4 * Author: Vitaly Wool <vitalywool@gmail.com>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
12 #include <linux/err.h>
14 #include <linux/module.h>
15 #include <linux/platform_device.h>
16 #include <linux/slab.h>
17 #include <linux/mtd/mtd.h>
18 #include <linux/mtd/platnand.h>
20 struct plat_nand_data
{
21 struct nand_chip chip
;
22 void __iomem
*io_base
;
26 * Probe for the NAND device.
28 static int plat_nand_probe(struct platform_device
*pdev
)
30 struct platform_nand_data
*pdata
= dev_get_platdata(&pdev
->dev
);
31 struct plat_nand_data
*data
;
34 const char **part_types
;
38 dev_err(&pdev
->dev
, "platform_nand_data is missing\n");
42 if (pdata
->chip
.nr_chips
< 1) {
43 dev_err(&pdev
->dev
, "invalid number of chips specified\n");
47 /* Allocate memory for the device structure (and zero it) */
48 data
= devm_kzalloc(&pdev
->dev
, sizeof(struct plat_nand_data
),
53 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
54 data
->io_base
= devm_ioremap_resource(&pdev
->dev
, res
);
55 if (IS_ERR(data
->io_base
))
56 return PTR_ERR(data
->io_base
);
58 nand_set_flash_node(&data
->chip
, pdev
->dev
.of_node
);
59 mtd
= nand_to_mtd(&data
->chip
);
60 mtd
->dev
.parent
= &pdev
->dev
;
62 data
->chip
.legacy
.IO_ADDR_R
= data
->io_base
;
63 data
->chip
.legacy
.IO_ADDR_W
= data
->io_base
;
64 data
->chip
.legacy
.cmd_ctrl
= pdata
->ctrl
.cmd_ctrl
;
65 data
->chip
.legacy
.dev_ready
= pdata
->ctrl
.dev_ready
;
66 data
->chip
.legacy
.select_chip
= pdata
->ctrl
.select_chip
;
67 data
->chip
.legacy
.write_buf
= pdata
->ctrl
.write_buf
;
68 data
->chip
.legacy
.read_buf
= pdata
->ctrl
.read_buf
;
69 data
->chip
.legacy
.chip_delay
= pdata
->chip
.chip_delay
;
70 data
->chip
.options
|= pdata
->chip
.options
;
71 data
->chip
.bbt_options
|= pdata
->chip
.bbt_options
;
73 data
->chip
.ecc
.mode
= NAND_ECC_SOFT
;
74 data
->chip
.ecc
.algo
= NAND_ECC_HAMMING
;
76 platform_set_drvdata(pdev
, data
);
78 /* Handle any platform specific setup */
79 if (pdata
->ctrl
.probe
) {
80 err
= pdata
->ctrl
.probe(pdev
);
85 /* Scan to find existence of the device */
86 err
= nand_scan(&data
->chip
, pdata
->chip
.nr_chips
);
90 part_types
= pdata
->chip
.part_probe_types
;
92 err
= mtd_device_parse_register(mtd
, part_types
, NULL
,
93 pdata
->chip
.partitions
,
94 pdata
->chip
.nr_partitions
);
99 nand_release(&data
->chip
);
101 if (pdata
->ctrl
.remove
)
102 pdata
->ctrl
.remove(pdev
);
107 * Remove a NAND device.
109 static int plat_nand_remove(struct platform_device
*pdev
)
111 struct plat_nand_data
*data
= platform_get_drvdata(pdev
);
112 struct platform_nand_data
*pdata
= dev_get_platdata(&pdev
->dev
);
114 nand_release(&data
->chip
);
115 if (pdata
->ctrl
.remove
)
116 pdata
->ctrl
.remove(pdev
);
121 static const struct of_device_id plat_nand_match
[] = {
122 { .compatible
= "gen_nand" },
125 MODULE_DEVICE_TABLE(of
, plat_nand_match
);
127 static struct platform_driver plat_nand_driver
= {
128 .probe
= plat_nand_probe
,
129 .remove
= plat_nand_remove
,
132 .of_match_table
= plat_nand_match
,
136 module_platform_driver(plat_nand_driver
);
138 MODULE_LICENSE("GPL");
139 MODULE_AUTHOR("Vitaly Wool");
140 MODULE_DESCRIPTION("Simple generic NAND driver");
141 MODULE_ALIAS("platform:gen_nand");