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