2 * Normal mappings of chips in physical memory
4 * Copyright (C) 2003 MontaVista Software Inc.
5 * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
7 * 031022 - [jsun] add run-time configure and partition setup
10 #include <linux/module.h>
11 #include <linux/types.h>
12 #include <linux/kernel.h>
13 #include <linux/init.h>
14 #include <linux/slab.h>
15 #include <linux/device.h>
16 #include <linux/platform_device.h>
17 #include <linux/mtd/mtd.h>
18 #include <linux/mtd/map.h>
19 #include <linux/mtd/partitions.h>
20 #include <linux/mtd/physmap.h>
21 #include <linux/mtd/concat.h>
24 #define MAX_RESOURCES 4
26 struct physmap_flash_info
{
27 struct mtd_info
*mtd
[MAX_RESOURCES
];
28 struct mtd_info
*cmtd
;
29 struct map_info map
[MAX_RESOURCES
];
31 struct mtd_partition
*parts
;
34 static int physmap_flash_remove(struct platform_device
*dev
)
36 struct physmap_flash_info
*info
;
37 struct physmap_flash_data
*physmap_data
;
40 info
= platform_get_drvdata(dev
);
43 platform_set_drvdata(dev
, NULL
);
45 physmap_data
= dev
->dev
.platform_data
;
48 mtd_device_unregister(info
->cmtd
);
51 if (info
->cmtd
!= info
->mtd
[0])
52 mtd_concat_destroy(info
->cmtd
);
55 for (i
= 0; i
< MAX_RESOURCES
; i
++) {
56 if (info
->mtd
[i
] != NULL
)
57 map_destroy(info
->mtd
[i
]);
60 if (physmap_data
->exit
)
61 physmap_data
->exit(dev
);
66 static void physmap_set_vpp(struct map_info
*map
, int state
)
68 struct platform_device
*pdev
;
69 struct physmap_flash_data
*physmap_data
;
71 pdev
= (struct platform_device
*)map
->map_priv_1
;
72 physmap_data
= pdev
->dev
.platform_data
;
74 if (physmap_data
->set_vpp
)
75 physmap_data
->set_vpp(pdev
, state
);
78 static const char *rom_probe_types
[] = {
84 static const char *part_probe_types
[] = { "cmdlinepart", "RedBoot", "afs",
87 static int physmap_flash_probe(struct platform_device
*dev
)
89 struct physmap_flash_data
*physmap_data
;
90 struct physmap_flash_info
*info
;
91 const char **probe_type
;
94 int devices_found
= 0;
96 physmap_data
= dev
->dev
.platform_data
;
97 if (physmap_data
== NULL
)
100 info
= devm_kzalloc(&dev
->dev
, sizeof(struct physmap_flash_info
),
107 if (physmap_data
->init
) {
108 err
= physmap_data
->init(dev
);
113 platform_set_drvdata(dev
, info
);
115 for (i
= 0; i
< dev
->num_resources
; i
++) {
116 printk(KERN_NOTICE
"physmap platform flash device: %.8llx at %.8llx\n",
117 (unsigned long long)resource_size(&dev
->resource
[i
]),
118 (unsigned long long)dev
->resource
[i
].start
);
120 if (!devm_request_mem_region(&dev
->dev
,
121 dev
->resource
[i
].start
,
122 resource_size(&dev
->resource
[i
]),
123 dev_name(&dev
->dev
))) {
124 dev_err(&dev
->dev
, "Could not reserve memory region\n");
129 info
->map
[i
].name
= dev_name(&dev
->dev
);
130 info
->map
[i
].phys
= dev
->resource
[i
].start
;
131 info
->map
[i
].size
= resource_size(&dev
->resource
[i
]);
132 info
->map
[i
].bankwidth
= physmap_data
->width
;
133 info
->map
[i
].set_vpp
= physmap_set_vpp
;
134 info
->map
[i
].pfow_base
= physmap_data
->pfow_base
;
135 info
->map
[i
].map_priv_1
= (unsigned long)dev
;
137 info
->map
[i
].virt
= devm_ioremap(&dev
->dev
, info
->map
[i
].phys
,
139 if (info
->map
[i
].virt
== NULL
) {
140 dev_err(&dev
->dev
, "Failed to ioremap flash region\n");
145 simple_map_init(&info
->map
[i
]);
147 probe_type
= rom_probe_types
;
148 if (physmap_data
->probe_type
== NULL
) {
149 for (; info
->mtd
[i
] == NULL
&& *probe_type
!= NULL
; probe_type
++)
150 info
->mtd
[i
] = do_map_probe(*probe_type
, &info
->map
[i
]);
152 info
->mtd
[i
] = do_map_probe(physmap_data
->probe_type
, &info
->map
[i
]);
154 if (info
->mtd
[i
] == NULL
) {
155 dev_err(&dev
->dev
, "map_probe failed\n");
161 info
->mtd
[i
]->owner
= THIS_MODULE
;
162 info
->mtd
[i
]->dev
.parent
= &dev
->dev
;
165 if (devices_found
== 1) {
166 info
->cmtd
= info
->mtd
[0];
167 } else if (devices_found
> 1) {
169 * We detected multiple devices. Concatenate them together.
171 info
->cmtd
= mtd_concat_create(info
->mtd
, devices_found
, dev_name(&dev
->dev
));
172 if (info
->cmtd
== NULL
)
178 err
= parse_mtd_partitions(info
->cmtd
, part_probe_types
,
181 mtd_device_register(info
->cmtd
, info
->parts
, err
);
182 info
->nr_parts
= err
;
186 if (physmap_data
->nr_parts
) {
187 printk(KERN_NOTICE
"Using physmap partition information\n");
188 mtd_device_register(info
->cmtd
, physmap_data
->parts
,
189 physmap_data
->nr_parts
);
193 mtd_device_register(info
->cmtd
, NULL
, 0);
198 physmap_flash_remove(dev
);
203 static void physmap_flash_shutdown(struct platform_device
*dev
)
205 struct physmap_flash_info
*info
= platform_get_drvdata(dev
);
208 for (i
= 0; i
< MAX_RESOURCES
&& info
->mtd
[i
]; i
++)
209 if (info
->mtd
[i
]->suspend
&& info
->mtd
[i
]->resume
)
210 if (info
->mtd
[i
]->suspend(info
->mtd
[i
]) == 0)
211 info
->mtd
[i
]->resume(info
->mtd
[i
]);
214 #define physmap_flash_shutdown NULL
217 static struct platform_driver physmap_flash_driver
= {
218 .probe
= physmap_flash_probe
,
219 .remove
= physmap_flash_remove
,
220 .shutdown
= physmap_flash_shutdown
,
222 .name
= "physmap-flash",
223 .owner
= THIS_MODULE
,
228 #ifdef CONFIG_MTD_PHYSMAP_COMPAT
229 static struct physmap_flash_data physmap_flash_data
= {
230 .width
= CONFIG_MTD_PHYSMAP_BANKWIDTH
,
233 static struct resource physmap_flash_resource
= {
234 .start
= CONFIG_MTD_PHYSMAP_START
,
235 .end
= CONFIG_MTD_PHYSMAP_START
+ CONFIG_MTD_PHYSMAP_LEN
- 1,
236 .flags
= IORESOURCE_MEM
,
239 static struct platform_device physmap_flash
= {
240 .name
= "physmap-flash",
243 .platform_data
= &physmap_flash_data
,
246 .resource
= &physmap_flash_resource
,
249 void physmap_configure(unsigned long addr
, unsigned long size
,
250 int bankwidth
, void (*set_vpp
)(struct map_info
*, int))
252 physmap_flash_resource
.start
= addr
;
253 physmap_flash_resource
.end
= addr
+ size
- 1;
254 physmap_flash_data
.width
= bankwidth
;
255 physmap_flash_data
.set_vpp
= set_vpp
;
258 void physmap_set_partitions(struct mtd_partition
*parts
, int num_parts
)
260 physmap_flash_data
.nr_parts
= num_parts
;
261 physmap_flash_data
.parts
= parts
;
265 static int __init
physmap_init(void)
269 err
= platform_driver_register(&physmap_flash_driver
);
270 #ifdef CONFIG_MTD_PHYSMAP_COMPAT
272 err
= platform_device_register(&physmap_flash
);
274 platform_driver_unregister(&physmap_flash_driver
);
281 static void __exit
physmap_exit(void)
283 #ifdef CONFIG_MTD_PHYSMAP_COMPAT
284 platform_device_unregister(&physmap_flash
);
286 platform_driver_unregister(&physmap_flash_driver
);
289 module_init(physmap_init
);
290 module_exit(physmap_exit
);
292 MODULE_LICENSE("GPL");
293 MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
294 MODULE_DESCRIPTION("Generic configurable MTD map driver");
296 /* legacy platform drivers can't hotplug or coldplg */
297 #ifndef CONFIG_MTD_PHYSMAP_COMPAT
298 /* work with hotplug and coldplug */
299 MODULE_ALIAS("platform:physmap-flash");