+/* up.c 6.1 83/07/29 */
+
+#include "up.h"
+#if NSC > 0
+/*
+ * UNIBUS disk driver with:
+ * overlapped seeks,
+ * ECC recovery, and
+ * bad sector forwarding.
+ *
+ * TODO:
+ * Check that offset recovery code works
+ */
+#include "../machine/pte.h"
+
+#include "../h/param.h"
+#include "../h/systm.h"
+#include "../h/dk.h"
+#include "../h/dkbad.h"
+#include "../h/buf.h"
+#include "../h/conf.h"
+#include "../h/dir.h"
+#include "../h/user.h"
+#include "../h/map.h"
+#include "../h/vm.h"
+#include "../h/cmap.h"
+#include "../h/uio.h"
+#include "../h/kernel.h"
+
+#include "../vax/cpu.h"
+#include "../vax/nexus.h"
+#include "../vaxuba/ubavar.h"
+#include "../vaxuba/ubareg.h"
+#include "../vaxuba/upreg.h"
+
+struct up_softc {
+ int sc_softas;
+ int sc_ndrive;
+ int sc_wticks;
+ int sc_recal;
+} up_softc[NSC];
+
+/* THIS SHOULD BE READ OFF THE PACK, PER DRIVE */
+struct size {
+ daddr_t nblocks;
+ int cyloff;
+} up9300_sizes[8] = {
+ 15884, 0, /* A=cyl 0 thru 26 */
+ 33440, 27, /* B=cyl 27 thru 81 */
+ 495520, 0, /* C=cyl 0 thru 814 */
+ 15884, 562, /* D=cyl 562 thru 588 */
+ 55936, 589, /* E=cyl 589 thru 680 */
+ 81376, 681, /* F=cyl 681 thru 814 */
+ 153728, 562, /* G=cyl 562 thru 814 */
+ 291346, 82, /* H=cyl 82 thru 561 */
+}, up9766_sizes[8] = {
+ 15884, 0, /* A=cyl 0 thru 26 */
+ 33440, 27, /* B=cyl 27 thru 81 */
+ 500384, 0, /* C=cyl 0 thru 822 */
+ 15884, 562, /* D=cyl 562 thru 588 */
+ 55936, 589, /* E=cyl 589 thru 680 */
+ 86240, 681, /* F=cyl 681 thru 822 */
+ 158592, 562, /* G=cyl 562 thru 822 */
+ 291346, 82, /* H=cyl 82 thru 561 */
+}, up160_sizes[8] = {
+ 15884, 0, /* A=cyl 0 thru 49 */
+ 33440, 50, /* B=cyl 50 thru 154 */
+ 263360, 0, /* C=cyl 0 thru 822 */
+ 15884, 155, /* D=cyl 155 thru 204 */
+ 55936, 205, /* E=cyl 205 thru 379 */
+ 141664, 380, /* F=cyl 380 thru 822 */
+ 213664, 155, /* G=cyl 155 thru 822 */
+ 0, 0,
+}, upam_sizes[8] = {
+ 15884, 0, /* A=cyl 0 thru 31 */
+ 33440, 32, /* B=cyl 32 thru 97 */
+ 524288, 0, /* C=cyl 0 thru 1023 */
+ 15884, 668, /* D=cyl 668 thru 699 */
+ 55936, 700, /* E=cyl 700 thru 809 */
+ 109472, 810, /* F=cyl 810 thru 1023 */
+ 182176, 668, /* G=cyl 668 thru 1023 */
+ 291346, 98, /* H=cyl 98 thru 667 */
+}, up980_sizes[8] = {
+ 15884, 0, /* A=cyl 0 thru 99 */
+ 33440, 100, /* B=cyl 100 thru 308 */
+ 131680, 0, /* C=cyl 0 thru 822 */
+ 15884, 309, /* D=cyl 309 thru 408 */
+ 55936, 409, /* E=cyl 409 thru 758 */
+ 10080, 759, /* F=cyl 759 thru 822 */
+ 82080, 309, /* G=cyl 309 thru 822 */
+ 0, 0,
+};
+/* END OF STUFF WHICH SHOULD BE READ IN PER DISK */
+
+int upprobe(), upslave(), upattach(), updgo(), upintr();
+struct uba_ctlr *upminfo[NSC];
+struct uba_device *updinfo[NUP];
+#define UPIPUNITS 8
+struct uba_device *upip[NSC][UPIPUNITS]; /* fuji w/fixed head gives n,n+4 */
+
+u_short upstd[] = { 0776700, 0774400, 0776300, 0 };
+struct uba_driver scdriver =
+ { upprobe, upslave, upattach, updgo, upstd, "up", updinfo, "sc", upminfo };
+struct buf uputab[NUP];
+char upinit[NUP];
+
+struct upst {
+ short nsect; /* # sectors/track */
+ short ntrak; /* # tracks/cylinder */
+ short nspc; /* # sectors/cylinder */
+ short ncyl; /* # cylinders */
+ struct size *sizes; /* partition tables */
+ short sdist; /* seek distance metric */
+ short rdist; /* rotational distance metric */
+} upst[] = {
+ { 32, 19, 32*19, 815, up9300_sizes, 3, 4 }, /* 9300 */
+ { 32, 19, 32*19, 823, up9766_sizes, 3, 4 }, /* 9766 */
+ { 32, 10, 32*10, 823, up160_sizes, 3, 4 }, /* fuji 160m */
+ { 32, 16, 32*16, 1024, upam_sizes, 7, 8 }, /* Capricorn */
+ { 32, 5, 32*5, 823, up980_sizes, 3, 4 }, /* DM980 */
+ { 0, 0, 0, 0, 0, 0, 0 }
+};
+
+u_char up_offset[16] = {
+ UPOF_P400, UPOF_M400, UPOF_P400, UPOF_M400,
+ UPOF_P800, UPOF_M800, UPOF_P800, UPOF_M800,
+ UPOF_P1200, UPOF_M1200, UPOF_P1200, UPOF_M1200,
+ 0, 0, 0, 0
+};
+
+struct buf rupbuf[NUP];
+struct buf bupbuf[NUP];
+struct dkbad upbad[NUP];
+
+#define b_cylin b_resid
+
+#ifdef INTRLVE
+daddr_t dkblock();
+#endif
+
+int upwstart, upwatch(); /* Have started guardian */
+int upseek;
+int upwaitdry;
+
+/*ARGSUSED*/
+upprobe(reg)
+ caddr_t reg;
+{
+ register int br, cvec;
+
+#ifdef lint
+ br = 0; cvec = br; br = cvec; upintr(0);
+#endif
+ ((struct updevice *)reg)->upcs1 = UP_IE|UP_RDY;
+ DELAY(10);
+ ((struct updevice *)reg)->upcs1 = 0;
+ return (sizeof (struct updevice));
+}
+
+upslave(ui, reg)
+ struct uba_device *ui;
+ caddr_t reg;
+{
+ register struct updevice *upaddr = (struct updevice *)reg;
+
+ upaddr->upcs1 = 0; /* conservative */
+ upaddr->upcs2 = ui->ui_slave;
+ upaddr->upcs1 = UP_NOP|UP_GO;
+ if (upaddr->upcs2&UPCS2_NED) {
+ upaddr->upcs1 = UP_DCLR|UP_GO;
+ return (0);
+ }
+ return (1);
+}
+
+upattach(ui)
+ register struct uba_device *ui;
+{
+
+ if (upwstart == 0) {
+ timeout(upwatch, (caddr_t)0, hz);
+ upwstart++;
+ }
+ if (ui->ui_dk >= 0)
+ dk_mspw[ui->ui_dk] = .0000020345;
+ upip[ui->ui_ctlr][ui->ui_slave] = ui;
+ up_softc[ui->ui_ctlr].sc_ndrive++;
+ ui->ui_type = upmaptype(ui);
+}
+
+upmaptype(ui)
+ register struct uba_device *ui;
+{
+ register struct updevice *upaddr = (struct updevice *)ui->ui_addr;
+ int type = ui->ui_type;
+ register struct upst *st;
+
+ upaddr->upcs1 = 0;
+ upaddr->upcs2 = ui->ui_slave;
+ upaddr->uphr = UPHR_MAXTRAK;
+ for (st = upst; st->nsect != 0; st++)
+ if (upaddr->uphr == st->ntrak - 1) {
+ type = st - upst;
+ break;
+ }
+ if (st->nsect == 0)
+ printf("up%d: uphr=%x\n", ui->ui_slave, upaddr->uphr);
+ if (type == 0) {
+ upaddr->uphr = UPHR_MAXCYL;
+ if (upaddr->uphr == 822)
+ type++;
+ }
+ upaddr->upcs2 = UPCS2_CLR;
+ return (type);
+}
+
+upopen(dev)
+ dev_t dev;
+{
+ register int unit = minor(dev) >> 3;
+ register struct uba_device *ui;
+
+ if (unit >= NUP || (ui = updinfo[unit]) == 0 || ui->ui_alive == 0)
+ return (ENXIO);
+ return (0);
+}
+
+upstrategy(bp)
+ register struct buf *bp;
+{
+ register struct uba_device *ui;
+ register struct upst *st;
+ register int unit;
+ register struct buf *dp;
+ int xunit = minor(bp->b_dev) & 07;
+ long bn, sz;
+
+ sz = (bp->b_bcount+511) >> 9;
+ unit = dkunit(bp);
+ if (unit >= NUP)
+ goto bad;
+ ui = updinfo[unit];
+ if (ui == 0 || ui->ui_alive == 0)
+ goto bad;
+ st = &upst[ui->ui_type];
+ if (bp->b_blkno < 0 ||
+ (bn = dkblock(bp))+sz > st->sizes[xunit].nblocks)
+ goto bad;
+ bp->b_cylin = bn/st->nspc + st->sizes[xunit].cyloff;
+ (void) spl5();
+ dp = &uputab[ui->ui_unit];
+ disksort(dp, bp);
+ if (dp->b_active == 0) {
+ (void) upustart(ui);
+ bp = &ui->ui_mi->um_tab;
+ if (bp->b_actf && bp->b_active == 0)
+ (void) upstart(ui->ui_mi);
+ }
+ (void) spl0();
+ return;
+
+bad:
+ bp->b_flags |= B_ERROR;
+ iodone(bp);
+ return;
+}
+
+/*
+ * Unit start routine.
+ * Seek the drive to be where the data is
+ * and then generate another interrupt
+ * to actually start the transfer.
+ * If there is only one drive on the controller,
+ * or we are very close to the data, don't
+ * bother with the search. If called after
+ * searching once, don't bother to look where
+ * we are, just queue for transfer (to avoid
+ * positioning forever without transferrring.)
+ */
+upustart(ui)
+ register struct uba_device *ui;
+{
+ register struct buf *bp, *dp;
+ register struct uba_ctlr *um;
+ register struct updevice *upaddr;
+ register struct upst *st;
+ daddr_t bn;
+ int sn, csn;
+ /*
+ * The SC21 cancels commands if you just say
+ * cs1 = UP_IE
+ * so we are cautious about handling of cs1.
+ * Also don't bother to clear as bits other than in upintr().
+ */
+ int didie = 0;
+
+ if (ui == 0)
+ return (0);
+ um = ui->ui_mi;
+ dk_busy &= ~(1<<ui->ui_dk);
+ dp = &uputab[ui->ui_unit];
+ if ((bp = dp->b_actf) == NULL)
+ goto out;
+ /*
+ * If the controller is active, just remember
+ * that this device would like to be positioned...
+ * if we tried to position now we would confuse the SC21.
+ */
+ if (um->um_tab.b_active) {
+ up_softc[um->um_ctlr].sc_softas |= 1<<ui->ui_slave;
+ return (0);
+ }
+ /*
+ * If we have already positioned this drive,
+ * then just put it on the ready queue.
+ */
+ if (dp->b_active)
+ goto done;
+ dp->b_active = 1;
+ upaddr = (struct updevice *)um->um_addr;
+ upaddr->upcs2 = ui->ui_slave;
+ /*
+ * If drive has just come up,
+ * setup the pack.
+ */
+ if ((upaddr->upds & UPDS_VV) == 0 || upinit[ui->ui_unit] == 0) {
+ struct buf *bbp = &bupbuf[ui->ui_unit];
+
+ /* SHOULD WARN SYSTEM THAT THIS HAPPENED */
+ upinit[ui->ui_unit] = 1;
+ upaddr->upcs1 = UP_IE|UP_DCLR|UP_GO;
+ upaddr->upcs1 = UP_IE|UP_PRESET|UP_GO;
+ upaddr->upof = UPOF_FMT22;
+ didie = 1;
+ st = &upst[ui->ui_type];
+ bbp->b_flags = B_READ|B_BUSY;
+ bbp->b_dev = bp->b_dev;
+ bbp->b_bcount = 512;
+ bbp->b_un.b_addr = (caddr_t)&upbad[ui->ui_unit];
+ bbp->b_blkno = st->ncyl * st->nspc - st->nsect;
+ bbp->b_cylin = st->ncyl - 1;
+ dp->b_actf = bbp;
+ bbp->av_forw = bp;
+ bp = bbp;
+ }
+ /*
+ * If drive is offline, forget about positioning.
+ */
+ if ((upaddr->upds & (UPDS_DPR|UPDS_MOL)) != (UPDS_DPR|UPDS_MOL))
+ goto done;
+ /*
+ * If there is only one drive,
+ * dont bother searching.
+ */
+ if (up_softc[um->um_ctlr].sc_ndrive == 1)
+ goto done;
+ /*
+ * Figure out where this transfer is going to
+ * and see if we are close enough to justify not searching.
+ */
+ st = &upst[ui->ui_type];
+ bn = dkblock(bp);
+ sn = bn%st->nspc;
+ sn = (sn + st->nsect - st->sdist) % st->nsect;
+ if (bp->b_cylin - upaddr->updc)
+ goto search; /* Not on-cylinder */
+ else if (upseek)
+ goto done; /* Ok just to be on-cylinder */
+ csn = (upaddr->upla>>6) - sn - 1;
+ if (csn < 0)
+ csn += st->nsect;
+ if (csn > st->nsect - st->rdist)
+ goto done;
+search:
+ upaddr->updc = bp->b_cylin;
+ /*
+ * Not on cylinder at correct position,
+ * seek/search.
+ */
+ if (upseek)
+ upaddr->upcs1 = UP_IE|UP_SEEK|UP_GO;
+ else {
+ upaddr->upda = sn;
+ upaddr->upcs1 = UP_IE|UP_SEARCH|UP_GO;
+ }
+ didie = 1;
+ /*
+ * Mark unit busy for iostat.
+ */
+ if (ui->ui_dk >= 0) {
+ dk_busy |= 1<<ui->ui_dk;
+ dk_seek[ui->ui_dk]++;
+ }
+ goto out;
+done:
+ /*
+ * Device is ready to go.
+ * Put it on the ready queue for the controller
+ * (unless its already there.)
+ */
+ if (dp->b_active != 2) {
+ dp->b_forw = NULL;
+ if (um->um_tab.b_actf == NULL)
+ um->um_tab.b_actf = dp;
+ else
+ um->um_tab.b_actl->b_forw = dp;
+ um->um_tab.b_actl = dp;
+ dp->b_active = 2;
+ }
+out:
+ return (didie);
+}
+
+/*
+ * Start up a transfer on a drive.
+ */
+upstart(um)
+ register struct uba_ctlr *um;
+{
+ register struct buf *bp, *dp;
+ register struct uba_device *ui;
+ register struct updevice *upaddr;
+ struct upst *st;
+ daddr_t bn;
+ int dn, sn, tn, cmd, waitdry;
+
+loop:
+ /*
+ * Pull a request off the controller queue
+ */
+ if ((dp = um->um_tab.b_actf) == NULL)
+ return (0);
+ if ((bp = dp->b_actf) == NULL) {
+ um->um_tab.b_actf = dp->b_forw;
+ goto loop;
+ }
+ /*
+ * Mark controller busy, and
+ * determine destination of this request.
+ */
+ um->um_tab.b_active++;
+ ui = updinfo[dkunit(bp)];
+ bn = dkblock(bp);
+ dn = ui->ui_slave;
+ st = &upst[ui->ui_type];
+ sn = bn%st->nspc;
+ tn = sn/st->nsect;
+ sn %= st->nsect;
+ upaddr = (struct updevice *)ui->ui_addr;
+ /*
+ * Select drive if not selected already.
+ */
+ if ((upaddr->upcs2&07) != dn)
+ upaddr->upcs2 = dn;
+ /*
+ * Check that it is ready and online
+ */
+ waitdry = 0;
+ while ((upaddr->upds&UPDS_DRY) == 0) {
+ printf("up%d: ds wait ds=%o\n",dkunit(bp),upaddr->upds);
+ if (++waitdry > 512)
+ break;
+ upwaitdry++;
+ }
+ if ((upaddr->upds & UPDS_DREADY) != UPDS_DREADY) {
+ printf("up%d: not ready", dkunit(bp));
+ if ((upaddr->upds & UPDS_DREADY) != UPDS_DREADY) {
+ printf("\n");
+ um->um_tab.b_active = 0;
+ um->um_tab.b_errcnt = 0;
+ dp->b_actf = bp->av_forw;
+ dp->b_active = 0;
+ bp->b_flags |= B_ERROR;
+ iodone(bp);
+ goto loop;
+ }
+ /*
+ * Oh, well, sometimes this
+ * happens, for reasons unknown.
+ */
+ printf(" (flakey)\n");
+ }
+ /*
+ * Setup for the transfer, and get in the
+ * UNIBUS adaptor queue.
+ */
+ upaddr->updc = bp->b_cylin;
+ upaddr->upda = (tn << 8) + sn;
+ upaddr->upwc = -bp->b_bcount / sizeof (short);
+ if (bp->b_flags & B_READ)
+ cmd = UP_IE|UP_RCOM|UP_GO;
+ else
+ cmd = UP_IE|UP_WCOM|UP_GO;
+ um->um_cmd = cmd;
+ (void) ubago(ui);
+ return (1);
+}
+
+/*
+ * Now all ready to go, stuff the registers.
+ */
+updgo(um)
+ struct uba_ctlr *um;
+{
+ register struct updevice *upaddr = (struct updevice *)um->um_addr;
+
+ um->um_tab.b_active = 2; /* should now be 2 */
+ upaddr->upba = um->um_ubinfo;
+ upaddr->upcs1 = um->um_cmd|((um->um_ubinfo>>8)&0x300);
+}
+
+/*
+ * Handle a disk interrupt.
+ */
+upintr(sc21)
+ register sc21;
+{
+ register struct buf *bp, *dp;
+ register struct uba_ctlr *um = upminfo[sc21];
+ register struct uba_device *ui;
+ register struct updevice *upaddr = (struct updevice *)um->um_addr;
+ register unit;
+ struct up_softc *sc = &up_softc[um->um_ctlr];
+ int as = (upaddr->upas & 0377) | sc->sc_softas;
+ int needie = 1, waitdry;
+
+ sc->sc_wticks = 0;
+ sc->sc_softas = 0;
+ /*
+ * If controller wasn't transferring, then this is an
+ * interrupt for attention status on seeking drives.
+ * Just service them.
+ */
+ if (um->um_tab.b_active != 2 && !sc->sc_recal) {
+ if (upaddr->upcs1 & UP_TRE)
+ upaddr->upcs1 = UP_TRE;
+ goto doattn;
+ }
+ um->um_tab.b_active = 1;
+ /*
+ * Get device and block structures, and a pointer
+ * to the uba_device for the drive. Select the drive.
+ */
+ dp = um->um_tab.b_actf;
+ bp = dp->b_actf;
+ ui = updinfo[dkunit(bp)];
+ dk_busy &= ~(1 << ui->ui_dk);
+ if ((upaddr->upcs2&07) != ui->ui_slave)
+ upaddr->upcs2 = ui->ui_slave;
+ if (bp->b_flags&B_BAD) {
+ if (upecc(ui, CONT))
+ return;
+ }
+ /*
+ * Check for and process errors on
+ * either the drive or the controller.
+ */
+ if ((upaddr->upds&UPDS_ERR) || (upaddr->upcs1&UP_TRE)) {
+ waitdry = 0;
+ while ((upaddr->upds & UPDS_DRY) == 0) {
+ if (++waitdry > 512)
+ break;
+ upwaitdry++;
+ }
+ if (upaddr->uper1&UPER1_WLE) {
+ /*
+ * Give up on write locked devices
+ * immediately.
+ */
+ printf("up%d: write locked\n", dkunit(bp));
+ bp->b_flags |= B_ERROR;
+ } else if (++um->um_tab.b_errcnt > 27) {
+ /*
+ * After 28 retries (16 without offset, and
+ * 12 with offset positioning) give up.
+ * If the error was header CRC, the header is
+ * screwed up, and the sector may in fact exist
+ * in the bad sector table, better check...
+ */
+ if (upaddr->uper1&UPER1_HCRC) {
+ if (upecc(ui, BSE))
+ return;
+ }
+ hard:
+ harderr(bp, "up");
+ printf("cn=%d tn=%d sn=%d cs2=%b er1=%b er2=%b\n",
+ upaddr->updc, ((upaddr->upda)>>8)&077,
+ (upaddr->upda)&037,
+ upaddr->upcs2, UPCS2_BITS,
+ upaddr->uper1, UPER1_BITS,
+ upaddr->uper2, UPER2_BITS);
+ bp->b_flags |= B_ERROR;
+ } else if (upaddr->uper2 & UPER2_BSE) {
+ if (upecc(ui, BSE))
+ return;
+ else
+ goto hard;
+ } else {
+ /*
+ * Retriable error.
+ * If a soft ecc, correct it (continuing
+ * by returning if necessary.
+ * Otherwise fall through and retry the transfer
+ */
+ if ((upaddr->uper1&(UPER1_DCK|UPER1_ECH))==UPER1_DCK) {
+ if (upecc(ui, ECC))
+ return;
+ } else
+ um->um_tab.b_active = 0; /* force retry */
+ }
+ /*
+ * Clear drive error and, every eight attempts,
+ * (starting with the fourth)
+ * recalibrate to clear the slate.
+ */
+ upaddr->upcs1 = UP_TRE|UP_IE|UP_DCLR|UP_GO;
+ needie = 0;
+ if ((um->um_tab.b_errcnt&07) == 4 && um->um_tab.b_active == 0) {
+ upaddr->upcs1 = UP_RECAL|UP_IE|UP_GO;
+ sc->sc_recal = 0;
+ goto nextrecal;
+ }
+ }
+ /*
+ * Advance recalibration finite state machine
+ * if recalibrate in progress, through
+ * RECAL
+ * SEEK
+ * OFFSET (optional)
+ * RETRY
+ */
+ switch (sc->sc_recal) {
+
+ case 1:
+ upaddr->updc = bp->b_cylin;
+ upaddr->upcs1 = UP_SEEK|UP_IE|UP_GO;
+ goto nextrecal;
+ case 2:
+ if (um->um_tab.b_errcnt < 16 || (bp->b_flags&B_READ) == 0)
+ goto donerecal;
+ upaddr->upof = up_offset[um->um_tab.b_errcnt & 017] | UPOF_FMT22;
+ upaddr->upcs1 = UP_IE|UP_OFFSET|UP_GO;
+ goto nextrecal;
+ nextrecal:
+ sc->sc_recal++;
+ um->um_tab.b_active = 1;
+ return;
+ donerecal:
+ case 3:
+ sc->sc_recal = 0;
+ um->um_tab.b_active = 0;
+ break;
+ }
+ /*
+ * If still ``active'', then don't need any more retries.
+ */
+ if (um->um_tab.b_active) {
+ /*
+ * If we were offset positioning,
+ * return to centerline.
+ */
+ if (um->um_tab.b_errcnt >= 16) {
+ upaddr->upof = UPOF_FMT22;
+ upaddr->upcs1 = UP_RTC|UP_GO|UP_IE;
+ while (upaddr->upds & UPDS_PIP)
+ DELAY(25);
+ needie = 0;
+ }
+ um->um_tab.b_active = 0;
+ um->um_tab.b_errcnt = 0;
+ um->um_tab.b_actf = dp->b_forw;
+ dp->b_active = 0;
+ dp->b_errcnt = 0;
+ dp->b_actf = bp->av_forw;
+ bp->b_resid = (-upaddr->upwc * sizeof(short));
+ iodone(bp);
+ /*
+ * If this unit has more work to do,
+ * then start it up right away.
+ */
+ if (dp->b_actf)
+ if (upustart(ui))
+ needie = 0;
+ }
+ as &= ~(1<<ui->ui_slave);
+ /*
+ * Release unibus resources and flush data paths.
+ */
+ ubadone(um);
+doattn:
+ /*
+ * Process other units which need attention.
+ * For each unit which needs attention, call
+ * the unit start routine to place the slave
+ * on the controller device queue.
+ */
+ while (unit = ffs(as)) {
+ unit--; /* was 1 origin */
+ as &= ~(1<<unit);
+ upaddr->upas = 1<<unit;
+ if (unit < UPIPUNITS && upustart(upip[sc21][unit]))
+ needie = 0;
+ }
+ /*
+ * If the controller is not transferring, but
+ * there are devices ready to transfer, start
+ * the controller.
+ */
+ if (um->um_tab.b_actf && um->um_tab.b_active == 0)
+ if (upstart(um))
+ needie = 0;
+ if (needie)
+ upaddr->upcs1 = UP_IE;
+}
+
+upread(dev, uio)
+ dev_t dev;
+ struct uio *uio;
+{
+ register int unit = minor(dev) >> 3;
+
+ if (unit >= NUP)
+ return (ENXIO);
+ return (physio(upstrategy, &rupbuf[unit], dev, B_READ, minphys, uio));
+}
+
+upwrite(dev, uio)
+ dev_t dev;
+ struct uio *uio;
+{
+ register int unit = minor(dev) >> 3;
+
+ if (unit >= NUP)
+ return (ENXIO);
+ return (physio(upstrategy, &rupbuf[unit], dev, B_WRITE, minphys, uio));
+}
+
+/*
+ * Correct an ECC error, and restart the i/o to complete
+ * the transfer if necessary. This is quite complicated because
+ * the transfer may be going to an odd memory address base and/or
+ * across a page boundary.
+ */
+upecc(ui, flag)
+ register struct uba_device *ui;
+ int flag;
+{
+ register struct updevice *up = (struct updevice *)ui->ui_addr;
+ register struct buf *bp = uputab[ui->ui_unit].b_actf;
+ register struct uba_ctlr *um = ui->ui_mi;
+ register struct upst *st;
+ struct uba_regs *ubp = ui->ui_hd->uh_uba;
+ register int i;
+ caddr_t addr;
+ int reg, bit, byte, npf, mask, o, cmd, ubaddr;
+ int bn, cn, tn, sn;
+
+ /*
+ * Npf is the number of sectors transferred before the sector
+ * containing the ECC error, and reg is the UBA register
+ * mapping (the first part of) the transfer.
+ * O is offset within a memory page of the first byte transferred.
+ */
+ if (flag == CONT)
+ npf = bp->b_error;
+ else
+ npf = btop((up->upwc * sizeof(short)) + bp->b_bcount);
+ reg = btop(um->um_ubinfo&0x3ffff) + npf;
+ o = (int)bp->b_un.b_addr & PGOFSET;
+ mask = up->upec2;
+#ifdef UPECCDEBUG
+ printf("npf %d reg %x o %d mask %o pos %d\n", npf, reg, o, mask,
+ up->upec1);
+#endif
+ bn = dkblock(bp);
+ st = &upst[ui->ui_type];
+ cn = bp->b_cylin;
+ sn = bn%st->nspc + npf;
+ tn = sn/st->nsect;
+ sn %= st->nsect;
+ cn += tn/st->ntrak;
+ tn %= st->ntrak;
+ ubapurge(um);
+ um->um_tab.b_active=2;
+ /*
+ * action taken depends on the flag
+ */
+ switch(flag){
+ case ECC:
+ npf--;
+ reg--;
+ mask = up->upec2;
+ printf("up%d%c: soft ecc sn%d\n", dkunit(bp),
+ 'a'+(minor(bp->b_dev)&07), bp->b_blkno + npf);
+ /*
+ * Flush the buffered data path, and compute the
+ * byte and bit position of the error. The variable i
+ * is the byte offset in the transfer, the variable byte
+ * is the offset from a page boundary in main memory.
+ */
+ i = up->upec1 - 1; /* -1 makes 0 origin */
+ bit = i&07;
+ i = (i&~07)>>3;
+ byte = i + o;
+ /*
+ * Correct while possible bits remain of mask. Since mask
+ * contains 11 bits, we continue while the bit offset is > -11.
+ * Also watch out for end of this block and the end of the whole
+ * transfer.
+ */
+ while (i < 512 && (int)ptob(npf)+i < bp->b_bcount && bit > -11) {
+ struct pte pte;
+
+ pte = ubp->uba_map[reg + btop(byte)];
+ addr = ptob(pte.pg_pfnum) + (byte & PGOFSET);
+#ifdef UPECCDEBUG
+ printf("addr %x map reg %x\n",
+ addr, *(int *)(&ubp->uba_map[reg+btop(byte)]));
+ printf("old: %x, ", getmemc(addr));
+#endif
+ putmemc(addr, getmemc(addr)^(mask<<bit));
+#ifdef UPECCDEBUG
+ printf("new: %x\n", getmemc(addr));
+#endif
+ byte++;
+ i++;
+ bit -= 8;
+ }
+ if (up->upwc == 0)
+ return (0);
+ npf++;
+ reg++;
+ break;
+ case BSE:
+ /*
+ * if not in bad sector table, return 0
+ */
+ if ((bn = isbad(&upbad[ui->ui_unit], cn, tn, sn)) < 0)
+ return(0);
+ /*
+ * flag this one as bad
+ */
+ bp->b_flags |= B_BAD;
+ bp->b_error = npf + 1;
+#ifdef UPECCDEBUG
+ printf("BSE: restart at %d\n",npf+1);
+#endif
+ bn = st->ncyl * st->nspc -st->nsect - 1 - bn;
+ cn = bn / st->nspc;
+ sn = bn % st->nspc;
+ tn = sn / st->nsect;
+ sn %= st->nsect;
+ up->upwc = -(512 / sizeof (short));
+#ifdef UPECCDEBUG
+ printf("revector to cn %d tn %d sn %d\n", cn, tn, sn);
+#endif
+ break;
+ case CONT:
+#ifdef UPECCDEBUG
+ printf("upecc, CONT: bn %d cn %d tn %d sn %d\n", bn, cn, tn, sn);
+#endif
+ bp->b_flags &= ~B_BAD;
+ up->upwc = -((bp->b_bcount - (int)ptob(npf)) / sizeof(short));
+ if (up->upwc == 0)
+ return(0);
+ break;
+ }
+ if (up->upwc == 0) {
+ um->um_tab.b_active = 0;
+ return (0);
+ }
+ /*
+ * Have to continue the transfer... clear the drive,
+ * and compute the position where the transfer is to continue.
+ * We have completed npf+1 sectors of the transfer already;
+ * restart at offset o of next sector (i.e. in UBA register reg+1).
+ */
+#ifdef notdef
+ up->uper1 = 0;
+ up->upcs1 |= UP_GO;
+#else
+ up->upcs1 = UP_TRE|UP_IE|UP_DCLR|UP_GO;
+ up->updc = cn;
+ up->upda = (tn << 8) | sn;
+ ubaddr = (int)ptob(reg) + o;
+ up->upba = ubaddr;
+ cmd = (ubaddr >> 8) & 0x300;
+ cmd |= ((bp->b_flags&B_READ)?UP_RCOM:UP_WCOM)|UP_IE|UP_GO;
+ um->um_tab.b_errcnt = 0;
+ up->upcs1 = cmd;
+#endif
+ return (1);
+}
+
+/*
+ * Reset driver after UBA init.
+ * Cancel software state of all pending transfers
+ * and restart all units and the controller.
+ */
+upreset(uban)
+ int uban;
+{
+ register struct uba_ctlr *um;
+ register struct uba_device *ui;
+ register sc21, unit;
+
+ for (sc21 = 0; sc21 < NSC; sc21++) {
+ if ((um = upminfo[sc21]) == 0 || um->um_ubanum != uban ||
+ um->um_alive == 0)
+ continue;
+ printf(" sc%d", sc21);
+ um->um_tab.b_active = 0;
+ um->um_tab.b_actf = um->um_tab.b_actl = 0;
+ up_softc[sc21].sc_recal = 0;
+ up_softc[sc21].sc_wticks = 0;
+ if (um->um_ubinfo) {
+ printf("<%d>", (um->um_ubinfo>>28)&0xf);
+ um->um_ubinfo = 0;
+ }
+ ((struct updevice *)(um->um_addr))->upcs2 = UPCS2_CLR;
+ for (unit = 0; unit < NUP; unit++) {
+ if ((ui = updinfo[unit]) == 0)
+ continue;
+ if (ui->ui_alive == 0 || ui->ui_mi != um)
+ continue;
+ uputab[unit].b_active = 0;
+ (void) upustart(ui);
+ }
+ (void) upstart(um);
+ }
+}
+
+/*
+ * Wake up every second and if an interrupt is pending
+ * but nothing has happened increment a counter.
+ * If nothing happens for 20 seconds, reset the UNIBUS
+ * and begin anew.
+ */
+upwatch()
+{
+ register struct uba_ctlr *um;
+ register sc21, unit;
+ register struct up_softc *sc;
+
+ timeout(upwatch, (caddr_t)0, hz);
+ for (sc21 = 0; sc21 < NSC; sc21++) {
+ um = upminfo[sc21];
+ if (um == 0 || um->um_alive == 0)
+ continue;
+ sc = &up_softc[sc21];
+ if (um->um_tab.b_active == 0) {
+ for (unit = 0; unit < NUP; unit++)
+ if (uputab[unit].b_active &&
+ updinfo[unit]->ui_mi == um)
+ goto active;
+ sc->sc_wticks = 0;
+ continue;
+ }
+active:
+ sc->sc_wticks++;
+ if (sc->sc_wticks >= 20) {
+ sc->sc_wticks = 0;
+ printf("sc%d: lost interrupt\n", sc21);
+ ubareset(um->um_ubanum);
+ }
+ }
+}
+
+#define DBSIZE 20
+
+updump(dev)
+ dev_t dev;
+{
+ struct updevice *upaddr;
+ char *start;
+ int num, blk, unit;
+ struct size *sizes;
+ register struct uba_regs *uba;
+ register struct uba_device *ui;
+ register short *rp;
+ struct upst *st;
+ register int retry;
+
+ unit = minor(dev) >> 3;
+ if (unit >= NUP)
+ return (ENXIO);
+#define phys(cast, addr) ((cast)((int)addr & 0x7fffffff))
+ ui = phys(struct uba_device *, updinfo[unit]);
+ if (ui->ui_alive == 0)
+ return (ENXIO);
+ uba = phys(struct uba_hd *, ui->ui_hd)->uh_physuba;
+ ubainit(uba);
+ upaddr = (struct updevice *)ui->ui_physaddr;
+ DELAY(5000000);
+ num = maxfree;
+ upaddr->upcs2 = unit;
+ DELAY(100);
+ upaddr->upcs1 = UP_DCLR|UP_GO;
+ upaddr->upcs1 = UP_PRESET|UP_GO;
+ upaddr->upof = UPOF_FMT22;
+ retry = 0;
+ do {
+ DELAY(25);
+ if (++retry > 527)
+ break;
+ } while ((upaddr->upds & UP_RDY) == 0);
+ if ((upaddr->upds & UPDS_DREADY) != UPDS_DREADY)
+ return (EFAULT);
+ start = 0;
+ st = &upst[ui->ui_type];
+ sizes = phys(struct size *, st->sizes);
+ if (dumplo < 0 || dumplo + num >= sizes[minor(dev)&07].nblocks)
+ return (EINVAL);
+ while (num > 0) {
+ register struct pte *io;
+ register int i;
+ int cn, sn, tn;
+ daddr_t bn;
+
+ blk = num > DBSIZE ? DBSIZE : num;
+ io = uba->uba_map;
+ for (i = 0; i < blk; i++)
+ *(int *)io++ = (btop(start)+i) | (1<<21) | UBAMR_MRV;
+ *(int *)io = 0;
+ bn = dumplo + btop(start);
+ cn = bn/st->nspc + sizes[minor(dev)&07].cyloff;
+ sn = bn%st->nspc;
+ tn = sn/st->nsect;
+ sn = sn%st->nsect;
+ upaddr->updc = cn;
+ rp = (short *) &upaddr->upda;
+ *rp = (tn << 8) + sn;
+ *--rp = 0;
+ *--rp = -blk*NBPG / sizeof (short);
+ *--rp = UP_GO|UP_WCOM;
+ retry = 0;
+ do {
+ DELAY(25);
+ if (++retry > 527)
+ break;
+ } while ((upaddr->upcs1 & UP_RDY) == 0);
+ if ((upaddr->upds & UPDS_DREADY) != UPDS_DREADY) {
+ printf("up%d: not ready", unit);
+ if ((upaddr->upds & UPDS_DREADY) != UPDS_DREADY) {
+ printf("\n");
+ return (EIO);
+ }
+ printf(" (flakey)\n");
+ }
+ if (upaddr->upds&UPDS_ERR)
+ return (EIO);
+ start += blk*NBPG;
+ num -= blk;
+ }
+ return (0);
+}
+
+upsize(dev)
+ dev_t dev;
+{
+ int unit = minor(dev) >> 3;
+ struct uba_device *ui;
+ struct upst *st;
+
+ if (unit >= NUP || (ui = updinfo[unit]) == 0 || ui->ui_alive == 0)
+ return (-1);
+ st = &upst[ui->ui_type];
+ return (st->sizes[minor(dev) & 07].nblocks);
+}
+#endif