Home | History | Annotate | Line # | Download | only in ata
wd.c revision 1.193.2.1
      1  1.193.2.1        he /*	$NetBSD: wd.c,v 1.193.2.1 2000/07/07 17:33:47 he 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.181    bouyer 		}
    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 		break;
    474      1.181    bouyer 	case WDC_COMPLETE:
    475      1.181    bouyer 		wddone(wd);
    476      1.181    bouyer 		break;
    477      1.181    bouyer 	default:
    478      1.181    bouyer 		panic("__wdstart: bad return code from wdc_ata_bio()");
    479      1.181    bouyer 	}
    480      1.181    bouyer }
    481      1.181    bouyer 
    482      1.181    bouyer void
    483      1.181    bouyer wddone(v)
    484      1.181    bouyer 	void *v;
    485      1.181    bouyer {
    486      1.181    bouyer 	struct wd_softc *wd = v;
    487      1.181    bouyer 	struct buf *bp = wd->sc_bp;
    488      1.181    bouyer 	char buf[256], *errbuf = buf;
    489      1.181    bouyer 	WDCDEBUG_PRINT(("wddone %s\n", wd->sc_dev.dv_xname),
    490      1.182    bouyer 	    DEBUG_XFERS);
    491      1.181    bouyer 
    492      1.181    bouyer 	bp->b_resid = wd->sc_wdc_bio.bcount;
    493      1.181    bouyer 	errbuf[0] = '\0';
    494      1.181    bouyer 	switch (wd->sc_wdc_bio.error) {
    495      1.181    bouyer 	case ERR_DMA:
    496      1.181    bouyer 		errbuf = "DMA error";
    497      1.181    bouyer 		goto retry;
    498      1.181    bouyer 	case ERR_DF:
    499      1.181    bouyer 		errbuf = "device fault";
    500      1.181    bouyer 		goto retry;
    501      1.181    bouyer 	case TIMEOUT:
    502      1.181    bouyer 		errbuf = "device timeout";
    503      1.181    bouyer 		goto retry;
    504      1.181    bouyer 	case ERROR:
    505      1.181    bouyer 		/* Don't care about media change bits */
    506      1.181    bouyer 		if (wd->sc_wdc_bio.r_error != 0 &&
    507      1.181    bouyer 		    (wd->sc_wdc_bio.r_error & ~(WDCE_MC | WDCE_MCR)) == 0)
    508      1.181    bouyer 			goto noerror;
    509      1.190    bouyer 		ata_perror(wd->drvp, wd->sc_wdc_bio.r_error, errbuf);
    510      1.181    bouyer retry:		/* Just reset and retry. Can we do more ? */
    511      1.181    bouyer 		wdc_reset_channel(wd->drvp);
    512      1.181    bouyer 		diskerr(bp, "wd", errbuf, LOG_PRINTF,
    513      1.181    bouyer 		    wd->sc_wdc_bio.blkdone, wd->sc_dk.dk_label);
    514      1.181    bouyer 		if (wd->retries++ < WDIORETRIES) {
    515      1.181    bouyer 			printf(", retrying\n");
    516      1.181    bouyer 			timeout(wdrestart, wd, RECOVERYTIME);
    517      1.181    bouyer 			return;
    518      1.181    bouyer 		}
    519      1.181    bouyer 		printf("\n");
    520      1.181    bouyer 		bp->b_flags |= B_ERROR;
    521      1.181    bouyer 		bp->b_error = EIO;
    522      1.181    bouyer 		break;
    523      1.181    bouyer 	case NOERROR:
    524      1.181    bouyer noerror:	if ((wd->sc_wdc_bio.flags & ATA_CORR) || wd->retries > 0)
    525      1.181    bouyer 			printf("%s: soft error (corrected)\n",
    526      1.181    bouyer 			    wd->sc_dev.dv_xname);
    527       1.64   mycroft 	}
    528      1.181    bouyer 	disk_unbusy(&wd->sc_dk, (bp->b_bcount - bp->b_resid));
    529      1.181    bouyer #if NRND > 0
    530      1.181    bouyer 	rnd_add_uint32(&wd->rnd_source, bp->b_blkno);
    531      1.181    bouyer #endif
    532      1.181    bouyer 	biodone(bp);
    533      1.181    bouyer 	wd->openings++;
    534      1.181    bouyer 	wdstart(wd);
    535      1.181    bouyer }
    536      1.181    bouyer 
    537      1.181    bouyer void
    538      1.181    bouyer wdrestart(v)
    539      1.181    bouyer 	void *v;
    540      1.181    bouyer {
    541      1.181    bouyer 	struct wd_softc *wd = v;
    542      1.181    bouyer 	struct buf *bp = wd->sc_bp;
    543      1.181    bouyer 	int s;
    544      1.181    bouyer 	WDCDEBUG_PRINT(("wdrestart %s\n", wd->sc_dev.dv_xname),
    545      1.182    bouyer 	    DEBUG_XFERS);
    546      1.181    bouyer 
    547      1.181    bouyer 	s = splbio();
    548      1.181    bouyer 	__wdstart(v, bp);
    549      1.181    bouyer 	splx(s);
    550      1.141   mycroft }
    551      1.141   mycroft 
    552      1.141   mycroft int
    553      1.149  christos wdread(dev, uio, flags)
    554      1.141   mycroft 	dev_t dev;
    555      1.141   mycroft 	struct uio *uio;
    556      1.149  christos 	int flags;
    557      1.141   mycroft {
    558      1.141   mycroft 
    559      1.182    bouyer 	WDCDEBUG_PRINT(("wdread\n"), DEBUG_XFERS);
    560      1.141   mycroft 	return (physio(wdstrategy, NULL, dev, B_READ, minphys, uio));
    561      1.141   mycroft }
    562      1.141   mycroft 
    563      1.141   mycroft int
    564      1.149  christos wdwrite(dev, uio, flags)
    565      1.141   mycroft 	dev_t dev;
    566      1.141   mycroft 	struct uio *uio;
    567      1.149  christos 	int flags;
    568      1.141   mycroft {
    569      1.141   mycroft 
    570      1.182    bouyer 	WDCDEBUG_PRINT(("wdwrite\n"), DEBUG_XFERS);
    571      1.141   mycroft 	return (physio(wdstrategy, NULL, dev, B_WRITE, minphys, uio));
    572       1.64   mycroft }
    573       1.64   mycroft 
    574        1.1       cgd /*
    575      1.135   mycroft  * Wait interruptibly for an exclusive lock.
    576      1.135   mycroft  *
    577      1.135   mycroft  * XXX
    578      1.135   mycroft  * Several drivers do this; it should be abstracted and made MP-safe.
    579      1.135   mycroft  */
    580      1.132   mycroft int
    581      1.181    bouyer wdlock(wd)
    582      1.181    bouyer 	struct wd_softc *wd;
    583      1.132   mycroft {
    584      1.132   mycroft 	int error;
    585      1.163    bouyer 	int s;
    586      1.163    bouyer 
    587      1.181    bouyer 	WDCDEBUG_PRINT(("wdlock\n"), DEBUG_FUNCS);
    588      1.132   mycroft 
    589      1.163    bouyer 	s = splbio();
    590      1.163    bouyer 
    591      1.181    bouyer 	while ((wd->sc_flags & WDF_LOCKED) != 0) {
    592      1.181    bouyer 		wd->sc_flags |= WDF_WANTED;
    593      1.181    bouyer 		if ((error = tsleep(wd, PRIBIO | PCATCH,
    594      1.163    bouyer 		    "wdlck", 0)) != 0) {
    595      1.163    bouyer 			splx(s);
    596      1.132   mycroft 			return error;
    597      1.163    bouyer 		}
    598      1.132   mycroft 	}
    599      1.181    bouyer 	wd->sc_flags |= WDF_LOCKED;
    600      1.163    bouyer 	splx(s);
    601      1.132   mycroft 	return 0;
    602      1.132   mycroft }
    603      1.132   mycroft 
    604      1.135   mycroft /*
    605      1.135   mycroft  * Unlock and wake up any waiters.
    606      1.135   mycroft  */
    607      1.132   mycroft void
    608      1.181    bouyer wdunlock(wd)
    609      1.181    bouyer 	struct wd_softc *wd;
    610      1.132   mycroft {
    611      1.132   mycroft 
    612      1.181    bouyer 	WDCDEBUG_PRINT(("wdunlock\n"), DEBUG_FUNCS);
    613      1.163    bouyer 
    614      1.181    bouyer 	wd->sc_flags &= ~WDF_LOCKED;
    615      1.181    bouyer 	if ((wd->sc_flags & WDF_WANTED) != 0) {
    616      1.181    bouyer 		wd->sc_flags &= ~WDF_WANTED;
    617      1.181    bouyer 		wakeup(wd);
    618      1.132   mycroft 	}
    619      1.132   mycroft }
    620      1.132   mycroft 
    621        1.1       cgd int
    622      1.149  christos wdopen(dev, flag, fmt, p)
    623       1.55   mycroft 	dev_t dev;
    624       1.93   mycroft 	int flag, fmt;
    625      1.149  christos 	struct proc *p;
    626        1.1       cgd {
    627      1.135   mycroft 	struct wd_softc *wd;
    628      1.135   mycroft 	int unit, part;
    629      1.109   mycroft 	int error;
    630      1.163    bouyer 
    631      1.181    bouyer 	WDCDEBUG_PRINT(("wdopen\n"), DEBUG_FUNCS);
    632      1.108   mycroft 	unit = WDUNIT(dev);
    633      1.147   thorpej 	if (unit >= wd_cd.cd_ndevs)
    634       1.37   mycroft 		return ENXIO;
    635      1.147   thorpej 	wd = wd_cd.cd_devs[unit];
    636      1.158        pk 	if (wd == NULL)
    637       1.37   mycroft 		return ENXIO;
    638      1.187   thorpej 
    639      1.187   thorpej 	/*
    640      1.187   thorpej 	 * If this is the first open of this device, add a reference
    641      1.187   thorpej 	 * to the adapter.
    642      1.187   thorpej 	 */
    643      1.187   thorpej 	if (wd->sc_dk.dk_openmask == 0 &&
    644      1.187   thorpej 	    (error = wdc_ata_addref(wd->drvp)) != 0)
    645      1.187   thorpej 		return (error);
    646      1.187   thorpej 
    647      1.181    bouyer 	if ((error = wdlock(wd)) != 0)
    648      1.187   thorpej 		goto bad4;
    649        1.3   deraadt 
    650      1.109   mycroft 	if (wd->sc_dk.dk_openmask != 0) {
    651      1.109   mycroft 		/*
    652      1.109   mycroft 		 * If any partition is open, but the disk has been invalidated,
    653      1.109   mycroft 		 * disallow further opens.
    654      1.109   mycroft 		 */
    655      1.181    bouyer 		if ((wd->sc_flags & WDF_LOADED) == 0) {
    656      1.136   mycroft 			error = EIO;
    657      1.136   mycroft 			goto bad3;
    658      1.136   mycroft 		}
    659      1.109   mycroft 	} else {
    660      1.181    bouyer 		if ((wd->sc_flags & WDF_LOADED) == 0) {
    661      1.181    bouyer 			wd->sc_flags |= WDF_LOADED;
    662      1.108   mycroft 
    663      1.108   mycroft 			/* Load the physical device parameters. */
    664      1.183    bouyer 			wd_get_params(wd, AT_WAIT, &wd->sc_params);
    665      1.108   mycroft 
    666      1.108   mycroft 			/* Load the partition info if not already loaded. */
    667      1.108   mycroft 			wdgetdisklabel(wd);
    668      1.108   mycroft 		}
    669      1.135   mycroft 	}
    670      1.108   mycroft 
    671      1.135   mycroft 	part = WDPART(dev);
    672      1.108   mycroft 
    673      1.109   mycroft 	/* Check that the partition exists. */
    674       1.93   mycroft 	if (part != RAW_PART &&
    675      1.144   thorpej 	    (part >= wd->sc_dk.dk_label->d_npartitions ||
    676      1.144   thorpej 	     wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
    677       1.93   mycroft 		error = ENXIO;
    678       1.93   mycroft 		goto bad;
    679       1.93   mycroft 	}
    680      1.181    bouyer 
    681       1.64   mycroft 	/* Insure only one open at a time. */
    682        1.3   deraadt 	switch (fmt) {
    683        1.3   deraadt 	case S_IFCHR:
    684       1.94   mycroft 		wd->sc_dk.dk_copenmask |= (1 << part);
    685        1.3   deraadt 		break;
    686        1.3   deraadt 	case S_IFBLK:
    687       1.94   mycroft 		wd->sc_dk.dk_bopenmask |= (1 << part);
    688        1.3   deraadt 		break;
    689        1.3   deraadt 	}
    690      1.181    bouyer 	wd->sc_dk.dk_openmask =
    691      1.181    bouyer 	    wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
    692       1.60   mycroft 
    693      1.181    bouyer 	wdunlock(wd);
    694       1.37   mycroft 	return 0;
    695       1.93   mycroft 
    696       1.93   mycroft bad:
    697      1.118   mycroft 	if (wd->sc_dk.dk_openmask == 0) {
    698      1.108   mycroft 	}
    699      1.108   mycroft 
    700      1.136   mycroft bad3:
    701      1.181    bouyer 	wdunlock(wd);
    702      1.187   thorpej bad4:
    703      1.187   thorpej 	if (wd->sc_dk.dk_openmask == 0)
    704      1.187   thorpej 		wdc_ata_delref(wd->drvp);
    705       1.93   mycroft 	return error;
    706        1.1       cgd }
    707        1.1       cgd 
    708      1.135   mycroft int
    709      1.149  christos wdclose(dev, flag, fmt, p)
    710      1.135   mycroft 	dev_t dev;
    711      1.135   mycroft 	int flag, fmt;
    712      1.149  christos 	struct proc *p;
    713      1.135   mycroft {
    714      1.147   thorpej 	struct wd_softc *wd = wd_cd.cd_devs[WDUNIT(dev)];
    715      1.135   mycroft 	int part = WDPART(dev);
    716      1.135   mycroft 	int error;
    717      1.181    bouyer 
    718      1.181    bouyer 	WDCDEBUG_PRINT(("wdclose\n"), DEBUG_FUNCS);
    719      1.181    bouyer 	if ((error = wdlock(wd)) != 0)
    720      1.135   mycroft 		return error;
    721      1.135   mycroft 
    722      1.135   mycroft 	switch (fmt) {
    723      1.135   mycroft 	case S_IFCHR:
    724      1.135   mycroft 		wd->sc_dk.dk_copenmask &= ~(1 << part);
    725      1.135   mycroft 		break;
    726      1.135   mycroft 	case S_IFBLK:
    727      1.135   mycroft 		wd->sc_dk.dk_bopenmask &= ~(1 << part);
    728      1.135   mycroft 		break;
    729      1.135   mycroft 	}
    730      1.181    bouyer 	wd->sc_dk.dk_openmask =
    731      1.181    bouyer 	    wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
    732      1.135   mycroft 
    733      1.135   mycroft 	if (wd->sc_dk.dk_openmask == 0) {
    734  1.193.2.1        he 		wd_flushcache(wd, AT_WAIT);
    735      1.135   mycroft 		/* XXXX Must wait for I/O to complete! */
    736      1.187   thorpej 
    737      1.187   thorpej 		wdc_ata_delref(wd->drvp);
    738      1.135   mycroft 	}
    739      1.135   mycroft 
    740      1.181    bouyer 	wdunlock(wd);
    741      1.135   mycroft 	return 0;
    742      1.135   mycroft }
    743      1.135   mycroft 
    744      1.108   mycroft void
    745      1.164   thorpej wdgetdefaultlabel(wd, lp)
    746      1.108   mycroft 	struct wd_softc *wd;
    747      1.164   thorpej 	struct disklabel *lp;
    748      1.108   mycroft {
    749      1.163    bouyer 
    750      1.181    bouyer 	WDCDEBUG_PRINT(("wdgetdefaultlabel\n"), DEBUG_FUNCS);
    751      1.181    bouyer 	memset(lp, 0, sizeof(struct disklabel));
    752      1.108   mycroft 
    753      1.142   mycroft 	lp->d_secsize = DEV_BSIZE;
    754      1.181    bouyer 	lp->d_ntracks = wd->sc_params.atap_heads;
    755      1.181    bouyer 	lp->d_nsectors = wd->sc_params.atap_sectors;
    756      1.181    bouyer 	lp->d_ncylinders = wd->sc_params.atap_cylinders;
    757      1.142   mycroft 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
    758      1.108   mycroft 
    759      1.108   mycroft #if 0
    760      1.181    bouyer 	if (strcmp(wd->sc_params.atap_model, "ST506") == 0) {
    761      1.181    bouyer 		lp->d_type = DTYPE_ST506;
    762      1.181    bouyer 		strncpy(lp->d_typename, "ST506 disk", 16);
    763      1.181    bouyer 	} else {
    764      1.181    bouyer 		lp->d_type = DTYPE_ESDI;
    765      1.181    bouyer 		strncpy(lp->d_typename, "ESDI/IDE",
    766      1.181    bouyer 		sizeof lp->d_typename);
    767      1.181    bouyer 	}
    768      1.108   mycroft #endif
    769      1.181    bouyer 	strncpy(lp->d_typename, wd->sc_params.atap_model, 16);
    770      1.180  drochner 	strncpy(lp->d_packname, "fictitious", 16);
    771      1.181    bouyer 	lp->d_secperunit = wd->sc_capacity;
    772      1.142   mycroft 	lp->d_rpm = 3600;
    773      1.142   mycroft 	lp->d_interleave = 1;
    774      1.142   mycroft 	lp->d_flags = 0;
    775      1.142   mycroft 
    776      1.142   mycroft 	lp->d_partitions[RAW_PART].p_offset = 0;
    777      1.142   mycroft 	lp->d_partitions[RAW_PART].p_size =
    778      1.181    bouyer 	lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
    779      1.142   mycroft 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
    780      1.142   mycroft 	lp->d_npartitions = RAW_PART + 1;
    781      1.142   mycroft 
    782      1.142   mycroft 	lp->d_magic = DISKMAGIC;
    783      1.142   mycroft 	lp->d_magic2 = DISKMAGIC;
    784      1.142   mycroft 	lp->d_checksum = dkcksum(lp);
    785      1.164   thorpej }
    786      1.164   thorpej 
    787      1.164   thorpej /*
    788      1.164   thorpej  * Fabricate a default disk label, and try to read the correct one.
    789      1.164   thorpej  */
    790      1.164   thorpej void
    791      1.164   thorpej wdgetdisklabel(wd)
    792      1.164   thorpej 	struct wd_softc *wd;
    793      1.164   thorpej {
    794      1.164   thorpej 	struct disklabel *lp = wd->sc_dk.dk_label;
    795      1.164   thorpej 	char *errstring;
    796      1.164   thorpej 
    797      1.181    bouyer 	WDCDEBUG_PRINT(("wdgetdisklabel\n"), DEBUG_FUNCS);
    798      1.164   thorpej 
    799      1.181    bouyer 	memset(wd->sc_dk.dk_cpulabel, 0, sizeof(struct cpu_disklabel));
    800      1.164   thorpej 
    801      1.164   thorpej 	wdgetdefaultlabel(wd, lp);
    802      1.108   mycroft 
    803      1.181    bouyer 	wd->sc_badsect[0] = -1;
    804      1.113   mycroft 
    805      1.181    bouyer 	if (wd->drvp->state > RECAL)
    806      1.183    bouyer 		wd->drvp->drive_flags |= DRIVE_RESET;
    807      1.108   mycroft 	errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit, RAW_PART),
    808      1.144   thorpej 	    wdstrategy, lp, wd->sc_dk.dk_cpulabel);
    809      1.108   mycroft 	if (errstring) {
    810      1.108   mycroft 		/*
    811      1.108   mycroft 		 * This probably happened because the drive's default
    812      1.108   mycroft 		 * geometry doesn't match the DOS geometry.  We
    813      1.108   mycroft 		 * assume the DOS geometry is now in the label and try
    814      1.108   mycroft 		 * again.  XXX This is a kluge.
    815      1.108   mycroft 		 */
    816      1.181    bouyer 		if (wd->drvp->state > RECAL)
    817      1.183    bouyer 			wd->drvp->drive_flags |= DRIVE_RESET;
    818      1.181    bouyer 		errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit,
    819      1.181    bouyer 		    RAW_PART), wdstrategy, lp, wd->sc_dk.dk_cpulabel);
    820      1.108   mycroft 	}
    821      1.108   mycroft 	if (errstring) {
    822      1.153  christos 		printf("%s: %s\n", wd->sc_dev.dv_xname, errstring);
    823      1.108   mycroft 		return;
    824      1.108   mycroft 	}
    825      1.108   mycroft 
    826      1.181    bouyer 	if (wd->drvp->state > RECAL)
    827      1.183    bouyer 		wd->drvp->drive_flags |= DRIVE_RESET;
    828      1.170       leo #ifdef HAS_BAD144_HANDLING
    829      1.142   mycroft 	if ((lp->d_flags & D_BADSECT) != 0)
    830      1.108   mycroft 		bad144intern(wd);
    831      1.170       leo #endif
    832      1.108   mycroft }
    833      1.108   mycroft 
    834        1.1       cgd int
    835      1.163    bouyer wdioctl(dev, xfer, addr, flag, p)
    836       1.55   mycroft 	dev_t dev;
    837      1.163    bouyer 	u_long xfer;
    838       1.55   mycroft 	caddr_t addr;
    839       1.55   mycroft 	int flag;
    840       1.55   mycroft 	struct proc *p;
    841        1.1       cgd {
    842      1.147   thorpej 	struct wd_softc *wd = wd_cd.cd_devs[WDUNIT(dev)];
    843       1.54   mycroft 	int error;
    844      1.163    bouyer 
    845      1.181    bouyer 	WDCDEBUG_PRINT(("wdioctl\n"), DEBUG_FUNCS);
    846      1.163    bouyer 
    847      1.181    bouyer 	if ((wd->sc_flags & WDF_LOADED) == 0)
    848      1.108   mycroft 		return EIO;
    849      1.108   mycroft 
    850      1.163    bouyer 	switch (xfer) {
    851      1.170       leo #ifdef HAS_BAD144_HANDLING
    852        1.1       cgd 	case DIOCSBAD:
    853        1.3   deraadt 		if ((flag & FWRITE) == 0)
    854       1.54   mycroft 			return EBADF;
    855      1.144   thorpej 		wd->sc_dk.dk_cpulabel->bad = *(struct dkbad *)addr;
    856      1.144   thorpej 		wd->sc_dk.dk_label->d_flags |= D_BADSECT;
    857       1.64   mycroft 		bad144intern(wd);
    858       1.54   mycroft 		return 0;
    859      1.170       leo #endif
    860        1.1       cgd 
    861        1.1       cgd 	case DIOCGDINFO:
    862      1.144   thorpej 		*(struct disklabel *)addr = *(wd->sc_dk.dk_label);
    863       1.54   mycroft 		return 0;
    864        1.3   deraadt 
    865        1.3   deraadt 	case DIOCGPART:
    866      1.144   thorpej 		((struct partinfo *)addr)->disklab = wd->sc_dk.dk_label;
    867        1.3   deraadt 		((struct partinfo *)addr)->part =
    868      1.144   thorpej 		    &wd->sc_dk.dk_label->d_partitions[WDPART(dev)];
    869       1.54   mycroft 		return 0;
    870        1.3   deraadt 
    871      1.132   mycroft 	case DIOCWDINFO:
    872        1.3   deraadt 	case DIOCSDINFO:
    873        1.3   deraadt 		if ((flag & FWRITE) == 0)
    874       1.54   mycroft 			return EBADF;
    875      1.132   mycroft 
    876      1.181    bouyer 		if ((error = wdlock(wd)) != 0)
    877      1.132   mycroft 			return error;
    878      1.181    bouyer 		wd->sc_flags |= WDF_LABELLING;
    879      1.132   mycroft 
    880      1.144   thorpej 		error = setdisklabel(wd->sc_dk.dk_label,
    881      1.128   mycroft 		    (struct disklabel *)addr, /*wd->sc_dk.dk_openmask : */0,
    882      1.144   thorpej 		    wd->sc_dk.dk_cpulabel);
    883        1.3   deraadt 		if (error == 0) {
    884      1.181    bouyer 			if (wd->drvp->state > RECAL)
    885      1.183    bouyer 				wd->drvp->drive_flags |= DRIVE_RESET;
    886      1.163    bouyer 			if (xfer == DIOCWDINFO)
    887      1.132   mycroft 				error = writedisklabel(WDLABELDEV(dev),
    888      1.144   thorpej 				    wdstrategy, wd->sc_dk.dk_label,
    889      1.144   thorpej 				    wd->sc_dk.dk_cpulabel);
    890        1.1       cgd 		}
    891      1.132   mycroft 
    892      1.181    bouyer 		wd->sc_flags &= ~WDF_LABELLING;
    893      1.181    bouyer 		wdunlock(wd);
    894       1.54   mycroft 		return error;
    895        1.3   deraadt 
    896       1.44   mycroft 	case DIOCWLABEL:
    897        1.3   deraadt 		if ((flag & FWRITE) == 0)
    898       1.54   mycroft 			return EBADF;
    899       1.93   mycroft 		if (*(int *)addr)
    900      1.181    bouyer 			wd->sc_flags |= WDF_WLABEL;
    901       1.93   mycroft 		else
    902      1.181    bouyer 			wd->sc_flags &= ~WDF_WLABEL;
    903       1.54   mycroft 		return 0;
    904      1.164   thorpej 
    905      1.164   thorpej 	case DIOCGDEFLABEL:
    906      1.164   thorpej 		wdgetdefaultlabel(wd, (struct disklabel *)addr);
    907      1.164   thorpej 		return 0;
    908      1.164   thorpej 
    909        1.1       cgd #ifdef notyet
    910        1.1       cgd 	case DIOCWFORMAT:
    911        1.1       cgd 		if ((flag & FWRITE) == 0)
    912       1.54   mycroft 			return EBADF;
    913      1.181    bouyer 		{
    914       1.54   mycroft 		register struct format_op *fop;
    915       1.54   mycroft 		struct iovec aiov;
    916       1.54   mycroft 		struct uio auio;
    917      1.181    bouyer 
    918       1.54   mycroft 		fop = (struct format_op *)addr;
    919       1.54   mycroft 		aiov.iov_base = fop->df_buf;
    920       1.54   mycroft 		aiov.iov_len = fop->df_count;
    921       1.54   mycroft 		auio.uio_iov = &aiov;
    922       1.54   mycroft 		auio.uio_iovcnt = 1;
    923       1.54   mycroft 		auio.uio_resid = fop->df_count;
    924       1.54   mycroft 		auio.uio_segflg = 0;
    925       1.54   mycroft 		auio.uio_offset =
    926      1.181    bouyer 			fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
    927       1.83        pk 		auio.uio_procp = p;
    928       1.64   mycroft 		error = physio(wdformat, NULL, dev, B_WRITE, minphys,
    929       1.64   mycroft 		    &auio);
    930       1.54   mycroft 		fop->df_count -= auio.uio_resid;
    931       1.64   mycroft 		fop->df_reg[0] = wdc->sc_status;
    932       1.64   mycroft 		fop->df_reg[1] = wdc->sc_error;
    933       1.54   mycroft 		return error;
    934      1.181    bouyer 		}
    935        1.1       cgd #endif
    936      1.185      kenh 
    937      1.186      kenh 	case ATAIOCCOMMAND:
    938      1.185      kenh 		/*
    939      1.185      kenh 		 * Make sure this command is (relatively) safe first
    940      1.185      kenh 		 */
    941      1.186      kenh 		if ((((atareq_t *) addr)->flags & ATACMD_READ) == 0 &&
    942      1.185      kenh 		    (flag & FWRITE) == 0)
    943      1.185      kenh 			return (EBADF);
    944      1.185      kenh 		{
    945      1.185      kenh 		struct wd_ioctl *wi;
    946      1.186      kenh 		atareq_t *atareq = (atareq_t *) addr;
    947      1.185      kenh 		int error;
    948      1.185      kenh 
    949      1.185      kenh 		wi = wi_get();
    950      1.185      kenh 		wi->wi_softc = wd;
    951      1.186      kenh 		wi->wi_atareq = *atareq;
    952      1.185      kenh 
    953      1.186      kenh 		if (atareq->datalen && atareq->flags &
    954      1.186      kenh 		    (ATACMD_READ | ATACMD_WRITE)) {
    955      1.186      kenh 			wi->wi_iov.iov_base = atareq->databuf;
    956      1.186      kenh 			wi->wi_iov.iov_len = atareq->datalen;
    957      1.185      kenh 			wi->wi_uio.uio_iov = &wi->wi_iov;
    958      1.185      kenh 			wi->wi_uio.uio_iovcnt = 1;
    959      1.186      kenh 			wi->wi_uio.uio_resid = atareq->datalen;
    960      1.185      kenh 			wi->wi_uio.uio_offset = 0;
    961      1.185      kenh 			wi->wi_uio.uio_segflg = UIO_USERSPACE;
    962      1.185      kenh 			wi->wi_uio.uio_rw =
    963      1.186      kenh 			    (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE;
    964      1.185      kenh 			wi->wi_uio.uio_procp = p;
    965      1.185      kenh 			error = physio(wdioctlstrategy, &wi->wi_bp, dev,
    966      1.186      kenh 			    (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE,
    967      1.185      kenh 			    minphys, &wi->wi_uio);
    968      1.185      kenh 		} else {
    969      1.185      kenh 			/* No need to call physio if we don't have any
    970      1.185      kenh 			   user data */
    971      1.185      kenh 			wi->wi_bp.b_flags = 0;
    972      1.185      kenh 			wi->wi_bp.b_data = 0;
    973      1.185      kenh 			wi->wi_bp.b_bcount = 0;
    974      1.185      kenh 			wi->wi_bp.b_dev = 0;
    975      1.185      kenh 			wi->wi_bp.b_proc = p;
    976      1.185      kenh 			wdioctlstrategy(&wi->wi_bp);
    977      1.185      kenh 			error = wi->wi_bp.b_error;
    978      1.185      kenh 		}
    979      1.186      kenh 		*atareq = wi->wi_atareq;
    980      1.185      kenh 		wi_free(wi);
    981      1.185      kenh 		return(error);
    982      1.185      kenh 		}
    983      1.185      kenh 
    984        1.1       cgd 	default:
    985       1.54   mycroft 		return ENOTTY;
    986        1.1       cgd 	}
    987       1.54   mycroft 
    988       1.54   mycroft #ifdef DIAGNOSTIC
    989       1.54   mycroft 	panic("wdioctl: impossible");
    990       1.54   mycroft #endif
    991        1.1       cgd }
    992        1.1       cgd 
    993       1.44   mycroft #ifdef B_FORMAT
    994        1.1       cgd int
    995        1.1       cgd wdformat(struct buf *bp)
    996        1.1       cgd {
    997       1.44   mycroft 
    998        1.1       cgd 	bp->b_flags |= B_FORMAT;
    999       1.37   mycroft 	return wdstrategy(bp);
   1000        1.1       cgd }
   1001        1.1       cgd #endif
   1002        1.1       cgd 
   1003        1.1       cgd int
   1004       1.55   mycroft wdsize(dev)
   1005       1.55   mycroft 	dev_t dev;
   1006        1.1       cgd {
   1007       1.64   mycroft 	struct wd_softc *wd;
   1008      1.158        pk 	int part, unit, omask;
   1009      1.108   mycroft 	int size;
   1010      1.163    bouyer 
   1011      1.181    bouyer 	WDCDEBUG_PRINT(("wdsize\n"), DEBUG_FUNCS);
   1012      1.163    bouyer 
   1013      1.158        pk 	unit = WDUNIT(dev);
   1014      1.158        pk 	if (unit >= wd_cd.cd_ndevs)
   1015      1.158        pk 		return (-1);
   1016      1.158        pk 	wd = wd_cd.cd_devs[unit];
   1017      1.158        pk 	if (wd == NULL)
   1018      1.158        pk 		return (-1);
   1019      1.158        pk 
   1020      1.158        pk 	part = WDPART(dev);
   1021      1.158        pk 	omask = wd->sc_dk.dk_openmask & (1 << part);
   1022      1.158        pk 
   1023      1.158        pk 	if (omask == 0 && wdopen(dev, 0, S_IFBLK, NULL) != 0)
   1024      1.158        pk 		return (-1);
   1025      1.144   thorpej 	if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
   1026      1.108   mycroft 		size = -1;
   1027      1.108   mycroft 	else
   1028      1.160   thorpej 		size = wd->sc_dk.dk_label->d_partitions[part].p_size *
   1029      1.181    bouyer 		    (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
   1030      1.158        pk 	if (omask == 0 && wdclose(dev, 0, S_IFBLK, NULL) != 0)
   1031      1.158        pk 		return (-1);
   1032      1.158        pk 	return (size);
   1033        1.1       cgd }
   1034        1.1       cgd 
   1035      1.140       cgd #ifndef __BDEVSW_DUMP_OLD_TYPE
   1036      1.140       cgd /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
   1037      1.181    bouyer static int wddoingadump = 0;
   1038      1.181    bouyer static int wddumprecalibrated = 0;
   1039      1.181    bouyer static int wddumpmulti = 1;
   1040      1.140       cgd 
   1041       1.64   mycroft /*
   1042       1.64   mycroft  * Dump core after a system crash.
   1043       1.64   mycroft  */
   1044        1.1       cgd int
   1045      1.140       cgd wddump(dev, blkno, va, size)
   1046      1.181    bouyer 	dev_t dev;
   1047      1.181    bouyer 	daddr_t blkno;
   1048      1.181    bouyer 	caddr_t va;
   1049      1.181    bouyer 	size_t size;
   1050      1.140       cgd {
   1051      1.140       cgd 	struct wd_softc *wd;	/* disk unit to do the I/O */
   1052      1.181    bouyer 	struct disklabel *lp;   /* disk's disklabel */
   1053      1.181    bouyer 	int unit, part;
   1054      1.181    bouyer 	int nblks;	/* total number of sectors left to write */
   1055      1.181    bouyer 	int err;
   1056      1.181    bouyer 	char errbuf[256];
   1057      1.140       cgd 
   1058      1.140       cgd 	/* Check if recursive dump; if so, punt. */
   1059      1.116   mycroft 	if (wddoingadump)
   1060      1.116   mycroft 		return EFAULT;
   1061      1.142   mycroft 	wddoingadump = 1;
   1062      1.140       cgd 
   1063      1.142   mycroft 	unit = WDUNIT(dev);
   1064      1.147   thorpej 	if (unit >= wd_cd.cd_ndevs)
   1065      1.142   mycroft 		return ENXIO;
   1066      1.147   thorpej 	wd = wd_cd.cd_devs[unit];
   1067      1.163    bouyer 	if (wd == (struct wd_softc *)0)
   1068      1.142   mycroft 		return ENXIO;
   1069       1.60   mycroft 
   1070      1.140       cgd 	part = WDPART(dev);
   1071      1.140       cgd 
   1072      1.140       cgd 	/* Make sure it was initialized. */
   1073      1.181    bouyer 	if (wd->drvp->state < READY)
   1074       1.37   mycroft 		return ENXIO;
   1075      1.140       cgd 
   1076      1.181    bouyer 	/* Convert to disk sectors.  Request must be a multiple of size. */
   1077      1.144   thorpej 	lp = wd->sc_dk.dk_label;
   1078      1.142   mycroft 	if ((size % lp->d_secsize) != 0)
   1079      1.140       cgd 		return EFAULT;
   1080      1.142   mycroft 	nblks = size / lp->d_secsize;
   1081      1.142   mycroft 	blkno = blkno / (lp->d_secsize / DEV_BSIZE);
   1082      1.116   mycroft 
   1083       1.64   mycroft 	/* Check transfer bounds against partition size. */
   1084      1.142   mycroft 	if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size))
   1085      1.140       cgd 		return EINVAL;
   1086      1.140       cgd 
   1087      1.140       cgd 	/* Offset block number to start of partition. */
   1088      1.142   mycroft 	blkno += lp->d_partitions[part].p_offset;
   1089       1.60   mycroft 
   1090      1.140       cgd 	/* Recalibrate, if first dump transfer. */
   1091      1.140       cgd 	if (wddumprecalibrated == 0) {
   1092      1.181    bouyer 		wddumpmulti = wd->sc_multi;
   1093      1.140       cgd 		wddumprecalibrated = 1;
   1094  1.193.2.1        he 		wd->drvp->state = RESET;
   1095       1.63   mycroft 	}
   1096      1.181    bouyer 
   1097      1.142   mycroft 	while (nblks > 0) {
   1098      1.181    bouyer again:
   1099      1.181    bouyer 		wd->sc_wdc_bio.blkno = blkno;
   1100      1.181    bouyer 		wd->sc_wdc_bio.flags = ATA_POLL;
   1101      1.181    bouyer 		if (wddumpmulti == 1)
   1102      1.181    bouyer 			wd->sc_wdc_bio.flags |= ATA_SINGLE;
   1103      1.181    bouyer 		if (wd->sc_flags & WDF_LBA)
   1104      1.181    bouyer 			wd->sc_wdc_bio.flags |= ATA_LBA;
   1105      1.181    bouyer 		wd->sc_wdc_bio.bcount =
   1106      1.181    bouyer 			min(nblks, wddumpmulti) * lp->d_secsize;
   1107      1.181    bouyer 		wd->sc_wdc_bio.databuf = va;
   1108      1.181    bouyer #ifndef WD_DUMP_NOT_TRUSTED
   1109      1.181    bouyer 		switch (wdc_ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
   1110      1.181    bouyer 		case WDC_TRY_AGAIN:
   1111      1.181    bouyer 			panic("wddump: try again");
   1112      1.181    bouyer 			break;
   1113      1.181    bouyer 		case WDC_QUEUED:
   1114      1.181    bouyer 			panic("wddump: polled command has been queued");
   1115      1.181    bouyer 			break;
   1116      1.181    bouyer 		case WDC_COMPLETE:
   1117      1.181    bouyer 			break;
   1118      1.116   mycroft 		}
   1119      1.181    bouyer 		switch(wd->sc_wdc_bio.error) {
   1120      1.181    bouyer 		case TIMEOUT:
   1121      1.181    bouyer 			printf("wddump: device timed out");
   1122      1.181    bouyer 			err = EIO;
   1123      1.181    bouyer 			break;
   1124      1.181    bouyer 		case ERR_DF:
   1125      1.181    bouyer 			printf("wddump: drive fault");
   1126      1.181    bouyer 			err = EIO;
   1127      1.181    bouyer 			break;
   1128      1.181    bouyer 		case ERR_DMA:
   1129      1.181    bouyer 			printf("wddump: DMA error");
   1130      1.181    bouyer 			err = EIO;
   1131      1.181    bouyer 			break;
   1132      1.181    bouyer 		case ERROR:
   1133      1.181    bouyer 			errbuf[0] = '\0';
   1134      1.190    bouyer 			ata_perror(wd->drvp, wd->sc_wdc_bio.r_error, errbuf);
   1135      1.181    bouyer 			printf("wddump: %s", errbuf);
   1136      1.181    bouyer 			err = EIO;
   1137      1.181    bouyer 			break;
   1138      1.181    bouyer 		case NOERROR:
   1139      1.181    bouyer 			err = 0;
   1140      1.181    bouyer 			break;
   1141      1.181    bouyer 		default:
   1142      1.181    bouyer 			panic("wddump: unknown error type");
   1143        1.3   deraadt 		}
   1144      1.181    bouyer 		if (err != 0) {
   1145      1.181    bouyer 			if (wddumpmulti != 1) {
   1146      1.181    bouyer 				wddumpmulti = 1; /* retry in single-sector */
   1147      1.181    bouyer 				printf(", retrying\n");
   1148      1.181    bouyer 				goto again;
   1149      1.181    bouyer 			}
   1150      1.181    bouyer 			printf("\n");
   1151      1.181    bouyer 			return err;
   1152       1.63   mycroft 		}
   1153      1.140       cgd #else	/* WD_DUMP_NOT_TRUSTED */
   1154      1.140       cgd 		/* Let's just talk about this first... */
   1155      1.153  christos 		printf("wd%d: dump addr 0x%x, cylin %d, head %d, sector %d\n",
   1156      1.140       cgd 		    unit, va, cylin, head, sector);
   1157      1.140       cgd 		delay(500 * 1000);	/* half a second */
   1158      1.140       cgd #endif
   1159        1.1       cgd 
   1160      1.140       cgd 		/* update block count */
   1161      1.181    bouyer 		nblks -= min(nblks, wddumpmulti);
   1162      1.181    bouyer 		blkno += min(nblks, wddumpmulti);
   1163      1.181    bouyer 		va += min(nblks, wddumpmulti) * lp->d_secsize;
   1164        1.1       cgd 	}
   1165      1.142   mycroft 
   1166      1.140       cgd 	wddoingadump = 0;
   1167      1.140       cgd 	return 0;
   1168      1.140       cgd }
   1169      1.140       cgd #else /* __BDEVSW_DUMP_NEW_TYPE */
   1170      1.163    bouyer 
   1171      1.163    bouyer 
   1172      1.140       cgd int
   1173      1.140       cgd wddump(dev, blkno, va, size)
   1174      1.181    bouyer 	dev_t dev;
   1175      1.181    bouyer 	daddr_t blkno;
   1176      1.181    bouyer 	caddr_t va;
   1177      1.181    bouyer 	size_t size;
   1178      1.140       cgd {
   1179      1.116   mycroft 
   1180      1.140       cgd 	/* Not implemented. */
   1181      1.140       cgd 	return ENXIO;
   1182        1.1       cgd }
   1183      1.140       cgd #endif /* __BDEVSW_DUMP_NEW_TYPE */
   1184        1.3   deraadt 
   1185      1.170       leo #ifdef HAS_BAD144_HANDLING
   1186        1.3   deraadt /*
   1187        1.3   deraadt  * Internalize the bad sector table.
   1188        1.3   deraadt  */
   1189        1.3   deraadt void
   1190       1.64   mycroft bad144intern(wd)
   1191       1.64   mycroft 	struct wd_softc *wd;
   1192        1.3   deraadt {
   1193      1.144   thorpej 	struct dkbad *bt = &wd->sc_dk.dk_cpulabel->bad;
   1194      1.144   thorpej 	struct disklabel *lp = wd->sc_dk.dk_label;
   1195       1.98   mycroft 	int i = 0;
   1196       1.55   mycroft 
   1197      1.182    bouyer 	WDCDEBUG_PRINT(("bad144intern\n"), DEBUG_XFERS);
   1198      1.163    bouyer 
   1199      1.170       leo 	for (; i < NBT_BAD; i++) {
   1200       1.98   mycroft 		if (bt->bt_bad[i].bt_cyl == 0xffff)
   1201       1.55   mycroft 			break;
   1202      1.181    bouyer 		wd->sc_badsect[i] =
   1203       1.98   mycroft 		    bt->bt_bad[i].bt_cyl * lp->d_secpercyl +
   1204       1.98   mycroft 		    (bt->bt_bad[i].bt_trksec >> 8) * lp->d_nsectors +
   1205       1.98   mycroft 		    (bt->bt_bad[i].bt_trksec & 0xff);
   1206        1.3   deraadt 	}
   1207      1.170       leo 	for (; i < NBT_BAD+1; i++)
   1208      1.181    bouyer 		wd->sc_badsect[i] = -1;
   1209       1.64   mycroft }
   1210      1.170       leo #endif
   1211       1.64   mycroft 
   1212      1.181    bouyer int
   1213      1.181    bouyer wd_get_params(wd, flags, params)
   1214      1.181    bouyer 	struct wd_softc *wd;
   1215      1.181    bouyer 	u_int8_t flags;
   1216      1.181    bouyer 	struct ataparams *params;
   1217       1.63   mycroft {
   1218      1.181    bouyer 	switch (ata_get_params(wd->drvp, flags, params)) {
   1219      1.181    bouyer 	case CMD_AGAIN:
   1220      1.181    bouyer 		return 1;
   1221      1.181    bouyer 	case CMD_ERR:
   1222      1.181    bouyer 		/*
   1223      1.181    bouyer 		 * We `know' there's a drive here; just assume it's old.
   1224      1.181    bouyer 		 * This geometry is only used to read the MBR and print a
   1225      1.181    bouyer 		 * (false) attach message.
   1226      1.181    bouyer 		 */
   1227      1.181    bouyer 		strncpy(params->atap_model, "ST506",
   1228      1.181    bouyer 		    sizeof params->atap_model);
   1229      1.181    bouyer 		params->atap_config = ATA_CFG_FIXED;
   1230      1.181    bouyer 		params->atap_cylinders = 1024;
   1231      1.181    bouyer 		params->atap_heads = 8;
   1232      1.181    bouyer 		params->atap_sectors = 17;
   1233      1.181    bouyer 		params->atap_multi = 1;
   1234      1.181    bouyer 		params->atap_capabilities1 = params->atap_capabilities2 = 0;
   1235      1.190    bouyer 		wd->drvp->ata_vers = -1; /* Mark it as pre-ATA */
   1236      1.181    bouyer 		return 0;
   1237      1.181    bouyer 	case CMD_OK:
   1238      1.181    bouyer 		return 0;
   1239      1.181    bouyer 	default:
   1240      1.181    bouyer 		panic("wd_get_params: bad return code from ata_get_params");
   1241      1.181    bouyer 		/* NOTREACHED */
   1242      1.181    bouyer 	}
   1243      1.190    bouyer }
   1244      1.190    bouyer 
   1245      1.190    bouyer void
   1246      1.190    bouyer wd_flushcache(wd, flags)
   1247      1.190    bouyer 	struct wd_softc *wd;
   1248      1.190    bouyer 	int flags;
   1249      1.190    bouyer {
   1250      1.190    bouyer 	struct wdc_command wdc_c;
   1251      1.190    bouyer 
   1252      1.190    bouyer 	if (wd->drvp->ata_vers < 4) /* WDCC_FLUSHCACHE is here since ATA-4 */
   1253      1.190    bouyer 		return;
   1254      1.190    bouyer 	memset(&wdc_c, 0, sizeof(struct wdc_command));
   1255      1.190    bouyer 	wdc_c.r_command = WDCC_FLUSHCACHE;
   1256      1.190    bouyer 	wdc_c.r_st_bmask = WDCS_DRDY;
   1257      1.190    bouyer 	wdc_c.r_st_pmask = WDCS_DRDY;
   1258  1.193.2.1        he 	wdc_c.flags = flags;
   1259      1.190    bouyer 	wdc_c.timeout = 30000; /* 30s timeout */
   1260      1.190    bouyer 	if (wdc_exec_command(wd->drvp, &wdc_c) != WDC_COMPLETE) {
   1261      1.190    bouyer 		printf("%s: flush cache command didn't complete\n",
   1262      1.190    bouyer 		    wd->sc_dev.dv_xname);
   1263      1.190    bouyer 	}
   1264      1.190    bouyer 	if (wdc_c.flags & AT_TIMEOU) {
   1265      1.190    bouyer 		printf("%s: flush cache command timeout\n",
   1266      1.190    bouyer 		    wd->sc_dev.dv_xname);
   1267      1.190    bouyer 	}
   1268      1.190    bouyer 	if (wdc_c.flags & AT_DF) {
   1269      1.190    bouyer 		printf("%s: flush cache command: drive fault\n",
   1270      1.190    bouyer 		    wd->sc_dev.dv_xname);
   1271      1.190    bouyer 	}
   1272      1.190    bouyer 	/*
   1273      1.190    bouyer 	 * Ignore error register, it shouldn't report anything else
   1274      1.190    bouyer 	 * than COMMAND ABORTED, which means the device doesn't support
   1275      1.190    bouyer 	 * flush cache
   1276      1.190    bouyer 	 */
   1277      1.190    bouyer }
   1278      1.190    bouyer 
   1279      1.190    bouyer void
   1280      1.190    bouyer wd_shutdown(arg)
   1281      1.190    bouyer 	void *arg;
   1282      1.190    bouyer {
   1283      1.190    bouyer 	struct wd_softc *wd = arg;
   1284  1.193.2.1        he 	wd_flushcache(wd, AT_POLL);
   1285      1.185      kenh }
   1286      1.185      kenh 
   1287      1.185      kenh /*
   1288      1.185      kenh  * Allocate space for a ioctl queue structure.  Mostly taken from
   1289      1.185      kenh  * scsipi_ioctl.c
   1290      1.185      kenh  */
   1291      1.185      kenh struct wd_ioctl *
   1292      1.185      kenh wi_get()
   1293      1.185      kenh {
   1294      1.185      kenh 	struct wd_ioctl *wi;
   1295      1.185      kenh 	int s;
   1296      1.185      kenh 
   1297      1.185      kenh 	wi = malloc(sizeof(struct wd_ioctl), M_TEMP, M_WAITOK);
   1298      1.185      kenh 	memset(wi, 0, sizeof (struct wd_ioctl));
   1299      1.185      kenh 	s = splbio();
   1300      1.185      kenh 	LIST_INSERT_HEAD(&wi_head, wi, wi_list);
   1301      1.185      kenh 	splx(s);
   1302      1.185      kenh 	return (wi);
   1303      1.185      kenh }
   1304      1.185      kenh 
   1305      1.185      kenh /*
   1306      1.185      kenh  * Free an ioctl structure and remove it from our list
   1307      1.185      kenh  */
   1308      1.185      kenh 
   1309      1.185      kenh void
   1310      1.185      kenh wi_free(wi)
   1311      1.185      kenh 	struct wd_ioctl *wi;
   1312      1.185      kenh {
   1313      1.185      kenh 	int s;
   1314      1.185      kenh 
   1315      1.185      kenh 	s = splbio();
   1316      1.185      kenh 	LIST_REMOVE(wi, wi_list);
   1317      1.185      kenh 	splx(s);
   1318      1.185      kenh 	free(wi, M_TEMP);
   1319      1.185      kenh }
   1320      1.185      kenh 
   1321      1.185      kenh /*
   1322      1.185      kenh  * Find a wd_ioctl structure based on the struct buf.
   1323      1.185      kenh  */
   1324      1.185      kenh 
   1325      1.185      kenh struct wd_ioctl *
   1326      1.185      kenh wi_find(bp)
   1327      1.185      kenh 	struct buf *bp;
   1328      1.185      kenh {
   1329      1.185      kenh 	struct wd_ioctl *wi;
   1330      1.185      kenh 	int s;
   1331      1.185      kenh 
   1332      1.185      kenh 	s = splbio();
   1333      1.185      kenh 	for (wi = wi_head.lh_first; wi != 0; wi = wi->wi_list.le_next)
   1334      1.185      kenh 		if (bp == &wi->wi_bp)
   1335      1.185      kenh 			break;
   1336      1.185      kenh 	splx(s);
   1337      1.185      kenh 	return (wi);
   1338      1.185      kenh }
   1339      1.185      kenh 
   1340      1.185      kenh /*
   1341      1.185      kenh  * Ioctl pseudo strategy routine
   1342      1.185      kenh  *
   1343      1.185      kenh  * This is mostly stolen from scsipi_ioctl.c:scsistrategy().  What
   1344      1.185      kenh  * happens here is:
   1345      1.185      kenh  *
   1346      1.185      kenh  * - wdioctl() queues a wd_ioctl structure.
   1347      1.185      kenh  *
   1348      1.185      kenh  * - wdioctl() calls physio/wdioctlstrategy based on whether or not
   1349      1.185      kenh  *   user space I/O is required.  If physio() is called, physio() eventually
   1350      1.185      kenh  *   calls wdioctlstrategy().
   1351      1.185      kenh  *
   1352      1.185      kenh  * - In either case, wdioctlstrategy() calls wdc_exec_command()
   1353      1.185      kenh  *   to perform the actual command
   1354      1.185      kenh  *
   1355      1.185      kenh  * The reason for the use of the pseudo strategy routine is because
   1356      1.185      kenh  * when doing I/O to/from user space, physio _really_ wants to be in
   1357      1.185      kenh  * the loop.  We could put the entire buffer into the ioctl request
   1358      1.185      kenh  * structure, but that won't scale if we want to do things like download
   1359      1.185      kenh  * microcode.
   1360      1.185      kenh  */
   1361      1.185      kenh 
   1362      1.185      kenh void
   1363      1.185      kenh wdioctlstrategy(bp)
   1364      1.185      kenh 	struct buf *bp;
   1365      1.185      kenh {
   1366      1.185      kenh 	struct wd_ioctl *wi;
   1367      1.185      kenh 	struct wdc_command wdc_c;
   1368      1.185      kenh 	int error = 0;
   1369      1.185      kenh 
   1370      1.185      kenh 	wi = wi_find(bp);
   1371      1.185      kenh 	if (wi == NULL) {
   1372      1.185      kenh 		printf("user_strat: No ioctl\n");
   1373      1.185      kenh 		error = EINVAL;
   1374      1.185      kenh 		goto bad;
   1375      1.185      kenh 	}
   1376      1.185      kenh 
   1377      1.185      kenh 	memset(&wdc_c, 0, sizeof(wdc_c));
   1378      1.185      kenh 
   1379      1.185      kenh 	/*
   1380      1.185      kenh 	 * Abort if physio broke up the transfer
   1381      1.185      kenh 	 */
   1382      1.185      kenh 
   1383      1.186      kenh 	if (bp->b_bcount != wi->wi_atareq.datalen) {
   1384      1.185      kenh 		printf("physio split wd ioctl request... cannot proceed\n");
   1385      1.185      kenh 		error = EIO;
   1386      1.185      kenh 		goto bad;
   1387      1.185      kenh 	}
   1388      1.185      kenh 
   1389      1.185      kenh 	/*
   1390      1.185      kenh 	 * Abort if we didn't get a buffer size that was a multiple of
   1391      1.185      kenh 	 * our sector size (or was larger than NBBY)
   1392      1.185      kenh 	 */
   1393      1.185      kenh 
   1394      1.185      kenh 	if ((bp->b_bcount % wi->wi_softc->sc_dk.dk_label->d_secsize) != 0 ||
   1395      1.185      kenh 	    (bp->b_bcount / wi->wi_softc->sc_dk.dk_label->d_secsize) >=
   1396      1.185      kenh 	     (1 << NBBY)) {
   1397      1.185      kenh 		error = EINVAL;
   1398      1.185      kenh 		goto bad;
   1399      1.185      kenh 	}
   1400      1.185      kenh 
   1401      1.185      kenh 	/*
   1402      1.185      kenh 	 * Make sure a timeout was supplied in the ioctl request
   1403      1.185      kenh 	 */
   1404      1.185      kenh 
   1405      1.186      kenh 	if (wi->wi_atareq.timeout == 0) {
   1406      1.185      kenh 		error = EINVAL;
   1407      1.185      kenh 		goto bad;
   1408      1.185      kenh 	}
   1409      1.185      kenh 
   1410      1.186      kenh 	if (wi->wi_atareq.flags & ATACMD_READ)
   1411      1.185      kenh 		wdc_c.flags |= AT_READ;
   1412      1.186      kenh 	else if (wi->wi_atareq.flags & ATACMD_WRITE)
   1413      1.185      kenh 		wdc_c.flags |= AT_WRITE;
   1414      1.185      kenh 
   1415      1.188      kenh 	if (wi->wi_atareq.flags & ATACMD_READREG)
   1416      1.188      kenh 		wdc_c.flags |= AT_READREG;
   1417      1.188      kenh 
   1418      1.185      kenh 	wdc_c.flags |= AT_WAIT;
   1419      1.185      kenh 
   1420      1.186      kenh 	wdc_c.timeout = wi->wi_atareq.timeout;
   1421      1.186      kenh 	wdc_c.r_command = wi->wi_atareq.command;
   1422      1.186      kenh 	wdc_c.r_head = wi->wi_atareq.head & 0x0f;
   1423      1.186      kenh 	wdc_c.r_cyl = wi->wi_atareq.cylinder;
   1424      1.186      kenh 	wdc_c.r_sector = wi->wi_atareq.sec_num;
   1425      1.186      kenh 	wdc_c.r_count = wi->wi_atareq.sec_count;
   1426      1.186      kenh 	wdc_c.r_precomp = wi->wi_atareq.features;
   1427      1.185      kenh 	wdc_c.r_st_bmask = WDCS_DRDY;
   1428      1.185      kenh 	wdc_c.r_st_pmask = WDCS_DRDY;
   1429      1.185      kenh 	wdc_c.data = wi->wi_bp.b_data;
   1430      1.185      kenh 	wdc_c.bcount = wi->wi_bp.b_bcount;
   1431      1.185      kenh 
   1432      1.185      kenh 	if (wdc_exec_command(wi->wi_softc->drvp, &wdc_c) != WDC_COMPLETE) {
   1433      1.186      kenh 		wi->wi_atareq.retsts = ATACMD_ERROR;
   1434      1.185      kenh 		goto bad;
   1435      1.185      kenh 	}
   1436      1.185      kenh 
   1437      1.185      kenh 	if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
   1438      1.185      kenh 		if (wdc_c.flags & AT_ERROR) {
   1439      1.186      kenh 			wi->wi_atareq.retsts = ATACMD_ERROR;
   1440      1.186      kenh 			wi->wi_atareq.error = wdc_c.r_error;
   1441      1.185      kenh 		} else if (wdc_c.flags & AT_DF)
   1442      1.186      kenh 			wi->wi_atareq.retsts = ATACMD_DF;
   1443      1.185      kenh 		else
   1444      1.186      kenh 			wi->wi_atareq.retsts = ATACMD_TIMEOUT;
   1445      1.188      kenh 	} else {
   1446      1.186      kenh 		wi->wi_atareq.retsts = ATACMD_OK;
   1447      1.188      kenh 		if (wi->wi_atareq.flags & ATACMD_READREG) {
   1448      1.188      kenh 			wi->wi_atareq.head = wdc_c.r_head ;
   1449      1.188      kenh 			wi->wi_atareq.cylinder = wdc_c.r_cyl;
   1450      1.188      kenh 			wi->wi_atareq.sec_num = wdc_c.r_sector;
   1451      1.188      kenh 			wi->wi_atareq.sec_count = wdc_c.r_count;
   1452      1.188      kenh 			wi->wi_atareq.features = wdc_c.r_precomp;
   1453      1.188      kenh 			wi->wi_atareq.error = wdc_c.r_error;
   1454      1.188      kenh 		}
   1455      1.188      kenh 	}
   1456      1.185      kenh 
   1457      1.185      kenh 	bp->b_error = 0;
   1458      1.185      kenh 	biodone(bp);
   1459      1.185      kenh 	return;
   1460      1.185      kenh bad:
   1461      1.185      kenh 	bp->b_flags |= B_ERROR;
   1462      1.185      kenh 	bp->b_error = error;
   1463      1.185      kenh 	biodone(bp);
   1464       1.21   deraadt }
   1465