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