17031Swnj #define RKDEBUG 27182Sroot #define RKBDEBUG 3*7731Sroot /* rk.c 4.43 82/08/13 */ 41899Swnj 51942Swnj #include "rk.h" 62648Swnj #if NHK > 0 73104Swnj int rkpip; /* DEBUG */ 83104Swnj int rknosval; /* DEBUG */ 93709Sroot #ifdef RKDEBUG 103293Swnj int rkdebug; 113709Sroot #endif 123709Sroot #ifdef RKBDEBUG 133709Sroot int rkbdebug; 143709Sroot #endif 151899Swnj /* 163293Swnj * RK611/RK0[67] disk driver 172622Swnj * 182622Swnj * This driver mimics up.c; see it for an explanation of common code. 192685Swnj * 202885Swnj * TODO: 213208Swnj * Learn why we lose an interrupt sometime when spinning drives down 221899Swnj */ 231899Swnj #include "../h/param.h" 241899Swnj #include "../h/systm.h" 251899Swnj #include "../h/buf.h" 261899Swnj #include "../h/conf.h" 271899Swnj #include "../h/dir.h" 281899Swnj #include "../h/user.h" 291899Swnj #include "../h/pte.h" 301899Swnj #include "../h/map.h" 312618Swnj #include "../h/vm.h" 322981Swnj #include "../h/ubareg.h" 332981Swnj #include "../h/ubavar.h" 341899Swnj #include "../h/dk.h" 352618Swnj #include "../h/cpu.h" 362618Swnj #include "../h/cmap.h" 373709Sroot #include "../h/dkbad.h" 38*7731Sroot #include "../h/uio.h" 391899Swnj 402618Swnj #include "../h/rkreg.h" 411899Swnj 422618Swnj struct rk_softc { 432618Swnj int sc_softas; 442618Swnj int sc_ndrive; 452618Swnj int sc_wticks; 462618Swnj int sc_recal; 472648Swnj } rk_softc[NHK]; 481899Swnj 492618Swnj /* THIS SHOULD BE READ OFF THE PACK, PER DRIVE */ 502787Swnj struct size { 512618Swnj daddr_t nblocks; 522618Swnj int cyloff; 533709Sroot } rk7_sizes[8] ={ 542618Swnj 15884, 0, /* A=cyl 0 thru 240 */ 552665Swnj 10032, 241, /* B=cyl 241 thru 392 */ 562665Swnj 53790, 0, /* C=cyl 0 thru 814 */ 572618Swnj 0, 0, 582618Swnj 0, 0, 592618Swnj 0, 0, 602618Swnj 27786, 393, /* G=cyl 393 thru 813 */ 612618Swnj 0, 0, 623709Sroot }, rk6_sizes[8] ={ 633709Sroot 15884, 0, /* A=cyl 0 thru 240 */ 643709Sroot 11154, 241, /* B=cyl 241 thru 409 */ 653709Sroot 27126, 0, /* C=cyl 0 thru 410 */ 663709Sroot 0, 0, 673709Sroot 0, 0, 683709Sroot 0, 0, 693709Sroot 0, 0, 703709Sroot 0, 0, 712618Swnj }; 722618Swnj /* END OF STUFF WHICH SHOULD BE READ IN PER DISK */ 731899Swnj 743709Sroot short rktypes[] = { RK_CDT, 0 }; 753709Sroot 762618Swnj int rkprobe(), rkslave(), rkattach(), rkdgo(), rkintr(); 772981Swnj struct uba_ctlr *rkminfo[NHK]; 782981Swnj struct uba_device *rkdinfo[NRK]; 792981Swnj struct uba_device *rkip[NHK][4]; 801899Swnj 812618Swnj u_short rkstd[] = { 0777440, 0 }; 822618Swnj struct uba_driver hkdriver = 832622Swnj { rkprobe, rkslave, rkattach, rkdgo, rkstd, "rk", rkdinfo, "hk", rkminfo, 1 }; 842648Swnj struct buf rkutab[NRK]; 852648Swnj short rkcyl[NRK]; 863727Sroot #ifndef NOBADSECT 873709Sroot struct dkbad rkbad[NRK]; 883709Sroot struct buf brkbuf[NRK]; 893709Sroot #endif 901899Swnj 912618Swnj struct rkst { 922618Swnj short nsect; 932618Swnj short ntrak; 942618Swnj short nspc; 952618Swnj short ncyl; 962618Swnj struct size *sizes; 972618Swnj } rkst[] = { 982618Swnj NRKSECT, NRKTRK, NRKSECT*NRKTRK, NRK7CYL, rk7_sizes, 993709Sroot NRKSECT, NRKTRK, NRKSECT*NRKTRK, NRK6CYL, rk6_sizes, 1002618Swnj }; 1011899Swnj 1022618Swnj u_char rk_offset[16] = 1033293Swnj { RKAS_P400,RKAS_M400,RKAS_P400,RKAS_M400,RKAS_P800,RKAS_M800,RKAS_P800, 1043293Swnj RKAS_M800,RKAS_P1200,RKAS_M1200,RKAS_P1200,RKAS_M1200,0,0,0,0 1053293Swnj }; 1061899Swnj 1072648Swnj struct buf rrkbuf[NRK]; 1082618Swnj 1092618Swnj #define b_cylin b_resid 1102618Swnj 1112618Swnj #ifdef INTRLVE 1122618Swnj daddr_t dkblock(); 1132618Swnj #endif 1142618Swnj 1152618Swnj int rkwstart, rkwatch(); 1162618Swnj 1172618Swnj rkprobe(reg) 1182618Swnj caddr_t reg; 1191899Swnj { 1202618Swnj register int br, cvec; 1211899Swnj 1222618Swnj #ifdef lint 1232618Swnj br = 0; cvec = br; br = cvec; 1244935Swnj rkintr(0); 1252618Swnj #endif 1262618Swnj ((struct rkdevice *)reg)->rkcs1 = RK_CDT|RK_IE|RK_CRDY; 1272618Swnj DELAY(10); 1282618Swnj ((struct rkdevice *)reg)->rkcs1 = RK_CDT; 1297416Skre return (sizeof (struct rkdevice)); 1302618Swnj } 1311899Swnj 1322618Swnj rkslave(ui, reg) 1332981Swnj struct uba_device *ui; 1342618Swnj caddr_t reg; 1352618Swnj { 1362618Swnj register struct rkdevice *rkaddr = (struct rkdevice *)reg; 1371899Swnj 1383709Sroot ui->ui_type = 0; 1393709Sroot rkaddr->rkcs1 = RK_CCLR; 1402618Swnj rkaddr->rkcs2 = ui->ui_slave; 1412957Swnj rkaddr->rkcs1 = RK_CDT|RK_DCLR|RK_GO; 1422622Swnj rkwait(rkaddr); 1432894Swnj DELAY(50); 1443293Swnj if (rkaddr->rkcs2&RKCS2_NED || (rkaddr->rkds&RKDS_SVAL) == 0) { 1453709Sroot rkaddr->rkcs1 = RK_CCLR; 1462618Swnj return (0); 1472618Swnj } 1483709Sroot if (rkaddr->rkcs1&RK_CERR && rkaddr->rker&RKER_DTYE) { 1493709Sroot ui->ui_type = 1; 1503709Sroot rkaddr->rkcs1 = RK_CCLR; 1513709Sroot } 1522618Swnj return (1); 1532618Swnj } 1542618Swnj 1552618Swnj rkattach(ui) 1562981Swnj register struct uba_device *ui; 1572618Swnj { 1582618Swnj 1592618Swnj if (rkwstart == 0) { 1602758Swnj timeout(rkwatch, (caddr_t)0, hz); 1612618Swnj rkwstart++; 1622618Swnj } 1632618Swnj if (ui->ui_dk >= 0) 1642758Swnj dk_mspw[ui->ui_dk] = 1.0 / (60 * NRKSECT * 256); 1652618Swnj rkip[ui->ui_ctlr][ui->ui_slave] = ui; 1662618Swnj rk_softc[ui->ui_ctlr].sc_ndrive++; 1672618Swnj rkcyl[ui->ui_unit] = -1; 1683709Sroot ui->ui_flags = 0; 1692618Swnj } 1702618Swnj 1711899Swnj rkstrategy(bp) 1722618Swnj register struct buf *bp; 1731899Swnj { 1742981Swnj register struct uba_device *ui; 1752618Swnj register struct rkst *st; 1762618Swnj register int unit; 1772618Swnj register struct buf *dp; 1782618Swnj int xunit = minor(bp->b_dev) & 07; 1792618Swnj long bn, sz; 1805433Sroot int s; 1811899Swnj 1822618Swnj sz = (bp->b_bcount+511) >> 9; 1832618Swnj unit = dkunit(bp); 1842648Swnj if (unit >= NRK) 1852618Swnj goto bad; 1862618Swnj ui = rkdinfo[unit]; 1872618Swnj if (ui == 0 || ui->ui_alive == 0) 1882618Swnj goto bad; 1892618Swnj st = &rkst[ui->ui_type]; 1902618Swnj if (bp->b_blkno < 0 || 1912618Swnj (bn = dkblock(bp))+sz > st->sizes[xunit].nblocks) 1922618Swnj goto bad; 1932618Swnj bp->b_cylin = bn/st->nspc + st->sizes[xunit].cyloff; 1945433Sroot s = spl5(); 1952618Swnj dp = &rkutab[ui->ui_unit]; 1962618Swnj disksort(dp, bp); 1972618Swnj if (dp->b_active == 0) { 1982618Swnj (void) rkustart(ui); 1992618Swnj bp = &ui->ui_mi->um_tab; 2002618Swnj if (bp->b_actf && bp->b_active == 0) 2012618Swnj (void) rkstart(ui->ui_mi); 2021899Swnj } 2035433Sroot splx(s); 2042618Swnj return; 2052618Swnj 2062618Swnj bad: 2072618Swnj bp->b_flags |= B_ERROR; 2082618Swnj iodone(bp); 2092618Swnj return; 2101899Swnj } 2111899Swnj 2122618Swnj rkustart(ui) 2132981Swnj register struct uba_device *ui; 2142618Swnj { 2152618Swnj register struct buf *bp, *dp; 2162981Swnj register struct uba_ctlr *um; 2172618Swnj register struct rkdevice *rkaddr; 2181899Swnj 2192618Swnj if (ui == 0) 2206347Swnj return; 2212618Swnj dk_busy &= ~(1<<ui->ui_dk); 2222618Swnj dp = &rkutab[ui->ui_unit]; 2232618Swnj um = ui->ui_mi; 2242894Swnj rkaddr = (struct rkdevice *)um->um_addr; 2252618Swnj if (um->um_tab.b_active) { 2262618Swnj rk_softc[um->um_ctlr].sc_softas |= 1<<ui->ui_slave; 2276347Swnj return; 2282618Swnj } 2296347Swnj if ((bp = dp->b_actf) == NULL) 2306347Swnj return; 2313709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_CERR; 2322618Swnj rkaddr->rkcs2 = ui->ui_slave; 2333709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_DCLR|RK_GO; 2342618Swnj rkwait(rkaddr); 2353709Sroot if ((rkaddr->rkds & RKDS_VV) == 0 || ui->ui_flags == 0) { 2362618Swnj /* SHOULD WARN SYSTEM THAT THIS HAPPENED */ 2373727Sroot #ifndef NOBADSECT 2383709Sroot struct rkst *st = &rkst[ui->ui_type]; 2393709Sroot struct buf *bbp = &brkbuf[ui->ui_unit]; 2403709Sroot #endif 2413709Sroot 2423709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_PACK|RK_GO; 2433709Sroot ui->ui_flags = 1; 2443727Sroot #ifndef NOBADSECT 2453709Sroot bbp->b_flags = B_READ|B_BUSY; 2463709Sroot bbp->b_dev = bp->b_dev; 2473709Sroot bbp->b_bcount = 512; 2483709Sroot bbp->b_un.b_addr = (caddr_t)&rkbad[ui->ui_unit]; 2493709Sroot bbp->b_blkno = st->ncyl*st->nspc - st->nsect; 2503709Sroot bbp->b_cylin = st->ncyl - 1; 2513709Sroot dp->b_actf = bbp; 2523709Sroot bbp->av_forw = bp; 2533709Sroot bp = bbp; 2543709Sroot #endif 2552618Swnj rkwait(rkaddr); 2562618Swnj } 2572903Swnj if (dp->b_active) 2582903Swnj goto done; 2592903Swnj dp->b_active = 1; 2603293Swnj if ((rkaddr->rkds & RKDS_DREADY) != RKDS_DREADY) 2612894Swnj goto done; 2622618Swnj if (rk_softc[um->um_ctlr].sc_ndrive == 1) 2632618Swnj goto done; 2642618Swnj if (bp->b_cylin == rkcyl[ui->ui_unit]) 2652618Swnj goto done; 2662618Swnj rkaddr->rkcyl = bp->b_cylin; 2672618Swnj rkcyl[ui->ui_unit] = bp->b_cylin; 2683709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_IE|RK_SEEK|RK_GO; 2692618Swnj if (ui->ui_dk >= 0) { 2702618Swnj dk_busy |= 1<<ui->ui_dk; 2712618Swnj dk_seek[ui->ui_dk]++; 2722618Swnj } 2732618Swnj goto out; 2742618Swnj done: 2752618Swnj if (dp->b_active != 2) { 2762618Swnj dp->b_forw = NULL; 2772618Swnj if (um->um_tab.b_actf == NULL) 2782618Swnj um->um_tab.b_actf = dp; 2792618Swnj else 2802618Swnj um->um_tab.b_actl->b_forw = dp; 2812618Swnj um->um_tab.b_actl = dp; 2822618Swnj dp->b_active = 2; 2832618Swnj } 2842618Swnj out: 2856347Swnj return; 2862618Swnj } 2872618Swnj 2882618Swnj rkstart(um) 2892981Swnj register struct uba_ctlr *um; 2901899Swnj { 2912618Swnj register struct buf *bp, *dp; 2922981Swnj register struct uba_device *ui; 2932618Swnj register struct rkdevice *rkaddr; 2942618Swnj struct rkst *st; 2951899Swnj daddr_t bn; 2962618Swnj int sn, tn, cmd; 2971899Swnj 2982618Swnj loop: 2992618Swnj if ((dp = um->um_tab.b_actf) == NULL) 3006347Swnj return; 3012618Swnj if ((bp = dp->b_actf) == NULL) { 3022618Swnj um->um_tab.b_actf = dp->b_forw; 3032618Swnj goto loop; 3041899Swnj } 3052618Swnj um->um_tab.b_active++; 3062618Swnj ui = rkdinfo[dkunit(bp)]; 3072618Swnj bn = dkblock(bp); 3082618Swnj st = &rkst[ui->ui_type]; 3092618Swnj sn = bn%st->nspc; 3102618Swnj tn = sn/st->nsect; 3112618Swnj sn %= st->nsect; 3122618Swnj rkaddr = (struct rkdevice *)ui->ui_addr; 3132957Swnj retry: 3143709Sroot rkaddr->rkcs1 = RK_CCLR; 3152618Swnj rkaddr->rkcs2 = ui->ui_slave; 3163709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_DCLR|RK_GO; 3172618Swnj rkwait(rkaddr); 3183293Swnj if ((rkaddr->rkds&RKDS_SVAL) == 0) { 3192957Swnj rknosval++; 3202957Swnj goto nosval; 3212894Swnj } 3223293Swnj if (rkaddr->rkds&RKDS_PIP) { 3232957Swnj rkpip++; 3242957Swnj goto retry; 3252957Swnj } 3263293Swnj if ((rkaddr->rkds&RKDS_DREADY) != RKDS_DREADY) { 3272927Swnj printf("rk%d: not ready", dkunit(bp)); 3283293Swnj if ((rkaddr->rkds&RKDS_DREADY) != RKDS_DREADY) { 3292894Swnj printf("\n"); 3303709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_DCLR|RK_GO; 3312894Swnj rkwait(rkaddr); 3323709Sroot rkaddr->rkcs1 = RK_CCLR; 3332894Swnj rkwait(rkaddr); 3342894Swnj um->um_tab.b_active = 0; 3352894Swnj um->um_tab.b_errcnt = 0; 3362894Swnj dp->b_actf = bp->av_forw; 3372894Swnj dp->b_active = 0; 3382894Swnj bp->b_flags |= B_ERROR; 3392894Swnj iodone(bp); 3402894Swnj goto loop; 3412894Swnj } 3422894Swnj printf(" (came back!)\n"); 3432894Swnj } 3442957Swnj nosval: 3452618Swnj rkaddr->rkcyl = bp->b_cylin; 3462618Swnj rkcyl[ui->ui_unit] = bp->b_cylin; 3472618Swnj rkaddr->rkda = (tn << 8) + sn; 3482618Swnj rkaddr->rkwc = -bp->b_bcount / sizeof (short); 3492618Swnj if (bp->b_flags & B_READ) 3503709Sroot cmd = rktypes[ui->ui_type]|RK_IE|RK_READ|RK_GO; 3512618Swnj else 3523709Sroot cmd = rktypes[ui->ui_type]|RK_IE|RK_WRITE|RK_GO; 3532618Swnj um->um_cmd = cmd; 3543104Swnj (void) ubago(ui); 3551899Swnj } 3561899Swnj 3572618Swnj rkdgo(um) 3582981Swnj register struct uba_ctlr *um; 3591899Swnj { 3602618Swnj register struct rkdevice *rkaddr = (struct rkdevice *)um->um_addr; 3611899Swnj 3627031Swnj um->um_tab.b_active = 2; /* should now be 2 */ 3632618Swnj rkaddr->rkba = um->um_ubinfo; 3642618Swnj rkaddr->rkcs1 = um->um_cmd|((um->um_ubinfo>>8)&0x300); 3652618Swnj } 3662618Swnj 3672710Swnj rkintr(rk11) 3682618Swnj int rk11; 3692618Swnj { 3702981Swnj register struct uba_ctlr *um = rkminfo[rk11]; 3712981Swnj register struct uba_device *ui; 3722618Swnj register struct rkdevice *rkaddr = (struct rkdevice *)um->um_addr; 3732618Swnj register struct buf *bp, *dp; 3742618Swnj int unit; 3752618Swnj struct rk_softc *sc = &rk_softc[um->um_ctlr]; 3762618Swnj int as = (rkaddr->rkatt >> 8) | sc->sc_softas; 3772618Swnj int needie = 1; 3782618Swnj 3792618Swnj sc->sc_wticks = 0; 3802618Swnj sc->sc_softas = 0; 3816347Swnj if (um->um_tab.b_active == 2 || sc->sc_recal) { 3827031Swnj um->um_tab.b_active = 1; 3832618Swnj dp = um->um_tab.b_actf; 3842618Swnj bp = dp->b_actf; 3852618Swnj ui = rkdinfo[dkunit(bp)]; 3862618Swnj dk_busy &= ~(1 << ui->ui_dk); 3873727Sroot #ifndef NOBADSECT 3883709Sroot if (bp->b_flags&B_BAD) 3893709Sroot if (rkecc(ui, CONT)) 3903709Sroot return; 3913709Sroot #endif 3922618Swnj if (rkaddr->rkcs1 & RK_CERR) { 3932618Swnj int recal; 3942618Swnj u_short ds = rkaddr->rkds; 3952618Swnj u_short cs2 = rkaddr->rkcs2; 3962618Swnj u_short er = rkaddr->rker; 3973709Sroot #ifdef RKDEBUG 3983293Swnj if (rkdebug) { 3993293Swnj printf("cs2=%b ds=%b er=%b\n", 4003293Swnj cs2, RKCS2_BITS, ds, 4013293Swnj RKDS_BITS, er, RKER_BITS); 4023293Swnj } 4033709Sroot #endif 4043293Swnj if (er & RKER_WLE) { 4052927Swnj printf("rk%d: write locked\n", dkunit(bp)); 4062685Swnj bp->b_flags |= B_ERROR; 4072685Swnj } else if (++um->um_tab.b_errcnt > 28 || 4082676Swnj ds&RKDS_HARD || er&RKER_HARD || cs2&RKCS2_HARD) { 4093709Sroot hard: 4102927Swnj harderr(bp, "rk"); 4112927Swnj printf("cs2=%b ds=%b er=%b\n", 4122894Swnj cs2, RKCS2_BITS, ds, 4132676Swnj RKDS_BITS, er, RKER_BITS); 4143145Swnj bp->b_flags |= B_ERROR; 4153145Swnj sc->sc_recal = 0; 4163709Sroot } else if (er & RKER_BSE) { 4173727Sroot #ifndef NOBADSECT 4183709Sroot if (rkecc(ui, BSE)) 4193709Sroot return; 4203709Sroot else 4213709Sroot #endif 4223709Sroot goto hard; 4237182Sroot } else { 4247182Sroot if ((er & (RKER_DCK|RKER_ECH)) == RKER_DCK) { 4257182Sroot if (rkecc(ui, ECC)) 4267182Sroot return; 4277182Sroot } else 4287182Sroot um->um_tab.b_active = 0; 4297182Sroot } 4303293Swnj if (cs2&RKCS2_MDS) { 4313293Swnj rkaddr->rkcs2 = RKCS2_SCLR; 4322618Swnj goto retry; 4331899Swnj } 4342618Swnj recal = 0; 4353293Swnj if (ds&RKDS_DROT || er&(RKER_OPI|RKER_SKI|RKER_UNS) || 4362618Swnj (um->um_tab.b_errcnt&07) == 4) 4372618Swnj recal = 1; 4383709Sroot rkaddr->rkcs1 = RK_CCLR; 4392618Swnj rkaddr->rkcs2 = ui->ui_slave; 4403709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_DCLR|RK_GO; 4412618Swnj rkwait(rkaddr); 4422618Swnj if (recal && um->um_tab.b_active == 0) { 4433709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_IE|RK_RECAL|RK_GO; 4442618Swnj rkcyl[ui->ui_unit] = -1; 4452957Swnj sc->sc_recal = 0; 4462957Swnj goto nextrecal; 4472618Swnj } 4481899Swnj } 4492618Swnj retry: 4502957Swnj switch (sc->sc_recal) { 4512957Swnj 4522957Swnj case 1: 4532957Swnj rkaddr->rkcyl = bp->b_cylin; 4542957Swnj rkcyl[ui->ui_unit] = bp->b_cylin; 4553709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_IE|RK_SEEK|RK_GO; 4562957Swnj goto nextrecal; 4572957Swnj case 2: 4582957Swnj if (um->um_tab.b_errcnt < 16 || 4593290Swnj (bp->b_flags&B_READ) == 0) 4603159Swnj goto donerecal; 4612957Swnj rkaddr->rkatt = rk_offset[um->um_tab.b_errcnt & 017]; 4623709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_IE|RK_OFFSET|RK_GO; 4632957Swnj /* fall into ... */ 4642957Swnj nextrecal: 4652957Swnj sc->sc_recal++; 4662957Swnj rkwait(rkaddr); 4672957Swnj um->um_tab.b_active = 1; 4682957Swnj return; 4693159Swnj donerecal: 4702957Swnj case 3: 4712618Swnj sc->sc_recal = 0; 4722618Swnj um->um_tab.b_active = 0; 4732957Swnj break; 4741899Swnj } 4753709Sroot ubadone(um); 4762618Swnj if (um->um_tab.b_active) { 4772618Swnj um->um_tab.b_active = 0; 4782618Swnj um->um_tab.b_errcnt = 0; 4792618Swnj um->um_tab.b_actf = dp->b_forw; 4802618Swnj dp->b_active = 0; 4812618Swnj dp->b_errcnt = 0; 4822618Swnj dp->b_actf = bp->av_forw; 4832618Swnj bp->b_resid = -rkaddr->rkwc * sizeof(short); 4842618Swnj iodone(bp); 4852618Swnj if (dp->b_actf) 4866347Swnj rkustart(ui); 4871899Swnj } 4882618Swnj as &= ~(1<<ui->ui_slave); 4891899Swnj } 4902618Swnj for (unit = 0; as; as >>= 1, unit++) 4912981Swnj if (as & 1) { 4922981Swnj ui = rkip[rk11][unit]; 4932981Swnj if (ui) { 4946347Swnj rkustart(rkip[rk11][unit]); 4952981Swnj } else { 4963709Sroot rkaddr->rkcs1 = RK_CCLR; 4972981Swnj rkaddr->rkcs2 = unit; 4983709Sroot rkaddr->rkcs1 = RK_DCLR|RK_GO; 4992981Swnj rkwait(rkaddr); 5003709Sroot rkaddr->rkcs1 = RK_CCLR; 5012981Swnj } 5022981Swnj } 5032618Swnj if (um->um_tab.b_actf && um->um_tab.b_active == 0) 5046347Swnj rkstart(um); 5056347Swnj if (((needie = rkaddr->rkcs1) & RK_IE) == 0) 5063709Sroot rkaddr->rkcs1 = RK_IE; 5071899Swnj } 5081899Swnj 5092618Swnj rkwait(addr) 5102618Swnj register struct rkdevice *addr; 5112618Swnj { 5121899Swnj 5132618Swnj while ((addr->rkcs1 & RK_CRDY) == 0) 5142618Swnj ; 5152618Swnj } 5162618Swnj 517*7731Sroot rkread(dev, uio) 5182618Swnj dev_t dev; 519*7731Sroot struct uio *uio; 5201899Swnj { 5212618Swnj register int unit = minor(dev) >> 3; 5222618Swnj 5232648Swnj if (unit >= NRK) 5242618Swnj u.u_error = ENXIO; 5252618Swnj else 526*7731Sroot physio(rkstrategy, &rrkbuf[unit], dev, B_READ, minphys, uio); 5271899Swnj } 5281899Swnj 5292618Swnj rkwrite(dev) 5302618Swnj dev_t dev; 5311899Swnj { 5322618Swnj register int unit = minor(dev) >> 3; 5331899Swnj 5342648Swnj if (unit >= NRK) 5352618Swnj u.u_error = ENXIO; 5362618Swnj else 537*7731Sroot physio(rkstrategy, &rrkbuf[unit], dev, B_WRITE, minphys, 0); 5381899Swnj } 5391899Swnj 5403709Sroot rkecc(ui, flag) 5412981Swnj register struct uba_device *ui; 5421899Swnj { 5432618Swnj register struct rkdevice *rk = (struct rkdevice *)ui->ui_addr; 5442618Swnj register struct buf *bp = rkutab[ui->ui_unit].b_actf; 5452981Swnj register struct uba_ctlr *um = ui->ui_mi; 5462618Swnj register struct rkst *st; 5472618Swnj struct uba_regs *ubp = ui->ui_hd->uh_uba; 5482618Swnj caddr_t addr; 5493709Sroot int reg, npf, o, cmd, ubaddr; 5502618Swnj int bn, cn, tn, sn; 5511899Swnj 5523727Sroot #ifndef NOBADSECT 5533709Sroot if (flag == CONT) 5543709Sroot npf = bp->b_error; 5553709Sroot else 5563709Sroot #endif 5573709Sroot npf = btop((rk->rkwc * sizeof(short)) + bp->b_bcount); 5582618Swnj reg = btop(um->um_ubinfo&0x3ffff) + npf; 5592618Swnj o = (int)bp->b_un.b_addr & PGOFSET; 5602618Swnj bn = dkblock(bp); 5612618Swnj st = &rkst[ui->ui_type]; 5622618Swnj cn = bp->b_cylin; 5633709Sroot sn = bn%st->nspc + npf; 5642618Swnj tn = sn/st->nsect; 5652618Swnj sn %= st->nsect; 5662618Swnj cn += tn/st->ntrak; 5672618Swnj tn %= st->ntrak; 5683709Sroot ubapurge(um); 5693709Sroot switch (flag) { 5703709Sroot case ECC: 5713709Sroot { 5723709Sroot register int i; 5733709Sroot int bit, byte, mask; 5743709Sroot 5753709Sroot npf--; 5763709Sroot reg--; 5773709Sroot printf("rk%d%c: soft ecc sn%d\n", dkunit(bp), 5783709Sroot 'a'+(minor(bp->b_dev)&07), bp->b_blkno + npf); 5793709Sroot mask = rk->rkec2; 5803709Sroot i = rk->rkec1 - 1; /* -1 makes 0 origin */ 5813709Sroot bit = i&07; 5823709Sroot i = (i&~07)>>3; 5833709Sroot byte = i + o; 5843709Sroot while (i < 512 && (int)ptob(npf)+i < bp->b_bcount && bit > -11) { 5853709Sroot addr = ptob(ubp->uba_map[reg+btop(byte)].pg_pfnum)+ 5863709Sroot (byte & PGOFSET); 5873709Sroot putmemc(addr, getmemc(addr)^(mask<<bit)); 5883709Sroot byte++; 5893709Sroot i++; 5903709Sroot bit -= 8; 5913709Sroot } 5927182Sroot if (rk->rkwc == 0) { 5937182Sroot um->um_tab.b_active = 0; 5943709Sroot return (0); 5957182Sroot } 5963709Sroot npf++; 5973709Sroot reg++; 5983709Sroot break; 5993709Sroot } 6003709Sroot 6013727Sroot #ifndef NOBADSECT 6023709Sroot case BSE: 6033709Sroot #ifdef RKBDEBUG 6043709Sroot if (rkbdebug) 6053709Sroot printf("rkecc, BSE: bn %d cn %d tn %d sn %d\n", bn, cn, tn, sn); 6063709Sroot #endif 6073709Sroot if ((bn = isbad(&rkbad[ui->ui_unit], cn, tn, sn)) < 0) 6083709Sroot return(0); 6093709Sroot bp->b_flags |= B_BAD; 6103709Sroot bp->b_error = npf + 1; 6113709Sroot bn = st->ncyl*st->nspc - st->nsect - 1 - bn; 6123709Sroot cn = bn/st->nspc; 6133709Sroot sn = bn%st->nspc; 6143709Sroot tn = sn/st->nsect; 6153709Sroot sn %= st->nsect; 6163709Sroot #ifdef RKBDEBUG 6173709Sroot if (rkbdebug) 6183709Sroot printf("revector to cn %d tn %d sn %d\n", cn, tn, sn); 6193709Sroot #endif 6203709Sroot rk->rkwc = -(512 / sizeof (short)); 6213709Sroot break; 6223709Sroot 6233709Sroot case CONT: 6243709Sroot #ifdef RKBDEBUG 6253709Sroot if (rkbdebug) 6263709Sroot printf("rkecc, CONT: bn %d cn %d tn %d sn %d\n", bn,cn,tn,sn); 6273709Sroot #endif 6283709Sroot bp->b_flags &= ~B_BAD; 6293709Sroot rk->rkwc = -((bp->b_bcount - (int)ptob(npf)) / sizeof (short)); 6307182Sroot if (rk->rkwc == 0) { 6317182Sroot um->um_tab.b_active = 0; 6327182Sroot return (0); 6337182Sroot } 6343709Sroot break; 6353709Sroot #endif 6363709Sroot } 6373709Sroot rk->rkcs1 = RK_CCLR; 6383709Sroot rk->rkcs2 = ui->ui_slave; 6393709Sroot rk->rkcs1 = rktypes[ui->ui_type]|RK_DCLR|RK_GO; 6403709Sroot rkwait(rk); 6412618Swnj rk->rkcyl = cn; 6422618Swnj rk->rkda = (tn << 8) | sn; 6433709Sroot ubaddr = (int)ptob(reg) + o; 6442618Swnj rk->rkba = ubaddr; 6453709Sroot cmd = (bp->b_flags&B_READ ? RK_READ : RK_WRITE)|RK_IE|RK_GO; 6463709Sroot cmd |= (ubaddr >> 8) & 0x300; 6473709Sroot cmd |= rktypes[ui->ui_type]; 6482618Swnj rk->rkcs1 = cmd; 6497031Swnj um->um_tab.b_active = 2; /* continuing */ 6503709Sroot um->um_tab.b_errcnt = 0; /* error has been corrected */ 6512618Swnj return (1); 6521899Swnj } 6531899Swnj 6542618Swnj rkreset(uban) 6552927Swnj int uban; 6561899Swnj { 6572981Swnj register struct uba_ctlr *um; 6582981Swnj register struct uba_device *ui; 6592618Swnj register rk11, unit; 6601899Swnj 6612648Swnj for (rk11 = 0; rk11 < NHK; rk11++) { 6622618Swnj if ((um = rkminfo[rk11]) == 0 || um->um_ubanum != uban || 6632618Swnj um->um_alive == 0) 6642618Swnj continue; 6652927Swnj printf(" hk%d", rk11); 6662618Swnj um->um_tab.b_active = 0; 6672618Swnj um->um_tab.b_actf = um->um_tab.b_actl = 0; 6682618Swnj rk_softc[um->um_ctlr].sc_recal = 0; 6696347Swnj rk_softc[um->um_ctlr].sc_wticks = 0; 6702618Swnj if (um->um_ubinfo) { 6712618Swnj printf("<%d>", (um->um_ubinfo>>28)&0xf); 6722618Swnj ubadone(um); 6732618Swnj } 6744039Swnj for (unit = 0; unit < NRK; unit++) { 6752618Swnj if ((ui = rkdinfo[unit]) == 0) 6762618Swnj continue; 6774039Swnj if (ui->ui_alive == 0 || ui->ui_mi != um) 6782618Swnj continue; 6792618Swnj rkutab[unit].b_active = 0; 6802618Swnj (void) rkustart(ui); 6812618Swnj } 6822618Swnj (void) rkstart(um); 6832618Swnj } 6841899Swnj } 6852380Swnj 6862618Swnj rkwatch() 6872380Swnj { 6882981Swnj register struct uba_ctlr *um; 6892618Swnj register rk11, unit; 6902618Swnj register struct rk_softc *sc; 6912380Swnj 6922758Swnj timeout(rkwatch, (caddr_t)0, hz); 6932648Swnj for (rk11 = 0; rk11 < NHK; rk11++) { 6942618Swnj um = rkminfo[rk11]; 6952618Swnj if (um == 0 || um->um_alive == 0) 6962618Swnj continue; 6972618Swnj sc = &rk_softc[rk11]; 6982618Swnj if (um->um_tab.b_active == 0) { 6992648Swnj for (unit = 0; unit < NRK; unit++) 7002622Swnj if (rkutab[unit].b_active && 7012622Swnj rkdinfo[unit]->ui_mi == um) 7022618Swnj goto active; 7032618Swnj sc->sc_wticks = 0; 7042618Swnj continue; 7052618Swnj } 7062618Swnj active: 7072618Swnj sc->sc_wticks++; 7082618Swnj if (sc->sc_wticks >= 20) { 7092618Swnj sc->sc_wticks = 0; 7102927Swnj printf("hk%d: lost interrupt\n", rk11); 7112648Swnj ubareset(um->um_ubanum); 7122618Swnj } 7132618Swnj } 7142380Swnj } 7152618Swnj 7162618Swnj #define DBSIZE 20 7172618Swnj 7182618Swnj rkdump(dev) 7192618Swnj dev_t dev; 7202618Swnj { 7212618Swnj struct rkdevice *rkaddr; 7222618Swnj char *start; 7232618Swnj int num, blk, unit; 7242618Swnj struct size *sizes; 7252618Swnj register struct uba_regs *uba; 7262981Swnj register struct uba_device *ui; 7272618Swnj register short *rp; 7282618Swnj struct rkst *st; 7292618Swnj 7302618Swnj unit = minor(dev) >> 3; 7312885Swnj if (unit >= NRK) 7322885Swnj return (ENXIO); 7332618Swnj #define phys(cast, addr) ((cast)((int)addr & 0x7fffffff)) 7342981Swnj ui = phys(struct uba_device *, rkdinfo[unit]); 7352885Swnj if (ui->ui_alive == 0) 7362885Swnj return (ENXIO); 7372618Swnj uba = phys(struct uba_hd *, ui->ui_hd)->uh_physuba; 7383329Swnj ubainit(uba); 7392618Swnj rkaddr = (struct rkdevice *)ui->ui_physaddr; 7402618Swnj num = maxfree; 7412618Swnj start = 0; 7423709Sroot rkaddr->rkcs1 = RK_CCLR; 7432618Swnj rkaddr->rkcs2 = unit; 7443709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_DCLR|RK_GO; 7452618Swnj rkwait(rkaddr); 7463293Swnj if ((rkaddr->rkds & RKDS_VV) == 0) { 7473709Sroot rkaddr->rkcs1 = rktypes[ui->ui_type]|RK_IE|RK_PACK|RK_GO; 7482618Swnj rkwait(rkaddr); 7492618Swnj } 7502618Swnj st = &rkst[ui->ui_type]; 7512618Swnj sizes = phys(struct size *, st->sizes); 7522885Swnj if (dumplo < 0 || dumplo + num >= sizes[minor(dev)&07].nblocks) 7532885Swnj return (EINVAL); 7542618Swnj while (num > 0) { 7552618Swnj register struct pte *io; 7562618Swnj register int i; 7572618Swnj int cn, sn, tn; 7582618Swnj daddr_t bn; 7592618Swnj 7602618Swnj blk = num > DBSIZE ? DBSIZE : num; 7612618Swnj io = uba->uba_map; 7622618Swnj for (i = 0; i < blk; i++) 7632981Swnj *(int *)io++ = (btop(start)+i) | (1<<21) | UBAMR_MRV; 7642618Swnj *(int *)io = 0; 7652618Swnj bn = dumplo + btop(start); 7662618Swnj cn = bn/st->nspc + sizes[minor(dev)&07].cyloff; 7672618Swnj sn = bn%st->nspc; 7682618Swnj tn = sn/st->nsect; 7692618Swnj sn = sn%st->nsect; 7702618Swnj rkaddr->rkcyl = cn; 7712618Swnj rp = (short *) &rkaddr->rkda; 7722618Swnj *rp = (tn << 8) + sn; 7732618Swnj *--rp = 0; 7742618Swnj *--rp = -blk*NBPG / sizeof (short); 7753709Sroot *--rp = rktypes[ui->ui_type]|RK_GO|RK_WRITE; 7762618Swnj rkwait(rkaddr); 7772885Swnj if (rkaddr->rkcs1 & RK_CERR) 7782885Swnj return (EIO); 7792618Swnj start += blk*NBPG; 7802618Swnj num -= blk; 7812618Swnj } 7822618Swnj return (0); 7832618Swnj } 7842618Swnj #endif 785