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