Home | History | Annotate | Line # | Download | only in ata
wd.c revision 1.62
      1 /*
      2  * Copyright (c) 1994 Charles Hannum.
      3  * Copyright (c) 1990 The Regents of the University of California.
      4  * All rights reserved.
      5  *
      6  * This code is derived from software contributed to Berkeley by
      7  * William Jolitz.
      8  *
      9  * Redistribution and use in source and binary forms, with or without
     10  * modification, are permitted provided that the following conditions
     11  * are met:
     12  * 1. Redistributions of source code must retain the above copyright
     13  *    notice, this list of conditions and the following disclaimer.
     14  * 2. Redistributions in binary form must reproduce the above copyright
     15  *    notice, this list of conditions and the following disclaimer in the
     16  *    documentation and/or other materials provided with the distribution.
     17  * 3. All advertising materials mentioning features or use of this software
     18  *    must display the following acknowledgement:
     19  *	This product includes software developed by the University of
     20  *	California, Berkeley and its contributors.
     21  * 4. Neither the name of the University nor the names of its contributors
     22  *    may be used to endorse or promote products derived from this software
     23  *    without specific prior written permission.
     24  *
     25  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     26  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     27  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     28  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     29  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     30  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     31  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     32  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     33  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     34  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     35  * SUCH DAMAGE.
     36  *
     37  *	from: @(#)wd.c	7.2 (Berkeley) 5/9/91
     38  *	$Id: wd.c,v 1.62 1994/03/07 03:18:35 mycroft Exp $
     39  */
     40 
     41 #define	INSTRUMENT	/* instrumentation stuff by Brad Parker */
     42 
     43 #include "wd.h"
     44 #if NWDC > 0
     45 
     46 #include <sys/param.h>
     47 #include <sys/dkbad.h>
     48 #include <sys/systm.h>
     49 #include <sys/kernel.h>
     50 #include <sys/conf.h>
     51 #include <sys/file.h>
     52 #include <sys/stat.h>
     53 #include <sys/ioctl.h>
     54 #include <sys/disklabel.h>
     55 #include <sys/buf.h>
     56 #include <sys/uio.h>
     57 #include <sys/malloc.h>
     58 #include <sys/syslog.h>
     59 #ifdef INSTRUMENT
     60 #include <sys/dkstat.h>
     61 #endif
     62 
     63 #include <vm/vm.h>
     64 
     65 #include <machine/cpu.h>
     66 #include <machine/cpufunc.h>
     67 #include <machine/pio.h>
     68 
     69 #include <i386/isa/isa.h>
     70 #include <i386/isa/isa_device.h>
     71 #include <i386/isa/icu.h>
     72 #include <i386/isa/wdreg.h>
     73 
     74 #define WDCNDELAY	100000	/* delay = 100us; so 10s for a controller state change */
     75 #define WDCDELAY	100
     76 
     77 #if 0
     78 /* if you enable this, it will report any delays more than 100us * N long */
     79 #define WDCNDELAY_DEBUG	100
     80 #endif
     81 
     82 #define	WDIORETRIES	5	/* number of retries before giving up */
     83 
     84 #define WDUNIT(dev)	((minor(dev) & 0xf8) >> 3)
     85 #define WDPART(dev)	((minor(dev) & 0x07)     )
     86 #define makewddev(maj, unit, part)	(makedev(maj, ((unit << 3) + part)))
     87 #define WDRAW	3		/* 'd' partition isn't a partition! */
     88 
     89 #define b_cylin	b_resid		/* cylinder number for doing IO to */
     90 				/* shares an entry in the buf struct */
     91 
     92 /*
     93  * Drive states.  Used to initialize drive.
     94  */
     95 #define	CLOSED		0		/* disk is closed. */
     96 #define	WANTOPEN	1		/* open requested, not started */
     97 #define	RECAL		2		/* doing restore */
     98 #define	OPEN		3		/* done with open */
     99 
    100 /*
    101  * Drive status.
    102  */
    103 struct	disk {
    104 	long	dk_bc;		/* byte count left */
    105 	long	dk_bct;		/* total byte count left */
    106 	short	dk_skip;	/* blocks already transferred */
    107 	short	dk_skipm;	/* blocks already transferred for multi */
    108 	char	dk_ctrlr;	/* physical controller number */
    109 	char	dk_unit;	/* physical unit number */
    110 	char	dk_lunit;	/* logical unit number */
    111 	char	dk_state;	/* control state */
    112 	int	dk_timeout;	/* timeout counter */
    113 	u_char	dk_status;	/* copy of status reg. */
    114 	u_char	dk_error;	/* copy of error reg. */
    115 	u_short	dk_port;	/* i/o port base */
    116 
    117 	u_long  dk_copenpart;   /* character units open on this drive */
    118 	u_long  dk_bopenpart;   /* block units open on this drive */
    119 	u_long  dk_openpart;    /* all units open on this drive */
    120 	short	dk_wlabel;	/* label writable? */
    121 	short	dk_flags;	/* drive characteistics found */
    122 #define	DKFL_SINGLE	0x00004	 /* sector at a time mode */
    123 #define	DKFL_ERROR	0x00008	 /* processing a disk error */
    124 #define	DKFL_BSDLABEL	0x00010	 /* has a BSD disk label */
    125 #define	DKFL_BADSECT	0x00020	 /* has a bad144 badsector table */
    126 #define	DKFL_WRITEPROT	0x00040	 /* manual unit write protect */
    127 	struct wdparams dk_params; /* ESDI/IDE drive/controller parameters */
    128 	struct disklabel dk_dd;	/* device configuration data */
    129 	struct cpu_disklabel dk_cpd;
    130 	long	dk_badsect[127];	/* 126 plus trailing -1 marker */
    131 };
    132 
    133 struct board {
    134 	short dkc_port;
    135 };
    136 
    137 struct	board	wdcontroller[NWDC];
    138 struct	disk	*wddrives[NWD];		/* table of units */
    139 struct	buf	wdtab[NWDC];		/* various per-controller info */
    140 struct	buf	wdutab[NWD];		/* head of queue per drive */
    141 struct	buf	rwdbuf[NWD];		/* buffers for raw IO */
    142 long	wdxfer[NWD];			/* count of transfers */
    143 
    144 int wdprobe(), wdattach();
    145 
    146 struct	isa_driver wdcdriver = {
    147 	wdprobe, wdattach, "wdc",
    148 };
    149 
    150 static void wdustart __P((struct disk *));
    151 static void wdstart __P((int));
    152 static int wdcommand __P((struct disk *, int, int, int, int, int));
    153 static int wdcontrol __P((struct buf *));
    154 static int wdsetctlr __P((struct disk *));
    155 static int wdgetctlr __P((struct disk *));
    156 static void bad144intern __P((struct disk *));
    157 static int wdreset __P((struct disk *, int));
    158 static void wdtimeout __P((caddr_t));
    159 void wddisksort __P((struct buf *dp, struct buf *bp));
    160 int wdc_wait __P((struct disk *, int));
    161 #define	wait_for_drq(d)		wdc_wait(d, WDCS_DRQ)
    162 #define	wait_for_ready(d)	wdc_wait(d, WDCS_READY | WDCS_SEEKCMPLT)
    163 #define	wait_for_unbusy(d)	wdc_wait(d, 0)
    164 
    165 /*
    166  * Probe for controller.
    167  */
    168 int
    169 wdprobe(isa_dev)
    170 	struct isa_device *isa_dev;
    171 {
    172 	struct disk *du;
    173 	u_short wdc;
    174 
    175 	if (isa_dev->id_unit >= NWDC)
    176 		return 0;
    177 
    178 	du = (struct disk *)malloc(sizeof(struct disk), M_TEMP, M_NOWAIT);
    179 	bzero(du, sizeof(struct disk));
    180 
    181 	du->dk_ctrlr = isa_dev->id_unit;
    182 	du->dk_unit = 0;
    183 	du->dk_lunit = 0;
    184 	wdcontroller[isa_dev->id_unit].dkc_port = isa_dev->id_iobase;
    185 
    186 	wdc = du->dk_port = isa_dev->id_iobase;
    187 
    188 	/* check if we have registers that work */
    189 	outb(wdc+wd_error, 0x5a);	/* error register not writable */
    190 	outb(wdc+wd_cyl_lo, 0xa5);	/* but all of cyllo are implemented */
    191 	if (inb(wdc+wd_error) == 0x5a || inb(wdc+wd_cyl_lo) != 0xa5)
    192 		goto nodevice;
    193 
    194 	wdreset(du, 0);
    195 
    196 	/* execute a controller only command */
    197 	if (wdcommand(du, 0, 0, 0, 0, WDCC_DIAGNOSE) < 0)
    198 		goto nodevice;
    199 
    200 	free(du, M_TEMP);
    201 	return 8;
    202 
    203 nodevice:
    204 	free(du, M_TEMP);
    205 	return 0;
    206 }
    207 
    208 /*
    209  * Called for the controller too
    210  * Attach each drive if possible.
    211  */
    212 int
    213 wdattach(isa_dev)
    214 	struct isa_device *isa_dev;
    215 {
    216 	int unit, lunit;
    217 	struct disk *du;
    218 	int i, blank;
    219 
    220 	if (isa_dev->id_masunit == -1)
    221 		return 0;
    222 	if (isa_dev->id_masunit >= NWDC)
    223 		return 0;
    224 
    225 	lunit = isa_dev->id_unit;
    226 	if (lunit == -1) {
    227 		printf("wdc%d: cannot support unit ?\n", isa_dev->id_masunit);
    228 		return 0;
    229 	}
    230 	if (lunit >= NWD)
    231 		return 0;
    232 	unit = isa_dev->id_physid;
    233 
    234 	du = wddrives[lunit] =
    235 	    (struct disk *)malloc(sizeof(struct disk), M_TEMP, M_NOWAIT);
    236 	bzero(du, sizeof(struct disk));
    237 	bzero(&wdutab[lunit], sizeof(struct buf));
    238 	bzero(&rwdbuf[lunit], sizeof(struct buf));
    239 	wdxfer[lunit] = 0;
    240 	du->dk_ctrlr = isa_dev->id_masunit;
    241 	du->dk_unit = unit;
    242 	du->dk_lunit = lunit;
    243 	du->dk_port = wdcontroller[isa_dev->id_masunit].dkc_port;
    244 
    245 	if (wdgetctlr(du) != 0) {
    246 		/*printf("wd%d at wdc%d slave %d -- error\n", lunit,
    247 		    isa_dev->id_masunit, unit);*/
    248 		wddrives[lunit] = 0;
    249 		free(du, M_TEMP);
    250 		return 0;
    251 	}
    252 
    253 	printf("wd%d at wdc%d targ %d: ", isa_dev->id_unit,
    254 	    isa_dev->id_masunit, isa_dev->id_physid);
    255 	if (du->dk_params.wdp_heads == 0)
    256 		printf("(unknown size) <");
    257 	else
    258 		printf("%dMB %d cyl, %d head, %d sec <",
    259 		    du->dk_dd.d_ncylinders * du->dk_dd.d_secpercyl /
    260 		    (1048576 / DEV_BSIZE),
    261 		    du->dk_dd.d_ncylinders, du->dk_dd.d_ntracks,
    262 		    du->dk_dd.d_nsectors);
    263 	for (i = blank = 0; i < sizeof(du->dk_params.wdp_model); i++) {
    264 		char c = du->dk_params.wdp_model[i];
    265 		if (c == '\0')
    266 			break;
    267 		if (c != ' ') {
    268 			if (blank)
    269 				printf(" %c", c);
    270 			else
    271 				printf("%c", c);
    272 			blank = 0;
    273 		} else
    274 			blank = 1;
    275 	}
    276 	printf(">\n");
    277 
    278 	wdtimeout((caddr_t)du);
    279 
    280 	return 1;
    281 }
    282 
    283 /* Read/write routine for a buffer.  Finds the proper unit, range checks
    284  * arguments, and schedules the transfer.  Does not wait for the transfer
    285  * to complete.  Multi-page transfers are supported.  All I/O requests must
    286  * be a multiple of a sector in length.
    287  */
    288 int
    289 wdstrategy(bp)
    290 	struct buf *bp;
    291 {
    292 	struct buf *dp;
    293 	struct disk *du;	/* Disk unit to do the IO.	*/
    294 	int lunit = WDUNIT(bp->b_dev);
    295 	int s;
    296 
    297 	/* valid unit, controller, and request?  */
    298 	if (lunit >= NWD || bp->b_blkno < 0 ||
    299 	    howmany(bp->b_bcount, DEV_BSIZE) >= (1 << NBBY) ||
    300 	    (du = wddrives[lunit]) == 0) {
    301 		bp->b_error = EINVAL;
    302 		bp->b_flags |= B_ERROR;
    303 		goto done;
    304 	}
    305 
    306 	/* "soft" write protect check */
    307 	if ((du->dk_flags & DKFL_WRITEPROT) && (bp->b_flags & B_READ) == 0) {
    308 		bp->b_error = EROFS;
    309 		bp->b_flags |= B_ERROR;
    310 		goto done;
    311 	}
    312 
    313 	/* have partitions and want to use them? */
    314 	if ((du->dk_flags & DKFL_BSDLABEL) != 0 && WDPART(bp->b_dev) != WDRAW) {
    315 		/*
    316 		 * do bounds checking, adjust transfer. if error, process.
    317 		 * if end of partition, just return
    318 		 */
    319 		if (bounds_check_with_label(bp, &du->dk_dd, du->dk_wlabel) <= 0)
    320 			goto done;
    321 		/* otherwise, process transfer request */
    322 	}
    323 
    324 	/* don't bother */
    325 	bp->b_cylin = 0;
    326 
    327 	/* queue transfer on drive, activate drive and controller if idle */
    328 	dp = &wdutab[lunit];
    329 	s = splbio();
    330 	wddisksort(dp, bp);
    331 	if (dp->b_active == 0)
    332 		wdustart(du);		/* start drive */
    333 	if (wdtab[du->dk_ctrlr].b_active == 0)
    334 		wdstart(du->dk_ctrlr);		/* start controller */
    335 	splx(s);
    336 	return 0;
    337 
    338 done:
    339 	/* toss transfer, we're done early */
    340 	biodone(bp);
    341 }
    342 
    343 /*
    344  * Need to skip over multitransfer bufs.
    345  */
    346 void
    347 wddisksort(dp, bp)
    348 	struct buf *dp, *bp;
    349 {
    350 	struct buf *ap;
    351 
    352 	while ((ap = dp->b_actf) && ap->b_flags & B_XXX)
    353 		dp = ap;
    354 	disksort(dp, bp);
    355 }
    356 
    357 /*
    358  * Routine to queue a command to the controller.  The unit's
    359  * request is linked into the active list for the controller.
    360  * If the controller is idle, the transfer is started.
    361  */
    362 static void
    363 wdustart(du)
    364 	struct disk *du;
    365 {
    366 	struct buf *dp = &wdutab[du->dk_lunit];
    367 	int ctrlr = du->dk_ctrlr;
    368 
    369 	/* unit already active? */
    370 	if (dp->b_active)
    371 		return;
    372 
    373 	/* anything to start? */
    374 	if (dp->b_actf == NULL)
    375 		return;
    376 
    377 	/* link onto controller queue */
    378 	dp->b_forw = NULL;
    379 	if (wdtab[ctrlr].b_forw == NULL)
    380 		wdtab[ctrlr].b_forw = dp;
    381 	else
    382 		wdtab[ctrlr].b_actl->b_forw = dp;
    383 	wdtab[ctrlr].b_actl = dp;
    384 
    385 	/* mark the drive unit as busy */
    386 	dp->b_active = 1;
    387 }
    388 
    389 /*
    390  * Controller startup routine.  This does the calculation, and starts
    391  * a single-sector read or write operation.  Called to start a transfer,
    392  * or from the interrupt routine to continue a multi-sector transfer.
    393  * RESTRICTIONS:
    394  * 1.	The transfer length must be an exact multiple of the sector size.
    395  */
    396 static void
    397 wdstart(ctrlr)
    398 	int ctrlr;
    399 {
    400 	register struct disk *du;	/* disk unit for IO */
    401 	register struct buf *bp;
    402 	struct disklabel *lp;
    403 	struct buf *dp;
    404 	long blknum, cylin, head, sector;
    405 	long secpertrk, secpercyl;
    406 	int xfrblknum;
    407 	int lunit;
    408 	u_short wdc;
    409 
    410 loop:
    411 	/* is there a drive for the controller to do a transfer with? */
    412 	dp = wdtab[ctrlr].b_forw;
    413 	if (dp == NULL) {
    414 		wdtab[ctrlr].b_active = 0;
    415 		return;
    416 	}
    417 
    418 	/* is there a transfer to this drive ? if so, link it on
    419 	   the controller's queue */
    420 	bp = dp->b_actf;
    421 	if (bp == NULL) {
    422 		dp->b_active = 0;
    423 		wdtab[ctrlr].b_forw = dp->b_forw;
    424 		goto loop;
    425 	}
    426 
    427 	/* obtain controller and drive information */
    428 	lunit = WDUNIT(bp->b_dev);
    429 	du = wddrives[lunit];
    430 
    431 	/* clear any pending timeout, just in case */
    432 	du->dk_timeout = 0;
    433 
    434 	/* if not really a transfer, do control operations specially */
    435 	if (du->dk_state < OPEN) {
    436 		(void) wdcontrol(bp);
    437 		return;
    438 	}
    439 
    440 	/* calculate transfer details */
    441 	blknum = bp->b_blkno + du->dk_skip;
    442 #ifdef WDDEBUG
    443 	if (du->dk_skip == 0)
    444 		printf("\nwdstart %d: %s %d@%d; map ", lunit,
    445 		    (bp->b_flags & B_READ) ? "read" : "write", bp->b_bcount,
    446 		    blknum);
    447 	else
    448 		printf(" %d)%x", du->dk_skip, inb(du->dk_port+wd_altsts));
    449 #endif
    450 	if (du->dk_skip == 0)
    451 		du->dk_bc = bp->b_bcount;
    452 	if (du->dk_skipm == 0) {
    453 		struct buf *oldbp, *nextbp;
    454 		oldbp = bp;
    455 		nextbp = bp->b_actf;
    456 		du->dk_bct = du->dk_bc;
    457 		oldbp->b_flags |= B_XXX;
    458 		while (nextbp && (oldbp->b_flags & DKFL_SINGLE) == 0 &&
    459 		    oldbp->b_dev == nextbp->b_dev && nextbp->b_blkno ==
    460 		    (oldbp->b_blkno + (oldbp->b_bcount / DEV_BSIZE)) &&
    461 		    (oldbp->b_flags & B_READ) == (nextbp->b_flags & B_READ)) {
    462 			if ((du->dk_bct + nextbp->b_bcount) / DEV_BSIZE >= 240)
    463 				break;
    464 			du->dk_bct += nextbp->b_bcount;
    465 			nextbp->b_flags |= B_XXX;
    466 			oldbp = nextbp;
    467 			nextbp = nextbp->b_actf;
    468 		}
    469 	}
    470 
    471 	lp = &du->dk_dd;
    472 	secpertrk = lp->d_nsectors;
    473 	secpercyl = lp->d_secpercyl;
    474 	if ((du->dk_flags & DKFL_BSDLABEL) != 0 && WDPART(bp->b_dev) != WDRAW)
    475 		blknum += lp->d_partitions[WDPART(bp->b_dev)].p_offset;
    476 	cylin = blknum / secpercyl;
    477 	head = (blknum % secpercyl) / secpertrk;
    478 	sector = blknum % secpertrk;
    479 
    480 	/* Check for bad sectors if we have them, and not formatting */
    481 	/* Only do this in single-sector mode, or when starting a */
    482 	/* multiple-sector transfer. */
    483 	if ((du->dk_flags & DKFL_BADSECT) &&
    484 #ifdef B_FORMAT
    485 	    (bp->b_flags & B_FORMAT) == 0 &&
    486 #endif
    487 	    (du->dk_skipm == 0 || (du->dk_flags & DKFL_SINGLE))) {
    488 
    489 		long blkchk, blkend, blknew;
    490 		int i;
    491 
    492 		blkend = blknum + howmany(du->dk_bct, DEV_BSIZE) - 1;
    493 		for (i = 0; (blkchk = du->dk_badsect[i]) != -1; i++) {
    494 			if (blkchk > blkend)
    495 				break;	/* transfer is completely OK; done */
    496 			if (blkchk == blknum) {
    497 				blknew =
    498 				    lp->d_secperunit - lp->d_nsectors - i - 1;
    499 				cylin = blknew / secpercyl;
    500 				head = (blknew % secpercyl) / secpertrk;
    501 				sector = blknew % secpertrk;
    502 				du->dk_flags |= DKFL_SINGLE;
    503 				/* found and replaced first blk of transfer; done */
    504 				break;
    505 			} else if (blkchk > blknum) {
    506 				du->dk_flags |= DKFL_SINGLE;
    507 				break;	/* bad block inside transfer; done */
    508 			}
    509 		}
    510 	}
    511 	if (du->dk_flags & DKFL_SINGLE) {
    512 		du->dk_bct = du->dk_bc;
    513 		du->dk_skipm = du->dk_skip;
    514 	}
    515 
    516 #ifdef WDDEBUG
    517 	printf("c%d h%d s%d ", cylin, head, sector);
    518 #endif
    519 
    520 	sector++;	/* sectors begin with 1, not 0 */
    521 
    522 	wdtab[ctrlr].b_active = 1;		/* mark controller active */
    523 	wdc = du->dk_port;
    524 
    525 #ifdef INSTRUMENT
    526 	/* instrumentation */
    527 	if (du->dk_unit >= 0 && du->dk_skip == 0) {
    528 		dk_busy |= 1 << du->dk_lunit;
    529 		dk_wds[du->dk_lunit] += bp->b_bcount >> 6;
    530 	}
    531 	if (du->dk_unit >= 0 && du->dk_skipm == 0) {
    532 		++dk_seek[du->dk_lunit];
    533 		++dk_xfer[du->dk_lunit];
    534 	}
    535 #endif
    536 
    537 retry:
    538 	/* if starting a multisector transfer, or doing single transfers */
    539 	if (du->dk_skipm == 0 || (du->dk_flags & DKFL_SINGLE)) {
    540 		int command, count;
    541 
    542 		if (wdtab[ctrlr].b_errcnt && (bp->b_flags & B_READ) == 0) {
    543 			du->dk_bc += DEV_BSIZE;
    544 			du->dk_bct += DEV_BSIZE;
    545 		}
    546 
    547 #ifdef B_FORMAT
    548 		if (bp->b_flags & B_FORMAT) {
    549 			sector = lp->d_gap3;
    550 			count = lp->d_nsectors;
    551 			command = WDCC_FORMAT;
    552 		} else {
    553 			if (du->dk_flags & DKFL_SINGLE)
    554 				count = 1;
    555 			else
    556 				count = howmany(du->dk_bct, DEV_BSIZE);
    557 			command =
    558 			    (bp->b_flags & B_READ) ? WDCC_READ : WDCC_WRITE;
    559 		}
    560 #else
    561 		if (du->dk_flags & DKFL_SINGLE)
    562 			count = 1;
    563 		else
    564 			count = howmany(du->dk_bct, DEV_BSIZE);
    565 		command = (bp->b_flags & B_READ) ? WDCC_READ : WDCC_WRITE;
    566 #endif
    567 
    568 		/* initiate command! */
    569 		if (wdcommand(du, cylin, head, sector, count, command) < 0) {
    570 			wdreset(du, 1);
    571 			goto retry;
    572 		}
    573 #ifdef WDDEBUG
    574 		printf("sector %d cylin %d head %d addr %x sts %x\n", sector,
    575 		    cylin, head, bp->b_un.b_addr, inb(wdc+wd_altsts));
    576 #endif
    577 	}
    578 
    579 	du->dk_timeout = 2;
    580 
    581 	/* if this is a read operation, just go away until it's done.	*/
    582 	if (bp->b_flags & B_READ)
    583 		return;
    584 
    585 	if (wait_for_drq(du) < 0) {
    586 		wdreset(du, 1);
    587 		goto retry;
    588 	}
    589 
    590 	/* then send it! */
    591 	outsw(wdc+wd_data, bp->b_un.b_addr + du->dk_skip * DEV_BSIZE,
    592 	    DEV_BSIZE / sizeof(short));
    593 
    594 	du->dk_bc -= DEV_BSIZE;
    595 	du->dk_bct -= DEV_BSIZE;
    596 }
    597 
    598 /* Interrupt routine for the controller.  Acknowledge the interrupt, check for
    599  * errors on the current operation, mark it done if necessary, and start
    600  * the next request.  Also check for a partially done transfer, and
    601  * continue with the next chunk if so.
    602  */
    603 void
    604 wdintr(ctrlr)
    605 	int ctrlr;
    606 {
    607 	register struct	disk *du;
    608 	register struct buf *bp, *dp;
    609 	int stat;
    610 	u_short wdc;
    611 
    612 	/* clear the pending interrupt */
    613 	(void) inb(wdcontroller[ctrlr].dkc_port+wd_status);
    614 
    615 	if (!wdtab[ctrlr].b_active) {
    616 		printf("wdc%d: extra interrupt\n", ctrlr);
    617 		return;
    618 	}
    619 
    620 	dp = wdtab[ctrlr].b_forw;
    621 	bp = dp->b_actf;
    622 	du = wddrives[WDUNIT(bp->b_dev)];
    623 	wdc = du->dk_port;
    624 	du->dk_timeout = 0;
    625 
    626 #ifdef WDDEBUG
    627 	printf("I%d ", ctrlr);
    628 #endif
    629 
    630 	stat = wait_for_unbusy(du);
    631 	if (stat < 0) {
    632 		printf("wdc%d: timeout waiting for unbusy\n", ctrlr);
    633 		stat |= WDCS_ERR;	/* XXX */
    634 	}
    635 
    636 	/* is it not a transfer, but a control operation? */
    637 	if (du->dk_state < OPEN) {
    638 		wdtab[ctrlr].b_active = 0;
    639 		switch (wdcontrol(bp)) {
    640 		case -1:
    641 			goto done;
    642 		case 1:
    643 			wdstart(ctrlr);
    644 			break;
    645 		}
    646 		return;
    647 	}
    648 
    649 	/* have we an error? */
    650 	if (stat & (WDCS_ERR | WDCS_ECCCOR)) {
    651 	lose:
    652 		du->dk_status = stat;
    653 		du->dk_error = inb(wdc+wd_error);
    654 #ifdef WDDEBUG
    655 		printf("stat %x error %x\n", stat, du->dk_error);
    656 #endif
    657 		if ((du->dk_flags & DKFL_SINGLE) == 0) {
    658 			du->dk_flags |= DKFL_ERROR;
    659 			goto outt;
    660 		}
    661 #ifdef B_FORMAT
    662 		if (bp->b_flags & B_FORMAT) {
    663 			bp->b_error = EIO;
    664 			bp->b_flags |= B_ERROR;
    665 			goto done;
    666 		}
    667 #endif
    668 
    669 		/* error or error correction? */
    670 		if (stat & WDCS_ERR) {
    671 			if (++wdtab[ctrlr].b_errcnt < WDIORETRIES)
    672 				wdtab[ctrlr].b_active = 0;
    673 			else {
    674 				diskerr(bp, "wd", "hard error", LOG_PRINTF,
    675 				    du->dk_skip, &du->dk_dd);
    676 #ifdef WDDEBUG
    677 				printf("wd%d: stat %b error %b\n", du->dk_lunit,
    678 				    stat, WDCS_BITS, inb(wdc+wd_error),
    679 				    WDERR_BITS);
    680 #endif
    681 				bp->b_error = EIO;
    682 				bp->b_flags |= B_ERROR;	/* flag the error */
    683 			}
    684 		} else
    685 			diskerr(bp, "wd", "soft error", 0, du->dk_skip,
    686 			    &du->dk_dd);
    687 	}
    688 
    689 	/*
    690 	 * If this was a successful read operation, fetch the data.
    691 	 */
    692 	if (((bp->b_flags & (B_READ | B_ERROR)) == B_READ) &&
    693 	    wdtab[ctrlr].b_active) {
    694 		int chk;
    695 
    696 		chk = min(DEV_BSIZE / sizeof(short), du->dk_bc / sizeof(short));
    697 
    698 		/* ready to receive data? */
    699 		if (wait_for_drq(du) < 0) {
    700 			printf("wdc%d: timeout waiting for drq\n", ctrlr);
    701 			goto lose;
    702 		}
    703 
    704 		/* suck in data */
    705 		insw(wdc+wd_data,
    706 		    bp->b_un.b_addr + du->dk_skip * DEV_BSIZE, chk);
    707 		du->dk_bc -= chk * sizeof(short);
    708 		du->dk_bct -= chk * sizeof(short);
    709 
    710 		/* for obselete fractional sector reads */
    711 		while (chk++ < (DEV_BSIZE / sizeof(short)))
    712 			(void) inw(wdc+wd_data);
    713 	}
    714 
    715 	wdxfer[du->dk_lunit]++;
    716 outt:
    717 	if (wdtab[ctrlr].b_active) {
    718 #ifdef INSTRUMENT
    719 		if (du->dk_unit >= 0)
    720 			dk_busy &= ~(1 << du->dk_unit);
    721 #endif
    722 		if ((bp->b_flags & B_ERROR) == 0) {
    723 			du->dk_skip++;	/* Add to succ. sect */
    724 			du->dk_skipm++;	/* Add to succ. sect for multitransfer */
    725 			if (wdtab[ctrlr].b_errcnt)
    726 				diskerr(bp, "wd", "soft error", 0, du->dk_skip,
    727 				    &du->dk_dd);
    728 			wdtab[ctrlr].b_errcnt = 0;
    729 
    730 			/* see if more to transfer */
    731 			if (du->dk_bc > 0 && (du->dk_flags & DKFL_ERROR) == 0) {
    732 				wdtab[ctrlr].b_active = 0;
    733 				wdstart(ctrlr);
    734 				return;	/* next chunk is started */
    735 			} else if ((du->dk_flags & (DKFL_SINGLE | DKFL_ERROR)) == DKFL_ERROR) {
    736 				du->dk_skip = 0;
    737 				du->dk_skipm = 0;
    738 				du->dk_flags &= ~DKFL_ERROR;
    739 				du->dk_flags |= DKFL_SINGLE;
    740 				wdtab[ctrlr].b_active = 0;
    741 				wdstart(ctrlr);
    742 				return;	/* redo xfer sector by sector */
    743 			}
    744 		}
    745 
    746 	done:
    747 		/* done with this transfer, with or without error */
    748 		du->dk_flags &= ~DKFL_SINGLE;
    749 		wdtab[ctrlr].b_errcnt = 0;
    750 		if (du->dk_bct == 0) {
    751 			wdtab[ctrlr].b_forw = dp->b_forw;
    752 			du->dk_skipm = 0;
    753 			dp->b_active = 0;
    754 		}
    755 		bp->b_resid = bp->b_bcount - du->dk_skip * DEV_BSIZE;
    756 		bp->b_flags &= ~B_XXX;
    757 		du->dk_skip = 0;
    758 		dp->b_actf = bp->b_actf;
    759 		dp->b_errcnt = 0;
    760 		biodone(bp);
    761 	}
    762 
    763 	/* controller now idle */
    764 	wdtab[ctrlr].b_active = 0;
    765 
    766 	/* anything more on drive queue? */
    767 	if (dp->b_actf && du->dk_bct == 0)
    768 		wdustart(du);
    769 
    770 	/* anything more for controller to do? */
    771 	if (wdtab[ctrlr].b_forw)
    772 		wdstart(ctrlr);
    773 }
    774 
    775 /*
    776  * Initialize a drive.
    777  */
    778 int
    779 wdopen(dev, flag, fmt, p)
    780 	dev_t dev;
    781 	int flag;
    782 	int fmt;
    783 	struct proc *p;
    784 {
    785 	int lunit;
    786 	struct disk *du;
    787 	int part = WDPART(dev), mask = 1 << part;
    788 	struct partition *pp;
    789 	char *msg;
    790 
    791 	lunit = WDUNIT(dev);
    792 	if (lunit >= NWD)
    793 		return ENXIO;
    794 	du = wddrives[lunit];
    795 	if (du == 0)
    796 		return ENXIO;
    797 
    798 	if ((du->dk_flags & DKFL_BSDLABEL) == 0) {
    799 		du->dk_flags |= DKFL_WRITEPROT;
    800 		wdutab[lunit].b_actf = NULL;
    801 
    802 		/*
    803 		 * Use the default sizes until we've read the label,
    804 		 * or longer if there isn't one there.
    805 		 */
    806 		bzero(&du->dk_dd, sizeof(du->dk_dd));
    807 		du->dk_dd.d_type = DTYPE_ST506;
    808 		du->dk_dd.d_ncylinders = 1024;
    809 		du->dk_dd.d_secsize = DEV_BSIZE;
    810 		du->dk_dd.d_ntracks = 8;
    811 		du->dk_dd.d_nsectors = 17;
    812 		du->dk_dd.d_secpercyl = 17*8;
    813 		du->dk_dd.d_secperunit = 17*8*1024;
    814 		du->dk_state = WANTOPEN;
    815 
    816 		/* read label using "raw" partition */
    817 #ifdef notdef
    818 		/* wdsetctlr(du); */	/* Maybe do this TIH */
    819 		msg = readdisklabel(makewddev(major(dev), WDUNIT(dev), WDRAW),
    820 		    wdstrategy, &du->dk_dd, &du->dk_cpd);
    821 		wdsetctlr(du);
    822 #endif
    823 		if (msg = readdisklabel(makewddev(major(dev), WDUNIT(dev),
    824 		    WDRAW), wdstrategy, &du->dk_dd, &du->dk_cpd)) {
    825 			log(LOG_WARNING, "wd%d: cannot find label (%s)\n",
    826 			    lunit, msg);
    827 			if (part != WDRAW)
    828 				return EINVAL;	/* XXX needs translation */
    829 		} else {
    830 			wdsetctlr(du);
    831 			du->dk_flags |= DKFL_BSDLABEL;
    832 			du->dk_flags &= ~DKFL_WRITEPROT;
    833 			if (du->dk_dd.d_flags & D_BADSECT)
    834 				du->dk_flags |= DKFL_BADSECT;
    835 		}
    836 	}
    837 
    838 	if (du->dk_flags & DKFL_BADSECT)
    839 		bad144intern(du);
    840 
    841 	/*
    842 	 * Warn if a partition is opened that overlaps another partition which
    843 	 * is open unless one is the "raw" partition (whole disk).
    844 	 */
    845 	if ((du->dk_openpart & mask) == 0 && part != WDRAW) {
    846 		int start, end;
    847 
    848 		pp = &du->dk_dd.d_partitions[part];
    849 		start = pp->p_offset;
    850 		end = pp->p_offset + pp->p_size;
    851 		for (pp = du->dk_dd.d_partitions;
    852 		    pp < &du->dk_dd.d_partitions[du->dk_dd.d_npartitions];
    853 		    pp++) {
    854 			if (pp->p_offset + pp->p_size <= start ||
    855 			    pp->p_offset >= end)
    856 				continue;
    857 			if (pp - du->dk_dd.d_partitions == WDRAW)
    858 				continue;
    859 			if (du->dk_openpart & (1 << (pp - du->dk_dd.d_partitions)))
    860 				log(LOG_WARNING,
    861 				    "wd%d%c: overlaps open partition (%c)\n",
    862 				    lunit, part + 'a',
    863 				    pp - du->dk_dd.d_partitions + 'a');
    864 		}
    865 	}
    866 	if (part >= du->dk_dd.d_npartitions && part != WDRAW)
    867 		return ENXIO;
    868 
    869 	/* insure only one open at a time */
    870 	du->dk_openpart |= mask;
    871 	switch (fmt) {
    872 	case S_IFCHR:
    873 		du->dk_copenpart |= mask;
    874 		break;
    875 	case S_IFBLK:
    876 		du->dk_bopenpart |= mask;
    877 		break;
    878 	}
    879 
    880 	return 0;
    881 }
    882 
    883 /*
    884  * Implement operations other than read/write.
    885  * Called from wdstart or wdintr during opens and formats.
    886  * Uses finite-state-machine to track progress of operation in progress.
    887  * Returns 0 if operation still in progress, 1 if completed.
    888  */
    889 static int
    890 wdcontrol(bp)
    891 	struct buf *bp;
    892 {
    893 	struct disk *du;
    894 	int stat;
    895 	int s, ctrlr;
    896 	u_short wdc;
    897 
    898 	du = wddrives[WDUNIT(bp->b_dev)];
    899 	ctrlr = du->dk_ctrlr;
    900 	wdc = du->dk_port;
    901 
    902 	switch (du->dk_state) {
    903 	case WANTOPEN:			/* set SDH, step rate, do restore */
    904 	tryagainrecal:
    905 		s = splbio();		/* not called from intr level ... */
    906 		wdgetctlr(du);		/* XXX Is this necessary? */
    907 		wdtab[ctrlr].b_active = 1;
    908 		if (wdcommand(du, 0, 0, 0, 0, WDCC_RESTORE | WD_STEP) < 0) {
    909 			wdreset(du, 1);
    910 			splx(s);
    911 			goto tryagainrecal;
    912 		}
    913 		du->dk_state = RECAL;
    914 		splx(s);
    915 		return 0;
    916 
    917 	case RECAL:
    918 		stat = inb(wdc+wd_altsts);
    919 		if (stat & WDCS_ERR || wdsetctlr(du) < 0) {
    920 			printf("wd%d: recal failed: stat %b error %b\n",
    921 			    du->dk_lunit, stat, WDCS_BITS, inb(wdc+wd_error),
    922 			    WDERR_BITS);
    923 			du->dk_state = WANTOPEN;
    924 			if (++wdtab[ctrlr].b_errcnt < WDIORETRIES)
    925 				goto tryagainrecal;
    926 			bp->b_error = ENXIO;	/* XXX needs translation */
    927 			bp->b_flags |= B_ERROR;
    928 			return -1;
    929 		}
    930 		wdtab[ctrlr].b_errcnt = 0;
    931 		du->dk_state = OPEN;
    932 		/*
    933 		 * The rest of the initialization can be done
    934 		 * by normal means.
    935 		 */
    936 		return 1;
    937 	}
    938 
    939 #ifdef DIAGNOSTIC
    940 	panic("wdcontrol: impossible");
    941 #endif
    942 }
    943 
    944 /*
    945  * send a command and wait uninterruptibly until controller is finished.
    946  * return -1 if controller busy for too long, otherwise
    947  * return status. intended for brief controller commands at critical points.
    948  * assumes interrupts are blocked.
    949  */
    950 static int
    951 wdcommand(du, cylin, head, sector, count, cmd)
    952 	struct disk *du;
    953 	int cylin, head, sector, count;
    954 	int cmd;
    955 {
    956 	int stat;
    957 	u_short wdc;
    958 
    959 	/* controller ready for command? */
    960 	if (wait_for_unbusy(du) < 0)
    961 		return -1;
    962 
    963 	/* select drive */
    964 	wdc = du->dk_port;
    965 	outb(wdc+wd_sdh, WDSD_IBM | (du->dk_unit << 4) | head);
    966 	if (cmd == WDCC_DIAGNOSE || cmd == WDCC_IDC)
    967 		stat = wait_for_unbusy(du);
    968 	else
    969 		stat = wdc_wait(du, WDCS_READY);
    970 	if (stat < 0)
    971 		return -1;
    972 
    973 	/* load parameters */
    974 	outb(wdc+wd_precomp, du->dk_dd.d_precompcyl / 4);
    975 	outb(wdc+wd_cyl_lo, cylin);
    976 	outb(wdc+wd_cyl_hi, cylin >> 8);
    977 	outb(wdc+wd_sector, sector);
    978 	outb(wdc+wd_seccnt, count);
    979 
    980 	/* send command, await results */
    981 	outb(wdc+wd_command, cmd);
    982 
    983 	switch (cmd) {
    984 	default:
    985 #if 0
    986 	case WDCC_FORMAT:
    987 	case WDCC_RESTORE | WD_STEP:
    988 	case WDCC_DIAGNOSE:
    989 #endif
    990 		return wait_for_unbusy(du);
    991 	case WDCC_READ:
    992 	case WDCC_WRITE:
    993 		return 0;
    994 	case WDCC_IDC:
    995 		return wdc_wait(du, WDCS_READY);
    996 	case WDCC_READP:
    997 		return wait_for_drq(du);
    998 	}
    999 }
   1000 
   1001 /*
   1002  * issue IDC to drive to tell it just what geometry it is to be.
   1003  */
   1004 static int
   1005 wdsetctlr(du)
   1006 	struct disk *du;
   1007 {
   1008 	int stat, s;
   1009 
   1010 #ifdef WDDEBUG
   1011 	printf("wd(%d,%d) C%dH%dS%d\n", du->dk_ctrlr, du->dk_unit,
   1012 	    du->dk_dd.d_ncylinders, du->dk_dd.d_ntracks, du->dk_dd.d_nsectors);
   1013 #endif
   1014 
   1015 	s = splbio();
   1016 	stat = wdcommand(du, du->dk_dd.d_ncylinders, du->dk_dd.d_ntracks - 1, 0,
   1017 	    du->dk_dd.d_nsectors, WDCC_IDC);
   1018 	if (stat < 0 || stat & WDCS_ERR) {
   1019 		printf("wd%d: wdsetctlr: stat %b error %b\n", du->dk_lunit,
   1020 		    stat, WDCS_BITS, inb(du->dk_port+wd_error), WDERR_BITS);
   1021 		return -1;
   1022 	}
   1023 	splx(s);
   1024 	return 0;
   1025 }
   1026 
   1027 /*
   1028  * issue READP to drive to ask it what it is.
   1029  */
   1030 static int
   1031 wdgetctlr(du)
   1032 	struct disk *du;
   1033 {
   1034 	int stat, s, i;
   1035 	char tb[DEV_BSIZE];
   1036 	struct wdparams *wp;
   1037 
   1038 	s = splbio();		/* not called from intr level ... */
   1039 
   1040 	stat = wdcommand(du, 0, 0, 0, 0, WDCC_READP);
   1041 	if (stat < 0 || stat & WDCS_ERR) {
   1042 		/*
   1043 		 * If WDCC_READP fails then we might have an old drive
   1044 		 * so we try a seek to 0; if that passes then the
   1045 		 * drive is there but it's OLD AND KRUSTY.
   1046 		 */
   1047 		stat = wdcommand(du, 0, 0, 0, 0, WDCC_RESTORE | WD_STEP);
   1048 		if (stat < 0 || stat & WDCS_ERR) {
   1049 			splx(s);
   1050 			return -1;
   1051 		}
   1052 
   1053 		strncpy(du->dk_dd.d_typename, "ST506",
   1054 		    sizeof du->dk_dd.d_typename);
   1055 		strncpy(du->dk_params.wdp_model, "Unknown Type",
   1056 		    sizeof du->dk_params.wdp_model);
   1057 		du->dk_dd.d_type = DTYPE_ST506;
   1058 	} else {
   1059 		/* obtain parameters */
   1060 		wp = &du->dk_params;
   1061 		insw(du->dk_port+wd_data, tb, sizeof(tb) / sizeof(short));
   1062 		bcopy(tb, wp, sizeof(struct wdparams));
   1063 
   1064 		/* shuffle string byte order */
   1065 		for (i = 0; i < sizeof(wp->wdp_model); i += 2) {
   1066 			u_short *p;
   1067 			p = (u_short *)(wp->wdp_model + i);
   1068 			*p = ntohs(*p);
   1069 		}
   1070 
   1071 		strncpy(du->dk_dd.d_typename, "ESDI/IDE",
   1072 		    sizeof du->dk_dd.d_typename);
   1073 		du->dk_dd.d_type = DTYPE_ESDI;
   1074 		bcopy(wp->wdp_model+20, du->dk_dd.d_packname, 14-1);
   1075 
   1076 		/* update disklabel given drive information */
   1077 		du->dk_dd.d_ncylinders =
   1078 		    wp->wdp_fixedcyl + wp->wdp_removcyl /*+- 1*/;
   1079 		du->dk_dd.d_ntracks = wp->wdp_heads;
   1080 		du->dk_dd.d_nsectors = wp->wdp_sectors;
   1081 		du->dk_dd.d_secpercyl =
   1082 		    du->dk_dd.d_ntracks * du->dk_dd.d_nsectors;
   1083 		du->dk_dd.d_partitions[1].p_size =
   1084 		    du->dk_dd.d_secpercyl * wp->wdp_sectors;
   1085 		du->dk_dd.d_partitions[1].p_offset = 0;
   1086 	}
   1087 
   1088 #if 0
   1089 	printf("gc %x cyl %d trk %d sec %d type %d sz %d model %s\n",
   1090 	    wp->wdp_config, wp->wdp_fixedcyl + wp->wdp_removcyl, wp->wdp_heads,
   1091 	    wp->wdp_sectors, wp->wdp_cntype, wp->wdp_cnsbsz, wp->wdp_model);
   1092 #endif
   1093 
   1094 	/* better ... */
   1095 	du->dk_dd.d_subtype |= DSTYPE_GEOMETRY;
   1096 
   1097 	/* XXX sometimes possibly needed */
   1098 	(void) inb(du->dk_port+wd_status);
   1099 	splx(s);
   1100 	return 0;
   1101 }
   1102 
   1103 int
   1104 wdclose(dev, flag, fmt)
   1105 	dev_t dev;
   1106 	int flag;
   1107 	int fmt;
   1108 {
   1109 	struct disk *du = wddrives[WDUNIT(dev)];
   1110 	int part = WDPART(dev), mask = 1 << part;
   1111 
   1112 	du->dk_openpart &= ~mask;
   1113 	switch (fmt) {
   1114 	case S_IFCHR:
   1115 		du->dk_copenpart &= ~mask;
   1116 		break;
   1117 	case S_IFBLK:
   1118 		du->dk_bopenpart &= ~mask;
   1119 		break;
   1120 	}
   1121 
   1122 	return 0;
   1123 }
   1124 
   1125 int
   1126 wdioctl(dev, cmd, addr, flag, p)
   1127 	dev_t dev;
   1128 	int cmd;
   1129 	caddr_t addr;
   1130 	int flag;
   1131 	struct proc *p;
   1132 {
   1133 	int lunit = WDUNIT(dev);
   1134 	struct disk *du = wddrives[lunit];
   1135 	int error;
   1136 
   1137 	switch (cmd) {
   1138 	case DIOCSBAD:
   1139 		if ((flag & FWRITE) == 0)
   1140 			return EBADF;
   1141 		du->dk_cpd.bad = *(struct dkbad *)addr;
   1142 		bad144intern(du);
   1143 		return 0;
   1144 
   1145 	case DIOCGDINFO:
   1146 		*(struct disklabel *)addr = du->dk_dd;
   1147 		return 0;
   1148 
   1149 	case DIOCGPART:
   1150 		((struct partinfo *)addr)->disklab = &du->dk_dd;
   1151 		((struct partinfo *)addr)->part =
   1152 		    &du->dk_dd.d_partitions[WDPART(dev)];
   1153 		return 0;
   1154 
   1155 	case DIOCSDINFO:
   1156 		if ((flag & FWRITE) == 0)
   1157 			return EBADF;
   1158 		error = setdisklabel(&du->dk_dd,
   1159 		    (struct disklabel *)addr,
   1160 		    /*(du->dk_flags & DKFL_BSDLABEL) ? du->dk_openpart : */0,
   1161 		    &du->dk_cpd);
   1162 		if (error == 0) {
   1163 			du->dk_flags |= DKFL_BSDLABEL;
   1164 			wdsetctlr(du);
   1165 		}
   1166 		return error;
   1167 
   1168 	case DIOCWLABEL:
   1169 		du->dk_flags &= ~DKFL_WRITEPROT;
   1170 		if ((flag & FWRITE) == 0)
   1171 			return EBADF;
   1172 		du->dk_wlabel = *(int *)addr;
   1173 		return 0;
   1174 
   1175 	case DIOCWDINFO:
   1176 		du->dk_flags &= ~DKFL_WRITEPROT;
   1177 		if ((flag & FWRITE) == 0)
   1178 			return EBADF;
   1179 		error = setdisklabel(&du->dk_dd,
   1180 		    (struct disklabel *)addr,
   1181 		    /*(du->dk_flags & DKFL_BSDLABEL) ? du->dk_openpart :*/0,
   1182 		    &du->dk_cpd);
   1183 		if (error == 0) {
   1184 			int wlab;
   1185 
   1186 			du->dk_flags |= DKFL_BSDLABEL;
   1187 			wdsetctlr(du);
   1188 
   1189 			/* simulate opening partition 0 so write succeeds */
   1190 			du->dk_openpart |= (1 << 0);	    /* XXX */
   1191 			wlab = du->dk_wlabel;
   1192 			du->dk_wlabel = 1;
   1193 			error = writedisklabel(dev, wdstrategy, &du->dk_dd,
   1194 			    &du->dk_cpd);
   1195 			du->dk_openpart = du->dk_copenpart | du->dk_bopenpart;
   1196 			du->dk_wlabel = wlab;
   1197 		}
   1198 		return error;
   1199 
   1200 #ifdef notyet
   1201 	case DIOCGDINFOP:
   1202 		*(struct disklabel **)addr = &du->dk_dd;
   1203 		return 0;
   1204 
   1205 	case DIOCWFORMAT:
   1206 		if ((flag & FWRITE) == 0)
   1207 			return EBADF;
   1208 	{
   1209 		register struct format_op *fop;
   1210 		struct iovec aiov;
   1211 		struct uio auio;
   1212 
   1213 		fop = (struct format_op *)addr;
   1214 		aiov.iov_base = fop->df_buf;
   1215 		aiov.iov_len = fop->df_count;
   1216 		auio.uio_iov = &aiov;
   1217 		auio.uio_iovcnt = 1;
   1218 		auio.uio_resid = fop->df_count;
   1219 		auio.uio_segflg = 0;
   1220 		auio.uio_offset =
   1221 		    fop->df_startblk * du->dk_dd.d_secsize;
   1222 		error = physio(wdformat, &rwdbuf[lunit], dev, B_WRITE,
   1223 		    minphys, &auio);
   1224 		fop->df_count -= auio.uio_resid;
   1225 		fop->df_reg[0] = du->dk_status;
   1226 		fop->df_reg[1] = du->dk_error;
   1227 		return error;
   1228 	}
   1229 #endif
   1230 
   1231 	default:
   1232 		return ENOTTY;
   1233 	}
   1234 
   1235 #ifdef DIAGNOSTIC
   1236 	panic("wdioctl: impossible");
   1237 #endif
   1238 }
   1239 
   1240 #ifdef B_FORMAT
   1241 int
   1242 wdformat(struct buf *bp)
   1243 {
   1244 
   1245 	bp->b_flags |= B_FORMAT;
   1246 	return wdstrategy(bp);
   1247 }
   1248 #endif
   1249 
   1250 int
   1251 wdsize(dev)
   1252 	dev_t dev;
   1253 {
   1254 	int lunit = WDUNIT(dev), part = WDPART(dev);
   1255 	struct disk *du;
   1256 
   1257 	if (lunit >= NWD)
   1258 		return -1;
   1259 	du = wddrives[lunit];
   1260 	if (du == 0)
   1261 		return -1;
   1262 
   1263 	if (du->dk_state < OPEN || (du->dk_flags & DKFL_BSDLABEL) == 0) {
   1264 		int val;
   1265 		val = wdopen(makewddev(major(dev), lunit, WDRAW), FREAD,
   1266 		    S_IFBLK, 0);
   1267 		/* XXX Clear the open flag? */
   1268 		if (val != 0)
   1269 			return -1;
   1270 	}
   1271 
   1272 	if ((du->dk_flags & (DKFL_WRITEPROT | DKFL_BSDLABEL)) != DKFL_BSDLABEL)
   1273 		return -1;
   1274 
   1275 	return (int)du->dk_dd.d_partitions[part].p_size;
   1276 }
   1277 
   1278 /* dump core after a system crash */
   1279 int
   1280 wddump(dev)
   1281 	dev_t dev;
   1282 {
   1283 	register struct disk *du;	/* disk unit to do the IO */
   1284 	long num;			/* number of sectors to write */
   1285 	int ctrlr, lunit, part;
   1286 	u_short wdc;
   1287 	long blkoff, blknum;
   1288 	long cylin, head, sector, stat;
   1289 	long secpertrk, secpercyl, nblocks;
   1290 	char *addr;
   1291 	static wddoingadump = 0;
   1292 	extern caddr_t CADDR1;
   1293 	extern struct pte *CMAP1;
   1294 
   1295 	addr = (char *)0;		/* starting address */
   1296 
   1297 #if DO_NOT_KNOW_HOW
   1298 	/* toss any characters present prior to dump, ie. non-blocking getc */
   1299 	while (cngetc())
   1300 		;
   1301 #endif
   1302 
   1303 	/* size of memory to dump */
   1304 	lunit = WDUNIT(dev);
   1305 	part = WDPART(dev);	/* file system */
   1306 	/* check for acceptable drive number */
   1307 	if (lunit >= NWD)
   1308 		return ENXIO;
   1309 	du = wddrives[lunit];
   1310 	/* was it ever initialized ? */
   1311 	if (du == 0 || du->dk_state < OPEN || du->dk_flags & DKFL_WRITEPROT)
   1312 		return ENXIO;
   1313 
   1314 	wdc = du->dk_port;
   1315 	ctrlr = du->dk_ctrlr;
   1316 
   1317 	/* Convert to disk sectors */
   1318 	num = ctob(physmem) / du->dk_dd.d_secsize;
   1319 
   1320 	secpertrk = du->dk_dd.d_nsectors;
   1321 	secpercyl = du->dk_dd.d_secpercyl;
   1322 	nblocks = du->dk_dd.d_partitions[part].p_size;
   1323 	blkoff = du->dk_dd.d_partitions[part].p_offset;
   1324 
   1325 	/*printf("part %x, nblocks %d, dumplo %d, num %d\n", part, nblocks,
   1326 	    dumplo, num);*/
   1327 
   1328 	/* check transfer bounds against partition size */
   1329 	if (dumplo < 0 || dumplo + num > nblocks)
   1330 		return EINVAL;
   1331 
   1332 	/* check if controller active */
   1333 	/*if (wdtab[ctrlr].b_active)
   1334 		return EFAULT;*/
   1335 	if (wddoingadump)
   1336 		return EFAULT;
   1337 
   1338 	/* mark controller active for if we panic during the dump */
   1339 	/*wdtab[ctrlr].b_active = 1;*/
   1340 	wddoingadump = 1;
   1341 
   1342 	/* Recalibrate. */
   1343 	if (wdcommand(du, 0, 0, 0, 0, WDCC_RESTORE | WD_STEP) < 0 ||
   1344 	    wdsetctlr(du) < 0)
   1345 		return EIO;
   1346 
   1347 	blknum = dumplo + blkoff;
   1348 	while (num > 0) {
   1349 		/* compute disk address */
   1350 		cylin = blknum / secpercyl;
   1351 		head = (blknum % secpercyl) / secpertrk;
   1352 		sector = blknum % secpertrk;
   1353 
   1354 		if (du->dk_flags & DKFL_BADSECT) {
   1355 			long newblk;
   1356 			int i;
   1357 
   1358 			for (i = 0; du->dk_badsect[i] != -1; i++) {
   1359 				if (blknum < du->dk_badsect[i]) {
   1360 					/* sorted list, passed our block by */
   1361 					break;
   1362 				} else if (blknum == du->dk_badsect[i]) {
   1363 					newblk = du->dk_dd.d_secperunit -
   1364 						du->dk_dd.d_nsectors - i - 1;
   1365 					cylin = newblk / secpercyl;
   1366 					head = (newblk % secpercyl) / secpertrk;
   1367 					sector = newblk % secpertrk;
   1368 					/* found and replaced; done */
   1369 					break;
   1370 				}
   1371 			}
   1372 		}
   1373 		sector++;		/* origin 1 */
   1374 
   1375 #ifdef notdef
   1376 		/* lets just talk about this first...*/
   1377 		printf("cylin %d, head %d, sector %d, addr 0x%x", cylin, head,
   1378 		    sector, addr);
   1379 #endif
   1380 		stat = wdcommand(du, cylin, head, sector, 1, WDCC_WRITE);
   1381 		if (stat < 0 || stat & WDCS_ERR || wait_for_drq(du) < 0)
   1382 			return EIO;
   1383 
   1384 #ifdef notdef	/* cannot use this since this address was mapped differently */
   1385 		pmap_enter(kernel_pmap, CADDR1, trunc_page(addr), VM_PROT_READ, TRUE);
   1386 #else
   1387 		*(int *)CMAP1 = PG_V | PG_KW | ctob((long)addr);
   1388 		tlbflush();
   1389 #endif
   1390 
   1391 		outsw(wdc+wd_data, CADDR1 + ((int)addr & PGOFSET),
   1392 		    DEV_BSIZE / sizeof(short));
   1393 
   1394 		/* Check data request (should be done). */
   1395 		stat = wait_for_ready(du);
   1396 		if (stat < 0 || stat & (WDCS_ERR | WDCS_DRQ))
   1397 			return EIO;
   1398 
   1399 		if ((unsigned)addr % 1048576 == 0)
   1400 			printf("%d ", num / (1048576 / DEV_BSIZE));
   1401 
   1402 		/* update block count */
   1403 		num--;
   1404 		blknum++;
   1405 		(int)addr += DEV_BSIZE;
   1406 
   1407 #if DO_NOT_KNOW_HOW
   1408 		/* operator aborting dump? non-blocking getc() */
   1409 		if (cngetc())
   1410 			return EINTR;
   1411 #endif
   1412 	}
   1413 	return 0;
   1414 }
   1415 
   1416 /*
   1417  * Internalize the bad sector table.
   1418  */
   1419 void
   1420 bad144intern(du)
   1421 	struct disk *du;
   1422 {
   1423 	int i;
   1424 
   1425 	if ((du->dk_flags & DKFL_BADSECT) == 0)
   1426 		return;
   1427 
   1428 	for (i = 0; i < 127; i++)
   1429 		du->dk_badsect[i] = -1;
   1430 	for (i = 0; i < 126; i++) {
   1431 		if (du->dk_cpd.bad.bt_bad[i].bt_cyl == 0xffff)
   1432 			break;
   1433 		du->dk_badsect[i] =
   1434 		    du->dk_cpd.bad.bt_bad[i].bt_cyl * du->dk_dd.d_secpercyl +
   1435 		    (du->dk_cpd.bad.bt_bad[i].bt_trksec >> 8) *
   1436 			du->dk_dd.d_nsectors +
   1437 		    (du->dk_cpd.bad.bt_bad[i].bt_trksec & 0x00ff);
   1438 	}
   1439 }
   1440 
   1441 static int
   1442 wdreset(du, err)
   1443 	struct disk *du;
   1444 	int err;
   1445 {
   1446 	int wdc = du->dk_port;
   1447 	int stat;
   1448 
   1449 	if (err)
   1450 		printf("wdc%d: busy too long, resetting\n", du->dk_ctrlr);
   1451 
   1452 	/* reset the device  */
   1453 	outb(wdc+wd_ctlr, WDCTL_RST | WDCTL_IDS);
   1454 	delay(1000);
   1455 	outb(wdc+wd_ctlr, WDCTL_IDS);
   1456 	delay(1000);
   1457 	(void) inb(wdc+wd_error);
   1458 	outb(wdc+wd_ctlr, WDCTL_4BIT);
   1459 
   1460 	if (wait_for_unbusy(du) < 0)
   1461 		printf("wdc%d: failed to reset controller\n", du->dk_ctrlr);
   1462 }
   1463 
   1464 int
   1465 wdc_wait(du, mask)
   1466 	struct disk *du;
   1467 	int mask;
   1468 {
   1469 	int wdc = du->dk_port;
   1470 	int timeout = 0;
   1471 	int stat;
   1472 
   1473 	for (;;) {
   1474 		stat = inb(wdc+wd_altsts);
   1475 		if ((stat & WDCS_BUSY) == 0 && (stat & mask) == mask)
   1476 			break;
   1477 		if (++timeout > WDCNDELAY)
   1478 			return -1;
   1479 		delay(WDCDELAY);
   1480 	}
   1481 #ifdef WDCNDELAY_DEBUG
   1482 	if (timeout > WDCNDELAY_DEBUG)
   1483 		printf("wdc%d: timeout took %dus\n", du->dk_ctrlr,
   1484 		    WDCDELAY * timeout);
   1485 #endif
   1486 	return stat;
   1487 }
   1488 
   1489 static void
   1490 wdtimeout(arg)
   1491 	caddr_t arg;
   1492 {
   1493 	int s = splbio();
   1494 	struct disk *du = (void *)arg;
   1495 
   1496 	if (du->dk_timeout && --du->dk_timeout == 0) {
   1497 		int wdc = du->dk_port;
   1498 
   1499 		printf("wd%d: lost interrupt: stat %x error %x\n",
   1500 		    du->dk_lunit, inb(wdc+wd_status), inb(wdc+wd_error));
   1501 		wdreset(du, 0);
   1502 		/* XXX Need to recalibrate and upload geometry. */
   1503 		du->dk_skip = 0;
   1504 		du->dk_flags |= DKFL_SINGLE;
   1505 		wdstart(du->dk_ctrlr);
   1506 	}
   1507 	timeout((timeout_t)wdtimeout, arg, hz);
   1508 	splx(s);
   1509 }
   1510 
   1511 #endif /* NWDC > 0 */
   1512