ref: c04f70e2bb4a02655bb8a6247a8f07f75ff431bd
dir: /libfis/fis.c/
/* * sata fises and sas frames * copyright © 2009-2010 erik quanstrom */ #include <u.h> #include <libc.h> #include <fis.h> static char *flagname[9] = { "lba", "llba", "smart", "power", "nop", "atapi", "atapi16", "ata8", "sct", }; /* * ata8 standard (llba) cmd layout * * feature 16 bits * count 16 bits * lba 48 bits * device 8 bits * command 8 bits * * response: * * status 8 bits * error 8 bits * reason 8 bits * count 8 bits * sstatus 8 bits * sactive 8 bits */ /* * sata fis layout for fistype 0x27: host-to-device: * * 0 fistype * 1 fis flags * 2 ata command * 3 features * 4 sector lba low 7:0 * 5 cyl low lba mid 15:8 * 6 cyl hi lba hi 23:16 * 7 device / head * 8 sec exp lba 31:24 * 9 cy low e lba 39:32 * 10 cy hi e lba 48:40 * 11 features (exp) * 12 sector count * 13 sector count (exp) * 14 r * 15 control */ void setfissig(Sfis *x, uint sig) { x->sig = sig; } void skelfis(uchar *c) { memset(c, 0, Fissize); c[Ftype] = H2dev; c[Fflags] = Fiscmd; c[Fdev] = Ataobs; } int nopfis(Sfis*, uchar *c, int srst) { skelfis(c); if(srst){ c[Fflags] &= ~Fiscmd; c[Fcontrol] = 1<<2; return Preset|P28; } return Pnd|P28; } int txmodefis(Sfis *f, uchar *c, uchar d) { int m; /* hack */ if((f->sig >> 16) == 0xeb14) return -1; m = 0x40; if(d == 0xff){ d = 0; m = 0; } skelfis(c); c[Fcmd] = 0xef; c[Ffeat] = 3; /* set transfer mode */ c[Fsc] = m | d; /* sector count */ return Pnd|P28; } int featfis(Sfis*, uchar *c, uchar f) { skelfis(c); c[Fcmd] = 0xef; c[Ffeat] = f; return Pnd|P28; } int identifyfis(Sfis *f, uchar *c) { static uchar tab[] = { 0xec, 0xa1, }; skelfis(c); c[Fcmd] = tab[f->sig>>16 == 0xeb14]; return Pin|Ppio|P28|P512; } int flushcachefis(Sfis *f, uchar *c) { static uchar tab[2] = {0xe7, 0xea}; static uchar ptab[2] = {Pnd|P28, Pnd|P48}; int llba; llba = (f->feat & Dllba) != 0; skelfis(c); c[Fcmd] = tab[llba]; return ptab[llba]; } static ushort gbit16(void *a) { ushort j; uchar *i; i = a; j = i[1] << 8; j |= i[0]; return j; } static uint gbit32(void *a) { uint j; uchar *i; i = a; j = i[3] << 24; j |= i[2] << 16; j |= i[1] << 8; j |= i[0]; return j; } static uvlong gbit64(void *a) { uchar *i; i = a; return (uvlong)gbit32(i+4) << 32 | gbit32(a); } ushort id16(ushort *id, int i) { return gbit16(id+i); } uint id32(ushort *id, int i) { return gbit32(id+i); } uvlong id64(ushort *id, int i) { return gbit64(id+i); } /* acs-2 §7.18.7.4 */ static ushort puistab[] = { 0x37c8, Pspinup, 0x738c, Pspinup | Pidready, 0x8c73, 0, 0xc837, Pidready, }; int idpuis(ushort *id) { ushort u, i; u = gbit16(id + 2); for(i = 0; i < nelem(puistab); i += 2) if(u == puistab[i]) return puistab[i + 1]; return Pidready; /* annoying cdroms */ } static ushort onesc(ushort *id) { ushort u; u = gbit16(id); if(u == 0xffff) u = 0; return u; } enum{ Idmasp = 1<<8, Ilbasp = 1<<9, Illba = 1<<10, }; vlong idfeat(Sfis *f, ushort *id) { int i, j; vlong s; f->feat = 0; if(f->sig>>16 == 0xeb14) f->feat |= Datapi; i = gbit16(id + 49); if((i & Ilbasp) == 0){ if((gbit16(id + 53) & 1) == 0){ f->c = gbit16(id + 1); f->h = gbit16(id + 3); f->s = gbit16(id + 6); }else{ f->c = gbit16(id + 54); f->h = gbit16(id + 55); f->s = gbit16(id + 56); } s = f->c*f->h*f->s; }else{ f->c = f->h = f->s = 0; f->feat |= Dlba; j = gbit16(id + 83) | gbit16(id + 86); if(j & Illba){ f->feat |= Dllba; s = gbit64(id + 100); }else s = gbit32(id + 60); } f->udma = 0xff; if(i & Idmasp) if(gbit16(id + 53) & 4) for(i = gbit16(id + 88) & 0x7f; i; i >>= 1) f->udma++; if(f->feat & Datapi){ i = gbit16(id + 0); if(i & 1) f->feat |= Datapi16; } i = gbit16(id+83); if((i>>14) == 1){ if(i & (1<<3)) f->feat |= Dpower; i = gbit16(id + 82); if(i & 1) f->feat |= Dsmart; if(i & (1<<14)) f->feat |= Dnop; } i = onesc(id + 80); if(i & 1<<8){ f->feat |= Data8; i = onesc(id + 222); /* sata? */ j = onesc(id + 76); if(i != 0 && i >> 12 == 1 && j != 0){ j >>= 1; f->speeds = j & 7; /* * not acceptable for comreset to * wipe out device configuration. * reject drive. i = gbit16(id + 78) & gbit16(id + 79); if((i & 1<<6) == 0) return -1; */ } } if(gbit16(id + 206) & 1) f->feat |= Dsct; idss(f, id); return s; } int idss(Sfis *f, ushort *id) { uint sw, i, pa; if(f->sig>>16 == 0xeb14) return 0; f->lsectsz = 512; f->physshift = 0; f->physalign = 0; i = gbit16(id + 106); if(i >> 14 != 1) return f->lsectsz; if((i & (1<<12)) && (sw = gbit32(id + 117)) >= 256) f->lsectsz = sw * 2; if(i & 1<<13){ f->physshift = i & 7; if((pa = gbit16(id + 209)) & 0x4000) f->physalign = pa & 0x3fff; } return f->lsectsz; } uvlong idwwn(Sfis*, ushort *id) { uvlong u; u = 0; if(id[108]>>12 == 5){ u |= (uvlong)gbit16(id + 108) << 48; u |= (uvlong)gbit16(id + 109) << 32; u |= gbit16(id + 110) << 16; u |= gbit16(id + 111) << 0; } return u; } void idmove(char *p, ushort *u, int n) { int i; char *op, *e, *s; op = p; s = (char*)u; for(i = 0; i < n; i += 2){ *p++ = s[i + 1]; *p++ = s[i + 0]; } *p = 0; while(p > op && *--p == ' ') *p = 0; e = p; p = op; while(*p == ' ') p++; memmove(op, p, n - (e - p)); } char* pflag(char *s, char *e, Sfis *f) { ushort i, u; u = f->feat; for(i = 0; i < Dnflag; i++) if(u & (1 << i)) s = seprint(s, e, "%s ", flagname[i]); return seprint(s, e, "\n"); } int atapirwfis(Sfis *f, uchar *c, uchar *cdb, int cdblen, int ndata) { int fill, len; fill = f->feat&Datapi16? 16: 12; if((len = cdblen) > fill) len = fill; memmove(c + 0x40, cdb, len); memset(c + 0x40 + len, 0, fill - len); c[Ftype] = H2dev; c[Fflags] = Fiscmd; c[Fcmd] = Ataobs; if(ndata != 0) c[Ffeat] = 1; /* dma */ else c[Ffeat] = 0; /* features (exp); */ c[Flba0] = 0; c[Flba8] = ndata; c[Flba16] = ndata >> 8; c[Fdev] = Ataobs; memset(c + 8, 0, Fissize - 8); return P28|Ppkt; } int rwfis(Sfis *f, uchar *c, int rw, int nsect, uvlong lba) { uchar acmd, llba, udma; static uchar tab[2][2][2] = { 0x20, 0x24, 0x30, 0x34, 0xc8, 0x25, 0xca, 0x35, }; static uchar ptab[2][2][2] = { Pin|Ppio|P28, Pin|Ppio|P48, Pout|Ppio|P28, Pout|Ppio|P48, Pin|Pdma|P28, Pin|Pdma|P48, Pout|Pdma|P28, Pout|Pdma|P48, }; udma = f->udma != 0xff; llba = (f->feat & Dllba) != 0; acmd = tab[udma][rw][llba]; c[Ftype] = 0x27; c[Fflags] = 0x80; c[Fcmd] = acmd; c[Ffeat] = 0; c[Flba0] = lba; c[Flba8] = lba >> 8; c[Flba16] = lba >> 16; c[Fdev] = Ataobs | Atalba; if(llba == 0) c[Fdev] |= (lba>>24) & 0xf; c[Flba24] = lba >> 24; c[Flba32] = lba >> 32; c[Flba40] = lba >> 40; c[Ffeat8] = 0; c[Fsc] = nsect; c[Fsc8] = nsect >> 8; c[Ficc] = 0; c[Fcontrol] = 0; memset(c + 16, 0, Fissize - 16); return ptab[udma][rw][llba]; } uvlong fisrw(Sfis *, uchar *c, int *n) { uvlong lba; lba = c[Flba0]; lba |= c[Flba8] << 8; lba |= c[Flba16] << 16; lba |= c[Flba24] << 24; lba |= (uvlong)(c[Flba32] | c[Flba40]<<8) << 32; *n = c[Fsc]; *n |= c[Fsc8] << 8; return lba; } void sigtofis(Sfis *f, uchar *c) { uint u; u = f->sig; memset(c, 0, Fissize); c[Ftype] = 0x34; c[Fflags] = 0x00; c[Fcmd] = 0x50; c[Ffeat] = 0x01; c[Flba0] = u >> 8; c[Flba8] = u >> 16; c[Flba16] = u >> 24; c[Fdev] = Ataobs; c[Fsc] = u; } uint fistosig(uchar *u) { return u[Fsc] | u[Flba0]<<8 | u[Flba8]<<16 | u[Flba16]<<24; } /* sas smp */ void smpskelframe(Cfis *f, uchar *c, int m) { memset(c, 0, Fissize); c[Ftype] = 0x40; c[Fflags] = m; if(f->phyid) c[Flba32] = f->phyid; } uint sashash(uvlong u) { uint poly, msb, l, r; uvlong m; r = 0; poly = 0x01db2777; msb = 0x01000000; for(m = 1ull<<63; m > 0; m >>= 1){ l = 0; if(m & u) l = msb; r <<= 1; r ^= l; if(r & msb) r ^= poly; } return r & 0xffffff; } uchar* sasbhash(uchar *t, uchar *s) { uint poly, msb, l, r, i, j; r = 0; poly = 0x01db2777; msb = 0x01000000; for(i = 0; i < 8; i++) for(j = 0x80; j != 0; j >>= 1){ l = 0; if(s[i] & j) l = msb; r <<= 1; r ^= l; if(r & msb) r ^= poly; } t[0] = r>>16; t[1] = r>>8; t[2] = r; return t; }