![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to up.c CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [CSRG BSD Unix] / 40BSD / sys / dev|
Return to up.c CVS log | Up to [CSRG BSD Unix] / 40BSD / sys / dev |
1.1 ! root 1: /* up.c 4.3 11/13/80 */ ! 2: ! 3: #include "../conf/up.h" ! 4: #if NUP > 0 ! 5: /* ! 6: * UNIBUS disk driver with overlapped seeks and ECC recovery. ! 7: */ ! 8: #define DELAY(N) { register int d; d = N; while (--d > 0); } ! 9: ! 10: #include "../h/param.h" ! 11: #include "../h/systm.h" ! 12: #include "../h/dk.h" ! 13: #include "../h/buf.h" ! 14: #include "../h/conf.h" ! 15: #include "../h/dir.h" ! 16: #include "../h/user.h" ! 17: #include "../h/map.h" ! 18: #include "../h/pte.h" ! 19: #include "../h/mba.h" ! 20: #include "../h/mtpr.h" ! 21: #include "../h/uba.h" ! 22: #include "../h/vm.h" ! 23: ! 24: #define ushort unsigned short ! 25: ! 26: struct device ! 27: { ! 28: ushort upcs1; /* control and status register 1 */ ! 29: short upwc; /* word count register */ ! 30: ushort upba; /* UNIBUS address register */ ! 31: ushort upda; /* desired address register */ ! 32: ushort upcs2; /* control and status register 2 */ ! 33: ushort upds; /* drive Status */ ! 34: ushort uper1; /* error register 1 */ ! 35: ushort upas; /* attention summary */ ! 36: ushort upla; /* look ahead */ ! 37: ushort updb; /* data buffer */ ! 38: ushort upmr; /* maintenance */ ! 39: ushort updt; /* drive type */ ! 40: ushort upsn; /* serial number */ ! 41: ushort upof; /* offset register */ ! 42: ushort updc; /* desired cylinder address register */ ! 43: ushort upcc; /* current cylinder */ ! 44: ushort uper2; /* error register 2 */ ! 45: ushort uper3; /* error register 3 */ ! 46: ushort upec1; /* burst error bit position */ ! 47: ushort upec2; /* burst error bit pattern */ ! 48: }; ! 49: ! 50: /* ! 51: * Software extension to the upas register, so we can ! 52: * postpone starting SEARCH commands until the controller ! 53: * is not transferring. ! 54: */ ! 55: int upsoftas; ! 56: ! 57: /* ! 58: * If upseek then we don't issue SEARCH commands but rather just ! 59: * settle for a SEEK to the correct cylinder. ! 60: */ ! 61: int upseek; ! 62: ! 63: #define NSECT 32 ! 64: #define NTRAC 19 ! 65: ! 66: /* ! 67: * Constants controlling on-cylinder SEARCH usage. ! 68: * ! 69: * upSDIST/2 msec time needed to start transfer ! 70: * upRDIST/2 msec tolerable rotational latency when on-cylinder ! 71: * ! 72: * If we are no closer than upSDIST sectors and no further than upSDIST+upRDIST ! 73: * and in the driver then we take it as it is. Otherwise we do a SEARCH ! 74: * requesting an interrupt upSDIST sectors in advance. ! 75: */ ! 76: #define _upSDIST 2 /* 1.0 msec */ ! 77: #define _upRDIST 4 /* 2.0 msec */ ! 78: ! 79: int upSDIST = _upSDIST; ! 80: int upRDIST = _upRDIST; ! 81: ! 82: /* ! 83: * To fill a 300M drive: ! 84: * A is designed to be used as a root. ! 85: * B is suitable for a swap area. ! 86: * H is the primary storage area. ! 87: * On systems with RP06'es, we normally use only 291346 blocks of the H ! 88: * area, and use DEF or G to cover the rest of the drive. The C system ! 89: * covers the whole drive and can be used for pack-pack copying. ! 90: * ! 91: * Note: sizes here are for AMPEX drives with 815 cylinders. ! 92: * CDC drives can make the F,G, and H areas larger as they have 823 cylinders. ! 93: */ ! 94: struct size ! 95: { ! 96: daddr_t nblocks; ! 97: int cyloff; ! 98: } up_sizes[8] = { ! 99: 15884, 0, /* A=cyl 0 thru 26 */ ! 100: 33440, 27, /* B=cyl 27 thru 81 */ ! 101: 495520, 0, /* C=cyl 0 thru 814 */ ! 102: 15884, 562, /* D=cyl 562 thru 588 */ ! 103: 55936, 589, /* E=cyl 589 thru 680 */ ! 104: 81472, 681, /* F=cyl 681 thru 814 */ ! 105: 153824, 562, /* G=cyl 562 thru 814 */ ! 106: 291346, 82, /* H=cyl 82 thru 561 */ ! 107: }; ! 108: ! 109: /* ! 110: * The following defines are used in offset positioning ! 111: * when trying to recover disk errors, with the constants being ! 112: * +/- microinches. Note that header compare inhibit (HCI) is not ! 113: * tried (this makes sense only during read, in any case.) ! 114: * ! 115: * NB: Not all drives/controllers emulate all of these. ! 116: */ ! 117: #define P400 020 ! 118: #define M400 0220 ! 119: #define P800 040 ! 120: #define M800 0240 ! 121: #define P1200 060 ! 122: #define M1200 0260 ! 123: #define HCI 020000 ! 124: ! 125: int up_offset[16] = ! 126: { ! 127: P400, M400, P400, M400, ! 128: P800, M800, P800, M800, ! 129: P1200, M1200, P1200, M1200, ! 130: 0, 0, 0, 0, ! 131: }; ! 132: ! 133: /* ! 134: * Each drive has a table uputab[i]. On this table are sorted the ! 135: * pending requests implementing an elevator algorithm (see dsort.c.) ! 136: * In the upustart() routine, each drive is independently advanced ! 137: * until it is on the desired cylinder for the next transfer and near ! 138: * the desired sector. The drive is then chained onto the uptab ! 139: * table, and the transfer is initiated by the upstart() routine. ! 140: * When the transfer is completed the driver reinvokes the upustart() ! 141: * routine to set up the next transfer. ! 142: */ ! 143: struct buf uptab; ! 144: struct buf uputab[NUP]; ! 145: ! 146: struct buf rupbuf; /* Buffer for raw i/o */ ! 147: ! 148: /* Drive commands, placed in upcs1 */ ! 149: #define GO 01 /* Go bit, set in all commands */ ! 150: #define PRESET 020 /* Preset drive at init or after errors */ ! 151: #define OFFSET 014 /* Offset heads to try to recover error */ ! 152: #define RTC 016 /* Return to center-line after OFFSET */ ! 153: #define SEARCH 030 /* Search for cylinder+sector */ ! 154: #define SEEK 04 /* Seek to cylinder */ ! 155: #define RECAL 06 /* Recalibrate, needed after seek error */ ! 156: #define DCLR 010 /* Drive clear, after error */ ! 157: #define WCOM 060 /* Write */ ! 158: #define RCOM 070 /* Read */ ! 159: ! 160: /* Other bits of upcs1 */ ! 161: #define IE 0100 /* Controller wide interrupt enable */ ! 162: #define TRE 040000 /* Transfer error */ ! 163: #define RDY 0200 /* Transfer terminated */ ! 164: ! 165: /* Drive status bits of upds */ ! 166: #define PIP 020000 /* Positioning in progress */ ! 167: #define ERR 040000 /* Error has occurred, DCLR necessary */ ! 168: #define VV 0100 /* Volume is valid, set by PRESET */ ! 169: #define DPR 0400 /* Drive has been preset */ ! 170: #define MOL 010000 /* Drive is online, heads loaded, etc */ ! 171: #define DRY 0200 /* Drive ready */ ! 172: ! 173: /* Bits of upcs2 */ ! 174: #define CLR 040 /* Controller clear */ ! 175: /* Bits of uper1 */ ! 176: #define DCK 0100000 /* Ecc error occurred */ ! 177: #define ECH 0100 /* Ecc error was unrecoverable */ ! 178: #define WLE 04000 /* Attempt to write read-only drive */ ! 179: ! 180: /* Bits of upof; the offset bits above are also in this register */ ! 181: #define FMT22 010000 /* 16 bits/word, must be always set */ ! 182: ! 183: #define b_cylin b_resid ! 184: ! 185: int up_ubinfo; /* Information about UBA usage saved here */ ! 186: ! 187: int up_wticks; /* Ticks waiting for interrupt */ ! 188: int upwstart; /* Have started guardian */ ! 189: int upwatch(); ! 190: ! 191: #ifdef INTRLVE ! 192: daddr_t dkblock(); ! 193: #endif ! 194: ! 195: /* ! 196: * Queue an i/o request for a drive, checking first that it is in range. ! 197: * ! 198: * A unit start is issued if the drive is inactive, causing ! 199: * a SEARCH for the correct cylinder/sector. If the drive is ! 200: * already nearly on the money and the controller is not transferring ! 201: * we kick it to start the transfer. ! 202: */ ! 203: upstrategy(bp) ! 204: register struct buf *bp; ! 205: { ! 206: register struct buf *dp; ! 207: register unit, xunit; ! 208: long sz, bn; ! 209: ! 210: if (upwstart == 0) { ! 211: timeout(upwatch, (caddr_t)0, HZ); ! 212: upwstart++; ! 213: } ! 214: xunit = minor(bp->b_dev) & 077; ! 215: sz = bp->b_bcount; ! 216: sz = (sz+511) >> 9; /* transfer size in 512 byte sectors */ ! 217: unit = dkunit(bp); ! 218: if (unit >= NUP || ! 219: bp->b_blkno < 0 || ! 220: (bn = dkblock(bp))+sz > up_sizes[xunit&07].nblocks) { ! 221: bp->b_flags |= B_ERROR; ! 222: iodone(bp); ! 223: return; ! 224: } ! 225: if (DK_N+unit <= DK_NMAX) ! 226: dk_mspw[DK_N+unit] = .0000020345; ! 227: bp->b_cylin = bn/(NSECT*NTRAC) + up_sizes[xunit&07].cyloff; ! 228: dp = &uputab[unit]; ! 229: (void) spl5(); ! 230: disksort(dp, bp); ! 231: if (dp->b_active == 0) { ! 232: (void) upustart(unit); ! 233: if (uptab.b_actf && uptab.b_active == 0) ! 234: (void) upstart(); ! 235: } ! 236: (void) spl0(); ! 237: } ! 238: ! 239: /* ! 240: * Start activity on specified drive; called when drive is inactive ! 241: * and new transfer request arrives and also when upas indicates that ! 242: * a SEARCH command is complete. ! 243: */ ! 244: upustart(unit) ! 245: register unit; ! 246: { ! 247: register struct buf *bp, *dp; ! 248: register struct device *upaddr = UPADDR; ! 249: daddr_t bn; ! 250: int sn, cn, csn; ! 251: int didie = 0; ! 252: ! 253: /* ! 254: * Other drivers tend to say something like ! 255: * upaddr->upcs1 = IE; ! 256: * upaddr->upas = 1<<unit; ! 257: * here, but some controllers will cancel a command ! 258: * happens to be sitting in the cs1 if you clear the go ! 259: * bit by storing there (so the first is not safe). ! 260: * ! 261: * Thus we keep careful track of when we re-enable IE ! 262: * after an interrupt and do it only if we didn't issue ! 263: * a command which re-enabled it as a matter of course. ! 264: * We clear bits in upas in the interrupt routine, when ! 265: * no transfers are active. ! 266: */ ! 267: if (unit >= NUP) ! 268: goto out; ! 269: if (unit+DK_N <= DK_NMAX) ! 270: dk_busy &= ~(1<<(unit+DK_N)); ! 271: dp = &uputab[unit]; ! 272: if ((bp = dp->b_actf) == NULL) ! 273: goto out; ! 274: /* ! 275: * Most controllers don't start SEARCH commands when transfers are ! 276: * in progress. In fact, some tend to get confused when given ! 277: * SEARCH'es during transfers, generating interrupts with neither ! 278: * RDY nor a bit in the upas register. Thus we defer ! 279: * until an interrupt when a transfer is pending. ! 280: */ ! 281: if (uptab.b_active) { ! 282: upsoftas |= 1<<unit; ! 283: return (0); ! 284: } ! 285: if (dp->b_active) ! 286: goto done; ! 287: dp->b_active = 1; ! 288: if ((upaddr->upcs2 & 07) != unit) ! 289: upaddr->upcs2 = unit; ! 290: /* ! 291: * If we have changed packs or just initialized, ! 292: * then the volume will not be valid; if so, clear ! 293: * the drive, preset it and put in 16bit/word mode. ! 294: */ ! 295: if ((upaddr->upds & VV) == 0) { ! 296: upaddr->upcs1 = IE|DCLR|GO; ! 297: upaddr->upcs1 = IE|PRESET|GO; ! 298: upaddr->upof = FMT22; ! 299: didie = 1; ! 300: } ! 301: if ((upaddr->upds & (DPR|MOL)) != (DPR|MOL)) ! 302: goto done; ! 303: /* ! 304: * Do enough of the disk address decoding to determine ! 305: * which cylinder and sector the request is on. ! 306: * If we are on the correct cylinder and the desired sector ! 307: * lies between upSDIST and upSDIST+upRDIST sectors ahead of us, then ! 308: * we don't bother to SEARCH but just begin the transfer asap. ! 309: * Otherwise ask for a interrupt upSDIST sectors ahead. ! 310: */ ! 311: bn = dkblock(bp); ! 312: cn = bp->b_cylin; ! 313: sn = bn%(NSECT*NTRAC); ! 314: sn = (sn+NSECT-upSDIST)%NSECT; ! 315: ! 316: if (cn - upaddr->updc) ! 317: goto search; /* Not on-cylinder */ ! 318: else if (upseek) ! 319: goto done; /* Ok just to be on-cylinder */ ! 320: csn = (upaddr->upla>>6) - sn - 1; ! 321: if (csn < 0) ! 322: csn += NSECT; ! 323: if (csn > NSECT-upRDIST) ! 324: goto done; ! 325: ! 326: search: ! 327: upaddr->updc = cn; ! 328: if (upseek) ! 329: upaddr->upcs1 = IE|SEEK|GO; ! 330: else { ! 331: upaddr->upda = sn; ! 332: upaddr->upcs1 = IE|SEARCH|GO; ! 333: } ! 334: didie = 1; ! 335: /* ! 336: * Mark this unit busy. ! 337: */ ! 338: unit += DK_N; ! 339: if (unit <= DK_NMAX) { ! 340: dk_busy |= 1<<unit; ! 341: dk_seek[unit]++; ! 342: } ! 343: goto out; ! 344: ! 345: done: ! 346: /* ! 347: * This unit is ready to go so ! 348: * link it onto the chain of ready disks. ! 349: */ ! 350: dp->b_forw = NULL; ! 351: if (uptab.b_actf == NULL) ! 352: uptab.b_actf = dp; ! 353: else ! 354: uptab.b_actl->b_forw = dp; ! 355: uptab.b_actl = dp; ! 356: ! 357: out: ! 358: return (didie); ! 359: } ! 360: ! 361: /* ! 362: * Start a transfer; call from top level at spl5() or on interrupt. ! 363: */ ! 364: upstart() ! 365: { ! 366: register struct buf *bp, *dp; ! 367: register unit; ! 368: register struct device *upaddr; ! 369: daddr_t bn; ! 370: int dn, sn, tn, cn, cmd; ! 371: ! 372: loop: ! 373: /* ! 374: * Pick a drive off the queue of ready drives, and ! 375: * perform the first transfer on its queue. ! 376: * ! 377: * Looping here is completely for the sake of drives which ! 378: * are not present and on-line, for which we completely clear the ! 379: * request queue. ! 380: */ ! 381: if ((dp = uptab.b_actf) == NULL) ! 382: return (0); ! 383: if ((bp = dp->b_actf) == NULL) { ! 384: uptab.b_actf = dp->b_forw; ! 385: goto loop; ! 386: } ! 387: /* ! 388: * Mark the controller busy, and multi-part disk address. ! 389: * Select the unit on which the i/o is to take place. ! 390: */ ! 391: uptab.b_active++; ! 392: unit = minor(bp->b_dev) & 077; ! 393: dn = dkunit(bp); ! 394: bn = dkblock(bp); ! 395: cn = up_sizes[unit&07].cyloff; ! 396: cn += bn/(NSECT*NTRAC); ! 397: sn = bn%(NSECT*NTRAC); ! 398: tn = sn/NSECT; ! 399: sn %= NSECT; ! 400: upaddr = UPADDR; ! 401: if ((upaddr->upcs2 & 07) != dn) ! 402: upaddr->upcs2 = dn; ! 403: up_ubinfo = ubasetup(bp, 1); ! 404: /* ! 405: * If drive is not present and on-line, then ! 406: * get rid of this with an error and loop to get ! 407: * rid of the rest of its queued requests. ! 408: * (Then on to any other ready drives.) ! 409: */ ! 410: if ((upaddr->upds & (DPR|MOL)) != (DPR|MOL)) { ! 411: printf("!DPR || !MOL, unit %d, ds %o", dn, upaddr->upds); ! 412: if ((upaddr->upds & (DPR|MOL)) != (DPR|MOL)) { ! 413: printf("-- hard\n"); ! 414: uptab.b_active = 0; ! 415: uptab.b_errcnt = 0; ! 416: dp->b_actf = bp->av_forw; ! 417: dp->b_active = 0; ! 418: bp->b_flags |= B_ERROR; ! 419: iodone(bp); ! 420: /* A funny place to do this ... */ ! 421: ubafree(up_ubinfo), up_ubinfo = 0; ! 422: goto loop; ! 423: } ! 424: printf("-- came back\n"); ! 425: } ! 426: /* ! 427: * If this is a retry, then with the 16'th retry we ! 428: * begin to try offsetting the heads to recover the data. ! 429: */ ! 430: if (uptab.b_errcnt >= 16 && (bp->b_flags&B_WRITE) == 0) { ! 431: upaddr->upof = up_offset[uptab.b_errcnt & 017] | FMT22; ! 432: upaddr->upcs1 = IE|OFFSET|GO; ! 433: while (upaddr->upds & PIP) ! 434: DELAY(25); ! 435: } ! 436: /* ! 437: * Now set up the transfer, retrieving the high ! 438: * 2 bits of the UNIBUS address from the information ! 439: * returned by ubasetup() for the cs1 register bits 8 and 9. ! 440: */ ! 441: upaddr->updc = cn; ! 442: upaddr->upda = (tn << 8) + sn; ! 443: upaddr->upba = up_ubinfo; ! 444: upaddr->upwc = -bp->b_bcount / sizeof (short); ! 445: cmd = (up_ubinfo >> 8) & 0x300; ! 446: if (bp->b_flags & B_READ) ! 447: cmd |= IE|RCOM|GO; ! 448: else ! 449: cmd |= IE|WCOM|GO; ! 450: upaddr->upcs1 = cmd; ! 451: /* ! 452: * This is a controller busy situation. ! 453: * Record in dk slot NUP+DK_N (after last drive) ! 454: * unless there aren't that many slots reserved for ! 455: * us in which case we record this as a drive busy ! 456: * (if there is room for that). ! 457: */ ! 458: unit = dn+DK_N; ! 459: if (unit <= DK_NMAX) { ! 460: dk_busy |= 1<<unit; ! 461: dk_xfer[unit]++; ! 462: dk_wds[unit] += bp->b_bcount>>6; ! 463: } ! 464: return (1); ! 465: } ! 466: ! 467: /* ! 468: * Handle a device interrupt. ! 469: * ! 470: * If the transferring drive needs attention, service it ! 471: * retrying on error or beginning next transfer. ! 472: * Service all other ready drives, calling ustart to transfer ! 473: * their blocks to the ready queue in uptab, and then restart ! 474: * the controller if there is anything to do. ! 475: */ ! 476: upintr() ! 477: { ! 478: register struct buf *bp, *dp; ! 479: register unit; ! 480: register struct device *upaddr = UPADDR; ! 481: int as = upaddr->upas & 0377; ! 482: int oupsoftas; ! 483: int needie = 1; ! 484: ! 485: (void) spl6(); ! 486: up_wticks = 0; ! 487: if (uptab.b_active) { ! 488: /* ! 489: * The drive is transferring, thus the hardware ! 490: * (say the designers) will only interrupt when the transfer ! 491: * completes; check for it anyways. ! 492: */ ! 493: if ((upaddr->upcs1 & RDY) == 0) { ! 494: printf("!RDY: cs1 %o, ds %o, wc %d\n", upaddr->upcs1, ! 495: upaddr->upds, upaddr->upwc); ! 496: printf("as=%d act %d %d %d\n", as, uptab.b_active, ! 497: uputab[0].b_active, uputab[1].b_active); ! 498: } ! 499: /* ! 500: * Mark drive not busy, and check for an ! 501: * error condition which may have resulted from the transfer. ! 502: */ ! 503: dp = uptab.b_actf; ! 504: bp = dp->b_actf; ! 505: unit = dkunit(bp); ! 506: if (DK_N+unit <= DK_NMAX) ! 507: dk_busy &= ~(1<<(DK_N+unit)); ! 508: if ((upaddr->upcs2 & 07) != unit) ! 509: upaddr->upcs2 = unit; ! 510: if ((upaddr->upds&ERR) || (upaddr->upcs1&TRE)) { ! 511: /* ! 512: * An error occurred, indeed. Select this unit ! 513: * to get at the drive status (a SEARCH may have ! 514: * intervened to change the selected unit), and ! 515: * wait for the command which caused the interrupt ! 516: * to complete (DRY). ! 517: */ ! 518: while ((upaddr->upds & DRY) == 0) ! 519: DELAY(25); ! 520: /* ! 521: * After 28 retries (16 w/o servo offsets, and then ! 522: * 12 with servo offsets), or if we encountered ! 523: * an error because the drive is write-protected, ! 524: * give up. Print an error message on the last 2 ! 525: * retries before a hard failure. ! 526: */ ! 527: if (++uptab.b_errcnt > 28 || upaddr->uper1&WLE) ! 528: bp->b_flags |= B_ERROR; ! 529: else ! 530: uptab.b_active = 0; /* To force retry */ ! 531: if (uptab.b_errcnt > 27) ! 532: deverror(bp, (int)upaddr->upcs2, ! 533: (int)upaddr->uper1); ! 534: /* ! 535: * If this was a correctible ECC error, let upecc ! 536: * do the dirty work to correct it. If upecc ! 537: * starts another READ for the rest of the data ! 538: * then it returns 1 (having set uptab.b_active). ! 539: * Otherwise we are done and fall through to ! 540: * finish up. ! 541: */ ! 542: if ((upaddr->uper1&(DCK|ECH))==DCK && upecc(upaddr, bp)) ! 543: return; ! 544: /* ! 545: * Clear the drive and, every 4 retries, recalibrate ! 546: * to hopefully help clear up seek positioning problems. ! 547: */ ! 548: upaddr->upcs1 = TRE|IE|DCLR|GO; ! 549: needie = 0; ! 550: if ((uptab.b_errcnt&07) == 4) { ! 551: upaddr->upcs1 = RECAL|GO|IE; ! 552: while(upaddr->upds & PIP) ! 553: DELAY(25); ! 554: } ! 555: } ! 556: /* ! 557: * If we are still noted as active, then no ! 558: * (further) retries are necessary. ! 559: * ! 560: * Make sure the correct unit is selected, ! 561: * return it to centerline if necessary, and mark ! 562: * this i/o complete, starting the next transfer ! 563: * on this drive with the upustart routine (if any). ! 564: */ ! 565: if (uptab.b_active) { ! 566: if (uptab.b_errcnt >= 16) { ! 567: upaddr->upcs1 = RTC|GO|IE; ! 568: while (upaddr->upds & PIP) ! 569: DELAY(25); ! 570: needie = 0; ! 571: } ! 572: uptab.b_active = 0; ! 573: uptab.b_errcnt = 0; ! 574: uptab.b_actf = dp->b_forw; ! 575: dp->b_active = 0; ! 576: dp->b_errcnt = 0; ! 577: dp->b_actf = bp->av_forw; ! 578: bp->b_resid = (-upaddr->upwc * sizeof(short)); ! 579: if (bp->b_resid) ! 580: printf("resid %d ds %o er? %o %o %o\n", ! 581: bp->b_resid, upaddr->upds, ! 582: upaddr->uper1, upaddr->uper2, upaddr->uper3); ! 583: iodone(bp); ! 584: if(dp->b_actf) ! 585: if (upustart(unit)) ! 586: needie = 0; ! 587: } ! 588: as &= ~(1<<unit); ! 589: upsoftas &= ~(1<<unit); ! 590: ubafree(up_ubinfo), up_ubinfo = 0; ! 591: } else { ! 592: if (upaddr->upcs1 & TRE) ! 593: upaddr->upcs1 = TRE; ! 594: } ! 595: /* ! 596: * If we have a unit with an outstanding SEARCH, ! 597: * and the hardware indicates the unit requires attention, ! 598: * the bring the drive to the ready queue. ! 599: * Finally, if the controller is not transferring ! 600: * start it if any drives are now ready to transfer. ! 601: */ ! 602: as |= upsoftas; ! 603: oupsoftas = upsoftas; ! 604: upsoftas = 0; ! 605: for (unit = 0; unit < NUP; unit++) ! 606: if ((as|oupsoftas) & (1<<unit)) { ! 607: if (as & (1<<unit)) ! 608: upaddr->upas = 1<<unit; ! 609: if (upustart(unit)) ! 610: needie = 0; ! 611: } ! 612: if (uptab.b_actf && uptab.b_active == 0) ! 613: if (upstart()) ! 614: needie = 0; ! 615: if (needie) ! 616: upaddr->upcs1 = IE; ! 617: } ! 618: ! 619: upread(dev) ! 620: { ! 621: ! 622: physio(upstrategy, &rupbuf, dev, B_READ, minphys); ! 623: } ! 624: ! 625: upwrite(dev) ! 626: { ! 627: ! 628: physio(upstrategy, &rupbuf, dev, B_WRITE, minphys); ! 629: } ! 630: ! 631: /* ! 632: * Correct an ECC error, and restart the i/o to complete ! 633: * the transfer if necessary. This is quite complicated because ! 634: * the transfer may be going to an odd memory address base and/or ! 635: * across a page boundary. ! 636: */ ! 637: upecc(up, bp) ! 638: register struct device *up; ! 639: register struct buf *bp; ! 640: { ! 641: struct uba_regs *ubp = (struct uba_regs *)UBA0; ! 642: register int i; ! 643: caddr_t addr; ! 644: int reg, bit, byte, npf, mask, o, cmd, ubaddr; ! 645: int bn, cn, tn, sn; ! 646: ! 647: /* ! 648: * Npf is the number of sectors transferred before the sector ! 649: * containing the ECC error, and reg is the UBA register ! 650: * mapping (the first part of) the transfer. ! 651: * O is offset within a memory page of the first byte transferred. ! 652: */ ! 653: npf = btop((up->upwc * sizeof(short)) + bp->b_bcount) - 1; ! 654: reg = btop(up_ubinfo&0x3ffff) + npf; ! 655: o = (int)bp->b_un.b_addr & PGOFSET; ! 656: printf("%D ", bp->b_blkno+npf); ! 657: prdev("ECC", bp->b_dev); ! 658: mask = up->upec2; ! 659: if (mask == 0) { ! 660: up->upof = FMT22; /* == RTC ???? */ ! 661: return (0); ! 662: } ! 663: /* ! 664: * Flush the buffered data path, and compute the ! 665: * byte and bit position of the error. The variable i ! 666: * is the byte offset in the transfer, the variable byte ! 667: * is the offset from a page boundary in main memory. ! 668: */ ! 669: ubp->uba_dpr[(up_ubinfo>>28)&0x0f] |= BNE; ! 670: i = up->upec1 - 1; /* -1 makes 0 origin */ ! 671: bit = i&07; ! 672: i = (i&~07)>>3; ! 673: byte = i + o; ! 674: /* ! 675: * Correct while possible bits remain of mask. Since mask ! 676: * contains 11 bits, we continue while the bit offset is > -11. ! 677: * Also watch out for end of this block and the end of the whole ! 678: * transfer. ! 679: */ ! 680: while (i < 512 && (int)ptob(npf)+i < bp->b_bcount && bit > -11) { ! 681: addr = ptob(ubp->uba_map[reg+btop(byte)].pg_pfnum)+ ! 682: (byte & PGOFSET); ! 683: putmemc(addr, getmemc(addr)^(mask<<bit)); ! 684: byte++; ! 685: i++; ! 686: bit -= 8; ! 687: } ! 688: uptab.b_active++; /* Either complete or continuing... */ ! 689: if (up->upwc == 0) ! 690: return (0); ! 691: /* ! 692: * Have to continue the transfer... clear the drive, ! 693: * and compute the position where the transfer is to continue. ! 694: * We have completed npf+1 sectors of the transfer already; ! 695: * restart at offset o of next sector (i.e. in UBA register reg+1). ! 696: */ ! 697: up->upcs1 = TRE|IE|DCLR|GO; ! 698: bn = dkblock(bp); ! 699: cn = bp->b_cylin; ! 700: sn = bn%(NSECT*NTRAC) + npf + 1; ! 701: tn = sn/NSECT; ! 702: sn %= NSECT; ! 703: cn += tn/NTRAC; ! 704: tn %= NTRAC; ! 705: up->updc = cn; ! 706: up->upda = (tn << 8) | sn; ! 707: ubaddr = (int)ptob(reg+1) + o; ! 708: up->upba = ubaddr; ! 709: cmd = (ubaddr >> 8) & 0x300; ! 710: cmd |= IE|GO|RCOM; ! 711: up->upcs1 = cmd; ! 712: return (1); ! 713: } ! 714: ! 715: /* ! 716: * Reset driver after UBA init. ! 717: * Cancel software state of all pending transfers ! 718: * and restart all units and the controller. ! 719: */ ! 720: upreset() ! 721: { ! 722: int unit; ! 723: ! 724: printf(" up"); ! 725: uptab.b_active = 0; ! 726: uptab.b_actf = uptab.b_actl = 0; ! 727: if (up_ubinfo) { ! 728: printf("<%d>", (up_ubinfo>>28)&0xf); ! 729: ubafree(up_ubinfo), up_ubinfo = 0; ! 730: } ! 731: UPADDR->upcs2 = CLR; /* clear controller */ ! 732: for (unit = 0; unit < NUP; unit++) { ! 733: uputab[unit].b_active = 0; ! 734: (void) upustart(unit); ! 735: } ! 736: (void) upstart(); ! 737: } ! 738: ! 739: /* ! 740: * Wake up every second and if an interrupt is pending ! 741: * but nothing has happened increment a counter. ! 742: * If nothing happens for 20 seconds, reset the controller ! 743: * and begin anew. ! 744: */ ! 745: upwatch() ! 746: { ! 747: int i; ! 748: ! 749: timeout(upwatch, (caddr_t)0, HZ); ! 750: if (uptab.b_active == 0) { ! 751: for (i = 0; i < NUP; i++) ! 752: if (uputab[i].b_active) ! 753: goto active; ! 754: up_wticks = 0; /* idling */ ! 755: return; ! 756: } ! 757: active: ! 758: up_wticks++; ! 759: if (up_wticks >= 20) { ! 760: up_wticks = 0; ! 761: printf("LOST INTERRUPT RESET"); ! 762: upreset(); ! 763: printf("\n"); ! 764: } ! 765: } ! 766: #endif
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.