Merge master.kernel.org:/home/rmk/linux-2.6-arm
[linux-2.6] / drivers / mtd / maps / ocelot.c
1 /*
2  * $Id: ocelot.c,v 1.17 2005/11/07 11:14:27 gleixner Exp $
3  *
4  * Flash on Momenco Ocelot
5  */
6
7 #include <linux/module.h>
8 #include <linux/types.h>
9 #include <linux/kernel.h>
10 #include <linux/init.h>
11 #include <asm/io.h>
12 #include <linux/mtd/mtd.h>
13 #include <linux/mtd/map.h>
14 #include <linux/mtd/partitions.h>
15
16 #define OCELOT_PLD 0x2c000000
17 #define FLASH_WINDOW_ADDR 0x2fc00000
18 #define FLASH_WINDOW_SIZE 0x00080000
19 #define FLASH_BUSWIDTH 1
20 #define NVRAM_WINDOW_ADDR 0x2c800000
21 #define NVRAM_WINDOW_SIZE 0x00007FF0
22 #define NVRAM_BUSWIDTH 1
23
24 static unsigned int cacheflush = 0;
25
26 static struct mtd_info *flash_mtd;
27 static struct mtd_info *nvram_mtd;
28
29 static void ocelot_ram_write(struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const u_char *buf)
30 {
31         struct map_info *map = mtd->priv;
32         size_t done = 0;
33
34         /* If we use memcpy, it does word-wide writes. Even though we told the
35            GT64120A that it's an 8-bit wide region, word-wide writes don't work.
36            We end up just writing the first byte of the four to all four bytes.
37            So we have this loop instead */
38         *retlen = len;
39         while(len) {
40                 __raw_writeb(*(unsigned char *) from, map->virt + to);
41                 from++;
42                 to++;
43                 len--;
44         }
45 }
46
47 static struct mtd_partition *parsed_parts;
48
49 struct map_info ocelot_flash_map = {
50         .name = "Ocelot boot flash",
51         .size = FLASH_WINDOW_SIZE,
52         .bankwidth = FLASH_BUSWIDTH,
53         .phys = FLASH_WINDOW_ADDR,
54 };
55
56 struct map_info ocelot_nvram_map = {
57         .name = "Ocelot NVRAM",
58         .size = NVRAM_WINDOW_SIZE,
59         .bankwidth = NVRAM_BUSWIDTH,
60         .phys = NVRAM_WINDOW_ADDR,
61 };
62
63 static const char *probes[] = { "RedBoot", NULL };
64
65 static int __init init_ocelot_maps(void)
66 {
67         void *pld;
68         int nr_parts;
69         unsigned char brd_status;
70
71         printk(KERN_INFO "Momenco Ocelot MTD mappings: Flash 0x%x at 0x%x, NVRAM 0x%x at 0x%x\n",
72                FLASH_WINDOW_SIZE, FLASH_WINDOW_ADDR, NVRAM_WINDOW_SIZE, NVRAM_WINDOW_ADDR);
73
74         /* First check whether the flash jumper is present */
75         pld = ioremap(OCELOT_PLD, 0x10);
76         if (!pld) {
77                 printk(KERN_NOTICE "Failed to ioremap Ocelot PLD\n");
78                 return -EIO;
79         }
80         brd_status = readb(pld+4);
81         iounmap(pld);
82
83         /* Now ioremap the NVRAM space */
84         ocelot_nvram_map.virt = ioremap_nocache(NVRAM_WINDOW_ADDR, NVRAM_WINDOW_SIZE);
85         if (!ocelot_nvram_map.virt) {
86                 printk(KERN_NOTICE "Failed to ioremap Ocelot NVRAM space\n");
87                 return -EIO;
88         }
89
90         simple_map_init(&ocelot_nvram_map);
91
92         /* And do the RAM probe on it to get an MTD device */
93         nvram_mtd = do_map_probe("map_ram", &ocelot_nvram_map);
94         if (!nvram_mtd) {
95                 printk("NVRAM probe failed\n");
96                 goto fail_1;
97         }
98         nvram_mtd->owner = THIS_MODULE;
99         nvram_mtd->erasesize = 16;
100         /* Override the write() method */
101         nvram_mtd->write = ocelot_ram_write;
102
103         /* Now map the flash space */
104         ocelot_flash_map.virt = ioremap_nocache(FLASH_WINDOW_ADDR, FLASH_WINDOW_SIZE);
105         if (!ocelot_flash_map.virt) {
106                 printk(KERN_NOTICE "Failed to ioremap Ocelot flash space\n");
107                 goto fail_2;
108         }
109         /* Now the cached version */
110         ocelot_flash_map.cached = (unsigned long)__ioremap(FLASH_WINDOW_ADDR, FLASH_WINDOW_SIZE, 0);
111
112         simple_map_init(&ocelot_flash_map);
113
114         /* Only probe for flash if the write jumper is present */
115         if (brd_status & 0x40) {
116                 flash_mtd = do_map_probe("jedec", &ocelot_flash_map);
117         } else {
118                 printk(KERN_NOTICE "Ocelot flash write jumper not present. Treating as ROM\n");
119         }
120         /* If that failed or the jumper's absent, pretend it's ROM */
121         if (!flash_mtd) {
122                 flash_mtd = do_map_probe("map_rom", &ocelot_flash_map);
123                 /* If we're treating it as ROM, set the erase size */
124                 if (flash_mtd)
125                         flash_mtd->erasesize = 0x10000;
126         }
127         if (!flash_mtd)
128                 goto fail3;
129
130         add_mtd_device(nvram_mtd);
131
132         flash_mtd->owner = THIS_MODULE;
133         nr_parts = parse_mtd_partitions(flash_mtd, probes, &parsed_parts, 0);
134
135         if (nr_parts > 0)
136                 add_mtd_partitions(flash_mtd, parsed_parts, nr_parts);
137         else
138                 add_mtd_device(flash_mtd);
139
140         return 0;
141
142  fail3:
143         iounmap((void *)ocelot_flash_map.virt);
144         if (ocelot_flash_map.cached)
145                         iounmap((void *)ocelot_flash_map.cached);
146  fail_2:
147         map_destroy(nvram_mtd);
148  fail_1:
149         iounmap((void *)ocelot_nvram_map.virt);
150
151         return -ENXIO;
152 }
153
154 static void __exit cleanup_ocelot_maps(void)
155 {
156         del_mtd_device(nvram_mtd);
157         map_destroy(nvram_mtd);
158         iounmap((void *)ocelot_nvram_map.virt);
159
160         if (parsed_parts)
161                 del_mtd_partitions(flash_mtd);
162         else
163                 del_mtd_device(flash_mtd);
164         map_destroy(flash_mtd);
165         iounmap((void *)ocelot_flash_map.virt);
166         if (ocelot_flash_map.cached)
167                 iounmap((void *)ocelot_flash_map.cached);
168 }
169
170 module_init(init_ocelot_maps);
171 module_exit(cleanup_ocelot_maps);
172
173 MODULE_LICENSE("GPL");
174 MODULE_AUTHOR("Red Hat, Inc. - David Woodhouse <dwmw2@cambridge.redhat.com>");
175 MODULE_DESCRIPTION("MTD map driver for Momenco Ocelot board");