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.
13 #include <linux/module.h>
14 #include <linux/platform_device.h>
15 #include <linux/slab.h>
16 #include <linux/mtd/mtd.h>
17 #include <linux/mtd/nand.h>
18 #include <linux/mtd/partitions.h>
20 struct plat_nand_data
{
21 struct nand_chip chip
;
23 void __iomem
*io_base
;
25 struct mtd_partition
*parts
;
29 * Probe for the NAND device.
31 static int __devinit
plat_nand_probe(struct platform_device
*pdev
)
33 struct platform_nand_data
*pdata
= pdev
->dev
.platform_data
;
34 struct plat_nand_data
*data
;
38 if (pdata
->chip
.nr_chips
< 1) {
39 dev_err(&pdev
->dev
, "invalid number of chips specified\n");
43 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
47 /* Allocate memory for the device structure (and zero it) */
48 data
= kzalloc(sizeof(struct plat_nand_data
), GFP_KERNEL
);
50 dev_err(&pdev
->dev
, "failed to allocate device structure.\n");
54 if (!request_mem_region(res
->start
, resource_size(res
),
55 dev_name(&pdev
->dev
))) {
56 dev_err(&pdev
->dev
, "request_mem_region failed\n");
61 data
->io_base
= ioremap(res
->start
, resource_size(res
));
62 if (data
->io_base
== NULL
) {
63 dev_err(&pdev
->dev
, "ioremap failed\n");
68 data
->chip
.priv
= &data
;
69 data
->mtd
.priv
= &data
->chip
;
70 data
->mtd
.owner
= THIS_MODULE
;
71 data
->mtd
.name
= dev_name(&pdev
->dev
);
73 data
->chip
.IO_ADDR_R
= data
->io_base
;
74 data
->chip
.IO_ADDR_W
= data
->io_base
;
75 data
->chip
.cmd_ctrl
= pdata
->ctrl
.cmd_ctrl
;
76 data
->chip
.dev_ready
= pdata
->ctrl
.dev_ready
;
77 data
->chip
.select_chip
= pdata
->ctrl
.select_chip
;
78 data
->chip
.write_buf
= pdata
->ctrl
.write_buf
;
79 data
->chip
.read_buf
= pdata
->ctrl
.read_buf
;
80 data
->chip
.chip_delay
= pdata
->chip
.chip_delay
;
81 data
->chip
.options
|= pdata
->chip
.options
;
82 data
->chip
.bbt_options
|= pdata
->chip
.bbt_options
;
84 data
->chip
.ecc
.hwctl
= pdata
->ctrl
.hwcontrol
;
85 data
->chip
.ecc
.layout
= pdata
->chip
.ecclayout
;
86 data
->chip
.ecc
.mode
= NAND_ECC_SOFT
;
88 platform_set_drvdata(pdev
, data
);
90 /* Handle any platform specific setup */
91 if (pdata
->ctrl
.probe
) {
92 err
= pdata
->ctrl
.probe(pdev
);
97 /* Scan to find existence of the device */
98 if (nand_scan(&data
->mtd
, pdata
->chip
.nr_chips
)) {
103 if (pdata
->chip
.part_probe_types
) {
104 err
= parse_mtd_partitions(&data
->mtd
,
105 pdata
->chip
.part_probe_types
,
108 mtd_device_register(&data
->mtd
, data
->parts
, err
);
112 if (pdata
->chip
.partitions
) {
113 data
->parts
= pdata
->chip
.partitions
;
114 err
= mtd_device_register(&data
->mtd
, data
->parts
,
115 pdata
->chip
.nr_partitions
);
117 err
= mtd_device_register(&data
->mtd
, NULL
, 0);
122 nand_release(&data
->mtd
);
124 if (pdata
->ctrl
.remove
)
125 pdata
->ctrl
.remove(pdev
);
126 platform_set_drvdata(pdev
, NULL
);
127 iounmap(data
->io_base
);
129 release_mem_region(res
->start
, resource_size(res
));
136 * Remove a NAND device.
138 static int __devexit
plat_nand_remove(struct platform_device
*pdev
)
140 struct plat_nand_data
*data
= platform_get_drvdata(pdev
);
141 struct platform_nand_data
*pdata
= pdev
->dev
.platform_data
;
142 struct resource
*res
;
144 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
146 nand_release(&data
->mtd
);
147 if (data
->parts
&& data
->parts
!= pdata
->chip
.partitions
)
149 if (pdata
->ctrl
.remove
)
150 pdata
->ctrl
.remove(pdev
);
151 iounmap(data
->io_base
);
152 release_mem_region(res
->start
, resource_size(res
));
158 static struct platform_driver plat_nand_driver
= {
159 .probe
= plat_nand_probe
,
160 .remove
= __devexit_p(plat_nand_remove
),
163 .owner
= THIS_MODULE
,
167 static int __init
plat_nand_init(void)
169 return platform_driver_register(&plat_nand_driver
);
172 static void __exit
plat_nand_exit(void)
174 platform_driver_unregister(&plat_nand_driver
);
177 module_init(plat_nand_init
);
178 module_exit(plat_nand_exit
);
180 MODULE_LICENSE("GPL");
181 MODULE_AUTHOR("Vitaly Wool");
182 MODULE_DESCRIPTION("Simple generic NAND driver");
183 MODULE_ALIAS("platform:gen_nand");