[unix-history] / usr / src / sys / vax / mba / hp.c

/*	hp.c	4.25	81/03/08	*/

#include "hp.h"
#if NHP > 0
/*
 * HP disk driver for RP0x+RM0x
 *
 * TODO:
 *	check RM80 skip sector handling, esp when ECC's occur later
 *	add reading of bad sector information and disk layout from sector 1
 *	add bad sector forwarding code
 *	check interaction with tape driver on same mba
 *	check multiple drive handling
 *	check offset recovery handling
 *	see if DCLR and/or RELEASE set attention status
 */

#include "../h/param.h"
#include "../h/systm.h"
#include "../h/dk.h"
#include "../h/buf.h"
#include "../h/conf.h"
#include "../h/dir.h"
#include "../h/user.h"
#include "../h/map.h"
#include "../h/pte.h"
#include "../h/mbareg.h"
#include "../h/mbavar.h"
#include "../h/mtpr.h"
#include "../h/vm.h"
#include "../h/cmap.h"

#include "../h/hpreg.h"

/* THIS SHOULD BE READ OFF THE PACK, PER DRIVE */
struct	size {
	daddr_t	nblocks;
	int	cyloff;
} hp_sizes[8] = {
	15884,	0,		/* A=cyl 0 thru 37 */
	33440,	38,		/* B=cyl 38 thru 117 */
	340670,	0,		/* C=cyl 0 thru 814 */
	0,	0,
	0,	0,
	0,	0,
	291346,	118,		/* G=cyl 118 thru 814 */
	0,	0,
}, rm_sizes[8] = {
	15884,	0,		/* A=cyl 0 thru 99 */
	33440,	100,		/* B=cyl 100 thru 309 */
	131680,	0,		/* C=cyl 0 thru 822 */
	2720,	291,
	0,	0,
	0,	0,
	82080,	310,		/* G=cyl 310 thru 822 */
	0,	0,
}, rm5_sizes[8] = {
	15884,	0,		/* A=cyl 0 thru 26 */
	33440,	27,		/* B=cyl 27 thru 81 */
	500992,	0,		/* C=cyl 0 thru 823 */
	15884,	562,		/* D=cyl 562 thru 588 */
	55936,	589,		/* E=cyl 589 thru 680 */
	86944,	681,		/* F=cyl 681 thru 823 */
	159296,	562,		/* G=cyl 562 thru 823 */
	291346,	82,		/* H=cyl 82 thru 561 */
}, rm80_sizes[8] = {
	15884,	0,		/* A=cyl 0 thru 36 */
	33440,	37,		/* B=cyl 37 thru 114 */
	242606,	0,		/* C=cyl 0 thru 558 */
	0,	0,
	0,	0,
	0,	0,
	82080,	115,		/* G=cyl 115 thru 304 */
	110236,	305,		/* H=cyl 305 thru 558 */
};
/* END OF STUFF WHICH SHOULD BE READ IN PER DISK */

#define	_hpSDIST	2
#define	_hpRDIST	3

int	hpSDIST = _hpSDIST;
int	hpRDIST = _hpRDIST;

short	hptypes[] =
	{ MBDT_RM03, MBDT_RM05, MBDT_RP06, MBDT_RM80, 0 };
struct	mba_device *hpinfo[NHP];
int	hpattach(),hpustart(),hpstart(),hpdtint();
struct	mba_driver hpdriver =
	{ hpattach, 0, hpustart, hpstart, hpdtint, 0,
	  hptypes, "hp", 0, hpinfo };

struct hpst {
	short	nsect;
	short	ntrak;
	short	nspc;
	short	ncyl;
	struct	size *sizes;
} hpst[] = {
	32,	5,	32*5,	823,	rm_sizes,	/* RM03 */
	32,	19,	32*19,	823,	rm5_sizes,	/* RM05 */
	22,	19,	22*19,	815,	hp_sizes,	/* RP06 */
	31,	14, 	31*14,	559,	rm80_sizes	/* 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	buf	rhpbuf[NHP];
char	hprecal[NHP];

#define	b_cylin b_resid
 
#ifdef INTRLVE
daddr_t dkblock();
#endif
 
int	hpseek;

/*ARGSUSED*/
hpattach(mi, slave)
	struct mba_device *mi;
{
	register struct hpst *st = &hpst[mi->mi_type];

	if (mi->mi_dk >= 0)
		dk_mspw[mi->mi_dk] = 1.0 / 60 / (st->nsect * 256);
}

hpstrategy(bp)
	register struct buf *bp;
{
	register struct mba_device *mi;
	register struct hpst *st;
	register int unit;
	long sz, bn;
	int xunit = minor(bp->b_dev) & 07;

	sz = bp->b_bcount;
	sz = (sz+511) >> 9;
	unit = dkunit(bp);
	if (unit >= NHP)
		goto bad;
	mi = hpinfo[unit];
	if (mi == 0 || mi->mi_alive == 0)
		goto bad;
	st = &hpst[mi->mi_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();
	disksort(&mi->mi_tab, bp);
	if (mi->mi_tab.b_active == 0)
		mbustart(mi);
	(void) spl0();
	return;

bad:
	bp->b_flags |= B_ERROR;
	iodone(bp);
	return;
}

hpustart(mi)
	register struct mba_device *mi;
{
	register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv;
	register struct buf *bp = mi->mi_tab.b_actf;
	register struct hpst *st;
	daddr_t bn;
	int sn, dist, flags;

	if ((hpaddr->hpcs1&HP_DVA) == 0)
		return (MBU_BUSY);
	if ((hpaddr->hpds & HPDS_VV) == 0) {
		hpaddr->hpcs1 = HP_DCLR|HP_GO;
		hpaddr->hpcs1 = HP_PRESET|HP_GO;
		hpaddr->hpof = HPOF_FMT22;
	}
	if (mi->mi_tab.b_active || mi->mi_hd->mh_ndrive == 1)
		return (MBU_DODATA);
	if ((hpaddr->hpds & HPDS_DREADY) != HPDS_DREADY)
		return (MBU_DODATA);
	st = &hpst[mi->mi_type];
	bn = dkblock(bp);
	sn = bn%st->nspc;
	sn = (sn+st->nsect-hpSDIST)%st->nsect;
	if (bp->b_cylin == (hpaddr->hpdc & 0xffff)) {
		if (hpseek)
			return (MBU_DODATA);
		dist = ((hpaddr->hpla & 0xffff)>>6) - st->nsect + 1;
		if (dist < 0)
			dist += st->nsect;
		if (dist > st->nsect - hpRDIST)
			return (MBU_DODATA);
	} else
		hpaddr->hpdc = bp->b_cylin;
	if (hpseek)
		hpaddr->hpcs1 = HP_SEEK|HP_GO;
	else {
		hpaddr->hpda = sn;
		hpaddr->hpcs1 = HP_SEARCH|HP_GO;
	}
	return (MBU_STARTED);
}

hpstart(mi)
	register struct mba_device *mi;
{
	register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv;
	register struct buf *bp = mi->mi_tab.b_actf;
	register struct hpst *st = &hpst[mi->mi_type];
	daddr_t bn;
	int sn, tn;

	bn = dkblock(bp);
	sn = bn%st->nspc;
	tn = sn/st->nsect;
	sn %= st->nsect;
	hpaddr->hpdc = bp->b_cylin;
	hpaddr->hpda = (tn << 8) + sn;
}

hpdtint(mi, mbasr)
	register struct mba_device *mi;
	int mbasr;
{
	register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv;
	register struct buf *bp = mi->mi_tab.b_actf;
	int retry = 0;

	if (hpaddr->hpds&HPDS_ERR || mbasr&MBAEBITS) {
		if (hpaddr->hper1&HPER1_WLE) {
			printf("hp%d: write locked\n", dkunit(bp));
			bp->b_flags |= B_ERROR;
		} else if (++mi->mi_tab.b_errcnt > 27 ||
		    mbasr & MBASR_HARD ||
		    hpaddr->hper1 & HPER1_HARD ||
		    hpaddr->hper2 & HPER2_HARD) {
			harderr(bp, "hp");
			printf("mbasr=%b er1=%b er2=%b\n",
			    mbasr, mbasr_bits,
			    hpaddr->hper1, HPER1_BITS,
			    hpaddr->hper2, HPER2_BITS);
			bp->b_flags |= B_ERROR;
#ifdef notdef
		} else if (hpaddr->hper2&HPER2_SSE) {
			hpecc(mi, 1);
			return (MBD_RESTARTED);
#endif
		} else if ((hpaddr->hper1&(HPER1_DCK|HPER1_ECH))==HPER1_DCK) {
			if (hpecc(mi, 0))
				return (MBD_RESTARTED);
			/* else done */
		} else
			retry = 1;
		hpaddr->hpcs1 = HP_DCLR|HP_GO;
		if ((mi->mi_tab.b_errcnt&07) == 4) {
			hpaddr->hpcs1 = HP_RECAL|HP_GO;
			hprecal[mi->mi_unit] = 0;
			goto nextrecal;
		}
		if (retry)
			return (MBD_RETRY);
	}
	switch (hprecal[mi->mi_unit]) {

	case 1:
		hpaddr->hpdc = bp->b_cylin;
		hpaddr->hpcs1 = HP_SEEK|HP_GO;
		goto nextrecal;
	case 2:
		if (mi->mi_tab.b_errcnt < 16 ||
		    (bp->b_flags & B_READ) != 0)
			goto donerecal;
		hpaddr->hpof = hp_offset[mi->mi_tab.b_errcnt & 017]|HPOF_FMT22;
		hpaddr->hpcs1 = HP_OFFSET|HP_GO;
		goto nextrecal;
	nextrecal:
		hprecal[mi->mi_unit]++;
		return (MBD_RESTARTED);
	donerecal:
		hprecal[mi->mi_unit] = 0;
		return (MBD_RETRY);
	}
	bp->b_resid = -(mi->mi_mba->mba_bcr) & 0xffff;
	if (mi->mi_tab.b_errcnt > 16) {
		/*
		 * This is fast and occurs rarely; we don't
		 * bother with interrupts.
		 */
		hpaddr->hpcs1 = HP_RTC|HP_GO;
		while (hpaddr->hpds & HPDS_PIP)
			;
		mbclrattn(mi);
	}
	hpaddr->hpcs1 = HP_RELEASE|HP_GO;
	return (MBD_DONE);
}

hpread(dev)
	dev_t dev;
{
	register int unit = minor(dev) >> 3;

	if (unit >= NHP)
		u.u_error = ENXIO;
	else
		physio(hpstrategy, &rhpbuf[unit], dev, B_READ, minphys);
}

hpwrite(dev)
	dev_t dev;
{
	register int unit = minor(dev) >> 3;

	if (unit >= NHP)
		u.u_error = ENXIO;
	else
		physio(hpstrategy, &rhpbuf[unit], dev, B_WRITE, minphys);
}

hpecc(mi, rm80sse)
	register struct mba_device *mi;
	int rm80sse;
{
	register struct mba_regs *mbp = mi->mi_mba;
	register struct hpdevice *rp = (struct hpdevice *)mi->mi_drv;
	register struct buf *bp = mi->mi_tab.b_actf;
	register struct hpst *st;
	register int i;
	caddr_t addr;
	int reg, bit, byte, npf, mask, o;
	int bn, cn, tn, sn;
	struct pte mpte;
	int bcr;

	bcr = mbp->mba_bcr & 0xffff;
	if (bcr)
		bcr |= 0xffff0000;		/* sxt */
	npf = btop(bcr + bp->b_bcount) - 1;
	reg = npf;
#ifdef notdef
	if (rm80sse) {
		rp->hpof |= HPOF_SSEI;
		reg--;		/* compensate in advance for reg-- below */
		goto sse;
	}
#endif
	o = (int)bp->b_un.b_addr & PGOFSET;
	printf("hp%d%c: soft ecc sn%d\n", dkunit(bp),
	    'a'+(minor(bp->b_dev)&07), bp->b_blkno + npf);
	mask = rp->hpec2&0xffff;
	i = (rp->hpec1&0xffff) - 1;		/* -1 makes 0 origin */
	bit = i&07;
	i = (i&~07)>>3;
	byte = i + o;
	while (i < 512 && (int)ptob(npf)+i < bp->b_bcount && bit > -11) {
		mpte = mbp->mba_map[reg+btop(byte)];
		addr = ptob(mpte.pg_pfnum) + (byte & PGOFSET);
		putmemc(addr, getmemc(addr)^(mask<<bit));
		byte++;
		i++;
		bit -= 8;
	}
	if (bcr == 0)
		return (0);
#ifdef notdef
sse:
	if (rpof&HPOF_SSEI)
		rp->hpda = rp->hpda + 1;
	rp->hper1 = 0;
	rp->hpcs1 = HP_RCOM|HP_GO;
#else
sse:
	rp->hpcs1 = HP_DCLR|HP_GO;
	bn = dkblock(bp);
	st = &hpst[mi->mi_type];
	cn = bp->b_cylin;
	sn = bn%(st->nspc) + npf + 1;
	tn = sn/st->nsect;
	sn %= st->nsect;
	cn += tn/st->ntrak;
	tn %= st->ntrak;
#ifdef notdef
	if (rp->hpof&SSEI)
		sn++;
#endif
	rp->hpdc = cn;
	rp->hpda = (tn<<8) + sn;
	mbp->mba_sr = -1;
	mbp->mba_var = (int)ptob(reg+1) + o;
	rp->hpcs1 = HP_RCOM|HP_GO;
#endif
	return (1);
}

#define	DBSIZE	20

hpdump(dev)
	dev_t dev;
{
	register struct mba_device *mi;
	register struct mba_regs *mba;
	struct hpdevice *hpaddr;
	char *start;
	int num, unit;
	register struct hpst *st;

	num = maxfree;
	start = 0;
	unit = minor(dev) >> 3;
	if (unit >= NHP)
		return (ENXIO);
#define	phys(a,b)	((b)((int)(a)&0x7fffffff))
	mi = phys(hpinfo[unit],struct mba_device *);
	if (mi == 0 || mi->mi_alive == 0)
		return (ENXIO);
	mba = phys(mi->mi_hd, struct mba_hd *)->mh_physmba;
	mba->mba_cr = MBAINIT;
	hpaddr = (struct hpdevice *)&mba->mba_drv[mi->mi_drive];
	if ((hpaddr->hpds & HPDS_VV) == 0) {
		hpaddr->hpcs1 = HP_DCLR|HP_GO;
		hpaddr->hpcs1 = HP_PRESET|HP_GO;
		hpaddr->hpof = HPOF_FMT22;
	}
	st = &hpst[mi->mi_type];
	if (dumplo < 0 || dumplo + num >= st->sizes[minor(dev)&07].nblocks)
		return (EINVAL);
	while (num > 0) {
		register struct pte *hpte = mba->mba_map;
		register int i;
		int blk, cn, sn, tn;
		daddr_t bn;

		blk = num > DBSIZE ? DBSIZE : num;
		bn = dumplo + btop(start);
		cn = bn/st->nspc + st->sizes[minor(dev)&07].cyloff;
		sn = bn%st->nspc;
		tn = sn/st->nsect;
		sn = sn%st->nsect;
		hpaddr->hpdc = cn;
		hpaddr->hpda = (tn << 8) + sn;
		for (i = 0; i < blk; i++)
			*(int *)hpte++ = (btop(start)+i) | PG_V;
		mba->mba_sr = -1;
		mba->mba_bcr = -(blk*NBPG);
		mba->mba_var = 0;
		hpaddr->hpcs1 = HP_WCOM | HP_GO;
		while ((hpaddr->hpds & HPDS_DRY) == 0)
			;
		if (hpaddr->hpds&HPDS_ERR)
			return (EIO);
		start += blk*NBPG;
		num -= blk;
	}
	return (0);
}
#endif
Commit	Line	Data
d565635a	1	/* hp.c 4.25 81/03/08 */
04b9d53d	2
66b4fb09	3	#include "hp.h"
a5cc519e	4	#if NHP > 0
04b9d53d	5	/*
804f6eab	6	* HP disk driver for RP0x+RM0x
1b81ee79 BJ	7	*
1b81ee79 BJ	8	* TODO:
d565635a BJ	9	* check RM80 skip sector handling, esp when ECC's occur later
	10	* add reading of bad sector information and disk layout from sector 1
	11	* add bad sector forwarding code
	12	* check interaction with tape driver on same mba
	13	* check multiple drive handling
	14	* check offset recovery handling
	15	* see if DCLR and/or RELEASE set attention status
04b9d53d BJ	16	*/
	17
	18	#include "../h/param.h"
	19	#include "../h/systm.h"
41888f16	20	#include "../h/dk.h"
04b9d53d BJ	21	#include "../h/buf.h"
	22	#include "../h/conf.h"
	23	#include "../h/dir.h"
	24	#include "../h/user.h"
	25	#include "../h/map.h"
80e7c811	26	#include "../h/pte.h"
4a4e3072 BJ	27	#include "../h/mbareg.h"
4a4e3072 BJ	28	#include "../h/mbavar.h"
04b9d53d	29	#include "../h/mtpr.h"
80e7c811	30	#include "../h/vm.h"
e3b4b145	31	#include "../h/cmap.h"
04b9d53d	32
b81fd3e8	33	#include "../h/hpreg.h"
04b9d53d	34
b81fd3e8 BJ	35	/* THIS SHOULD BE READ OFF THE PACK, PER DRIVE */
b81fd3e8 BJ	36	struct size {
04b9d53d BJ	37	daddr_t nblocks;
04b9d53d BJ	38	int cyloff;
b81fd3e8	39	} hp_sizes[8] = {
5c777efe BJ	40	15884, 0, /* A=cyl 0 thru 37 */
	41	33440, 38, /* B=cyl 38 thru 117 */
	42	340670, 0, /* C=cyl 0 thru 814 */
04b9d53d	43	0, 0,
04b9d53d BJ	44	0, 0,
04b9d53d BJ	45	0, 0,
5c777efe	46	291346, 118, /* G=cyl 118 thru 814 */
04b9d53d	47	0, 0,
04b9d53d	48	}, rm_sizes[8] = {
5c777efe BJ	49	15884, 0, /* A=cyl 0 thru 99 */
	50	33440, 100, /* B=cyl 100 thru 309 */
	51	131680, 0, /* C=cyl 0 thru 822 */
e3b4b145	52	2720, 291,
04b9d53d BJ	53	0, 0,
04b9d53d BJ	54	0, 0,
5c777efe	55	82080, 310, /* G=cyl 310 thru 822 */
04b9d53d	56	0, 0,
5c777efe BJ	57	}, rm5_sizes[8] = {
	58	15884, 0, /* A=cyl 0 thru 26 */
	59	33440, 27, /* B=cyl 27 thru 81 */
	60	500992, 0, /* C=cyl 0 thru 823 */
	61	15884, 562, /* D=cyl 562 thru 588 */
	62	55936, 589, /* E=cyl 589 thru 680 */
	63	86944, 681, /* F=cyl 681 thru 823 */
	64	159296, 562, /* G=cyl 562 thru 823 */
	65	291346, 82, /* H=cyl 82 thru 561 */
b81fd3e8 BJ	66	}, rm80_sizes[8] = {
	67	15884, 0, /* A=cyl 0 thru 36 */
	68	33440, 37, /* B=cyl 37 thru 114 */
	69	242606, 0, /* C=cyl 0 thru 558 */
	70	0, 0,
	71	0, 0,
	72	0, 0,
	73	82080, 115, /* G=cyl 115 thru 304 */
	74	110236, 305, /* H=cyl 305 thru 558 */
04b9d53d	75	};
b81fd3e8	76	/* END OF STUFF WHICH SHOULD BE READ IN PER DISK */
04b9d53d	77
b81fd3e8 BJ	78	#define _hpSDIST 2
	79	#define _hpRDIST 3
	80
	81	int hpSDIST = _hpSDIST;
	82	int hpRDIST = _hpRDIST;
	83
	84	short hptypes[] =
	85	{ MBDT_RM03, MBDT_RM05, MBDT_RP06, MBDT_RM80, 0 };
4a4e3072 BJ	86	struct mba_device *hpinfo[NHP];
4a4e3072 BJ	87	int hpattach(),hpustart(),hpstart(),hpdtint();
b81fd3e8	88	struct mba_driver hpdriver =
4a4e3072 BJ	89	{ hpattach, 0, hpustart, hpstart, hpdtint, 0,
4a4e3072 BJ	90	hptypes, "hp", 0, hpinfo };
b81fd3e8 BJ	91
	92	struct hpst {
	93	short nsect;
	94	short ntrak;
	95	short nspc;
	96	short ncyl;
	97	struct size *sizes;
	98	} hpst[] = {
	99	32, 5, 325, 823, rm_sizes, / RM03 */
	100	32, 19, 3219, 823, rm5_sizes, / RM05 */
	101	22, 19, 2219, 815, hp_sizes, / RP06 */
	102	31, 14, 3114, 559, rm80_sizes / RM80 */
	103	};
	104
804f6eab	105	u_char hp_offset[16] = {
d565635a BJ	106	HPOF_P400, HPOF_M400, HPOF_P400, HPOF_M400,
	107	HPOF_P800, HPOF_M800, HPOF_P800, HPOF_M800,
	108	HPOF_P1200, HPOF_M1200, HPOF_P1200, HPOF_M1200,
	109	0, 0, 0, 0,
04b9d53d BJ	110	};
04b9d53d BJ	111
804f6eab	112	struct buf rhpbuf[NHP];
3dbaa9da	113	char hprecal[NHP];
04b9d53d BJ	114
	115	#define b_cylin b_resid
	116
	117	#ifdef INTRLVE
	118	daddr_t dkblock();
	119	#endif
	120
71236e46 BJ	121	int hpseek;
71236e46 BJ	122
4a4e3072 BJ	123	/ARGSUSED/
	124	hpattach(mi, slave)
	125	struct mba_device *mi;
71236e46 BJ	126	{
	127	register struct hpst *st = &hpst[mi->mi_type];
	128
	129	if (mi->mi_dk >= 0)
7780575a	130	dk_mspw[mi->mi_dk] = 1.0 / 60 / (st->nsect * 256);
71236e46 BJ	131	}
71236e46 BJ	132
04b9d53d	133	hpstrategy(bp)
b81fd3e8	134	register struct buf *bp;
04b9d53d	135	{
4a4e3072	136	register struct mba_device *mi;
b81fd3e8 BJ	137	register struct hpst *st;
b81fd3e8 BJ	138	register int unit;
04b9d53d	139	long sz, bn;
b81fd3e8	140	int xunit = minor(bp->b_dev) & 07;
04b9d53d	141
04b9d53d BJ	142	sz = bp->b_bcount;
	143	sz = (sz+511) >> 9;
	144	unit = dkunit(bp);
b81fd3e8 BJ	145	if (unit >= NHP)
	146	goto bad;
	147	mi = hpinfo[unit];
3f3a34c3	148	if (mi == 0 \|\| mi->mi_alive == 0)
b81fd3e8 BJ	149	goto bad;
	150	st = &hpst[mi->mi_type];
	151	if (bp->b_blkno < 0 \|\|
	152	(bn = dkblock(bp))+sz > st->sizes[xunit].nblocks)
	153	goto bad;
	154	bp->b_cylin = bn/st->nspc + st->sizes[xunit].cyloff;
81263dba	155	(void) spl5();
b81fd3e8 BJ	156	disksort(&mi->mi_tab, bp);
	157	if (mi->mi_tab.b_active == 0)
	158	mbustart(mi);
81263dba	159	(void) spl0();
b81fd3e8 BJ	160	return;
	161
	162	bad:
	163	bp->b_flags \|= B_ERROR;
	164	iodone(bp);
	165	return;
04b9d53d BJ	166	}
04b9d53d BJ	167
b81fd3e8	168	hpustart(mi)
4a4e3072	169	register struct mba_device *mi;
04b9d53d	170	{
804f6eab	171	register struct hpdevice hpaddr = (struct hpdevice )mi->mi_drv;
b81fd3e8 BJ	172	register struct buf *bp = mi->mi_tab.b_actf;
b81fd3e8 BJ	173	register struct hpst *st;
04b9d53d	174	daddr_t bn;
b81fd3e8	175	int sn, dist, flags;
04b9d53d	176
804f6eab	177	if ((hpaddr->hpcs1&HP_DVA) == 0)
b81fd3e8	178	return (MBU_BUSY);
d565635a	179	if ((hpaddr->hpds & HPDS_VV) == 0) {
804f6eab BJ	180	hpaddr->hpcs1 = HP_DCLR\|HP_GO;
804f6eab BJ	181	hpaddr->hpcs1 = HP_PRESET\|HP_GO;
d565635a	182	hpaddr->hpof = HPOF_FMT22;
04b9d53d	183	}
71236e46	184	if (mi->mi_tab.b_active \|\| mi->mi_hd->mh_ndrive == 1)
b81fd3e8	185	return (MBU_DODATA);
d565635a	186	if ((hpaddr->hpds & HPDS_DREADY) != HPDS_DREADY)
b81fd3e8	187	return (MBU_DODATA);
3f3a34c3 BJ	188	st = &hpst[mi->mi_type];
	189	bn = dkblock(bp);
	190	sn = bn%st->nspc;
	191	sn = (sn+st->nsect-hpSDIST)%st->nsect;
b81fd3e8	192	if (bp->b_cylin == (hpaddr->hpdc & 0xffff)) {
71236e46	193	if (hpseek)
b81fd3e8	194	return (MBU_DODATA);
b81fd3e8 BJ	195	dist = ((hpaddr->hpla & 0xffff)>>6) - st->nsect + 1;
	196	if (dist < 0)
	197	dist += st->nsect;
	198	if (dist > st->nsect - hpRDIST)
	199	return (MBU_DODATA);
0801d37f BJ	200	} else
0801d37f BJ	201	hpaddr->hpdc = bp->b_cylin;
71236e46	202	if (hpseek)
804f6eab	203	hpaddr->hpcs1 = HP_SEEK\|HP_GO;
41888f16 BJ	204	else {
41888f16 BJ	205	hpaddr->hpda = sn;
804f6eab	206	hpaddr->hpcs1 = HP_SEARCH\|HP_GO;
41888f16	207	}
b81fd3e8	208	return (MBU_STARTED);
04b9d53d BJ	209	}
04b9d53d BJ	210
b81fd3e8	211	hpstart(mi)
4a4e3072	212	register struct mba_device *mi;
04b9d53d	213	{
804f6eab	214	register struct hpdevice hpaddr = (struct hpdevice )mi->mi_drv;
b81fd3e8 BJ	215	register struct buf *bp = mi->mi_tab.b_actf;
b81fd3e8 BJ	216	register struct hpst *st = &hpst[mi->mi_type];
04b9d53d	217	daddr_t bn;
b81fd3e8	218	int sn, tn;
04b9d53d	219
04b9d53d	220	bn = dkblock(bp);
b81fd3e8 BJ	221	sn = bn%st->nspc;
b81fd3e8 BJ	222	tn = sn/st->nsect;
3f3a34c3	223	sn %= st->nsect;
b81fd3e8	224	hpaddr->hpdc = bp->b_cylin;
04b9d53d	225	hpaddr->hpda = (tn << 8) + sn;
04b9d53d BJ	226	}
04b9d53d BJ	227
736772ef	228	hpdtint(mi, mbasr)
4a4e3072	229	register struct mba_device *mi;
736772ef	230	int mbasr;
04b9d53d	231	{
804f6eab	232	register struct hpdevice hpaddr = (struct hpdevice )mi->mi_drv;
b81fd3e8	233	register struct buf *bp = mi->mi_tab.b_actf;
e34bc1ef	234	int retry = 0;
b81fd3e8	235
d565635a BJ	236	if (hpaddr->hpds&HPDS_ERR \|\| mbasr&MBAEBITS) {
d565635a BJ	237	if (hpaddr->hper1&HPER1_WLE) {
fd2cb420	238	printf("hp%d: write locked\n", dkunit(bp));
e34bc1ef BJ	239	bp->b_flags \|= B_ERROR;
	240	} else if (++mi->mi_tab.b_errcnt > 27 \|\|
	241	mbasr & MBASR_HARD \|\|
	242	hpaddr->hper1 & HPER1_HARD \|\|
	243	hpaddr->hper2 & HPER2_HARD) {
fd2cb420 BJ	244	harderr(bp, "hp");
fd2cb420 BJ	245	printf("mbasr=%b er1=%b er2=%b\n",
3dbaa9da	246	mbasr, mbasr_bits,
e34bc1ef BJ	247	hpaddr->hper1, HPER1_BITS,
e34bc1ef BJ	248	hpaddr->hper2, HPER2_BITS);
b81fd3e8	249	bp->b_flags \|= B_ERROR;
c9e9b65b	250	#ifdef notdef
d565635a	251	} else if (hpaddr->hper2&HPER2_SSE) {
c9e9b65b BJ	252	hpecc(mi, 1);
	253	return (MBD_RESTARTED);
	254	#endif
d565635a	255	} else if ((hpaddr->hper1&(HPER1_DCK\|HPER1_ECH))==HPER1_DCK) {
c9e9b65b	256	if (hpecc(mi, 0))
e34bc1ef BJ	257	return (MBD_RESTARTED);
	258	/* else done */
	259	} else
	260	retry = 1;
	261	hpaddr->hpcs1 = HP_DCLR\|HP_GO;
	262	if ((mi->mi_tab.b_errcnt&07) == 4) {
	263	hpaddr->hpcs1 = HP_RECAL\|HP_GO;
d565635a BJ	264	hprecal[mi->mi_unit] = 0;
d565635a BJ	265	goto nextrecal;
04b9d53d	266	}
e34bc1ef BJ	267	if (retry)
	268	return (MBD_RETRY);
	269	}
d565635a BJ	270	switch (hprecal[mi->mi_unit]) {
	271
	272	case 1:
	273	hpaddr->hpdc = bp->b_cylin;
	274	hpaddr->hpcs1 = HP_SEEK\|HP_GO;
	275	goto nextrecal;
	276	case 2:
	277	if (mi->mi_tab.b_errcnt < 16 \|\|
	278	(bp->b_flags & B_READ) != 0)
	279	goto donerecal;
	280	hpaddr->hpof = hp_offset[mi->mi_tab.b_errcnt & 017]\|HPOF_FMT22;
	281	hpaddr->hpcs1 = HP_OFFSET\|HP_GO;
	282	goto nextrecal;
	283	nextrecal:
	284	hprecal[mi->mi_unit]++;
	285	return (MBD_RESTARTED);
	286	donerecal:
3dbaa9da BJ	287	hprecal[mi->mi_unit] = 0;
	288	return (MBD_RETRY);
	289	}
b81fd3e8	290	bp->b_resid = -(mi->mi_mba->mba_bcr) & 0xffff;
e34bc1ef	291	if (mi->mi_tab.b_errcnt > 16) {
d565635a BJ	292	/*
	293	* This is fast and occurs rarely; we don't
	294	* bother with interrupts.
	295	*/
804f6eab	296	hpaddr->hpcs1 = HP_RTC\|HP_GO;
d565635a	297	while (hpaddr->hpds & HPDS_PIP)
b81fd3e8 BJ	298	;
b81fd3e8 BJ	299	mbclrattn(mi);
04b9d53d	300	}
804f6eab	301	hpaddr->hpcs1 = HP_RELEASE\|HP_GO;
b81fd3e8	302	return (MBD_DONE);
04b9d53d BJ	303	}
	304
	305	hpread(dev)
804f6eab	306	dev_t dev;
04b9d53d	307	{
804f6eab	308	register int unit = minor(dev) >> 3;
04b9d53d	309
804f6eab BJ	310	if (unit >= NHP)
	311	u.u_error = ENXIO;
	312	else
	313	physio(hpstrategy, &rhpbuf[unit], dev, B_READ, minphys);
04b9d53d BJ	314	}
	315
	316	hpwrite(dev)
804f6eab	317	dev_t dev;
04b9d53d	318	{
804f6eab	319	register int unit = minor(dev) >> 3;
04b9d53d	320
804f6eab BJ	321	if (unit >= NHP)
	322	u.u_error = ENXIO;
	323	else
	324	physio(hpstrategy, &rhpbuf[unit], dev, B_WRITE, minphys);
04b9d53d BJ	325	}
04b9d53d BJ	326
c9e9b65b	327	hpecc(mi, rm80sse)
4a4e3072	328	register struct mba_device *mi;
c9e9b65b	329	int rm80sse;
04b9d53d	330	{
b81fd3e8	331	register struct mba_regs *mbp = mi->mi_mba;
804f6eab	332	register struct hpdevice rp = (struct hpdevice )mi->mi_drv;
b81fd3e8 BJ	333	register struct buf *bp = mi->mi_tab.b_actf;
b81fd3e8 BJ	334	register struct hpst *st;
80e7c811 BJ	335	register int i;
	336	caddr_t addr;
	337	int reg, bit, byte, npf, mask, o;
b81fd3e8	338	int bn, cn, tn, sn;
80e7c811	339	struct pte mpte;
fa1d69d6	340	int bcr;
80e7c811	341
fa1d69d6 BJ	342	bcr = mbp->mba_bcr & 0xffff;
	343	if (bcr)
	344	bcr \|= 0xffff0000; /* sxt */
acecdc5c	345	npf = btop(bcr + bp->b_bcount) - 1;
f9b6e695	346	reg = npf;
c9e9b65b BJ	347	#ifdef notdef
c9e9b65b BJ	348	if (rm80sse) {
d565635a	349	rp->hpof \|= HPOF_SSEI;
c9e9b65b BJ	350	reg--; /* compensate in advance for reg-- below */
	351	goto sse;
	352	}
	353	#endif
80e7c811	354	o = (int)bp->b_un.b_addr & PGOFSET;
8dddd61f	355	printf("hp%d%c: soft ecc sn%d\n", dkunit(bp),
e34bc1ef	356	'a'+(minor(bp->b_dev)&07), bp->b_blkno + npf);
04b9d53d	357	mask = rp->hpec2&0xffff;
80e7c811	358	i = (rp->hpec1&0xffff) - 1; /* -1 makes 0 origin */
acecdc5c	359	bit = i&07;
80e7c811 BJ	360	i = (i&~07)>>3;
80e7c811 BJ	361	byte = i + o;
80e7c811 BJ	362	while (i < 512 && (int)ptob(npf)+i < bp->b_bcount && bit > -11) {
	363	mpte = mbp->mba_map[reg+btop(byte)];
	364	addr = ptob(mpte.pg_pfnum) + (byte & PGOFSET);
	365	putmemc(addr, getmemc(addr)^(mask<<bit));
	366	byte++;
	367	i++;
	368	bit -= 8;
04b9d53d	369	}
acecdc5c	370	if (bcr == 0)
80e7c811	371	return (0);
804f6eab	372	#ifdef notdef
c9e9b65b	373	sse:
d565635a	374	if (rpof&HPOF_SSEI)
c9e9b65b	375	rp->hpda = rp->hpda + 1;
804f6eab BJ	376	rp->hper1 = 0;
	377	rp->hpcs1 = HP_RCOM\|HP_GO;
	378	#else
c9e9b65b	379	sse:
804f6eab	380	rp->hpcs1 = HP_DCLR\|HP_GO;
80e7c811	381	bn = dkblock(bp);
b81fd3e8	382	st = &hpst[mi->mi_type];
80e7c811	383	cn = bp->b_cylin;
b81fd3e8 BJ	384	sn = bn%(st->nspc) + npf + 1;
	385	tn = sn/st->nsect;
	386	sn %= st->nsect;
	387	cn += tn/st->ntrak;
	388	tn %= st->ntrak;
c9e9b65b BJ	389	#ifdef notdef
	390	if (rp->hpof&SSEI)
	391	sn++;
	392	#endif
80e7c811 BJ	393	rp->hpdc = cn;
	394	rp->hpda = (tn<<8) + sn;
	395	mbp->mba_sr = -1;
	396	mbp->mba_var = (int)ptob(reg+1) + o;
804f6eab BJ	397	rp->hpcs1 = HP_RCOM\|HP_GO;
804f6eab BJ	398	#endif
80e7c811	399	return (1);
04b9d53d	400	}
e3b4b145 BJ	401
	402	#define DBSIZE 20
	403
	404	hpdump(dev)
	405	dev_t dev;
	406	{
4a4e3072	407	register struct mba_device *mi;
b81fd3e8	408	register struct mba_regs *mba;
804f6eab	409	struct hpdevice *hpaddr;
e3b4b145	410	char *start;
b81fd3e8 BJ	411	int num, unit;
b81fd3e8 BJ	412	register struct hpst *st;
e3b4b145 BJ	413
	414	num = maxfree;
	415	start = 0;
	416	unit = minor(dev) >> 3;
1b81ee79 BJ	417	if (unit >= NHP)
1b81ee79 BJ	418	return (ENXIO);
b81fd3e8	419	#define phys(a,b) ((b)((int)(a)&0x7fffffff))
4a4e3072	420	mi = phys(hpinfo[unit],struct mba_device *);
1b81ee79 BJ	421	if (mi == 0 \|\| mi->mi_alive == 0)
1b81ee79 BJ	422	return (ENXIO);
b81fd3e8 BJ	423	mba = phys(mi->mi_hd, struct mba_hd *)->mh_physmba;
b81fd3e8 BJ	424	mba->mba_cr = MBAINIT;
804f6eab	425	hpaddr = (struct hpdevice *)&mba->mba_drv[mi->mi_drive];
d565635a	426	if ((hpaddr->hpds & HPDS_VV) == 0) {
804f6eab BJ	427	hpaddr->hpcs1 = HP_DCLR\|HP_GO;
804f6eab BJ	428	hpaddr->hpcs1 = HP_PRESET\|HP_GO;
d565635a	429	hpaddr->hpof = HPOF_FMT22;
e3b4b145	430	}
b81fd3e8	431	st = &hpst[mi->mi_type];
1b81ee79 BJ	432	if (dumplo < 0 \|\| dumplo + num >= st->sizes[minor(dev)&07].nblocks)
1b81ee79 BJ	433	return (EINVAL);
e3b4b145	434	while (num > 0) {
b81fd3e8	435	register struct pte *hpte = mba->mba_map;
e3b4b145	436	register int i;
b81fd3e8	437	int blk, cn, sn, tn;
e3b4b145 BJ	438	daddr_t bn;
	439
	440	blk = num > DBSIZE ? DBSIZE : num;
	441	bn = dumplo + btop(start);
b81fd3e8 BJ	442	cn = bn/st->nspc + st->sizes[minor(dev)&07].cyloff;
	443	sn = bn%st->nspc;
	444	tn = sn/st->nsect;
	445	sn = sn%st->nsect;
e3b4b145 BJ	446	hpaddr->hpdc = cn;
	447	hpaddr->hpda = (tn << 8) + sn;
	448	for (i = 0; i < blk; i++)
	449	(int )hpte++ = (btop(start)+i) \| PG_V;
b81fd3e8 BJ	450	mba->mba_sr = -1;
	451	mba->mba_bcr = -(blk*NBPG);
	452	mba->mba_var = 0;
804f6eab	453	hpaddr->hpcs1 = HP_WCOM \| HP_GO;
d565635a	454	while ((hpaddr->hpds & HPDS_DRY) == 0)
e3b4b145	455	;
d565635a	456	if (hpaddr->hpds&HPDS_ERR)
1b81ee79	457	return (EIO);
e3b4b145 BJ	458	start += blk*NBPG;
	459	num -= blk;
	460	}
	461	return (0);
	462	}
a5cc519e	463	#endif