]> nv-tegra.nvidia Code Review - linux-3.10.git/blob - drivers/mtd/maps/mainstone-flash.c
[MTD] Add mapping driver for Intel PXA27x Mainstone board flash.
[linux-3.10.git] / drivers / mtd / maps / mainstone-flash.c
1 /*
2  * $Id:  $
3  *
4  * Map driver for the Mainstone developer platform.
5  *
6  * Author:      Nicolas Pitre
7  * Copyright:   (C) 2001 MontaVista Software Inc.
8  * 
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  */
13
14 #include <linux/module.h>
15 #include <linux/types.h>
16 #include <linux/kernel.h>
17 #include <linux/init.h>
18 #include <linux/dma-mapping.h>
19 #include <linux/mtd/mtd.h>
20 #include <linux/mtd/map.h>
21 #include <linux/mtd/partitions.h>
22 #include <asm/io.h>
23 #include <asm/hardware.h>
24 #include <asm/arch/pxa-regs.h>
25 #include <asm/arch/mainstone.h>
26
27
28 #define ROM_ADDR        0x00000000
29 #define FLASH_ADDR      0x04000000
30
31 #define WINDOW_SIZE     0x04000000
32
33 static void mainstone_map_inval_cache(struct map_info *map, unsigned long from,
34                                       ssize_t len)
35 {
36         consistent_sync((char *)map->cached + from, len, DMA_FROM_DEVICE);
37 }
38
39 static struct map_info mainstone_maps[2] = { {
40         .size =         WINDOW_SIZE,
41         .phys =         PXA_CS0_PHYS,
42         .inval_cache =  mainstone_map_inval_cache,
43 }, {
44         .size =         WINDOW_SIZE,
45         .phys =         PXA_CS1_PHYS,
46         .inval_cache =  mainstone_map_inval_cache,
47 } };
48
49 static struct mtd_partition mainstone_partitions[] = {
50         {
51                 .name =         "Bootloader",
52                 .size =         0x00040000,
53                 .offset =       0,
54                 .mask_flags =   MTD_WRITEABLE  /* force read-only */
55         },{
56                 .name =         "Kernel",
57                 .size =         0x00400000,
58                 .offset =       0x00040000,
59         },{
60                 .name =         "Filesystem",
61                 .size =         MTDPART_SIZ_FULL,
62                 .offset =       0x00440000
63         }
64 };
65
66 static struct mtd_info *mymtds[2];
67 static struct mtd_partition *parsed_parts[2];
68 static int nr_parsed_parts[2];
69
70 static const char *probes[] = { "RedBoot", "cmdlinepart", NULL };
71
72 static int __init init_mainstone(void)
73 {
74         int SW7 = 0;  /* FIXME: get from SCR (Mst doc section 3.2.1.1) */
75         int ret = 0, i;
76
77         mainstone_maps[0].bankwidth = (BOOT_DEF & 1) ? 2 : 4;
78         mainstone_maps[1].bankwidth = 4;
79
80         /* Compensate for SW7 which swaps the flash banks */
81         mainstone_maps[SW7].name = "processor flash";
82         mainstone_maps[SW7 ^ 1].name = "main board flash";
83
84         printk(KERN_NOTICE "Mainstone configured to boot from %s\n",
85                mainstone_maps[0].name);
86
87         for (i = 0; i < 2; i++) {
88                 mainstone_maps[i].virt = ioremap(mainstone_maps[i].phys,
89                                                  WINDOW_SIZE);
90                 if (!mainstone_maps[i].virt) {
91                         printk(KERN_WARNING "Failed to ioremap %s\n", 
92                                mainstone_maps[i].name);
93                         if (!ret)
94                                 ret = -ENOMEM;
95                         continue;
96                 }
97                 mainstone_maps[i].cached = 
98                         ioremap_cached(mainstone_maps[i].phys, WINDOW_SIZE);
99                 if (!mainstone_maps[i].cached)
100                         printk(KERN_WARNING "Failed to ioremap cached %s\n",
101                                mainstone_maps[i].name);
102                 simple_map_init(&mainstone_maps[i]);
103
104                 printk(KERN_NOTICE 
105                        "Probing %s at physical address 0x%08lx"
106                        " (%d-bit bankwidth)\n",
107                        mainstone_maps[i].name, mainstone_maps[i].phys, 
108                        mainstone_maps[i].bankwidth * 8);
109
110                 mymtds[i] = do_map_probe("cfi_probe", &mainstone_maps[i]);
111                 
112                 if (!mymtds[i]) {
113                         iounmap((void *)mainstone_maps[i].virt);
114                         if (mainstone_maps[i].cached)
115                                 iounmap(mainstone_maps[i].cached);
116                         if (!ret)
117                                 ret = -EIO;
118                         continue;
119                 }
120                 mymtds[i]->owner = THIS_MODULE;
121
122                 ret = parse_mtd_partitions(mymtds[i], probes,
123                                            &parsed_parts[i], 0);
124
125                 if (ret > 0)
126                         nr_parsed_parts[i] = ret;
127         }
128
129         if (!mymtds[0] && !mymtds[1])
130                 return ret;
131         
132         for (i = 0; i < 2; i++) {
133                 if (!mymtds[i]) {
134                         printk(KERN_WARNING "%s is absent. Skipping\n", 
135                                mainstone_maps[i].name);
136                 } else if (nr_parsed_parts[i]) {
137                         add_mtd_partitions(mymtds[i], parsed_parts[i], 
138                                            nr_parsed_parts[i]);
139                 } else if (!i) {
140                         printk("Using static partitions on %s\n",
141                                mainstone_maps[i].name);
142                         add_mtd_partitions(mymtds[i], mainstone_partitions, 
143                                            ARRAY_SIZE(mainstone_partitions));
144                 } else {
145                         printk("Registering %s as whole device\n", 
146                                mainstone_maps[i].name);
147                         add_mtd_device(mymtds[i]);
148                 }
149         }
150         return 0;
151 }
152
153 static void __exit cleanup_mainstone(void)
154 {
155         int i;
156         for (i = 0; i < 2; i++) {
157                 if (!mymtds[i])
158                         continue;
159
160                 if (nr_parsed_parts[i] || !i)
161                         del_mtd_partitions(mymtds[i]);
162                 else
163                         del_mtd_device(mymtds[i]);
164
165                 map_destroy(mymtds[i]);
166                 iounmap((void *)mainstone_maps[i].virt);
167                 if (mainstone_maps[i].cached)
168                         iounmap(mainstone_maps[i].cached);
169                 kfree(parsed_parts[i]);
170         }
171 }
172
173 module_init(init_mainstone);
174 module_exit(cleanup_mainstone);
175
176 MODULE_LICENSE("GPL");
177 MODULE_AUTHOR("Nicolas Pitre <nico@cam.org>");
178 MODULE_DESCRIPTION("MTD map driver for Intel Mainstone");