Merge x86-64 update from Andi
[linux-2.6] / drivers / mtd / chips / amd_flash.c
1 /*
2  * MTD map driver for AMD compatible flash chips (non-CFI)
3  *
4  * Author: Jonas Holmberg <jonas.holmberg@axis.com>
5  *
6  * $Id: amd_flash.c,v 1.28 2005/11/07 11:14:22 gleixner Exp $
7  *
8  * Copyright (c) 2001 Axis Communications AB
9  *
10  * This file is under GPL.
11  *
12  */
13
14 #include <linux/module.h>
15 #include <linux/types.h>
16 #include <linux/kernel.h>
17 #include <linux/sched.h>
18 #include <linux/errno.h>
19 #include <linux/slab.h>
20 #include <linux/delay.h>
21 #include <linux/interrupt.h>
22 #include <linux/init.h>
23 #include <linux/mtd/map.h>
24 #include <linux/mtd/mtd.h>
25 #include <linux/mtd/flashchip.h>
26
27 /* There's no limit. It exists only to avoid realloc. */
28 #define MAX_AMD_CHIPS 8
29
30 #define DEVICE_TYPE_X8  (8 / 8)
31 #define DEVICE_TYPE_X16 (16 / 8)
32 #define DEVICE_TYPE_X32 (32 / 8)
33
34 /* Addresses */
35 #define ADDR_MANUFACTURER               0x0000
36 #define ADDR_DEVICE_ID                  0x0001
37 #define ADDR_SECTOR_LOCK                0x0002
38 #define ADDR_HANDSHAKE                  0x0003
39 #define ADDR_UNLOCK_1                   0x0555
40 #define ADDR_UNLOCK_2                   0x02AA
41
42 /* Commands */
43 #define CMD_UNLOCK_DATA_1               0x00AA
44 #define CMD_UNLOCK_DATA_2               0x0055
45 #define CMD_MANUFACTURER_UNLOCK_DATA    0x0090
46 #define CMD_UNLOCK_BYPASS_MODE          0x0020
47 #define CMD_PROGRAM_UNLOCK_DATA         0x00A0
48 #define CMD_RESET_DATA                  0x00F0
49 #define CMD_SECTOR_ERASE_UNLOCK_DATA    0x0080
50 #define CMD_SECTOR_ERASE_UNLOCK_DATA_2  0x0030
51
52 #define CMD_UNLOCK_SECTOR               0x0060
53
54 /* Manufacturers */
55 #define MANUFACTURER_AMD        0x0001
56 #define MANUFACTURER_ATMEL      0x001F
57 #define MANUFACTURER_FUJITSU    0x0004
58 #define MANUFACTURER_ST         0x0020
59 #define MANUFACTURER_SST        0x00BF
60 #define MANUFACTURER_TOSHIBA    0x0098
61
62 /* AMD */
63 #define AM29F800BB      0x2258
64 #define AM29F800BT      0x22D6
65 #define AM29LV800BB     0x225B
66 #define AM29LV800BT     0x22DA
67 #define AM29LV160DT     0x22C4
68 #define AM29LV160DB     0x2249
69 #define AM29BDS323D     0x22D1
70
71 /* Atmel */
72 #define AT49xV16x       0x00C0
73 #define AT49xV16xT      0x00C2
74
75 /* Fujitsu */
76 #define MBM29LV160TE    0x22C4
77 #define MBM29LV160BE    0x2249
78 #define MBM29LV800BB    0x225B
79
80 /* ST - www.st.com */
81 #define M29W800T        0x00D7
82 #define M29W160DT       0x22C4
83 #define M29W160DB       0x2249
84
85 /* SST */
86 #define SST39LF800      0x2781
87 #define SST39LF160      0x2782
88
89 /* Toshiba */
90 #define TC58FVT160      0x00C2
91 #define TC58FVB160      0x0043
92
93 #define D6_MASK 0x40
94
95 struct amd_flash_private {
96         int device_type;
97         int interleave;
98         int numchips;
99         unsigned long chipshift;
100 //      const char *im_name;
101         struct flchip chips[0];
102 };
103
104 struct amd_flash_info {
105         const __u16 mfr_id;
106         const __u16 dev_id;
107         const char *name;
108         const u_long size;
109         const int numeraseregions;
110         const struct mtd_erase_region_info regions[4];
111 };
112
113
114
115 static int amd_flash_read(struct mtd_info *, loff_t, size_t, size_t *,
116                           u_char *);
117 static int amd_flash_write(struct mtd_info *, loff_t, size_t, size_t *,
118                            const u_char *);
119 static int amd_flash_erase(struct mtd_info *, struct erase_info *);
120 static void amd_flash_sync(struct mtd_info *);
121 static int amd_flash_suspend(struct mtd_info *);
122 static void amd_flash_resume(struct mtd_info *);
123 static void amd_flash_destroy(struct mtd_info *);
124 static struct mtd_info *amd_flash_probe(struct map_info *map);
125
126
127 static struct mtd_chip_driver amd_flash_chipdrv = {
128         .probe = amd_flash_probe,
129         .destroy = amd_flash_destroy,
130         .name = "amd_flash",
131         .module = THIS_MODULE
132 };
133
134
135
136 static const char im_name[] = "amd_flash";
137
138
139
140 static inline __u32 wide_read(struct map_info *map, __u32 addr)
141 {
142         if (map->buswidth == 1) {
143                 return map_read8(map, addr);
144         } else if (map->buswidth == 2) {
145                 return map_read16(map, addr);
146         } else if (map->buswidth == 4) {
147                 return map_read32(map, addr);
148         }
149
150         return 0;
151 }
152
153 static inline void wide_write(struct map_info *map, __u32 val, __u32 addr)
154 {
155         if (map->buswidth == 1) {
156                 map_write8(map, val, addr);
157         } else if (map->buswidth == 2) {
158                 map_write16(map, val, addr);
159         } else if (map->buswidth == 4) {
160                 map_write32(map, val, addr);
161         }
162 }
163
164 static inline __u32 make_cmd(struct map_info *map, __u32 cmd)
165 {
166         const struct amd_flash_private *private = map->fldrv_priv;
167         if ((private->interleave == 2) &&
168             (private->device_type == DEVICE_TYPE_X16)) {
169                 cmd |= (cmd << 16);
170         }
171
172         return cmd;
173 }
174
175 static inline void send_unlock(struct map_info *map, unsigned long base)
176 {
177         wide_write(map, (CMD_UNLOCK_DATA_1 << 16) | CMD_UNLOCK_DATA_1,
178                    base + (map->buswidth * ADDR_UNLOCK_1));
179         wide_write(map, (CMD_UNLOCK_DATA_2 << 16) | CMD_UNLOCK_DATA_2,
180                    base + (map->buswidth * ADDR_UNLOCK_2));
181 }
182
183 static inline void send_cmd(struct map_info *map, unsigned long base, __u32 cmd)
184 {
185         send_unlock(map, base);
186         wide_write(map, make_cmd(map, cmd),
187                    base + (map->buswidth * ADDR_UNLOCK_1));
188 }
189
190 static inline void send_cmd_to_addr(struct map_info *map, unsigned long base,
191                                     __u32 cmd, unsigned long addr)
192 {
193         send_unlock(map, base);
194         wide_write(map, make_cmd(map, cmd), addr);
195 }
196
197 static inline int flash_is_busy(struct map_info *map, unsigned long addr,
198                                 int interleave)
199 {
200
201         if ((interleave == 2) && (map->buswidth == 4)) {
202                 __u32 read1, read2;
203
204                 read1 = wide_read(map, addr);
205                 read2 = wide_read(map, addr);
206
207                 return (((read1 >> 16) & D6_MASK) !=
208                         ((read2 >> 16) & D6_MASK)) ||
209                        (((read1 & 0xffff) & D6_MASK) !=
210                         ((read2 & 0xffff) & D6_MASK));
211         }
212
213         return ((wide_read(map, addr) & D6_MASK) !=
214                 (wide_read(map, addr) & D6_MASK));
215 }
216
217 static inline void unlock_sector(struct map_info *map, unsigned long sect_addr,
218                                  int unlock)
219 {
220         /* Sector lock address. A6 = 1 for unlock, A6 = 0 for lock */
221         int SLA = unlock ?
222                 (sect_addr |  (0x40 * map->buswidth)) :
223                 (sect_addr & ~(0x40 * map->buswidth)) ;
224
225         __u32 cmd = make_cmd(map, CMD_UNLOCK_SECTOR);
226
227         wide_write(map, make_cmd(map, CMD_RESET_DATA), 0);
228         wide_write(map, cmd, SLA); /* 1st cycle: write cmd to any address */
229         wide_write(map, cmd, SLA); /* 2nd cycle: write cmd to any address */
230         wide_write(map, cmd, SLA); /* 3rd cycle: write cmd to SLA */
231 }
232
233 static inline int is_sector_locked(struct map_info *map,
234                                    unsigned long sect_addr)
235 {
236         int status;
237
238         wide_write(map, CMD_RESET_DATA, 0);
239         send_cmd(map, sect_addr, CMD_MANUFACTURER_UNLOCK_DATA);
240
241         /* status is 0x0000 for unlocked and 0x0001 for locked */
242         status = wide_read(map, sect_addr + (map->buswidth * ADDR_SECTOR_LOCK));
243         wide_write(map, CMD_RESET_DATA, 0);
244         return status;
245 }
246
247 static int amd_flash_do_unlock(struct mtd_info *mtd, loff_t ofs, size_t len,
248                                int is_unlock)
249 {
250         struct map_info *map;
251         struct mtd_erase_region_info *merip;
252         int eraseoffset, erasesize, eraseblocks;
253         int i;
254         int retval = 0;
255         int lock_status;
256
257         map = mtd->priv;
258
259         /* Pass the whole chip through sector by sector and check for each
260            sector if the sector and the given interval overlap */
261         for(i = 0; i < mtd->numeraseregions; i++) {
262                 merip = &mtd->eraseregions[i];
263
264                 eraseoffset = merip->offset;
265                 erasesize = merip->erasesize;
266                 eraseblocks = merip->numblocks;
267
268                 if (ofs > eraseoffset + erasesize)
269                         continue;
270
271                 while (eraseblocks > 0) {
272                         if (ofs < eraseoffset + erasesize && ofs + len > eraseoffset) {
273                                 unlock_sector(map, eraseoffset, is_unlock);
274
275                                 lock_status = is_sector_locked(map, eraseoffset);
276
277                                 if (is_unlock && lock_status) {
278                                         printk("Cannot unlock sector at address %x length %xx\n",
279                                                eraseoffset, merip->erasesize);
280                                         retval = -1;
281                                 } else if (!is_unlock && !lock_status) {
282                                         printk("Cannot lock sector at address %x length %x\n",
283                                                eraseoffset, merip->erasesize);
284                                         retval = -1;
285                                 }
286                         }
287                         eraseoffset += erasesize;
288                         eraseblocks --;
289                 }
290         }
291         return retval;
292 }
293
294 static int amd_flash_unlock(struct mtd_info *mtd, loff_t ofs, size_t len)
295 {
296         return amd_flash_do_unlock(mtd, ofs, len, 1);
297 }
298
299 static int amd_flash_lock(struct mtd_info *mtd, loff_t ofs, size_t len)
300 {
301         return amd_flash_do_unlock(mtd, ofs, len, 0);
302 }
303
304
305 /*
306  * Reads JEDEC manufacturer ID and device ID and returns the index of the first
307  * matching table entry (-1 if not found or alias for already found chip).
308  */
309 static int probe_new_chip(struct mtd_info *mtd, __u32 base,
310                           struct flchip *chips,
311                           struct amd_flash_private *private,
312                           const struct amd_flash_info *table, int table_size)
313 {
314         __u32 mfr_id;
315         __u32 dev_id;
316         struct map_info *map = mtd->priv;
317         struct amd_flash_private temp;
318         int i;
319
320         temp.device_type = DEVICE_TYPE_X16;     // Assume X16 (FIXME)
321         temp.interleave = 2;
322         map->fldrv_priv = &temp;
323
324         /* Enter autoselect mode. */
325         send_cmd(map, base, CMD_RESET_DATA);
326         send_cmd(map, base, CMD_MANUFACTURER_UNLOCK_DATA);
327
328         mfr_id = wide_read(map, base + (map->buswidth * ADDR_MANUFACTURER));
329         dev_id = wide_read(map, base + (map->buswidth * ADDR_DEVICE_ID));
330
331         if ((map->buswidth == 4) && ((mfr_id >> 16) == (mfr_id & 0xffff)) &&
332             ((dev_id >> 16) == (dev_id & 0xffff))) {
333                 mfr_id &= 0xffff;
334                 dev_id &= 0xffff;
335         } else {
336                 temp.interleave = 1;
337         }
338
339         for (i = 0; i < table_size; i++) {
340                 if ((mfr_id == table[i].mfr_id) &&
341                     (dev_id == table[i].dev_id)) {
342                         if (chips) {
343                                 int j;
344
345                                 /* Is this an alias for an already found chip?
346                                  * In that case that chip should be in
347                                  * autoselect mode now.
348                                  */
349                                 for (j = 0; j < private->numchips; j++) {
350                                         __u32 mfr_id_other;
351                                         __u32 dev_id_other;
352
353                                         mfr_id_other =
354                                                 wide_read(map, chips[j].start +
355                                                                (map->buswidth *
356                                                                 ADDR_MANUFACTURER
357                                                                ));
358                                         dev_id_other =
359                                                 wide_read(map, chips[j].start +
360                                                                (map->buswidth *
361                                                                 ADDR_DEVICE_ID));
362                                         if (temp.interleave == 2) {
363                                                 mfr_id_other &= 0xffff;
364                                                 dev_id_other &= 0xffff;
365                                         }
366                                         if ((mfr_id_other == mfr_id) &&
367                                             (dev_id_other == dev_id)) {
368
369                                                 /* Exit autoselect mode. */
370                                                 send_cmd(map, base,
371                                                          CMD_RESET_DATA);
372
373                                                 return -1;
374                                         }
375                                 }
376
377                                 if (private->numchips == MAX_AMD_CHIPS) {
378                                         printk(KERN_WARNING
379                                                "%s: Too many flash chips "
380                                                "detected. Increase "
381                                                "MAX_AMD_CHIPS from %d.\n",
382                                                map->name, MAX_AMD_CHIPS);
383
384                                         return -1;
385                                 }
386
387                                 chips[private->numchips].start = base;
388                                 chips[private->numchips].state = FL_READY;
389                                 chips[private->numchips].mutex =
390                                         &chips[private->numchips]._spinlock;
391                                 private->numchips++;
392                         }
393
394                         printk("%s: Found %d x %ldMiB %s at 0x%x\n", map->name,
395                                temp.interleave, (table[i].size)/(1024*1024),
396                                table[i].name, base);
397
398                         mtd->size += table[i].size * temp.interleave;
399                         mtd->numeraseregions += table[i].numeraseregions;
400
401                         break;
402                 }
403         }
404
405         /* Exit autoselect mode. */
406         send_cmd(map, base, CMD_RESET_DATA);
407
408         if (i == table_size) {
409                 printk(KERN_DEBUG "%s: unknown flash device at 0x%x, "
410                        "mfr id 0x%x, dev id 0x%x\n", map->name,
411                        base, mfr_id, dev_id);
412                 map->fldrv_priv = NULL;
413
414                 return -1;
415         }
416
417         private->device_type = temp.device_type;
418         private->interleave = temp.interleave;
419
420         return i;
421 }
422
423
424
425 static struct mtd_info *amd_flash_probe(struct map_info *map)
426 {
427         static const struct amd_flash_info table[] = {
428         {
429                 .mfr_id = MANUFACTURER_AMD,
430                 .dev_id = AM29LV160DT,
431                 .name = "AMD AM29LV160DT",
432                 .size = 0x00200000,
433                 .numeraseregions = 4,
434                 .regions = {
435                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 },
436                         { .offset = 0x1F0000, .erasesize = 0x08000, .numblocks =  1 },
437                         { .offset = 0x1F8000, .erasesize = 0x02000, .numblocks =  2 },
438                         { .offset = 0x1FC000, .erasesize = 0x04000, .numblocks =  1 }
439                 }
440         }, {
441                 .mfr_id = MANUFACTURER_AMD,
442                 .dev_id = AM29LV160DB,
443                 .name = "AMD AM29LV160DB",
444                 .size = 0x00200000,
445                 .numeraseregions = 4,
446                 .regions = {
447                         { .offset = 0x000000, .erasesize = 0x04000, .numblocks =  1 },
448                         { .offset = 0x004000, .erasesize = 0x02000, .numblocks =  2 },
449                         { .offset = 0x008000, .erasesize = 0x08000, .numblocks =  1 },
450                         { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 }
451                 }
452         }, {
453                 .mfr_id = MANUFACTURER_TOSHIBA,
454                 .dev_id = TC58FVT160,
455                 .name = "Toshiba TC58FVT160",
456                 .size = 0x00200000,
457                 .numeraseregions = 4,
458                 .regions = {
459                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 },
460                         { .offset = 0x1F0000, .erasesize = 0x08000, .numblocks =  1 },
461                         { .offset = 0x1F8000, .erasesize = 0x02000, .numblocks =  2 },
462                         { .offset = 0x1FC000, .erasesize = 0x04000, .numblocks =  1 }
463                 }
464         }, {
465                 .mfr_id = MANUFACTURER_FUJITSU,
466                 .dev_id = MBM29LV160TE,
467                 .name = "Fujitsu MBM29LV160TE",
468                 .size = 0x00200000,
469                 .numeraseregions = 4,
470                 .regions = {
471                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 },
472                         { .offset = 0x1F0000, .erasesize = 0x08000, .numblocks =  1 },
473                         { .offset = 0x1F8000, .erasesize = 0x02000, .numblocks =  2 },
474                         { .offset = 0x1FC000, .erasesize = 0x04000, .numblocks =  1 }
475                 }
476         }, {
477                 .mfr_id = MANUFACTURER_TOSHIBA,
478                 .dev_id = TC58FVB160,
479                 .name = "Toshiba TC58FVB160",
480                 .size = 0x00200000,
481                 .numeraseregions = 4,
482                 .regions = {
483                         { .offset = 0x000000, .erasesize = 0x04000, .numblocks =  1 },
484                         { .offset = 0x004000, .erasesize = 0x02000, .numblocks =  2 },
485                         { .offset = 0x008000, .erasesize = 0x08000, .numblocks =  1 },
486                         { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 }
487                 }
488         }, {
489                 .mfr_id = MANUFACTURER_FUJITSU,
490                 .dev_id = MBM29LV160BE,
491                 .name = "Fujitsu MBM29LV160BE",
492                 .size = 0x00200000,
493                 .numeraseregions = 4,
494                 .regions = {
495                         { .offset = 0x000000, .erasesize = 0x04000, .numblocks =  1 },
496                         { .offset = 0x004000, .erasesize = 0x02000, .numblocks =  2 },
497                         { .offset = 0x008000, .erasesize = 0x08000, .numblocks =  1 },
498                         { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 }
499                 }
500         }, {
501                 .mfr_id = MANUFACTURER_AMD,
502                 .dev_id = AM29LV800BB,
503                 .name = "AMD AM29LV800BB",
504                 .size = 0x00100000,
505                 .numeraseregions = 4,
506                 .regions = {
507                         { .offset = 0x000000, .erasesize = 0x04000, .numblocks =  1 },
508                         { .offset = 0x004000, .erasesize = 0x02000, .numblocks =  2 },
509                         { .offset = 0x008000, .erasesize = 0x08000, .numblocks =  1 },
510                         { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 15 }
511                 }
512         }, {
513                 .mfr_id = MANUFACTURER_AMD,
514                 .dev_id = AM29F800BB,
515                 .name = "AMD AM29F800BB",
516                 .size = 0x00100000,
517                 .numeraseregions = 4,
518                 .regions = {
519                         { .offset = 0x000000, .erasesize = 0x04000, .numblocks =  1 },
520                         { .offset = 0x004000, .erasesize = 0x02000, .numblocks =  2 },
521                         { .offset = 0x008000, .erasesize = 0x08000, .numblocks =  1 },
522                         { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 15 }
523                 }
524         }, {
525                 .mfr_id = MANUFACTURER_AMD,
526                 .dev_id = AM29LV800BT,
527                 .name = "AMD AM29LV800BT",
528                 .size = 0x00100000,
529                 .numeraseregions = 4,
530                 .regions = {
531                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 15 },
532                         { .offset = 0x0F0000, .erasesize = 0x08000, .numblocks =  1 },
533                         { .offset = 0x0F8000, .erasesize = 0x02000, .numblocks =  2 },
534                         { .offset = 0x0FC000, .erasesize = 0x04000, .numblocks =  1 }
535                 }
536         }, {
537                 .mfr_id = MANUFACTURER_AMD,
538                 .dev_id = AM29F800BT,
539                 .name = "AMD AM29F800BT",
540                 .size = 0x00100000,
541                 .numeraseregions = 4,
542                 .regions = {
543                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 15 },
544                         { .offset = 0x0F0000, .erasesize = 0x08000, .numblocks =  1 },
545                         { .offset = 0x0F8000, .erasesize = 0x02000, .numblocks =  2 },
546                         { .offset = 0x0FC000, .erasesize = 0x04000, .numblocks =  1 }
547                 }
548         }, {
549                 .mfr_id = MANUFACTURER_AMD,
550                 .dev_id = AM29LV800BB,
551                 .name = "AMD AM29LV800BB",
552                 .size = 0x00100000,
553                 .numeraseregions = 4,
554                 .regions = {
555                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 15 },
556                         { .offset = 0x0F0000, .erasesize = 0x08000, .numblocks =  1 },
557                         { .offset = 0x0F8000, .erasesize = 0x02000, .numblocks =  2 },
558                         { .offset = 0x0FC000, .erasesize = 0x04000, .numblocks =  1 }
559                 }
560         }, {
561                 .mfr_id = MANUFACTURER_FUJITSU,
562                 .dev_id = MBM29LV800BB,
563                 .name = "Fujitsu MBM29LV800BB",
564                 .size = 0x00100000,
565                 .numeraseregions = 4,
566                 .regions = {
567                         { .offset = 0x000000, .erasesize = 0x04000, .numblocks =  1 },
568                         { .offset = 0x004000, .erasesize = 0x02000, .numblocks =  2 },
569                         { .offset = 0x008000, .erasesize = 0x08000, .numblocks =  1 },
570                         { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 15 }
571                 }
572         }, {
573                 .mfr_id = MANUFACTURER_ST,
574                 .dev_id = M29W800T,
575                 .name = "ST M29W800T",
576                 .size = 0x00100000,
577                 .numeraseregions = 4,
578                 .regions = {
579                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 15 },
580                         { .offset = 0x0F0000, .erasesize = 0x08000, .numblocks =  1 },
581                         { .offset = 0x0F8000, .erasesize = 0x02000, .numblocks =  2 },
582                         { .offset = 0x0FC000, .erasesize = 0x04000, .numblocks =  1 }
583                 }
584         }, {
585                 .mfr_id = MANUFACTURER_ST,
586                 .dev_id = M29W160DT,
587                 .name = "ST M29W160DT",
588                 .size = 0x00200000,
589                 .numeraseregions = 4,
590                 .regions = {
591                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 },
592                         { .offset = 0x1F0000, .erasesize = 0x08000, .numblocks =  1 },
593                         { .offset = 0x1F8000, .erasesize = 0x02000, .numblocks =  2 },
594                         { .offset = 0x1FC000, .erasesize = 0x04000, .numblocks =  1 }
595                 }
596         }, {
597                 .mfr_id = MANUFACTURER_ST,
598                 .dev_id = M29W160DB,
599                 .name = "ST M29W160DB",
600                 .size = 0x00200000,
601                 .numeraseregions = 4,
602                 .regions = {
603                         { .offset = 0x000000, .erasesize = 0x04000, .numblocks =  1 },
604                         { .offset = 0x004000, .erasesize = 0x02000, .numblocks =  2 },
605                         { .offset = 0x008000, .erasesize = 0x08000, .numblocks =  1 },
606                         { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 }
607                 }
608         }, {
609                 .mfr_id = MANUFACTURER_AMD,
610                 .dev_id = AM29BDS323D,
611                 .name = "AMD AM29BDS323D",
612                 .size = 0x00400000,
613                 .numeraseregions = 3,
614                 .regions = {
615                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 48 },
616                         { .offset = 0x300000, .erasesize = 0x10000, .numblocks = 15 },
617                         { .offset = 0x3f0000, .erasesize = 0x02000, .numblocks =  8 },
618                 }
619         }, {
620                 .mfr_id = MANUFACTURER_ATMEL,
621                 .dev_id = AT49xV16x,
622                 .name = "Atmel AT49xV16x",
623                 .size = 0x00200000,
624                 .numeraseregions = 2,
625                 .regions = {
626                         { .offset = 0x000000, .erasesize = 0x02000, .numblocks =  8 },
627                         { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 }
628                 }
629         }, {
630                 .mfr_id = MANUFACTURER_ATMEL,
631                 .dev_id = AT49xV16xT,
632                 .name = "Atmel AT49xV16xT",
633                 .size = 0x00200000,
634                 .numeraseregions = 2,
635                 .regions = {
636                         { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 },
637                         { .offset = 0x1F0000, .erasesize = 0x02000, .numblocks =  8 }
638                 }
639         }
640         };
641
642         struct mtd_info *mtd;
643         struct flchip chips[MAX_AMD_CHIPS];
644         int table_pos[MAX_AMD_CHIPS];
645         struct amd_flash_private temp;
646         struct amd_flash_private *private;
647         u_long size;
648         unsigned long base;
649         int i;
650         int reg_idx;
651         int offset;
652
653         mtd = (struct mtd_info*)kmalloc(sizeof(*mtd), GFP_KERNEL);
654         if (!mtd) {
655                 printk(KERN_WARNING
656                        "%s: kmalloc failed for info structure\n", map->name);
657                 return NULL;
658         }
659         memset(mtd, 0, sizeof(*mtd));
660         mtd->priv = map;
661
662         memset(&temp, 0, sizeof(temp));
663
664         printk("%s: Probing for AMD compatible flash...\n", map->name);
665
666         if ((table_pos[0] = probe_new_chip(mtd, 0, NULL, &temp, table,
667                                            sizeof(table)/sizeof(table[0])))
668             == -1) {
669                 printk(KERN_WARNING
670                        "%s: Found no AMD compatible device at location zero\n",
671                        map->name);
672                 kfree(mtd);
673
674                 return NULL;
675         }
676
677         chips[0].start = 0;
678         chips[0].state = FL_READY;
679         chips[0].mutex = &chips[0]._spinlock;
680         temp.numchips = 1;
681         for (size = mtd->size; size > 1; size >>= 1) {
682                 temp.chipshift++;
683         }
684         switch (temp.interleave) {
685                 case 2:
686                         temp.chipshift += 1;
687                         break;
688                 case 4:
689                         temp.chipshift += 2;
690                         break;
691         }
692
693         /* Find out if there are any more chips in the map. */
694         for (base = (1 << temp.chipshift);
695              base < map->size;
696              base += (1 << temp.chipshift)) {
697                 int numchips = temp.numchips;
698                 table_pos[numchips] = probe_new_chip(mtd, base, chips,
699                         &temp, table, sizeof(table)/sizeof(table[0]));
700         }
701
702         mtd->eraseregions = kmalloc(sizeof(struct mtd_erase_region_info) *
703                                     mtd->numeraseregions, GFP_KERNEL);
704         if (!mtd->eraseregions) {
705                 printk(KERN_WARNING "%s: Failed to allocate "
706                        "memory for MTD erase region info\n", map->name);
707                 kfree(mtd);
708                 map->fldrv_priv = NULL;
709                 return NULL;
710         }
711
712         reg_idx = 0;
713         offset = 0;
714         for (i = 0; i < temp.numchips; i++) {
715                 int dev_size;
716                 int j;
717
718                 dev_size = 0;
719                 for (j = 0; j < table[table_pos[i]].numeraseregions; j++) {
720                         mtd->eraseregions[reg_idx].offset = offset +
721                                 (table[table_pos[i]].regions[j].offset *
722                                  temp.interleave);
723                         mtd->eraseregions[reg_idx].erasesize =
724                                 table[table_pos[i]].regions[j].erasesize *
725                                 temp.interleave;
726                         mtd->eraseregions[reg_idx].numblocks =
727                                 table[table_pos[i]].regions[j].numblocks;
728                         if (mtd->erasesize <
729                             mtd->eraseregions[reg_idx].erasesize) {
730                                 mtd->erasesize =
731                                         mtd->eraseregions[reg_idx].erasesize;
732                         }
733                         dev_size += mtd->eraseregions[reg_idx].erasesize *
734                                     mtd->eraseregions[reg_idx].numblocks;
735                         reg_idx++;
736                 }
737                 offset += dev_size;
738         }
739         mtd->type = MTD_NORFLASH;
740         mtd->flags = MTD_CAP_NORFLASH;
741         mtd->name = map->name;
742         mtd->erase = amd_flash_erase;
743         mtd->read = amd_flash_read;
744         mtd->write = amd_flash_write;
745         mtd->sync = amd_flash_sync;
746         mtd->suspend = amd_flash_suspend;
747         mtd->resume = amd_flash_resume;
748         mtd->lock = amd_flash_lock;
749         mtd->unlock = amd_flash_unlock;
750
751         private = kmalloc(sizeof(*private) + (sizeof(struct flchip) *
752                                               temp.numchips), GFP_KERNEL);
753         if (!private) {
754                 printk(KERN_WARNING
755                        "%s: kmalloc failed for private structure\n", map->name);
756                 kfree(mtd);
757                 map->fldrv_priv = NULL;
758                 return NULL;
759         }
760         memcpy(private, &temp, sizeof(temp));
761         memcpy(private->chips, chips,
762                sizeof(struct flchip) * private->numchips);
763         for (i = 0; i < private->numchips; i++) {
764                 init_waitqueue_head(&private->chips[i].wq);
765                 spin_lock_init(&private->chips[i]._spinlock);
766         }
767
768         map->fldrv_priv = private;
769
770         map->fldrv = &amd_flash_chipdrv;
771
772         __module_get(THIS_MODULE);
773         return mtd;
774 }
775
776
777
778 static inline int read_one_chip(struct map_info *map, struct flchip *chip,
779                                loff_t adr, size_t len, u_char *buf)
780 {
781         DECLARE_WAITQUEUE(wait, current);
782         unsigned long timeo = jiffies + HZ;
783
784 retry:
785         spin_lock_bh(chip->mutex);
786
787         if (chip->state != FL_READY){
788                 printk(KERN_INFO "%s: waiting for chip to read, state = %d\n",
789                        map->name, chip->state);
790                 set_current_state(TASK_UNINTERRUPTIBLE);
791                 add_wait_queue(&chip->wq, &wait);
792
793                 spin_unlock_bh(chip->mutex);
794
795                 schedule();
796                 remove_wait_queue(&chip->wq, &wait);
797
798                 if(signal_pending(current)) {
799                         return -EINTR;
800                 }
801
802                 timeo = jiffies + HZ;
803
804                 goto retry;
805         }
806
807         adr += chip->start;
808
809         chip->state = FL_READY;
810
811         map_copy_from(map, buf, adr, len);
812
813         wake_up(&chip->wq);
814         spin_unlock_bh(chip->mutex);
815
816         return 0;
817 }
818
819
820
821 static int amd_flash_read(struct mtd_info *mtd, loff_t from, size_t len,
822                           size_t *retlen, u_char *buf)
823 {
824         struct map_info *map = mtd->priv;
825         struct amd_flash_private *private = map->fldrv_priv;
826         unsigned long ofs;
827         int chipnum;
828         int ret = 0;
829
830         if ((from + len) > mtd->size) {
831                 printk(KERN_WARNING "%s: read request past end of device "
832                        "(0x%lx)\n", map->name, (unsigned long)from + len);
833
834                 return -EINVAL;
835         }
836
837         /* Offset within the first chip that the first read should start. */
838         chipnum = (from >> private->chipshift);
839         ofs = from - (chipnum <<  private->chipshift);
840
841         *retlen = 0;
842
843         while (len) {
844                 unsigned long this_len;
845
846                 if (chipnum >= private->numchips) {
847                         break;
848                 }
849
850                 if ((len + ofs - 1) >> private->chipshift) {
851                         this_len = (1 << private->chipshift) - ofs;
852                 } else {
853                         this_len = len;
854                 }
855
856                 ret = read_one_chip(map, &private->chips[chipnum], ofs,
857                                     this_len, buf);
858                 if (ret) {
859                         break;
860                 }
861
862                 *retlen += this_len;
863                 len -= this_len;
864                 buf += this_len;
865
866                 ofs = 0;
867                 chipnum++;
868         }
869
870         return ret;
871 }
872
873
874
875 static int write_one_word(struct map_info *map, struct flchip *chip,
876                           unsigned long adr, __u32 datum)
877 {
878         unsigned long timeo = jiffies + HZ;
879         struct amd_flash_private *private = map->fldrv_priv;
880         DECLARE_WAITQUEUE(wait, current);
881         int ret = 0;
882         int times_left;
883
884 retry:
885         spin_lock_bh(chip->mutex);
886
887         if (chip->state != FL_READY){
888                 printk("%s: waiting for chip to write, state = %d\n",
889                        map->name, chip->state);
890                 set_current_state(TASK_UNINTERRUPTIBLE);
891                 add_wait_queue(&chip->wq, &wait);
892
893                 spin_unlock_bh(chip->mutex);
894
895                 schedule();
896                 remove_wait_queue(&chip->wq, &wait);
897                 printk(KERN_INFO "%s: woke up to write\n", map->name);
898                 if(signal_pending(current))
899                         return -EINTR;
900
901                 timeo = jiffies + HZ;
902
903                 goto retry;
904         }
905
906         chip->state = FL_WRITING;
907
908         adr += chip->start;
909         ENABLE_VPP(map);
910         send_cmd(map, chip->start, CMD_PROGRAM_UNLOCK_DATA);
911         wide_write(map, datum, adr);
912
913         times_left = 500000;
914         while (times_left-- && flash_is_busy(map, adr, private->interleave)) {
915                 if (need_resched()) {
916                         spin_unlock_bh(chip->mutex);
917                         schedule();
918                         spin_lock_bh(chip->mutex);
919                 }
920         }
921
922         if (!times_left) {
923                 printk(KERN_WARNING "%s: write to 0x%lx timed out!\n",
924                        map->name, adr);
925                 ret = -EIO;
926         } else {
927                 __u32 verify;
928                 if ((verify = wide_read(map, adr)) != datum) {
929                         printk(KERN_WARNING "%s: write to 0x%lx failed. "
930                                "datum = %x, verify = %x\n",
931                                map->name, adr, datum, verify);
932                         ret = -EIO;
933                 }
934         }
935
936         DISABLE_VPP(map);
937         chip->state = FL_READY;
938         wake_up(&chip->wq);
939         spin_unlock_bh(chip->mutex);
940
941         return ret;
942 }
943
944
945
946 static int amd_flash_write(struct mtd_info *mtd, loff_t to , size_t len,
947                            size_t *retlen, const u_char *buf)
948 {
949         struct map_info *map = mtd->priv;
950         struct amd_flash_private *private = map->fldrv_priv;
951         int ret = 0;
952         int chipnum;
953         unsigned long ofs;
954         unsigned long chipstart;
955
956         *retlen = 0;
957         if (!len) {
958                 return 0;
959         }
960
961         chipnum = to >> private->chipshift;
962         ofs = to  - (chipnum << private->chipshift);
963         chipstart = private->chips[chipnum].start;
964
965         /* If it's not bus-aligned, do the first byte write. */
966         if (ofs & (map->buswidth - 1)) {
967                 unsigned long bus_ofs = ofs & ~(map->buswidth - 1);
968                 int i = ofs - bus_ofs;
969                 int n = 0;
970                 u_char tmp_buf[4];
971                 __u32 datum;
972
973                 map_copy_from(map, tmp_buf,
974                                bus_ofs + private->chips[chipnum].start,
975                                map->buswidth);
976                 while (len && i < map->buswidth)
977                         tmp_buf[i++] = buf[n++], len--;
978
979                 if (map->buswidth == 2) {
980                         datum = *(__u16*)tmp_buf;
981                 } else if (map->buswidth == 4) {
982                         datum = *(__u32*)tmp_buf;
983                 } else {
984                         return -EINVAL;  /* should never happen, but be safe */
985                 }
986
987                 ret = write_one_word(map, &private->chips[chipnum], bus_ofs,
988                                      datum);
989                 if (ret) {
990                         return ret;
991                 }
992
993                 ofs += n;
994                 buf += n;
995                 (*retlen) += n;
996
997                 if (ofs >> private->chipshift) {
998                         chipnum++;
999                         ofs = 0;
1000                         if (chipnum == private->numchips) {
1001                                 return 0;
1002                         }
1003                 }
1004         }
1005
1006         /* We are now aligned, write as much as possible. */
1007         while(len >= map->buswidth) {
1008                 __u32 datum;
1009
1010                 if (map->buswidth == 1) {
1011                         datum = *(__u8*)buf;
1012                 } else if (map->buswidth == 2) {
1013                         datum = *(__u16*)buf;
1014                 } else if (map->buswidth == 4) {
1015                         datum = *(__u32*)buf;
1016                 } else {
1017                         return -EINVAL;
1018                 }
1019
1020                 ret = write_one_word(map, &private->chips[chipnum], ofs, datum);
1021
1022                 if (ret) {
1023                         return ret;
1024                 }
1025
1026                 ofs += map->buswidth;
1027                 buf += map->buswidth;
1028                 (*retlen) += map->buswidth;
1029                 len -= map->buswidth;
1030
1031                 if (ofs >> private->chipshift) {
1032                         chipnum++;
1033                         ofs = 0;
1034                         if (chipnum == private->numchips) {
1035                                 return 0;
1036                         }
1037                         chipstart = private->chips[chipnum].start;
1038                 }
1039         }
1040
1041         if (len & (map->buswidth - 1)) {
1042                 int i = 0, n = 0;
1043                 u_char tmp_buf[2];
1044                 __u32 datum;
1045
1046                 map_copy_from(map, tmp_buf,
1047                                ofs + private->chips[chipnum].start,
1048                                map->buswidth);
1049                 while (len--) {
1050                         tmp_buf[i++] = buf[n++];
1051                 }
1052
1053                 if (map->buswidth == 2) {
1054                         datum = *(__u16*)tmp_buf;
1055                 } else if (map->buswidth == 4) {
1056                         datum = *(__u32*)tmp_buf;
1057                 } else {
1058                         return -EINVAL;  /* should never happen, but be safe */
1059                 }
1060
1061                 ret = write_one_word(map, &private->chips[chipnum], ofs, datum);
1062
1063                 if (ret) {
1064                         return ret;
1065                 }
1066
1067                 (*retlen) += n;
1068         }
1069
1070         return 0;
1071 }
1072
1073
1074
1075 static inline int erase_one_block(struct map_info *map, struct flchip *chip,
1076                                   unsigned long adr, u_long size)
1077 {
1078         unsigned long timeo = jiffies + HZ;
1079         struct amd_flash_private *private = map->fldrv_priv;
1080         DECLARE_WAITQUEUE(wait, current);
1081
1082 retry:
1083         spin_lock_bh(chip->mutex);
1084
1085         if (chip->state != FL_READY){
1086                 set_current_state(TASK_UNINTERRUPTIBLE);
1087                 add_wait_queue(&chip->wq, &wait);
1088
1089                 spin_unlock_bh(chip->mutex);
1090
1091                 schedule();
1092                 remove_wait_queue(&chip->wq, &wait);
1093
1094                 if (signal_pending(current)) {
1095                         return -EINTR;
1096                 }
1097
1098                 timeo = jiffies + HZ;
1099
1100                 goto retry;
1101         }
1102
1103         chip->state = FL_ERASING;
1104
1105         adr += chip->start;
1106         ENABLE_VPP(map);
1107         send_cmd(map, chip->start, CMD_SECTOR_ERASE_UNLOCK_DATA);
1108         send_cmd_to_addr(map, chip->start, CMD_SECTOR_ERASE_UNLOCK_DATA_2, adr);
1109
1110         timeo = jiffies + (HZ * 20);
1111
1112         spin_unlock_bh(chip->mutex);
1113         msleep(1000);
1114         spin_lock_bh(chip->mutex);
1115
1116         while (flash_is_busy(map, adr, private->interleave)) {
1117
1118                 if (chip->state != FL_ERASING) {
1119                         /* Someone's suspended the erase. Sleep */
1120                         set_current_state(TASK_UNINTERRUPTIBLE);
1121                         add_wait_queue(&chip->wq, &wait);
1122
1123                         spin_unlock_bh(chip->mutex);
1124                         printk(KERN_INFO "%s: erase suspended. Sleeping\n",
1125                                map->name);
1126                         schedule();
1127                         remove_wait_queue(&chip->wq, &wait);
1128
1129                         if (signal_pending(current)) {
1130                                 return -EINTR;
1131                         }
1132
1133                         timeo = jiffies + (HZ*2); /* FIXME */
1134                         spin_lock_bh(chip->mutex);
1135                         continue;
1136                 }
1137
1138                 /* OK Still waiting */
1139                 if (time_after(jiffies, timeo)) {
1140                         chip->state = FL_READY;
1141                         spin_unlock_bh(chip->mutex);
1142                         printk(KERN_WARNING "%s: waiting for erase to complete "
1143                                "timed out.\n", map->name);
1144                         DISABLE_VPP(map);
1145
1146                         return -EIO;
1147                 }
1148
1149                 /* Latency issues. Drop the lock, wait a while and retry */
1150                 spin_unlock_bh(chip->mutex);
1151
1152                 if (need_resched())
1153                         schedule();
1154                 else
1155                         udelay(1);
1156
1157                 spin_lock_bh(chip->mutex);
1158         }
1159
1160         /* Verify every single word */
1161         {
1162                 int address;
1163                 int error = 0;
1164                 __u8 verify;
1165
1166                 for (address = adr; address < (adr + size); address++) {
1167                         if ((verify = map_read8(map, address)) != 0xFF) {
1168                                 error = 1;
1169                                 break;
1170                         }
1171                 }
1172                 if (error) {
1173                         chip->state = FL_READY;
1174                         spin_unlock_bh(chip->mutex);
1175                         printk(KERN_WARNING
1176                                "%s: verify error at 0x%x, size %ld.\n",
1177                                map->name, address, size);
1178                         DISABLE_VPP(map);
1179
1180                         return -EIO;
1181                 }
1182         }
1183
1184         DISABLE_VPP(map);
1185         chip->state = FL_READY;
1186         wake_up(&chip->wq);
1187         spin_unlock_bh(chip->mutex);
1188
1189         return 0;
1190 }
1191
1192
1193
1194 static int amd_flash_erase(struct mtd_info *mtd, struct erase_info *instr)
1195 {
1196         struct map_info *map = mtd->priv;
1197         struct amd_flash_private *private = map->fldrv_priv;
1198         unsigned long adr, len;
1199         int chipnum;
1200         int ret = 0;
1201         int i;
1202         int first;
1203         struct mtd_erase_region_info *regions = mtd->eraseregions;
1204
1205         if (instr->addr > mtd->size) {
1206                 return -EINVAL;
1207         }
1208
1209         if ((instr->len + instr->addr) > mtd->size) {
1210                 return -EINVAL;
1211         }
1212
1213         /* Check that both start and end of the requested erase are
1214          * aligned with the erasesize at the appropriate addresses.
1215          */
1216
1217         i = 0;
1218
1219         /* Skip all erase regions which are ended before the start of
1220            the requested erase. Actually, to save on the calculations,
1221            we skip to the first erase region which starts after the
1222            start of the requested erase, and then go back one.
1223         */
1224
1225         while ((i < mtd->numeraseregions) &&
1226                (instr->addr >= regions[i].offset)) {
1227                i++;
1228         }
1229         i--;
1230
1231         /* OK, now i is pointing at the erase region in which this
1232          * erase request starts. Check the start of the requested
1233          * erase range is aligned with the erase size which is in
1234          * effect here.
1235          */
1236
1237         if (instr->addr & (regions[i].erasesize-1)) {
1238                 return -EINVAL;
1239         }
1240
1241         /* Remember the erase region we start on. */
1242
1243         first = i;
1244
1245         /* Next, check that the end of the requested erase is aligned
1246          * with the erase region at that address.
1247          */
1248
1249         while ((i < mtd->numeraseregions) &&
1250                ((instr->addr + instr->len) >= regions[i].offset)) {
1251                 i++;
1252         }
1253
1254         /* As before, drop back one to point at the region in which
1255          * the address actually falls.
1256          */
1257
1258         i--;
1259
1260         if ((instr->addr + instr->len) & (regions[i].erasesize-1)) {
1261                 return -EINVAL;
1262         }
1263
1264         chipnum = instr->addr >> private->chipshift;
1265         adr = instr->addr - (chipnum << private->chipshift);
1266         len = instr->len;
1267
1268         i = first;
1269
1270         while (len) {
1271                 ret = erase_one_block(map, &private->chips[chipnum], adr,
1272                                       regions[i].erasesize);
1273
1274                 if (ret) {
1275                         return ret;
1276                 }
1277
1278                 adr += regions[i].erasesize;
1279                 len -= regions[i].erasesize;
1280
1281                 if ((adr % (1 << private->chipshift)) ==
1282                     ((regions[i].offset + (regions[i].erasesize *
1283                                            regions[i].numblocks))
1284                      % (1 << private->chipshift))) {
1285                         i++;
1286                 }
1287
1288                 if (adr >> private->chipshift) {
1289                         adr = 0;
1290                         chipnum++;
1291                         if (chipnum >= private->numchips) {
1292                                 break;
1293                         }
1294                 }
1295         }
1296
1297         instr->state = MTD_ERASE_DONE;
1298         mtd_erase_callback(instr);
1299
1300         return 0;
1301 }
1302
1303
1304
1305 static void amd_flash_sync(struct mtd_info *mtd)
1306 {
1307         struct map_info *map = mtd->priv;
1308         struct amd_flash_private *private = map->fldrv_priv;
1309         int i;
1310         struct flchip *chip;
1311         int ret = 0;
1312         DECLARE_WAITQUEUE(wait, current);
1313
1314         for (i = 0; !ret && (i < private->numchips); i++) {
1315                 chip = &private->chips[i];
1316
1317         retry:
1318                 spin_lock_bh(chip->mutex);
1319
1320                 switch(chip->state) {
1321                 case FL_READY:
1322                 case FL_STATUS:
1323                 case FL_CFI_QUERY:
1324                 case FL_JEDEC_QUERY:
1325                         chip->oldstate = chip->state;
1326                         chip->state = FL_SYNCING;
1327                         /* No need to wake_up() on this state change -
1328                          * as the whole point is that nobody can do anything
1329                          * with the chip now anyway.
1330                          */
1331                 case FL_SYNCING:
1332                         spin_unlock_bh(chip->mutex);
1333                         break;
1334
1335                 default:
1336                         /* Not an idle state */
1337                         add_wait_queue(&chip->wq, &wait);
1338
1339                         spin_unlock_bh(chip->mutex);
1340
1341                         schedule();
1342
1343                         remove_wait_queue(&chip->wq, &wait);
1344
1345                         goto retry;
1346                 }
1347         }
1348
1349         /* Unlock the chips again */
1350         for (i--; i >= 0; i--) {
1351                 chip = &private->chips[i];
1352
1353                 spin_lock_bh(chip->mutex);
1354
1355                 if (chip->state == FL_SYNCING) {
1356                         chip->state = chip->oldstate;
1357                         wake_up(&chip->wq);
1358                 }
1359                 spin_unlock_bh(chip->mutex);
1360         }
1361 }
1362
1363
1364
1365 static int amd_flash_suspend(struct mtd_info *mtd)
1366 {
1367 printk("amd_flash_suspend(): not implemented!\n");
1368         return -EINVAL;
1369 }
1370
1371
1372
1373 static void amd_flash_resume(struct mtd_info *mtd)
1374 {
1375 printk("amd_flash_resume(): not implemented!\n");
1376 }
1377
1378
1379
1380 static void amd_flash_destroy(struct mtd_info *mtd)
1381 {
1382         struct map_info *map = mtd->priv;
1383         struct amd_flash_private *private = map->fldrv_priv;
1384         kfree(private);
1385 }
1386
1387 int __init amd_flash_init(void)
1388 {
1389         register_mtd_chip_driver(&amd_flash_chipdrv);
1390         return 0;
1391 }
1392
1393 void __exit amd_flash_exit(void)
1394 {
1395         unregister_mtd_chip_driver(&amd_flash_chipdrv);
1396 }
1397
1398 module_init(amd_flash_init);
1399 module_exit(amd_flash_exit);
1400
1401 MODULE_LICENSE("GPL");
1402 MODULE_AUTHOR("Jonas Holmberg <jonas.holmberg@axis.com>");
1403 MODULE_DESCRIPTION("Old MTD chip driver for AMD flash chips");