sd53c8xx.c 50 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094
  1. /*
  2. * NCR/Symbios/LSI Logic 53c8xx driver for Plan 9
  3. * Nigel Roles (nigel@9fs.org)
  4. *
  5. * 27/5/02 Fixed problems with transfers >= 256 * 512
  6. *
  7. * 13/3/01 Fixed microcode to support targets > 7
  8. *
  9. * 01/12/00 Removed previous comments. Fixed a small problem in
  10. * mismatch recovery for targets with synchronous offsets of >=16
  11. * connected to >=875s. Thanks, Jean.
  12. *
  13. * Known problems
  14. *
  15. * Read/write mismatch recovery may fail on 53c1010s. Really need to get a manual.
  16. */
  17. #define MAXTARGET 16 /* can be 8 or 16 */
  18. #include "u.h"
  19. #include "../port/lib.h"
  20. #include "mem.h"
  21. #include "dat.h"
  22. #include "fns.h"
  23. #include "io.h"
  24. #include "../port/sd.h"
  25. extern SDifc sd53c8xxifc;
  26. /**********************************/
  27. /* Portable configuration macros */
  28. /**********************************/
  29. //#define BOOTDEBUG
  30. //#define ASYNC_ONLY
  31. //#define INTERNAL_SCLK
  32. //#define ALWAYS_DO_WDTR
  33. #define WMR_DEBUG
  34. /**********************************/
  35. /* CPU specific macros */
  36. /**********************************/
  37. #define PRINTPREFIX "sd53c8xx: "
  38. #ifdef BOOTDEBUG
  39. #define KPRINT oprint
  40. #define IPRINT intrprint
  41. #define DEBUG(n) 1
  42. #define IFLUSH() iflush()
  43. #else
  44. #define KPRINT if(0) print
  45. #define IPRINT if(0) print
  46. #define DEBUG(n) (0)
  47. #define IFLUSH()
  48. #endif /* BOOTDEBUG */
  49. /*******************************/
  50. /* General */
  51. /*******************************/
  52. #ifndef DMASEG
  53. #define DMASEG(x) PCIWADDR(x)
  54. #define legetl(x) (*(ulong*)(x))
  55. #define lesetl(x,v) (*(ulong*)(x) = (v))
  56. #define swabl(a,b,c)
  57. #else
  58. #endif /*DMASEG */
  59. #define DMASEG_TO_KADDR(x) KADDR((x)-PCIWINDOW)
  60. #define KPTR(x) ((x) == 0 ? 0 : DMASEG_TO_KADDR(x))
  61. #define MEGA 1000000L
  62. #ifdef INTERNAL_SCLK
  63. #define SCLK (33 * MEGA)
  64. #else
  65. #define SCLK (40 * MEGA)
  66. #endif /* INTERNAL_SCLK */
  67. #define ULTRA_NOCLOCKDOUBLE_SCLK (80 * MEGA)
  68. #define MAXSYNCSCSIRATE (5 * MEGA)
  69. #define MAXFASTSYNCSCSIRATE (10 * MEGA)
  70. #define MAXULTRASYNCSCSIRATE (20 * MEGA)
  71. #define MAXULTRA2SYNCSCSIRATE (40 * MEGA)
  72. #define MAXASYNCCORERATE (25 * MEGA)
  73. #define MAXSYNCCORERATE (25 * MEGA)
  74. #define MAXFASTSYNCCORERATE (50 * MEGA)
  75. #define MAXULTRASYNCCORERATE (80 * MEGA)
  76. #define MAXULTRA2SYNCCORERATE (160 * MEGA)
  77. #define X_MSG 1
  78. #define X_MSG_SDTR 1
  79. #define X_MSG_WDTR 3
  80. struct na_patch {
  81. unsigned lwoff;
  82. unsigned char type;
  83. };
  84. typedef struct Ncr {
  85. uchar scntl0; /* 00 */
  86. uchar scntl1;
  87. uchar scntl2;
  88. uchar scntl3;
  89. uchar scid; /* 04 */
  90. uchar sxfer;
  91. uchar sdid;
  92. uchar gpreg;
  93. uchar sfbr; /* 08 */
  94. uchar socl;
  95. uchar ssid;
  96. uchar sbcl;
  97. uchar dstat; /* 0c */
  98. uchar sstat0;
  99. uchar sstat1;
  100. uchar sstat2;
  101. uchar dsa[4]; /* 10 */
  102. uchar istat; /* 14 */
  103. uchar istatpad[3];
  104. uchar ctest0; /* 18 */
  105. uchar ctest1;
  106. uchar ctest2;
  107. uchar ctest3;
  108. uchar temp[4]; /* 1c */
  109. uchar dfifo; /* 20 */
  110. uchar ctest4;
  111. uchar ctest5;
  112. uchar ctest6;
  113. uchar dbc[3]; /* 24 */
  114. uchar dcmd; /* 27 */
  115. uchar dnad[4]; /* 28 */
  116. uchar dsp[4]; /* 2c */
  117. uchar dsps[4]; /* 30 */
  118. uchar scratcha[4]; /* 34 */
  119. uchar dmode; /* 38 */
  120. uchar dien;
  121. uchar dwt;
  122. uchar dcntl;
  123. uchar adder[4]; /* 3c */
  124. uchar sien0; /* 40 */
  125. uchar sien1;
  126. uchar sist0;
  127. uchar sist1;
  128. uchar slpar; /* 44 */
  129. uchar slparpad0;
  130. uchar macntl;
  131. uchar gpcntl;
  132. uchar stime0; /* 48 */
  133. uchar stime1;
  134. uchar respid;
  135. uchar respidpad0;
  136. uchar stest0; /* 4c */
  137. uchar stest1;
  138. uchar stest2;
  139. uchar stest3;
  140. uchar sidl; /* 50 */
  141. uchar sidlpad[3];
  142. uchar sodl; /* 54 */
  143. uchar sodlpad[3];
  144. uchar sbdl; /* 58 */
  145. uchar sbdlpad[3];
  146. uchar scratchb[4]; /* 5c */
  147. } Ncr;
  148. typedef struct Movedata {
  149. uchar dbc[4];
  150. uchar pa[4];
  151. } Movedata;
  152. typedef enum NegoState {
  153. NeitherDone, WideInit, WideResponse, WideDone,
  154. SyncInit, SyncResponse, BothDone
  155. } NegoState;
  156. typedef enum State {
  157. Allocated, Queued, Active, Done
  158. } State;
  159. typedef struct Dsa {
  160. uchar stateb;
  161. uchar result;
  162. uchar dmablks;
  163. uchar flag; /* setbyte(state,3,...) */
  164. union {
  165. ulong dmancr; /* For block transfer: NCR order (little-endian) */
  166. uchar dmaaddr[4];
  167. };
  168. uchar target; /* Target */
  169. uchar pad0[3];
  170. uchar lun; /* Logical Unit Number */
  171. uchar pad1[3];
  172. uchar scntl3;
  173. uchar sxfer;
  174. uchar pad2[2];
  175. uchar next[4]; /* chaining for SCRIPT (NCR byte order) */
  176. struct Dsa *freechain; /* chaining for freelist */
  177. Rendez;
  178. uchar scsi_id_buf[4];
  179. Movedata msg_out_buf;
  180. Movedata cmd_buf;
  181. Movedata data_buf;
  182. Movedata status_buf;
  183. uchar msg_out[10]; /* enough to include SDTR */
  184. uchar status;
  185. int p9status;
  186. uchar parityerror;
  187. } Dsa;
  188. typedef enum Feature {
  189. BigFifo = 1, /* 536 byte fifo */
  190. BurstOpCodeFetch = 2, /* burst fetch opcodes */
  191. Prefetch = 4, /* prefetch 8 longwords */
  192. LocalRAM = 8, /* 4K longwords of local RAM */
  193. Differential = 16, /* Differential support */
  194. Wide = 32, /* Wide capable */
  195. Ultra = 64, /* Ultra capable */
  196. ClockDouble = 128, /* Has clock doubler */
  197. ClockQuad = 256, /* Has clock quadrupler (same as Ultra2) */
  198. Ultra2 = 256,
  199. } Feature;
  200. typedef enum Burst {
  201. Burst2 = 0,
  202. Burst4 = 1,
  203. Burst8 = 2,
  204. Burst16 = 3,
  205. Burst32 = 4,
  206. Burst64 = 5,
  207. Burst128 = 6
  208. } Burst;
  209. typedef struct Variant {
  210. ushort did;
  211. uchar maxrid; /* maximum allowed revision ID */
  212. char *name;
  213. Burst burst; /* codings for max burst */
  214. uchar maxsyncoff; /* max synchronous offset */
  215. uchar registers; /* number of 32 bit registers */
  216. unsigned feature;
  217. } Variant;
  218. static unsigned char cf2[] = { 6, 2, 3, 4, 6, 8, 12, 16 };
  219. #define NULTRA2SCF (sizeof(cf2)/sizeof(cf2[0]))
  220. #define NULTRASCF (NULTRA2SCF - 2)
  221. #define NSCF (NULTRASCF - 1)
  222. typedef struct Controller {
  223. Lock;
  224. struct {
  225. uchar scntl3;
  226. uchar stest2;
  227. } bios;
  228. uchar synctab[NULTRA2SCF - 1][8];/* table of legal tpfs */
  229. NegoState s[MAXTARGET];
  230. uchar scntl3[MAXTARGET];
  231. uchar sxfer[MAXTARGET];
  232. uchar cap[MAXTARGET]; /* capabilities byte from Identify */
  233. ushort capvalid; /* bit per target for validity of cap[] */
  234. ushort wide; /* bit per target set if wide negotiated */
  235. ulong sclk; /* clock speed of controller */
  236. uchar clockmult; /* set by synctabinit */
  237. uchar ccf; /* CCF bits */
  238. uchar tpf; /* best tpf value for this controller */
  239. uchar feature; /* requested features */
  240. int running; /* is the script processor running? */
  241. int ssm; /* single step mode */
  242. Ncr *n; /* pointer to registers */
  243. Variant *v; /* pointer to variant type */
  244. ulong *script; /* where the real script is */
  245. ulong scriptpa; /* where the real script is */
  246. Pcidev* pcidev;
  247. SDev* sdev;
  248. struct {
  249. Lock;
  250. uchar head[4]; /* head of free list (NCR byte order) */
  251. Dsa *tail;
  252. Dsa *freechain;
  253. } dsalist;
  254. QLock q[MAXTARGET]; /* queues for each target */
  255. } Controller;
  256. #define SYNCOFFMASK(c) (((c)->v->maxsyncoff * 2) - 1)
  257. #define SSIDMASK(c) (((c)->v->feature & Wide) ? 15 : 7)
  258. /* ISTAT */
  259. enum { Abrt = 0x80, Srst = 0x40, Sigp = 0x20, Sem = 0x10, Con = 0x08, Intf = 0x04, Sip = 0x02, Dip = 0x01 };
  260. /* DSTAT */
  261. enum { Dfe = 0x80, Mdpe = 0x40, Bf = 0x20, Abrted = 0x10, Ssi = 0x08, Sir = 0x04, Iid = 0x01 };
  262. /* SSTAT */
  263. enum { DataOut, DataIn, Cmd, Status, ReservedOut, ReservedIn, MessageOut, MessageIn };
  264. static void setmovedata(Movedata*, ulong, ulong);
  265. static void advancedata(Movedata*, long);
  266. static int bios_set_differential(Controller *c);
  267. static char *phase[] = {
  268. "data out", "data in", "command", "status",
  269. "reserved out", "reserved in", "message out", "message in"
  270. };
  271. #ifdef BOOTDEBUG
  272. #define DEBUGSIZE 10240
  273. char debugbuf[DEBUGSIZE];
  274. char *debuglast;
  275. static void
  276. intrprint(char *format, ...)
  277. {
  278. if (debuglast == 0)
  279. debuglast = debugbuf;
  280. debuglast = vseprint(debuglast, debugbuf + (DEBUGSIZE - 1), format, (&format + 1));
  281. }
  282. static void
  283. iflush()
  284. {
  285. int s;
  286. char *endp;
  287. s = splhi();
  288. if (debuglast == 0)
  289. debuglast = debugbuf;
  290. if (debuglast == debugbuf) {
  291. splx(s);
  292. return;
  293. }
  294. endp = debuglast;
  295. splx(s);
  296. screenputs(debugbuf, endp - debugbuf);
  297. s = splhi();
  298. memmove(debugbuf, endp, debuglast - endp);
  299. debuglast -= endp - debugbuf;
  300. splx(s);
  301. }
  302. static void
  303. oprint(char *format, ...)
  304. {
  305. int s;
  306. iflush();
  307. s = splhi();
  308. if (debuglast == 0)
  309. debuglast = debugbuf;
  310. debuglast = vseprint(debuglast, debugbuf + (DEBUGSIZE - 1), format, (&format + 1));
  311. splx(s);
  312. iflush();
  313. }
  314. #endif
  315. #include "sd53c8xx.i"
  316. static Dsa *
  317. dsaalloc(Controller *c, int target, int lun)
  318. {
  319. Dsa *d;
  320. ilock(&c->dsalist);
  321. if ((d = c->dsalist.freechain) == 0) {
  322. d = xalloc(sizeof(*d));
  323. if (DEBUG(1))
  324. KPRINT(PRINTPREFIX "%d/%d: allocated new dsa %lux\n", target, lun, (ulong)d);
  325. lesetl(d->next, 0);
  326. lesetl(&d->stateb, A_STATE_ALLOCATED);
  327. if (legetl(c->dsalist.head) == 0)
  328. lesetl(c->dsalist.head, DMASEG(d)); /* ATOMIC?!? */
  329. else
  330. lesetl(c->dsalist.tail->next, DMASEG(d)); /* ATOMIC?!? */
  331. c->dsalist.tail = d;
  332. }
  333. else {
  334. if (DEBUG(1))
  335. KPRINT(PRINTPREFIX "%d/%d: reused dsa %lux\n", target, lun, (ulong)d);
  336. c->dsalist.freechain = d->freechain;
  337. lesetl(&d->stateb, A_STATE_ALLOCATED);
  338. }
  339. iunlock(&c->dsalist);
  340. d->target = target;
  341. d->lun = lun;
  342. return d;
  343. }
  344. static void
  345. dsafree(Controller *c, Dsa *d)
  346. {
  347. ilock(&c->dsalist);
  348. d->freechain = c->dsalist.freechain;
  349. c->dsalist.freechain = d;
  350. lesetl(&d->stateb, A_STATE_FREE);
  351. iunlock(&c->dsalist);
  352. }
  353. static Dsa *
  354. dsafind(Controller *c, uchar target, uchar lun, uchar state)
  355. {
  356. Dsa *d;
  357. for (d = KPTR(legetl(c->dsalist.head)); d; d = KPTR(legetl(d->next))) {
  358. if (d->target != 0xff && d->target != target)
  359. continue;
  360. if (lun != 0xff && d->lun != lun)
  361. continue;
  362. if (state != 0xff && d->stateb != state)
  363. continue;
  364. break;
  365. }
  366. return d;
  367. }
  368. static void
  369. dumpncrregs(Controller *c, int intr)
  370. {
  371. int i;
  372. Ncr *n = c->n;
  373. int depth = c->v->registers / 4;
  374. KPRINT("sa = %.8lux\n", c->scriptpa);
  375. for (i = 0; i < depth; i++) {
  376. int j;
  377. for (j = 0; j < 4; j++) {
  378. int k = j * depth + i;
  379. uchar *p;
  380. /* display little-endian to make 32-bit values readable */
  381. p = (uchar*)n+k*4;
  382. if (intr)
  383. IPRINT(" %.2x%.2x%.2x%.2x %.2x %.2x", p[3], p[2], p[1], p[0], k * 4, (k * 4) + 0x80);
  384. else
  385. KPRINT(" %.2x%.2x%.2x%.2x %.2x %.2x", p[3], p[2], p[1], p[0], k * 4, (k * 4) + 0x80);
  386. USED(p);
  387. }
  388. if (intr)
  389. IPRINT("\n");
  390. else
  391. KPRINT("\n");
  392. }
  393. }
  394. static int
  395. chooserate(Controller *c, int tpf, int *scfp, int *xferpp)
  396. {
  397. /* find lowest entry >= tpf */
  398. int besttpf = 1000;
  399. int bestscfi = 0;
  400. int bestxferp = 0;
  401. int scf, xferp;
  402. int maxscf;
  403. if (c->v->feature & Ultra2)
  404. maxscf = NULTRA2SCF;
  405. else if (c->v->feature & Ultra)
  406. maxscf = NULTRASCF;
  407. else
  408. maxscf = NSCF;
  409. /*
  410. * search large clock factors first since this should
  411. * result in more reliable transfers
  412. */
  413. for (scf = maxscf; scf >= 1; scf--) {
  414. for (xferp = 0; xferp < 8; xferp++) {
  415. unsigned char v = c->synctab[scf - 1][xferp];
  416. if (v == 0)
  417. continue;
  418. if (v >= tpf && v < besttpf) {
  419. besttpf = v;
  420. bestscfi = scf;
  421. bestxferp = xferp;
  422. }
  423. }
  424. }
  425. if (besttpf == 1000)
  426. return 0;
  427. if (scfp)
  428. *scfp = bestscfi;
  429. if (xferpp)
  430. *xferpp = bestxferp;
  431. return besttpf;
  432. }
  433. static void
  434. synctabinit(Controller *c)
  435. {
  436. int scf;
  437. unsigned long scsilimit;
  438. int xferp;
  439. unsigned long cr, sr;
  440. int tpf;
  441. int fast;
  442. int maxscf;
  443. if (c->v->feature & Ultra2)
  444. maxscf = NULTRA2SCF;
  445. else if (c->v->feature & Ultra)
  446. maxscf = NULTRASCF;
  447. else
  448. maxscf = NSCF;
  449. /*
  450. * for chips with no clock doubler, but Ultra capable (e.g. 860, or interestingly the
  451. * first spin of the 875), assume 80MHz
  452. * otherwise use the internal (33 Mhz) or external (40MHz) default
  453. */
  454. if ((c->v->feature & Ultra) != 0 && (c->v->feature & (ClockDouble | ClockQuad)) == 0)
  455. c->sclk = ULTRA_NOCLOCKDOUBLE_SCLK;
  456. else
  457. c->sclk = SCLK;
  458. /*
  459. * otherwise, if the chip is Ultra capable, but has a slow(ish) clock,
  460. * invoke the doubler
  461. */
  462. if (SCLK <= 40000000) {
  463. if (c->v->feature & ClockDouble) {
  464. c->sclk *= 2;
  465. c->clockmult = 1;
  466. }
  467. else if (c->v->feature & ClockQuad) {
  468. c->sclk *= 4;
  469. c->clockmult = 1;
  470. }
  471. else
  472. c->clockmult = 0;
  473. }
  474. else
  475. c->clockmult = 0;
  476. /* derive CCF from sclk */
  477. /* woebetide anyone with SCLK < 16.7 or > 80MHz */
  478. if (c->sclk <= 25 * MEGA)
  479. c->ccf = 1;
  480. else if (c->sclk <= 3750000)
  481. c->ccf = 2;
  482. else if (c->sclk <= 50 * MEGA)
  483. c->ccf = 3;
  484. else if (c->sclk <= 75 * MEGA)
  485. c->ccf = 4;
  486. else if ((c->v->feature & ClockDouble) && c->sclk <= 80 * MEGA)
  487. c->ccf = 5;
  488. else if ((c->v->feature & ClockQuad) && c->sclk <= 120 * MEGA)
  489. c->ccf = 6;
  490. else if ((c->v->feature & ClockQuad) && c->sclk <= 160 * MEGA)
  491. c->ccf = 7;
  492. for (scf = 1; scf < maxscf; scf++) {
  493. /* check for legal core rate */
  494. /* round up so we run slower for safety */
  495. cr = (c->sclk * 2 + cf2[scf] - 1) / cf2[scf];
  496. if (cr <= MAXSYNCCORERATE) {
  497. scsilimit = MAXSYNCSCSIRATE;
  498. fast = 0;
  499. }
  500. else if (cr <= MAXFASTSYNCCORERATE) {
  501. scsilimit = MAXFASTSYNCSCSIRATE;
  502. fast = 1;
  503. }
  504. else if ((c->v->feature & Ultra) && cr <= MAXULTRASYNCCORERATE) {
  505. scsilimit = MAXULTRASYNCSCSIRATE;
  506. fast = 2;
  507. }
  508. else if ((c->v->feature & Ultra2) && cr <= MAXULTRA2SYNCCORERATE) {
  509. scsilimit = MAXULTRA2SYNCSCSIRATE;
  510. fast = 3;
  511. }
  512. else
  513. continue;
  514. for (xferp = 11; xferp >= 4; xferp--) {
  515. int ok;
  516. int tp;
  517. /* calculate scsi rate - round up again */
  518. /* start from sclk for accuracy */
  519. int totaldivide = xferp * cf2[scf];
  520. sr = (c->sclk * 2 + totaldivide - 1) / totaldivide;
  521. if (sr > scsilimit)
  522. break;
  523. /*
  524. * now work out transfer period
  525. * round down now so that period is pessimistic
  526. */
  527. tp = (MEGA * 1000) / sr;
  528. /*
  529. * bounds check it
  530. */
  531. if (tp < 25 || tp > 255 * 4)
  532. continue;
  533. /*
  534. * spot stupid special case for Ultra or Ultra2
  535. * while working out factor
  536. */
  537. if (tp == 25)
  538. tpf = 10;
  539. else if (tp == 50)
  540. tpf = 12;
  541. else if (tp < 52)
  542. continue;
  543. else
  544. tpf = tp / 4;
  545. /*
  546. * now check tpf looks sensible
  547. * given core rate
  548. */
  549. switch (fast) {
  550. case 0:
  551. /* scf must be ccf for SCSI 1 */
  552. ok = tpf >= 50 && scf == c->ccf;
  553. break;
  554. case 1:
  555. ok = tpf >= 25 && tpf < 50;
  556. break;
  557. case 2:
  558. /*
  559. * must use xferp of 4, or 5 at a pinch
  560. * for an Ultra transfer
  561. */
  562. ok = xferp <= 5 && tpf >= 12 && tpf < 25;
  563. break;
  564. case 3:
  565. ok = xferp == 4 && (tpf == 10 || tpf == 11);
  566. break;
  567. default:
  568. ok = 0;
  569. }
  570. if (!ok)
  571. continue;
  572. c->synctab[scf - 1][xferp - 4] = tpf;
  573. }
  574. }
  575. #ifndef NO_ULTRA2
  576. if (c->v->feature & Ultra2)
  577. tpf = 10;
  578. else
  579. #endif
  580. if (c->v->feature & Ultra)
  581. tpf = 12;
  582. else
  583. tpf = 25;
  584. for (; tpf < 256; tpf++) {
  585. if (chooserate(c, tpf, &scf, &xferp) == tpf) {
  586. unsigned tp = tpf == 10 ? 25 : (tpf == 12 ? 50 : tpf * 4);
  587. unsigned long khz = (MEGA + tp - 1) / (tp);
  588. KPRINT(PRINTPREFIX "tpf=%d scf=%d.%.1d xferp=%d mhz=%ld.%.3ld\n",
  589. tpf, cf2[scf] / 2, (cf2[scf] & 1) ? 5 : 0,
  590. xferp + 4, khz / 1000, khz % 1000);
  591. USED(khz);
  592. if (c->tpf == 0)
  593. c->tpf = tpf; /* note lowest value for controller */
  594. }
  595. }
  596. }
  597. static void
  598. synctodsa(Dsa *dsa, Controller *c)
  599. {
  600. /*
  601. KPRINT("synctodsa(dsa=%lux, target=%d, scntl3=%.2lx sxfer=%.2x)\n",
  602. dsa, dsa->target, c->scntl3[dsa->target], c->sxfer[dsa->target]);
  603. */
  604. dsa->scntl3 = c->scntl3[dsa->target];
  605. dsa->sxfer = c->sxfer[dsa->target];
  606. }
  607. static void
  608. setsync(Dsa *dsa, Controller *c, int target, uchar ultra, uchar scf, uchar xferp, uchar reqack)
  609. {
  610. c->scntl3[target] =
  611. (c->scntl3[target] & 0x08) | (((scf << 4) | c->ccf | (ultra << 7)) & ~0x08);
  612. c->sxfer[target] = (xferp << 5) | reqack;
  613. c->s[target] = BothDone;
  614. if (dsa) {
  615. synctodsa(dsa, c);
  616. c->n->scntl3 = c->scntl3[target];
  617. c->n->sxfer = c->sxfer[target];
  618. }
  619. }
  620. static void
  621. setasync(Dsa *dsa, Controller *c, int target)
  622. {
  623. setsync(dsa, c, target, 0, c->ccf, 0, 0);
  624. }
  625. static void
  626. setwide(Dsa *dsa, Controller *c, int target, uchar wide)
  627. {
  628. c->scntl3[target] = wide ? (1 << 3) : 0;
  629. setasync(dsa, c, target);
  630. c->s[target] = WideDone;
  631. }
  632. static int
  633. buildsdtrmsg(uchar *buf, uchar tpf, uchar offset)
  634. {
  635. *buf++ = X_MSG;
  636. *buf++ = 3;
  637. *buf++ = X_MSG_SDTR;
  638. *buf++ = tpf;
  639. *buf = offset;
  640. return 5;
  641. }
  642. static int
  643. buildwdtrmsg(uchar *buf, uchar expo)
  644. {
  645. *buf++ = X_MSG;
  646. *buf++ = 2;
  647. *buf++ = X_MSG_WDTR;
  648. *buf = expo;
  649. return 4;
  650. }
  651. static void
  652. start(Controller *c, long entry)
  653. {
  654. ulong p;
  655. if (c->running)
  656. panic(PRINTPREFIX "start called while running");
  657. c->running = 1;
  658. p = c->scriptpa + entry;
  659. lesetl(c->n->dsp, p);
  660. if (c->ssm)
  661. c->n->dcntl |= 0x4; /* start DMA in SSI mode */
  662. }
  663. static void
  664. ncrcontinue(Controller *c)
  665. {
  666. if (c->running)
  667. panic(PRINTPREFIX "ncrcontinue called while running");
  668. /* set the start DMA bit to continue execution */
  669. c->running = 1;
  670. c->n->dcntl |= 0x4;
  671. }
  672. static void
  673. softreset(Controller *c)
  674. {
  675. Ncr *n = c->n;
  676. n->istat = Srst; /* software reset */
  677. n->istat = 0;
  678. /* general initialisation */
  679. n->scid = (1 << 6) | 7; /* respond to reselect, ID 7 */
  680. n->respid = 1 << 7; /* response ID = 7 */
  681. #ifdef INTERNAL_SCLK
  682. n->stest1 = 0x80; /* disable external scsi clock */
  683. #else
  684. n->stest1 = 0x00;
  685. #endif
  686. n->stime0 = 0xdd; /* about 0.5 second timeout on each device */
  687. n->scntl0 |= 0x8; /* Enable parity checking */
  688. /* continued setup */
  689. n->sien0 = 0x8f;
  690. n->sien1 = 0x04;
  691. n->dien = 0x7d;
  692. n->stest3 = 0x80; /* TolerANT enable */
  693. c->running = 0;
  694. if (c->v->feature & BigFifo)
  695. n->ctest5 = (1 << 5);
  696. n->dmode = c->v->burst << 6; /* set burst length bits */
  697. if (c->v->burst & 4)
  698. n->ctest5 |= (1 << 2); /* including overflow into ctest5 bit 2 */
  699. if (c->v->feature & Prefetch)
  700. n->dcntl |= (1 << 5); /* prefetch enable */
  701. else if (c->v->feature & BurstOpCodeFetch)
  702. n->dmode |= (1 << 1); /* burst opcode fetch */
  703. if (c->v->feature & Differential) {
  704. /* chip capable */
  705. if ((c->feature & Differential) || bios_set_differential(c)) {
  706. /* user enabled, or some evidence bios set differential */
  707. if (n->sstat2 & (1 << 2))
  708. print(PRINTPREFIX "can't go differential; wrong cable\n");
  709. else {
  710. n->stest2 = (1 << 5);
  711. print(PRINTPREFIX "differential mode set\n");
  712. }
  713. }
  714. }
  715. if (c->clockmult) {
  716. n->stest1 |= (1 << 3); /* power up doubler */
  717. delay(2);
  718. n->stest3 |= (1 << 5); /* stop clock */
  719. n->stest1 |= (1 << 2); /* enable doubler */
  720. n->stest3 &= ~(1 << 5); /* start clock */
  721. /* pray */
  722. }
  723. }
  724. static void
  725. msgsm(Dsa *dsa, Controller *c, int msg, int *cont, int *wakeme)
  726. {
  727. uchar histpf, hisreqack;
  728. int tpf;
  729. int scf, xferp;
  730. int len;
  731. Ncr *n = c->n;
  732. switch (c->s[dsa->target]) {
  733. case SyncInit:
  734. switch (msg) {
  735. case A_SIR_MSG_SDTR:
  736. /* reply to my SDTR */
  737. histpf = n->scratcha[2];
  738. hisreqack = n->scratcha[3];
  739. KPRINT(PRINTPREFIX "%d: SDTN response %d %d\n",
  740. dsa->target, histpf, hisreqack);
  741. if (hisreqack == 0)
  742. setasync(dsa, c, dsa->target);
  743. else {
  744. /* hisreqack should be <= c->v->maxsyncoff */
  745. tpf = chooserate(c, histpf, &scf, &xferp);
  746. KPRINT(PRINTPREFIX "%d: SDTN: using %d %d\n",
  747. dsa->target, tpf, hisreqack);
  748. setsync(dsa, c, dsa->target, tpf < 25, scf, xferp, hisreqack);
  749. }
  750. *cont = -2;
  751. return;
  752. case A_SIR_EV_PHASE_SWITCH_AFTER_ID:
  753. /* target ignored ATN for message after IDENTIFY - not SCSI-II */
  754. KPRINT(PRINTPREFIX "%d: illegal phase switch after ID message - SCSI-1 device?\n", dsa->target);
  755. KPRINT(PRINTPREFIX "%d: SDTN: async\n", dsa->target);
  756. setasync(dsa, c, dsa->target);
  757. *cont = E_to_decisions;
  758. return;
  759. case A_SIR_MSG_REJECT:
  760. /* rejection of my SDTR */
  761. KPRINT(PRINTPREFIX "%d: SDTN: rejected SDTR\n", dsa->target);
  762. //async:
  763. KPRINT(PRINTPREFIX "%d: SDTN: async\n", dsa->target);
  764. setasync(dsa, c, dsa->target);
  765. *cont = -2;
  766. return;
  767. }
  768. break;
  769. case WideInit:
  770. switch (msg) {
  771. case A_SIR_MSG_WDTR:
  772. /* reply to my WDTR */
  773. KPRINT(PRINTPREFIX "%d: WDTN: response %d\n",
  774. dsa->target, n->scratcha[2]);
  775. setwide(dsa, c, dsa->target, n->scratcha[2]);
  776. *cont = -2;
  777. return;
  778. case A_SIR_EV_PHASE_SWITCH_AFTER_ID:
  779. /* target ignored ATN for message after IDENTIFY - not SCSI-II */
  780. KPRINT(PRINTPREFIX "%d: illegal phase switch after ID message - SCSI-1 device?\n", dsa->target);
  781. setwide(dsa, c, dsa->target, 0);
  782. *cont = E_to_decisions;
  783. return;
  784. case A_SIR_MSG_REJECT:
  785. /* rejection of my SDTR */
  786. KPRINT(PRINTPREFIX "%d: WDTN: rejected WDTR\n", dsa->target);
  787. setwide(dsa, c, dsa->target, 0);
  788. *cont = -2;
  789. return;
  790. }
  791. break;
  792. case NeitherDone:
  793. case WideDone:
  794. case BothDone:
  795. switch (msg) {
  796. case A_SIR_MSG_WDTR: {
  797. uchar hiswide, mywide;
  798. hiswide = n->scratcha[2];
  799. mywide = (c->v->feature & Wide) != 0;
  800. KPRINT(PRINTPREFIX "%d: WDTN: target init %d\n",
  801. dsa->target, hiswide);
  802. if (hiswide < mywide)
  803. mywide = hiswide;
  804. KPRINT(PRINTPREFIX "%d: WDTN: responding %d\n",
  805. dsa->target, mywide);
  806. setwide(dsa, c, dsa->target, mywide);
  807. len = buildwdtrmsg(dsa->msg_out, mywide);
  808. setmovedata(&dsa->msg_out_buf, DMASEG(dsa->msg_out), len);
  809. *cont = E_response;
  810. c->s[dsa->target] = WideResponse;
  811. return;
  812. }
  813. case A_SIR_MSG_SDTR:
  814. #ifdef ASYNC_ONLY
  815. *cont = E_reject;
  816. return;
  817. #else
  818. /* target decides to renegotiate */
  819. histpf = n->scratcha[2];
  820. hisreqack = n->scratcha[3];
  821. KPRINT(PRINTPREFIX "%d: SDTN: target init %d %d\n",
  822. dsa->target, histpf, hisreqack);
  823. if (hisreqack == 0) {
  824. /* he wants asynchronous */
  825. setasync(dsa, c, dsa->target);
  826. tpf = 0;
  827. }
  828. else {
  829. /* he wants synchronous */
  830. tpf = chooserate(c, histpf, &scf, &xferp);
  831. if (hisreqack > c->v->maxsyncoff)
  832. hisreqack = c->v->maxsyncoff;
  833. KPRINT(PRINTPREFIX "%d: using %d %d\n",
  834. dsa->target, tpf, hisreqack);
  835. setsync(dsa, c, dsa->target, tpf < 25, scf, xferp, hisreqack);
  836. }
  837. /* build my SDTR message */
  838. len = buildsdtrmsg(dsa->msg_out, tpf, hisreqack);
  839. setmovedata(&dsa->msg_out_buf, DMASEG(dsa->msg_out), len);
  840. *cont = E_response;
  841. c->s[dsa->target] = SyncResponse;
  842. return;
  843. #endif
  844. }
  845. break;
  846. case WideResponse:
  847. switch (msg) {
  848. case A_SIR_EV_RESPONSE_OK:
  849. c->s[dsa->target] = WideDone;
  850. KPRINT(PRINTPREFIX "%d: WDTN: response accepted\n", dsa->target);
  851. *cont = -2;
  852. return;
  853. case A_SIR_MSG_REJECT:
  854. setwide(dsa, c, dsa->target, 0);
  855. KPRINT(PRINTPREFIX "%d: WDTN: response REJECTed\n", dsa->target);
  856. *cont = -2;
  857. return;
  858. }
  859. break;
  860. case SyncResponse:
  861. switch (msg) {
  862. case A_SIR_EV_RESPONSE_OK:
  863. c->s[dsa->target] = BothDone;
  864. KPRINT(PRINTPREFIX "%d: SDTN: response accepted (%s)\n",
  865. dsa->target, phase[n->sstat1 & 7]);
  866. *cont = -2;
  867. return; /* chf */
  868. case A_SIR_MSG_REJECT:
  869. setasync(dsa, c, dsa->target);
  870. KPRINT(PRINTPREFIX "%d: SDTN: response REJECTed\n", dsa->target);
  871. *cont = -2;
  872. return;
  873. }
  874. break;
  875. }
  876. KPRINT(PRINTPREFIX "%d: msgsm: state %d msg %d\n",
  877. dsa->target, c->s[dsa->target], msg);
  878. *wakeme = 1;
  879. return;
  880. }
  881. static void
  882. calcblockdma(Dsa *d, ulong base, ulong count)
  883. {
  884. ulong blocks;
  885. if (DEBUG(3))
  886. blocks = 0;
  887. else {
  888. blocks = count / A_BSIZE;
  889. if (blocks > 255)
  890. blocks = 255;
  891. }
  892. d->dmablks = blocks;
  893. d->dmaaddr[0] = base;
  894. d->dmaaddr[1] = base >> 8;
  895. d->dmaaddr[2] = base >> 16;
  896. d->dmaaddr[3] = base >> 24;
  897. setmovedata(&d->data_buf, base + blocks * A_BSIZE, count - blocks * A_BSIZE);
  898. d->flag = legetl(d->data_buf.dbc) == 0;
  899. }
  900. static ulong
  901. read_mismatch_recover(Controller *c, Ncr *n, Dsa *dsa)
  902. {
  903. ulong dbc;
  904. uchar dfifo = n->dfifo;
  905. int inchip;
  906. dbc = (n->dbc[2]<<16)|(n->dbc[1]<<8)|n->dbc[0];
  907. if (n->ctest5 & (1 << 5))
  908. inchip = ((dfifo | ((n->ctest5 & 3) << 8)) - (dbc & 0x3ff)) & 0x3ff;
  909. else
  910. inchip = ((dfifo & 0x7f) - (dbc & 0x7f)) & 0x7f;
  911. if (inchip) {
  912. IPRINT(PRINTPREFIX "%d/%d: read_mismatch_recover: DMA FIFO = %d\n",
  913. dsa->target, dsa->lun, inchip);
  914. }
  915. if (n->sxfer & SYNCOFFMASK(c)) {
  916. /* SCSI FIFO */
  917. uchar fifo = n->sstat1 >> 4;
  918. if (c->v->maxsyncoff > 8)
  919. fifo |= (n->sstat2 & (1 << 4));
  920. if (fifo) {
  921. inchip += fifo;
  922. IPRINT(PRINTPREFIX "%d/%d: read_mismatch_recover: SCSI FIFO = %d\n",
  923. dsa->target, dsa->lun, fifo);
  924. }
  925. }
  926. else {
  927. if (n->sstat0 & (1 << 7)) {
  928. inchip++;
  929. IPRINT(PRINTPREFIX "%d/%d: read_mismatch_recover: SIDL full\n",
  930. dsa->target, dsa->lun);
  931. }
  932. if (n->sstat2 & (1 << 7)) {
  933. inchip++;
  934. IPRINT(PRINTPREFIX "%d/%d: read_mismatch_recover: SIDL msb full\n",
  935. dsa->target, dsa->lun);
  936. }
  937. }
  938. USED(inchip);
  939. return dbc;
  940. }
  941. static ulong
  942. write_mismatch_recover(Controller *c, Ncr *n, Dsa *dsa)
  943. {
  944. ulong dbc;
  945. uchar dfifo = n->dfifo;
  946. int inchip;
  947. dbc = (n->dbc[2]<<16)|(n->dbc[1]<<8)|n->dbc[0];
  948. USED(dsa);
  949. if (n->ctest5 & (1 << 5))
  950. inchip = ((dfifo | ((n->ctest5 & 3) << 8)) - (dbc & 0x3ff)) & 0x3ff;
  951. else
  952. inchip = ((dfifo & 0x7f) - (dbc & 0x7f)) & 0x7f;
  953. #ifdef WMR_DEBUG
  954. if (inchip) {
  955. IPRINT(PRINTPREFIX "%d/%d: write_mismatch_recover: DMA FIFO = %d\n",
  956. dsa->target, dsa->lun, inchip);
  957. }
  958. #endif
  959. if (n->sstat0 & (1 << 5)) {
  960. inchip++;
  961. #ifdef WMR_DEBUG
  962. IPRINT(PRINTPREFIX "%d/%d: write_mismatch_recover: SODL full\n", dsa->target, dsa->lun);
  963. #endif
  964. }
  965. if (n->sstat2 & (1 << 5)) {
  966. inchip++;
  967. #ifdef WMR_DEBUG
  968. IPRINT(PRINTPREFIX "%d/%d: write_mismatch_recover: SODL msb full\n", dsa->target, dsa->lun);
  969. #endif
  970. }
  971. if (n->sxfer & SYNCOFFMASK(c)) {
  972. /* synchronous SODR */
  973. if (n->sstat0 & (1 << 6)) {
  974. inchip++;
  975. #ifdef WMR_DEBUG
  976. IPRINT(PRINTPREFIX "%d/%d: write_mismatch_recover: SODR full\n",
  977. dsa->target, dsa->lun);
  978. #endif
  979. }
  980. if (n->sstat2 & (1 << 6)) {
  981. inchip++;
  982. #ifdef WMR_DEBUG
  983. IPRINT(PRINTPREFIX "%d/%d: write_mismatch_recover: SODR msb full\n",
  984. dsa->target, dsa->lun);
  985. #endif
  986. }
  987. }
  988. /* clear the dma fifo */
  989. n->ctest3 |= (1 << 2);
  990. /* wait till done */
  991. while ((n->dstat & Dfe) == 0)
  992. ;
  993. return dbc + inchip;
  994. }
  995. static void
  996. sd53c8xxinterrupt(Ureg *ur, void *a)
  997. {
  998. uchar istat;
  999. ushort sist;
  1000. uchar dstat;
  1001. int wakeme = 0;
  1002. int cont = -1;
  1003. Dsa *dsa;
  1004. Controller *c = a;
  1005. Ncr *n = c->n;
  1006. USED(ur);
  1007. if (DEBUG(1))
  1008. IPRINT(PRINTPREFIX "int\n");
  1009. ilock(c);
  1010. istat = n->istat;
  1011. if (istat & Intf) {
  1012. Dsa *d;
  1013. int wokesomething = 0;
  1014. if (DEBUG(1))
  1015. IPRINT(PRINTPREFIX "Intfly\n");
  1016. n->istat = Intf;
  1017. /* search for structures in A_STATE_DONE */
  1018. for (d = KPTR(legetl(c->dsalist.head)); d; d = KPTR(legetl(d->next))) {
  1019. if (d->stateb == A_STATE_DONE) {
  1020. d->p9status = d->status;
  1021. if (DEBUG(1))
  1022. IPRINT(PRINTPREFIX "waking up dsa %lux\n", (ulong)d);
  1023. wakeup(d);
  1024. wokesomething = 1;
  1025. }
  1026. }
  1027. if (!wokesomething)
  1028. IPRINT(PRINTPREFIX "nothing to wake up\n");
  1029. }
  1030. if ((istat & (Sip | Dip)) == 0) {
  1031. if (DEBUG(1))
  1032. IPRINT(PRINTPREFIX "int end %x\n", istat);
  1033. iunlock(c);
  1034. return;
  1035. }
  1036. sist = (n->sist1<<8)|n->sist0; /* BUG? can two-byte read be inconsistent? */
  1037. dstat = n->dstat;
  1038. dsa = (Dsa *)DMASEG_TO_KADDR(legetl(n->dsa));
  1039. c->running = 0;
  1040. if (istat & Sip) {
  1041. if (DEBUG(1))
  1042. IPRINT("sist = %.4x\n", sist);
  1043. if (sist & 0x80) {
  1044. ulong addr;
  1045. ulong sa;
  1046. ulong dbc;
  1047. ulong tbc;
  1048. int dmablks;
  1049. ulong dmaaddr;
  1050. addr = legetl(n->dsp);
  1051. sa = addr - c->scriptpa;
  1052. if (DEBUG(1) || DEBUG(2))
  1053. IPRINT(PRINTPREFIX "%d/%d: Phase Mismatch sa=%.8lux\n",
  1054. dsa->target, dsa->lun, sa);
  1055. /*
  1056. * now recover
  1057. */
  1058. if (sa == E_data_in_mismatch) {
  1059. /*
  1060. * though this is a failure in the residue, there may have been blocks
  1061. * as well. if so, dmablks will not have been zeroed, since the state
  1062. * was not saved by the microcode.
  1063. */
  1064. dbc = read_mismatch_recover(c, n, dsa);
  1065. tbc = legetl(dsa->data_buf.dbc) - dbc;
  1066. dsa->dmablks = 0;
  1067. n->scratcha[2] = 0;
  1068. advancedata(&dsa->data_buf, tbc);
  1069. if (DEBUG(1) || DEBUG(2))
  1070. IPRINT(PRINTPREFIX "%d/%d: transferred = %ld residue = %ld\n",
  1071. dsa->target, dsa->lun, tbc, legetl(dsa->data_buf.dbc));
  1072. cont = E_data_mismatch_recover;
  1073. }
  1074. else if (sa == E_data_in_block_mismatch) {
  1075. dbc = read_mismatch_recover(c, n, dsa);
  1076. tbc = A_BSIZE - dbc;
  1077. /* recover current state from registers */
  1078. dmablks = n->scratcha[2];
  1079. dmaaddr = legetl(n->scratchb);
  1080. /* we have got to dmaaddr + tbc */
  1081. /* we have dmablks * A_BSIZE - tbc + residue left to do */
  1082. /* so remaining transfer is */
  1083. IPRINT("in_block_mismatch: dmaaddr = 0x%lux tbc=%lud dmablks=%d\n",
  1084. dmaaddr, tbc, dmablks);
  1085. calcblockdma(dsa, dmaaddr + tbc,
  1086. dmablks * A_BSIZE - tbc + legetl(dsa->data_buf.dbc));
  1087. /* copy changes into scratch registers */
  1088. IPRINT("recalc: dmablks %d dmaaddr 0x%lx pa 0x%lx dbc %ld\n",
  1089. dsa->dmablks, legetl(dsa->dmaaddr),
  1090. legetl(dsa->data_buf.pa), legetl(dsa->data_buf.dbc));
  1091. n->scratcha[2] = dsa->dmablks;
  1092. lesetl(n->scratchb, dsa->dmancr);
  1093. cont = E_data_block_mismatch_recover;
  1094. }
  1095. else if (sa == E_data_out_mismatch) {
  1096. dbc = write_mismatch_recover(c, n, dsa);
  1097. tbc = legetl(dsa->data_buf.dbc) - dbc;
  1098. dsa->dmablks = 0;
  1099. n->scratcha[2] = 0;
  1100. advancedata(&dsa->data_buf, tbc);
  1101. if (DEBUG(1) || DEBUG(2))
  1102. IPRINT(PRINTPREFIX "%d/%d: transferred = %ld residue = %ld\n",
  1103. dsa->target, dsa->lun, tbc, legetl(dsa->data_buf.dbc));
  1104. cont = E_data_mismatch_recover;
  1105. }
  1106. else if (sa == E_data_out_block_mismatch) {
  1107. dbc = write_mismatch_recover(c, n, dsa);
  1108. tbc = legetl(dsa->data_buf.dbc) - dbc;
  1109. /* recover current state from registers */
  1110. dmablks = n->scratcha[2];
  1111. dmaaddr = legetl(n->scratchb);
  1112. /* we have got to dmaaddr + tbc */
  1113. /* we have dmablks blocks - tbc + residue left to do */
  1114. /* so remaining transfer is */
  1115. IPRINT("out_block_mismatch: dmaaddr = %lux tbc=%lud dmablks=%d\n",
  1116. dmaaddr, tbc, dmablks);
  1117. calcblockdma(dsa, dmaaddr + tbc,
  1118. dmablks * A_BSIZE - tbc + legetl(dsa->data_buf.dbc));
  1119. /* copy changes into scratch registers */
  1120. n->scratcha[2] = dsa->dmablks;
  1121. lesetl(n->scratchb, dsa->dmancr);
  1122. cont = E_data_block_mismatch_recover;
  1123. }
  1124. else if (sa == E_id_out_mismatch) {
  1125. /*
  1126. * target switched phases while attention held during
  1127. * message out. The possibilities are:
  1128. * 1. It didn't like the last message. This is indicated
  1129. * by the new phase being message_in. Use script to recover
  1130. *
  1131. * 2. It's not SCSI-II compliant. The new phase will be other
  1132. * than message_in. We should also indicate that the device
  1133. * is asynchronous, if it's the SDTR that got ignored
  1134. *
  1135. * For now, if the phase switch is not to message_in, and
  1136. * and it happens after IDENTIFY and before SDTR, we
  1137. * notify the negotiation state machine.
  1138. */
  1139. ulong lim = legetl(dsa->msg_out_buf.dbc);
  1140. uchar p = n->sstat1 & 7;
  1141. dbc = write_mismatch_recover(c, n, dsa);
  1142. tbc = lim - dbc;
  1143. IPRINT(PRINTPREFIX "%d/%d: msg_out_mismatch: %lud/%lud sent, phase %s\n",
  1144. dsa->target, dsa->lun, tbc, lim, phase[p]);
  1145. if (p != MessageIn && tbc == 1) {
  1146. msgsm(dsa, c, A_SIR_EV_PHASE_SWITCH_AFTER_ID, &cont, &wakeme);
  1147. }
  1148. else
  1149. cont = E_id_out_mismatch_recover;
  1150. }
  1151. else if (sa == E_cmd_out_mismatch) {
  1152. /*
  1153. * probably the command count is longer than the device wants ...
  1154. */
  1155. ulong lim = legetl(dsa->cmd_buf.dbc);
  1156. uchar p = n->sstat1 & 7;
  1157. dbc = write_mismatch_recover(c, n, dsa);
  1158. tbc = lim - dbc;
  1159. IPRINT(PRINTPREFIX "%d/%d: cmd_out_mismatch: %lud/%lud sent, phase %s\n",
  1160. dsa->target, dsa->lun, tbc, lim, phase[p]);
  1161. USED(p, tbc);
  1162. cont = E_to_decisions;
  1163. }
  1164. else {
  1165. IPRINT(PRINTPREFIX "%d/%d: ma sa=%.8lux wanted=%s got=%s\n",
  1166. dsa->target, dsa->lun, sa,
  1167. phase[n->dcmd & 7],
  1168. phase[n->sstat1 & 7]);
  1169. dumpncrregs(c, 1);
  1170. dsa->p9status = SDeio; /* chf */
  1171. wakeme = 1;
  1172. }
  1173. }
  1174. /*else*/ if (sist & 0x400) {
  1175. if (DEBUG(0))
  1176. IPRINT(PRINTPREFIX "%d/%d Sto\n", dsa->target, dsa->lun);
  1177. dsa->p9status = SDtimeout;
  1178. dsa->stateb = A_STATE_DONE;
  1179. softreset(c);
  1180. cont = E_issue_check;
  1181. wakeme = 1;
  1182. }
  1183. if (sist & 0x1) {
  1184. IPRINT(PRINTPREFIX "%d/%d: parity error\n", dsa->target, dsa->lun);
  1185. dsa->parityerror = 1;
  1186. }
  1187. if (sist & 0x4) {
  1188. IPRINT(PRINTPREFIX "%d/%d: unexpected disconnect\n",
  1189. dsa->target, dsa->lun);
  1190. dumpncrregs(c, 1);
  1191. //wakeme = 1;
  1192. dsa->p9status = SDeio;
  1193. }
  1194. }
  1195. if (istat & Dip) {
  1196. if (DEBUG(1))
  1197. IPRINT("dstat = %.2x\n", dstat);
  1198. /*else*/ if (dstat & Ssi) {
  1199. ulong *p = DMASEG_TO_KADDR(legetl(n->dsp));
  1200. ulong w = (uchar *)p - (uchar *)c->script;
  1201. IPRINT("[%lux]", w);
  1202. USED(w);
  1203. cont = -2; /* restart */
  1204. }
  1205. if (dstat & Sir) {
  1206. switch (legetl(n->dsps)) {
  1207. case A_SIR_MSG_IO_COMPLETE:
  1208. dsa->p9status = dsa->status;
  1209. wakeme = 1;
  1210. break;
  1211. case A_SIR_MSG_SDTR:
  1212. case A_SIR_MSG_WDTR:
  1213. case A_SIR_MSG_REJECT:
  1214. case A_SIR_EV_RESPONSE_OK:
  1215. msgsm(dsa, c, legetl(n->dsps), &cont, &wakeme);
  1216. break;
  1217. case A_SIR_MSG_IGNORE_WIDE_RESIDUE:
  1218. /* back up one in the data transfer */
  1219. IPRINT(PRINTPREFIX "%d/%d: ignore wide residue %d, WSR = %d\n",
  1220. dsa->target, dsa->lun, n->scratcha[1], n->scntl2 & 1);
  1221. if (dsa->flag == 2)
  1222. IPRINT(PRINTPREFIX "%d/%d: transfer over; residue ignored\n",
  1223. dsa->target, dsa->lun);
  1224. else {
  1225. calcblockdma(dsa, legetl(dsa->dmaaddr) - 1,
  1226. dsa->dmablks * A_BSIZE + legetl(dsa->data_buf.dbc) + 1);
  1227. }
  1228. cont = -2;
  1229. break;
  1230. case A_SIR_ERROR_NOT_MSG_IN_AFTER_RESELECT:
  1231. IPRINT(PRINTPREFIX "%d: not msg_in after reselect (%s)",
  1232. n->ssid & SSIDMASK(c), phase[n->sstat1 & 7]);
  1233. dsa = dsafind(c, n->ssid & SSIDMASK(c), -1, A_STATE_DISCONNECTED);
  1234. dumpncrregs(c, 1);
  1235. wakeme = 1;
  1236. break;
  1237. case A_SIR_NOTIFY_MSG_IN:
  1238. IPRINT(PRINTPREFIX "%d/%d: msg_in %d\n",
  1239. dsa->target, dsa->lun, n->sfbr);
  1240. cont = -2;
  1241. break;
  1242. case A_SIR_NOTIFY_DISC:
  1243. IPRINT(PRINTPREFIX "%d/%d: disconnect:", dsa->target, dsa->lun);
  1244. goto dsadump;
  1245. case A_SIR_NOTIFY_STATUS:
  1246. IPRINT(PRINTPREFIX "%d/%d: status\n", dsa->target, dsa->lun);
  1247. cont = -2;
  1248. break;
  1249. case A_SIR_NOTIFY_COMMAND:
  1250. IPRINT(PRINTPREFIX "%d/%d: commands\n", dsa->target, dsa->lun);
  1251. cont = -2;
  1252. break;
  1253. case A_SIR_NOTIFY_DATA_IN:
  1254. IPRINT(PRINTPREFIX "%d/%d: data in a %lx b %lx\n",
  1255. dsa->target, dsa->lun, legetl(n->scratcha), legetl(n->scratchb));
  1256. cont = -2;
  1257. break;
  1258. case A_SIR_NOTIFY_BLOCK_DATA_IN:
  1259. IPRINT(PRINTPREFIX "%d/%d: block data in: a2 %x b %lx\n",
  1260. dsa->target, dsa->lun, n->scratcha[2], legetl(n->scratchb));
  1261. cont = -2;
  1262. break;
  1263. case A_SIR_NOTIFY_DATA_OUT:
  1264. IPRINT(PRINTPREFIX "%d/%d: data out\n", dsa->target, dsa->lun);
  1265. cont = -2;
  1266. break;
  1267. case A_SIR_NOTIFY_DUMP:
  1268. IPRINT(PRINTPREFIX "%d/%d: dump\n", dsa->target, dsa->lun);
  1269. dumpncrregs(c, 1);
  1270. cont = -2;
  1271. break;
  1272. case A_SIR_NOTIFY_DUMP2:
  1273. IPRINT(PRINTPREFIX "%d/%d: dump2:", dsa->target, dsa->lun);
  1274. IPRINT(" sa %lux", legetl(n->dsp) - c->scriptpa);
  1275. IPRINT(" dsa %lux", legetl(n->dsa));
  1276. IPRINT(" sfbr %ux", n->sfbr);
  1277. IPRINT(" a %lux", legetl(n->scratcha));
  1278. IPRINT(" b %lux", legetl(n->scratchb));
  1279. IPRINT(" ssid %ux", n->ssid);
  1280. IPRINT("\n");
  1281. cont = -2;
  1282. break;
  1283. case A_SIR_NOTIFY_WAIT_RESELECT:
  1284. IPRINT(PRINTPREFIX "wait reselect\n");
  1285. cont = -2;
  1286. break;
  1287. case A_SIR_NOTIFY_RESELECT:
  1288. IPRINT(PRINTPREFIX "reselect: ssid %.2x sfbr %.2x at %ld\n",
  1289. n->ssid, n->sfbr, TK2MS(m->ticks));
  1290. cont = -2;
  1291. break;
  1292. case A_SIR_NOTIFY_ISSUE:
  1293. IPRINT(PRINTPREFIX "%d/%d: issue:", dsa->target, dsa->lun);
  1294. dsadump:
  1295. IPRINT(" tgt=%d", dsa->target);
  1296. IPRINT(" time=%ld", TK2MS(m->ticks));
  1297. IPRINT("\n");
  1298. cont = -2;
  1299. break;
  1300. case A_SIR_NOTIFY_ISSUE_CHECK:
  1301. IPRINT(PRINTPREFIX "issue check\n");
  1302. cont = -2;
  1303. break;
  1304. case A_SIR_NOTIFY_SIGP:
  1305. IPRINT(PRINTPREFIX "responded to SIGP\n");
  1306. cont = -2;
  1307. break;
  1308. case A_SIR_NOTIFY_DUMP_NEXT_CODE: {
  1309. ulong *dsp = DMASEG_TO_KADDR(legetl(n->dsp));
  1310. int x;
  1311. IPRINT(PRINTPREFIX "code at %lux", dsp - c->script);
  1312. for (x = 0; x < 6; x++)
  1313. IPRINT(" %.8lux", dsp[x]);
  1314. IPRINT("\n");
  1315. USED(dsp);
  1316. cont = -2;
  1317. break;
  1318. }
  1319. case A_SIR_NOTIFY_WSR:
  1320. IPRINT(PRINTPREFIX "%d/%d: WSR set\n", dsa->target, dsa->lun);
  1321. cont = -2;
  1322. break;
  1323. case A_SIR_NOTIFY_LOAD_SYNC:
  1324. IPRINT(PRINTPREFIX "%d/%d: scntl=%.2x sxfer=%.2x\n",
  1325. dsa->target, dsa->lun, n->scntl3, n->sxfer);
  1326. cont = -2;
  1327. break;
  1328. case A_SIR_NOTIFY_RESELECTED_ON_SELECT:
  1329. IPRINT(PRINTPREFIX "%d/%d: reselected during select\n",
  1330. dsa->target, dsa->lun);
  1331. cont = -2;
  1332. break;
  1333. case A_error_reselected: /* dsa isn't valid here */
  1334. print(PRINTPREFIX "reselection error\n");
  1335. dumpncrregs(c, 1);
  1336. for (dsa = KPTR(legetl(c->dsalist.head)); dsa; dsa = KPTR(legetl(dsa->next)))
  1337. IPRINT(PRINTPREFIX "dsa target %d lun %d state %d\n", dsa->target, dsa->lun, dsa->stateb);
  1338. break;
  1339. default:
  1340. IPRINT(PRINTPREFIX "%d/%d: script error %ld\n",
  1341. dsa->target, dsa->lun, legetl(n->dsps));
  1342. dumpncrregs(c, 1);
  1343. wakeme = 1;
  1344. }
  1345. }
  1346. /*else*/ if (dstat & Iid) {
  1347. ulong addr = legetl(n->dsp);
  1348. ulong dbc = (n->dbc[2]<<16)|(n->dbc[1]<<8)|n->dbc[0];
  1349. IPRINT(PRINTPREFIX "%d/%d: Iid pa=%.8lux sa=%.8lux dbc=%lux\n",
  1350. dsa->target, dsa->lun,
  1351. addr, addr - c->scriptpa, dbc);
  1352. addr = (ulong)DMASEG_TO_KADDR(addr);
  1353. IPRINT("%.8lux %.8lux %.8lux\n",
  1354. *(ulong *)(addr - 12), *(ulong *)(addr - 8), *(ulong *)(addr - 4));
  1355. USED(addr, dbc);
  1356. dsa->p9status = SDeio;
  1357. wakeme = 1;
  1358. }
  1359. /*else*/ if (dstat & Bf) {
  1360. IPRINT(PRINTPREFIX "%d/%d: Bus Fault\n", dsa->target, dsa->lun);
  1361. dumpncrregs(c, 1);
  1362. dsa->p9status = SDeio;
  1363. wakeme = 1;
  1364. }
  1365. }
  1366. if (cont == -2)
  1367. ncrcontinue(c);
  1368. else if (cont >= 0)
  1369. start(c, cont);
  1370. if (wakeme){
  1371. if(dsa->p9status == SDnostatus)
  1372. dsa->p9status = SDeio;
  1373. wakeup(dsa);
  1374. }
  1375. iunlock(c);
  1376. if (DEBUG(1)) {
  1377. IPRINT(PRINTPREFIX "int end 1\n");
  1378. }
  1379. }
  1380. static int
  1381. done(void *arg)
  1382. {
  1383. return ((Dsa *)arg)->p9status != SDnostatus;
  1384. }
  1385. static void
  1386. setmovedata(Movedata *d, ulong pa, ulong bc)
  1387. {
  1388. d->pa[0] = pa;
  1389. d->pa[1] = pa>>8;
  1390. d->pa[2] = pa>>16;
  1391. d->pa[3] = pa>>24;
  1392. d->dbc[0] = bc;
  1393. d->dbc[1] = bc>>8;
  1394. d->dbc[2] = bc>>16;
  1395. d->dbc[3] = bc>>24;
  1396. }
  1397. static void
  1398. advancedata(Movedata *d, long v)
  1399. {
  1400. lesetl(d->pa, legetl(d->pa) + v);
  1401. lesetl(d->dbc, legetl(d->dbc) - v);
  1402. }
  1403. static void
  1404. dumpwritedata(uchar *data, int datalen)
  1405. {
  1406. int i;
  1407. uchar *bp;
  1408. if (!DEBUG(0)){
  1409. USED(data, datalen);
  1410. return;
  1411. }
  1412. if (datalen) {
  1413. KPRINT(PRINTPREFIX "write:");
  1414. for (i = 0, bp = data; i < 50 && i < datalen; i++, bp++)
  1415. KPRINT("%.2ux", *bp);
  1416. if (i < datalen) {
  1417. KPRINT("...");
  1418. }
  1419. KPRINT("\n");
  1420. }
  1421. }
  1422. static void
  1423. dumpreaddata(uchar *data, int datalen)
  1424. {
  1425. int i;
  1426. uchar *bp;
  1427. if (!DEBUG(0)){
  1428. USED(data, datalen);
  1429. return;
  1430. }
  1431. if (datalen) {
  1432. KPRINT(PRINTPREFIX "read:");
  1433. for (i = 0, bp = data; i < 50 && i < datalen; i++, bp++)
  1434. KPRINT("%.2ux", *bp);
  1435. if (i < datalen) {
  1436. KPRINT("...");
  1437. }
  1438. KPRINT("\n");
  1439. }
  1440. }
  1441. static void
  1442. busreset(Controller *c)
  1443. {
  1444. int x, ntarget;
  1445. /* bus reset */
  1446. c->n->scntl1 |= (1 << 3);
  1447. delay(500);
  1448. c->n->scntl1 &= ~(1 << 3);
  1449. if(!(c->v->feature & Wide))
  1450. ntarget = 8;
  1451. else
  1452. ntarget = MAXTARGET;
  1453. for (x = 0; x < ntarget; x++) {
  1454. setwide(0, c, x, 0);
  1455. #ifndef ASYNC_ONLY
  1456. c->s[x] = NeitherDone;
  1457. #endif
  1458. }
  1459. c->capvalid = 0;
  1460. }
  1461. static void
  1462. reset(Controller *c)
  1463. {
  1464. /* should wakeup all pending tasks */
  1465. softreset(c);
  1466. busreset(c);
  1467. }
  1468. static int
  1469. sd53c8xxrio(SDreq* r)
  1470. {
  1471. Dsa *d;
  1472. uchar *bp;
  1473. Controller *c;
  1474. uchar target_expo, my_expo;
  1475. int bc, check, status, target;
  1476. if((target = r->unit->subno) == 0x07)
  1477. return r->status = SDtimeout; /* assign */
  1478. c = r->unit->dev->ctlr;
  1479. check = 0;
  1480. d = dsaalloc(c, target, r->lun);
  1481. qlock(&c->q[target]); /* obtain access to target */
  1482. docheck:
  1483. /* load the transfer control stuff */
  1484. d->scsi_id_buf[0] = 0;
  1485. d->scsi_id_buf[1] = c->sxfer[target];
  1486. d->scsi_id_buf[2] = target;
  1487. d->scsi_id_buf[3] = c->scntl3[target];
  1488. synctodsa(d, c);
  1489. bc = 0;
  1490. d->msg_out[bc] = 0x80 | r->lun;
  1491. #ifndef NO_DISCONNECT
  1492. d->msg_out[bc] |= (1 << 6);
  1493. #endif
  1494. bc++;
  1495. /* work out what to do about negotiation */
  1496. switch (c->s[target]) {
  1497. default:
  1498. KPRINT(PRINTPREFIX "%d: strange nego state %d\n", target, c->s[target]);
  1499. c->s[target] = NeitherDone;
  1500. /* fall through */
  1501. case NeitherDone:
  1502. if ((c->capvalid & (1 << target)) == 0)
  1503. break;
  1504. target_expo = (c->cap[target] >> 5) & 3;
  1505. my_expo = (c->v->feature & Wide) != 0;
  1506. if (target_expo < my_expo)
  1507. my_expo = target_expo;
  1508. #ifdef ALWAYS_DO_WDTR
  1509. bc += buildwdtrmsg(d->msg_out + bc, my_expo);
  1510. KPRINT(PRINTPREFIX "%d: WDTN: initiating expo %d\n", target, my_expo);
  1511. c->s[target] = WideInit;
  1512. break;
  1513. #else
  1514. if (my_expo) {
  1515. bc += buildwdtrmsg(d->msg_out + bc, (c->v->feature & Wide) ? 1 : 0);
  1516. KPRINT(PRINTPREFIX "%d: WDTN: initiating expo %d\n", target, my_expo);
  1517. c->s[target] = WideInit;
  1518. break;
  1519. }
  1520. KPRINT(PRINTPREFIX "%d: WDTN: narrow\n", target);
  1521. /* fall through */
  1522. #endif
  1523. case WideDone:
  1524. if (c->cap[target] & (1 << 4)) {
  1525. KPRINT(PRINTPREFIX "%d: SDTN: initiating %d %d\n", target, c->tpf, c->v->maxsyncoff);
  1526. bc += buildsdtrmsg(d->msg_out + bc, c->tpf, c->v->maxsyncoff);
  1527. c->s[target] = SyncInit;
  1528. break;
  1529. }
  1530. KPRINT(PRINTPREFIX "%d: SDTN: async only\n", target);
  1531. c->s[target] = BothDone;
  1532. break;
  1533. case BothDone:
  1534. break;
  1535. }
  1536. setmovedata(&d->msg_out_buf, DMASEG(d->msg_out), bc);
  1537. setmovedata(&d->cmd_buf, DMASEG(r->cmd), r->clen);
  1538. calcblockdma(d, DMASEG(r->data), r->dlen);
  1539. if (DEBUG(0)) {
  1540. KPRINT(PRINTPREFIX "%d/%d: exec: ", target, r->lun);
  1541. for (bp = r->cmd; bp < &r->cmd[r->clen]; bp++)
  1542. KPRINT("%.2ux", *bp);
  1543. KPRINT("\n");
  1544. if (!r->write)
  1545. KPRINT(PRINTPREFIX "%d/%d: exec: limit=(%d)%ld\n",
  1546. target, r->lun, d->dmablks, legetl(d->data_buf.dbc));
  1547. else
  1548. dumpwritedata(r->data, r->dlen);
  1549. }
  1550. setmovedata(&d->status_buf, DMASEG(&d->status), 1);
  1551. d->p9status = SDnostatus;
  1552. d->parityerror = 0;
  1553. d->stateb = A_STATE_ISSUE; /* start operation */
  1554. ilock(c);
  1555. if (c->ssm)
  1556. c->n->dcntl |= 0x10; /* SSI */
  1557. if (c->running) {
  1558. c->n->istat |= Sigp;
  1559. }
  1560. else {
  1561. start(c, E_issue_check);
  1562. }
  1563. iunlock(c);
  1564. while(waserror())
  1565. ;
  1566. tsleep(d, done, d, 600 * 1000);
  1567. poperror();
  1568. if (!done(d)) {
  1569. KPRINT(PRINTPREFIX "%d/%d: exec: Timed out\n", target, r->lun);
  1570. dumpncrregs(c, 0);
  1571. dsafree(c, d);
  1572. reset(c);
  1573. qunlock(&c->q[target]);
  1574. r->status = SDtimeout;
  1575. return r->status = SDtimeout; /* assign */
  1576. }
  1577. if((status = d->p9status) == SDeio)
  1578. c->s[target] = NeitherDone;
  1579. if (d->parityerror) {
  1580. status = SDeio;
  1581. }
  1582. /*
  1583. * adjust datalen
  1584. */
  1585. r->rlen = r->dlen;
  1586. if (DEBUG(0))
  1587. KPRINT(PRINTPREFIX "%d/%d: exec: before rlen adjust: dmablks %d flag %d dbc %lud\n",
  1588. target, r->lun, d->dmablks, d->flag, legetl(d->data_buf.dbc));
  1589. r->rlen = r->dlen;
  1590. if (d->flag != 2) {
  1591. r->rlen -= d->dmablks * A_BSIZE;
  1592. r->rlen -= legetl(d->data_buf.dbc);
  1593. }
  1594. if(!r->write)
  1595. dumpreaddata(r->data, r->rlen);
  1596. if (DEBUG(0))
  1597. KPRINT(PRINTPREFIX "%d/%d: exec: p9status=%d status %d rlen %ld\n",
  1598. target, r->lun, d->p9status, status, r->rlen);
  1599. /*
  1600. * spot the identify
  1601. */
  1602. if ((c->capvalid & (1 << target)) == 0
  1603. && (status == SDok || status == SDcheck)
  1604. && r->cmd[0] == 0x12 && r->dlen >= 8) {
  1605. c->capvalid |= 1 << target;
  1606. bp = r->data;
  1607. c->cap[target] = bp[7];
  1608. KPRINT(PRINTPREFIX "%d: capabilities %.2x\n", target, bp[7]);
  1609. }
  1610. if(!check && status == SDcheck && !(r->flags & SDnosense)){
  1611. check = 1;
  1612. r->write = 0;
  1613. memset(r->cmd, 0, sizeof(r->cmd));
  1614. r->cmd[0] = 0x03;
  1615. r->cmd[1] = r->lun<<5;
  1616. r->cmd[4] = sizeof(r->sense)-1;
  1617. r->clen = 6;
  1618. r->data = r->sense;
  1619. r->dlen = sizeof(r->sense)-1;
  1620. /*
  1621. * Clear out the microcode state
  1622. * so the Dsa can be re-used.
  1623. */
  1624. lesetl(&d->stateb, A_STATE_ALLOCATED);
  1625. goto docheck;
  1626. }
  1627. qunlock(&c->q[target]);
  1628. dsafree(c, d);
  1629. if(status == SDok && check){
  1630. status = SDcheck;
  1631. r->flags |= SDvalidsense;
  1632. }
  1633. KPRINT(PRINTPREFIX "%d: r flags %8.8uX status %d rlen %ld\n",
  1634. target, r->flags, status, r->rlen);
  1635. return r->status = status;
  1636. }
  1637. static void
  1638. cribbios(Controller *c)
  1639. {
  1640. c->bios.scntl3 = c->n->scntl3;
  1641. c->bios.stest2 = c->n->stest2;
  1642. print(PRINTPREFIX "bios scntl3(%.2x) stest2(%.2x)\n", c->bios.scntl3, c->bios.stest2);
  1643. }
  1644. static int
  1645. bios_set_differential(Controller *c)
  1646. {
  1647. /* Concept lifted from FreeBSD - thanks Gerard */
  1648. /* basically, if clock conversion factors are set, then there is
  1649. * evidence the bios had a go at the chip, and if so, it would
  1650. * have set the differential enable bit in stest2
  1651. */
  1652. return (c->bios.scntl3 & 7) != 0 && (c->bios.stest2 & 0x20) != 0;
  1653. }
  1654. #define NCR_VID 0x1000
  1655. #define NCR_810_DID 0x0001
  1656. #define NCR_820_DID 0x0002 /* don't know enough about this one to support it */
  1657. #define NCR_825_DID 0x0003
  1658. #define NCR_815_DID 0x0004
  1659. #define SYM_810AP_DID 0x0005
  1660. #define SYM_860_DID 0x0006
  1661. #define SYM_896_DID 0x000b
  1662. #define SYM_895_DID 0x000c
  1663. #define SYM_885_DID 0x000d /* ditto */
  1664. #define SYM_875_DID 0x000f /* ditto */
  1665. #define SYM_1010_DID 0x0020
  1666. #define SYM_875J_DID 0x008f
  1667. static Variant variant[] = {
  1668. { NCR_810_DID, 0x0f, "NCR53C810", Burst16, 8, 24, 0 },
  1669. { NCR_810_DID, 0x1f, "SYM53C810ALV", Burst16, 8, 24, Prefetch },
  1670. { NCR_810_DID, 0xff, "SYM53C810A", Burst16, 8, 24, Prefetch },
  1671. { SYM_810AP_DID, 0xff, "SYM53C810AP", Burst16, 8, 24, Prefetch },
  1672. { NCR_815_DID, 0xff, "NCR53C815", Burst16, 8, 24, BurstOpCodeFetch },
  1673. { NCR_825_DID, 0x0f, "NCR53C825", Burst16, 8, 24, Wide|BurstOpCodeFetch|Differential },
  1674. { NCR_825_DID, 0xff, "SYM53C825A", Burst128, 16, 24, Prefetch|LocalRAM|BigFifo|Differential|Wide },
  1675. { SYM_860_DID, 0x0f, "SYM53C860", Burst16, 8, 24, Prefetch|Ultra },
  1676. { SYM_860_DID, 0xff, "SYM53C860LV", Burst16, 8, 24, Prefetch|Ultra },
  1677. { SYM_875_DID, 0x01, "SYM53C875r1", Burst128, 16, 24, Prefetch|LocalRAM|BigFifo|Differential|Wide|Ultra },
  1678. { SYM_875_DID, 0xff, "SYM53C875", Burst128, 16, 24, Prefetch|LocalRAM|BigFifo|Differential|Wide|Ultra|ClockDouble },
  1679. { SYM_875J_DID, 0xff, "SYM53C875j", Burst128, 16, 24, Prefetch|LocalRAM|BigFifo|Differential|Wide|Ultra|ClockDouble },
  1680. { SYM_885_DID, 0xff, "SYM53C885", Burst128, 16, 24, Prefetch|LocalRAM|BigFifo|Wide|Ultra|ClockDouble },
  1681. { SYM_895_DID, 0xff, "SYM53C895", Burst128, 16, 24, Prefetch|LocalRAM|BigFifo|Wide|Ultra|Ultra2 },
  1682. { SYM_896_DID, 0xff, "SYM53C896", Burst128, 16, 64, Prefetch|LocalRAM|BigFifo|Wide|Ultra|Ultra2 },
  1683. { SYM_1010_DID, 0xff, "SYM53C1010", Burst128, 16, 64, Prefetch|LocalRAM|BigFifo|Wide|Ultra|Ultra2 },
  1684. };
  1685. #define offsetof(s, t) ((ulong)&((s *)0)->t)
  1686. static int
  1687. xfunc(Controller *c, enum na_external x, unsigned long *v)
  1688. {
  1689. switch (x)
  1690. {
  1691. case X_scsi_id_buf:
  1692. *v = offsetof(Dsa, scsi_id_buf[0]); return 1;
  1693. case X_msg_out_buf:
  1694. *v = offsetof(Dsa, msg_out_buf); return 1;
  1695. case X_cmd_buf:
  1696. *v = offsetof(Dsa, cmd_buf); return 1;
  1697. case X_data_buf:
  1698. *v = offsetof(Dsa, data_buf); return 1;
  1699. case X_status_buf:
  1700. *v = offsetof(Dsa, status_buf); return 1;
  1701. case X_dsa_head:
  1702. *v = DMASEG(&c->dsalist.head[0]); return 1;
  1703. case X_ssid_mask:
  1704. *v = SSIDMASK(c); return 1;
  1705. default:
  1706. print("xfunc: can't find external %d\n", x);
  1707. return 0;
  1708. }
  1709. return 1;
  1710. }
  1711. static int
  1712. na_fixup(Controller *c, ulong pa_reg,
  1713. struct na_patch *patch, int patches,
  1714. int (*externval)(Controller*, int, ulong*))
  1715. {
  1716. int p;
  1717. int v;
  1718. ulong *script, pa_script;
  1719. unsigned long lw, lv;
  1720. script = c->script;
  1721. pa_script = c->scriptpa;
  1722. for (p = 0; p < patches; p++) {
  1723. switch (patch[p].type) {
  1724. case 1:
  1725. /* script relative */
  1726. script[patch[p].lwoff] += pa_script;
  1727. break;
  1728. case 2:
  1729. /* register i/o relative */
  1730. script[patch[p].lwoff] += pa_reg;
  1731. break;
  1732. case 3:
  1733. /* data external */
  1734. lw = script[patch[p].lwoff];
  1735. v = (lw >> 8) & 0xff;
  1736. if (!(*externval)(c, v, &lv))
  1737. return 0;
  1738. v = lv & 0xff;
  1739. script[patch[p].lwoff] = (lw & 0xffff00ffL) | (v << 8);
  1740. break;
  1741. case 4:
  1742. /* 32 bit external */
  1743. lw = script[patch[p].lwoff];
  1744. if (!(*externval)(c, lw, &lv))
  1745. return 0;
  1746. script[patch[p].lwoff] = lv;
  1747. break;
  1748. case 5:
  1749. /* 24 bit external */
  1750. lw = script[patch[p].lwoff];
  1751. if (!(*externval)(c, lw & 0xffffff, &lv))
  1752. return 0;
  1753. script[patch[p].lwoff] = (lw & 0xff000000L) | (lv & 0xffffffL);
  1754. break;
  1755. }
  1756. }
  1757. return 1;
  1758. }
  1759. static SDev*
  1760. sd53c8xxpnp(void)
  1761. {
  1762. char *cp;
  1763. Pcidev *p;
  1764. Variant *v;
  1765. int ba, nctlr;
  1766. void *scriptma;
  1767. Controller *ctlr;
  1768. SDev *sdev, *head, *tail;
  1769. ulong regpa, *script, scriptpa;
  1770. if(cp = getconf("*maxsd53c8xx"))
  1771. nctlr = strtoul(cp, 0, 0);
  1772. else
  1773. nctlr = 32;
  1774. p = nil;
  1775. head = tail = nil;
  1776. while((p = pcimatch(p, NCR_VID, 0)) != nil && nctlr > 0){
  1777. for(v = variant; v < &variant[nelem(variant)]; v++){
  1778. if(p->did == v->did && p->rid <= v->maxrid)
  1779. break;
  1780. }
  1781. if(v >= &variant[nelem(variant)]) {
  1782. print("no match\n");
  1783. continue;
  1784. }
  1785. print(PRINTPREFIX "%s rev. 0x%2.2x intr=%d command=%4.4luX\n",
  1786. v->name, p->rid, p->intl, p->pcr);
  1787. regpa = p->mem[1].bar;
  1788. ba = 2;
  1789. if(regpa & 0x04){
  1790. if(p->mem[2].bar)
  1791. continue;
  1792. ba++;
  1793. }
  1794. regpa = upamalloc(regpa & ~0x0F, p->mem[1].size, 0);
  1795. if(regpa == 0)
  1796. continue;
  1797. script = nil;
  1798. scriptpa = 0;
  1799. scriptma = nil;
  1800. if((v->feature & LocalRAM) && sizeof(na_script) <= 4096){
  1801. scriptpa = p->mem[ba].bar;
  1802. if((scriptpa & 0x04) && p->mem[ba+1].bar){
  1803. upafree(regpa, p->mem[1].size);
  1804. continue;
  1805. }
  1806. scriptpa = upamalloc(scriptpa & ~0x0F,
  1807. p->mem[ba].size, 0);
  1808. if(scriptpa)
  1809. script = KADDR(scriptpa);
  1810. }
  1811. if(scriptpa == 0){
  1812. /*
  1813. * Either the map failed, or this chip does not have
  1814. * local RAM. It will need a copy of the microcode.
  1815. */
  1816. scriptma = malloc(sizeof(na_script));
  1817. if(scriptma == nil){
  1818. upafree(regpa, p->mem[1].size);
  1819. continue;
  1820. }
  1821. scriptpa = DMASEG(scriptma);
  1822. script = scriptma;
  1823. }
  1824. ctlr = malloc(sizeof(Controller));
  1825. sdev = malloc(sizeof(SDev));
  1826. if(ctlr == nil || sdev == nil){
  1827. buggery:
  1828. if(ctlr)
  1829. free(ctlr);
  1830. if(sdev)
  1831. free(sdev);
  1832. if(scriptma)
  1833. free(scriptma);
  1834. else
  1835. upafree(scriptpa, p->mem[ba].size);
  1836. upafree(regpa, p->mem[1].size);
  1837. continue;
  1838. }
  1839. ctlr->n = KADDR(regpa);
  1840. ctlr->v = v;
  1841. ctlr->script = script;
  1842. memmove(ctlr->script, na_script, sizeof(na_script));
  1843. /*
  1844. * Because we don't yet have an abstraction for the
  1845. * addresses as seen from the controller side (and on
  1846. * the 386 it doesn't matter), the follwong two lines
  1847. * are different between the 386 and alpha copies of
  1848. * this driver.
  1849. */
  1850. ctlr->scriptpa = scriptpa;
  1851. if(!na_fixup(ctlr, regpa, na_patches, NA_PATCHES, xfunc)){
  1852. print("script fixup failed\n");
  1853. goto buggery;
  1854. }
  1855. swabl(ctlr->script, ctlr->script, sizeof(na_script));
  1856. ctlr->dsalist.freechain = 0;
  1857. lesetl(ctlr->dsalist.head, 0);
  1858. ctlr->pcidev = p;
  1859. sdev->ifc = &sd53c8xxifc;
  1860. sdev->ctlr = ctlr;
  1861. if(!(v->feature & Wide))
  1862. sdev->nunit = 8;
  1863. else
  1864. sdev->nunit = MAXTARGET;
  1865. ctlr->sdev = sdev;
  1866. if(head != nil)
  1867. tail->next = sdev;
  1868. else
  1869. head = sdev;
  1870. tail = sdev;
  1871. nctlr--;
  1872. }
  1873. return head;
  1874. }
  1875. static SDev*
  1876. sd53c8xxid(SDev* sdev)
  1877. {
  1878. return scsiid(sdev, &sd53c8xxifc);
  1879. }
  1880. static int
  1881. sd53c8xxenable(SDev* sdev)
  1882. {
  1883. Pcidev *pcidev;
  1884. Controller *ctlr;
  1885. char name[32];
  1886. ctlr = sdev->ctlr;
  1887. pcidev = ctlr->pcidev;
  1888. pcisetbme(pcidev);
  1889. snprint(name, sizeof(name), "%s (%s)", sdev->name, sdev->ifc->name);
  1890. intrenable(pcidev->intl, sd53c8xxinterrupt, ctlr, pcidev->tbdf, name);
  1891. ilock(ctlr);
  1892. synctabinit(ctlr);
  1893. cribbios(ctlr);
  1894. reset(ctlr);
  1895. iunlock(ctlr);
  1896. return 1;
  1897. }
  1898. SDifc sd53c8xxifc = {
  1899. "53c8xx", /* name */
  1900. sd53c8xxpnp, /* pnp */
  1901. nil, /* legacy */
  1902. sd53c8xxid, /* id */
  1903. sd53c8xxenable, /* enable */
  1904. nil, /* disable */
  1905. scsiverify, /* verify */
  1906. scsionline, /* online */
  1907. sd53c8xxrio, /* rio */
  1908. nil, /* rctl */
  1909. nil, /* wctl */
  1910. scsibio, /* bio */
  1911. nil, /* probe */
  1912. nil, /* clear */
  1913. nil, /* stat */
  1914. };