Merge branch 'x86/core' into x86/xsave
[linux-2.6] / drivers / mtd / maps / physmap.c
1 /*
2  * Normal mappings of chips in physical memory
3  *
4  * Copyright (C) 2003 MontaVista Software Inc.
5  * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
6  *
7  * 031022 - [jsun] add run-time configure and partition setup
8  */
9
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>
22 #include <asm/io.h>
23
24 #define MAX_RESOURCES           4
25
26 struct physmap_flash_info {
27         struct mtd_info         *mtd[MAX_RESOURCES];
28         struct mtd_info         *cmtd;
29         struct map_info         map[MAX_RESOURCES];
30         struct resource         *res;
31 #ifdef CONFIG_MTD_PARTITIONS
32         int                     nr_parts;
33         struct mtd_partition    *parts;
34 #endif
35 };
36
37 static int physmap_flash_remove(struct platform_device *dev)
38 {
39         struct physmap_flash_info *info;
40         struct physmap_flash_data *physmap_data;
41         int i;
42
43         info = platform_get_drvdata(dev);
44         if (info == NULL)
45                 return 0;
46         platform_set_drvdata(dev, NULL);
47
48         physmap_data = dev->dev.platform_data;
49
50 #ifdef CONFIG_MTD_CONCAT
51         if (info->cmtd != info->mtd[0]) {
52                 del_mtd_device(info->cmtd);
53                 mtd_concat_destroy(info->cmtd);
54         }
55 #endif
56
57         for (i = 0; i < MAX_RESOURCES; i++) {
58                 if (info->mtd[i] != NULL) {
59 #ifdef CONFIG_MTD_PARTITIONS
60                         if (info->nr_parts) {
61                                 del_mtd_partitions(info->mtd[i]);
62                                 kfree(info->parts);
63                         } else if (physmap_data->nr_parts) {
64                                 del_mtd_partitions(info->mtd[i]);
65                         } else {
66                                 del_mtd_device(info->mtd[i]);
67                         }
68 #else
69                         del_mtd_device(info->mtd[i]);
70 #endif
71                         map_destroy(info->mtd[i]);
72                 }
73
74                 if (info->map[i].virt != NULL)
75                         iounmap(info->map[i].virt);
76         }
77
78         if (info->res != NULL) {
79                 release_resource(info->res);
80                 kfree(info->res);
81         }
82
83         return 0;
84 }
85
86 static const char *rom_probe_types[] = { "cfi_probe", "jedec_probe", "map_rom", NULL };
87 #ifdef CONFIG_MTD_PARTITIONS
88 static const char *part_probe_types[] = { "cmdlinepart", "RedBoot", NULL };
89 #endif
90
91 static int physmap_flash_probe(struct platform_device *dev)
92 {
93         struct physmap_flash_data *physmap_data;
94         struct physmap_flash_info *info;
95         const char **probe_type;
96         int err = 0;
97         int i;
98         int devices_found = 0;
99
100         physmap_data = dev->dev.platform_data;
101         if (physmap_data == NULL)
102                 return -ENODEV;
103
104         info = kzalloc(sizeof(struct physmap_flash_info), GFP_KERNEL);
105         if (info == NULL) {
106                 err = -ENOMEM;
107                 goto err_out;
108         }
109
110         platform_set_drvdata(dev, info);
111
112         for (i = 0; i < dev->num_resources; i++) {
113                 printk(KERN_NOTICE "physmap platform flash device: %.8llx at %.8llx\n",
114                        (unsigned long long)(dev->resource[i].end - dev->resource[i].start + 1),
115                        (unsigned long long)dev->resource[i].start);
116
117                 info->res = request_mem_region(dev->resource[i].start,
118                                                dev->resource[i].end - dev->resource[i].start + 1,
119                                                dev->dev.bus_id);
120                 if (info->res == NULL) {
121                         dev_err(&dev->dev, "Could not reserve memory region\n");
122                         err = -ENOMEM;
123                         goto err_out;
124                 }
125
126                 info->map[i].name = dev->dev.bus_id;
127                 info->map[i].phys = dev->resource[i].start;
128                 info->map[i].size = dev->resource[i].end - dev->resource[i].start + 1;
129                 info->map[i].bankwidth = physmap_data->width;
130                 info->map[i].set_vpp = physmap_data->set_vpp;
131
132                 info->map[i].virt = ioremap(info->map[i].phys, info->map[i].size);
133                 if (info->map[i].virt == NULL) {
134                         dev_err(&dev->dev, "Failed to ioremap flash region\n");
135                         err = EIO;
136                         goto err_out;
137                 }
138
139                 simple_map_init(&info->map[i]);
140
141                 probe_type = rom_probe_types;
142                 for (; info->mtd[i] == NULL && *probe_type != NULL; probe_type++)
143                         info->mtd[i] = do_map_probe(*probe_type, &info->map[i]);
144                 if (info->mtd[i] == NULL) {
145                         dev_err(&dev->dev, "map_probe failed\n");
146                         err = -ENXIO;
147                         goto err_out;
148                 } else {
149                         devices_found++;
150                 }
151                 info->mtd[i]->owner = THIS_MODULE;
152         }
153
154         if (devices_found == 1) {
155                 info->cmtd = info->mtd[0];
156         } else if (devices_found > 1) {
157                 /*
158                  * We detected multiple devices. Concatenate them together.
159                  */
160 #ifdef CONFIG_MTD_CONCAT
161                 info->cmtd = mtd_concat_create(info->mtd, devices_found, dev->dev.bus_id);
162                 if (info->cmtd == NULL)
163                         err = -ENXIO;
164 #else
165                 printk(KERN_ERR "physmap-flash: multiple devices "
166                        "found but MTD concat support disabled.\n");
167                 err = -ENXIO;
168 #endif
169         }
170         if (err)
171                 goto err_out;
172
173 #ifdef CONFIG_MTD_PARTITIONS
174         err = parse_mtd_partitions(info->cmtd, part_probe_types, &info->parts, 0);
175         if (err > 0) {
176                 add_mtd_partitions(info->cmtd, info->parts, err);
177                 return 0;
178         }
179
180         if (physmap_data->nr_parts) {
181                 printk(KERN_NOTICE "Using physmap partition information\n");
182                 add_mtd_partitions(info->cmtd, physmap_data->parts,
183                                    physmap_data->nr_parts);
184                 return 0;
185         }
186 #endif
187
188         add_mtd_device(info->cmtd);
189         return 0;
190
191 err_out:
192         physmap_flash_remove(dev);
193         return err;
194 }
195
196 #ifdef CONFIG_PM
197 static int physmap_flash_suspend(struct platform_device *dev, pm_message_t state)
198 {
199         struct physmap_flash_info *info = platform_get_drvdata(dev);
200         int ret = 0;
201         int i;
202
203         for (i = 0; i < MAX_RESOURCES && info->mtd[i]; i++)
204                 if (info->mtd[i]->suspend) {
205                         ret = info->mtd[i]->suspend(info->mtd[i]);
206                         if (ret)
207                                 goto fail;
208                 }
209
210         return 0;
211 fail:
212         for (--i; i >= 0; --i)
213                 if (info->mtd[i]->suspend) {
214                         BUG_ON(!info->mtd[i]->resume);
215                         info->mtd[i]->resume(info->mtd[i]);
216                 }
217
218         return ret;
219 }
220
221 static int physmap_flash_resume(struct platform_device *dev)
222 {
223         struct physmap_flash_info *info = platform_get_drvdata(dev);
224         int i;
225
226         for (i = 0; i < MAX_RESOURCES && info->mtd[i]; i++)
227                 if (info->mtd[i]->resume)
228                         info->mtd[i]->resume(info->mtd[i]);
229
230         return 0;
231 }
232
233 static void physmap_flash_shutdown(struct platform_device *dev)
234 {
235         struct physmap_flash_info *info = platform_get_drvdata(dev);
236         int i;
237
238         for (i = 0; i < MAX_RESOURCES && info->mtd[i]; i++)
239                 if (info->mtd[i]->suspend && info->mtd[i]->resume)
240                         if (info->mtd[i]->suspend(info->mtd[i]) == 0)
241                                 info->mtd[i]->resume(info->mtd[i]);
242 }
243 #else
244 #define physmap_flash_suspend NULL
245 #define physmap_flash_resume NULL
246 #define physmap_flash_shutdown NULL
247 #endif
248
249 static struct platform_driver physmap_flash_driver = {
250         .probe          = physmap_flash_probe,
251         .remove         = physmap_flash_remove,
252         .suspend        = physmap_flash_suspend,
253         .resume         = physmap_flash_resume,
254         .shutdown       = physmap_flash_shutdown,
255         .driver         = {
256                 .name   = "physmap-flash",
257                 .owner  = THIS_MODULE,
258         },
259 };
260
261
262 #ifdef CONFIG_MTD_PHYSMAP_LEN
263 #if CONFIG_MTD_PHYSMAP_LEN != 0
264 #warning using PHYSMAP compat code
265 #define PHYSMAP_COMPAT
266 #endif
267 #endif
268
269 #ifdef PHYSMAP_COMPAT
270 static struct physmap_flash_data physmap_flash_data = {
271         .width          = CONFIG_MTD_PHYSMAP_BANKWIDTH,
272 };
273
274 static struct resource physmap_flash_resource = {
275         .start          = CONFIG_MTD_PHYSMAP_START,
276         .end            = CONFIG_MTD_PHYSMAP_START + CONFIG_MTD_PHYSMAP_LEN - 1,
277         .flags          = IORESOURCE_MEM,
278 };
279
280 static struct platform_device physmap_flash = {
281         .name           = "physmap-flash",
282         .id             = 0,
283         .dev            = {
284                 .platform_data  = &physmap_flash_data,
285         },
286         .num_resources  = 1,
287         .resource       = &physmap_flash_resource,
288 };
289
290 void physmap_configure(unsigned long addr, unsigned long size,
291                 int bankwidth, void (*set_vpp)(struct map_info *, int))
292 {
293         physmap_flash_resource.start = addr;
294         physmap_flash_resource.end = addr + size - 1;
295         physmap_flash_data.width = bankwidth;
296         physmap_flash_data.set_vpp = set_vpp;
297 }
298
299 #ifdef CONFIG_MTD_PARTITIONS
300 void physmap_set_partitions(struct mtd_partition *parts, int num_parts)
301 {
302         physmap_flash_data.nr_parts = num_parts;
303         physmap_flash_data.parts = parts;
304 }
305 #endif
306 #endif
307
308 static int __init physmap_init(void)
309 {
310         int err;
311
312         err = platform_driver_register(&physmap_flash_driver);
313 #ifdef PHYSMAP_COMPAT
314         if (err == 0)
315                 platform_device_register(&physmap_flash);
316 #endif
317
318         return err;
319 }
320
321 static void __exit physmap_exit(void)
322 {
323 #ifdef PHYSMAP_COMPAT
324         platform_device_unregister(&physmap_flash);
325 #endif
326         platform_driver_unregister(&physmap_flash_driver);
327 }
328
329 module_init(physmap_init);
330 module_exit(physmap_exit);
331
332 MODULE_LICENSE("GPL");
333 MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
334 MODULE_DESCRIPTION("Generic configurable MTD map driver");
335
336 /* legacy platform drivers can't hotplug or coldplg */
337 #ifndef PHYSMAP_COMPAT
338 /* work with hotplug and coldplug */
339 MODULE_ALIAS("platform:physmap-flash");
340 #endif
341