sd53c8xx.c 50 KB

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