1 /* 2 * Linux driver for NAND Flash Translation Layer 3 * 4 * Copyright © 1999 Machine Vision Holdings, Inc. 5 * Copyright © 1999-2010 David Woodhouse <dwmw2@infradead.org> 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 22 #define PRERELEASE 23 24 #include <linux/kernel.h> 25 #include <linux/module.h> 26 #include <asm/errno.h> 27 #include <asm/io.h> 28 #include <asm/uaccess.h> 29 #include <linux/delay.h> 30 #include <linux/slab.h> 31 #include <linux/init.h> 32 #include <linux/hdreg.h> 33 #include <linux/blkdev.h> 34 35 #include <linux/kmod.h> 36 #include <linux/mtd/mtd.h> 37 #include <linux/mtd/nand.h> 38 #include <linux/mtd/nftl.h> 39 #include <linux/mtd/blktrans.h> 40 41 /* maximum number of loops while examining next block, to have a 42 chance to detect consistency problems (they should never happen 43 because of the checks done in the mounting */ 44 45 #define MAX_LOOPS 10000 46 47 48 static void nftl_add_mtd(struct mtd_blktrans_ops *tr, struct mtd_info *mtd) 49 { 50 struct NFTLrecord *nftl; 51 unsigned long temp; 52 53 if (mtd->type != MTD_NANDFLASH || mtd->size > UINT_MAX) 54 return; 55 /* OK, this is moderately ugly. But probably safe. Alternatives? */ 56 if (memcmp(mtd->name, "DiskOnChip", 10)) 57 return; 58 59 if (!mtd->block_isbad) { 60 printk(KERN_ERR 61 "NFTL no longer supports the old DiskOnChip drivers loaded via docprobe.\n" 62 "Please use the new diskonchip driver under the NAND subsystem.\n"); 63 return; 64 } 65 66 DEBUG(MTD_DEBUG_LEVEL1, "NFTL: add_mtd for %s\n", mtd->name); 67 68 nftl = kzalloc(sizeof(struct NFTLrecord), GFP_KERNEL); 69 70 if (!nftl) { 71 printk(KERN_WARNING "NFTL: out of memory for data structures\n"); 72 return; 73 } 74 75 nftl->mbd.mtd = mtd; 76 nftl->mbd.devnum = -1; 77 78 nftl->mbd.tr = tr; 79 80 if (NFTL_mount(nftl) < 0) { 81 printk(KERN_WARNING "NFTL: could not mount device\n"); 82 kfree(nftl); 83 return; 84 } 85 86 /* OK, it's a new one. Set up all the data structures. */ 87 88 /* Calculate geometry */ 89 nftl->cylinders = 1024; 90 nftl->heads = 16; 91 92 temp = nftl->cylinders * nftl->heads; 93 nftl->sectors = nftl->mbd.size / temp; 94 if (nftl->mbd.size % temp) { 95 nftl->sectors++; 96 temp = nftl->cylinders * nftl->sectors; 97 nftl->heads = nftl->mbd.size / temp; 98 99 if (nftl->mbd.size % temp) { 100 nftl->heads++; 101 temp = nftl->heads * nftl->sectors; 102 nftl->cylinders = nftl->mbd.size / temp; 103 } 104 } 105 106 if (nftl->mbd.size != nftl->heads * nftl->cylinders * nftl->sectors) { 107 /* 108 Oh no we don't have 109 mbd.size == heads * cylinders * sectors 110 */ 111 printk(KERN_WARNING "NFTL: cannot calculate a geometry to " 112 "match size of 0x%lx.\n", nftl->mbd.size); 113 printk(KERN_WARNING "NFTL: using C:%d H:%d S:%d " 114 "(== 0x%lx sects)\n", 115 nftl->cylinders, nftl->heads , nftl->sectors, 116 (long)nftl->cylinders * (long)nftl->heads * 117 (long)nftl->sectors ); 118 } 119 120 if (add_mtd_blktrans_dev(&nftl->mbd)) { 121 kfree(nftl->ReplUnitTable); 122 kfree(nftl->EUNtable); 123 kfree(nftl); 124 return; 125 } 126 #ifdef PSYCHO_DEBUG 127 printk(KERN_INFO "NFTL: Found new nftl%c\n", nftl->mbd.devnum + 'a'); 128 #endif 129 } 130 131 static void nftl_remove_dev(struct mtd_blktrans_dev *dev) 132 { 133 struct NFTLrecord *nftl = (void *)dev; 134 135 DEBUG(MTD_DEBUG_LEVEL1, "NFTL: remove_dev (i=%d)\n", dev->devnum); 136 137 del_mtd_blktrans_dev(dev); 138 kfree(nftl->ReplUnitTable); 139 kfree(nftl->EUNtable); 140 } 141 142 /* 143 * Read oob data from flash 144 */ 145 int nftl_read_oob(struct mtd_info *mtd, loff_t offs, size_t len, 146 size_t *retlen, uint8_t *buf) 147 { 148 loff_t mask = mtd->writesize - 1; 149 struct mtd_oob_ops ops; 150 int res; 151 152 ops.mode = MTD_OOB_PLACE; 153 ops.ooboffs = offs & mask; 154 ops.ooblen = len; 155 ops.oobbuf = buf; 156 ops.datbuf = NULL; 157 158 res = mtd->read_oob(mtd, offs & ~mask, &ops); 159 *retlen = ops.oobretlen; 160 return res; 161 } 162 163 /* 164 * Write oob data to flash 165 */ 166 int nftl_write_oob(struct mtd_info *mtd, loff_t offs, size_t len, 167 size_t *retlen, uint8_t *buf) 168 { 169 loff_t mask = mtd->writesize - 1; 170 struct mtd_oob_ops ops; 171 int res; 172 173 ops.mode = MTD_OOB_PLACE; 174 ops.ooboffs = offs & mask; 175 ops.ooblen = len; 176 ops.oobbuf = buf; 177 ops.datbuf = NULL; 178 179 res = mtd->write_oob(mtd, offs & ~mask, &ops); 180 *retlen = ops.oobretlen; 181 return res; 182 } 183 184 #ifdef CONFIG_NFTL_RW 185 186 /* 187 * Write data and oob to flash 188 */ 189 static int nftl_write(struct mtd_info *mtd, loff_t offs, size_t len, 190 size_t *retlen, uint8_t *buf, uint8_t *oob) 191 { 192 loff_t mask = mtd->writesize - 1; 193 struct mtd_oob_ops ops; 194 int res; 195 196 ops.mode = MTD_OOB_PLACE; 197 ops.ooboffs = offs & mask; 198 ops.ooblen = mtd->oobsize; 199 ops.oobbuf = oob; 200 ops.datbuf = buf; 201 ops.len = len; 202 203 res = mtd->write_oob(mtd, offs & ~mask, &ops); 204 *retlen = ops.retlen; 205 return res; 206 } 207 208 /* Actual NFTL access routines */ 209 /* NFTL_findfreeblock: Find a free Erase Unit on the NFTL partition. This function is used 210 * when the give Virtual Unit Chain 211 */ 212 static u16 NFTL_findfreeblock(struct NFTLrecord *nftl, int desperate ) 213 { 214 /* For a given Virtual Unit Chain: find or create a free block and 215 add it to the chain */ 216 /* We're passed the number of the last EUN in the chain, to save us from 217 having to look it up again */ 218 u16 pot = nftl->LastFreeEUN; 219 int silly = nftl->nb_blocks; 220 221 /* Normally, we force a fold to happen before we run out of free blocks completely */ 222 if (!desperate && nftl->numfreeEUNs < 2) { 223 DEBUG(MTD_DEBUG_LEVEL1, "NFTL_findfreeblock: there are too few free EUNs\n"); 224 return BLOCK_NIL; 225 } 226 227 /* Scan for a free block */ 228 do { 229 if (nftl->ReplUnitTable[pot] == BLOCK_FREE) { 230 nftl->LastFreeEUN = pot; 231 nftl->numfreeEUNs--; 232 return pot; 233 } 234 235 /* This will probably point to the MediaHdr unit itself, 236 right at the beginning of the partition. But that unit 237 (and the backup unit too) should have the UCI set 238 up so that it's not selected for overwriting */ 239 if (++pot > nftl->lastEUN) 240 pot = le16_to_cpu(nftl->MediaHdr.FirstPhysicalEUN); 241 242 if (!silly--) { 243 printk("Argh! No free blocks found! LastFreeEUN = %d, " 244 "FirstEUN = %d\n", nftl->LastFreeEUN, 245 le16_to_cpu(nftl->MediaHdr.FirstPhysicalEUN)); 246 return BLOCK_NIL; 247 } 248 } while (pot != nftl->LastFreeEUN); 249 250 return BLOCK_NIL; 251 } 252 253 static u16 NFTL_foldchain (struct NFTLrecord *nftl, unsigned thisVUC, unsigned pendingblock ) 254 { 255 struct mtd_info *mtd = nftl->mbd.mtd; 256 u16 BlockMap[MAX_SECTORS_PER_UNIT]; 257 unsigned char BlockLastState[MAX_SECTORS_PER_UNIT]; 258 unsigned char BlockFreeFound[MAX_SECTORS_PER_UNIT]; 259 unsigned int thisEUN; 260 int block; 261 int silly; 262 unsigned int targetEUN; 263 struct nftl_oob oob; 264 int inplace = 1; 265 size_t retlen; 266 267 memset(BlockMap, 0xff, sizeof(BlockMap)); 268 memset(BlockFreeFound, 0, sizeof(BlockFreeFound)); 269 270 thisEUN = nftl->EUNtable[thisVUC]; 271 272 if (thisEUN == BLOCK_NIL) { 273 printk(KERN_WARNING "Trying to fold non-existent " 274 "Virtual Unit Chain %d!\n", thisVUC); 275 return BLOCK_NIL; 276 } 277 278 /* Scan to find the Erase Unit which holds the actual data for each 279 512-byte block within the Chain. 280 */ 281 silly = MAX_LOOPS; 282 targetEUN = BLOCK_NIL; 283 while (thisEUN <= nftl->lastEUN ) { 284 unsigned int status, foldmark; 285 286 targetEUN = thisEUN; 287 for (block = 0; block < nftl->EraseSize / 512; block ++) { 288 nftl_read_oob(mtd, (thisEUN * nftl->EraseSize) + 289 (block * 512), 16 , &retlen, 290 (char *)&oob); 291 if (block == 2) { 292 foldmark = oob.u.c.FoldMark | oob.u.c.FoldMark1; 293 if (foldmark == FOLD_MARK_IN_PROGRESS) { 294 DEBUG(MTD_DEBUG_LEVEL1, 295 "Write Inhibited on EUN %d\n", thisEUN); 296 inplace = 0; 297 } else { 298 /* There's no other reason not to do inplace, 299 except ones that come later. So we don't need 300 to preserve inplace */ 301 inplace = 1; 302 } 303 } 304 status = oob.b.Status | oob.b.Status1; 305 BlockLastState[block] = status; 306 307 switch(status) { 308 case SECTOR_FREE: 309 BlockFreeFound[block] = 1; 310 break; 311 312 case SECTOR_USED: 313 if (!BlockFreeFound[block]) 314 BlockMap[block] = thisEUN; 315 else 316 printk(KERN_WARNING 317 "SECTOR_USED found after SECTOR_FREE " 318 "in Virtual Unit Chain %d for block %d\n", 319 thisVUC, block); 320 break; 321 case SECTOR_DELETED: 322 if (!BlockFreeFound[block]) 323 BlockMap[block] = BLOCK_NIL; 324 else 325 printk(KERN_WARNING 326 "SECTOR_DELETED found after SECTOR_FREE " 327 "in Virtual Unit Chain %d for block %d\n", 328 thisVUC, block); 329 break; 330 331 case SECTOR_IGNORE: 332 break; 333 default: 334 printk("Unknown status for block %d in EUN %d: %x\n", 335 block, thisEUN, status); 336 } 337 } 338 339 if (!silly--) { 340 printk(KERN_WARNING "Infinite loop in Virtual Unit Chain 0x%x\n", 341 thisVUC); 342 return BLOCK_NIL; 343 } 344 345 thisEUN = nftl->ReplUnitTable[thisEUN]; 346 } 347 348 if (inplace) { 349 /* We're being asked to be a fold-in-place. Check 350 that all blocks which actually have data associated 351 with them (i.e. BlockMap[block] != BLOCK_NIL) are 352 either already present or SECTOR_FREE in the target 353 block. If not, we're going to have to fold out-of-place 354 anyway. 355 */ 356 for (block = 0; block < nftl->EraseSize / 512 ; block++) { 357 if (BlockLastState[block] != SECTOR_FREE && 358 BlockMap[block] != BLOCK_NIL && 359 BlockMap[block] != targetEUN) { 360 DEBUG(MTD_DEBUG_LEVEL1, "Setting inplace to 0. VUC %d, " 361 "block %d was %x lastEUN, " 362 "and is in EUN %d (%s) %d\n", 363 thisVUC, block, BlockLastState[block], 364 BlockMap[block], 365 BlockMap[block]== targetEUN ? "==" : "!=", 366 targetEUN); 367 inplace = 0; 368 break; 369 } 370 } 371 372 if (pendingblock >= (thisVUC * (nftl->EraseSize / 512)) && 373 pendingblock < ((thisVUC + 1)* (nftl->EraseSize / 512)) && 374 BlockLastState[pendingblock - (thisVUC * (nftl->EraseSize / 512))] != 375 SECTOR_FREE) { 376 DEBUG(MTD_DEBUG_LEVEL1, "Pending write not free in EUN %d. " 377 "Folding out of place.\n", targetEUN); 378 inplace = 0; 379 } 380 } 381 382 if (!inplace) { 383 DEBUG(MTD_DEBUG_LEVEL1, "Cannot fold Virtual Unit Chain %d in place. " 384 "Trying out-of-place\n", thisVUC); 385 /* We need to find a targetEUN to fold into. */ 386 targetEUN = NFTL_findfreeblock(nftl, 1); 387 if (targetEUN == BLOCK_NIL) { 388 /* Ouch. Now we're screwed. We need to do a 389 fold-in-place of another chain to make room 390 for this one. We need a better way of selecting 391 which chain to fold, because makefreeblock will 392 only ask us to fold the same one again. 393 */ 394 printk(KERN_WARNING 395 "NFTL_findfreeblock(desperate) returns 0xffff.\n"); 396 return BLOCK_NIL; 397 } 398 } else { 399 /* We put a fold mark in the chain we are folding only if we 400 fold in place to help the mount check code. If we do not fold in 401 place, it is possible to find the valid chain by selecting the 402 longer one */ 403 oob.u.c.FoldMark = oob.u.c.FoldMark1 = cpu_to_le16(FOLD_MARK_IN_PROGRESS); 404 oob.u.c.unused = 0xffffffff; 405 nftl_write_oob(mtd, (nftl->EraseSize * targetEUN) + 2 * 512 + 8, 406 8, &retlen, (char *)&oob.u); 407 } 408 409 /* OK. We now know the location of every block in the Virtual Unit Chain, 410 and the Erase Unit into which we are supposed to be copying. 411 Go for it. 412 */ 413 DEBUG(MTD_DEBUG_LEVEL1,"Folding chain %d into unit %d\n", thisVUC, targetEUN); 414 for (block = 0; block < nftl->EraseSize / 512 ; block++) { 415 unsigned char movebuf[512]; 416 int ret; 417 418 /* If it's in the target EUN already, or if it's pending write, do nothing */ 419 if (BlockMap[block] == targetEUN || 420 (pendingblock == (thisVUC * (nftl->EraseSize / 512) + block))) { 421 continue; 422 } 423 424 /* copy only in non free block (free blocks can only 425 happen in case of media errors or deleted blocks) */ 426 if (BlockMap[block] == BLOCK_NIL) 427 continue; 428 429 ret = mtd->read(mtd, (nftl->EraseSize * BlockMap[block]) + (block * 512), 430 512, &retlen, movebuf); 431 if (ret < 0 && ret != -EUCLEAN) { 432 ret = mtd->read(mtd, (nftl->EraseSize * BlockMap[block]) 433 + (block * 512), 512, &retlen, 434 movebuf); 435 if (ret != -EIO) 436 printk("Error went away on retry.\n"); 437 } 438 memset(&oob, 0xff, sizeof(struct nftl_oob)); 439 oob.b.Status = oob.b.Status1 = SECTOR_USED; 440 441 nftl_write(nftl->mbd.mtd, (nftl->EraseSize * targetEUN) + 442 (block * 512), 512, &retlen, movebuf, (char *)&oob); 443 } 444 445 /* add the header so that it is now a valid chain */ 446 oob.u.a.VirtUnitNum = oob.u.a.SpareVirtUnitNum = cpu_to_le16(thisVUC); 447 oob.u.a.ReplUnitNum = oob.u.a.SpareReplUnitNum = BLOCK_NIL; 448 449 nftl_write_oob(mtd, (nftl->EraseSize * targetEUN) + 8, 450 8, &retlen, (char *)&oob.u); 451 452 /* OK. We've moved the whole lot into the new block. Now we have to free the original blocks. */ 453 454 /* At this point, we have two different chains for this Virtual Unit, and no way to tell 455 them apart. If we crash now, we get confused. However, both contain the same data, so we 456 shouldn't actually lose data in this case. It's just that when we load up on a medium which 457 has duplicate chains, we need to free one of the chains because it's not necessary any more. 458 */ 459 thisEUN = nftl->EUNtable[thisVUC]; 460 DEBUG(MTD_DEBUG_LEVEL1,"Want to erase\n"); 461 462 /* For each block in the old chain (except the targetEUN of course), 463 free it and make it available for future use */ 464 while (thisEUN <= nftl->lastEUN && thisEUN != targetEUN) { 465 unsigned int EUNtmp; 466 467 EUNtmp = nftl->ReplUnitTable[thisEUN]; 468 469 if (NFTL_formatblock(nftl, thisEUN) < 0) { 470 /* could not erase : mark block as reserved 471 */ 472 nftl->ReplUnitTable[thisEUN] = BLOCK_RESERVED; 473 } else { 474 /* correctly erased : mark it as free */ 475 nftl->ReplUnitTable[thisEUN] = BLOCK_FREE; 476 nftl->numfreeEUNs++; 477 } 478 thisEUN = EUNtmp; 479 } 480 481 /* Make this the new start of chain for thisVUC */ 482 nftl->ReplUnitTable[targetEUN] = BLOCK_NIL; 483 nftl->EUNtable[thisVUC] = targetEUN; 484 485 return targetEUN; 486 } 487 488 static u16 NFTL_makefreeblock( struct NFTLrecord *nftl , unsigned pendingblock) 489 { 490 /* This is the part that needs some cleverness applied. 491 For now, I'm doing the minimum applicable to actually 492 get the thing to work. 493 Wear-levelling and other clever stuff needs to be implemented 494 and we also need to do some assessment of the results when 495 the system loses power half-way through the routine. 496 */ 497 u16 LongestChain = 0; 498 u16 ChainLength = 0, thislen; 499 u16 chain, EUN; 500 501 for (chain = 0; chain < le32_to_cpu(nftl->MediaHdr.FormattedSize) / nftl->EraseSize; chain++) { 502 EUN = nftl->EUNtable[chain]; 503 thislen = 0; 504 505 while (EUN <= nftl->lastEUN) { 506 thislen++; 507 //printk("VUC %d reaches len %d with EUN %d\n", chain, thislen, EUN); 508 EUN = nftl->ReplUnitTable[EUN] & 0x7fff; 509 if (thislen > 0xff00) { 510 printk("Endless loop in Virtual Chain %d: Unit %x\n", 511 chain, EUN); 512 } 513 if (thislen > 0xff10) { 514 /* Actually, don't return failure. Just ignore this chain and 515 get on with it. */ 516 thislen = 0; 517 break; 518 } 519 } 520 521 if (thislen > ChainLength) { 522 //printk("New longest chain is %d with length %d\n", chain, thislen); 523 ChainLength = thislen; 524 LongestChain = chain; 525 } 526 } 527 528 if (ChainLength < 2) { 529 printk(KERN_WARNING "No Virtual Unit Chains available for folding. " 530 "Failing request\n"); 531 return BLOCK_NIL; 532 } 533 534 return NFTL_foldchain (nftl, LongestChain, pendingblock); 535 } 536 537 /* NFTL_findwriteunit: Return the unit number into which we can write 538 for this block. Make it available if it isn't already 539 */ 540 static inline u16 NFTL_findwriteunit(struct NFTLrecord *nftl, unsigned block) 541 { 542 u16 lastEUN; 543 u16 thisVUC = block / (nftl->EraseSize / 512); 544 struct mtd_info *mtd = nftl->mbd.mtd; 545 unsigned int writeEUN; 546 unsigned long blockofs = (block * 512) & (nftl->EraseSize -1); 547 size_t retlen; 548 int silly, silly2 = 3; 549 struct nftl_oob oob; 550 551 do { 552 /* Scan the media to find a unit in the VUC which has 553 a free space for the block in question. 554 */ 555 556 /* This condition catches the 0x[7f]fff cases, as well as 557 being a sanity check for past-end-of-media access 558 */ 559 lastEUN = BLOCK_NIL; 560 writeEUN = nftl->EUNtable[thisVUC]; 561 silly = MAX_LOOPS; 562 while (writeEUN <= nftl->lastEUN) { 563 struct nftl_bci bci; 564 size_t retlen; 565 unsigned int status; 566 567 lastEUN = writeEUN; 568 569 nftl_read_oob(mtd, 570 (writeEUN * nftl->EraseSize) + blockofs, 571 8, &retlen, (char *)&bci); 572 573 DEBUG(MTD_DEBUG_LEVEL2, "Status of block %d in EUN %d is %x\n", 574 block , writeEUN, le16_to_cpu(bci.Status)); 575 576 status = bci.Status | bci.Status1; 577 switch(status) { 578 case SECTOR_FREE: 579 return writeEUN; 580 581 case SECTOR_DELETED: 582 case SECTOR_USED: 583 case SECTOR_IGNORE: 584 break; 585 default: 586 // Invalid block. Don't use it any more. Must implement. 587 break; 588 } 589 590 if (!silly--) { 591 printk(KERN_WARNING 592 "Infinite loop in Virtual Unit Chain 0x%x\n", 593 thisVUC); 594 return BLOCK_NIL; 595 } 596 597 /* Skip to next block in chain */ 598 writeEUN = nftl->ReplUnitTable[writeEUN]; 599 } 600 601 /* OK. We didn't find one in the existing chain, or there 602 is no existing chain. */ 603 604 /* Try to find an already-free block */ 605 writeEUN = NFTL_findfreeblock(nftl, 0); 606 607 if (writeEUN == BLOCK_NIL) { 608 /* That didn't work - there were no free blocks just 609 waiting to be picked up. We're going to have to fold 610 a chain to make room. 611 */ 612 613 /* First remember the start of this chain */ 614 //u16 startEUN = nftl->EUNtable[thisVUC]; 615 616 //printk("Write to VirtualUnitChain %d, calling makefreeblock()\n", thisVUC); 617 writeEUN = NFTL_makefreeblock(nftl, BLOCK_NIL); 618 619 if (writeEUN == BLOCK_NIL) { 620 /* OK, we accept that the above comment is 621 lying - there may have been free blocks 622 last time we called NFTL_findfreeblock(), 623 but they are reserved for when we're 624 desperate. Well, now we're desperate. 625 */ 626 DEBUG(MTD_DEBUG_LEVEL1, "Using desperate==1 to find free EUN to accommodate write to VUC %d\n", thisVUC); 627 writeEUN = NFTL_findfreeblock(nftl, 1); 628 } 629 if (writeEUN == BLOCK_NIL) { 630 /* Ouch. This should never happen - we should 631 always be able to make some room somehow. 632 If we get here, we've allocated more storage 633 space than actual media, or our makefreeblock 634 routine is missing something. 635 */ 636 printk(KERN_WARNING "Cannot make free space.\n"); 637 return BLOCK_NIL; 638 } 639 //printk("Restarting scan\n"); 640 lastEUN = BLOCK_NIL; 641 continue; 642 } 643 644 /* We've found a free block. Insert it into the chain. */ 645 646 if (lastEUN != BLOCK_NIL) { 647 thisVUC |= 0x8000; /* It's a replacement block */ 648 } else { 649 /* The first block in a new chain */ 650 nftl->EUNtable[thisVUC] = writeEUN; 651 } 652 653 /* set up the actual EUN we're writing into */ 654 /* Both in our cache... */ 655 nftl->ReplUnitTable[writeEUN] = BLOCK_NIL; 656 657 /* ... and on the flash itself */ 658 nftl_read_oob(mtd, writeEUN * nftl->EraseSize + 8, 8, 659 &retlen, (char *)&oob.u); 660 661 oob.u.a.VirtUnitNum = oob.u.a.SpareVirtUnitNum = cpu_to_le16(thisVUC); 662 663 nftl_write_oob(mtd, writeEUN * nftl->EraseSize + 8, 8, 664 &retlen, (char *)&oob.u); 665 666 /* we link the new block to the chain only after the 667 block is ready. It avoids the case where the chain 668 could point to a free block */ 669 if (lastEUN != BLOCK_NIL) { 670 /* Both in our cache... */ 671 nftl->ReplUnitTable[lastEUN] = writeEUN; 672 /* ... and on the flash itself */ 673 nftl_read_oob(mtd, (lastEUN * nftl->EraseSize) + 8, 674 8, &retlen, (char *)&oob.u); 675 676 oob.u.a.ReplUnitNum = oob.u.a.SpareReplUnitNum 677 = cpu_to_le16(writeEUN); 678 679 nftl_write_oob(mtd, (lastEUN * nftl->EraseSize) + 8, 680 8, &retlen, (char *)&oob.u); 681 } 682 683 return writeEUN; 684 685 } while (silly2--); 686 687 printk(KERN_WARNING "Error folding to make room for Virtual Unit Chain 0x%x\n", 688 thisVUC); 689 return BLOCK_NIL; 690 } 691 692 static int nftl_writeblock(struct mtd_blktrans_dev *mbd, unsigned long block, 693 char *buffer) 694 { 695 struct NFTLrecord *nftl = (void *)mbd; 696 u16 writeEUN; 697 unsigned long blockofs = (block * 512) & (nftl->EraseSize - 1); 698 size_t retlen; 699 struct nftl_oob oob; 700 701 writeEUN = NFTL_findwriteunit(nftl, block); 702 703 if (writeEUN == BLOCK_NIL) { 704 printk(KERN_WARNING 705 "NFTL_writeblock(): Cannot find block to write to\n"); 706 /* If we _still_ haven't got a block to use, we're screwed */ 707 return 1; 708 } 709 710 memset(&oob, 0xff, sizeof(struct nftl_oob)); 711 oob.b.Status = oob.b.Status1 = SECTOR_USED; 712 713 nftl_write(nftl->mbd.mtd, (writeEUN * nftl->EraseSize) + blockofs, 714 512, &retlen, (char *)buffer, (char *)&oob); 715 return 0; 716 } 717 #endif /* CONFIG_NFTL_RW */ 718 719 static int nftl_readblock(struct mtd_blktrans_dev *mbd, unsigned long block, 720 char *buffer) 721 { 722 struct NFTLrecord *nftl = (void *)mbd; 723 struct mtd_info *mtd = nftl->mbd.mtd; 724 u16 lastgoodEUN; 725 u16 thisEUN = nftl->EUNtable[block / (nftl->EraseSize / 512)]; 726 unsigned long blockofs = (block * 512) & (nftl->EraseSize - 1); 727 unsigned int status; 728 int silly = MAX_LOOPS; 729 size_t retlen; 730 struct nftl_bci bci; 731 732 lastgoodEUN = BLOCK_NIL; 733 734 if (thisEUN != BLOCK_NIL) { 735 while (thisEUN < nftl->nb_blocks) { 736 if (nftl_read_oob(mtd, (thisEUN * nftl->EraseSize) + 737 blockofs, 8, &retlen, 738 (char *)&bci) < 0) 739 status = SECTOR_IGNORE; 740 else 741 status = bci.Status | bci.Status1; 742 743 switch (status) { 744 case SECTOR_FREE: 745 /* no modification of a sector should follow a free sector */ 746 goto the_end; 747 case SECTOR_DELETED: 748 lastgoodEUN = BLOCK_NIL; 749 break; 750 case SECTOR_USED: 751 lastgoodEUN = thisEUN; 752 break; 753 case SECTOR_IGNORE: 754 break; 755 default: 756 printk("Unknown status for block %ld in EUN %d: %x\n", 757 block, thisEUN, status); 758 break; 759 } 760 761 if (!silly--) { 762 printk(KERN_WARNING "Infinite loop in Virtual Unit Chain 0x%lx\n", 763 block / (nftl->EraseSize / 512)); 764 return 1; 765 } 766 thisEUN = nftl->ReplUnitTable[thisEUN]; 767 } 768 } 769 770 the_end: 771 if (lastgoodEUN == BLOCK_NIL) { 772 /* the requested block is not on the media, return all 0x00 */ 773 memset(buffer, 0, 512); 774 } else { 775 loff_t ptr = (lastgoodEUN * nftl->EraseSize) + blockofs; 776 size_t retlen; 777 int res = mtd->read(mtd, ptr, 512, &retlen, buffer); 778 779 if (res < 0 && res != -EUCLEAN) 780 return -EIO; 781 } 782 return 0; 783 } 784 785 static int nftl_getgeo(struct mtd_blktrans_dev *dev, struct hd_geometry *geo) 786 { 787 struct NFTLrecord *nftl = (void *)dev; 788 789 geo->heads = nftl->heads; 790 geo->sectors = nftl->sectors; 791 geo->cylinders = nftl->cylinders; 792 793 return 0; 794 } 795 796 /**************************************************************************** 797 * 798 * Module stuff 799 * 800 ****************************************************************************/ 801 802 803 static struct mtd_blktrans_ops nftl_tr = { 804 .name = "nftl", 805 .major = NFTL_MAJOR, 806 .part_bits = NFTL_PARTN_BITS, 807 .blksize = 512, 808 .getgeo = nftl_getgeo, 809 .readsect = nftl_readblock, 810 #ifdef CONFIG_NFTL_RW 811 .writesect = nftl_writeblock, 812 #endif 813 .add_mtd = nftl_add_mtd, 814 .remove_dev = nftl_remove_dev, 815 .owner = THIS_MODULE, 816 }; 817 818 static int __init init_nftl(void) 819 { 820 return register_mtd_blktrans(&nftl_tr); 821 } 822 823 static void __exit cleanup_nftl(void) 824 { 825 deregister_mtd_blktrans(&nftl_tr); 826 } 827 828 module_init(init_nftl); 829 module_exit(cleanup_nftl); 830 831 MODULE_LICENSE("GPL"); 832 MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>, Fabrice Bellard <fabrice.bellard@netgem.com> et al."); 833 MODULE_DESCRIPTION("Support code for NAND Flash Translation Layer, used on M-Systems DiskOnChip 2000 and Millennium"); 834 MODULE_ALIAS_BLOCKDEV_MAJOR(NFTL_MAJOR); 835