#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "../port/error.h"
enum {
Nflash = 2,
Maxwchunk= 1024, /* maximum chunk written by one call to falg->write */
};
/*
* Flashes are either 8 or 16 bits wide. On some installations (e.g., the
* bitsy, they are interleaved: address 0 is in the first chip, address 2
* on the second, address 4 on the first, etc.
* We define Funit as the unit that matches the width of a single flash chip,
* so Funit is either `uchar' or `ushort' (I haven't seen 32-bit wide flashes),
* and we define Fword as the unit that matches a set of interleaved Funits.
* We access interleaved flashes simultaneously, by doing single reads and
* writes to both. The macro `mirror' takes a command and replicates it for
* this purpose.
* The Blast board has a non-interleaved 16-bit wide flash. When doing
* writes to it, we must swap bytes.
*/
typedef struct FlashAlg FlashAlg;
typedef struct Flash Flash;
typedef struct FlashRegion FlashRegion;
#ifdef WIDTH8
typedef uchar Funit; /* Width of the flash (uchar or ushort) */
# define toendian(x) (x) /* Little or big endianness */
# define fromendian(x) (x)
# define reg(x) ((x)<<1)
# ifdef INTERLEAVED
# define mirror(x) ((x)<<8|(x)) /* Double query for interleaved flashes */
typedef ushort Fword; /* Width after interleaving */
# define Wshift 1
# else
# define mirror(x) (x)
typedef uchar Fword;
# define Wshift 0
# endif
#else
typedef ushort Funit;
# define toendian(x) ((x)<<8)
# define fromendian(x) ((x)>>8)
# define reg(x) (x)
# ifdef INTERLEAVED
# define mirror(x) (toendian(x)<<16|toendian(x))
typedef ulong Fword;
# define Wshift 2
# else
# define mirror(x) toendian(x)
typedef ushort Fword;
# define Wshift 1
# endif
#endif
/* this defines a contiguous set of erase blocks of one size */
struct FlashRegion
{
ulong addr; /* start of region */
ulong end; /* end of region + 1 */
ulong n; /* number of blocks */
ulong size; /* size of each block */
};
struct Flash
{
ISAConf; /* contains size */
RWlock;
Fword *p;
ushort algid; /* access algorithm */
FlashAlg *alg;
ushort manid; /* manufacturer id */
ushort devid; /* device id */
int wbsize; /* size of write buffer */
ulong nr; /* number of regions */
uchar bootprotect;
ulong offset; /* beginning offset of this flash */
FlashRegion r[32];
};
/* this defines a particular access algorithm */
struct FlashAlg
{
int id;
char *name;
void (*identify)(Flash*); /* identify device */
void (*erase)(Flash*, ulong); /* erase a region */
void (*write)(Flash*, void*, long, ulong); /* write a region */
};
static void ise_id(Flash*);
static void ise_erase(Flash*, ulong);
static void ise_write(Flash*, void*, long, ulong);
static void afs_id(Flash*);
static void afs_erase(Flash*, ulong);
static void afs_write(Flash*, void*, long, ulong);
static ulong blockstart(Flash*, ulong);
static ulong blockend(Flash*, ulong);
FlashAlg falg[] =
{
{ 1, "Intel/Sharp Extended", ise_id, ise_erase, ise_write },
{ 2, "AMD/Fujitsu Standard", afs_id, afs_erase, afs_write },
};
Flash flashes[Nflash];
/*
* common flash interface
*/
static uchar
cfigetc(Flash *flash, int off)
{
uchar rv;
flash->p[reg(0x55)] = mirror(0x98);
rv = fromendian(flash->p[reg(off)]);
flash->p[reg(0x55)] = mirror(0xFF);
return rv;
}
static ushort
cfigets(Flash *flash, int off)
{
return (cfigetc(flash, off+1)<<8)|cfigetc(flash, off);
}
static ulong
cfigetl(Flash *flash, int off)
{
return (cfigetc(flash, off+3)<<24)|(cfigetc(flash, off+2)<<16)|
(cfigetc(flash, off+1)<<8)|cfigetc(flash, off);
}
static void
cfiquery(Flash *flash)
{
uchar q, r, y;
ulong x, addr;
q = cfigetc(flash, 0x10);
r = cfigetc(flash, 0x11);
y = cfigetc(flash, 0x12);
if(q != 'Q' || r != 'R' || y != 'Y'){
print("cfi query failed: %ux %ux %ux\n", q, r, y);
return;
}
flash->algid = cfigetc(flash, 0x13);
flash->size = (sizeof(Fword)/sizeof(Funit)) * (1<<(cfigetc(flash, 0x27)));
flash->wbsize = (sizeof(Fword)/sizeof(Funit)) * (1<<(cfigetc(flash, 0x2a)));
flash->nr = cfigetc(flash, 0x2c);
if(flash->nr > nelem(flash->r)){
print("cfi reports > %d regions\n", nelem(flash->r));
flash->nr = nelem(flash->r);
}
addr = 0;
for(q = 0; q < flash->nr; q++){
x = cfigetl(flash, q+0x2d);
flash->r[q].size = (sizeof(Fword)/sizeof(Funit)) * 256 * (x>>16);
flash->r[q].n = (x&0xffff)+1;
flash->r[q].addr = addr;
addr += flash->r[q].size*flash->r[q].n;
flash->r[q].end = addr;
}
}
/*
* flash device interface
*/
enum
{
Qtopdir,
Q2nddir,
Qfctl,
Qfdata,
Maxpart= 8,
};
typedef struct FPart FPart;
struct FPart
{
Flash *flash;
char *name;
char *ctlname;
ulong start;
ulong end;
};
static FPart part[Maxpart];
#define FQID(p,q) ((p)<<8|(q))
#define FTYPE(q) ((q) & 0xff)
#define FPART(q) (&part[(q) >>8])
static int
gen(Chan *c, char*, Dirtab*, int, int i, Dir *dp)
{
Qid q;
FPart *fp;
q.vers = 0;
/* top level directory contains the name of the network */
if(c->qid.path == Qtopdir){
switch(i){
case DEVDOTDOT:
q.path = Qtopdir;
q.type = QTDIR;
devdir(c, q, "#F", 0, eve, DMDIR|0555, dp);
break;
case 0:
q.path = Q2nddir;
q.type = QTDIR;
devdir(c, q, "flash", 0, eve, DMDIR|0555, dp);
break;
default:
return -1;
}
return 1;
}
/* second level contains all partitions and their control files */
switch(i) {
case DEVDOTDOT:
q.path = Qtopdir;
q.type = QTDIR;
devdir(c, q, "#F", 0, eve, DMDIR|0555, dp);
break;
default:
if(i >= 2*Maxpart)
return -1;
fp = &part[i>>1];
if(fp->name == nil)
return 0;
if(i & 1){
q.path = FQID(i>>1, Qfdata);
q.type = QTFILE;
devdir(c, q, fp->name, fp->end-fp->start, eve, 0660, dp);
} else {
q.path = FQID(i>>1, Qfctl);
q.type = QTFILE;
devdir(c, q, fp->ctlname, 0, eve, 0660, dp);
}
break;
}
return 1;
}
static Flash *
findflash(ulong addr)
{
Flash *flash;
for (flash = flashes; flash < flashes + Nflash; flash++)
if(addr >= flash->offset && addr < flash->offset + flash->size)
return flash;
return nil;
}
static FPart*
findpart(char *name)
{
int i;
for(i = 0; i < Maxpart; i++)
if(part[i].name != nil && strcmp(name, part[i].name) == 0)
break;
if(i >= Maxpart)
return nil;
return &part[i];
}
static void
addpart(FPart *fp, char *name, ulong start, ulong end)
{
int i;
char ctlname[64];
Flash *flash;
if (start > end)
error(Ebadarg);
if(fp == nil){
flash = findflash(start);
if (flash == nil || end > flash->offset + flash->size)
error(Ebadarg);
start -= flash->offset;
end -= flash->offset;
} else {
start += fp->start;
end += fp->start;
if(start >= fp->end || end > fp->end){
error(Ebadarg);
}
flash = fp->flash;
}
if(blockstart(flash, start) != start)
error("must start on erase boundary");
if(blockstart(flash, end) != end && end != flash->size)
error("must end on erase boundary");
fp = findpart(name);
if(fp != nil)
error(Eexist);
for(i = 0; i < Maxpart; i++)
if(part[i].name == nil)
break;
if(i == Maxpart)
error("no more partitions");
fp = &part[i];
kstrdup(&fp->name, name);
snprint(ctlname, sizeof ctlname, "%sctl", name);
kstrdup(&fp->ctlname, ctlname);
fp->flash = flash;
fp->start = start;
fp->end = end;
}
static void
rempart(FPart *fp)
{
char *p, *cp;
p = fp->name;
fp->name = nil;
cp = fp->ctlname;
fp->ctlname = nil;
free(p);
free(cp);
}
void
flashinit(void)
{
int i, ctlrno;
char *fname;
ulong offset;
Flash *flash;
offset = 0;
for (ctlrno = 0; ctlrno < Nflash; ctlrno++){
flash = flashes + ctlrno;
if(isaconfig("flash", ctlrno, flash) == 0)
continue;
flash->p = (Fword*)flash->mem;
cfiquery(flash);
for(i = 0; i < nelem(falg); i++)
if(flash->algid == falg[i].id){
flash->alg = &falg[i];
(*flash->alg->identify)(flash);
break;
}
flash->bootprotect = 1;
flash->offset = offset;
fname = malloc(8);
sprint(fname, "flash%d", ctlrno);
addpart(nil, fname, offset, offset + flash->size);
offset += flash->size;
}
}
static Chan*
flashattach(char* spec)
{
return devattach('F', spec);
}
static Walkqid*
flashwalk(Chan *c, Chan *nc, char **name, int nname)
{
return devwalk(c, nc, name, nname, nil, 0, gen);
}
static int
flashstat(Chan *c, uchar *db, int n)
{
return devstat(c, db, n, nil, 0, gen);
}
static Chan*
flashopen(Chan* c, int omode)
{
omode = openmode(omode);
if(strcmp(up->user, eve)!=0)
error(Eperm);
return devopen(c, omode, nil, 0, gen);
}
static void
flashclose(Chan*)
{
}
static long
flashctlread(FPart *fp, void* a, long n, vlong off)
{
char *buf, *p, *e;
int i;
ulong addr, end;
Flash *flash;
flash = fp->flash;
buf = smalloc(1024);
e = buf + 1024;
p = seprint(buf, e, "0x%-9lux 0x%-9lux 0x%-9lux 0x%-9x 0x%-9ux 0x%-9ux\n",
flash->offset, fp->start, fp->end-fp->start, flash->wbsize, flash->manid, flash->devid);
addr = fp->start;
for(i = 0; i < flash->nr && addr < fp->end; i++)
if(flash->r[i].addr <= addr && flash->r[i].end > addr){
if(fp->end <= flash->r[i].end)
end = fp->end;
else
end = flash->r[i].end;
p = seprint(p, e, "0x%-9lux 0x%-9lux 0x%-9lux\n", addr,
(end-addr)/flash->r[i].size, flash->r[i].size);
addr = end;
}
n = readstr(off, a, n, buf);
free(buf);
return n;
}
static long
flashdataread(FPart *fp, void* a, long n, vlong off)
{
Flash *flash;
flash = fp->flash;
rlock(flash);
if(waserror()){
runlock(flash);
nexterror();
}
if(fp->name == nil)
error("partition vanished");
if(!iseve())
error(Eperm);
off += fp->start;
if(off >= fp->end)
n = 0;
if(off+n >= fp->end)
n = fp->end - off;
if(n > 0)
memmove(a, ((uchar*)flash->mem)+off, n);
runlock(flash);
poperror();
return n;
}
static long
flashread(Chan* c, void* a, long n, vlong off)
{
int t;
if(c->qid.type == QTDIR)
return devdirread(c, a, n, nil, 0, gen);
t = FTYPE(c->qid.path);
switch(t){
default:
error(Eperm);
case Qfctl:
n = flashctlread(FPART(c->qid.path), a, n, off);
break;
case Qfdata:
n = flashdataread(FPART(c->qid.path), a, n, off);
break;
}
return n;
}
static void
bootprotect(ulong addr)
{
FlashRegion *r;
Flash *flash;
flash = findflash(addr);
if (flash == nil)
error(Ebadarg);
if(flash->bootprotect == 0)
return;
if(flash->nr == 0)
error("writing over boot loader disallowed");
r = flash->r;
if(addr >= r->addr && addr < r->addr + r->size)
error("writing over boot loader disallowed");
}
static ulong
blockstart(Flash *flash, ulong addr)
{
FlashRegion *r, *e;
ulong x;
r = flash->r;
for(e = &flash->r[flash->nr]; r < e; r++){
if(addr >= r->addr && addr < r->end){
x = addr - r->addr;
x /= r->size;
return r->addr + x*r->size;
}
}
return (ulong)-1;
}
static ulong
blockend(Flash *flash, ulong addr)
{
FlashRegion *r, *e;
ulong x;
r = flash->r;
for(e = &flash->r[flash->nr]; r < e; r++)
if(addr >= r->addr && addr < r->end){
x = addr - r->addr;
x /= r->size;
return r->addr + (x+1)*r->size;
}
return (ulong)-1;
}
static long
flashctlwrite(FPart *fp, char *p, long n)
{
Cmdbuf *cmd;
ulong off;
Flash *flash;
if(fp == nil)
panic("flashctlwrite");
flash = fp->flash;
cmd = parsecmd(p, n);
wlock(flash);
if(waserror()){
wunlock(flash);
nexterror();
}
if(strcmp(cmd->f[0], "erase") == 0){
switch(cmd->nf){
case 2:
/* erase a single block in the partition */
off = atoi(cmd->f[1]);
off += fp->start;
if(off >= fp->end)
error("region not in partition");
if(off != blockstart(flash, off))
error("erase must be a block boundary");
bootprotect(off);
(*flash->alg->erase)(flash, off);
break;
case 1:
/* erase the whole partition */
bootprotect(fp->start);
for(off = fp->start; off < fp->end; off = blockend(flash, off))
(*flash->alg->erase)(flash, off);
break;
default:
error(Ebadarg);
}
} else if(strcmp(cmd->f[0], "add") == 0){
if(cmd->nf != 4)
error(Ebadarg);
addpart(fp, cmd->f[1], strtoul(cmd->f[2], nil, 0), strtoul(cmd->f[3], nil, 0));
} else if(strcmp(cmd->f[0], "remove") == 0){
rempart(fp);
} else if(strcmp(cmd->f[0], "protectboot") == 0){
if(cmd->nf == 0 || strcmp(cmd->f[1], "off") != 0)
flash->bootprotect = 1;
else
flash->bootprotect = 0;
} else
error(Ebadarg);
poperror();
wunlock(flash);
free(cmd);
return n;
}
static long
flashdatawrite(FPart *fp, uchar *p, long n, long off)
{
uchar *end;
int m;
int on;
long ooff;
uchar *buf;
Flash *flash;
if(fp == nil)
panic("flashdatawrite");
flash = fp->flash;
buf = nil;
wlock(flash);
if(waserror()){
wunlock(flash);
if(buf != nil)
free(buf);
nexterror();
}
if(fp->name == nil)
error("partition vanished");
if(!iseve())
error(Eperm);
/* can't cross partition boundaries */
off += fp->start;
if(off >= fp->end || off+n > fp->end || n <= 0)
error(Ebadarg);
/* make sure we're not writing the boot sector */
bootprotect(off);
on = n;
/*
* get the data into kernel memory to avoid faults during writing.
* if write is not on a quad boundary or not a multiple of 4 bytes,
* extend with data already in flash.
*/
buf = smalloc(n+8);
m = off & 3;
if(m){
*(ulong*)buf = flash->p[off>>Wshift];
n += m;
off -= m;
}
if(n & 3){
n -= n & 3;
*(ulong*)(&buf[n]) = flash->p[(off+n)>>Wshift];
n += 4;
}
memmove(&buf[m], p, on);
/* (*flash->alg->write) can't cross blocks */
ooff = off;
p = buf;
for(end = p + n; p < end; p += m){
m = blockend(flash, off) - off;
if(m > end - p)
m = end - p;
if(m > Maxwchunk)
m = Maxwchunk;
(*flash->alg->write)(flash, p, m, off);
off += m;
}
/* make sure write succeeded */
if(memcmp(buf, &flash->p[ooff>>Wshift], n) != 0)
error("written bytes don't match");
wunlock(flash);
free(buf);
poperror();
return on;
}
static long
flashwrite(Chan* c, void* a, long n, vlong off)
{
int t;
if(c->qid.type == QTDIR)
error(Eperm);
if(!iseve())
error(Eperm);
t = FTYPE(c->qid.path);
switch(t){
default:
panic("flashwrite");
case Qfctl:
n = flashctlwrite(FPART(c->qid.path), a, n);
break;
case Qfdata:
n = flashdatawrite(FPART(c->qid.path), a, n, off);
break;
}
return n;
}
Dev flashdevtab = {
'F',
"flash",
devreset,
flashinit,
devshutdown,
flashattach,
flashwalk,
flashstat,
flashopen,
devcreate,
flashclose,
flashread,
devbread,
flashwrite,
devbwrite,
devremove,
devwstat,
};
enum
{
/* status register */
ISEs_lockerr= 1<<1,
ISEs_powererr= 1<<3,
ISEs_progerr= 1<<4,
ISEs_eraseerr= 1<<5,
ISEs_ready= 1<<7,
ISEs_err= (ISEs_lockerr|ISEs_powererr|ISEs_progerr|ISEs_eraseerr),
/* extended status register */
ISExs_bufavail= 1<<7,
};
/* intel/sharp extended command set */
static void
ise_reset(Flash* flash)
{
flash->p[reg(0xaa)] = mirror(0xff); /* reset */
}
static void
ise_id(Flash* flash)
{
ise_reset(flash);
flash->p[reg(0xaaa)] = mirror(0x90); /* uncover vendor info */
flash->manid = fromendian(flash->p[reg(0x0)]);
flash->devid = fromendian(flash->p[reg(0x1)]);
ise_reset(flash);
}
static void
ise_clearerror(Flash* flash)
{
flash->p[reg(0x200)] = mirror(0x50);
}
static void
ise_error(int bank, ulong status)
{
char err[64];
if(status & (ISEs_lockerr)){
sprint(err, "flash%d: block locked %lux", bank, status);
error(err);
}
if(status & (ISEs_powererr)){
sprint(err, "flash%d: low prog voltage %lux", bank, status);
error(err);
}
if(status & (ISEs_progerr|ISEs_eraseerr)){
sprint(err, "flash%d: i/o error %lux", bank, status);
error(err);
}
}
static void
ise_erase(Flash *flash, ulong addr)
{
ulong start;
ulong x;
addr >>= Wshift;
flashprogpower(1);
flash->p[addr] = mirror(0x20);
flash->p[addr] = mirror(0xd0);
start = m->ticks;
do {
x = fromendian(flash->p[addr]);
if((x & mirror(ISEs_ready)) == mirror(ISEs_ready))
break;
} while(TK2MS(m->ticks-start) < 1500);
flashprogpower(0);
ise_clearerror(flash);
ise_error(0, x);
ise_error(1, x>>16);
ise_reset(flash);
}
/*
* the flash spec claimes writing goes faster if we use
* the write buffer. We fill the write buffer and then
* issue the write request. After the write request,
* subsequent reads will yield the status register.
*
* returns the status, even on timeouts.
*
* NOTE: I tried starting back to back buffered writes
* without reading the status in between, as the
* flowchart in the intel data sheet suggests.
* However, it always responded with an illegal
* command sequence, so I must be missing something.
* If someone learns better, please email me, though
* I doubt it will be much faster. - presotto@bell-labs.com
*/
static long
ise_wbwrite(Flash *flash, Fword *p, int n, ulong off, ulong baddr, ulong *status)
{
Fword x;
ulong start;
int i;
int s;
/* put flash into write buffer mode */
start = m->ticks;
for(;;) {
s = splhi();
/* request write buffer mode */
flash->p[baddr] = mirror(0xe8);
/* look at extended status reg for status */
if((flash->p[baddr] & mirror(1<<7)) == mirror(1<<7))
break;
splx(s);
/* didn't work, keep trying for 2 secs */
if(TK2MS(m->ticks-start) > 2000){
/* set up to read status */
flash->p[baddr] = mirror(0x70);
*status = fromendian(flash->p[baddr]);
pprint("write buffered cmd timed out\n");
return -1;
}
}
/* fill write buffer */
flash->p[baddr] = mirror(n-1);
for(i = 0; i < n; i++)
flash->p[off+i] = *p++;
/* program from buffer */
flash->p[baddr] = mirror(0xd0);
splx(s);
/* wait till the programming is done */
start = m->ticks;
for(;;) {
x = flash->p[baddr]; /* read status register */
*status = fromendian(x);
if((x & mirror(ISEs_ready)) == mirror(ISEs_ready))
break;
if(TK2MS(m->ticks-start) > 2000){
pprint("read status timed out\n");
return -1;
}
}
if(x & mirror(ISEs_err))
return -1;
return n;
}
static void
ise_write(Flash *flash, void *a, long n, ulong off)
{
Fword *p, *end;
int i, wbsize;
ulong x, baddr;
/* everything in terms of Fwords */
wbsize = flash->wbsize >> Wshift;
baddr = blockstart(flash, off) >> Wshift;
off >>= Wshift;
n >>= Wshift;
p = a;
/* first see if write will succeed */
for(i = 0; i < n; i++)
if((p[i] & flash->p[off+i]) != p[i])
error("flash needs erase");
if(waserror()){
ise_reset(flash);
flashprogpower(0);
nexterror();
}
flashprogpower(1);
/*
* use the first write to reach
* a write buffer boundary. the intel maunal
* says writes starting at wb boundaries
* maximize speed.
*/
i = wbsize - (off & (wbsize-1));
for(end = p + n; p < end;){
if(i > end - p)
i = end - p;
if(ise_wbwrite(flash, p, i, off, baddr, &x) < 0)
break;
off += i;
p += i;
i = wbsize;
}
ise_clearerror(flash);
ise_error(0, x);
ise_error(1, x>>16);
ise_reset(flash);
flashprogpower(0);
poperror();
}
/* amd/fujitsu standard command set
* I don't have an amd chipset to work with
* so I'm loathe to write this yet. If someone
* else does, please send it to me and I'll
* incorporate it -- presotto@bell-labs.com
*/
static void
afs_reset(Flash *flash)
{
flash->p[reg(0xaa)] = mirror(0xf0); /* reset */
}
static void
afs_id(Flash *flash)
{
afs_reset(flash);
flash->p[reg(0xaa)] = mirror(0xf0); /* reset */
flash->p[reg(0xaaa)] = mirror(0xaa); /* query vendor block */
flash->p[reg(0x554)] = mirror(0x55);
flash->p[reg(0xaaa)] = mirror(0x90);
flash->manid = fromendian(flash->p[reg(0x00)]);
afs_reset(flash);
flash->p[reg(0xaaa)] = mirror(0xaa); /* query vendor block */
flash->p[reg(0x554)] = mirror(0x55);
flash->p[reg(0xaaa)] = mirror(0x90);
flash->devid = fromendian(flash->p[reg(0x02)]);
afs_reset(flash);
}
static void
afs_erase(Flash*, ulong)
{
error("amd/fujistsu erase not implemented");
}
static void
afs_write(Flash*, void*, long, ulong)
{
error("amd/fujistsu write not implemented");
}
|
