Home | History | Annotate | Line # | Download | only in ata
ata.c revision 1.35
      1  1.35  mycroft /*      $NetBSD: ata.c,v 1.35 2004/08/10 23:09:38 mycroft Exp $      */
      2  1.21  thorpej 
      3   1.2   bouyer /*
      4  1.16   bouyer  * Copyright (c) 1998, 2001 Manuel Bouyer.  All rights reserved.
      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.2   bouyer  *  This product includes software developed by Manuel Bouyer.
     17   1.2   bouyer  * 4. The name of the author may not be used to endorse or promote products
     18   1.2   bouyer  *    derived from this software without specific prior written permission.
     19   1.2   bouyer  *
     20   1.2   bouyer  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21   1.2   bouyer  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22   1.2   bouyer  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23  1.13   bouyer  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24   1.2   bouyer  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25   1.2   bouyer  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26   1.2   bouyer  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27   1.2   bouyer  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28   1.2   bouyer  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29   1.2   bouyer  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30   1.2   bouyer  */
     31  1.14    lukem 
     32  1.14    lukem #include <sys/cdefs.h>
     33  1.35  mycroft __KERNEL_RCSID(0, "$NetBSD: ata.c,v 1.35 2004/08/10 23:09:38 mycroft Exp $");
     34   1.2   bouyer 
     35   1.6  hubertf #ifndef WDCDEBUG
     36   1.2   bouyer #define WDCDEBUG
     37   1.6  hubertf #endif /* WDCDEBUG */
     38   1.2   bouyer 
     39   1.2   bouyer #include <sys/param.h>
     40   1.2   bouyer #include <sys/systm.h>
     41   1.2   bouyer #include <sys/kernel.h>
     42   1.2   bouyer #include <sys/malloc.h>
     43   1.2   bouyer #include <sys/device.h>
     44  1.30   bouyer #include <sys/conf.h>
     45  1.30   bouyer #include <sys/fcntl.h>
     46  1.23  thorpej #include <sys/proc.h>
     47  1.23  thorpej #include <sys/kthread.h>
     48  1.23  thorpej #include <sys/errno.h>
     49  1.30   bouyer #include <sys/ataio.h>
     50   1.2   bouyer 
     51  1.15   bouyer #include <machine/intr.h>
     52  1.15   bouyer #include <machine/bus.h>
     53  1.15   bouyer 
     54   1.2   bouyer #include <dev/ata/atareg.h>
     55   1.2   bouyer #include <dev/ata/atavar.h>
     56  1.15   bouyer #include <dev/ic/wdcreg.h>
     57  1.15   bouyer #include <dev/ic/wdcvar.h>
     58   1.2   bouyer 
     59  1.23  thorpej #include "locators.h"
     60  1.23  thorpej 
     61   1.2   bouyer #define DEBUG_FUNCS  0x08
     62   1.2   bouyer #define DEBUG_PROBE  0x10
     63  1.23  thorpej #define DEBUG_DETACH 0x20
     64   1.2   bouyer #ifdef WDCDEBUG
     65   1.2   bouyer extern int wdcdebug_mask; /* init'ed in wdc.c */
     66   1.2   bouyer #define WDCDEBUG_PRINT(args, level) \
     67   1.2   bouyer         if (wdcdebug_mask & (level)) \
     68   1.2   bouyer 		printf args
     69   1.2   bouyer #else
     70   1.2   bouyer #define WDCDEBUG_PRINT(args, level)
     71   1.2   bouyer #endif
     72   1.2   bouyer 
     73  1.23  thorpej /*****************************************************************************
     74  1.23  thorpej  * ATA bus layer.
     75  1.23  thorpej  *
     76  1.23  thorpej  * ATA controllers attach an atabus instance, which handles probing the bus
     77  1.23  thorpej  * for drives, etc.
     78  1.23  thorpej  *****************************************************************************/
     79  1.23  thorpej 
     80  1.30   bouyer dev_type_open(atabusopen);
     81  1.30   bouyer dev_type_close(atabusclose);
     82  1.30   bouyer dev_type_ioctl(atabusioctl);
     83  1.30   bouyer 
     84  1.30   bouyer const struct cdevsw atabus_cdevsw = {
     85  1.30   bouyer 	atabusopen, atabusclose, noread, nowrite, atabusioctl,
     86  1.30   bouyer 	nostop, notty, nopoll, nommap, nokqfilter,
     87  1.30   bouyer };
     88  1.30   bouyer 
     89  1.30   bouyer extern struct cfdriver atabus_cd;
     90  1.30   bouyer 
     91  1.30   bouyer 
     92  1.23  thorpej /*
     93  1.23  thorpej  * atabusprint:
     94  1.23  thorpej  *
     95  1.23  thorpej  *	Autoconfiguration print routine used by ATA controllers when
     96  1.23  thorpej  *	attaching an atabus instance.
     97  1.23  thorpej  */
     98  1.23  thorpej int
     99  1.23  thorpej atabusprint(void *aux, const char *pnp)
    100  1.23  thorpej {
    101  1.25  thorpej 	struct wdc_channel *chan = aux;
    102  1.23  thorpej 
    103  1.23  thorpej 	if (pnp)
    104  1.23  thorpej 		aprint_normal("atabus at %s", pnp);
    105  1.26  thorpej 	aprint_normal(" channel %d", chan->ch_channel);
    106  1.23  thorpej 
    107  1.23  thorpej 	return (UNCONF);
    108  1.23  thorpej }
    109  1.23  thorpej 
    110  1.23  thorpej /*
    111  1.23  thorpej  * ataprint:
    112  1.23  thorpej  *
    113  1.23  thorpej  *	Autoconfiguration print routine.
    114  1.23  thorpej  */
    115  1.23  thorpej int
    116  1.23  thorpej ataprint(void *aux, const char *pnp)
    117  1.23  thorpej {
    118  1.23  thorpej 	struct ata_device *adev = aux;
    119  1.23  thorpej 
    120  1.23  thorpej 	if (pnp)
    121  1.23  thorpej 		aprint_normal("wd at %s", pnp);
    122  1.23  thorpej 	aprint_normal(" drive %d", adev->adev_drv_data->drive);
    123  1.23  thorpej 
    124  1.23  thorpej 	return (UNCONF);
    125  1.23  thorpej }
    126  1.23  thorpej 
    127  1.23  thorpej /*
    128  1.23  thorpej  * atabus_thread:
    129  1.23  thorpej  *
    130  1.23  thorpej  *	Worker thread for the ATA bus.
    131  1.23  thorpej  */
    132  1.23  thorpej static void
    133  1.23  thorpej atabus_thread(void *arg)
    134  1.23  thorpej {
    135  1.23  thorpej 	struct atabus_softc *sc = arg;
    136  1.25  thorpej 	struct wdc_channel *chp = sc->sc_chan;
    137  1.24  thorpej 	struct ata_xfer *xfer;
    138  1.23  thorpej 	int s;
    139  1.23  thorpej 
    140  1.23  thorpej 	s = splbio();
    141  1.23  thorpej 	chp->ch_flags |= WDCF_TH_RUN;
    142  1.23  thorpej 	splx(s);
    143  1.23  thorpej 
    144  1.23  thorpej 	/* Configure the devices on the bus. */
    145  1.23  thorpej 	atabusconfig(sc);
    146  1.23  thorpej 
    147  1.23  thorpej 	for (;;) {
    148  1.23  thorpej 		s = splbio();
    149  1.23  thorpej 		if ((chp->ch_flags & (WDCF_TH_RESET | WDCF_SHUTDOWN)) == 0 &&
    150  1.33   bouyer 		    (chp->ch_queue->active_xfer == NULL ||
    151  1.23  thorpej 		     chp->ch_queue->queue_freeze == 0)) {
    152  1.23  thorpej 			chp->ch_flags &= ~WDCF_TH_RUN;
    153  1.27  thorpej 			(void) tsleep(&chp->ch_thread, PRIBIO, "atath", 0);
    154  1.23  thorpej 			chp->ch_flags |= WDCF_TH_RUN;
    155  1.23  thorpej 		}
    156  1.23  thorpej 		splx(s);
    157  1.23  thorpej 		if (chp->ch_flags & WDCF_SHUTDOWN)
    158  1.23  thorpej 			break;
    159  1.23  thorpej 		s = splbio();
    160  1.23  thorpej 		if (chp->ch_flags & WDCF_TH_RESET) {
    161  1.31   bouyer 			/*
    162  1.31   bouyer 			 * wdc_reset_channel() will freeze 2 times, so
    163  1.31   bouyer 			 * unfreeze one time. Not a problem as we're at splbio
    164  1.31   bouyer 			 */
    165  1.23  thorpej 			chp->ch_queue->queue_freeze--;
    166  1.31   bouyer 			wdc_reset_channel(chp, AT_WAIT | chp->ch_reset_flags);
    167  1.33   bouyer 		} else if (chp->ch_queue->active_xfer != NULL &&
    168  1.23  thorpej 			   chp->ch_queue->queue_freeze == 1) {
    169  1.23  thorpej 			/*
    170  1.23  thorpej 			 * Caller has bumped queue_freeze, decrease it.
    171  1.23  thorpej 			 */
    172  1.23  thorpej 			chp->ch_queue->queue_freeze--;
    173  1.33   bouyer 			xfer = chp->ch_queue->active_xfer;
    174  1.23  thorpej 			KASSERT(xfer != NULL);
    175  1.23  thorpej 			(*xfer->c_start)(chp, xfer);
    176  1.23  thorpej 		} else if (chp->ch_queue->queue_freeze > 1)
    177  1.23  thorpej 			panic("ata_thread: queue_freeze");
    178  1.23  thorpej 		splx(s);
    179  1.23  thorpej 	}
    180  1.27  thorpej 	chp->ch_thread = NULL;
    181  1.28   bouyer 	wakeup((void *)&chp->ch_flags);
    182  1.23  thorpej 	kthread_exit(0);
    183  1.23  thorpej }
    184  1.23  thorpej 
    185  1.23  thorpej /*
    186  1.23  thorpej  * atabus_create_thread:
    187  1.23  thorpej  *
    188  1.23  thorpej  *	Helper routine to create the ATA bus worker thread.
    189  1.23  thorpej  */
    190  1.23  thorpej static void
    191  1.23  thorpej atabus_create_thread(void *arg)
    192  1.23  thorpej {
    193  1.23  thorpej 	struct atabus_softc *sc = arg;
    194  1.25  thorpej 	struct wdc_channel *chp = sc->sc_chan;
    195  1.23  thorpej 	int error;
    196  1.23  thorpej 
    197  1.27  thorpej 	if ((error = kthread_create1(atabus_thread, sc, &chp->ch_thread,
    198  1.23  thorpej 				     "%s", sc->sc_dev.dv_xname)) != 0)
    199  1.23  thorpej 		aprint_error("%s: unable to create kernel thread: error %d\n",
    200  1.23  thorpej 		    sc->sc_dev.dv_xname, error);
    201  1.23  thorpej }
    202  1.23  thorpej 
    203  1.23  thorpej /*
    204  1.23  thorpej  * atabus_match:
    205  1.23  thorpej  *
    206  1.23  thorpej  *	Autoconfiguration match routine.
    207  1.23  thorpej  */
    208  1.23  thorpej static int
    209  1.23  thorpej atabus_match(struct device *parent, struct cfdata *cf, void *aux)
    210  1.23  thorpej {
    211  1.25  thorpej 	struct wdc_channel *chp = aux;
    212  1.23  thorpej 
    213  1.23  thorpej 	if (chp == NULL)
    214  1.23  thorpej 		return (0);
    215  1.23  thorpej 
    216  1.26  thorpej 	if (cf->cf_loc[ATACF_CHANNEL] != chp->ch_channel &&
    217  1.23  thorpej 	    cf->cf_loc[ATACF_CHANNEL] != ATACF_CHANNEL_DEFAULT)
    218  1.23  thorpej 	    	return (0);
    219  1.23  thorpej 
    220  1.23  thorpej 	return (1);
    221  1.23  thorpej }
    222  1.23  thorpej 
    223  1.23  thorpej /*
    224  1.23  thorpej  * atabus_attach:
    225  1.23  thorpej  *
    226  1.23  thorpej  *	Autoconfiguration attach routine.
    227  1.23  thorpej  */
    228  1.23  thorpej static void
    229  1.23  thorpej atabus_attach(struct device *parent, struct device *self, void *aux)
    230  1.23  thorpej {
    231  1.23  thorpej 	struct atabus_softc *sc = (void *) self;
    232  1.25  thorpej 	struct wdc_channel *chp = aux;
    233  1.23  thorpej 	struct atabus_initq *initq;
    234  1.23  thorpej 
    235  1.23  thorpej 	sc->sc_chan = chp;
    236  1.23  thorpej 
    237  1.23  thorpej 	aprint_normal("\n");
    238  1.23  thorpej 	aprint_naive("\n");
    239  1.23  thorpej 
    240  1.35  mycroft         if (wdc_addref(chp))
    241  1.35  mycroft                 return;
    242  1.35  mycroft 
    243  1.23  thorpej 	initq = malloc(sizeof(*initq), M_DEVBUF, M_WAITOK);
    244  1.23  thorpej 	initq->atabus_sc = sc;
    245  1.23  thorpej 	TAILQ_INSERT_TAIL(&atabus_initq_head, initq, atabus_initq);
    246  1.23  thorpej 	config_pending_incr();
    247  1.23  thorpej 	kthread_create(atabus_create_thread, sc);
    248  1.23  thorpej }
    249  1.23  thorpej 
    250  1.23  thorpej /*
    251  1.23  thorpej  * atabus_activate:
    252  1.23  thorpej  *
    253  1.23  thorpej  *	Autoconfiguration activation routine.
    254  1.23  thorpej  */
    255  1.23  thorpej static int
    256  1.23  thorpej atabus_activate(struct device *self, enum devact act)
    257  1.23  thorpej {
    258  1.23  thorpej 	struct atabus_softc *sc = (void *) self;
    259  1.25  thorpej 	struct wdc_channel *chp = sc->sc_chan;
    260  1.23  thorpej 	struct device *dev = NULL;
    261  1.23  thorpej 	int s, i, error = 0;
    262  1.23  thorpej 
    263  1.23  thorpej 	s = splbio();
    264  1.23  thorpej 	switch (act) {
    265  1.23  thorpej 	case DVACT_ACTIVATE:
    266  1.23  thorpej 		error = EOPNOTSUPP;
    267  1.23  thorpej 		break;
    268  1.23  thorpej 
    269  1.23  thorpej 	case DVACT_DEACTIVATE:
    270  1.23  thorpej 		/*
    271  1.23  thorpej 		 * We might deactivate the children of atapibus twice
    272  1.23  thorpej 		 * (once bia atapibus, once directly), but since the
    273  1.23  thorpej 		 * generic autoconfiguration code maintains the DVF_ACTIVE
    274  1.23  thorpej 		 * flag, it's safe.
    275  1.23  thorpej 		 */
    276  1.23  thorpej 		if ((dev = chp->atapibus) != NULL) {
    277  1.23  thorpej 			error = config_deactivate(dev);
    278  1.23  thorpej 			if (error)
    279  1.23  thorpej 				goto out;
    280  1.23  thorpej 		}
    281  1.23  thorpej 
    282  1.23  thorpej 		for (i = 0; i < 2; i++) {
    283  1.23  thorpej 			if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
    284  1.23  thorpej 				WDCDEBUG_PRINT(("atabus_activate: %s: "
    285  1.23  thorpej 				    "deactivating %s\n", sc->sc_dev.dv_xname,
    286  1.23  thorpej 				    dev->dv_xname),
    287  1.23  thorpej 				    DEBUG_DETACH);
    288  1.23  thorpej 				error = config_deactivate(dev);
    289  1.23  thorpej 				if (error)
    290  1.23  thorpej 					goto out;
    291  1.23  thorpej 			}
    292  1.23  thorpej 		}
    293  1.23  thorpej 		break;
    294  1.23  thorpej 	}
    295  1.23  thorpej  out:
    296  1.23  thorpej 	splx(s);
    297  1.23  thorpej 
    298  1.23  thorpej #ifdef WDCDEBUG
    299  1.23  thorpej 	if (dev != NULL && error != 0)
    300  1.23  thorpej 		WDCDEBUG_PRINT(("atabus_activate: %s: "
    301  1.23  thorpej 		    "error %d deactivating %s\n", sc->sc_dev.dv_xname,
    302  1.23  thorpej 		    error, dev->dv_xname), DEBUG_DETACH);
    303  1.23  thorpej #endif /* WDCDEBUG */
    304  1.23  thorpej 
    305  1.23  thorpej 	return (error);
    306  1.23  thorpej }
    307  1.23  thorpej 
    308  1.23  thorpej /*
    309  1.23  thorpej  * atabus_detach:
    310  1.23  thorpej  *
    311  1.23  thorpej  *	Autoconfiguration detach routine.
    312  1.23  thorpej  */
    313  1.23  thorpej static int
    314  1.23  thorpej atabus_detach(struct device *self, int flags)
    315  1.23  thorpej {
    316  1.23  thorpej 	struct atabus_softc *sc = (void *) self;
    317  1.25  thorpej 	struct wdc_channel *chp = sc->sc_chan;
    318  1.23  thorpej 	struct device *dev = NULL;
    319  1.23  thorpej 	int i, error = 0;
    320  1.23  thorpej 
    321  1.23  thorpej 	/* Shutdown the channel. */
    322  1.23  thorpej 	/* XXX NEED AN INTERLOCK HERE. */
    323  1.23  thorpej 	chp->ch_flags |= WDCF_SHUTDOWN;
    324  1.27  thorpej 	wakeup(&chp->ch_thread);
    325  1.27  thorpej 	while (chp->ch_thread != NULL)
    326  1.28   bouyer 		(void) tsleep((void *)&chp->ch_flags, PRIBIO, "atadown", 0);
    327  1.23  thorpej 
    328  1.23  thorpej 	/*
    329  1.23  thorpej 	 * Detach atapibus and its children.
    330  1.23  thorpej 	 */
    331  1.23  thorpej 	if ((dev = chp->atapibus) != NULL) {
    332  1.23  thorpej 		WDCDEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
    333  1.23  thorpej 		    sc->sc_dev.dv_xname, dev->dv_xname), DEBUG_DETACH);
    334  1.23  thorpej 		error = config_detach(dev, flags);
    335  1.23  thorpej 		if (error)
    336  1.23  thorpej 			goto out;
    337  1.23  thorpej 	}
    338  1.23  thorpej 
    339  1.23  thorpej 	/*
    340  1.23  thorpej 	 * Detach our other children.
    341  1.23  thorpej 	 */
    342  1.23  thorpej 	for (i = 0; i < 2; i++) {
    343  1.23  thorpej 		if (chp->ch_drive[i].drive_flags & DRIVE_ATAPI)
    344  1.23  thorpej 			continue;
    345  1.23  thorpej 		if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
    346  1.23  thorpej 			WDCDEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
    347  1.23  thorpej 			    sc->sc_dev.dv_xname, dev->dv_xname),
    348  1.23  thorpej 			    DEBUG_DETACH);
    349  1.23  thorpej 			error = config_detach(dev, flags);
    350  1.23  thorpej 			if (error)
    351  1.23  thorpej 				goto out;
    352  1.23  thorpej 		}
    353  1.23  thorpej 	}
    354  1.23  thorpej 
    355  1.23  thorpej  out:
    356  1.23  thorpej #ifdef WDCDEBUG
    357  1.23  thorpej 	if (dev != NULL && error != 0)
    358  1.23  thorpej 		WDCDEBUG_PRINT(("atabus_detach: %s: error %d detaching %s\n",
    359  1.23  thorpej 		    sc->sc_dev.dv_xname, error, dev->dv_xname),
    360  1.23  thorpej 		    DEBUG_DETACH);
    361  1.23  thorpej #endif /* WDCDEBUG */
    362  1.23  thorpej 
    363  1.23  thorpej 	return (error);
    364  1.23  thorpej }
    365  1.23  thorpej 
    366  1.23  thorpej CFATTACH_DECL(atabus, sizeof(struct atabus_softc),
    367  1.23  thorpej     atabus_match, atabus_attach, atabus_detach, atabus_activate);
    368  1.23  thorpej 
    369  1.23  thorpej /*****************************************************************************
    370  1.23  thorpej  * Common ATA bus operations.
    371  1.23  thorpej  *****************************************************************************/
    372  1.23  thorpej 
    373   1.2   bouyer /* Get the disk's parameters */
    374   1.2   bouyer int
    375  1.21  thorpej ata_get_params(struct ata_drive_datas *drvp, u_int8_t flags,
    376  1.21  thorpej     struct ataparams *prms)
    377   1.2   bouyer {
    378   1.2   bouyer 	char tb[DEV_BSIZE];
    379   1.2   bouyer 	struct wdc_command wdc_c;
    380   1.2   bouyer 
    381   1.2   bouyer #if BYTE_ORDER == LITTLE_ENDIAN
    382   1.2   bouyer 	int i;
    383   1.2   bouyer 	u_int16_t *p;
    384   1.2   bouyer #endif
    385   1.2   bouyer 
    386  1.22  thorpej 	WDCDEBUG_PRINT(("ata_get_parms\n"), DEBUG_FUNCS);
    387   1.2   bouyer 
    388   1.2   bouyer 	memset(tb, 0, DEV_BSIZE);
    389   1.2   bouyer 	memset(prms, 0, sizeof(struct ataparams));
    390   1.2   bouyer 	memset(&wdc_c, 0, sizeof(struct wdc_command));
    391   1.2   bouyer 
    392   1.2   bouyer 	if (drvp->drive_flags & DRIVE_ATA) {
    393   1.2   bouyer 		wdc_c.r_command = WDCC_IDENTIFY;
    394   1.5   bouyer 		wdc_c.r_st_bmask = WDCS_DRDY;
    395  1.19  mycroft 		wdc_c.r_st_pmask = 0;
    396  1.18   bouyer 		wdc_c.timeout = 3000; /* 3s */
    397   1.7   bouyer 	} else if (drvp->drive_flags & DRIVE_ATAPI) {
    398   1.2   bouyer 		wdc_c.r_command = ATAPI_IDENTIFY_DEVICE;
    399   1.2   bouyer 		wdc_c.r_st_bmask = 0;
    400  1.19  mycroft 		wdc_c.r_st_pmask = 0;
    401   1.9   bouyer 		wdc_c.timeout = 10000; /* 10s */
    402   1.7   bouyer 	} else {
    403  1.22  thorpej 		WDCDEBUG_PRINT(("ata_get_parms: no disks\n"),
    404  1.10   bouyer 		    DEBUG_FUNCS|DEBUG_PROBE);
    405   1.7   bouyer 		return CMD_ERR;
    406   1.2   bouyer 	}
    407   1.2   bouyer 	wdc_c.flags = AT_READ | flags;
    408   1.2   bouyer 	wdc_c.data = tb;
    409   1.2   bouyer 	wdc_c.bcount = DEV_BSIZE;
    410  1.10   bouyer 	if (wdc_exec_command(drvp, &wdc_c) != WDC_COMPLETE) {
    411  1.22  thorpej 		WDCDEBUG_PRINT(("ata_get_parms: wdc_exec_command failed\n"),
    412  1.10   bouyer 		    DEBUG_FUNCS|DEBUG_PROBE);
    413   1.2   bouyer 		return CMD_AGAIN;
    414  1.10   bouyer 	}
    415   1.2   bouyer 	if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
    416  1.22  thorpej 		WDCDEBUG_PRINT(("ata_get_parms: wdc_c.flags=0x%x\n",
    417  1.10   bouyer 		    wdc_c.flags), DEBUG_FUNCS|DEBUG_PROBE);
    418   1.2   bouyer 		return CMD_ERR;
    419   1.2   bouyer 	} else {
    420  1.17   bouyer 		/* if we didn't read any data something is wrong */
    421  1.17   bouyer 		if ((wdc_c.flags & AT_XFDONE) == 0)
    422  1.17   bouyer 			return CMD_ERR;
    423   1.2   bouyer 		/* Read in parameter block. */
    424   1.2   bouyer 		memcpy(prms, tb, sizeof(struct ataparams));
    425   1.2   bouyer #if BYTE_ORDER == LITTLE_ENDIAN
    426   1.2   bouyer 		/*
    427   1.2   bouyer 		 * Shuffle string byte order.
    428   1.2   bouyer 		 * ATAPI Mitsumi and NEC drives don't need this.
    429   1.2   bouyer 		 */
    430   1.2   bouyer 		if ((prms->atap_config & WDC_CFG_ATAPI_MASK) ==
    431   1.2   bouyer 		    WDC_CFG_ATAPI &&
    432   1.2   bouyer 		    ((prms->atap_model[0] == 'N' &&
    433   1.2   bouyer 			prms->atap_model[1] == 'E') ||
    434   1.2   bouyer 		     (prms->atap_model[0] == 'F' &&
    435   1.2   bouyer 			 prms->atap_model[1] == 'X')))
    436   1.2   bouyer 			return 0;
    437   1.2   bouyer 		for (i = 0; i < sizeof(prms->atap_model); i += 2) {
    438   1.2   bouyer 			p = (u_short *)(prms->atap_model + i);
    439   1.2   bouyer 			*p = ntohs(*p);
    440   1.2   bouyer 		}
    441   1.2   bouyer 		for (i = 0; i < sizeof(prms->atap_serial); i += 2) {
    442   1.2   bouyer 			p = (u_short *)(prms->atap_serial + i);
    443   1.2   bouyer 			*p = ntohs(*p);
    444   1.2   bouyer 		}
    445   1.2   bouyer 		for (i = 0; i < sizeof(prms->atap_revision); i += 2) {
    446   1.2   bouyer 			p = (u_short *)(prms->atap_revision + i);
    447   1.2   bouyer 			*p = ntohs(*p);
    448   1.2   bouyer 		}
    449   1.2   bouyer #endif
    450   1.2   bouyer 		return CMD_OK;
    451   1.2   bouyer 	}
    452   1.2   bouyer }
    453   1.2   bouyer 
    454   1.2   bouyer int
    455  1.21  thorpej ata_set_mode(struct ata_drive_datas *drvp, u_int8_t mode, u_int8_t flags)
    456   1.2   bouyer {
    457   1.2   bouyer 	struct wdc_command wdc_c;
    458   1.2   bouyer 
    459  1.22  thorpej 	WDCDEBUG_PRINT(("ata_set_mode=0x%x\n", mode), DEBUG_FUNCS);
    460   1.2   bouyer 	memset(&wdc_c, 0, sizeof(struct wdc_command));
    461   1.2   bouyer 
    462   1.2   bouyer 	wdc_c.r_command = SET_FEATURES;
    463   1.2   bouyer 	wdc_c.r_st_bmask = 0;
    464   1.2   bouyer 	wdc_c.r_st_pmask = 0;
    465  1.29  thorpej 	wdc_c.r_features = WDSF_SET_MODE;
    466   1.2   bouyer 	wdc_c.r_count = mode;
    467  1.19  mycroft 	wdc_c.flags = flags;
    468   1.2   bouyer 	wdc_c.timeout = 1000; /* 1s */
    469   1.2   bouyer 	if (wdc_exec_command(drvp, &wdc_c) != WDC_COMPLETE)
    470   1.2   bouyer 		return CMD_AGAIN;
    471   1.2   bouyer 	if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
    472   1.2   bouyer 		return CMD_ERR;
    473   1.2   bouyer 	}
    474   1.2   bouyer 	return CMD_OK;
    475  1.11   bouyer }
    476  1.11   bouyer 
    477  1.11   bouyer void
    478  1.21  thorpej ata_dmaerr(struct ata_drive_datas *drvp, int flags)
    479  1.11   bouyer {
    480  1.11   bouyer 	/*
    481  1.11   bouyer 	 * Downgrade decision: if we get NERRS_MAX in NXFER.
    482  1.11   bouyer 	 * We start with n_dmaerrs set to NERRS_MAX-1 so that the
    483  1.11   bouyer 	 * first error within the first NXFER ops will immediatly trigger
    484  1.11   bouyer 	 * a downgrade.
    485  1.11   bouyer 	 * If we got an error and n_xfers is bigger than NXFER reset counters.
    486  1.11   bouyer 	 */
    487  1.11   bouyer 	drvp->n_dmaerrs++;
    488  1.11   bouyer 	if (drvp->n_dmaerrs >= NERRS_MAX && drvp->n_xfers <= NXFER) {
    489  1.20   bouyer 		wdc_downgrade_mode(drvp, flags);
    490  1.11   bouyer 		drvp->n_dmaerrs = NERRS_MAX-1;
    491  1.11   bouyer 		drvp->n_xfers = 0;
    492  1.11   bouyer 		return;
    493  1.11   bouyer 	}
    494  1.11   bouyer 	if (drvp->n_xfers > NXFER) {
    495  1.11   bouyer 		drvp->n_dmaerrs = 1; /* just got an error */
    496  1.11   bouyer 		drvp->n_xfers = 1; /* restart counting from this error */
    497   1.4   bouyer 	}
    498   1.2   bouyer }
    499  1.30   bouyer 
    500  1.30   bouyer /* management of the /dev/atabus* devices */
    501  1.30   bouyer int atabusopen(dev, flag, fmt, p)
    502  1.30   bouyer 	dev_t dev;
    503  1.30   bouyer 	int flag, fmt;
    504  1.30   bouyer 	struct proc *p;
    505  1.30   bouyer {
    506  1.30   bouyer         struct atabus_softc *sc;
    507  1.30   bouyer         int error, unit = minor(dev);
    508  1.30   bouyer 
    509  1.30   bouyer         if (unit >= atabus_cd.cd_ndevs ||
    510  1.30   bouyer             (sc = atabus_cd.cd_devs[unit]) == NULL)
    511  1.30   bouyer                 return (ENXIO);
    512  1.30   bouyer 
    513  1.30   bouyer         if (sc->sc_flags & ATABUSCF_OPEN)
    514  1.30   bouyer                 return (EBUSY);
    515  1.30   bouyer 
    516  1.30   bouyer         if ((error = wdc_addref(sc->sc_chan)) != 0)
    517  1.30   bouyer                 return (error);
    518  1.30   bouyer 
    519  1.30   bouyer         sc->sc_flags |= ATABUSCF_OPEN;
    520  1.30   bouyer 
    521  1.30   bouyer         return (0);
    522  1.30   bouyer }
    523  1.30   bouyer 
    524  1.30   bouyer 
    525  1.30   bouyer int
    526  1.30   bouyer atabusclose(dev, flag, fmt, p)
    527  1.30   bouyer         dev_t dev;
    528  1.30   bouyer         int flag, fmt;
    529  1.30   bouyer         struct proc *p;
    530  1.30   bouyer {
    531  1.30   bouyer         struct atabus_softc *sc = atabus_cd.cd_devs[minor(dev)];
    532  1.30   bouyer 
    533  1.30   bouyer         wdc_delref(sc->sc_chan);
    534  1.30   bouyer 
    535  1.30   bouyer         sc->sc_flags &= ~ATABUSCF_OPEN;
    536  1.30   bouyer 
    537  1.30   bouyer         return (0);
    538  1.30   bouyer }
    539  1.30   bouyer 
    540  1.30   bouyer int
    541  1.30   bouyer atabusioctl(dev, cmd, addr, flag, p)
    542  1.30   bouyer         dev_t dev;
    543  1.30   bouyer         u_long cmd;
    544  1.30   bouyer         caddr_t addr;
    545  1.30   bouyer         int flag;
    546  1.30   bouyer         struct proc *p;
    547  1.30   bouyer {
    548  1.30   bouyer         struct atabus_softc *sc = atabus_cd.cd_devs[minor(dev)];
    549  1.32   bouyer 	struct wdc_channel *chp = sc->sc_chan;
    550  1.32   bouyer 	int min_drive, max_drive, drive;
    551  1.30   bouyer         int error;
    552  1.30   bouyer 	int s;
    553  1.30   bouyer 
    554  1.30   bouyer         /*
    555  1.30   bouyer          * Enforce write permission for ioctls that change the
    556  1.30   bouyer          * state of the bus.  Host adapter specific ioctls must
    557  1.30   bouyer          * be checked by the adapter driver.
    558  1.30   bouyer          */
    559  1.30   bouyer         switch (cmd) {
    560  1.30   bouyer         case ATABUSIOSCAN:
    561  1.30   bouyer         case ATABUSIODETACH:
    562  1.30   bouyer         case ATABUSIORESET:
    563  1.30   bouyer                 if ((flag & FWRITE) == 0)
    564  1.30   bouyer                         return (EBADF);
    565  1.30   bouyer         }
    566  1.30   bouyer 
    567  1.30   bouyer         switch (cmd) {
    568  1.30   bouyer         case ATABUSIORESET:
    569  1.30   bouyer 		s = splbio();
    570  1.30   bouyer 		wdc_reset_channel(sc->sc_chan, AT_WAIT | AT_POLL);
    571  1.30   bouyer 		splx(s);
    572  1.30   bouyer 		error = 0;
    573  1.30   bouyer 		break;
    574  1.32   bouyer 	case ATABUSIOSCAN:
    575  1.32   bouyer 	{
    576  1.32   bouyer #if 0
    577  1.32   bouyer 		struct atabusioscan_args *a=
    578  1.32   bouyer 		    (struct atabusioscan_args *)addr;
    579  1.32   bouyer #endif
    580  1.32   bouyer 		if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
    581  1.32   bouyer 		    (chp->ch_drive[1].drive_flags & DRIVE_OLD))
    582  1.32   bouyer 			return (EOPNOTSUPP);
    583  1.32   bouyer 		return (EOPNOTSUPP);
    584  1.32   bouyer 	}
    585  1.32   bouyer 	case ATABUSIODETACH:
    586  1.32   bouyer 	{
    587  1.32   bouyer 		struct atabusioscan_args *a=
    588  1.32   bouyer 		    (struct atabusioscan_args *)addr;
    589  1.32   bouyer 		if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
    590  1.32   bouyer 		    (chp->ch_drive[1].drive_flags & DRIVE_OLD))
    591  1.32   bouyer 			return (EOPNOTSUPP);
    592  1.32   bouyer 		switch (a->at_dev) {
    593  1.32   bouyer 		case -1:
    594  1.32   bouyer 			min_drive = 0;
    595  1.32   bouyer 			max_drive = 1;
    596  1.32   bouyer 			break;
    597  1.32   bouyer 		case 0:
    598  1.32   bouyer 		case 1:
    599  1.32   bouyer 			min_drive = max_drive = a->at_dev;
    600  1.32   bouyer 			break;
    601  1.32   bouyer 		default:
    602  1.32   bouyer 			return (EINVAL);
    603  1.32   bouyer 		}
    604  1.32   bouyer 		for (drive = min_drive; drive <= max_drive; drive++) {
    605  1.32   bouyer 			if (chp->ch_drive[drive].drv_softc != NULL) {
    606  1.32   bouyer 				error = config_detach(
    607  1.32   bouyer 				    chp->ch_drive[drive].drv_softc, 0);
    608  1.32   bouyer 				if (error)
    609  1.32   bouyer 					return (error);
    610  1.34   bouyer 				chp->ch_drive[drive].drv_softc = NULL;
    611  1.32   bouyer 			}
    612  1.32   bouyer 		}
    613  1.32   bouyer 		error = 0;
    614  1.32   bouyer 		break;
    615  1.32   bouyer 	}
    616  1.30   bouyer 	default:
    617  1.30   bouyer 		error = ENOTTY;
    618  1.30   bouyer 	}
    619  1.30   bouyer 	return (error);
    620  1.30   bouyer };
    621