Home | History | Annotate | Line # | Download | only in ata
wd.c revision 1.362
      1 /*	$NetBSD: wd.c,v 1.362 2008/05/02 21:11:00 plunky Exp $ */
      2 
      3 /*
      4  * Copyright (c) 1998, 2001 Manuel Bouyer.  All rights reserved.
      5  *
      6  * Redistribution and use in source and binary forms, with or without
      7  * modification, are permitted provided that the following conditions
      8  * are met:
      9  * 1. Redistributions of source code must retain the above copyright
     10  *	notice, this list of conditions and the following disclaimer.
     11  * 2. Redistributions in binary form must reproduce the above copyright
     12  *	notice, this list of conditions and the following disclaimer in the
     13  *	documentation and/or other materials provided with the distribution.
     14  * 3. All advertising materials mentioning features or use of this software
     15  *	must display the following acknowledgement:
     16  *  This product includes software developed by Manuel Bouyer.
     17  * 4. The name of the author may not be used to endorse or promote products
     18  *	derived from this software without specific prior written permission.
     19  *
     20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 /*-
     33  * Copyright (c) 1998, 2003, 2004 The NetBSD Foundation, Inc.
     34  * All rights reserved.
     35  *
     36  * This code is derived from software contributed to The NetBSD Foundation
     37  * by Charles M. Hannum and by Onno van der Linden.
     38  *
     39  * Redistribution and use in source and binary forms, with or without
     40  * modification, are permitted provided that the following conditions
     41  * are met:
     42  * 1. Redistributions of source code must retain the above copyright
     43  *    notice, this list of conditions and the following disclaimer.
     44  * 2. Redistributions in binary form must reproduce the above copyright
     45  *    notice, this list of conditions and the following disclaimer in the
     46  *    documentation and/or other materials provided with the distribution.
     47  *
     48  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     49  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     50  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     51  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     52  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     53  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     54  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     55  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     56  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     57  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     58  * POSSIBILITY OF SUCH DAMAGE.
     59  */
     60 
     61 #include <sys/cdefs.h>
     62 __KERNEL_RCSID(0, "$NetBSD: wd.c,v 1.362 2008/05/02 21:11:00 plunky Exp $");
     63 
     64 #include "opt_ata.h"
     65 
     66 #include "rnd.h"
     67 
     68 #include <sys/param.h>
     69 #include <sys/systm.h>
     70 #include <sys/kernel.h>
     71 #include <sys/conf.h>
     72 #include <sys/file.h>
     73 #include <sys/stat.h>
     74 #include <sys/ioctl.h>
     75 #include <sys/buf.h>
     76 #include <sys/bufq.h>
     77 #include <sys/uio.h>
     78 #include <sys/malloc.h>
     79 #include <sys/device.h>
     80 #include <sys/disklabel.h>
     81 #include <sys/disk.h>
     82 #include <sys/syslog.h>
     83 #include <sys/proc.h>
     84 #include <sys/reboot.h>
     85 #include <sys/vnode.h>
     86 #if NRND > 0
     87 #include <sys/rnd.h>
     88 #endif
     89 
     90 #include <sys/intr.h>
     91 #include <sys/bus.h>
     92 
     93 #include <dev/ata/atareg.h>
     94 #include <dev/ata/atavar.h>
     95 #include <dev/ata/wdvar.h>
     96 #include <dev/ic/wdcreg.h>
     97 #include <sys/ataio.h>
     98 #include "locators.h"
     99 
    100 #include <prop/proplib.h>
    101 
    102 #define	LBA48_THRESHOLD		(0xfffffff)	/* 128GB / DEV_BSIZE */
    103 
    104 #define	WDIORETRIES_SINGLE 4	/* number of retries before single-sector */
    105 #define	WDIORETRIES	5	/* number of retries before giving up */
    106 #define	RECOVERYTIME hz/2	/* time to wait before retrying a cmd */
    107 
    108 #define	WDUNIT(dev)		DISKUNIT(dev)
    109 #define	WDPART(dev)		DISKPART(dev)
    110 #define	WDMINOR(unit, part)	DISKMINOR(unit, part)
    111 #define	MAKEWDDEV(maj, unit, part)	MAKEDISKDEV(maj, unit, part)
    112 
    113 #define	WDLABELDEV(dev)	(MAKEWDDEV(major(dev), WDUNIT(dev), RAW_PART))
    114 
    115 #define DEBUG_INTR   0x01
    116 #define DEBUG_XFERS  0x02
    117 #define DEBUG_STATUS 0x04
    118 #define DEBUG_FUNCS  0x08
    119 #define DEBUG_PROBE  0x10
    120 #ifdef ATADEBUG
    121 int wdcdebug_wd_mask = 0x0;
    122 #define ATADEBUG_PRINT(args, level) \
    123 	if (wdcdebug_wd_mask & (level)) \
    124 		printf args
    125 #else
    126 #define ATADEBUG_PRINT(args, level)
    127 #endif
    128 
    129 int	wdprobe(struct device *, struct cfdata *, void *);
    130 void	wdattach(struct device *, struct device *, void *);
    131 int	wddetach(struct device *, int);
    132 int	wdactivate(struct device *, enum devact);
    133 int	wdprint(void *, char *);
    134 void	wdperror(const struct wd_softc *);
    135 
    136 static bool	wd_suspend(device_t PMF_FN_PROTO);
    137 static int	wd_standby(struct wd_softc *, int);
    138 
    139 CFATTACH_DECL_NEW(wd, sizeof(struct wd_softc),
    140     wdprobe, wdattach, wddetach, wdactivate);
    141 
    142 extern struct cfdriver wd_cd;
    143 
    144 dev_type_open(wdopen);
    145 dev_type_close(wdclose);
    146 dev_type_read(wdread);
    147 dev_type_write(wdwrite);
    148 dev_type_ioctl(wdioctl);
    149 dev_type_strategy(wdstrategy);
    150 dev_type_dump(wddump);
    151 dev_type_size(wdsize);
    152 
    153 const struct bdevsw wd_bdevsw = {
    154 	wdopen, wdclose, wdstrategy, wdioctl, wddump, wdsize, D_DISK
    155 };
    156 
    157 const struct cdevsw wd_cdevsw = {
    158 	wdopen, wdclose, wdread, wdwrite, wdioctl,
    159 	nostop, notty, nopoll, nommap, nokqfilter, D_DISK
    160 };
    161 
    162 /*
    163  * Glue necessary to hook WDCIOCCOMMAND into physio
    164  */
    165 
    166 struct wd_ioctl {
    167 	LIST_ENTRY(wd_ioctl) wi_list;
    168 	struct buf wi_bp;
    169 	struct uio wi_uio;
    170 	struct iovec wi_iov;
    171 	atareq_t wi_atareq;
    172 	struct wd_softc *wi_softc;
    173 };
    174 
    175 LIST_HEAD(, wd_ioctl) wi_head;
    176 
    177 struct	wd_ioctl *wi_find(struct buf *);
    178 void	wi_free(struct wd_ioctl *);
    179 struct	wd_ioctl *wi_get(void);
    180 void	wdioctlstrategy(struct buf *);
    181 
    182 void  wdgetdefaultlabel(struct wd_softc *, struct disklabel *);
    183 void  wdgetdisklabel(struct wd_softc *);
    184 void  wdstart(void *);
    185 void  __wdstart(struct wd_softc*, struct buf *);
    186 void  wdrestart(void *);
    187 void  wddone(void *);
    188 int   wd_get_params(struct wd_softc *, u_int8_t, struct ataparams *);
    189 int   wd_flushcache(struct wd_softc *, int);
    190 bool  wd_shutdown(device_t, int);
    191 
    192 int   wd_getcache(struct wd_softc *, int *);
    193 int   wd_setcache(struct wd_softc *, int);
    194 
    195 struct dkdriver wddkdriver = { wdstrategy, minphys };
    196 
    197 #ifdef HAS_BAD144_HANDLING
    198 static void bad144intern(struct wd_softc *);
    199 #endif
    200 
    201 #define	WD_QUIRK_SPLIT_MOD15_WRITE	0x0001	/* must split certain writes */
    202 #define	WD_QUIRK_FORCE_LBA48		0x0002	/* must use LBA48 commands */
    203 
    204 #define	WD_QUIRK_FMT "\20\1SPLIT_MOD15_WRITE\2FORCE_LBA48"
    205 
    206 /*
    207  * Quirk table for IDE drives.  Put more-specific matches first, since
    208  * a simple globbing routine is used for matching.
    209  */
    210 static const struct wd_quirk {
    211 	const char *wdq_match;		/* inquiry pattern to match */
    212 	int wdq_quirks;			/* drive quirks */
    213 } wd_quirk_table[] = {
    214 	/*
    215 	 * Some Seagate S-ATA drives have a PHY which can get confused
    216 	 * with the way data is packetized by some S-ATA controllers.
    217 	 *
    218 	 * The work-around is to split in two any write transfer whose
    219 	 * sector count % 15 == 1 (assuming 512 byte sectors).
    220 	 *
    221 	 * XXX This is an incomplete list.  There are at least a couple
    222 	 * XXX more model numbers.  If you have trouble with such transfers
    223 	 * XXX (8K is the most common) on Seagate S-ATA drives, please
    224 	 * XXX notify thorpej (at) NetBSD.org.
    225 	 */
    226 	{ "ST3120023AS",
    227 	  WD_QUIRK_SPLIT_MOD15_WRITE },
    228 	{ "ST380023AS",
    229 	  WD_QUIRK_SPLIT_MOD15_WRITE },
    230 
    231 	/*
    232 	 * These seagate drives seems to have issue addressing sector 0xfffffff
    233 	 * (aka LBA48_THRESHOLD) in LBA mode. The workaround is to force
    234 	 * LBA48
    235 	 * Note that we can't just change the code to always use LBA48 for
    236 	 * sector 0xfffffff, because this would break valid and working
    237 	 * setups using LBA48 drives on non-LBA48-capable controllers
    238 	 * (and it's hard to get a list of such controllers)
    239 	 */
    240 	{ "ST3160021A*",
    241 	  WD_QUIRK_FORCE_LBA48 },
    242 	{ "ST3160811A*",
    243 	  WD_QUIRK_FORCE_LBA48 },
    244 	{ "ST3160812A*",
    245 	  WD_QUIRK_FORCE_LBA48 },
    246 	{ "ST3160023A*",
    247 	  WD_QUIRK_FORCE_LBA48 },
    248 	{ "ST3160827A*",
    249 	  WD_QUIRK_FORCE_LBA48 },
    250 	/* Attempt to catch all seagate drives larger than 200GB */
    251 	{ "ST3[2-9][0-9][0-9][0-9][0-9][0-9][A-Z]*",
    252 	  WD_QUIRK_FORCE_LBA48 },
    253 	{ "ST3[1-9][0-9][0-9][0-9][0-9][0-9][0-9][A-Z]*",
    254 	  WD_QUIRK_FORCE_LBA48 },
    255 	{ NULL,
    256 	  0 }
    257 };
    258 
    259 static const struct wd_quirk *
    260 wd_lookup_quirks(const char *name)
    261 {
    262 	const struct wd_quirk *wdq;
    263 	const char *estr;
    264 
    265 	for (wdq = wd_quirk_table; wdq->wdq_match != NULL; wdq++) {
    266 		/*
    267 		 * We only want exact matches (which include matches
    268 		 * against globbing characters).
    269 		 */
    270 		if (pmatch(name, wdq->wdq_match, &estr) == 2)
    271 			return (wdq);
    272 	}
    273 	return (NULL);
    274 }
    275 
    276 int
    277 wdprobe(struct device *parent, struct cfdata *match, void *aux)
    278 {
    279 	struct ata_device *adev = aux;
    280 
    281 	if (adev == NULL)
    282 		return 0;
    283 	if (adev->adev_bustype->bustype_type != SCSIPI_BUSTYPE_ATA)
    284 		return 0;
    285 
    286 	if (match->cf_loc[ATA_HLCF_DRIVE] != ATA_HLCF_DRIVE_DEFAULT &&
    287 	    match->cf_loc[ATA_HLCF_DRIVE] != adev->adev_drv_data->drive)
    288 		return 0;
    289 	return 1;
    290 }
    291 
    292 void
    293 wdattach(struct device *parent, struct device *self, void *aux)
    294 {
    295 	struct wd_softc *wd = device_private(self);
    296 	struct ata_device *adev= aux;
    297 	int i, blank;
    298 	char tbuf[41], pbuf[9], c, *p, *q;
    299 	const struct wd_quirk *wdq;
    300 
    301 	wd->sc_dev = self;
    302 
    303 	ATADEBUG_PRINT(("wdattach\n"), DEBUG_FUNCS | DEBUG_PROBE);
    304 	callout_init(&wd->sc_restart_ch, 0);
    305 	bufq_alloc(&wd->sc_q, BUFQ_DISK_DEFAULT_STRAT, BUFQ_SORT_RAWBLOCK);
    306 #ifdef WD_SOFTBADSECT
    307 	SLIST_INIT(&wd->sc_bslist);
    308 #endif
    309 	wd->atabus = adev->adev_bustype;
    310 	wd->openings = adev->adev_openings;
    311 	wd->drvp = adev->adev_drv_data;
    312 
    313 	wd->drvp->drv_done = wddone;
    314 	wd->drvp->drv_softc = wd->sc_dev;
    315 
    316 	aprint_naive("\n");
    317 
    318 	/* read our drive info */
    319 	if (wd_get_params(wd, AT_WAIT, &wd->sc_params) != 0) {
    320 		aprint_error("\n%s: IDENTIFY failed\n", device_xname(self));
    321 		return;
    322 	}
    323 
    324 	for (blank = 0, p = wd->sc_params.atap_model, q = tbuf, i = 0;
    325 	    i < sizeof(wd->sc_params.atap_model); i++) {
    326 		c = *p++;
    327 		if (c == '\0')
    328 			break;
    329 		if (c != ' ') {
    330 			if (blank) {
    331 				*q++ = ' ';
    332 				blank = 0;
    333 			}
    334 			*q++ = c;
    335 		} else
    336 			blank = 1;
    337 	}
    338 	*q++ = '\0';
    339 
    340 	aprint_normal(": <%s>\n", tbuf);
    341 
    342 	wdq = wd_lookup_quirks(tbuf);
    343 	if (wdq != NULL)
    344 		wd->sc_quirks = wdq->wdq_quirks;
    345 
    346 	if (wd->sc_quirks != 0) {
    347 		char sbuf[sizeof(WD_QUIRK_FMT) + 64];
    348 		bitmask_snprintf(wd->sc_quirks, WD_QUIRK_FMT,
    349 		    sbuf, sizeof(sbuf));
    350 		aprint_normal_dev(self, "quirks %s\n", sbuf);
    351 	}
    352 
    353 	if ((wd->sc_params.atap_multi & 0xff) > 1) {
    354 		wd->sc_multi = wd->sc_params.atap_multi & 0xff;
    355 	} else {
    356 		wd->sc_multi = 1;
    357 	}
    358 
    359 	aprint_verbose_dev(self, "drive supports %d-sector PIO transfers,",
    360 	    wd->sc_multi);
    361 
    362 	/* 48-bit LBA addressing */
    363 	if ((wd->sc_params.atap_cmd2_en & ATA_CMD2_LBA48) != 0)
    364 		wd->sc_flags |= WDF_LBA48;
    365 
    366 	/* Prior to ATA-4, LBA was optional. */
    367 	if ((wd->sc_params.atap_capabilities1 & WDC_CAP_LBA) != 0)
    368 		wd->sc_flags |= WDF_LBA;
    369 #if 0
    370 	/* ATA-4 requires LBA. */
    371 	if (wd->sc_params.atap_ataversion != 0xffff &&
    372 	    wd->sc_params.atap_ataversion >= WDC_VER_ATA4)
    373 		wd->sc_flags |= WDF_LBA;
    374 #endif
    375 
    376 	if ((wd->sc_flags & WDF_LBA48) != 0) {
    377 		aprint_verbose(" LBA48 addressing\n");
    378 		wd->sc_capacity =
    379 		    ((u_int64_t) wd->sc_params.__reserved6[11] << 48) |
    380 		    ((u_int64_t) wd->sc_params.__reserved6[10] << 32) |
    381 		    ((u_int64_t) wd->sc_params.__reserved6[9]  << 16) |
    382 		    ((u_int64_t) wd->sc_params.__reserved6[8]  << 0);
    383 	} else if ((wd->sc_flags & WDF_LBA) != 0) {
    384 		aprint_verbose(" LBA addressing\n");
    385 		wd->sc_capacity =
    386 		    ((u_int64_t)wd->sc_params.atap_capacity[1] << 16) |
    387 		    wd->sc_params.atap_capacity[0];
    388 	} else {
    389 		aprint_verbose(" chs addressing\n");
    390 		wd->sc_capacity =
    391 		    wd->sc_params.atap_cylinders *
    392 		    wd->sc_params.atap_heads *
    393 		    wd->sc_params.atap_sectors;
    394 	}
    395 	format_bytes(pbuf, sizeof(pbuf), wd->sc_capacity * DEV_BSIZE);
    396 	aprint_normal_dev(self, "%s, %d cyl, %d head, %d sec, "
    397 	    "%d bytes/sect x %llu sectors\n",
    398 	    pbuf,
    399 	    (wd->sc_flags & WDF_LBA) ? (int)(wd->sc_capacity /
    400 		(wd->sc_params.atap_heads * wd->sc_params.atap_sectors)) :
    401 		wd->sc_params.atap_cylinders,
    402 	    wd->sc_params.atap_heads, wd->sc_params.atap_sectors,
    403 	    DEV_BSIZE, (unsigned long long)wd->sc_capacity);
    404 
    405 	ATADEBUG_PRINT(("%s: atap_dmatiming_mimi=%d, atap_dmatiming_recom=%d\n",
    406 	    device_xname(self), wd->sc_params.atap_dmatiming_mimi,
    407 	    wd->sc_params.atap_dmatiming_recom), DEBUG_PROBE);
    408 	/*
    409 	 * Initialize and attach the disk structure.
    410 	 */
    411 	/* we fill in dk_info later */
    412 	disk_init(&wd->sc_dk, device_xname(wd->sc_dev), &wddkdriver);
    413 	disk_attach(&wd->sc_dk);
    414 	wd->sc_wdc_bio.lp = wd->sc_dk.dk_label;
    415 #if NRND > 0
    416 	rnd_attach_source(&wd->rnd_source, device_xname(wd->sc_dev),
    417 			  RND_TYPE_DISK, 0);
    418 #endif
    419 
    420 	/* Discover wedges on this disk. */
    421 	dkwedge_discover(&wd->sc_dk);
    422 
    423 	if (!pmf_device_register1(self, wd_suspend, NULL, wd_shutdown))
    424 		aprint_error_dev(self, "couldn't establish power handler\n");
    425 }
    426 
    427 static bool
    428 wd_suspend(device_t dv PMF_FN_ARGS)
    429 {
    430 	struct wd_softc *sc = device_private(dv);
    431 
    432 	wd_flushcache(sc, AT_WAIT);
    433 	wd_standby(sc, AT_WAIT);
    434 	return true;
    435 }
    436 
    437 int
    438 wdactivate(struct device *self, enum devact act)
    439 {
    440 	int rv = 0;
    441 
    442 	switch (act) {
    443 	case DVACT_ACTIVATE:
    444 		rv = EOPNOTSUPP;
    445 		break;
    446 
    447 	case DVACT_DEACTIVATE:
    448 		/*
    449 		 * Nothing to do; we key off the device's DVF_ACTIVATE.
    450 		 */
    451 		break;
    452 	}
    453 	return (rv);
    454 }
    455 
    456 int
    457 wddetach(struct device *self, int flags)
    458 {
    459 	struct wd_softc *sc = device_private(self);
    460 	int s, bmaj, cmaj, i, mn;
    461 
    462 	/* locate the major number */
    463 	bmaj = bdevsw_lookup_major(&wd_bdevsw);
    464 	cmaj = cdevsw_lookup_major(&wd_cdevsw);
    465 
    466 	/* Nuke the vnodes for any open instances. */
    467 	for (i = 0; i < MAXPARTITIONS; i++) {
    468 		mn = WDMINOR(device_unit(self), i);
    469 		vdevgone(bmaj, mn, mn, VBLK);
    470 		vdevgone(cmaj, mn, mn, VCHR);
    471 	}
    472 
    473 	/* Delete all of our wedges. */
    474 	dkwedge_delall(&sc->sc_dk);
    475 
    476 	s = splbio();
    477 
    478 	/* Kill off any queued buffers. */
    479 	bufq_drain(sc->sc_q);
    480 
    481 	bufq_free(sc->sc_q);
    482 	sc->atabus->ata_killpending(sc->drvp);
    483 
    484 	splx(s);
    485 
    486 	/* Detach disk. */
    487 	disk_detach(&sc->sc_dk);
    488 	disk_destroy(&sc->sc_dk);
    489 
    490 #ifdef WD_SOFTBADSECT
    491 	/* Clean out the bad sector list */
    492 	while (!SLIST_EMPTY(&sc->sc_bslist)) {
    493 		void *head = SLIST_FIRST(&sc->sc_bslist);
    494 		SLIST_REMOVE_HEAD(&sc->sc_bslist, dbs_next);
    495 		free(head, M_TEMP);
    496 	}
    497 	sc->sc_bscount = 0;
    498 #endif
    499 
    500 	pmf_device_deregister(self);
    501 
    502 #if NRND > 0
    503 	/* Unhook the entropy source. */
    504 	rnd_detach_source(&sc->rnd_source);
    505 #endif
    506 
    507 	sc->drvp->drive_flags = 0; /* no drive any more here */
    508 
    509 	return (0);
    510 }
    511 
    512 /*
    513  * Read/write routine for a buffer.  Validates the arguments and schedules the
    514  * transfer.  Does not wait for the transfer to complete.
    515  */
    516 void
    517 wdstrategy(struct buf *bp)
    518 {
    519 	struct wd_softc *wd =
    520 	    device_private(device_lookup(&wd_cd, WDUNIT(bp->b_dev)));
    521 	struct disklabel *lp = wd->sc_dk.dk_label;
    522 	daddr_t blkno;
    523 	int s;
    524 
    525 	ATADEBUG_PRINT(("wdstrategy (%s)\n", device_xname(wd->sc_dev)),
    526 	    DEBUG_XFERS);
    527 
    528 	/* Valid request?  */
    529 	if (bp->b_blkno < 0 ||
    530 	    (bp->b_bcount % lp->d_secsize) != 0 ||
    531 	    (bp->b_bcount / lp->d_secsize) >= (1 << NBBY)) {
    532 		bp->b_error = EINVAL;
    533 		goto done;
    534 	}
    535 
    536 	/* If device invalidated (e.g. media change, door open), error. */
    537 	if ((wd->sc_flags & WDF_LOADED) == 0) {
    538 		bp->b_error = EIO;
    539 		goto done;
    540 	}
    541 
    542 	/* If it's a null transfer, return immediately. */
    543 	if (bp->b_bcount == 0)
    544 		goto done;
    545 
    546 	/*
    547 	 * Do bounds checking, adjust transfer. if error, process.
    548 	 * If end of partition, just return.
    549 	 */
    550 	if (WDPART(bp->b_dev) == RAW_PART) {
    551 		if (bounds_check_with_mediasize(bp, DEV_BSIZE,
    552 		    wd->sc_capacity) <= 0)
    553 			goto done;
    554 	} else {
    555 		if (bounds_check_with_label(&wd->sc_dk, bp,
    556 		    (wd->sc_flags & (WDF_WLABEL|WDF_LABELLING)) != 0) <= 0)
    557 			goto done;
    558 	}
    559 
    560 	/*
    561 	 * Now convert the block number to absolute and put it in
    562 	 * terms of the device's logical block size.
    563 	 */
    564 	if (lp->d_secsize >= DEV_BSIZE)
    565 		blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
    566 	else
    567 		blkno = bp->b_blkno * (DEV_BSIZE / lp->d_secsize);
    568 
    569 	if (WDPART(bp->b_dev) != RAW_PART)
    570 		blkno += lp->d_partitions[WDPART(bp->b_dev)].p_offset;
    571 
    572 	bp->b_rawblkno = blkno;
    573 
    574 #ifdef WD_SOFTBADSECT
    575 	/*
    576 	 * If the transfer about to be attempted contains only a block that
    577 	 * is known to be bad then return an error for the transfer without
    578 	 * even attempting to start a transfer up under the premis that we
    579 	 * will just end up doing more retries for a transfer that will end
    580 	 * up failing again.
    581 	 * XXX:SMP - mutex required to protect with DIOCBSFLUSH
    582 	 */
    583 	if (__predict_false(!SLIST_EMPTY(&wd->sc_bslist))) {
    584 		struct disk_badsectors *dbs;
    585 		daddr_t maxblk = blkno + (bp->b_bcount >> DEV_BSHIFT) - 1;
    586 
    587 		SLIST_FOREACH(dbs, &wd->sc_bslist, dbs_next)
    588 			if ((dbs->dbs_min <= blkno && blkno <= dbs->dbs_max) ||
    589 			    (dbs->dbs_min <= maxblk && maxblk <= dbs->dbs_max)){
    590 				bp->b_error = EIO;
    591 				goto done;
    592 			}
    593 	}
    594 #endif
    595 
    596 	/* Queue transfer on drive, activate drive and controller if idle. */
    597 	s = splbio();
    598 	BUFQ_PUT(wd->sc_q, bp);
    599 	wdstart(wd);
    600 	splx(s);
    601 	return;
    602 done:
    603 	/* Toss transfer; we're done early. */
    604 	bp->b_resid = bp->b_bcount;
    605 	biodone(bp);
    606 }
    607 
    608 /*
    609  * Queue a drive for I/O.
    610  */
    611 void
    612 wdstart(void *arg)
    613 {
    614 	struct wd_softc *wd = arg;
    615 	struct buf *bp = NULL;
    616 
    617 	ATADEBUG_PRINT(("wdstart %s\n", device_xname(wd->sc_dev)),
    618 	    DEBUG_XFERS);
    619 	while (wd->openings > 0) {
    620 
    621 		/* Is there a buf for us ? */
    622 		if ((bp = BUFQ_GET(wd->sc_q)) == NULL)
    623 			return;
    624 
    625 		/*
    626 		 * Make the command. First lock the device
    627 		 */
    628 		wd->openings--;
    629 
    630 		wd->retries = 0;
    631 		__wdstart(wd, bp);
    632 	}
    633 }
    634 
    635 static void
    636 wd_split_mod15_write(struct buf *bp)
    637 {
    638 	struct buf *obp = bp->b_private;
    639 	struct wd_softc *sc =
    640 	    device_private(wd_cd.cd_devs[DISKUNIT(obp->b_dev)]);
    641 
    642 	if (__predict_false(bp->b_error != 0)) {
    643 		/*
    644 		 * Propagate the error.  If this was the first half of
    645 		 * the original transfer, make sure to account for that
    646 		 * in the residual.
    647 		 */
    648 		if (bp->b_data == obp->b_data)
    649 			bp->b_resid += bp->b_bcount;
    650 		goto done;
    651 	}
    652 
    653 	/*
    654 	 * If this was the second half of the transfer, we're all done!
    655 	 */
    656 	if (bp->b_data != obp->b_data)
    657 		goto done;
    658 
    659 	/*
    660 	 * Advance the pointer to the second half and issue that command
    661 	 * using the same opening.
    662 	 */
    663 	bp->b_flags = obp->b_flags;
    664 	bp->b_oflags = obp->b_oflags;
    665 	bp->b_cflags = obp->b_cflags;
    666 	bp->b_data = (char *)bp->b_data + bp->b_bcount;
    667 	bp->b_blkno += (bp->b_bcount / 512);
    668 	bp->b_rawblkno += (bp->b_bcount / 512);
    669 	__wdstart(sc, bp);
    670 	return;
    671 
    672  done:
    673 	obp->b_error = bp->b_error;
    674 	obp->b_resid = bp->b_resid;
    675 	putiobuf(bp);
    676 	biodone(obp);
    677 	sc->openings++;
    678 	/* wddone() will call wdstart() */
    679 }
    680 
    681 void
    682 __wdstart(struct wd_softc *wd, struct buf *bp)
    683 {
    684 
    685 	/*
    686 	 * Deal with the "split mod15 write" quirk.  We just divide the
    687 	 * transfer in two, doing the first half and then then second half
    688 	 * with the same command opening.
    689 	 *
    690 	 * Note we MUST do this here, because we can't let insertion
    691 	 * into the bufq cause the transfers to be re-merged.
    692 	 */
    693 	if (__predict_false((wd->sc_quirks & WD_QUIRK_SPLIT_MOD15_WRITE) != 0 &&
    694 			    (bp->b_flags & B_READ) == 0 &&
    695 			    bp->b_bcount > 512 &&
    696 			    ((bp->b_bcount / 512) % 15) == 1)) {
    697 		struct buf *nbp;
    698 
    699 		/* already at splbio */
    700 		nbp = getiobuf(NULL, false);
    701 		if (__predict_false(nbp == NULL)) {
    702 			/* No memory -- fail the iop. */
    703 			bp->b_error = ENOMEM;
    704 			bp->b_resid = bp->b_bcount;
    705 			biodone(bp);
    706 			wd->openings++;
    707 			return;
    708 		}
    709 
    710 		nbp->b_error = 0;
    711 		nbp->b_proc = bp->b_proc;
    712 		nbp->b_dev = bp->b_dev;
    713 
    714 		nbp->b_bcount = bp->b_bcount / 2;
    715 		nbp->b_bufsize = bp->b_bcount / 2;
    716 		nbp->b_data = bp->b_data;
    717 
    718 		nbp->b_blkno = bp->b_blkno;
    719 		nbp->b_rawblkno = bp->b_rawblkno;
    720 
    721 		nbp->b_flags = bp->b_flags;
    722 		nbp->b_oflags = bp->b_oflags;
    723 		nbp->b_cflags = bp->b_cflags;
    724 		nbp->b_iodone = wd_split_mod15_write;
    725 
    726 		/* Put ptr to orig buf in b_private and use new buf */
    727 		nbp->b_private = bp;
    728 
    729 		BIO_COPYPRIO(nbp, bp);
    730 
    731 		bp = nbp;
    732 	}
    733 
    734 	wd->sc_wdc_bio.blkno = bp->b_rawblkno;
    735 	wd->sc_wdc_bio.blkdone =0;
    736 	wd->sc_bp = bp;
    737 	/*
    738 	 * If we're retrying, retry in single-sector mode. This will give us
    739 	 * the sector number of the problem, and will eventually allow the
    740 	 * transfer to succeed.
    741 	 */
    742 	if (wd->retries >= WDIORETRIES_SINGLE)
    743 		wd->sc_wdc_bio.flags = ATA_SINGLE;
    744 	else
    745 		wd->sc_wdc_bio.flags = 0;
    746 	if (wd->sc_flags & WDF_LBA48 &&
    747 	    (wd->sc_wdc_bio.blkno > LBA48_THRESHOLD ||
    748 	    (wd->sc_quirks & WD_QUIRK_FORCE_LBA48) != 0))
    749 		wd->sc_wdc_bio.flags |= ATA_LBA48;
    750 	if (wd->sc_flags & WDF_LBA)
    751 		wd->sc_wdc_bio.flags |= ATA_LBA;
    752 	if (bp->b_flags & B_READ)
    753 		wd->sc_wdc_bio.flags |= ATA_READ;
    754 	wd->sc_wdc_bio.bcount = bp->b_bcount;
    755 	wd->sc_wdc_bio.databuf = bp->b_data;
    756 	/* Instrumentation. */
    757 	disk_busy(&wd->sc_dk);
    758 	switch (wd->atabus->ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
    759 	case ATACMD_TRY_AGAIN:
    760 		callout_reset(&wd->sc_restart_ch, hz, wdrestart, wd);
    761 		break;
    762 	case ATACMD_QUEUED:
    763 	case ATACMD_COMPLETE:
    764 		break;
    765 	default:
    766 		panic("__wdstart: bad return code from ata_bio()");
    767 	}
    768 }
    769 
    770 void
    771 wddone(void *v)
    772 {
    773 	struct wd_softc *wd = device_private(v);
    774 	struct buf *bp = wd->sc_bp;
    775 	const char *errmsg;
    776 	int do_perror = 0;
    777 	int nblks;
    778 
    779 	ATADEBUG_PRINT(("wddone %s\n", device_xname(wd->sc_dev)),
    780 	    DEBUG_XFERS);
    781 	if (bp == NULL)
    782 		return;
    783 	bp->b_resid = wd->sc_wdc_bio.bcount;
    784 	switch (wd->sc_wdc_bio.error) {
    785 	case ERR_DMA:
    786 		errmsg = "DMA error";
    787 		goto retry;
    788 	case ERR_DF:
    789 		errmsg = "device fault";
    790 		goto retry;
    791 	case TIMEOUT:
    792 		errmsg = "device timeout";
    793 		goto retry;
    794 	case ERR_RESET:
    795 		errmsg = "channel reset";
    796 		goto retry2;
    797 	case ERROR:
    798 		/* Don't care about media change bits */
    799 		if (wd->sc_wdc_bio.r_error != 0 &&
    800 		    (wd->sc_wdc_bio.r_error & ~(WDCE_MC | WDCE_MCR)) == 0)
    801 			goto noerror;
    802 		errmsg = "error";
    803 		do_perror = 1;
    804 		if ((wd->sc_wdc_bio.r_error & (WDCE_IDNF | WDCE_ABRT)) &&
    805 		    (wd->sc_quirks & WD_QUIRK_FORCE_LBA48) == 0) {
    806 			nblks = wd->sc_wdc_bio.bcount /
    807 			    wd->sc_dk.dk_label->d_secsize;
    808 			/*
    809 			 * If we get a "id not found" when crossing the
    810 			 * LBA48_THRESHOLD, and the drive is larger than
    811 			 * 128GB, then we can assume the drive has the
    812 			 * LBA48 bug and we switch to LBA48.
    813 			 */
    814 			if (wd->sc_wdc_bio.blkno <= LBA48_THRESHOLD &&
    815 			    wd->sc_wdc_bio.blkno + nblks > LBA48_THRESHOLD &&
    816 			    wd->sc_capacity > LBA48_THRESHOLD + 1) {
    817 				errmsg = "LBA48 bug";
    818 				wd->sc_quirks |= WD_QUIRK_FORCE_LBA48;
    819 				do_perror = 0;
    820 				goto retry2;
    821 			}
    822 		}
    823 retry:		/* Just reset and retry. Can we do more ? */
    824 		(*wd->atabus->ata_reset_drive)(wd->drvp, AT_RST_NOCMD);
    825 retry2:
    826 		diskerr(bp, "wd", errmsg, LOG_PRINTF,
    827 		    wd->sc_wdc_bio.blkdone, wd->sc_dk.dk_label);
    828 		if (wd->retries < WDIORETRIES)
    829 			printf(", retrying");
    830 		printf("\n");
    831 		if (do_perror)
    832 			wdperror(wd);
    833 		if (wd->retries < WDIORETRIES) {
    834 			wd->retries++;
    835 			callout_reset(&wd->sc_restart_ch, RECOVERYTIME,
    836 			    wdrestart, wd);
    837 			return;
    838 		}
    839 
    840 #ifdef WD_SOFTBADSECT
    841 		/*
    842 		 * Not all errors indicate a failed block but those that do,
    843 		 * put the block on the bad-block list for the device.  Only
    844 		 * do this for reads because the drive should do it for writes,
    845 		 * itself, according to Manuel.
    846 		 */
    847 		if ((bp->b_flags & B_READ) &&
    848 		    ((wd->drvp->ata_vers >= 4 && wd->sc_wdc_bio.r_error & 64) ||
    849 	     	     (wd->drvp->ata_vers < 4 && wd->sc_wdc_bio.r_error & 192))) {
    850 			struct disk_badsectors *dbs;
    851 
    852 			dbs = malloc(sizeof *dbs, M_TEMP, M_WAITOK);
    853 			dbs->dbs_min = bp->b_rawblkno;
    854 			dbs->dbs_max = dbs->dbs_min + (bp->b_bcount >> DEV_BSHIFT) - 1;
    855 			microtime(&dbs->dbs_failedat);
    856 			SLIST_INSERT_HEAD(&wd->sc_bslist, dbs, dbs_next);
    857 			wd->sc_bscount++;
    858 		}
    859 #endif
    860 		bp->b_error = EIO;
    861 		break;
    862 	case NOERROR:
    863 noerror:	if ((wd->sc_wdc_bio.flags & ATA_CORR) || wd->retries > 0)
    864 			aprint_error_dev(wd->sc_dev,
    865 			    "soft error (corrected)\n");
    866 		break;
    867 	case ERR_NODEV:
    868 		bp->b_error = EIO;
    869 		break;
    870 	}
    871 	disk_unbusy(&wd->sc_dk, (bp->b_bcount - bp->b_resid),
    872 	    (bp->b_flags & B_READ));
    873 #if NRND > 0
    874 	rnd_add_uint32(&wd->rnd_source, bp->b_blkno);
    875 #endif
    876 	/* XXX Yuck, but we don't want to increment openings in this case */
    877 	if (__predict_false(bp->b_iodone == wd_split_mod15_write))
    878 		biodone(bp);
    879 	else {
    880 		biodone(bp);
    881 		wd->openings++;
    882 	}
    883 	wdstart(wd);
    884 }
    885 
    886 void
    887 wdrestart(void *v)
    888 {
    889 	struct wd_softc *wd = v;
    890 	struct buf *bp = wd->sc_bp;
    891 	int s;
    892 
    893 	ATADEBUG_PRINT(("wdrestart %s\n", device_xname(wd->sc_dev)),
    894 	    DEBUG_XFERS);
    895 	s = splbio();
    896 	__wdstart(v, bp);
    897 	splx(s);
    898 }
    899 
    900 int
    901 wdread(dev_t dev, struct uio *uio, int flags)
    902 {
    903 
    904 	ATADEBUG_PRINT(("wdread\n"), DEBUG_XFERS);
    905 	return (physio(wdstrategy, NULL, dev, B_READ, minphys, uio));
    906 }
    907 
    908 int
    909 wdwrite(dev_t dev, struct uio *uio, int flags)
    910 {
    911 
    912 	ATADEBUG_PRINT(("wdwrite\n"), DEBUG_XFERS);
    913 	return (physio(wdstrategy, NULL, dev, B_WRITE, minphys, uio));
    914 }
    915 
    916 int
    917 wdopen(dev_t dev, int flag, int fmt, struct lwp *l)
    918 {
    919 	struct wd_softc *wd;
    920 	int part, error;
    921 
    922 	ATADEBUG_PRINT(("wdopen\n"), DEBUG_FUNCS);
    923 	wd = device_private(device_lookup(&wd_cd, WDUNIT(dev)));
    924 	if (wd == NULL)
    925 		return (ENXIO);
    926 
    927 	if (! device_is_active(wd->sc_dev))
    928 		return (ENODEV);
    929 
    930 	part = WDPART(dev);
    931 
    932 	mutex_enter(&wd->sc_dk.dk_openlock);
    933 
    934 	/*
    935 	 * If there are wedges, and this is not RAW_PART, then we
    936 	 * need to fail.
    937 	 */
    938 	if (wd->sc_dk.dk_nwedges != 0 && part != RAW_PART) {
    939 		error = EBUSY;
    940 		goto bad1;
    941 	}
    942 
    943 	/*
    944 	 * If this is the first open of this device, add a reference
    945 	 * to the adapter.
    946 	 */
    947 	if (wd->sc_dk.dk_openmask == 0 &&
    948 	    (error = wd->atabus->ata_addref(wd->drvp)) != 0)
    949 		goto bad1;
    950 
    951 	if (wd->sc_dk.dk_openmask != 0) {
    952 		/*
    953 		 * If any partition is open, but the disk has been invalidated,
    954 		 * disallow further opens.
    955 		 */
    956 		if ((wd->sc_flags & WDF_LOADED) == 0) {
    957 			error = EIO;
    958 			goto bad2;
    959 		}
    960 	} else {
    961 		if ((wd->sc_flags & WDF_LOADED) == 0) {
    962 			wd->sc_flags |= WDF_LOADED;
    963 
    964 			/* Load the physical device parameters. */
    965 			wd_get_params(wd, AT_WAIT, &wd->sc_params);
    966 
    967 			/* Load the partition info if not already loaded. */
    968 			wdgetdisklabel(wd);
    969 		}
    970 	}
    971 
    972 	/* Check that the partition exists. */
    973 	if (part != RAW_PART &&
    974 	    (part >= wd->sc_dk.dk_label->d_npartitions ||
    975 	     wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
    976 		error = ENXIO;
    977 		goto bad2;
    978 	}
    979 
    980 	/* Insure only one open at a time. */
    981 	switch (fmt) {
    982 	case S_IFCHR:
    983 		wd->sc_dk.dk_copenmask |= (1 << part);
    984 		break;
    985 	case S_IFBLK:
    986 		wd->sc_dk.dk_bopenmask |= (1 << part);
    987 		break;
    988 	}
    989 	wd->sc_dk.dk_openmask =
    990 	    wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
    991 
    992 	mutex_exit(&wd->sc_dk.dk_openlock);
    993 	return 0;
    994 
    995  bad2:
    996 	if (wd->sc_dk.dk_openmask == 0)
    997 		wd->atabus->ata_delref(wd->drvp);
    998  bad1:
    999 	mutex_exit(&wd->sc_dk.dk_openlock);
   1000 	return error;
   1001 }
   1002 
   1003 int
   1004 wdclose(dev_t dev, int flag, int fmt, struct lwp *l)
   1005 {
   1006 	struct wd_softc *wd =
   1007 	    device_private(device_lookup(&wd_cd, WDUNIT(dev)));
   1008 	int part = WDPART(dev);
   1009 
   1010 	ATADEBUG_PRINT(("wdclose\n"), DEBUG_FUNCS);
   1011 
   1012 	mutex_enter(&wd->sc_dk.dk_openlock);
   1013 
   1014 	switch (fmt) {
   1015 	case S_IFCHR:
   1016 		wd->sc_dk.dk_copenmask &= ~(1 << part);
   1017 		break;
   1018 	case S_IFBLK:
   1019 		wd->sc_dk.dk_bopenmask &= ~(1 << part);
   1020 		break;
   1021 	}
   1022 	wd->sc_dk.dk_openmask =
   1023 	    wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
   1024 
   1025 	if (wd->sc_dk.dk_openmask == 0) {
   1026 		wd_flushcache(wd, AT_WAIT);
   1027 
   1028 		if (! (wd->sc_flags & WDF_KLABEL))
   1029 			wd->sc_flags &= ~WDF_LOADED;
   1030 
   1031 		wd->atabus->ata_delref(wd->drvp);
   1032 	}
   1033 
   1034 	mutex_exit(&wd->sc_dk.dk_openlock);
   1035 	return 0;
   1036 }
   1037 
   1038 void
   1039 wdgetdefaultlabel(struct wd_softc *wd, struct disklabel *lp)
   1040 {
   1041 
   1042 	ATADEBUG_PRINT(("wdgetdefaultlabel\n"), DEBUG_FUNCS);
   1043 	memset(lp, 0, sizeof(struct disklabel));
   1044 
   1045 	lp->d_secsize = DEV_BSIZE;
   1046 	lp->d_ntracks = wd->sc_params.atap_heads;
   1047 	lp->d_nsectors = wd->sc_params.atap_sectors;
   1048 	lp->d_ncylinders = (wd->sc_flags & WDF_LBA) ? wd->sc_capacity /
   1049 		(wd->sc_params.atap_heads * wd->sc_params.atap_sectors) :
   1050 		wd->sc_params.atap_cylinders;
   1051 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
   1052 
   1053 	if (strcmp(wd->sc_params.atap_model, "ST506") == 0)
   1054 		lp->d_type = DTYPE_ST506;
   1055 	else
   1056 		lp->d_type = DTYPE_ESDI;
   1057 
   1058 	strncpy(lp->d_typename, wd->sc_params.atap_model, 16);
   1059 	strncpy(lp->d_packname, "fictitious", 16);
   1060 	if (wd->sc_capacity > UINT32_MAX)
   1061 		lp->d_secperunit = UINT32_MAX;
   1062 	else
   1063 		lp->d_secperunit = wd->sc_capacity;
   1064 	lp->d_rpm = 3600;
   1065 	lp->d_interleave = 1;
   1066 	lp->d_flags = 0;
   1067 
   1068 	lp->d_partitions[RAW_PART].p_offset = 0;
   1069 	lp->d_partitions[RAW_PART].p_size =
   1070 	    lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
   1071 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
   1072 	lp->d_npartitions = RAW_PART + 1;
   1073 
   1074 	lp->d_magic = DISKMAGIC;
   1075 	lp->d_magic2 = DISKMAGIC;
   1076 	lp->d_checksum = dkcksum(lp);
   1077 }
   1078 
   1079 /*
   1080  * Fabricate a default disk label, and try to read the correct one.
   1081  */
   1082 void
   1083 wdgetdisklabel(struct wd_softc *wd)
   1084 {
   1085 	struct disklabel *lp = wd->sc_dk.dk_label;
   1086 	const char *errstring;
   1087 	int s;
   1088 
   1089 	ATADEBUG_PRINT(("wdgetdisklabel\n"), DEBUG_FUNCS);
   1090 
   1091 	memset(wd->sc_dk.dk_cpulabel, 0, sizeof(struct cpu_disklabel));
   1092 
   1093 	wdgetdefaultlabel(wd, lp);
   1094 
   1095 	wd->sc_badsect[0] = -1;
   1096 
   1097 	if (wd->drvp->state > RESET) {
   1098 		s = splbio();
   1099 		wd->drvp->drive_flags |= DRIVE_RESET;
   1100 		splx(s);
   1101 	}
   1102 	errstring = readdisklabel(MAKEWDDEV(0, device_unit(wd->sc_dev),
   1103 				  RAW_PART), wdstrategy, lp,
   1104 				  wd->sc_dk.dk_cpulabel);
   1105 	if (errstring) {
   1106 		/*
   1107 		 * This probably happened because the drive's default
   1108 		 * geometry doesn't match the DOS geometry.  We
   1109 		 * assume the DOS geometry is now in the label and try
   1110 		 * again.  XXX This is a kluge.
   1111 		 */
   1112 		if (wd->drvp->state > RESET) {
   1113 			s = splbio();
   1114 			wd->drvp->drive_flags |= DRIVE_RESET;
   1115 			splx(s);
   1116 		}
   1117 		errstring = readdisklabel(MAKEWDDEV(0, device_unit(wd->sc_dev),
   1118 		    RAW_PART), wdstrategy, lp, wd->sc_dk.dk_cpulabel);
   1119 	}
   1120 	if (errstring) {
   1121 		aprint_error_dev(wd->sc_dev, "%s\n", errstring);
   1122 		return;
   1123 	}
   1124 
   1125 	if (wd->drvp->state > RESET) {
   1126 		s = splbio();
   1127 		wd->drvp->drive_flags |= DRIVE_RESET;
   1128 		splx(s);
   1129 	}
   1130 #ifdef HAS_BAD144_HANDLING
   1131 	if ((lp->d_flags & D_BADSECT) != 0)
   1132 		bad144intern(wd);
   1133 #endif
   1134 }
   1135 
   1136 void
   1137 wdperror(const struct wd_softc *wd)
   1138 {
   1139 	static const char *const errstr0_3[] = {"address mark not found",
   1140 	    "track 0 not found", "aborted command", "media change requested",
   1141 	    "id not found", "media changed", "uncorrectable data error",
   1142 	    "bad block detected"};
   1143 	static const char *const errstr4_5[] = {
   1144 	    "obsolete (address mark not found)",
   1145 	    "no media/write protected", "aborted command",
   1146 	    "media change requested", "id not found", "media changed",
   1147 	    "uncorrectable data error", "interface CRC error"};
   1148 	const char *const *errstr;
   1149 	int i;
   1150 	const char *sep = "";
   1151 
   1152 	const char *devname = device_xname(wd->sc_dev);
   1153 	struct ata_drive_datas *drvp = wd->drvp;
   1154 	int errno = wd->sc_wdc_bio.r_error;
   1155 
   1156 	if (drvp->ata_vers >= 4)
   1157 		errstr = errstr4_5;
   1158 	else
   1159 		errstr = errstr0_3;
   1160 
   1161 	printf("%s: (", devname);
   1162 
   1163 	if (errno == 0)
   1164 		printf("error not notified");
   1165 
   1166 	for (i = 0; i < 8; i++) {
   1167 		if (errno & (1 << i)) {
   1168 			printf("%s%s", sep, errstr[i]);
   1169 			sep = ", ";
   1170 		}
   1171 	}
   1172 	printf(")\n");
   1173 }
   1174 
   1175 int
   1176 wdioctl(dev_t dev, u_long xfer, void *addr, int flag, struct lwp *l)
   1177 {
   1178 	struct wd_softc *wd =
   1179 	    device_private(device_lookup(&wd_cd, WDUNIT(dev)));
   1180 	int error = 0, s;
   1181 #ifdef __HAVE_OLD_DISKLABEL
   1182 	struct disklabel *newlabel = NULL;
   1183 #endif
   1184 
   1185 	ATADEBUG_PRINT(("wdioctl\n"), DEBUG_FUNCS);
   1186 
   1187 	if ((wd->sc_flags & WDF_LOADED) == 0)
   1188 		return EIO;
   1189 
   1190 	error = disk_ioctl(&wd->sc_dk, xfer, addr, flag, l);
   1191 	if (error != EPASSTHROUGH)
   1192 		return (error);
   1193 
   1194 	switch (xfer) {
   1195 #ifdef HAS_BAD144_HANDLING
   1196 	case DIOCSBAD:
   1197 		if ((flag & FWRITE) == 0)
   1198 			return EBADF;
   1199 		wd->sc_dk.dk_cpulabel->bad = *(struct dkbad *)addr;
   1200 		wd->sc_dk.dk_label->d_flags |= D_BADSECT;
   1201 		bad144intern(wd);
   1202 		return 0;
   1203 #endif
   1204 #ifdef WD_SOFTBADSECT
   1205 	case DIOCBSLIST :
   1206 	{
   1207 		u_int32_t count, missing, skip;
   1208 		struct disk_badsecinfo dbsi;
   1209 		struct disk_badsectors *dbs;
   1210 		size_t available;
   1211 		uint8_t *laddr;
   1212 
   1213 		dbsi = *(struct disk_badsecinfo *)addr;
   1214 		missing = wd->sc_bscount;
   1215 		count = 0;
   1216 		available = dbsi.dbsi_bufsize;
   1217 		skip = dbsi.dbsi_skip;
   1218 		laddr = (uint8_t *)dbsi.dbsi_buffer;
   1219 
   1220 		/*
   1221 		 * We start this loop with the expectation that all of the
   1222 		 * entries will be missed and decrement this counter each
   1223 		 * time we either skip over one (already copied out) or
   1224 		 * we actually copy it back to user space.  The structs
   1225 		 * holding the bad sector information are copied directly
   1226 		 * back to user space whilst the summary is returned via
   1227 		 * the struct passed in via the ioctl.
   1228 		 */
   1229 		SLIST_FOREACH(dbs, &wd->sc_bslist, dbs_next) {
   1230 			if (skip > 0) {
   1231 				missing--;
   1232 				skip--;
   1233 				continue;
   1234 			}
   1235 			if (available < sizeof(*dbs))
   1236 				break;
   1237 			available -= sizeof(*dbs);
   1238 			copyout(dbs, laddr, sizeof(*dbs));
   1239 			laddr += sizeof(*dbs);
   1240 			missing--;
   1241 			count++;
   1242 		}
   1243 		dbsi.dbsi_left = missing;
   1244 		dbsi.dbsi_copied = count;
   1245 		*(struct disk_badsecinfo *)addr = dbsi;
   1246 		return 0;
   1247 	}
   1248 
   1249 	case DIOCBSFLUSH :
   1250 		/* Clean out the bad sector list */
   1251 		while (!SLIST_EMPTY(&wd->sc_bslist)) {
   1252 			void *head = SLIST_FIRST(&wd->sc_bslist);
   1253 			SLIST_REMOVE_HEAD(&wd->sc_bslist, dbs_next);
   1254 			free(head, M_TEMP);
   1255 		}
   1256 		wd->sc_bscount = 0;
   1257 		return 0;
   1258 #endif
   1259 	case DIOCGDINFO:
   1260 		*(struct disklabel *)addr = *(wd->sc_dk.dk_label);
   1261 		return 0;
   1262 #ifdef __HAVE_OLD_DISKLABEL
   1263 	case ODIOCGDINFO:
   1264 		newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
   1265 		if (newlabel == NULL)
   1266 			return EIO;
   1267 		*newlabel = *(wd->sc_dk.dk_label);
   1268 		if (newlabel->d_npartitions <= OLDMAXPARTITIONS)
   1269 			memcpy(addr, newlabel, sizeof (struct olddisklabel));
   1270 		else
   1271 			error = ENOTTY;
   1272 		free(newlabel, M_TEMP);
   1273 		return error;
   1274 #endif
   1275 
   1276 	case DIOCGPART:
   1277 		((struct partinfo *)addr)->disklab = wd->sc_dk.dk_label;
   1278 		((struct partinfo *)addr)->part =
   1279 		    &wd->sc_dk.dk_label->d_partitions[WDPART(dev)];
   1280 		return 0;
   1281 
   1282 	case DIOCWDINFO:
   1283 	case DIOCSDINFO:
   1284 #ifdef __HAVE_OLD_DISKLABEL
   1285 	case ODIOCWDINFO:
   1286 	case ODIOCSDINFO:
   1287 #endif
   1288 	{
   1289 		struct disklabel *lp;
   1290 
   1291 		if ((flag & FWRITE) == 0)
   1292 			return EBADF;
   1293 
   1294 #ifdef __HAVE_OLD_DISKLABEL
   1295 		if (xfer == ODIOCSDINFO || xfer == ODIOCWDINFO) {
   1296 			newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
   1297 			if (newlabel == NULL)
   1298 				return EIO;
   1299 			memset(newlabel, 0, sizeof newlabel);
   1300 			memcpy(newlabel, addr, sizeof (struct olddisklabel));
   1301 			lp = newlabel;
   1302 		} else
   1303 #endif
   1304 		lp = (struct disklabel *)addr;
   1305 
   1306 		mutex_enter(&wd->sc_dk.dk_openlock);
   1307 		wd->sc_flags |= WDF_LABELLING;
   1308 
   1309 		error = setdisklabel(wd->sc_dk.dk_label,
   1310 		    lp, /*wd->sc_dk.dk_openmask : */0,
   1311 		    wd->sc_dk.dk_cpulabel);
   1312 		if (error == 0) {
   1313 			if (wd->drvp->state > RESET) {
   1314 				s = splbio();
   1315 				wd->drvp->drive_flags |= DRIVE_RESET;
   1316 				splx(s);
   1317 			}
   1318 			if (xfer == DIOCWDINFO
   1319 #ifdef __HAVE_OLD_DISKLABEL
   1320 			    || xfer == ODIOCWDINFO
   1321 #endif
   1322 			    )
   1323 				error = writedisklabel(WDLABELDEV(dev),
   1324 				    wdstrategy, wd->sc_dk.dk_label,
   1325 				    wd->sc_dk.dk_cpulabel);
   1326 		}
   1327 
   1328 		wd->sc_flags &= ~WDF_LABELLING;
   1329 		mutex_exit(&wd->sc_dk.dk_openlock);
   1330 #ifdef __HAVE_OLD_DISKLABEL
   1331 		if (newlabel != NULL)
   1332 			free(newlabel, M_TEMP);
   1333 #endif
   1334 		return error;
   1335 	}
   1336 
   1337 	case DIOCKLABEL:
   1338 		if (*(int *)addr)
   1339 			wd->sc_flags |= WDF_KLABEL;
   1340 		else
   1341 			wd->sc_flags &= ~WDF_KLABEL;
   1342 		return 0;
   1343 
   1344 	case DIOCWLABEL:
   1345 		if ((flag & FWRITE) == 0)
   1346 			return EBADF;
   1347 		if (*(int *)addr)
   1348 			wd->sc_flags |= WDF_WLABEL;
   1349 		else
   1350 			wd->sc_flags &= ~WDF_WLABEL;
   1351 		return 0;
   1352 
   1353 	case DIOCGDEFLABEL:
   1354 		wdgetdefaultlabel(wd, (struct disklabel *)addr);
   1355 		return 0;
   1356 #ifdef __HAVE_OLD_DISKLABEL
   1357 	case ODIOCGDEFLABEL:
   1358 		newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
   1359 		if (newlabel == NULL)
   1360 			return EIO;
   1361 		wdgetdefaultlabel(wd, newlabel);
   1362 		if (newlabel->d_npartitions <= OLDMAXPARTITIONS)
   1363 			memcpy(addr, &newlabel, sizeof (struct olddisklabel));
   1364 		else
   1365 			error = ENOTTY;
   1366 		free(newlabel, M_TEMP);
   1367 		return error;
   1368 #endif
   1369 
   1370 #ifdef notyet
   1371 	case DIOCWFORMAT:
   1372 		if ((flag & FWRITE) == 0)
   1373 			return EBADF;
   1374 		{
   1375 		register struct format_op *fop;
   1376 		struct iovec aiov;
   1377 		struct uio auio;
   1378 
   1379 		fop = (struct format_op *)addr;
   1380 		aiov.iov_base = fop->df_buf;
   1381 		aiov.iov_len = fop->df_count;
   1382 		auio.uio_iov = &aiov;
   1383 		auio.uio_iovcnt = 1;
   1384 		auio.uio_resid = fop->df_count;
   1385 		auio.uio_offset =
   1386 			fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
   1387 		auio.uio_vmspace = l->l_proc->p_vmspace;
   1388 		error = physio(wdformat, NULL, dev, B_WRITE, minphys,
   1389 		    &auio);
   1390 		fop->df_count -= auio.uio_resid;
   1391 		fop->df_reg[0] = wdc->sc_status;
   1392 		fop->df_reg[1] = wdc->sc_error;
   1393 		return error;
   1394 		}
   1395 #endif
   1396 	case DIOCGCACHE:
   1397 		return wd_getcache(wd, (int *)addr);
   1398 
   1399 	case DIOCSCACHE:
   1400 		return wd_setcache(wd, *(int *)addr);
   1401 
   1402 	case DIOCCACHESYNC:
   1403 		return wd_flushcache(wd, AT_WAIT);
   1404 
   1405 	case ATAIOCCOMMAND:
   1406 		/*
   1407 		 * Make sure this command is (relatively) safe first
   1408 		 */
   1409 		if ((((atareq_t *) addr)->flags & ATACMD_READ) == 0 &&
   1410 		    (flag & FWRITE) == 0)
   1411 			return (EBADF);
   1412 		{
   1413 		struct wd_ioctl *wi;
   1414 		atareq_t *atareq = (atareq_t *) addr;
   1415 		int error1;
   1416 
   1417 		wi = wi_get();
   1418 		wi->wi_softc = wd;
   1419 		wi->wi_atareq = *atareq;
   1420 
   1421 		if (atareq->datalen && atareq->flags &
   1422 		    (ATACMD_READ | ATACMD_WRITE)) {
   1423 			void *tbuf;
   1424 			if (atareq->datalen < DEV_BSIZE
   1425 			    && atareq->command == WDCC_IDENTIFY) {
   1426 				tbuf = malloc(DEV_BSIZE, M_TEMP, M_WAITOK);
   1427 				wi->wi_iov.iov_base = tbuf;
   1428 				wi->wi_iov.iov_len = DEV_BSIZE;
   1429 				UIO_SETUP_SYSSPACE(&wi->wi_uio);
   1430 			} else {
   1431 				tbuf = NULL;
   1432 				wi->wi_iov.iov_base = atareq->databuf;
   1433 				wi->wi_iov.iov_len = atareq->datalen;
   1434 				wi->wi_uio.uio_vmspace = l->l_proc->p_vmspace;
   1435 			}
   1436 			wi->wi_uio.uio_iov = &wi->wi_iov;
   1437 			wi->wi_uio.uio_iovcnt = 1;
   1438 			wi->wi_uio.uio_resid = atareq->datalen;
   1439 			wi->wi_uio.uio_offset = 0;
   1440 			wi->wi_uio.uio_rw =
   1441 			    (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE;
   1442 			error1 = physio(wdioctlstrategy, &wi->wi_bp, dev,
   1443 			    (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE,
   1444 			    minphys, &wi->wi_uio);
   1445 			if (tbuf != NULL && error1 == 0) {
   1446 				error1 = copyout(tbuf, atareq->databuf,
   1447 				    atareq->datalen);
   1448 				free(tbuf, M_TEMP);
   1449 			}
   1450 		} else {
   1451 			/* No need to call physio if we don't have any
   1452 			   user data */
   1453 			wi->wi_bp.b_flags = 0;
   1454 			wi->wi_bp.b_data = 0;
   1455 			wi->wi_bp.b_bcount = 0;
   1456 			wi->wi_bp.b_dev = 0;
   1457 			wi->wi_bp.b_proc = l->l_proc;
   1458 			wdioctlstrategy(&wi->wi_bp);
   1459 			error1 = wi->wi_bp.b_error;
   1460 		}
   1461 		*atareq = wi->wi_atareq;
   1462 		wi_free(wi);
   1463 		return(error1);
   1464 		}
   1465 
   1466 	case DIOCAWEDGE:
   1467 	    {
   1468 	    	struct dkwedge_info *dkw = (void *) addr;
   1469 
   1470 		if ((flag & FWRITE) == 0)
   1471 			return (EBADF);
   1472 
   1473 		/* If the ioctl happens here, the parent is us. */
   1474 		strcpy(dkw->dkw_parent, device_xname(wd->sc_dev));
   1475 		return (dkwedge_add(dkw));
   1476 	    }
   1477 
   1478 	case DIOCDWEDGE:
   1479 	    {
   1480 	    	struct dkwedge_info *dkw = (void *) addr;
   1481 
   1482 		if ((flag & FWRITE) == 0)
   1483 			return (EBADF);
   1484 
   1485 		/* If the ioctl happens here, the parent is us. */
   1486 		strcpy(dkw->dkw_parent, device_xname(wd->sc_dev));
   1487 		return (dkwedge_del(dkw));
   1488 	    }
   1489 
   1490 	case DIOCLWEDGES:
   1491 	    {
   1492 	    	struct dkwedge_list *dkwl = (void *) addr;
   1493 
   1494 		return (dkwedge_list(&wd->sc_dk, dkwl, l));
   1495 	    }
   1496 
   1497 	case DIOCGSTRATEGY:
   1498 	    {
   1499 		struct disk_strategy *dks = (void *)addr;
   1500 
   1501 		s = splbio();
   1502 		strlcpy(dks->dks_name, bufq_getstrategyname(wd->sc_q),
   1503 		    sizeof(dks->dks_name));
   1504 		splx(s);
   1505 		dks->dks_paramlen = 0;
   1506 
   1507 		return 0;
   1508 	    }
   1509 
   1510 	case DIOCSSTRATEGY:
   1511 	    {
   1512 		struct disk_strategy *dks = (void *)addr;
   1513 		struct bufq_state *new;
   1514 		struct bufq_state *old;
   1515 
   1516 		if ((flag & FWRITE) == 0) {
   1517 			return EBADF;
   1518 		}
   1519 		if (dks->dks_param != NULL) {
   1520 			return EINVAL;
   1521 		}
   1522 		dks->dks_name[sizeof(dks->dks_name) - 1] = 0; /* ensure term */
   1523 		error = bufq_alloc(&new, dks->dks_name,
   1524 		    BUFQ_EXACT|BUFQ_SORT_RAWBLOCK);
   1525 		if (error) {
   1526 			return error;
   1527 		}
   1528 		s = splbio();
   1529 		old = wd->sc_q;
   1530 		bufq_move(new, old);
   1531 		wd->sc_q = new;
   1532 		splx(s);
   1533 		bufq_free(old);
   1534 
   1535 		return 0;
   1536 	    }
   1537 
   1538 	default:
   1539 		return ENOTTY;
   1540 	}
   1541 
   1542 #ifdef DIAGNOSTIC
   1543 	panic("wdioctl: impossible");
   1544 #endif
   1545 }
   1546 
   1547 #ifdef B_FORMAT
   1548 int
   1549 wdformat(struct buf *bp)
   1550 {
   1551 
   1552 	bp->b_flags |= B_FORMAT;
   1553 	return wdstrategy(bp);
   1554 }
   1555 #endif
   1556 
   1557 int
   1558 wdsize(dev_t dev)
   1559 {
   1560 	struct wd_softc *wd;
   1561 	int part, omask;
   1562 	int size;
   1563 
   1564 	ATADEBUG_PRINT(("wdsize\n"), DEBUG_FUNCS);
   1565 
   1566 	wd = device_private(device_lookup(&wd_cd, WDUNIT(dev)));
   1567 	if (wd == NULL)
   1568 		return (-1);
   1569 
   1570 	part = WDPART(dev);
   1571 	omask = wd->sc_dk.dk_openmask & (1 << part);
   1572 
   1573 	if (omask == 0 && wdopen(dev, 0, S_IFBLK, NULL) != 0)
   1574 		return (-1);
   1575 	if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
   1576 		size = -1;
   1577 	else
   1578 		size = wd->sc_dk.dk_label->d_partitions[part].p_size *
   1579 		    (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
   1580 	if (omask == 0 && wdclose(dev, 0, S_IFBLK, NULL) != 0)
   1581 		return (-1);
   1582 	return (size);
   1583 }
   1584 
   1585 /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
   1586 static int wddoingadump = 0;
   1587 static int wddumprecalibrated = 0;
   1588 
   1589 /*
   1590  * Dump core after a system crash.
   1591  */
   1592 int
   1593 wddump(dev_t dev, daddr_t blkno, void *va, size_t size)
   1594 {
   1595 	struct wd_softc *wd;	/* disk unit to do the I/O */
   1596 	struct disklabel *lp;   /* disk's disklabel */
   1597 	int part, err;
   1598 	int nblks;	/* total number of sectors left to write */
   1599 
   1600 	/* Check if recursive dump; if so, punt. */
   1601 	if (wddoingadump)
   1602 		return EFAULT;
   1603 	wddoingadump = 1;
   1604 
   1605 	wd = device_private(device_lookup(&wd_cd, WDUNIT(dev)));
   1606 	if (wd == NULL)
   1607 		return (ENXIO);
   1608 
   1609 	part = WDPART(dev);
   1610 
   1611 	/* Convert to disk sectors.  Request must be a multiple of size. */
   1612 	lp = wd->sc_dk.dk_label;
   1613 	if ((size % lp->d_secsize) != 0)
   1614 		return EFAULT;
   1615 	nblks = size / lp->d_secsize;
   1616 	blkno = blkno / (lp->d_secsize / DEV_BSIZE);
   1617 
   1618 	/* Check transfer bounds against partition size. */
   1619 	if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size))
   1620 		return EINVAL;
   1621 
   1622 	/* Offset block number to start of partition. */
   1623 	blkno += lp->d_partitions[part].p_offset;
   1624 
   1625 	/* Recalibrate, if first dump transfer. */
   1626 	if (wddumprecalibrated == 0) {
   1627 		wddumprecalibrated = 1;
   1628 		(*wd->atabus->ata_reset_drive)(wd->drvp,
   1629 					       AT_POLL | AT_RST_EMERG);
   1630 		wd->drvp->state = RESET;
   1631 	}
   1632 
   1633 	wd->sc_bp = NULL;
   1634 	wd->sc_wdc_bio.blkno = blkno;
   1635 	wd->sc_wdc_bio.flags = ATA_POLL;
   1636 	if (wd->sc_flags & WDF_LBA48 &&
   1637 	    (blkno > LBA48_THRESHOLD ||
   1638     	    (wd->sc_quirks & WD_QUIRK_FORCE_LBA48) != 0))
   1639 		wd->sc_wdc_bio.flags |= ATA_LBA48;
   1640 	if (wd->sc_flags & WDF_LBA)
   1641 		wd->sc_wdc_bio.flags |= ATA_LBA;
   1642 	wd->sc_wdc_bio.bcount = nblks * lp->d_secsize;
   1643 	wd->sc_wdc_bio.databuf = va;
   1644 #ifndef WD_DUMP_NOT_TRUSTED
   1645 	switch (wd->atabus->ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
   1646 	case ATACMD_TRY_AGAIN:
   1647 		panic("wddump: try again");
   1648 		break;
   1649 	case ATACMD_QUEUED:
   1650 		panic("wddump: polled command has been queued");
   1651 		break;
   1652 	case ATACMD_COMPLETE:
   1653 		break;
   1654 	}
   1655 	switch(wd->sc_wdc_bio.error) {
   1656 	case TIMEOUT:
   1657 		printf("wddump: device timed out");
   1658 		err = EIO;
   1659 		break;
   1660 	case ERR_DF:
   1661 		printf("wddump: drive fault");
   1662 		err = EIO;
   1663 		break;
   1664 	case ERR_DMA:
   1665 		printf("wddump: DMA error");
   1666 		err = EIO;
   1667 		break;
   1668 	case ERROR:
   1669 		printf("wddump: ");
   1670 		wdperror(wd);
   1671 		err = EIO;
   1672 		break;
   1673 	case NOERROR:
   1674 		err = 0;
   1675 		break;
   1676 	default:
   1677 		panic("wddump: unknown error type");
   1678 	}
   1679 	if (err != 0) {
   1680 		printf("\n");
   1681 		return err;
   1682 	}
   1683 #else	/* WD_DUMP_NOT_TRUSTED */
   1684 	/* Let's just talk about this first... */
   1685 	printf("wd%d: dump addr 0x%x, cylin %d, head %d, sector %d\n",
   1686 	    unit, va, cylin, head, sector);
   1687 	delay(500 * 1000);	/* half a second */
   1688 #endif
   1689 
   1690 	wddoingadump = 0;
   1691 	return 0;
   1692 }
   1693 
   1694 #ifdef HAS_BAD144_HANDLING
   1695 /*
   1696  * Internalize the bad sector table.
   1697  */
   1698 void
   1699 bad144intern(struct wd_softc *wd)
   1700 {
   1701 	struct dkbad *bt = &wd->sc_dk.dk_cpulabel->bad;
   1702 	struct disklabel *lp = wd->sc_dk.dk_label;
   1703 	int i = 0;
   1704 
   1705 	ATADEBUG_PRINT(("bad144intern\n"), DEBUG_XFERS);
   1706 
   1707 	for (; i < NBT_BAD; i++) {
   1708 		if (bt->bt_bad[i].bt_cyl == 0xffff)
   1709 			break;
   1710 		wd->sc_badsect[i] =
   1711 		    bt->bt_bad[i].bt_cyl * lp->d_secpercyl +
   1712 		    (bt->bt_bad[i].bt_trksec >> 8) * lp->d_nsectors +
   1713 		    (bt->bt_bad[i].bt_trksec & 0xff);
   1714 	}
   1715 	for (; i < NBT_BAD+1; i++)
   1716 		wd->sc_badsect[i] = -1;
   1717 }
   1718 #endif
   1719 
   1720 static void
   1721 wd_params_to_properties(struct wd_softc *wd, struct ataparams *params)
   1722 {
   1723 	prop_dictionary_t disk_info, odisk_info, geom;
   1724 	const char *cp;
   1725 
   1726 	disk_info = prop_dictionary_create();
   1727 
   1728 	if (strcmp(wd->sc_params.atap_model, "ST506") == 0)
   1729 		cp = "ST506";
   1730 	else {
   1731 		/* XXX Should have a case for ATA here, too. */
   1732 		cp = "ESDI";
   1733 	}
   1734 	prop_dictionary_set_cstring_nocopy(disk_info, "type", cp);
   1735 
   1736 	geom = prop_dictionary_create();
   1737 
   1738 	prop_dictionary_set_uint64(geom, "sectors-per-unit", wd->sc_capacity);
   1739 
   1740 	prop_dictionary_set_uint32(geom, "sector-size",
   1741 				   DEV_BSIZE /* XXX 512? */);
   1742 
   1743 	prop_dictionary_set_uint16(geom, "sectors-per-track",
   1744 				   wd->sc_params.atap_sectors);
   1745 
   1746 	prop_dictionary_set_uint16(geom, "tracks-per-cylinder",
   1747 				   wd->sc_params.atap_heads);
   1748 
   1749 	if (wd->sc_flags & WDF_LBA)
   1750 		prop_dictionary_set_uint64(geom, "cylinders-per-unit",
   1751 					   wd->sc_capacity /
   1752 					       (wd->sc_params.atap_heads *
   1753 					        wd->sc_params.atap_sectors));
   1754 	else
   1755 		prop_dictionary_set_uint16(geom, "cylinders-per-unit",
   1756 					   wd->sc_params.atap_cylinders);
   1757 
   1758 	prop_dictionary_set(disk_info, "geometry", geom);
   1759 	prop_object_release(geom);
   1760 
   1761 	prop_dictionary_set(device_properties(wd->sc_dev),
   1762 			    "disk-info", disk_info);
   1763 
   1764 	/*
   1765 	 * Don't release disk_info here; we keep a reference to it.
   1766 	 * disk_detach() will release it when we go away.
   1767 	 */
   1768 
   1769 	odisk_info = wd->sc_dk.dk_info;
   1770 	wd->sc_dk.dk_info = disk_info;
   1771 	if (odisk_info)
   1772 		prop_object_release(odisk_info);
   1773 }
   1774 
   1775 int
   1776 wd_get_params(struct wd_softc *wd, u_int8_t flags, struct ataparams *params)
   1777 {
   1778 
   1779 	switch (wd->atabus->ata_get_params(wd->drvp, flags, params)) {
   1780 	case CMD_AGAIN:
   1781 		return 1;
   1782 	case CMD_ERR:
   1783 		/*
   1784 		 * We `know' there's a drive here; just assume it's old.
   1785 		 * This geometry is only used to read the MBR and print a
   1786 		 * (false) attach message.
   1787 		 */
   1788 		strncpy(params->atap_model, "ST506",
   1789 		    sizeof params->atap_model);
   1790 		params->atap_config = ATA_CFG_FIXED;
   1791 		params->atap_cylinders = 1024;
   1792 		params->atap_heads = 8;
   1793 		params->atap_sectors = 17;
   1794 		params->atap_multi = 1;
   1795 		params->atap_capabilities1 = params->atap_capabilities2 = 0;
   1796 		wd->drvp->ata_vers = -1; /* Mark it as pre-ATA */
   1797 		/* FALLTHROUGH */
   1798 	case CMD_OK:
   1799 		wd_params_to_properties(wd, params);
   1800 		return 0;
   1801 	default:
   1802 		panic("wd_get_params: bad return code from ata_get_params");
   1803 		/* NOTREACHED */
   1804 	}
   1805 }
   1806 
   1807 int
   1808 wd_getcache(struct wd_softc *wd, int *bitsp)
   1809 {
   1810 	struct ataparams params;
   1811 
   1812 	if (wd_get_params(wd, AT_WAIT, &params) != 0)
   1813 		return EIO;
   1814 	if (params.atap_cmd_set1 == 0x0000 ||
   1815 	    params.atap_cmd_set1 == 0xffff ||
   1816 	    (params.atap_cmd_set1 & WDC_CMD1_CACHE) == 0) {
   1817 		*bitsp = 0;
   1818 		return 0;
   1819 	}
   1820 	*bitsp = DKCACHE_WCHANGE | DKCACHE_READ;
   1821 	if (params.atap_cmd1_en & WDC_CMD1_CACHE)
   1822 		*bitsp |= DKCACHE_WRITE;
   1823 
   1824 	return 0;
   1825 }
   1826 
   1827 const char at_errbits[] = "\20\10ERROR\11TIMEOU\12DF";
   1828 
   1829 int
   1830 wd_setcache(struct wd_softc *wd, int bits)
   1831 {
   1832 	struct ataparams params;
   1833 	struct ata_command ata_c;
   1834 
   1835 	if (wd_get_params(wd, AT_WAIT, &params) != 0)
   1836 		return EIO;
   1837 
   1838 	if (params.atap_cmd_set1 == 0x0000 ||
   1839 	    params.atap_cmd_set1 == 0xffff ||
   1840 	    (params.atap_cmd_set1 & WDC_CMD1_CACHE) == 0)
   1841 		return EOPNOTSUPP;
   1842 
   1843 	if ((bits & DKCACHE_READ) == 0 ||
   1844 	    (bits & DKCACHE_SAVE) != 0)
   1845 		return EOPNOTSUPP;
   1846 
   1847 	memset(&ata_c, 0, sizeof(struct ata_command));
   1848 	ata_c.r_command = SET_FEATURES;
   1849 	ata_c.r_st_bmask = 0;
   1850 	ata_c.r_st_pmask = 0;
   1851 	ata_c.timeout = 30000; /* 30s timeout */
   1852 	ata_c.flags = AT_WAIT;
   1853 	if (bits & DKCACHE_WRITE)
   1854 		ata_c.r_features = WDSF_WRITE_CACHE_EN;
   1855 	else
   1856 		ata_c.r_features = WDSF_WRITE_CACHE_DS;
   1857 	if (wd->atabus->ata_exec_command(wd->drvp, &ata_c) != ATACMD_COMPLETE) {
   1858 		aprint_error_dev(wd->sc_dev,
   1859 		    "wd_setcache command not complete\n");
   1860 		return EIO;
   1861 	}
   1862 	if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
   1863 		char sbuf[sizeof(at_errbits) + 64];
   1864 		bitmask_snprintf(ata_c.flags, at_errbits, sbuf, sizeof(sbuf));
   1865 		aprint_error_dev(wd->sc_dev, "wd_setcache: status=%s\n", sbuf);
   1866 		return EIO;
   1867 	}
   1868 	return 0;
   1869 }
   1870 
   1871 static int
   1872 wd_standby(struct wd_softc *wd, int flags)
   1873 {
   1874 	struct ata_command ata_c;
   1875 
   1876 	memset(&ata_c, 0, sizeof(struct ata_command));
   1877 	ata_c.r_command = WDCC_STANDBY_IMMED;
   1878 	ata_c.r_st_bmask = WDCS_DRDY;
   1879 	ata_c.r_st_pmask = WDCS_DRDY;
   1880 	ata_c.flags = flags;
   1881 	ata_c.timeout = 30000; /* 30s timeout */
   1882 	if (wd->atabus->ata_exec_command(wd->drvp, &ata_c) != ATACMD_COMPLETE) {
   1883 		aprint_error_dev(wd->sc_dev,
   1884 		    "standby immediate command didn't complete\n");
   1885 		return EIO;
   1886 	}
   1887 	if (ata_c.flags & AT_ERROR) {
   1888 		if (ata_c.r_error == WDCE_ABRT) /* command not supported */
   1889 			return ENODEV;
   1890 	}
   1891 	if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
   1892 		char sbuf[sizeof(at_errbits) + 64];
   1893 		bitmask_snprintf(ata_c.flags, at_errbits, sbuf, sizeof(sbuf));
   1894 		aprint_error_dev(wd->sc_dev, "wd_standby: status=%s\n", sbuf);
   1895 		return EIO;
   1896 	}
   1897 	return 0;
   1898 }
   1899 
   1900 int
   1901 wd_flushcache(struct wd_softc *wd, int flags)
   1902 {
   1903 	struct ata_command ata_c;
   1904 
   1905 	/*
   1906 	 * WDCC_FLUSHCACHE is here since ATA-4, but some drives report
   1907 	 * only ATA-2 and still support it.
   1908 	 */
   1909 	if (wd->drvp->ata_vers < 4 &&
   1910 	    ((wd->sc_params.atap_cmd_set2 & WDC_CMD2_FC) == 0 ||
   1911 	    wd->sc_params.atap_cmd_set2 == 0xffff))
   1912 		return ENODEV;
   1913 	memset(&ata_c, 0, sizeof(struct ata_command));
   1914 	if ((wd->sc_params.atap_cmd2_en & ATA_CMD2_LBA48) != 0 &&
   1915 	    (wd->sc_params.atap_cmd2_en & ATA_CMD2_FCE) != 0)
   1916 		ata_c.r_command = WDCC_FLUSHCACHE_EXT;
   1917 	else
   1918 		ata_c.r_command = WDCC_FLUSHCACHE;
   1919 	ata_c.r_st_bmask = WDCS_DRDY;
   1920 	ata_c.r_st_pmask = WDCS_DRDY;
   1921 	ata_c.flags = flags;
   1922 	ata_c.timeout = 30000; /* 30s timeout */
   1923 	if (wd->atabus->ata_exec_command(wd->drvp, &ata_c) != ATACMD_COMPLETE) {
   1924 		aprint_error_dev(wd->sc_dev,
   1925 		    "flush cache command didn't complete\n");
   1926 		return EIO;
   1927 	}
   1928 	if (ata_c.flags & AT_ERROR) {
   1929 		if (ata_c.r_error == WDCE_ABRT) /* command not supported */
   1930 			return ENODEV;
   1931 	}
   1932 	if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
   1933 		char sbuf[sizeof(at_errbits) + 64];
   1934 		bitmask_snprintf(ata_c.flags, at_errbits, sbuf, sizeof(sbuf));
   1935 		aprint_error_dev(wd->sc_dev, "wd_flushcache: status=%s\n",
   1936 		    sbuf);
   1937 		return EIO;
   1938 	}
   1939 	return 0;
   1940 }
   1941 
   1942 bool
   1943 wd_shutdown(device_t dev, int how)
   1944 {
   1945 
   1946 	struct wd_softc *wd = device_private(dev);
   1947 	wd_flushcache(wd, AT_POLL);
   1948 	if ((how & RB_POWERDOWN) == RB_POWERDOWN)
   1949 		wd_standby(wd, AT_POLL);
   1950 	return true;
   1951 }
   1952 
   1953 /*
   1954  * Allocate space for a ioctl queue structure.  Mostly taken from
   1955  * scsipi_ioctl.c
   1956  */
   1957 struct wd_ioctl *
   1958 wi_get(void)
   1959 {
   1960 	struct wd_ioctl *wi;
   1961 	int s;
   1962 
   1963 	wi = malloc(sizeof(struct wd_ioctl), M_TEMP, M_WAITOK|M_ZERO);
   1964 	buf_init(&wi->wi_bp);
   1965 	s = splbio();
   1966 	LIST_INSERT_HEAD(&wi_head, wi, wi_list);
   1967 	splx(s);
   1968 	return (wi);
   1969 }
   1970 
   1971 /*
   1972  * Free an ioctl structure and remove it from our list
   1973  */
   1974 
   1975 void
   1976 wi_free(struct wd_ioctl *wi)
   1977 {
   1978 	int s;
   1979 
   1980 	s = splbio();
   1981 	LIST_REMOVE(wi, wi_list);
   1982 	splx(s);
   1983 	buf_destroy(&wi->wi_bp);
   1984 	free(wi, M_TEMP);
   1985 }
   1986 
   1987 /*
   1988  * Find a wd_ioctl structure based on the struct buf.
   1989  */
   1990 
   1991 struct wd_ioctl *
   1992 wi_find(struct buf *bp)
   1993 {
   1994 	struct wd_ioctl *wi;
   1995 	int s;
   1996 
   1997 	s = splbio();
   1998 	for (wi = wi_head.lh_first; wi != 0; wi = wi->wi_list.le_next)
   1999 		if (bp == &wi->wi_bp)
   2000 			break;
   2001 	splx(s);
   2002 	return (wi);
   2003 }
   2004 
   2005 /*
   2006  * Ioctl pseudo strategy routine
   2007  *
   2008  * This is mostly stolen from scsipi_ioctl.c:scsistrategy().  What
   2009  * happens here is:
   2010  *
   2011  * - wdioctl() queues a wd_ioctl structure.
   2012  *
   2013  * - wdioctl() calls physio/wdioctlstrategy based on whether or not
   2014  *   user space I/O is required.  If physio() is called, physio() eventually
   2015  *   calls wdioctlstrategy().
   2016  *
   2017  * - In either case, wdioctlstrategy() calls wd->atabus->ata_exec_command()
   2018  *   to perform the actual command
   2019  *
   2020  * The reason for the use of the pseudo strategy routine is because
   2021  * when doing I/O to/from user space, physio _really_ wants to be in
   2022  * the loop.  We could put the entire buffer into the ioctl request
   2023  * structure, but that won't scale if we want to do things like download
   2024  * microcode.
   2025  */
   2026 
   2027 void
   2028 wdioctlstrategy(struct buf *bp)
   2029 {
   2030 	struct wd_ioctl *wi;
   2031 	struct ata_command ata_c;
   2032 	int error = 0;
   2033 
   2034 	wi = wi_find(bp);
   2035 	if (wi == NULL) {
   2036 		printf("wdioctlstrategy: "
   2037 		    "No matching ioctl request found in queue\n");
   2038 		error = EINVAL;
   2039 		goto bad;
   2040 	}
   2041 
   2042 	memset(&ata_c, 0, sizeof(ata_c));
   2043 
   2044 	/*
   2045 	 * Abort if physio broke up the transfer
   2046 	 */
   2047 
   2048 	if (bp->b_bcount != wi->wi_atareq.datalen) {
   2049 		printf("physio split wd ioctl request... cannot proceed\n");
   2050 		error = EIO;
   2051 		goto bad;
   2052 	}
   2053 
   2054 	/*
   2055 	 * Abort if we didn't get a buffer size that was a multiple of
   2056 	 * our sector size (or was larger than NBBY)
   2057 	 */
   2058 
   2059 	if ((bp->b_bcount % wi->wi_softc->sc_dk.dk_label->d_secsize) != 0 ||
   2060 	    (bp->b_bcount / wi->wi_softc->sc_dk.dk_label->d_secsize) >=
   2061 	     (1 << NBBY)) {
   2062 		error = EINVAL;
   2063 		goto bad;
   2064 	}
   2065 
   2066 	/*
   2067 	 * Make sure a timeout was supplied in the ioctl request
   2068 	 */
   2069 
   2070 	if (wi->wi_atareq.timeout == 0) {
   2071 		error = EINVAL;
   2072 		goto bad;
   2073 	}
   2074 
   2075 	if (wi->wi_atareq.flags & ATACMD_READ)
   2076 		ata_c.flags |= AT_READ;
   2077 	else if (wi->wi_atareq.flags & ATACMD_WRITE)
   2078 		ata_c.flags |= AT_WRITE;
   2079 
   2080 	if (wi->wi_atareq.flags & ATACMD_READREG)
   2081 		ata_c.flags |= AT_READREG;
   2082 
   2083 	ata_c.flags |= AT_WAIT;
   2084 
   2085 	ata_c.timeout = wi->wi_atareq.timeout;
   2086 	ata_c.r_command = wi->wi_atareq.command;
   2087 	ata_c.r_head = wi->wi_atareq.head & 0x0f;
   2088 	ata_c.r_cyl = wi->wi_atareq.cylinder;
   2089 	ata_c.r_sector = wi->wi_atareq.sec_num;
   2090 	ata_c.r_count = wi->wi_atareq.sec_count;
   2091 	ata_c.r_features = wi->wi_atareq.features;
   2092 	ata_c.r_st_bmask = WDCS_DRDY;
   2093 	ata_c.r_st_pmask = WDCS_DRDY;
   2094 	ata_c.data = wi->wi_bp.b_data;
   2095 	ata_c.bcount = wi->wi_bp.b_bcount;
   2096 
   2097 	if (wi->wi_softc->atabus->ata_exec_command(wi->wi_softc->drvp, &ata_c)
   2098 	    != ATACMD_COMPLETE) {
   2099 		wi->wi_atareq.retsts = ATACMD_ERROR;
   2100 		goto bad;
   2101 	}
   2102 
   2103 	if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
   2104 		if (ata_c.flags & AT_ERROR) {
   2105 			wi->wi_atareq.retsts = ATACMD_ERROR;
   2106 			wi->wi_atareq.error = ata_c.r_error;
   2107 		} else if (ata_c.flags & AT_DF)
   2108 			wi->wi_atareq.retsts = ATACMD_DF;
   2109 		else
   2110 			wi->wi_atareq.retsts = ATACMD_TIMEOUT;
   2111 	} else {
   2112 		wi->wi_atareq.retsts = ATACMD_OK;
   2113 		if (wi->wi_atareq.flags & ATACMD_READREG) {
   2114 			wi->wi_atareq.head = ata_c.r_head ;
   2115 			wi->wi_atareq.cylinder = ata_c.r_cyl;
   2116 			wi->wi_atareq.sec_num = ata_c.r_sector;
   2117 			wi->wi_atareq.sec_count = ata_c.r_count;
   2118 			wi->wi_atareq.features = ata_c.r_features;
   2119 			wi->wi_atareq.error = ata_c.r_error;
   2120 		}
   2121 	}
   2122 
   2123 	bp->b_error = 0;
   2124 	biodone(bp);
   2125 	return;
   2126 bad:
   2127 	bp->b_error = error;
   2128 	biodone(bp);
   2129 }
   2130