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