Home | History | Annotate | Line # | Download | only in ata
wd.c revision 1.214.2.2
      1  1.214.2.2  jdolecek /*	$NetBSD: wd.c,v 1.214.2.2 2002/02/11 20:09:39 jdolecek Exp $ */
      2      1.181    bouyer 
      3      1.181    bouyer /*
      4  1.214.2.1   thorpej  * Copyright (c) 1998, 2001 Manuel Bouyer.  All rights reserved.
      5      1.181    bouyer  *
      6      1.181    bouyer  * Redistribution and use in source and binary forms, with or without
      7      1.181    bouyer  * modification, are permitted provided that the following conditions
      8      1.181    bouyer  * are met:
      9      1.181    bouyer  * 1. Redistributions of source code must retain the above copyright
     10      1.181    bouyer  *	notice, this list of conditions and the following disclaimer.
     11      1.181    bouyer  * 2. Redistributions in binary form must reproduce the above copyright
     12      1.181    bouyer  *	notice, this list of conditions and the following disclaimer in the
     13      1.181    bouyer  *	documentation and/or other materials provided with the distribution.
     14      1.181    bouyer  * 3. All advertising materials mentioning features or use of this software
     15      1.181    bouyer  *	must display the following acknowledgement:
     16      1.181    bouyer  *  This product includes software developed by Manuel Bouyer.
     17      1.181    bouyer  * 4. The name of the author may not be used to endorse or promote products
     18      1.181    bouyer  *	derived from this software without specific prior written permission.
     19      1.181    bouyer  *
     20      1.181    bouyer  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21      1.181    bouyer  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22      1.181    bouyer  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23      1.204    bouyer  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24      1.181    bouyer  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25      1.181    bouyer  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26      1.181    bouyer  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27      1.181    bouyer  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28      1.181    bouyer  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29      1.181    bouyer  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30      1.181    bouyer  */
     31      1.100       cgd 
     32      1.178   mycroft /*-
     33      1.178   mycroft  * Copyright (c) 1998 The NetBSD Foundation, Inc.
     34      1.178   mycroft  * All rights reserved.
     35      1.119   mycroft  *
     36      1.178   mycroft  * This code is derived from software contributed to The NetBSD Foundation
     37      1.178   mycroft  * by Charles M. Hannum and by Onno van der Linden.
     38      1.168       cgd  *
     39      1.113   mycroft  * Redistribution and use in source and binary forms, with or without
     40      1.113   mycroft  * modification, are permitted provided that the following conditions
     41      1.113   mycroft  * are met:
     42      1.113   mycroft  * 1. Redistributions of source code must retain the above copyright
     43      1.113   mycroft  *    notice, this list of conditions and the following disclaimer.
     44      1.113   mycroft  * 2. Redistributions in binary form must reproduce the above copyright
     45      1.113   mycroft  *    notice, this list of conditions and the following disclaimer in the
     46      1.113   mycroft  *    documentation and/or other materials provided with the distribution.
     47      1.113   mycroft  * 3. All advertising materials mentioning features or use of this software
     48      1.113   mycroft  *    must display the following acknowledgement:
     49      1.178   mycroft  *        This product includes software developed by the NetBSD
     50      1.178   mycroft  *        Foundation, Inc. and its contributors.
     51      1.178   mycroft  * 4. Neither the name of The NetBSD Foundation nor the names of its
     52      1.178   mycroft  *    contributors may be used to endorse or promote products derived
     53      1.178   mycroft  *    from this software without specific prior written permission.
     54      1.113   mycroft  *
     55      1.178   mycroft  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     56      1.178   mycroft  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     57      1.178   mycroft  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     58      1.178   mycroft  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     59      1.178   mycroft  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     60      1.178   mycroft  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     61      1.178   mycroft  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     62      1.178   mycroft  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     63      1.178   mycroft  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     64      1.178   mycroft  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     65      1.178   mycroft  * POSSIBILITY OF SUCH DAMAGE.
     66        1.1       cgd  */
     67        1.1       cgd 
     68  1.214.2.1   thorpej #include <sys/cdefs.h>
     69  1.214.2.2  jdolecek __KERNEL_RCSID(0, "$NetBSD: wd.c,v 1.214.2.2 2002/02/11 20:09:39 jdolecek Exp $");
     70  1.214.2.1   thorpej 
     71      1.192   hubertf #ifndef WDCDEBUG
     72      1.181    bouyer #define WDCDEBUG
     73      1.192   hubertf #endif /* WDCDEBUG */
     74      1.181    bouyer 
     75      1.166  explorer #include "rnd.h"
     76      1.166  explorer 
     77       1.29   mycroft #include <sys/param.h>
     78       1.29   mycroft #include <sys/systm.h>
     79       1.43   mycroft #include <sys/kernel.h>
     80       1.29   mycroft #include <sys/conf.h>
     81       1.29   mycroft #include <sys/file.h>
     82       1.29   mycroft #include <sys/stat.h>
     83       1.29   mycroft #include <sys/ioctl.h>
     84       1.29   mycroft #include <sys/buf.h>
     85       1.29   mycroft #include <sys/uio.h>
     86       1.29   mycroft #include <sys/malloc.h>
     87       1.64   mycroft #include <sys/device.h>
     88       1.94   mycroft #include <sys/disklabel.h>
     89       1.94   mycroft #include <sys/disk.h>
     90       1.29   mycroft #include <sys/syslog.h>
     91      1.149  christos #include <sys/proc.h>
     92      1.196     enami #include <sys/vnode.h>
     93      1.166  explorer #if NRND > 0
     94      1.165  explorer #include <sys/rnd.h>
     95      1.166  explorer #endif
     96       1.29   mycroft 
     97      1.150   mycroft #include <machine/intr.h>
     98      1.168       cgd #include <machine/bus.h>
     99       1.29   mycroft 
    100      1.181    bouyer #include <dev/ata/atareg.h>
    101      1.181    bouyer #include <dev/ata/atavar.h>
    102      1.181    bouyer #include <dev/ata/wdvar.h>
    103      1.181    bouyer #include <dev/ic/wdcreg.h>
    104      1.186      kenh #include <sys/ataio.h>
    105      1.163    bouyer #include "locators.h"
    106        1.1       cgd 
    107       1.98   mycroft #define	WAITTIME	(4 * hz)	/* time to wait for a completion */
    108      1.189    bouyer #define	WDIORETRIES_SINGLE 4	/* number of retries before single-sector */
    109      1.181    bouyer #define	WDIORETRIES	5	/* number of retries before giving up */
    110      1.181    bouyer #define	RECOVERYTIME hz/2	/* time to wait before retrying a cmd */
    111       1.23   deraadt 
    112      1.181    bouyer #define	WDUNIT(dev)		DISKUNIT(dev)
    113      1.181    bouyer #define	WDPART(dev)		DISKPART(dev)
    114      1.196     enami #define	WDMINOR(unit, part)	DISKMINOR(unit, part)
    115       1.92       cgd #define	MAKEWDDEV(maj, unit, part)	MAKEDISKDEV(maj, unit, part)
    116       1.92       cgd 
    117       1.92       cgd #define	WDLABELDEV(dev)	(MAKEWDDEV(major(dev), WDUNIT(dev), RAW_PART))
    118        1.1       cgd 
    119      1.181    bouyer #define DEBUG_INTR   0x01
    120      1.181    bouyer #define DEBUG_XFERS  0x02
    121      1.181    bouyer #define DEBUG_STATUS 0x04
    122      1.181    bouyer #define DEBUG_FUNCS  0x08
    123      1.181    bouyer #define DEBUG_PROBE  0x10
    124      1.181    bouyer #ifdef WDCDEBUG
    125      1.181    bouyer extern int wdcdebug_wd_mask; /* init'ed in ata_wdc.c */
    126      1.181    bouyer #define WDCDEBUG_PRINT(args, level) \
    127      1.181    bouyer 	if (wdcdebug_wd_mask & (level)) \
    128      1.181    bouyer 		printf args
    129      1.163    bouyer #else
    130      1.181    bouyer #define WDCDEBUG_PRINT(args, level)
    131      1.163    bouyer #endif
    132      1.163    bouyer 
    133       1.64   mycroft struct wd_softc {
    134      1.181    bouyer 	/* General disk infos */
    135       1.64   mycroft 	struct device sc_dev;
    136      1.144   thorpej 	struct disk sc_dk;
    137      1.200   thorpej 	struct buf_queue sc_q;
    138      1.203   thorpej 	struct callout sc_restart_ch;
    139      1.181    bouyer 	/* IDE disk soft states */
    140      1.184    bouyer 	struct ata_bio sc_wdc_bio; /* current transfer */
    141      1.181    bouyer 	struct buf *sc_bp; /* buf being transfered */
    142      1.181    bouyer 	void *wdc_softc;   /* pointer to our parent */
    143      1.181    bouyer 	struct ata_drive_datas *drvp; /* Our controller's infos */
    144  1.214.2.1   thorpej 	const struct ata_bustype *atabus;
    145      1.181    bouyer 	int openings;
    146      1.181    bouyer 	struct ataparams sc_params;/* drive characteistics found */
    147      1.181    bouyer 	int sc_flags;
    148  1.214.2.2  jdolecek #define	WDF_LOCKED	0x001
    149  1.214.2.2  jdolecek #define	WDF_WANTED	0x002
    150  1.214.2.2  jdolecek #define	WDF_WLABEL	0x004 /* label is writable */
    151  1.214.2.2  jdolecek #define	WDF_LABELLING	0x008 /* writing label */
    152      1.181    bouyer /*
    153      1.181    bouyer  * XXX Nothing resets this yet, but disk change sensing will when ATA-4 is
    154      1.181    bouyer  * more fully implemented.
    155      1.181    bouyer  */
    156  1.214.2.2  jdolecek #define WDF_LOADED	0x010 /* parameters loaded */
    157  1.214.2.2  jdolecek #define WDF_WAIT	0x020 /* waiting for resources */
    158  1.214.2.2  jdolecek #define WDF_LBA		0x040 /* using LBA mode */
    159  1.214.2.2  jdolecek #define WDF_KLABEL	0x080 /* retain label after 'full' close */
    160  1.214.2.2  jdolecek #define WDF_LBA48	0x100 /* using 48-bit LBA mode */
    161      1.181    bouyer 	int sc_capacity;
    162      1.181    bouyer 	int cyl; /* actual drive parameters */
    163      1.181    bouyer 	int heads;
    164      1.181    bouyer 	int sectors;
    165      1.181    bouyer 	int retries; /* number of xfer retry */
    166      1.196     enami 
    167      1.196     enami 	void *sc_sdhook;		/* our shutdown hook */
    168      1.196     enami 
    169      1.166  explorer #if NRND > 0
    170      1.165  explorer 	rndsource_element_t	rnd_source;
    171      1.166  explorer #endif
    172       1.74   mycroft };
    173       1.64   mycroft 
    174      1.181    bouyer #define sc_drive sc_wdc_bio.drive
    175      1.181    bouyer #define sc_mode sc_wdc_bio.mode
    176      1.181    bouyer #define sc_multi sc_wdc_bio.multi
    177      1.181    bouyer #define sc_badsect sc_wdc_bio.badsect
    178      1.181    bouyer 
    179      1.168       cgd int	wdprobe		__P((struct device *, struct cfdata *, void *));
    180      1.163    bouyer void	wdattach	__P((struct device *, struct device *, void *));
    181      1.196     enami int	wddetach __P((struct device *, int));
    182      1.196     enami int	wdactivate __P((struct device *, enum devact));
    183      1.181    bouyer int	wdprint	__P((void *, char *));
    184  1.214.2.1   thorpej void    wdperror __P((struct ata_drive_datas *, int, char *));
    185      1.102   mycroft 
    186      1.147   thorpej struct cfattach wd_ca = {
    187      1.196     enami 	sizeof(struct wd_softc), wdprobe, wdattach, wddetach, wdactivate
    188      1.147   thorpej };
    189      1.147   thorpej 
    190      1.167   thorpej extern struct cfdriver wd_cd;
    191      1.108   mycroft 
    192      1.185      kenh /*
    193      1.185      kenh  * Glue necessary to hook WDCIOCCOMMAND into physio
    194      1.185      kenh  */
    195      1.185      kenh 
    196      1.185      kenh struct wd_ioctl {
    197      1.185      kenh 	LIST_ENTRY(wd_ioctl) wi_list;
    198      1.185      kenh 	struct buf wi_bp;
    199      1.185      kenh 	struct uio wi_uio;
    200      1.185      kenh 	struct iovec wi_iov;
    201      1.186      kenh 	atareq_t wi_atareq;
    202      1.185      kenh 	struct wd_softc *wi_softc;
    203      1.185      kenh };
    204      1.185      kenh 
    205      1.185      kenh LIST_HEAD(, wd_ioctl) wi_head;
    206      1.185      kenh 
    207      1.185      kenh struct	wd_ioctl *wi_find __P((struct buf *));
    208      1.185      kenh void	wi_free __P((struct wd_ioctl *));
    209      1.185      kenh struct	wd_ioctl *wi_get __P((void));
    210      1.185      kenh void	wdioctlstrategy __P((struct buf *));
    211      1.185      kenh 
    212      1.181    bouyer void  wdgetdefaultlabel __P((struct wd_softc *, struct disklabel *));
    213      1.181    bouyer void  wdgetdisklabel	__P((struct wd_softc *));
    214      1.181    bouyer void  wdstrategy	__P((struct buf *));
    215      1.181    bouyer void  wdstart	__P((void *));
    216      1.181    bouyer void  __wdstart	__P((struct wd_softc*, struct buf *));
    217      1.181    bouyer void  wdrestart __P((void*));
    218      1.181    bouyer int   wd_get_params __P((struct wd_softc *, u_int8_t, struct ataparams *));
    219      1.190    bouyer void  wd_flushcache __P((struct wd_softc *, int));
    220      1.190    bouyer void  wd_shutdown __P((void*));
    221      1.108   mycroft 
    222      1.102   mycroft struct dkdriver wddkdriver = { wdstrategy };
    223       1.65   mycroft 
    224      1.149  christos /* XXX: these should go elsewhere */
    225      1.149  christos cdev_decl(wd);
    226      1.149  christos bdev_decl(wd);
    227      1.149  christos 
    228      1.170       leo #ifdef HAS_BAD144_HANDLING
    229       1.64   mycroft static void bad144intern __P((struct wd_softc *));
    230      1.170       leo #endif
    231      1.181    bouyer int	wdlock	__P((struct wd_softc *));
    232      1.181    bouyer void	wdunlock	__P((struct wd_softc *));
    233        1.1       cgd 
    234        1.1       cgd int
    235      1.163    bouyer wdprobe(parent, match, aux)
    236      1.102   mycroft 	struct device *parent;
    237      1.168       cgd 	struct cfdata *match;
    238      1.168       cgd 
    239      1.168       cgd 	void *aux;
    240        1.1       cgd {
    241  1.214.2.1   thorpej 	struct ata_device *adev = aux;
    242      1.167   thorpej 
    243  1.214.2.1   thorpej 	if (adev == NULL)
    244      1.181    bouyer 		return 0;
    245  1.214.2.1   thorpej 	if (adev->adev_bustype->bustype_type != SCSIPI_BUSTYPE_ATA)
    246       1.64   mycroft 		return 0;
    247      1.181    bouyer 
    248      1.181    bouyer 	if (match->cf_loc[ATACF_CHANNEL] != ATACF_CHANNEL_DEFAULT &&
    249  1.214.2.1   thorpej 	    match->cf_loc[ATACF_CHANNEL] != adev->adev_channel)
    250      1.105   mycroft 		return 0;
    251      1.105   mycroft 
    252      1.168       cgd 	if (match->cf_loc[ATACF_DRIVE] != ATACF_DRIVE_DEFAULT &&
    253  1.214.2.1   thorpej 	    match->cf_loc[ATACF_DRIVE] != adev->adev_drv_data->drive)
    254       1.74   mycroft 		return 0;
    255       1.74   mycroft 	return 1;
    256       1.74   mycroft }
    257       1.64   mycroft 
    258       1.74   mycroft void
    259       1.74   mycroft wdattach(parent, self, aux)
    260       1.74   mycroft 	struct device *parent, *self;
    261       1.74   mycroft 	void *aux;
    262       1.74   mycroft {
    263       1.74   mycroft 	struct wd_softc *wd = (void *)self;
    264  1.214.2.1   thorpej 	struct ata_device *adev= aux;
    265       1.74   mycroft 	int i, blank;
    266      1.201     enami 	char buf[41], pbuf[9], c, *p, *q;
    267      1.181    bouyer 	WDCDEBUG_PRINT(("wdattach\n"), DEBUG_FUNCS | DEBUG_PROBE);
    268       1.56   mycroft 
    269      1.203   thorpej 	callout_init(&wd->sc_restart_ch);
    270      1.200   thorpej 	BUFQ_INIT(&wd->sc_q);
    271      1.200   thorpej 
    272  1.214.2.1   thorpej 	wd->atabus = adev->adev_bustype;
    273  1.214.2.1   thorpej 	wd->openings = adev->adev_openings;
    274  1.214.2.1   thorpej 	wd->drvp = adev->adev_drv_data;;
    275      1.181    bouyer 	wd->wdc_softc = parent;
    276      1.181    bouyer 	/* give back our softc to our caller */
    277      1.181    bouyer 	wd->drvp->drv_softc = &wd->sc_dev;
    278      1.181    bouyer 
    279      1.181    bouyer 	/* read our drive info */
    280      1.181    bouyer 	if (wd_get_params(wd, AT_POLL, &wd->sc_params) != 0) {
    281      1.181    bouyer 		printf("%s: IDENTIFY failed\n", wd->sc_dev.dv_xname);
    282      1.181    bouyer 		return;
    283      1.181    bouyer 	}
    284      1.163    bouyer 
    285      1.181    bouyer 	for (blank = 0, p = wd->sc_params.atap_model, q = buf, i = 0;
    286      1.181    bouyer 	    i < sizeof(wd->sc_params.atap_model); i++) {
    287      1.135   mycroft 		c = *p++;
    288      1.135   mycroft 		if (c == '\0')
    289      1.135   mycroft 			break;
    290      1.135   mycroft 		if (c != ' ') {
    291      1.135   mycroft 			if (blank) {
    292      1.135   mycroft 				*q++ = ' ';
    293      1.135   mycroft 				blank = 0;
    294      1.135   mycroft 			}
    295      1.135   mycroft 			*q++ = c;
    296      1.135   mycroft 		} else
    297      1.135   mycroft 			blank = 1;
    298      1.195     enami 	}
    299      1.135   mycroft 	*q++ = '\0';
    300      1.135   mycroft 
    301      1.172   mycroft 	printf(": <%s>\n", buf);
    302      1.113   mycroft 
    303      1.181    bouyer 	if ((wd->sc_params.atap_multi & 0xff) > 1) {
    304      1.181    bouyer 		wd->sc_multi = wd->sc_params.atap_multi & 0xff;
    305      1.113   mycroft 	} else {
    306      1.181    bouyer 		wd->sc_multi = 1;
    307      1.113   mycroft 	}
    308      1.113   mycroft 
    309      1.210     lukem 	printf("%s: drive supports %d-sector PIO transfers,",
    310      1.184    bouyer 	    wd->sc_dev.dv_xname, wd->sc_multi);
    311      1.172   mycroft 
    312  1.214.2.2  jdolecek 	/* 48-bit LBA addressing */
    313  1.214.2.2  jdolecek 	if ((wd->sc_params.atap_cmd2_en & WDC_CAP_LBA48) != 0)
    314  1.214.2.2  jdolecek 		wd->sc_flags |= WDF_LBA48;
    315  1.214.2.2  jdolecek 
    316      1.172   mycroft 	/* Prior to ATA-4, LBA was optional. */
    317      1.181    bouyer 	if ((wd->sc_params.atap_capabilities1 & WDC_CAP_LBA) != 0)
    318      1.181    bouyer 		wd->sc_flags |= WDF_LBA;
    319      1.174   mycroft #if 0
    320      1.172   mycroft 	/* ATA-4 requires LBA. */
    321      1.181    bouyer 	if (wd->sc_params.atap_ataversion != 0xffff &&
    322      1.181    bouyer 	    wd->sc_params.atap_ataversion >= WDC_VER_ATA4)
    323      1.181    bouyer 		wd->sc_flags |= WDF_LBA;
    324      1.174   mycroft #endif
    325      1.172   mycroft 
    326  1.214.2.2  jdolecek 	if ((wd->sc_flags & WDF_LBA48) != 0) {
    327  1.214.2.2  jdolecek 		printf(" LBA48 addressing\n");
    328  1.214.2.2  jdolecek 		wd->sc_capacity =
    329  1.214.2.2  jdolecek 		    ((u_int64_t) wd->sc_params.__reserved6[11] << 48) |
    330  1.214.2.2  jdolecek 		    ((u_int64_t) wd->sc_params.__reserved6[10] << 32) |
    331  1.214.2.2  jdolecek 		    ((u_int64_t) wd->sc_params.__reserved6[9]  << 16) |
    332  1.214.2.2  jdolecek 		    ((u_int64_t) wd->sc_params.__reserved6[8]  << 0);
    333  1.214.2.2  jdolecek 	} else if ((wd->sc_flags & WDF_LBA) != 0) {
    334      1.210     lukem 		printf(" LBA addressing\n");
    335      1.181    bouyer 		wd->sc_capacity =
    336      1.181    bouyer 		    (wd->sc_params.atap_capacity[1] << 16) |
    337      1.181    bouyer 		    wd->sc_params.atap_capacity[0];
    338      1.172   mycroft 	} else {
    339      1.184    bouyer 		printf(" chs addressing\n");
    340      1.181    bouyer 		wd->sc_capacity =
    341      1.181    bouyer 		    wd->sc_params.atap_cylinders *
    342      1.181    bouyer 		    wd->sc_params.atap_heads *
    343      1.181    bouyer 		    wd->sc_params.atap_sectors;
    344      1.172   mycroft 	}
    345      1.201     enami 	format_bytes(pbuf, sizeof(pbuf),
    346      1.201     enami 	    (u_int64_t)wd->sc_capacity * DEV_BSIZE);
    347      1.201     enami 	printf("%s: %s, %d cyl, %d head, %d sec, "
    348      1.201     enami 	    "%d bytes/sect x %d sectors\n",
    349      1.201     enami 	    self->dv_xname, pbuf, wd->sc_params.atap_cylinders,
    350      1.201     enami 	    wd->sc_params.atap_heads, wd->sc_params.atap_sectors,
    351      1.201     enami 	    DEV_BSIZE, wd->sc_capacity);
    352      1.201     enami 
    353      1.181    bouyer 	WDCDEBUG_PRINT(("%s: atap_dmatiming_mimi=%d, atap_dmatiming_recom=%d\n",
    354      1.181    bouyer 	    self->dv_xname, wd->sc_params.atap_dmatiming_mimi,
    355      1.181    bouyer 	    wd->sc_params.atap_dmatiming_recom), DEBUG_PROBE);
    356      1.181    bouyer 	/*
    357      1.181    bouyer 	 * Initialize and attach the disk structure.
    358      1.181    bouyer 	 */
    359      1.181    bouyer 	wd->sc_dk.dk_driver = &wddkdriver;
    360      1.181    bouyer 	wd->sc_dk.dk_name = wd->sc_dev.dv_xname;
    361      1.181    bouyer 	disk_attach(&wd->sc_dk);
    362      1.181    bouyer 	wd->sc_wdc_bio.lp = wd->sc_dk.dk_label;
    363      1.196     enami 	wd->sc_sdhook = shutdownhook_establish(wd_shutdown, wd);
    364      1.196     enami 	if (wd->sc_sdhook == NULL)
    365      1.190    bouyer 		printf("%s: WARNING: unable to establish shutdown hook\n",
    366      1.190    bouyer 		    wd->sc_dev.dv_xname);
    367      1.166  explorer #if NRND > 0
    368      1.193  explorer 	rnd_attach_source(&wd->rnd_source, wd->sc_dev.dv_xname,
    369      1.193  explorer 			  RND_TYPE_DISK, 0);
    370      1.166  explorer #endif
    371      1.196     enami }
    372      1.196     enami 
    373      1.196     enami int
    374      1.196     enami wdactivate(self, act)
    375      1.196     enami 	struct device *self;
    376      1.196     enami 	enum devact act;
    377      1.196     enami {
    378      1.196     enami 	int rv = 0;
    379      1.196     enami 
    380      1.196     enami 	switch (act) {
    381      1.196     enami 	case DVACT_ACTIVATE:
    382      1.196     enami 		rv = EOPNOTSUPP;
    383      1.196     enami 		break;
    384      1.196     enami 
    385      1.196     enami 	case DVACT_DEACTIVATE:
    386      1.196     enami 		/*
    387      1.196     enami 		 * Nothing to do; we key off the device's DVF_ACTIVATE.
    388      1.196     enami 		 */
    389      1.196     enami 		break;
    390      1.196     enami 	}
    391      1.196     enami 	return (rv);
    392      1.196     enami }
    393      1.196     enami 
    394      1.196     enami int
    395      1.196     enami wddetach(self, flags)
    396      1.196     enami 	struct device *self;
    397      1.196     enami 	int flags;
    398      1.196     enami {
    399      1.196     enami 	struct wd_softc *sc = (struct wd_softc *)self;
    400      1.196     enami 	struct buf *bp;
    401      1.213  drochner 	int s, bmaj, cmaj, i, mn;
    402      1.196     enami 
    403      1.196     enami 	/* locate the major number */
    404      1.196     enami 	for (bmaj = 0; bmaj < nblkdev; bmaj++)
    405      1.196     enami 		if (bdevsw[bmaj].d_open == wdopen)
    406      1.196     enami 			break;
    407      1.196     enami 	for (cmaj = 0; cmaj < nchrdev; cmaj++)
    408      1.196     enami 		if (cdevsw[cmaj].d_open == wdopen)
    409      1.196     enami 			break;
    410      1.196     enami 
    411      1.196     enami 	s = splbio();
    412      1.196     enami 
    413      1.196     enami 	/* Kill off any queued buffers. */
    414      1.200   thorpej 	while ((bp = BUFQ_FIRST(&sc->sc_q)) != NULL) {
    415      1.200   thorpej 		BUFQ_REMOVE(&sc->sc_q, bp);
    416      1.196     enami 		bp->b_error = EIO;
    417      1.196     enami 		bp->b_flags |= B_ERROR;
    418      1.196     enami 		bp->b_resid = bp->b_bcount;
    419      1.196     enami 		biodone(bp);
    420      1.196     enami 	}
    421      1.196     enami 
    422      1.196     enami 	splx(s);
    423      1.196     enami 
    424      1.196     enami 	/* Nuke the vnodes for any open instances. */
    425      1.213  drochner 	for (i = 0; i < MAXPARTITIONS; i++) {
    426      1.213  drochner 		mn = WDMINOR(self->dv_unit, i);
    427      1.213  drochner 		vdevgone(bmaj, mn, mn, VBLK);
    428      1.213  drochner 		vdevgone(cmaj, mn, mn, VCHR);
    429      1.213  drochner 	}
    430      1.196     enami 
    431      1.196     enami 	/* Detach disk. */
    432      1.196     enami 	disk_detach(&sc->sc_dk);
    433      1.196     enami 
    434      1.196     enami 	/* Get rid of the shutdown hook. */
    435      1.196     enami 	if (sc->sc_sdhook != NULL)
    436      1.196     enami 		shutdownhook_disestablish(sc->sc_sdhook);
    437      1.196     enami 
    438      1.196     enami #if NRND > 0
    439      1.196     enami 	/* Unhook the entropy source. */
    440      1.196     enami 	rnd_detach_source(&sc->rnd_source);
    441      1.196     enami #endif
    442      1.196     enami 
    443      1.196     enami 	return (0);
    444        1.1       cgd }
    445        1.1       cgd 
    446       1.64   mycroft /*
    447      1.135   mycroft  * Read/write routine for a buffer.  Validates the arguments and schedules the
    448      1.135   mycroft  * transfer.  Does not wait for the transfer to complete.
    449        1.1       cgd  */
    450       1.64   mycroft void
    451       1.55   mycroft wdstrategy(bp)
    452       1.55   mycroft 	struct buf *bp;
    453        1.1       cgd {
    454      1.209   thorpej 	struct wd_softc *wd = device_lookup(&wd_cd, WDUNIT(bp->b_dev));
    455      1.202   thorpej 	struct disklabel *lp = wd->sc_dk.dk_label;
    456      1.202   thorpej 	daddr_t blkno;
    457       1.37   mycroft 	int s;
    458      1.202   thorpej 
    459      1.181    bouyer 	WDCDEBUG_PRINT(("wdstrategy (%s)\n", wd->sc_dev.dv_xname),
    460      1.182    bouyer 	    DEBUG_XFERS);
    461      1.181    bouyer 
    462      1.135   mycroft 	/* Valid request?  */
    463      1.135   mycroft 	if (bp->b_blkno < 0 ||
    464      1.202   thorpej 	    (bp->b_bcount % lp->d_secsize) != 0 ||
    465      1.202   thorpej 	    (bp->b_bcount / lp->d_secsize) >= (1 << NBBY)) {
    466        1.1       cgd 		bp->b_error = EINVAL;
    467       1.93   mycroft 		goto bad;
    468        1.1       cgd 	}
    469      1.181    bouyer 
    470      1.135   mycroft 	/* If device invalidated (e.g. media change, door open), error. */
    471      1.181    bouyer 	if ((wd->sc_flags & WDF_LOADED) == 0) {
    472      1.135   mycroft 		bp->b_error = EIO;
    473      1.135   mycroft 		goto bad;
    474      1.135   mycroft 	}
    475      1.135   mycroft 
    476       1.93   mycroft 	/* If it's a null transfer, return immediately. */
    477       1.93   mycroft 	if (bp->b_bcount == 0)
    478       1.93   mycroft 		goto done;
    479       1.93   mycroft 
    480      1.128   mycroft 	/*
    481      1.128   mycroft 	 * Do bounds checking, adjust transfer. if error, process.
    482      1.128   mycroft 	 * If end of partition, just return.
    483      1.128   mycroft 	 */
    484      1.138   mycroft 	if (WDPART(bp->b_dev) != RAW_PART &&
    485      1.144   thorpej 	    bounds_check_with_label(bp, wd->sc_dk.dk_label,
    486      1.181    bouyer 	    (wd->sc_flags & (WDF_WLABEL|WDF_LABELLING)) != 0) <= 0)
    487      1.128   mycroft 		goto done;
    488      1.202   thorpej 
    489      1.202   thorpej 	/*
    490      1.202   thorpej 	 * Now convert the block number to absolute and put it in
    491      1.202   thorpej 	 * terms of the device's logical block size.
    492      1.202   thorpej 	 */
    493      1.202   thorpej 	if (lp->d_secsize >= DEV_BSIZE)
    494      1.202   thorpej 		blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
    495      1.202   thorpej 	else
    496      1.202   thorpej 		blkno = bp->b_blkno * (DEV_BSIZE / lp->d_secsize);
    497      1.202   thorpej 
    498      1.202   thorpej 	if (WDPART(bp->b_dev) != RAW_PART)
    499      1.202   thorpej 		blkno += lp->d_partitions[WDPART(bp->b_dev)].p_offset;
    500      1.202   thorpej 
    501      1.202   thorpej 	bp->b_rawblkno = blkno;
    502      1.202   thorpej 
    503       1.64   mycroft 	/* Queue transfer on drive, activate drive and controller if idle. */
    504        1.1       cgd 	s = splbio();
    505      1.200   thorpej 	disksort_blkno(&wd->sc_q, bp);
    506      1.163    bouyer 	wdstart(wd);
    507        1.1       cgd 	splx(s);
    508       1.64   mycroft 	return;
    509       1.93   mycroft bad:
    510       1.93   mycroft 	bp->b_flags |= B_ERROR;
    511        1.1       cgd done:
    512       1.64   mycroft 	/* Toss transfer; we're done early. */
    513      1.135   mycroft 	bp->b_resid = bp->b_bcount;
    514        1.1       cgd 	biodone(bp);
    515        1.1       cgd }
    516        1.1       cgd 
    517        1.1       cgd /*
    518      1.135   mycroft  * Queue a drive for I/O.
    519        1.1       cgd  */
    520      1.108   mycroft void
    521      1.163    bouyer wdstart(arg)
    522      1.163    bouyer 	void *arg;
    523        1.1       cgd {
    524      1.163    bouyer 	struct wd_softc *wd = arg;
    525      1.200   thorpej 	struct buf *bp = NULL;
    526      1.163    bouyer 
    527      1.181    bouyer 	WDCDEBUG_PRINT(("wdstart %s\n", wd->sc_dev.dv_xname),
    528      1.182    bouyer 	    DEBUG_XFERS);
    529      1.181    bouyer 	while (wd->openings > 0) {
    530      1.163    bouyer 
    531      1.163    bouyer 		/* Is there a buf for us ? */
    532      1.200   thorpej 		if ((bp = BUFQ_FIRST(&wd->sc_q)) == NULL)
    533      1.200   thorpej 			return;
    534      1.200   thorpej 		BUFQ_REMOVE(&wd->sc_q, bp);
    535      1.181    bouyer 
    536      1.163    bouyer 		/*
    537      1.163    bouyer 		 * Make the command. First lock the device
    538      1.163    bouyer 		 */
    539      1.181    bouyer 		wd->openings--;
    540      1.181    bouyer 
    541      1.181    bouyer 		wd->retries = 0;
    542      1.181    bouyer 		__wdstart(wd, bp);
    543      1.181    bouyer 	}
    544      1.181    bouyer }
    545      1.181    bouyer 
    546      1.181    bouyer void
    547      1.181    bouyer __wdstart(wd, bp)
    548      1.181    bouyer 	struct wd_softc *wd;
    549      1.181    bouyer 	struct buf *bp;
    550      1.181    bouyer {
    551      1.202   thorpej 
    552      1.202   thorpej 	wd->sc_wdc_bio.blkno = bp->b_rawblkno;
    553      1.181    bouyer 	wd->sc_wdc_bio.blkdone =0;
    554      1.181    bouyer 	wd->sc_bp = bp;
    555      1.181    bouyer 	/*
    556      1.181    bouyer 	 * If we're retrying, retry in single-sector mode. This will give us
    557      1.181    bouyer 	 * the sector number of the problem, and will eventually allow the
    558      1.184    bouyer 	 * transfer to succeed.
    559      1.181    bouyer 	 */
    560      1.189    bouyer 	if (wd->sc_multi == 1 || wd->retries >= WDIORETRIES_SINGLE)
    561      1.181    bouyer 		wd->sc_wdc_bio.flags = ATA_SINGLE;
    562      1.181    bouyer 	else
    563      1.181    bouyer 		wd->sc_wdc_bio.flags = 0;
    564  1.214.2.2  jdolecek 	if (wd->sc_flags & WDF_LBA48)
    565  1.214.2.2  jdolecek 		wd->sc_wdc_bio.flags |= ATA_LBA48;
    566      1.181    bouyer 	if (wd->sc_flags & WDF_LBA)
    567      1.181    bouyer 		wd->sc_wdc_bio.flags |= ATA_LBA;
    568      1.181    bouyer 	if (bp->b_flags & B_READ)
    569      1.181    bouyer 		wd->sc_wdc_bio.flags |= ATA_READ;
    570      1.181    bouyer 	wd->sc_wdc_bio.bcount = bp->b_bcount;
    571      1.181    bouyer 	wd->sc_wdc_bio.databuf = bp->b_data;
    572      1.181    bouyer 	/* Instrumentation. */
    573      1.181    bouyer 	disk_busy(&wd->sc_dk);
    574  1.214.2.1   thorpej 	switch (wd->atabus->ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
    575      1.181    bouyer 	case WDC_TRY_AGAIN:
    576      1.203   thorpej 		callout_reset(&wd->sc_restart_ch, hz, wdrestart, wd);
    577      1.181    bouyer 		break;
    578      1.181    bouyer 	case WDC_QUEUED:
    579      1.181    bouyer 	case WDC_COMPLETE:
    580      1.181    bouyer 		break;
    581      1.181    bouyer 	default:
    582  1.214.2.1   thorpej 		panic("__wdstart: bad return code from ata_bio()");
    583      1.181    bouyer 	}
    584      1.181    bouyer }
    585      1.181    bouyer 
    586      1.181    bouyer void
    587      1.181    bouyer wddone(v)
    588      1.181    bouyer 	void *v;
    589      1.181    bouyer {
    590      1.181    bouyer 	struct wd_softc *wd = v;
    591      1.181    bouyer 	struct buf *bp = wd->sc_bp;
    592      1.181    bouyer 	char buf[256], *errbuf = buf;
    593      1.181    bouyer 	WDCDEBUG_PRINT(("wddone %s\n", wd->sc_dev.dv_xname),
    594      1.182    bouyer 	    DEBUG_XFERS);
    595      1.181    bouyer 
    596      1.214     bjh21 	if (bp == NULL)
    597      1.214     bjh21 		return;
    598      1.181    bouyer 	bp->b_resid = wd->sc_wdc_bio.bcount;
    599      1.181    bouyer 	errbuf[0] = '\0';
    600      1.181    bouyer 	switch (wd->sc_wdc_bio.error) {
    601      1.181    bouyer 	case ERR_DMA:
    602      1.181    bouyer 		errbuf = "DMA error";
    603      1.181    bouyer 		goto retry;
    604      1.181    bouyer 	case ERR_DF:
    605      1.181    bouyer 		errbuf = "device fault";
    606      1.181    bouyer 		goto retry;
    607      1.181    bouyer 	case TIMEOUT:
    608      1.181    bouyer 		errbuf = "device timeout";
    609      1.181    bouyer 		goto retry;
    610      1.181    bouyer 	case ERROR:
    611      1.181    bouyer 		/* Don't care about media change bits */
    612      1.181    bouyer 		if (wd->sc_wdc_bio.r_error != 0 &&
    613      1.181    bouyer 		    (wd->sc_wdc_bio.r_error & ~(WDCE_MC | WDCE_MCR)) == 0)
    614      1.181    bouyer 			goto noerror;
    615  1.214.2.1   thorpej 		wdperror(wd->drvp, wd->sc_wdc_bio.r_error, errbuf);
    616      1.181    bouyer retry:		/* Just reset and retry. Can we do more ? */
    617  1.214.2.1   thorpej 		wd->atabus->ata_reset_channel(wd->drvp);
    618      1.181    bouyer 		diskerr(bp, "wd", errbuf, LOG_PRINTF,
    619      1.181    bouyer 		    wd->sc_wdc_bio.blkdone, wd->sc_dk.dk_label);
    620      1.181    bouyer 		if (wd->retries++ < WDIORETRIES) {
    621      1.181    bouyer 			printf(", retrying\n");
    622      1.203   thorpej 			callout_reset(&wd->sc_restart_ch, RECOVERYTIME,
    623      1.203   thorpej 			    wdrestart, wd);
    624      1.181    bouyer 			return;
    625      1.181    bouyer 		}
    626      1.181    bouyer 		printf("\n");
    627      1.181    bouyer 		bp->b_flags |= B_ERROR;
    628      1.181    bouyer 		bp->b_error = EIO;
    629      1.181    bouyer 		break;
    630      1.181    bouyer 	case NOERROR:
    631      1.181    bouyer noerror:	if ((wd->sc_wdc_bio.flags & ATA_CORR) || wd->retries > 0)
    632      1.181    bouyer 			printf("%s: soft error (corrected)\n",
    633      1.181    bouyer 			    wd->sc_dev.dv_xname);
    634      1.197     enami 		break;
    635      1.197     enami 	case ERR_NODEV:
    636      1.197     enami 		bp->b_flags |= B_ERROR;
    637      1.197     enami 		bp->b_error = EIO;
    638      1.197     enami 		break;
    639       1.64   mycroft 	}
    640      1.181    bouyer 	disk_unbusy(&wd->sc_dk, (bp->b_bcount - bp->b_resid));
    641      1.181    bouyer #if NRND > 0
    642      1.181    bouyer 	rnd_add_uint32(&wd->rnd_source, bp->b_blkno);
    643      1.181    bouyer #endif
    644      1.181    bouyer 	biodone(bp);
    645      1.181    bouyer 	wd->openings++;
    646      1.181    bouyer 	wdstart(wd);
    647      1.181    bouyer }
    648      1.181    bouyer 
    649      1.181    bouyer void
    650      1.181    bouyer wdrestart(v)
    651      1.181    bouyer 	void *v;
    652      1.181    bouyer {
    653      1.181    bouyer 	struct wd_softc *wd = v;
    654      1.181    bouyer 	struct buf *bp = wd->sc_bp;
    655      1.181    bouyer 	int s;
    656      1.181    bouyer 	WDCDEBUG_PRINT(("wdrestart %s\n", wd->sc_dev.dv_xname),
    657      1.182    bouyer 	    DEBUG_XFERS);
    658      1.181    bouyer 
    659      1.181    bouyer 	s = splbio();
    660      1.181    bouyer 	__wdstart(v, bp);
    661      1.181    bouyer 	splx(s);
    662      1.141   mycroft }
    663      1.141   mycroft 
    664      1.141   mycroft int
    665      1.149  christos wdread(dev, uio, flags)
    666      1.141   mycroft 	dev_t dev;
    667      1.141   mycroft 	struct uio *uio;
    668      1.149  christos 	int flags;
    669      1.141   mycroft {
    670      1.141   mycroft 
    671      1.182    bouyer 	WDCDEBUG_PRINT(("wdread\n"), DEBUG_XFERS);
    672      1.141   mycroft 	return (physio(wdstrategy, NULL, dev, B_READ, minphys, uio));
    673      1.141   mycroft }
    674      1.141   mycroft 
    675      1.141   mycroft int
    676      1.149  christos wdwrite(dev, uio, flags)
    677      1.141   mycroft 	dev_t dev;
    678      1.141   mycroft 	struct uio *uio;
    679      1.149  christos 	int flags;
    680      1.141   mycroft {
    681      1.141   mycroft 
    682      1.182    bouyer 	WDCDEBUG_PRINT(("wdwrite\n"), DEBUG_XFERS);
    683      1.141   mycroft 	return (physio(wdstrategy, NULL, dev, B_WRITE, minphys, uio));
    684       1.64   mycroft }
    685       1.64   mycroft 
    686        1.1       cgd /*
    687      1.135   mycroft  * Wait interruptibly for an exclusive lock.
    688      1.135   mycroft  *
    689      1.135   mycroft  * XXX
    690      1.135   mycroft  * Several drivers do this; it should be abstracted and made MP-safe.
    691      1.135   mycroft  */
    692      1.132   mycroft int
    693      1.181    bouyer wdlock(wd)
    694      1.181    bouyer 	struct wd_softc *wd;
    695      1.132   mycroft {
    696      1.132   mycroft 	int error;
    697      1.163    bouyer 	int s;
    698      1.163    bouyer 
    699      1.181    bouyer 	WDCDEBUG_PRINT(("wdlock\n"), DEBUG_FUNCS);
    700      1.132   mycroft 
    701      1.163    bouyer 	s = splbio();
    702      1.163    bouyer 
    703      1.181    bouyer 	while ((wd->sc_flags & WDF_LOCKED) != 0) {
    704      1.181    bouyer 		wd->sc_flags |= WDF_WANTED;
    705      1.181    bouyer 		if ((error = tsleep(wd, PRIBIO | PCATCH,
    706      1.163    bouyer 		    "wdlck", 0)) != 0) {
    707      1.163    bouyer 			splx(s);
    708      1.132   mycroft 			return error;
    709      1.163    bouyer 		}
    710      1.132   mycroft 	}
    711      1.181    bouyer 	wd->sc_flags |= WDF_LOCKED;
    712      1.163    bouyer 	splx(s);
    713      1.132   mycroft 	return 0;
    714      1.132   mycroft }
    715      1.132   mycroft 
    716      1.135   mycroft /*
    717      1.135   mycroft  * Unlock and wake up any waiters.
    718      1.135   mycroft  */
    719      1.132   mycroft void
    720      1.181    bouyer wdunlock(wd)
    721      1.181    bouyer 	struct wd_softc *wd;
    722      1.132   mycroft {
    723      1.132   mycroft 
    724      1.181    bouyer 	WDCDEBUG_PRINT(("wdunlock\n"), DEBUG_FUNCS);
    725      1.163    bouyer 
    726      1.181    bouyer 	wd->sc_flags &= ~WDF_LOCKED;
    727      1.181    bouyer 	if ((wd->sc_flags & WDF_WANTED) != 0) {
    728      1.181    bouyer 		wd->sc_flags &= ~WDF_WANTED;
    729      1.181    bouyer 		wakeup(wd);
    730      1.132   mycroft 	}
    731      1.132   mycroft }
    732      1.132   mycroft 
    733        1.1       cgd int
    734      1.149  christos wdopen(dev, flag, fmt, p)
    735       1.55   mycroft 	dev_t dev;
    736       1.93   mycroft 	int flag, fmt;
    737      1.149  christos 	struct proc *p;
    738        1.1       cgd {
    739      1.135   mycroft 	struct wd_softc *wd;
    740      1.208   thorpej 	int part, error;
    741      1.163    bouyer 
    742      1.181    bouyer 	WDCDEBUG_PRINT(("wdopen\n"), DEBUG_FUNCS);
    743      1.208   thorpej 	wd = device_lookup(&wd_cd, WDUNIT(dev));
    744      1.158        pk 	if (wd == NULL)
    745      1.208   thorpej 		return (ENXIO);
    746      1.187   thorpej 
    747      1.187   thorpej 	/*
    748      1.187   thorpej 	 * If this is the first open of this device, add a reference
    749      1.187   thorpej 	 * to the adapter.
    750      1.187   thorpej 	 */
    751      1.187   thorpej 	if (wd->sc_dk.dk_openmask == 0 &&
    752  1.214.2.1   thorpej 	    (error = wd->atabus->ata_addref(wd->drvp)) != 0)
    753      1.187   thorpej 		return (error);
    754      1.187   thorpej 
    755      1.181    bouyer 	if ((error = wdlock(wd)) != 0)
    756      1.187   thorpej 		goto bad4;
    757        1.3   deraadt 
    758      1.109   mycroft 	if (wd->sc_dk.dk_openmask != 0) {
    759      1.109   mycroft 		/*
    760      1.109   mycroft 		 * If any partition is open, but the disk has been invalidated,
    761      1.109   mycroft 		 * disallow further opens.
    762      1.109   mycroft 		 */
    763      1.181    bouyer 		if ((wd->sc_flags & WDF_LOADED) == 0) {
    764      1.136   mycroft 			error = EIO;
    765      1.136   mycroft 			goto bad3;
    766      1.136   mycroft 		}
    767      1.109   mycroft 	} else {
    768      1.181    bouyer 		if ((wd->sc_flags & WDF_LOADED) == 0) {
    769      1.181    bouyer 			wd->sc_flags |= WDF_LOADED;
    770      1.108   mycroft 
    771      1.108   mycroft 			/* Load the physical device parameters. */
    772      1.183    bouyer 			wd_get_params(wd, AT_WAIT, &wd->sc_params);
    773      1.108   mycroft 
    774      1.108   mycroft 			/* Load the partition info if not already loaded. */
    775      1.108   mycroft 			wdgetdisklabel(wd);
    776      1.108   mycroft 		}
    777      1.135   mycroft 	}
    778      1.108   mycroft 
    779      1.135   mycroft 	part = WDPART(dev);
    780      1.108   mycroft 
    781      1.109   mycroft 	/* Check that the partition exists. */
    782       1.93   mycroft 	if (part != RAW_PART &&
    783      1.144   thorpej 	    (part >= wd->sc_dk.dk_label->d_npartitions ||
    784      1.144   thorpej 	     wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
    785       1.93   mycroft 		error = ENXIO;
    786       1.93   mycroft 		goto bad;
    787       1.93   mycroft 	}
    788      1.181    bouyer 
    789       1.64   mycroft 	/* Insure only one open at a time. */
    790        1.3   deraadt 	switch (fmt) {
    791        1.3   deraadt 	case S_IFCHR:
    792       1.94   mycroft 		wd->sc_dk.dk_copenmask |= (1 << part);
    793        1.3   deraadt 		break;
    794        1.3   deraadt 	case S_IFBLK:
    795       1.94   mycroft 		wd->sc_dk.dk_bopenmask |= (1 << part);
    796        1.3   deraadt 		break;
    797        1.3   deraadt 	}
    798      1.181    bouyer 	wd->sc_dk.dk_openmask =
    799      1.181    bouyer 	    wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
    800       1.60   mycroft 
    801      1.181    bouyer 	wdunlock(wd);
    802       1.37   mycroft 	return 0;
    803       1.93   mycroft 
    804       1.93   mycroft bad:
    805      1.118   mycroft 	if (wd->sc_dk.dk_openmask == 0) {
    806      1.108   mycroft 	}
    807      1.108   mycroft 
    808      1.136   mycroft bad3:
    809      1.181    bouyer 	wdunlock(wd);
    810      1.187   thorpej bad4:
    811      1.187   thorpej 	if (wd->sc_dk.dk_openmask == 0)
    812  1.214.2.1   thorpej 		wd->atabus->ata_delref(wd->drvp);
    813       1.93   mycroft 	return error;
    814        1.1       cgd }
    815        1.1       cgd 
    816      1.135   mycroft int
    817      1.149  christos wdclose(dev, flag, fmt, p)
    818      1.135   mycroft 	dev_t dev;
    819      1.135   mycroft 	int flag, fmt;
    820      1.149  christos 	struct proc *p;
    821      1.135   mycroft {
    822      1.209   thorpej 	struct wd_softc *wd = device_lookup(&wd_cd, WDUNIT(dev));
    823      1.135   mycroft 	int part = WDPART(dev);
    824      1.135   mycroft 	int error;
    825      1.181    bouyer 
    826      1.181    bouyer 	WDCDEBUG_PRINT(("wdclose\n"), DEBUG_FUNCS);
    827      1.181    bouyer 	if ((error = wdlock(wd)) != 0)
    828      1.135   mycroft 		return error;
    829      1.135   mycroft 
    830      1.135   mycroft 	switch (fmt) {
    831      1.135   mycroft 	case S_IFCHR:
    832      1.135   mycroft 		wd->sc_dk.dk_copenmask &= ~(1 << part);
    833      1.135   mycroft 		break;
    834      1.135   mycroft 	case S_IFBLK:
    835      1.135   mycroft 		wd->sc_dk.dk_bopenmask &= ~(1 << part);
    836      1.135   mycroft 		break;
    837      1.135   mycroft 	}
    838      1.181    bouyer 	wd->sc_dk.dk_openmask =
    839      1.181    bouyer 	    wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
    840      1.135   mycroft 
    841      1.135   mycroft 	if (wd->sc_dk.dk_openmask == 0) {
    842      1.194    bouyer 		wd_flushcache(wd, AT_WAIT);
    843      1.135   mycroft 		/* XXXX Must wait for I/O to complete! */
    844      1.187   thorpej 
    845      1.199       leo 		if (! (wd->sc_flags & WDF_KLABEL))
    846      1.199       leo 			wd->sc_flags &= ~WDF_LOADED;
    847      1.199       leo 
    848  1.214.2.1   thorpej 		wd->atabus->ata_delref(wd->drvp);
    849      1.135   mycroft 	}
    850      1.135   mycroft 
    851      1.181    bouyer 	wdunlock(wd);
    852      1.135   mycroft 	return 0;
    853      1.135   mycroft }
    854      1.135   mycroft 
    855      1.108   mycroft void
    856      1.164   thorpej wdgetdefaultlabel(wd, lp)
    857      1.108   mycroft 	struct wd_softc *wd;
    858      1.164   thorpej 	struct disklabel *lp;
    859      1.108   mycroft {
    860      1.163    bouyer 
    861      1.181    bouyer 	WDCDEBUG_PRINT(("wdgetdefaultlabel\n"), DEBUG_FUNCS);
    862      1.181    bouyer 	memset(lp, 0, sizeof(struct disklabel));
    863      1.108   mycroft 
    864      1.142   mycroft 	lp->d_secsize = DEV_BSIZE;
    865      1.181    bouyer 	lp->d_ntracks = wd->sc_params.atap_heads;
    866      1.181    bouyer 	lp->d_nsectors = wd->sc_params.atap_sectors;
    867      1.181    bouyer 	lp->d_ncylinders = wd->sc_params.atap_cylinders;
    868      1.142   mycroft 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
    869      1.108   mycroft 
    870      1.198       leo 	if (strcmp(wd->sc_params.atap_model, "ST506") == 0)
    871      1.181    bouyer 		lp->d_type = DTYPE_ST506;
    872      1.198       leo 	else
    873      1.181    bouyer 		lp->d_type = DTYPE_ESDI;
    874      1.198       leo 
    875      1.181    bouyer 	strncpy(lp->d_typename, wd->sc_params.atap_model, 16);
    876      1.180  drochner 	strncpy(lp->d_packname, "fictitious", 16);
    877      1.181    bouyer 	lp->d_secperunit = wd->sc_capacity;
    878      1.142   mycroft 	lp->d_rpm = 3600;
    879      1.142   mycroft 	lp->d_interleave = 1;
    880      1.142   mycroft 	lp->d_flags = 0;
    881      1.142   mycroft 
    882      1.142   mycroft 	lp->d_partitions[RAW_PART].p_offset = 0;
    883      1.142   mycroft 	lp->d_partitions[RAW_PART].p_size =
    884      1.181    bouyer 	lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
    885      1.142   mycroft 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
    886      1.142   mycroft 	lp->d_npartitions = RAW_PART + 1;
    887      1.142   mycroft 
    888      1.142   mycroft 	lp->d_magic = DISKMAGIC;
    889      1.142   mycroft 	lp->d_magic2 = DISKMAGIC;
    890      1.142   mycroft 	lp->d_checksum = dkcksum(lp);
    891      1.164   thorpej }
    892      1.164   thorpej 
    893      1.164   thorpej /*
    894      1.164   thorpej  * Fabricate a default disk label, and try to read the correct one.
    895      1.164   thorpej  */
    896      1.164   thorpej void
    897      1.164   thorpej wdgetdisklabel(wd)
    898      1.164   thorpej 	struct wd_softc *wd;
    899      1.164   thorpej {
    900      1.164   thorpej 	struct disklabel *lp = wd->sc_dk.dk_label;
    901      1.164   thorpej 	char *errstring;
    902      1.164   thorpej 
    903      1.181    bouyer 	WDCDEBUG_PRINT(("wdgetdisklabel\n"), DEBUG_FUNCS);
    904      1.164   thorpej 
    905      1.181    bouyer 	memset(wd->sc_dk.dk_cpulabel, 0, sizeof(struct cpu_disklabel));
    906      1.164   thorpej 
    907      1.164   thorpej 	wdgetdefaultlabel(wd, lp);
    908      1.108   mycroft 
    909      1.181    bouyer 	wd->sc_badsect[0] = -1;
    910      1.113   mycroft 
    911      1.181    bouyer 	if (wd->drvp->state > RECAL)
    912      1.183    bouyer 		wd->drvp->drive_flags |= DRIVE_RESET;
    913      1.108   mycroft 	errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit, RAW_PART),
    914      1.144   thorpej 	    wdstrategy, lp, wd->sc_dk.dk_cpulabel);
    915      1.108   mycroft 	if (errstring) {
    916      1.108   mycroft 		/*
    917      1.108   mycroft 		 * This probably happened because the drive's default
    918      1.108   mycroft 		 * geometry doesn't match the DOS geometry.  We
    919      1.108   mycroft 		 * assume the DOS geometry is now in the label and try
    920      1.108   mycroft 		 * again.  XXX This is a kluge.
    921      1.108   mycroft 		 */
    922      1.181    bouyer 		if (wd->drvp->state > RECAL)
    923      1.183    bouyer 			wd->drvp->drive_flags |= DRIVE_RESET;
    924      1.181    bouyer 		errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit,
    925      1.181    bouyer 		    RAW_PART), wdstrategy, lp, wd->sc_dk.dk_cpulabel);
    926      1.108   mycroft 	}
    927      1.108   mycroft 	if (errstring) {
    928      1.153  christos 		printf("%s: %s\n", wd->sc_dev.dv_xname, errstring);
    929      1.108   mycroft 		return;
    930      1.108   mycroft 	}
    931      1.108   mycroft 
    932      1.181    bouyer 	if (wd->drvp->state > RECAL)
    933      1.183    bouyer 		wd->drvp->drive_flags |= DRIVE_RESET;
    934      1.170       leo #ifdef HAS_BAD144_HANDLING
    935      1.142   mycroft 	if ((lp->d_flags & D_BADSECT) != 0)
    936      1.108   mycroft 		bad144intern(wd);
    937      1.170       leo #endif
    938      1.108   mycroft }
    939      1.108   mycroft 
    940  1.214.2.1   thorpej void
    941  1.214.2.1   thorpej wdperror(drvp, errno, buf)
    942  1.214.2.1   thorpej 	struct ata_drive_datas *drvp;
    943  1.214.2.1   thorpej 	int errno;
    944  1.214.2.1   thorpej 	char *buf;
    945  1.214.2.1   thorpej {
    946  1.214.2.1   thorpej 	static char *errstr0_3[] = {"address mark not found",
    947  1.214.2.1   thorpej 	    "track 0 not found", "aborted command", "media change requested",
    948  1.214.2.1   thorpej 	    "id not found", "media changed", "uncorrectable data error",
    949  1.214.2.1   thorpej 	    "bad block detected"};
    950  1.214.2.1   thorpej 	static char *errstr4_5[] = {"obsolete (address mark not found)",
    951  1.214.2.1   thorpej 	    "no media/write protected", "aborted command",
    952  1.214.2.1   thorpej 	    "media change requested", "id not found", "media changed",
    953  1.214.2.1   thorpej 	    "uncorrectable data error", "interface CRC error"};
    954  1.214.2.1   thorpej 	char **errstr;
    955  1.214.2.1   thorpej 	int i;
    956  1.214.2.1   thorpej 	char *sep = "";
    957  1.214.2.1   thorpej 
    958  1.214.2.1   thorpej 	if (drvp->ata_vers >= 4)
    959  1.214.2.1   thorpej 		errstr = errstr4_5;
    960  1.214.2.1   thorpej 	else
    961  1.214.2.1   thorpej 		errstr = errstr0_3;
    962  1.214.2.1   thorpej 
    963  1.214.2.1   thorpej 	if (errno == 0)
    964  1.214.2.1   thorpej 		sprintf(buf, "error not notified");
    965  1.214.2.1   thorpej 
    966  1.214.2.1   thorpej 	for (i = 0; i < 8; i++) {
    967  1.214.2.1   thorpej 		if (errno & (1 << i)) {
    968  1.214.2.1   thorpej 			buf += sprintf(buf, "%s%s", sep, errstr[i]);
    969  1.214.2.1   thorpej 			sep = ", ";
    970  1.214.2.1   thorpej 		}
    971  1.214.2.1   thorpej 	}
    972  1.214.2.1   thorpej }
    973  1.214.2.1   thorpej 
    974        1.1       cgd int
    975      1.163    bouyer wdioctl(dev, xfer, addr, flag, p)
    976       1.55   mycroft 	dev_t dev;
    977      1.163    bouyer 	u_long xfer;
    978       1.55   mycroft 	caddr_t addr;
    979       1.55   mycroft 	int flag;
    980       1.55   mycroft 	struct proc *p;
    981        1.1       cgd {
    982      1.209   thorpej 	struct wd_softc *wd = device_lookup(&wd_cd, WDUNIT(dev));
    983       1.54   mycroft 	int error;
    984      1.211      fvdl #ifdef __HAVE_OLD_DISKLABEL
    985      1.211      fvdl 	struct disklabel newlabel;
    986      1.211      fvdl #endif
    987      1.163    bouyer 
    988      1.181    bouyer 	WDCDEBUG_PRINT(("wdioctl\n"), DEBUG_FUNCS);
    989      1.163    bouyer 
    990      1.181    bouyer 	if ((wd->sc_flags & WDF_LOADED) == 0)
    991      1.108   mycroft 		return EIO;
    992      1.108   mycroft 
    993      1.163    bouyer 	switch (xfer) {
    994      1.170       leo #ifdef HAS_BAD144_HANDLING
    995        1.1       cgd 	case DIOCSBAD:
    996        1.3   deraadt 		if ((flag & FWRITE) == 0)
    997       1.54   mycroft 			return EBADF;
    998      1.144   thorpej 		wd->sc_dk.dk_cpulabel->bad = *(struct dkbad *)addr;
    999      1.144   thorpej 		wd->sc_dk.dk_label->d_flags |= D_BADSECT;
   1000       1.64   mycroft 		bad144intern(wd);
   1001       1.54   mycroft 		return 0;
   1002      1.170       leo #endif
   1003        1.1       cgd 
   1004        1.1       cgd 	case DIOCGDINFO:
   1005      1.144   thorpej 		*(struct disklabel *)addr = *(wd->sc_dk.dk_label);
   1006       1.54   mycroft 		return 0;
   1007      1.211      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1008      1.211      fvdl 	case ODIOCGDINFO:
   1009      1.211      fvdl 		newlabel = *(wd->sc_dk.dk_label);
   1010      1.211      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
   1011      1.212      fvdl 			return ENOTTY;
   1012      1.211      fvdl 		memcpy(addr, &newlabel, sizeof (struct olddisklabel));
   1013      1.211      fvdl 		return 0;
   1014      1.211      fvdl #endif
   1015      1.211      fvdl 
   1016        1.3   deraadt 	case DIOCGPART:
   1017      1.144   thorpej 		((struct partinfo *)addr)->disklab = wd->sc_dk.dk_label;
   1018        1.3   deraadt 		((struct partinfo *)addr)->part =
   1019      1.144   thorpej 		    &wd->sc_dk.dk_label->d_partitions[WDPART(dev)];
   1020       1.54   mycroft 		return 0;
   1021        1.3   deraadt 
   1022      1.132   mycroft 	case DIOCWDINFO:
   1023        1.3   deraadt 	case DIOCSDINFO:
   1024      1.211      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1025      1.211      fvdl 	case ODIOCWDINFO:
   1026      1.211      fvdl 	case ODIOCSDINFO:
   1027      1.211      fvdl #endif
   1028      1.211      fvdl 	{
   1029      1.211      fvdl 		struct disklabel *lp;
   1030      1.211      fvdl 
   1031      1.211      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1032      1.211      fvdl 		if (xfer == ODIOCSDINFO || xfer == ODIOCWDINFO) {
   1033      1.211      fvdl 			memset(&newlabel, 0, sizeof newlabel);
   1034      1.211      fvdl 			memcpy(&newlabel, addr, sizeof (struct olddisklabel));
   1035      1.211      fvdl 			lp = &newlabel;
   1036      1.211      fvdl 		} else
   1037      1.211      fvdl #endif
   1038      1.211      fvdl 		lp = (struct disklabel *)addr;
   1039      1.211      fvdl 
   1040        1.3   deraadt 		if ((flag & FWRITE) == 0)
   1041       1.54   mycroft 			return EBADF;
   1042      1.132   mycroft 
   1043      1.181    bouyer 		if ((error = wdlock(wd)) != 0)
   1044      1.132   mycroft 			return error;
   1045      1.181    bouyer 		wd->sc_flags |= WDF_LABELLING;
   1046      1.132   mycroft 
   1047      1.144   thorpej 		error = setdisklabel(wd->sc_dk.dk_label,
   1048      1.211      fvdl 		    lp, /*wd->sc_dk.dk_openmask : */0,
   1049      1.144   thorpej 		    wd->sc_dk.dk_cpulabel);
   1050        1.3   deraadt 		if (error == 0) {
   1051      1.181    bouyer 			if (wd->drvp->state > RECAL)
   1052      1.183    bouyer 				wd->drvp->drive_flags |= DRIVE_RESET;
   1053      1.211      fvdl 			if (xfer == DIOCWDINFO
   1054      1.211      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1055      1.211      fvdl 			    || xfer == ODIOCWDINFO
   1056      1.211      fvdl #endif
   1057      1.211      fvdl 			    )
   1058      1.132   mycroft 				error = writedisklabel(WDLABELDEV(dev),
   1059      1.144   thorpej 				    wdstrategy, wd->sc_dk.dk_label,
   1060      1.144   thorpej 				    wd->sc_dk.dk_cpulabel);
   1061        1.1       cgd 		}
   1062      1.132   mycroft 
   1063      1.181    bouyer 		wd->sc_flags &= ~WDF_LABELLING;
   1064      1.181    bouyer 		wdunlock(wd);
   1065       1.54   mycroft 		return error;
   1066      1.211      fvdl 	}
   1067      1.199       leo 
   1068      1.199       leo 	case DIOCKLABEL:
   1069      1.199       leo 		if (*(int *)addr)
   1070      1.199       leo 			wd->sc_flags |= WDF_KLABEL;
   1071      1.199       leo 		else
   1072      1.199       leo 			wd->sc_flags &= ~WDF_KLABEL;
   1073      1.199       leo 		return 0;
   1074        1.3   deraadt 
   1075       1.44   mycroft 	case DIOCWLABEL:
   1076        1.3   deraadt 		if ((flag & FWRITE) == 0)
   1077       1.54   mycroft 			return EBADF;
   1078       1.93   mycroft 		if (*(int *)addr)
   1079      1.181    bouyer 			wd->sc_flags |= WDF_WLABEL;
   1080       1.93   mycroft 		else
   1081      1.181    bouyer 			wd->sc_flags &= ~WDF_WLABEL;
   1082       1.54   mycroft 		return 0;
   1083      1.164   thorpej 
   1084      1.164   thorpej 	case DIOCGDEFLABEL:
   1085      1.164   thorpej 		wdgetdefaultlabel(wd, (struct disklabel *)addr);
   1086      1.164   thorpej 		return 0;
   1087      1.211      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1088      1.211      fvdl 	case ODIOCGDEFLABEL:
   1089      1.211      fvdl 		wdgetdefaultlabel(wd, &newlabel);
   1090      1.211      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
   1091      1.212      fvdl 			return ENOTTY;
   1092      1.211      fvdl 		memcpy(addr, &newlabel, sizeof (struct olddisklabel));
   1093      1.211      fvdl 		return 0;
   1094      1.211      fvdl #endif
   1095      1.164   thorpej 
   1096        1.1       cgd #ifdef notyet
   1097        1.1       cgd 	case DIOCWFORMAT:
   1098        1.1       cgd 		if ((flag & FWRITE) == 0)
   1099       1.54   mycroft 			return EBADF;
   1100      1.181    bouyer 		{
   1101       1.54   mycroft 		register struct format_op *fop;
   1102       1.54   mycroft 		struct iovec aiov;
   1103       1.54   mycroft 		struct uio auio;
   1104      1.181    bouyer 
   1105       1.54   mycroft 		fop = (struct format_op *)addr;
   1106       1.54   mycroft 		aiov.iov_base = fop->df_buf;
   1107       1.54   mycroft 		aiov.iov_len = fop->df_count;
   1108       1.54   mycroft 		auio.uio_iov = &aiov;
   1109       1.54   mycroft 		auio.uio_iovcnt = 1;
   1110       1.54   mycroft 		auio.uio_resid = fop->df_count;
   1111       1.54   mycroft 		auio.uio_segflg = 0;
   1112       1.54   mycroft 		auio.uio_offset =
   1113      1.181    bouyer 			fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
   1114       1.83        pk 		auio.uio_procp = p;
   1115       1.64   mycroft 		error = physio(wdformat, NULL, dev, B_WRITE, minphys,
   1116       1.64   mycroft 		    &auio);
   1117       1.54   mycroft 		fop->df_count -= auio.uio_resid;
   1118       1.64   mycroft 		fop->df_reg[0] = wdc->sc_status;
   1119       1.64   mycroft 		fop->df_reg[1] = wdc->sc_error;
   1120       1.54   mycroft 		return error;
   1121      1.181    bouyer 		}
   1122        1.1       cgd #endif
   1123      1.185      kenh 
   1124      1.186      kenh 	case ATAIOCCOMMAND:
   1125      1.185      kenh 		/*
   1126      1.185      kenh 		 * Make sure this command is (relatively) safe first
   1127      1.185      kenh 		 */
   1128      1.186      kenh 		if ((((atareq_t *) addr)->flags & ATACMD_READ) == 0 &&
   1129      1.185      kenh 		    (flag & FWRITE) == 0)
   1130      1.185      kenh 			return (EBADF);
   1131      1.185      kenh 		{
   1132      1.185      kenh 		struct wd_ioctl *wi;
   1133      1.186      kenh 		atareq_t *atareq = (atareq_t *) addr;
   1134      1.185      kenh 		int error;
   1135      1.185      kenh 
   1136      1.185      kenh 		wi = wi_get();
   1137      1.185      kenh 		wi->wi_softc = wd;
   1138      1.186      kenh 		wi->wi_atareq = *atareq;
   1139      1.185      kenh 
   1140      1.186      kenh 		if (atareq->datalen && atareq->flags &
   1141      1.186      kenh 		    (ATACMD_READ | ATACMD_WRITE)) {
   1142      1.186      kenh 			wi->wi_iov.iov_base = atareq->databuf;
   1143      1.186      kenh 			wi->wi_iov.iov_len = atareq->datalen;
   1144      1.185      kenh 			wi->wi_uio.uio_iov = &wi->wi_iov;
   1145      1.185      kenh 			wi->wi_uio.uio_iovcnt = 1;
   1146      1.186      kenh 			wi->wi_uio.uio_resid = atareq->datalen;
   1147      1.185      kenh 			wi->wi_uio.uio_offset = 0;
   1148      1.185      kenh 			wi->wi_uio.uio_segflg = UIO_USERSPACE;
   1149      1.185      kenh 			wi->wi_uio.uio_rw =
   1150      1.186      kenh 			    (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE;
   1151      1.185      kenh 			wi->wi_uio.uio_procp = p;
   1152      1.185      kenh 			error = physio(wdioctlstrategy, &wi->wi_bp, dev,
   1153      1.186      kenh 			    (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE,
   1154      1.185      kenh 			    minphys, &wi->wi_uio);
   1155      1.185      kenh 		} else {
   1156      1.185      kenh 			/* No need to call physio if we don't have any
   1157      1.185      kenh 			   user data */
   1158      1.185      kenh 			wi->wi_bp.b_flags = 0;
   1159      1.185      kenh 			wi->wi_bp.b_data = 0;
   1160      1.185      kenh 			wi->wi_bp.b_bcount = 0;
   1161      1.185      kenh 			wi->wi_bp.b_dev = 0;
   1162      1.185      kenh 			wi->wi_bp.b_proc = p;
   1163      1.185      kenh 			wdioctlstrategy(&wi->wi_bp);
   1164      1.185      kenh 			error = wi->wi_bp.b_error;
   1165      1.185      kenh 		}
   1166      1.186      kenh 		*atareq = wi->wi_atareq;
   1167      1.185      kenh 		wi_free(wi);
   1168      1.185      kenh 		return(error);
   1169      1.185      kenh 		}
   1170      1.185      kenh 
   1171        1.1       cgd 	default:
   1172       1.54   mycroft 		return ENOTTY;
   1173        1.1       cgd 	}
   1174       1.54   mycroft 
   1175       1.54   mycroft #ifdef DIAGNOSTIC
   1176       1.54   mycroft 	panic("wdioctl: impossible");
   1177       1.54   mycroft #endif
   1178        1.1       cgd }
   1179        1.1       cgd 
   1180       1.44   mycroft #ifdef B_FORMAT
   1181        1.1       cgd int
   1182        1.1       cgd wdformat(struct buf *bp)
   1183        1.1       cgd {
   1184       1.44   mycroft 
   1185        1.1       cgd 	bp->b_flags |= B_FORMAT;
   1186       1.37   mycroft 	return wdstrategy(bp);
   1187        1.1       cgd }
   1188        1.1       cgd #endif
   1189        1.1       cgd 
   1190        1.1       cgd int
   1191       1.55   mycroft wdsize(dev)
   1192       1.55   mycroft 	dev_t dev;
   1193        1.1       cgd {
   1194       1.64   mycroft 	struct wd_softc *wd;
   1195      1.208   thorpej 	int part, omask;
   1196      1.108   mycroft 	int size;
   1197      1.163    bouyer 
   1198      1.181    bouyer 	WDCDEBUG_PRINT(("wdsize\n"), DEBUG_FUNCS);
   1199      1.163    bouyer 
   1200      1.208   thorpej 	wd = device_lookup(&wd_cd, WDUNIT(dev));
   1201      1.158        pk 	if (wd == NULL)
   1202      1.158        pk 		return (-1);
   1203      1.158        pk 
   1204      1.158        pk 	part = WDPART(dev);
   1205      1.158        pk 	omask = wd->sc_dk.dk_openmask & (1 << part);
   1206      1.158        pk 
   1207      1.158        pk 	if (omask == 0 && wdopen(dev, 0, S_IFBLK, NULL) != 0)
   1208      1.158        pk 		return (-1);
   1209      1.144   thorpej 	if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
   1210      1.108   mycroft 		size = -1;
   1211      1.108   mycroft 	else
   1212      1.160   thorpej 		size = wd->sc_dk.dk_label->d_partitions[part].p_size *
   1213      1.181    bouyer 		    (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
   1214      1.158        pk 	if (omask == 0 && wdclose(dev, 0, S_IFBLK, NULL) != 0)
   1215      1.158        pk 		return (-1);
   1216      1.158        pk 	return (size);
   1217        1.1       cgd }
   1218        1.1       cgd 
   1219      1.140       cgd /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
   1220      1.181    bouyer static int wddoingadump = 0;
   1221      1.181    bouyer static int wddumprecalibrated = 0;
   1222      1.181    bouyer static int wddumpmulti = 1;
   1223      1.140       cgd 
   1224       1.64   mycroft /*
   1225       1.64   mycroft  * Dump core after a system crash.
   1226       1.64   mycroft  */
   1227        1.1       cgd int
   1228      1.140       cgd wddump(dev, blkno, va, size)
   1229      1.181    bouyer 	dev_t dev;
   1230      1.181    bouyer 	daddr_t blkno;
   1231      1.181    bouyer 	caddr_t va;
   1232      1.181    bouyer 	size_t size;
   1233      1.140       cgd {
   1234      1.140       cgd 	struct wd_softc *wd;	/* disk unit to do the I/O */
   1235      1.181    bouyer 	struct disklabel *lp;   /* disk's disklabel */
   1236      1.208   thorpej 	int part, err;
   1237      1.181    bouyer 	int nblks;	/* total number of sectors left to write */
   1238      1.181    bouyer 	char errbuf[256];
   1239      1.140       cgd 
   1240      1.140       cgd 	/* Check if recursive dump; if so, punt. */
   1241      1.116   mycroft 	if (wddoingadump)
   1242      1.116   mycroft 		return EFAULT;
   1243      1.142   mycroft 	wddoingadump = 1;
   1244      1.140       cgd 
   1245      1.208   thorpej 	wd = device_lookup(&wd_cd, WDUNIT(dev));
   1246      1.208   thorpej 	if (wd == NULL)
   1247      1.208   thorpej 		return (ENXIO);
   1248       1.60   mycroft 
   1249      1.140       cgd 	part = WDPART(dev);
   1250      1.140       cgd 
   1251      1.140       cgd 	/* Make sure it was initialized. */
   1252      1.181    bouyer 	if (wd->drvp->state < READY)
   1253       1.37   mycroft 		return ENXIO;
   1254      1.140       cgd 
   1255      1.181    bouyer 	/* Convert to disk sectors.  Request must be a multiple of size. */
   1256      1.144   thorpej 	lp = wd->sc_dk.dk_label;
   1257      1.142   mycroft 	if ((size % lp->d_secsize) != 0)
   1258      1.140       cgd 		return EFAULT;
   1259      1.142   mycroft 	nblks = size / lp->d_secsize;
   1260      1.142   mycroft 	blkno = blkno / (lp->d_secsize / DEV_BSIZE);
   1261      1.116   mycroft 
   1262       1.64   mycroft 	/* Check transfer bounds against partition size. */
   1263      1.142   mycroft 	if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size))
   1264      1.140       cgd 		return EINVAL;
   1265      1.140       cgd 
   1266      1.140       cgd 	/* Offset block number to start of partition. */
   1267      1.142   mycroft 	blkno += lp->d_partitions[part].p_offset;
   1268       1.60   mycroft 
   1269      1.140       cgd 	/* Recalibrate, if first dump transfer. */
   1270      1.140       cgd 	if (wddumprecalibrated == 0) {
   1271      1.181    bouyer 		wddumpmulti = wd->sc_multi;
   1272      1.140       cgd 		wddumprecalibrated = 1;
   1273      1.205    bouyer 		wd->drvp->state = RESET;
   1274       1.63   mycroft 	}
   1275      1.181    bouyer 
   1276      1.142   mycroft 	while (nblks > 0) {
   1277      1.181    bouyer again:
   1278      1.214     bjh21 		wd->sc_bp = NULL;
   1279      1.181    bouyer 		wd->sc_wdc_bio.blkno = blkno;
   1280      1.181    bouyer 		wd->sc_wdc_bio.flags = ATA_POLL;
   1281      1.181    bouyer 		if (wddumpmulti == 1)
   1282      1.181    bouyer 			wd->sc_wdc_bio.flags |= ATA_SINGLE;
   1283  1.214.2.2  jdolecek 		if (wd->sc_flags & WDF_LBA48)
   1284  1.214.2.2  jdolecek 			wd->sc_wdc_bio.flags |= ATA_LBA48;
   1285      1.181    bouyer 		if (wd->sc_flags & WDF_LBA)
   1286      1.181    bouyer 			wd->sc_wdc_bio.flags |= ATA_LBA;
   1287      1.181    bouyer 		wd->sc_wdc_bio.bcount =
   1288      1.181    bouyer 			min(nblks, wddumpmulti) * lp->d_secsize;
   1289      1.181    bouyer 		wd->sc_wdc_bio.databuf = va;
   1290      1.181    bouyer #ifndef WD_DUMP_NOT_TRUSTED
   1291  1.214.2.1   thorpej 		switch (wd->atabus->ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
   1292      1.181    bouyer 		case WDC_TRY_AGAIN:
   1293      1.181    bouyer 			panic("wddump: try again");
   1294      1.181    bouyer 			break;
   1295      1.181    bouyer 		case WDC_QUEUED:
   1296      1.181    bouyer 			panic("wddump: polled command has been queued");
   1297      1.181    bouyer 			break;
   1298      1.181    bouyer 		case WDC_COMPLETE:
   1299      1.181    bouyer 			break;
   1300      1.116   mycroft 		}
   1301      1.181    bouyer 		switch(wd->sc_wdc_bio.error) {
   1302      1.181    bouyer 		case TIMEOUT:
   1303      1.181    bouyer 			printf("wddump: device timed out");
   1304      1.181    bouyer 			err = EIO;
   1305      1.181    bouyer 			break;
   1306      1.181    bouyer 		case ERR_DF:
   1307      1.181    bouyer 			printf("wddump: drive fault");
   1308      1.181    bouyer 			err = EIO;
   1309      1.181    bouyer 			break;
   1310      1.181    bouyer 		case ERR_DMA:
   1311      1.181    bouyer 			printf("wddump: DMA error");
   1312      1.181    bouyer 			err = EIO;
   1313      1.181    bouyer 			break;
   1314      1.181    bouyer 		case ERROR:
   1315      1.181    bouyer 			errbuf[0] = '\0';
   1316  1.214.2.1   thorpej 			wdperror(wd->drvp, wd->sc_wdc_bio.r_error, errbuf);
   1317      1.181    bouyer 			printf("wddump: %s", errbuf);
   1318      1.181    bouyer 			err = EIO;
   1319      1.181    bouyer 			break;
   1320      1.181    bouyer 		case NOERROR:
   1321      1.181    bouyer 			err = 0;
   1322      1.181    bouyer 			break;
   1323      1.181    bouyer 		default:
   1324      1.181    bouyer 			panic("wddump: unknown error type");
   1325        1.3   deraadt 		}
   1326      1.181    bouyer 		if (err != 0) {
   1327      1.181    bouyer 			if (wddumpmulti != 1) {
   1328      1.181    bouyer 				wddumpmulti = 1; /* retry in single-sector */
   1329      1.181    bouyer 				printf(", retrying\n");
   1330      1.181    bouyer 				goto again;
   1331      1.181    bouyer 			}
   1332      1.181    bouyer 			printf("\n");
   1333      1.181    bouyer 			return err;
   1334       1.63   mycroft 		}
   1335      1.140       cgd #else	/* WD_DUMP_NOT_TRUSTED */
   1336      1.140       cgd 		/* Let's just talk about this first... */
   1337      1.153  christos 		printf("wd%d: dump addr 0x%x, cylin %d, head %d, sector %d\n",
   1338      1.140       cgd 		    unit, va, cylin, head, sector);
   1339      1.140       cgd 		delay(500 * 1000);	/* half a second */
   1340      1.140       cgd #endif
   1341        1.1       cgd 
   1342      1.140       cgd 		/* update block count */
   1343      1.181    bouyer 		nblks -= min(nblks, wddumpmulti);
   1344      1.181    bouyer 		blkno += min(nblks, wddumpmulti);
   1345      1.181    bouyer 		va += min(nblks, wddumpmulti) * lp->d_secsize;
   1346        1.1       cgd 	}
   1347      1.142   mycroft 
   1348      1.140       cgd 	wddoingadump = 0;
   1349      1.140       cgd 	return 0;
   1350      1.140       cgd }
   1351        1.3   deraadt 
   1352      1.170       leo #ifdef HAS_BAD144_HANDLING
   1353        1.3   deraadt /*
   1354        1.3   deraadt  * Internalize the bad sector table.
   1355        1.3   deraadt  */
   1356        1.3   deraadt void
   1357       1.64   mycroft bad144intern(wd)
   1358       1.64   mycroft 	struct wd_softc *wd;
   1359        1.3   deraadt {
   1360      1.144   thorpej 	struct dkbad *bt = &wd->sc_dk.dk_cpulabel->bad;
   1361      1.144   thorpej 	struct disklabel *lp = wd->sc_dk.dk_label;
   1362       1.98   mycroft 	int i = 0;
   1363       1.55   mycroft 
   1364      1.182    bouyer 	WDCDEBUG_PRINT(("bad144intern\n"), DEBUG_XFERS);
   1365      1.163    bouyer 
   1366      1.170       leo 	for (; i < NBT_BAD; i++) {
   1367       1.98   mycroft 		if (bt->bt_bad[i].bt_cyl == 0xffff)
   1368       1.55   mycroft 			break;
   1369      1.181    bouyer 		wd->sc_badsect[i] =
   1370       1.98   mycroft 		    bt->bt_bad[i].bt_cyl * lp->d_secpercyl +
   1371       1.98   mycroft 		    (bt->bt_bad[i].bt_trksec >> 8) * lp->d_nsectors +
   1372       1.98   mycroft 		    (bt->bt_bad[i].bt_trksec & 0xff);
   1373        1.3   deraadt 	}
   1374      1.170       leo 	for (; i < NBT_BAD+1; i++)
   1375      1.181    bouyer 		wd->sc_badsect[i] = -1;
   1376       1.64   mycroft }
   1377      1.170       leo #endif
   1378       1.64   mycroft 
   1379      1.181    bouyer int
   1380      1.181    bouyer wd_get_params(wd, flags, params)
   1381      1.181    bouyer 	struct wd_softc *wd;
   1382      1.181    bouyer 	u_int8_t flags;
   1383      1.181    bouyer 	struct ataparams *params;
   1384       1.63   mycroft {
   1385  1.214.2.1   thorpej 	switch (wd->atabus->ata_get_params(wd->drvp, flags, params)) {
   1386      1.181    bouyer 	case CMD_AGAIN:
   1387      1.181    bouyer 		return 1;
   1388      1.181    bouyer 	case CMD_ERR:
   1389      1.181    bouyer 		/*
   1390      1.181    bouyer 		 * We `know' there's a drive here; just assume it's old.
   1391      1.181    bouyer 		 * This geometry is only used to read the MBR and print a
   1392      1.181    bouyer 		 * (false) attach message.
   1393      1.181    bouyer 		 */
   1394      1.181    bouyer 		strncpy(params->atap_model, "ST506",
   1395      1.181    bouyer 		    sizeof params->atap_model);
   1396      1.181    bouyer 		params->atap_config = ATA_CFG_FIXED;
   1397      1.181    bouyer 		params->atap_cylinders = 1024;
   1398      1.181    bouyer 		params->atap_heads = 8;
   1399      1.181    bouyer 		params->atap_sectors = 17;
   1400      1.181    bouyer 		params->atap_multi = 1;
   1401      1.181    bouyer 		params->atap_capabilities1 = params->atap_capabilities2 = 0;
   1402      1.190    bouyer 		wd->drvp->ata_vers = -1; /* Mark it as pre-ATA */
   1403      1.181    bouyer 		return 0;
   1404      1.181    bouyer 	case CMD_OK:
   1405      1.181    bouyer 		return 0;
   1406      1.181    bouyer 	default:
   1407      1.181    bouyer 		panic("wd_get_params: bad return code from ata_get_params");
   1408      1.181    bouyer 		/* NOTREACHED */
   1409      1.181    bouyer 	}
   1410      1.190    bouyer }
   1411      1.190    bouyer 
   1412      1.190    bouyer void
   1413      1.190    bouyer wd_flushcache(wd, flags)
   1414      1.190    bouyer 	struct wd_softc *wd;
   1415      1.190    bouyer 	int flags;
   1416      1.190    bouyer {
   1417      1.190    bouyer 	struct wdc_command wdc_c;
   1418      1.190    bouyer 
   1419      1.190    bouyer 	if (wd->drvp->ata_vers < 4) /* WDCC_FLUSHCACHE is here since ATA-4 */
   1420      1.190    bouyer 		return;
   1421      1.190    bouyer 	memset(&wdc_c, 0, sizeof(struct wdc_command));
   1422      1.190    bouyer 	wdc_c.r_command = WDCC_FLUSHCACHE;
   1423      1.190    bouyer 	wdc_c.r_st_bmask = WDCS_DRDY;
   1424      1.190    bouyer 	wdc_c.r_st_pmask = WDCS_DRDY;
   1425      1.194    bouyer 	wdc_c.flags = flags;
   1426      1.190    bouyer 	wdc_c.timeout = 30000; /* 30s timeout */
   1427  1.214.2.1   thorpej 	if (wd->atabus->ata_exec_command(wd->drvp, &wdc_c) != WDC_COMPLETE) {
   1428      1.190    bouyer 		printf("%s: flush cache command didn't complete\n",
   1429      1.190    bouyer 		    wd->sc_dev.dv_xname);
   1430      1.190    bouyer 	}
   1431      1.190    bouyer 	if (wdc_c.flags & AT_TIMEOU) {
   1432      1.190    bouyer 		printf("%s: flush cache command timeout\n",
   1433      1.190    bouyer 		    wd->sc_dev.dv_xname);
   1434      1.190    bouyer 	}
   1435      1.190    bouyer 	if (wdc_c.flags & AT_DF) {
   1436      1.190    bouyer 		printf("%s: flush cache command: drive fault\n",
   1437      1.190    bouyer 		    wd->sc_dev.dv_xname);
   1438      1.190    bouyer 	}
   1439      1.190    bouyer 	/*
   1440      1.190    bouyer 	 * Ignore error register, it shouldn't report anything else
   1441      1.190    bouyer 	 * than COMMAND ABORTED, which means the device doesn't support
   1442      1.190    bouyer 	 * flush cache
   1443      1.190    bouyer 	 */
   1444      1.190    bouyer }
   1445      1.190    bouyer 
   1446      1.190    bouyer void
   1447      1.190    bouyer wd_shutdown(arg)
   1448      1.190    bouyer 	void *arg;
   1449      1.190    bouyer {
   1450      1.190    bouyer 	struct wd_softc *wd = arg;
   1451      1.194    bouyer 	wd_flushcache(wd, AT_POLL);
   1452      1.185      kenh }
   1453      1.185      kenh 
   1454      1.185      kenh /*
   1455      1.185      kenh  * Allocate space for a ioctl queue structure.  Mostly taken from
   1456      1.185      kenh  * scsipi_ioctl.c
   1457      1.185      kenh  */
   1458      1.185      kenh struct wd_ioctl *
   1459      1.185      kenh wi_get()
   1460      1.185      kenh {
   1461      1.185      kenh 	struct wd_ioctl *wi;
   1462      1.185      kenh 	int s;
   1463      1.185      kenh 
   1464  1.214.2.2  jdolecek 	wi = malloc(sizeof(struct wd_ioctl), M_TEMP, M_WAITOK|M_ZERO);
   1465      1.185      kenh 	s = splbio();
   1466      1.185      kenh 	LIST_INSERT_HEAD(&wi_head, wi, wi_list);
   1467      1.185      kenh 	splx(s);
   1468      1.185      kenh 	return (wi);
   1469      1.185      kenh }
   1470      1.185      kenh 
   1471      1.185      kenh /*
   1472      1.185      kenh  * Free an ioctl structure and remove it from our list
   1473      1.185      kenh  */
   1474      1.185      kenh 
   1475      1.185      kenh void
   1476      1.185      kenh wi_free(wi)
   1477      1.185      kenh 	struct wd_ioctl *wi;
   1478      1.185      kenh {
   1479      1.185      kenh 	int s;
   1480      1.185      kenh 
   1481      1.185      kenh 	s = splbio();
   1482      1.185      kenh 	LIST_REMOVE(wi, wi_list);
   1483      1.185      kenh 	splx(s);
   1484      1.185      kenh 	free(wi, M_TEMP);
   1485      1.185      kenh }
   1486      1.185      kenh 
   1487      1.185      kenh /*
   1488      1.185      kenh  * Find a wd_ioctl structure based on the struct buf.
   1489      1.185      kenh  */
   1490      1.185      kenh 
   1491      1.185      kenh struct wd_ioctl *
   1492      1.185      kenh wi_find(bp)
   1493      1.185      kenh 	struct buf *bp;
   1494      1.185      kenh {
   1495      1.185      kenh 	struct wd_ioctl *wi;
   1496      1.185      kenh 	int s;
   1497      1.185      kenh 
   1498      1.185      kenh 	s = splbio();
   1499      1.185      kenh 	for (wi = wi_head.lh_first; wi != 0; wi = wi->wi_list.le_next)
   1500      1.185      kenh 		if (bp == &wi->wi_bp)
   1501      1.185      kenh 			break;
   1502      1.185      kenh 	splx(s);
   1503      1.185      kenh 	return (wi);
   1504      1.185      kenh }
   1505      1.185      kenh 
   1506      1.185      kenh /*
   1507      1.185      kenh  * Ioctl pseudo strategy routine
   1508      1.185      kenh  *
   1509      1.185      kenh  * This is mostly stolen from scsipi_ioctl.c:scsistrategy().  What
   1510      1.185      kenh  * happens here is:
   1511      1.185      kenh  *
   1512      1.185      kenh  * - wdioctl() queues a wd_ioctl structure.
   1513      1.185      kenh  *
   1514      1.185      kenh  * - wdioctl() calls physio/wdioctlstrategy based on whether or not
   1515      1.185      kenh  *   user space I/O is required.  If physio() is called, physio() eventually
   1516      1.185      kenh  *   calls wdioctlstrategy().
   1517      1.185      kenh  *
   1518  1.214.2.1   thorpej  * - In either case, wdioctlstrategy() calls wd->atabus->ata_exec_command()
   1519      1.185      kenh  *   to perform the actual command
   1520      1.185      kenh  *
   1521      1.185      kenh  * The reason for the use of the pseudo strategy routine is because
   1522      1.185      kenh  * when doing I/O to/from user space, physio _really_ wants to be in
   1523      1.185      kenh  * the loop.  We could put the entire buffer into the ioctl request
   1524      1.185      kenh  * structure, but that won't scale if we want to do things like download
   1525      1.185      kenh  * microcode.
   1526      1.185      kenh  */
   1527      1.185      kenh 
   1528      1.185      kenh void
   1529      1.185      kenh wdioctlstrategy(bp)
   1530      1.185      kenh 	struct buf *bp;
   1531      1.185      kenh {
   1532      1.185      kenh 	struct wd_ioctl *wi;
   1533      1.185      kenh 	struct wdc_command wdc_c;
   1534      1.185      kenh 	int error = 0;
   1535      1.185      kenh 
   1536      1.185      kenh 	wi = wi_find(bp);
   1537      1.185      kenh 	if (wi == NULL) {
   1538      1.185      kenh 		printf("user_strat: No ioctl\n");
   1539      1.185      kenh 		error = EINVAL;
   1540      1.185      kenh 		goto bad;
   1541      1.185      kenh 	}
   1542      1.185      kenh 
   1543      1.185      kenh 	memset(&wdc_c, 0, sizeof(wdc_c));
   1544      1.185      kenh 
   1545      1.185      kenh 	/*
   1546      1.185      kenh 	 * Abort if physio broke up the transfer
   1547      1.185      kenh 	 */
   1548      1.185      kenh 
   1549      1.186      kenh 	if (bp->b_bcount != wi->wi_atareq.datalen) {
   1550      1.185      kenh 		printf("physio split wd ioctl request... cannot proceed\n");
   1551      1.185      kenh 		error = EIO;
   1552      1.185      kenh 		goto bad;
   1553      1.185      kenh 	}
   1554      1.185      kenh 
   1555      1.185      kenh 	/*
   1556      1.185      kenh 	 * Abort if we didn't get a buffer size that was a multiple of
   1557      1.185      kenh 	 * our sector size (or was larger than NBBY)
   1558      1.185      kenh 	 */
   1559      1.185      kenh 
   1560      1.185      kenh 	if ((bp->b_bcount % wi->wi_softc->sc_dk.dk_label->d_secsize) != 0 ||
   1561      1.185      kenh 	    (bp->b_bcount / wi->wi_softc->sc_dk.dk_label->d_secsize) >=
   1562      1.185      kenh 	     (1 << NBBY)) {
   1563      1.185      kenh 		error = EINVAL;
   1564      1.185      kenh 		goto bad;
   1565      1.185      kenh 	}
   1566      1.185      kenh 
   1567      1.185      kenh 	/*
   1568      1.185      kenh 	 * Make sure a timeout was supplied in the ioctl request
   1569      1.185      kenh 	 */
   1570      1.185      kenh 
   1571      1.186      kenh 	if (wi->wi_atareq.timeout == 0) {
   1572      1.185      kenh 		error = EINVAL;
   1573      1.185      kenh 		goto bad;
   1574      1.185      kenh 	}
   1575      1.185      kenh 
   1576      1.186      kenh 	if (wi->wi_atareq.flags & ATACMD_READ)
   1577      1.185      kenh 		wdc_c.flags |= AT_READ;
   1578      1.186      kenh 	else if (wi->wi_atareq.flags & ATACMD_WRITE)
   1579      1.185      kenh 		wdc_c.flags |= AT_WRITE;
   1580      1.185      kenh 
   1581      1.188      kenh 	if (wi->wi_atareq.flags & ATACMD_READREG)
   1582      1.188      kenh 		wdc_c.flags |= AT_READREG;
   1583      1.188      kenh 
   1584      1.185      kenh 	wdc_c.flags |= AT_WAIT;
   1585      1.185      kenh 
   1586      1.186      kenh 	wdc_c.timeout = wi->wi_atareq.timeout;
   1587      1.186      kenh 	wdc_c.r_command = wi->wi_atareq.command;
   1588      1.186      kenh 	wdc_c.r_head = wi->wi_atareq.head & 0x0f;
   1589      1.186      kenh 	wdc_c.r_cyl = wi->wi_atareq.cylinder;
   1590      1.186      kenh 	wdc_c.r_sector = wi->wi_atareq.sec_num;
   1591      1.186      kenh 	wdc_c.r_count = wi->wi_atareq.sec_count;
   1592      1.186      kenh 	wdc_c.r_precomp = wi->wi_atareq.features;
   1593      1.185      kenh 	wdc_c.r_st_bmask = WDCS_DRDY;
   1594      1.185      kenh 	wdc_c.r_st_pmask = WDCS_DRDY;
   1595      1.185      kenh 	wdc_c.data = wi->wi_bp.b_data;
   1596      1.185      kenh 	wdc_c.bcount = wi->wi_bp.b_bcount;
   1597      1.185      kenh 
   1598  1.214.2.1   thorpej 	if (wi->wi_softc->atabus->ata_exec_command(wi->wi_softc->drvp, &wdc_c)
   1599  1.214.2.1   thorpej 	    != WDC_COMPLETE) {
   1600      1.186      kenh 		wi->wi_atareq.retsts = ATACMD_ERROR;
   1601      1.185      kenh 		goto bad;
   1602      1.185      kenh 	}
   1603      1.185      kenh 
   1604      1.185      kenh 	if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
   1605      1.185      kenh 		if (wdc_c.flags & AT_ERROR) {
   1606      1.186      kenh 			wi->wi_atareq.retsts = ATACMD_ERROR;
   1607      1.186      kenh 			wi->wi_atareq.error = wdc_c.r_error;
   1608      1.185      kenh 		} else if (wdc_c.flags & AT_DF)
   1609      1.186      kenh 			wi->wi_atareq.retsts = ATACMD_DF;
   1610      1.185      kenh 		else
   1611      1.186      kenh 			wi->wi_atareq.retsts = ATACMD_TIMEOUT;
   1612      1.188      kenh 	} else {
   1613      1.186      kenh 		wi->wi_atareq.retsts = ATACMD_OK;
   1614      1.188      kenh 		if (wi->wi_atareq.flags & ATACMD_READREG) {
   1615      1.188      kenh 			wi->wi_atareq.head = wdc_c.r_head ;
   1616      1.188      kenh 			wi->wi_atareq.cylinder = wdc_c.r_cyl;
   1617      1.188      kenh 			wi->wi_atareq.sec_num = wdc_c.r_sector;
   1618      1.188      kenh 			wi->wi_atareq.sec_count = wdc_c.r_count;
   1619      1.188      kenh 			wi->wi_atareq.features = wdc_c.r_precomp;
   1620      1.188      kenh 			wi->wi_atareq.error = wdc_c.r_error;
   1621      1.188      kenh 		}
   1622      1.188      kenh 	}
   1623      1.185      kenh 
   1624      1.185      kenh 	bp->b_error = 0;
   1625      1.185      kenh 	biodone(bp);
   1626      1.185      kenh 	return;
   1627      1.185      kenh bad:
   1628      1.185      kenh 	bp->b_flags |= B_ERROR;
   1629      1.185      kenh 	bp->b_error = error;
   1630      1.185      kenh 	biodone(bp);
   1631       1.21   deraadt }
   1632