2 * Flash memory access on SA11x0 based devices
4 * (C) 2000 Nicolas Pitre <nico@fluxnic.net>
6 #include <linux/module.h>
7 #include <linux/types.h>
8 #include <linux/ioport.h>
9 #include <linux/kernel.h>
10 #include <linux/init.h>
11 #include <linux/errno.h>
12 #include <linux/slab.h>
13 #include <linux/platform_device.h>
14 #include <linux/err.h>
17 #include <linux/mtd/mtd.h>
18 #include <linux/mtd/map.h>
19 #include <linux/mtd/partitions.h>
20 #include <linux/mtd/concat.h>
22 #include <mach/hardware.h>
23 #include <asm/sizes.h>
24 #include <asm/mach/flash.h>
27 struct sa_subdev_info
{
31 struct flash_platform_data
*plat
;
35 struct mtd_partition
*parts
;
38 unsigned int nr_parts
;
39 struct sa_subdev_info subdev
[0];
42 static void sa1100_set_vpp(struct map_info
*map
, int on
)
44 struct sa_subdev_info
*subdev
= container_of(map
, struct sa_subdev_info
, map
);
45 subdev
->plat
->set_vpp(on
);
48 static void sa1100_destroy_subdev(struct sa_subdev_info
*subdev
)
51 map_destroy(subdev
->mtd
);
53 iounmap(subdev
->map
.virt
);
54 release_mem_region(subdev
->map
.phys
, subdev
->map
.size
);
57 static int sa1100_probe_subdev(struct sa_subdev_info
*subdev
, struct resource
*res
)
64 size
= res
->end
- phys
+ 1;
67 * Retrieve the bankwidth from the MSC registers.
68 * We currently only implement CS0 and CS1 here.
72 printk(KERN_WARNING
"SA1100 flash: unknown base address "
73 "0x%08lx, assuming CS0\n", phys
);
76 subdev
->map
.bankwidth
= (MSC0
& MSC_RBW
) ? 2 : 4;
80 subdev
->map
.bankwidth
= ((MSC0
>> 16) & MSC_RBW
) ? 2 : 4;
84 if (!request_mem_region(phys
, size
, subdev
->name
)) {
89 if (subdev
->plat
->set_vpp
)
90 subdev
->map
.set_vpp
= sa1100_set_vpp
;
92 subdev
->map
.phys
= phys
;
93 subdev
->map
.size
= size
;
94 subdev
->map
.virt
= ioremap(phys
, size
);
95 if (!subdev
->map
.virt
) {
100 simple_map_init(&subdev
->map
);
103 * Now let's probe for the actual flash. Do it here since
104 * specific machine settings might have been set above.
106 subdev
->mtd
= do_map_probe(subdev
->plat
->map_name
, &subdev
->map
);
107 if (subdev
->mtd
== NULL
) {
111 subdev
->mtd
->owner
= THIS_MODULE
;
113 printk(KERN_INFO
"SA1100 flash: CFI device at 0x%08lx, %uMiB, %d-bit\n",
114 phys
, (unsigned)(subdev
->mtd
->size
>> 20),
115 subdev
->map
.bankwidth
* 8);
120 sa1100_destroy_subdev(subdev
);
125 static void sa1100_destroy(struct sa_info
*info
, struct flash_platform_data
*plat
)
130 if (info
->nr_parts
== 0)
131 del_mtd_device(info
->mtd
);
132 #ifdef CONFIG_MTD_PARTITIONS
134 del_mtd_partitions(info
->mtd
);
136 #ifdef CONFIG_MTD_CONCAT
137 if (info
->mtd
!= info
->subdev
[0].mtd
)
138 mtd_concat_destroy(info
->mtd
);
144 for (i
= info
->num_subdev
- 1; i
>= 0; i
--)
145 sa1100_destroy_subdev(&info
->subdev
[i
]);
152 static struct sa_info
*__devinit
153 sa1100_setup_mtd(struct platform_device
*pdev
, struct flash_platform_data
*plat
)
155 struct sa_info
*info
;
156 int nr
, size
, i
, ret
= 0;
159 * Count number of devices.
162 if (!platform_get_resource(pdev
, IORESOURCE_MEM
, nr
))
170 size
= sizeof(struct sa_info
) + sizeof(struct sa_subdev_info
) * nr
;
173 * Allocate the map_info structs in one go.
175 info
= kzalloc(size
, GFP_KERNEL
);
188 * Claim and then map the memory regions.
190 for (i
= 0; i
< nr
; i
++) {
191 struct sa_subdev_info
*subdev
= &info
->subdev
[i
];
192 struct resource
*res
;
194 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, i
);
198 subdev
->map
.name
= subdev
->name
;
199 sprintf(subdev
->name
, "%s-%d", plat
->name
, i
);
202 ret
= sa1100_probe_subdev(subdev
, res
);
207 info
->num_subdev
= i
;
210 * ENXIO is special. It means we didn't find a chip when we probed.
212 if (ret
!= 0 && !(ret
== -ENXIO
&& info
->num_subdev
> 0))
216 * If we found one device, don't bother with concat support. If
217 * we found multiple devices, use concat if we have it available,
218 * otherwise fail. Either way, it'll be called "sa1100".
220 if (info
->num_subdev
== 1) {
221 strcpy(info
->subdev
[0].name
, plat
->name
);
222 info
->mtd
= info
->subdev
[0].mtd
;
224 } else if (info
->num_subdev
> 1) {
225 #ifdef CONFIG_MTD_CONCAT
226 struct mtd_info
*cdev
[nr
];
228 * We detected multiple devices. Concatenate them together.
230 for (i
= 0; i
< info
->num_subdev
; i
++)
231 cdev
[i
] = info
->subdev
[i
].mtd
;
233 info
->mtd
= mtd_concat_create(cdev
, info
->num_subdev
,
235 if (info
->mtd
== NULL
)
238 printk(KERN_ERR
"SA1100 flash: multiple devices "
239 "found but MTD concat support disabled.\n");
248 sa1100_destroy(info
, plat
);
253 static const char *part_probes
[] = { "cmdlinepart", "RedBoot", NULL
};
255 static int __devinit
sa1100_mtd_probe(struct platform_device
*pdev
)
257 struct flash_platform_data
*plat
= pdev
->dev
.platform_data
;
258 struct mtd_partition
*parts
;
259 const char *part_type
= NULL
;
260 struct sa_info
*info
;
261 int err
, nr_parts
= 0;
266 info
= sa1100_setup_mtd(pdev
, plat
);
273 * Partition selection stuff.
275 #ifdef CONFIG_MTD_PARTITIONS
276 nr_parts
= parse_mtd_partitions(info
->mtd
, part_probes
, &parts
, 0);
279 part_type
= "dynamic";
284 nr_parts
= plat
->nr_parts
;
285 part_type
= "static";
289 printk(KERN_NOTICE
"SA1100 flash: no partition info "
290 "available, registering whole flash\n");
291 add_mtd_device(info
->mtd
);
293 printk(KERN_NOTICE
"SA1100 flash: using %s partition "
294 "definition\n", part_type
);
295 add_mtd_partitions(info
->mtd
, parts
, nr_parts
);
298 info
->nr_parts
= nr_parts
;
300 platform_set_drvdata(pdev
, info
);
307 static int __exit
sa1100_mtd_remove(struct platform_device
*pdev
)
309 struct sa_info
*info
= platform_get_drvdata(pdev
);
310 struct flash_platform_data
*plat
= pdev
->dev
.platform_data
;
312 platform_set_drvdata(pdev
, NULL
);
313 sa1100_destroy(info
, plat
);
319 static void sa1100_mtd_shutdown(struct platform_device
*dev
)
321 struct sa_info
*info
= platform_get_drvdata(dev
);
322 if (info
&& info
->mtd
->suspend(info
->mtd
) == 0)
323 info
->mtd
->resume(info
->mtd
);
326 #define sa1100_mtd_shutdown NULL
329 static struct platform_driver sa1100_mtd_driver
= {
330 .probe
= sa1100_mtd_probe
,
331 .remove
= __exit_p(sa1100_mtd_remove
),
332 .shutdown
= sa1100_mtd_shutdown
,
334 .name
= "sa1100-mtd",
335 .owner
= THIS_MODULE
,
339 static int __init
sa1100_mtd_init(void)
341 return platform_driver_register(&sa1100_mtd_driver
);
344 static void __exit
sa1100_mtd_exit(void)
346 platform_driver_unregister(&sa1100_mtd_driver
);
349 module_init(sa1100_mtd_init
);
350 module_exit(sa1100_mtd_exit
);
352 MODULE_AUTHOR("Nicolas Pitre");
353 MODULE_DESCRIPTION("SA1100 CFI map driver");
354 MODULE_LICENSE("GPL");
355 MODULE_ALIAS("platform:sa1100-mtd");