Home | History | Annotate | Line # | Download | only in ata
ata_wdc.c revision 1.39.2.2
      1  1.39.2.2     skrll /*	$NetBSD: ata_wdc.c,v 1.39.2.2 2004/08/12 11:41:22 skrll Exp $	*/
      2       1.2    bouyer 
      3       1.2    bouyer /*
      4  1.39.2.1     skrll  * Copyright (c) 1998, 2001, 2003 Manuel Bouyer.
      5       1.2    bouyer  *
      6       1.2    bouyer  * Redistribution and use in source and binary forms, with or without
      7       1.2    bouyer  * modification, are permitted provided that the following conditions
      8       1.2    bouyer  * are met:
      9       1.2    bouyer  * 1. Redistributions of source code must retain the above copyright
     10       1.2    bouyer  *    notice, this list of conditions and the following disclaimer.
     11       1.2    bouyer  * 2. Redistributions in binary form must reproduce the above copyright
     12       1.2    bouyer  *    notice, this list of conditions and the following disclaimer in the
     13       1.2    bouyer  *    documentation and/or other materials provided with the distribution.
     14       1.2    bouyer  * 3. All advertising materials mentioning features or use of this software
     15       1.2    bouyer  *    must display the following acknowledgement:
     16      1.36    bouyer  *	This product includes software developed by Manuel Bouyer.
     17  1.39.2.1     skrll  * 4. The name of the author may not be used to endorse or promote products
     18  1.39.2.1     skrll  *    derived from this software without specific prior written permission.
     19       1.2    bouyer  *
     20      1.27    bouyer  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21      1.27    bouyer  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22      1.27    bouyer  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23      1.27    bouyer  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24      1.27    bouyer  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25      1.27    bouyer  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26      1.27    bouyer  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27      1.27    bouyer  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28      1.27    bouyer  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29      1.27    bouyer  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30       1.2    bouyer  */
     31       1.2    bouyer 
     32       1.2    bouyer /*-
     33  1.39.2.1     skrll  * Copyright (c) 1998, 2004 The NetBSD Foundation, Inc.
     34       1.2    bouyer  * All rights reserved.
     35       1.2    bouyer  *
     36       1.2    bouyer  * This code is derived from software contributed to The NetBSD Foundation
     37       1.2    bouyer  * by Charles M. Hannum, by Onno van der Linden and by Manuel Bouyer.
     38       1.2    bouyer  *
     39       1.2    bouyer  * Redistribution and use in source and binary forms, with or without
     40       1.2    bouyer  * modification, are permitted provided that the following conditions
     41       1.2    bouyer  * are met:
     42       1.2    bouyer  * 1. Redistributions of source code must retain the above copyright
     43       1.2    bouyer  *    notice, this list of conditions and the following disclaimer.
     44       1.2    bouyer  * 2. Redistributions in binary form must reproduce the above copyright
     45       1.2    bouyer  *    notice, this list of conditions and the following disclaimer in the
     46       1.2    bouyer  *    documentation and/or other materials provided with the distribution.
     47       1.2    bouyer  * 3. All advertising materials mentioning features or use of this software
     48       1.2    bouyer  *    must display the following acknowledgement:
     49       1.2    bouyer  *        This product includes software developed by the NetBSD
     50       1.2    bouyer  *        Foundation, Inc. and its contributors.
     51       1.2    bouyer  * 4. Neither the name of The NetBSD Foundation nor the names of its
     52       1.2    bouyer  *    contributors may be used to endorse or promote products derived
     53       1.2    bouyer  *    from this software without specific prior written permission.
     54       1.2    bouyer  *
     55       1.2    bouyer  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     56       1.2    bouyer  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     57       1.2    bouyer  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     58       1.2    bouyer  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     59       1.2    bouyer  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     60       1.2    bouyer  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     61       1.2    bouyer  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     62       1.2    bouyer  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     63       1.2    bouyer  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     64       1.2    bouyer  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     65       1.2    bouyer  * POSSIBILITY OF SUCH DAMAGE.
     66       1.2    bouyer  */
     67      1.31     lukem 
     68      1.31     lukem #include <sys/cdefs.h>
     69  1.39.2.2     skrll __KERNEL_RCSID(0, "$NetBSD: ata_wdc.c,v 1.39.2.2 2004/08/12 11:41:22 skrll Exp $");
     70       1.2    bouyer 
     71      1.15   hubertf #ifndef WDCDEBUG
     72       1.2    bouyer #define WDCDEBUG
     73      1.15   hubertf #endif /* WDCDEBUG */
     74       1.2    bouyer 
     75       1.2    bouyer #include <sys/param.h>
     76       1.2    bouyer #include <sys/systm.h>
     77       1.2    bouyer #include <sys/kernel.h>
     78       1.2    bouyer #include <sys/file.h>
     79       1.2    bouyer #include <sys/stat.h>
     80       1.2    bouyer #include <sys/buf.h>
     81       1.2    bouyer #include <sys/malloc.h>
     82       1.2    bouyer #include <sys/device.h>
     83       1.2    bouyer #include <sys/disklabel.h>
     84       1.2    bouyer #include <sys/syslog.h>
     85       1.2    bouyer #include <sys/proc.h>
     86       1.2    bouyer 
     87       1.2    bouyer #include <machine/intr.h>
     88       1.2    bouyer #include <machine/bus.h>
     89       1.2    bouyer #ifndef __BUS_SPACE_HAS_STREAM_METHODS
     90       1.2    bouyer #define    bus_space_write_multi_stream_2    bus_space_write_multi_2
     91       1.2    bouyer #define    bus_space_write_multi_stream_4    bus_space_write_multi_4
     92       1.2    bouyer #define    bus_space_read_multi_stream_2    bus_space_read_multi_2
     93       1.2    bouyer #define    bus_space_read_multi_stream_4    bus_space_read_multi_4
     94       1.2    bouyer #endif /* __BUS_SPACE_HAS_STREAM_METHODS */
     95       1.2    bouyer 
     96       1.2    bouyer #include <dev/ata/atareg.h>
     97       1.2    bouyer #include <dev/ata/atavar.h>
     98       1.2    bouyer #include <dev/ic/wdcreg.h>
     99       1.2    bouyer #include <dev/ic/wdcvar.h>
    100       1.2    bouyer 
    101       1.2    bouyer #define DEBUG_INTR   0x01
    102       1.2    bouyer #define DEBUG_XFERS  0x02
    103       1.2    bouyer #define DEBUG_STATUS 0x04
    104       1.2    bouyer #define DEBUG_FUNCS  0x08
    105       1.2    bouyer #define DEBUG_PROBE  0x10
    106       1.2    bouyer #ifdef WDCDEBUG
    107  1.39.2.1     skrll extern int wdcdebug_wd_mask; /* inited in wd.c */
    108       1.2    bouyer #define WDCDEBUG_PRINT(args, level) \
    109       1.2    bouyer 	if (wdcdebug_wd_mask & (level)) \
    110       1.2    bouyer 		printf args
    111       1.2    bouyer #else
    112       1.2    bouyer #define WDCDEBUG_PRINT(args, level)
    113       1.2    bouyer #endif
    114       1.2    bouyer 
    115      1.17    bouyer #define ATA_DELAY 10000 /* 10s for a drive I/O */
    116       1.2    bouyer 
    117  1.39.2.1     skrll static int	wdc_ata_bio(struct ata_drive_datas*, struct ata_bio*);
    118  1.39.2.1     skrll static void	wdc_ata_bio_start(struct wdc_channel *,struct ata_xfer *);
    119  1.39.2.1     skrll static void	_wdc_ata_bio_start(struct wdc_channel *,struct ata_xfer *);
    120  1.39.2.1     skrll static int	wdc_ata_bio_intr(struct wdc_channel *, struct ata_xfer *,
    121  1.39.2.1     skrll 				 int);
    122  1.39.2.1     skrll static void	wdc_ata_bio_kill_xfer(struct wdc_channel *,
    123  1.39.2.1     skrll 				      struct ata_xfer *, int);
    124  1.39.2.1     skrll static void	wdc_ata_bio_done(struct wdc_channel *, struct ata_xfer *);
    125  1.39.2.1     skrll static int	wdc_ata_err(struct ata_drive_datas *, struct ata_bio *);
    126       1.2    bouyer #define WDC_ATA_NOERR 0x00 /* Drive doesn't report an error */
    127       1.2    bouyer #define WDC_ATA_RECOV 0x01 /* There was a recovered error */
    128       1.2    bouyer #define WDC_ATA_ERR   0x02 /* Drive reports an error */
    129  1.39.2.1     skrll static int	wdc_ata_addref(struct ata_drive_datas *);
    130  1.39.2.1     skrll static void	wdc_ata_delref(struct ata_drive_datas *);
    131      1.32    bouyer 
    132      1.32    bouyer const struct ata_bustype wdc_ata_bustype = {
    133      1.32    bouyer 	SCSIPI_BUSTYPE_ATA,
    134      1.32    bouyer 	wdc_ata_bio,
    135  1.39.2.1     skrll 	wdc_reset_drive,
    136      1.32    bouyer 	wdc_exec_command,
    137      1.32    bouyer 	ata_get_params,
    138      1.32    bouyer 	wdc_ata_addref,
    139      1.32    bouyer 	wdc_ata_delref,
    140  1.39.2.2     skrll 	wdc_kill_pending,
    141      1.32    bouyer };
    142      1.32    bouyer 
    143       1.2    bouyer /*
    144      1.34  christos  * Convert a 32 bit command to a 48 bit command.
    145      1.34  christos  */
    146  1.39.2.1     skrll static __inline
    147      1.34  christos int to48(int cmd32)
    148      1.34  christos {
    149      1.34  christos 	switch (cmd32) {
    150      1.34  christos 	case WDCC_READ:
    151      1.34  christos 		return WDCC_READ_EXT;
    152      1.34  christos 	case WDCC_WRITE:
    153      1.34  christos 		return WDCC_WRITE_EXT;
    154      1.34  christos 	case WDCC_READMULTI:
    155      1.34  christos 		return WDCC_READMULTI_EXT;
    156      1.34  christos 	case WDCC_WRITEMULTI:
    157      1.34  christos 		return WDCC_WRITEMULTI_EXT;
    158      1.35  christos 	case WDCC_READDMA:
    159      1.35  christos 		return WDCC_READDMA_EXT;
    160      1.35  christos 	case WDCC_WRITEDMA:
    161      1.35  christos 		return WDCC_WRITEDMA_EXT;
    162      1.34  christos 	default:
    163      1.34  christos 		panic("ata_wdc: illegal 32 bit command %d", cmd32);
    164      1.34  christos 		/*NOTREACHED*/
    165      1.34  christos 	}
    166      1.34  christos }
    167      1.34  christos 
    168      1.34  christos /*
    169  1.39.2.2     skrll  * Handle block I/O operation. Return ATACMD_COMPLETE, ATACMD_QUEUED, or
    170  1.39.2.2     skrll  * ATACMD_TRY_AGAIN. Must be called at splbio().
    171       1.2    bouyer  */
    172  1.39.2.1     skrll static int
    173  1.39.2.1     skrll wdc_ata_bio(struct ata_drive_datas *drvp, struct ata_bio *ata_bio)
    174       1.2    bouyer {
    175  1.39.2.1     skrll 	struct ata_xfer *xfer;
    176  1.39.2.1     skrll 	struct wdc_channel *chp = drvp->chnl_softc;
    177  1.39.2.1     skrll 	struct wdc_softc *wdc = chp->ch_wdc;
    178       1.2    bouyer 
    179       1.2    bouyer 	xfer = wdc_get_xfer(WDC_NOSLEEP);
    180       1.2    bouyer 	if (xfer == NULL)
    181  1.39.2.2     skrll 		return ATACMD_TRY_AGAIN;
    182  1.39.2.1     skrll 	if (wdc->cap & WDC_CAPABILITY_NOIRQ)
    183      1.30     bjh21 		ata_bio->flags |= ATA_POLL;
    184       1.2    bouyer 	if (ata_bio->flags & ATA_POLL)
    185       1.2    bouyer 		xfer->c_flags |= C_POLL;
    186       1.2    bouyer 	if ((drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA)) &&
    187       1.2    bouyer 	    (ata_bio->flags & ATA_SINGLE) == 0)
    188       1.2    bouyer 		xfer->c_flags |= C_DMA;
    189  1.39.2.1     skrll 	xfer->c_drive = drvp->drive;
    190  1.39.2.1     skrll 	xfer->c_cmd = ata_bio;
    191  1.39.2.1     skrll 	xfer->c_databuf = ata_bio->databuf;
    192       1.2    bouyer 	xfer->c_bcount = ata_bio->bcount;
    193       1.2    bouyer 	xfer->c_start = wdc_ata_bio_start;
    194       1.2    bouyer 	xfer->c_intr = wdc_ata_bio_intr;
    195      1.22     enami 	xfer->c_kill_xfer = wdc_ata_bio_kill_xfer;
    196       1.2    bouyer 	wdc_exec_xfer(chp, xfer);
    197  1.39.2.2     skrll 	return (ata_bio->flags & ATA_ITSDONE) ? ATACMD_COMPLETE : ATACMD_QUEUED;
    198       1.2    bouyer }
    199       1.2    bouyer 
    200  1.39.2.1     skrll static void
    201  1.39.2.1     skrll wdc_ata_bio_start(struct wdc_channel *chp, struct ata_xfer *xfer)
    202       1.2    bouyer {
    203  1.39.2.1     skrll 	struct wdc_softc *wdc = chp->ch_wdc;
    204  1.39.2.1     skrll 	struct ata_bio *ata_bio = xfer->c_cmd;
    205  1.39.2.1     skrll 	struct ata_drive_datas *drvp = &chp->ch_drive[xfer->c_drive];
    206  1.39.2.1     skrll 	int wait_flags = (xfer->c_flags & C_POLL) ? AT_POLL : 0;
    207  1.39.2.1     skrll 	char *errstring;
    208  1.39.2.1     skrll 
    209      1.20    bouyer 	WDCDEBUG_PRINT(("wdc_ata_bio_start %s:%d:%d\n",
    210  1.39.2.1     skrll 	    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive),
    211      1.20    bouyer 	    DEBUG_XFERS);
    212      1.20    bouyer 
    213  1.39.2.1     skrll 	/* Do control operations specially. */
    214  1.39.2.1     skrll 	if (__predict_false(drvp->state < READY)) {
    215  1.39.2.1     skrll 		/*
    216  1.39.2.1     skrll 		 * Actually, we want to be careful not to mess with the control
    217  1.39.2.1     skrll 		 * state if the device is currently busy, but we can assume
    218  1.39.2.1     skrll 		 * that we never get to this point if that's the case.
    219  1.39.2.1     skrll 		 */
    220  1.39.2.1     skrll 		/* If it's not a polled command, we need the kenrel thread */
    221  1.39.2.1     skrll 		if ((xfer->c_flags & C_POLL) == 0 &&
    222  1.39.2.1     skrll 		    (chp->ch_flags & WDCF_TH_RUN) == 0) {
    223  1.39.2.1     skrll 			chp->ch_queue->queue_freeze++;
    224  1.39.2.1     skrll 			wakeup(&chp->ch_thread);
    225  1.39.2.1     skrll 			return;
    226  1.39.2.1     skrll 		}
    227  1.39.2.1     skrll 		/*
    228  1.39.2.1     skrll 		 * disable interrupts, all commands here should be quick
    229  1.39.2.1     skrll 		 * enouth to be able to poll, and we don't go here that often
    230  1.39.2.1     skrll 		 */
    231  1.39.2.1     skrll 		bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
    232  1.39.2.1     skrll 		    WDCTL_4BIT | WDCTL_IDS);
    233  1.39.2.1     skrll 		if (wdc->cap & WDC_CAPABILITY_SELECT)
    234  1.39.2.1     skrll 			wdc->select(chp, xfer->c_drive);
    235  1.39.2.1     skrll 		bus_space_write_1(chp->cmd_iot, chp->cmd_iohs[wd_sdh], 0,
    236  1.39.2.1     skrll 		    WDSD_IBM | (xfer->c_drive << 4));
    237  1.39.2.1     skrll 		DELAY(10);
    238  1.39.2.1     skrll 		errstring = "wait";
    239  1.39.2.1     skrll 		if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
    240  1.39.2.1     skrll 			goto ctrltimeout;
    241  1.39.2.1     skrll 		wdccommandshort(chp, xfer->c_drive, WDCC_RECAL);
    242  1.39.2.1     skrll 		/* Wait for at last 400ns for status bit to be valid */
    243  1.39.2.1     skrll 		DELAY(1);
    244  1.39.2.1     skrll 		errstring = "recal";
    245  1.39.2.1     skrll 		if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
    246  1.39.2.1     skrll 			goto ctrltimeout;
    247  1.39.2.1     skrll 		if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
    248  1.39.2.1     skrll 			goto ctrlerror;
    249  1.39.2.1     skrll 		/* Don't try to set modes if controller can't be adjusted */
    250  1.39.2.1     skrll 		if ((wdc->cap & WDC_CAPABILITY_MODE) == 0)
    251  1.39.2.1     skrll 			goto geometry;
    252  1.39.2.1     skrll 		/* Also don't try if the drive didn't report its mode */
    253  1.39.2.1     skrll 		if ((drvp->drive_flags & DRIVE_MODE) == 0)
    254  1.39.2.1     skrll 			goto geometry;
    255  1.39.2.1     skrll 		wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
    256  1.39.2.1     skrll 		    0x08 | drvp->PIO_mode, WDSF_SET_MODE);
    257  1.39.2.1     skrll 		errstring = "piomode";
    258  1.39.2.1     skrll 		if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
    259  1.39.2.1     skrll 			goto ctrltimeout;
    260  1.39.2.1     skrll 		if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
    261  1.39.2.1     skrll 			goto ctrlerror;
    262  1.39.2.1     skrll 		if (drvp->drive_flags & DRIVE_UDMA) {
    263  1.39.2.1     skrll 			wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
    264  1.39.2.1     skrll 			    0x40 | drvp->UDMA_mode, WDSF_SET_MODE);
    265  1.39.2.1     skrll 		} else if (drvp->drive_flags & DRIVE_DMA) {
    266  1.39.2.1     skrll 			wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
    267  1.39.2.1     skrll 			    0x20 | drvp->DMA_mode, WDSF_SET_MODE);
    268  1.39.2.1     skrll 		} else {
    269  1.39.2.1     skrll 			goto geometry;
    270  1.39.2.1     skrll 		}
    271  1.39.2.1     skrll 		errstring = "dmamode";
    272  1.39.2.1     skrll 		if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
    273  1.39.2.1     skrll 			goto ctrltimeout;
    274  1.39.2.1     skrll 		if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
    275  1.39.2.1     skrll 			goto ctrlerror;
    276  1.39.2.1     skrll geometry:
    277  1.39.2.1     skrll 		if (ata_bio->flags & ATA_LBA)
    278  1.39.2.1     skrll 			goto multimode;
    279  1.39.2.1     skrll 		wdccommand(chp, xfer->c_drive, WDCC_IDP,
    280  1.39.2.1     skrll 		    ata_bio->lp->d_ncylinders,
    281  1.39.2.1     skrll 		    ata_bio->lp->d_ntracks - 1, 0, ata_bio->lp->d_nsectors,
    282  1.39.2.1     skrll 		    (ata_bio->lp->d_type == DTYPE_ST506) ?
    283  1.39.2.1     skrll 			ata_bio->lp->d_precompcyl / 4 : 0);
    284  1.39.2.1     skrll 		errstring = "geometry";
    285  1.39.2.1     skrll 		if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
    286  1.39.2.1     skrll 			goto ctrltimeout;
    287  1.39.2.1     skrll 		if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
    288  1.39.2.1     skrll 			goto ctrlerror;
    289  1.39.2.1     skrll multimode:
    290  1.39.2.1     skrll 		if (ata_bio->multi == 1)
    291  1.39.2.1     skrll 			goto ready;
    292  1.39.2.1     skrll 		wdccommand(chp, xfer->c_drive, WDCC_SETMULTI, 0, 0, 0,
    293  1.39.2.1     skrll 		    ata_bio->multi, 0);
    294  1.39.2.1     skrll 		errstring = "setmulti";
    295  1.39.2.1     skrll 		if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
    296  1.39.2.1     skrll 			goto ctrltimeout;
    297  1.39.2.1     skrll 		if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
    298  1.39.2.1     skrll 			goto ctrlerror;
    299  1.39.2.1     skrll ready:
    300  1.39.2.1     skrll 		drvp->state = READY;
    301  1.39.2.1     skrll 		/*
    302  1.39.2.1     skrll 		 * The drive is usable now
    303  1.39.2.1     skrll 		 */
    304  1.39.2.1     skrll 		bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
    305  1.39.2.1     skrll 		    WDCTL_4BIT);
    306  1.39.2.1     skrll 		delay(10); /* some drives need a little delay here */
    307  1.39.2.1     skrll 	}
    308  1.39.2.1     skrll 
    309      1.20    bouyer 	_wdc_ata_bio_start(chp, xfer);
    310  1.39.2.1     skrll 	return;
    311  1.39.2.1     skrll ctrltimeout:
    312  1.39.2.1     skrll 	printf("%s:%d:%d: %s timed out\n",
    313  1.39.2.1     skrll 	    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
    314  1.39.2.1     skrll 	    errstring);
    315  1.39.2.1     skrll 	ata_bio->error = TIMEOUT;
    316  1.39.2.1     skrll 	goto ctrldone;
    317  1.39.2.1     skrll ctrlerror:
    318  1.39.2.1     skrll 	printf("%s:%d:%d: %s ",
    319  1.39.2.1     skrll 	    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
    320  1.39.2.1     skrll 	    errstring);
    321  1.39.2.1     skrll 	if (chp->ch_status & WDCS_DWF) {
    322  1.39.2.1     skrll 		printf("drive fault\n");
    323  1.39.2.1     skrll 		ata_bio->error = ERR_DF;
    324  1.39.2.1     skrll 	} else {
    325  1.39.2.1     skrll 		printf("error (%x)\n", chp->ch_error);
    326  1.39.2.1     skrll 		ata_bio->r_error = chp->ch_error;
    327  1.39.2.1     skrll 		ata_bio->error = ERROR;
    328  1.39.2.1     skrll 	}
    329  1.39.2.1     skrll ctrldone:
    330  1.39.2.1     skrll 	drvp->state = 0;
    331  1.39.2.1     skrll 	wdc_ata_bio_done(chp, xfer);
    332  1.39.2.1     skrll 	bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr, WDCTL_4BIT);
    333  1.39.2.1     skrll 	return;
    334      1.20    bouyer }
    335      1.20    bouyer 
    336  1.39.2.1     skrll static void
    337  1.39.2.1     skrll _wdc_ata_bio_start(struct wdc_channel *chp, struct ata_xfer *xfer)
    338      1.20    bouyer {
    339  1.39.2.1     skrll 	struct wdc_softc *wdc = chp->ch_wdc;
    340  1.39.2.1     skrll 	struct ata_bio *ata_bio = xfer->c_cmd;
    341  1.39.2.1     skrll 	struct ata_drive_datas *drvp = &chp->ch_drive[xfer->c_drive];
    342  1.39.2.1     skrll 	int wait_flags = (xfer->c_flags & C_POLL) ? AT_POLL : 0;
    343       1.2    bouyer 	u_int16_t cyl;
    344       1.2    bouyer 	u_int8_t head, sect, cmd = 0;
    345       1.2    bouyer 	int nblks;
    346       1.2    bouyer 	int dma_flags = 0;
    347       1.2    bouyer 
    348      1.20    bouyer 	WDCDEBUG_PRINT(("_wdc_ata_bio_start %s:%d:%d\n",
    349  1.39.2.1     skrll 	    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive),
    350      1.20    bouyer 	    DEBUG_INTR | DEBUG_XFERS);
    351       1.2    bouyer 
    352       1.2    bouyer 	if (xfer->c_flags & C_DMA) {
    353      1.23    bouyer 		if (drvp->n_xfers <= NXFER)
    354      1.23    bouyer 			drvp->n_xfers++;
    355       1.2    bouyer 		dma_flags = (ata_bio->flags & ATA_READ) ?  WDC_DMA_READ : 0;
    356      1.39  nakayama 		if (ata_bio->flags & ATA_LBA48)
    357      1.39  nakayama 			dma_flags |= WDC_DMA_LBA48;
    358       1.2    bouyer 	}
    359       1.2    bouyer again:
    360       1.2    bouyer 	/*
    361       1.2    bouyer 	 *
    362       1.2    bouyer 	 * When starting a multi-sector transfer, or doing single-sector
    363       1.2    bouyer 	 * transfers...
    364       1.2    bouyer 	 */
    365       1.2    bouyer 	if (xfer->c_skip == 0 || (ata_bio->flags & ATA_SINGLE) != 0) {
    366       1.2    bouyer 		if (ata_bio->flags & ATA_SINGLE)
    367       1.2    bouyer 			nblks = 1;
    368       1.2    bouyer 		else
    369       1.2    bouyer 			nblks = xfer->c_bcount / ata_bio->lp->d_secsize;
    370       1.2    bouyer 		/* Check for bad sectors and adjust transfer, if necessary. */
    371       1.2    bouyer 		if ((ata_bio->lp->d_flags & D_BADSECT) != 0) {
    372       1.2    bouyer 			long blkdiff;
    373       1.2    bouyer 			int i;
    374       1.2    bouyer 			for (i = 0; (blkdiff = ata_bio->badsect[i]) != -1;
    375       1.2    bouyer 			    i++) {
    376       1.2    bouyer 				blkdiff -= ata_bio->blkno;
    377       1.2    bouyer 				if (blkdiff < 0)
    378       1.2    bouyer 					continue;
    379       1.2    bouyer 				if (blkdiff == 0) {
    380       1.2    bouyer 					/* Replace current block of transfer. */
    381       1.2    bouyer 					ata_bio->blkno =
    382       1.2    bouyer 					    ata_bio->lp->d_secperunit -
    383       1.2    bouyer 					    ata_bio->lp->d_nsectors - i - 1;
    384       1.2    bouyer 				}
    385       1.2    bouyer 				if (blkdiff < nblks) {
    386       1.2    bouyer 					/* Bad block inside transfer. */
    387       1.2    bouyer 					ata_bio->flags |= ATA_SINGLE;
    388       1.2    bouyer 					nblks = 1;
    389       1.2    bouyer 				}
    390       1.2    bouyer 				break;
    391       1.2    bouyer 			}
    392       1.2    bouyer 		/* Transfer is okay now. */
    393       1.2    bouyer 		}
    394      1.34  christos 		if (ata_bio->flags & ATA_LBA48) {
    395      1.34  christos 			sect = 0;
    396      1.34  christos 			cyl =  0;
    397      1.34  christos 			head = 0;
    398      1.34  christos 		} else if (ata_bio->flags & ATA_LBA) {
    399       1.2    bouyer 			sect = (ata_bio->blkno >> 0) & 0xff;
    400       1.2    bouyer 			cyl = (ata_bio->blkno >> 8) & 0xffff;
    401       1.2    bouyer 			head = (ata_bio->blkno >> 24) & 0x0f;
    402       1.2    bouyer 			head |= WDSD_LBA;
    403       1.2    bouyer 		} else {
    404       1.2    bouyer 			int blkno = ata_bio->blkno;
    405       1.2    bouyer 			sect = blkno % ata_bio->lp->d_nsectors;
    406       1.2    bouyer 			sect++;    /* Sectors begin with 1, not 0. */
    407       1.2    bouyer 			blkno /= ata_bio->lp->d_nsectors;
    408       1.2    bouyer 			head = blkno % ata_bio->lp->d_ntracks;
    409       1.2    bouyer 			blkno /= ata_bio->lp->d_ntracks;
    410       1.2    bouyer 			cyl = blkno;
    411       1.2    bouyer 			head |= WDSD_CHS;
    412       1.2    bouyer 		}
    413       1.2    bouyer 		if (xfer->c_flags & C_DMA) {
    414       1.2    bouyer 			ata_bio->nblks = nblks;
    415       1.2    bouyer 			ata_bio->nbytes = xfer->c_bcount;
    416       1.2    bouyer 			cmd = (ata_bio->flags & ATA_READ) ?
    417       1.2    bouyer 			    WDCC_READDMA : WDCC_WRITEDMA;
    418       1.2    bouyer 	    		/* Init the DMA channel. */
    419  1.39.2.1     skrll 			if ((*wdc->dma_init)(wdc->dma_arg,
    420  1.39.2.1     skrll 			    chp->ch_channel, xfer->c_drive,
    421  1.39.2.1     skrll 			    (char *)xfer->c_databuf + xfer->c_skip,
    422      1.11  augustss 			    ata_bio->nbytes, dma_flags) != 0) {
    423       1.2    bouyer 				ata_bio->error = ERR_DMA;
    424       1.2    bouyer 				ata_bio->r_error = 0;
    425       1.2    bouyer 				wdc_ata_bio_done(chp, xfer);
    426       1.2    bouyer 				return;
    427       1.2    bouyer 			}
    428       1.2    bouyer 			/* Initiate command */
    429  1.39.2.1     skrll 			if (wdc->cap & WDC_CAPABILITY_SELECT)
    430  1.39.2.1     skrll 				wdc->select(chp, xfer->c_drive);
    431  1.39.2.1     skrll 			bus_space_write_1(chp->cmd_iot, chp->cmd_iohs[wd_sdh],
    432  1.39.2.1     skrll 			    0, WDSD_IBM | (xfer->c_drive << 4));
    433  1.39.2.1     skrll 			switch(wdc_wait_for_ready(chp, ATA_DELAY, wait_flags)) {
    434  1.39.2.1     skrll 			case WDCWAIT_OK:
    435  1.39.2.1     skrll 				break;
    436  1.39.2.1     skrll 			case WDCWAIT_TOUT:
    437       1.2    bouyer 				goto timeout;
    438  1.39.2.1     skrll 			case WDCWAIT_THR:
    439  1.39.2.1     skrll 				return;
    440  1.39.2.1     skrll 			}
    441      1.34  christos 			if (ata_bio->flags & ATA_LBA48) {
    442  1.39.2.1     skrll 			    wdccommandext(chp, xfer->c_drive, to48(cmd),
    443      1.34  christos 				(u_int64_t)ata_bio->blkno, nblks);
    444      1.34  christos 			} else {
    445  1.39.2.1     skrll 			    wdccommand(chp, xfer->c_drive, cmd, cyl,
    446      1.34  christos 				head, sect, nblks, 0);
    447      1.34  christos 			}
    448       1.2    bouyer 			/* start the DMA channel */
    449  1.39.2.1     skrll 			(*wdc->dma_start)(wdc->dma_arg,
    450  1.39.2.1     skrll 			    chp->ch_channel, xfer->c_drive);
    451      1.26    bouyer 			chp->ch_flags |= WDCF_DMA_WAIT;
    452  1.39.2.1     skrll 			/* start timeout machinery */
    453  1.39.2.1     skrll 			if ((xfer->c_flags & C_POLL) == 0)
    454  1.39.2.1     skrll 				callout_reset(&chp->ch_callout,
    455  1.39.2.1     skrll 				    ATA_DELAY / 1000 * hz, wdctimeout, chp);
    456       1.2    bouyer 			/* wait for irq */
    457       1.2    bouyer 			goto intr;
    458       1.2    bouyer 		} /* else not DMA */
    459       1.2    bouyer 		ata_bio->nblks = min(nblks, ata_bio->multi);
    460       1.2    bouyer 		ata_bio->nbytes = ata_bio->nblks * ata_bio->lp->d_secsize;
    461  1.39.2.1     skrll 		KASSERT(nblks == 1 || (ata_bio->flags & ATA_SINGLE) == 0);
    462  1.39.2.1     skrll 		if (ata_bio->nblks > 1) {
    463       1.2    bouyer 			cmd = (ata_bio->flags & ATA_READ) ?
    464       1.2    bouyer 			    WDCC_READMULTI : WDCC_WRITEMULTI;
    465       1.2    bouyer 		} else {
    466       1.2    bouyer 			cmd = (ata_bio->flags & ATA_READ) ?
    467       1.2    bouyer 			    WDCC_READ : WDCC_WRITE;
    468       1.2    bouyer 		}
    469       1.2    bouyer 		/* Initiate command! */
    470  1.39.2.1     skrll 		if (wdc->cap & WDC_CAPABILITY_SELECT)
    471  1.39.2.1     skrll 			wdc->select(chp, xfer->c_drive);
    472  1.39.2.1     skrll 		bus_space_write_1(chp->cmd_iot, chp->cmd_iohs[wd_sdh], 0,
    473  1.39.2.1     skrll 		    WDSD_IBM | (xfer->c_drive << 4));
    474  1.39.2.1     skrll 		switch(wdc_wait_for_ready(chp, ATA_DELAY, wait_flags)) {
    475  1.39.2.1     skrll 		case WDCWAIT_OK:
    476  1.39.2.1     skrll 			break;
    477  1.39.2.1     skrll 		case WDCWAIT_TOUT:
    478       1.2    bouyer 			goto timeout;
    479  1.39.2.1     skrll 		case WDCWAIT_THR:
    480  1.39.2.1     skrll 			return;
    481  1.39.2.1     skrll 		}
    482      1.34  christos 		if (ata_bio->flags & ATA_LBA48) {
    483  1.39.2.1     skrll 		    wdccommandext(chp, xfer->c_drive, to48(cmd),
    484      1.34  christos 			(u_int64_t) ata_bio->blkno, nblks);
    485      1.34  christos 		} else {
    486  1.39.2.1     skrll 		    wdccommand(chp, xfer->c_drive, cmd, cyl,
    487      1.34  christos 			head, sect, nblks,
    488      1.34  christos 			(ata_bio->lp->d_type == DTYPE_ST506) ?
    489      1.34  christos 			ata_bio->lp->d_precompcyl / 4 : 0);
    490      1.34  christos 		}
    491  1.39.2.1     skrll 		/* start timeout machinery */
    492  1.39.2.1     skrll 		if ((xfer->c_flags & C_POLL) == 0)
    493  1.39.2.1     skrll 			callout_reset(&chp->ch_callout,
    494  1.39.2.1     skrll 			    ATA_DELAY / 1000 * hz, wdctimeout, chp);
    495       1.2    bouyer 	} else if (ata_bio->nblks > 1) {
    496       1.2    bouyer 		/* The number of blocks in the last stretch may be smaller. */
    497       1.2    bouyer 		nblks = xfer->c_bcount / ata_bio->lp->d_secsize;
    498       1.2    bouyer 		if (ata_bio->nblks > nblks) {
    499       1.2    bouyer 		ata_bio->nblks = nblks;
    500       1.2    bouyer 		ata_bio->nbytes = xfer->c_bcount;
    501       1.2    bouyer 		}
    502       1.2    bouyer 	}
    503       1.2    bouyer 	/* If this was a write and not using DMA, push the data. */
    504       1.2    bouyer 	if ((ata_bio->flags & ATA_READ) == 0) {
    505  1.39.2.1     skrll 		/*
    506  1.39.2.1     skrll 		 * we have to busy-wait here, we can't rely on running in
    507  1.39.2.1     skrll 		 * thread context.
    508  1.39.2.1     skrll 		 */
    509  1.39.2.1     skrll 		if (wdc_wait_for_drq(chp, ATA_DELAY, AT_POLL) != 0) {
    510       1.2    bouyer 			printf("%s:%d:%d: timeout waiting for DRQ, "
    511       1.2    bouyer 			    "st=0x%02x, err=0x%02x\n",
    512  1.39.2.1     skrll 			    wdc->sc_dev.dv_xname, chp->ch_channel,
    513  1.39.2.1     skrll 			    xfer->c_drive, chp->ch_status, chp->ch_error);
    514      1.16    bouyer 			if (wdc_ata_err(drvp, ata_bio) != WDC_ATA_ERR)
    515       1.2    bouyer 				ata_bio->error = TIMEOUT;
    516       1.2    bouyer 			wdc_ata_bio_done(chp, xfer);
    517       1.2    bouyer 			return;
    518       1.2    bouyer 		}
    519      1.16    bouyer 		if (wdc_ata_err(drvp, ata_bio) == WDC_ATA_ERR) {
    520       1.2    bouyer 			wdc_ata_bio_done(chp, xfer);
    521       1.2    bouyer 			return;
    522       1.2    bouyer 		}
    523  1.39.2.2     skrll 		wdc->dataout_pio(chp, drvp->drive_flags,
    524  1.39.2.2     skrll 		    (char *)xfer->c_databuf + xfer->c_skip, ata_bio->nbytes);
    525       1.2    bouyer 	}
    526       1.2    bouyer 
    527       1.2    bouyer intr:	/* Wait for IRQ (either real or polled) */
    528       1.2    bouyer 	if ((ata_bio->flags & ATA_POLL) == 0) {
    529       1.2    bouyer 		chp->ch_flags |= WDCF_IRQ_WAIT;
    530       1.2    bouyer 	} else {
    531       1.2    bouyer 		/* Wait for at last 400ns for status bit to be valid */
    532       1.2    bouyer 		delay(1);
    533      1.26    bouyer 		if (chp->ch_flags & WDCF_DMA_WAIT) {
    534      1.26    bouyer 			wdc_dmawait(chp, xfer, ATA_DELAY);
    535      1.26    bouyer 			chp->ch_flags &= ~WDCF_DMA_WAIT;
    536      1.26    bouyer 		}
    537      1.19    bouyer 		wdc_ata_bio_intr(chp, xfer, 0);
    538       1.2    bouyer 		if ((ata_bio->flags & ATA_ITSDONE) == 0)
    539       1.2    bouyer 			goto again;
    540       1.2    bouyer 	}
    541       1.2    bouyer 	return;
    542       1.2    bouyer timeout:
    543       1.2    bouyer 	printf("%s:%d:%d: not ready, st=0x%02x, err=0x%02x\n",
    544  1.39.2.1     skrll 	    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
    545       1.2    bouyer 	    chp->ch_status, chp->ch_error);
    546      1.16    bouyer 	if (wdc_ata_err(drvp, ata_bio) != WDC_ATA_ERR)
    547       1.2    bouyer 		ata_bio->error = TIMEOUT;
    548       1.2    bouyer 	wdc_ata_bio_done(chp, xfer);
    549       1.2    bouyer 	return;
    550       1.2    bouyer }
    551       1.2    bouyer 
    552  1.39.2.1     skrll static int
    553  1.39.2.1     skrll wdc_ata_bio_intr(struct wdc_channel *chp, struct ata_xfer *xfer, int irq)
    554       1.2    bouyer {
    555  1.39.2.1     skrll 	struct wdc_softc *wdc = chp->ch_wdc;
    556  1.39.2.1     skrll 	struct ata_bio *ata_bio = xfer->c_cmd;
    557  1.39.2.1     skrll 	struct ata_drive_datas *drvp = &chp->ch_drive[xfer->c_drive];
    558       1.2    bouyer 	int drv_err;
    559       1.2    bouyer 
    560       1.2    bouyer 	WDCDEBUG_PRINT(("wdc_ata_bio_intr %s:%d:%d\n",
    561  1.39.2.1     skrll 	    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive),
    562       1.2    bouyer 	    DEBUG_INTR | DEBUG_XFERS);
    563       1.2    bouyer 
    564       1.2    bouyer 
    565       1.2    bouyer 	/* Is it not a transfer, but a control operation? */
    566       1.2    bouyer 	if (drvp->state < READY) {
    567       1.2    bouyer 		printf("%s:%d:%d: bad state %d in wdc_ata_bio_intr\n",
    568  1.39.2.1     skrll 		    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
    569       1.2    bouyer 		    drvp->state);
    570      1.38    provos 		panic("wdc_ata_bio_intr: bad state");
    571       1.2    bouyer 	}
    572       1.2    bouyer 
    573      1.20    bouyer 	/*
    574      1.20    bouyer 	 * if we missed an interrupt in a PIO transfer, reset and restart.
    575      1.20    bouyer 	 * Don't try to continue transfer, we may have missed cycles.
    576      1.20    bouyer 	 */
    577      1.20    bouyer 	if ((xfer->c_flags & (C_TIMEOU | C_DMA)) == C_TIMEOU) {
    578      1.20    bouyer 		ata_bio->error = TIMEOUT;
    579      1.20    bouyer 		wdc_ata_bio_done(chp, xfer);
    580      1.20    bouyer 		return 1;
    581      1.20    bouyer 	}
    582      1.20    bouyer 
    583  1.39.2.1     skrll 	/* Ack interrupt done by wdc_wait_for_unbusy */
    584  1.39.2.1     skrll 	if (wdc_wait_for_unbusy(chp, (irq == 0) ? ATA_DELAY : 0, AT_POLL) < 0) {
    585      1.19    bouyer 		if (irq && (xfer->c_flags & C_TIMEOU) == 0)
    586      1.18    bouyer 			return 0; /* IRQ was not for us */
    587       1.2    bouyer 		printf("%s:%d:%d: device timeout, c_bcount=%d, c_skip%d\n",
    588  1.39.2.1     skrll 		    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
    589       1.2    bouyer 		    xfer->c_bcount, xfer->c_skip);
    590       1.2    bouyer 		ata_bio->error = TIMEOUT;
    591       1.2    bouyer 		wdc_ata_bio_done(chp, xfer);
    592       1.2    bouyer 		return 1;
    593       1.2    bouyer 	}
    594  1.39.2.1     skrll 	if (wdc->cap & WDC_CAPABILITY_IRQACK)
    595  1.39.2.1     skrll 		wdc->irqack(chp);
    596       1.2    bouyer 
    597      1.16    bouyer 	drv_err = wdc_ata_err(drvp, ata_bio);
    598       1.2    bouyer 
    599       1.2    bouyer 	/* If we were using DMA, Turn off the DMA channel and check for error */
    600       1.2    bouyer 	if (xfer->c_flags & C_DMA) {
    601       1.2    bouyer 		if (ata_bio->flags & ATA_POLL) {
    602       1.2    bouyer 			/*
    603      1.13    bouyer 			 * IDE drives deassert WDCS_BSY before transfer is
    604       1.2    bouyer 			 * complete when using DMA. Polling for DRQ to deassert
    605      1.37       wiz 			 * is not enough DRQ is not required to be
    606       1.7    bouyer 			 * asserted for DMA transfers, so poll for DRDY.
    607       1.2    bouyer 			 */
    608       1.2    bouyer 			if (wdcwait(chp, WDCS_DRDY | WDCS_DRQ, WDCS_DRDY,
    609  1.39.2.1     skrll 			    ATA_DELAY, ATA_POLL) == WDCWAIT_TOUT) {
    610       1.7    bouyer 				printf("%s:%d:%d: polled transfer timed out "
    611  1.39.2.1     skrll 				    "(st=0x%x)\n", wdc->sc_dev.dv_xname,
    612  1.39.2.1     skrll 				    chp->ch_channel, xfer->c_drive,
    613  1.39.2.1     skrll 				    chp->ch_status);
    614       1.2    bouyer 				ata_bio->error = TIMEOUT;
    615      1.10    bouyer 				drv_err = WDC_ATA_ERR;
    616      1.10    bouyer 			}
    617      1.10    bouyer 		}
    618  1.39.2.1     skrll 		if (wdc->dma_status != 0) {
    619      1.10    bouyer 			if (drv_err != WDC_ATA_ERR) {
    620      1.10    bouyer 				ata_bio->error = ERR_DMA;
    621      1.10    bouyer 				drv_err = WDC_ATA_ERR;
    622       1.2    bouyer 			}
    623       1.2    bouyer 		}
    624       1.2    bouyer 		if (chp->ch_status & WDCS_DRQ) {
    625       1.2    bouyer 			if (drv_err != WDC_ATA_ERR) {
    626       1.2    bouyer 				printf("%s:%d:%d: intr with DRQ (st=0x%x)\n",
    627  1.39.2.1     skrll 				    wdc->sc_dev.dv_xname, chp->ch_channel,
    628  1.39.2.1     skrll 				    xfer->c_drive, chp->ch_status);
    629       1.2    bouyer 				ata_bio->error = TIMEOUT;
    630       1.2    bouyer 				drv_err = WDC_ATA_ERR;
    631       1.2    bouyer 			}
    632       1.2    bouyer 		}
    633  1.39.2.1     skrll 		if (ata_bio->r_error & WDCE_CRC)
    634  1.39.2.1     skrll 			ata_dmaerr(drvp, (xfer->c_flags & C_POLL) ? AT_POLL : 0);
    635       1.2    bouyer 		if (drv_err != WDC_ATA_ERR)
    636       1.2    bouyer 			goto end;
    637       1.2    bouyer 	}
    638       1.2    bouyer 
    639       1.2    bouyer 	/* if we had an error, end */
    640       1.2    bouyer 	if (drv_err == WDC_ATA_ERR) {
    641       1.2    bouyer 		wdc_ata_bio_done(chp, xfer);
    642       1.2    bouyer 		return 1;
    643       1.2    bouyer 	}
    644       1.2    bouyer 
    645       1.2    bouyer 	/* If this was a read and not using DMA, fetch the data. */
    646       1.2    bouyer 	if ((ata_bio->flags & ATA_READ) != 0) {
    647      1.14    bouyer 		if ((chp->ch_status & WDCS_DRQ) != WDCS_DRQ) {
    648       1.2    bouyer 			printf("%s:%d:%d: read intr before drq\n",
    649  1.39.2.1     skrll 			    wdc->sc_dev.dv_xname, chp->ch_channel,
    650  1.39.2.1     skrll 			    xfer->c_drive);
    651       1.2    bouyer 			ata_bio->error = TIMEOUT;
    652       1.2    bouyer 			wdc_ata_bio_done(chp, xfer);
    653       1.2    bouyer 			return 1;
    654       1.2    bouyer 		}
    655  1.39.2.2     skrll 		wdc->datain_pio(chp, drvp->drive_flags,
    656  1.39.2.2     skrll 		    (char *)xfer->c_databuf + xfer->c_skip, ata_bio->nbytes);
    657       1.2    bouyer 	}
    658       1.2    bouyer 
    659       1.2    bouyer end:
    660       1.2    bouyer 	ata_bio->blkno += ata_bio->nblks;
    661       1.2    bouyer 	ata_bio->blkdone += ata_bio->nblks;
    662       1.2    bouyer 	xfer->c_skip += ata_bio->nbytes;
    663       1.2    bouyer 	xfer->c_bcount -= ata_bio->nbytes;
    664       1.2    bouyer 	/* See if this transfer is complete. */
    665       1.2    bouyer 	if (xfer->c_bcount > 0) {
    666       1.2    bouyer 		if ((ata_bio->flags & ATA_POLL) == 0) {
    667       1.2    bouyer 			/* Start the next operation */
    668      1.20    bouyer 			_wdc_ata_bio_start(chp, xfer);
    669       1.2    bouyer 		} else {
    670      1.20    bouyer 			/* Let _wdc_ata_bio_start do the loop */
    671       1.2    bouyer 			return 1;
    672       1.2    bouyer 		}
    673       1.2    bouyer 	} else { /* Done with this transfer */
    674       1.2    bouyer 		ata_bio->error = NOERROR;
    675       1.2    bouyer 		wdc_ata_bio_done(chp, xfer);
    676       1.2    bouyer 	}
    677       1.2    bouyer 	return 1;
    678      1.22     enami }
    679      1.22     enami 
    680  1.39.2.1     skrll static void
    681  1.39.2.1     skrll wdc_ata_bio_kill_xfer(struct wdc_channel *chp, struct ata_xfer *xfer,
    682  1.39.2.1     skrll     int reason)
    683      1.22     enami {
    684  1.39.2.1     skrll 	struct ata_bio *ata_bio = xfer->c_cmd;
    685  1.39.2.1     skrll 	int drive = xfer->c_drive;
    686      1.22     enami 
    687      1.22     enami 	wdc_free_xfer(chp, xfer);
    688      1.22     enami 
    689      1.22     enami 	ata_bio->flags |= ATA_ITSDONE;
    690  1.39.2.1     skrll 	switch (reason) {
    691  1.39.2.1     skrll 	case KILL_GONE:
    692  1.39.2.1     skrll 		ata_bio->error = ERR_NODEV;
    693  1.39.2.1     skrll 		break;
    694  1.39.2.1     skrll 	case KILL_RESET:
    695  1.39.2.1     skrll 		ata_bio->error = ERR_RESET;
    696  1.39.2.1     skrll 		break;
    697  1.39.2.1     skrll 	default:
    698  1.39.2.1     skrll 		printf("wdc_ata_bio_kill_xfer: unknown reason %d\n",
    699  1.39.2.1     skrll 		    reason);
    700  1.39.2.1     skrll 		panic("wdc_ata_bio_kill_xfer");
    701  1.39.2.1     skrll 	}
    702      1.22     enami 	ata_bio->r_error = WDCE_ABRT;
    703  1.39.2.1     skrll 	WDCDEBUG_PRINT(("wdc_ata_done: drv_done\n"), DEBUG_XFERS);
    704  1.39.2.1     skrll 	(*chp->ch_drive[drive].drv_done)(chp->ch_drive[drive].drv_softc);
    705       1.2    bouyer }
    706       1.2    bouyer 
    707  1.39.2.1     skrll static void
    708  1.39.2.1     skrll wdc_ata_bio_done(struct wdc_channel *chp, struct ata_xfer *xfer)
    709       1.2    bouyer {
    710  1.39.2.1     skrll 	struct wdc_softc *wdc = chp->ch_wdc;
    711  1.39.2.1     skrll 	struct ata_bio *ata_bio = xfer->c_cmd;
    712  1.39.2.1     skrll 	int drive = xfer->c_drive;
    713       1.2    bouyer 
    714       1.5    bouyer 	WDCDEBUG_PRINT(("wdc_ata_bio_done %s:%d:%d: flags 0x%x\n",
    715  1.39.2.1     skrll 	    wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
    716       1.5    bouyer 	    (u_int)xfer->c_flags),
    717       1.4    bouyer 	    DEBUG_XFERS);
    718      1.10    bouyer 
    719      1.24   thorpej 	callout_stop(&chp->ch_callout);
    720       1.2    bouyer 
    721       1.2    bouyer 	/* feed back residual bcount to our caller */
    722       1.2    bouyer 	ata_bio->bcount = xfer->c_bcount;
    723       1.2    bouyer 
    724  1.39.2.2     skrll 	/* mark controller inactive and free xfer */
    725  1.39.2.2     skrll 	chp->ch_queue->active_xfer = NULL;
    726       1.2    bouyer 	wdc_free_xfer(chp, xfer);
    727       1.2    bouyer 
    728  1.39.2.2     skrll 	if (chp->ch_drive[drive].drive_flags & DRIVE_WAITDRAIN) {
    729  1.39.2.2     skrll 		ata_bio->error = ERR_NODEV;
    730  1.39.2.2     skrll 		chp->ch_drive[drive].drive_flags &= ~DRIVE_WAITDRAIN;
    731  1.39.2.2     skrll 		wakeup(&chp->ch_queue->active_xfer);
    732  1.39.2.2     skrll 	}
    733       1.2    bouyer 	ata_bio->flags |= ATA_ITSDONE;
    734  1.39.2.1     skrll 	WDCDEBUG_PRINT(("wdc_ata_done: drv_done\n"), DEBUG_XFERS);
    735  1.39.2.1     skrll 	(*chp->ch_drive[drive].drv_done)(chp->ch_drive[drive].drv_softc);
    736       1.2    bouyer 	WDCDEBUG_PRINT(("wdcstart from wdc_ata_done, flags 0x%x\n",
    737       1.4    bouyer 	    chp->ch_flags), DEBUG_XFERS);
    738       1.9  drochner 	wdcstart(chp);
    739       1.2    bouyer }
    740       1.2    bouyer 
    741  1.39.2.1     skrll static int
    742  1.39.2.1     skrll wdc_ata_err(struct ata_drive_datas *drvp, struct ata_bio *ata_bio)
    743       1.2    bouyer {
    744  1.39.2.1     skrll 	struct wdc_channel *chp = drvp->chnl_softc;
    745       1.2    bouyer 	ata_bio->error = 0;
    746       1.2    bouyer 	if (chp->ch_status & WDCS_BSY) {
    747       1.2    bouyer 		ata_bio->error = TIMEOUT;
    748       1.2    bouyer 		return WDC_ATA_ERR;
    749       1.2    bouyer 	}
    750       1.2    bouyer 
    751       1.2    bouyer 	if (chp->ch_status & WDCS_DWF) {
    752       1.2    bouyer 		ata_bio->error = ERR_DF;
    753       1.2    bouyer 		return WDC_ATA_ERR;
    754       1.2    bouyer 	}
    755       1.2    bouyer 
    756       1.2    bouyer 	if (chp->ch_status & WDCS_ERR) {
    757       1.2    bouyer 		ata_bio->error = ERROR;
    758       1.2    bouyer 		ata_bio->r_error = chp->ch_error;
    759       1.2    bouyer 		if (ata_bio->r_error & (WDCE_BBK | WDCE_UNC | WDCE_IDNF |
    760       1.2    bouyer 		    WDCE_ABRT | WDCE_TK0NF | WDCE_AMNF))
    761       1.2    bouyer 			return WDC_ATA_ERR;
    762       1.2    bouyer 		return WDC_ATA_NOERR;
    763       1.2    bouyer 	}
    764       1.2    bouyer 
    765       1.2    bouyer 	if (chp->ch_status & WDCS_CORR)
    766       1.2    bouyer 		ata_bio->flags |= ATA_CORR;
    767       1.2    bouyer 	return WDC_ATA_NOERR;
    768       1.8   thorpej }
    769       1.8   thorpej 
    770  1.39.2.1     skrll static int
    771  1.39.2.1     skrll wdc_ata_addref(struct ata_drive_datas *drvp)
    772       1.8   thorpej {
    773  1.39.2.1     skrll 	struct wdc_channel *chp = drvp->chnl_softc;
    774       1.8   thorpej 
    775       1.8   thorpej 	return (wdc_addref(chp));
    776       1.8   thorpej }
    777       1.8   thorpej 
    778  1.39.2.1     skrll static void
    779  1.39.2.1     skrll wdc_ata_delref(struct ata_drive_datas *drvp)
    780       1.8   thorpej {
    781  1.39.2.1     skrll 	struct wdc_channel *chp = drvp->chnl_softc;
    782       1.8   thorpej 
    783       1.8   thorpej 	wdc_delref(chp);
    784       1.2    bouyer }
    785