Home | History | Annotate | Line # | Download | only in ata
ata.c revision 1.101
      1  1.101    bouyer /*	$NetBSD: ata.c,v 1.101 2008/10/02 21:05:17 bouyer 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.65     perry  * 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.101    bouyer __KERNEL_RCSID(0, "$NetBSD: ata.c,v 1.101 2008/10/02 21:05:17 bouyer Exp $");
     34    1.2    bouyer 
     35   1.88    dyoung #include "opt_ata.h"
     36    1.2    bouyer 
     37    1.2    bouyer #include <sys/param.h>
     38    1.2    bouyer #include <sys/systm.h>
     39    1.2    bouyer #include <sys/kernel.h>
     40    1.2    bouyer #include <sys/malloc.h>
     41    1.2    bouyer #include <sys/device.h>
     42   1.30    bouyer #include <sys/conf.h>
     43   1.30    bouyer #include <sys/fcntl.h>
     44   1.23   thorpej #include <sys/proc.h>
     45  1.101    bouyer #include <sys/cpu.h>
     46   1.41   thorpej #include <sys/pool.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.93     pooka #include <sys/kmem.h>
     51   1.94        ad #include <sys/simplelock.h>
     52   1.91        ad #include <sys/intr.h>
     53   1.91        ad #include <sys/bus.h>
     54   1.15    bouyer 
     55   1.76     itohy #include <dev/ata/ataconf.h>
     56    1.2    bouyer #include <dev/ata/atareg.h>
     57    1.2    bouyer #include <dev/ata/atavar.h>
     58   1.76     itohy #include <dev/ic/wdcvar.h>	/* for PIOBM */
     59    1.2    bouyer 
     60   1.23   thorpej #include "locators.h"
     61   1.23   thorpej 
     62   1.51   thorpej #include "atapibus.h"
     63   1.51   thorpej #include "ataraid.h"
     64   1.51   thorpej 
     65   1.65     perry #if NATARAID > 0
     66   1.65     perry #include <dev/ata/ata_raidvar.h>
     67   1.51   thorpej #endif
     68   1.51   thorpej 
     69    1.2    bouyer #define DEBUG_FUNCS  0x08
     70    1.2    bouyer #define DEBUG_PROBE  0x10
     71   1.23   thorpej #define DEBUG_DETACH 0x20
     72   1.44   thorpej #define	DEBUG_XFERS  0x40
     73   1.47   thorpej #ifdef ATADEBUG
     74   1.47   thorpej int atadebug_mask = 0;
     75   1.47   thorpej #define ATADEBUG_PRINT(args, level) \
     76   1.81     itohy 	if (atadebug_mask & (level)) \
     77    1.2    bouyer 		printf args
     78    1.2    bouyer #else
     79   1.47   thorpej #define ATADEBUG_PRINT(args, level)
     80    1.2    bouyer #endif
     81    1.2    bouyer 
     82   1.87        ad POOL_INIT(ata_xfer_pool, sizeof(struct ata_xfer), 0, 0, 0, "ataspl", NULL,
     83   1.87        ad     IPL_BIO);
     84   1.41   thorpej 
     85   1.51   thorpej /*
     86   1.51   thorpej  * A queue of atabus instances, used to ensure the same bus probe order
     87   1.51   thorpej  * for a given hardware configuration at each boot.
     88   1.51   thorpej  */
     89   1.51   thorpej struct atabus_initq_head atabus_initq_head =
     90   1.51   thorpej     TAILQ_HEAD_INITIALIZER(atabus_initq_head);
     91   1.51   thorpej struct simplelock atabus_interlock = SIMPLELOCK_INITIALIZER;
     92   1.51   thorpej 
     93  1.100    bouyer /* kernel thread probing devices on a atabus. Only one probing at once */
     94  1.100    bouyer struct lwp *atabus_configlwp;
     95  1.100    bouyer 
     96   1.23   thorpej /*****************************************************************************
     97   1.23   thorpej  * ATA bus layer.
     98   1.23   thorpej  *
     99   1.23   thorpej  * ATA controllers attach an atabus instance, which handles probing the bus
    100   1.23   thorpej  * for drives, etc.
    101   1.23   thorpej  *****************************************************************************/
    102   1.23   thorpej 
    103   1.30    bouyer dev_type_open(atabusopen);
    104   1.30    bouyer dev_type_close(atabusclose);
    105   1.30    bouyer dev_type_ioctl(atabusioctl);
    106   1.30    bouyer 
    107   1.30    bouyer const struct cdevsw atabus_cdevsw = {
    108   1.30    bouyer 	atabusopen, atabusclose, noread, nowrite, atabusioctl,
    109   1.75  christos 	nostop, notty, nopoll, nommap, nokqfilter, D_OTHER
    110   1.30    bouyer };
    111   1.30    bouyer 
    112   1.30    bouyer extern struct cfdriver atabus_cd;
    113   1.30    bouyer 
    114   1.95    dyoung static void atabus_childdetached(device_t, device_t);
    115   1.97    dyoung static bool atabus_resume(device_t PMF_FN_PROTO);
    116   1.97    dyoung static bool atabus_suspend(device_t PMF_FN_PROTO);
    117  1.100    bouyer static void atabusconfig_thread(void *);
    118   1.30    bouyer 
    119   1.23   thorpej /*
    120   1.23   thorpej  * atabusprint:
    121   1.23   thorpej  *
    122   1.23   thorpej  *	Autoconfiguration print routine used by ATA controllers when
    123   1.23   thorpej  *	attaching an atabus instance.
    124   1.23   thorpej  */
    125   1.23   thorpej int
    126   1.23   thorpej atabusprint(void *aux, const char *pnp)
    127   1.23   thorpej {
    128   1.48   thorpej 	struct ata_channel *chan = aux;
    129   1.65     perry 
    130   1.23   thorpej 	if (pnp)
    131   1.23   thorpej 		aprint_normal("atabus at %s", pnp);
    132   1.26   thorpej 	aprint_normal(" channel %d", chan->ch_channel);
    133   1.23   thorpej 
    134   1.23   thorpej 	return (UNCONF);
    135   1.23   thorpej }
    136   1.23   thorpej 
    137   1.23   thorpej /*
    138   1.23   thorpej  * ataprint:
    139   1.23   thorpej  *
    140   1.23   thorpej  *	Autoconfiguration print routine.
    141   1.23   thorpej  */
    142   1.23   thorpej int
    143   1.23   thorpej ataprint(void *aux, const char *pnp)
    144   1.23   thorpej {
    145   1.23   thorpej 	struct ata_device *adev = aux;
    146   1.23   thorpej 
    147   1.23   thorpej 	if (pnp)
    148   1.23   thorpej 		aprint_normal("wd at %s", pnp);
    149   1.23   thorpej 	aprint_normal(" drive %d", adev->adev_drv_data->drive);
    150   1.23   thorpej 
    151   1.23   thorpej 	return (UNCONF);
    152   1.23   thorpej }
    153   1.23   thorpej 
    154   1.52   thorpej /*
    155   1.52   thorpej  * ata_channel_attach:
    156   1.52   thorpej  *
    157   1.52   thorpej  *	Common parts of attaching an atabus to an ATA controller channel.
    158   1.52   thorpej  */
    159   1.52   thorpej void
    160   1.52   thorpej ata_channel_attach(struct ata_channel *chp)
    161   1.52   thorpej {
    162   1.52   thorpej 
    163   1.52   thorpej 	if (chp->ch_flags & ATACH_DISABLED)
    164   1.52   thorpej 		return;
    165   1.65     perry 
    166   1.90        ad 	callout_init(&chp->ch_callout, 0);
    167   1.52   thorpej 
    168   1.52   thorpej 	TAILQ_INIT(&chp->ch_queue->queue_xfer);
    169   1.52   thorpej 	chp->ch_queue->queue_freeze = 0;
    170   1.68    bouyer 	chp->ch_queue->queue_flags = 0;
    171   1.52   thorpej 	chp->ch_queue->active_xfer = NULL;
    172   1.52   thorpej 
    173   1.98      cube 	chp->atabus = config_found_ia(chp->ch_atac->atac_dev, "ata", chp,
    174   1.71  drochner 		atabusprint);
    175   1.52   thorpej }
    176   1.52   thorpej 
    177   1.51   thorpej static void
    178   1.51   thorpej atabusconfig(struct atabus_softc *atabus_sc)
    179   1.51   thorpej {
    180   1.51   thorpej 	struct ata_channel *chp = atabus_sc->sc_chan;
    181   1.51   thorpej 	struct atac_softc *atac = chp->ch_atac;
    182   1.51   thorpej 	struct atabus_initq *atabus_initq = NULL;
    183  1.101    bouyer 	int i, error;
    184   1.51   thorpej 
    185   1.51   thorpej 	/* Probe for the drives. */
    186   1.82    bouyer 	/* XXX for SATA devices we will power up all drives at once */
    187   1.51   thorpej 	(*atac->atac_probe)(chp);
    188   1.51   thorpej 
    189   1.51   thorpej 	ATADEBUG_PRINT(("atabusattach: ch_drive_flags 0x%x 0x%x\n",
    190   1.51   thorpej 	    chp->ch_drive[0].drive_flags, chp->ch_drive[1].drive_flags),
    191   1.51   thorpej 	    DEBUG_PROBE);
    192   1.51   thorpej 
    193  1.100    bouyer 	/* Make sure the devices probe in atabus order to avoid jitter. */
    194  1.100    bouyer 	simple_lock(&atabus_interlock);
    195  1.100    bouyer 	while(1) {
    196  1.100    bouyer 		atabus_initq = TAILQ_FIRST(&atabus_initq_head);
    197  1.100    bouyer 		if (atabus_initq->atabus_sc == atabus_sc)
    198  1.100    bouyer 			break;
    199  1.100    bouyer 		ltsleep(&atabus_initq_head, PRIBIO, "ata_initq", 0,
    200  1.100    bouyer 		    &atabus_interlock);
    201  1.100    bouyer 	}
    202  1.100    bouyer 	simple_unlock(&atabus_interlock);
    203  1.100    bouyer 
    204   1.51   thorpej 	/* If no drives, abort here */
    205   1.51   thorpej 	for (i = 0; i < chp->ch_ndrive; i++)
    206   1.51   thorpej 		if ((chp->ch_drive[i].drive_flags & DRIVE) != 0)
    207   1.51   thorpej 			break;
    208   1.51   thorpej 	if (i == chp->ch_ndrive)
    209   1.51   thorpej 		goto out;
    210   1.51   thorpej 
    211   1.51   thorpej 	/* Shortcut in case we've been shutdown */
    212   1.51   thorpej 	if (chp->ch_flags & ATACH_SHUTDOWN)
    213   1.51   thorpej 		goto out;
    214   1.51   thorpej 
    215  1.100    bouyer 
    216  1.100    bouyer 	if ((error = kthread_create(PRI_NONE, 0, NULL, atabusconfig_thread,
    217  1.100    bouyer 	    atabus_sc, &atabus_configlwp,
    218  1.100    bouyer 	    "%scnf", device_xname(atac->atac_dev))) != 0)
    219  1.100    bouyer 		aprint_error_dev(atac->atac_dev,
    220  1.100    bouyer 		    "unable to create config thread: error %d\n", error);
    221  1.100    bouyer 	return;
    222  1.100    bouyer 
    223  1.100    bouyer  out:
    224   1.51   thorpej 	simple_lock(&atabus_interlock);
    225  1.100    bouyer 	TAILQ_REMOVE(&atabus_initq_head, atabus_initq, atabus_initq);
    226   1.51   thorpej 	simple_unlock(&atabus_interlock);
    227   1.51   thorpej 
    228  1.100    bouyer 	free(atabus_initq, M_DEVBUF);
    229  1.100    bouyer 	wakeup(&atabus_initq_head);
    230  1.100    bouyer 
    231  1.100    bouyer 	ata_delref(chp);
    232  1.100    bouyer 
    233  1.100    bouyer 	config_pending_decr();
    234  1.100    bouyer }
    235  1.100    bouyer 
    236  1.100    bouyer /*
    237  1.100    bouyer  * atabus_configthread: finish attach of atabus's childrens, in a separate
    238  1.100    bouyer  * kernel thread.
    239  1.100    bouyer  */
    240  1.100    bouyer static void
    241  1.100    bouyer atabusconfig_thread(void *arg)
    242  1.100    bouyer {
    243  1.100    bouyer 	struct atabus_softc *atabus_sc = arg;
    244  1.100    bouyer 	struct ata_channel *chp = atabus_sc->sc_chan;
    245  1.100    bouyer 	struct atac_softc *atac = chp->ch_atac;
    246  1.100    bouyer 	int i, s;
    247  1.100    bouyer 	struct atabus_initq *atabus_initq = NULL;
    248  1.100    bouyer 
    249  1.100    bouyer 	simple_lock(&atabus_interlock);
    250  1.100    bouyer 	atabus_initq = TAILQ_FIRST(&atabus_initq_head);
    251  1.100    bouyer 	simple_unlock(&atabus_interlock);
    252  1.100    bouyer 	KASSERT(atabus_initq->atabus_sc == atabus_sc);
    253   1.51   thorpej 	/*
    254   1.51   thorpej 	 * Attach an ATAPI bus, if needed.
    255   1.51   thorpej 	 */
    256   1.51   thorpej 	for (i = 0; i < chp->ch_ndrive; i++) {
    257   1.51   thorpej 		if (chp->ch_drive[i].drive_flags & DRIVE_ATAPI) {
    258   1.51   thorpej #if NATAPIBUS > 0
    259   1.51   thorpej 			(*atac->atac_atapibus_attach)(atabus_sc);
    260   1.51   thorpej #else
    261   1.51   thorpej 			/*
    262   1.51   thorpej 			 * Fake the autoconfig "not configured" message
    263   1.51   thorpej 			 */
    264   1.51   thorpej 			aprint_normal("atapibus at %s not configured\n",
    265   1.98      cube 			    device_xname(atac->atac_dev));
    266   1.51   thorpej 			chp->atapibus = NULL;
    267   1.58   thorpej 			s = splbio();
    268   1.51   thorpej 			for (i = 0; i < chp->ch_ndrive; i++)
    269   1.51   thorpej 				chp->ch_drive[i].drive_flags &= ~DRIVE_ATAPI;
    270   1.58   thorpej 			splx(s);
    271   1.51   thorpej #endif
    272   1.51   thorpej 			break;
    273   1.51   thorpej 		}
    274   1.51   thorpej 	}
    275   1.51   thorpej 
    276   1.51   thorpej 	for (i = 0; i < chp->ch_ndrive; i++) {
    277   1.51   thorpej 		struct ata_device adev;
    278   1.51   thorpej 		if ((chp->ch_drive[i].drive_flags &
    279   1.51   thorpej 		    (DRIVE_ATA | DRIVE_OLD)) == 0) {
    280   1.51   thorpej 			continue;
    281   1.51   thorpej 		}
    282   1.51   thorpej 		memset(&adev, 0, sizeof(struct ata_device));
    283   1.51   thorpej 		adev.adev_bustype = atac->atac_bustype_ata;
    284   1.51   thorpej 		adev.adev_channel = chp->ch_channel;
    285   1.51   thorpej 		adev.adev_openings = 1;
    286   1.51   thorpej 		adev.adev_drv_data = &chp->ch_drive[i];
    287   1.98      cube 		chp->ata_drives[i] = config_found_ia(atabus_sc->sc_dev,
    288   1.71  drochner 		    "ata_hl", &adev, ataprint);
    289   1.51   thorpej 		if (chp->ata_drives[i] != NULL)
    290   1.51   thorpej 			ata_probe_caps(&chp->ch_drive[i]);
    291   1.58   thorpej 		else {
    292   1.58   thorpej 			s = splbio();
    293   1.51   thorpej 			chp->ch_drive[i].drive_flags &=
    294   1.51   thorpej 			    ~(DRIVE_ATA | DRIVE_OLD);
    295   1.58   thorpej 			splx(s);
    296   1.58   thorpej 		}
    297   1.51   thorpej 	}
    298   1.51   thorpej 
    299   1.51   thorpej 	/* now that we know the drives, the controller can set its modes */
    300   1.51   thorpej 	if (atac->atac_set_modes) {
    301   1.51   thorpej 		(*atac->atac_set_modes)(chp);
    302   1.51   thorpej 		ata_print_modes(chp);
    303   1.51   thorpej 	}
    304   1.51   thorpej #if NATARAID > 0
    305   1.51   thorpej 	if (atac->atac_cap & ATAC_CAP_RAID)
    306   1.51   thorpej 		for (i = 0; i < chp->ch_ndrive; i++)
    307   1.51   thorpej 			if (chp->ata_drives[i] != NULL)
    308   1.51   thorpej 				ata_raid_check_component(chp->ata_drives[i]);
    309   1.51   thorpej #endif /* NATARAID > 0 */
    310   1.51   thorpej 
    311   1.51   thorpej 	/*
    312   1.51   thorpej 	 * reset drive_flags for unattached devices, reset state for attached
    313   1.51   thorpej 	 * ones
    314   1.51   thorpej 	 */
    315   1.58   thorpej 	s = splbio();
    316   1.51   thorpej 	for (i = 0; i < chp->ch_ndrive; i++) {
    317   1.51   thorpej 		if (chp->ch_drive[i].drv_softc == NULL)
    318   1.51   thorpej 			chp->ch_drive[i].drive_flags = 0;
    319   1.51   thorpej 		else
    320   1.51   thorpej 			chp->ch_drive[i].state = 0;
    321   1.51   thorpej 	}
    322   1.58   thorpej 	splx(s);
    323   1.51   thorpej 
    324   1.81     itohy 	simple_lock(&atabus_interlock);
    325   1.81     itohy 	TAILQ_REMOVE(&atabus_initq_head, atabus_initq, atabus_initq);
    326   1.81     itohy 	simple_unlock(&atabus_interlock);
    327   1.51   thorpej 
    328   1.81     itohy 	free(atabus_initq, M_DEVBUF);
    329   1.81     itohy 	wakeup(&atabus_initq_head);
    330   1.51   thorpej 
    331   1.51   thorpej 	ata_delref(chp);
    332   1.51   thorpej 
    333   1.51   thorpej 	config_pending_decr();
    334  1.100    bouyer 	kthread_exit(0);
    335   1.51   thorpej }
    336   1.51   thorpej 
    337   1.23   thorpej /*
    338   1.23   thorpej  * atabus_thread:
    339   1.23   thorpej  *
    340   1.23   thorpej  *	Worker thread for the ATA bus.
    341   1.23   thorpej  */
    342   1.23   thorpej static void
    343   1.23   thorpej atabus_thread(void *arg)
    344   1.23   thorpej {
    345   1.23   thorpej 	struct atabus_softc *sc = arg;
    346   1.48   thorpej 	struct ata_channel *chp = sc->sc_chan;
    347   1.24   thorpej 	struct ata_xfer *xfer;
    348   1.48   thorpej 	int i, s;
    349   1.23   thorpej 
    350   1.23   thorpej 	s = splbio();
    351   1.48   thorpej 	/*
    352   1.48   thorpej 	 * Probe the drives.  Reset all flags to 0 to indicate to controllers
    353   1.48   thorpej 	 * that can re-probe that all drives must be probed..
    354   1.48   thorpej 	 *
    355   1.48   thorpej 	 * Note: ch_ndrive may be changed during the probe.
    356   1.48   thorpej 	 */
    357   1.48   thorpej 	for (i = 0; i < ATA_MAXDRIVES; i++)
    358   1.48   thorpej 		chp->ch_drive[i].drive_flags = 0;
    359   1.23   thorpej 	splx(s);
    360   1.23   thorpej 
    361   1.23   thorpej 	/* Configure the devices on the bus. */
    362   1.68    bouyer 	atabusconfig(sc);
    363   1.23   thorpej 
    364   1.69    bouyer 	s = splbio();
    365   1.23   thorpej 	for (;;) {
    366   1.48   thorpej 		if ((chp->ch_flags & (ATACH_TH_RESET | ATACH_SHUTDOWN)) == 0 &&
    367   1.33    bouyer 		    (chp->ch_queue->active_xfer == NULL ||
    368   1.23   thorpej 		     chp->ch_queue->queue_freeze == 0)) {
    369   1.27   thorpej 			(void) tsleep(&chp->ch_thread, PRIBIO, "atath", 0);
    370   1.23   thorpej 		}
    371   1.59   thorpej 		if (chp->ch_flags & ATACH_SHUTDOWN) {
    372   1.23   thorpej 			break;
    373   1.59   thorpej 		}
    374   1.48   thorpej 		if (chp->ch_flags & ATACH_TH_RESET) {
    375   1.31    bouyer 			/*
    376   1.55   thorpej 			 * ata_reset_channel() will freeze 2 times, so
    377   1.31    bouyer 			 * unfreeze one time. Not a problem as we're at splbio
    378   1.31    bouyer 			 */
    379   1.23   thorpej 			chp->ch_queue->queue_freeze--;
    380   1.55   thorpej 			ata_reset_channel(chp, AT_WAIT | chp->ch_reset_flags);
    381   1.33    bouyer 		} else if (chp->ch_queue->active_xfer != NULL &&
    382   1.23   thorpej 			   chp->ch_queue->queue_freeze == 1) {
    383   1.23   thorpej 			/*
    384   1.23   thorpej 			 * Caller has bumped queue_freeze, decrease it.
    385   1.23   thorpej 			 */
    386   1.23   thorpej 			chp->ch_queue->queue_freeze--;
    387   1.33    bouyer 			xfer = chp->ch_queue->active_xfer;
    388   1.23   thorpej 			KASSERT(xfer != NULL);
    389   1.61    bouyer 			(*xfer->c_start)(xfer->c_chp, xfer);
    390   1.23   thorpej 		} else if (chp->ch_queue->queue_freeze > 1)
    391   1.23   thorpej 			panic("ata_thread: queue_freeze");
    392   1.23   thorpej 	}
    393   1.69    bouyer 	splx(s);
    394   1.27   thorpej 	chp->ch_thread = NULL;
    395   1.70  christos 	wakeup(&chp->ch_flags);
    396   1.23   thorpej 	kthread_exit(0);
    397   1.23   thorpej }
    398   1.23   thorpej 
    399   1.23   thorpej /*
    400   1.23   thorpej  * atabus_match:
    401   1.23   thorpej  *
    402   1.23   thorpej  *	Autoconfiguration match routine.
    403   1.23   thorpej  */
    404   1.23   thorpej static int
    405   1.95    dyoung atabus_match(device_t parent, struct cfdata *cf, void *aux)
    406   1.23   thorpej {
    407   1.48   thorpej 	struct ata_channel *chp = aux;
    408   1.23   thorpej 
    409   1.23   thorpej 	if (chp == NULL)
    410   1.23   thorpej 		return (0);
    411   1.65     perry 
    412   1.26   thorpej 	if (cf->cf_loc[ATACF_CHANNEL] != chp->ch_channel &&
    413   1.23   thorpej 	    cf->cf_loc[ATACF_CHANNEL] != ATACF_CHANNEL_DEFAULT)
    414   1.81     itohy 		return (0);
    415   1.65     perry 
    416   1.23   thorpej 	return (1);
    417   1.23   thorpej }
    418   1.23   thorpej 
    419   1.23   thorpej /*
    420   1.23   thorpej  * atabus_attach:
    421   1.23   thorpej  *
    422   1.23   thorpej  *	Autoconfiguration attach routine.
    423   1.23   thorpej  */
    424   1.23   thorpej static void
    425   1.95    dyoung atabus_attach(device_t parent, device_t self, void *aux)
    426   1.23   thorpej {
    427   1.95    dyoung 	struct atabus_softc *sc = device_private(self);
    428   1.48   thorpej 	struct ata_channel *chp = aux;
    429   1.23   thorpej 	struct atabus_initq *initq;
    430   1.90        ad 	int error;
    431   1.23   thorpej 
    432   1.23   thorpej 	sc->sc_chan = chp;
    433   1.23   thorpej 
    434   1.23   thorpej 	aprint_normal("\n");
    435   1.23   thorpej 	aprint_naive("\n");
    436   1.23   thorpej 
    437   1.98      cube 	sc->sc_dev = self;
    438   1.98      cube 
    439   1.81     itohy 	if (ata_addref(chp))
    440   1.81     itohy 		return;
    441   1.35   mycroft 
    442   1.23   thorpej 	initq = malloc(sizeof(*initq), M_DEVBUF, M_WAITOK);
    443   1.23   thorpej 	initq->atabus_sc = sc;
    444   1.23   thorpej 	TAILQ_INSERT_TAIL(&atabus_initq_head, initq, atabus_initq);
    445   1.23   thorpej 	config_pending_incr();
    446   1.90        ad 
    447   1.90        ad 	if ((error = kthread_create(PRI_NONE, 0, NULL, atabus_thread, sc,
    448   1.95    dyoung 	    &chp->ch_thread, "%s", device_xname(self))) != 0)
    449   1.95    dyoung 		aprint_error_dev(self,
    450   1.95    dyoung 		    "unable to create kernel thread: error %d\n", error);
    451   1.64  jmcneill 
    452   1.92  jmcneill 	if (!pmf_device_register(self, atabus_suspend, atabus_resume))
    453   1.92  jmcneill 		aprint_error_dev(self, "couldn't establish power handler\n");
    454   1.23   thorpej }
    455   1.23   thorpej 
    456   1.23   thorpej /*
    457   1.23   thorpej  * atabus_activate:
    458   1.23   thorpej  *
    459   1.23   thorpej  *	Autoconfiguration activation routine.
    460   1.23   thorpej  */
    461   1.23   thorpej static int
    462   1.95    dyoung atabus_activate(device_t self, enum devact act)
    463   1.23   thorpej {
    464   1.95    dyoung 	struct atabus_softc *sc = device_private(self);
    465   1.48   thorpej 	struct ata_channel *chp = sc->sc_chan;
    466   1.95    dyoung 	device_t dev = NULL;
    467   1.23   thorpej 	int s, i, error = 0;
    468   1.23   thorpej 
    469   1.23   thorpej 	s = splbio();
    470   1.23   thorpej 	switch (act) {
    471   1.23   thorpej 	case DVACT_ACTIVATE:
    472   1.23   thorpej 		error = EOPNOTSUPP;
    473   1.23   thorpej 		break;
    474   1.65     perry 
    475   1.23   thorpej 	case DVACT_DEACTIVATE:
    476   1.23   thorpej 		/*
    477   1.23   thorpej 		 * We might deactivate the children of atapibus twice
    478   1.23   thorpej 		 * (once bia atapibus, once directly), but since the
    479   1.23   thorpej 		 * generic autoconfiguration code maintains the DVF_ACTIVE
    480   1.23   thorpej 		 * flag, it's safe.
    481   1.23   thorpej 		 */
    482   1.23   thorpej 		if ((dev = chp->atapibus) != NULL) {
    483   1.23   thorpej 			error = config_deactivate(dev);
    484   1.23   thorpej 			if (error)
    485   1.23   thorpej 				goto out;
    486   1.23   thorpej 		}
    487   1.23   thorpej 
    488   1.48   thorpej 		for (i = 0; i < chp->ch_ndrive; i++) {
    489   1.23   thorpej 			if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
    490   1.47   thorpej 				ATADEBUG_PRINT(("atabus_activate: %s: "
    491   1.95    dyoung 				    "deactivating %s\n", device_xname(self),
    492   1.95    dyoung 				    device_xname(dev)),
    493   1.23   thorpej 				    DEBUG_DETACH);
    494   1.23   thorpej 				error = config_deactivate(dev);
    495   1.23   thorpej 				if (error)
    496   1.23   thorpej 					goto out;
    497   1.23   thorpej 			}
    498   1.23   thorpej 		}
    499   1.23   thorpej 		break;
    500   1.23   thorpej 	}
    501   1.23   thorpej  out:
    502   1.23   thorpej 	splx(s);
    503   1.23   thorpej 
    504   1.47   thorpej #ifdef ATADEBUG
    505   1.23   thorpej 	if (dev != NULL && error != 0)
    506   1.47   thorpej 		ATADEBUG_PRINT(("atabus_activate: %s: "
    507   1.95    dyoung 		    "error %d deactivating %s\n", device_xname(self),
    508   1.95    dyoung 		    error, device_xname(dev)), DEBUG_DETACH);
    509   1.47   thorpej #endif /* ATADEBUG */
    510   1.23   thorpej 
    511   1.23   thorpej 	return (error);
    512   1.23   thorpej }
    513   1.23   thorpej 
    514   1.23   thorpej /*
    515   1.23   thorpej  * atabus_detach:
    516   1.23   thorpej  *
    517   1.23   thorpej  *	Autoconfiguration detach routine.
    518   1.23   thorpej  */
    519   1.23   thorpej static int
    520   1.95    dyoung atabus_detach(device_t self, int flags)
    521   1.23   thorpej {
    522   1.95    dyoung 	struct atabus_softc *sc = device_private(self);
    523   1.48   thorpej 	struct ata_channel *chp = sc->sc_chan;
    524   1.95    dyoung 	device_t dev = NULL;
    525   1.57   thorpej 	int s, i, error = 0;
    526   1.23   thorpej 
    527   1.23   thorpej 	/* Shutdown the channel. */
    528   1.57   thorpej 	s = splbio();		/* XXX ALSO NEED AN INTERLOCK HERE. */
    529   1.48   thorpej 	chp->ch_flags |= ATACH_SHUTDOWN;
    530   1.57   thorpej 	splx(s);
    531   1.95    dyoung 
    532   1.27   thorpej 	wakeup(&chp->ch_thread);
    533   1.95    dyoung 
    534   1.27   thorpej 	while (chp->ch_thread != NULL)
    535   1.70  christos 		(void) tsleep(&chp->ch_flags, PRIBIO, "atadown", 0);
    536   1.65     perry 
    537   1.95    dyoung 
    538   1.23   thorpej 	/*
    539   1.23   thorpej 	 * Detach atapibus and its children.
    540   1.23   thorpej 	 */
    541   1.23   thorpej 	if ((dev = chp->atapibus) != NULL) {
    542   1.47   thorpej 		ATADEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
    543   1.95    dyoung 		    device_xname(self), device_xname(dev)), DEBUG_DETACH);
    544   1.95    dyoung 
    545   1.23   thorpej 		error = config_detach(dev, flags);
    546   1.23   thorpej 		if (error)
    547   1.23   thorpej 			goto out;
    548   1.23   thorpej 	}
    549   1.23   thorpej 
    550   1.23   thorpej 	/*
    551   1.23   thorpej 	 * Detach our other children.
    552   1.23   thorpej 	 */
    553   1.48   thorpej 	for (i = 0; i < chp->ch_ndrive; i++) {
    554   1.23   thorpej 		if (chp->ch_drive[i].drive_flags & DRIVE_ATAPI)
    555   1.23   thorpej 			continue;
    556   1.23   thorpej 		if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
    557   1.47   thorpej 			ATADEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
    558   1.95    dyoung 			    device_xname(self), device_xname(dev)),
    559   1.23   thorpej 			    DEBUG_DETACH);
    560   1.23   thorpej 			error = config_detach(dev, flags);
    561   1.23   thorpej 			if (error)
    562   1.23   thorpej 				goto out;
    563   1.23   thorpej 		}
    564   1.23   thorpej 	}
    565   1.23   thorpej 
    566   1.23   thorpej  out:
    567   1.47   thorpej #ifdef ATADEBUG
    568   1.23   thorpej 	if (dev != NULL && error != 0)
    569   1.47   thorpej 		ATADEBUG_PRINT(("atabus_detach: %s: error %d detaching %s\n",
    570   1.95    dyoung 		    device_xname(self), error, device_xname(dev)),
    571   1.23   thorpej 		    DEBUG_DETACH);
    572   1.47   thorpej #endif /* ATADEBUG */
    573   1.23   thorpej 
    574   1.23   thorpej 	return (error);
    575   1.23   thorpej }
    576   1.23   thorpej 
    577   1.95    dyoung void
    578   1.95    dyoung atabus_childdetached(device_t self, device_t child)
    579   1.95    dyoung {
    580   1.95    dyoung 	struct atabus_softc *sc = device_private(self);
    581   1.95    dyoung 	struct ata_channel *chp = sc->sc_chan;
    582   1.95    dyoung 	int i;
    583   1.95    dyoung 
    584   1.95    dyoung 	/*
    585   1.95    dyoung 	 * atapibus detached.
    586   1.95    dyoung 	 */
    587   1.95    dyoung 	if (child == chp->atapibus) {
    588   1.95    dyoung 		chp->atapibus = NULL;
    589   1.95    dyoung 		return;
    590   1.95    dyoung 	}
    591   1.95    dyoung 
    592   1.95    dyoung 	/*
    593   1.95    dyoung 	 * Detach our other children.
    594   1.95    dyoung 	 */
    595   1.95    dyoung 	for (i = 0; i < chp->ch_ndrive; i++) {
    596   1.95    dyoung 		if (chp->ch_drive[i].drive_flags & DRIVE_ATAPI)
    597   1.95    dyoung 			continue;
    598   1.95    dyoung 		if (child == chp->ch_drive[i].drv_softc) {
    599   1.95    dyoung 			chp->ch_drive[i].drv_softc = NULL;
    600   1.95    dyoung 			chp->ch_drive[i].drive_flags = 0;
    601   1.95    dyoung 			return;
    602   1.95    dyoung 		}
    603   1.95    dyoung 	}
    604   1.95    dyoung 
    605   1.95    dyoung 	aprint_error_dev(self, "unknown child %p", (const void *)child);
    606   1.95    dyoung }
    607   1.95    dyoung 
    608   1.98      cube CFATTACH_DECL2_NEW(atabus, sizeof(struct atabus_softc),
    609   1.95    dyoung     atabus_match, atabus_attach, atabus_detach, atabus_activate, NULL,
    610   1.95    dyoung     atabus_childdetached);
    611   1.23   thorpej 
    612   1.23   thorpej /*****************************************************************************
    613   1.23   thorpej  * Common ATA bus operations.
    614   1.23   thorpej  *****************************************************************************/
    615   1.23   thorpej 
    616    1.2    bouyer /* Get the disk's parameters */
    617    1.2    bouyer int
    618   1.21   thorpej ata_get_params(struct ata_drive_datas *drvp, u_int8_t flags,
    619   1.21   thorpej     struct ataparams *prms)
    620    1.2    bouyer {
    621   1.36   thorpej 	struct ata_command ata_c;
    622   1.50   thorpej 	struct ata_channel *chp = drvp->chnl_softc;
    623   1.50   thorpej 	struct atac_softc *atac = chp->ch_atac;
    624   1.93     pooka 	char *tb;
    625   1.93     pooka 	int i, rv;
    626    1.2    bouyer 	u_int16_t *p;
    627    1.2    bouyer 
    628   1.88    dyoung 	ATADEBUG_PRINT(("%s\n", __func__), DEBUG_FUNCS);
    629    1.2    bouyer 
    630   1.93     pooka 	tb = kmem_zalloc(DEV_BSIZE, KM_SLEEP);
    631    1.2    bouyer 	memset(prms, 0, sizeof(struct ataparams));
    632   1.36   thorpej 	memset(&ata_c, 0, sizeof(struct ata_command));
    633    1.2    bouyer 
    634    1.2    bouyer 	if (drvp->drive_flags & DRIVE_ATA) {
    635   1.36   thorpej 		ata_c.r_command = WDCC_IDENTIFY;
    636   1.36   thorpej 		ata_c.r_st_bmask = WDCS_DRDY;
    637   1.73    bouyer 		ata_c.r_st_pmask = WDCS_DRQ;
    638   1.36   thorpej 		ata_c.timeout = 3000; /* 3s */
    639    1.7    bouyer 	} else if (drvp->drive_flags & DRIVE_ATAPI) {
    640   1.36   thorpej 		ata_c.r_command = ATAPI_IDENTIFY_DEVICE;
    641   1.36   thorpej 		ata_c.r_st_bmask = 0;
    642   1.73    bouyer 		ata_c.r_st_pmask = WDCS_DRQ;
    643   1.36   thorpej 		ata_c.timeout = 10000; /* 10s */
    644    1.7    bouyer 	} else {
    645   1.47   thorpej 		ATADEBUG_PRINT(("ata_get_parms: no disks\n"),
    646   1.10    bouyer 		    DEBUG_FUNCS|DEBUG_PROBE);
    647   1.93     pooka 		rv = CMD_ERR;
    648   1.93     pooka 		goto out;
    649    1.2    bouyer 	}
    650   1.36   thorpej 	ata_c.flags = AT_READ | flags;
    651   1.36   thorpej 	ata_c.data = tb;
    652   1.36   thorpej 	ata_c.bcount = DEV_BSIZE;
    653   1.50   thorpej 	if ((*atac->atac_bustype_ata->ata_exec_command)(drvp,
    654   1.50   thorpej 						&ata_c) != ATACMD_COMPLETE) {
    655   1.47   thorpej 		ATADEBUG_PRINT(("ata_get_parms: wdc_exec_command failed\n"),
    656   1.10    bouyer 		    DEBUG_FUNCS|DEBUG_PROBE);
    657   1.93     pooka 		rv = CMD_AGAIN;
    658   1.93     pooka 		goto out;
    659   1.10    bouyer 	}
    660   1.36   thorpej 	if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
    661   1.47   thorpej 		ATADEBUG_PRINT(("ata_get_parms: ata_c.flags=0x%x\n",
    662   1.36   thorpej 		    ata_c.flags), DEBUG_FUNCS|DEBUG_PROBE);
    663   1.93     pooka 		rv = CMD_ERR;
    664   1.93     pooka 		goto out;
    665   1.89       dsl 	}
    666   1.89       dsl 	/* if we didn't read any data something is wrong */
    667   1.93     pooka 	if ((ata_c.flags & AT_XFDONE) == 0) {
    668   1.93     pooka 		rv = CMD_ERR;
    669   1.93     pooka 		goto out;
    670   1.93     pooka 	}
    671   1.89       dsl 
    672   1.89       dsl 	/* Read in parameter block. */
    673   1.89       dsl 	memcpy(prms, tb, sizeof(struct ataparams));
    674   1.80     itohy 
    675   1.89       dsl 	/*
    676   1.89       dsl 	 * Shuffle string byte order.
    677   1.89       dsl 	 * ATAPI NEC, Mitsumi and Pioneer drives and
    678   1.89       dsl 	 * old ATA TDK CompactFlash cards
    679   1.89       dsl 	 * have different byte order.
    680   1.89       dsl 	 */
    681   1.80     itohy #if BYTE_ORDER == BIG_ENDIAN
    682   1.80     itohy # define M(n)	prms->atap_model[(n) ^ 1]
    683   1.80     itohy #else
    684   1.80     itohy # define M(n)	prms->atap_model[n]
    685   1.80     itohy #endif
    686   1.89       dsl 	if (
    687   1.80     itohy #if BYTE_ORDER == BIG_ENDIAN
    688   1.89       dsl 	    !
    689   1.80     itohy #endif
    690   1.89       dsl 	    ((drvp->drive_flags & DRIVE_ATAPI) ?
    691   1.89       dsl 	     ((M(0) == 'N' && M(1) == 'E') ||
    692   1.89       dsl 	      (M(0) == 'F' && M(1) == 'X') ||
    693   1.89       dsl 	      (M(0) == 'P' && M(1) == 'i')) :
    694   1.93     pooka 	     ((M(0) == 'T' && M(1) == 'D' && M(2) == 'K')))) {
    695   1.93     pooka 		rv = CMD_OK;
    696   1.93     pooka 		goto out;
    697   1.93     pooka 	     }
    698   1.80     itohy #undef M
    699   1.89       dsl 	for (i = 0; i < sizeof(prms->atap_model); i += 2) {
    700   1.89       dsl 		p = (u_int16_t *)(prms->atap_model + i);
    701   1.89       dsl 		*p = bswap16(*p);
    702   1.89       dsl 	}
    703   1.89       dsl 	for (i = 0; i < sizeof(prms->atap_serial); i += 2) {
    704   1.89       dsl 		p = (u_int16_t *)(prms->atap_serial + i);
    705   1.89       dsl 		*p = bswap16(*p);
    706   1.89       dsl 	}
    707   1.89       dsl 	for (i = 0; i < sizeof(prms->atap_revision); i += 2) {
    708   1.89       dsl 		p = (u_int16_t *)(prms->atap_revision + i);
    709   1.89       dsl 		*p = bswap16(*p);
    710   1.89       dsl 	}
    711   1.80     itohy 
    712   1.93     pooka 	rv = CMD_OK;
    713   1.93     pooka  out:
    714   1.93     pooka 	kmem_free(tb, DEV_BSIZE);
    715   1.93     pooka 	return rv;
    716    1.2    bouyer }
    717    1.2    bouyer 
    718    1.2    bouyer int
    719   1.21   thorpej ata_set_mode(struct ata_drive_datas *drvp, u_int8_t mode, u_int8_t flags)
    720    1.2    bouyer {
    721   1.36   thorpej 	struct ata_command ata_c;
    722   1.50   thorpej 	struct ata_channel *chp = drvp->chnl_softc;
    723   1.50   thorpej 	struct atac_softc *atac = chp->ch_atac;
    724    1.2    bouyer 
    725   1.47   thorpej 	ATADEBUG_PRINT(("ata_set_mode=0x%x\n", mode), DEBUG_FUNCS);
    726   1.36   thorpej 	memset(&ata_c, 0, sizeof(struct ata_command));
    727    1.2    bouyer 
    728   1.36   thorpej 	ata_c.r_command = SET_FEATURES;
    729   1.36   thorpej 	ata_c.r_st_bmask = 0;
    730   1.36   thorpej 	ata_c.r_st_pmask = 0;
    731   1.36   thorpej 	ata_c.r_features = WDSF_SET_MODE;
    732   1.36   thorpej 	ata_c.r_count = mode;
    733   1.36   thorpej 	ata_c.flags = flags;
    734   1.36   thorpej 	ata_c.timeout = 1000; /* 1s */
    735   1.50   thorpej 	if ((*atac->atac_bustype_ata->ata_exec_command)(drvp,
    736   1.50   thorpej 						&ata_c) != ATACMD_COMPLETE)
    737    1.2    bouyer 		return CMD_AGAIN;
    738   1.36   thorpej 	if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
    739    1.2    bouyer 		return CMD_ERR;
    740    1.2    bouyer 	}
    741    1.2    bouyer 	return CMD_OK;
    742   1.11    bouyer }
    743   1.11    bouyer 
    744   1.78     itohy #if NATA_DMA
    745   1.11    bouyer void
    746   1.21   thorpej ata_dmaerr(struct ata_drive_datas *drvp, int flags)
    747   1.11    bouyer {
    748   1.11    bouyer 	/*
    749   1.11    bouyer 	 * Downgrade decision: if we get NERRS_MAX in NXFER.
    750   1.11    bouyer 	 * We start with n_dmaerrs set to NERRS_MAX-1 so that the
    751   1.11    bouyer 	 * first error within the first NXFER ops will immediatly trigger
    752   1.11    bouyer 	 * a downgrade.
    753   1.11    bouyer 	 * If we got an error and n_xfers is bigger than NXFER reset counters.
    754   1.11    bouyer 	 */
    755   1.11    bouyer 	drvp->n_dmaerrs++;
    756   1.11    bouyer 	if (drvp->n_dmaerrs >= NERRS_MAX && drvp->n_xfers <= NXFER) {
    757   1.39   thorpej 		ata_downgrade_mode(drvp, flags);
    758   1.11    bouyer 		drvp->n_dmaerrs = NERRS_MAX-1;
    759   1.11    bouyer 		drvp->n_xfers = 0;
    760   1.11    bouyer 		return;
    761   1.11    bouyer 	}
    762   1.11    bouyer 	if (drvp->n_xfers > NXFER) {
    763   1.11    bouyer 		drvp->n_dmaerrs = 1; /* just got an error */
    764   1.11    bouyer 		drvp->n_xfers = 1; /* restart counting from this error */
    765    1.4    bouyer 	}
    766    1.2    bouyer }
    767   1.78     itohy #endif	/* NATA_DMA */
    768   1.30    bouyer 
    769   1.44   thorpej /*
    770   1.68    bouyer  * freeze the queue and wait for the controller to be idle. Caller has to
    771   1.68    bouyer  * unfreeze/restart the queue
    772   1.68    bouyer  */
    773   1.68    bouyer void
    774   1.68    bouyer ata_queue_idle(struct ata_queue *queue)
    775   1.68    bouyer {
    776   1.68    bouyer 	int s = splbio();
    777   1.68    bouyer 	queue->queue_freeze++;
    778   1.68    bouyer 	while (queue->active_xfer != NULL) {
    779   1.68    bouyer 		queue->queue_flags |= QF_IDLE_WAIT;
    780   1.68    bouyer 		tsleep(&queue->queue_flags, PRIBIO, "qidl", 0);
    781   1.68    bouyer 	}
    782   1.68    bouyer 	splx(s);
    783   1.68    bouyer }
    784   1.68    bouyer 
    785   1.68    bouyer /*
    786   1.57   thorpej  * Add a command to the queue and start controller.
    787   1.57   thorpej  *
    788   1.57   thorpej  * MUST BE CALLED AT splbio()!
    789   1.44   thorpej  */
    790   1.44   thorpej void
    791   1.48   thorpej ata_exec_xfer(struct ata_channel *chp, struct ata_xfer *xfer)
    792   1.44   thorpej {
    793   1.44   thorpej 
    794   1.47   thorpej 	ATADEBUG_PRINT(("ata_exec_xfer %p channel %d drive %d\n", xfer,
    795   1.44   thorpej 	    chp->ch_channel, xfer->c_drive), DEBUG_XFERS);
    796   1.44   thorpej 
    797   1.44   thorpej 	/* complete xfer setup */
    798   1.44   thorpej 	xfer->c_chp = chp;
    799   1.44   thorpej 
    800   1.44   thorpej 	/* insert at the end of command list */
    801   1.44   thorpej 	TAILQ_INSERT_TAIL(&chp->ch_queue->queue_xfer, xfer, c_xferchain);
    802   1.47   thorpej 	ATADEBUG_PRINT(("atastart from ata_exec_xfer, flags 0x%x\n",
    803   1.44   thorpej 	    chp->ch_flags), DEBUG_XFERS);
    804   1.62    bouyer 	/*
    805   1.62    bouyer 	 * if polling and can sleep, wait for the xfer to be at head of queue
    806   1.62    bouyer 	 */
    807   1.62    bouyer 	if ((xfer->c_flags & (C_POLL | C_WAIT)) ==  (C_POLL | C_WAIT)) {
    808   1.62    bouyer 		while (chp->ch_queue->active_xfer != NULL ||
    809   1.62    bouyer 		    TAILQ_FIRST(&chp->ch_queue->queue_xfer) != xfer) {
    810   1.62    bouyer 			xfer->c_flags |= C_WAITACT;
    811   1.62    bouyer 			tsleep(xfer, PRIBIO, "ataact", 0);
    812   1.62    bouyer 			xfer->c_flags &= ~C_WAITACT;
    813   1.62    bouyer 			if (xfer->c_flags & C_FREE) {
    814   1.62    bouyer 				ata_free_xfer(chp, xfer);
    815   1.62    bouyer 				return;
    816   1.62    bouyer 			}
    817   1.62    bouyer 		}
    818   1.62    bouyer 	}
    819   1.45   thorpej 	atastart(chp);
    820   1.45   thorpej }
    821   1.45   thorpej 
    822   1.45   thorpej /*
    823   1.45   thorpej  * Start I/O on a controller, for the given channel.
    824   1.45   thorpej  * The first xfer may be not for our channel if the channel queues
    825   1.45   thorpej  * are shared.
    826   1.57   thorpej  *
    827   1.57   thorpej  * MUST BE CALLED AT splbio()!
    828   1.45   thorpej  */
    829   1.45   thorpej void
    830   1.48   thorpej atastart(struct ata_channel *chp)
    831   1.45   thorpej {
    832   1.49   thorpej 	struct atac_softc *atac = chp->ch_atac;
    833   1.45   thorpej 	struct ata_xfer *xfer;
    834   1.45   thorpej 
    835   1.56   thorpej #ifdef ATA_DEBUG
    836   1.45   thorpej 	int spl1, spl2;
    837   1.45   thorpej 
    838   1.45   thorpej 	spl1 = splbio();
    839   1.45   thorpej 	spl2 = splbio();
    840   1.45   thorpej 	if (spl2 != spl1) {
    841   1.45   thorpej 		printf("atastart: not at splbio()\n");
    842   1.45   thorpej 		panic("atastart");
    843   1.45   thorpej 	}
    844   1.45   thorpej 	splx(spl2);
    845   1.45   thorpej 	splx(spl1);
    846   1.56   thorpej #endif /* ATA_DEBUG */
    847   1.45   thorpej 
    848   1.45   thorpej 	/* is there a xfer ? */
    849   1.45   thorpej 	if ((xfer = TAILQ_FIRST(&chp->ch_queue->queue_xfer)) == NULL)
    850   1.45   thorpej 		return;
    851   1.45   thorpej 
    852   1.45   thorpej 	/* adjust chp, in case we have a shared queue */
    853   1.45   thorpej 	chp = xfer->c_chp;
    854   1.45   thorpej 
    855   1.45   thorpej 	if (chp->ch_queue->active_xfer != NULL) {
    856   1.45   thorpej 		return; /* channel aleady active */
    857   1.45   thorpej 	}
    858   1.45   thorpej 	if (__predict_false(chp->ch_queue->queue_freeze > 0)) {
    859   1.68    bouyer 		if (chp->ch_queue->queue_flags & QF_IDLE_WAIT) {
    860   1.68    bouyer 			chp->ch_queue->queue_flags &= ~QF_IDLE_WAIT;
    861   1.68    bouyer 			wakeup(&chp->ch_queue->queue_flags);
    862   1.68    bouyer 		}
    863   1.68    bouyer 		return; /* queue frozen */
    864   1.45   thorpej 	}
    865   1.62    bouyer 	/*
    866   1.62    bouyer 	 * if someone is waiting for the command to be active, wake it up
    867   1.62    bouyer 	 * and let it process the command
    868   1.62    bouyer 	 */
    869   1.62    bouyer 	if (xfer->c_flags & C_WAITACT) {
    870   1.62    bouyer 		ATADEBUG_PRINT(("atastart: xfer %p channel %d drive %d "
    871   1.62    bouyer 		    "wait active\n", xfer, chp->ch_channel, xfer->c_drive),
    872   1.62    bouyer 		    DEBUG_XFERS);
    873   1.62    bouyer 		wakeup(xfer);
    874   1.62    bouyer 		return;
    875   1.62    bouyer 	}
    876   1.45   thorpej #ifdef DIAGNOSTIC
    877   1.48   thorpej 	if ((chp->ch_flags & ATACH_IRQ_WAIT) != 0)
    878   1.45   thorpej 		panic("atastart: channel waiting for irq");
    879   1.45   thorpej #endif
    880   1.49   thorpej 	if (atac->atac_claim_hw)
    881   1.49   thorpej 		if (!(*atac->atac_claim_hw)(chp, 0))
    882   1.45   thorpej 			return;
    883   1.45   thorpej 
    884   1.47   thorpej 	ATADEBUG_PRINT(("atastart: xfer %p channel %d drive %d\n", xfer,
    885   1.45   thorpej 	    chp->ch_channel, xfer->c_drive), DEBUG_XFERS);
    886   1.45   thorpej 	if (chp->ch_drive[xfer->c_drive].drive_flags & DRIVE_RESET) {
    887   1.45   thorpej 		chp->ch_drive[xfer->c_drive].drive_flags &= ~DRIVE_RESET;
    888   1.45   thorpej 		chp->ch_drive[xfer->c_drive].state = 0;
    889   1.45   thorpej 	}
    890   1.45   thorpej 	chp->ch_queue->active_xfer = xfer;
    891   1.45   thorpej 	TAILQ_REMOVE(&chp->ch_queue->queue_xfer, xfer, c_xferchain);
    892   1.65     perry 
    893   1.49   thorpej 	if (atac->atac_cap & ATAC_CAP_NOIRQ)
    894   1.45   thorpej 		KASSERT(xfer->c_flags & C_POLL);
    895   1.62    bouyer 
    896   1.45   thorpej 	xfer->c_start(chp, xfer);
    897   1.44   thorpej }
    898   1.44   thorpej 
    899   1.41   thorpej struct ata_xfer *
    900   1.41   thorpej ata_get_xfer(int flags)
    901   1.41   thorpej {
    902   1.41   thorpej 	struct ata_xfer *xfer;
    903   1.41   thorpej 	int s;
    904   1.41   thorpej 
    905   1.41   thorpej 	s = splbio();
    906   1.41   thorpej 	xfer = pool_get(&ata_xfer_pool,
    907   1.41   thorpej 	    ((flags & ATAXF_NOSLEEP) != 0 ? PR_NOWAIT : PR_WAITOK));
    908   1.41   thorpej 	splx(s);
    909   1.41   thorpej 	if (xfer != NULL) {
    910   1.41   thorpej 		memset(xfer, 0, sizeof(struct ata_xfer));
    911   1.41   thorpej 	}
    912   1.41   thorpej 	return xfer;
    913   1.41   thorpej }
    914   1.41   thorpej 
    915   1.41   thorpej void
    916   1.48   thorpej ata_free_xfer(struct ata_channel *chp, struct ata_xfer *xfer)
    917   1.41   thorpej {
    918   1.49   thorpej 	struct atac_softc *atac = chp->ch_atac;
    919   1.41   thorpej 	int s;
    920   1.41   thorpej 
    921   1.62    bouyer 	if (xfer->c_flags & C_WAITACT) {
    922   1.62    bouyer 		/* Someone is waiting for this xfer, so we can't free now */
    923   1.62    bouyer 		xfer->c_flags |= C_FREE;
    924   1.62    bouyer 		wakeup(xfer);
    925   1.62    bouyer 		return;
    926   1.62    bouyer 	}
    927   1.62    bouyer 
    928   1.76     itohy #if NATA_PIOBM		/* XXX wdc dependent code */
    929   1.76     itohy 	if (xfer->c_flags & C_PIOBM) {
    930   1.76     itohy 		struct wdc_softc *wdc = CHAN_TO_WDC(chp);
    931   1.76     itohy 
    932   1.76     itohy 		/* finish the busmastering PIO */
    933   1.76     itohy 		(*wdc->piobm_done)(wdc->dma_arg,
    934   1.76     itohy 		    chp->ch_channel, xfer->c_drive);
    935   1.76     itohy 		chp->ch_flags &= ~(ATACH_DMA_WAIT | ATACH_PIOBM_WAIT | ATACH_IRQ_WAIT);
    936   1.76     itohy 	}
    937   1.76     itohy #endif
    938   1.76     itohy 
    939   1.49   thorpej 	if (atac->atac_free_hw)
    940   1.49   thorpej 		(*atac->atac_free_hw)(chp);
    941   1.41   thorpej 	s = splbio();
    942   1.41   thorpej 	pool_put(&ata_xfer_pool, xfer);
    943   1.41   thorpej 	splx(s);
    944   1.41   thorpej }
    945   1.41   thorpej 
    946   1.42   thorpej /*
    947   1.48   thorpej  * Kill off all pending xfers for a ata_channel.
    948   1.42   thorpej  *
    949   1.42   thorpej  * Must be called at splbio().
    950   1.42   thorpej  */
    951   1.42   thorpej void
    952   1.42   thorpej ata_kill_pending(struct ata_drive_datas *drvp)
    953   1.42   thorpej {
    954   1.48   thorpej 	struct ata_channel *chp = drvp->chnl_softc;
    955   1.42   thorpej 	struct ata_xfer *xfer, *next_xfer;
    956   1.42   thorpej 	int s = splbio();
    957   1.42   thorpej 
    958   1.42   thorpej 	for (xfer = TAILQ_FIRST(&chp->ch_queue->queue_xfer);
    959   1.42   thorpej 	    xfer != NULL; xfer = next_xfer) {
    960   1.42   thorpej 		next_xfer = TAILQ_NEXT(xfer, c_xferchain);
    961   1.42   thorpej 		if (xfer->c_chp != chp || xfer->c_drive != drvp->drive)
    962   1.42   thorpej 			continue;
    963   1.42   thorpej 		TAILQ_REMOVE(&chp->ch_queue->queue_xfer, xfer, c_xferchain);
    964   1.42   thorpej 		(*xfer->c_kill_xfer)(chp, xfer, KILL_GONE);
    965   1.42   thorpej 	}
    966   1.42   thorpej 
    967   1.42   thorpej 	while ((xfer = chp->ch_queue->active_xfer) != NULL) {
    968   1.42   thorpej 		if (xfer->c_chp == chp && xfer->c_drive == drvp->drive) {
    969   1.42   thorpej 			drvp->drive_flags |= DRIVE_WAITDRAIN;
    970   1.42   thorpej 			(void) tsleep(&chp->ch_queue->active_xfer,
    971   1.42   thorpej 			    PRIBIO, "atdrn", 0);
    972   1.42   thorpej 		} else {
    973   1.42   thorpej 			/* no more xfer for us */
    974   1.42   thorpej 			break;
    975   1.42   thorpej 		}
    976   1.42   thorpej 	}
    977   1.42   thorpej 	splx(s);
    978   1.42   thorpej }
    979   1.42   thorpej 
    980   1.55   thorpej /*
    981   1.55   thorpej  * ata_reset_channel:
    982   1.55   thorpej  *
    983   1.55   thorpej  *	Reset and ATA channel.
    984   1.57   thorpej  *
    985   1.57   thorpej  *	MUST BE CALLED AT splbio()!
    986   1.55   thorpej  */
    987   1.55   thorpej void
    988   1.55   thorpej ata_reset_channel(struct ata_channel *chp, int flags)
    989   1.55   thorpej {
    990   1.55   thorpej 	struct atac_softc *atac = chp->ch_atac;
    991   1.55   thorpej 	int drive;
    992   1.55   thorpej 
    993   1.57   thorpej #ifdef ATA_DEBUG
    994   1.57   thorpej 	int spl1, spl2;
    995   1.57   thorpej 
    996   1.57   thorpej 	spl1 = splbio();
    997   1.57   thorpej 	spl2 = splbio();
    998   1.57   thorpej 	if (spl2 != spl1) {
    999   1.57   thorpej 		printf("ata_reset_channel: not at splbio()\n");
   1000   1.57   thorpej 		panic("ata_reset_channel");
   1001   1.57   thorpej 	}
   1002   1.57   thorpej 	splx(spl2);
   1003   1.57   thorpej 	splx(spl1);
   1004   1.57   thorpej #endif /* ATA_DEBUG */
   1005   1.57   thorpej 
   1006   1.55   thorpej 	chp->ch_queue->queue_freeze++;
   1007   1.55   thorpej 
   1008   1.55   thorpej 	/*
   1009   1.55   thorpej 	 * If we can poll or wait it's OK, otherwise wake up the
   1010   1.55   thorpej 	 * kernel thread to do it for us.
   1011   1.55   thorpej 	 */
   1012  1.100    bouyer 	ATADEBUG_PRINT(("ata_reset_channel flags 0x%x ch_flags 0x%x\n",
   1013  1.100    bouyer 	    flags, chp->ch_flags), DEBUG_FUNCS | DEBUG_XFERS);
   1014   1.55   thorpej 	if ((flags & (AT_POLL | AT_WAIT)) == 0) {
   1015   1.55   thorpej 		if (chp->ch_flags & ATACH_TH_RESET) {
   1016   1.55   thorpej 			/* No need to schedule a reset more than one time. */
   1017   1.60    bouyer 			chp->ch_queue->queue_freeze--;
   1018   1.55   thorpej 			return;
   1019   1.55   thorpej 		}
   1020   1.55   thorpej 		chp->ch_flags |= ATACH_TH_RESET;
   1021   1.55   thorpej 		chp->ch_reset_flags = flags & (AT_RST_EMERG | AT_RST_NOCMD);
   1022   1.55   thorpej 		wakeup(&chp->ch_thread);
   1023   1.55   thorpej 		return;
   1024   1.55   thorpej 	}
   1025   1.55   thorpej 
   1026   1.55   thorpej 	(*atac->atac_bustype_ata->ata_reset_channel)(chp, flags);
   1027   1.55   thorpej 
   1028   1.55   thorpej 	for (drive = 0; drive < chp->ch_ndrive; drive++)
   1029   1.55   thorpej 		chp->ch_drive[drive].state = 0;
   1030   1.55   thorpej 
   1031   1.55   thorpej 	chp->ch_flags &= ~ATACH_TH_RESET;
   1032   1.55   thorpej 	if ((flags & AT_RST_EMERG) == 0)  {
   1033   1.55   thorpej 		chp->ch_queue->queue_freeze--;
   1034   1.55   thorpej 		atastart(chp);
   1035   1.55   thorpej 	} else {
   1036   1.55   thorpej 		/* make sure that we can use polled commands */
   1037   1.55   thorpej 		TAILQ_INIT(&chp->ch_queue->queue_xfer);
   1038   1.55   thorpej 		chp->ch_queue->queue_freeze = 0;
   1039   1.55   thorpej 		chp->ch_queue->active_xfer = NULL;
   1040   1.55   thorpej 	}
   1041   1.55   thorpej }
   1042   1.55   thorpej 
   1043   1.43   thorpej int
   1044   1.48   thorpej ata_addref(struct ata_channel *chp)
   1045   1.43   thorpej {
   1046   1.65     perry 	struct atac_softc *atac = chp->ch_atac;
   1047   1.49   thorpej 	struct scsipi_adapter *adapt = &atac->atac_atapi_adapter._generic;
   1048   1.43   thorpej 	int s, error = 0;
   1049   1.43   thorpej 
   1050   1.43   thorpej 	s = splbio();
   1051   1.43   thorpej 	if (adapt->adapt_refcnt++ == 0 &&
   1052   1.43   thorpej 	    adapt->adapt_enable != NULL) {
   1053   1.98      cube 		error = (*adapt->adapt_enable)(atac->atac_dev, 1);
   1054   1.43   thorpej 		if (error)
   1055   1.43   thorpej 			adapt->adapt_refcnt--;
   1056   1.43   thorpej 	}
   1057   1.43   thorpej 	splx(s);
   1058   1.43   thorpej 	return (error);
   1059   1.43   thorpej }
   1060   1.43   thorpej 
   1061   1.43   thorpej void
   1062   1.48   thorpej ata_delref(struct ata_channel *chp)
   1063   1.43   thorpej {
   1064   1.49   thorpej 	struct atac_softc *atac = chp->ch_atac;
   1065   1.49   thorpej 	struct scsipi_adapter *adapt = &atac->atac_atapi_adapter._generic;
   1066   1.43   thorpej 	int s;
   1067   1.43   thorpej 
   1068   1.43   thorpej 	s = splbio();
   1069   1.43   thorpej 	if (adapt->adapt_refcnt-- == 1 &&
   1070   1.43   thorpej 	    adapt->adapt_enable != NULL)
   1071   1.98      cube 		(void) (*adapt->adapt_enable)(atac->atac_dev, 0);
   1072   1.43   thorpej 	splx(s);
   1073   1.43   thorpej }
   1074   1.43   thorpej 
   1075   1.38   thorpej void
   1076   1.48   thorpej ata_print_modes(struct ata_channel *chp)
   1077   1.38   thorpej {
   1078   1.49   thorpej 	struct atac_softc *atac = chp->ch_atac;
   1079   1.38   thorpej 	int drive;
   1080   1.38   thorpej 	struct ata_drive_datas *drvp;
   1081   1.38   thorpej 
   1082   1.67      matt 	for (drive = 0; drive < chp->ch_ndrive; drive++) {
   1083   1.38   thorpej 		drvp = &chp->ch_drive[drive];
   1084   1.67      matt 		if ((drvp->drive_flags & DRIVE) == 0 || drvp->drv_softc == NULL)
   1085   1.38   thorpej 			continue;
   1086   1.85        ad 		aprint_verbose("%s(%s:%d:%d): using PIO mode %d",
   1087   1.95    dyoung 			device_xname(drvp->drv_softc),
   1088   1.98      cube 			device_xname(atac->atac_dev),
   1089   1.67      matt 			chp->ch_channel, drvp->drive, drvp->PIO_mode);
   1090   1.78     itohy #if NATA_DMA
   1091   1.38   thorpej 		if (drvp->drive_flags & DRIVE_DMA)
   1092   1.85        ad 			aprint_verbose(", DMA mode %d", drvp->DMA_mode);
   1093   1.78     itohy #if NATA_UDMA
   1094   1.38   thorpej 		if (drvp->drive_flags & DRIVE_UDMA) {
   1095   1.85        ad 			aprint_verbose(", Ultra-DMA mode %d", drvp->UDMA_mode);
   1096   1.38   thorpej 			if (drvp->UDMA_mode == 2)
   1097   1.85        ad 				aprint_verbose(" (Ultra/33)");
   1098   1.38   thorpej 			else if (drvp->UDMA_mode == 4)
   1099   1.85        ad 				aprint_verbose(" (Ultra/66)");
   1100   1.38   thorpej 			else if (drvp->UDMA_mode == 5)
   1101   1.85        ad 				aprint_verbose(" (Ultra/100)");
   1102   1.38   thorpej 			else if (drvp->UDMA_mode == 6)
   1103   1.85        ad 				aprint_verbose(" (Ultra/133)");
   1104   1.38   thorpej 		}
   1105   1.78     itohy #endif	/* NATA_UDMA */
   1106   1.78     itohy #endif	/* NATA_DMA */
   1107   1.78     itohy #if NATA_DMA || NATA_PIOBM
   1108   1.78     itohy 		if (0
   1109   1.78     itohy #if NATA_DMA
   1110   1.78     itohy 		    || (drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA))
   1111   1.78     itohy #endif
   1112   1.76     itohy #if NATA_PIOBM
   1113   1.76     itohy 		    /* PIOBM capable controllers use DMA for PIO commands */
   1114   1.76     itohy 		    || (atac->atac_cap & ATAC_CAP_PIOBM)
   1115   1.76     itohy #endif
   1116   1.76     itohy 		    )
   1117   1.85        ad 			aprint_verbose(" (using DMA)");
   1118   1.78     itohy #endif	/* NATA_DMA || NATA_PIOBM */
   1119   1.85        ad 		aprint_verbose("\n");
   1120   1.38   thorpej 	}
   1121   1.38   thorpej }
   1122   1.38   thorpej 
   1123   1.78     itohy #if NATA_DMA
   1124   1.39   thorpej /*
   1125   1.39   thorpej  * downgrade the transfer mode of a drive after an error. return 1 if
   1126   1.39   thorpej  * downgrade was possible, 0 otherwise.
   1127   1.57   thorpej  *
   1128   1.57   thorpej  * MUST BE CALLED AT splbio()!
   1129   1.39   thorpej  */
   1130   1.39   thorpej int
   1131   1.39   thorpej ata_downgrade_mode(struct ata_drive_datas *drvp, int flags)
   1132   1.39   thorpej {
   1133   1.48   thorpej 	struct ata_channel *chp = drvp->chnl_softc;
   1134   1.49   thorpej 	struct atac_softc *atac = chp->ch_atac;
   1135   1.95    dyoung 	device_t drv_dev = drvp->drv_softc;
   1136   1.74   thorpej 	int cf_flags = device_cfdata(drv_dev)->cf_flags;
   1137   1.39   thorpej 
   1138   1.39   thorpej 	/* if drive or controller don't know its mode, we can't do much */
   1139   1.39   thorpej 	if ((drvp->drive_flags & DRIVE_MODE) == 0 ||
   1140   1.49   thorpej 	    (atac->atac_set_modes == NULL))
   1141   1.39   thorpej 		return 0;
   1142   1.39   thorpej 	/* current drive mode was set by a config flag, let it this way */
   1143   1.39   thorpej 	if ((cf_flags & ATA_CONFIG_PIO_SET) ||
   1144   1.39   thorpej 	    (cf_flags & ATA_CONFIG_DMA_SET) ||
   1145   1.39   thorpej 	    (cf_flags & ATA_CONFIG_UDMA_SET))
   1146   1.39   thorpej 		return 0;
   1147   1.39   thorpej 
   1148   1.78     itohy #if NATA_UDMA
   1149   1.39   thorpej 	/*
   1150   1.39   thorpej 	 * If we were using Ultra-DMA mode, downgrade to the next lower mode.
   1151   1.39   thorpej 	 */
   1152   1.39   thorpej 	if ((drvp->drive_flags & DRIVE_UDMA) && drvp->UDMA_mode >= 2) {
   1153   1.39   thorpej 		drvp->UDMA_mode--;
   1154   1.98      cube 		aprint_error_dev(drv_dev,
   1155   1.98      cube 		    "transfer error, downgrading to Ultra-DMA mode %d\n",
   1156   1.98      cube 		    drvp->UDMA_mode);
   1157   1.39   thorpej 	}
   1158   1.78     itohy #endif
   1159   1.39   thorpej 
   1160   1.39   thorpej 	/*
   1161   1.39   thorpej 	 * If we were using ultra-DMA, don't downgrade to multiword DMA.
   1162   1.39   thorpej 	 */
   1163   1.39   thorpej 	else if (drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA)) {
   1164   1.39   thorpej 		drvp->drive_flags &= ~(DRIVE_DMA | DRIVE_UDMA);
   1165   1.39   thorpej 		drvp->PIO_mode = drvp->PIO_cap;
   1166   1.98      cube 		aprint_error_dev(drv_dev,
   1167   1.98      cube 		    "transfer error, downgrading to PIO mode %d\n",
   1168   1.98      cube 		    drvp->PIO_mode);
   1169   1.39   thorpej 	} else /* already using PIO, can't downgrade */
   1170   1.39   thorpej 		return 0;
   1171   1.39   thorpej 
   1172   1.49   thorpej 	(*atac->atac_set_modes)(chp);
   1173   1.39   thorpej 	ata_print_modes(chp);
   1174   1.84       wiz 	/* reset the channel, which will schedule all drives for setup */
   1175   1.55   thorpej 	ata_reset_channel(chp, flags | AT_RST_NOCMD);
   1176   1.39   thorpej 	return 1;
   1177   1.39   thorpej }
   1178   1.78     itohy #endif	/* NATA_DMA */
   1179   1.39   thorpej 
   1180   1.40   thorpej /*
   1181   1.40   thorpej  * Probe drive's capabilities, for use by the controller later
   1182   1.65     perry  * Assumes drvp points to an existing drive.
   1183   1.40   thorpej  */
   1184   1.40   thorpej void
   1185   1.40   thorpej ata_probe_caps(struct ata_drive_datas *drvp)
   1186   1.40   thorpej {
   1187   1.40   thorpej 	struct ataparams params, params2;
   1188   1.48   thorpej 	struct ata_channel *chp = drvp->chnl_softc;
   1189   1.49   thorpej 	struct atac_softc *atac = chp->ch_atac;
   1190   1.95    dyoung 	device_t drv_dev = drvp->drv_softc;
   1191   1.58   thorpej 	int i, printed, s;
   1192   1.70  christos 	const char *sep = "";
   1193   1.40   thorpej 	int cf_flags;
   1194   1.40   thorpej 
   1195   1.40   thorpej 	if (ata_get_params(drvp, AT_WAIT, &params) != CMD_OK) {
   1196   1.40   thorpej 		/* IDENTIFY failed. Can't tell more about the device */
   1197   1.40   thorpej 		return;
   1198   1.40   thorpej 	}
   1199   1.49   thorpej 	if ((atac->atac_cap & (ATAC_CAP_DATA16 | ATAC_CAP_DATA32)) ==
   1200   1.49   thorpej 	    (ATAC_CAP_DATA16 | ATAC_CAP_DATA32)) {
   1201   1.40   thorpej 		/*
   1202   1.40   thorpej 		 * Controller claims 16 and 32 bit transfers.
   1203   1.40   thorpej 		 * Re-do an IDENTIFY with 32-bit transfers,
   1204   1.40   thorpej 		 * and compare results.
   1205   1.40   thorpej 		 */
   1206   1.58   thorpej 		s = splbio();
   1207   1.40   thorpej 		drvp->drive_flags |= DRIVE_CAP32;
   1208   1.58   thorpej 		splx(s);
   1209   1.40   thorpej 		ata_get_params(drvp, AT_WAIT, &params2);
   1210   1.40   thorpej 		if (memcmp(&params, &params2, sizeof(struct ataparams)) != 0) {
   1211   1.40   thorpej 			/* Not good. fall back to 16bits */
   1212   1.58   thorpej 			s = splbio();
   1213   1.40   thorpej 			drvp->drive_flags &= ~DRIVE_CAP32;
   1214   1.58   thorpej 			splx(s);
   1215   1.40   thorpej 		} else {
   1216   1.98      cube 			aprint_verbose_dev(drv_dev, "32-bit data port\n");
   1217   1.40   thorpej 		}
   1218   1.40   thorpej 	}
   1219   1.40   thorpej #if 0 /* Some ultra-DMA drives claims to only support ATA-3. sigh */
   1220   1.65     perry 	if (params.atap_ata_major > 0x01 &&
   1221   1.40   thorpej 	    params.atap_ata_major != 0xffff) {
   1222   1.40   thorpej 		for (i = 14; i > 0; i--) {
   1223   1.40   thorpej 			if (params.atap_ata_major & (1 << i)) {
   1224   1.98      cube 				aprint_verbose_dev(drv_dev,
   1225   1.98      cube 				    "ATA version %d\n", i);
   1226   1.40   thorpej 				drvp->ata_vers = i;
   1227   1.40   thorpej 				break;
   1228   1.40   thorpej 			}
   1229   1.40   thorpej 		}
   1230   1.40   thorpej 	}
   1231   1.40   thorpej #endif
   1232   1.40   thorpej 
   1233   1.40   thorpej 	/* An ATAPI device is at last PIO mode 3 */
   1234   1.40   thorpej 	if (drvp->drive_flags & DRIVE_ATAPI)
   1235   1.40   thorpej 		drvp->PIO_mode = 3;
   1236   1.40   thorpej 
   1237   1.40   thorpej 	/*
   1238   1.65     perry 	 * It's not in the specs, but it seems that some drive
   1239   1.40   thorpej 	 * returns 0xffff in atap_extensions when this field is invalid
   1240   1.40   thorpej 	 */
   1241   1.40   thorpej 	if (params.atap_extensions != 0xffff &&
   1242   1.40   thorpej 	    (params.atap_extensions & WDC_EXT_MODES)) {
   1243   1.40   thorpej 		printed = 0;
   1244   1.40   thorpej 		/*
   1245   1.40   thorpej 		 * XXX some drives report something wrong here (they claim to
   1246   1.40   thorpej 		 * support PIO mode 8 !). As mode is coded on 3 bits in
   1247   1.40   thorpej 		 * SET FEATURE, limit it to 7 (so limit i to 4).
   1248   1.40   thorpej 		 * If higher mode than 7 is found, abort.
   1249   1.40   thorpej 		 */
   1250   1.40   thorpej 		for (i = 7; i >= 0; i--) {
   1251   1.40   thorpej 			if ((params.atap_piomode_supp & (1 << i)) == 0)
   1252   1.40   thorpej 				continue;
   1253   1.40   thorpej 			if (i > 4)
   1254   1.40   thorpej 				return;
   1255   1.40   thorpej 			/*
   1256   1.40   thorpej 			 * See if mode is accepted.
   1257   1.40   thorpej 			 * If the controller can't set its PIO mode,
   1258   1.40   thorpej 			 * assume the defaults are good, so don't try
   1259   1.40   thorpej 			 * to set it
   1260   1.40   thorpej 			 */
   1261   1.49   thorpej 			if (atac->atac_set_modes)
   1262   1.40   thorpej 				/*
   1263   1.40   thorpej 				 * It's OK to pool here, it's fast enouth
   1264   1.40   thorpej 				 * to not bother waiting for interrupt
   1265   1.40   thorpej 				 */
   1266   1.40   thorpej 				if (ata_set_mode(drvp, 0x08 | (i + 3),
   1267   1.40   thorpej 				   AT_WAIT) != CMD_OK)
   1268   1.40   thorpej 					continue;
   1269   1.65     perry 			if (!printed) {
   1270   1.98      cube 				aprint_verbose_dev(drv_dev,
   1271   1.98      cube 				    "drive supports PIO mode %d", i + 3);
   1272   1.40   thorpej 				sep = ",";
   1273   1.40   thorpej 				printed = 1;
   1274   1.40   thorpej 			}
   1275   1.40   thorpej 			/*
   1276   1.40   thorpej 			 * If controller's driver can't set its PIO mode,
   1277   1.40   thorpej 			 * get the highter one for the drive.
   1278   1.40   thorpej 			 */
   1279   1.49   thorpej 			if (atac->atac_set_modes == NULL ||
   1280   1.49   thorpej 			    atac->atac_pio_cap >= i + 3) {
   1281   1.40   thorpej 				drvp->PIO_mode = i + 3;
   1282   1.40   thorpej 				drvp->PIO_cap = i + 3;
   1283   1.40   thorpej 				break;
   1284   1.40   thorpej 			}
   1285   1.40   thorpej 		}
   1286   1.40   thorpej 		if (!printed) {
   1287   1.65     perry 			/*
   1288   1.40   thorpej 			 * We didn't find a valid PIO mode.
   1289   1.40   thorpej 			 * Assume the values returned for DMA are buggy too
   1290   1.40   thorpej 			 */
   1291   1.40   thorpej 			return;
   1292   1.40   thorpej 		}
   1293   1.58   thorpej 		s = splbio();
   1294   1.40   thorpej 		drvp->drive_flags |= DRIVE_MODE;
   1295   1.58   thorpej 		splx(s);
   1296   1.40   thorpej 		printed = 0;
   1297   1.40   thorpej 		for (i = 7; i >= 0; i--) {
   1298   1.40   thorpej 			if ((params.atap_dmamode_supp & (1 << i)) == 0)
   1299   1.40   thorpej 				continue;
   1300   1.78     itohy #if NATA_DMA
   1301   1.49   thorpej 			if ((atac->atac_cap & ATAC_CAP_DMA) &&
   1302   1.49   thorpej 			    atac->atac_set_modes != NULL)
   1303   1.40   thorpej 				if (ata_set_mode(drvp, 0x20 | i, AT_WAIT)
   1304   1.40   thorpej 				    != CMD_OK)
   1305   1.40   thorpej 					continue;
   1306   1.78     itohy #endif
   1307   1.40   thorpej 			if (!printed) {
   1308   1.85        ad 				aprint_verbose("%s DMA mode %d", sep, i);
   1309   1.40   thorpej 				sep = ",";
   1310   1.40   thorpej 				printed = 1;
   1311   1.40   thorpej 			}
   1312   1.78     itohy #if NATA_DMA
   1313   1.49   thorpej 			if (atac->atac_cap & ATAC_CAP_DMA) {
   1314   1.49   thorpej 				if (atac->atac_set_modes != NULL &&
   1315   1.49   thorpej 				    atac->atac_dma_cap < i)
   1316   1.40   thorpej 					continue;
   1317   1.40   thorpej 				drvp->DMA_mode = i;
   1318   1.40   thorpej 				drvp->DMA_cap = i;
   1319   1.58   thorpej 				s = splbio();
   1320   1.40   thorpej 				drvp->drive_flags |= DRIVE_DMA;
   1321   1.58   thorpej 				splx(s);
   1322   1.40   thorpej 			}
   1323   1.78     itohy #endif
   1324   1.40   thorpej 			break;
   1325   1.40   thorpej 		}
   1326   1.40   thorpej 		if (params.atap_extensions & WDC_EXT_UDMA_MODES) {
   1327   1.40   thorpej 			printed = 0;
   1328   1.40   thorpej 			for (i = 7; i >= 0; i--) {
   1329   1.40   thorpej 				if ((params.atap_udmamode_supp & (1 << i))
   1330   1.40   thorpej 				    == 0)
   1331   1.40   thorpej 					continue;
   1332   1.78     itohy #if NATA_UDMA
   1333   1.49   thorpej 				if (atac->atac_set_modes != NULL &&
   1334   1.49   thorpej 				    (atac->atac_cap & ATAC_CAP_UDMA))
   1335   1.40   thorpej 					if (ata_set_mode(drvp, 0x40 | i,
   1336   1.40   thorpej 					    AT_WAIT) != CMD_OK)
   1337   1.40   thorpej 						continue;
   1338   1.78     itohy #endif
   1339   1.40   thorpej 				if (!printed) {
   1340   1.85        ad 					aprint_verbose("%s Ultra-DMA mode %d",
   1341   1.40   thorpej 					    sep, i);
   1342   1.40   thorpej 					if (i == 2)
   1343   1.85        ad 						aprint_verbose(" (Ultra/33)");
   1344   1.40   thorpej 					else if (i == 4)
   1345   1.85        ad 						aprint_verbose(" (Ultra/66)");
   1346   1.40   thorpej 					else if (i == 5)
   1347   1.85        ad 						aprint_verbose(" (Ultra/100)");
   1348   1.40   thorpej 					else if (i == 6)
   1349   1.85        ad 						aprint_verbose(" (Ultra/133)");
   1350   1.40   thorpej 					sep = ",";
   1351   1.40   thorpej 					printed = 1;
   1352   1.40   thorpej 				}
   1353   1.78     itohy #if NATA_UDMA
   1354   1.49   thorpej 				if (atac->atac_cap & ATAC_CAP_UDMA) {
   1355   1.49   thorpej 					if (atac->atac_set_modes != NULL &&
   1356   1.49   thorpej 					    atac->atac_udma_cap < i)
   1357   1.40   thorpej 						continue;
   1358   1.40   thorpej 					drvp->UDMA_mode = i;
   1359   1.40   thorpej 					drvp->UDMA_cap = i;
   1360   1.58   thorpej 					s = splbio();
   1361   1.40   thorpej 					drvp->drive_flags |= DRIVE_UDMA;
   1362   1.58   thorpej 					splx(s);
   1363   1.40   thorpej 				}
   1364   1.78     itohy #endif
   1365   1.40   thorpej 				break;
   1366   1.40   thorpej 			}
   1367   1.40   thorpej 		}
   1368   1.85        ad 		aprint_verbose("\n");
   1369   1.40   thorpej 	}
   1370   1.40   thorpej 
   1371   1.58   thorpej 	s = splbio();
   1372   1.40   thorpej 	drvp->drive_flags &= ~DRIVE_NOSTREAM;
   1373   1.40   thorpej 	if (drvp->drive_flags & DRIVE_ATAPI) {
   1374   1.65     perry 		if (atac->atac_cap & ATAC_CAP_ATAPI_NOSTREAM)
   1375   1.40   thorpej 			drvp->drive_flags |= DRIVE_NOSTREAM;
   1376   1.40   thorpej 	} else {
   1377   1.65     perry 		if (atac->atac_cap & ATAC_CAP_ATA_NOSTREAM)
   1378   1.40   thorpej 			drvp->drive_flags |= DRIVE_NOSTREAM;
   1379   1.40   thorpej 	}
   1380   1.58   thorpej 	splx(s);
   1381   1.40   thorpej 
   1382   1.40   thorpej 	/* Try to guess ATA version here, if it didn't get reported */
   1383   1.40   thorpej 	if (drvp->ata_vers == 0) {
   1384   1.78     itohy #if NATA_UDMA
   1385   1.40   thorpej 		if (drvp->drive_flags & DRIVE_UDMA)
   1386   1.40   thorpej 			drvp->ata_vers = 4; /* should be at last ATA-4 */
   1387   1.78     itohy 		else
   1388   1.78     itohy #endif
   1389   1.78     itohy 		if (drvp->PIO_cap > 2)
   1390   1.40   thorpej 			drvp->ata_vers = 2; /* should be at last ATA-2 */
   1391   1.40   thorpej 	}
   1392   1.74   thorpej 	cf_flags = device_cfdata(drv_dev)->cf_flags;
   1393   1.40   thorpej 	if (cf_flags & ATA_CONFIG_PIO_SET) {
   1394   1.58   thorpej 		s = splbio();
   1395   1.40   thorpej 		drvp->PIO_mode =
   1396   1.40   thorpej 		    (cf_flags & ATA_CONFIG_PIO_MODES) >> ATA_CONFIG_PIO_OFF;
   1397   1.40   thorpej 		drvp->drive_flags |= DRIVE_MODE;
   1398   1.58   thorpej 		splx(s);
   1399   1.40   thorpej 	}
   1400   1.78     itohy #if NATA_DMA
   1401   1.49   thorpej 	if ((atac->atac_cap & ATAC_CAP_DMA) == 0) {
   1402   1.40   thorpej 		/* don't care about DMA modes */
   1403   1.40   thorpej 		return;
   1404   1.40   thorpej 	}
   1405   1.40   thorpej 	if (cf_flags & ATA_CONFIG_DMA_SET) {
   1406   1.58   thorpej 		s = splbio();
   1407   1.40   thorpej 		if ((cf_flags & ATA_CONFIG_DMA_MODES) ==
   1408   1.40   thorpej 		    ATA_CONFIG_DMA_DISABLE) {
   1409   1.40   thorpej 			drvp->drive_flags &= ~DRIVE_DMA;
   1410   1.40   thorpej 		} else {
   1411   1.40   thorpej 			drvp->DMA_mode = (cf_flags & ATA_CONFIG_DMA_MODES) >>
   1412   1.40   thorpej 			    ATA_CONFIG_DMA_OFF;
   1413   1.40   thorpej 			drvp->drive_flags |= DRIVE_DMA | DRIVE_MODE;
   1414   1.40   thorpej 		}
   1415   1.58   thorpej 		splx(s);
   1416   1.40   thorpej 	}
   1417   1.78     itohy #if NATA_UDMA
   1418   1.49   thorpej 	if ((atac->atac_cap & ATAC_CAP_UDMA) == 0) {
   1419   1.40   thorpej 		/* don't care about UDMA modes */
   1420   1.40   thorpej 		return;
   1421   1.40   thorpej 	}
   1422   1.40   thorpej 	if (cf_flags & ATA_CONFIG_UDMA_SET) {
   1423   1.58   thorpej 		s = splbio();
   1424   1.40   thorpej 		if ((cf_flags & ATA_CONFIG_UDMA_MODES) ==
   1425   1.40   thorpej 		    ATA_CONFIG_UDMA_DISABLE) {
   1426   1.40   thorpej 			drvp->drive_flags &= ~DRIVE_UDMA;
   1427   1.40   thorpej 		} else {
   1428   1.40   thorpej 			drvp->UDMA_mode = (cf_flags & ATA_CONFIG_UDMA_MODES) >>
   1429   1.40   thorpej 			    ATA_CONFIG_UDMA_OFF;
   1430   1.40   thorpej 			drvp->drive_flags |= DRIVE_UDMA | DRIVE_MODE;
   1431   1.40   thorpej 		}
   1432   1.58   thorpej 		splx(s);
   1433   1.40   thorpej 	}
   1434   1.78     itohy #endif	/* NATA_UDMA */
   1435   1.78     itohy #endif	/* NATA_DMA */
   1436   1.40   thorpej }
   1437   1.40   thorpej 
   1438   1.30    bouyer /* management of the /dev/atabus* devices */
   1439   1.54   thorpej int
   1440   1.83  christos atabusopen(dev_t dev, int flag, int fmt,
   1441   1.83  christos     struct lwp *l)
   1442   1.30    bouyer {
   1443   1.81     itohy 	struct atabus_softc *sc;
   1444   1.99    cegger 	int error;
   1445   1.65     perry 
   1446   1.99    cegger 	sc = device_lookup_private(&atabus_cd, minor(dev));
   1447   1.99    cegger 	if (sc == NULL)
   1448   1.81     itohy 		return (ENXIO);
   1449   1.65     perry 
   1450   1.81     itohy 	if (sc->sc_flags & ATABUSCF_OPEN)
   1451   1.81     itohy 		return (EBUSY);
   1452   1.30    bouyer 
   1453   1.81     itohy 	if ((error = ata_addref(sc->sc_chan)) != 0)
   1454   1.81     itohy 		return (error);
   1455   1.30    bouyer 
   1456   1.81     itohy 	sc->sc_flags |= ATABUSCF_OPEN;
   1457   1.30    bouyer 
   1458   1.81     itohy 	return (0);
   1459   1.30    bouyer }
   1460   1.30    bouyer 
   1461   1.30    bouyer 
   1462   1.30    bouyer int
   1463   1.83  christos atabusclose(dev_t dev, int flag, int fmt,
   1464   1.83  christos     struct lwp *l)
   1465   1.30    bouyer {
   1466   1.98      cube 	struct atabus_softc *sc =
   1467   1.99    cegger 	    device_lookup_private(&atabus_cd, minor(dev));
   1468   1.30    bouyer 
   1469   1.81     itohy 	ata_delref(sc->sc_chan);
   1470   1.30    bouyer 
   1471   1.81     itohy 	sc->sc_flags &= ~ATABUSCF_OPEN;
   1472   1.30    bouyer 
   1473   1.81     itohy 	return (0);
   1474   1.30    bouyer }
   1475   1.30    bouyer 
   1476   1.30    bouyer int
   1477   1.86  christos atabusioctl(dev_t dev, u_long cmd, void *addr, int flag,
   1478   1.83  christos     struct lwp *l)
   1479   1.30    bouyer {
   1480   1.98      cube 	struct atabus_softc *sc =
   1481   1.99    cegger 	    device_lookup_private(&atabus_cd, minor(dev));
   1482   1.48   thorpej 	struct ata_channel *chp = sc->sc_chan;
   1483   1.32    bouyer 	int min_drive, max_drive, drive;
   1484   1.81     itohy 	int error;
   1485   1.30    bouyer 	int s;
   1486   1.30    bouyer 
   1487   1.81     itohy 	/*
   1488   1.81     itohy 	 * Enforce write permission for ioctls that change the
   1489   1.81     itohy 	 * state of the bus.  Host adapter specific ioctls must
   1490   1.81     itohy 	 * be checked by the adapter driver.
   1491   1.81     itohy 	 */
   1492   1.81     itohy 	switch (cmd) {
   1493   1.81     itohy 	case ATABUSIOSCAN:
   1494   1.81     itohy 	case ATABUSIODETACH:
   1495   1.81     itohy 	case ATABUSIORESET:
   1496   1.81     itohy 		if ((flag & FWRITE) == 0)
   1497   1.81     itohy 			return (EBADF);
   1498   1.81     itohy 	}
   1499   1.30    bouyer 
   1500   1.81     itohy 	switch (cmd) {
   1501   1.81     itohy 	case ATABUSIORESET:
   1502   1.30    bouyer 		s = splbio();
   1503   1.55   thorpej 		ata_reset_channel(sc->sc_chan, AT_WAIT | AT_POLL);
   1504   1.30    bouyer 		splx(s);
   1505   1.30    bouyer 		error = 0;
   1506   1.30    bouyer 		break;
   1507   1.32    bouyer 	case ATABUSIOSCAN:
   1508   1.32    bouyer 	{
   1509   1.32    bouyer #if 0
   1510   1.32    bouyer 		struct atabusioscan_args *a=
   1511   1.32    bouyer 		    (struct atabusioscan_args *)addr;
   1512   1.32    bouyer #endif
   1513   1.32    bouyer 		if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
   1514   1.32    bouyer 		    (chp->ch_drive[1].drive_flags & DRIVE_OLD))
   1515   1.32    bouyer 			return (EOPNOTSUPP);
   1516   1.32    bouyer 		return (EOPNOTSUPP);
   1517   1.32    bouyer 	}
   1518   1.32    bouyer 	case ATABUSIODETACH:
   1519   1.32    bouyer 	{
   1520   1.32    bouyer 		struct atabusioscan_args *a=
   1521   1.32    bouyer 		    (struct atabusioscan_args *)addr;
   1522   1.32    bouyer 		if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
   1523   1.32    bouyer 		    (chp->ch_drive[1].drive_flags & DRIVE_OLD))
   1524   1.32    bouyer 			return (EOPNOTSUPP);
   1525   1.32    bouyer 		switch (a->at_dev) {
   1526   1.32    bouyer 		case -1:
   1527   1.32    bouyer 			min_drive = 0;
   1528   1.32    bouyer 			max_drive = 1;
   1529   1.32    bouyer 			break;
   1530   1.32    bouyer 		case 0:
   1531   1.32    bouyer 		case 1:
   1532   1.32    bouyer 			min_drive = max_drive = a->at_dev;
   1533   1.32    bouyer 			break;
   1534   1.32    bouyer 		default:
   1535   1.32    bouyer 			return (EINVAL);
   1536   1.32    bouyer 		}
   1537   1.32    bouyer 		for (drive = min_drive; drive <= max_drive; drive++) {
   1538   1.32    bouyer 			if (chp->ch_drive[drive].drv_softc != NULL) {
   1539   1.32    bouyer 				error = config_detach(
   1540   1.32    bouyer 				    chp->ch_drive[drive].drv_softc, 0);
   1541   1.32    bouyer 				if (error)
   1542   1.32    bouyer 					return (error);
   1543   1.95    dyoung 				KASSERT(chp->ch_drive[drive].drv_softc == NULL);
   1544   1.32    bouyer 			}
   1545   1.32    bouyer 		}
   1546   1.32    bouyer 		error = 0;
   1547   1.32    bouyer 		break;
   1548   1.32    bouyer 	}
   1549   1.30    bouyer 	default:
   1550   1.30    bouyer 		error = ENOTTY;
   1551   1.30    bouyer 	}
   1552   1.30    bouyer 	return (error);
   1553   1.30    bouyer };
   1554   1.64  jmcneill 
   1555   1.92  jmcneill static bool
   1556   1.97    dyoung atabus_suspend(device_t dv PMF_FN_ARGS)
   1557   1.92  jmcneill {
   1558   1.92  jmcneill 	struct atabus_softc *sc = device_private(dv);
   1559   1.92  jmcneill 	struct ata_channel *chp = sc->sc_chan;
   1560   1.92  jmcneill 
   1561   1.92  jmcneill 	ata_queue_idle(chp->ch_queue);
   1562   1.92  jmcneill 
   1563   1.92  jmcneill 	return true;
   1564   1.92  jmcneill }
   1565   1.92  jmcneill 
   1566   1.92  jmcneill static bool
   1567   1.97    dyoung atabus_resume(device_t dv PMF_FN_ARGS)
   1568   1.64  jmcneill {
   1569   1.92  jmcneill 	struct atabus_softc *sc = device_private(dv);
   1570   1.64  jmcneill 	struct ata_channel *chp = sc->sc_chan;
   1571   1.64  jmcneill 	int s;
   1572   1.64  jmcneill 
   1573   1.92  jmcneill 	/*
   1574   1.92  jmcneill 	 * XXX joerg: with wdc, the first channel unfreezes the controler.
   1575   1.92  jmcneill 	 * Move this the reset and queue idling into wdc.
   1576   1.92  jmcneill 	 */
   1577   1.92  jmcneill 	s = splbio();
   1578   1.92  jmcneill 	if (chp->ch_queue->queue_freeze == 0) {
   1579   1.64  jmcneill 		splx(s);
   1580   1.92  jmcneill 		return true;
   1581   1.64  jmcneill 	}
   1582   1.92  jmcneill 	KASSERT(chp->ch_queue->queue_freeze > 0);
   1583   1.92  jmcneill 	/* unfreeze the queue and reset drives */
   1584   1.92  jmcneill 	chp->ch_queue->queue_freeze--;
   1585   1.92  jmcneill 	ata_reset_channel(chp, AT_WAIT);
   1586   1.92  jmcneill 	splx(s);
   1587   1.64  jmcneill 
   1588   1.92  jmcneill 	return true;
   1589   1.64  jmcneill }
   1590