projects / openwrt.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
Make jffs2 images work with rdc, add a sitecom wl-153 profile and kernel config,...
[openwrt.git] / target / linux / rdc-2.6 / files / drivers / mtd / maps / rdc3210.c
1 /*******************************************************************
2 * Simple Flash mapping for RDC3210 *
3 * *
4 * 2005.03.23 *
5 * Dante Su (dante_su@gemtek.com.tw) *
6 * Copyright (C) 2005 Gemtek Corporation *
7 *******************************************************************/
8
9 #include <linux/module.h>
10 #include <linux/types.h>
11 #include <linux/kernel.h>
12 #include <asm/io.h>
13 #include <linux/mtd/mtd.h>
14 #include <linux/mtd/map.h>
15 #include <linux/mtd/partitions.h>
16 #include <linux/autoconf.h>
17 #include <linux/sched.h>
18 #include <linux/squashfs_fs.h>
19
20 static struct mtd_info *rdc3210_mtd;
21
22 struct map_info rdc3210_map =
23 {
24 .name = "RDC3210 Flash",
25 .size = CONFIG_MTD_RDC3210_SIZE,
26 .bankwidth = CONFIG_MTD_RDC3210_BUSWIDTH,
27 };
28
29 /* Dante: This is the default static mapping, however this is nothing but a hint. (Say dynamic mapping) */
30 static struct mtd_partition rdc3210_parts[] =
31 {
32 #if CONFIG_MTD_RDC3210_SIZE == 0x400000
33 { name: "linux", offset: 0, size: 0x003C0000 }, /* 3840 KB = (Kernel + ROMFS) = (768 KB + 3072 KB) */
34 { name: "romfs", offset: 0x000C0000, size: 0x00300000 }, /* 3072 KB */
35 { name: "nvram", offset: 0x003C0000, size: 0x00010000 }, /* 64 KB */
36 #ifdef CONFIG_MTD_RDC3210_FACTORY_PRESENT
37 { name: "factory", offset: 0x003D0000, size: 0x00010000 }, /* 64 KB */
38 #endif
39 { name: "bootldr", offset: 0x003E0000, size: 0x00020000 }, /* 128 KB */
40 #elif CONFIG_MTD_RDC3210_SIZE == 0x200000
41 { name: "linux", offset: 0x00010000, size: 0x001E0000 },
42 { name: "romfs", offset: 0x000D0000, size: 0x00120000 },
43 { name: "nvram", offset: 0x00000000, size: 0x00010000 }, /* 64 KB */
44 #ifdef CONFIG_MTD_RDC3210_FACTORY_PRESENT
45 #error Unsupported configuration!
46 #endif
47 { name: "bootldr", offset: 0x001F0000, size: 0x00010000 },
48 #else
49 #error Unsupported configuration!
50 #endif
51 };
52
53 static __u32 crctab[257] = {
54 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba,
55 0x076dc419, 0x706af48f, 0xe963a535, 0x9e6495a3,
56 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988,
57 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91,
58 0x1db71064, 0x6ab020f2, 0xf3b97148, 0x84be41de,
59 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7,
60 0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec,
61 0x14015c4f, 0x63066cd9, 0xfa0f3d63, 0x8d080df5,
62 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172,
63 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b,
64 0x35b5a8fa, 0x42b2986c, 0xdbbbc9d6, 0xacbcf940,
65 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59,
66 0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116,
67 0x21b4f4b5, 0x56b3c423, 0xcfba9599, 0xb8bda50f,
68 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924,
69 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d,
70 0x76dc4190, 0x01db7106, 0x98d220bc, 0xefd5102a,
71 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433,
72 0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818,
73 0x7f6a0dbb, 0x086d3d2d, 0x91646c97, 0xe6635c01,
74 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e,
75 0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457,
76 0x65b0d9c6, 0x12b7e950, 0x8bbeb8ea, 0xfcb9887c,
77 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65,
78 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2,
79 0x4adfa541, 0x3dd895d7, 0xa4d1c46d, 0xd3d6f4fb,
80 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0,
81 0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9,
82 0x5005713c, 0x270241aa, 0xbe0b1010, 0xc90c2086,
83 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f,
84 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4,
85 0x59b33d17, 0x2eb40d81, 0xb7bd5c3b, 0xc0ba6cad,
86 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a,
87 0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683,
88 0xe3630b12, 0x94643b84, 0x0d6d6a3e, 0x7a6a5aa8,
89 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1,
90 0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe,
91 0xf762575d, 0x806567cb, 0x196c3671, 0x6e6b06e7,
92 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc,
93 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5,
94 0xd6d6a3e8, 0xa1d1937e, 0x38d8c2c4, 0x4fdff252,
95 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b,
96 0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60,
97 0xdf60efc3, 0xa867df55, 0x316e8eef, 0x4669be79,
98 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236,
99 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f,
100 0xc5ba3bbe, 0xb2bd0b28, 0x2bb45a92, 0x5cb36a04,
101 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d,
102 0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a,
103 0x9c0906a9, 0xeb0e363f, 0x72076785, 0x05005713,
104 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38,
105 0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21,
106 0x86d3d2d4, 0xf1d4e242, 0x68ddb3f8, 0x1fda836e,
107 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777,
108 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c,
109 0x8f659eff, 0xf862ae69, 0x616bffd3, 0x166ccf45,
110 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2,
111 0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db,
112 0xaed16a4a, 0xd9d65adc, 0x40df0b66, 0x37d83bf0,
113 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9,
114 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6,
115 0xbad03605, 0xcdd70693, 0x54de5729, 0x23d967bf,
116 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94,
117 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d,
118 0
119 };
120
121 static __u32 crc32(__u8 * buf, __u32 len)
122 {
123 register int i;
124 __u32 sum;
125 register __u32 s0;
126 s0 = ~0;
127 for (i = 0; i < len; i++) {
128 s0 = (s0 >> 8) ^ crctab[(__u8) (s0 & 0xFF) ^ buf[i]];
129 }
130 sum = ~s0;
131 return sum;
132 }
133
134 static void erase_callback(struct erase_info *done)
135 {
136 wait_queue_head_t *wait_q = (wait_queue_head_t *)done->priv;
137 wake_up(wait_q);
138 }
139
140 static int erase_write (struct mtd_info *mtd, unsigned long pos,
141 int len, const char *buf)
142 {
143 struct erase_info erase;
144 DECLARE_WAITQUEUE(wait, current);
145 wait_queue_head_t wait_q;
146 size_t retlen;
147 int ret;
148
149 /*
150 * First, let's erase the flash block.
151 */
152
153 init_waitqueue_head(&wait_q);
154 erase.mtd = mtd;
155 erase.callback = erase_callback;
156 erase.addr = pos;
157 erase.len = len;
158 erase.priv = (u_long)&wait_q;
159
160 set_current_state(TASK_INTERRUPTIBLE);
161 add_wait_queue(&wait_q, &wait);
162
163 ret = mtd->erase(mtd, &erase);
164 if (ret) {
165 set_current_state(TASK_RUNNING);
166 remove_wait_queue(&wait_q, &wait);
167 printk (KERN_WARNING "erase of region [0x%lx, 0x%x] "
168 "on \"%s\" failed\n",
169 pos, len, mtd->name);
170 return ret;
171 }
172
173 schedule(); /* Wait for erase to finish. */
174 remove_wait_queue(&wait_q, &wait);
175
176 /*
177 * Next, writhe data to flash.
178 */
179
180 ret = mtd->write (mtd, pos, len, &retlen, buf);
181 if (ret)
182 return ret;
183 if (retlen != len)
184 return -EIO;
185 return 0;
186 }
187
188 static int __init init_rdc3210_map(void)
189 {
190 rdc3210_map.phys = -rdc3210_map.size;
191 printk(KERN_NOTICE "flash device: %x at %x\n", rdc3210_map.size, rdc3210_map.phys);
192
193 rdc3210_map.map_priv_1 = (unsigned long)(rdc3210_map.virt = ioremap_nocache(rdc3210_map.phys, rdc3210_map.size));
194
195 if (!rdc3210_map.map_priv_1)
196 {
197 printk("Failed to ioremap\n");
198 return -EIO;
199 }
200 rdc3210_mtd = do_map_probe("cfi_probe", &rdc3210_map);
201 #ifdef CONFIG_MTD_RDC3210_STATIC_MAP /* Dante: This is for fixed map */
202 if (rdc3210_mtd)
203 {
204 rdc3210_mtd->module = THIS_MODULE;
205 add_mtd_partitions(rdc3210_mtd, rdc3210_parts, sizeof(rdc3210_parts)/sizeof(rdc3210_parts[0]));
206 return 0;
207 }
208 #else /* Dante: This is for dynamic mapping */
209
210 #include "imghdr.h"
211
212 typedef struct {
213 u8 magic[4];
214 u32 kernelsz, ramdisksz;
215 u8 magic2[4];
216 u32 sz2;
217 }sc_imghdr_t;
218
219 if (rdc3210_mtd)
220 { // Dante
221 sc_imghdr_t *hdr2= (sc_imghdr_t *)(rdc3210_map.map_priv_1);
222 gt_imghdr_t *hdr = (gt_imghdr_t *)hdr2
223 #ifdef CONFIG_MTD_RDC3210_ALLOW_JFFS2
224 , *ptmp
225 #endif
226 ;
227 int len, tmp, tmp2, tmp3, tmp4, hdr_type = 0;
228
229 if(!memcmp(hdr->magic, GTIMG_MAGIC, 4))
230 {
231 hdr_type = 1;
232 tmp = hdr->kernelsz + sizeof(gt_imghdr_t);
233 tmp2 = rdc3210_mtd->erasesize;
234 tmp3 = ((tmp / 32) + ((tmp % 32) ? 1 : 0)) * 32;
235 tmp4 = ((tmp / tmp2) + ((tmp % tmp2) ? 1 : 0)) * tmp2;
236 }
237 #ifndef CONFIG_MTD_RDC3210_ALLOW_JFFS2
238 else if (!memcmp(hdr2->magic, "CSYS", 4))
239 {
240 hdr_type = 2;
241 tmp = hdr2->ramdisksz + hdr2->kernelsz + sizeof(sc_imghdr_t);
242 tmp2 = rdc3210_mtd->erasesize;
243 tmp3 = ((tmp / 32) + ((tmp % 32) ? 1 : 0)) * 32;
244 tmp4 = ((tmp / tmp2) + ((tmp % tmp2) ? 1 : 0)) * tmp2;
245 }
246 #endif
247 else
248 {
249 iounmap((void *)rdc3210_map.map_priv_1);
250 rdc3210_map.map_priv_1 = 0L;
251 rdc3210_map.virt = NULL;
252 printk("Invalid MAGIC for Firmware Image!!!\n");
253 return -EIO;
254 }
255 #ifdef CONFIG_MTD_RDC3210_ALLOW_JFFS2
256 tmp = (tmp3 == tmp4) ? tmp4 + tmp2 : tmp4;
257 if ((ptmp = (gt_imghdr_t *)vmalloc(tmp)) == NULL)
258 {
259 iounmap((void *)rdc3210_map.map_priv_1);
260 rdc3210_map.map_priv_1 = 0L;
261 rdc3210_map.virt = NULL;
262 printk("Can't allocate 0x%08x for flash-reading buffer!\n", tmp);
263 return -ENOMEM;
264 }
265 if (rdc3210_mtd->read(rdc3210_mtd, 0, tmp, &len, (__u8 *)ptmp) || len != tmp)
266 {
267 vfree(ptmp);
268 iounmap((void *)rdc3210_map.map_priv_1);
269 rdc3210_map.map_priv_1 = 0L;
270 rdc3210_map.virt = NULL;
271 printk("Can't read that much flash! Read 0x%08x of it.\n", len);
272 return -EIO;
273 }
274 #endif
275 #ifdef CONFIG_MTD_RDC3210_FACTORY_PRESENT
276 /* 1. Adjust Redboot */
277 tmp = rdc3210_mtd->size - rdc3210_parts[4].size;
278 rdc3210_parts[4].offset = tmp - (tmp % tmp2);
279 rdc3210_parts[4].size = rdc3210_mtd->size - rdc3210_parts[4].offset;
280
281 /* 2. Adjust Factory Default */
282 tmp -= rdc3210_parts[3].size;
283 rdc3210_parts[3].offset = tmp - (tmp % tmp2);
284 rdc3210_parts[3].size = rdc3210_parts[4].offset - rdc3210_parts[3].offset;
285 #else
286 /* 1. Adjust Redboot */
287 tmp = rdc3210_mtd->size - rdc3210_parts[3].size;
288 rdc3210_parts[3].offset = tmp - (tmp % tmp2);
289 rdc3210_parts[3].size = rdc3210_mtd->size - rdc3210_parts[3].offset;
290 #endif
291 if (hdr_type == 1) {
292 /* 3. Adjust NVRAM */
293 #ifdef CONFIG_MTD_RDC3210_ALLOW_JFFS2
294 if (*(__u32 *)(((unsigned char *)ptmp)+tmp3) == SQUASHFS_MAGIC)
295 {
296 len = 1;
297 tmp4 = tmp3;
298 tmp = hdr->imagesz;
299 rdc3210_parts[2].name = "rootfs_data";
300 rdc3210_parts[2].offset = rdc3210_parts[0].offset + (((tmp / tmp2) + ((tmp % tmp2) ? 1 : 0)) * tmp2);
301 }
302 else
303 #else
304 tmp4 = tmp3;
305 #endif
306 {
307 len = 0;
308 tmp -= rdc3210_parts[2].size;
309 rdc3210_parts[2].offset = tmp - (tmp % tmp2);
310 }
311 rdc3210_parts[2].size = rdc3210_parts[3].offset - rdc3210_parts[2].offset;
312 }
313 else if (hdr_type == 2)
314 {
315 len = 0;
316 tmp4 = tmp3;
317 }
318
319 /* 4. Adjust Linux (Kernel + ROMFS) */
320 rdc3210_parts[0].size = rdc3210_parts[len + hdr_type + 1].offset - rdc3210_parts[0].offset;
321
322 /* 5. Adjust ROMFS */
323 rdc3210_parts[1].offset = rdc3210_parts[0].offset + tmp4;
324 rdc3210_parts[1].size = rdc3210_parts[hdr_type + 1].offset - rdc3210_parts[1].offset;
325 #ifdef CONFIG_MTD_RDC3210_ALLOW_JFFS2
326 if (!(hdr->reserved || len))
327 {
328 __u8 buf[1024];
329 ptmp->reserved = hdr->imagesz;
330 ptmp->imagesz = tmp4;
331 ptmp->checksum = ptmp->fastcksum = 0;
332 memcpy(buf, ptmp, 0x100);
333 memcpy(buf + 0x100, ((__u8 *)ptmp) + ((tmp4 >> 1) - ((tmp4 & 0x6) >> 1)), 0x100);
334 memcpy(buf + 0x200, ((__u8 *)ptmp) + (tmp4 - 0x200), 0x200);
335 ptmp->fastcksum = crc32(buf, sizeof(buf));
336 ptmp->checksum = crc32((__u8 *)ptmp, tmp4);
337 if (rdc3210_mtd->unlock) rdc3210_mtd->unlock(rdc3210_mtd, 0, tmp2);
338 if ((len = erase_write(rdc3210_mtd, 0, tmp2, (char *)ptmp)))
339 {
340 vfree(ptmp);
341 iounmap((void *)rdc3210_map.map_priv_1);
342 rdc3210_map.map_priv_1 = 0L;
343 rdc3210_map.virt = NULL;
344 printk("Couldn't erase! Got %d.\n", len);
345 return len;
346 }
347 if (rdc3210_mtd->sync) rdc3210_mtd->sync(rdc3210_mtd);
348 }
349 vfree(ptmp);
350 #endif
351 rdc3210_mtd->owner = THIS_MODULE;
352 add_mtd_partitions(rdc3210_mtd, rdc3210_parts, sizeof(rdc3210_parts)/sizeof(rdc3210_parts[0]));
353 return 0;
354 }
355 #endif
356 iounmap((void *)rdc3210_map.map_priv_1);
357 rdc3210_map.map_priv_1 = 0L;
358 rdc3210_map.virt = NULL;
359 return -ENXIO;
360 }
361
362 static void __exit cleanup_rdc3210_map(void)
363 {
364 if (rdc3210_mtd)
365 {
366 del_mtd_partitions(rdc3210_mtd);
367 map_destroy(rdc3210_mtd);
368 }
369
370 if (rdc3210_map.map_priv_1)
371 {
372 iounmap((void *)rdc3210_map.map_priv_1);
373 rdc3210_map.map_priv_1 = 0L;
374 rdc3210_map.virt = NULL;
375 }
376 }
377
378 module_init(init_rdc3210_map);
379 module_exit(cleanup_rdc3210_map);
Personal OpenWRT clone
This page took 0.063091 seconds and 5 git commands to generate.