ref: 7ae7351ace73a70cbbaf5a2da016005485d0d43b
dir: /os/port/flashnand.c/
#include "u.h" #include "../port/lib.h" #include "mem.h" #include "dat.h" #include "fns.h" #include "io.h" #include "../port/error.h" #include "flashif.h" typedef struct Nandtab Nandtab; struct Nandtab { short manufacturer; uchar id; uchar l2bytesperpage; ushort pagesperblock; ushort blocks; uchar tPROGms; ushort tBERASEms; uchar tRus; }; static Nandtab nandtab[] = { { 0xec, 0xe6, 9, 16, 1024, 1, 4, 7 }, /* Samsung KM29U64000T */ { 0x98, 0xe6, 9, 16, 1024, 1, 4, 25 }, /* Toshiba TC58V64AFT */ { 0x98, 0x73, 9, 32, 1024, 1, 10, 25}, /* Toshiba TC56V128AFT */ /* Generic entries which take timings from Toshiba SMIL example code */ { -1, 0xea, 8, 16, 512, 20, 400, 100 }, { -1, 0xe3, 9, 16, 512, 20, 400, 100 }, { -1, 0xe5, 9, 16, 512, 20, 400, 100 }, { -1, 0x73, 9, 32, 1024, 20, 400, 100 }, { -1, 0x75, 9, 32, 2048, 20, 400, 100 }, { -1, 0x76, 9, 32, 4096, 20, 400, 100 }, }; enum { ReadMode1 = 0x00, ReadMode2 = 0x01, Program = 0x10, ReadMode3 = 0x50, Erase1 = 0x60, ReadStatus = 0x70, Write = 0x80, Identify = 0x90, Erase2 = 0xd0, StatusReady = 0x40, StatusFail = 0x01, }; /* * NAND flash driver */ #define DPRINT if(0)print #define EPRINT if(1)print static int idchip(Flash *f); static void nand_writebyte(Flash *f, uchar b) { archnand_write(f, &b, 1); } static uchar nand_readbyte(Flash *f) { uchar b; archnand_read(f, &b, 1); return b; } static int idchip(Flash *f) { int x; uchar maker, device; f->id = 0; f->devid = 0; f->width = 1; archnand_claim(f, 1); archnand_setCLEandALE(f, 1, 0); nand_writebyte(f, Identify); archnand_setCLEandALE(f, 0, 1); nand_writebyte(f, 0); archnand_setCLEandALE(f, 0, 0); maker = nand_readbyte(f); device = nand_readbyte(f); archnand_claim(f, 0); iprint("man=%#ux device=%#ux\n", maker, device); for(x = 0; x < sizeof(nandtab) / sizeof(nandtab[0]); x++){ if(nandtab[x].id == (device & 0xff) && (nandtab[x].manufacturer == maker || nandtab[x].manufacturer == -1)){ ulong bpp; f->id = maker; f->devid = device; f->nr = 1; bpp = 1 << nandtab[x].l2bytesperpage; bpp |= bpp >> 5; f->regions[0].erasesize = bpp * nandtab[x].pagesperblock; f->size = f->regions[0].erasesize * nandtab[x].blocks; f->regions[0].n = nandtab[x].blocks; f->regions[0].start = 0; f->regions[0].end = f->size; f->regions[0].pagesize = bpp; f->data = &nandtab[x]; return 0; } } print("nand: device %#.2ux/%#.2ux not recognised\n", maker, device); return -1; } static int erasezone(Flash *f, Flashregion *r, ulong byteaddr) { Nandtab *nt = f->data; int paddress; uchar val; int rv; uchar addr[2]; if(byteaddr%r->erasesize || byteaddr >= f->size) return -1; /* bad zone */ paddress = byteaddr/r->erasesize * nt->pagesperblock; /* can simplify ... */ //print("erasezone(%.8lux) page %d %.8lux\n", byteaddr, paddress, r->erasesize); archnand_claim(f, 1); archnand_setCLEandALE(f, 1, 0); // command mode nand_writebyte(f, Erase1); archnand_setCLEandALE(f, 0, 1); // address mode addr[0] = paddress; addr[1] = paddress >> 8; archnand_write(f, addr, 2); archnand_setCLEandALE(f, 1, 0); // command mode nand_writebyte(f, Erase2); nand_writebyte(f, ReadStatus); archnand_setCLEandALE(f, 0, 0); // data mode do { val = nand_readbyte(f); } while((val & StatusReady) != StatusReady); if((val & StatusFail) != 0){ print("erasezone failed: %.2ux\n", val); rv = -1; } else rv = 0; archnand_claim(f, 0); // turn off chip return rv; } static int writepage(Flash *f, ulong page, ushort addr, void *buf, long n) { uchar cmd; uchar val; int rv; uchar cmdbuf[3]; //print("writepage(%ld, %d, %ld)\n", page, addr, n); // Fake a read to set the pointer if(addr < 256) cmd = ReadMode1; else if(addr < 512){ cmd = ReadMode2; addr -= 256; }else{ cmd = ReadMode3; addr -= 512; } archnand_claim(f, 1); archnand_setCLEandALE(f, 1, 0); // command mode nand_writebyte(f, cmd); nand_writebyte(f, Write); archnand_setCLEandALE(f, 0, 1); // address mode cmdbuf[0] = addr; cmdbuf[1] = page; cmdbuf[2] = page >> 8; archnand_write(f, cmdbuf, 3); archnand_setCLEandALE(f, 0, 0); // data mode archnand_write(f, buf, n); archnand_setCLEandALE(f, 1, 0); // command mode nand_writebyte(f, Program); nand_writebyte(f, ReadStatus); archnand_setCLEandALE(f, 0, 0); // data mode do { val = nand_readbyte(f); }while((val & StatusReady) != StatusReady); if((val & StatusFail) != 0){ print("writepage failed: %.2ux\n", val); rv = -1; }else rv = 0; archnand_claim(f, 0); return rv; } static int write(Flash *f, ulong offset, void *buf, long n) { Nandtab *nt = f->data; ulong page; ulong addr; ulong xbpp; //print("write(%ld, %ld)\n", offset, n); xbpp = (1 << nt->l2bytesperpage); xbpp |= (xbpp >> 5); page = offset / xbpp; addr = offset % xbpp; while(n > 0){ int count; count = xbpp - addr; if(count > n) count = n; if(writepage(f, page, addr, buf, count) < 0) return -1; offset += count; n -= count; buf = (uchar *)buf + count; addr = 0; } //print("write done\n"); return 0; } static int read(Flash *f, ulong offset, void *buf, long n) { Nandtab *nt = f->data; uchar cmd; ulong page; ulong addr; ushort bytesperpage, xbytesperpage, skip, partialaddr; uchar cmdbuf[3]; int toread; //print("read(%ld, %.8lux, %ld)\n", offset, buf, n); bytesperpage = (1 << nt->l2bytesperpage); xbytesperpage = bytesperpage; xbytesperpage += bytesperpage >> 5; // 512 => 16, 256 => 8 page = offset / xbytesperpage; partialaddr = offset % xbytesperpage; skip = 0; if(partialaddr >= bytesperpage && xbytesperpage - partialaddr < n){ // cannot start read in extended area, and then chain into main area, // so start on last byte of main area, and skip the extra bytes // stupid chip design this one skip = partialaddr - bytesperpage + 1; n += skip; partialaddr = bytesperpage - 1; } addr = partialaddr; if(addr >= bytesperpage){ cmd = ReadMode3; addr -= bytesperpage; }else if(addr >= 256){ cmd = ReadMode2; addr -= 256; }else cmd = ReadMode1; //print("cmd %.2x page %.4lux addr %.8lux partialaddr %d skip %d\n", cmd, page, addr, partialaddr, skip); // Read first page archnand_claim(f, 1); archnand_setCLEandALE(f, 1, 0); nand_writebyte(f, cmd); archnand_setCLEandALE(f, 0, 1); cmdbuf[0] = addr; cmdbuf[1] = page; cmdbuf[2] = page >> 8; archnand_write(f, cmdbuf, 3); archnand_setCLEandALE(f, 0, 0); if(partialaddr){ // partial first page microdelay(nt->tRus); toread = partialaddr < xbytesperpage ? xbytesperpage - partialaddr : 0; if(toread > n) toread = n; if(skip){ archnand_read(f, 0, skip); toread -= skip; n -= skip; // partialaddr += skip; } archnand_read(f, buf, toread); n -= toread; // partialaddr += toread; buf = (uchar *)buf + toread; } while(n){ microdelay(nt->tRus); toread = xbytesperpage; if(n < toread) toread = n; archnand_read(f, buf, toread); n -= toread; buf = (uchar *)buf + toread; } archnand_claim(f, 0); //print("readn done\n"); return 0; } static int reset(Flash *f) { //iprint("nandreset\n"); if(f->data != nil) return 1; f->write = write; f->read = read; f->eraseall = nil; f->erasezone = erasezone; f->suspend = nil; f->resume = nil; f->sort = "nand"; archnand_init(f); return idchip(f); } void flashnandlink(void) { addflashcard("nand", reset); }