xref: /csrg-svn/sys/tahoe/vba/vd.c (revision 34866)
134528Skarels /*
234528Skarels  * Copyright (c) 1988 Regents of the University of California.
334528Skarels  * All rights reserved.
434528Skarels  *
534528Skarels  * Redistribution and use in source and binary forms are permitted
6*34866Sbostic  * provided that the above copyright notice and this paragraph are
7*34866Sbostic  * duplicated in all such forms and that any documentation,
8*34866Sbostic  * advertising materials, and other materials related to such
9*34866Sbostic  * distribution and use acknowledge that the software was developed
10*34866Sbostic  * by the University of California, Berkeley.  The name of the
11*34866Sbostic  * University may not be used to endorse or promote products derived
12*34866Sbostic  * from this software without specific prior written permission.
13*34866Sbostic  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
14*34866Sbostic  * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
15*34866Sbostic  * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
1634528Skarels  *
17*34866Sbostic  *	@(#)vd.c	7.5 (Berkeley) 06/29/88
1834528Skarels  */
1924004Ssam 
2029564Ssam #include "dk.h"
2124004Ssam #if NVD > 0
2224004Ssam /*
2330519Ssam  * Versabus VDDC/SMDE driver.
2425675Ssam  */
2525675Ssam #include "param.h"
2625675Ssam #include "buf.h"
2725675Ssam #include "cmap.h"
2825675Ssam #include "conf.h"
2925675Ssam #include "dir.h"
3029564Ssam #include "dkstat.h"
3130519Ssam #include "disklabel.h"
3225675Ssam #include "map.h"
3330519Ssam #include "file.h"
3425675Ssam #include "systm.h"
3525675Ssam #include "user.h"
3625675Ssam #include "vmmac.h"
3725675Ssam #include "proc.h"
3825675Ssam #include "uio.h"
3930370Skarels #include "syslog.h"
4030370Skarels #include "kernel.h"
4130519Ssam #include "ioctl.h"
4230756Skarels #include "stat.h"
4324004Ssam 
4429951Skarels #include "../tahoe/cpu.h"
4529951Skarels #include "../tahoe/mtpr.h"
4629951Skarels #include "../tahoe/pte.h"
4729951Skarels 
4825675Ssam #include "../tahoevba/vbavar.h"
4925928Ssam #include "../tahoevba/vdreg.h"
5024004Ssam 
5132211Skarels #ifndef	COMPAT_42
5230519Ssam #define	COMPAT_42
5332211Skarels #endif
5434396Skarels #define	B_FORMAT	B_XXX		/* XXX */
5530519Ssam 
5630519Ssam #define vdunit(dev)	(minor(dev) >> 3)
5730519Ssam #define vdpart(dev)	(minor(dev) & 0x07)
5830519Ssam #define	vdminor(unit,part)	(((unit) << 3) | (part))
5924004Ssam 
6024004Ssam struct	vba_ctlr *vdminfo[NVD];
6129564Ssam struct  vba_device *vddinfo[NDK];
6230756Skarels int	vdprobe(), vdslave(), vdattach(), vddgo(), vdstrategy();
6334528Skarels long	vdstd[] = { 0xffff2000, 0xffff2100, 0xffff2200, 0xffff2300, 0 };
6425675Ssam struct	vba_driver vddriver =
6534528Skarels   { vdprobe, vdslave, vdattach, vddgo, vdstd, "dk", vddinfo, "vd", vdminfo };
6624004Ssam 
6724004Ssam /*
6830519Ssam  * Per-controller state.
6930519Ssam  */
7030519Ssam struct vdsoftc {
7130519Ssam 	u_short	vd_flags;
7230519Ssam #define	VD_INIT		0x1	/* controller initialized */
7330519Ssam #define	VD_STARTED	0x2	/* start command issued */
7430519Ssam #define	VD_DOSEEKS	0x4	/* should overlap seeks */
7530756Skarels #define	VD_SCATGATH	0x8	/* can do scatter-gather commands (correctly) */
7630519Ssam 	u_short	vd_type;	/* controller type */
7730519Ssam 	u_short	vd_wticks;	/* timeout */
7830519Ssam 	struct	mdcb vd_mdcb;	/* master command block */
7930519Ssam 	u_long	vd_mdcbphys;	/* physical address of vd_mdcb */
8030519Ssam 	struct	dcb vd_dcb;	/* i/o command block */
8130519Ssam 	u_long	vd_dcbphys;	/* physical address of vd_dcb */
8230601Skarels 	struct	vb_buf vd_rbuf;	/* vba resources */
8330519Ssam } vdsoftc[NVD];
8430519Ssam 
8534396Skarels #define	VDMAXTIME	20	/* max time for operation, sec. */
8634396Skarels 
8730519Ssam /*
8825675Ssam  * Per-drive state.
8925675Ssam  */
9030519Ssam struct	dksoftc {
9134076Skarels 	int	dk_state;	/* open fsm */
9230756Skarels #ifndef SECSIZE
9330756Skarels 	u_short	dk_bshift;	/* shift for * (DEV_BSIZE / sectorsize) XXX */
9430756Skarels #endif SECSIZE
9534076Skarels 	int	dk_wlabel;	/* label sector is currently writable */
9632576Skarels 	u_long	dk_copenpart;	/* character units open on this drive */
9732576Skarels 	u_long	dk_bopenpart;	/* block units open on this drive */
9832576Skarels 	u_long	dk_openpart;	/* all units open on this drive */
9930519Ssam 	u_int	dk_curcyl;	/* last selected cylinder */
10030756Skarels 	struct	skdcb dk_dcb;	/* seek command block */
10130519Ssam 	u_long	dk_dcbphys;	/* physical address of dk_dcb */
10234396Skarels 	int	df_reg[3];	/* for formatting, in-out parameters */
10330519Ssam } dksoftc[NDK];
10424004Ssam 
10524004Ssam /*
10630519Ssam  * Drive states.  Used during steps of open/initialization.
10730519Ssam  * States < OPEN (> 0) are transient, during an open operation.
10834076Skarels  * OPENRAW is used for unlabeled disks, to allow format operations.
10925675Ssam  */
11030519Ssam #define	CLOSED		0		/* disk is closed */
11130519Ssam #define	WANTOPEN	1		/* open requested, not started */
11230519Ssam #define	WANTOPENRAW	2		/* open requested, no label */
11330519Ssam #define	RDLABEL		3		/* reading pack label */
11430519Ssam #define	OPEN		4		/* intialized and ready */
11530519Ssam #define	OPENRAW		5		/* open, no label */
11624004Ssam 
11730519Ssam struct	buf dkutab[NDK];	/* i/o queue headers */
11830519Ssam struct	disklabel dklabel[NDK];	/* pack labels */
11924004Ssam 
12030519Ssam #define b_cylin	b_resid
12130574Skarels #define	b_track	b_error		/* used for seek commands */
12230574Skarels #define	b_seekf	b_forw		/* second queue on um_tab */
12330574Skarels #define	b_seekl	b_back		/* second queue on um_tab */
12430519Ssam 
12530519Ssam int	vdwstart, vdwatch();
12630519Ssam 
12724004Ssam /*
12825675Ssam  * See if the controller is really there; if so, initialize it.
12925675Ssam  */
13025857Ssam vdprobe(reg, vm)
13125857Ssam 	caddr_t reg;
13225857Ssam 	struct vba_ctlr *vm;
13325675Ssam {
13425857Ssam 	register br, cvec;		/* must be r12, r11 */
13530519Ssam 	register struct vddevice *vdaddr = (struct vddevice *)reg;
13630519Ssam 	struct vdsoftc *vd;
13730573Skarels 	int s;
13825857Ssam 
13930370Skarels #ifdef lint
14030370Skarels 	br = 0; cvec = br; br = cvec;
14130370Skarels 	vdintr(0);
14230370Skarels #endif
14325857Ssam 	if (badaddr((caddr_t)reg, 2))
14425675Ssam 		return (0);
14530519Ssam 	vd = &vdsoftc[vm->um_ctlr];
14630519Ssam 	vdaddr->vdreset = 0xffffffff;
14725675Ssam 	DELAY(1000000);
14830519Ssam 	if (vdaddr->vdreset != (unsigned)0xffffffff) {
14930519Ssam 		vd->vd_type = VDTYPE_VDDC;
15030519Ssam 		vd->vd_flags &= ~VD_DOSEEKS;
15125675Ssam 		DELAY(1000000);
15225675Ssam 	} else {
15330519Ssam 		vd->vd_type = VDTYPE_SMDE;
15430519Ssam 		vd->vd_flags |= VD_DOSEEKS;
15530519Ssam 		vdaddr->vdrstclr = 0;
15625675Ssam 		DELAY(3000000);
15730519Ssam 		vdaddr->vdcsr = 0;
15830519Ssam 		vdaddr->vdtcf_mdcb = AM_ENPDA;
15930519Ssam 		vdaddr->vdtcf_dcb = AM_ENPDA;
16030519Ssam 		vdaddr->vdtcf_trail = AM_ENPDA;
16130519Ssam 		vdaddr->vdtcf_data = AM_ENPDA;
16230519Ssam 		vdaddr->vdccf = CCF_SEN | CCF_DER | CCF_STS |
16329921Skarels 		    XMD_32BIT | BSZ_16WRD |
16425925Ssam 		    CCF_ENP | CCF_EPE | CCF_EDE | CCF_ECE | CCF_ERR;
16525675Ssam 	}
16630519Ssam 	vd->vd_mdcbphys = vtoph((struct proc *)0, (unsigned)&vd->vd_mdcb);
16730519Ssam 	vd->vd_dcbphys = vtoph((struct proc *)0, (unsigned)&vd->vd_dcb);
16830519Ssam 	vm->um_addr = reg;		/* XXX */
16930573Skarels 	s = spl7();
17030519Ssam 	if (!vdcmd(vm, VDOP_INIT, 10) || !vdcmd(vm, VDOP_DIAG, 10)) {
17130519Ssam 		printf("vd%d: %s cmd failed\n", vm->um_ctlr,
17230519Ssam 		    vd->vd_dcb.opcode == VDOP_INIT ? "init" : "diag");
17330573Skarels 		splx(s);
17430519Ssam 		return (0);
17530519Ssam 	}
17630756Skarels 	if (vd->vd_type == VDTYPE_SMDE) {
17730756Skarels 		vd->vd_dcb.trail.idtrail.date = 0;
17830756Skarels 		if (vdcmd(vm, VDOP_IDENT, 10)) {
17930756Skarels 			uncache(&vd->vd_dcb.trail.idtrail.date);
18030756Skarels 			if (vd->vd_dcb.trail.idtrail.date != 0)
18130756Skarels 				vd->vd_flags |= VD_SCATGATH;
18230756Skarels 		}
18330756Skarels 	}
18430573Skarels 	splx(s);
18525925Ssam 	/*
18625950Ssam 	 * Allocate page tables and i/o buffer.
18725925Ssam 	 */
18832211Skarels 	if (vbainit(&vd->vd_rbuf, MAXPHYS,
18932211Skarels 	    vd->vd_type == VDTYPE_VDDC ? VB_24BIT : VB_32BIT) == 0) {
19032211Skarels 		printf("vd%d: vbainit failed\n", vm->um_ctlr);
19132211Skarels 		return (0);
19232211Skarels 	}
19325857Ssam 	br = 0x17, cvec = 0xe0 + vm->um_ctlr;	/* XXX */
19430519Ssam 	return (sizeof (struct vddevice));
19525675Ssam }
19624004Ssam 
19724004Ssam /*
19830519Ssam  * See if a drive is really there.
19930519Ssam  *
20030519Ssam  * Can't read pack label here as various data structures
20130519Ssam  * aren't setup for doing a read in a straightforward
20230519Ssam  * manner.  Instead just probe for the drive and leave
20330519Ssam  * the pack label stuff to the attach routine.
20425675Ssam  */
20534076Skarels /* ARGSUSED */
20634076Skarels vdslave(vi, vdaddr)
20725675Ssam 	register struct vba_device *vi;
20830519Ssam 	struct vddevice *vdaddr;
20925675Ssam {
21030519Ssam 	register struct disklabel *lp = &dklabel[vi->ui_unit];
21132211Skarels 	register struct dksoftc *dk = &dksoftc[vi->ui_unit];
21230519Ssam 	struct vdsoftc *vd = &vdsoftc[vi->ui_ctlr];
21324004Ssam 
21430519Ssam 	if ((vd->vd_flags&VD_INIT) == 0) {
21530756Skarels 		printf("vd%d: %s controller%s\n", vi->ui_ctlr,
21630756Skarels 		    vd->vd_type == VDTYPE_VDDC ? "VDDC" : "SMDE",
21730756Skarels 		    (vd->vd_flags & VD_SCATGATH) ? " with scatter-gather" : "");
21830519Ssam 		vd->vd_flags |= VD_INIT;
21925675Ssam 	}
22030519Ssam 
22125675Ssam 	/*
22230519Ssam 	 * Initialize label enough to do a reset on
22330519Ssam 	 * the drive.  The remainder of the default
22430519Ssam 	 * label values will be filled in in vdinit
22530519Ssam 	 * at attach time.
22625675Ssam 	 */
22732211Skarels 	if (vd->vd_type == VDTYPE_SMDE)
22832211Skarels 		lp->d_secsize = VD_MAXSECSIZE;
22932211Skarels 	else
23032211Skarels 		lp->d_secsize = VDDC_SECSIZE;
23134396Skarels 	lp->d_nsectors = 66;		/* only used on smd-e */
23234076Skarels 	lp->d_ntracks = 23;
23334396Skarels 	lp->d_ncylinders = 850;
23434396Skarels 	lp->d_secpercyl = 66*23;
23534592Skarels 	lp->d_npartitions = 1;
23634592Skarels 	lp->d_partitions[0].p_offset = 0;
23734592Skarels 	lp->d_partitions[0].p_size = LABELSECTOR + 1;
23824004Ssam 
23930519Ssam 	/*
24030519Ssam 	 * Initialize invariant portion of
24130519Ssam 	 * dcb used for overlapped seeks.
24230519Ssam 	 */
24330519Ssam 	dk->dk_dcb.opcode = VDOP_SEEK;
24430519Ssam 	dk->dk_dcb.intflg = DCBINT_NONE | DCBINT_PBA;
24530519Ssam 	dk->dk_dcb.devselect = vi->ui_slave;
24630756Skarels 	dk->dk_dcb.trailcnt = sizeof (struct trseek) / sizeof (long);
24730519Ssam 	dk->dk_dcb.trail.sktrail.skaddr.sector = 0;
24830519Ssam 	dk->dk_dcbphys = vtoph((struct proc *)0, (unsigned)&dk->dk_dcb);
24932211Skarels #ifndef SECSIZE
25032211Skarels 	vd_setsecsize(dk, lp);
25132211Skarels #endif
25232211Skarels 	return (vdreset_drive(vi));
25332211Skarels }
25432211Skarels 
25532211Skarels vdattach(vi)
25632211Skarels 	register struct vba_device *vi;
25732211Skarels {
25832211Skarels 	register int unit = vi->ui_unit;
25932211Skarels 	register struct disklabel *lp = &dklabel[unit];
26032211Skarels 
26130601Skarels 	/*
26230601Skarels 	 * Try to initialize device and read pack label.
26330601Skarels 	 */
26430601Skarels 	if (vdinit(vdminor(unit, 0), 0) != 0) {
26530601Skarels 		printf(": unknown drive type");
26630601Skarels 		return;
26730601Skarels 	}
26832211Skarels 	if (dksoftc[unit].dk_state == OPEN)
26932211Skarels 		printf(": %s <secsize %d, ntrak %d, ncyl %d, nsec %d>",
27032211Skarels 		    lp->d_typename, lp->d_secsize,
27132211Skarels 		    lp->d_ntracks, lp->d_ncylinders, lp->d_nsectors);
27230519Ssam 	/*
27330519Ssam 	 * (60 / rpm) / (sectors per track * (bytes per sector / 2))
27430519Ssam 	 */
27530519Ssam 	if (vi->ui_dk >= 0)
27630519Ssam 		dk_mspw[vi->ui_dk] = 120.0 /
27730519Ssam 		    (lp->d_rpm * lp->d_nsectors * lp->d_secsize);
27830519Ssam #ifdef notyet
27930573Skarels 	addswap(makedev(VDMAJOR, vdminor(unit, 0)), lp);
28030519Ssam #endif
28124004Ssam }
28224004Ssam 
28330756Skarels vdopen(dev, flags, fmt)
28430519Ssam 	dev_t dev;
28530756Skarels 	int flags, fmt;
28624004Ssam {
28730519Ssam 	register unit = vdunit(dev);
28830519Ssam 	register struct disklabel *lp;
28930519Ssam 	register struct dksoftc *dk;
29030519Ssam 	register struct partition *pp;
29130519Ssam 	struct vba_device *vi;
29230756Skarels 	int s, error, part = vdpart(dev), mask = 1 << part;
29330519Ssam 	daddr_t start, end;
29424004Ssam 
29530519Ssam 	if (unit >= NDK || (vi = vddinfo[unit]) == 0 || vi->ui_alive == 0)
29630519Ssam 		return (ENXIO);
29730519Ssam 	lp = &dklabel[unit];
29830519Ssam 	dk = &dksoftc[unit];
29930519Ssam 
30030519Ssam 	s = spl7();
30130519Ssam 	while (dk->dk_state != OPEN && dk->dk_state != OPENRAW &&
30230519Ssam 	    dk->dk_state != CLOSED)
30330519Ssam 		sleep((caddr_t)dk, PZERO+1);
30430519Ssam 	splx(s);
30530519Ssam 	if (dk->dk_state != OPEN && dk->dk_state != OPENRAW)
30630519Ssam 		if (error = vdinit(dev, flags))
30730519Ssam 			return (error);
30830573Skarels 
30930573Skarels 	if (vdwstart == 0) {
31030573Skarels 		timeout(vdwatch, (caddr_t)0, hz);
31130573Skarels 		vdwstart++;
31230573Skarels 	}
31330519Ssam 	/*
31430519Ssam 	 * Warn if a partion is opened
31530519Ssam 	 * that overlaps another partition which is open
31630519Ssam 	 * unless one is the "raw" partition (whole disk).
31730519Ssam 	 */
31832211Skarels #define	RAWPART		8		/* 'x' partition */	/* XXX */
31932576Skarels 	if ((dk->dk_openpart & mask) == 0 && part != RAWPART) {
32030519Ssam 		pp = &lp->d_partitions[part];
32130519Ssam 		start = pp->p_offset;
32230519Ssam 		end = pp->p_offset + pp->p_size;
32330519Ssam 		for (pp = lp->d_partitions;
32430519Ssam 		     pp < &lp->d_partitions[lp->d_npartitions]; pp++) {
32530519Ssam 			if (pp->p_offset + pp->p_size <= start ||
32630519Ssam 			    pp->p_offset >= end)
32730519Ssam 				continue;
32830519Ssam 			if (pp - lp->d_partitions == RAWPART)
32930519Ssam 				continue;
33030519Ssam 			if (dk->dk_openpart & (1 << (pp - lp->d_partitions)))
33130519Ssam 				log(LOG_WARNING,
33230519Ssam 				    "dk%d%c: overlaps open partition (%c)\n",
33330519Ssam 				    unit, part + 'a',
33430519Ssam 				    pp - lp->d_partitions + 'a');
33530519Ssam 		}
33624004Ssam 	}
33730519Ssam 	if (part >= lp->d_npartitions)
33830519Ssam 		return (ENXIO);
33930756Skarels 	dk->dk_openpart |= mask;
34030756Skarels 	switch (fmt) {
34130756Skarels 	case S_IFCHR:
34230756Skarels 		dk->dk_copenpart |= mask;
34330756Skarels 		break;
34430756Skarels 	case S_IFBLK:
34530756Skarels 		dk->dk_bopenpart |= mask;
34630756Skarels 		break;
34730756Skarels 	}
34830519Ssam 	return (0);
34925675Ssam }
35024004Ssam 
35134528Skarels /* ARGSUSED */
35230756Skarels vdclose(dev, flags, fmt)
35330519Ssam 	dev_t dev;
35430756Skarels 	int flags, fmt;
35524004Ssam {
35630519Ssam 	register int unit = vdunit(dev);
35730519Ssam 	register struct dksoftc *dk = &dksoftc[unit];
35830756Skarels 	int part = vdpart(dev), mask = 1 << part;
35924004Ssam 
36030756Skarels 	switch (fmt) {
36130756Skarels 	case S_IFCHR:
36230756Skarels 		dk->dk_copenpart &= ~mask;
36330756Skarels 		break;
36430756Skarels 	case S_IFBLK:
36530756Skarels 		dk->dk_bopenpart &= ~mask;
36630756Skarels 		break;
36730756Skarels 	}
36830756Skarels 	if (((dk->dk_copenpart | dk->dk_bopenpart) & mask) == 0)
36930756Skarels 		dk->dk_openpart &= ~mask;
37030519Ssam 	/*
37130519Ssam 	 * Should wait for i/o to complete on this partition
37230519Ssam 	 * even if others are open, but wait for work on blkflush().
37330519Ssam 	 */
37430519Ssam 	if (dk->dk_openpart == 0) {
37530573Skarels 		int s = spl7();
37630573Skarels 		while (dkutab[unit].b_actf)
37730573Skarels 			sleep((caddr_t)dk, PZERO-1);
37830519Ssam 		splx(s);
37930519Ssam 		dk->dk_state = CLOSED;
38034076Skarels 		dk->dk_wlabel = 0;
38124004Ssam 	}
38230756Skarels 	return (0);
38325675Ssam }
38424004Ssam 
38530519Ssam vdinit(dev, flags)
38630519Ssam 	dev_t dev;
38730519Ssam 	int flags;
38825675Ssam {
38930519Ssam 	register struct disklabel *lp;
39030519Ssam 	register struct dksoftc *dk;
39130519Ssam 	struct vba_device *vi;
39230519Ssam 	int unit = vdunit(dev), error = 0;
39330756Skarels 	char *msg, *readdisklabel();
39430519Ssam 	extern int cold;
39525675Ssam 
39630519Ssam 	dk = &dksoftc[unit];
39730519Ssam 	if (flags & O_NDELAY) {
39830519Ssam 		dk->dk_state = OPENRAW;
39934528Skarels 		return (0);
40030519Ssam 	}
40130519Ssam 	dk->dk_state = RDLABEL;
40230519Ssam 	lp = &dklabel[unit];
40330519Ssam 	vi = vddinfo[unit];
40430756Skarels 	if (msg = readdisklabel(dev, vdstrategy, lp)) {
40534076Skarels 		if (cold) {
40630601Skarels 			printf(": %s", msg);
40734076Skarels 			dk->dk_state = CLOSED;
40834076Skarels 		} else {
40932211Skarels 			log(LOG_ERR, "dk%d: %s\n", unit, msg);
41034076Skarels 			dk->dk_state = OPENRAW;
41134076Skarels 		}
41230519Ssam #ifdef COMPAT_42
41334076Skarels 		if (vdmaptype(vi, lp))
41430519Ssam 			dk->dk_state = OPEN;
41530519Ssam #endif
41630756Skarels 	} else {
41730756Skarels 		/*
41830756Skarels 		 * Now that we have the label, configure
41930756Skarels 		 * the correct drive parameters.
42030756Skarels 		 */
42132211Skarels 		if (vdreset_drive(vi))
42232211Skarels 			dk->dk_state = OPEN;
42332211Skarels 		else {
42430756Skarels 			dk->dk_state = CLOSED;
42530756Skarels 			error = ENXIO;
42632211Skarels 		}
42725675Ssam 	}
42830756Skarels #ifndef SECSIZE
42932211Skarels 	vd_setsecsize(dk, lp);
43032211Skarels #endif
43130519Ssam 	wakeup((caddr_t)dk);
43230519Ssam 	return (error);
43324004Ssam }
43424004Ssam 
43532211Skarels #ifndef SECSIZE
43632211Skarels vd_setsecsize(dk, lp)
43732211Skarels 	register struct dksoftc *dk;
43832211Skarels 	register struct disklabel *lp;
43932211Skarels {
44032211Skarels 	int mul;
44132211Skarels 
44232211Skarels 	/*
44332211Skarels 	 * Calculate scaling shift for mapping
44432211Skarels 	 * DEV_BSIZE blocks to drive sectors.
44532211Skarels 	 */
44632211Skarels 	mul = DEV_BSIZE / lp->d_secsize;
44732211Skarels 	dk->dk_bshift = 0;
44832211Skarels 	while ((mul >>= 1) > 0)
44932211Skarels 		dk->dk_bshift++;
45032211Skarels }
45132211Skarels #endif SECSIZE
45232211Skarels 
45325675Ssam /*ARGSUSED*/
45430519Ssam vddgo(vm)
45530519Ssam 	struct vba_device *vm;
45624004Ssam {
45724004Ssam 
45824004Ssam }
45924004Ssam 
46024004Ssam vdstrategy(bp)
46125675Ssam 	register struct buf *bp;
46224004Ssam {
46330519Ssam 	register struct vba_device *vi;
46430519Ssam 	register struct disklabel *lp;
46530519Ssam 	register struct dksoftc *dk;
46630519Ssam 	register int unit;
46730573Skarels 	register daddr_t sn;
46830519Ssam 	struct buf *dp;
46930573Skarels 	daddr_t sz, maxsz;
47030519Ssam 	int part, s;
47124004Ssam 
47230519Ssam 	unit = vdunit(bp->b_dev);
47332211Skarels 	if (unit >= NDK) {
47429954Skarels 		bp->b_error = ENXIO;
47525675Ssam 		goto bad;
47629954Skarels 	}
47730519Ssam 	vi = vddinfo[unit];
47830519Ssam 	lp = &dklabel[unit];
47930519Ssam 	if (vi == 0 || vi->ui_alive == 0) {
48030519Ssam 		bp->b_error = ENXIO;
48130519Ssam 		goto bad;
48230519Ssam 	}
48330519Ssam 	dk = &dksoftc[unit];
48430519Ssam 	if (dk->dk_state < OPEN)
48530519Ssam 		goto q;
48634076Skarels 	if (dk->dk_state != OPEN && (bp->b_flags & B_READ) == 0) {
48734076Skarels 		bp->b_error = EROFS;
48834076Skarels 		goto bad;
48934076Skarels 	}
49030519Ssam 	part = vdpart(bp->b_dev);
49130519Ssam 	if ((dk->dk_openpart & (1 << part)) == 0) {
49230519Ssam 		bp->b_error = ENODEV;
49330519Ssam 		goto bad;
49430519Ssam 	}
49532211Skarels 	sz = (bp->b_bcount + lp->d_secsize - 1) / lp->d_secsize;
49630519Ssam 	maxsz = lp->d_partitions[part].p_size;
49730756Skarels #ifndef SECSIZE
49830756Skarels 	sn = bp->b_blkno << dk->dk_bshift;
49930756Skarels #else SECSIZE
50030573Skarels 	sn = bp->b_blkno;
50130756Skarels #endif SECSIZE
50234076Skarels 	if (sn + lp->d_partitions[part].p_offset <= LABELSECTOR &&
50334076Skarels #if LABELSECTOR != 0
50434076Skarels 	    sn + lp->d_partitions[part].p_offset + sz > LABELSECTOR &&
50534076Skarels #endif
50634076Skarels 	    (bp->b_flags & B_READ) == 0 && dk->dk_wlabel == 0) {
50734076Skarels 		bp->b_error = EROFS;
50834076Skarels 		goto bad;
50934076Skarels 	}
51030519Ssam 	if (sn < 0 || sn + sz > maxsz) {
51130519Ssam 		if (sn == maxsz) {
51229954Skarels 			bp->b_resid = bp->b_bcount;
51329954Skarels 			goto done;
51429954Skarels 		}
51530756Skarels 		sz = maxsz - sn;
51630573Skarels 		if (sz <= 0) {
51730573Skarels 			bp->b_error = EINVAL;
51830573Skarels 			goto bad;
51930573Skarels 		}
52030573Skarels 		bp->b_bcount = sz * lp->d_secsize;
52125675Ssam 	}
52230519Ssam 	bp->b_cylin = (sn + lp->d_partitions[part].p_offset) / lp->d_secpercyl;
52330756Skarels #ifdef SECSIZE
52430756Skarels if (bp->b_blksize != lp->d_secsize && (bp->b_flags & B_PGIN) == 0)
52530756Skarels panic("vdstrat blksize");
52630756Skarels #endif SECSIZE
52730519Ssam q:
52825675Ssam 	s = spl7();
52930519Ssam 	dp = &dkutab[vi->ui_unit];
53030519Ssam 	disksort(dp, bp);
53130519Ssam 	if (!dp->b_active) {
53230519Ssam 		(void) vdustart(vi);
53330573Skarels 		if (!vi->ui_mi->um_tab.b_active)
53430519Ssam 			vdstart(vi->ui_mi);
53524004Ssam 	}
53630519Ssam 	splx(s);
53724004Ssam 	return;
53825675Ssam bad:
53929954Skarels 	bp->b_flags |= B_ERROR;
54029954Skarels done:
54130519Ssam 	biodone(bp);
54230519Ssam 	return;
54324004Ssam }
54424004Ssam 
54530519Ssam vdustart(vi)
54630519Ssam 	register struct vba_device *vi;
54724004Ssam {
54830519Ssam 	register struct buf *bp, *dp;
54930519Ssam 	register struct vba_ctlr *vm;
55030519Ssam 	register int unit = vi->ui_unit;
55130519Ssam 	register struct dksoftc *dk;
55230519Ssam 	register struct vdsoftc *vd;
55330519Ssam 	struct disklabel *lp;
55424004Ssam 
55530519Ssam 	dp = &dkutab[unit];
55630519Ssam 	/*
55730519Ssam 	 * If queue empty, nothing to do.
55830519Ssam 	 */
55930519Ssam 	if ((bp = dp->b_actf) == NULL)
56030519Ssam 		return;
56130519Ssam 	/*
56230574Skarels 	 * If drive is off-cylinder and controller supports seeks,
56330574Skarels 	 * place drive on seek queue for controller.
56430574Skarels 	 * Otherwise, place on transfer queue.
56530519Ssam 	 */
56630519Ssam 	vd = &vdsoftc[vi->ui_ctlr];
56730519Ssam 	dk = &dksoftc[unit];
56830574Skarels 	vm = vi->ui_mi;
56930519Ssam 	if (bp->b_cylin != dk->dk_curcyl && vd->vd_flags&VD_DOSEEKS) {
57030519Ssam 		lp = &dklabel[unit];
57130574Skarels 		bp->b_track = (bp->b_blkno % lp->d_secpercyl) / lp->d_nsectors;
57230574Skarels 		if (vm->um_tab.b_seekf == NULL)
57330574Skarels 			vm->um_tab.b_seekf = dp;
57430574Skarels 		else
57530574Skarels 			vm->um_tab.b_seekl->b_forw = dp;
57630574Skarels 		vm->um_tab.b_seekl = dp;
57730574Skarels 	} else {
57830574Skarels 		if (vm->um_tab.b_actf == NULL)
57930574Skarels 			vm->um_tab.b_actf = dp;
58030574Skarels 		else
58130574Skarels 			vm->um_tab.b_actl->b_forw = dp;
58230574Skarels 		vm->um_tab.b_actl = dp;
58330519Ssam 	}
58430573Skarels 	dp->b_forw = NULL;
58530573Skarels 	dp->b_active++;
58625675Ssam }
58725675Ssam 
58825675Ssam /*
58930519Ssam  * Start next transfer on a controller.
59030574Skarels  * There are two queues of drives, the first on-cylinder
59130574Skarels  * and the second off-cylinder from their next transfers.
59230574Skarels  * Perform the first transfer for the first drive on the on-cylinder
59330574Skarels  * queue, if any, otherwise the first transfer for the first drive
59430574Skarels  * on the second queue.  Initiate seeks on remaining drives on the
59530574Skarels  * off-cylinder queue, then move them all to the on-cylinder queue.
59625675Ssam  */
59730519Ssam vdstart(vm)
59830519Ssam 	register struct vba_ctlr *vm;
59925675Ssam {
60025675Ssam 	register struct buf *bp;
60130519Ssam 	register struct vba_device *vi;
60230519Ssam 	register struct vdsoftc *vd;
60330519Ssam 	register struct dksoftc *dk;
60430519Ssam 	register struct disklabel *lp;
60530519Ssam 	register struct dcb **dcbp;
60630519Ssam 	struct buf *dp;
60730519Ssam 	int sn, tn;
60825675Ssam 
60930519Ssam loop:
61030519Ssam 	/*
61130519Ssam 	 * Pull a request off the controller queue.
61230519Ssam 	 */
61330574Skarels 	if ((dp = vm->um_tab.b_actf) == NULL &&
61430574Skarels 	    (dp = vm->um_tab.b_seekf) == NULL)
61530519Ssam 		return;
61630519Ssam 	if ((bp = dp->b_actf) == NULL) {
61730601Skarels 		if (dp == vm->um_tab.b_actf)
61830601Skarels 			vm->um_tab.b_actf = dp->b_forw;
61930601Skarels 		else
62030601Skarels 			vm->um_tab.b_seekf = dp->b_forw;
62130519Ssam 		goto loop;
62230519Ssam 	}
62325675Ssam 
62424004Ssam 	/*
62530519Ssam 	 * Mark controller busy, and determine
62630519Ssam 	 * destination of this request.
62724004Ssam 	 */
62830519Ssam 	vm->um_tab.b_active++;
62930519Ssam 	vi = vddinfo[vdunit(bp->b_dev)];
63030519Ssam 	dk = &dksoftc[vi->ui_unit];
63130756Skarels #ifndef SECSIZE
63230756Skarels 	sn = bp->b_blkno << dk->dk_bshift;
63330756Skarels #else SECSIZE
63430573Skarels 	sn = bp->b_blkno;
63530756Skarels #endif SECSIZE
63630519Ssam 	lp = &dklabel[vi->ui_unit];
63730519Ssam 	sn %= lp->d_secpercyl;
63830519Ssam 	tn = sn / lp->d_nsectors;
63930519Ssam 	sn %= lp->d_nsectors;
64030519Ssam 
64130519Ssam 	/*
64230519Ssam 	 * Construct dcb for read/write command.
64330519Ssam 	 */
64430519Ssam 	vd = &vdsoftc[vm->um_ctlr];
64530519Ssam 	vd->vd_dcb.intflg = DCBINT_DONE;
64632211Skarels 	vd->vd_dcb.devselect = dk->dk_dcb.devselect;
64730519Ssam 	vd->vd_dcb.operrsta = 0;
64830519Ssam 	vd->vd_dcb.nxtdcb = (struct dcb *)0;	/* end of chain */
64930519Ssam 	vd->vd_dcb.trail.rwtrail.disk.cylinder = bp->b_cylin;
65030519Ssam 	vd->vd_dcb.trail.rwtrail.disk.track = tn;
65130519Ssam 	vd->vd_dcb.trail.rwtrail.disk.sector = sn;
65230574Skarels 	dk->dk_curcyl = bp->b_cylin;
65330574Skarels 	bp->b_track = 0;		/* init overloaded field */
65430756Skarels 	vd->vd_dcb.trailcnt = sizeof (struct trrw) / sizeof (long);
65534396Skarels 	if (bp->b_flags & B_FORMAT)
65634396Skarels 		vd->vd_dcb.opcode = dk->dk_op;
65734396Skarels 	else if (vd->vd_flags & VD_SCATGATH &&
65834396Skarels 	    ((int)bp->b_un.b_addr & (sizeof(long) - 1)) == 0)
65930756Skarels 		vd->vd_dcb.opcode = (bp->b_flags & B_READ)? VDOP_RAS : VDOP_GAW;
66034396Skarels 	else
66130756Skarels 		vd->vd_dcb.opcode = (bp->b_flags & B_READ)? VDOP_RD : VDOP_WD;
66234396Skarels 
66334396Skarels 	switch (vd->vd_dcb.opcode) {
66434396Skarels 	case VDOP_FSECT:
66534396Skarels 		vd->vd_dcb.trailcnt = sizeof (struct trrw) / sizeof (long);
66634396Skarels 		vd->vd_dcb.trail.fmtrail.nsectors = bp->b_bcount /
66734396Skarels 		    lp->d_secsize;
66834396Skarels 		vd->vd_dcb.trail.fmtrail.hdr = *(dskadr *)&dk->dk_althdr;
66934396Skarels 		vd->vd_dcb.trail.rwtrail.disk.cylinder |= dk->dk_fmtflags;
67034396Skarels 		goto setupaddr;
67134396Skarels 
67234396Skarels 	case VDOP_RDRAW:
67334396Skarels 	case VDOP_RD:
67434396Skarels 	case VDOP_WD:
67534396Skarels 		vd->vd_dcb.trail.rwtrail.wcount = (bp->b_bcount+1) >> 1;
67634396Skarels setupaddr:
67730756Skarels 		vd->vd_dcb.trail.rwtrail.memadr =
67834528Skarels 			vbasetup(bp, &vd->vd_rbuf, (int)lp->d_secsize);
67934396Skarels 		break;
68034396Skarels 
68134396Skarels 	case VDOP_RAS:
68234396Skarels 	case VDOP_GAW:
68334396Skarels 		vd->vd_dcb.trailcnt += vba_sgsetup(bp, &vd->vd_rbuf,
68434396Skarels 		    &vd->vd_dcb.trail.sgtrail);
68534396Skarels 		break;
68630756Skarels 	}
68730574Skarels 	if (vi->ui_dk >= 0) {
68830574Skarels 		dk_busy |= 1<<vi->ui_dk;
68930574Skarels 		dk_xfer[vi->ui_dk]++;
69030574Skarels 		dk_wds[vi->ui_dk] += bp->b_bcount>>6;
69130574Skarels 	}
69230519Ssam 
69330519Ssam 	/*
69430519Ssam 	 * Look for any seeks to be performed on other drives on this
69530519Ssam 	 * controller.  If overlapped seeks exist, insert seek commands
69630519Ssam 	 * on the controller's command queue before the transfer.
69730519Ssam 	 */
69830519Ssam 	dcbp = &vd->vd_mdcb.mdcb_head;
69930519Ssam 
70030574Skarels 	if (dp == vm->um_tab.b_seekf)
70130574Skarels 		dp = dp->b_forw;
70230574Skarels 	else
70330574Skarels 		dp = vm->um_tab.b_seekf;
70430574Skarels 	for (; dp != NULL; dp = dp->b_forw) {
70530574Skarels 		if ((bp = dp->b_actf) == NULL)
70630574Skarels 			continue;
70730574Skarels 		vi = vddinfo[vdunit(bp->b_dev)];
70830574Skarels 		dk = &dksoftc[vi->ui_unit];
70930519Ssam 		dk->dk_curcyl = bp->b_cylin;
71030574Skarels 		if (vi->ui_dk >= 0)
71130574Skarels 			dk_seek[vi->ui_dk]++;
71230574Skarels 		dk->dk_dcb.operrsta = 0;
71330574Skarels 		dk->dk_dcb.trail.sktrail.skaddr.cylinder = bp->b_cylin;
71430574Skarels 		dk->dk_dcb.trail.sktrail.skaddr.track = bp->b_track;
71530574Skarels 		*dcbp = (struct dcb *)dk->dk_dcbphys;
71630574Skarels 		dcbp = &dk->dk_dcb.nxtdcb;
71724004Ssam 	}
71830519Ssam 	*dcbp = (struct dcb *)vd->vd_dcbphys;
71930574Skarels 	if (vm->um_tab.b_actf)
72030574Skarels 		vm->um_tab.b_actl->b_forw = vm->um_tab.b_seekf;
72130574Skarels 	else
72230574Skarels 		vm->um_tab.b_actf = vm->um_tab.b_seekf;
72330601Skarels 	if (vm->um_tab.b_seekf)
72430601Skarels 		vm->um_tab.b_actl = vm->um_tab.b_seekl;
72530574Skarels 	vm->um_tab.b_seekf = 0;
72624004Ssam 
72730519Ssam 	/*
72830519Ssam 	 * Initiate operation.
72930519Ssam 	 */
73030519Ssam 	vd->vd_mdcb.mdcb_status = 0;
73130519Ssam 	VDGO(vm->um_addr, vd->vd_mdcbphys, vd->vd_type);
73224004Ssam }
73324004Ssam 
73430519Ssam #define	DONTCARE (DCBS_DSE|DCBS_DSL|DCBS_TOP|DCBS_TOM|DCBS_FAIL|DCBS_DONE)
73524004Ssam /*
73624004Ssam  * Handle a disk interrupt.
73724004Ssam  */
73825675Ssam vdintr(ctlr)
73930519Ssam 	register ctlr;
74024004Ssam {
74130519Ssam 	register struct buf *bp, *dp;
74230519Ssam 	register struct vba_ctlr *vm = vdminfo[ctlr];
74330519Ssam 	register struct vba_device *vi;
74430519Ssam 	register struct vdsoftc *vd = &vdsoftc[ctlr];
74530519Ssam 	register status;
74634528Skarels 	int timedout;
74730573Skarels 	struct dksoftc *dk;
74824004Ssam 
74930519Ssam 	if (!vm->um_tab.b_active) {
75025675Ssam 		printf("vd%d: stray interrupt\n", ctlr);
75124004Ssam 		return;
75224004Ssam 	}
75325675Ssam 	/*
75430519Ssam 	 * Get device and block structures, and a pointer
75530519Ssam 	 * to the vba_device for the drive.
75625675Ssam 	 */
75730519Ssam 	dp = vm->um_tab.b_actf;
75830519Ssam 	bp = dp->b_actf;
75930519Ssam 	vi = vddinfo[vdunit(bp->b_dev)];
76034528Skarels 	dk = &dksoftc[vi->ui_unit];
76130574Skarels 	if (vi->ui_dk >= 0)
76230574Skarels 		dk_busy &= ~(1<<vi->ui_dk);
76334396Skarels 	timedout = (vd->vd_wticks >= VDMAXTIME);
76430519Ssam 	/*
76530519Ssam 	 * Check for and process errors on
76630519Ssam 	 * either the drive or the controller.
76730519Ssam 	 */
76830519Ssam 	uncache(&vd->vd_dcb.operrsta);
76930519Ssam 	status = vd->vd_dcb.operrsta;
77034396Skarels 	if (bp->b_flags & B_FORMAT) {
77134396Skarels 		dk->dk_operrsta = status;
77234396Skarels 		uncache(&vd->vd_dcb.err_code);
77334396Skarels 		dk->dk_ecode = vd->vd_dcb.err_code;
77434396Skarels 	}
77534396Skarels 	if (status & VDERR_HARD || timedout) {
77634528Skarels 		if (vd->vd_type == VDTYPE_SMDE)
77730601Skarels 			uncache(&vd->vd_dcb.err_code);
77830519Ssam 		if (status & DCBS_WPT) {
77930519Ssam 			/*
78030519Ssam 			 * Give up on write locked devices immediately.
78130519Ssam 			 */
78230573Skarels 			printf("dk%d: write locked\n", vi->ui_unit);
78330519Ssam 			bp->b_flags |= B_ERROR;
78434396Skarels 		} else if (status & VDERR_RETRY || timedout) {
78532211Skarels 			int endline = 1;
78632211Skarels 
78734396Skarels 			if (status & VDERR_CTLR || timedout) {
78834396Skarels 				vdharderr("controller err",
78934396Skarels 				    vd, bp, &vd->vd_dcb);
79034396Skarels 				printf("; resetting controller...");
79134396Skarels 				vdreset_ctlr(vm);
79234396Skarels 			} else if (status & VDERR_DRIVE) {
79334396Skarels 				vdharderr("drive err", vd, bp, &vd->vd_dcb);
79434396Skarels 				printf("; resetting drive...");
79530519Ssam 				if (!vdreset_drive(vi))
79630519Ssam 					vi->ui_alive = 0;
79732211Skarels 			} else
79832211Skarels 				endline = 0;
79930519Ssam 			/*
80030519Ssam 			 * Retry transfer once, unless reset failed.
80130519Ssam 			 */
80234396Skarels 			if (!vi->ui_alive || dp->b_errcnt++ >= 2 ||
80334396Skarels 			    bp->b_flags & B_FORMAT) {
80432211Skarels 				if (endline)
80532211Skarels 					printf("\n");
80630519Ssam 				goto hard;
80732211Skarels 			}
80832211Skarels 
80932211Skarels 			if (endline)
81032211Skarels 				printf(" retrying\n");
81130519Ssam 			vm->um_tab.b_active = 0;	/* force retry */
81230519Ssam 		} else  {
81330519Ssam 	hard:
81430519Ssam 			bp->b_flags |= B_ERROR;
81534396Skarels 			vdharderr("hard error", vd, bp, &vd->vd_dcb);
81630519Ssam 			printf("\n");
81730519Ssam 		}
81830519Ssam 	} else if (status & DCBS_SOFT)
81934528Skarels 		vdsofterr(bp, &vd->vd_dcb);
82034396Skarels 	vd->vd_wticks = 0;
82130519Ssam 	if (vm->um_tab.b_active) {
82230519Ssam 		vm->um_tab.b_active = 0;
82330519Ssam 		vm->um_tab.b_actf = dp->b_forw;
82430519Ssam 		dp->b_active = 0;
82530519Ssam 		dp->b_errcnt = 0;
82630519Ssam 		dp->b_actf = bp->av_forw;
82730519Ssam 		bp->b_resid = 0;
82830601Skarels 		vbadone(bp, &vd->vd_rbuf);
82930519Ssam 		biodone(bp);
83030370Skarels 		/*
83130519Ssam 		 * If this unit has more work to do,
83230519Ssam 		 * then start it up right away.
83330370Skarels 		 */
83430519Ssam 		if (dp->b_actf)
83530519Ssam 			vdustart(vi);
83634528Skarels 		else if (dk->dk_openpart == 0)
83730573Skarels 			wakeup((caddr_t)dk);
83824004Ssam 	}
83925675Ssam 	/*
84030519Ssam 	 * If there are devices ready to
84130519Ssam 	 * transfer, start the controller.
84225675Ssam 	 */
84330601Skarels 	if (vm->um_tab.b_actf || vm->um_tab.b_seekf)
84430519Ssam 		vdstart(vm);
84524004Ssam }
84624004Ssam 
84734396Skarels vdharderr(what, vd, bp, dcb)
84834396Skarels 	char *what;
84934396Skarels 	struct vdsoftc *vd;
85034396Skarels 	register struct buf *bp;
85134396Skarels 	register struct dcb *dcb;
85234396Skarels {
85334396Skarels 	int unit = vdunit(bp->b_dev), status = dcb->operrsta;
85434396Skarels 	register struct disklabel *lp = &dklabel[unit];
85534528Skarels 	int blkdone;
85634396Skarels 
85734396Skarels 	if (vd->vd_wticks < VDMAXTIME)
85834396Skarels 		status &= ~DONTCARE;
85934710Skarels 	blkdone = ((((dcb->err_cyl & 0xfff) * lp->d_ntracks + dcb->err_trk) *
86034710Skarels 	    lp->d_nsectors + dcb->err_sec -
86134710Skarels 	    lp->d_partitions[vdpart(bp->b_dev)].p_offset) >>
86234710Skarels 	    dksoftc[unit].dk_bshift) - bp->b_blkno;
86334528Skarels 	diskerr(bp, "dk", what, LOG_PRINTF, blkdone, lp);
86434528Skarels 	printf(", status %b", status, VDERRBITS);
86534396Skarels 	if (vd->vd_type == VDTYPE_SMDE)
86634396Skarels 		printf(" ecode %x", dcb->err_code);
86734396Skarels }
86834396Skarels 
86934528Skarels vdsofterr(bp, dcb)
87025675Ssam 	register struct buf *bp;
87130519Ssam 	register struct dcb *dcb;
87225675Ssam {
87334562Skarels 	int unit = vdunit(bp->b_dev);
87434562Skarels 	struct disklabel *lp = &dklabel[unit];
87534528Skarels 	int status = dcb->operrsta;
87634528Skarels 	int blkdone;
87725675Ssam 
87834710Skarels 	blkdone = ((((dcb->err_cyl & 0xfff) * lp->d_ntracks + dcb->err_trk) *
87934710Skarels 	    lp->d_nsectors + dcb->err_sec -
88034710Skarels 	    lp->d_partitions[vdpart(bp->b_dev)].p_offset) >>
88134710Skarels 	    dksoftc[unit].dk_bshift) - bp->b_blkno;
88234528Skarels 
88334528Skarels 	if (status != (DCBS_CCD|DCBS_SOFT|DCBS_ERR|DCBS_DONE)) {
88434528Skarels 		diskerr(bp, "dk", "soft error", LOG_WARNING, blkdone, lp);
88534528Skarels 		addlog(", status %b ecode %x\n", status, VDERRBITS,
88634396Skarels 		    dcb->err_code);
88734528Skarels 	} else {
88834528Skarels 		diskerr(bp, "dk", "soft ecc", LOG_WARNING, blkdone, lp);
88934528Skarels 		addlog("\n");
89034528Skarels 	}
89125675Ssam }
89225675Ssam 
89330519Ssam vdioctl(dev, cmd, data, flag)
89425675Ssam 	dev_t dev;
89530519Ssam 	int cmd;
89630519Ssam 	caddr_t data;
89730519Ssam 	int flag;
89824004Ssam {
89932576Skarels 	register int unit = vdunit(dev);
90030519Ssam 	register struct disklabel *lp = &dklabel[unit];
90134076Skarels 	register struct dksoftc *dk = &dksoftc[unit];
90234640Skarels 	int error = 0, vdformat();
90324004Ssam 
90430519Ssam 	switch (cmd) {
90530519Ssam 
90630519Ssam 	case DIOCGDINFO:
90730519Ssam 		*(struct disklabel *)data = *lp;
90830519Ssam 		break;
90930519Ssam 
91030573Skarels 	case DIOCGPART:
91130573Skarels 		((struct partinfo *)data)->disklab = lp;
91230573Skarels 		((struct partinfo *)data)->part =
91330573Skarels 		    &lp->d_partitions[vdpart(dev)];
91430519Ssam 		break;
91530519Ssam 
91630519Ssam 	case DIOCSDINFO:
91730519Ssam 		if ((flag & FWRITE) == 0)
91830519Ssam 			error = EBADF;
91930519Ssam 		else
92032576Skarels 			error = setdisklabel(lp, (struct disklabel *)data,
92134076Skarels 			    (dk->dk_state == OPENRAW) ? 0 : dk->dk_openpart);
92234396Skarels 		if (error == 0 && dk->dk_state == OPENRAW &&
92334396Skarels 		    vdreset_drive(vddinfo[unit]))
92434076Skarels 			dk->dk_state = OPEN;
92530519Ssam 		break;
92630519Ssam 
92734076Skarels 	case DIOCWLABEL:
92834076Skarels 		if ((flag & FWRITE) == 0)
92934076Skarels 			error = EBADF;
93034076Skarels 		else
93134076Skarels 			dk->dk_wlabel = *(int *)data;
93234076Skarels 		break;
93334076Skarels 
93432576Skarels 	case DIOCWDINFO:
93532576Skarels 		if ((flag & FWRITE) == 0)
93630519Ssam 			error = EBADF;
93732576Skarels 		else if ((error = setdisklabel(lp, (struct disklabel *)data,
93834076Skarels 		    (dk->dk_state == OPENRAW) ? 0 : dk->dk_openpart)) == 0) {
93934640Skarels 			int wlab;
94034640Skarels 
94134076Skarels 			dk->dk_state = OPEN;
94234640Skarels 			/* simulate opening partition 0 so write succeeds */
94334640Skarels 			dk->dk_openpart |= (1 << 0);		/* XXX */
94434640Skarels 			wlab = dk->dk_wlabel;
94534640Skarels 			dk->dk_wlabel = 1;
94632576Skarels 			error = writedisklabel(dev, vdstrategy, lp);
94734640Skarels 			dk->dk_openpart = dk->dk_copenpart | dk->dk_bopenpart;
94834640Skarels 			dk->dk_wlabel = wlab;
94934076Skarels 		}
95030519Ssam 		break;
95130519Ssam 
95234396Skarels 	case DIOCWFORMAT:
95334396Skarels 	    {
95434396Skarels 		register struct format_op *fop;
95534396Skarels 		struct uio auio;
95634396Skarels 		struct iovec aiov;
95734396Skarels 
95834396Skarels 		if ((flag & FWRITE) == 0) {
95934396Skarels 			error = EBADF;
96034396Skarels 			break;
96134396Skarels 		}
96234396Skarels 		fop = (struct format_op *)data;
96334396Skarels 		aiov.iov_base = fop->df_buf;
96434396Skarels 		aiov.iov_len = fop->df_count;
96534396Skarels 		auio.uio_iov = &aiov;
96634396Skarels 		auio.uio_iovcnt = 1;
96734396Skarels 		auio.uio_resid = fop->df_count;
96834396Skarels 		auio.uio_segflg = UIO_USERSPACE;
96934396Skarels 		auio.uio_offset = fop->df_startblk * lp->d_secsize;
97034396Skarels 		dk->dk_operrsta = fop->dk_operrsta;
97134396Skarels 		dk->dk_ecode = fop->dk_ecode;
97234396Skarels 		/*
97334396Skarels 		 * Don't return errors, as the format op won't get copied
97434396Skarels 		 * out if we return nonzero.  Callers must check the returned
97534396Skarels 		 * count.
97634396Skarels 		 */
97734396Skarels 		(void) physio(vdformat, (struct buf *)NULL, dev,
97834396Skarels 		    (cmd == DIOCWFORMAT ? B_WRITE : B_READ), minphys, &auio);
97934396Skarels 		fop->df_count -= auio.uio_resid;
98034396Skarels 		fop->dk_operrsta = dk->dk_operrsta;
98134396Skarels 		fop->dk_ecode = dk->dk_ecode;
98234396Skarels 		break;
98334396Skarels 	    }
98434396Skarels 
98530519Ssam 	default:
98630519Ssam 		error = ENOTTY;
98730519Ssam 		break;
98824004Ssam 	}
98932606Skarels 	return (error);
99024004Ssam }
99124004Ssam 
99234396Skarels vdformat(bp)
99334396Skarels 	struct buf *bp;
99434396Skarels {
99534396Skarels 	bp->b_flags |= B_FORMAT;
99634396Skarels 	vdstrategy(bp);
99734396Skarels }
99834396Skarels 
99925675Ssam /*
100030519Ssam  * Watch for lost interrupts.
100125675Ssam  */
100230519Ssam vdwatch()
100330519Ssam {
100430519Ssam 	register struct vdsoftc *vd;
100530519Ssam 	register struct vba_ctlr *vm;
100634528Skarels 	register int ctlr;
100734396Skarels 	int s;
100830519Ssam 
100930519Ssam 	timeout(vdwatch, (caddr_t)0, hz);
101030519Ssam 	for (ctlr = 0; ctlr < NVD; ctlr++) {
101130519Ssam 		vm = vdminfo[ctlr];
101230519Ssam 		if (vm == 0 || vm->um_alive == 0)
101330519Ssam 			continue;
101430519Ssam 		vd = &vdsoftc[ctlr];
101534396Skarels 		s = spl7();
101634396Skarels 		if (vm->um_tab.b_active && vd->vd_wticks++ >= VDMAXTIME) {
101730519Ssam 			printf("vd%d: lost interrupt\n", ctlr);
101834396Skarels #ifdef maybe
101934396Skarels 			VDABORT((struct vddevice *)vm->um_addr, vd->vd_type);
102034396Skarels #endif
102134396Skarels 			vdintr(ctlr);
102230519Ssam 		}
102334396Skarels 		splx(s);
102430519Ssam 	}
102530519Ssam }
102630519Ssam 
102730519Ssam #define	DBSIZE	64	/* controller limit with 1K sectors */
102830519Ssam /*
102930519Ssam  * Crash dump.
103030519Ssam  */
103130519Ssam vddump(dev)
103230519Ssam 	dev_t dev;
103324004Ssam {
103430519Ssam 	register struct vba_device *vi;
103530519Ssam 	register struct vba_ctlr *vm;
103630519Ssam 	register struct disklabel *lp;
103730519Ssam 	register struct vdsoftc *vd;
103830519Ssam 	struct dksoftc *dk;
103930519Ssam 	int part, unit, num;
104030601Skarels 	u_long start;
104124004Ssam 
104230519Ssam 	start = 0;
104330519Ssam 	unit = vdunit(dev);
104430519Ssam 	if (unit > NDK || (vi = vddinfo[unit]) == 0 || vi->ui_alive == 0)
104530519Ssam 		return (ENXIO);
104630519Ssam 	dk = &dksoftc[unit];
104734076Skarels 	if (dk->dk_state != OPEN && dk->dk_state != OPENRAW &&
104834076Skarels 	    vdinit(vdminor(unit, 0), 0) != 0)
104930519Ssam 		return (ENXIO);
105030519Ssam 	lp = &dklabel[unit];
105130519Ssam 	part = vdpart(dev);
105230519Ssam 	if (part >= lp->d_npartitions)
105330519Ssam 		return (ENXIO);
105432211Skarels 	vm = vi->ui_mi;
105530519Ssam 	vdreset_ctlr(vm);
105630519Ssam 	if (dumplo < 0)
105730519Ssam 		return (EINVAL);
105830519Ssam 	/*
105930756Skarels 	 * Maxfree is in pages, dumplo is in DEV_BSIZE units.
106030519Ssam 	 */
106130519Ssam 	num = maxfree * (NBPG / lp->d_secsize);
106230756Skarels 	dumplo *= DEV_BSIZE / lp->d_secsize;
106330519Ssam 	if (dumplo + num >= lp->d_partitions[vdpart(dev)].p_size)
106430519Ssam 		num = lp->d_partitions[vdpart(dev)].p_size - dumplo;
106530519Ssam 	vd = &vdsoftc[vm->um_ctlr];
106630519Ssam 	vd->vd_dcb.intflg = DCBINT_NONE;
106730519Ssam 	vd->vd_dcb.opcode = VDOP_WD;
106832211Skarels 	vd->vd_dcb.devselect = dk->dk_dcb.devselect;
106930756Skarels 	vd->vd_dcb.trailcnt = sizeof (struct trrw) / sizeof (long);
107030519Ssam 	while (num > 0) {
107130519Ssam 		int nsec, cn, sn, tn;
107230519Ssam 
107330519Ssam 		nsec = MIN(num, DBSIZE);
107430601Skarels 		sn = dumplo + start / lp->d_secsize;
107530519Ssam 		cn = (sn + lp->d_partitions[vdpart(dev)].p_offset) /
107630519Ssam 		    lp->d_secpercyl;
107730519Ssam 		sn %= lp->d_secpercyl;
107830519Ssam 		tn = sn / lp->d_nsectors;
107930519Ssam 		sn %= lp->d_nsectors;
108030519Ssam 		vd->vd_mdcb.mdcb_head = (struct dcb *)vd->vd_dcbphys;
108130519Ssam 		vd->vd_dcb.trail.rwtrail.memadr = start;
108230519Ssam 		vd->vd_dcb.trail.rwtrail.wcount = (nsec * lp->d_secsize) >> 1;
108330519Ssam 		vd->vd_dcb.trail.rwtrail.disk.cylinder = cn;
108430519Ssam 		vd->vd_dcb.trail.rwtrail.disk.track = tn;
108530519Ssam 		vd->vd_dcb.trail.rwtrail.disk.sector = sn;
108630519Ssam 		vd->vd_dcb.operrsta = 0;
108730519Ssam 		VDGO(vm->um_addr, vd->vd_mdcbphys, vd->vd_type);
108830519Ssam 		if (!vdpoll(vm, 5)) {
108930519Ssam 			printf(" during dump\n");
109030519Ssam 			return (EIO);
109130519Ssam 		}
109230519Ssam 		if (vd->vd_dcb.operrsta & VDERR_HARD) {
109330519Ssam 			printf("dk%d: hard error, status=%b\n", unit,
109430519Ssam 			    vd->vd_dcb.operrsta, VDERRBITS);
109530519Ssam 			return (EIO);
109630519Ssam 		}
109730519Ssam 		start += nsec * lp->d_secsize;
109830519Ssam 		num -= nsec;
109925675Ssam 	}
110030519Ssam 	return (0);
110124004Ssam }
110224004Ssam 
110324004Ssam vdsize(dev)
110425675Ssam 	dev_t dev;
110524004Ssam {
110630519Ssam 	register int unit = vdunit(dev);
110730519Ssam 	register struct dksoftc *dk;
110830519Ssam 	struct vba_device *vi;
110930519Ssam 	struct disklabel *lp;
111024004Ssam 
111130519Ssam 	if (unit >= NDK || (vi = vddinfo[unit]) == 0 || vi->ui_alive == 0 ||
111230519Ssam 	    (dk = &dksoftc[unit])->dk_state != OPEN)
111325675Ssam 		return (-1);
111430519Ssam 	lp = &dklabel[unit];
111530756Skarels #ifdef SECSIZE
111630573Skarels 	return ((int)lp->d_partitions[vdpart(dev)].p_size);
111730756Skarels #else SECSIZE
111830756Skarels 	return ((int)lp->d_partitions[vdpart(dev)].p_size >> dk->dk_bshift);
111930756Skarels #endif SECSIZE
112024004Ssam }
112124004Ssam 
112225675Ssam /*
112325675Ssam  * Perform a controller reset.
112425675Ssam  */
112530519Ssam vdreset_ctlr(vm)
112630519Ssam 	register struct vba_ctlr *vm;
112724004Ssam {
112830519Ssam 	register struct vddevice *vdaddr = (struct vddevice *)vm->um_addr;
112930519Ssam 	register struct vdsoftc *vd = &vdsoftc[vm->um_ctlr];
113030519Ssam 	register int unit;
113130519Ssam 	struct vba_device *vi;
113225675Ssam 
113330519Ssam 	VDRESET(vdaddr, vd->vd_type);
113430519Ssam 	if (vd->vd_type == VDTYPE_SMDE) {
113530519Ssam 		vdaddr->vdcsr = 0;
113630519Ssam 		vdaddr->vdtcf_mdcb = AM_ENPDA;
113730519Ssam 		vdaddr->vdtcf_dcb = AM_ENPDA;
113830519Ssam 		vdaddr->vdtcf_trail = AM_ENPDA;
113930519Ssam 		vdaddr->vdtcf_data = AM_ENPDA;
114030519Ssam 		vdaddr->vdccf = CCF_STS | XMD_32BIT | BSZ_16WRD |
114125675Ssam 		    CCF_ENP | CCF_EPE | CCF_EDE | CCF_ECE | CCF_ERR;
114225675Ssam 	}
114330519Ssam 	if (!vdcmd(vm, VDOP_INIT, 10) || !vdcmd(vm, VDOP_DIAG, 10)) {
114430519Ssam 		printf("%s cmd failed\n",
114530519Ssam 		    vd->vd_dcb.opcode == VDOP_INIT ? "init" : "diag");
114630370Skarels 		return;
114725675Ssam 	}
114830519Ssam 	for (unit = 0; unit < NDK; unit++)
114930519Ssam 		if ((vi = vddinfo[unit])->ui_mi == vm && vi->ui_alive)
115030519Ssam 			(void) vdreset_drive(vi);
115130519Ssam }
115230519Ssam 
115330519Ssam vdreset_drive(vi)
115430519Ssam 	register struct vba_device *vi;
115530519Ssam {
115630519Ssam 	register struct disklabel *lp = &dklabel[vi->ui_unit];
115730519Ssam 	struct vba_ctlr *vm = vdminfo[vi->ui_ctlr];
115830519Ssam 	struct vddevice *vdaddr = (struct vddevice *)vm->um_addr;
115932211Skarels 	register struct vdsoftc *vd = &vdsoftc[vi->ui_ctlr];
116032211Skarels 	register struct dksoftc *dk = &dksoftc[vi->ui_unit];
116130519Ssam 
116230519Ssam top:
116330519Ssam 	vd->vd_dcb.opcode = VDOP_CONFIG;		/* command */
116430519Ssam 	vd->vd_dcb.intflg = DCBINT_NONE;
116530519Ssam 	vd->vd_dcb.nxtdcb = (struct dcb *)0;	/* end of chain */
116630519Ssam 	vd->vd_dcb.operrsta = 0;
116732211Skarels 	vd->vd_dcb.devselect = vi->ui_slave | lp->d_devflags;
116830519Ssam 	vd->vd_dcb.trail.rstrail.ncyl = lp->d_ncylinders;
116930519Ssam 	vd->vd_dcb.trail.rstrail.nsurfaces = lp->d_ntracks;
117030519Ssam 	if (vd->vd_type == VDTYPE_SMDE) {
117130756Skarels 		vd->vd_dcb.trailcnt = sizeof (struct treset) / sizeof (long);
117230519Ssam 		vd->vd_dcb.trail.rstrail.nsectors = lp->d_nsectors;
117330601Skarels 		vd->vd_dcb.trail.rstrail.slip_sec = lp->d_sparespertrack;
117432211Skarels 		vd->vd_dcb.trail.rstrail.recovery = VDRF_NORMAL;
117530519Ssam 	} else
117630519Ssam 		vd->vd_dcb.trailcnt = 2;		/* XXX */
117730519Ssam 	vd->vd_mdcb.mdcb_head = (struct dcb *)vd->vd_dcbphys;
117830519Ssam 	vd->vd_mdcb.mdcb_status = 0;
117930519Ssam 	VDGO(vdaddr, vd->vd_mdcbphys, vd->vd_type);
118030519Ssam 	if (!vdpoll(vm, 5)) {
118130519Ssam 		printf(" during config\n");
118230519Ssam 		return (0);
118325675Ssam 	}
118430519Ssam 	if (vd->vd_dcb.operrsta & VDERR_HARD) {
118532211Skarels 		if (vd->vd_type == VDTYPE_SMDE) {
118632211Skarels 			if (lp->d_devflags == 0) {
118732211Skarels 				lp->d_devflags = VD_ESDI;
118832211Skarels 				goto top;
118932211Skarels 			}
119032211Skarels #ifdef notdef
119132211Skarels 			/* this doesn't work, STA_US isn't set(?) */
119232211Skarels 			if ((vdaddr->vdstatus[vi->ui_slave] & STA_US) == 0)
119332211Skarels 				return (0);
119432211Skarels #endif
119532211Skarels 		}
119630519Ssam 		if ((vd->vd_dcb.operrsta & (DCBS_OCYL|DCBS_NRDY)) == 0)
119732211Skarels 			printf("dk%d: config error %b ecode %x\n", vi->ui_unit,
119834396Skarels 			   vd->vd_dcb.operrsta, VDERRBITS,
119934396Skarels 			   (u_char) vd->vd_dcb.err_code);
120032211Skarels 		else if ((vd->vd_flags & VD_STARTED) == 0) {
120130519Ssam 			int started;
120230519Ssam 
120332211Skarels 			printf(" starting drives, wait ... ");
120430519Ssam 			vd->vd_flags |= VD_STARTED;
120530519Ssam 			started = (vdcmd(vm, VDOP_START, 10) == 1);
120630519Ssam 			DELAY(62000000);
120732211Skarels 			printf("done");
120832211Skarels 			lp->d_devflags = 0;
120930519Ssam 			if (started)
121030519Ssam 				goto top;
121130519Ssam 		}
121230519Ssam 		return (0);
121330519Ssam 	}
121432211Skarels 	dk->dk_dcb.devselect |= lp->d_devflags;
121530519Ssam 	return (1);
121625675Ssam }
121724004Ssam 
121825675Ssam /*
121930519Ssam  * Perform a command w/o trailer.
122025675Ssam  */
122130519Ssam vdcmd(vm, cmd, t)
122230519Ssam 	register struct vba_ctlr *vm;
122325675Ssam {
122430519Ssam 	register struct vdsoftc *vd = &vdsoftc[vm->um_ctlr];
122525675Ssam 
122630519Ssam 	vd->vd_dcb.opcode = cmd;		/* command */
122730519Ssam 	vd->vd_dcb.intflg = DCBINT_NONE;
122830519Ssam 	vd->vd_dcb.nxtdcb = (struct dcb *)0;	/* end of chain */
122930519Ssam 	vd->vd_dcb.operrsta = 0;
123030519Ssam 	vd->vd_dcb.devselect = 0;
123130519Ssam 	vd->vd_dcb.trailcnt = 0;
123230519Ssam 	vd->vd_mdcb.mdcb_head = (struct dcb *)vd->vd_dcbphys;
123330519Ssam 	vd->vd_mdcb.mdcb_status = 0;
123430519Ssam 	VDGO(vm->um_addr, vd->vd_mdcbphys, vd->vd_type);
123530519Ssam 	if (!vdpoll(vm, t)) {
123630519Ssam 		printf(" during init\n");
123730370Skarels 		return (0);
123830370Skarels 	}
123930519Ssam 	return ((vd->vd_dcb.operrsta&VDERR_HARD) == 0);
124025675Ssam }
124125675Ssam 
124225925Ssam /*
124330519Ssam  * Poll controller until operation
124430519Ssam  * completes or timeout expires.
124525925Ssam  */
124630519Ssam vdpoll(vm, t)
124730519Ssam 	register struct vba_ctlr *vm;
124825925Ssam 	register int t;
124925925Ssam {
125030519Ssam 	register struct vdsoftc *vd = &vdsoftc[vm->um_ctlr];
125130519Ssam 	register struct vddevice *vdaddr = (struct vddevice *)vm->um_addr;
125225925Ssam 
125325925Ssam 	t *= 1000;
125430370Skarels 	for (;;) {
125530519Ssam 		uncache(&vd->vd_dcb.operrsta);
125630519Ssam 		if (vd->vd_dcb.operrsta & (DCBS_DONE|DCBS_ABORT))
125730370Skarels 			break;
125825925Ssam 		if (--t <= 0) {
125930519Ssam 			printf("vd%d: controller timeout", vm->um_ctlr);
126030519Ssam 			VDABORT(vdaddr, vd->vd_type);
126125925Ssam 			return (0);
126225925Ssam 		}
126330370Skarels 		DELAY(1000);
126425925Ssam 	}
126530519Ssam 	if (vd->vd_type == VDTYPE_SMDE) {
126630519Ssam 		do {
126725925Ssam 			DELAY(50);
126830519Ssam 			uncache(&vdaddr->vdcsr);
126930519Ssam 		} while (vdaddr->vdcsr & CS_GO);
127032211Skarels 	 	DELAY(300);
127132211Skarels 		uncache(&vd->vd_dcb.err_code);
127225925Ssam 	}
127325925Ssam 	DELAY(200);
127430519Ssam 	uncache(&vd->vd_dcb.operrsta);
127525925Ssam 	return (1);
127625925Ssam }
127725925Ssam 
127830519Ssam #ifdef COMPAT_42
127930519Ssam struct	vdst {
128030519Ssam 	int	nsec;		/* sectors/track */
128130519Ssam 	int	ntrack;		/* tracks/cylinder */
128230519Ssam 	int	ncyl;		/* cylinders */
128332211Skarels 	int	secsize;	/* sector size */
128430519Ssam 	char	*name;		/* type name */
128530519Ssam 	struct {
128630519Ssam 		int	off;	/* partition offset in sectors */
128730519Ssam 		int	size;	/* partition size in sectors */
128830573Skarels 	} parts[8];
128930519Ssam } vdst[] = {
129032211Skarels 	{ 66, 23, 850, 512, "NEC 800",
129132211Skarels 		{0,	 1290300},	/* a cyl   0 - 849 */
129232211Skarels 	},
129334737Sbostic 	{ 64, 20, 842, 512, "2361a",
129434737Sbostic 		{0,	 61440},	/* a cyl   0 - 47 */
129534737Sbostic 		{61440,	 67840},	/* b cyl  48 - 100 */
129634737Sbostic 		{129280, 942080}, 	/* c cyl 101 - 836 */
129734737Sbostic 		{0,      1071360}, 	/* d cyl   0 - 836 */
129834737Sbostic 		{449280, 311040},	/* e cyl 351 - 593 */
129934737Sbostic 		{760320, 311040}, 	/* f cyl 594 - 836 */
130034737Sbostic 		{449280, 622080},	/* g cyl 351 - 836 */
130134737Sbostic 		{129280, 320000}	/* h cyl 101 - 350 */
130234737Sbostic 	},
130332211Skarels 	{ 48, 24, 711, 512, "xsd",
130431039Skarels 		{0,	 61056},	/* a cyl   0 - 52 */
130531039Skarels 		{61056,	 61056},	/* b cyl  53 - 105 */
130631039Skarels 		{122112, 691200}, 	/* c cyl 106 - 705 */
130731039Skarels 		{237312, 576000}, 	/* d cyl 206 - 705 */
130831039Skarels 		{352512, 460800},	/* e cyl 306 - 705 */
130931039Skarels 		{467712, 345600}, 	/* f cyl 406 - 705 */
131031039Skarels 		{582912, 230400},	/* g cyl 506 - 705 */
131131039Skarels 		{698112, 115200}	/* h cyl 606 - 705 */
131230573Skarels 	},
131332211Skarels 	{ 44, 20, 842, 512, "eagle",
131430601Skarels 		{0,	 52800},	/* egl0a cyl   0 - 59 */
131530601Skarels 		{52800,	 66000},	/* egl0b cyl  60 - 134 */
131630601Skarels 		{118800, 617760}, 	/* egl0c cyl 135 - 836 */
131730756Skarels 		{736560, 4400}, 	/* egl0d cyl 837 - 841 */
131831039Skarels 		{0, 	 736560},	/* egl0e cyl   0 - 836 */
131931039Skarels 		{0, 	 740960}, 	/* egl0f cyl   0 - 841 */
132030601Skarels 		{118800, 310640},	/* egl0g cyl 135 - 487 */
132130601Skarels 		{429440, 307120}	/* egl0h cyl 488 - 836 */
132230573Skarels 	},
132332211Skarels 	{ 64, 10, 823, 512, "fuj",
132431039Skarels 		{0,	 38400},	/* fuj0a cyl   0 - 59 */
132531039Skarels 		{38400,	 48000},	/* fuj0b cyl  60 - 134 */
132631039Skarels 		{86400,	 437120}, 	/* fuj0c cyl 135 - 817 */
132731039Skarels 		{159360, 364160}, 	/* fuj0d cyl 249 - 817 */
132831039Skarels 		{232320, 291200},	/* fuj0e cyl 363 - 817 */
132931039Skarels 		{305280, 218240}, 	/* fuj0f cyl 477 - 817 */
133031039Skarels 		{378240, 145280},	/* fuj0g cyl 591 - 817 */
133131039Skarels 		{451200, 72320}		/* fug0h cyl 705 - 817 */
133230573Skarels 	},
133332211Skarels 	{ 32, 24, 711, 512, "xfd",
133430756Skarels 		{ 0,	 40704 },	/* a cyl   0 - 52 */
133530756Skarels 		{ 40704, 40704 },	/* b cyl  53 - 105 */
133630756Skarels 		{ 81408, 460800 },	/* c cyl 106 - 705 */
133730756Skarels 		{ 0,	 81408 },	/* d cyl 709 - 710 (a & b) */
133830756Skarels 		{ 0,	 542208 },	/* e cyl   0 - 705 */
133930756Skarels 		{ 40704, 501504 },	/* f cyl  53 - 705 (b & c) */
134030756Skarels 		{ 81408, 230400 },	/* g cyl 106 - 405 (1/2 of c) */
134130756Skarels 		{ 311808,230400 }	/* h cyl 406 - 705 (1/2 of c) */
134230573Skarels 	},
134332211Skarels 	{ 32, 19, 823, 512, "smd",
134431039Skarels 		{0,	 40128},	/* a cyl   0-65 */
134531039Skarels 		{40128,  27360},	/* b cyl  66-110 */
134631039Skarels 		{67488,  429856},	/* c cyl 111-817 */
134731039Skarels 		{139232, 358112},	/* d cyl 229 - 817 */
134831039Skarels 		{210976, 286368},	/* e cyl 347 - 817 */
134931039Skarels 		{282720, 214624},	/* f cyl 465 - 817 */
135031039Skarels 		{354464, 142880},	/* g cyl 583 - 817 */
135131039Skarels 		{426208, 71136}		/* h cyl 701 - 817 */
135230573Skarels 	},
135332211Skarels 	{ 18, 15, 1224, 1024, "mxd",
135432211Skarels 		{0,	 21600},	/* a cyl   0-79 */
135532211Skarels 		{21600,  22410},	/* b cyl  80-162 */
135632211Skarels 		{44010,  285120},	/* c cyl 163-1217 */
135732211Skarels #ifdef notyet
135832211Skarels 		{x, 237600},	/* d cyl y - 1217 */
135932211Skarels 		{x, 190080},	/* e cyl y - 1217 */
136032211Skarels 		{x, 142560},	/* f cyl y - 1217 */
136132211Skarels 		{x, 95040},	/* g cyl y - 1217 */
136232211Skarels 		{x, 47520}		/* h cyl 701 - 817 */
136332211Skarels #endif
136432211Skarels 	},
136532211Skarels 	{ 32, 10, 823, 512, "fsd",
136630756Skarels 		{0,	 19200},	/* a cyl   0 -  59 */
136730756Skarels 		{19200,	 24000},	/* b cyl  60 - 134 */
136830756Skarels 		{43200,	 218560},	/* c cyl 135 - 817 */
136930573Skarels 	}
137030519Ssam };
137130519Ssam #define	NVDST	(sizeof (vdst) / sizeof (vdst[0]))
137230519Ssam 
137325675Ssam /*
137430519Ssam  * Construct a label for an unlabeled pack.  We
137530519Ssam  * deduce the drive type by reading from the last
137630519Ssam  * track on successively smaller drives until we
137730519Ssam  * don't get an error.
137825675Ssam  */
137930519Ssam vdmaptype(vi, lp)
138030519Ssam 	register struct vba_device *vi;
138130519Ssam 	register struct disklabel *lp;
138225675Ssam {
138330519Ssam 	register struct vdsoftc *vd;
138430519Ssam 	register struct vdst *p;
138532211Skarels 	struct vba_ctlr *vm = vi->ui_mi;
138630519Ssam 	int i;
138725675Ssam 
138830519Ssam 	vd = &vdsoftc[vi->ui_ctlr];
138930519Ssam 	for (p = vdst; p < &vdst[NVDST]; p++) {
139030519Ssam 		if (vd->vd_type == VDTYPE_VDDC && p->nsec != 32)
139130519Ssam 			continue;
139230519Ssam 		lp->d_nsectors = p->nsec;
139330519Ssam 		lp->d_ntracks = p->ntrack;
139430519Ssam 		lp->d_ncylinders = p->ncyl;
139532211Skarels 		lp->d_secsize = p->secsize;
139630519Ssam 		if (!vdreset_drive(vi))
139730519Ssam 			return (0);
139830519Ssam 		vd->vd_dcb.opcode = VDOP_RD;
139930519Ssam 		vd->vd_dcb.intflg = DCBINT_NONE;
140030519Ssam 		vd->vd_dcb.nxtdcb = (struct dcb *)0;	/* end of chain */
140132211Skarels 		vd->vd_dcb.devselect = dksoftc[vi->ui_unit].dk_dcb.devselect;
140230756Skarels 		vd->vd_dcb.trailcnt = sizeof (struct trrw) / sizeof (long);
140330601Skarels 		vd->vd_dcb.trail.rwtrail.memadr =
140430601Skarels 		    vtoph((struct proc *)0, (unsigned)vd->vd_rbuf.vb_rawbuf);
140532211Skarels 		vd->vd_dcb.trail.rwtrail.wcount = lp->d_secsize / sizeof(short);
140630519Ssam 		vd->vd_dcb.operrsta = 0;
140730519Ssam 		vd->vd_dcb.trail.rwtrail.disk.cylinder = p->ncyl - 2;
140830519Ssam 		vd->vd_dcb.trail.rwtrail.disk.track = p->ntrack - 1;
140930519Ssam 		vd->vd_dcb.trail.rwtrail.disk.sector = p->nsec - 1;
141030519Ssam 		vd->vd_mdcb.mdcb_head = (struct dcb *)vd->vd_dcbphys;
141130519Ssam 		vd->vd_mdcb.mdcb_status = 0;
141230519Ssam 		VDGO(vm->um_addr, vd->vd_mdcbphys, vd->vd_type);
141330519Ssam 		if (!vdpoll(vm, 60))
141430519Ssam 			printf(" during probe\n");
141530519Ssam 		if ((vd->vd_dcb.operrsta & VDERR_HARD) == 0)
141630519Ssam 			break;
141724004Ssam 	}
141832211Skarels 	if (p >= &vdst[NVDST])
141930519Ssam 		return (0);
142032211Skarels 
142130573Skarels 	for (i = 0; i < 8; i++) {
142230519Ssam 		lp->d_partitions[i].p_offset = p->parts[i].off;
142330519Ssam 		lp->d_partitions[i].p_size = p->parts[i].size;
142430519Ssam 	}
142530573Skarels 	lp->d_npartitions = 8;
142630519Ssam 	lp->d_secpercyl = lp->d_nsectors * lp->d_ntracks;
142730519Ssam 	lp->d_rpm = 3600;
142830519Ssam 	bcopy(p->name, lp->d_typename, 4);
142930519Ssam 	return (1);
143024004Ssam }
143130519Ssam #endif COMPAT_42
143224004Ssam #endif
1433