1 // SPDX-License-Identifier: GPL-2.0-only
18 #include <linux/mtd/mtd.h>
19 #include <linux/mtd/map.h>
20 #include <linux/mtd/partitions.h>
21 #include <linux/mtd/concat.h>
28 	char name[16];  member
30 	struct mtd_info *mtd;  member
35 	struct mtd_info		*mtd;  member
50 			subdev->plat->set_vpp(1);  in sa1100_set_vpp()
52 		if (--sa1100_vpp_refcnt == 0)   /* last nested 'off' */  in sa1100_set_vpp()
53 			subdev->plat->set_vpp(0);  in sa1100_set_vpp()
60 	if (subdev->mtd)  in sa1100_destroy_subdev()
61 		map_destroy(subdev->mtd);  in sa1100_destroy_subdev()
62 	if (subdev->map.virt)  in sa1100_destroy_subdev()
63 		iounmap(subdev->map.virt);  in sa1100_destroy_subdev()
64 	release_mem_region(subdev->map.phys, subdev->map.size);  in sa1100_destroy_subdev()
73 	phys = res->start;  in sa1100_probe_subdev()
74 	size = res->end - phys + 1;  in sa1100_probe_subdev()
86 		subdev->map.bankwidth = (MSC0 & MSC_RBW) ? 2 : 4;  in sa1100_probe_subdev()
90 		subdev->map.bankwidth = ((MSC0 >> 16) & MSC_RBW) ? 2 : 4;  in sa1100_probe_subdev()
94 	if (!request_mem_region(phys, size, subdev->name)) {  in sa1100_probe_subdev()
95 		ret = -EBUSY;  in sa1100_probe_subdev()
99 	if (subdev->plat->set_vpp)  in sa1100_probe_subdev()
100 		subdev->map.set_vpp = sa1100_set_vpp;  in sa1100_probe_subdev()
102 	subdev->map.phys = phys;  in sa1100_probe_subdev()
103 	subdev->map.size = size;  in sa1100_probe_subdev()
104 	subdev->map.virt = ioremap(phys, size);  in sa1100_probe_subdev()
105 	if (!subdev->map.virt) {  in sa1100_probe_subdev()
106 		ret = -ENOMEM;  in sa1100_probe_subdev()
110 	simple_map_init(&subdev->map);  in sa1100_probe_subdev()
116 	subdev->mtd = do_map_probe(subdev->plat->map_name, &subdev->map);  in sa1100_probe_subdev()
117 	if (subdev->mtd == NULL) {  in sa1100_probe_subdev()
118 		ret = -ENXIO;  in sa1100_probe_subdev()
122 	printk(KERN_INFO "SA1100 flash: CFI device at 0x%08lx, %uMiB, %d-bit\n",  in sa1100_probe_subdev()
123 		phys, (unsigned)(subdev->mtd->size >> 20),  in sa1100_probe_subdev()
124 		subdev->map.bankwidth * 8);  in sa1100_probe_subdev()
138 	if (info->mtd) {  in sa1100_destroy()
139 		mtd_device_unregister(info->mtd);  in sa1100_destroy()
140 		if (info->mtd != info->subdev[0].mtd)  in sa1100_destroy()
141 			mtd_concat_destroy(info->mtd);  in sa1100_destroy()
144 	for (i = info->num_subdev - 1; i >= 0; i--)  in sa1100_destroy()
145 		sa1100_destroy_subdev(&info->subdev[i]);  in sa1100_destroy()
148 	if (plat->exit)  in sa1100_destroy()
149 		plat->exit();  in sa1100_destroy()
166 		ret = -ENODEV;  in sa1100_setup_mtd()
177 		ret = -ENOMEM;  in sa1100_setup_mtd()
181 	if (plat->init) {  in sa1100_setup_mtd()
182 		ret = plat->init();  in sa1100_setup_mtd()
191 		struct sa_subdev_info *subdev = &info->subdev[i];  in sa1100_setup_mtd()
198 		subdev->map.name = subdev->name;  in sa1100_setup_mtd()
199 		sprintf(subdev->name, "%s-%d", plat->name, i);  in sa1100_setup_mtd()
200 		subdev->plat = plat;  in sa1100_setup_mtd()
207 	info->num_subdev = i;  in sa1100_setup_mtd()
212 	if (ret != 0 && !(ret == -ENXIO && info->num_subdev > 0))  in sa1100_setup_mtd()
220 	if (info->num_subdev == 1) {  in sa1100_setup_mtd()
221 		strcpy(info->subdev[0].name, plat->name);  in sa1100_setup_mtd()
222 		info->mtd = info->subdev[0].mtd;  in sa1100_setup_mtd()
224 	} else if (info->num_subdev > 1) {  in sa1100_setup_mtd()
229 			ret = -ENOMEM;  in sa1100_setup_mtd()
236 		for (i = 0; i < info->num_subdev; i++)  in sa1100_setup_mtd()
237 			cdev[i] = info->subdev[i].mtd;  in sa1100_setup_mtd()
239 		info->mtd = mtd_concat_create(cdev, info->num_subdev,  in sa1100_setup_mtd()
240 					      plat->name);  in sa1100_setup_mtd()
242 		if (info->mtd == NULL) {  in sa1100_setup_mtd()
243 			ret = -ENXIO;  in sa1100_setup_mtd()
247 	info->mtd->dev.parent = &pdev->dev;  in sa1100_setup_mtd()
262 	struct flash_platform_data *plat = dev_get_platdata(&pdev->dev);  in sa1100_mtd_probe()
267 		return -ENODEV;  in sa1100_mtd_probe()
278 	mtd_device_parse_register(info->mtd, part_probes, NULL, plat->parts,  in sa1100_mtd_probe()
279 				  plat->nr_parts);  in sa1100_mtd_probe()
291 	struct flash_platform_data *plat = dev_get_platdata(&pdev->dev);  in sa1100_mtd_remove()
302 		.name	= "sa1100-mtd",
311 MODULE_ALIAS("platform:sa1100-mtd");