sd53c8xx.c 51 KB

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