Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux

Merge git://git.infradead.org/mtd-2.6

* git://git.infradead.org/mtd-2.6: (21 commits)
[MTD] [CHIPS] Remove MTD_OBSOLETE_CHIPS (jedec, amd_flash, sharp)
[MTD] Delete allegedly obsolete "bank_size" field of mtd_info.
[MTD] Remove unnecessary user space check from mtd.h.
[MTD] [MAPS] Remove flash maps for no longer supported 405LP boards
[MTD] [MAPS] Fix missing printk() parameter in physmap_of.c MTD driver
[MTD] [NAND] platform NAND driver: add driver
[MTD] [NAND] platform NAND driver: update header
[JFFS2] Simplify and clean up jffs2_add_tn_to_tree() some more.
[JFFS2] Remove another bogus optimisation in jffs2_add_tn_to_tree()
[JFFS2] Remove broken insert_point optimisation in jffs2_add_tn_to_tree()
[JFFS2] Remember to calculate overlap on nodes which replace older nodes
[JFFS2] Don't advance c->wbuf_ofs to next eraseblock after wbuf flush
[MTD] [NAND] at91_nand.c: CMDLINE_PARTS support
[MTD] [NAND] Tidy up handling of page number in nand_block_bad()
[MTD] block2mtd_paramline[] mustn't be __initdata
[MTD] [NAND] Support multiple chips in CAFÉ driver
[MTD] [NAND] Rename cafe.c to cafe_nand.c and remove the multi-obj magic
[MTD] [NAND] Use rslib for CAFÉ ECC
[RSLIB] Support non-canonical GF representations
[JFFS2] Remove dead file histo_mips.h
...

+430 -4752
+6
MAINTAINERS
··· 2648 2648 L: video4linux-list@redhat.com 2649 2649 S: Maintained 2650 2650 2651 + ONENAND FLASH DRIVER 2652 + P: Kyungmin Park 2653 + M: kyungmin.park@samsung.com 2654 + L: linux-mtd@lists.infradead.org 2655 + S: Maintained 2656 + 2651 2657 ONSTREAM SCSI TAPE DRIVER 2652 2658 P: Willem Riede 2653 2659 M: osst@riede.org
-40
drivers/mtd/chips/Kconfig
··· 1 1 # drivers/mtd/chips/Kconfig 2 - # $Id: Kconfig,v 1.18 2005/11/07 11:14:22 gleixner Exp $ 3 2 4 3 menu "RAM/ROM/Flash chip drivers" 5 4 depends on MTD!=n ··· 229 230 preserves the expected registration order of MTD device nodes on 230 231 the system regardless of media presence. Device nodes created 231 232 with this driver will return -ENODEV upon access. 232 - 233 - config MTD_OBSOLETE_CHIPS 234 - bool "Older (theoretically obsoleted now) drivers for non-CFI chips" 235 - help 236 - This option does not enable any code directly, but will allow you to 237 - select some other chip drivers which are now considered obsolete, 238 - because the generic CONFIG_JEDECPROBE code above should now detect 239 - the chips which are supported by these drivers, and allow the generic 240 - CFI-compatible drivers to drive the chips. Say 'N' here unless you have 241 - already tried the CONFIG_JEDECPROBE method and reported its failure 242 - to the MTD mailing list at <linux-mtd@lists.infradead.org> 243 - 244 - config MTD_AMDSTD 245 - tristate "AMD compatible flash chip support (non-CFI)" 246 - depends on MTD_OBSOLETE_CHIPS && BROKEN 247 - help 248 - This option enables support for flash chips using AMD-compatible 249 - commands, including some which are not CFI-compatible and hence 250 - cannot be used with the CONFIG_MTD_CFI_AMDSTD option. 251 - 252 - It also works on AMD compatible chips that do conform to CFI. 253 - 254 - config MTD_SHARP 255 - tristate "pre-CFI Sharp chip support" 256 - depends on MTD_OBSOLETE_CHIPS 257 - help 258 - This option enables support for flash chips using Sharp-compatible 259 - commands, including some which are not CFI-compatible and hence 260 - cannot be used with the CONFIG_MTD_CFI_INTELxxx options. 261 - 262 - config MTD_JEDEC 263 - tristate "JEDEC device support" 264 - depends on MTD_OBSOLETE_CHIPS && BROKEN 265 - help 266 - Enable older JEDEC flash interface devices for self 267 - programming flash. It is commonly used in older AMD chips. It is 268 - only called JEDEC because the JEDEC association 269 - <http://www.jedec.org/> distributes the identification codes for the 270 - chips. 271 233 272 234 config MTD_XIP 273 235 bool "XIP aware MTD support"
-4
drivers/mtd/chips/Makefile
··· 1 1 # 2 2 # linux/drivers/chips/Makefile 3 3 # 4 - # $Id: Makefile.common,v 1.5 2005/11/07 11:14:22 gleixner Exp $ 5 4 6 5 obj-$(CONFIG_MTD) += chipreg.o 7 - obj-$(CONFIG_MTD_AMDSTD) += amd_flash.o 8 6 obj-$(CONFIG_MTD_CFI) += cfi_probe.o 9 7 obj-$(CONFIG_MTD_CFI_UTIL) += cfi_util.o 10 8 obj-$(CONFIG_MTD_CFI_STAA) += cfi_cmdset_0020.o 11 9 obj-$(CONFIG_MTD_CFI_AMDSTD) += cfi_cmdset_0002.o 12 10 obj-$(CONFIG_MTD_CFI_INTELEXT) += cfi_cmdset_0001.o 13 11 obj-$(CONFIG_MTD_GEN_PROBE) += gen_probe.o 14 - obj-$(CONFIG_MTD_JEDEC) += jedec.o 15 12 obj-$(CONFIG_MTD_JEDECPROBE) += jedec_probe.o 16 13 obj-$(CONFIG_MTD_RAM) += map_ram.o 17 14 obj-$(CONFIG_MTD_ROM) += map_rom.o 18 - obj-$(CONFIG_MTD_SHARP) += sharp.o 19 15 obj-$(CONFIG_MTD_ABSENT) += map_absent.o
-1396
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 - struct flchip chips[0]; 101 - }; 102 - 103 - struct amd_flash_info { 104 - const __u16 mfr_id; 105 - const __u16 dev_id; 106 - const char *name; 107 - const u_long size; 108 - const int numeraseregions; 109 - const struct mtd_erase_region_info regions[4]; 110 - }; 111 - 112 - 113 - 114 - static int amd_flash_read(struct mtd_info *, loff_t, size_t, size_t *, 115 - u_char *); 116 - static int amd_flash_write(struct mtd_info *, loff_t, size_t, size_t *, 117 - const u_char *); 118 - static int amd_flash_erase(struct mtd_info *, struct erase_info *); 119 - static void amd_flash_sync(struct mtd_info *); 120 - static int amd_flash_suspend(struct mtd_info *); 121 - static void amd_flash_resume(struct mtd_info *); 122 - static void amd_flash_destroy(struct mtd_info *); 123 - static struct mtd_info *amd_flash_probe(struct map_info *map); 124 - 125 - 126 - static struct mtd_chip_driver amd_flash_chipdrv = { 127 - .probe = amd_flash_probe, 128 - .destroy = amd_flash_destroy, 129 - .name = "amd_flash", 130 - .module = THIS_MODULE 131 - }; 132 - 133 - static inline __u32 wide_read(struct map_info *map, __u32 addr) 134 - { 135 - if (map->buswidth == 1) { 136 - return map_read8(map, addr); 137 - } else if (map->buswidth == 2) { 138 - return map_read16(map, addr); 139 - } else if (map->buswidth == 4) { 140 - return map_read32(map, addr); 141 - } 142 - 143 - return 0; 144 - } 145 - 146 - static inline void wide_write(struct map_info *map, __u32 val, __u32 addr) 147 - { 148 - if (map->buswidth == 1) { 149 - map_write8(map, val, addr); 150 - } else if (map->buswidth == 2) { 151 - map_write16(map, val, addr); 152 - } else if (map->buswidth == 4) { 153 - map_write32(map, val, addr); 154 - } 155 - } 156 - 157 - static inline __u32 make_cmd(struct map_info *map, __u32 cmd) 158 - { 159 - const struct amd_flash_private *private = map->fldrv_priv; 160 - if ((private->interleave == 2) && 161 - (private->device_type == DEVICE_TYPE_X16)) { 162 - cmd |= (cmd << 16); 163 - } 164 - 165 - return cmd; 166 - } 167 - 168 - static inline void send_unlock(struct map_info *map, unsigned long base) 169 - { 170 - wide_write(map, (CMD_UNLOCK_DATA_1 << 16) | CMD_UNLOCK_DATA_1, 171 - base + (map->buswidth * ADDR_UNLOCK_1)); 172 - wide_write(map, (CMD_UNLOCK_DATA_2 << 16) | CMD_UNLOCK_DATA_2, 173 - base + (map->buswidth * ADDR_UNLOCK_2)); 174 - } 175 - 176 - static inline void send_cmd(struct map_info *map, unsigned long base, __u32 cmd) 177 - { 178 - send_unlock(map, base); 179 - wide_write(map, make_cmd(map, cmd), 180 - base + (map->buswidth * ADDR_UNLOCK_1)); 181 - } 182 - 183 - static inline void send_cmd_to_addr(struct map_info *map, unsigned long base, 184 - __u32 cmd, unsigned long addr) 185 - { 186 - send_unlock(map, base); 187 - wide_write(map, make_cmd(map, cmd), addr); 188 - } 189 - 190 - static inline int flash_is_busy(struct map_info *map, unsigned long addr, 191 - int interleave) 192 - { 193 - 194 - if ((interleave == 2) && (map->buswidth == 4)) { 195 - __u32 read1, read2; 196 - 197 - read1 = wide_read(map, addr); 198 - read2 = wide_read(map, addr); 199 - 200 - return (((read1 >> 16) & D6_MASK) != 201 - ((read2 >> 16) & D6_MASK)) || 202 - (((read1 & 0xffff) & D6_MASK) != 203 - ((read2 & 0xffff) & D6_MASK)); 204 - } 205 - 206 - return ((wide_read(map, addr) & D6_MASK) != 207 - (wide_read(map, addr) & D6_MASK)); 208 - } 209 - 210 - static inline void unlock_sector(struct map_info *map, unsigned long sect_addr, 211 - int unlock) 212 - { 213 - /* Sector lock address. A6 = 1 for unlock, A6 = 0 for lock */ 214 - int SLA = unlock ? 215 - (sect_addr | (0x40 * map->buswidth)) : 216 - (sect_addr & ~(0x40 * map->buswidth)) ; 217 - 218 - __u32 cmd = make_cmd(map, CMD_UNLOCK_SECTOR); 219 - 220 - wide_write(map, make_cmd(map, CMD_RESET_DATA), 0); 221 - wide_write(map, cmd, SLA); /* 1st cycle: write cmd to any address */ 222 - wide_write(map, cmd, SLA); /* 2nd cycle: write cmd to any address */ 223 - wide_write(map, cmd, SLA); /* 3rd cycle: write cmd to SLA */ 224 - } 225 - 226 - static inline int is_sector_locked(struct map_info *map, 227 - unsigned long sect_addr) 228 - { 229 - int status; 230 - 231 - wide_write(map, CMD_RESET_DATA, 0); 232 - send_cmd(map, sect_addr, CMD_MANUFACTURER_UNLOCK_DATA); 233 - 234 - /* status is 0x0000 for unlocked and 0x0001 for locked */ 235 - status = wide_read(map, sect_addr + (map->buswidth * ADDR_SECTOR_LOCK)); 236 - wide_write(map, CMD_RESET_DATA, 0); 237 - return status; 238 - } 239 - 240 - static int amd_flash_do_unlock(struct mtd_info *mtd, loff_t ofs, size_t len, 241 - int is_unlock) 242 - { 243 - struct map_info *map; 244 - struct mtd_erase_region_info *merip; 245 - int eraseoffset, erasesize, eraseblocks; 246 - int i; 247 - int retval = 0; 248 - int lock_status; 249 - 250 - map = mtd->priv; 251 - 252 - /* Pass the whole chip through sector by sector and check for each 253 - sector if the sector and the given interval overlap */ 254 - for(i = 0; i < mtd->numeraseregions; i++) { 255 - merip = &mtd->eraseregions[i]; 256 - 257 - eraseoffset = merip->offset; 258 - erasesize = merip->erasesize; 259 - eraseblocks = merip->numblocks; 260 - 261 - if (ofs > eraseoffset + erasesize) 262 - continue; 263 - 264 - while (eraseblocks > 0) { 265 - if (ofs < eraseoffset + erasesize && ofs + len > eraseoffset) { 266 - unlock_sector(map, eraseoffset, is_unlock); 267 - 268 - lock_status = is_sector_locked(map, eraseoffset); 269 - 270 - if (is_unlock && lock_status) { 271 - printk("Cannot unlock sector at address %x length %xx\n", 272 - eraseoffset, merip->erasesize); 273 - retval = -1; 274 - } else if (!is_unlock && !lock_status) { 275 - printk("Cannot lock sector at address %x length %x\n", 276 - eraseoffset, merip->erasesize); 277 - retval = -1; 278 - } 279 - } 280 - eraseoffset += erasesize; 281 - eraseblocks --; 282 - } 283 - } 284 - return retval; 285 - } 286 - 287 - static int amd_flash_unlock(struct mtd_info *mtd, loff_t ofs, size_t len) 288 - { 289 - return amd_flash_do_unlock(mtd, ofs, len, 1); 290 - } 291 - 292 - static int amd_flash_lock(struct mtd_info *mtd, loff_t ofs, size_t len) 293 - { 294 - return amd_flash_do_unlock(mtd, ofs, len, 0); 295 - } 296 - 297 - 298 - /* 299 - * Reads JEDEC manufacturer ID and device ID and returns the index of the first 300 - * matching table entry (-1 if not found or alias for already found chip). 301 - */ 302 - static int probe_new_chip(struct mtd_info *mtd, __u32 base, 303 - struct flchip *chips, 304 - struct amd_flash_private *private, 305 - const struct amd_flash_info *table, int table_size) 306 - { 307 - __u32 mfr_id; 308 - __u32 dev_id; 309 - struct map_info *map = mtd->priv; 310 - struct amd_flash_private temp; 311 - int i; 312 - 313 - temp.device_type = DEVICE_TYPE_X16; // Assume X16 (FIXME) 314 - temp.interleave = 2; 315 - map->fldrv_priv = &temp; 316 - 317 - /* Enter autoselect mode. */ 318 - send_cmd(map, base, CMD_RESET_DATA); 319 - send_cmd(map, base, CMD_MANUFACTURER_UNLOCK_DATA); 320 - 321 - mfr_id = wide_read(map, base + (map->buswidth * ADDR_MANUFACTURER)); 322 - dev_id = wide_read(map, base + (map->buswidth * ADDR_DEVICE_ID)); 323 - 324 - if ((map->buswidth == 4) && ((mfr_id >> 16) == (mfr_id & 0xffff)) && 325 - ((dev_id >> 16) == (dev_id & 0xffff))) { 326 - mfr_id &= 0xffff; 327 - dev_id &= 0xffff; 328 - } else { 329 - temp.interleave = 1; 330 - } 331 - 332 - for (i = 0; i < table_size; i++) { 333 - if ((mfr_id == table[i].mfr_id) && 334 - (dev_id == table[i].dev_id)) { 335 - if (chips) { 336 - int j; 337 - 338 - /* Is this an alias for an already found chip? 339 - * In that case that chip should be in 340 - * autoselect mode now. 341 - */ 342 - for (j = 0; j < private->numchips; j++) { 343 - __u32 mfr_id_other; 344 - __u32 dev_id_other; 345 - 346 - mfr_id_other = 347 - wide_read(map, chips[j].start + 348 - (map->buswidth * 349 - ADDR_MANUFACTURER 350 - )); 351 - dev_id_other = 352 - wide_read(map, chips[j].start + 353 - (map->buswidth * 354 - ADDR_DEVICE_ID)); 355 - if (temp.interleave == 2) { 356 - mfr_id_other &= 0xffff; 357 - dev_id_other &= 0xffff; 358 - } 359 - if ((mfr_id_other == mfr_id) && 360 - (dev_id_other == dev_id)) { 361 - 362 - /* Exit autoselect mode. */ 363 - send_cmd(map, base, 364 - CMD_RESET_DATA); 365 - 366 - return -1; 367 - } 368 - } 369 - 370 - if (private->numchips == MAX_AMD_CHIPS) { 371 - printk(KERN_WARNING 372 - "%s: Too many flash chips " 373 - "detected. Increase " 374 - "MAX_AMD_CHIPS from %d.\n", 375 - map->name, MAX_AMD_CHIPS); 376 - 377 - return -1; 378 - } 379 - 380 - chips[private->numchips].start = base; 381 - chips[private->numchips].state = FL_READY; 382 - chips[private->numchips].mutex = 383 - &chips[private->numchips]._spinlock; 384 - private->numchips++; 385 - } 386 - 387 - printk("%s: Found %d x %ldMiB %s at 0x%x\n", map->name, 388 - temp.interleave, (table[i].size)/(1024*1024), 389 - table[i].name, base); 390 - 391 - mtd->size += table[i].size * temp.interleave; 392 - mtd->numeraseregions += table[i].numeraseregions; 393 - 394 - break; 395 - } 396 - } 397 - 398 - /* Exit autoselect mode. */ 399 - send_cmd(map, base, CMD_RESET_DATA); 400 - 401 - if (i == table_size) { 402 - printk(KERN_DEBUG "%s: unknown flash device at 0x%x, " 403 - "mfr id 0x%x, dev id 0x%x\n", map->name, 404 - base, mfr_id, dev_id); 405 - map->fldrv_priv = NULL; 406 - 407 - return -1; 408 - } 409 - 410 - private->device_type = temp.device_type; 411 - private->interleave = temp.interleave; 412 - 413 - return i; 414 - } 415 - 416 - 417 - 418 - static struct mtd_info *amd_flash_probe(struct map_info *map) 419 - { 420 - static const struct amd_flash_info table[] = { 421 - { 422 - .mfr_id = MANUFACTURER_AMD, 423 - .dev_id = AM29LV160DT, 424 - .name = "AMD AM29LV160DT", 425 - .size = 0x00200000, 426 - .numeraseregions = 4, 427 - .regions = { 428 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 }, 429 - { .offset = 0x1F0000, .erasesize = 0x08000, .numblocks = 1 }, 430 - { .offset = 0x1F8000, .erasesize = 0x02000, .numblocks = 2 }, 431 - { .offset = 0x1FC000, .erasesize = 0x04000, .numblocks = 1 } 432 - } 433 - }, { 434 - .mfr_id = MANUFACTURER_AMD, 435 - .dev_id = AM29LV160DB, 436 - .name = "AMD AM29LV160DB", 437 - .size = 0x00200000, 438 - .numeraseregions = 4, 439 - .regions = { 440 - { .offset = 0x000000, .erasesize = 0x04000, .numblocks = 1 }, 441 - { .offset = 0x004000, .erasesize = 0x02000, .numblocks = 2 }, 442 - { .offset = 0x008000, .erasesize = 0x08000, .numblocks = 1 }, 443 - { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 } 444 - } 445 - }, { 446 - .mfr_id = MANUFACTURER_TOSHIBA, 447 - .dev_id = TC58FVT160, 448 - .name = "Toshiba TC58FVT160", 449 - .size = 0x00200000, 450 - .numeraseregions = 4, 451 - .regions = { 452 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 }, 453 - { .offset = 0x1F0000, .erasesize = 0x08000, .numblocks = 1 }, 454 - { .offset = 0x1F8000, .erasesize = 0x02000, .numblocks = 2 }, 455 - { .offset = 0x1FC000, .erasesize = 0x04000, .numblocks = 1 } 456 - } 457 - }, { 458 - .mfr_id = MANUFACTURER_FUJITSU, 459 - .dev_id = MBM29LV160TE, 460 - .name = "Fujitsu MBM29LV160TE", 461 - .size = 0x00200000, 462 - .numeraseregions = 4, 463 - .regions = { 464 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 }, 465 - { .offset = 0x1F0000, .erasesize = 0x08000, .numblocks = 1 }, 466 - { .offset = 0x1F8000, .erasesize = 0x02000, .numblocks = 2 }, 467 - { .offset = 0x1FC000, .erasesize = 0x04000, .numblocks = 1 } 468 - } 469 - }, { 470 - .mfr_id = MANUFACTURER_TOSHIBA, 471 - .dev_id = TC58FVB160, 472 - .name = "Toshiba TC58FVB160", 473 - .size = 0x00200000, 474 - .numeraseregions = 4, 475 - .regions = { 476 - { .offset = 0x000000, .erasesize = 0x04000, .numblocks = 1 }, 477 - { .offset = 0x004000, .erasesize = 0x02000, .numblocks = 2 }, 478 - { .offset = 0x008000, .erasesize = 0x08000, .numblocks = 1 }, 479 - { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 } 480 - } 481 - }, { 482 - .mfr_id = MANUFACTURER_FUJITSU, 483 - .dev_id = MBM29LV160BE, 484 - .name = "Fujitsu MBM29LV160BE", 485 - .size = 0x00200000, 486 - .numeraseregions = 4, 487 - .regions = { 488 - { .offset = 0x000000, .erasesize = 0x04000, .numblocks = 1 }, 489 - { .offset = 0x004000, .erasesize = 0x02000, .numblocks = 2 }, 490 - { .offset = 0x008000, .erasesize = 0x08000, .numblocks = 1 }, 491 - { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 } 492 - } 493 - }, { 494 - .mfr_id = MANUFACTURER_AMD, 495 - .dev_id = AM29LV800BB, 496 - .name = "AMD AM29LV800BB", 497 - .size = 0x00100000, 498 - .numeraseregions = 4, 499 - .regions = { 500 - { .offset = 0x000000, .erasesize = 0x04000, .numblocks = 1 }, 501 - { .offset = 0x004000, .erasesize = 0x02000, .numblocks = 2 }, 502 - { .offset = 0x008000, .erasesize = 0x08000, .numblocks = 1 }, 503 - { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 15 } 504 - } 505 - }, { 506 - .mfr_id = MANUFACTURER_AMD, 507 - .dev_id = AM29F800BB, 508 - .name = "AMD AM29F800BB", 509 - .size = 0x00100000, 510 - .numeraseregions = 4, 511 - .regions = { 512 - { .offset = 0x000000, .erasesize = 0x04000, .numblocks = 1 }, 513 - { .offset = 0x004000, .erasesize = 0x02000, .numblocks = 2 }, 514 - { .offset = 0x008000, .erasesize = 0x08000, .numblocks = 1 }, 515 - { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 15 } 516 - } 517 - }, { 518 - .mfr_id = MANUFACTURER_AMD, 519 - .dev_id = AM29LV800BT, 520 - .name = "AMD AM29LV800BT", 521 - .size = 0x00100000, 522 - .numeraseregions = 4, 523 - .regions = { 524 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 15 }, 525 - { .offset = 0x0F0000, .erasesize = 0x08000, .numblocks = 1 }, 526 - { .offset = 0x0F8000, .erasesize = 0x02000, .numblocks = 2 }, 527 - { .offset = 0x0FC000, .erasesize = 0x04000, .numblocks = 1 } 528 - } 529 - }, { 530 - .mfr_id = MANUFACTURER_AMD, 531 - .dev_id = AM29F800BT, 532 - .name = "AMD AM29F800BT", 533 - .size = 0x00100000, 534 - .numeraseregions = 4, 535 - .regions = { 536 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 15 }, 537 - { .offset = 0x0F0000, .erasesize = 0x08000, .numblocks = 1 }, 538 - { .offset = 0x0F8000, .erasesize = 0x02000, .numblocks = 2 }, 539 - { .offset = 0x0FC000, .erasesize = 0x04000, .numblocks = 1 } 540 - } 541 - }, { 542 - .mfr_id = MANUFACTURER_AMD, 543 - .dev_id = AM29LV800BB, 544 - .name = "AMD AM29LV800BB", 545 - .size = 0x00100000, 546 - .numeraseregions = 4, 547 - .regions = { 548 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 15 }, 549 - { .offset = 0x0F0000, .erasesize = 0x08000, .numblocks = 1 }, 550 - { .offset = 0x0F8000, .erasesize = 0x02000, .numblocks = 2 }, 551 - { .offset = 0x0FC000, .erasesize = 0x04000, .numblocks = 1 } 552 - } 553 - }, { 554 - .mfr_id = MANUFACTURER_FUJITSU, 555 - .dev_id = MBM29LV800BB, 556 - .name = "Fujitsu MBM29LV800BB", 557 - .size = 0x00100000, 558 - .numeraseregions = 4, 559 - .regions = { 560 - { .offset = 0x000000, .erasesize = 0x04000, .numblocks = 1 }, 561 - { .offset = 0x004000, .erasesize = 0x02000, .numblocks = 2 }, 562 - { .offset = 0x008000, .erasesize = 0x08000, .numblocks = 1 }, 563 - { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 15 } 564 - } 565 - }, { 566 - .mfr_id = MANUFACTURER_ST, 567 - .dev_id = M29W800T, 568 - .name = "ST M29W800T", 569 - .size = 0x00100000, 570 - .numeraseregions = 4, 571 - .regions = { 572 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 15 }, 573 - { .offset = 0x0F0000, .erasesize = 0x08000, .numblocks = 1 }, 574 - { .offset = 0x0F8000, .erasesize = 0x02000, .numblocks = 2 }, 575 - { .offset = 0x0FC000, .erasesize = 0x04000, .numblocks = 1 } 576 - } 577 - }, { 578 - .mfr_id = MANUFACTURER_ST, 579 - .dev_id = M29W160DT, 580 - .name = "ST M29W160DT", 581 - .size = 0x00200000, 582 - .numeraseregions = 4, 583 - .regions = { 584 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 }, 585 - { .offset = 0x1F0000, .erasesize = 0x08000, .numblocks = 1 }, 586 - { .offset = 0x1F8000, .erasesize = 0x02000, .numblocks = 2 }, 587 - { .offset = 0x1FC000, .erasesize = 0x04000, .numblocks = 1 } 588 - } 589 - }, { 590 - .mfr_id = MANUFACTURER_ST, 591 - .dev_id = M29W160DB, 592 - .name = "ST M29W160DB", 593 - .size = 0x00200000, 594 - .numeraseregions = 4, 595 - .regions = { 596 - { .offset = 0x000000, .erasesize = 0x04000, .numblocks = 1 }, 597 - { .offset = 0x004000, .erasesize = 0x02000, .numblocks = 2 }, 598 - { .offset = 0x008000, .erasesize = 0x08000, .numblocks = 1 }, 599 - { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 } 600 - } 601 - }, { 602 - .mfr_id = MANUFACTURER_AMD, 603 - .dev_id = AM29BDS323D, 604 - .name = "AMD AM29BDS323D", 605 - .size = 0x00400000, 606 - .numeraseregions = 3, 607 - .regions = { 608 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 48 }, 609 - { .offset = 0x300000, .erasesize = 0x10000, .numblocks = 15 }, 610 - { .offset = 0x3f0000, .erasesize = 0x02000, .numblocks = 8 }, 611 - } 612 - }, { 613 - .mfr_id = MANUFACTURER_ATMEL, 614 - .dev_id = AT49xV16x, 615 - .name = "Atmel AT49xV16x", 616 - .size = 0x00200000, 617 - .numeraseregions = 2, 618 - .regions = { 619 - { .offset = 0x000000, .erasesize = 0x02000, .numblocks = 8 }, 620 - { .offset = 0x010000, .erasesize = 0x10000, .numblocks = 31 } 621 - } 622 - }, { 623 - .mfr_id = MANUFACTURER_ATMEL, 624 - .dev_id = AT49xV16xT, 625 - .name = "Atmel AT49xV16xT", 626 - .size = 0x00200000, 627 - .numeraseregions = 2, 628 - .regions = { 629 - { .offset = 0x000000, .erasesize = 0x10000, .numblocks = 31 }, 630 - { .offset = 0x1F0000, .erasesize = 0x02000, .numblocks = 8 } 631 - } 632 - } 633 - }; 634 - 635 - struct mtd_info *mtd; 636 - struct flchip chips[MAX_AMD_CHIPS]; 637 - int table_pos[MAX_AMD_CHIPS]; 638 - struct amd_flash_private temp; 639 - struct amd_flash_private *private; 640 - u_long size; 641 - unsigned long base; 642 - int i; 643 - int reg_idx; 644 - int offset; 645 - 646 - mtd = kzalloc(sizeof(*mtd), GFP_KERNEL); 647 - if (!mtd) { 648 - printk(KERN_WARNING 649 - "%s: kmalloc failed for info structure\n", map->name); 650 - return NULL; 651 - } 652 - mtd->priv = map; 653 - 654 - memset(&temp, 0, sizeof(temp)); 655 - 656 - printk("%s: Probing for AMD compatible flash...\n", map->name); 657 - 658 - if ((table_pos[0] = probe_new_chip(mtd, 0, NULL, &temp, table, 659 - ARRAY_SIZE(table))) 660 - == -1) { 661 - printk(KERN_WARNING 662 - "%s: Found no AMD compatible device at location zero\n", 663 - map->name); 664 - kfree(mtd); 665 - 666 - return NULL; 667 - } 668 - 669 - chips[0].start = 0; 670 - chips[0].state = FL_READY; 671 - chips[0].mutex = &chips[0]._spinlock; 672 - temp.numchips = 1; 673 - for (size = mtd->size; size > 1; size >>= 1) { 674 - temp.chipshift++; 675 - } 676 - switch (temp.interleave) { 677 - case 2: 678 - temp.chipshift += 1; 679 - break; 680 - case 4: 681 - temp.chipshift += 2; 682 - break; 683 - } 684 - 685 - /* Find out if there are any more chips in the map. */ 686 - for (base = (1 << temp.chipshift); 687 - base < map->size; 688 - base += (1 << temp.chipshift)) { 689 - int numchips = temp.numchips; 690 - table_pos[numchips] = probe_new_chip(mtd, base, chips, 691 - &temp, table, ARRAY_SIZE(table)); 692 - } 693 - 694 - mtd->eraseregions = kmalloc(sizeof(struct mtd_erase_region_info) * 695 - mtd->numeraseregions, GFP_KERNEL); 696 - if (!mtd->eraseregions) { 697 - printk(KERN_WARNING "%s: Failed to allocate " 698 - "memory for MTD erase region info\n", map->name); 699 - kfree(mtd); 700 - map->fldrv_priv = NULL; 701 - return NULL; 702 - } 703 - 704 - reg_idx = 0; 705 - offset = 0; 706 - for (i = 0; i < temp.numchips; i++) { 707 - int dev_size; 708 - int j; 709 - 710 - dev_size = 0; 711 - for (j = 0; j < table[table_pos[i]].numeraseregions; j++) { 712 - mtd->eraseregions[reg_idx].offset = offset + 713 - (table[table_pos[i]].regions[j].offset * 714 - temp.interleave); 715 - mtd->eraseregions[reg_idx].erasesize = 716 - table[table_pos[i]].regions[j].erasesize * 717 - temp.interleave; 718 - mtd->eraseregions[reg_idx].numblocks = 719 - table[table_pos[i]].regions[j].numblocks; 720 - if (mtd->erasesize < 721 - mtd->eraseregions[reg_idx].erasesize) { 722 - mtd->erasesize = 723 - mtd->eraseregions[reg_idx].erasesize; 724 - } 725 - dev_size += mtd->eraseregions[reg_idx].erasesize * 726 - mtd->eraseregions[reg_idx].numblocks; 727 - reg_idx++; 728 - } 729 - offset += dev_size; 730 - } 731 - mtd->type = MTD_NORFLASH; 732 - mtd->writesize = 1; 733 - mtd->flags = MTD_CAP_NORFLASH; 734 - mtd->name = map->name; 735 - mtd->erase = amd_flash_erase; 736 - mtd->read = amd_flash_read; 737 - mtd->write = amd_flash_write; 738 - mtd->sync = amd_flash_sync; 739 - mtd->suspend = amd_flash_suspend; 740 - mtd->resume = amd_flash_resume; 741 - mtd->lock = amd_flash_lock; 742 - mtd->unlock = amd_flash_unlock; 743 - 744 - private = kmalloc(sizeof(*private) + (sizeof(struct flchip) * 745 - temp.numchips), GFP_KERNEL); 746 - if (!private) { 747 - printk(KERN_WARNING 748 - "%s: kmalloc failed for private structure\n", map->name); 749 - kfree(mtd); 750 - map->fldrv_priv = NULL; 751 - return NULL; 752 - } 753 - memcpy(private, &temp, sizeof(temp)); 754 - memcpy(private->chips, chips, 755 - sizeof(struct flchip) * private->numchips); 756 - for (i = 0; i < private->numchips; i++) { 757 - init_waitqueue_head(&private->chips[i].wq); 758 - spin_lock_init(&private->chips[i]._spinlock); 759 - } 760 - 761 - map->fldrv_priv = private; 762 - 763 - map->fldrv = &amd_flash_chipdrv; 764 - 765 - __module_get(THIS_MODULE); 766 - return mtd; 767 - } 768 - 769 - 770 - 771 - static inline int read_one_chip(struct map_info *map, struct flchip *chip, 772 - loff_t adr, size_t len, u_char *buf) 773 - { 774 - DECLARE_WAITQUEUE(wait, current); 775 - unsigned long timeo = jiffies + HZ; 776 - 777 - retry: 778 - spin_lock_bh(chip->mutex); 779 - 780 - if (chip->state != FL_READY){ 781 - printk(KERN_INFO "%s: waiting for chip to read, state = %d\n", 782 - map->name, chip->state); 783 - set_current_state(TASK_UNINTERRUPTIBLE); 784 - add_wait_queue(&chip->wq, &wait); 785 - 786 - spin_unlock_bh(chip->mutex); 787 - 788 - schedule(); 789 - remove_wait_queue(&chip->wq, &wait); 790 - 791 - if(signal_pending(current)) { 792 - return -EINTR; 793 - } 794 - 795 - timeo = jiffies + HZ; 796 - 797 - goto retry; 798 - } 799 - 800 - adr += chip->start; 801 - 802 - chip->state = FL_READY; 803 - 804 - map_copy_from(map, buf, adr, len); 805 - 806 - wake_up(&chip->wq); 807 - spin_unlock_bh(chip->mutex); 808 - 809 - return 0; 810 - } 811 - 812 - 813 - 814 - static int amd_flash_read(struct mtd_info *mtd, loff_t from, size_t len, 815 - size_t *retlen, u_char *buf) 816 - { 817 - struct map_info *map = mtd->priv; 818 - struct amd_flash_private *private = map->fldrv_priv; 819 - unsigned long ofs; 820 - int chipnum; 821 - int ret = 0; 822 - 823 - if ((from + len) > mtd->size) { 824 - printk(KERN_WARNING "%s: read request past end of device " 825 - "(0x%lx)\n", map->name, (unsigned long)from + len); 826 - 827 - return -EINVAL; 828 - } 829 - 830 - /* Offset within the first chip that the first read should start. */ 831 - chipnum = (from >> private->chipshift); 832 - ofs = from - (chipnum << private->chipshift); 833 - 834 - *retlen = 0; 835 - 836 - while (len) { 837 - unsigned long this_len; 838 - 839 - if (chipnum >= private->numchips) { 840 - break; 841 - } 842 - 843 - if ((len + ofs - 1) >> private->chipshift) { 844 - this_len = (1 << private->chipshift) - ofs; 845 - } else { 846 - this_len = len; 847 - } 848 - 849 - ret = read_one_chip(map, &private->chips[chipnum], ofs, 850 - this_len, buf); 851 - if (ret) { 852 - break; 853 - } 854 - 855 - *retlen += this_len; 856 - len -= this_len; 857 - buf += this_len; 858 - 859 - ofs = 0; 860 - chipnum++; 861 - } 862 - 863 - return ret; 864 - } 865 - 866 - 867 - 868 - static int write_one_word(struct map_info *map, struct flchip *chip, 869 - unsigned long adr, __u32 datum) 870 - { 871 - unsigned long timeo = jiffies + HZ; 872 - struct amd_flash_private *private = map->fldrv_priv; 873 - DECLARE_WAITQUEUE(wait, current); 874 - int ret = 0; 875 - int times_left; 876 - 877 - retry: 878 - spin_lock_bh(chip->mutex); 879 - 880 - if (chip->state != FL_READY){ 881 - printk("%s: waiting for chip to write, state = %d\n", 882 - map->name, chip->state); 883 - set_current_state(TASK_UNINTERRUPTIBLE); 884 - add_wait_queue(&chip->wq, &wait); 885 - 886 - spin_unlock_bh(chip->mutex); 887 - 888 - schedule(); 889 - remove_wait_queue(&chip->wq, &wait); 890 - printk(KERN_INFO "%s: woke up to write\n", map->name); 891 - if(signal_pending(current)) 892 - return -EINTR; 893 - 894 - timeo = jiffies + HZ; 895 - 896 - goto retry; 897 - } 898 - 899 - chip->state = FL_WRITING; 900 - 901 - adr += chip->start; 902 - ENABLE_VPP(map); 903 - send_cmd(map, chip->start, CMD_PROGRAM_UNLOCK_DATA); 904 - wide_write(map, datum, adr); 905 - 906 - times_left = 500000; 907 - while (times_left-- && flash_is_busy(map, adr, private->interleave)) { 908 - if (need_resched()) { 909 - spin_unlock_bh(chip->mutex); 910 - schedule(); 911 - spin_lock_bh(chip->mutex); 912 - } 913 - } 914 - 915 - if (!times_left) { 916 - printk(KERN_WARNING "%s: write to 0x%lx timed out!\n", 917 - map->name, adr); 918 - ret = -EIO; 919 - } else { 920 - __u32 verify; 921 - if ((verify = wide_read(map, adr)) != datum) { 922 - printk(KERN_WARNING "%s: write to 0x%lx failed. " 923 - "datum = %x, verify = %x\n", 924 - map->name, adr, datum, verify); 925 - ret = -EIO; 926 - } 927 - } 928 - 929 - DISABLE_VPP(map); 930 - chip->state = FL_READY; 931 - wake_up(&chip->wq); 932 - spin_unlock_bh(chip->mutex); 933 - 934 - return ret; 935 - } 936 - 937 - 938 - 939 - static int amd_flash_write(struct mtd_info *mtd, loff_t to , size_t len, 940 - size_t *retlen, const u_char *buf) 941 - { 942 - struct map_info *map = mtd->priv; 943 - struct amd_flash_private *private = map->fldrv_priv; 944 - int ret = 0; 945 - int chipnum; 946 - unsigned long ofs; 947 - unsigned long chipstart; 948 - 949 - *retlen = 0; 950 - if (!len) { 951 - return 0; 952 - } 953 - 954 - chipnum = to >> private->chipshift; 955 - ofs = to - (chipnum << private->chipshift); 956 - chipstart = private->chips[chipnum].start; 957 - 958 - /* If it's not bus-aligned, do the first byte write. */ 959 - if (ofs & (map->buswidth - 1)) { 960 - unsigned long bus_ofs = ofs & ~(map->buswidth - 1); 961 - int i = ofs - bus_ofs; 962 - int n = 0; 963 - u_char tmp_buf[4]; 964 - __u32 datum; 965 - 966 - map_copy_from(map, tmp_buf, 967 - bus_ofs + private->chips[chipnum].start, 968 - map->buswidth); 969 - while (len && i < map->buswidth) 970 - tmp_buf[i++] = buf[n++], len--; 971 - 972 - if (map->buswidth == 2) { 973 - datum = *(__u16*)tmp_buf; 974 - } else if (map->buswidth == 4) { 975 - datum = *(__u32*)tmp_buf; 976 - } else { 977 - return -EINVAL; /* should never happen, but be safe */ 978 - } 979 - 980 - ret = write_one_word(map, &private->chips[chipnum], bus_ofs, 981 - datum); 982 - if (ret) { 983 - return ret; 984 - } 985 - 986 - ofs += n; 987 - buf += n; 988 - (*retlen) += n; 989 - 990 - if (ofs >> private->chipshift) { 991 - chipnum++; 992 - ofs = 0; 993 - if (chipnum == private->numchips) { 994 - return 0; 995 - } 996 - } 997 - } 998 - 999 - /* We are now aligned, write as much as possible. */ 1000 - while(len >= map->buswidth) { 1001 - __u32 datum; 1002 - 1003 - if (map->buswidth == 1) { 1004 - datum = *(__u8*)buf; 1005 - } else if (map->buswidth == 2) { 1006 - datum = *(__u16*)buf; 1007 - } else if (map->buswidth == 4) { 1008 - datum = *(__u32*)buf; 1009 - } else { 1010 - return -EINVAL; 1011 - } 1012 - 1013 - ret = write_one_word(map, &private->chips[chipnum], ofs, datum); 1014 - 1015 - if (ret) { 1016 - return ret; 1017 - } 1018 - 1019 - ofs += map->buswidth; 1020 - buf += map->buswidth; 1021 - (*retlen) += map->buswidth; 1022 - len -= map->buswidth; 1023 - 1024 - if (ofs >> private->chipshift) { 1025 - chipnum++; 1026 - ofs = 0; 1027 - if (chipnum == private->numchips) { 1028 - return 0; 1029 - } 1030 - chipstart = private->chips[chipnum].start; 1031 - } 1032 - } 1033 - 1034 - if (len & (map->buswidth - 1)) { 1035 - int i = 0, n = 0; 1036 - u_char tmp_buf[2]; 1037 - __u32 datum; 1038 - 1039 - map_copy_from(map, tmp_buf, 1040 - ofs + private->chips[chipnum].start, 1041 - map->buswidth); 1042 - while (len--) { 1043 - tmp_buf[i++] = buf[n++]; 1044 - } 1045 - 1046 - if (map->buswidth == 2) { 1047 - datum = *(__u16*)tmp_buf; 1048 - } else if (map->buswidth == 4) { 1049 - datum = *(__u32*)tmp_buf; 1050 - } else { 1051 - return -EINVAL; /* should never happen, but be safe */ 1052 - } 1053 - 1054 - ret = write_one_word(map, &private->chips[chipnum], ofs, datum); 1055 - 1056 - if (ret) { 1057 - return ret; 1058 - } 1059 - 1060 - (*retlen) += n; 1061 - } 1062 - 1063 - return 0; 1064 - } 1065 - 1066 - 1067 - 1068 - static inline int erase_one_block(struct map_info *map, struct flchip *chip, 1069 - unsigned long adr, u_long size) 1070 - { 1071 - unsigned long timeo = jiffies + HZ; 1072 - struct amd_flash_private *private = map->fldrv_priv; 1073 - DECLARE_WAITQUEUE(wait, current); 1074 - 1075 - retry: 1076 - spin_lock_bh(chip->mutex); 1077 - 1078 - if (chip->state != FL_READY){ 1079 - set_current_state(TASK_UNINTERRUPTIBLE); 1080 - add_wait_queue(&chip->wq, &wait); 1081 - 1082 - spin_unlock_bh(chip->mutex); 1083 - 1084 - schedule(); 1085 - remove_wait_queue(&chip->wq, &wait); 1086 - 1087 - if (signal_pending(current)) { 1088 - return -EINTR; 1089 - } 1090 - 1091 - timeo = jiffies + HZ; 1092 - 1093 - goto retry; 1094 - } 1095 - 1096 - chip->state = FL_ERASING; 1097 - 1098 - adr += chip->start; 1099 - ENABLE_VPP(map); 1100 - send_cmd(map, chip->start, CMD_SECTOR_ERASE_UNLOCK_DATA); 1101 - send_cmd_to_addr(map, chip->start, CMD_SECTOR_ERASE_UNLOCK_DATA_2, adr); 1102 - 1103 - timeo = jiffies + (HZ * 20); 1104 - 1105 - spin_unlock_bh(chip->mutex); 1106 - msleep(1000); 1107 - spin_lock_bh(chip->mutex); 1108 - 1109 - while (flash_is_busy(map, adr, private->interleave)) { 1110 - 1111 - if (chip->state != FL_ERASING) { 1112 - /* Someone's suspended the erase. Sleep */ 1113 - set_current_state(TASK_UNINTERRUPTIBLE); 1114 - add_wait_queue(&chip->wq, &wait); 1115 - 1116 - spin_unlock_bh(chip->mutex); 1117 - printk(KERN_INFO "%s: erase suspended. Sleeping\n", 1118 - map->name); 1119 - schedule(); 1120 - remove_wait_queue(&chip->wq, &wait); 1121 - 1122 - if (signal_pending(current)) { 1123 - return -EINTR; 1124 - } 1125 - 1126 - timeo = jiffies + (HZ*2); /* FIXME */ 1127 - spin_lock_bh(chip->mutex); 1128 - continue; 1129 - } 1130 - 1131 - /* OK Still waiting */ 1132 - if (time_after(jiffies, timeo)) { 1133 - chip->state = FL_READY; 1134 - spin_unlock_bh(chip->mutex); 1135 - printk(KERN_WARNING "%s: waiting for erase to complete " 1136 - "timed out.\n", map->name); 1137 - DISABLE_VPP(map); 1138 - 1139 - return -EIO; 1140 - } 1141 - 1142 - /* Latency issues. Drop the lock, wait a while and retry */ 1143 - spin_unlock_bh(chip->mutex); 1144 - 1145 - if (need_resched()) 1146 - schedule(); 1147 - else 1148 - udelay(1); 1149 - 1150 - spin_lock_bh(chip->mutex); 1151 - } 1152 - 1153 - /* Verify every single word */ 1154 - { 1155 - int address; 1156 - int error = 0; 1157 - __u8 verify; 1158 - 1159 - for (address = adr; address < (adr + size); address++) { 1160 - if ((verify = map_read8(map, address)) != 0xFF) { 1161 - error = 1; 1162 - break; 1163 - } 1164 - } 1165 - if (error) { 1166 - chip->state = FL_READY; 1167 - spin_unlock_bh(chip->mutex); 1168 - printk(KERN_WARNING 1169 - "%s: verify error at 0x%x, size %ld.\n", 1170 - map->name, address, size); 1171 - DISABLE_VPP(map); 1172 - 1173 - return -EIO; 1174 - } 1175 - } 1176 - 1177 - DISABLE_VPP(map); 1178 - chip->state = FL_READY; 1179 - wake_up(&chip->wq); 1180 - spin_unlock_bh(chip->mutex); 1181 - 1182 - return 0; 1183 - } 1184 - 1185 - 1186 - 1187 - static int amd_flash_erase(struct mtd_info *mtd, struct erase_info *instr) 1188 - { 1189 - struct map_info *map = mtd->priv; 1190 - struct amd_flash_private *private = map->fldrv_priv; 1191 - unsigned long adr, len; 1192 - int chipnum; 1193 - int ret = 0; 1194 - int i; 1195 - int first; 1196 - struct mtd_erase_region_info *regions = mtd->eraseregions; 1197 - 1198 - if (instr->addr > mtd->size) { 1199 - return -EINVAL; 1200 - } 1201 - 1202 - if ((instr->len + instr->addr) > mtd->size) { 1203 - return -EINVAL; 1204 - } 1205 - 1206 - /* Check that both start and end of the requested erase are 1207 - * aligned with the erasesize at the appropriate addresses. 1208 - */ 1209 - 1210 - i = 0; 1211 - 1212 - /* Skip all erase regions which are ended before the start of 1213 - the requested erase. Actually, to save on the calculations, 1214 - we skip to the first erase region which starts after the 1215 - start of the requested erase, and then go back one. 1216 - */ 1217 - 1218 - while ((i < mtd->numeraseregions) && 1219 - (instr->addr >= regions[i].offset)) { 1220 - i++; 1221 - } 1222 - i--; 1223 - 1224 - /* OK, now i is pointing at the erase region in which this 1225 - * erase request starts. Check the start of the requested 1226 - * erase range is aligned with the erase size which is in 1227 - * effect here. 1228 - */ 1229 - 1230 - if (instr->addr & (regions[i].erasesize-1)) { 1231 - return -EINVAL; 1232 - } 1233 - 1234 - /* Remember the erase region we start on. */ 1235 - 1236 - first = i; 1237 - 1238 - /* Next, check that the end of the requested erase is aligned 1239 - * with the erase region at that address. 1240 - */ 1241 - 1242 - while ((i < mtd->numeraseregions) && 1243 - ((instr->addr + instr->len) >= regions[i].offset)) { 1244 - i++; 1245 - } 1246 - 1247 - /* As before, drop back one to point at the region in which 1248 - * the address actually falls. 1249 - */ 1250 - 1251 - i--; 1252 - 1253 - if ((instr->addr + instr->len) & (regions[i].erasesize-1)) { 1254 - return -EINVAL; 1255 - } 1256 - 1257 - chipnum = instr->addr >> private->chipshift; 1258 - adr = instr->addr - (chipnum << private->chipshift); 1259 - len = instr->len; 1260 - 1261 - i = first; 1262 - 1263 - while (len) { 1264 - ret = erase_one_block(map, &private->chips[chipnum], adr, 1265 - regions[i].erasesize); 1266 - 1267 - if (ret) { 1268 - return ret; 1269 - } 1270 - 1271 - adr += regions[i].erasesize; 1272 - len -= regions[i].erasesize; 1273 - 1274 - if ((adr % (1 << private->chipshift)) == 1275 - ((regions[i].offset + (regions[i].erasesize * 1276 - regions[i].numblocks)) 1277 - % (1 << private->chipshift))) { 1278 - i++; 1279 - } 1280 - 1281 - if (adr >> private->chipshift) { 1282 - adr = 0; 1283 - chipnum++; 1284 - if (chipnum >= private->numchips) { 1285 - break; 1286 - } 1287 - } 1288 - } 1289 - 1290 - instr->state = MTD_ERASE_DONE; 1291 - mtd_erase_callback(instr); 1292 - 1293 - return 0; 1294 - } 1295 - 1296 - 1297 - 1298 - static void amd_flash_sync(struct mtd_info *mtd) 1299 - { 1300 - struct map_info *map = mtd->priv; 1301 - struct amd_flash_private *private = map->fldrv_priv; 1302 - int i; 1303 - struct flchip *chip; 1304 - int ret = 0; 1305 - DECLARE_WAITQUEUE(wait, current); 1306 - 1307 - for (i = 0; !ret && (i < private->numchips); i++) { 1308 - chip = &private->chips[i]; 1309 - 1310 - retry: 1311 - spin_lock_bh(chip->mutex); 1312 - 1313 - switch(chip->state) { 1314 - case FL_READY: 1315 - case FL_STATUS: 1316 - case FL_CFI_QUERY: 1317 - case FL_JEDEC_QUERY: 1318 - chip->oldstate = chip->state; 1319 - chip->state = FL_SYNCING; 1320 - /* No need to wake_up() on this state change - 1321 - * as the whole point is that nobody can do anything 1322 - * with the chip now anyway. 1323 - */ 1324 - case FL_SYNCING: 1325 - spin_unlock_bh(chip->mutex); 1326 - break; 1327 - 1328 - default: 1329 - /* Not an idle state */ 1330 - add_wait_queue(&chip->wq, &wait); 1331 - 1332 - spin_unlock_bh(chip->mutex); 1333 - 1334 - schedule(); 1335 - 1336 - remove_wait_queue(&chip->wq, &wait); 1337 - 1338 - goto retry; 1339 - } 1340 - } 1341 - 1342 - /* Unlock the chips again */ 1343 - for (i--; i >= 0; i--) { 1344 - chip = &private->chips[i]; 1345 - 1346 - spin_lock_bh(chip->mutex); 1347 - 1348 - if (chip->state == FL_SYNCING) { 1349 - chip->state = chip->oldstate; 1350 - wake_up(&chip->wq); 1351 - } 1352 - spin_unlock_bh(chip->mutex); 1353 - } 1354 - } 1355 - 1356 - 1357 - 1358 - static int amd_flash_suspend(struct mtd_info *mtd) 1359 - { 1360 - printk("amd_flash_suspend(): not implemented!\n"); 1361 - return -EINVAL; 1362 - } 1363 - 1364 - 1365 - 1366 - static void amd_flash_resume(struct mtd_info *mtd) 1367 - { 1368 - printk("amd_flash_resume(): not implemented!\n"); 1369 - } 1370 - 1371 - 1372 - 1373 - static void amd_flash_destroy(struct mtd_info *mtd) 1374 - { 1375 - struct map_info *map = mtd->priv; 1376 - struct amd_flash_private *private = map->fldrv_priv; 1377 - kfree(private); 1378 - } 1379 - 1380 - int __init amd_flash_init(void) 1381 - { 1382 - register_mtd_chip_driver(&amd_flash_chipdrv); 1383 - return 0; 1384 - } 1385 - 1386 - void __exit amd_flash_exit(void) 1387 - { 1388 - unregister_mtd_chip_driver(&amd_flash_chipdrv); 1389 - } 1390 - 1391 - module_init(amd_flash_init); 1392 - module_exit(amd_flash_exit); 1393 - 1394 - MODULE_LICENSE("GPL"); 1395 - MODULE_AUTHOR("Jonas Holmberg <jonas.holmberg@axis.com>"); 1396 - MODULE_DESCRIPTION("Old MTD chip driver for AMD flash chips");
-935
drivers/mtd/chips/jedec.c
··· 1 - 2 - /* JEDEC Flash Interface. 3 - * This is an older type of interface for self programming flash. It is 4 - * commonly use in older AMD chips and is obsolete compared with CFI. 5 - * It is called JEDEC because the JEDEC association distributes the ID codes 6 - * for the chips. 7 - * 8 - * See the AMD flash databook for information on how to operate the interface. 9 - * 10 - * This code does not support anything wider than 8 bit flash chips, I am 11 - * not going to guess how to send commands to them, plus I expect they will 12 - * all speak CFI.. 13 - * 14 - * $Id: jedec.c,v 1.22 2005/01/05 18:05:11 dwmw2 Exp $ 15 - */ 16 - 17 - #include <linux/init.h> 18 - #include <linux/module.h> 19 - #include <linux/kernel.h> 20 - #include <linux/slab.h> 21 - #include <linux/mtd/jedec.h> 22 - #include <linux/mtd/map.h> 23 - #include <linux/mtd/mtd.h> 24 - #include <linux/mtd/compatmac.h> 25 - 26 - static struct mtd_info *jedec_probe(struct map_info *); 27 - static int jedec_probe8(struct map_info *map,unsigned long base, 28 - struct jedec_private *priv); 29 - static int jedec_probe16(struct map_info *map,unsigned long base, 30 - struct jedec_private *priv); 31 - static int jedec_probe32(struct map_info *map,unsigned long base, 32 - struct jedec_private *priv); 33 - static void jedec_flash_chip_scan(struct jedec_private *priv,unsigned long start, 34 - unsigned long len); 35 - static int flash_erase(struct mtd_info *mtd, struct erase_info *instr); 36 - static int flash_write(struct mtd_info *mtd, loff_t start, size_t len, 37 - size_t *retlen, const u_char *buf); 38 - 39 - static unsigned long my_bank_size; 40 - 41 - /* Listing of parts and sizes. We need this table to learn the sector 42 - size of the chip and the total length */ 43 - static const struct JEDECTable JEDEC_table[] = { 44 - { 45 - .jedec = 0x013D, 46 - .name = "AMD Am29F017D", 47 - .size = 2*1024*1024, 48 - .sectorsize = 64*1024, 49 - .capabilities = MTD_CAP_NORFLASH 50 - }, 51 - { 52 - .jedec = 0x01AD, 53 - .name = "AMD Am29F016", 54 - .size = 2*1024*1024, 55 - .sectorsize = 64*1024, 56 - .capabilities = MTD_CAP_NORFLASH 57 - }, 58 - { 59 - .jedec = 0x01D5, 60 - .name = "AMD Am29F080", 61 - .size = 1*1024*1024, 62 - .sectorsize = 64*1024, 63 - .capabilities = MTD_CAP_NORFLASH 64 - }, 65 - { 66 - .jedec = 0x01A4, 67 - .name = "AMD Am29F040", 68 - .size = 512*1024, 69 - .sectorsize = 64*1024, 70 - .capabilities = MTD_CAP_NORFLASH 71 - }, 72 - { 73 - .jedec = 0x20E3, 74 - .name = "AMD Am29W040B", 75 - .size = 512*1024, 76 - .sectorsize = 64*1024, 77 - .capabilities = MTD_CAP_NORFLASH 78 - }, 79 - { 80 - .jedec = 0xC2AD, 81 - .name = "Macronix MX29F016", 82 - .size = 2*1024*1024, 83 - .sectorsize = 64*1024, 84 - .capabilities = MTD_CAP_NORFLASH 85 - }, 86 - { .jedec = 0x0 } 87 - }; 88 - 89 - static const struct JEDECTable *jedec_idtoinf(__u8 mfr,__u8 id); 90 - static void jedec_sync(struct mtd_info *mtd) {}; 91 - static int jedec_read(struct mtd_info *mtd, loff_t from, size_t len, 92 - size_t *retlen, u_char *buf); 93 - static int jedec_read_banked(struct mtd_info *mtd, loff_t from, size_t len, 94 - size_t *retlen, u_char *buf); 95 - 96 - static struct mtd_info *jedec_probe(struct map_info *map); 97 - 98 - 99 - 100 - static struct mtd_chip_driver jedec_chipdrv = { 101 - .probe = jedec_probe, 102 - .name = "jedec", 103 - .module = THIS_MODULE 104 - }; 105 - 106 - /* Probe entry point */ 107 - 108 - static struct mtd_info *jedec_probe(struct map_info *map) 109 - { 110 - struct mtd_info *MTD; 111 - struct jedec_private *priv; 112 - unsigned long Base; 113 - unsigned long SectorSize; 114 - unsigned count; 115 - unsigned I,Uniq; 116 - char Part[200]; 117 - memset(&priv,0,sizeof(priv)); 118 - 119 - MTD = kzalloc(sizeof(struct mtd_info) + sizeof(struct jedec_private), GFP_KERNEL); 120 - if (!MTD) 121 - return NULL; 122 - 123 - priv = (struct jedec_private *)&MTD[1]; 124 - 125 - my_bank_size = map->size; 126 - 127 - if (map->size/my_bank_size > MAX_JEDEC_CHIPS) 128 - { 129 - printk("mtd: Increase MAX_JEDEC_CHIPS, too many banks.\n"); 130 - kfree(MTD); 131 - return NULL; 132 - } 133 - 134 - for (Base = 0; Base < map->size; Base += my_bank_size) 135 - { 136 - // Perhaps zero could designate all tests? 137 - if (map->buswidth == 0) 138 - map->buswidth = 1; 139 - 140 - if (map->buswidth == 1){ 141 - if (jedec_probe8(map,Base,priv) == 0) { 142 - printk("did recognize jedec chip\n"); 143 - kfree(MTD); 144 - return NULL; 145 - } 146 - } 147 - if (map->buswidth == 2) 148 - jedec_probe16(map,Base,priv); 149 - if (map->buswidth == 4) 150 - jedec_probe32(map,Base,priv); 151 - } 152 - 153 - // Get the biggest sector size 154 - SectorSize = 0; 155 - for (I = 0; priv->chips[I].jedec != 0 && I < MAX_JEDEC_CHIPS; I++) 156 - { 157 - // printk("priv->chips[%d].jedec is %x\n",I,priv->chips[I].jedec); 158 - // printk("priv->chips[%d].sectorsize is %lx\n",I,priv->chips[I].sectorsize); 159 - if (priv->chips[I].sectorsize > SectorSize) 160 - SectorSize = priv->chips[I].sectorsize; 161 - } 162 - 163 - // Quickly ensure that the other sector sizes are factors of the largest 164 - for (I = 0; priv->chips[I].jedec != 0 && I < MAX_JEDEC_CHIPS; I++) 165 - { 166 - if ((SectorSize/priv->chips[I].sectorsize)*priv->chips[I].sectorsize != SectorSize) 167 - { 168 - printk("mtd: Failed. Device has incompatible mixed sector sizes\n"); 169 - kfree(MTD); 170 - return NULL; 171 - } 172 - } 173 - 174 - /* Generate a part name that includes the number of different chips and 175 - other configuration information */ 176 - count = 1; 177 - strlcpy(Part,map->name,sizeof(Part)-10); 178 - strcat(Part," "); 179 - Uniq = 0; 180 - for (I = 0; priv->chips[I].jedec != 0 && I < MAX_JEDEC_CHIPS; I++) 181 - { 182 - const struct JEDECTable *JEDEC; 183 - 184 - if (priv->chips[I+1].jedec == priv->chips[I].jedec) 185 - { 186 - count++; 187 - continue; 188 - } 189 - 190 - // Locate the chip in the jedec table 191 - JEDEC = jedec_idtoinf(priv->chips[I].jedec >> 8,priv->chips[I].jedec); 192 - if (JEDEC == 0) 193 - { 194 - printk("mtd: Internal Error, JEDEC not set\n"); 195 - kfree(MTD); 196 - return NULL; 197 - } 198 - 199 - if (Uniq != 0) 200 - strcat(Part,","); 201 - Uniq++; 202 - 203 - if (count != 1) 204 - sprintf(Part+strlen(Part),"%x*[%s]",count,JEDEC->name); 205 - else 206 - sprintf(Part+strlen(Part),"%s",JEDEC->name); 207 - if (strlen(Part) > sizeof(Part)*2/3) 208 - break; 209 - count = 1; 210 - } 211 - 212 - /* Determine if the chips are organized in a linear fashion, or if there 213 - are empty banks. Note, the last bank does not count here, only the 214 - first banks are important. Holes on non-bank boundaries can not exist 215 - due to the way the detection algorithm works. */ 216 - if (priv->size < my_bank_size) 217 - my_bank_size = priv->size; 218 - priv->is_banked = 0; 219 - //printk("priv->size is %x, my_bank_size is %x\n",priv->size,my_bank_size); 220 - //printk("priv->bank_fill[0] is %x\n",priv->bank_fill[0]); 221 - if (!priv->size) { 222 - printk("priv->size is zero\n"); 223 - kfree(MTD); 224 - return NULL; 225 - } 226 - if (priv->size/my_bank_size) { 227 - if (priv->size/my_bank_size == 1) { 228 - priv->size = my_bank_size; 229 - } 230 - else { 231 - for (I = 0; I != priv->size/my_bank_size - 1; I++) 232 - { 233 - if (priv->bank_fill[I] != my_bank_size) 234 - priv->is_banked = 1; 235 - 236 - /* This even could be eliminated, but new de-optimized read/write 237 - functions have to be written */ 238 - printk("priv->bank_fill[%d] is %lx, priv->bank_fill[0] is %lx\n",I,priv->bank_fill[I],priv->bank_fill[0]); 239 - if (priv->bank_fill[I] != priv->bank_fill[0]) 240 - { 241 - printk("mtd: Failed. Cannot handle unsymmetric banking\n"); 242 - kfree(MTD); 243 - return NULL; 244 - } 245 - } 246 - } 247 - } 248 - if (priv->is_banked == 1) 249 - strcat(Part,", banked"); 250 - 251 - // printk("Part: '%s'\n",Part); 252 - 253 - memset(MTD,0,sizeof(*MTD)); 254 - // strlcpy(MTD->name,Part,sizeof(MTD->name)); 255 - MTD->name = map->name; 256 - MTD->type = MTD_NORFLASH; 257 - MTD->flags = MTD_CAP_NORFLASH; 258 - MTD->writesize = 1; 259 - MTD->erasesize = SectorSize*(map->buswidth); 260 - // printk("MTD->erasesize is %x\n",(unsigned int)MTD->erasesize); 261 - MTD->size = priv->size; 262 - // printk("MTD->size is %x\n",(unsigned int)MTD->size); 263 - //MTD->module = THIS_MODULE; // ? Maybe this should be the low level module? 264 - MTD->erase = flash_erase; 265 - if (priv->is_banked == 1) 266 - MTD->read = jedec_read_banked; 267 - else 268 - MTD->read = jedec_read; 269 - MTD->write = flash_write; 270 - MTD->sync = jedec_sync; 271 - MTD->priv = map; 272 - map->fldrv_priv = priv; 273 - map->fldrv = &jedec_chipdrv; 274 - __module_get(THIS_MODULE); 275 - return MTD; 276 - } 277 - 278 - /* Helper for the JEDEC function, JEDEC numbers all have odd parity */ 279 - static int checkparity(u_char C) 280 - { 281 - u_char parity = 0; 282 - while (C != 0) 283 - { 284 - parity ^= C & 1; 285 - C >>= 1; 286 - } 287 - 288 - return parity == 1; 289 - } 290 - 291 - 292 - /* Take an array of JEDEC numbers that represent interleved flash chips 293 - and process them. Check to make sure they are good JEDEC numbers, look 294 - them up and then add them to the chip list */ 295 - static int handle_jedecs(struct map_info *map,__u8 *Mfg,__u8 *Id,unsigned Count, 296 - unsigned long base,struct jedec_private *priv) 297 - { 298 - unsigned I,J; 299 - unsigned long Size; 300 - unsigned long SectorSize; 301 - const struct JEDECTable *JEDEC; 302 - 303 - // Test #2 JEDEC numbers exhibit odd parity 304 - for (I = 0; I != Count; I++) 305 - { 306 - if (checkparity(Mfg[I]) == 0 || checkparity(Id[I]) == 0) 307 - return 0; 308 - } 309 - 310 - // Finally, just make sure all the chip sizes are the same 311 - JEDEC = jedec_idtoinf(Mfg[0],Id[0]); 312 - 313 - if (JEDEC == 0) 314 - { 315 - printk("mtd: Found JEDEC flash chip, but do not have a table entry for %x:%x\n",Mfg[0],Mfg[1]); 316 - return 0; 317 - } 318 - 319 - Size = JEDEC->size; 320 - SectorSize = JEDEC->sectorsize; 321 - for (I = 0; I != Count; I++) 322 - { 323 - JEDEC = jedec_idtoinf(Mfg[0],Id[0]); 324 - if (JEDEC == 0) 325 - { 326 - printk("mtd: Found JEDEC flash chip, but do not have a table entry for %x:%x\n",Mfg[0],Mfg[1]); 327 - return 0; 328 - } 329 - 330 - if (Size != JEDEC->size || SectorSize != JEDEC->sectorsize) 331 - { 332 - printk("mtd: Failed. Interleved flash does not have matching characteristics\n"); 333 - return 0; 334 - } 335 - } 336 - 337 - // Load the Chips 338 - for (I = 0; I != MAX_JEDEC_CHIPS; I++) 339 - { 340 - if (priv->chips[I].jedec == 0) 341 - break; 342 - } 343 - 344 - if (I + Count > MAX_JEDEC_CHIPS) 345 - { 346 - printk("mtd: Device has too many chips. Increase MAX_JEDEC_CHIPS\n"); 347 - return 0; 348 - } 349 - 350 - // Add them to the table 351 - for (J = 0; J != Count; J++) 352 - { 353 - unsigned long Bank; 354 - 355 - JEDEC = jedec_idtoinf(Mfg[J],Id[J]); 356 - priv->chips[I].jedec = (Mfg[J] << 8) | Id[J]; 357 - priv->chips[I].size = JEDEC->size; 358 - priv->chips[I].sectorsize = JEDEC->sectorsize; 359 - priv->chips[I].base = base + J; 360 - priv->chips[I].datashift = J*8; 361 - priv->chips[I].capabilities = JEDEC->capabilities; 362 - priv->chips[I].offset = priv->size + J; 363 - 364 - // log2 n :| 365 - priv->chips[I].addrshift = 0; 366 - for (Bank = Count; Bank != 1; Bank >>= 1, priv->chips[I].addrshift++); 367 - 368 - // Determine how filled this bank is. 369 - Bank = base & (~(my_bank_size-1)); 370 - if (priv->bank_fill[Bank/my_bank_size] < base + 371 - (JEDEC->size << priv->chips[I].addrshift) - Bank) 372 - priv->bank_fill[Bank/my_bank_size] = base + (JEDEC->size << priv->chips[I].addrshift) - Bank; 373 - I++; 374 - } 375 - 376 - priv->size += priv->chips[I-1].size*Count; 377 - 378 - return priv->chips[I-1].size; 379 - } 380 - 381 - /* Lookup the chip information from the JEDEC ID table. */ 382 - static const struct JEDECTable *jedec_idtoinf(__u8 mfr,__u8 id) 383 - { 384 - __u16 Id = (mfr << 8) | id; 385 - unsigned long I = 0; 386 - for (I = 0; JEDEC_table[I].jedec != 0; I++) 387 - if (JEDEC_table[I].jedec == Id) 388 - return JEDEC_table + I; 389 - return NULL; 390 - } 391 - 392 - // Look for flash using an 8 bit bus interface 393 - static int jedec_probe8(struct map_info *map,unsigned long base, 394 - struct jedec_private *priv) 395 - { 396 - #define flread(x) map_read8(map,base+x) 397 - #define flwrite(v,x) map_write8(map,v,base+x) 398 - 399 - const unsigned long AutoSel1 = 0xAA; 400 - const unsigned long AutoSel2 = 0x55; 401 - const unsigned long AutoSel3 = 0x90; 402 - const unsigned long Reset = 0xF0; 403 - __u32 OldVal; 404 - __u8 Mfg[1]; 405 - __u8 Id[1]; 406 - unsigned I; 407 - unsigned long Size; 408 - 409 - // Wait for any write/erase operation to settle 410 - OldVal = flread(base); 411 - for (I = 0; OldVal != flread(base) && I < 10000; I++) 412 - OldVal = flread(base); 413 - 414 - // Reset the chip 415 - flwrite(Reset,0x555); 416 - 417 - // Send the sequence 418 - flwrite(AutoSel1,0x555); 419 - flwrite(AutoSel2,0x2AA); 420 - flwrite(AutoSel3,0x555); 421 - 422 - // Get the JEDEC numbers 423 - Mfg[0] = flread(0); 424 - Id[0] = flread(1); 425 - // printk("Mfg is %x, Id is %x\n",Mfg[0],Id[0]); 426 - 427 - Size = handle_jedecs(map,Mfg,Id,1,base,priv); 428 - // printk("handle_jedecs Size is %x\n",(unsigned int)Size); 429 - if (Size == 0) 430 - { 431 - flwrite(Reset,0x555); 432 - return 0; 433 - } 434 - 435 - 436 - // Reset. 437 - flwrite(Reset,0x555); 438 - 439 - return 1; 440 - 441 - #undef flread 442 - #undef flwrite 443 - } 444 - 445 - // Look for flash using a 16 bit bus interface (ie 2 8-bit chips) 446 - static int jedec_probe16(struct map_info *map,unsigned long base, 447 - struct jedec_private *priv) 448 - { 449 - return 0; 450 - } 451 - 452 - // Look for flash using a 32 bit bus interface (ie 4 8-bit chips) 453 - static int jedec_probe32(struct map_info *map,unsigned long base, 454 - struct jedec_private *priv) 455 - { 456 - #define flread(x) map_read32(map,base+((x)<<2)) 457 - #define flwrite(v,x) map_write32(map,v,base+((x)<<2)) 458 - 459 - const unsigned long AutoSel1 = 0xAAAAAAAA; 460 - const unsigned long AutoSel2 = 0x55555555; 461 - const unsigned long AutoSel3 = 0x90909090; 462 - const unsigned long Reset = 0xF0F0F0F0; 463 - __u32 OldVal; 464 - __u8 Mfg[4]; 465 - __u8 Id[4]; 466 - unsigned I; 467 - unsigned long Size; 468 - 469 - // Wait for any write/erase operation to settle 470 - OldVal = flread(base); 471 - for (I = 0; OldVal != flread(base) && I < 10000; I++) 472 - OldVal = flread(base); 473 - 474 - // Reset the chip 475 - flwrite(Reset,0x555); 476 - 477 - // Send the sequence 478 - flwrite(AutoSel1,0x555); 479 - flwrite(AutoSel2,0x2AA); 480 - flwrite(AutoSel3,0x555); 481 - 482 - // Test #1, JEDEC numbers are readable from 0x??00/0x??01 483 - if (flread(0) != flread(0x100) || 484 - flread(1) != flread(0x101)) 485 - { 486 - flwrite(Reset,0x555); 487 - return 0; 488 - } 489 - 490 - // Split up the JEDEC numbers 491 - OldVal = flread(0); 492 - for (I = 0; I != 4; I++) 493 - Mfg[I] = (OldVal >> (I*8)); 494 - OldVal = flread(1); 495 - for (I = 0; I != 4; I++) 496 - Id[I] = (OldVal >> (I*8)); 497 - 498 - Size = handle_jedecs(map,Mfg,Id,4,base,priv); 499 - if (Size == 0) 500 - { 501 - flwrite(Reset,0x555); 502 - return 0; 503 - } 504 - 505 - /* Check if there is address wrap around within a single bank, if this 506 - returns JEDEC numbers then we assume that it is wrap around. Notice 507 - we call this routine with the JEDEC return still enabled, if two or 508 - more flashes have a truncated address space the probe test will still 509 - work */ 510 - if (base + (Size<<2)+0x555 < map->size && 511 - base + (Size<<2)+0x555 < (base & (~(my_bank_size-1))) + my_bank_size) 512 - { 513 - if (flread(base+Size) != flread(base+Size + 0x100) || 514 - flread(base+Size + 1) != flread(base+Size + 0x101)) 515 - { 516 - jedec_probe32(map,base+Size,priv); 517 - } 518 - } 519 - 520 - // Reset. 521 - flwrite(0xF0F0F0F0,0x555); 522 - 523 - return 1; 524 - 525 - #undef flread 526 - #undef flwrite 527 - } 528 - 529 - /* Linear read. */ 530 - static int jedec_read(struct mtd_info *mtd, loff_t from, size_t len, 531 - size_t *retlen, u_char *buf) 532 - { 533 - struct map_info *map = mtd->priv; 534 - 535 - map_copy_from(map, buf, from, len); 536 - *retlen = len; 537 - return 0; 538 - } 539 - 540 - /* Banked read. Take special care to jump past the holes in the bank 541 - mapping. This version assumes symetry in the holes.. */ 542 - static int jedec_read_banked(struct mtd_info *mtd, loff_t from, size_t len, 543 - size_t *retlen, u_char *buf) 544 - { 545 - struct map_info *map = mtd->priv; 546 - struct jedec_private *priv = map->fldrv_priv; 547 - 548 - *retlen = 0; 549 - while (len > 0) 550 - { 551 - // Determine what bank and offset into that bank the first byte is 552 - unsigned long bank = from & (~(priv->bank_fill[0]-1)); 553 - unsigned long offset = from & (priv->bank_fill[0]-1); 554 - unsigned long get = len; 555 - if (priv->bank_fill[0] - offset < len) 556 - get = priv->bank_fill[0] - offset; 557 - 558 - bank /= priv->bank_fill[0]; 559 - map_copy_from(map,buf + *retlen,bank*my_bank_size + offset,get); 560 - 561 - len -= get; 562 - *retlen += get; 563 - from += get; 564 - } 565 - return 0; 566 - } 567 - 568 - /* Pass the flags value that the flash return before it re-entered read 569 - mode. */ 570 - static void jedec_flash_failed(unsigned char code) 571 - { 572 - /* Bit 5 being high indicates that there was an internal device 573 - failure, erasure time limits exceeded or something */ 574 - if ((code & (1 << 5)) != 0) 575 - { 576 - printk("mtd: Internal Flash failure\n"); 577 - return; 578 - } 579 - printk("mtd: Programming didn't take\n"); 580 - } 581 - 582 - /* This uses the erasure function described in the AMD Flash Handbook, 583 - it will work for flashes with a fixed sector size only. Flashes with 584 - a selection of sector sizes (ie the AMD Am29F800B) will need a different 585 - routine. This routine tries to parallize erasing multiple chips/sectors 586 - where possible */ 587 - static int flash_erase(struct mtd_info *mtd, struct erase_info *instr) 588 - { 589 - // Does IO to the currently selected chip 590 - #define flread(x) map_read8(map,chip->base+((x)<<chip->addrshift)) 591 - #define flwrite(v,x) map_write8(map,v,chip->base+((x)<<chip->addrshift)) 592 - 593 - unsigned long Time = 0; 594 - unsigned long NoTime = 0; 595 - unsigned long start = instr->addr, len = instr->len; 596 - unsigned int I; 597 - struct map_info *map = mtd->priv; 598 - struct jedec_private *priv = map->fldrv_priv; 599 - 600 - // Verify the arguments.. 601 - if (start + len > mtd->size || 602 - (start % mtd->erasesize) != 0 || 603 - (len % mtd->erasesize) != 0 || 604 - (len/mtd->erasesize) == 0) 605 - return -EINVAL; 606 - 607 - jedec_flash_chip_scan(priv,start,len); 608 - 609 - // Start the erase sequence on each chip 610 - for (I = 0; priv->chips[I].jedec != 0 && I < MAX_JEDEC_CHIPS; I++) 611 - { 612 - unsigned long off; 613 - struct jedec_flash_chip *chip = priv->chips + I; 614 - 615 - if (chip->length == 0) 616 - continue; 617 - 618 - if (chip->start + chip->length > chip->size) 619 - { 620 - printk("DIE\n"); 621 - return -EIO; 622 - } 623 - 624 - flwrite(0xF0,chip->start + 0x555); 625 - flwrite(0xAA,chip->start + 0x555); 626 - flwrite(0x55,chip->start + 0x2AA); 627 - flwrite(0x80,chip->start + 0x555); 628 - flwrite(0xAA,chip->start + 0x555); 629 - flwrite(0x55,chip->start + 0x2AA); 630 - 631 - /* Once we start selecting the erase sectors the delay between each 632 - command must not exceed 50us or it will immediately start erasing 633 - and ignore the other sectors */ 634 - for (off = 0; off < len; off += chip->sectorsize) 635 - { 636 - // Check to make sure we didn't timeout 637 - flwrite(0x30,chip->start + off); 638 - if (off == 0) 639 - continue; 640 - if ((flread(chip->start + off) & (1 << 3)) != 0) 641 - { 642 - printk("mtd: Ack! We timed out the erase timer!\n"); 643 - return -EIO; 644 - } 645 - } 646 - } 647 - 648 - /* We could split this into a timer routine and return early, performing 649 - background erasure.. Maybe later if the need warrents */ 650 - 651 - /* Poll the flash for erasure completion, specs say this can take as long 652 - as 480 seconds to do all the sectors (for a 2 meg flash). 653 - Erasure time is dependent on chip age, temp and wear.. */ 654 - 655 - /* This being a generic routine assumes a 32 bit bus. It does read32s 656 - and bundles interleved chips into the same grouping. This will work 657 - for all bus widths */ 658 - Time = 0; 659 - NoTime = 0; 660 - for (I = 0; priv->chips[I].jedec != 0 && I < MAX_JEDEC_CHIPS; I++) 661 - { 662 - struct jedec_flash_chip *chip = priv->chips + I; 663 - unsigned long off = 0; 664 - unsigned todo[4] = {0,0,0,0}; 665 - unsigned todo_left = 0; 666 - unsigned J; 667 - 668 - if (chip->length == 0) 669 - continue; 670 - 671 - /* Find all chips in this data line, realistically this is all 672 - or nothing up to the interleve count */ 673 - for (J = 0; priv->chips[J].jedec != 0 && J < MAX_JEDEC_CHIPS; J++) 674 - { 675 - if ((priv->chips[J].base & (~((1<<chip->addrshift)-1))) == 676 - (chip->base & (~((1<<chip->addrshift)-1)))) 677 - { 678 - todo_left++; 679 - todo[priv->chips[J].base & ((1<<chip->addrshift)-1)] = 1; 680 - } 681 - } 682 - 683 - /* printk("todo: %x %x %x %x\n",(short)todo[0],(short)todo[1], 684 - (short)todo[2],(short)todo[3]); 685 - */ 686 - while (1) 687 - { 688 - __u32 Last[4]; 689 - unsigned long Count = 0; 690 - 691 - /* During erase bit 7 is held low and bit 6 toggles, we watch this, 692 - should it stop toggling or go high then the erase is completed, 693 - or this is not really flash ;> */ 694 - switch (map->buswidth) { 695 - case 1: 696 - Last[0] = map_read8(map,(chip->base >> chip->addrshift) + chip->start + off); 697 - Last[1] = map_read8(map,(chip->base >> chip->addrshift) + chip->start + off); 698 - Last[2] = map_read8(map,(chip->base >> chip->addrshift) + chip->start + off); 699 - break; 700 - case 2: 701 - Last[0] = map_read16(map,(chip->base >> chip->addrshift) + chip->start + off); 702 - Last[1] = map_read16(map,(chip->base >> chip->addrshift) + chip->start + off); 703 - Last[2] = map_read16(map,(chip->base >> chip->addrshift) + chip->start + off); 704 - break; 705 - case 3: 706 - Last[0] = map_read32(map,(chip->base >> chip->addrshift) + chip->start + off); 707 - Last[1] = map_read32(map,(chip->base >> chip->addrshift) + chip->start + off); 708 - Last[2] = map_read32(map,(chip->base >> chip->addrshift) + chip->start + off); 709 - break; 710 - } 711 - Count = 3; 712 - while (todo_left != 0) 713 - { 714 - for (J = 0; J != 4; J++) 715 - { 716 - __u8 Byte1 = (Last[(Count-1)%4] >> (J*8)) & 0xFF; 717 - __u8 Byte2 = (Last[(Count-2)%4] >> (J*8)) & 0xFF; 718 - __u8 Byte3 = (Last[(Count-3)%4] >> (J*8)) & 0xFF; 719 - if (todo[J] == 0) 720 - continue; 721 - 722 - if ((Byte1 & (1 << 7)) == 0 && Byte1 != Byte2) 723 - { 724 - // printk("Check %x %x %x\n",(short)J,(short)Byte1,(short)Byte2); 725 - continue; 726 - } 727 - 728 - if (Byte1 == Byte2) 729 - { 730 - jedec_flash_failed(Byte3); 731 - return -EIO; 732 - } 733 - 734 - todo[J] = 0; 735 - todo_left--; 736 - } 737 - 738 - /* if (NoTime == 0) 739 - Time += HZ/10 - schedule_timeout(HZ/10);*/ 740 - NoTime = 0; 741 - 742 - switch (map->buswidth) { 743 - case 1: 744 - Last[Count % 4] = map_read8(map,(chip->base >> chip->addrshift) + chip->start + off); 745 - break; 746 - case 2: 747 - Last[Count % 4] = map_read16(map,(chip->base >> chip->addrshift) + chip->start + off); 748 - break; 749 - case 4: 750 - Last[Count % 4] = map_read32(map,(chip->base >> chip->addrshift) + chip->start + off); 751 - break; 752 - } 753 - Count++; 754 - 755 - /* // Count time, max of 15s per sector (according to AMD) 756 - if (Time > 15*len/mtd->erasesize*HZ) 757 - { 758 - printk("mtd: Flash Erase Timed out\n"); 759 - return -EIO; 760 - } */ 761 - } 762 - 763 - // Skip to the next chip if we used chip erase 764 - if (chip->length == chip->size) 765 - off = chip->size; 766 - else 767 - off += chip->sectorsize; 768 - 769 - if (off >= chip->length) 770 - break; 771 - NoTime = 1; 772 - } 773 - 774 - for (J = 0; priv->chips[J].jedec != 0 && J < MAX_JEDEC_CHIPS; J++) 775 - { 776 - if ((priv->chips[J].base & (~((1<<chip->addrshift)-1))) == 777 - (chip->base & (~((1<<chip->addrshift)-1)))) 778 - priv->chips[J].length = 0; 779 - } 780 - } 781 - 782 - //printk("done\n"); 783 - instr->state = MTD_ERASE_DONE; 784 - mtd_erase_callback(instr); 785 - return 0; 786 - 787 - #undef flread 788 - #undef flwrite 789 - } 790 - 791 - /* This is the simple flash writing function. It writes to every byte, in 792 - sequence. It takes care of how to properly address the flash if 793 - the flash is interleved. It can only be used if all the chips in the 794 - array are identical!*/ 795 - static int flash_write(struct mtd_info *mtd, loff_t start, size_t len, 796 - size_t *retlen, const u_char *buf) 797 - { 798 - /* Does IO to the currently selected chip. It takes the bank addressing 799 - base (which is divisible by the chip size) adds the necessary lower bits 800 - of addrshift (interleave index) and then adds the control register index. */ 801 - #define flread(x) map_read8(map,base+(off&((1<<chip->addrshift)-1))+((x)<<chip->addrshift)) 802 - #define flwrite(v,x) map_write8(map,v,base+(off&((1<<chip->addrshift)-1))+((x)<<chip->addrshift)) 803 - 804 - struct map_info *map = mtd->priv; 805 - struct jedec_private *priv = map->fldrv_priv; 806 - unsigned long base; 807 - unsigned long off; 808 - size_t save_len = len; 809 - 810 - if (start + len > mtd->size) 811 - return -EIO; 812 - 813 - //printk("Here"); 814 - 815 - //printk("flash_write: start is %x, len is %x\n",start,(unsigned long)len); 816 - while (len != 0) 817 - { 818 - struct jedec_flash_chip *chip = priv->chips; 819 - unsigned long bank; 820 - unsigned long boffset; 821 - 822 - // Compute the base of the flash. 823 - off = ((unsigned long)start) % (chip->size << chip->addrshift); 824 - base = start - off; 825 - 826 - // Perform banked addressing translation. 827 - bank = base & (~(priv->bank_fill[0]-1)); 828 - boffset = base & (priv->bank_fill[0]-1); 829 - bank = (bank/priv->bank_fill[0])*my_bank_size; 830 - base = bank + boffset; 831 - 832 - // printk("Flasing %X %X %X\n",base,chip->size,len); 833 - // printk("off is %x, compare with %x\n",off,chip->size << chip->addrshift); 834 - 835 - // Loop over this page 836 - for (; off != (chip->size << chip->addrshift) && len != 0; start++, len--, off++,buf++) 837 - { 838 - unsigned char oldbyte = map_read8(map,base+off); 839 - unsigned char Last[4]; 840 - unsigned long Count = 0; 841 - 842 - if (oldbyte == *buf) { 843 - // printk("oldbyte and *buf is %x,len is %x\n",oldbyte,len); 844 - continue; 845 - } 846 - if (((~oldbyte) & *buf) != 0) 847 - printk("mtd: warn: Trying to set a 0 to a 1\n"); 848 - 849 - // Write 850 - flwrite(0xAA,0x555); 851 - flwrite(0x55,0x2AA); 852 - flwrite(0xA0,0x555); 853 - map_write8(map,*buf,base + off); 854 - Last[0] = map_read8(map,base + off); 855 - Last[1] = map_read8(map,base + off); 856 - Last[2] = map_read8(map,base + off); 857 - 858 - /* Wait for the flash to finish the operation. We store the last 4 859 - status bytes that have been retrieved so we can determine why 860 - it failed. The toggle bits keep toggling when there is a 861 - failure */ 862 - for (Count = 3; Last[(Count - 1) % 4] != Last[(Count - 2) % 4] && 863 - Count < 10000; Count++) 864 - Last[Count % 4] = map_read8(map,base + off); 865 - if (Last[(Count - 1) % 4] != *buf) 866 - { 867 - jedec_flash_failed(Last[(Count - 3) % 4]); 868 - return -EIO; 869 - } 870 - } 871 - } 872 - *retlen = save_len; 873 - return 0; 874 - } 875 - 876 - /* This is used to enhance the speed of the erase routine, 877 - when things are being done to multiple chips it is possible to 878 - parallize the operations, particularly full memory erases of multi 879 - chip memories benifit */ 880 - static void jedec_flash_chip_scan(struct jedec_private *priv,unsigned long start, 881 - unsigned long len) 882 - { 883 - unsigned int I; 884 - 885 - // Zero the records 886 - for (I = 0; priv->chips[I].jedec != 0 && I < MAX_JEDEC_CHIPS; I++) 887 - priv->chips[I].start = priv->chips[I].length = 0; 888 - 889 - // Intersect the region with each chip 890 - for (I = 0; priv->chips[I].jedec != 0 && I < MAX_JEDEC_CHIPS; I++) 891 - { 892 - struct jedec_flash_chip *chip = priv->chips + I; 893 - unsigned long ByteStart; 894 - unsigned long ChipEndByte = chip->offset + (chip->size << chip->addrshift); 895 - 896 - // End is before this chip or the start is after it 897 - if (start+len < chip->offset || 898 - ChipEndByte - (1 << chip->addrshift) < start) 899 - continue; 900 - 901 - if (start < chip->offset) 902 - { 903 - ByteStart = chip->offset; 904 - chip->start = 0; 905 - } 906 - else 907 - { 908 - chip->start = (start - chip->offset + (1 << chip->addrshift)-1) >> chip->addrshift; 909 - ByteStart = start; 910 - } 911 - 912 - if (start + len >= ChipEndByte) 913 - chip->length = (ChipEndByte - ByteStart) >> chip->addrshift; 914 - else 915 - chip->length = (start + len - ByteStart + (1 << chip->addrshift)-1) >> chip->addrshift; 916 - } 917 - } 918 - 919 - int __init jedec_init(void) 920 - { 921 - register_mtd_chip_driver(&jedec_chipdrv); 922 - return 0; 923 - } 924 - 925 - static void __exit jedec_exit(void) 926 - { 927 - unregister_mtd_chip_driver(&jedec_chipdrv); 928 - } 929 - 930 - module_init(jedec_init); 931 - module_exit(jedec_exit); 932 - 933 - MODULE_LICENSE("GPL"); 934 - MODULE_AUTHOR("Jason Gunthorpe <jgg@deltatee.com> et al."); 935 - MODULE_DESCRIPTION("Old MTD chip driver for JEDEC-compliant flash chips");
-601
drivers/mtd/chips/sharp.c
··· 1 - /* 2 - * MTD chip driver for pre-CFI Sharp flash chips 3 - * 4 - * Copyright 2000,2001 David A. Schleef <ds@schleef.org> 5 - * 2000,2001 Lineo, Inc. 6 - * 7 - * $Id: sharp.c,v 1.17 2005/11/29 14:28:28 gleixner Exp $ 8 - * 9 - * Devices supported: 10 - * LH28F016SCT Symmetrical block flash memory, 2Mx8 11 - * LH28F008SCT Symmetrical block flash memory, 1Mx8 12 - * 13 - * Documentation: 14 - * http://www.sharpmeg.com/datasheets/memic/flashcmp/ 15 - * http://www.sharpmeg.com/datasheets/memic/flashcmp/01symf/16m/016sctl9.pdf 16 - * 016sctl9.pdf 17 - * 18 - * Limitations: 19 - * This driver only supports 4x1 arrangement of chips. 20 - * Not tested on anything but PowerPC. 21 - */ 22 - 23 - #include <linux/kernel.h> 24 - #include <linux/module.h> 25 - #include <linux/types.h> 26 - #include <linux/sched.h> 27 - #include <linux/errno.h> 28 - #include <linux/interrupt.h> 29 - #include <linux/mtd/map.h> 30 - #include <linux/mtd/mtd.h> 31 - #include <linux/mtd/cfi.h> 32 - #include <linux/delay.h> 33 - #include <linux/init.h> 34 - #include <linux/slab.h> 35 - 36 - #define CMD_RESET 0xffffffff 37 - #define CMD_READ_ID 0x90909090 38 - #define CMD_READ_STATUS 0x70707070 39 - #define CMD_CLEAR_STATUS 0x50505050 40 - #define CMD_BLOCK_ERASE_1 0x20202020 41 - #define CMD_BLOCK_ERASE_2 0xd0d0d0d0 42 - #define CMD_BYTE_WRITE 0x40404040 43 - #define CMD_SUSPEND 0xb0b0b0b0 44 - #define CMD_RESUME 0xd0d0d0d0 45 - #define CMD_SET_BLOCK_LOCK_1 0x60606060 46 - #define CMD_SET_BLOCK_LOCK_2 0x01010101 47 - #define CMD_SET_MASTER_LOCK_1 0x60606060 48 - #define CMD_SET_MASTER_LOCK_2 0xf1f1f1f1 49 - #define CMD_CLEAR_BLOCK_LOCKS_1 0x60606060 50 - #define CMD_CLEAR_BLOCK_LOCKS_2 0xd0d0d0d0 51 - 52 - #define SR_READY 0x80808080 // 1 = ready 53 - #define SR_ERASE_SUSPEND 0x40404040 // 1 = block erase suspended 54 - #define SR_ERROR_ERASE 0x20202020 // 1 = error in block erase or clear lock bits 55 - #define SR_ERROR_WRITE 0x10101010 // 1 = error in byte write or set lock bit 56 - #define SR_VPP 0x08080808 // 1 = Vpp is low 57 - #define SR_WRITE_SUSPEND 0x04040404 // 1 = byte write suspended 58 - #define SR_PROTECT 0x02020202 // 1 = lock bit set 59 - #define SR_RESERVED 0x01010101 60 - 61 - #define SR_ERRORS (SR_ERROR_ERASE|SR_ERROR_WRITE|SR_VPP|SR_PROTECT) 62 - 63 - /* Configuration options */ 64 - 65 - #undef AUTOUNLOCK /* automatically unlocks blocks before erasing */ 66 - 67 - static struct mtd_info *sharp_probe(struct map_info *); 68 - 69 - static int sharp_probe_map(struct map_info *map,struct mtd_info *mtd); 70 - 71 - static int sharp_read(struct mtd_info *mtd, loff_t from, size_t len, 72 - size_t *retlen, u_char *buf); 73 - static int sharp_write(struct mtd_info *mtd, loff_t from, size_t len, 74 - size_t *retlen, const u_char *buf); 75 - static int sharp_erase(struct mtd_info *mtd, struct erase_info *instr); 76 - static void sharp_sync(struct mtd_info *mtd); 77 - static int sharp_suspend(struct mtd_info *mtd); 78 - static void sharp_resume(struct mtd_info *mtd); 79 - static void sharp_destroy(struct mtd_info *mtd); 80 - 81 - static int sharp_write_oneword(struct map_info *map, struct flchip *chip, 82 - unsigned long adr, __u32 datum); 83 - static int sharp_erase_oneblock(struct map_info *map, struct flchip *chip, 84 - unsigned long adr); 85 - #ifdef AUTOUNLOCK 86 - static void sharp_unlock_oneblock(struct map_info *map, struct flchip *chip, 87 - unsigned long adr); 88 - #endif 89 - 90 - 91 - struct sharp_info{ 92 - struct flchip *chip; 93 - int bogus; 94 - int chipshift; 95 - int numchips; 96 - struct flchip chips[1]; 97 - }; 98 - 99 - static void sharp_destroy(struct mtd_info *mtd); 100 - 101 - static struct mtd_chip_driver sharp_chipdrv = { 102 - .probe = sharp_probe, 103 - .destroy = sharp_destroy, 104 - .name = "sharp", 105 - .module = THIS_MODULE 106 - }; 107 - 108 - 109 - static struct mtd_info *sharp_probe(struct map_info *map) 110 - { 111 - struct mtd_info *mtd = NULL; 112 - struct sharp_info *sharp = NULL; 113 - int width; 114 - 115 - mtd = kzalloc(sizeof(*mtd), GFP_KERNEL); 116 - if(!mtd) 117 - return NULL; 118 - 119 - sharp = kzalloc(sizeof(*sharp), GFP_KERNEL); 120 - if(!sharp) { 121 - kfree(mtd); 122 - return NULL; 123 - } 124 - 125 - width = sharp_probe_map(map,mtd); 126 - if(!width){ 127 - kfree(mtd); 128 - kfree(sharp); 129 - return NULL; 130 - } 131 - 132 - mtd->priv = map; 133 - mtd->type = MTD_NORFLASH; 134 - mtd->erase = sharp_erase; 135 - mtd->read = sharp_read; 136 - mtd->write = sharp_write; 137 - mtd->sync = sharp_sync; 138 - mtd->suspend = sharp_suspend; 139 - mtd->resume = sharp_resume; 140 - mtd->flags = MTD_CAP_NORFLASH; 141 - mtd->writesize = 1; 142 - mtd->name = map->name; 143 - 144 - sharp->chipshift = 23; 145 - sharp->numchips = 1; 146 - sharp->chips[0].start = 0; 147 - sharp->chips[0].state = FL_READY; 148 - sharp->chips[0].mutex = &sharp->chips[0]._spinlock; 149 - sharp->chips[0].word_write_time = 0; 150 - init_waitqueue_head(&sharp->chips[0].wq); 151 - spin_lock_init(&sharp->chips[0]._spinlock); 152 - 153 - map->fldrv = &sharp_chipdrv; 154 - map->fldrv_priv = sharp; 155 - 156 - __module_get(THIS_MODULE); 157 - return mtd; 158 - } 159 - 160 - static inline void sharp_send_cmd(struct map_info *map, unsigned long cmd, unsigned long adr) 161 - { 162 - map_word map_cmd; 163 - map_cmd.x[0] = cmd; 164 - map_write(map, map_cmd, adr); 165 - } 166 - 167 - static int sharp_probe_map(struct map_info *map,struct mtd_info *mtd) 168 - { 169 - map_word tmp, read0, read4; 170 - unsigned long base = 0; 171 - int width = 4; 172 - 173 - tmp = map_read(map, base+0); 174 - 175 - sharp_send_cmd(map, CMD_READ_ID, base+0); 176 - 177 - read0 = map_read(map, base+0); 178 - read4 = map_read(map, base+4); 179 - if(read0.x[0] == 0x89898989){ 180 - printk("Looks like sharp flash\n"); 181 - switch(read4.x[0]){ 182 - case 0xaaaaaaaa: 183 - case 0xa0a0a0a0: 184 - /* aa - LH28F016SCT-L95 2Mx8, 32 64k blocks*/ 185 - /* a0 - LH28F016SCT-Z4 2Mx8, 32 64k blocks*/ 186 - mtd->erasesize = 0x10000 * width; 187 - mtd->size = 0x200000 * width; 188 - return width; 189 - case 0xa6a6a6a6: 190 - /* a6 - LH28F008SCT-L12 1Mx8, 16 64k blocks*/ 191 - /* a6 - LH28F008SCR-L85 1Mx8, 16 64k blocks*/ 192 - mtd->erasesize = 0x10000 * width; 193 - mtd->size = 0x100000 * width; 194 - return width; 195 - #if 0 196 - case 0x00000000: /* unknown */ 197 - /* XX - LH28F004SCT 512kx8, 8 64k blocks*/ 198 - mtd->erasesize = 0x10000 * width; 199 - mtd->size = 0x80000 * width; 200 - return width; 201 - #endif 202 - default: 203 - printk("Sort-of looks like sharp flash, 0x%08lx 0x%08lx\n", 204 - read0.x[0], read4.x[0]); 205 - } 206 - }else if((map_read(map, base+0).x[0] == CMD_READ_ID)){ 207 - /* RAM, probably */ 208 - printk("Looks like RAM\n"); 209 - map_write(map, tmp, base+0); 210 - }else{ 211 - printk("Doesn't look like sharp flash, 0x%08lx 0x%08lx\n", 212 - read0.x[0], read4.x[0]); 213 - } 214 - 215 - return 0; 216 - } 217 - 218 - /* This function returns with the chip->mutex lock held. */ 219 - static int sharp_wait(struct map_info *map, struct flchip *chip) 220 - { 221 - int i; 222 - map_word status; 223 - unsigned long timeo = jiffies + HZ; 224 - DECLARE_WAITQUEUE(wait, current); 225 - int adr = 0; 226 - 227 - retry: 228 - spin_lock_bh(chip->mutex); 229 - 230 - switch(chip->state){ 231 - case FL_READY: 232 - sharp_send_cmd(map, CMD_READ_STATUS, adr); 233 - chip->state = FL_STATUS; 234 - case FL_STATUS: 235 - for(i=0;i<100;i++){ 236 - status = map_read(map, adr); 237 - if((status.x[0] & SR_READY)==SR_READY) 238 - break; 239 - udelay(1); 240 - } 241 - break; 242 - default: 243 - printk("Waiting for chip\n"); 244 - 245 - set_current_state(TASK_INTERRUPTIBLE); 246 - add_wait_queue(&chip->wq, &wait); 247 - 248 - spin_unlock_bh(chip->mutex); 249 - 250 - schedule(); 251 - remove_wait_queue(&chip->wq, &wait); 252 - 253 - if(signal_pending(current)) 254 - return -EINTR; 255 - 256 - timeo = jiffies + HZ; 257 - 258 - goto retry; 259 - } 260 - 261 - sharp_send_cmd(map, CMD_RESET, adr); 262 - 263 - chip->state = FL_READY; 264 - 265 - return 0; 266 - } 267 - 268 - static void sharp_release(struct flchip *chip) 269 - { 270 - wake_up(&chip->wq); 271 - spin_unlock_bh(chip->mutex); 272 - } 273 - 274 - static int sharp_read(struct mtd_info *mtd, loff_t from, size_t len, 275 - size_t *retlen, u_char *buf) 276 - { 277 - struct map_info *map = mtd->priv; 278 - struct sharp_info *sharp = map->fldrv_priv; 279 - int chipnum; 280 - int ret = 0; 281 - int ofs = 0; 282 - 283 - chipnum = (from >> sharp->chipshift); 284 - ofs = from & ((1 << sharp->chipshift)-1); 285 - 286 - *retlen = 0; 287 - 288 - while(len){ 289 - unsigned long thislen; 290 - 291 - if(chipnum>=sharp->numchips) 292 - break; 293 - 294 - thislen = len; 295 - if(ofs+thislen >= (1<<sharp->chipshift)) 296 - thislen = (1<<sharp->chipshift) - ofs; 297 - 298 - ret = sharp_wait(map,&sharp->chips[chipnum]); 299 - if(ret<0) 300 - break; 301 - 302 - map_copy_from(map,buf,ofs,thislen); 303 - 304 - sharp_release(&sharp->chips[chipnum]); 305 - 306 - *retlen += thislen; 307 - len -= thislen; 308 - buf += thislen; 309 - 310 - ofs = 0; 311 - chipnum++; 312 - } 313 - return ret; 314 - } 315 - 316 - static int sharp_write(struct mtd_info *mtd, loff_t to, size_t len, 317 - size_t *retlen, const u_char *buf) 318 - { 319 - struct map_info *map = mtd->priv; 320 - struct sharp_info *sharp = map->fldrv_priv; 321 - int ret = 0; 322 - int i,j; 323 - int chipnum; 324 - unsigned long ofs; 325 - union { u32 l; unsigned char uc[4]; } tbuf; 326 - 327 - *retlen = 0; 328 - 329 - while(len){ 330 - tbuf.l = 0xffffffff; 331 - chipnum = to >> sharp->chipshift; 332 - ofs = to & ((1<<sharp->chipshift)-1); 333 - 334 - j=0; 335 - for(i=ofs&3;i<4 && len;i++){ 336 - tbuf.uc[i] = *buf; 337 - buf++; 338 - to++; 339 - len--; 340 - j++; 341 - } 342 - sharp_write_oneword(map, &sharp->chips[chipnum], ofs&~3, tbuf.l); 343 - if(ret<0) 344 - return ret; 345 - (*retlen)+=j; 346 - } 347 - 348 - return 0; 349 - } 350 - 351 - static int sharp_write_oneword(struct map_info *map, struct flchip *chip, 352 - unsigned long adr, __u32 datum) 353 - { 354 - int ret; 355 - int timeo; 356 - int try; 357 - int i; 358 - map_word data, status; 359 - 360 - status.x[0] = 0; 361 - ret = sharp_wait(map,chip); 362 - 363 - for(try=0;try<10;try++){ 364 - sharp_send_cmd(map, CMD_BYTE_WRITE, adr); 365 - /* cpu_to_le32 -> hack to fix the writel be->le conversion */ 366 - data.x[0] = cpu_to_le32(datum); 367 - map_write(map, data, adr); 368 - 369 - chip->state = FL_WRITING; 370 - 371 - timeo = jiffies + (HZ/2); 372 - 373 - sharp_send_cmd(map, CMD_READ_STATUS, adr); 374 - for(i=0;i<100;i++){ 375 - status = map_read(map, adr); 376 - if((status.x[0] & SR_READY) == SR_READY) 377 - break; 378 - } 379 - if(i==100){ 380 - printk("sharp: timed out writing\n"); 381 - } 382 - 383 - if(!(status.x[0] & SR_ERRORS)) 384 - break; 385 - 386 - printk("sharp: error writing byte at addr=%08lx status=%08lx\n", adr, status.x[0]); 387 - 388 - sharp_send_cmd(map, CMD_CLEAR_STATUS, adr); 389 - } 390 - sharp_send_cmd(map, CMD_RESET, adr); 391 - chip->state = FL_READY; 392 - 393 - wake_up(&chip->wq); 394 - spin_unlock_bh(chip->mutex); 395 - 396 - return 0; 397 - } 398 - 399 - static int sharp_erase(struct mtd_info *mtd, struct erase_info *instr) 400 - { 401 - struct map_info *map = mtd->priv; 402 - struct sharp_info *sharp = map->fldrv_priv; 403 - unsigned long adr,len; 404 - int chipnum, ret=0; 405 - 406 - //printk("sharp_erase()\n"); 407 - if(instr->addr & (mtd->erasesize - 1)) 408 - return -EINVAL; 409 - if(instr->len & (mtd->erasesize - 1)) 410 - return -EINVAL; 411 - if(instr->len + instr->addr > mtd->size) 412 - return -EINVAL; 413 - 414 - chipnum = instr->addr >> sharp->chipshift; 415 - adr = instr->addr & ((1<<sharp->chipshift)-1); 416 - len = instr->len; 417 - 418 - while(len){ 419 - ret = sharp_erase_oneblock(map, &sharp->chips[chipnum], adr); 420 - if(ret)return ret; 421 - 422 - adr += mtd->erasesize; 423 - len -= mtd->erasesize; 424 - if(adr >> sharp->chipshift){ 425 - adr = 0; 426 - chipnum++; 427 - if(chipnum>=sharp->numchips) 428 - break; 429 - } 430 - } 431 - 432 - instr->state = MTD_ERASE_DONE; 433 - mtd_erase_callback(instr); 434 - 435 - return 0; 436 - } 437 - 438 - static int sharp_do_wait_for_ready(struct map_info *map, struct flchip *chip, 439 - unsigned long adr) 440 - { 441 - int ret; 442 - unsigned long timeo; 443 - map_word status; 444 - DECLARE_WAITQUEUE(wait, current); 445 - 446 - sharp_send_cmd(map, CMD_READ_STATUS, adr); 447 - status = map_read(map, adr); 448 - 449 - timeo = jiffies + HZ; 450 - 451 - while(time_before(jiffies, timeo)){ 452 - sharp_send_cmd(map, CMD_READ_STATUS, adr); 453 - status = map_read(map, adr); 454 - if((status.x[0] & SR_READY)==SR_READY){ 455 - ret = 0; 456 - goto out; 457 - } 458 - set_current_state(TASK_INTERRUPTIBLE); 459 - add_wait_queue(&chip->wq, &wait); 460 - 461 - //spin_unlock_bh(chip->mutex); 462 - 463 - schedule_timeout(1); 464 - schedule(); 465 - remove_wait_queue(&chip->wq, &wait); 466 - 467 - //spin_lock_bh(chip->mutex); 468 - 469 - if (signal_pending(current)){ 470 - ret = -EINTR; 471 - goto out; 472 - } 473 - 474 - } 475 - ret = -ETIME; 476 - out: 477 - return ret; 478 - } 479 - 480 - static int sharp_erase_oneblock(struct map_info *map, struct flchip *chip, 481 - unsigned long adr) 482 - { 483 - int ret; 484 - //int timeo; 485 - map_word status; 486 - //int i; 487 - 488 - //printk("sharp_erase_oneblock()\n"); 489 - 490 - #ifdef AUTOUNLOCK 491 - /* This seems like a good place to do an unlock */ 492 - sharp_unlock_oneblock(map,chip,adr); 493 - #endif 494 - 495 - sharp_send_cmd(map, CMD_BLOCK_ERASE_1, adr); 496 - sharp_send_cmd(map, CMD_BLOCK_ERASE_2, adr); 497 - 498 - chip->state = FL_ERASING; 499 - 500 - ret = sharp_do_wait_for_ready(map,chip,adr); 501 - if(ret<0)return ret; 502 - 503 - sharp_send_cmd(map, CMD_READ_STATUS, adr); 504 - status = map_read(map, adr); 505 - 506 - if(!(status.x[0] & SR_ERRORS)){ 507 - sharp_send_cmd(map, CMD_RESET, adr); 508 - chip->state = FL_READY; 509 - //spin_unlock_bh(chip->mutex); 510 - return 0; 511 - } 512 - 513 - printk("sharp: error erasing block at addr=%08lx status=%08lx\n", adr, status.x[0]); 514 - sharp_send_cmd(map, CMD_CLEAR_STATUS, adr); 515 - 516 - //spin_unlock_bh(chip->mutex); 517 - 518 - return -EIO; 519 - } 520 - 521 - #ifdef AUTOUNLOCK 522 - static void sharp_unlock_oneblock(struct map_info *map, struct flchip *chip, 523 - unsigned long adr) 524 - { 525 - int i; 526 - map_word status; 527 - 528 - sharp_send_cmd(map, CMD_CLEAR_BLOCK_LOCKS_1, adr); 529 - sharp_send_cmd(map, CMD_CLEAR_BLOCK_LOCKS_2, adr); 530 - 531 - udelay(100); 532 - 533 - status = map_read(map, adr); 534 - printk("status=%08lx\n", status.x[0]); 535 - 536 - for(i=0;i<1000;i++){ 537 - //sharp_send_cmd(map, CMD_READ_STATUS, adr); 538 - status = map_read(map, adr); 539 - if((status.x[0] & SR_READY) == SR_READY) 540 - break; 541 - udelay(100); 542 - } 543 - if(i==1000){ 544 - printk("sharp: timed out unlocking block\n"); 545 - } 546 - 547 - if(!(status.x[0] & SR_ERRORS)){ 548 - sharp_send_cmd(map, CMD_RESET, adr); 549 - chip->state = FL_READY; 550 - return; 551 - } 552 - 553 - printk("sharp: error unlocking block at addr=%08lx status=%08lx\n", adr, status.x[0]); 554 - sharp_send_cmd(map, CMD_CLEAR_STATUS, adr); 555 - } 556 - #endif 557 - 558 - static void sharp_sync(struct mtd_info *mtd) 559 - { 560 - //printk("sharp_sync()\n"); 561 - } 562 - 563 - static int sharp_suspend(struct mtd_info *mtd) 564 - { 565 - printk("sharp_suspend()\n"); 566 - return -EINVAL; 567 - } 568 - 569 - static void sharp_resume(struct mtd_info *mtd) 570 - { 571 - printk("sharp_resume()\n"); 572 - 573 - } 574 - 575 - static void sharp_destroy(struct mtd_info *mtd) 576 - { 577 - printk("sharp_destroy()\n"); 578 - 579 - } 580 - 581 - static int __init sharp_probe_init(void) 582 - { 583 - printk("MTD Sharp chip driver <ds@lineo.com>\n"); 584 - 585 - register_mtd_chip_driver(&sharp_chipdrv); 586 - 587 - return 0; 588 - } 589 - 590 - static void __exit sharp_probe_exit(void) 591 - { 592 - unregister_mtd_chip_driver(&sharp_chipdrv); 593 - } 594 - 595 - module_init(sharp_probe_init); 596 - module_exit(sharp_probe_exit); 597 - 598 - 599 - MODULE_LICENSE("GPL"); 600 - MODULE_AUTHOR("David Schleef <ds@schleef.org>"); 601 - MODULE_DESCRIPTION("Old MTD chip driver for pre-CFI Sharp flash chips");
+1 -1
drivers/mtd/devices/block2mtd.c
··· 373 373 374 374 #ifndef MODULE 375 375 static int block2mtd_init_called = 0; 376 - static __initdata char block2mtd_paramline[80 + 12]; /* 80 for device, 12 for erase size */ 376 + static char block2mtd_paramline[80 + 12]; /* 80 for device, 12 for erase size */ 377 377 #endif 378 378 379 379
-16
drivers/mtd/maps/Kconfig
··· 358 358 Mapping for the Flaga digital module. If you don't have one, ignore 359 359 this setting. 360 360 361 - config MTD_BEECH 362 - tristate "CFI Flash device mapped on IBM 405LP Beech" 363 - depends on MTD_CFI && BEECH 364 - help 365 - This enables access routines for the flash chips on the IBM 366 - 405LP Beech board. If you have one of these boards and would like 367 - to use the flash chips on it, say 'Y'. 368 - 369 - config MTD_ARCTIC 370 - tristate "CFI Flash device mapped on IBM 405LP Arctic" 371 - depends on MTD_CFI && ARCTIC2 372 - help 373 - This enables access routines for the flash chips on the IBM 405LP 374 - Arctic board. If you have one of these boards and would like to 375 - use the flash chips on it, say 'Y'. 376 - 377 361 config MTD_WALNUT 378 362 tristate "Flash device mapped on IBM 405GP Walnut" 379 363 depends on MTD_JEDECPROBE && WALNUT
-2
drivers/mtd/maps/Makefile
··· 58 58 obj-$(CONFIG_MTD_SCB2_FLASH) += scb2_flash.o 59 59 obj-$(CONFIG_MTD_EBONY) += ebony.o 60 60 obj-$(CONFIG_MTD_OCOTEA) += ocotea.o 61 - obj-$(CONFIG_MTD_BEECH) += beech-mtd.o 62 - obj-$(CONFIG_MTD_ARCTIC) += arctic-mtd.o 63 61 obj-$(CONFIG_MTD_WALNUT) += walnut.o 64 62 obj-$(CONFIG_MTD_H720X) += h720x-flash.o 65 63 obj-$(CONFIG_MTD_SBC8240) += sbc8240.o
-145
drivers/mtd/maps/arctic-mtd.c
··· 1 - /* 2 - * $Id: arctic-mtd.c,v 1.14 2005/11/07 11:14:26 gleixner Exp $ 3 - * 4 - * drivers/mtd/maps/arctic-mtd.c MTD mappings and partition tables for 5 - * IBM 405LP Arctic boards. 6 - * 7 - * This program is free software; you can redistribute it and/or modify 8 - * it under the terms of the GNU General Public License as published by 9 - * the Free Software Foundation; either version 2 of the License, or 10 - * (at your option) any later version. 11 - * 12 - * This program is distributed in the hope that it will be useful, 13 - * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 - * GNU General Public License for more details. 16 - * 17 - * You should have received a copy of the GNU General Public License 18 - * along with this program; if not, write to the Free Software 19 - * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 20 - * 21 - * Copyright (C) 2002, International Business Machines Corporation 22 - * All Rights Reserved. 23 - * 24 - * Bishop Brock 25 - * IBM Research, Austin Center for Low-Power Computing 26 - * bcbrock@us.ibm.com 27 - * March 2002 28 - * 29 - * modified for Arctic by, 30 - * David Gibson 31 - * IBM OzLabs, Canberra, Australia 32 - * <arctic@gibson.dropbear.id.au> 33 - */ 34 - 35 - #include <linux/kernel.h> 36 - #include <linux/module.h> 37 - #include <linux/types.h> 38 - #include <linux/init.h> 39 - 40 - #include <linux/mtd/mtd.h> 41 - #include <linux/mtd/map.h> 42 - #include <linux/mtd/partitions.h> 43 - 44 - #include <asm/io.h> 45 - #include <asm/ibm4xx.h> 46 - 47 - /* 48 - * 0 : 0xFE00 0000 - 0xFEFF FFFF : Filesystem 1 (16MiB) 49 - * 1 : 0xFF00 0000 - 0xFF4F FFFF : kernel (5.12MiB) 50 - * 2 : 0xFF50 0000 - 0xFFF5 FFFF : Filesystem 2 (10.624MiB) (if non-XIP) 51 - * 3 : 0xFFF6 0000 - 0xFFFF FFFF : PIBS Firmware (640KiB) 52 - */ 53 - 54 - #define FFS1_SIZE 0x01000000 /* 16MiB */ 55 - #define KERNEL_SIZE 0x00500000 /* 5.12MiB */ 56 - #define FFS2_SIZE 0x00a60000 /* 10.624MiB */ 57 - #define FIRMWARE_SIZE 0x000a0000 /* 640KiB */ 58 - 59 - 60 - #define NAME "Arctic Linux Flash" 61 - #define PADDR SUBZERO_BOOTFLASH_PADDR 62 - #define BUSWIDTH 2 63 - #define SIZE SUBZERO_BOOTFLASH_SIZE 64 - #define PARTITIONS 4 65 - 66 - /* Flash memories on these boards are memory resources, accessed big-endian. */ 67 - 68 - { 69 - /* do nothing for now */ 70 - } 71 - 72 - static struct map_info arctic_mtd_map = { 73 - .name = NAME, 74 - .size = SIZE, 75 - .bankwidth = BUSWIDTH, 76 - .phys = PADDR, 77 - }; 78 - 79 - static struct mtd_info *arctic_mtd; 80 - 81 - static struct mtd_partition arctic_partitions[PARTITIONS] = { 82 - { .name = "Filesystem", 83 - .size = FFS1_SIZE, 84 - .offset = 0,}, 85 - { .name = "Kernel", 86 - .size = KERNEL_SIZE, 87 - .offset = FFS1_SIZE,}, 88 - { .name = "Filesystem", 89 - .size = FFS2_SIZE, 90 - .offset = FFS1_SIZE + KERNEL_SIZE,}, 91 - { .name = "Firmware", 92 - .size = FIRMWARE_SIZE, 93 - .offset = SUBZERO_BOOTFLASH_SIZE - FIRMWARE_SIZE,}, 94 - }; 95 - 96 - static int __init 97 - init_arctic_mtd(void) 98 - { 99 - int err; 100 - 101 - printk("%s: 0x%08x at 0x%08x\n", NAME, SIZE, PADDR); 102 - 103 - arctic_mtd_map.virt = ioremap(PADDR, SIZE); 104 - 105 - if (!arctic_mtd_map.virt) { 106 - printk("%s: failed to ioremap 0x%x\n", NAME, PADDR); 107 - return -EIO; 108 - } 109 - simple_map_init(&arctic_mtd_map); 110 - 111 - printk("%s: probing %d-bit flash bus\n", NAME, BUSWIDTH * 8); 112 - arctic_mtd = do_map_probe("cfi_probe", &arctic_mtd_map); 113 - 114 - if (!arctic_mtd) { 115 - iounmap(arctic_mtd_map.virt); 116 - return -ENXIO; 117 - } 118 - 119 - arctic_mtd->owner = THIS_MODULE; 120 - 121 - err = add_mtd_partitions(arctic_mtd, arctic_partitions, PARTITIONS); 122 - if (err) { 123 - printk("%s: add_mtd_partitions failed\n", NAME); 124 - iounmap(arctic_mtd_map.virt); 125 - } 126 - 127 - return err; 128 - } 129 - 130 - static void __exit 131 - cleanup_arctic_mtd(void) 132 - { 133 - if (arctic_mtd) { 134 - del_mtd_partitions(arctic_mtd); 135 - map_destroy(arctic_mtd); 136 - iounmap((void *) arctic_mtd_map.virt); 137 - } 138 - } 139 - 140 - module_init(init_arctic_mtd); 141 - module_exit(cleanup_arctic_mtd); 142 - 143 - MODULE_LICENSE("GPL"); 144 - MODULE_AUTHOR("David Gibson <arctic@gibson.dropbear.id.au>"); 145 - MODULE_DESCRIPTION("MTD map and partitions for IBM 405LP Arctic boards");
-122
drivers/mtd/maps/beech-mtd.c
··· 1 - /* 2 - * $Id: beech-mtd.c,v 1.11 2005/11/07 11:14:26 gleixner Exp $ 3 - * 4 - * drivers/mtd/maps/beech-mtd.c MTD mappings and partition tables for 5 - * IBM 405LP Beech boards. 6 - * 7 - * This program is free software; you can redistribute it and/or modify 8 - * it under the terms of the GNU General Public License as published by 9 - * the Free Software Foundation; either version 2 of the License, or 10 - * (at your option) any later version. 11 - * 12 - * This program is distributed in the hope that it will be useful, 13 - * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 - * GNU General Public License for more details. 16 - * 17 - * You should have received a copy of the GNU General Public License 18 - * along with this program; if not, write to the Free Software 19 - * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 20 - * 21 - * Copyright (C) 2002, International Business Machines Corporation 22 - * All Rights Reserved. 23 - * 24 - * Bishop Brock 25 - * IBM Research, Austin Center for Low-Power Computing 26 - * bcbrock@us.ibm.com 27 - * March 2002 28 - * 29 - */ 30 - 31 - #include <linux/kernel.h> 32 - #include <linux/module.h> 33 - #include <linux/types.h> 34 - #include <linux/init.h> 35 - 36 - #include <linux/mtd/mtd.h> 37 - #include <linux/mtd/map.h> 38 - #include <linux/mtd/partitions.h> 39 - 40 - #include <asm/io.h> 41 - #include <asm/ibm4xx.h> 42 - 43 - #define NAME "Beech Linux Flash" 44 - #define PADDR BEECH_BIGFLASH_PADDR 45 - #define SIZE BEECH_BIGFLASH_SIZE 46 - #define BUSWIDTH 1 47 - 48 - /* Flash memories on these boards are memory resources, accessed big-endian. */ 49 - 50 - 51 - static struct map_info beech_mtd_map = { 52 - .name = NAME, 53 - .size = SIZE, 54 - .bankwidth = BUSWIDTH, 55 - .phys = PADDR 56 - }; 57 - 58 - static struct mtd_info *beech_mtd; 59 - 60 - static struct mtd_partition beech_partitions[2] = { 61 - { 62 - .name = "Linux Kernel", 63 - .size = BEECH_KERNEL_SIZE, 64 - .offset = BEECH_KERNEL_OFFSET 65 - }, { 66 - .name = "Free Area", 67 - .size = BEECH_FREE_AREA_SIZE, 68 - .offset = BEECH_FREE_AREA_OFFSET 69 - } 70 - }; 71 - 72 - static int __init 73 - init_beech_mtd(void) 74 - { 75 - int err; 76 - 77 - printk("%s: 0x%08x at 0x%08x\n", NAME, SIZE, PADDR); 78 - 79 - beech_mtd_map.virt = ioremap(PADDR, SIZE); 80 - 81 - if (!beech_mtd_map.virt) { 82 - printk("%s: failed to ioremap 0x%x\n", NAME, PADDR); 83 - return -EIO; 84 - } 85 - 86 - simple_map_init(&beech_mtd_map); 87 - 88 - printk("%s: probing %d-bit flash bus\n", NAME, BUSWIDTH * 8); 89 - beech_mtd = do_map_probe("cfi_probe", &beech_mtd_map); 90 - 91 - if (!beech_mtd) { 92 - iounmap(beech_mtd_map.virt); 93 - return -ENXIO; 94 - } 95 - 96 - beech_mtd->owner = THIS_MODULE; 97 - 98 - err = add_mtd_partitions(beech_mtd, beech_partitions, 2); 99 - if (err) { 100 - printk("%s: add_mtd_partitions failed\n", NAME); 101 - iounmap(beech_mtd_map.virt); 102 - } 103 - 104 - return err; 105 - } 106 - 107 - static void __exit 108 - cleanup_beech_mtd(void) 109 - { 110 - if (beech_mtd) { 111 - del_mtd_partitions(beech_mtd); 112 - map_destroy(beech_mtd); 113 - iounmap((void *) beech_mtd_map.virt); 114 - } 115 - } 116 - 117 - module_init(init_beech_mtd); 118 - module_exit(cleanup_beech_mtd); 119 - 120 - MODULE_LICENSE("GPL"); 121 - MODULE_AUTHOR("Bishop Brock <bcbrock@us.ibm.com>"); 122 - MODULE_DESCRIPTION("MTD map and partitions for IBM 405LP Beech boards");
+1 -1
drivers/mtd/maps/physmap_of.c
··· 186 186 else { 187 187 if (strcmp(of_probe, "ROM")) 188 188 dev_dbg(&dev->dev, "map_probe: don't know probe type " 189 - "'%s', mapping as rom\n"); 189 + "'%s', mapping as rom\n", of_probe); 190 190 info->mtd = do_map_probe("mtd_rom", &info->map); 191 191 } 192 192 if (info->mtd == NULL) {
-1
drivers/mtd/mtdpart.c
··· 347 347 slave->mtd.subpage_sft = master->subpage_sft; 348 348 349 349 slave->mtd.name = parts[i].name; 350 - slave->mtd.bank_size = master->bank_size; 351 350 slave->mtd.owner = master->owner; 352 351 353 352 slave->mtd.read = part_read;
+16 -5
drivers/mtd/nand/Kconfig
··· 232 232 will be named "excite_nandflash.ko". 233 233 234 234 config MTD_NAND_CAFE 235 - tristate "NAND support for OLPC CAFÉ chip" 236 - depends on PCI 237 - help 238 - Use NAND flash attached to the CAFÉ chip designed for the $100 239 - laptop. 235 + tristate "NAND support for OLPC CAFÉ chip" 236 + depends on PCI 237 + select REED_SOLOMON 238 + select REED_SOLOMON_DEC16 239 + help 240 + Use NAND flash attached to the CAFÉ chip designed for the $100 241 + laptop. 240 242 241 243 config MTD_NAND_CS553X 242 244 tristate "NAND support for CS5535/CS5536 (AMD Geode companion chip)" ··· 271 269 help 272 270 The simulator may simulate various NAND flash chips for the 273 271 MTD nand layer. 272 + 273 + config MTD_NAND_PLATFORM 274 + tristate "Support for generic platform NAND driver" 275 + depends on MTD_NAND 276 + help 277 + This implements a generic NAND driver for on-SOC platform 278 + devices. You will need to provide platform-specific functions 279 + via platform_data. 280 + 274 281 275 282 endif # MTD_NAND
+1 -1
drivers/mtd/nand/Makefile
··· 26 26 obj-$(CONFIG_MTD_NAND_AT91) += at91_nand.o 27 27 obj-$(CONFIG_MTD_NAND_CM_X270) += cmx270_nand.o 28 28 obj-$(CONFIG_MTD_NAND_BASLER_EXCITE) += excite_nandflash.o 29 + obj-$(CONFIG_MTD_NAND_PLATFORM) += plat_nand.o 29 30 30 31 nand-objs := nand_base.o nand_bbt.o 31 - cafe_nand-objs := cafe.o cafe_ecc.o
+10
drivers/mtd/nand/at91_nand.c
··· 82 82 at91_set_gpio_value(host->board->enable_pin, 1); 83 83 } 84 84 85 + #ifdef CONFIG_MTD_PARTITIONS 86 + const char *part_probes[] = { "cmdlinepart", NULL }; 87 + #endif 88 + 85 89 /* 86 90 * Probe for the NAND device. 87 91 */ ··· 155 151 #ifdef CONFIG_MTD_PARTITIONS 156 152 if (host->board->partition_info) 157 153 partitions = host->board->partition_info(mtd->size, &num_partitions); 154 + #ifdef CONFIG_MTD_CMDLINE_PARTS 155 + else { 156 + mtd->name = "at91_nand"; 157 + num_partitions = parse_mtd_partitions(mtd, part_probes, &partitions, 0); 158 + } 159 + #endif 158 160 159 161 if ((!partitions) || (num_partitions == 0)) { 160 162 printk(KERN_ERR "at91_nand: No parititions defined, or unsupported device.\n");
+117 -20
drivers/mtd/nand/cafe.c drivers/mtd/nand/cafe_nand.c
··· 11 11 #undef DEBUG 12 12 #include <linux/mtd/mtd.h> 13 13 #include <linux/mtd/nand.h> 14 + #include <linux/rslib.h> 14 15 #include <linux/pci.h> 15 16 #include <linux/delay.h> 16 17 #include <linux/interrupt.h> ··· 47 46 #define CAFE_GLOBAL_IRQ_MASK 0x300c 48 47 #define CAFE_NAND_RESET 0x3034 49 48 50 - int cafe_correct_ecc(unsigned char *buf, 51 - unsigned short *chk_syndrome_list); 49 + /* Missing from the datasheet: bit 19 of CTRL1 sets CE0 vs. CE1 */ 50 + #define CTRL1_CHIPSELECT (1<<19) 52 51 53 52 struct cafe_priv { 54 53 struct nand_chip nand; 55 54 struct pci_dev *pdev; 56 55 void __iomem *mmio; 56 + struct rs_control *rs; 57 57 uint32_t ctl1; 58 58 uint32_t ctl2; 59 59 int datalen; ··· 197 195 198 196 cafe->data_pos = cafe->datalen = 0; 199 197 200 - /* Set command valid bit */ 201 - ctl1 = 0x80000000 | command; 198 + /* Set command valid bit, mask in the chip select bit */ 199 + ctl1 = 0x80000000 | command | (cafe->ctl1 & CTRL1_CHIPSELECT); 202 200 203 201 /* Set RD or WR bits as appropriate */ 204 202 if (command == NAND_CMD_READID || command == NAND_CMD_STATUS) { ··· 311 309 312 310 static void cafe_select_chip(struct mtd_info *mtd, int chipnr) 313 311 { 314 - //struct cafe_priv *cafe = mtd->priv; 315 - // cafe_dev_dbg(&cafe->pdev->dev, "select_chip %d\n", chipnr); 312 + struct cafe_priv *cafe = mtd->priv; 313 + 314 + cafe_dev_dbg(&cafe->pdev->dev, "select_chip %d\n", chipnr); 315 + 316 + /* Mask the appropriate bit into the stored value of ctl1 317 + which will be used by cafe_nand_cmdfunc() */ 318 + if (chipnr) 319 + cafe->ctl1 |= CTRL1_CHIPSELECT; 320 + else 321 + cafe->ctl1 &= ~CTRL1_CHIPSELECT; 316 322 } 317 323 318 324 static int cafe_nand_interrupt(int irq, void *id) ··· 384 374 chip->read_buf(mtd, chip->oob_poi, mtd->oobsize); 385 375 386 376 if (checkecc && cafe_readl(cafe, NAND_ECC_RESULT) & (1<<18)) { 387 - unsigned short syn[8]; 388 - int i; 377 + unsigned short syn[8], pat[4]; 378 + int pos[4]; 379 + u8 *oob = chip->oob_poi; 380 + int i, n; 389 381 390 382 for (i=0; i<8; i+=2) { 391 383 uint32_t tmp = cafe_readl(cafe, NAND_ECC_SYN01 + (i*2)); 392 - syn[i] = tmp & 0xfff; 393 - syn[i+1] = (tmp >> 16) & 0xfff; 384 + syn[i] = cafe->rs->index_of[tmp & 0xfff]; 385 + syn[i+1] = cafe->rs->index_of[(tmp >> 16) & 0xfff]; 394 386 } 395 387 396 - if ((i = cafe_correct_ecc(buf, syn)) < 0) { 388 + n = decode_rs16(cafe->rs, NULL, NULL, 1367, syn, 0, pos, 0, 389 + pat); 390 + 391 + for (i = 0; i < n; i++) { 392 + int p = pos[i]; 393 + 394 + /* The 12-bit symbols are mapped to bytes here */ 395 + 396 + if (p > 1374) { 397 + /* out of range */ 398 + n = -1374; 399 + } else if (p == 0) { 400 + /* high four bits do not correspond to data */ 401 + if (pat[i] > 0xff) 402 + n = -2048; 403 + else 404 + buf[0] ^= pat[i]; 405 + } else if (p == 1365) { 406 + buf[2047] ^= pat[i] >> 4; 407 + oob[0] ^= pat[i] << 4; 408 + } else if (p > 1365) { 409 + if ((p & 1) == 1) { 410 + oob[3*p/2 - 2048] ^= pat[i] >> 4; 411 + oob[3*p/2 - 2047] ^= pat[i] << 4; 412 + } else { 413 + oob[3*p/2 - 2049] ^= pat[i] >> 8; 414 + oob[3*p/2 - 2048] ^= pat[i]; 415 + } 416 + } else if ((p & 1) == 1) { 417 + buf[3*p/2] ^= pat[i] >> 4; 418 + buf[3*p/2 + 1] ^= pat[i] << 4; 419 + } else { 420 + buf[3*p/2 - 1] ^= pat[i] >> 8; 421 + buf[3*p/2] ^= pat[i]; 422 + } 423 + } 424 + 425 + if (n < 0) { 397 426 dev_dbg(&cafe->pdev->dev, "Failed to correct ECC at %08x\n", 398 427 cafe_readl(cafe, NAND_ADDR2) * 2048); 399 - for (i=0; i< 0x5c; i+=4) 428 + for (i = 0; i < 0x5c; i += 4) 400 429 printk("Register %x: %08x\n", i, readl(cafe->mmio + i)); 401 430 mtd->ecc_stats.failed++; 402 431 } else { 403 - dev_dbg(&cafe->pdev->dev, "Corrected %d symbol errors\n", i); 404 - mtd->ecc_stats.corrected += i; 432 + dev_dbg(&cafe->pdev->dev, "Corrected %d symbol errors\n", n); 433 + mtd->ecc_stats.corrected += n; 405 434 } 406 435 } 407 - 408 436 409 437 return 0; 410 438 } ··· 464 416 465 417 static struct nand_bbt_descr cafe_bbt_main_descr_2048 = { 466 418 .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE 467 - | NAND_BBT_2BIT | NAND_BBT_VERSION | NAND_BBT_PERCHIP, 419 + | NAND_BBT_2BIT | NAND_BBT_VERSION, 468 420 .offs = 14, 469 421 .len = 4, 470 422 .veroffs = 18, ··· 474 426 475 427 static struct nand_bbt_descr cafe_bbt_mirror_descr_2048 = { 476 428 .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE 477 - | NAND_BBT_2BIT | NAND_BBT_VERSION | NAND_BBT_PERCHIP, 429 + | NAND_BBT_2BIT | NAND_BBT_VERSION, 478 430 .offs = 14, 479 431 .len = 4, 480 432 .veroffs = 18, ··· 490 442 491 443 static struct nand_bbt_descr cafe_bbt_main_descr_512 = { 492 444 .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE 493 - | NAND_BBT_2BIT | NAND_BBT_VERSION | NAND_BBT_PERCHIP, 445 + | NAND_BBT_2BIT | NAND_BBT_VERSION, 494 446 .offs = 14, 495 447 .len = 1, 496 448 .veroffs = 15, ··· 500 452 501 453 static struct nand_bbt_descr cafe_bbt_mirror_descr_512 = { 502 454 .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE 503 - | NAND_BBT_2BIT | NAND_BBT_VERSION | NAND_BBT_PERCHIP, 455 + | NAND_BBT_2BIT | NAND_BBT_VERSION, 504 456 .offs = 14, 505 457 .len = 1, 506 458 .veroffs = 15, ··· 573 525 return 0; 574 526 } 575 527 528 + /* F_2[X]/(X**6+X+1) */ 529 + static unsigned short __devinit gf64_mul(u8 a, u8 b) 530 + { 531 + u8 c; 532 + unsigned int i; 533 + 534 + c = 0; 535 + for (i = 0; i < 6; i++) { 536 + if (a & 1) 537 + c ^= b; 538 + a >>= 1; 539 + b <<= 1; 540 + if ((b & 0x40) != 0) 541 + b ^= 0x43; 542 + } 543 + 544 + return c; 545 + } 546 + 547 + /* F_64[X]/(X**2+X+A**-1) with A the generator of F_64[X] */ 548 + static u16 __devinit gf4096_mul(u16 a, u16 b) 549 + { 550 + u8 ah, al, bh, bl, ch, cl; 551 + 552 + ah = a >> 6; 553 + al = a & 0x3f; 554 + bh = b >> 6; 555 + bl = b & 0x3f; 556 + 557 + ch = gf64_mul(ah ^ al, bh ^ bl) ^ gf64_mul(al, bl); 558 + cl = gf64_mul(gf64_mul(ah, bh), 0x21) ^ gf64_mul(al, bl); 559 + 560 + return (ch << 6) ^ cl; 561 + } 562 + 563 + static int __devinit cafe_mul(int x) 564 + { 565 + if (x == 0) 566 + return 1; 567 + return gf4096_mul(x, 0xe01); 568 + } 569 + 576 570 static int __devinit cafe_nand_probe(struct pci_dev *pdev, 577 571 const struct pci_device_id *ent) 578 572 { ··· 653 563 goto out_ior; 654 564 } 655 565 cafe->nand.buffers = (void *)cafe->dmabuf + 2112; 566 + 567 + cafe->rs = init_rs_non_canonical(12, &cafe_mul, 0, 1, 8); 568 + if (!cafe->rs) { 569 + err = -ENOMEM; 570 + goto out_ior; 571 + } 656 572 657 573 cafe->nand.cmdfunc = cafe_nand_cmdfunc; 658 574 cafe->nand.dev_ready = cafe_device_ready; ··· 742 646 cafe_readl(cafe, GLOBAL_CTRL), cafe_readl(cafe, GLOBAL_IRQ_MASK)); 743 647 744 648 /* Scan to find existence of the device */ 745 - if (nand_scan_ident(mtd, 1)) { 649 + if (nand_scan_ident(mtd, 2)) { 746 650 err = -ENXIO; 747 651 goto out_irq; 748 652 } ··· 809 713 cafe_writel(cafe, ~1 & cafe_readl(cafe, GLOBAL_IRQ_MASK), GLOBAL_IRQ_MASK); 810 714 free_irq(pdev->irq, mtd); 811 715 nand_release(mtd); 716 + free_rs(cafe->rs); 812 717 pci_iounmap(pdev, cafe->mmio); 813 718 dma_free_coherent(&cafe->pdev->dev, 2112, cafe->dmabuf, cafe->dmaaddr); 814 719 kfree(mtd);
-1381
drivers/mtd/nand/cafe_ecc.c
··· 1 - /* Error correction for CAFÉ NAND controller 2 - * 3 - * © 2006 Marvell, Inc. 4 - * Author: Tom Chiou 5 - * 6 - * This program is free software; you can redistribute it and/or modify it 7 - * under the terms of the GNU General Public License as published by the Free 8 - * Software Foundation; either version 2 of the License, or (at your option) 9 - * any later version. 10 - * 11 - * This program is distributed in the hope that it will be useful, but WITHOUT 12 - * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 13 - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 14 - * more details. 15 - * 16 - * You should have received a copy of the GNU General Public License along with 17 - * this program; if not, write to the Free Software Foundation, Inc., 59 18 - * Temple Place - Suite 330, Boston, MA 02111-1307, USA. 19 - */ 20 - 21 - #include <linux/kernel.h> 22 - #include <linux/module.h> 23 - #include <linux/errno.h> 24 - 25 - static unsigned short gf4096_mul(unsigned short, unsigned short); 26 - static unsigned short gf64_mul(unsigned short, unsigned short); 27 - static unsigned short gf4096_inv(unsigned short); 28 - static unsigned short err_pos(unsigned short); 29 - static void find_4bit_err_coefs(unsigned short, unsigned short, unsigned short, 30 - unsigned short, unsigned short, unsigned short, 31 - unsigned short, unsigned short, unsigned short *); 32 - static void zero_4x5_col3(unsigned short[4][5]); 33 - static void zero_4x5_col2(unsigned short[4][5]); 34 - static void zero_4x5_col1(unsigned short[4][5]); 35 - static void swap_4x5_rows(unsigned short[4][5], int, int, int); 36 - static void swap_2x3_rows(unsigned short m[2][3]); 37 - static void solve_4x5(unsigned short m[4][5], unsigned short *, int *); 38 - static void sort_coefs(int *, unsigned short *, int); 39 - static void find_4bit_err_pats(unsigned short, unsigned short, unsigned short, 40 - unsigned short, unsigned short, unsigned short, 41 - unsigned short, unsigned short, unsigned short *); 42 - static void find_3bit_err_coefs(unsigned short, unsigned short, unsigned short, 43 - unsigned short, unsigned short, unsigned short, 44 - unsigned short *); 45 - static void zero_3x4_col2(unsigned short[3][4]); 46 - static void zero_3x4_col1(unsigned short[3][4]); 47 - static void swap_3x4_rows(unsigned short[3][4], int, int, int); 48 - static void solve_3x4(unsigned short[3][4], unsigned short *, int *); 49 - static void find_3bit_err_pats(unsigned short, unsigned short, unsigned short, 50 - unsigned short, unsigned short, unsigned short, 51 - unsigned short *); 52 - 53 - static void find_2bit_err_pats(unsigned short, unsigned short, unsigned short, 54 - unsigned short, unsigned short *); 55 - static void find_2x2_soln(unsigned short, unsigned short, unsigned short, 56 - unsigned short, unsigned short, unsigned short, 57 - unsigned short *); 58 - static void solve_2x3(unsigned short[2][3], unsigned short *); 59 - static int chk_no_err_only(unsigned short *, unsigned short *); 60 - static int chk_1_err_only(unsigned short *, unsigned short *); 61 - static int chk_2_err_only(unsigned short *, unsigned short *); 62 - static int chk_3_err_only(unsigned short *, unsigned short *); 63 - static int chk_4_err_only(unsigned short *, unsigned short *); 64 - 65 - static unsigned short gf64_mul(unsigned short a, unsigned short b) 66 - { 67 - unsigned short tmp1, tmp2, tmp3, tmp4, tmp5; 68 - unsigned short c_bit0, c_bit1, c_bit2, c_bit3, c_bit4, c_bit5, c; 69 - 70 - tmp1 = ((a) ^ (a >> 5)); 71 - tmp2 = ((a >> 4) ^ (a >> 5)); 72 - tmp3 = ((a >> 3) ^ (a >> 4)); 73 - tmp4 = ((a >> 2) ^ (a >> 3)); 74 - tmp5 = ((a >> 1) ^ (a >> 2)); 75 - 76 - c_bit0 = ((a & b) ^ ((a >> 5) & (b >> 1)) ^ ((a >> 4) & (b >> 2)) ^ 77 - ((a >> 3) & (b >> 3)) ^ ((a >> 2) & (b >> 4)) ^ ((a >> 1) & (b >> 5))) & 0x1; 78 - 79 - c_bit1 = (((a >> 1) & b) ^ (tmp1 & (b >> 1)) ^ (tmp2 & (b >> 2)) ^ 80 - (tmp3 & (b >> 3)) ^ (tmp4 & (b >> 4)) ^ (tmp5 & (b >> 5))) & 0x1; 81 - 82 - c_bit2 = (((a >> 2) & b) ^ ((a >> 1) & (b >> 1)) ^ (tmp1 & (b >> 2)) ^ 83 - (tmp2 & (b >> 3)) ^ (tmp3 & (b >> 4)) ^ (tmp4 & (b >> 5))) & 0x1; 84 - 85 - c_bit3 = (((a >> 3) & b) ^ ((a >> 2) & (b >> 1)) ^ ((a >> 1) & (b >> 2)) ^ 86 - (tmp1 & (b >> 3)) ^ (tmp2 & (b >> 4)) ^ (tmp3 & (b >> 5))) & 0x1; 87 - 88 - c_bit4 = (((a >> 4) & b) ^ ((a >> 3) & (b >> 1)) ^ ((a >> 2) & (b >> 2)) ^ 89 - ((a >> 1) & (b >> 3)) ^ (tmp1 & (b >> 4)) ^ (tmp2 & (b >> 5))) & 0x1; 90 - 91 - c_bit5 = (((a >> 5) & b) ^ ((a >> 4) & (b >> 1)) ^ ((a >> 3) & (b >> 2)) ^ 92 - ((a >> 2) & (b >> 3)) ^ ((a >> 1) & (b >> 4)) ^ (tmp1 & (b >> 5))) & 0x1; 93 - 94 - c = c_bit0 | (c_bit1 << 1) | (c_bit2 << 2) | (c_bit3 << 3) | (c_bit4 << 4) | (c_bit5 << 5); 95 - 96 - return c; 97 - } 98 - 99 - static unsigned short gf4096_mul(unsigned short a, unsigned short b) 100 - { 101 - unsigned short ah, al, bh, bl, alxah, blxbh, ablh, albl, ahbh, ahbhB, c; 102 - 103 - ah = (a >> 6) & 0x3f; 104 - al = a & 0x3f; 105 - bh = (b >> 6) & 0x3f; 106 - bl = b & 0x3f; 107 - alxah = al ^ ah; 108 - blxbh = bl ^ bh; 109 - 110 - ablh = gf64_mul(alxah, blxbh); 111 - albl = gf64_mul(al, bl); 112 - ahbh = gf64_mul(ah, bh); 113 - 114 - ahbhB = ((ahbh & 0x1) << 5) | 115 - ((ahbh & 0x20) >> 1) | 116 - ((ahbh & 0x10) >> 1) | ((ahbh & 0x8) >> 1) | ((ahbh & 0x4) >> 1) | (((ahbh >> 1) ^ ahbh) & 0x1); 117 - 118 - c = ((ablh ^ albl) << 6) | (ahbhB ^ albl); 119 - return c; 120 - } 121 - 122 - static void find_2bit_err_pats(unsigned short s0, unsigned short s1, unsigned short r0, unsigned short r1, unsigned short *pats) 123 - { 124 - find_2x2_soln(0x1, 0x1, r0, r1, s0, s1, pats); 125 - } 126 - 127 - static void find_3bit_err_coefs(unsigned short s0, unsigned short s1, 128 - unsigned short s2, unsigned short s3, unsigned short s4, unsigned short s5, unsigned short *coefs) 129 - { 130 - unsigned short m[3][4]; 131 - int row_order[3]; 132 - 133 - row_order[0] = 0; 134 - row_order[1] = 1; 135 - row_order[2] = 2; 136 - m[0][0] = s2; 137 - m[0][1] = s1; 138 - m[0][2] = s0; 139 - m[0][3] = s3; 140 - m[1][0] = s3; 141 - m[1][1] = s2; 142 - m[1][2] = s1; 143 - m[1][3] = s4; 144 - m[2][0] = s4; 145 - m[2][1] = s3; 146 - m[2][2] = s2; 147 - m[2][3] = s5; 148 - 149 - if (m[0][2] != 0x0) { 150 - zero_3x4_col2(m); 151 - } else if (m[1][2] != 0x0) { 152 - swap_3x4_rows(m, 0, 1, 4); 153 - zero_3x4_col2(m); 154 - } else if (m[2][2] != 0x0) { 155 - swap_3x4_rows(m, 0, 2, 4); 156 - zero_3x4_col2(m); 157 - } else { 158 - printk(KERN_ERR "Error: find_3bit_err_coefs, s0,s1,s2 all zeros!\n"); 159 - } 160 - 161 - if (m[1][1] != 0x0) { 162 - zero_3x4_col1(m); 163 - } else if (m[2][1] != 0x0) { 164 - swap_3x4_rows(m, 1, 2, 4); 165 - zero_3x4_col1(m); 166 - } else { 167 - printk(KERN_ERR "Error: find_3bit_err_coefs, cannot resolve col 1!\n"); 168 - } 169 - 170 - /* solve coefs */ 171 - solve_3x4(m, coefs, row_order); 172 - } 173 - 174 - static void zero_3x4_col2(unsigned short m[3][4]) 175 - { 176 - unsigned short minv1, minv2; 177 - 178 - minv1 = gf4096_mul(m[1][2], gf4096_inv(m[0][2])); 179 - minv2 = gf4096_mul(m[2][2], gf4096_inv(m[0][2])); 180 - m[1][0] = m[1][0] ^ gf4096_mul(m[0][0], minv1); 181 - m[1][1] = m[1][1] ^ gf4096_mul(m[0][1], minv1); 182 - m[1][3] = m[1][3] ^ gf4096_mul(m[0][3], minv1); 183 - m[2][0] = m[2][0] ^ gf4096_mul(m[0][0], minv2); 184 - m[2][1] = m[2][1] ^ gf4096_mul(m[0][1], minv2); 185 - m[2][3] = m[2][3] ^ gf4096_mul(m[0][3], minv2); 186 - } 187 - 188 - static void zero_3x4_col1(unsigned short m[3][4]) 189 - { 190 - unsigned short minv; 191 - minv = gf4096_mul(m[2][1], gf4096_inv(m[1][1])); 192 - m[2][0] = m[2][0] ^ gf4096_mul(m[1][0], minv); 193 - m[2][3] = m[2][3] ^ gf4096_mul(m[1][3], minv); 194 - } 195 - 196 - static void swap_3x4_rows(unsigned short m[3][4], int i, int j, int col_width) 197 - { 198 - unsigned short tmp0; 199 - int cnt; 200 - for (cnt = 0; cnt < col_width; cnt++) { 201 - tmp0 = m[i][cnt]; 202 - m[i][cnt] = m[j][cnt]; 203 - m[j][cnt] = tmp0; 204 - } 205 - } 206 - 207 - static void solve_3x4(unsigned short m[3][4], unsigned short *coefs, int *row_order) 208 - { 209 - unsigned short tmp[3]; 210 - tmp[0] = gf4096_mul(m[2][3], gf4096_inv(m[2][0])); 211 - tmp[1] = gf4096_mul((gf4096_mul(tmp[0], m[1][0]) ^ m[1][3]), gf4096_inv(m[1][1])); 212 - tmp[2] = gf4096_mul((gf4096_mul(tmp[0], m[0][0]) ^ gf4096_mul(tmp[1], m[0][1]) ^ m[0][3]), gf4096_inv(m[0][2])); 213 - sort_coefs(row_order, tmp, 3); 214 - coefs[0] = tmp[0]; 215 - coefs[1] = tmp[1]; 216 - coefs[2] = tmp[2]; 217 - } 218 - 219 - static void find_3bit_err_pats(unsigned short s0, unsigned short s1, 220 - unsigned short s2, unsigned short r0, 221 - unsigned short r1, unsigned short r2, 222 - unsigned short *pats) 223 - { 224 - find_2x2_soln(r0 ^ r2, r1 ^ r2, 225 - gf4096_mul(r0, r0 ^ r2), gf4096_mul(r1, r1 ^ r2), 226 - gf4096_mul(s0, r2) ^ s1, gf4096_mul(s1, r2) ^ s2, pats); 227 - pats[2] = s0 ^ pats[0] ^ pats[1]; 228 - } 229 - 230 - static void find_4bit_err_coefs(unsigned short s0, unsigned short s1, 231 - unsigned short s2, unsigned short s3, 232 - unsigned short s4, unsigned short s5, 233 - unsigned short s6, unsigned short s7, 234 - unsigned short *coefs) 235 - { 236 - unsigned short m[4][5]; 237 - int row_order[4]; 238 - 239 - row_order[0] = 0; 240 - row_order[1] = 1; 241 - row_order[2] = 2; 242 - row_order[3] = 3; 243 - 244 - m[0][0] = s3; 245 - m[0][1] = s2; 246 - m[0][2] = s1; 247 - m[0][3] = s0; 248 - m[0][4] = s4; 249 - m[1][0] = s4; 250 - m[1][1] = s3; 251 - m[1][2] = s2; 252 - m[1][3] = s1; 253 - m[1][4] = s5; 254 - m[2][0] = s5; 255 - m[2][1] = s4; 256 - m[2][2] = s3; 257 - m[2][3] = s2; 258 - m[2][4] = s6; 259 - m[3][0] = s6; 260 - m[3][1] = s5; 261 - m[3][2] = s4; 262 - m[3][3] = s3; 263 - m[3][4] = s7; 264 - 265 - if (m[0][3] != 0x0) { 266 - zero_4x5_col3(m); 267 - } else if (m[1][3] != 0x0) { 268 - swap_4x5_rows(m, 0, 1, 5); 269 - zero_4x5_col3(m); 270 - } else if (m[2][3] != 0x0) { 271 - swap_4x5_rows(m, 0, 2, 5); 272 - zero_4x5_col3(m); 273 - } else if (m[3][3] != 0x0) { 274 - swap_4x5_rows(m, 0, 3, 5); 275 - zero_4x5_col3(m); 276 - } else { 277 - printk(KERN_ERR "Error: find_4bit_err_coefs, s0,s1,s2,s3 all zeros!\n"); 278 - } 279 - 280 - if (m[1][2] != 0x0) { 281 - zero_4x5_col2(m); 282 - } else if (m[2][2] != 0x0) { 283 - swap_4x5_rows(m, 1, 2, 5); 284 - zero_4x5_col2(m); 285 - } else if (m[3][2] != 0x0) { 286 - swap_4x5_rows(m, 1, 3, 5); 287 - zero_4x5_col2(m); 288 - } else { 289 - printk(KERN_ERR "Error: find_4bit_err_coefs, cannot resolve col 2!\n"); 290 - } 291 - 292 - if (m[2][1] != 0x0) { 293 - zero_4x5_col1(m); 294 - } else if (m[3][1] != 0x0) { 295 - swap_4x5_rows(m, 2, 3, 5); 296 - zero_4x5_col1(m); 297 - } else { 298 - printk(KERN_ERR "Error: find_4bit_err_coefs, cannot resolve col 1!\n"); 299 - } 300 - 301 - solve_4x5(m, coefs, row_order); 302 - } 303 - 304 - static void zero_4x5_col3(unsigned short m[4][5]) 305 - { 306 - unsigned short minv1, minv2, minv3; 307 - 308 - minv1 = gf4096_mul(m[1][3], gf4096_inv(m[0][3])); 309 - minv2 = gf4096_mul(m[2][3], gf4096_inv(m[0][3])); 310 - minv3 = gf4096_mul(m[3][3], gf4096_inv(m[0][3])); 311 - 312 - m[1][0] = m[1][0] ^ gf4096_mul(m[0][0], minv1); 313 - m[1][1] = m[1][1] ^ gf4096_mul(m[0][1], minv1); 314 - m[1][2] = m[1][2] ^ gf4096_mul(m[0][2], minv1); 315 - m[1][4] = m[1][4] ^ gf4096_mul(m[0][4], minv1); 316 - m[2][0] = m[2][0] ^ gf4096_mul(m[0][0], minv2); 317 - m[2][1] = m[2][1] ^ gf4096_mul(m[0][1], minv2); 318 - m[2][2] = m[2][2] ^ gf4096_mul(m[0][2], minv2); 319 - m[2][4] = m[2][4] ^ gf4096_mul(m[0][4], minv2); 320 - m[3][0] = m[3][0] ^ gf4096_mul(m[0][0], minv3); 321 - m[3][1] = m[3][1] ^ gf4096_mul(m[0][1], minv3); 322 - m[3][2] = m[3][2] ^ gf4096_mul(m[0][2], minv3); 323 - m[3][4] = m[3][4] ^ gf4096_mul(m[0][4], minv3); 324 - } 325 - 326 - static void zero_4x5_col2(unsigned short m[4][5]) 327 - { 328 - unsigned short minv2, minv3; 329 - 330 - minv2 = gf4096_mul(m[2][2], gf4096_inv(m[1][2])); 331 - minv3 = gf4096_mul(m[3][2], gf4096_inv(m[1][2])); 332 - 333 - m[2][0] = m[2][0] ^ gf4096_mul(m[1][0], minv2); 334 - m[2][1] = m[2][1] ^ gf4096_mul(m[1][1], minv2); 335 - m[2][4] = m[2][4] ^ gf4096_mul(m[1][4], minv2); 336 - m[3][0] = m[3][0] ^ gf4096_mul(m[1][0], minv3); 337 - m[3][1] = m[3][1] ^ gf4096_mul(m[1][1], minv3); 338 - m[3][4] = m[3][4] ^ gf4096_mul(m[1][4], minv3); 339 - } 340 - 341 - static void zero_4x5_col1(unsigned short m[4][5]) 342 - { 343 - unsigned short minv; 344 - 345 - minv = gf4096_mul(m[3][1], gf4096_inv(m[2][1])); 346 - 347 - m[3][0] = m[3][0] ^ gf4096_mul(m[2][0], minv); 348 - m[3][4] = m[3][4] ^ gf4096_mul(m[2][4], minv); 349 - } 350 - 351 - static void swap_4x5_rows(unsigned short m[4][5], int i, int j, int col_width) 352 - { 353 - unsigned short tmp0; 354 - int cnt; 355 - 356 - for (cnt = 0; cnt < col_width; cnt++) { 357 - tmp0 = m[i][cnt]; 358 - m[i][cnt] = m[j][cnt]; 359 - m[j][cnt] = tmp0; 360 - } 361 - } 362 - 363 - static void solve_4x5(unsigned short m[4][5], unsigned short *coefs, int *row_order) 364 - { 365 - unsigned short tmp[4]; 366 - 367 - tmp[0] = gf4096_mul(m[3][4], gf4096_inv(m[3][0])); 368 - tmp[1] = gf4096_mul((gf4096_mul(tmp[0], m[2][0]) ^ m[2][4]), gf4096_inv(m[2][1])); 369 - tmp[2] = gf4096_mul((gf4096_mul(tmp[0], m[1][0]) ^ gf4096_mul(tmp[1], m[1][1]) ^ m[1][4]), gf4096_inv(m[1][2])); 370 - tmp[3] = gf4096_mul((gf4096_mul(tmp[0], m[0][0]) ^ 371 - gf4096_mul(tmp[1], m[0][1]) ^ gf4096_mul(tmp[2], m[0][2]) ^ m[0][4]), gf4096_inv(m[0][3])); 372 - sort_coefs(row_order, tmp, 4); 373 - coefs[0] = tmp[0]; 374 - coefs[1] = tmp[1]; 375 - coefs[2] = tmp[2]; 376 - coefs[3] = tmp[3]; 377 - } 378 - 379 - static void sort_coefs(int *order, unsigned short *soln, int len) 380 - { 381 - int cnt, start_cnt, least_ord, least_cnt; 382 - unsigned short tmp0; 383 - for (start_cnt = 0; start_cnt < len; start_cnt++) { 384 - for (cnt = start_cnt; cnt < len; cnt++) { 385 - if (cnt == start_cnt) { 386 - least_ord = order[cnt]; 387 - least_cnt = start_cnt; 388 - } else { 389 - if (least_ord > order[cnt]) { 390 - least_ord = order[cnt]; 391 - least_cnt = cnt; 392 - } 393 - } 394 - } 395 - if (least_cnt != start_cnt) { 396 - tmp0 = order[least_cnt]; 397 - order[least_cnt] = order[start_cnt]; 398 - order[start_cnt] = tmp0; 399 - tmp0 = soln[least_cnt]; 400 - soln[least_cnt] = soln[start_cnt]; 401 - soln[start_cnt] = tmp0; 402 - } 403 - } 404 - } 405 - 406 - static void find_4bit_err_pats(unsigned short s0, unsigned short s1, 407 - unsigned short s2, unsigned short s3, 408 - unsigned short z1, unsigned short z2, 409 - unsigned short z3, unsigned short z4, 410 - unsigned short *pats) 411 - { 412 - unsigned short z4_z1, z3z4_z3z3, z4_z2, s0z4_s1, z1z4_z1z1, 413 - z4_z3, z2z4_z2z2, s1z4_s2, z3z3z4_z3z3z3, z1z1z4_z1z1z1, z2z2z4_z2z2z2, s2z4_s3; 414 - unsigned short tmp0, tmp1, tmp2, tmp3; 415 - 416 - z4_z1 = z4 ^ z1; 417 - z3z4_z3z3 = gf4096_mul(z3, z4) ^ gf4096_mul(z3, z3); 418 - z4_z2 = z4 ^ z2; 419 - s0z4_s1 = gf4096_mul(s0, z4) ^ s1; 420 - z1z4_z1z1 = gf4096_mul(z1, z4) ^ gf4096_mul(z1, z1); 421 - z4_z3 = z4 ^ z3; 422 - z2z4_z2z2 = gf4096_mul(z2, z4) ^ gf4096_mul(z2, z2); 423 - s1z4_s2 = gf4096_mul(s1, z4) ^ s2; 424 - z3z3z4_z3z3z3 = gf4096_mul(gf4096_mul(z3, z3), z4) ^ gf4096_mul(gf4096_mul(z3, z3), z3); 425 - z1z1z4_z1z1z1 = gf4096_mul(gf4096_mul(z1, z1), z4) ^ gf4096_mul(gf4096_mul(z1, z1), z1); 426 - z2z2z4_z2z2z2 = gf4096_mul(gf4096_mul(z2, z2), z4) ^ gf4096_mul(gf4096_mul(z2, z2), z2); 427 - s2z4_s3 = gf4096_mul(s2, z4) ^ s3; 428 - 429 - //find err pat 0,1 430 - find_2x2_soln(gf4096_mul(z4_z1, z3z4_z3z3) ^ 431 - gf4096_mul(z1z4_z1z1, z4_z3), gf4096_mul(z4_z2, 432 - z3z4_z3z3) ^ 433 - gf4096_mul(z2z4_z2z2, z4_z3), gf4096_mul(z1z4_z1z1, 434 - z3z3z4_z3z3z3) ^ 435 - gf4096_mul(z1z1z4_z1z1z1, z3z4_z3z3), 436 - gf4096_mul(z2z4_z2z2, 437 - z3z3z4_z3z3z3) ^ gf4096_mul(z2z2z4_z2z2z2, 438 - z3z4_z3z3), 439 - gf4096_mul(s0z4_s1, z3z4_z3z3) ^ gf4096_mul(s1z4_s2, 440 - z4_z3), 441 - gf4096_mul(s1z4_s2, z3z3z4_z3z3z3) ^ gf4096_mul(s2z4_s3, z3z4_z3z3), pats); 442 - tmp0 = pats[0]; 443 - tmp1 = pats[1]; 444 - tmp2 = pats[0] ^ pats[1] ^ s0; 445 - tmp3 = gf4096_mul(pats[0], z1) ^ gf4096_mul(pats[1], z2) ^ s1; 446 - 447 - //find err pat 2,3 448 - find_2x2_soln(0x1, 0x1, z3, z4, tmp2, tmp3, pats); 449 - pats[2] = pats[0]; 450 - pats[3] = pats[1]; 451 - pats[0] = tmp0; 452 - pats[1] = tmp1; 453 - } 454 - 455 - static void find_2x2_soln(unsigned short c00, unsigned short c01, 456 - unsigned short c10, unsigned short c11, 457 - unsigned short lval0, unsigned short lval1, 458 - unsigned short *soln) 459 - { 460 - unsigned short m[2][3]; 461 - m[0][0] = c00; 462 - m[0][1] = c01; 463 - m[0][2] = lval0; 464 - m[1][0] = c10; 465 - m[1][1] = c11; 466 - m[1][2] = lval1; 467 - 468 - if (m[0][1] != 0x0) { 469 - /* */ 470 - } else if (m[1][1] != 0x0) { 471 - swap_2x3_rows(m); 472 - } else { 473 - printk(KERN_ERR "Warning: find_2bit_err_coefs, s0,s1 all zeros!\n"); 474 - } 475 - 476 - solve_2x3(m, soln); 477 - } 478 - 479 - static void swap_2x3_rows(unsigned short m[2][3]) 480 - { 481 - unsigned short tmp0; 482 - int cnt; 483 - 484 - for (cnt = 0; cnt < 3; cnt++) { 485 - tmp0 = m[0][cnt]; 486 - m[0][cnt] = m[1][cnt]; 487 - m[1][cnt] = tmp0; 488 - } 489 - } 490 - 491 - static void solve_2x3(unsigned short m[2][3], unsigned short *coefs) 492 - { 493 - unsigned short minv; 494 - 495 - minv = gf4096_mul(m[1][1], gf4096_inv(m[0][1])); 496 - m[1][0] = m[1][0] ^ gf4096_mul(m[0][0], minv); 497 - m[1][2] = m[1][2] ^ gf4096_mul(m[0][2], minv); 498 - coefs[0] = gf4096_mul(m[1][2], gf4096_inv(m[1][0])); 499 - coefs[1] = gf4096_mul((gf4096_mul(coefs[0], m[0][0]) ^ m[0][2]), gf4096_inv(m[0][1])); 500 - } 501 - 502 - static unsigned char gf64_inv[64] = { 503 - 0, 1, 33, 62, 49, 43, 31, 44, 57, 37, 52, 28, 46, 40, 22, 25, 504 - 61, 54, 51, 39, 26, 35, 14, 24, 23, 15, 20, 34, 11, 53, 45, 6, 505 - 63, 2, 27, 21, 56, 9, 50, 19, 13, 47, 48, 5, 7, 30, 12, 41, 506 - 42, 4, 38, 18, 10, 29, 17, 60, 36, 8, 59, 58, 55, 16, 3, 32 507 - }; 508 - 509 - static unsigned short gf4096_inv(unsigned short din) 510 - { 511 - unsigned short alahxal, ah2B, deno, inv, bl, bh; 512 - unsigned short ah, al, ahxal; 513 - unsigned short dout; 514 - 515 - ah = (din >> 6) & 0x3f; 516 - al = din & 0x3f; 517 - ahxal = ah ^ al; 518 - ah2B = (((ah ^ (ah >> 3)) & 0x1) << 5) | 519 - ((ah >> 1) & 0x10) | 520 - ((((ah >> 5) ^ (ah >> 2)) & 0x1) << 3) | 521 - ((ah >> 2) & 0x4) | ((((ah >> 4) ^ (ah >> 1)) & 0x1) << 1) | (ah & 0x1); 522 - alahxal = gf64_mul(ahxal, al); 523 - deno = alahxal ^ ah2B; 524 - inv = gf64_inv[deno]; 525 - bl = gf64_mul(inv, ahxal); 526 - bh = gf64_mul(inv, ah); 527 - dout = ((bh & 0x3f) << 6) | (bl & 0x3f); 528 - return (((bh & 0x3f) << 6) | (bl & 0x3f)); 529 - } 530 - 531 - static unsigned short err_pos_lut[4096] = { 532 - 0xfff, 0x000, 0x451, 0xfff, 0xfff, 0x3cf, 0xfff, 0x041, 533 - 0xfff, 0xfff, 0xfff, 0xfff, 0x28a, 0xfff, 0x492, 0xfff, 534 - 0x145, 0xfff, 0xfff, 0x514, 0xfff, 0x082, 0xfff, 0xfff, 535 - 0xfff, 0x249, 0x38e, 0x410, 0xfff, 0x104, 0x208, 0x1c7, 536 - 0xfff, 0xfff, 0xfff, 0xfff, 0x2cb, 0xfff, 0xfff, 0xfff, 537 - 0x0c3, 0x34d, 0x4d3, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 538 - 0xfff, 0xfff, 0xfff, 0x186, 0xfff, 0xfff, 0xfff, 0xfff, 539 - 0xfff, 0x30c, 0x555, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 540 - 0xfff, 0xfff, 0xfff, 0x166, 0xfff, 0xfff, 0xfff, 0xfff, 541 - 0x385, 0x14e, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x4e1, 542 - 0xfff, 0xfff, 0xfff, 0xfff, 0x538, 0xfff, 0x16d, 0xfff, 543 - 0xfff, 0xfff, 0x45b, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 544 - 0xfff, 0xfff, 0xfff, 0x29c, 0x2cc, 0x30b, 0x2b3, 0xfff, 545 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x0b3, 0xfff, 0x2f7, 546 - 0xfff, 0x32b, 0xfff, 0xfff, 0xfff, 0xfff, 0x0a7, 0xfff, 547 - 0xfff, 0x2da, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 548 - 0xfff, 0x07e, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 549 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x11c, 0xfff, 0xfff, 550 - 0xfff, 0xfff, 0xfff, 0x22f, 0xfff, 0x1f4, 0xfff, 0xfff, 551 - 0x2b0, 0x504, 0xfff, 0x114, 0xfff, 0xfff, 0xfff, 0x21d, 552 - 0xfff, 0xfff, 0xfff, 0xfff, 0x00d, 0x3c4, 0x340, 0x10f, 553 - 0xfff, 0xfff, 0x266, 0x02e, 0xfff, 0xfff, 0xfff, 0x4f8, 554 - 0x337, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 555 - 0xfff, 0xfff, 0xfff, 0x07b, 0x168, 0xfff, 0xfff, 0x0fe, 556 - 0xfff, 0xfff, 0x51a, 0xfff, 0x458, 0xfff, 0x36d, 0xfff, 557 - 0xfff, 0xfff, 0xfff, 0x073, 0x37d, 0x415, 0x550, 0xfff, 558 - 0xfff, 0xfff, 0x23b, 0x4b4, 0xfff, 0xfff, 0xfff, 0x1a1, 559 - 0xfff, 0xfff, 0x3aa, 0xfff, 0x117, 0x04d, 0x341, 0xfff, 560 - 0xfff, 0xfff, 0xfff, 0x518, 0x03e, 0x0f2, 0xfff, 0xfff, 561 - 0xfff, 0xfff, 0xfff, 0x363, 0xfff, 0x0b9, 0xfff, 0xfff, 562 - 0x241, 0xfff, 0xfff, 0x049, 0xfff, 0xfff, 0xfff, 0xfff, 563 - 0x15f, 0x52d, 0xfff, 0xfff, 0xfff, 0x29e, 0xfff, 0xfff, 564 - 0xfff, 0xfff, 0x4cf, 0x0fc, 0xfff, 0x36f, 0x3d3, 0xfff, 565 - 0x228, 0xfff, 0xfff, 0x45e, 0xfff, 0xfff, 0xfff, 0xfff, 566 - 0x238, 0xfff, 0xfff, 0xfff, 0xfff, 0x47f, 0xfff, 0xfff, 567 - 0x43a, 0x265, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x3e8, 568 - 0xfff, 0xfff, 0x01a, 0xfff, 0xfff, 0xfff, 0xfff, 0x21e, 569 - 0x1fc, 0x40b, 0xfff, 0xfff, 0xfff, 0x2d0, 0x159, 0xfff, 570 - 0xfff, 0x313, 0xfff, 0xfff, 0x05c, 0x4cc, 0xfff, 0xfff, 571 - 0x0f6, 0x3d5, 0xfff, 0xfff, 0xfff, 0x54f, 0xfff, 0xfff, 572 - 0xfff, 0x172, 0x1e4, 0x07c, 0xfff, 0xfff, 0xfff, 0xfff, 573 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x53c, 0x1ad, 0x535, 574 - 0x19b, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 575 - 0xfff, 0xfff, 0x092, 0xfff, 0x2be, 0xfff, 0xfff, 0x482, 576 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x0e6, 0xfff, 0xfff, 577 - 0xfff, 0xfff, 0xfff, 0x476, 0xfff, 0x51d, 0xfff, 0xfff, 578 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 579 - 0xfff, 0xfff, 0x342, 0x2b5, 0x22e, 0x09a, 0xfff, 0x08d, 580 - 0x44f, 0x3ed, 0xfff, 0xfff, 0xfff, 0xfff, 0x3d1, 0xfff, 581 - 0xfff, 0x543, 0xfff, 0x48f, 0xfff, 0x3d2, 0xfff, 0x0d5, 582 - 0x113, 0x0ec, 0x427, 0xfff, 0xfff, 0xfff, 0x4c4, 0xfff, 583 - 0xfff, 0x50a, 0xfff, 0x144, 0xfff, 0x105, 0x39f, 0x294, 584 - 0x164, 0xfff, 0x31a, 0xfff, 0xfff, 0x49a, 0xfff, 0x130, 585 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 586 - 0x1be, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 587 - 0xfff, 0xfff, 0x49e, 0x371, 0xfff, 0xfff, 0xfff, 0xfff, 588 - 0xfff, 0xfff, 0xfff, 0xfff, 0x0e8, 0x49c, 0x0f4, 0xfff, 589 - 0x338, 0x1a7, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 590 - 0xfff, 0x36c, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 591 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 592 - 0xfff, 0x1ae, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 593 - 0xfff, 0x31b, 0xfff, 0xfff, 0x2dd, 0x522, 0xfff, 0xfff, 594 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x2f4, 595 - 0x3c6, 0x30d, 0xfff, 0xfff, 0xfff, 0xfff, 0x34c, 0x18f, 596 - 0x30a, 0xfff, 0x01f, 0x079, 0xfff, 0xfff, 0x54d, 0x46b, 597 - 0x28c, 0x37f, 0xfff, 0xfff, 0xfff, 0xfff, 0x355, 0xfff, 598 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x14f, 0xfff, 0xfff, 599 - 0xfff, 0xfff, 0xfff, 0x359, 0x3fe, 0x3c5, 0xfff, 0xfff, 600 - 0xfff, 0xfff, 0x423, 0xfff, 0xfff, 0x34a, 0x22c, 0xfff, 601 - 0x25a, 0xfff, 0xfff, 0x4ad, 0xfff, 0x28d, 0xfff, 0xfff, 602 - 0xfff, 0xfff, 0xfff, 0x547, 0xfff, 0xfff, 0xfff, 0xfff, 603 - 0x2e2, 0xfff, 0xfff, 0x1d5, 0xfff, 0x2a8, 0xfff, 0xfff, 604 - 0x03f, 0xfff, 0xfff, 0xfff, 0xfff, 0x3eb, 0x0fa, 0xfff, 605 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x55b, 0xfff, 606 - 0x08e, 0xfff, 0x3ae, 0xfff, 0x3a4, 0xfff, 0x282, 0x158, 607 - 0xfff, 0x382, 0xfff, 0xfff, 0x499, 0xfff, 0xfff, 0x08a, 608 - 0xfff, 0xfff, 0xfff, 0x456, 0x3be, 0xfff, 0x1e2, 0xfff, 609 - 0xfff, 0xfff, 0xfff, 0xfff, 0x559, 0xfff, 0x1a0, 0xfff, 610 - 0xfff, 0x0b4, 0xfff, 0xfff, 0xfff, 0x2df, 0xfff, 0xfff, 611 - 0xfff, 0x07f, 0x4f5, 0xfff, 0xfff, 0x27c, 0x133, 0x017, 612 - 0xfff, 0x3fd, 0xfff, 0xfff, 0xfff, 0x44d, 0x4cd, 0x17a, 613 - 0x0d7, 0x537, 0xfff, 0xfff, 0x353, 0xfff, 0xfff, 0x351, 614 - 0x366, 0xfff, 0x44a, 0xfff, 0x1a6, 0xfff, 0xfff, 0xfff, 615 - 0x291, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x1e3, 616 - 0xfff, 0xfff, 0xfff, 0xfff, 0x389, 0xfff, 0x07a, 0xfff, 617 - 0x1b6, 0x2ed, 0xfff, 0xfff, 0xfff, 0xfff, 0x24e, 0x074, 618 - 0xfff, 0xfff, 0x3dc, 0xfff, 0x4e3, 0xfff, 0xfff, 0xfff, 619 - 0xfff, 0x4eb, 0xfff, 0xfff, 0x3b8, 0x4de, 0xfff, 0x19c, 620 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x262, 621 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x076, 0x4e8, 0x3da, 622 - 0xfff, 0x531, 0xfff, 0xfff, 0x14a, 0xfff, 0x0a2, 0x433, 623 - 0x3df, 0x1e9, 0xfff, 0xfff, 0xfff, 0xfff, 0x3e7, 0x285, 624 - 0x2d8, 0xfff, 0xfff, 0xfff, 0x349, 0x18d, 0x098, 0xfff, 625 - 0x0df, 0x4bf, 0xfff, 0xfff, 0x0b2, 0xfff, 0x346, 0x24d, 626 - 0xfff, 0xfff, 0xfff, 0x24f, 0x4fa, 0x2f9, 0xfff, 0xfff, 627 - 0x3c9, 0xfff, 0x2b4, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 628 - 0xfff, 0x056, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 629 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 630 - 0xfff, 0x179, 0xfff, 0x0e9, 0x3f0, 0x33d, 0xfff, 0xfff, 631 - 0xfff, 0xfff, 0xfff, 0x1fd, 0xfff, 0xfff, 0x526, 0xfff, 632 - 0xfff, 0xfff, 0x53d, 0xfff, 0xfff, 0xfff, 0x170, 0x331, 633 - 0xfff, 0x068, 0xfff, 0xfff, 0xfff, 0x3f7, 0xfff, 0x3d8, 634 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 635 - 0xfff, 0x09f, 0x556, 0xfff, 0xfff, 0x02d, 0xfff, 0xfff, 636 - 0x553, 0xfff, 0xfff, 0xfff, 0x1f0, 0xfff, 0xfff, 0x4d6, 637 - 0x41e, 0xfff, 0xfff, 0xfff, 0xfff, 0x4d5, 0xfff, 0xfff, 638 - 0xfff, 0xfff, 0xfff, 0x248, 0xfff, 0xfff, 0xfff, 0x0a3, 639 - 0xfff, 0x217, 0xfff, 0xfff, 0xfff, 0x4f1, 0x209, 0xfff, 640 - 0xfff, 0x475, 0x234, 0x52b, 0x398, 0xfff, 0x08b, 0xfff, 641 - 0xfff, 0xfff, 0xfff, 0x2c2, 0xfff, 0xfff, 0xfff, 0xfff, 642 - 0xfff, 0xfff, 0x268, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 643 - 0xfff, 0x4a3, 0xfff, 0x0aa, 0xfff, 0x1d9, 0xfff, 0xfff, 644 - 0xfff, 0xfff, 0x155, 0xfff, 0xfff, 0xfff, 0xfff, 0x0bf, 645 - 0x539, 0xfff, 0xfff, 0x2f1, 0x545, 0xfff, 0xfff, 0xfff, 646 - 0xfff, 0xfff, 0xfff, 0x2a7, 0x06f, 0xfff, 0x378, 0xfff, 647 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x25e, 0xfff, 648 - 0xfff, 0xfff, 0xfff, 0x15d, 0x02a, 0xfff, 0xfff, 0x0bc, 649 - 0x235, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 650 - 0x150, 0xfff, 0x1a9, 0xfff, 0xfff, 0xfff, 0xfff, 0x381, 651 - 0xfff, 0x04e, 0x270, 0x13f, 0xfff, 0xfff, 0x405, 0xfff, 652 - 0x3cd, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 653 - 0xfff, 0x2ef, 0xfff, 0x06a, 0xfff, 0xfff, 0xfff, 0x34f, 654 - 0x212, 0xfff, 0xfff, 0x0e2, 0xfff, 0x083, 0x298, 0xfff, 655 - 0xfff, 0xfff, 0x0c2, 0xfff, 0xfff, 0x52e, 0xfff, 0x488, 656 - 0xfff, 0xfff, 0xfff, 0x36b, 0xfff, 0xfff, 0xfff, 0x442, 657 - 0x091, 0xfff, 0x41c, 0xfff, 0xfff, 0x3a5, 0xfff, 0x4e6, 658 - 0xfff, 0xfff, 0x40d, 0x31d, 0xfff, 0xfff, 0xfff, 0x4c1, 659 - 0x053, 0xfff, 0x418, 0x13c, 0xfff, 0x350, 0xfff, 0x0ae, 660 - 0xfff, 0xfff, 0x41f, 0xfff, 0x470, 0xfff, 0x4ca, 0xfff, 661 - 0xfff, 0xfff, 0x02b, 0x450, 0xfff, 0x1f8, 0xfff, 0xfff, 662 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x293, 0xfff, 663 - 0xfff, 0xfff, 0xfff, 0x411, 0xfff, 0xfff, 0xfff, 0xfff, 664 - 0xfff, 0xfff, 0xfff, 0xfff, 0x0b8, 0xfff, 0xfff, 0xfff, 665 - 0x3e1, 0xfff, 0xfff, 0xfff, 0xfff, 0x43c, 0xfff, 0x2b2, 666 - 0x2ab, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x1ec, 667 - 0xfff, 0xfff, 0xfff, 0x3f8, 0x034, 0xfff, 0xfff, 0xfff, 668 - 0xfff, 0xfff, 0xfff, 0x11a, 0xfff, 0x541, 0x45c, 0x134, 669 - 0x1cc, 0xfff, 0xfff, 0xfff, 0x469, 0xfff, 0xfff, 0x44b, 670 - 0x161, 0xfff, 0xfff, 0xfff, 0x055, 0xfff, 0xfff, 0xfff, 671 - 0xfff, 0x307, 0xfff, 0xfff, 0xfff, 0xfff, 0x2d1, 0xfff, 672 - 0xfff, 0xfff, 0x124, 0x37b, 0x26b, 0x336, 0xfff, 0xfff, 673 - 0x2e4, 0x3cb, 0xfff, 0xfff, 0x0f8, 0x3c8, 0xfff, 0xfff, 674 - 0xfff, 0x461, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x4b5, 675 - 0x2cf, 0xfff, 0xfff, 0xfff, 0x20f, 0xfff, 0x35a, 0xfff, 676 - 0x490, 0xfff, 0x185, 0xfff, 0xfff, 0xfff, 0xfff, 0x42e, 677 - 0xfff, 0xfff, 0xfff, 0xfff, 0x54b, 0xfff, 0xfff, 0xfff, 678 - 0x146, 0xfff, 0x412, 0xfff, 0xfff, 0xfff, 0x1ff, 0xfff, 679 - 0xfff, 0x3e0, 0xfff, 0xfff, 0xfff, 0xfff, 0x2d5, 0xfff, 680 - 0x4df, 0x505, 0xfff, 0x413, 0xfff, 0x1a5, 0xfff, 0x3b2, 681 - 0xfff, 0xfff, 0xfff, 0x35b, 0xfff, 0x116, 0xfff, 0xfff, 682 - 0x171, 0x4d0, 0xfff, 0x154, 0x12d, 0xfff, 0xfff, 0xfff, 683 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x468, 0x4db, 0xfff, 684 - 0xfff, 0x1df, 0xfff, 0xfff, 0xfff, 0xfff, 0x05a, 0xfff, 685 - 0x0f1, 0x403, 0xfff, 0x22b, 0x2e0, 0xfff, 0xfff, 0xfff, 686 - 0x2b7, 0x373, 0xfff, 0xfff, 0xfff, 0xfff, 0x13e, 0xfff, 687 - 0xfff, 0xfff, 0x0d0, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 688 - 0x329, 0x1d2, 0x3fa, 0x047, 0xfff, 0x2f2, 0xfff, 0xfff, 689 - 0x141, 0x0ac, 0x1d7, 0xfff, 0x07d, 0xfff, 0xfff, 0xfff, 690 - 0x1c1, 0xfff, 0x487, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 691 - 0xfff, 0xfff, 0xfff, 0x045, 0xfff, 0xfff, 0xfff, 0xfff, 692 - 0x288, 0x0cd, 0xfff, 0xfff, 0xfff, 0xfff, 0x226, 0x1d8, 693 - 0xfff, 0x153, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x4cb, 694 - 0x528, 0xfff, 0xfff, 0xfff, 0x20a, 0x343, 0x3a1, 0xfff, 695 - 0xfff, 0xfff, 0x2d7, 0x2d3, 0x1aa, 0x4c5, 0xfff, 0xfff, 696 - 0xfff, 0x42b, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 697 - 0xfff, 0xfff, 0xfff, 0xfff, 0x3e9, 0xfff, 0x20b, 0x260, 698 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x37c, 0x2fd, 699 - 0xfff, 0xfff, 0x2c8, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 700 - 0xfff, 0x31e, 0xfff, 0x335, 0xfff, 0xfff, 0xfff, 0xfff, 701 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 702 - 0xfff, 0xfff, 0x135, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 703 - 0xfff, 0xfff, 0x35c, 0x4dd, 0x129, 0xfff, 0xfff, 0xfff, 704 - 0xfff, 0xfff, 0x1ef, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 705 - 0xfff, 0x34e, 0xfff, 0xfff, 0xfff, 0xfff, 0x407, 0xfff, 706 - 0xfff, 0xfff, 0xfff, 0xfff, 0x3ad, 0xfff, 0xfff, 0xfff, 707 - 0x379, 0xfff, 0xfff, 0x1d0, 0x38d, 0xfff, 0xfff, 0x1e8, 708 - 0x184, 0x3c1, 0x1c4, 0xfff, 0x1f9, 0xfff, 0xfff, 0x424, 709 - 0xfff, 0xfff, 0xfff, 0xfff, 0x1d3, 0x0d4, 0xfff, 0x4e9, 710 - 0xfff, 0xfff, 0xfff, 0x530, 0x107, 0xfff, 0x106, 0x04f, 711 - 0xfff, 0xfff, 0x4c7, 0x503, 0xfff, 0xfff, 0xfff, 0xfff, 712 - 0xfff, 0x15c, 0xfff, 0x23f, 0xfff, 0xfff, 0xfff, 0xfff, 713 - 0xfff, 0xfff, 0xfff, 0xfff, 0x4f3, 0xfff, 0xfff, 0x3c7, 714 - 0xfff, 0x278, 0xfff, 0xfff, 0x0a6, 0xfff, 0xfff, 0xfff, 715 - 0x122, 0x1cf, 0xfff, 0x327, 0xfff, 0x2e5, 0xfff, 0x29d, 716 - 0xfff, 0xfff, 0x3f1, 0xfff, 0xfff, 0x48d, 0xfff, 0xfff, 717 - 0xfff, 0xfff, 0x054, 0xfff, 0xfff, 0xfff, 0xfff, 0x178, 718 - 0x27e, 0x4e0, 0x352, 0x02f, 0x09c, 0xfff, 0x2a0, 0xfff, 719 - 0xfff, 0x46a, 0x457, 0xfff, 0xfff, 0x501, 0xfff, 0x2ba, 720 - 0xfff, 0xfff, 0xfff, 0x54e, 0x2e7, 0xfff, 0xfff, 0xfff, 721 - 0xfff, 0xfff, 0x551, 0xfff, 0xfff, 0x1db, 0x2aa, 0xfff, 722 - 0xfff, 0x4bc, 0xfff, 0xfff, 0x395, 0xfff, 0x0de, 0xfff, 723 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x455, 0xfff, 0x17e, 724 - 0xfff, 0x221, 0x4a7, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 725 - 0x388, 0xfff, 0xfff, 0xfff, 0x308, 0xfff, 0xfff, 0xfff, 726 - 0x20e, 0x4b9, 0xfff, 0x273, 0x20c, 0x09e, 0xfff, 0x057, 727 - 0xfff, 0xfff, 0xfff, 0xfff, 0x3f2, 0xfff, 0x1a8, 0x3a6, 728 - 0x14c, 0xfff, 0xfff, 0x071, 0xfff, 0xfff, 0x53a, 0xfff, 729 - 0xfff, 0xfff, 0xfff, 0x109, 0xfff, 0xfff, 0x399, 0xfff, 730 - 0x061, 0x4f0, 0x39e, 0x244, 0xfff, 0x035, 0xfff, 0xfff, 731 - 0x305, 0x47e, 0x297, 0xfff, 0xfff, 0x2b8, 0xfff, 0xfff, 732 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x1bc, 0xfff, 0x2fc, 733 - 0xfff, 0xfff, 0x554, 0xfff, 0xfff, 0xfff, 0xfff, 0x3b6, 734 - 0xfff, 0xfff, 0xfff, 0x515, 0x397, 0xfff, 0xfff, 0x12f, 735 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x4e5, 736 - 0xfff, 0x4fc, 0xfff, 0xfff, 0x05e, 0xfff, 0xfff, 0xfff, 737 - 0xfff, 0xfff, 0x0a8, 0x3af, 0x015, 0xfff, 0xfff, 0xfff, 738 - 0xfff, 0x138, 0xfff, 0xfff, 0xfff, 0x540, 0xfff, 0xfff, 739 - 0xfff, 0x027, 0x523, 0x2f0, 0xfff, 0xfff, 0xfff, 0xfff, 740 - 0xfff, 0xfff, 0x16c, 0xfff, 0x27d, 0xfff, 0xfff, 0xfff, 741 - 0xfff, 0x04c, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x4dc, 742 - 0xfff, 0xfff, 0x059, 0x301, 0xfff, 0xfff, 0xfff, 0xfff, 743 - 0xfff, 0xfff, 0xfff, 0x1a3, 0xfff, 0x15a, 0xfff, 0xfff, 744 - 0x0a5, 0xfff, 0x435, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 745 - 0xfff, 0x051, 0xfff, 0xfff, 0x131, 0xfff, 0x4f4, 0xfff, 746 - 0xfff, 0xfff, 0xfff, 0x441, 0xfff, 0x4fb, 0xfff, 0x03b, 747 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x1ed, 0x274, 748 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x0d3, 0x55e, 0x1b3, 749 - 0xfff, 0x0bd, 0xfff, 0xfff, 0xfff, 0xfff, 0x225, 0xfff, 750 - 0xfff, 0xfff, 0xfff, 0xfff, 0x4b7, 0xfff, 0xfff, 0x2ff, 751 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x4c3, 0xfff, 752 - 0x383, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x2f6, 753 - 0xfff, 0xfff, 0x1ee, 0xfff, 0x03d, 0xfff, 0xfff, 0xfff, 754 - 0xfff, 0xfff, 0x26f, 0x1dc, 0xfff, 0x0db, 0xfff, 0xfff, 755 - 0xfff, 0xfff, 0xfff, 0x0ce, 0xfff, 0xfff, 0x127, 0x03a, 756 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x311, 0xfff, 757 - 0xfff, 0x13d, 0x09d, 0x47b, 0x2a6, 0x50d, 0x510, 0x19a, 758 - 0xfff, 0x354, 0x414, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 759 - 0xfff, 0xfff, 0x44c, 0x3b0, 0xfff, 0x23d, 0x429, 0xfff, 760 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 761 - 0x4c0, 0x416, 0xfff, 0x05b, 0xfff, 0xfff, 0x137, 0xfff, 762 - 0x25f, 0x49f, 0xfff, 0x279, 0x013, 0xfff, 0xfff, 0xfff, 763 - 0x269, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 764 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x3d0, 0xfff, 0xfff, 765 - 0xfff, 0xfff, 0xfff, 0xfff, 0x077, 0xfff, 0xfff, 0x3fb, 766 - 0xfff, 0xfff, 0xfff, 0xfff, 0x271, 0x3a0, 0xfff, 0xfff, 767 - 0x40f, 0xfff, 0xfff, 0x3de, 0xfff, 0xfff, 0xfff, 0xfff, 768 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x1ab, 0x26a, 769 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x489, 0xfff, 0xfff, 770 - 0x252, 0xfff, 0xfff, 0xfff, 0xfff, 0x1b7, 0x42f, 0xfff, 771 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x3b7, 772 - 0xfff, 0x2bb, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 773 - 0xfff, 0xfff, 0xfff, 0x0f7, 0x01d, 0xfff, 0x067, 0xfff, 774 - 0xfff, 0xfff, 0xfff, 0x4e2, 0xfff, 0xfff, 0x4bb, 0xfff, 775 - 0xfff, 0xfff, 0x17b, 0xfff, 0x0ee, 0xfff, 0xfff, 0xfff, 776 - 0xfff, 0xfff, 0x36e, 0xfff, 0xfff, 0xfff, 0x533, 0xfff, 777 - 0xfff, 0xfff, 0x4d4, 0x356, 0xfff, 0xfff, 0x375, 0xfff, 778 - 0xfff, 0xfff, 0xfff, 0x4a4, 0x513, 0xfff, 0xfff, 0xfff, 779 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x4ff, 0xfff, 0x2af, 780 - 0xfff, 0xfff, 0x026, 0xfff, 0x0ad, 0xfff, 0xfff, 0xfff, 781 - 0xfff, 0x26e, 0xfff, 0xfff, 0xfff, 0xfff, 0x493, 0xfff, 782 - 0x463, 0x4d2, 0x4be, 0xfff, 0xfff, 0xfff, 0xfff, 0x4f2, 783 - 0x0b6, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 784 - 0xfff, 0x32d, 0x315, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 785 - 0xfff, 0x13a, 0x4a1, 0xfff, 0x27a, 0xfff, 0xfff, 0xfff, 786 - 0x47a, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 787 - 0x334, 0xfff, 0xfff, 0xfff, 0xfff, 0x54c, 0xfff, 0xfff, 788 - 0xfff, 0x0c9, 0x007, 0xfff, 0xfff, 0x12e, 0xfff, 0x0ff, 789 - 0xfff, 0xfff, 0x3f5, 0x509, 0xfff, 0xfff, 0xfff, 0xfff, 790 - 0x1c3, 0x2ad, 0xfff, 0xfff, 0x47c, 0x261, 0xfff, 0xfff, 791 - 0xfff, 0xfff, 0xfff, 0x152, 0xfff, 0xfff, 0xfff, 0x339, 792 - 0xfff, 0x243, 0x1c0, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 793 - 0x063, 0xfff, 0xfff, 0x254, 0xfff, 0xfff, 0x173, 0xfff, 794 - 0x0c7, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 795 - 0xfff, 0x362, 0x259, 0x485, 0x374, 0x0dc, 0x3ab, 0xfff, 796 - 0x1c5, 0x534, 0x544, 0xfff, 0xfff, 0x508, 0xfff, 0x402, 797 - 0x408, 0xfff, 0x0e7, 0xfff, 0xfff, 0x00a, 0x205, 0xfff, 798 - 0xfff, 0x2b9, 0xfff, 0xfff, 0xfff, 0x465, 0xfff, 0xfff, 799 - 0xfff, 0xfff, 0xfff, 0xfff, 0x23a, 0xfff, 0xfff, 0xfff, 800 - 0xfff, 0x147, 0x19d, 0x115, 0x214, 0xfff, 0x090, 0x368, 801 - 0xfff, 0x210, 0xfff, 0xfff, 0x280, 0x52a, 0x163, 0x148, 802 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x326, 0xfff, 0xfff, 803 - 0xfff, 0xfff, 0xfff, 0x2de, 0xfff, 0xfff, 0xfff, 0xfff, 804 - 0x206, 0x2c1, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 805 - 0x189, 0xfff, 0xfff, 0xfff, 0xfff, 0x367, 0xfff, 0x1a4, 806 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x443, 0xfff, 0x27b, 807 - 0xfff, 0xfff, 0x251, 0x549, 0xfff, 0xfff, 0xfff, 0xfff, 808 - 0xfff, 0xfff, 0x188, 0x04b, 0xfff, 0xfff, 0xfff, 0x31f, 809 - 0x4a6, 0xfff, 0x246, 0x1de, 0x156, 0xfff, 0xfff, 0xfff, 810 - 0x3a9, 0xfff, 0xfff, 0xfff, 0x2fa, 0xfff, 0x128, 0x0d1, 811 - 0x449, 0x255, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 812 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 813 - 0xfff, 0xfff, 0xfff, 0xfff, 0x258, 0xfff, 0xfff, 0xfff, 814 - 0x532, 0xfff, 0xfff, 0xfff, 0x303, 0x517, 0xfff, 0xfff, 815 - 0x2a9, 0x24a, 0xfff, 0xfff, 0x231, 0xfff, 0xfff, 0xfff, 816 - 0xfff, 0xfff, 0x4b6, 0x516, 0xfff, 0xfff, 0x0e4, 0x0eb, 817 - 0xfff, 0x4e4, 0xfff, 0x275, 0xfff, 0xfff, 0x031, 0xfff, 818 - 0xfff, 0xfff, 0xfff, 0xfff, 0x025, 0x21a, 0xfff, 0x0cc, 819 - 0x45f, 0x3d9, 0x289, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 820 - 0xfff, 0xfff, 0x23e, 0xfff, 0xfff, 0xfff, 0x438, 0x097, 821 - 0x419, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 822 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 823 - 0xfff, 0xfff, 0x0a9, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 824 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 825 - 0x37e, 0x0e0, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x431, 826 - 0x372, 0xfff, 0xfff, 0xfff, 0x1ba, 0x06e, 0xfff, 0x1b1, 827 - 0xfff, 0xfff, 0x12a, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 828 - 0xfff, 0xfff, 0x193, 0xfff, 0xfff, 0xfff, 0xfff, 0x10a, 829 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x048, 0x1b4, 830 - 0xfff, 0xfff, 0xfff, 0xfff, 0x295, 0x140, 0x108, 0xfff, 831 - 0xfff, 0xfff, 0xfff, 0x16f, 0xfff, 0x0a4, 0x37a, 0xfff, 832 - 0x29a, 0xfff, 0x284, 0xfff, 0xfff, 0xfff, 0xfff, 0x4c6, 833 - 0x2a2, 0x3a3, 0xfff, 0x201, 0xfff, 0xfff, 0xfff, 0x4bd, 834 - 0x005, 0x54a, 0x3b5, 0x204, 0x2ee, 0x11d, 0x436, 0xfff, 835 - 0xfff, 0xfff, 0xfff, 0xfff, 0x3ec, 0xfff, 0xfff, 0xfff, 836 - 0xfff, 0xfff, 0xfff, 0xfff, 0x11f, 0x498, 0x21c, 0xfff, 837 - 0xfff, 0xfff, 0x3d6, 0xfff, 0x4ab, 0xfff, 0x432, 0x2eb, 838 - 0x542, 0x4fd, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 839 - 0xfff, 0xfff, 0xfff, 0x4ce, 0xfff, 0xfff, 0x2fb, 0xfff, 840 - 0xfff, 0x2e1, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 841 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x1b9, 0x037, 0x0dd, 842 - 0xfff, 0xfff, 0xfff, 0x2bf, 0x521, 0x496, 0x095, 0xfff, 843 - 0xfff, 0x328, 0x070, 0x1bf, 0xfff, 0x393, 0xfff, 0xfff, 844 - 0x102, 0xfff, 0xfff, 0x21b, 0xfff, 0x142, 0x263, 0x519, 845 - 0xfff, 0x2a5, 0x177, 0xfff, 0x14d, 0x471, 0x4ae, 0xfff, 846 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 847 - 0x1f6, 0xfff, 0x481, 0xfff, 0xfff, 0xfff, 0x151, 0xfff, 848 - 0xfff, 0xfff, 0x085, 0x33f, 0xfff, 0xfff, 0xfff, 0x084, 849 - 0xfff, 0xfff, 0xfff, 0x345, 0x3a2, 0xfff, 0xfff, 0x0a0, 850 - 0x0da, 0x024, 0xfff, 0xfff, 0xfff, 0x1bd, 0xfff, 0x55c, 851 - 0x467, 0x445, 0xfff, 0xfff, 0xfff, 0x052, 0xfff, 0xfff, 852 - 0xfff, 0xfff, 0x51e, 0xfff, 0xfff, 0x39d, 0xfff, 0x35f, 853 - 0xfff, 0x376, 0x3ee, 0xfff, 0xfff, 0xfff, 0xfff, 0x448, 854 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x16a, 855 - 0xfff, 0x036, 0x38f, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 856 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x211, 857 - 0xfff, 0xfff, 0xfff, 0x230, 0xfff, 0xfff, 0x3ba, 0xfff, 858 - 0xfff, 0xfff, 0x3ce, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 859 - 0xfff, 0xfff, 0xfff, 0x229, 0xfff, 0x176, 0xfff, 0xfff, 860 - 0xfff, 0xfff, 0xfff, 0x00b, 0xfff, 0x162, 0x018, 0xfff, 861 - 0xfff, 0x233, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 862 - 0x400, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 863 - 0xfff, 0xfff, 0xfff, 0x12b, 0xfff, 0xfff, 0xfff, 0xfff, 864 - 0xfff, 0x3f4, 0xfff, 0x0f0, 0xfff, 0x1ac, 0xfff, 0xfff, 865 - 0x119, 0xfff, 0x2c0, 0xfff, 0xfff, 0xfff, 0x49b, 0xfff, 866 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x23c, 0xfff, 867 - 0x4b3, 0x010, 0x064, 0xfff, 0xfff, 0x4ba, 0xfff, 0xfff, 868 - 0xfff, 0xfff, 0xfff, 0x3c2, 0xfff, 0xfff, 0xfff, 0xfff, 869 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x006, 0x196, 0xfff, 870 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x100, 0x191, 0xfff, 871 - 0x1ea, 0x29f, 0xfff, 0xfff, 0xfff, 0x276, 0xfff, 0xfff, 872 - 0x2b1, 0x3b9, 0xfff, 0x03c, 0xfff, 0xfff, 0xfff, 0x180, 873 - 0xfff, 0x08f, 0xfff, 0xfff, 0x19e, 0x019, 0xfff, 0x0b0, 874 - 0x0fd, 0x332, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 875 - 0xfff, 0x06b, 0x2e8, 0xfff, 0x446, 0xfff, 0xfff, 0x004, 876 - 0x247, 0x197, 0xfff, 0x112, 0x169, 0x292, 0xfff, 0x302, 877 - 0xfff, 0xfff, 0x33b, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 878 - 0xfff, 0xfff, 0xfff, 0x287, 0x21f, 0xfff, 0x3ea, 0xfff, 879 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x4e7, 0xfff, 0xfff, 880 - 0xfff, 0xfff, 0xfff, 0x3a8, 0xfff, 0xfff, 0x2bc, 0xfff, 881 - 0x484, 0x296, 0xfff, 0x1c9, 0x08c, 0x1e5, 0x48a, 0xfff, 882 - 0x360, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 883 - 0x1ca, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 884 - 0xfff, 0xfff, 0xfff, 0x10d, 0xfff, 0xfff, 0xfff, 0xfff, 885 - 0xfff, 0xfff, 0x066, 0x2ea, 0x28b, 0x25b, 0xfff, 0x072, 886 - 0xfff, 0xfff, 0xfff, 0xfff, 0x2b6, 0xfff, 0xfff, 0x272, 887 - 0xfff, 0xfff, 0x525, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 888 - 0x2ca, 0xfff, 0xfff, 0xfff, 0x299, 0xfff, 0xfff, 0xfff, 889 - 0x558, 0x41a, 0xfff, 0x4f7, 0x557, 0xfff, 0x4a0, 0x344, 890 - 0x12c, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x125, 891 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 892 - 0x40e, 0xfff, 0xfff, 0x502, 0xfff, 0x103, 0x3e6, 0xfff, 893 - 0x527, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 894 - 0xfff, 0xfff, 0xfff, 0x45d, 0xfff, 0xfff, 0xfff, 0xfff, 895 - 0x44e, 0xfff, 0xfff, 0xfff, 0xfff, 0x0d2, 0x4c9, 0x35e, 896 - 0x459, 0x2d9, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x17d, 897 - 0x0c4, 0xfff, 0xfff, 0xfff, 0x3ac, 0x390, 0x094, 0xfff, 898 - 0x483, 0x0ab, 0xfff, 0x253, 0xfff, 0x391, 0xfff, 0xfff, 899 - 0xfff, 0xfff, 0x123, 0x0ef, 0xfff, 0xfff, 0xfff, 0x330, 900 - 0x38c, 0xfff, 0xfff, 0x2ae, 0xfff, 0xfff, 0xfff, 0x042, 901 - 0x012, 0x06d, 0xfff, 0xfff, 0xfff, 0x32a, 0x3db, 0x364, 902 - 0x2dc, 0xfff, 0x30f, 0x3d7, 0x4a5, 0x050, 0xfff, 0xfff, 903 - 0x029, 0xfff, 0xfff, 0xfff, 0xfff, 0x1d1, 0xfff, 0xfff, 904 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x480, 0xfff, 905 - 0x4ed, 0x081, 0x0a1, 0xfff, 0xfff, 0xfff, 0x30e, 0x52f, 906 - 0x257, 0xfff, 0xfff, 0x447, 0xfff, 0xfff, 0xfff, 0xfff, 907 - 0xfff, 0xfff, 0xfff, 0x401, 0x3cc, 0xfff, 0xfff, 0x0fb, 908 - 0x2c9, 0x42a, 0x314, 0x33e, 0x3bd, 0x318, 0xfff, 0x10e, 909 - 0x2a1, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x24c, 910 - 0x506, 0xfff, 0x267, 0xfff, 0xfff, 0x219, 0xfff, 0x1eb, 911 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 912 - 0x309, 0x3e2, 0x46c, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 913 - 0x384, 0xfff, 0xfff, 0xfff, 0xfff, 0x50c, 0xfff, 0x24b, 914 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x038, 915 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x194, 916 - 0x143, 0x3e3, 0xfff, 0xfff, 0xfff, 0x4c2, 0xfff, 0xfff, 917 - 0x0e1, 0x25c, 0xfff, 0x237, 0xfff, 0x1fe, 0xfff, 0xfff, 918 - 0xfff, 0x065, 0x2a4, 0xfff, 0x386, 0x55a, 0x11b, 0xfff, 919 - 0xfff, 0x192, 0xfff, 0x183, 0x00e, 0xfff, 0xfff, 0xfff, 920 - 0xfff, 0xfff, 0xfff, 0x4b2, 0x18e, 0xfff, 0xfff, 0xfff, 921 - 0xfff, 0x486, 0x4ef, 0x0c6, 0x380, 0xfff, 0x4a8, 0xfff, 922 - 0x0c5, 0xfff, 0xfff, 0xfff, 0xfff, 0x093, 0x1b8, 0xfff, 923 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x2e6, 924 - 0xfff, 0x0f3, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 925 - 0x28e, 0xfff, 0x53b, 0x420, 0x22a, 0x33a, 0xfff, 0x387, 926 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x2a3, 0xfff, 0xfff, 927 - 0xfff, 0x428, 0x500, 0xfff, 0xfff, 0x120, 0x2c6, 0x290, 928 - 0x2f5, 0x0e3, 0xfff, 0x0b7, 0xfff, 0x319, 0x474, 0xfff, 929 - 0xfff, 0xfff, 0x529, 0x014, 0xfff, 0x41b, 0x40a, 0x18b, 930 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x0d9, 931 - 0xfff, 0x38a, 0xfff, 0xfff, 0xfff, 0xfff, 0x1ce, 0xfff, 932 - 0xfff, 0xfff, 0xfff, 0xfff, 0x3b1, 0xfff, 0xfff, 0x05d, 933 - 0x2c4, 0xfff, 0xfff, 0x4af, 0xfff, 0x030, 0xfff, 0xfff, 934 - 0x203, 0xfff, 0x277, 0x256, 0xfff, 0xfff, 0xfff, 0x4f9, 935 - 0xfff, 0x2c7, 0xfff, 0x466, 0x016, 0x1cd, 0xfff, 0x167, 936 - 0xfff, 0xfff, 0x0c8, 0xfff, 0x43d, 0xfff, 0xfff, 0x020, 937 - 0xfff, 0xfff, 0x232, 0x1cb, 0x1e0, 0xfff, 0xfff, 0x347, 938 - 0xfff, 0x478, 0xfff, 0x365, 0xfff, 0xfff, 0xfff, 0xfff, 939 - 0x358, 0xfff, 0x10b, 0xfff, 0x35d, 0xfff, 0xfff, 0xfff, 940 - 0xfff, 0xfff, 0x452, 0x22d, 0xfff, 0xfff, 0x47d, 0xfff, 941 - 0x2f3, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x460, 0xfff, 942 - 0xfff, 0xfff, 0x50b, 0xfff, 0xfff, 0xfff, 0x2ec, 0xfff, 943 - 0xfff, 0xfff, 0xfff, 0xfff, 0x4b1, 0x422, 0xfff, 0xfff, 944 - 0xfff, 0x2d4, 0xfff, 0x239, 0xfff, 0xfff, 0xfff, 0x439, 945 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 946 - 0xfff, 0x491, 0x075, 0xfff, 0xfff, 0xfff, 0x06c, 0xfff, 947 - 0xfff, 0x0f9, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 948 - 0xfff, 0x139, 0xfff, 0x4f6, 0xfff, 0xfff, 0x409, 0xfff, 949 - 0xfff, 0x15b, 0xfff, 0xfff, 0x348, 0xfff, 0xfff, 0xfff, 950 - 0xfff, 0x4a2, 0x49d, 0xfff, 0x033, 0x175, 0xfff, 0x039, 951 - 0xfff, 0x312, 0x40c, 0xfff, 0xfff, 0x325, 0xfff, 0xfff, 952 - 0xfff, 0xfff, 0xfff, 0xfff, 0x4aa, 0xfff, 0xfff, 0xfff, 953 - 0xfff, 0xfff, 0xfff, 0x165, 0x3bc, 0x48c, 0x310, 0x096, 954 - 0xfff, 0xfff, 0x250, 0x1a2, 0xfff, 0xfff, 0xfff, 0xfff, 955 - 0x20d, 0x2ac, 0xfff, 0xfff, 0x39b, 0xfff, 0x377, 0xfff, 956 - 0x512, 0x495, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 957 - 0xfff, 0xfff, 0xfff, 0xfff, 0x357, 0x4ea, 0xfff, 0xfff, 958 - 0xfff, 0xfff, 0x198, 0xfff, 0xfff, 0xfff, 0x434, 0x04a, 959 - 0xfff, 0xfff, 0xfff, 0xfff, 0x062, 0xfff, 0x1d6, 0x1c8, 960 - 0xfff, 0x1f3, 0x281, 0xfff, 0x462, 0xfff, 0xfff, 0xfff, 961 - 0x4b0, 0xfff, 0x207, 0xfff, 0xfff, 0xfff, 0xfff, 0x3dd, 962 - 0xfff, 0xfff, 0x55d, 0xfff, 0x552, 0x494, 0x1af, 0xfff, 963 - 0xfff, 0xfff, 0xfff, 0xfff, 0x227, 0xfff, 0xfff, 0x069, 964 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x43e, 965 - 0x0b5, 0xfff, 0x524, 0x2d2, 0xfff, 0xfff, 0xfff, 0x28f, 966 - 0xfff, 0x01b, 0x50e, 0xfff, 0xfff, 0x1bb, 0xfff, 0xfff, 967 - 0x41d, 0xfff, 0x32e, 0x48e, 0xfff, 0x1f7, 0x224, 0xfff, 968 - 0xfff, 0xfff, 0xfff, 0xfff, 0x394, 0xfff, 0xfff, 0xfff, 969 - 0xfff, 0x52c, 0xfff, 0xfff, 0xfff, 0x392, 0xfff, 0x1e7, 970 - 0xfff, 0xfff, 0x3f9, 0x3a7, 0xfff, 0x51f, 0xfff, 0x0bb, 971 - 0x118, 0x3ca, 0xfff, 0x1dd, 0xfff, 0x48b, 0xfff, 0xfff, 972 - 0xfff, 0xfff, 0x50f, 0xfff, 0x0d6, 0xfff, 0x1fa, 0xfff, 973 - 0x11e, 0xfff, 0xfff, 0xfff, 0xfff, 0x4d7, 0xfff, 0x078, 974 - 0x008, 0xfff, 0x25d, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 975 - 0x032, 0x33c, 0xfff, 0x4d9, 0x160, 0xfff, 0xfff, 0x300, 976 - 0x0b1, 0xfff, 0x322, 0xfff, 0x4ec, 0xfff, 0xfff, 0x200, 977 - 0x00c, 0x369, 0x473, 0xfff, 0xfff, 0x32c, 0xfff, 0xfff, 978 - 0xfff, 0xfff, 0xfff, 0xfff, 0x53e, 0x3d4, 0x417, 0xfff, 979 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 980 - 0x34b, 0x001, 0x39a, 0x02c, 0xfff, 0xfff, 0x2ce, 0x00f, 981 - 0xfff, 0x0ba, 0xfff, 0xfff, 0xfff, 0xfff, 0x060, 0xfff, 982 - 0x406, 0xfff, 0xfff, 0xfff, 0x4ee, 0x4ac, 0xfff, 0x43f, 983 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x29b, 0xfff, 0xfff, 984 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x216, 985 - 0x190, 0xfff, 0x396, 0x464, 0xfff, 0xfff, 0x323, 0xfff, 986 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x2e9, 0xfff, 0x26d, 987 - 0x2cd, 0x040, 0xfff, 0xfff, 0xfff, 0xfff, 0x38b, 0x3c0, 988 - 0xfff, 0xfff, 0xfff, 0x1f2, 0xfff, 0x0ea, 0xfff, 0xfff, 989 - 0x472, 0xfff, 0x1fb, 0xfff, 0xfff, 0x0af, 0x27f, 0xfff, 990 - 0xfff, 0xfff, 0x479, 0x023, 0xfff, 0x0d8, 0x3b3, 0xfff, 991 - 0xfff, 0xfff, 0x121, 0xfff, 0xfff, 0x3bf, 0xfff, 0xfff, 992 - 0x16b, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 993 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 994 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 995 - 0x45a, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 996 - 0xfff, 0x0be, 0xfff, 0xfff, 0xfff, 0x111, 0xfff, 0x220, 997 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 998 - 0xfff, 0xfff, 0x09b, 0x218, 0xfff, 0x022, 0x202, 0xfff, 999 - 0x4c8, 0xfff, 0x0ed, 0xfff, 0xfff, 0x182, 0xfff, 0xfff, 1000 - 0xfff, 0x17f, 0x213, 0xfff, 0x321, 0x36a, 0xfff, 0x086, 1001 - 0xfff, 0xfff, 0xfff, 0x43b, 0x088, 0xfff, 0xfff, 0xfff, 1002 - 0xfff, 0x26c, 0xfff, 0x2f8, 0x3b4, 0xfff, 0xfff, 0xfff, 1003 - 0x132, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x333, 0x444, 1004 - 0x0c1, 0x4d8, 0x46d, 0x264, 0xfff, 0xfff, 0xfff, 0xfff, 1005 - 0x426, 0xfff, 0xfff, 0xfff, 0xfff, 0x2fe, 0xfff, 0xfff, 1006 - 0xfff, 0xfff, 0x011, 0xfff, 0x05f, 0xfff, 0xfff, 0xfff, 1007 - 0xfff, 0x10c, 0x101, 0xfff, 0xfff, 0xfff, 0xfff, 0x110, 1008 - 0xfff, 0x044, 0x304, 0x361, 0x404, 0xfff, 0x51b, 0x099, 1009 - 0xfff, 0x440, 0xfff, 0xfff, 0xfff, 0x222, 0xfff, 0xfff, 1010 - 0xfff, 0xfff, 0x1b5, 0xfff, 0x136, 0x430, 0xfff, 0x1da, 1011 - 0xfff, 0xfff, 0xfff, 0x043, 0xfff, 0x17c, 0xfff, 0xfff, 1012 - 0xfff, 0x01c, 0xfff, 0xfff, 0xfff, 0x425, 0x236, 0xfff, 1013 - 0x317, 0xfff, 0xfff, 0x437, 0x3fc, 0xfff, 0x1f1, 0xfff, 1014 - 0x324, 0xfff, 0xfff, 0x0ca, 0x306, 0xfff, 0x548, 0xfff, 1015 - 0x46e, 0xfff, 0xfff, 0xfff, 0x4b8, 0x1c2, 0x286, 0xfff, 1016 - 0xfff, 0x087, 0x18a, 0x19f, 0xfff, 0xfff, 0xfff, 0xfff, 1017 - 0x18c, 0xfff, 0x215, 0xfff, 0xfff, 0xfff, 0xfff, 0x283, 1018 - 0xfff, 0xfff, 0xfff, 0x126, 0xfff, 0xfff, 0x370, 0xfff, 1019 - 0x53f, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0x31c, 0xfff, 1020 - 0x4d1, 0xfff, 0xfff, 0xfff, 0x021, 0xfff, 0x157, 0xfff, 1021 - 0xfff, 0x028, 0x16e, 0xfff, 0x421, 0xfff, 0x1c6, 0xfff, 1022 - 0xfff, 0x511, 0xfff, 0xfff, 0x39c, 0x46f, 0x1b2, 0xfff, 1023 - 0xfff, 0x316, 0xfff, 0xfff, 0x009, 0xfff, 0xfff, 0x195, 1024 - 0xfff, 0x240, 0x546, 0xfff, 0xfff, 0x520, 0xfff, 0xfff, 1025 - 0xfff, 0xfff, 0xfff, 0xfff, 0x454, 0xfff, 0xfff, 0xfff, 1026 - 0x3f3, 0xfff, 0xfff, 0x187, 0xfff, 0x4a9, 0xfff, 0xfff, 1027 - 0xfff, 0xfff, 0xfff, 0xfff, 0x51c, 0x453, 0x1e6, 0xfff, 1028 - 0xfff, 0xfff, 0x1b0, 0xfff, 0x477, 0xfff, 0xfff, 0xfff, 1029 - 0x4fe, 0xfff, 0x32f, 0xfff, 0xfff, 0x15e, 0x1d4, 0xfff, 1030 - 0x0e5, 0xfff, 0xfff, 0xfff, 0x242, 0x14b, 0x046, 0xfff, 1031 - 0x3f6, 0x3bb, 0x3e4, 0xfff, 0xfff, 0x2e3, 0xfff, 0x245, 1032 - 0xfff, 0x149, 0xfff, 0xfff, 0xfff, 0x2db, 0xfff, 0xfff, 1033 - 0x181, 0xfff, 0x089, 0x2c5, 0xfff, 0x1f5, 0xfff, 0x2d6, 1034 - 0x507, 0xfff, 0x42d, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 1035 - 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 1036 - 0x080, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 0xfff, 1037 - 0xfff, 0xfff, 0xfff, 0xfff, 0x3c3, 0x320, 0xfff, 0x1e1, 1038 - 0xfff, 0x0f5, 0x13b, 0xfff, 0xfff, 0xfff, 0x003, 0x4da, 1039 - 0xfff, 0xfff, 0xfff, 0x42c, 0xfff, 0xfff, 0x0cb, 0xfff, 1040 - 0x536, 0x2c3, 0xfff, 0xfff, 0xfff, 0xfff, 0x199, 0xfff, 1041 - 0xfff, 0x0c0, 0xfff, 0x01e, 0x497, 0xfff, 0xfff, 0x3e5, 1042 - 0xfff, 0xfff, 0xfff, 0x0cf, 0xfff, 0x2bd, 0xfff, 0x223, 1043 - 0xfff, 0x3ff, 0xfff, 0x058, 0x174, 0x3ef, 0xfff, 0x002 1044 - }; 1045 - 1046 - static unsigned short err_pos(unsigned short din) 1047 - { 1048 - BUG_ON(din >= ARRAY_SIZE(err_pos_lut)); 1049 - return err_pos_lut[din]; 1050 - } 1051 - static int chk_no_err_only(unsigned short *chk_syndrome_list, unsigned short *err_info) 1052 - { 1053 - if ((chk_syndrome_list[0] | chk_syndrome_list[1] | 1054 - chk_syndrome_list[2] | chk_syndrome_list[3] | 1055 - chk_syndrome_list[4] | chk_syndrome_list[5] | 1056 - chk_syndrome_list[6] | chk_syndrome_list[7]) != 0x0) { 1057 - return -EINVAL; 1058 - } else { 1059 - err_info[0] = 0x0; 1060 - return 0; 1061 - } 1062 - } 1063 - static int chk_1_err_only(unsigned short *chk_syndrome_list, unsigned short *err_info) 1064 - { 1065 - unsigned short tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6; 1066 - tmp0 = gf4096_mul(chk_syndrome_list[1], gf4096_inv(chk_syndrome_list[0])); 1067 - tmp1 = gf4096_mul(chk_syndrome_list[2], gf4096_inv(chk_syndrome_list[1])); 1068 - tmp2 = gf4096_mul(chk_syndrome_list[3], gf4096_inv(chk_syndrome_list[2])); 1069 - tmp3 = gf4096_mul(chk_syndrome_list[4], gf4096_inv(chk_syndrome_list[3])); 1070 - tmp4 = gf4096_mul(chk_syndrome_list[5], gf4096_inv(chk_syndrome_list[4])); 1071 - tmp5 = gf4096_mul(chk_syndrome_list[6], gf4096_inv(chk_syndrome_list[5])); 1072 - tmp6 = gf4096_mul(chk_syndrome_list[7], gf4096_inv(chk_syndrome_list[6])); 1073 - if ((tmp0 == tmp1) & (tmp1 == tmp2) & (tmp2 == tmp3) & (tmp3 == tmp4) & (tmp4 == tmp5) & (tmp5 == tmp6)) { 1074 - err_info[0] = 0x1; // encode 1-symbol error as 0x1 1075 - err_info[1] = err_pos(tmp0); 1076 - err_info[1] = (unsigned short)(0x55e - err_info[1]); 1077 - err_info[5] = chk_syndrome_list[0]; 1078 - return 0; 1079 - } else 1080 - return -EINVAL; 1081 - } 1082 - static int chk_2_err_only(unsigned short *chk_syndrome_list, unsigned short *err_info) 1083 - { 1084 - unsigned short tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7; 1085 - unsigned short coefs[4]; 1086 - unsigned short err_pats[4]; 1087 - int found_num_root = 0; 1088 - unsigned short bit2_root0, bit2_root1; 1089 - unsigned short bit2_root0_inv, bit2_root1_inv; 1090 - unsigned short err_loc_eqn, test_root; 1091 - unsigned short bit2_loc0, bit2_loc1; 1092 - unsigned short bit2_pat0, bit2_pat1; 1093 - 1094 - find_2x2_soln(chk_syndrome_list[1], 1095 - chk_syndrome_list[0], 1096 - chk_syndrome_list[2], chk_syndrome_list[1], chk_syndrome_list[2], chk_syndrome_list[3], coefs); 1097 - for (test_root = 0x1; test_root < 0xfff; test_root++) { 1098 - err_loc_eqn = 1099 - gf4096_mul(coefs[1], gf4096_mul(test_root, test_root)) ^ gf4096_mul(coefs[0], test_root) ^ 0x1; 1100 - if (err_loc_eqn == 0x0) { 1101 - if (found_num_root == 0) { 1102 - bit2_root0 = test_root; 1103 - found_num_root = 1; 1104 - } else if (found_num_root == 1) { 1105 - bit2_root1 = test_root; 1106 - found_num_root = 2; 1107 - break; 1108 - } 1109 - } 1110 - } 1111 - if (found_num_root != 2) 1112 - return -EINVAL; 1113 - else { 1114 - bit2_root0_inv = gf4096_inv(bit2_root0); 1115 - bit2_root1_inv = gf4096_inv(bit2_root1); 1116 - find_2bit_err_pats(chk_syndrome_list[0], 1117 - chk_syndrome_list[1], bit2_root0_inv, bit2_root1_inv, err_pats); 1118 - bit2_pat0 = err_pats[0]; 1119 - bit2_pat1 = err_pats[1]; 1120 - //for(x+1) 1121 - tmp0 = gf4096_mul(gf4096_mul(bit2_root0_inv, bit2_root0_inv), gf4096_mul(bit2_root0_inv, bit2_root0_inv)); //rinv0^4 1122 - tmp1 = gf4096_mul(bit2_root0_inv, tmp0); //rinv0^5 1123 - tmp2 = gf4096_mul(bit2_root0_inv, tmp1); //rinv0^6 1124 - tmp3 = gf4096_mul(bit2_root0_inv, tmp2); //rinv0^7 1125 - tmp4 = gf4096_mul(gf4096_mul(bit2_root1_inv, bit2_root1_inv), gf4096_mul(bit2_root1_inv, bit2_root1_inv)); //rinv1^4 1126 - tmp5 = gf4096_mul(bit2_root1_inv, tmp4); //rinv1^5 1127 - tmp6 = gf4096_mul(bit2_root1_inv, tmp5); //rinv1^6 1128 - tmp7 = gf4096_mul(bit2_root1_inv, tmp6); //rinv1^7 1129 - //check if only 2-bit error 1130 - if ((chk_syndrome_list[4] == 1131 - (gf4096_mul(bit2_pat0, tmp0) ^ 1132 - gf4096_mul(bit2_pat1, 1133 - tmp4))) & (chk_syndrome_list[5] == 1134 - (gf4096_mul(bit2_pat0, tmp1) ^ 1135 - gf4096_mul(bit2_pat1, 1136 - tmp5))) & 1137 - (chk_syndrome_list[6] == 1138 - (gf4096_mul(bit2_pat0, tmp2) ^ 1139 - gf4096_mul(bit2_pat1, 1140 - tmp6))) & (chk_syndrome_list[7] == 1141 - (gf4096_mul(bit2_pat0, tmp3) ^ gf4096_mul(bit2_pat1, tmp7)))) { 1142 - if ((err_pos(bit2_root0_inv) == 0xfff) | (err_pos(bit2_root1_inv) == 0xfff)) { 1143 - return -EINVAL; 1144 - } else { 1145 - bit2_loc0 = 0x55e - err_pos(bit2_root0_inv); 1146 - bit2_loc1 = 0x55e - err_pos(bit2_root1_inv); 1147 - err_info[0] = 0x2; // encode 2-symbol error as 0x2 1148 - err_info[1] = bit2_loc0; 1149 - err_info[2] = bit2_loc1; 1150 - err_info[5] = bit2_pat0; 1151 - err_info[6] = bit2_pat1; 1152 - return 0; 1153 - } 1154 - } else 1155 - return -EINVAL; 1156 - } 1157 - } 1158 - static int chk_3_err_only(unsigned short *chk_syndrome_list, unsigned short *err_info) 1159 - { 1160 - unsigned short tmp0, tmp1, tmp2, tmp3, tmp4, tmp5; 1161 - unsigned short coefs[4]; 1162 - unsigned short err_pats[4]; 1163 - int found_num_root = 0; 1164 - unsigned short bit3_root0, bit3_root1, bit3_root2; 1165 - unsigned short bit3_root0_inv, bit3_root1_inv, bit3_root2_inv; 1166 - unsigned short err_loc_eqn, test_root; 1167 - 1168 - find_3bit_err_coefs(chk_syndrome_list[0], chk_syndrome_list[1], 1169 - chk_syndrome_list[2], chk_syndrome_list[3], 1170 - chk_syndrome_list[4], chk_syndrome_list[5], coefs); 1171 - 1172 - for (test_root = 0x1; test_root < 0xfff; test_root++) { 1173 - err_loc_eqn = gf4096_mul(coefs[2], 1174 - gf4096_mul(gf4096_mul(test_root, test_root), 1175 - test_root)) ^ gf4096_mul(coefs[1], gf4096_mul(test_root, test_root)) 1176 - ^ gf4096_mul(coefs[0], test_root) ^ 0x1; 1177 - 1178 - if (err_loc_eqn == 0x0) { 1179 - if (found_num_root == 0) { 1180 - bit3_root0 = test_root; 1181 - found_num_root = 1; 1182 - } else if (found_num_root == 1) { 1183 - bit3_root1 = test_root; 1184 - found_num_root = 2; 1185 - } else if (found_num_root == 2) { 1186 - bit3_root2 = test_root; 1187 - found_num_root = 3; 1188 - break; 1189 - } 1190 - } 1191 - } 1192 - if (found_num_root != 3) 1193 - return -EINVAL; 1194 - else { 1195 - bit3_root0_inv = gf4096_inv(bit3_root0); 1196 - bit3_root1_inv = gf4096_inv(bit3_root1); 1197 - bit3_root2_inv = gf4096_inv(bit3_root2); 1198 - 1199 - find_3bit_err_pats(chk_syndrome_list[0], chk_syndrome_list[1], 1200 - chk_syndrome_list[2], bit3_root0_inv, 1201 - bit3_root1_inv, bit3_root2_inv, err_pats); 1202 - 1203 - //check if only 3-bit error 1204 - tmp0 = gf4096_mul(bit3_root0_inv, bit3_root0_inv); 1205 - tmp0 = gf4096_mul(tmp0, tmp0); 1206 - tmp0 = gf4096_mul(tmp0, bit3_root0_inv); 1207 - tmp0 = gf4096_mul(tmp0, bit3_root0_inv); //rinv0^6 1208 - tmp1 = gf4096_mul(tmp0, bit3_root0_inv); //rinv0^7 1209 - tmp2 = gf4096_mul(bit3_root1_inv, bit3_root1_inv); 1210 - tmp2 = gf4096_mul(tmp2, tmp2); 1211 - tmp2 = gf4096_mul(tmp2, bit3_root1_inv); 1212 - tmp2 = gf4096_mul(tmp2, bit3_root1_inv); //rinv1^6 1213 - tmp3 = gf4096_mul(tmp2, bit3_root1_inv); //rinv1^7 1214 - tmp4 = gf4096_mul(bit3_root2_inv, bit3_root2_inv); 1215 - tmp4 = gf4096_mul(tmp4, tmp4); 1216 - tmp4 = gf4096_mul(tmp4, bit3_root2_inv); 1217 - tmp4 = gf4096_mul(tmp4, bit3_root2_inv); //rinv2^6 1218 - tmp5 = gf4096_mul(tmp4, bit3_root2_inv); //rinv2^7 1219 - 1220 - //check if only 3 errors 1221 - if ((chk_syndrome_list[6] == (gf4096_mul(err_pats[0], tmp0) ^ 1222 - gf4096_mul(err_pats[1], tmp2) ^ 1223 - gf4096_mul(err_pats[2], tmp4))) & 1224 - (chk_syndrome_list[7] == (gf4096_mul(err_pats[0], tmp1) ^ 1225 - gf4096_mul(err_pats[1], tmp3) ^ gf4096_mul(err_pats[2], tmp5)))) { 1226 - if ((err_pos(bit3_root0_inv) == 0xfff) | 1227 - (err_pos(bit3_root1_inv) == 0xfff) | (err_pos(bit3_root2_inv) == 0xfff)) { 1228 - return -EINVAL; 1229 - } else { 1230 - err_info[0] = 0x3; 1231 - err_info[1] = (0x55e - err_pos(bit3_root0_inv)); 1232 - err_info[2] = (0x55e - err_pos(bit3_root1_inv)); 1233 - err_info[3] = (0x55e - err_pos(bit3_root2_inv)); 1234 - err_info[5] = err_pats[0]; 1235 - err_info[6] = err_pats[1]; 1236 - err_info[7] = err_pats[2]; 1237 - return 0; 1238 - } 1239 - } else 1240 - return -EINVAL; 1241 - } 1242 - } 1243 - static int chk_4_err_only(unsigned short *chk_syndrome_list, unsigned short *err_info) 1244 - { 1245 - unsigned short coefs[4]; 1246 - unsigned short err_pats[4]; 1247 - int found_num_root = 0; 1248 - unsigned short bit4_root0, bit4_root1, bit4_root2, bit4_root3; 1249 - unsigned short bit4_root0_inv, bit4_root1_inv, bit4_root2_inv, bit4_root3_inv; 1250 - unsigned short err_loc_eqn, test_root; 1251 - 1252 - find_4bit_err_coefs(chk_syndrome_list[0], 1253 - chk_syndrome_list[1], 1254 - chk_syndrome_list[2], 1255 - chk_syndrome_list[3], 1256 - chk_syndrome_list[4], 1257 - chk_syndrome_list[5], chk_syndrome_list[6], chk_syndrome_list[7], coefs); 1258 - 1259 - for (test_root = 0x1; test_root < 0xfff; test_root++) { 1260 - err_loc_eqn = 1261 - gf4096_mul(coefs[3], 1262 - gf4096_mul(gf4096_mul 1263 - (gf4096_mul(test_root, test_root), 1264 - test_root), 1265 - test_root)) ^ gf4096_mul(coefs[2], 1266 - gf4096_mul 1267 - (gf4096_mul(test_root, test_root), test_root)) 1268 - ^ gf4096_mul(coefs[1], gf4096_mul(test_root, test_root)) ^ gf4096_mul(coefs[0], test_root) 1269 - ^ 0x1; 1270 - if (err_loc_eqn == 0x0) { 1271 - if (found_num_root == 0) { 1272 - bit4_root0 = test_root; 1273 - found_num_root = 1; 1274 - } else if (found_num_root == 1) { 1275 - bit4_root1 = test_root; 1276 - found_num_root = 2; 1277 - } else if (found_num_root == 2) { 1278 - bit4_root2 = test_root; 1279 - found_num_root = 3; 1280 - } else { 1281 - found_num_root = 4; 1282 - bit4_root3 = test_root; 1283 - break; 1284 - } 1285 - } 1286 - } 1287 - if (found_num_root != 4) { 1288 - return -EINVAL; 1289 - } else { 1290 - bit4_root0_inv = gf4096_inv(bit4_root0); 1291 - bit4_root1_inv = gf4096_inv(bit4_root1); 1292 - bit4_root2_inv = gf4096_inv(bit4_root2); 1293 - bit4_root3_inv = gf4096_inv(bit4_root3); 1294 - find_4bit_err_pats(chk_syndrome_list[0], 1295 - chk_syndrome_list[1], 1296 - chk_syndrome_list[2], 1297 - chk_syndrome_list[3], 1298 - bit4_root0_inv, bit4_root1_inv, bit4_root2_inv, bit4_root3_inv, err_pats); 1299 - err_info[0] = 0x4; 1300 - err_info[1] = (0x55e - err_pos(bit4_root0_inv)); 1301 - err_info[2] = (0x55e - err_pos(bit4_root1_inv)); 1302 - err_info[3] = (0x55e - err_pos(bit4_root2_inv)); 1303 - err_info[4] = (0x55e - err_pos(bit4_root3_inv)); 1304 - err_info[5] = err_pats[0]; 1305 - err_info[6] = err_pats[1]; 1306 - err_info[7] = err_pats[2]; 1307 - err_info[8] = err_pats[3]; 1308 - return 0; 1309 - } 1310 - } 1311 - 1312 - void correct_12bit_symbol(unsigned char *buf, unsigned short sym, 1313 - unsigned short val) 1314 - { 1315 - if (unlikely(sym > 1366)) { 1316 - printk(KERN_ERR "Error: symbol %d out of range; cannot correct\n", sym); 1317 - } else if (sym == 0) { 1318 - buf[0] ^= val; 1319 - } else if (sym & 1) { 1320 - buf[1+(3*(sym-1))/2] ^= (val >> 4); 1321 - buf[2+(3*(sym-1))/2] ^= ((val & 0xf) << 4); 1322 - } else { 1323 - buf[2+(3*(sym-2))/2] ^= (val >> 8); 1324 - buf[3+(3*(sym-2))/2] ^= (val & 0xff); 1325 - } 1326 - } 1327 - 1328 - static int debugecc = 0; 1329 - module_param(debugecc, int, 0644); 1330 - 1331 - int cafe_correct_ecc(unsigned char *buf, 1332 - unsigned short *chk_syndrome_list) 1333 - { 1334 - unsigned short err_info[9]; 1335 - int i; 1336 - 1337 - if (debugecc) { 1338 - printk(KERN_WARNING "cafe_correct_ecc invoked. Syndromes %x %x %x %x %x %x %x %x\n", 1339 - chk_syndrome_list[0], chk_syndrome_list[1], 1340 - chk_syndrome_list[2], chk_syndrome_list[3], 1341 - chk_syndrome_list[4], chk_syndrome_list[5], 1342 - chk_syndrome_list[6], chk_syndrome_list[7]); 1343 - for (i=0; i < 2048; i+=16) { 1344 - printk(KERN_WARNING "D %04x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", 1345 - i, 1346 - buf[i], buf[i+1], buf[i+2], buf[i+3], 1347 - buf[i+4], buf[i+5], buf[i+6], buf[i+7], 1348 - buf[i+8], buf[i+9], buf[i+10], buf[i+11], 1349 - buf[i+12], buf[i+13], buf[i+14], buf[i+15]); 1350 - } 1351 - for ( ; i < 2112; i+=16) { 1352 - printk(KERN_WARNING "O %02x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", 1353 - i - 2048, 1354 - buf[i], buf[i+1], buf[i+2], buf[i+3], 1355 - buf[i+4], buf[i+5], buf[i+6], buf[i+7], 1356 - buf[i+8], buf[i+9], buf[i+10], buf[i+11], 1357 - buf[i+12], buf[i+13], buf[i+14], buf[i+15]); 1358 - } 1359 - } 1360 - 1361 - 1362 - 1363 - if (chk_no_err_only(chk_syndrome_list, err_info) && 1364 - chk_1_err_only(chk_syndrome_list, err_info) && 1365 - chk_2_err_only(chk_syndrome_list, err_info) && 1366 - chk_3_err_only(chk_syndrome_list, err_info) && 1367 - chk_4_err_only(chk_syndrome_list, err_info)) { 1368 - return -EIO; 1369 - } 1370 - 1371 - for (i=0; i < err_info[0]; i++) { 1372 - if (debugecc) 1373 - printk(KERN_WARNING "Correct symbol %d with 0x%03x\n", 1374 - err_info[1+i], err_info[5+i]); 1375 - 1376 - correct_12bit_symbol(buf, err_info[1+i], err_info[5+i]); 1377 - } 1378 - 1379 - return err_info[0]; 1380 - } 1381 -
+5 -6
drivers/mtd/nand/nand_base.c
··· 303 303 struct nand_chip *chip = mtd->priv; 304 304 u16 bad; 305 305 306 + page = (int)(ofs >> chip->page_shift) & chip->pagemask; 307 + 306 308 if (getchip) { 307 - page = (int)(ofs >> chip->page_shift); 308 309 chipnr = (int)(ofs >> chip->chip_shift); 309 310 310 311 nand_get_device(chip, mtd, FL_READING); 311 312 312 313 /* Select the NAND device */ 313 314 chip->select_chip(mtd, chipnr); 314 - } else 315 - page = (int)(ofs >> chip->page_shift); 315 + } 316 316 317 317 if (chip->options & NAND_BUSWIDTH_16) { 318 318 chip->cmdfunc(mtd, NAND_CMD_READOOB, chip->badblockpos & 0xFE, 319 - page & chip->pagemask); 319 + page); 320 320 bad = cpu_to_le16(chip->read_word(mtd)); 321 321 if (chip->badblockpos & 0x1) 322 322 bad >>= 8; 323 323 if ((bad & 0xFF) != 0xff) 324 324 res = 1; 325 325 } else { 326 - chip->cmdfunc(mtd, NAND_CMD_READOOB, chip->badblockpos, 327 - page & chip->pagemask); 326 + chip->cmdfunc(mtd, NAND_CMD_READOOB, chip->badblockpos, page); 328 327 if (chip->read_byte(mtd) != 0xff) 329 328 res = 1; 330 329 }
+150
drivers/mtd/nand/plat_nand.c
··· 1 + /* 2 + * Generic NAND driver 3 + * 4 + * Author: Vitaly Wool <vitalywool@gmail.com> 5 + * 6 + * This program is free software; you can redistribute it and/or modify 7 + * it under the terms of the GNU General Public License version 2 as 8 + * published by the Free Software Foundation. 9 + * 10 + */ 11 + 12 + #include <linux/io.h> 13 + #include <linux/module.h> 14 + #include <linux/platform_device.h> 15 + #include <linux/slab.h> 16 + #include <linux/mtd/mtd.h> 17 + #include <linux/mtd/nand.h> 18 + #include <linux/mtd/partitions.h> 19 + 20 + struct plat_nand_data { 21 + struct nand_chip chip; 22 + struct mtd_info mtd; 23 + void __iomem *io_base; 24 + #ifdef CONFIG_MTD_PARTITIONS 25 + int nr_parts; 26 + struct mtd_partition *parts; 27 + #endif 28 + }; 29 + 30 + /* 31 + * Probe for the NAND device. 32 + */ 33 + static int __init plat_nand_probe(struct platform_device *pdev) 34 + { 35 + struct platform_nand_data *pdata = pdev->dev.platform_data; 36 + struct plat_nand_data *data; 37 + int res = 0; 38 + 39 + /* Allocate memory for the device structure (and zero it) */ 40 + data = kzalloc(sizeof(struct plat_nand_data), GFP_KERNEL); 41 + if (!data) { 42 + dev_err(&pdev->dev, "failed to allocate device structure.\n"); 43 + return -ENOMEM; 44 + } 45 + 46 + data->io_base = ioremap(pdev->resource[0].start, 47 + pdev->resource[0].end - pdev->resource[0].start + 1); 48 + if (data->io_base == NULL) { 49 + dev_err(&pdev->dev, "ioremap failed\n"); 50 + kfree(data); 51 + return -EIO; 52 + } 53 + 54 + data->chip.priv = &data; 55 + data->mtd.priv = &data->chip; 56 + data->mtd.owner = THIS_MODULE; 57 + 58 + data->chip.IO_ADDR_R = data->io_base; 59 + data->chip.IO_ADDR_W = data->io_base; 60 + data->chip.cmd_ctrl = pdata->ctrl.cmd_ctrl; 61 + data->chip.dev_ready = pdata->ctrl.dev_ready; 62 + data->chip.select_chip = pdata->ctrl.select_chip; 63 + data->chip.chip_delay = pdata->chip.chip_delay; 64 + data->chip.options |= pdata->chip.options; 65 + 66 + data->chip.ecc.hwctl = pdata->ctrl.hwcontrol; 67 + data->chip.ecc.layout = pdata->chip.ecclayout; 68 + data->chip.ecc.mode = NAND_ECC_SOFT; 69 + 70 + platform_set_drvdata(pdev, data); 71 + 72 + /* Scan to find existance of the device */ 73 + if (nand_scan(&data->mtd, 1)) { 74 + res = -ENXIO; 75 + goto out; 76 + } 77 + 78 + #ifdef CONFIG_MTD_PARTITIONS 79 + if (pdata->chip.part_probe_types) { 80 + res = parse_mtd_partitions(&data->mtd, 81 + pdata->chip.part_probe_types, 82 + &data->parts, 0); 83 + if (res > 0) { 84 + add_mtd_partitions(&data->mtd, data->parts, res); 85 + return 0; 86 + } 87 + } 88 + if (pdata->chip.partitions) { 89 + data->parts = pdata->chip.partitions; 90 + res = add_mtd_partitions(&data->mtd, data->parts, 91 + pdata->chip.nr_partitions); 92 + } else 93 + #endif 94 + res = add_mtd_device(&data->mtd); 95 + 96 + if (!res) 97 + return res; 98 + 99 + nand_release(&data->mtd); 100 + out: 101 + platform_set_drvdata(pdev, NULL); 102 + iounmap(data->io_base); 103 + kfree(data); 104 + return res; 105 + } 106 + 107 + /* 108 + * Remove a NAND device. 109 + */ 110 + static int __devexit plat_nand_remove(struct platform_device *pdev) 111 + { 112 + struct plat_nand_data *data = platform_get_drvdata(pdev); 113 + struct platform_nand_data *pdata = pdev->dev.platform_data; 114 + 115 + nand_release(&data->mtd); 116 + #ifdef CONFIG_MTD_PARTITIONS 117 + if (data->parts && data->parts != pdata->chip.partitions) 118 + kfree(data->parts); 119 + #endif 120 + iounmap(data->io_base); 121 + kfree(data); 122 + 123 + return 0; 124 + } 125 + 126 + static struct platform_driver plat_nand_driver = { 127 + .probe = plat_nand_probe, 128 + .remove = plat_nand_remove, 129 + .driver = { 130 + .name = "gen_nand", 131 + .owner = THIS_MODULE, 132 + }, 133 + }; 134 + 135 + static int __init plat_nand_init(void) 136 + { 137 + return platform_driver_register(&plat_nand_driver); 138 + } 139 + 140 + static void __exit plat_nand_exit(void) 141 + { 142 + platform_driver_unregister(&plat_nand_driver); 143 + } 144 + 145 + module_init(plat_nand_init); 146 + module_exit(plat_nand_exit); 147 + 148 + MODULE_LICENSE("GPL"); 149 + MODULE_AUTHOR("Vitaly Wool"); 150 + MODULE_DESCRIPTION("Simple generic NAND driver");
-2
fs/jffs2/histo_mips.h
··· 1 - #define BIT_DIVIDER_MIPS 1043 2 - static int bits_mips[8] = { 277,249,290,267,229,341,212,241}; /* mips32 */
+30 -50
fs/jffs2/readinode.c
··· 219 219 struct jffs2_tmp_dnode_info *tn) 220 220 { 221 221 uint32_t fn_end = tn->fn->ofs + tn->fn->size; 222 - struct jffs2_tmp_dnode_info *insert_point = NULL, *this; 222 + struct jffs2_tmp_dnode_info *this; 223 223 224 - dbg_readinode("insert fragment %#04x-%#04x, ver %u\n", tn->fn->ofs, fn_end, tn->version); 224 + dbg_readinode("insert fragment %#04x-%#04x, ver %u at %08x\n", tn->fn->ofs, fn_end, tn->version, ref_offset(tn->fn->raw)); 225 225 226 226 /* If a node has zero dsize, we only have to keep if it if it might be the 227 227 node with highest version -- i.e. the one which will end up as f->metadata. ··· 240 240 241 241 /* Find the earliest node which _may_ be relevant to this one */ 242 242 this = jffs2_lookup_tn(&rii->tn_root, tn->fn->ofs); 243 - if (!this) { 244 - /* First addition to empty tree. $DEITY how I love the easy cases */ 245 - rb_link_node(&tn->rb, NULL, &rii->tn_root.rb_node); 246 - rb_insert_color(&tn->rb, &rii->tn_root); 247 - dbg_readinode("keep new frag\n"); 248 - return 0; 243 + if (this) { 244 + /* If the node is coincident with another at a lower address, 245 + back up until the other node is found. It may be relevant */ 246 + while (this->overlapped) 247 + this = tn_prev(this); 248 + 249 + /* First node should never be marked overlapped */ 250 + BUG_ON(!this); 251 + dbg_readinode("'this' found %#04x-%#04x (%s)\n", this->fn->ofs, this->fn->ofs + this->fn->size, this->fn ? "data" : "hole"); 249 252 } 250 - 251 - /* If we add a new node it'll be somewhere under here. */ 252 - insert_point = this; 253 - 254 - /* If the node is coincident with another at a lower address, 255 - back up until the other node is found. It may be relevant */ 256 - while (tn->overlapped) 257 - tn = tn_prev(tn); 258 - 259 - dbg_readinode("'this' found %#04x-%#04x (%s)\n", this->fn->ofs, this->fn->ofs + this->fn->size, this->fn ? "data" : "hole"); 260 253 261 254 while (this) { 262 255 if (this->fn->ofs > fn_end) ··· 267 274 return 0; 268 275 } else { 269 276 /* Who cares if the new one is good; keep it for now anyway. */ 270 - rb_replace_node(&this->rb, &tn->rb, &rii->tn_root); 271 - /* Same overlapping from in front and behind */ 272 - tn->overlapped = this->overlapped; 273 - jffs2_kill_tn(c, this); 274 277 dbg_readinode("Like new node. Throw away old\n"); 278 + rb_replace_node(&this->rb, &tn->rb, &rii->tn_root); 279 + jffs2_kill_tn(c, this); 280 + /* Same overlapping from in front and behind */ 275 281 return 0; 276 282 } 277 283 } ··· 283 291 jffs2_kill_tn(c, tn); 284 292 return 0; 285 293 } 286 - /* ... and is good. Kill 'this'... */ 287 - rb_replace_node(&this->rb, &tn->rb, &rii->tn_root); 288 - tn->overlapped = this->overlapped; 289 - jffs2_kill_tn(c, this); 290 - /* ... and any subsequent nodes which are also overlapped */ 291 - this = tn_next(tn); 292 - while (this && this->fn->ofs + this->fn->size < fn_end) { 294 + /* ... and is good. Kill 'this' and any subsequent nodes which are also overlapped */ 295 + while (this && this->fn->ofs + this->fn->size <= fn_end) { 293 296 struct jffs2_tmp_dnode_info *next = tn_next(this); 294 297 if (this->version < tn->version) { 295 298 tn_erase(this, &rii->tn_root); ··· 295 308 } 296 309 this = next; 297 310 } 298 - dbg_readinode("Done inserting new\n"); 299 - return 0; 311 + dbg_readinode("Done killing overlapped nodes\n"); 312 + continue; 300 313 } 301 314 if (this->version > tn->version && 302 315 this->fn->ofs <= tn->fn->ofs && ··· 308 321 return 0; 309 322 } 310 323 /* ... but 'this' was bad. Replace it... */ 311 - rb_replace_node(&this->rb, &tn->rb, &rii->tn_root); 312 324 dbg_readinode("Bad CRC on old overlapping node. Kill it\n"); 325 + tn_erase(this, &rii->tn_root); 313 326 jffs2_kill_tn(c, this); 314 - return 0; 327 + break; 315 328 } 316 - /* We want to be inserted under the last node which is 317 - either at a lower offset _or_ has a smaller range */ 318 - if (this->fn->ofs < tn->fn->ofs || 319 - (this->fn->ofs == tn->fn->ofs && 320 - this->fn->size <= tn->fn->size)) 321 - insert_point = this; 322 329 323 330 this = tn_next(this); 324 331 } 325 - dbg_readinode("insert_point %p, ver %d, 0x%x-0x%x, ov %d\n", 326 - insert_point, insert_point->version, insert_point->fn->ofs, 327 - insert_point->fn->ofs+insert_point->fn->size, 328 - insert_point->overlapped); 332 + 329 333 /* We neither completely obsoleted nor were completely 330 - obsoleted by an earlier node. Insert under insert_point */ 334 + obsoleted by an earlier node. Insert into the tree */ 331 335 { 332 - struct rb_node *parent = &insert_point->rb; 333 - struct rb_node **link = &parent; 336 + struct rb_node *parent; 337 + struct rb_node **link = &rii->tn_root.rb_node; 338 + struct jffs2_tmp_dnode_info *insert_point = NULL; 334 339 335 340 while (*link) { 336 341 parent = *link; ··· 338 359 rb_link_node(&tn->rb, &insert_point->rb, link); 339 360 rb_insert_color(&tn->rb, &rii->tn_root); 340 361 } 362 + 341 363 /* If there's anything behind that overlaps us, note it */ 342 364 this = tn_prev(tn); 343 365 if (this) { ··· 437 457 this = tn_last(&rii->tn_root); 438 458 while (this) { 439 459 dbg_readinode("tn %p ver %d range 0x%x-0x%x ov %d\n", this, this->version, this->fn->ofs, 440 - this->fn->ofs+this->fn->size, this->overlapped); 460 + this->fn->ofs+this->fn->size, this->overlapped); 441 461 this = tn_prev(this); 442 462 } 443 463 #endif ··· 463 483 vers_next = tn_prev(this); 464 484 eat_last(&ver_root, &this->rb); 465 485 if (check_tn_node(c, this)) { 466 - dbg_readinode("node ver %x, 0x%x-0x%x failed CRC\n", 486 + dbg_readinode("node ver %d, 0x%x-0x%x failed CRC\n", 467 487 this->version, this->fn->ofs, 468 488 this->fn->ofs+this->fn->size); 469 489 jffs2_kill_tn(c, this); ··· 476 496 high_ver = this->version; 477 497 rii->latest_ref = this->fn->raw; 478 498 } 479 - dbg_readinode("Add %p (v %x, 0x%x-0x%x, ov %d) to fragtree\n", 499 + dbg_readinode("Add %p (v %d, 0x%x-0x%x, ov %d) to fragtree\n", 480 500 this, this->version, this->fn->ofs, 481 501 this->fn->ofs+this->fn->size, this->overlapped); 482 502 ··· 830 850 return ret; 831 851 } 832 852 #ifdef JFFS2_DBG_READINODE_MESSAGES 833 - dbg_readinode("After adding ver %d:\n", tn->version); 853 + dbg_readinode("After adding ver %d:\n", je32_to_cpu(rd->version)); 834 854 tn = tn_first(&rii->tn_root); 835 855 while (tn) { 836 856 dbg_readinode("%p: v %d r 0x%x-0x%x ov %d\n",
+4 -1
fs/jffs2/wbuf.c
··· 637 637 638 638 memset(c->wbuf,0xff,c->wbuf_pagesize); 639 639 /* adjust write buffer offset, else we get a non contiguous write bug */ 640 - c->wbuf_ofs += c->wbuf_pagesize; 640 + if (SECTOR_ADDR(c->wbuf_ofs) == SECTOR_ADDR(c->wbuf_ofs+c->wbuf_pagesize)) 641 + c->wbuf_ofs += c->wbuf_pagesize; 642 + else 643 + c->wbuf_ofs = 0xffffffff; 641 644 c->wbuf_len = 0; 642 645 return 0; 643 646 }
-7
include/linux/mtd/mtd.h
··· 9 9 #ifndef __MTD_MTD_H__ 10 10 #define __MTD_MTD_H__ 11 11 12 - #ifndef __KERNEL__ 13 - #error This is a kernel header. Perhaps include mtd-user.h instead? 14 - #endif 15 - 16 12 #include <linux/types.h> 17 13 #include <linux/module.h> 18 14 #include <linux/uio.h> ··· 132 136 */ 133 137 int numeraseregions; 134 138 struct mtd_erase_region_info *eraseregions; 135 - 136 - /* This really shouldn't be here. It can go away in 2.5 */ 137 - u_int32_t bank_size; 138 139 139 140 int (*erase) (struct mtd_info *mtd, struct erase_info *instr); 140 141
+16
include/linux/mtd/nand.h
··· 560 560 * @chip_delay: R/B delay value in us 561 561 * @options: Option flags, e.g. 16bit buswidth 562 562 * @ecclayout: ecc layout info structure 563 + * @part_probe_types: NULL-terminated array of probe types 563 564 * @priv: hardware controller specific settings 564 565 */ 565 566 struct platform_nand_chip { ··· 571 570 struct nand_ecclayout *ecclayout; 572 571 int chip_delay; 573 572 unsigned int options; 573 + const char **part_probe_types; 574 574 void *priv; 575 575 }; 576 576 ··· 580 578 * @hwcontrol: platform specific hardware control structure 581 579 * @dev_ready: platform specific function to read ready/busy pin 582 580 * @select_chip: platform specific chip select function 581 + * @cmd_ctrl: platform specific function for controlling 582 + * ALE/CLE/nCE. Also used to write command and address 583 583 * @priv: private data to transport driver specific settings 584 584 * 585 585 * All fields are optional and depend on the hardware driver requirements ··· 590 586 void (*hwcontrol)(struct mtd_info *mtd, int cmd); 591 587 int (*dev_ready)(struct mtd_info *mtd); 592 588 void (*select_chip)(struct mtd_info *mtd, int chip); 589 + void (*cmd_ctrl)(struct mtd_info *mtd, int dat, 590 + unsigned int ctrl); 593 591 void *priv; 592 + }; 593 + 594 + /** 595 + * struct platform_nand_data - container structure for platform-specific data 596 + * @chip: chip level chip structure 597 + * @ctrl: controller level device structure 598 + */ 599 + struct platform_nand_data { 600 + struct platform_nand_chip chip; 601 + struct platform_nand_ctrl ctrl; 594 602 }; 595 603 596 604 /* Some helpers to access the data structures */
+4
include/linux/rslib.h
··· 34 34 * @prim: Primitive element, index form 35 35 * @iprim: prim-th root of 1, index form 36 36 * @gfpoly: The primitive generator polynominal 37 + * @gffunc: Function to generate the field, if non-canonical representation 37 38 * @users: Users of this structure 38 39 * @list: List entry for the rs control list 39 40 */ ··· 49 48 int prim; 50 49 int iprim; 51 50 int gfpoly; 51 + int (*gffunc)(int); 52 52 int users; 53 53 struct list_head list; 54 54 }; ··· 79 77 /* Create or get a matching rs control structure */ 80 78 struct rs_control *init_rs(int symsize, int gfpoly, int fcr, int prim, 81 79 int nroots); 80 + struct rs_control *init_rs_non_canonical(int symsize, int (*func)(int), 81 + int fcr, int prim, int nroots); 82 82 83 83 /* Release a rs control structure */ 84 84 void free_rs(struct rs_control *rs);
+69 -15
lib/reed_solomon/reed_solomon.c
··· 56 56 * rs_init - Initialize a Reed-Solomon codec 57 57 * @symsize: symbol size, bits (1-8) 58 58 * @gfpoly: Field generator polynomial coefficients 59 + * @gffunc: Field generator function 59 60 * @fcr: first root of RS code generator polynomial, index form 60 61 * @prim: primitive element to generate polynomial roots 61 62 * @nroots: RS code generator polynomial degree (number of roots) ··· 64 63 * Allocate a control structure and the polynom arrays for faster 65 64 * en/decoding. Fill the arrays according to the given parameters. 66 65 */ 67 - static struct rs_control *rs_init(int symsize, int gfpoly, int fcr, 68 - int prim, int nroots) 66 + static struct rs_control *rs_init(int symsize, int gfpoly, int (*gffunc)(int), 67 + int fcr, int prim, int nroots) 69 68 { 70 69 struct rs_control *rs; 71 70 int i, j, sr, root, iprim; ··· 83 82 rs->prim = prim; 84 83 rs->nroots = nroots; 85 84 rs->gfpoly = gfpoly; 85 + rs->gffunc = gffunc; 86 86 87 87 /* Allocate the arrays */ 88 88 rs->alpha_to = kmalloc(sizeof(uint16_t) * (rs->nn + 1), GFP_KERNEL); ··· 101 99 /* Generate Galois field lookup tables */ 102 100 rs->index_of[0] = rs->nn; /* log(zero) = -inf */ 103 101 rs->alpha_to[rs->nn] = 0; /* alpha**-inf = 0 */ 104 - sr = 1; 105 - for (i = 0; i < rs->nn; i++) { 106 - rs->index_of[sr] = i; 107 - rs->alpha_to[i] = sr; 108 - sr <<= 1; 109 - if (sr & (1 << symsize)) 110 - sr ^= gfpoly; 111 - sr &= rs->nn; 102 + if (gfpoly) { 103 + sr = 1; 104 + for (i = 0; i < rs->nn; i++) { 105 + rs->index_of[sr] = i; 106 + rs->alpha_to[i] = sr; 107 + sr <<= 1; 108 + if (sr & (1 << symsize)) 109 + sr ^= gfpoly; 110 + sr &= rs->nn; 111 + } 112 + } else { 113 + sr = gffunc(0); 114 + for (i = 0; i < rs->nn; i++) { 115 + rs->index_of[sr] = i; 116 + rs->alpha_to[i] = sr; 117 + sr = gffunc(sr); 118 + } 112 119 } 113 120 /* If it's not primitive, exit */ 114 - if(sr != 1) 121 + if(sr != rs->alpha_to[0]) 115 122 goto errpol; 116 123 117 124 /* Find prim-th root of 1, used in decoding */ ··· 184 173 } 185 174 186 175 /** 187 - * init_rs - Find a matching or allocate a new rs control structure 176 + * init_rs_internal - Find a matching or allocate a new rs control structure 188 177 * @symsize: the symbol size (number of bits) 189 178 * @gfpoly: the extended Galois field generator polynomial coefficients, 190 179 * with the 0th coefficient in the low order bit. The polynomial 191 180 * must be primitive; 181 + * @gffunc: pointer to function to generate the next field element, 182 + * or the multiplicative identity element if given 0. Used 183 + * instead of gfpoly if gfpoly is 0 192 184 * @fcr: the first consecutive root of the rs code generator polynomial 193 185 * in index form 194 186 * @prim: primitive element to generate polynomial roots 195 187 * @nroots: RS code generator polynomial degree (number of roots) 196 188 */ 197 - struct rs_control *init_rs(int symsize, int gfpoly, int fcr, int prim, 198 - int nroots) 189 + static struct rs_control *init_rs_internal(int symsize, int gfpoly, 190 + int (*gffunc)(int), int fcr, 191 + int prim, int nroots) 199 192 { 200 193 struct list_head *tmp; 201 194 struct rs_control *rs; ··· 223 208 continue; 224 209 if (gfpoly != rs->gfpoly) 225 210 continue; 211 + if (gffunc != rs->gffunc) 212 + continue; 226 213 if (fcr != rs->fcr) 227 214 continue; 228 215 if (prim != rs->prim) ··· 237 220 } 238 221 239 222 /* Create a new one */ 240 - rs = rs_init(symsize, gfpoly, fcr, prim, nroots); 223 + rs = rs_init(symsize, gfpoly, gffunc, fcr, prim, nroots); 241 224 if (rs) { 242 225 rs->users = 1; 243 226 list_add(&rs->list, &rslist); ··· 245 228 out: 246 229 mutex_unlock(&rslistlock); 247 230 return rs; 231 + } 232 + 233 + /** 234 + * init_rs - Find a matching or allocate a new rs control structure 235 + * @symsize: the symbol size (number of bits) 236 + * @gfpoly: the extended Galois field generator polynomial coefficients, 237 + * with the 0th coefficient in the low order bit. The polynomial 238 + * must be primitive; 239 + * @fcr: the first consecutive root of the rs code generator polynomial 240 + * in index form 241 + * @prim: primitive element to generate polynomial roots 242 + * @nroots: RS code generator polynomial degree (number of roots) 243 + */ 244 + struct rs_control *init_rs(int symsize, int gfpoly, int fcr, int prim, 245 + int nroots) 246 + { 247 + return init_rs_internal(symsize, gfpoly, NULL, fcr, prim, nroots); 248 + } 249 + 250 + /** 251 + * init_rs_non_canonical - Find a matching or allocate a new rs control 252 + * structure, for fields with non-canonical 253 + * representation 254 + * @symsize: the symbol size (number of bits) 255 + * @gffunc: pointer to function to generate the next field element, 256 + * or the multiplicative identity element if given 0. Used 257 + * instead of gfpoly if gfpoly is 0 258 + * @fcr: the first consecutive root of the rs code generator polynomial 259 + * in index form 260 + * @prim: primitive element to generate polynomial roots 261 + * @nroots: RS code generator polynomial degree (number of roots) 262 + */ 263 + struct rs_control *init_rs_non_canonical(int symsize, int (*gffunc)(int), 264 + int fcr, int prim, int nroots) 265 + { 266 + return init_rs_internal(symsize, 0, gffunc, fcr, prim, nroots); 248 267 } 249 268 250 269 #ifdef CONFIG_REED_SOLOMON_ENC8 ··· 374 321 #endif 375 322 376 323 EXPORT_SYMBOL_GPL(init_rs); 324 + EXPORT_SYMBOL_GPL(init_rs_non_canonical); 377 325 EXPORT_SYMBOL_GPL(free_rs); 378 326 379 327 MODULE_LICENSE("GPL");