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>
26 struct sa_subdev_info
{
30 struct flash_platform_data
*plat
;
36 struct sa_subdev_info subdev
[0];
39 static void sa1100_set_vpp(struct map_info
*map
, int on
)
41 struct sa_subdev_info
*subdev
= container_of(map
, struct sa_subdev_info
, map
);
42 subdev
->plat
->set_vpp(on
);
45 static void sa1100_destroy_subdev(struct sa_subdev_info
*subdev
)
48 map_destroy(subdev
->mtd
);
50 iounmap(subdev
->map
.virt
);
51 release_mem_region(subdev
->map
.phys
, subdev
->map
.size
);
54 static int sa1100_probe_subdev(struct sa_subdev_info
*subdev
, struct resource
*res
)
61 size
= res
->end
- phys
+ 1;
64 * Retrieve the bankwidth from the MSC registers.
65 * We currently only implement CS0 and CS1 here.
69 printk(KERN_WARNING
"SA1100 flash: unknown base address "
70 "0x%08lx, assuming CS0\n", phys
);
73 subdev
->map
.bankwidth
= (MSC0
& MSC_RBW
) ? 2 : 4;
77 subdev
->map
.bankwidth
= ((MSC0
>> 16) & MSC_RBW
) ? 2 : 4;
81 if (!request_mem_region(phys
, size
, subdev
->name
)) {
86 if (subdev
->plat
->set_vpp
)
87 subdev
->map
.set_vpp
= sa1100_set_vpp
;
89 subdev
->map
.phys
= phys
;
90 subdev
->map
.size
= size
;
91 subdev
->map
.virt
= ioremap(phys
, size
);
92 if (!subdev
->map
.virt
) {
97 simple_map_init(&subdev
->map
);
100 * Now let's probe for the actual flash. Do it here since
101 * specific machine settings might have been set above.
103 subdev
->mtd
= do_map_probe(subdev
->plat
->map_name
, &subdev
->map
);
104 if (subdev
->mtd
== NULL
) {
108 subdev
->mtd
->owner
= THIS_MODULE
;
110 printk(KERN_INFO
"SA1100 flash: CFI device at 0x%08lx, %uMiB, %d-bit\n",
111 phys
, (unsigned)(subdev
->mtd
->size
>> 20),
112 subdev
->map
.bankwidth
* 8);
117 sa1100_destroy_subdev(subdev
);
122 static void sa1100_destroy(struct sa_info
*info
, struct flash_platform_data
*plat
)
127 mtd_device_unregister(info
->mtd
);
128 if (info
->mtd
!= info
->subdev
[0].mtd
)
129 mtd_concat_destroy(info
->mtd
);
132 for (i
= info
->num_subdev
- 1; i
>= 0; i
--)
133 sa1100_destroy_subdev(&info
->subdev
[i
]);
140 static struct sa_info
*__devinit
141 sa1100_setup_mtd(struct platform_device
*pdev
, struct flash_platform_data
*plat
)
143 struct sa_info
*info
;
144 int nr
, size
, i
, ret
= 0;
147 * Count number of devices.
150 if (!platform_get_resource(pdev
, IORESOURCE_MEM
, nr
))
158 size
= sizeof(struct sa_info
) + sizeof(struct sa_subdev_info
) * nr
;
161 * Allocate the map_info structs in one go.
163 info
= kzalloc(size
, GFP_KERNEL
);
176 * Claim and then map the memory regions.
178 for (i
= 0; i
< nr
; i
++) {
179 struct sa_subdev_info
*subdev
= &info
->subdev
[i
];
180 struct resource
*res
;
182 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, i
);
186 subdev
->map
.name
= subdev
->name
;
187 sprintf(subdev
->name
, "%s-%d", plat
->name
, i
);
190 ret
= sa1100_probe_subdev(subdev
, res
);
195 info
->num_subdev
= i
;
198 * ENXIO is special. It means we didn't find a chip when we probed.
200 if (ret
!= 0 && !(ret
== -ENXIO
&& info
->num_subdev
> 0))
204 * If we found one device, don't bother with concat support. If
205 * we found multiple devices, use concat if we have it available,
206 * otherwise fail. Either way, it'll be called "sa1100".
208 if (info
->num_subdev
== 1) {
209 strcpy(info
->subdev
[0].name
, plat
->name
);
210 info
->mtd
= info
->subdev
[0].mtd
;
212 } else if (info
->num_subdev
> 1) {
213 struct mtd_info
*cdev
[nr
];
215 * We detected multiple devices. Concatenate them together.
217 for (i
= 0; i
< info
->num_subdev
; i
++)
218 cdev
[i
] = info
->subdev
[i
].mtd
;
220 info
->mtd
= mtd_concat_create(cdev
, info
->num_subdev
,
222 if (info
->mtd
== NULL
)
230 sa1100_destroy(info
, plat
);
235 static const char *part_probes
[] = { "cmdlinepart", "RedBoot", NULL
};
237 static int __devinit
sa1100_mtd_probe(struct platform_device
*pdev
)
239 struct flash_platform_data
*plat
= pdev
->dev
.platform_data
;
240 struct sa_info
*info
;
246 info
= sa1100_setup_mtd(pdev
, plat
);
253 * Partition selection stuff.
255 mtd_device_parse_register(info
->mtd
, part_probes
, 0,
256 plat
->parts
, plat
->nr_parts
);
258 platform_set_drvdata(pdev
, info
);
265 static int __exit
sa1100_mtd_remove(struct platform_device
*pdev
)
267 struct sa_info
*info
= platform_get_drvdata(pdev
);
268 struct flash_platform_data
*plat
= pdev
->dev
.platform_data
;
270 platform_set_drvdata(pdev
, NULL
);
271 sa1100_destroy(info
, plat
);
276 static struct platform_driver sa1100_mtd_driver
= {
277 .probe
= sa1100_mtd_probe
,
278 .remove
= __exit_p(sa1100_mtd_remove
),
280 .name
= "sa1100-mtd",
281 .owner
= THIS_MODULE
,
285 module_platform_driver(sa1100_mtd_driver
);
287 MODULE_AUTHOR("Nicolas Pitre");
288 MODULE_DESCRIPTION("SA1100 CFI map driver");
289 MODULE_LICENSE("GPL");
290 MODULE_ALIAS("platform:sa1100-mtd");