4.1cBSD/a/sys/stand/hp.new.c
/* hp.new.c 4.17 83/03/01 */
/*
* RP??/RM?? disk driver
* with ECC handling and bad block forwarding.
* Also supports header io operations and
* commands to write check header and data.
*/
#include "../h/param.h"
#include "../h/inode.h"
#include "../h/fs.h"
#include "../h/dkbad.h"
#include "../vax/pte.h"
#include "../vaxmba/hpreg.h"
#include "../vaxmba/mbareg.h"
#include "saio.h"
#include "savax.h"
#define MASKREG(reg) ((reg)&0xffff)
#define MAXBADDESC 126
#define SECTSIZ 512 /* sector size in bytes */
#define HDRSIZ 4 /* number of bytes in sector header */
#define MAXECC 5 /* max # bits allow in ecc error w/ F_ECCLM */
char hp_type[MAXNMBA*8] = { 0 };
extern struct st hpst[];
short hptypes[] = {
MBDT_RM03,
MBDT_RM05,
MBDT_RP06,
MBDT_RM80,
MBDT_RP05,
MBDT_RP07,
MBDT_ML11A,
MBDT_ML11B,
-1, /* 9755 */
-1, /* 9730 */
-1, /* Capricorn */
-1, /* Eagle */
MBDT_RM02, /* actually something else */
-1, /* 9300 */
0
};
#define RP06 (hptypes[hp_type[unit]] <= MBDT_RP06)
#define ML11 (hptypes[hp_type[unit]] == MBDT_ML11A)
#define RM80 (hptypes[hp_type[unit]] == MBDT_RM80)
u_char hp_offset[16] = {
HPOF_P400, HPOF_M400, HPOF_P400, HPOF_M400,
HPOF_P800, HPOF_M800, HPOF_P800, HPOF_M800,
HPOF_P1200, HPOF_M1200, HPOF_P1200, HPOF_M1200,
0, 0, 0, 0,
};
struct dkbad hpbad[MAXNMBA*8];
int ssect[MAXNMBA*8]; /* 1 when on track w/skip sector */
int hpdebug[MAXNMBA*8];
#define HPF_BSEDEBUG 01 /* debugging bad sector forwarding */
#define HPF_ECCDEBUG 02 /* debugging ecc correction */
int sectsiz;
/*
* When awaiting command completion, don't
* hang on to the status register since
* this ties up some controllers.
*/
#define HPWAIT(addr) \
while ((((addr)->hpds)&HPDS_DRY)==0) DELAY(500);
hpopen(io)
register struct iob *io;
{
register unit = io->i_unit;
struct hpdevice *hpaddr = (struct hpdevice *)mbadrv(unit);
register struct st *st;
mbainit(UNITTOMBA(unit));
if (hp_type[unit] == 0) {
register i, type = hpaddr->hpdt & MBDT_TYPE;
struct iob tio;
for (i = 0; hptypes[i]; i++)
if (hptypes[i] == type)
goto found;
_stop("unknown drive type");
found:
hpaddr->hpcs1 = HP_DCLR|HP_GO; /* init drive */
hpaddr->hpcs1 = HP_PRESET|HP_GO;
if (!ML11)
hpaddr->hpof = HPOF_FMT22;
hp_type[unit] = hpmaptype(hpaddr, i, unit);
/*
* Read in the bad sector table.
*/
st = &hpst[hp_type[unit]];
tio = *io;
tio.i_bn = st->nspc * st->ncyl - st->nsect;
tio.i_ma = (char *)&hpbad[unit];
tio.i_cc = sizeof (struct dkbad);
tio.i_flgs |= F_RDDATA;
for (i = 0; i < 5; i++) {
if (hpstrategy(&tio, READ) == sizeof (struct dkbad))
break;
tio.i_bn += 2;
}
if (i == 5) {
printf("Unable to read bad sector table\n");
for (i = 0; i < MAXBADDESC; i++) {
hpbad[unit].bt_bad[i].bt_cyl = -1;
hpbad[unit].bt_bad[i].bt_trksec = -1;
}
}
}
if (io->i_boff < 0 || io->i_boff > 7 ||
st->off[io->i_boff]== -1)
_stop("hp bad minor");
io->i_boff = st->off[io->i_boff] * st->nspc;
}
hpstrategy(io, func)
register struct iob *io;
{
register unit = io->i_unit;
struct mba_regs *mba = mbamba(unit);
daddr_t bn, startblock;
struct hpdevice *hpaddr = (struct hpdevice *)mbadrv(unit);
struct st *st = &hpst[hp_type[unit]];
int cn, tn, sn, bytecnt, bytesleft;
char *membase;
int er1, er2, hprecal;
sectsiz = SECTSIZ;
if ((io->i_flgs & (F_HDR|F_HCHECK)) != 0)
sectsiz += HDRSIZ;
if ((hpaddr->hpds & HPDS_VV) == 0) {
hpaddr->hpcs1 = HP_DCLR|HP_GO;
hpaddr->hpcs1 = HP_PRESET|HP_GO;
if (!ML11)
hpaddr->hpof = HPOF_FMT22;
}
io->i_errcnt = 0;
ssect[unit] = 0;
bytecnt = io->i_cc;
membase = io->i_ma;
startblock = io->i_bn;
hprecal = 0;
restart:
bn = io->i_bn;
cn = bn/st->nspc;
sn = bn%st->nspc;
tn = sn/st->nsect;
sn = sn%st->nsect + ssect[unit];
HPWAIT(hpaddr);
mba->mba_sr = -1;
if (ML11)
hpaddr->hpda = bn;
else {
hpaddr->hpdc = cn;
hpaddr->hpda = (tn << 8) + sn;
}
if (mbastart(io, func) != 0) /* start transfer */
return (-1);
HPWAIT(hpaddr);
/*
* Successful data transfer, return.
*/
if ((hpaddr->hpds&HPDS_ERR) == 0 && (mba->mba_sr&MBSR_EBITS) == 0)
return (bytecnt);
/*
* Error handling. Calculate location of error.
*/
bytesleft = MASKREG(mba->mba_bcr);
if (bytesleft)
bytesleft |= 0xffff0000; /* sxt */
bn = io->i_bn + (io->i_cc + bytesleft) / sectsiz;
cn = bn/st->nspc;
sn = bn%st->nspc;
tn = sn/st->nsect;
sn = sn%st->nsect;
er1 = MASKREG(hpaddr->hper1);
er2 = MASKREG(hpaddr->hper2);
if (hpdebug[unit] & (HPF_ECCDEBUG|HPF_BSEDEBUG)) {
printf("hp error: (cyl,trk,sec)=(%d,%d,%d) ds=%b\n",
cn, tn, sn, MASKREG(hpaddr->hpds), HPDS_BITS);
printf("er1=%b er2=%b\n", er1, HPER1_BITS, er2, HPER2_BITS);
printf("bytes left: %d, of 0x%x, da 0x%x\n",-bytesleft,
hpaddr->hpof, hpaddr->hpda);
}
if (er1 & HPER1_HCRC) {
er1 &= ~(HPER1_HCE|HPER1_FER);
er2 &= ~HPER2_BSE;
}
/*
* Give up early if drive write locked.
*/
if (er1&HPER1_WLE) {
printf("hp%d: write locked\n", unit);
return (-1);
}
/*
* Interpret format error bit as a bad block on RP06's.
*/
if (MASKREG(er1) == HPER1_FER && RP06)
goto badsect;
/*
* If a hard error, or maximum retry count
* exceeded, clear controller state and
* pass back error to caller.
*/
if (++io->i_errcnt > 27 || (er1 & HPER1_HARD) ||
(!ML11 && (er2 & HPER2_HARD))) {
if ((io->i_flgs&F_NBSF) == 0 && hpecc(io, BSE) == 0)
goto success;
hard0:
io->i_error = EHER;
if (mba->mba_sr & (MBSR_WCKUP|MBSR_WCKLWR))
io->i_error = EWCK;
hard:
io->i_errblk = bn + ssect[unit];
printf("hp error: (cyl,trk,sec)=(%d,%d,%d) ds=%b \n",
cn, tn, sn, MASKREG(hpaddr->hpds), HPDS_BITS);
printf("er1=%b er2=%b", er1, HPER1_BITS, er2, HPER2_BITS);
if (hpaddr->hpmr)
printf(" mr1=%o", MASKREG(hpaddr->hpmr));
if (hpaddr->hpmr2)
printf(" mr2=%o", MASKREG(hpaddr->hpmr2));
if (hpdebug[unit] & (HPF_BSEDEBUG|HPF_ECCDEBUG))
printf(" dc=%d, da=0x%x",MASKREG(hpaddr->hpdc),
MASKREG(hpaddr->hpda));
hpaddr->hpcs1 = HP_DCLR|HP_GO;
printf("\n");
return (-1);
}
/*
* Attempt to forward bad sectors on
* anything but an ML11. If drive
* supports skip sector handling, try to
* use it first; otherwise try the
* bad sector table.
*/
if ((er2 & HPER2_BSE) && !ML11) {
badsect:
if (!ssect[unit] && (er2&HPER2_SSE))
goto skipsect;
if (io->i_flgs & F_NBSF) {
io->i_error = EBSE;
goto hard;
}
if (hpecc(io, BSE) == 0)
goto success;
io->i_error = EBSE;
goto hard;
}
/*
* Skip sector handling.
*/
if (RM80 && (er2 & HPER2_SSE)) {
skipsect:
(void) hpecc(io, SSE);
ssect[unit] = 1;
goto success;
}
/*
* ECC correction?
*/
if ((er1 & (HPER1_DCK|HPER1_ECH)) == HPER1_DCK) {
if (hpecc(io, ECC) == 0)
goto success;
io->i_error = EECC;
return (-1);
}
if (ML11 && (io->i_errcnt >= 16))
goto hard0;
/* fall thru to retry */
hpaddr->hpcs1 = HP_DCLR|HP_GO;
HPWAIT(hpaddr);
/*
* Every fourth retry recalibrate.
*/
if (((io->i_errcnt & 07) == 4) ) {
hpaddr->hpcs1 = HP_RECAL|HP_GO;
hprecal = 1;
goto again;
}
/*
* Recalibration state machine.
*/
switch (hprecal) {
case 1:
hpaddr->hpdc = cn;
hpaddr->hpcs1 = HP_SEEK|HP_GO;
hprecal = 2;
goto again;
case 2:
if (io->i_errcnt < 16 || (io->i_flgs & F_READ) == 0)
goto donerecal;
hpaddr->hpof = hp_offset[io->i_errcnt & 017]|HPOF_FMT22;
hpaddr->hpcs1 = HP_OFFSET|HP_GO;
hprecal = 3;
goto again;
case 3:
donerecal:
hprecal = 0;
goto again;
}
if (io->i_errcnt >= 16) {
hpaddr->hpcs1 = HP_RTC|HP_GO;
while (hpaddr->hpds & HPDS_PIP)
;
}
goto again;
success:
/*
* On successful error recovery, bump
* block number to advance to next portion
* of i/o transfer.
*/
bn++;
if ((bn-startblock) * sectsiz < bytecnt) {
again:
io->i_bn = bn;
io->i_ma = membase + (io->i_bn - startblock)*sectsiz;
io->i_cc = bytecnt - (io->i_bn - startblock)*sectsiz;
if (hpdebug[unit] & (HPF_ECCDEBUG|HPF_BSEDEBUG))
printf("restart: bn=%d, cc=%d, ma=0x%x hprecal=%d\n",
io->i_bn, io->i_cc, io->i_ma, hprecal);
goto restart;
}
return (bytecnt);
}
hpecc(io, flag)
register struct iob *io;
int flag;
{
register unit = io->i_unit;
register struct mba_regs *mbp = mbamba(unit);
register struct hpdevice *rp = (struct hpdevice *)mbadrv(unit);
register struct st *st = &hpst[hp_type[unit]];
int npf, bn, cn, tn, sn, bcr;
bcr = MASKREG(mbp->mba_bcr);
if (bcr)
bcr |= 0xffff0000; /* sxt */
npf = (bcr + io->i_cc) / sectsiz; /* # sectors read */
bn = io->i_bn + npf + ssect[unit]; /* physical block #*/
if (hpdebug[unit]&HPF_ECCDEBUG)
printf("bcr=%d npf=%d ssect=%d sectsiz=%d i_cc=%d\n",
bcr, npf, ssect[unit], sectsiz, io->i_cc);
/*
* ECC correction logic.
*/
if (flag == ECC) {
register int i;
caddr_t addr;
int bit, o, mask, ecccnt = 0;
printf("hp%d: soft ecc sn%d\n", unit, bn);
mask = MASKREG(rp->hpec2);
i = MASKREG(rp->hpec1) - 1; /* -1 makes 0 origin */
bit = i&07;
o = (i & ~07) >> 3;
rp->hpcs1 = HP_DCLR | HP_GO;
while (o <sectsiz && npf*sectsiz + o < io->i_cc && bit > -11) {
addr = io->i_ma + (npf*sectsiz) + o;
/*
* No data transfer occurs with a write check,
* so don't correct the resident copy of data.
*/
if ((io->i_flgs & (F_CHECK|F_HCHECK)) == 0) {
if (hpdebug[unit] & HPF_ECCDEBUG)
printf("addr=%x old=%x ", addr,
(*addr & 0xff));
*addr ^= (mask << bit);
if (hpdebug[unit] & HPF_ECCDEBUG)
printf("new=%x\n",(*addr & 0xff));
}
o++, bit -= 8;
if ((io->i_flgs & F_ECCLM) && ecccnt++ >= MAXECC)
return (1);
}
return (0);
}
/*
* Skip sector error.
* Set skip-sector-inhibit and
* read next sector
*/
if (flag == SSE) {
rp->hpcs1 = HP_DCLR | HP_GO;
HPWAIT(rp);
rp->hpof |= HPOF_SSEI;
return (0);
}
/*
* Bad block forwarding.
*/
if (flag == BSE) {
int bbn;
rp->hpcs1 = HP_DCLR | HP_GO;
if (hpdebug[unit] & HPF_BSEDEBUG)
printf("hpecc: BSE @ bn %d\n", bn);
cn = bn/st->nspc;
sn = bn%st->nspc;
tn = sn/st->nsect;
sn = sn%st->nsect;
bcr += sectsiz;
if ((bbn = isbad(&hpbad[unit], cn, tn, sn)) < 0)
return (1);
bbn = st->ncyl*st->nspc - st->nsect - 1 - bbn;
cn = bbn/st->nspc;
sn = bbn%st->nspc;
tn = sn/st->nsect;
sn = sn%st->nsect;
io->i_cc = sectsiz;
io->i_ma += npf*sectsiz;
if (hpdebug[unit] & HPF_BSEDEBUG)
printf("revector to cn %d tn %d sn %d\n", cn, tn, sn);
rp->hpof &= ~HPOF_SSEI;
mbp->mba_sr = -1;
rp->hpdc = cn;
rp->hpda = (tn<<8) + sn;
mbastart(io,io->i_flgs);
io->i_errcnt = 0;
HPWAIT(rp);
return (rp->hpds&HPDS_ERR);
}
printf("hpecc: flag=%d\n", flag);
return (1);
}
/*ARGSUSED*/
hpioctl(io, cmd, arg)
struct iob *io;
int cmd;
caddr_t arg;
{
register unit = io->i_unit;
struct st *st = &hpst[hp_type[unit]], *tmp;
struct mba_drv *drv = mbadrv(unit);
int flag;
switch(cmd) {
case SAIODEBUG:
flag = (int)arg;
if (flag > 0)
hpdebug[unit] |= flag;
else
hpdebug[unit] &= ~flag;
return (0);
case SAIODEVDATA:
if ((drv->mbd_dt&MBDT_TAP) == 0) {
tmp = (struct st *)arg;
*tmp = *st;
return (0);
}
return (ECMD);
case SAIOSSI: /* skip-sector-inhibit */
if (drv->mbd_dt&MBDT_TAP)
return (ECMD);
if ((io->i_flgs&F_SSI) == 0) {
/* make sure this is done once only */
io->i_flgs |= F_SSI;
st->nsect++;
st->nspc += st->ntrak;
}
return (0);
case SAIONOSSI: /* remove skip-sector-inhibit */
if (io->i_flgs & F_SSI) {
io->i_flgs &= ~F_SSI;
drv->mbd_of &= ~HPOF_SSEI;
st->nsect--;
st->nspc -= st->ntrak;
}
return(0);
case SAIOSSDEV: /* drive have skip sector? */
return (RM80 ? 0 : ECMD);
}
return (ECMD);
}