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