Home | History | Annotate | Line # | Download | only in scsipi
scsipi_base.c revision 1.163
      1  1.163  christos /*	$NetBSD: scsipi_base.c,v 1.163 2014/11/17 18:43:48 christos Exp $	*/
      2    1.2    bouyer 
      3    1.8   mycroft /*-
      4  1.113   mycroft  * Copyright (c) 1998, 1999, 2000, 2002, 2003, 2004 The NetBSD Foundation, Inc.
      5    1.8   mycroft  * All rights reserved.
      6    1.8   mycroft  *
      7    1.8   mycroft  * This code is derived from software contributed to The NetBSD Foundation
      8   1.39    bouyer  * by Charles M. Hannum; by Jason R. Thorpe of the Numerical Aerospace
      9   1.39    bouyer  * Simulation Facility, NASA Ames Research Center.
     10    1.2    bouyer  *
     11    1.2    bouyer  * Redistribution and use in source and binary forms, with or without
     12    1.2    bouyer  * modification, are permitted provided that the following conditions
     13    1.2    bouyer  * are met:
     14    1.2    bouyer  * 1. Redistributions of source code must retain the above copyright
     15    1.2    bouyer  *    notice, this list of conditions and the following disclaimer.
     16    1.2    bouyer  * 2. Redistributions in binary form must reproduce the above copyright
     17    1.2    bouyer  *    notice, this list of conditions and the following disclaimer in the
     18    1.2    bouyer  *    documentation and/or other materials provided with the distribution.
     19    1.2    bouyer  *
     20    1.8   mycroft  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     21    1.8   mycroft  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     22    1.8   mycroft  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     23    1.8   mycroft  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     24    1.8   mycroft  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     25    1.8   mycroft  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     26    1.8   mycroft  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     27    1.8   mycroft  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     28    1.8   mycroft  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     29    1.8   mycroft  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     30    1.8   mycroft  * POSSIBILITY OF SUCH DAMAGE.
     31    1.2    bouyer  */
     32   1.62     lukem 
     33   1.62     lukem #include <sys/cdefs.h>
     34  1.163  christos __KERNEL_RCSID(0, "$NetBSD: scsipi_base.c,v 1.163 2014/11/17 18:43:48 christos Exp $");
     35    1.2    bouyer 
     36   1.13    bouyer #include "opt_scsi.h"
     37   1.13    bouyer 
     38    1.2    bouyer #include <sys/param.h>
     39    1.2    bouyer #include <sys/systm.h>
     40    1.2    bouyer #include <sys/kernel.h>
     41    1.2    bouyer #include <sys/buf.h>
     42    1.2    bouyer #include <sys/uio.h>
     43    1.2    bouyer #include <sys/malloc.h>
     44    1.6   thorpej #include <sys/pool.h>
     45    1.2    bouyer #include <sys/errno.h>
     46    1.2    bouyer #include <sys/device.h>
     47    1.2    bouyer #include <sys/proc.h>
     48   1.39    bouyer #include <sys/kthread.h>
     49   1.74   thorpej #include <sys/hash.h>
     50  1.111       chs 
     51  1.127   thorpej #include <dev/scsipi/scsi_spc.h>
     52    1.2    bouyer #include <dev/scsipi/scsipi_all.h>
     53    1.2    bouyer #include <dev/scsipi/scsipi_disk.h>
     54    1.2    bouyer #include <dev/scsipi/scsipiconf.h>
     55    1.2    bouyer #include <dev/scsipi/scsipi_base.h>
     56    1.2    bouyer 
     57   1.39    bouyer #include <dev/scsipi/scsi_all.h>
     58   1.39    bouyer #include <dev/scsipi/scsi_message.h>
     59   1.39    bouyer 
     60  1.151     pooka #include <machine/param.h>
     61  1.151     pooka 
     62  1.108   thorpej static int	scsipi_complete(struct scsipi_xfer *);
     63  1.108   thorpej static void	scsipi_request_sense(struct scsipi_xfer *);
     64  1.108   thorpej static int	scsipi_enqueue(struct scsipi_xfer *);
     65  1.108   thorpej static void	scsipi_run_queue(struct scsipi_channel *chan);
     66  1.108   thorpej 
     67  1.108   thorpej static void	scsipi_completion_thread(void *);
     68  1.108   thorpej 
     69  1.108   thorpej static void	scsipi_get_tag(struct scsipi_xfer *);
     70  1.108   thorpej static void	scsipi_put_tag(struct scsipi_xfer *);
     71  1.108   thorpej 
     72  1.108   thorpej static int	scsipi_get_resource(struct scsipi_channel *);
     73  1.108   thorpej static void	scsipi_put_resource(struct scsipi_channel *);
     74  1.108   thorpej 
     75  1.108   thorpej static void	scsipi_async_event_max_openings(struct scsipi_channel *,
     76  1.108   thorpej 		    struct scsipi_max_openings *);
     77  1.108   thorpej static void	scsipi_async_event_channel_reset(struct scsipi_channel *);
     78   1.39    bouyer 
     79  1.108   thorpej static struct pool scsipi_xfer_pool;
     80    1.6   thorpej 
     81    1.2    bouyer /*
     82   1.39    bouyer  * scsipi_init:
     83   1.39    bouyer  *
     84   1.39    bouyer  *	Called when a scsibus or atapibus is attached to the system
     85   1.39    bouyer  *	to initialize shared data structures.
     86    1.6   thorpej  */
     87    1.6   thorpej void
     88  1.108   thorpej scsipi_init(void)
     89    1.6   thorpej {
     90    1.6   thorpej 	static int scsipi_init_done;
     91    1.6   thorpej 
     92    1.6   thorpej 	if (scsipi_init_done)
     93    1.6   thorpej 		return;
     94    1.6   thorpej 	scsipi_init_done = 1;
     95    1.6   thorpej 
     96    1.6   thorpej 	/* Initialize the scsipi_xfer pool. */
     97    1.6   thorpej 	pool_init(&scsipi_xfer_pool, sizeof(struct scsipi_xfer), 0,
     98  1.144        ad 	    0, 0, "scxspl", NULL, IPL_BIO);
     99  1.110    bouyer 	if (pool_prime(&scsipi_xfer_pool,
    100  1.110    bouyer 	    PAGE_SIZE / sizeof(struct scsipi_xfer)) == ENOMEM) {
    101  1.111       chs 		printf("WARNING: not enough memory for scsipi_xfer_pool\n");
    102  1.110    bouyer 	}
    103    1.6   thorpej }
    104    1.6   thorpej 
    105    1.6   thorpej /*
    106   1.39    bouyer  * scsipi_channel_init:
    107   1.39    bouyer  *
    108   1.39    bouyer  *	Initialize a scsipi_channel when it is attached.
    109   1.39    bouyer  */
    110   1.39    bouyer int
    111  1.108   thorpej scsipi_channel_init(struct scsipi_channel *chan)
    112   1.39    bouyer {
    113  1.145        ad 	struct scsipi_adapter *adapt = chan->chan_adapter;
    114   1.39    bouyer 	int i;
    115   1.39    bouyer 
    116   1.39    bouyer 	/* Initialize shared data. */
    117   1.39    bouyer 	scsipi_init();
    118   1.39    bouyer 
    119   1.39    bouyer 	/* Initialize the queues. */
    120   1.39    bouyer 	TAILQ_INIT(&chan->chan_queue);
    121   1.39    bouyer 	TAILQ_INIT(&chan->chan_complete);
    122   1.39    bouyer 
    123   1.74   thorpej 	for (i = 0; i < SCSIPI_CHAN_PERIPH_BUCKETS; i++)
    124   1.74   thorpej 		LIST_INIT(&chan->chan_periphtab[i]);
    125   1.39    bouyer 
    126   1.39    bouyer 	/*
    127   1.39    bouyer 	 * Create the asynchronous completion thread.
    128   1.39    bouyer 	 */
    129  1.145        ad 	if (kthread_create(PRI_NONE, 0, NULL, scsipi_completion_thread, chan,
    130  1.145        ad 	    &chan->chan_thread, "%s", chan->chan_name)) {
    131  1.146    cegger 		aprint_error_dev(adapt->adapt_dev, "unable to create completion thread for "
    132  1.146    cegger 		    "channel %d\n", chan->chan_channel);
    133  1.145        ad 		panic("scsipi_channel_init");
    134  1.145        ad 	}
    135  1.145        ad 
    136   1.39    bouyer 	return (0);
    137   1.39    bouyer }
    138   1.39    bouyer 
    139   1.39    bouyer /*
    140   1.39    bouyer  * scsipi_channel_shutdown:
    141   1.39    bouyer  *
    142   1.39    bouyer  *	Shutdown a scsipi_channel.
    143   1.39    bouyer  */
    144   1.39    bouyer void
    145  1.108   thorpej scsipi_channel_shutdown(struct scsipi_channel *chan)
    146   1.39    bouyer {
    147   1.39    bouyer 
    148   1.39    bouyer 	/*
    149   1.39    bouyer 	 * Shut down the completion thread.
    150   1.39    bouyer 	 */
    151   1.59    bouyer 	chan->chan_tflags |= SCSIPI_CHANT_SHUTDOWN;
    152   1.39    bouyer 	wakeup(&chan->chan_complete);
    153   1.39    bouyer 
    154   1.39    bouyer 	/*
    155   1.39    bouyer 	 * Now wait for the thread to exit.
    156   1.39    bouyer 	 */
    157   1.39    bouyer 	while (chan->chan_thread != NULL)
    158   1.39    bouyer 		(void) tsleep(&chan->chan_thread, PRIBIO, "scshut", 0);
    159   1.39    bouyer }
    160   1.39    bouyer 
    161   1.74   thorpej static uint32_t
    162   1.74   thorpej scsipi_chan_periph_hash(uint64_t t, uint64_t l)
    163   1.74   thorpej {
    164   1.74   thorpej 	uint32_t hash;
    165   1.74   thorpej 
    166   1.74   thorpej 	hash = hash32_buf(&t, sizeof(t), HASH32_BUF_INIT);
    167   1.74   thorpej 	hash = hash32_buf(&l, sizeof(l), hash);
    168   1.74   thorpej 
    169   1.74   thorpej 	return (hash & SCSIPI_CHAN_PERIPH_HASHMASK);
    170   1.74   thorpej }
    171   1.74   thorpej 
    172   1.39    bouyer /*
    173   1.39    bouyer  * scsipi_insert_periph:
    174   1.39    bouyer  *
    175   1.39    bouyer  *	Insert a periph into the channel.
    176   1.39    bouyer  */
    177   1.39    bouyer void
    178  1.108   thorpej scsipi_insert_periph(struct scsipi_channel *chan, struct scsipi_periph *periph)
    179   1.39    bouyer {
    180   1.74   thorpej 	uint32_t hash;
    181   1.39    bouyer 	int s;
    182   1.39    bouyer 
    183   1.74   thorpej 	hash = scsipi_chan_periph_hash(periph->periph_target,
    184   1.74   thorpej 	    periph->periph_lun);
    185   1.74   thorpej 
    186   1.39    bouyer 	s = splbio();
    187   1.74   thorpej 	LIST_INSERT_HEAD(&chan->chan_periphtab[hash], periph, periph_hash);
    188   1.39    bouyer 	splx(s);
    189   1.39    bouyer }
    190   1.39    bouyer 
    191   1.39    bouyer /*
    192   1.39    bouyer  * scsipi_remove_periph:
    193   1.39    bouyer  *
    194   1.39    bouyer  *	Remove a periph from the channel.
    195   1.39    bouyer  */
    196   1.39    bouyer void
    197  1.141  christos scsipi_remove_periph(struct scsipi_channel *chan,
    198  1.139  christos     struct scsipi_periph *periph)
    199   1.39    bouyer {
    200   1.39    bouyer 	int s;
    201   1.39    bouyer 
    202   1.39    bouyer 	s = splbio();
    203   1.74   thorpej 	LIST_REMOVE(periph, periph_hash);
    204   1.39    bouyer 	splx(s);
    205   1.39    bouyer }
    206   1.39    bouyer 
    207   1.39    bouyer /*
    208   1.39    bouyer  * scsipi_lookup_periph:
    209   1.39    bouyer  *
    210   1.39    bouyer  *	Lookup a periph on the specified channel.
    211   1.39    bouyer  */
    212   1.39    bouyer struct scsipi_periph *
    213  1.108   thorpej scsipi_lookup_periph(struct scsipi_channel *chan, int target, int lun)
    214   1.39    bouyer {
    215   1.39    bouyer 	struct scsipi_periph *periph;
    216   1.74   thorpej 	uint32_t hash;
    217   1.39    bouyer 	int s;
    218   1.39    bouyer 
    219  1.157    bouyer 	KASSERT(cold || KERNEL_LOCKED_P());
    220  1.156       mrg 
    221   1.39    bouyer 	if (target >= chan->chan_ntargets ||
    222   1.39    bouyer 	    lun >= chan->chan_nluns)
    223   1.39    bouyer 		return (NULL);
    224   1.39    bouyer 
    225   1.74   thorpej 	hash = scsipi_chan_periph_hash(target, lun);
    226   1.74   thorpej 
    227   1.39    bouyer 	s = splbio();
    228   1.74   thorpej 	LIST_FOREACH(periph, &chan->chan_periphtab[hash], periph_hash) {
    229   1.74   thorpej 		if (periph->periph_target == target &&
    230   1.74   thorpej 		    periph->periph_lun == lun)
    231   1.74   thorpej 			break;
    232   1.74   thorpej 	}
    233   1.39    bouyer 	splx(s);
    234   1.39    bouyer 
    235   1.39    bouyer 	return (periph);
    236   1.39    bouyer }
    237   1.39    bouyer 
    238   1.39    bouyer /*
    239   1.39    bouyer  * scsipi_get_resource:
    240   1.39    bouyer  *
    241   1.39    bouyer  *	Allocate a single xfer `resource' from the channel.
    242   1.39    bouyer  *
    243   1.39    bouyer  *	NOTE: Must be called at splbio().
    244   1.39    bouyer  */
    245  1.108   thorpej static int
    246  1.108   thorpej scsipi_get_resource(struct scsipi_channel *chan)
    247   1.39    bouyer {
    248   1.39    bouyer 	struct scsipi_adapter *adapt = chan->chan_adapter;
    249   1.39    bouyer 
    250   1.39    bouyer 	if (chan->chan_flags & SCSIPI_CHAN_OPENINGS) {
    251   1.39    bouyer 		if (chan->chan_openings > 0) {
    252   1.39    bouyer 			chan->chan_openings--;
    253   1.39    bouyer 			return (1);
    254   1.39    bouyer 		}
    255   1.39    bouyer 		return (0);
    256   1.39    bouyer 	}
    257   1.39    bouyer 
    258   1.39    bouyer 	if (adapt->adapt_openings > 0) {
    259   1.39    bouyer 		adapt->adapt_openings--;
    260   1.39    bouyer 		return (1);
    261   1.39    bouyer 	}
    262   1.39    bouyer 	return (0);
    263   1.39    bouyer }
    264   1.39    bouyer 
    265   1.39    bouyer /*
    266   1.39    bouyer  * scsipi_grow_resources:
    267   1.39    bouyer  *
    268   1.39    bouyer  *	Attempt to grow resources for a channel.  If this succeeds,
    269   1.39    bouyer  *	we allocate one for our caller.
    270   1.39    bouyer  *
    271   1.39    bouyer  *	NOTE: Must be called at splbio().
    272   1.39    bouyer  */
    273  1.133     perry static inline int
    274  1.108   thorpej scsipi_grow_resources(struct scsipi_channel *chan)
    275   1.39    bouyer {
    276   1.39    bouyer 
    277   1.39    bouyer 	if (chan->chan_flags & SCSIPI_CHAN_CANGROW) {
    278   1.60    bouyer 		if ((chan->chan_flags & SCSIPI_CHAN_TACTIVE) == 0) {
    279   1.60    bouyer 			scsipi_adapter_request(chan,
    280   1.60    bouyer 			    ADAPTER_REQ_GROW_RESOURCES, NULL);
    281   1.60    bouyer 			return (scsipi_get_resource(chan));
    282   1.60    bouyer 		}
    283   1.60    bouyer 		/*
    284   1.60    bouyer 		 * ask the channel thread to do it. It'll have to thaw the
    285   1.60    bouyer 		 * queue
    286   1.60    bouyer 		 */
    287   1.60    bouyer 		scsipi_channel_freeze(chan, 1);
    288   1.60    bouyer 		chan->chan_tflags |= SCSIPI_CHANT_GROWRES;
    289   1.60    bouyer 		wakeup(&chan->chan_complete);
    290   1.60    bouyer 		return (0);
    291   1.39    bouyer 	}
    292   1.39    bouyer 
    293   1.39    bouyer 	return (0);
    294   1.39    bouyer }
    295   1.39    bouyer 
    296   1.39    bouyer /*
    297   1.39    bouyer  * scsipi_put_resource:
    298   1.39    bouyer  *
    299   1.39    bouyer  *	Free a single xfer `resource' to the channel.
    300   1.39    bouyer  *
    301   1.39    bouyer  *	NOTE: Must be called at splbio().
    302   1.39    bouyer  */
    303  1.108   thorpej static void
    304  1.108   thorpej scsipi_put_resource(struct scsipi_channel *chan)
    305   1.39    bouyer {
    306   1.39    bouyer 	struct scsipi_adapter *adapt = chan->chan_adapter;
    307   1.39    bouyer 
    308   1.39    bouyer 	if (chan->chan_flags & SCSIPI_CHAN_OPENINGS)
    309   1.39    bouyer 		chan->chan_openings++;
    310   1.39    bouyer 	else
    311   1.39    bouyer 		adapt->adapt_openings++;
    312   1.39    bouyer }
    313   1.39    bouyer 
    314   1.39    bouyer /*
    315   1.39    bouyer  * scsipi_get_tag:
    316   1.39    bouyer  *
    317   1.39    bouyer  *	Get a tag ID for the specified xfer.
    318   1.39    bouyer  *
    319   1.39    bouyer  *	NOTE: Must be called at splbio().
    320   1.39    bouyer  */
    321  1.108   thorpej static void
    322  1.108   thorpej scsipi_get_tag(struct scsipi_xfer *xs)
    323   1.39    bouyer {
    324   1.39    bouyer 	struct scsipi_periph *periph = xs->xs_periph;
    325   1.81   thorpej 	int bit, tag;
    326  1.126   reinoud 	u_int word;
    327   1.39    bouyer 
    328   1.99    simonb 	bit = 0;	/* XXX gcc */
    329   1.39    bouyer 	for (word = 0; word < PERIPH_NTAGWORDS; word++) {
    330   1.39    bouyer 		bit = ffs(periph->periph_freetags[word]);
    331   1.39    bouyer 		if (bit != 0)
    332   1.39    bouyer 			break;
    333   1.39    bouyer 	}
    334   1.39    bouyer #ifdef DIAGNOSTIC
    335   1.39    bouyer 	if (word == PERIPH_NTAGWORDS) {
    336   1.39    bouyer 		scsipi_printaddr(periph);
    337   1.39    bouyer 		printf("no free tags\n");
    338   1.39    bouyer 		panic("scsipi_get_tag");
    339   1.39    bouyer 	}
    340   1.39    bouyer #endif
    341   1.39    bouyer 
    342   1.39    bouyer 	bit -= 1;
    343   1.39    bouyer 	periph->periph_freetags[word] &= ~(1 << bit);
    344   1.39    bouyer 	tag = (word << 5) | bit;
    345   1.39    bouyer 
    346   1.39    bouyer 	/* XXX Should eventually disallow this completely. */
    347   1.39    bouyer 	if (tag >= periph->periph_openings) {
    348   1.39    bouyer 		scsipi_printaddr(periph);
    349   1.39    bouyer 		printf("WARNING: tag %d greater than available openings %d\n",
    350   1.39    bouyer 		    tag, periph->periph_openings);
    351   1.39    bouyer 	}
    352   1.39    bouyer 
    353   1.39    bouyer 	xs->xs_tag_id = tag;
    354   1.39    bouyer }
    355   1.39    bouyer 
    356   1.39    bouyer /*
    357   1.39    bouyer  * scsipi_put_tag:
    358   1.39    bouyer  *
    359   1.39    bouyer  *	Put the tag ID for the specified xfer back into the pool.
    360   1.39    bouyer  *
    361   1.39    bouyer  *	NOTE: Must be called at splbio().
    362    1.2    bouyer  */
    363  1.108   thorpej static void
    364  1.108   thorpej scsipi_put_tag(struct scsipi_xfer *xs)
    365   1.39    bouyer {
    366   1.39    bouyer 	struct scsipi_periph *periph = xs->xs_periph;
    367   1.39    bouyer 	int word, bit;
    368   1.39    bouyer 
    369   1.39    bouyer 	word = xs->xs_tag_id >> 5;
    370   1.39    bouyer 	bit = xs->xs_tag_id & 0x1f;
    371   1.39    bouyer 
    372   1.39    bouyer 	periph->periph_freetags[word] |= (1 << bit);
    373   1.39    bouyer }
    374    1.2    bouyer 
    375   1.39    bouyer /*
    376   1.39    bouyer  * scsipi_get_xs:
    377   1.39    bouyer  *
    378   1.39    bouyer  *	Allocate an xfer descriptor and associate it with the
    379  1.160  dholland  *	specified peripheral.  If the peripheral has no more
    380   1.39    bouyer  *	available command openings, we either block waiting for
    381   1.39    bouyer  *	one to become available, or fail.
    382   1.39    bouyer  */
    383    1.2    bouyer struct scsipi_xfer *
    384  1.108   thorpej scsipi_get_xs(struct scsipi_periph *periph, int flags)
    385    1.2    bouyer {
    386    1.2    bouyer 	struct scsipi_xfer *xs;
    387    1.2    bouyer 	int s;
    388    1.2    bouyer 
    389   1.39    bouyer 	SC_DEBUG(periph, SCSIPI_DB3, ("scsipi_get_xs\n"));
    390    1.6   thorpej 
    391  1.119   mycroft 	KASSERT(!cold);
    392   1.24   thorpej 
    393   1.39    bouyer #ifdef DIAGNOSTIC
    394   1.39    bouyer 	/*
    395   1.39    bouyer 	 * URGENT commands can never be ASYNC.
    396   1.39    bouyer 	 */
    397   1.39    bouyer 	if ((flags & (XS_CTL_URGENT|XS_CTL_ASYNC)) ==
    398   1.39    bouyer 	    (XS_CTL_URGENT|XS_CTL_ASYNC)) {
    399   1.39    bouyer 		scsipi_printaddr(periph);
    400   1.39    bouyer 		printf("URGENT and ASYNC\n");
    401   1.39    bouyer 		panic("scsipi_get_xs");
    402   1.39    bouyer 	}
    403   1.39    bouyer #endif
    404   1.39    bouyer 
    405    1.2    bouyer 	s = splbio();
    406   1.39    bouyer 	/*
    407   1.39    bouyer 	 * Wait for a command opening to become available.  Rules:
    408   1.39    bouyer 	 *
    409   1.39    bouyer 	 *	- All xfers must wait for an available opening.
    410   1.39    bouyer 	 *	  Exception: URGENT xfers can proceed when
    411   1.39    bouyer 	 *	  active == openings, because we use the opening
    412   1.39    bouyer 	 *	  of the command we're recovering for.
    413   1.39    bouyer 	 *	- if the periph has sense pending, only URGENT & REQSENSE
    414   1.39    bouyer 	 *	  xfers may proceed.
    415   1.39    bouyer 	 *
    416   1.39    bouyer 	 *	- If the periph is recovering, only URGENT xfers may
    417   1.39    bouyer 	 *	  proceed.
    418   1.39    bouyer 	 *
    419   1.39    bouyer 	 *	- If the periph is currently executing a recovery
    420   1.39    bouyer 	 *	  command, URGENT commands must block, because only
    421   1.39    bouyer 	 *	  one recovery command can execute at a time.
    422   1.39    bouyer 	 */
    423   1.39    bouyer 	for (;;) {
    424   1.39    bouyer 		if (flags & XS_CTL_URGENT) {
    425   1.39    bouyer 			if (periph->periph_active > periph->periph_openings)
    426   1.39    bouyer 				goto wait_for_opening;
    427   1.39    bouyer 			if (periph->periph_flags & PERIPH_SENSE) {
    428   1.39    bouyer 				if ((flags & XS_CTL_REQSENSE) == 0)
    429   1.39    bouyer 					goto wait_for_opening;
    430   1.39    bouyer 			} else {
    431   1.39    bouyer 				if ((periph->periph_flags &
    432   1.39    bouyer 				    PERIPH_RECOVERY_ACTIVE) != 0)
    433   1.39    bouyer 					goto wait_for_opening;
    434   1.39    bouyer 				periph->periph_flags |= PERIPH_RECOVERY_ACTIVE;
    435   1.39    bouyer 			}
    436   1.39    bouyer 			break;
    437   1.39    bouyer 		}
    438   1.39    bouyer 		if (periph->periph_active >= periph->periph_openings ||
    439   1.39    bouyer 		    (periph->periph_flags & PERIPH_RECOVERING) != 0)
    440   1.39    bouyer 			goto wait_for_opening;
    441   1.39    bouyer 		periph->periph_active++;
    442   1.39    bouyer 		break;
    443   1.39    bouyer 
    444   1.39    bouyer  wait_for_opening:
    445   1.39    bouyer 		if (flags & XS_CTL_NOSLEEP) {
    446    1.2    bouyer 			splx(s);
    447   1.39    bouyer 			return (NULL);
    448    1.2    bouyer 		}
    449   1.39    bouyer 		SC_DEBUG(periph, SCSIPI_DB3, ("sleeping\n"));
    450   1.39    bouyer 		periph->periph_flags |= PERIPH_WAITING;
    451   1.39    bouyer 		(void) tsleep(periph, PRIBIO, "getxs", 0);
    452    1.2    bouyer 	}
    453   1.39    bouyer 	SC_DEBUG(periph, SCSIPI_DB3, ("calling pool_get\n"));
    454    1.6   thorpej 	xs = pool_get(&scsipi_xfer_pool,
    455   1.24   thorpej 	    ((flags & XS_CTL_NOSLEEP) != 0 ? PR_NOWAIT : PR_WAITOK));
    456   1.39    bouyer 	if (xs == NULL) {
    457   1.39    bouyer 		if (flags & XS_CTL_URGENT) {
    458   1.39    bouyer 			if ((flags & XS_CTL_REQSENSE) == 0)
    459   1.39    bouyer 				periph->periph_flags &= ~PERIPH_RECOVERY_ACTIVE;
    460   1.39    bouyer 		} else
    461   1.39    bouyer 			periph->periph_active--;
    462   1.39    bouyer 		scsipi_printaddr(periph);
    463   1.39    bouyer 		printf("unable to allocate %sscsipi_xfer\n",
    464   1.39    bouyer 		    (flags & XS_CTL_URGENT) ? "URGENT " : "");
    465    1.2    bouyer 	}
    466    1.6   thorpej 	splx(s);
    467    1.2    bouyer 
    468   1.39    bouyer 	SC_DEBUG(periph, SCSIPI_DB3, ("returning\n"));
    469    1.6   thorpej 
    470    1.7    scottr 	if (xs != NULL) {
    471  1.101   thorpej 		memset(xs, 0, sizeof(*xs));
    472  1.145        ad 		callout_init(&xs->xs_callout, 0);
    473   1.39    bouyer 		xs->xs_periph = periph;
    474   1.24   thorpej 		xs->xs_control = flags;
    475   1.37      fvdl 		xs->xs_status = 0;
    476   1.39    bouyer 		s = splbio();
    477   1.39    bouyer 		TAILQ_INSERT_TAIL(&periph->periph_xferq, xs, device_q);
    478   1.39    bouyer 		splx(s);
    479    1.7    scottr 	}
    480    1.3     enami 	return (xs);
    481    1.2    bouyer }
    482    1.2    bouyer 
    483    1.2    bouyer /*
    484   1.39    bouyer  * scsipi_put_xs:
    485   1.39    bouyer  *
    486   1.39    bouyer  *	Release an xfer descriptor, decreasing the outstanding command
    487  1.160  dholland  *	count for the peripheral.  If there is a thread waiting for
    488   1.39    bouyer  *	an opening, wake it up.  If not, kick any queued I/O the
    489  1.160  dholland  *	peripheral may have.
    490    1.6   thorpej  *
    491   1.39    bouyer  *	NOTE: Must be called at splbio().
    492    1.2    bouyer  */
    493    1.3     enami void
    494  1.108   thorpej scsipi_put_xs(struct scsipi_xfer *xs)
    495    1.2    bouyer {
    496   1.39    bouyer 	struct scsipi_periph *periph = xs->xs_periph;
    497   1.39    bouyer 	int flags = xs->xs_control;
    498   1.39    bouyer 
    499   1.39    bouyer 	SC_DEBUG(periph, SCSIPI_DB3, ("scsipi_free_xs\n"));
    500    1.2    bouyer 
    501   1.39    bouyer 	TAILQ_REMOVE(&periph->periph_xferq, xs, device_q);
    502  1.149    dyoung 	callout_destroy(&xs->xs_callout);
    503   1.39    bouyer 	pool_put(&scsipi_xfer_pool, xs);
    504   1.39    bouyer 
    505   1.39    bouyer #ifdef DIAGNOSTIC
    506   1.39    bouyer 	if ((periph->periph_flags & PERIPH_RECOVERY_ACTIVE) != 0 &&
    507   1.39    bouyer 	    periph->periph_active == 0) {
    508   1.39    bouyer 		scsipi_printaddr(periph);
    509   1.39    bouyer 		printf("recovery without a command to recovery for\n");
    510   1.39    bouyer 		panic("scsipi_put_xs");
    511   1.39    bouyer 	}
    512   1.39    bouyer #endif
    513   1.39    bouyer 
    514   1.39    bouyer 	if (flags & XS_CTL_URGENT) {
    515   1.39    bouyer 		if ((flags & XS_CTL_REQSENSE) == 0)
    516   1.39    bouyer 			periph->periph_flags &= ~PERIPH_RECOVERY_ACTIVE;
    517   1.39    bouyer 	} else
    518   1.39    bouyer 		periph->periph_active--;
    519   1.39    bouyer 	if (periph->periph_active == 0 &&
    520   1.39    bouyer 	    (periph->periph_flags & PERIPH_WAITDRAIN) != 0) {
    521   1.39    bouyer 		periph->periph_flags &= ~PERIPH_WAITDRAIN;
    522   1.39    bouyer 		wakeup(&periph->periph_active);
    523   1.16   thorpej 	}
    524    1.2    bouyer 
    525   1.39    bouyer 	if (periph->periph_flags & PERIPH_WAITING) {
    526   1.39    bouyer 		periph->periph_flags &= ~PERIPH_WAITING;
    527   1.39    bouyer 		wakeup(periph);
    528    1.2    bouyer 	} else {
    529  1.106    bouyer 		if (periph->periph_switch->psw_start != NULL &&
    530  1.134   thorpej 		    device_is_active(periph->periph_dev)) {
    531   1.39    bouyer 			SC_DEBUG(periph, SCSIPI_DB2,
    532    1.3     enami 			    ("calling private start()\n"));
    533   1.39    bouyer 			(*periph->periph_switch->psw_start)(periph);
    534    1.2    bouyer 		}
    535    1.2    bouyer 	}
    536   1.15   thorpej }
    537   1.15   thorpej 
    538   1.15   thorpej /*
    539   1.39    bouyer  * scsipi_channel_freeze:
    540   1.39    bouyer  *
    541   1.39    bouyer  *	Freeze a channel's xfer queue.
    542   1.39    bouyer  */
    543   1.39    bouyer void
    544  1.108   thorpej scsipi_channel_freeze(struct scsipi_channel *chan, int count)
    545   1.39    bouyer {
    546   1.39    bouyer 	int s;
    547   1.39    bouyer 
    548   1.39    bouyer 	s = splbio();
    549   1.39    bouyer 	chan->chan_qfreeze += count;
    550   1.39    bouyer 	splx(s);
    551   1.39    bouyer }
    552   1.39    bouyer 
    553   1.39    bouyer /*
    554   1.39    bouyer  * scsipi_channel_thaw:
    555   1.39    bouyer  *
    556   1.39    bouyer  *	Thaw a channel's xfer queue.
    557   1.39    bouyer  */
    558   1.39    bouyer void
    559  1.108   thorpej scsipi_channel_thaw(struct scsipi_channel *chan, int count)
    560   1.39    bouyer {
    561   1.39    bouyer 	int s;
    562   1.39    bouyer 
    563   1.39    bouyer 	s = splbio();
    564   1.39    bouyer 	chan->chan_qfreeze -= count;
    565   1.39    bouyer 	/*
    566   1.39    bouyer 	 * Don't let the freeze count go negative.
    567   1.39    bouyer 	 *
    568   1.39    bouyer 	 * Presumably the adapter driver could keep track of this,
    569   1.39    bouyer 	 * but it might just be easier to do this here so as to allow
    570   1.39    bouyer 	 * multiple callers, including those outside the adapter driver.
    571   1.39    bouyer 	 */
    572   1.39    bouyer 	if (chan->chan_qfreeze < 0) {
    573   1.39    bouyer 		chan->chan_qfreeze = 0;
    574   1.39    bouyer 	}
    575   1.39    bouyer 	splx(s);
    576   1.44    bouyer 	/*
    577   1.44    bouyer 	 * Kick the channel's queue here.  Note, we may be running in
    578   1.44    bouyer 	 * interrupt context (softclock or HBA's interrupt), so the adapter
    579   1.44    bouyer 	 * driver had better not sleep.
    580   1.44    bouyer 	 */
    581   1.44    bouyer 	if (chan->chan_qfreeze == 0)
    582   1.44    bouyer 		scsipi_run_queue(chan);
    583   1.39    bouyer }
    584   1.39    bouyer 
    585   1.39    bouyer /*
    586   1.39    bouyer  * scsipi_channel_timed_thaw:
    587   1.39    bouyer  *
    588   1.44    bouyer  *	Thaw a channel after some time has expired. This will also
    589   1.44    bouyer  * 	run the channel's queue if the freeze count has reached 0.
    590   1.39    bouyer  */
    591   1.39    bouyer void
    592  1.108   thorpej scsipi_channel_timed_thaw(void *arg)
    593   1.39    bouyer {
    594   1.39    bouyer 	struct scsipi_channel *chan = arg;
    595   1.39    bouyer 
    596   1.39    bouyer 	scsipi_channel_thaw(chan, 1);
    597   1.39    bouyer }
    598   1.39    bouyer 
    599   1.39    bouyer /*
    600   1.39    bouyer  * scsipi_periph_freeze:
    601   1.39    bouyer  *
    602   1.39    bouyer  *	Freeze a device's xfer queue.
    603   1.39    bouyer  */
    604   1.39    bouyer void
    605  1.108   thorpej scsipi_periph_freeze(struct scsipi_periph *periph, int count)
    606   1.39    bouyer {
    607   1.39    bouyer 	int s;
    608   1.39    bouyer 
    609   1.39    bouyer 	s = splbio();
    610   1.39    bouyer 	periph->periph_qfreeze += count;
    611   1.39    bouyer 	splx(s);
    612   1.39    bouyer }
    613   1.39    bouyer 
    614   1.39    bouyer /*
    615   1.39    bouyer  * scsipi_periph_thaw:
    616   1.39    bouyer  *
    617   1.39    bouyer  *	Thaw a device's xfer queue.
    618   1.39    bouyer  */
    619   1.39    bouyer void
    620  1.108   thorpej scsipi_periph_thaw(struct scsipi_periph *periph, int count)
    621   1.39    bouyer {
    622   1.39    bouyer 	int s;
    623   1.39    bouyer 
    624   1.39    bouyer 	s = splbio();
    625   1.39    bouyer 	periph->periph_qfreeze -= count;
    626   1.58    mjacob #ifdef DIAGNOSTIC
    627   1.58    mjacob 	if (periph->periph_qfreeze < 0) {
    628   1.58    mjacob 		static const char pc[] = "periph freeze count < 0";
    629   1.58    mjacob 		scsipi_printaddr(periph);
    630   1.58    mjacob 		printf("%s\n", pc);
    631   1.58    mjacob 		panic(pc);
    632   1.58    mjacob 	}
    633   1.58    mjacob #endif
    634   1.39    bouyer 	if (periph->periph_qfreeze == 0 &&
    635   1.39    bouyer 	    (periph->periph_flags & PERIPH_WAITING) != 0)
    636   1.39    bouyer 		wakeup(periph);
    637   1.39    bouyer 	splx(s);
    638   1.39    bouyer }
    639   1.39    bouyer 
    640   1.39    bouyer /*
    641   1.39    bouyer  * scsipi_periph_timed_thaw:
    642   1.39    bouyer  *
    643   1.39    bouyer  *	Thaw a device after some time has expired.
    644   1.39    bouyer  */
    645   1.39    bouyer void
    646  1.108   thorpej scsipi_periph_timed_thaw(void *arg)
    647   1.39    bouyer {
    648   1.58    mjacob 	int s;
    649   1.39    bouyer 	struct scsipi_periph *periph = arg;
    650   1.39    bouyer 
    651   1.39    bouyer 	callout_stop(&periph->periph_callout);
    652   1.58    mjacob 
    653   1.58    mjacob 	s = splbio();
    654   1.39    bouyer 	scsipi_periph_thaw(periph, 1);
    655   1.58    mjacob 	if ((periph->periph_channel->chan_flags & SCSIPI_CHAN_TACTIVE) == 0) {
    656   1.58    mjacob 		/*
    657   1.58    mjacob 		 * Kick the channel's queue here.  Note, we're running in
    658   1.58    mjacob 		 * interrupt context (softclock), so the adapter driver
    659   1.58    mjacob 		 * had better not sleep.
    660   1.58    mjacob 		 */
    661   1.58    mjacob 		scsipi_run_queue(periph->periph_channel);
    662   1.58    mjacob 	} else {
    663   1.58    mjacob 		/*
    664   1.58    mjacob 		 * Tell the completion thread to kick the channel's queue here.
    665   1.58    mjacob 		 */
    666   1.59    bouyer 		periph->periph_channel->chan_tflags |= SCSIPI_CHANT_KICK;
    667   1.58    mjacob 		wakeup(&periph->periph_channel->chan_complete);
    668   1.58    mjacob 	}
    669   1.58    mjacob 	splx(s);
    670   1.39    bouyer }
    671   1.39    bouyer 
    672   1.39    bouyer /*
    673   1.39    bouyer  * scsipi_wait_drain:
    674   1.39    bouyer  *
    675   1.39    bouyer  *	Wait for a periph's pending xfers to drain.
    676   1.15   thorpej  */
    677   1.15   thorpej void
    678  1.108   thorpej scsipi_wait_drain(struct scsipi_periph *periph)
    679   1.15   thorpej {
    680   1.15   thorpej 	int s;
    681   1.15   thorpej 
    682   1.15   thorpej 	s = splbio();
    683   1.39    bouyer 	while (periph->periph_active != 0) {
    684   1.39    bouyer 		periph->periph_flags |= PERIPH_WAITDRAIN;
    685   1.39    bouyer 		(void) tsleep(&periph->periph_active, PRIBIO, "sxdrn", 0);
    686   1.15   thorpej 	}
    687   1.15   thorpej 	splx(s);
    688   1.23   thorpej }
    689   1.23   thorpej 
    690   1.23   thorpej /*
    691   1.39    bouyer  * scsipi_kill_pending:
    692   1.39    bouyer  *
    693   1.39    bouyer  *	Kill off all pending xfers for a periph.
    694   1.23   thorpej  *
    695   1.39    bouyer  *	NOTE: Must be called at splbio().
    696   1.23   thorpej  */
    697   1.23   thorpej void
    698  1.108   thorpej scsipi_kill_pending(struct scsipi_periph *periph)
    699   1.23   thorpej {
    700   1.23   thorpej 
    701   1.39    bouyer 	(*periph->periph_channel->chan_bustype->bustype_kill_pending)(periph);
    702   1.39    bouyer 	scsipi_wait_drain(periph);
    703    1.2    bouyer }
    704    1.2    bouyer 
    705    1.2    bouyer /*
    706  1.104    bouyer  * scsipi_print_cdb:
    707  1.104    bouyer  * prints a command descriptor block (for debug purpose, error messages,
    708  1.152  pgoyette  * SCSIVERBOSE, ...)
    709  1.103    bouyer  */
    710  1.103    bouyer void
    711  1.108   thorpej scsipi_print_cdb(struct scsipi_generic *cmd)
    712  1.103    bouyer {
    713  1.103    bouyer 	int i, j;
    714  1.103    bouyer 
    715  1.103    bouyer  	printf("0x%02x", cmd->opcode);
    716  1.103    bouyer 
    717  1.103    bouyer  	switch (CDB_GROUPID(cmd->opcode)) {
    718  1.103    bouyer  	case CDB_GROUPID_0:
    719  1.103    bouyer  		j = CDB_GROUP0;
    720  1.103    bouyer  		break;
    721  1.103    bouyer  	case CDB_GROUPID_1:
    722  1.103    bouyer  		j = CDB_GROUP1;
    723  1.103    bouyer  		break;
    724  1.103    bouyer  	case CDB_GROUPID_2:
    725  1.103    bouyer  		j = CDB_GROUP2;
    726  1.103    bouyer  		break;
    727  1.103    bouyer  	case CDB_GROUPID_3:
    728  1.103    bouyer  		j = CDB_GROUP3;
    729  1.103    bouyer  		break;
    730  1.103    bouyer  	case CDB_GROUPID_4:
    731  1.103    bouyer  		j = CDB_GROUP4;
    732  1.103    bouyer  		break;
    733  1.103    bouyer  	case CDB_GROUPID_5:
    734  1.103    bouyer  		j = CDB_GROUP5;
    735  1.103    bouyer  		break;
    736  1.103    bouyer  	case CDB_GROUPID_6:
    737  1.103    bouyer  		j = CDB_GROUP6;
    738  1.103    bouyer  		break;
    739  1.103    bouyer  	case CDB_GROUPID_7:
    740  1.103    bouyer  		j = CDB_GROUP7;
    741  1.103    bouyer  		break;
    742  1.103    bouyer  	default:
    743  1.103    bouyer  		j = 0;
    744  1.103    bouyer  	}
    745  1.103    bouyer  	if (j == 0)
    746  1.103    bouyer  		j = sizeof (cmd->bytes);
    747  1.103    bouyer  	for (i = 0; i < j-1; i++) /* already done the opcode */
    748  1.103    bouyer  		printf(" %02x", cmd->bytes[i]);
    749  1.103    bouyer }
    750  1.103    bouyer 
    751  1.103    bouyer /*
    752   1.39    bouyer  * scsipi_interpret_sense:
    753   1.39    bouyer  *
    754   1.39    bouyer  *	Look at the returned sense and act on the error, determining
    755   1.39    bouyer  *	the unix error number to pass back.  (0 = report no error)
    756   1.39    bouyer  *
    757   1.39    bouyer  *	NOTE: If we return ERESTART, we are expected to haved
    758   1.39    bouyer  *	thawed the device!
    759   1.13    bouyer  *
    760   1.39    bouyer  *	THIS IS THE DEFAULT ERROR HANDLER FOR SCSI DEVICES.
    761   1.13    bouyer  */
    762   1.13    bouyer int
    763  1.108   thorpej scsipi_interpret_sense(struct scsipi_xfer *xs)
    764   1.13    bouyer {
    765  1.127   thorpej 	struct scsi_sense_data *sense;
    766   1.39    bouyer 	struct scsipi_periph *periph = xs->xs_periph;
    767  1.126   reinoud 	u_int8_t key;
    768   1.13    bouyer 	int error;
    769  1.126   reinoud 	u_int32_t info;
    770  1.131   xtraeme 	static const char *error_mes[] = {
    771   1.13    bouyer 		"soft error (corrected)",
    772   1.13    bouyer 		"not ready", "medium error",
    773   1.13    bouyer 		"non-media hardware failure", "illegal request",
    774   1.13    bouyer 		"unit attention", "readonly device",
    775   1.13    bouyer 		"no data found", "vendor unique",
    776   1.13    bouyer 		"copy aborted", "command aborted",
    777   1.13    bouyer 		"search returned equal", "volume overflow",
    778   1.13    bouyer 		"verify miscompare", "unknown error key"
    779   1.13    bouyer 	};
    780   1.13    bouyer 
    781   1.13    bouyer 	sense = &xs->sense.scsi_sense;
    782   1.39    bouyer #ifdef SCSIPI_DEBUG
    783   1.39    bouyer 	if (periph->periph_flags & SCSIPI_DB1) {
    784   1.13    bouyer 		int count;
    785   1.39    bouyer 		scsipi_printaddr(periph);
    786   1.39    bouyer 		printf(" sense debug information:\n");
    787  1.127   thorpej 		printf("\tcode 0x%x valid %d\n",
    788  1.127   thorpej 			SSD_RCODE(sense->response_code),
    789  1.127   thorpej 			sense->response_code & SSD_RCODE_VALID ? 1 : 0);
    790   1.39    bouyer 		printf("\tseg 0x%x key 0x%x ili 0x%x eom 0x%x fmark 0x%x\n",
    791   1.13    bouyer 			sense->segment,
    792  1.127   thorpej 			SSD_SENSE_KEY(sense->flags),
    793   1.13    bouyer 			sense->flags & SSD_ILI ? 1 : 0,
    794   1.13    bouyer 			sense->flags & SSD_EOM ? 1 : 0,
    795   1.13    bouyer 			sense->flags & SSD_FILEMARK ? 1 : 0);
    796   1.39    bouyer 		printf("\ninfo: 0x%x 0x%x 0x%x 0x%x followed by %d "
    797   1.39    bouyer 			"extra bytes\n",
    798   1.13    bouyer 			sense->info[0],
    799   1.13    bouyer 			sense->info[1],
    800   1.13    bouyer 			sense->info[2],
    801   1.13    bouyer 			sense->info[3],
    802   1.13    bouyer 			sense->extra_len);
    803   1.39    bouyer 		printf("\textra: ");
    804  1.127   thorpej 		for (count = 0; count < SSD_ADD_BYTES_LIM(sense); count++)
    805  1.127   thorpej 			printf("0x%x ", sense->csi[count]);
    806   1.13    bouyer 		printf("\n");
    807   1.13    bouyer 	}
    808   1.39    bouyer #endif
    809   1.39    bouyer 
    810   1.13    bouyer 	/*
    811  1.162       snj 	 * If the periph has its own error handler, call it first.
    812   1.13    bouyer 	 * If it returns a legit error value, return that, otherwise
    813   1.13    bouyer 	 * it wants us to continue with normal error processing.
    814   1.13    bouyer 	 */
    815   1.39    bouyer 	if (periph->periph_switch->psw_error != NULL) {
    816   1.39    bouyer 		SC_DEBUG(periph, SCSIPI_DB2,
    817   1.13    bouyer 		    ("calling private err_handler()\n"));
    818   1.39    bouyer 		error = (*periph->periph_switch->psw_error)(xs);
    819   1.39    bouyer 		if (error != EJUSTRETURN)
    820   1.39    bouyer 			return (error);
    821   1.13    bouyer 	}
    822   1.13    bouyer 	/* otherwise use the default */
    823  1.127   thorpej 	switch (SSD_RCODE(sense->response_code)) {
    824   1.64  fredette 
    825   1.64  fredette 		/*
    826   1.64  fredette 		 * Old SCSI-1 and SASI devices respond with
    827   1.64  fredette 		 * codes other than 70.
    828   1.64  fredette 		 */
    829   1.64  fredette 	case 0x00:		/* no error (command completed OK) */
    830   1.64  fredette 		return (0);
    831   1.64  fredette 	case 0x04:		/* drive not ready after it was selected */
    832   1.64  fredette 		if ((periph->periph_flags & PERIPH_REMOVABLE) != 0)
    833   1.64  fredette 			periph->periph_flags &= ~PERIPH_MEDIA_LOADED;
    834   1.64  fredette 		if ((xs->xs_control & XS_CTL_IGNORE_NOT_READY) != 0)
    835   1.64  fredette 			return (0);
    836   1.64  fredette 		/* XXX - display some sort of error here? */
    837   1.64  fredette 		return (EIO);
    838   1.64  fredette 	case 0x20:		/* invalid command */
    839   1.64  fredette 		if ((xs->xs_control &
    840   1.64  fredette 		     XS_CTL_IGNORE_ILLEGAL_REQUEST) != 0)
    841   1.64  fredette 			return (0);
    842   1.64  fredette 		return (EINVAL);
    843   1.64  fredette 	case 0x25:		/* invalid LUN (Adaptec ACB-4000) */
    844   1.64  fredette 		return (EACCES);
    845   1.64  fredette 
    846   1.13    bouyer 		/*
    847   1.13    bouyer 		 * If it's code 70, use the extended stuff and
    848   1.13    bouyer 		 * interpret the key
    849   1.13    bouyer 		 */
    850   1.13    bouyer 	case 0x71:		/* delayed error */
    851   1.39    bouyer 		scsipi_printaddr(periph);
    852  1.127   thorpej 		key = SSD_SENSE_KEY(sense->flags);
    853   1.13    bouyer 		printf(" DEFERRED ERROR, key = 0x%x\n", key);
    854   1.13    bouyer 		/* FALLTHROUGH */
    855   1.13    bouyer 	case 0x70:
    856  1.127   thorpej 		if ((sense->response_code & SSD_RCODE_VALID) != 0)
    857   1.13    bouyer 			info = _4btol(sense->info);
    858   1.13    bouyer 		else
    859   1.13    bouyer 			info = 0;
    860  1.127   thorpej 		key = SSD_SENSE_KEY(sense->flags);
    861   1.13    bouyer 
    862   1.13    bouyer 		switch (key) {
    863   1.13    bouyer 		case SKEY_NO_SENSE:
    864   1.13    bouyer 		case SKEY_RECOVERED_ERROR:
    865   1.13    bouyer 			if (xs->resid == xs->datalen && xs->datalen) {
    866   1.13    bouyer 				/*
    867   1.13    bouyer 				 * Why is this here?
    868   1.13    bouyer 				 */
    869   1.13    bouyer 				xs->resid = 0;	/* not short read */
    870   1.13    bouyer 			}
    871   1.13    bouyer 		case SKEY_EQUAL:
    872   1.13    bouyer 			error = 0;
    873   1.13    bouyer 			break;
    874   1.13    bouyer 		case SKEY_NOT_READY:
    875   1.39    bouyer 			if ((periph->periph_flags & PERIPH_REMOVABLE) != 0)
    876   1.39    bouyer 				periph->periph_flags &= ~PERIPH_MEDIA_LOADED;
    877   1.24   thorpej 			if ((xs->xs_control & XS_CTL_IGNORE_NOT_READY) != 0)
    878   1.13    bouyer 				return (0);
    879  1.127   thorpej 			if (sense->asc == 0x3A) {
    880   1.19    bouyer 				error = ENODEV; /* Medium not present */
    881   1.46    bouyer 				if (xs->xs_control & XS_CTL_SILENT_NODEV)
    882   1.46    bouyer 					return (error);
    883   1.46    bouyer 			} else
    884   1.19    bouyer 				error = EIO;
    885   1.24   thorpej 			if ((xs->xs_control & XS_CTL_SILENT) != 0)
    886   1.19    bouyer 				return (error);
    887   1.13    bouyer 			break;
    888   1.13    bouyer 		case SKEY_ILLEGAL_REQUEST:
    889   1.24   thorpej 			if ((xs->xs_control &
    890   1.24   thorpej 			     XS_CTL_IGNORE_ILLEGAL_REQUEST) != 0)
    891   1.13    bouyer 				return (0);
    892   1.24   thorpej 			/*
    893   1.24   thorpej 			 * Handle the case where a device reports
    894   1.24   thorpej 			 * Logical Unit Not Supported during discovery.
    895   1.24   thorpej 			 */
    896   1.24   thorpej 			if ((xs->xs_control & XS_CTL_DISCOVERY) != 0 &&
    897  1.127   thorpej 			    sense->asc == 0x25 &&
    898  1.127   thorpej 			    sense->ascq == 0x00)
    899   1.24   thorpej 				return (EINVAL);
    900   1.24   thorpej 			if ((xs->xs_control & XS_CTL_SILENT) != 0)
    901   1.13    bouyer 				return (EIO);
    902   1.13    bouyer 			error = EINVAL;
    903   1.13    bouyer 			break;
    904   1.13    bouyer 		case SKEY_UNIT_ATTENTION:
    905  1.127   thorpej 			if (sense->asc == 0x29 &&
    906  1.127   thorpej 			    sense->ascq == 0x00) {
    907   1.39    bouyer 				/* device or bus reset */
    908  1.105    bouyer 				return (ERESTART);
    909   1.39    bouyer 			}
    910   1.39    bouyer 			if ((periph->periph_flags & PERIPH_REMOVABLE) != 0)
    911   1.39    bouyer 				periph->periph_flags &= ~PERIPH_MEDIA_LOADED;
    912   1.24   thorpej 			if ((xs->xs_control &
    913   1.24   thorpej 			     XS_CTL_IGNORE_MEDIA_CHANGE) != 0 ||
    914   1.13    bouyer 				/* XXX Should reupload any transient state. */
    915   1.39    bouyer 				(periph->periph_flags &
    916   1.39    bouyer 				 PERIPH_REMOVABLE) == 0) {
    917   1.13    bouyer 				return (ERESTART);
    918   1.39    bouyer 			}
    919   1.24   thorpej 			if ((xs->xs_control & XS_CTL_SILENT) != 0)
    920   1.13    bouyer 				return (EIO);
    921   1.13    bouyer 			error = EIO;
    922   1.13    bouyer 			break;
    923  1.127   thorpej 		case SKEY_DATA_PROTECT:
    924   1.13    bouyer 			error = EROFS;
    925   1.13    bouyer 			break;
    926   1.13    bouyer 		case SKEY_BLANK_CHECK:
    927   1.13    bouyer 			error = 0;
    928   1.13    bouyer 			break;
    929   1.13    bouyer 		case SKEY_ABORTED_COMMAND:
    930  1.102    bouyer 			if (xs->xs_retries != 0) {
    931  1.102    bouyer 				xs->xs_retries--;
    932  1.102    bouyer 				error = ERESTART;
    933  1.102    bouyer 			} else
    934  1.102    bouyer 				error = EIO;
    935   1.13    bouyer 			break;
    936   1.13    bouyer 		case SKEY_VOLUME_OVERFLOW:
    937   1.13    bouyer 			error = ENOSPC;
    938   1.13    bouyer 			break;
    939   1.13    bouyer 		default:
    940   1.13    bouyer 			error = EIO;
    941   1.13    bouyer 			break;
    942   1.13    bouyer 		}
    943   1.13    bouyer 
    944  1.152  pgoyette 		/* Print verbose decode if appropriate and possible */
    945  1.152  pgoyette 		if ((key == 0) ||
    946  1.152  pgoyette 		    ((xs->xs_control & XS_CTL_SILENT) != 0) ||
    947  1.152  pgoyette 		    (scsipi_print_sense(xs, 0) != 0))
    948  1.152  pgoyette 			return (error);
    949  1.152  pgoyette 
    950  1.152  pgoyette 		/* Print brief(er) sense information */
    951  1.152  pgoyette 		scsipi_printaddr(periph);
    952  1.152  pgoyette 		printf("%s", error_mes[key - 1]);
    953  1.152  pgoyette 		if ((sense->response_code & SSD_RCODE_VALID) != 0) {
    954  1.152  pgoyette 			switch (key) {
    955  1.152  pgoyette 			case SKEY_NOT_READY:
    956  1.152  pgoyette 			case SKEY_ILLEGAL_REQUEST:
    957  1.152  pgoyette 			case SKEY_UNIT_ATTENTION:
    958  1.152  pgoyette 			case SKEY_DATA_PROTECT:
    959  1.152  pgoyette 				break;
    960  1.152  pgoyette 			case SKEY_BLANK_CHECK:
    961  1.152  pgoyette 				printf(", requested size: %d (decimal)",
    962  1.152  pgoyette 				    info);
    963  1.152  pgoyette 				break;
    964  1.152  pgoyette 			case SKEY_ABORTED_COMMAND:
    965  1.152  pgoyette 				if (xs->xs_retries)
    966  1.152  pgoyette 					printf(", retrying");
    967  1.152  pgoyette 				printf(", cmd 0x%x, info 0x%x",
    968  1.152  pgoyette 				    xs->cmd->opcode, info);
    969  1.152  pgoyette 				break;
    970  1.152  pgoyette 			default:
    971  1.152  pgoyette 				printf(", info = %d (decimal)", info);
    972   1.13    bouyer 			}
    973   1.13    bouyer 		}
    974  1.152  pgoyette 		if (sense->extra_len != 0) {
    975  1.152  pgoyette 			int n;
    976  1.152  pgoyette 			printf(", data =");
    977  1.152  pgoyette 			for (n = 0; n < sense->extra_len; n++)
    978  1.152  pgoyette 				printf(" %02x",
    979  1.152  pgoyette 				    sense->csi[n]);
    980  1.152  pgoyette 		}
    981  1.152  pgoyette 		printf("\n");
    982   1.13    bouyer 		return (error);
    983   1.13    bouyer 
    984   1.13    bouyer 	/*
    985   1.64  fredette 	 * Some other code, just report it
    986   1.13    bouyer 	 */
    987   1.13    bouyer 	default:
    988   1.39    bouyer #if    defined(SCSIDEBUG) || defined(DEBUG)
    989   1.28    mjacob 	{
    990  1.130  christos 		static const char *uc = "undecodable sense error";
    991   1.28    mjacob 		int i;
    992  1.126   reinoud 		u_int8_t *cptr = (u_int8_t *) sense;
    993   1.39    bouyer 		scsipi_printaddr(periph);
    994   1.28    mjacob 		if (xs->cmd == &xs->cmdstore) {
    995   1.28    mjacob 			printf("%s for opcode 0x%x, data=",
    996   1.28    mjacob 			    uc, xs->cmdstore.opcode);
    997   1.28    mjacob 		} else {
    998   1.28    mjacob 			printf("%s, data=", uc);
    999   1.28    mjacob 		}
   1000   1.28    mjacob 		for (i = 0; i < sizeof (sense); i++)
   1001   1.28    mjacob 			printf(" 0x%02x", *(cptr++) & 0xff);
   1002   1.28    mjacob 		printf("\n");
   1003   1.28    mjacob 	}
   1004   1.28    mjacob #else
   1005   1.39    bouyer 		scsipi_printaddr(periph);
   1006   1.17    mjacob 		printf("Sense Error Code 0x%x",
   1007  1.127   thorpej 			SSD_RCODE(sense->response_code));
   1008  1.127   thorpej 		if ((sense->response_code & SSD_RCODE_VALID) != 0) {
   1009  1.127   thorpej 			struct scsi_sense_data_unextended *usense =
   1010  1.127   thorpej 			    (struct scsi_sense_data_unextended *)sense;
   1011   1.13    bouyer 			printf(" at block no. %d (decimal)",
   1012   1.13    bouyer 			    _3btol(usense->block));
   1013   1.13    bouyer 		}
   1014   1.13    bouyer 		printf("\n");
   1015   1.28    mjacob #endif
   1016   1.13    bouyer 		return (EIO);
   1017   1.13    bouyer 	}
   1018   1.13    bouyer }
   1019   1.13    bouyer 
   1020   1.13    bouyer /*
   1021   1.39    bouyer  * scsipi_test_unit_ready:
   1022   1.39    bouyer  *
   1023   1.39    bouyer  *	Issue a `test unit ready' request.
   1024    1.2    bouyer  */
   1025    1.3     enami int
   1026  1.108   thorpej scsipi_test_unit_ready(struct scsipi_periph *periph, int flags)
   1027    1.2    bouyer {
   1028  1.127   thorpej 	struct scsi_test_unit_ready cmd;
   1029   1.88      fvdl 	int retries;
   1030    1.2    bouyer 
   1031  1.127   thorpej 	/* some ATAPI drives don't support TEST UNIT READY. Sigh */
   1032   1.39    bouyer 	if (periph->periph_quirks & PQUIRK_NOTUR)
   1033    1.3     enami 		return (0);
   1034    1.2    bouyer 
   1035   1.88      fvdl 	if (flags & XS_CTL_DISCOVERY)
   1036   1.88      fvdl 		retries = 0;
   1037   1.88      fvdl 	else
   1038   1.88      fvdl 		retries = SCSIPIRETRIES;
   1039   1.88      fvdl 
   1040  1.117   mycroft 	memset(&cmd, 0, sizeof(cmd));
   1041  1.127   thorpej 	cmd.opcode = SCSI_TEST_UNIT_READY;
   1042  1.117   mycroft 
   1043  1.116   mycroft 	return (scsipi_command(periph, (void *)&cmd, sizeof(cmd), 0, 0,
   1044  1.116   mycroft 	    retries, 10000, NULL, flags));
   1045    1.2    bouyer }
   1046    1.2    bouyer 
   1047  1.163  christos static const struct scsipi_inquiry3_pattern {
   1048  1.163  christos 	const char vendor[8];
   1049  1.163  christos 	const char product[16];
   1050  1.163  christos 	const char revision[4];
   1051  1.163  christos } scsipi_inquiry3_quirk[] = {
   1052  1.163  christos 	{ "ES-6600 ", "", "" },
   1053  1.163  christos };
   1054  1.163  christos 
   1055  1.163  christos static int
   1056  1.163  christos scsipi_inquiry3_ok(const struct scsipi_inquiry_data *ib)
   1057  1.163  christos {
   1058  1.163  christos 	for (size_t i = 0; i < __arraycount(scsipi_inquiry3_quirk); i++) {
   1059  1.163  christos 		const struct scsipi_inquiry3_pattern *q =
   1060  1.163  christos 		    &scsipi_inquiry3_quirk[i];
   1061  1.163  christos #define MATCH(field) \
   1062  1.163  christos     (q->field[0] ? memcmp(ib->field, q->field, sizeof(ib->field) == 0) : 1)
   1063  1.163  christos 		if (MATCH(vendor) && MATCH(product) && MATCH(revision))
   1064  1.163  christos 			return 0;
   1065  1.163  christos 	}
   1066  1.163  christos 	return 1;
   1067  1.163  christos }
   1068  1.163  christos 
   1069    1.2    bouyer /*
   1070   1.39    bouyer  * scsipi_inquire:
   1071   1.39    bouyer  *
   1072   1.39    bouyer  *	Ask the device about itself.
   1073    1.2    bouyer  */
   1074    1.3     enami int
   1075  1.108   thorpej scsipi_inquire(struct scsipi_periph *periph, struct scsipi_inquiry_data *inqbuf,
   1076  1.108   thorpej     int flags)
   1077    1.2    bouyer {
   1078  1.116   mycroft 	struct scsipi_inquiry cmd;
   1079   1.64  fredette 	int error;
   1080  1.117   mycroft 	int retries;
   1081    1.2    bouyer 
   1082   1.88      fvdl 	if (flags & XS_CTL_DISCOVERY)
   1083   1.88      fvdl 		retries = 0;
   1084   1.88      fvdl 	else
   1085   1.88      fvdl 		retries = SCSIPIRETRIES;
   1086   1.88      fvdl 
   1087   1.98   mycroft 	/*
   1088   1.98   mycroft 	 * If we request more data than the device can provide, it SHOULD just
   1089  1.161  christos 	 * return a short response.  However, some devices error with an
   1090   1.98   mycroft 	 * ILLEGAL REQUEST sense code, and yet others have even more special
   1091   1.98   mycroft 	 * failture modes (such as the GL641USB flash adapter, which goes loony
   1092   1.98   mycroft 	 * and sends corrupted CRCs).  To work around this, and to bring our
   1093   1.98   mycroft 	 * behavior more in line with other OSes, we do a shorter inquiry,
   1094   1.98   mycroft 	 * covering all the SCSI-2 information, first, and then request more
   1095   1.98   mycroft 	 * data iff the "additional length" field indicates there is more.
   1096   1.98   mycroft 	 * - mycroft, 2003/10/16
   1097   1.98   mycroft 	 */
   1098  1.117   mycroft 	memset(&cmd, 0, sizeof(cmd));
   1099  1.117   mycroft 	cmd.opcode = INQUIRY;
   1100  1.116   mycroft 	cmd.length = SCSIPI_INQUIRY_LENGTH_SCSI2;
   1101  1.116   mycroft 	error = scsipi_command(periph, (void *)&cmd, sizeof(cmd),
   1102  1.116   mycroft 	    (void *)inqbuf, SCSIPI_INQUIRY_LENGTH_SCSI2, retries,
   1103  1.117   mycroft 	    10000, NULL, flags | XS_CTL_DATA_IN);
   1104  1.117   mycroft 	if (!error &&
   1105  1.117   mycroft 	    inqbuf->additional_length > SCSIPI_INQUIRY_LENGTH_SCSI2 - 4) {
   1106  1.163  christos 	    if (scsipi_inquiry3_ok(inqbuf)) {
   1107  1.117   mycroft #if 0
   1108  1.117   mycroft printf("inquire: addlen=%d, retrying\n", inqbuf->additional_length);
   1109  1.117   mycroft #endif
   1110  1.116   mycroft 		cmd.length = SCSIPI_INQUIRY_LENGTH_SCSI3;
   1111  1.116   mycroft 		error = scsipi_command(periph, (void *)&cmd, sizeof(cmd),
   1112  1.116   mycroft 		    (void *)inqbuf, SCSIPI_INQUIRY_LENGTH_SCSI3, retries,
   1113  1.117   mycroft 		    10000, NULL, flags | XS_CTL_DATA_IN);
   1114  1.117   mycroft #if 0
   1115  1.117   mycroft printf("inquire: error=%d\n", error);
   1116  1.117   mycroft #endif
   1117  1.161  christos 	    }
   1118   1.97   mycroft 	}
   1119  1.128     perry 
   1120   1.65  fredette #ifdef SCSI_OLD_NOINQUIRY
   1121   1.64  fredette 	/*
   1122   1.64  fredette 	 * Kludge for the Adaptec ACB-4000 SCSI->MFM translator.
   1123   1.64  fredette 	 * This board doesn't support the INQUIRY command at all.
   1124   1.64  fredette 	 */
   1125   1.64  fredette 	if (error == EINVAL || error == EACCES) {
   1126   1.64  fredette 		/*
   1127   1.64  fredette 		 * Conjure up an INQUIRY response.
   1128   1.64  fredette 		 */
   1129   1.64  fredette 		inqbuf->device = (error == EINVAL ?
   1130   1.64  fredette 			 SID_QUAL_LU_PRESENT :
   1131   1.64  fredette 			 SID_QUAL_LU_NOTPRESENT) | T_DIRECT;
   1132   1.64  fredette 		inqbuf->dev_qual2 = 0;
   1133   1.64  fredette 		inqbuf->version = 0;
   1134   1.64  fredette 		inqbuf->response_format = SID_FORMAT_SCSI1;
   1135   1.96   mycroft 		inqbuf->additional_length = SCSIPI_INQUIRY_LENGTH_SCSI2 - 4;
   1136   1.64  fredette 		inqbuf->flags1 = inqbuf->flags2 = inqbuf->flags3 = 0;
   1137   1.96   mycroft 		memcpy(inqbuf->vendor, "ADAPTEC ACB-4000            ", 28);
   1138   1.64  fredette 		error = 0;
   1139   1.64  fredette 	}
   1140   1.64  fredette 
   1141   1.64  fredette 	/*
   1142   1.64  fredette 	 * Kludge for the Emulex MT-02 SCSI->QIC translator.
   1143   1.64  fredette 	 * This board gives an empty response to an INQUIRY command.
   1144   1.64  fredette 	 */
   1145  1.128     perry 	else if (error == 0 &&
   1146  1.117   mycroft 	    inqbuf->device == (SID_QUAL_LU_PRESENT | T_DIRECT) &&
   1147  1.117   mycroft 	    inqbuf->dev_qual2 == 0 &&
   1148  1.117   mycroft 	    inqbuf->version == 0 &&
   1149  1.117   mycroft 	    inqbuf->response_format == SID_FORMAT_SCSI1) {
   1150   1.64  fredette 		/*
   1151   1.64  fredette 		 * Fill out the INQUIRY response.
   1152   1.64  fredette 		 */
   1153   1.64  fredette 		inqbuf->device = (SID_QUAL_LU_PRESENT | T_SEQUENTIAL);
   1154   1.64  fredette 		inqbuf->dev_qual2 = SID_REMOVABLE;
   1155   1.96   mycroft 		inqbuf->additional_length = SCSIPI_INQUIRY_LENGTH_SCSI2 - 4;
   1156   1.64  fredette 		inqbuf->flags1 = inqbuf->flags2 = inqbuf->flags3 = 0;
   1157   1.96   mycroft 		memcpy(inqbuf->vendor, "EMULEX  MT-02 QIC           ", 28);
   1158   1.64  fredette 	}
   1159   1.65  fredette #endif /* SCSI_OLD_NOINQUIRY */
   1160   1.64  fredette 
   1161  1.128     perry 	return error;
   1162    1.2    bouyer }
   1163    1.2    bouyer 
   1164    1.2    bouyer /*
   1165   1.39    bouyer  * scsipi_prevent:
   1166   1.39    bouyer  *
   1167   1.39    bouyer  *	Prevent or allow the user to remove the media
   1168    1.2    bouyer  */
   1169    1.3     enami int
   1170  1.108   thorpej scsipi_prevent(struct scsipi_periph *periph, int type, int flags)
   1171    1.2    bouyer {
   1172  1.127   thorpej 	struct scsi_prevent_allow_medium_removal cmd;
   1173  1.116   mycroft 
   1174  1.148   mlelstv 	if (periph->periph_quirks & PQUIRK_NODOORLOCK)
   1175  1.148   mlelstv 		return 0;
   1176  1.148   mlelstv 
   1177  1.116   mycroft 	memset(&cmd, 0, sizeof(cmd));
   1178  1.127   thorpej 	cmd.opcode = SCSI_PREVENT_ALLOW_MEDIUM_REMOVAL;
   1179  1.116   mycroft 	cmd.how = type;
   1180    1.2    bouyer 
   1181  1.116   mycroft 	return (scsipi_command(periph, (void *)&cmd, sizeof(cmd), 0, 0,
   1182  1.116   mycroft 	    SCSIPIRETRIES, 5000, NULL, flags));
   1183    1.2    bouyer }
   1184    1.2    bouyer 
   1185    1.2    bouyer /*
   1186   1.39    bouyer  * scsipi_start:
   1187   1.39    bouyer  *
   1188   1.39    bouyer  *	Send a START UNIT.
   1189    1.2    bouyer  */
   1190    1.3     enami int
   1191  1.108   thorpej scsipi_start(struct scsipi_periph *periph, int type, int flags)
   1192    1.2    bouyer {
   1193  1.116   mycroft 	struct scsipi_start_stop cmd;
   1194  1.116   mycroft 
   1195  1.116   mycroft 	memset(&cmd, 0, sizeof(cmd));
   1196  1.116   mycroft 	cmd.opcode = START_STOP;
   1197  1.116   mycroft 	cmd.byte2 = 0x00;
   1198  1.116   mycroft 	cmd.how = type;
   1199    1.2    bouyer 
   1200  1.116   mycroft 	return (scsipi_command(periph, (void *)&cmd, sizeof(cmd), 0, 0,
   1201  1.116   mycroft 	    SCSIPIRETRIES, (type & SSS_START) ? 60000 : 10000, NULL, flags));
   1202   1.41    bouyer }
   1203   1.41    bouyer 
   1204   1.41    bouyer /*
   1205   1.41    bouyer  * scsipi_mode_sense, scsipi_mode_sense_big:
   1206   1.41    bouyer  *	get a sense page from a device
   1207   1.41    bouyer  */
   1208   1.41    bouyer 
   1209   1.41    bouyer int
   1210  1.108   thorpej scsipi_mode_sense(struct scsipi_periph *periph, int byte2, int page,
   1211  1.127   thorpej     struct scsi_mode_parameter_header_6 *data, int len, int flags, int retries,
   1212  1.108   thorpej     int timeout)
   1213   1.41    bouyer {
   1214  1.127   thorpej 	struct scsi_mode_sense_6 cmd;
   1215   1.41    bouyer 
   1216  1.116   mycroft 	memset(&cmd, 0, sizeof(cmd));
   1217  1.127   thorpej 	cmd.opcode = SCSI_MODE_SENSE_6;
   1218  1.116   mycroft 	cmd.byte2 = byte2;
   1219  1.116   mycroft 	cmd.page = page;
   1220  1.116   mycroft 	cmd.length = len & 0xff;
   1221  1.116   mycroft 
   1222  1.117   mycroft 	return (scsipi_command(periph, (void *)&cmd, sizeof(cmd),
   1223  1.117   mycroft 	    (void *)data, len, retries, timeout, NULL, flags | XS_CTL_DATA_IN));
   1224   1.41    bouyer }
   1225   1.41    bouyer 
   1226   1.41    bouyer int
   1227  1.108   thorpej scsipi_mode_sense_big(struct scsipi_periph *periph, int byte2, int page,
   1228  1.127   thorpej     struct scsi_mode_parameter_header_10 *data, int len, int flags, int retries,
   1229  1.108   thorpej     int timeout)
   1230   1.41    bouyer {
   1231  1.127   thorpej 	struct scsi_mode_sense_10 cmd;
   1232   1.41    bouyer 
   1233  1.116   mycroft 	memset(&cmd, 0, sizeof(cmd));
   1234  1.127   thorpej 	cmd.opcode = SCSI_MODE_SENSE_10;
   1235  1.116   mycroft 	cmd.byte2 = byte2;
   1236  1.116   mycroft 	cmd.page = page;
   1237  1.116   mycroft 	_lto2b(len, cmd.length);
   1238  1.116   mycroft 
   1239  1.117   mycroft 	return (scsipi_command(periph, (void *)&cmd, sizeof(cmd),
   1240  1.117   mycroft 	    (void *)data, len, retries, timeout, NULL, flags | XS_CTL_DATA_IN));
   1241   1.41    bouyer }
   1242   1.41    bouyer 
   1243   1.41    bouyer int
   1244  1.108   thorpej scsipi_mode_select(struct scsipi_periph *periph, int byte2,
   1245  1.127   thorpej     struct scsi_mode_parameter_header_6 *data, int len, int flags, int retries,
   1246  1.108   thorpej     int timeout)
   1247   1.41    bouyer {
   1248  1.127   thorpej 	struct scsi_mode_select_6 cmd;
   1249   1.41    bouyer 
   1250  1.116   mycroft 	memset(&cmd, 0, sizeof(cmd));
   1251  1.127   thorpej 	cmd.opcode = SCSI_MODE_SELECT_6;
   1252  1.116   mycroft 	cmd.byte2 = byte2;
   1253  1.116   mycroft 	cmd.length = len & 0xff;
   1254  1.116   mycroft 
   1255  1.117   mycroft 	return (scsipi_command(periph, (void *)&cmd, sizeof(cmd),
   1256  1.117   mycroft 	    (void *)data, len, retries, timeout, NULL, flags | XS_CTL_DATA_OUT));
   1257   1.41    bouyer }
   1258   1.41    bouyer 
   1259   1.41    bouyer int
   1260  1.108   thorpej scsipi_mode_select_big(struct scsipi_periph *periph, int byte2,
   1261  1.127   thorpej     struct scsi_mode_parameter_header_10 *data, int len, int flags, int retries,
   1262  1.108   thorpej     int timeout)
   1263   1.41    bouyer {
   1264  1.127   thorpej 	struct scsi_mode_select_10 cmd;
   1265   1.41    bouyer 
   1266  1.116   mycroft 	memset(&cmd, 0, sizeof(cmd));
   1267  1.127   thorpej 	cmd.opcode = SCSI_MODE_SELECT_10;
   1268  1.116   mycroft 	cmd.byte2 = byte2;
   1269  1.116   mycroft 	_lto2b(len, cmd.length);
   1270  1.116   mycroft 
   1271  1.117   mycroft 	return (scsipi_command(periph, (void *)&cmd, sizeof(cmd),
   1272  1.117   mycroft 	    (void *)data, len, retries, timeout, NULL, flags | XS_CTL_DATA_OUT));
   1273    1.2    bouyer }
   1274    1.2    bouyer 
   1275    1.2    bouyer /*
   1276   1.39    bouyer  * scsipi_done:
   1277   1.39    bouyer  *
   1278   1.39    bouyer  *	This routine is called by an adapter's interrupt handler when
   1279   1.39    bouyer  *	an xfer is completed.
   1280    1.2    bouyer  */
   1281    1.3     enami void
   1282  1.108   thorpej scsipi_done(struct scsipi_xfer *xs)
   1283    1.2    bouyer {
   1284   1.39    bouyer 	struct scsipi_periph *periph = xs->xs_periph;
   1285   1.39    bouyer 	struct scsipi_channel *chan = periph->periph_channel;
   1286   1.39    bouyer 	int s, freezecnt;
   1287   1.39    bouyer 
   1288  1.157    bouyer 	KASSERT(cold || KERNEL_LOCKED_P());
   1289  1.156       mrg 
   1290   1.39    bouyer 	SC_DEBUG(periph, SCSIPI_DB2, ("scsipi_done\n"));
   1291   1.39    bouyer #ifdef SCSIPI_DEBUG
   1292   1.39    bouyer 	if (periph->periph_dbflags & SCSIPI_DB1)
   1293   1.39    bouyer 		show_scsipi_cmd(xs);
   1294   1.39    bouyer #endif
   1295   1.39    bouyer 
   1296   1.39    bouyer 	s = splbio();
   1297   1.39    bouyer 	/*
   1298   1.39    bouyer 	 * The resource this command was using is now free.
   1299   1.39    bouyer 	 */
   1300  1.135   nathanw 	if (xs->xs_status & XS_STS_DONE) {
   1301  1.135   nathanw 		/* XXX in certain circumstances, such as a device
   1302  1.135   nathanw 		 * being detached, a xs that has already been
   1303  1.135   nathanw 		 * scsipi_done()'d by the main thread will be done'd
   1304  1.135   nathanw 		 * again by scsibusdetach(). Putting the xs on the
   1305  1.135   nathanw 		 * chan_complete queue causes list corruption and
   1306  1.135   nathanw 		 * everyone dies. This prevents that, but perhaps
   1307  1.135   nathanw 		 * there should be better coordination somewhere such
   1308  1.135   nathanw 		 * that this won't ever happen (and can be turned into
   1309  1.135   nathanw 		 * a KASSERT().
   1310  1.135   nathanw 		 */
   1311  1.135   nathanw 		splx(s);
   1312  1.135   nathanw 		goto out;
   1313  1.135   nathanw 	}
   1314   1.39    bouyer 	scsipi_put_resource(chan);
   1315   1.39    bouyer 	xs->xs_periph->periph_sent--;
   1316   1.39    bouyer 
   1317   1.39    bouyer 	/*
   1318   1.39    bouyer 	 * If the command was tagged, free the tag.
   1319   1.39    bouyer 	 */
   1320   1.39    bouyer 	if (XS_CTL_TAGTYPE(xs) != 0)
   1321   1.39    bouyer 		scsipi_put_tag(xs);
   1322   1.39    bouyer 	else
   1323   1.39    bouyer 		periph->periph_flags &= ~PERIPH_UNTAG;
   1324   1.39    bouyer 
   1325   1.39    bouyer 	/* Mark the command as `done'. */
   1326   1.39    bouyer 	xs->xs_status |= XS_STS_DONE;
   1327   1.39    bouyer 
   1328   1.39    bouyer #ifdef DIAGNOSTIC
   1329   1.39    bouyer 	if ((xs->xs_control & (XS_CTL_ASYNC|XS_CTL_POLL)) ==
   1330   1.39    bouyer 	    (XS_CTL_ASYNC|XS_CTL_POLL))
   1331   1.39    bouyer 		panic("scsipi_done: ASYNC and POLL");
   1332   1.39    bouyer #endif
   1333   1.39    bouyer 
   1334   1.39    bouyer 	/*
   1335   1.39    bouyer 	 * If the xfer had an error of any sort, freeze the
   1336   1.39    bouyer 	 * periph's queue.  Freeze it again if we were requested
   1337   1.39    bouyer 	 * to do so in the xfer.
   1338   1.39    bouyer 	 */
   1339   1.39    bouyer 	freezecnt = 0;
   1340   1.39    bouyer 	if (xs->error != XS_NOERROR)
   1341   1.39    bouyer 		freezecnt++;
   1342   1.39    bouyer 	if (xs->xs_control & XS_CTL_FREEZE_PERIPH)
   1343   1.39    bouyer 		freezecnt++;
   1344   1.39    bouyer 	if (freezecnt != 0)
   1345   1.39    bouyer 		scsipi_periph_freeze(periph, freezecnt);
   1346   1.39    bouyer 
   1347   1.39    bouyer 	/*
   1348   1.39    bouyer 	 * record the xfer with a pending sense, in case a SCSI reset is
   1349   1.39    bouyer 	 * received before the thread is waked up.
   1350   1.39    bouyer 	 */
   1351   1.39    bouyer 	if (xs->error == XS_BUSY && xs->status == SCSI_CHECK) {
   1352   1.39    bouyer 		periph->periph_flags |= PERIPH_SENSE;
   1353   1.39    bouyer 		periph->periph_xscheck = xs;
   1354   1.39    bouyer 	}
   1355   1.39    bouyer 
   1356   1.39    bouyer 	/*
   1357   1.58    mjacob 	 * If this was an xfer that was not to complete asynchronously,
   1358   1.39    bouyer 	 * let the requesting thread perform error checking/handling
   1359   1.39    bouyer 	 * in its context.
   1360   1.39    bouyer 	 */
   1361   1.39    bouyer 	if ((xs->xs_control & XS_CTL_ASYNC) == 0) {
   1362   1.39    bouyer 		splx(s);
   1363   1.39    bouyer 		/*
   1364   1.39    bouyer 		 * If it's a polling job, just return, to unwind the
   1365   1.39    bouyer 		 * call graph.  We don't need to restart the queue,
   1366   1.39    bouyer 		 * because pollings jobs are treated specially, and
   1367   1.39    bouyer 		 * are really only used during crash dumps anyway
   1368   1.39    bouyer 		 * (XXX or during boot-time autconfiguration of
   1369   1.39    bouyer 		 * ATAPI devices).
   1370   1.39    bouyer 		 */
   1371   1.39    bouyer 		if (xs->xs_control & XS_CTL_POLL)
   1372   1.39    bouyer 			return;
   1373   1.39    bouyer 		wakeup(xs);
   1374   1.39    bouyer 		goto out;
   1375   1.39    bouyer 	}
   1376   1.39    bouyer 
   1377   1.39    bouyer 	/*
   1378   1.39    bouyer 	 * Catch the extremely common case of I/O completing
   1379   1.39    bouyer 	 * without error; no use in taking a context switch
   1380   1.39    bouyer 	 * if we can handle it in interrupt context.
   1381   1.39    bouyer 	 */
   1382   1.39    bouyer 	if (xs->error == XS_NOERROR) {
   1383   1.39    bouyer 		splx(s);
   1384   1.39    bouyer 		(void) scsipi_complete(xs);
   1385   1.39    bouyer 		goto out;
   1386   1.39    bouyer 	}
   1387   1.39    bouyer 
   1388   1.39    bouyer 	/*
   1389   1.39    bouyer 	 * There is an error on this xfer.  Put it on the channel's
   1390   1.39    bouyer 	 * completion queue, and wake up the completion thread.
   1391   1.39    bouyer 	 */
   1392   1.39    bouyer 	TAILQ_INSERT_TAIL(&chan->chan_complete, xs, channel_q);
   1393   1.39    bouyer 	splx(s);
   1394   1.39    bouyer 	wakeup(&chan->chan_complete);
   1395   1.39    bouyer 
   1396   1.39    bouyer  out:
   1397   1.39    bouyer 	/*
   1398   1.39    bouyer 	 * If there are more xfers on the channel's queue, attempt to
   1399   1.39    bouyer 	 * run them.
   1400   1.39    bouyer 	 */
   1401   1.39    bouyer 	scsipi_run_queue(chan);
   1402   1.39    bouyer }
   1403   1.39    bouyer 
   1404   1.39    bouyer /*
   1405   1.39    bouyer  * scsipi_complete:
   1406   1.39    bouyer  *
   1407   1.39    bouyer  *	Completion of a scsipi_xfer.  This is the guts of scsipi_done().
   1408   1.39    bouyer  *
   1409   1.39    bouyer  *	NOTE: This routine MUST be called with valid thread context
   1410   1.39    bouyer  *	except for the case where the following two conditions are
   1411   1.39    bouyer  *	true:
   1412   1.39    bouyer  *
   1413   1.39    bouyer  *		xs->error == XS_NOERROR
   1414   1.39    bouyer  *		XS_CTL_ASYNC is set in xs->xs_control
   1415   1.39    bouyer  *
   1416   1.39    bouyer  *	The semantics of this routine can be tricky, so here is an
   1417   1.39    bouyer  *	explanation:
   1418   1.39    bouyer  *
   1419   1.39    bouyer  *		0		Xfer completed successfully.
   1420   1.39    bouyer  *
   1421   1.39    bouyer  *		ERESTART	Xfer had an error, but was restarted.
   1422   1.39    bouyer  *
   1423   1.39    bouyer  *		anything else	Xfer had an error, return value is Unix
   1424   1.39    bouyer  *				errno.
   1425   1.39    bouyer  *
   1426   1.39    bouyer  *	If the return value is anything but ERESTART:
   1427   1.39    bouyer  *
   1428   1.39    bouyer  *		- If XS_CTL_ASYNC is set, `xs' has been freed back to
   1429   1.39    bouyer  *		  the pool.
   1430   1.39    bouyer  *		- If there is a buf associated with the xfer,
   1431   1.39    bouyer  *		  it has been biodone()'d.
   1432   1.39    bouyer  */
   1433  1.108   thorpej static int
   1434  1.108   thorpej scsipi_complete(struct scsipi_xfer *xs)
   1435   1.39    bouyer {
   1436   1.39    bouyer 	struct scsipi_periph *periph = xs->xs_periph;
   1437   1.39    bouyer 	struct scsipi_channel *chan = periph->periph_channel;
   1438   1.31     enami 	int error, s;
   1439    1.2    bouyer 
   1440   1.39    bouyer #ifdef DIAGNOSTIC
   1441   1.39    bouyer 	if ((xs->xs_control & XS_CTL_ASYNC) != 0 && xs->bp == NULL)
   1442   1.39    bouyer 		panic("scsipi_complete: XS_CTL_ASYNC but no buf");
   1443   1.39    bouyer #endif
   1444   1.39    bouyer 	/*
   1445   1.39    bouyer 	 * If command terminated with a CHECK CONDITION, we need to issue a
   1446   1.39    bouyer 	 * REQUEST_SENSE command. Once the REQUEST_SENSE has been processed
   1447   1.39    bouyer 	 * we'll have the real status.
   1448   1.39    bouyer 	 * Must be processed at splbio() to avoid missing a SCSI bus reset
   1449   1.39    bouyer 	 * for this command.
   1450   1.39    bouyer 	 */
   1451   1.39    bouyer 	s = splbio();
   1452   1.39    bouyer 	if (xs->error == XS_BUSY && xs->status == SCSI_CHECK) {
   1453   1.39    bouyer 		/* request sense for a request sense ? */
   1454   1.39    bouyer 		if (xs->xs_control & XS_CTL_REQSENSE) {
   1455   1.39    bouyer 			scsipi_printaddr(periph);
   1456   1.47    bouyer 			printf("request sense for a request sense ?\n");
   1457   1.39    bouyer 			/* XXX maybe we should reset the device ? */
   1458   1.39    bouyer 			/* we've been frozen because xs->error != XS_NOERROR */
   1459   1.39    bouyer 			scsipi_periph_thaw(periph, 1);
   1460   1.39    bouyer 			splx(s);
   1461   1.47    bouyer 			if (xs->resid < xs->datalen) {
   1462   1.47    bouyer 				printf("we read %d bytes of sense anyway:\n",
   1463   1.47    bouyer 				    xs->datalen - xs->resid);
   1464   1.47    bouyer 				scsipi_print_sense_data((void *)xs->data, 0);
   1465   1.47    bouyer 			}
   1466   1.39    bouyer 			return EINVAL;
   1467   1.39    bouyer 		}
   1468   1.39    bouyer 		scsipi_request_sense(xs);
   1469   1.39    bouyer 	}
   1470   1.39    bouyer 	splx(s);
   1471   1.54        ad 
   1472    1.2    bouyer 	/*
   1473    1.3     enami 	 * If it's a user level request, bypass all usual completion
   1474  1.128     perry 	 * processing, let the user work it out..
   1475    1.3     enami 	 */
   1476   1.24   thorpej 	if ((xs->xs_control & XS_CTL_USERCMD) != 0) {
   1477   1.39    bouyer 		SC_DEBUG(periph, SCSIPI_DB3, ("calling user done()\n"));
   1478   1.39    bouyer 		if (xs->error != XS_NOERROR)
   1479   1.39    bouyer 			scsipi_periph_thaw(periph, 1);
   1480   1.39    bouyer 		scsipi_user_done(xs);
   1481   1.39    bouyer 		SC_DEBUG(periph, SCSIPI_DB3, ("returned from user done()\n "));
   1482   1.39    bouyer 		return 0;
   1483   1.39    bouyer 	}
   1484   1.39    bouyer 
   1485   1.39    bouyer 	switch (xs->error) {
   1486   1.39    bouyer 	case XS_NOERROR:
   1487   1.39    bouyer 		error = 0;
   1488   1.39    bouyer 		break;
   1489   1.39    bouyer 
   1490   1.39    bouyer 	case XS_SENSE:
   1491   1.39    bouyer 	case XS_SHORTSENSE:
   1492   1.39    bouyer 		error = (*chan->chan_bustype->bustype_interpret_sense)(xs);
   1493   1.39    bouyer 		break;
   1494    1.2    bouyer 
   1495   1.39    bouyer 	case XS_RESOURCE_SHORTAGE:
   1496    1.9    scottr 		/*
   1497   1.39    bouyer 		 * XXX Should freeze channel's queue.
   1498   1.39    bouyer 		 */
   1499   1.39    bouyer 		scsipi_printaddr(periph);
   1500   1.39    bouyer 		printf("adapter resource shortage\n");
   1501   1.39    bouyer 		/* FALLTHROUGH */
   1502   1.39    bouyer 
   1503   1.39    bouyer 	case XS_BUSY:
   1504   1.39    bouyer 		if (xs->error == XS_BUSY && xs->status == SCSI_QUEUE_FULL) {
   1505   1.39    bouyer 			struct scsipi_max_openings mo;
   1506   1.39    bouyer 
   1507   1.39    bouyer 			/*
   1508   1.39    bouyer 			 * We set the openings to active - 1, assuming that
   1509   1.39    bouyer 			 * the command that got us here is the first one that
   1510   1.39    bouyer 			 * can't fit into the device's queue.  If that's not
   1511   1.39    bouyer 			 * the case, I guess we'll find out soon enough.
   1512   1.39    bouyer 			 */
   1513   1.39    bouyer 			mo.mo_target = periph->periph_target;
   1514   1.39    bouyer 			mo.mo_lun = periph->periph_lun;
   1515   1.42    bouyer 			if (periph->periph_active < periph->periph_openings)
   1516   1.42    bouyer 				mo.mo_openings = periph->periph_active - 1;
   1517   1.42    bouyer 			else
   1518   1.42    bouyer 				mo.mo_openings = periph->periph_openings - 1;
   1519   1.39    bouyer #ifdef DIAGNOSTIC
   1520   1.39    bouyer 			if (mo.mo_openings < 0) {
   1521   1.39    bouyer 				scsipi_printaddr(periph);
   1522   1.39    bouyer 				printf("QUEUE FULL resulted in < 0 openings\n");
   1523   1.39    bouyer 				panic("scsipi_done");
   1524   1.39    bouyer 			}
   1525   1.39    bouyer #endif
   1526   1.39    bouyer 			if (mo.mo_openings == 0) {
   1527   1.39    bouyer 				scsipi_printaddr(periph);
   1528   1.39    bouyer 				printf("QUEUE FULL resulted in 0 openings\n");
   1529   1.39    bouyer 				mo.mo_openings = 1;
   1530   1.39    bouyer 			}
   1531   1.39    bouyer 			scsipi_async_event(chan, ASYNC_EVENT_MAX_OPENINGS, &mo);
   1532   1.39    bouyer 			error = ERESTART;
   1533   1.39    bouyer 		} else if (xs->xs_retries != 0) {
   1534   1.39    bouyer 			xs->xs_retries--;
   1535   1.39    bouyer 			/*
   1536   1.39    bouyer 			 * Wait one second, and try again.
   1537   1.39    bouyer 			 */
   1538   1.58    mjacob 			if ((xs->xs_control & XS_CTL_POLL) ||
   1539   1.58    mjacob 			    (chan->chan_flags & SCSIPI_CHAN_TACTIVE) == 0) {
   1540  1.154     pooka 				/* XXX: quite extreme */
   1541  1.154     pooka 				kpause("xsbusy", false, hz, NULL);
   1542   1.84   thorpej 			} else if (!callout_pending(&periph->periph_callout)) {
   1543   1.39    bouyer 				scsipi_periph_freeze(periph, 1);
   1544   1.39    bouyer 				callout_reset(&periph->periph_callout,
   1545   1.39    bouyer 				    hz, scsipi_periph_timed_thaw, periph);
   1546   1.39    bouyer 			}
   1547   1.39    bouyer 			error = ERESTART;
   1548   1.39    bouyer 		} else
   1549   1.39    bouyer 			error = EBUSY;
   1550   1.39    bouyer 		break;
   1551   1.39    bouyer 
   1552   1.39    bouyer 	case XS_REQUEUE:
   1553   1.39    bouyer 		error = ERESTART;
   1554   1.39    bouyer 		break;
   1555   1.39    bouyer 
   1556   1.77    mjacob 	case XS_SELTIMEOUT:
   1557   1.39    bouyer 	case XS_TIMEOUT:
   1558   1.77    mjacob 		/*
   1559   1.77    mjacob 		 * If the device hasn't gone away, honor retry counts.
   1560   1.77    mjacob 		 *
   1561   1.77    mjacob 		 * Note that if we're in the middle of probing it,
   1562   1.77    mjacob 		 * it won't be found because it isn't here yet so
   1563   1.77    mjacob 		 * we won't honor the retry count in that case.
   1564   1.77    mjacob 		 */
   1565   1.77    mjacob 		if (scsipi_lookup_periph(chan, periph->periph_target,
   1566   1.77    mjacob 		    periph->periph_lun) && xs->xs_retries != 0) {
   1567   1.39    bouyer 			xs->xs_retries--;
   1568   1.39    bouyer 			error = ERESTART;
   1569   1.39    bouyer 		} else
   1570   1.39    bouyer 			error = EIO;
   1571   1.39    bouyer 		break;
   1572   1.39    bouyer 
   1573   1.39    bouyer 	case XS_RESET:
   1574   1.39    bouyer 		if (xs->xs_control & XS_CTL_REQSENSE) {
   1575   1.39    bouyer 			/*
   1576   1.39    bouyer 			 * request sense interrupted by reset: signal it
   1577   1.39    bouyer 			 * with EINTR return code.
   1578   1.39    bouyer 			 */
   1579   1.39    bouyer 			error = EINTR;
   1580   1.39    bouyer 		} else {
   1581   1.39    bouyer 			if (xs->xs_retries != 0) {
   1582   1.39    bouyer 				xs->xs_retries--;
   1583   1.39    bouyer 				error = ERESTART;
   1584   1.39    bouyer 			} else
   1585   1.39    bouyer 				error = EIO;
   1586   1.31     enami 		}
   1587   1.39    bouyer 		break;
   1588   1.39    bouyer 
   1589   1.75    mjacob 	case XS_DRIVER_STUFFUP:
   1590   1.75    mjacob 		scsipi_printaddr(periph);
   1591   1.75    mjacob 		printf("generic HBA error\n");
   1592   1.75    mjacob 		error = EIO;
   1593   1.75    mjacob 		break;
   1594   1.39    bouyer 	default:
   1595   1.39    bouyer 		scsipi_printaddr(periph);
   1596   1.39    bouyer 		printf("invalid return code from adapter: %d\n", xs->error);
   1597   1.39    bouyer 		error = EIO;
   1598   1.39    bouyer 		break;
   1599    1.2    bouyer 	}
   1600    1.2    bouyer 
   1601   1.39    bouyer 	s = splbio();
   1602   1.39    bouyer 	if (error == ERESTART) {
   1603    1.2    bouyer 		/*
   1604   1.39    bouyer 		 * If we get here, the periph has been thawed and frozen
   1605   1.39    bouyer 		 * again if we had to issue recovery commands.  Alternatively,
   1606   1.39    bouyer 		 * it may have been frozen again and in a timed thaw.  In
   1607   1.39    bouyer 		 * any case, we thaw the periph once we re-enqueue the
   1608   1.39    bouyer 		 * command.  Once the periph is fully thawed, it will begin
   1609   1.39    bouyer 		 * operation again.
   1610    1.2    bouyer 		 */
   1611   1.39    bouyer 		xs->error = XS_NOERROR;
   1612   1.39    bouyer 		xs->status = SCSI_OK;
   1613   1.39    bouyer 		xs->xs_status &= ~XS_STS_DONE;
   1614   1.39    bouyer 		xs->xs_requeuecnt++;
   1615   1.39    bouyer 		error = scsipi_enqueue(xs);
   1616   1.39    bouyer 		if (error == 0) {
   1617   1.39    bouyer 			scsipi_periph_thaw(periph, 1);
   1618   1.39    bouyer 			splx(s);
   1619   1.39    bouyer 			return (ERESTART);
   1620   1.39    bouyer 		}
   1621    1.2    bouyer 	}
   1622    1.2    bouyer 
   1623    1.2    bouyer 	/*
   1624   1.39    bouyer 	 * scsipi_done() freezes the queue if not XS_NOERROR.
   1625   1.39    bouyer 	 * Thaw it here.
   1626    1.2    bouyer 	 */
   1627   1.39    bouyer 	if (xs->error != XS_NOERROR)
   1628   1.39    bouyer 		scsipi_periph_thaw(periph, 1);
   1629    1.2    bouyer 
   1630   1.70  christos 	if (periph->periph_switch->psw_done)
   1631  1.113   mycroft 		periph->periph_switch->psw_done(xs, error);
   1632   1.39    bouyer 
   1633   1.39    bouyer 	if (xs->xs_control & XS_CTL_ASYNC)
   1634   1.39    bouyer 		scsipi_put_xs(xs);
   1635   1.39    bouyer 	splx(s);
   1636   1.39    bouyer 
   1637   1.39    bouyer 	return (error);
   1638   1.39    bouyer }
   1639   1.39    bouyer 
   1640   1.39    bouyer /*
   1641   1.39    bouyer  * Issue a request sense for the given scsipi_xfer. Called when the xfer
   1642   1.39    bouyer  * returns with a CHECK_CONDITION status. Must be called in valid thread
   1643   1.39    bouyer  * context and at splbio().
   1644   1.39    bouyer  */
   1645   1.39    bouyer 
   1646  1.108   thorpej static void
   1647  1.108   thorpej scsipi_request_sense(struct scsipi_xfer *xs)
   1648   1.39    bouyer {
   1649   1.39    bouyer 	struct scsipi_periph *periph = xs->xs_periph;
   1650   1.39    bouyer 	int flags, error;
   1651  1.127   thorpej 	struct scsi_request_sense cmd;
   1652   1.39    bouyer 
   1653   1.39    bouyer 	periph->periph_flags |= PERIPH_SENSE;
   1654   1.39    bouyer 
   1655   1.39    bouyer 	/* if command was polling, request sense will too */
   1656   1.39    bouyer 	flags = xs->xs_control & XS_CTL_POLL;
   1657   1.39    bouyer 	/* Polling commands can't sleep */
   1658   1.39    bouyer 	if (flags)
   1659   1.39    bouyer 		flags |= XS_CTL_NOSLEEP;
   1660   1.39    bouyer 
   1661   1.39    bouyer 	flags |= XS_CTL_REQSENSE | XS_CTL_URGENT | XS_CTL_DATA_IN |
   1662   1.39    bouyer 	    XS_CTL_THAW_PERIPH | XS_CTL_FREEZE_PERIPH;
   1663   1.39    bouyer 
   1664   1.50   thorpej 	memset(&cmd, 0, sizeof(cmd));
   1665  1.127   thorpej 	cmd.opcode = SCSI_REQUEST_SENSE;
   1666  1.127   thorpej 	cmd.length = sizeof(struct scsi_sense_data);
   1667   1.39    bouyer 
   1668  1.116   mycroft 	error = scsipi_command(periph, (void *)&cmd, sizeof(cmd),
   1669  1.127   thorpej 	    (void *)&xs->sense.scsi_sense, sizeof(struct scsi_sense_data),
   1670   1.39    bouyer 	    0, 1000, NULL, flags);
   1671   1.39    bouyer 	periph->periph_flags &= ~PERIPH_SENSE;
   1672   1.39    bouyer 	periph->periph_xscheck = NULL;
   1673  1.117   mycroft 	switch (error) {
   1674   1.39    bouyer 	case 0:
   1675   1.39    bouyer 		/* we have a valid sense */
   1676   1.39    bouyer 		xs->error = XS_SENSE;
   1677   1.39    bouyer 		return;
   1678   1.39    bouyer 	case EINTR:
   1679   1.39    bouyer 		/* REQUEST_SENSE interrupted by bus reset. */
   1680   1.39    bouyer 		xs->error = XS_RESET;
   1681   1.39    bouyer 		return;
   1682   1.39    bouyer 	case EIO:
   1683   1.39    bouyer 		 /* request sense coudn't be performed */
   1684    1.2    bouyer 		/*
   1685   1.78       wiz 		 * XXX this isn't quite right but we don't have anything
   1686   1.39    bouyer 		 * better for now
   1687    1.2    bouyer 		 */
   1688   1.39    bouyer 		xs->error = XS_DRIVER_STUFFUP;
   1689   1.39    bouyer 		return;
   1690   1.39    bouyer 	default:
   1691   1.39    bouyer 		 /* Notify that request sense failed. */
   1692   1.39    bouyer 		xs->error = XS_DRIVER_STUFFUP;
   1693   1.39    bouyer 		scsipi_printaddr(periph);
   1694   1.39    bouyer 		printf("request sense failed with error %d\n", error);
   1695   1.39    bouyer 		return;
   1696   1.39    bouyer 	}
   1697   1.39    bouyer }
   1698   1.39    bouyer 
   1699   1.39    bouyer /*
   1700   1.39    bouyer  * scsipi_enqueue:
   1701   1.39    bouyer  *
   1702   1.39    bouyer  *	Enqueue an xfer on a channel.
   1703   1.39    bouyer  */
   1704  1.108   thorpej static int
   1705  1.108   thorpej scsipi_enqueue(struct scsipi_xfer *xs)
   1706   1.39    bouyer {
   1707   1.39    bouyer 	struct scsipi_channel *chan = xs->xs_periph->periph_channel;
   1708   1.39    bouyer 	struct scsipi_xfer *qxs;
   1709   1.39    bouyer 	int s;
   1710   1.39    bouyer 
   1711   1.39    bouyer 	s = splbio();
   1712   1.39    bouyer 
   1713   1.39    bouyer 	/*
   1714   1.39    bouyer 	 * If the xfer is to be polled, and there are already jobs on
   1715   1.39    bouyer 	 * the queue, we can't proceed.
   1716   1.39    bouyer 	 */
   1717   1.39    bouyer 	if ((xs->xs_control & XS_CTL_POLL) != 0 &&
   1718   1.39    bouyer 	    TAILQ_FIRST(&chan->chan_queue) != NULL) {
   1719   1.39    bouyer 		splx(s);
   1720   1.39    bouyer 		xs->error = XS_DRIVER_STUFFUP;
   1721   1.39    bouyer 		return (EAGAIN);
   1722    1.2    bouyer 	}
   1723   1.39    bouyer 
   1724    1.9    scottr 	/*
   1725   1.39    bouyer 	 * If we have an URGENT xfer, it's an error recovery command
   1726   1.39    bouyer 	 * and it should just go on the head of the channel's queue.
   1727    1.9    scottr 	 */
   1728   1.39    bouyer 	if (xs->xs_control & XS_CTL_URGENT) {
   1729   1.39    bouyer 		TAILQ_INSERT_HEAD(&chan->chan_queue, xs, channel_q);
   1730   1.39    bouyer 		goto out;
   1731   1.39    bouyer 	}
   1732   1.39    bouyer 
   1733   1.39    bouyer 	/*
   1734   1.39    bouyer 	 * If this xfer has already been on the queue before, we
   1735   1.39    bouyer 	 * need to reinsert it in the correct order.  That order is:
   1736   1.39    bouyer 	 *
   1737   1.39    bouyer 	 *	Immediately before the first xfer for this periph
   1738   1.39    bouyer 	 *	with a requeuecnt less than xs->xs_requeuecnt.
   1739   1.39    bouyer 	 *
   1740   1.39    bouyer 	 * Failing that, at the end of the queue.  (We'll end up
   1741   1.39    bouyer 	 * there naturally.)
   1742   1.39    bouyer 	 */
   1743   1.39    bouyer 	if (xs->xs_requeuecnt != 0) {
   1744   1.39    bouyer 		for (qxs = TAILQ_FIRST(&chan->chan_queue); qxs != NULL;
   1745   1.39    bouyer 		     qxs = TAILQ_NEXT(qxs, channel_q)) {
   1746   1.39    bouyer 			if (qxs->xs_periph == xs->xs_periph &&
   1747   1.39    bouyer 			    qxs->xs_requeuecnt < xs->xs_requeuecnt)
   1748   1.39    bouyer 				break;
   1749   1.39    bouyer 		}
   1750   1.39    bouyer 		if (qxs != NULL) {
   1751   1.39    bouyer 			TAILQ_INSERT_AFTER(&chan->chan_queue, qxs, xs,
   1752   1.39    bouyer 			    channel_q);
   1753   1.39    bouyer 			goto out;
   1754   1.39    bouyer 		}
   1755   1.39    bouyer 	}
   1756   1.39    bouyer 	TAILQ_INSERT_TAIL(&chan->chan_queue, xs, channel_q);
   1757   1.39    bouyer  out:
   1758   1.39    bouyer 	if (xs->xs_control & XS_CTL_THAW_PERIPH)
   1759   1.39    bouyer 		scsipi_periph_thaw(xs->xs_periph, 1);
   1760   1.39    bouyer 	splx(s);
   1761   1.39    bouyer 	return (0);
   1762   1.39    bouyer }
   1763   1.39    bouyer 
   1764   1.39    bouyer /*
   1765   1.39    bouyer  * scsipi_run_queue:
   1766   1.39    bouyer  *
   1767   1.39    bouyer  *	Start as many xfers as possible running on the channel.
   1768   1.39    bouyer  */
   1769  1.108   thorpej static void
   1770  1.108   thorpej scsipi_run_queue(struct scsipi_channel *chan)
   1771   1.39    bouyer {
   1772   1.39    bouyer 	struct scsipi_xfer *xs;
   1773   1.39    bouyer 	struct scsipi_periph *periph;
   1774   1.39    bouyer 	int s;
   1775   1.39    bouyer 
   1776   1.39    bouyer 	for (;;) {
   1777   1.31     enami 		s = splbio();
   1778   1.39    bouyer 
   1779   1.39    bouyer 		/*
   1780   1.39    bouyer 		 * If the channel is frozen, we can't do any work right
   1781   1.39    bouyer 		 * now.
   1782   1.39    bouyer 		 */
   1783   1.39    bouyer 		if (chan->chan_qfreeze != 0) {
   1784   1.39    bouyer 			splx(s);
   1785   1.39    bouyer 			return;
   1786   1.39    bouyer 		}
   1787   1.39    bouyer 
   1788   1.39    bouyer 		/*
   1789   1.39    bouyer 		 * Look for work to do, and make sure we can do it.
   1790   1.39    bouyer 		 */
   1791   1.39    bouyer 		for (xs = TAILQ_FIRST(&chan->chan_queue); xs != NULL;
   1792   1.39    bouyer 		     xs = TAILQ_NEXT(xs, channel_q)) {
   1793   1.39    bouyer 			periph = xs->xs_periph;
   1794   1.39    bouyer 
   1795   1.39    bouyer 			if ((periph->periph_sent >= periph->periph_openings) ||
   1796   1.39    bouyer 			    periph->periph_qfreeze != 0 ||
   1797   1.39    bouyer 			    (periph->periph_flags & PERIPH_UNTAG) != 0)
   1798   1.39    bouyer 				continue;
   1799   1.39    bouyer 
   1800   1.39    bouyer 			if ((periph->periph_flags &
   1801   1.39    bouyer 			    (PERIPH_RECOVERING | PERIPH_SENSE)) != 0 &&
   1802   1.39    bouyer 			    (xs->xs_control & XS_CTL_URGENT) == 0)
   1803   1.39    bouyer 				continue;
   1804   1.39    bouyer 
   1805   1.39    bouyer 			/*
   1806   1.39    bouyer 			 * We can issue this xfer!
   1807   1.39    bouyer 			 */
   1808   1.39    bouyer 			goto got_one;
   1809   1.39    bouyer 		}
   1810   1.39    bouyer 
   1811   1.39    bouyer 		/*
   1812   1.39    bouyer 		 * Can't find any work to do right now.
   1813   1.39    bouyer 		 */
   1814   1.22        pk 		splx(s);
   1815   1.39    bouyer 		return;
   1816   1.39    bouyer 
   1817   1.39    bouyer  got_one:
   1818   1.39    bouyer 		/*
   1819   1.39    bouyer 		 * Have an xfer to run.  Allocate a resource from
   1820   1.39    bouyer 		 * the adapter to run it.  If we can't allocate that
   1821   1.39    bouyer 		 * resource, we don't dequeue the xfer.
   1822   1.39    bouyer 		 */
   1823   1.39    bouyer 		if (scsipi_get_resource(chan) == 0) {
   1824   1.39    bouyer 			/*
   1825   1.39    bouyer 			 * Adapter is out of resources.  If the adapter
   1826   1.39    bouyer 			 * supports it, attempt to grow them.
   1827   1.39    bouyer 			 */
   1828   1.39    bouyer 			if (scsipi_grow_resources(chan) == 0) {
   1829   1.39    bouyer 				/*
   1830   1.39    bouyer 				 * Wasn't able to grow resources,
   1831   1.39    bouyer 				 * nothing more we can do.
   1832   1.39    bouyer 				 */
   1833   1.39    bouyer 				if (xs->xs_control & XS_CTL_POLL) {
   1834   1.39    bouyer 					scsipi_printaddr(xs->xs_periph);
   1835   1.39    bouyer 					printf("polling command but no "
   1836   1.39    bouyer 					    "adapter resources");
   1837   1.39    bouyer 					/* We'll panic shortly... */
   1838   1.39    bouyer 				}
   1839   1.39    bouyer 				splx(s);
   1840  1.128     perry 
   1841   1.39    bouyer 				/*
   1842   1.39    bouyer 				 * XXX: We should be able to note that
   1843   1.39    bouyer 				 * XXX: that resources are needed here!
   1844   1.39    bouyer 				 */
   1845   1.39    bouyer 				return;
   1846   1.39    bouyer 			}
   1847   1.39    bouyer 			/*
   1848   1.39    bouyer 			 * scsipi_grow_resources() allocated the resource
   1849   1.39    bouyer 			 * for us.
   1850   1.39    bouyer 			 */
   1851   1.39    bouyer 		}
   1852   1.39    bouyer 
   1853   1.39    bouyer 		/*
   1854   1.39    bouyer 		 * We have a resource to run this xfer, do it!
   1855   1.39    bouyer 		 */
   1856   1.39    bouyer 		TAILQ_REMOVE(&chan->chan_queue, xs, channel_q);
   1857   1.39    bouyer 
   1858   1.39    bouyer 		/*
   1859   1.39    bouyer 		 * If the command is to be tagged, allocate a tag ID
   1860   1.39    bouyer 		 * for it.
   1861   1.39    bouyer 		 */
   1862   1.39    bouyer 		if (XS_CTL_TAGTYPE(xs) != 0)
   1863   1.39    bouyer 			scsipi_get_tag(xs);
   1864   1.39    bouyer 		else
   1865   1.39    bouyer 			periph->periph_flags |= PERIPH_UNTAG;
   1866   1.39    bouyer 		periph->periph_sent++;
   1867   1.39    bouyer 		splx(s);
   1868   1.39    bouyer 
   1869   1.39    bouyer 		scsipi_adapter_request(chan, ADAPTER_REQ_RUN_XFER, xs);
   1870   1.22        pk 	}
   1871   1.39    bouyer #ifdef DIAGNOSTIC
   1872   1.39    bouyer 	panic("scsipi_run_queue: impossible");
   1873   1.39    bouyer #endif
   1874    1.2    bouyer }
   1875    1.2    bouyer 
   1876   1.39    bouyer /*
   1877   1.39    bouyer  * scsipi_execute_xs:
   1878   1.39    bouyer  *
   1879   1.39    bouyer  *	Begin execution of an xfer, waiting for it to complete, if necessary.
   1880   1.39    bouyer  */
   1881    1.2    bouyer int
   1882  1.108   thorpej scsipi_execute_xs(struct scsipi_xfer *xs)
   1883    1.2    bouyer {
   1884   1.39    bouyer 	struct scsipi_periph *periph = xs->xs_periph;
   1885   1.39    bouyer 	struct scsipi_channel *chan = periph->periph_channel;
   1886  1.120   mycroft 	int oasync, async, poll, error, s;
   1887    1.2    bouyer 
   1888  1.119   mycroft 	KASSERT(!cold);
   1889  1.156       mrg 	KASSERT(KERNEL_LOCKED_P());
   1890  1.119   mycroft 
   1891  1.114   mycroft 	(chan->chan_bustype->bustype_cmd)(xs);
   1892  1.114   mycroft 
   1893   1.24   thorpej 	xs->xs_status &= ~XS_STS_DONE;
   1894    1.2    bouyer 	xs->error = XS_NOERROR;
   1895    1.2    bouyer 	xs->resid = xs->datalen;
   1896   1.39    bouyer 	xs->status = SCSI_OK;
   1897   1.39    bouyer 
   1898   1.39    bouyer #ifdef SCSIPI_DEBUG
   1899   1.39    bouyer 	if (xs->xs_periph->periph_dbflags & SCSIPI_DB3) {
   1900   1.39    bouyer 		printf("scsipi_execute_xs: ");
   1901   1.39    bouyer 		show_scsipi_xs(xs);
   1902   1.39    bouyer 		printf("\n");
   1903   1.39    bouyer 	}
   1904   1.39    bouyer #endif
   1905    1.2    bouyer 
   1906    1.2    bouyer 	/*
   1907   1.39    bouyer 	 * Deal with command tagging:
   1908    1.3     enami 	 *
   1909   1.39    bouyer 	 *	- If the device's current operating mode doesn't
   1910   1.39    bouyer 	 *	  include tagged queueing, clear the tag mask.
   1911    1.3     enami 	 *
   1912   1.39    bouyer 	 *	- If the device's current operating mode *does*
   1913   1.39    bouyer 	 *	  include tagged queueing, set the tag_type in
   1914   1.39    bouyer 	 *	  the xfer to the appropriate byte for the tag
   1915   1.39    bouyer 	 *	  message.
   1916   1.39    bouyer 	 */
   1917   1.39    bouyer 	if ((PERIPH_XFER_MODE(periph) & PERIPH_CAP_TQING) == 0 ||
   1918   1.39    bouyer 		(xs->xs_control & XS_CTL_REQSENSE)) {
   1919   1.39    bouyer 		xs->xs_control &= ~XS_CTL_TAGMASK;
   1920   1.39    bouyer 		xs->xs_tag_type = 0;
   1921   1.39    bouyer 	} else {
   1922   1.39    bouyer 		/*
   1923   1.39    bouyer 		 * If the request doesn't specify a tag, give Head
   1924   1.39    bouyer 		 * tags to URGENT operations and Ordered tags to
   1925   1.39    bouyer 		 * everything else.
   1926   1.39    bouyer 		 */
   1927   1.39    bouyer 		if (XS_CTL_TAGTYPE(xs) == 0) {
   1928   1.39    bouyer 			if (xs->xs_control & XS_CTL_URGENT)
   1929   1.39    bouyer 				xs->xs_control |= XS_CTL_HEAD_TAG;
   1930   1.39    bouyer 			else
   1931   1.39    bouyer 				xs->xs_control |= XS_CTL_ORDERED_TAG;
   1932   1.39    bouyer 		}
   1933   1.39    bouyer 
   1934   1.39    bouyer 		switch (XS_CTL_TAGTYPE(xs)) {
   1935   1.39    bouyer 		case XS_CTL_ORDERED_TAG:
   1936   1.39    bouyer 			xs->xs_tag_type = MSG_ORDERED_Q_TAG;
   1937   1.39    bouyer 			break;
   1938   1.39    bouyer 
   1939   1.39    bouyer 		case XS_CTL_SIMPLE_TAG:
   1940   1.39    bouyer 			xs->xs_tag_type = MSG_SIMPLE_Q_TAG;
   1941   1.39    bouyer 			break;
   1942   1.39    bouyer 
   1943   1.39    bouyer 		case XS_CTL_HEAD_TAG:
   1944   1.39    bouyer 			xs->xs_tag_type = MSG_HEAD_OF_Q_TAG;
   1945   1.39    bouyer 			break;
   1946   1.39    bouyer 
   1947   1.39    bouyer 		default:
   1948   1.39    bouyer 			scsipi_printaddr(periph);
   1949   1.39    bouyer 			printf("invalid tag mask 0x%08x\n",
   1950   1.39    bouyer 			    XS_CTL_TAGTYPE(xs));
   1951   1.39    bouyer 			panic("scsipi_execute_xs");
   1952   1.39    bouyer 		}
   1953    1.2    bouyer 	}
   1954   1.45     bjh21 
   1955   1.45     bjh21 	/* If the adaptor wants us to poll, poll. */
   1956   1.45     bjh21 	if (chan->chan_adapter->adapt_flags & SCSIPI_ADAPT_POLL_ONLY)
   1957   1.45     bjh21 		xs->xs_control |= XS_CTL_POLL;
   1958   1.39    bouyer 
   1959   1.39    bouyer 	/*
   1960   1.39    bouyer 	 * If we don't yet have a completion thread, or we are to poll for
   1961   1.39    bouyer 	 * completion, clear the ASYNC flag.
   1962   1.39    bouyer 	 */
   1963   1.69    bouyer 	oasync =  (xs->xs_control & XS_CTL_ASYNC);
   1964   1.39    bouyer 	if (chan->chan_thread == NULL || (xs->xs_control & XS_CTL_POLL) != 0)
   1965   1.39    bouyer 		xs->xs_control &= ~XS_CTL_ASYNC;
   1966   1.39    bouyer 
   1967   1.24   thorpej 	async = (xs->xs_control & XS_CTL_ASYNC);
   1968   1.39    bouyer 	poll = (xs->xs_control & XS_CTL_POLL);
   1969   1.39    bouyer 
   1970    1.2    bouyer #ifdef DIAGNOSTIC
   1971   1.69    bouyer 	if (oasync != 0 && xs->bp == NULL)
   1972   1.39    bouyer 		panic("scsipi_execute_xs: XS_CTL_ASYNC but no buf");
   1973    1.2    bouyer #endif
   1974   1.39    bouyer 
   1975   1.39    bouyer 	/*
   1976   1.39    bouyer 	 * Enqueue the transfer.  If we're not polling for completion, this
   1977   1.39    bouyer 	 * should ALWAYS return `no error'.
   1978   1.39    bouyer 	 */
   1979   1.39    bouyer 	error = scsipi_enqueue(xs);
   1980   1.39    bouyer 	if (error) {
   1981   1.39    bouyer 		if (poll == 0) {
   1982   1.39    bouyer 			scsipi_printaddr(periph);
   1983   1.39    bouyer 			printf("not polling, but enqueue failed with %d\n",
   1984   1.39    bouyer 			    error);
   1985   1.39    bouyer 			panic("scsipi_execute_xs");
   1986   1.39    bouyer 		}
   1987  1.128     perry 
   1988   1.39    bouyer 		scsipi_printaddr(periph);
   1989  1.120   mycroft 		printf("should have flushed queue?\n");
   1990   1.39    bouyer 		goto free_xs;
   1991   1.39    bouyer 	}
   1992   1.39    bouyer 
   1993   1.39    bouyer  restarted:
   1994   1.39    bouyer 	scsipi_run_queue(chan);
   1995   1.39    bouyer 
   1996   1.39    bouyer 	/*
   1997   1.39    bouyer 	 * The xfer is enqueued, and possibly running.  If it's to be
   1998   1.39    bouyer 	 * completed asynchronously, just return now.
   1999   1.39    bouyer 	 */
   2000   1.39    bouyer 	if (async)
   2001  1.118   mycroft 		return (0);
   2002   1.39    bouyer 
   2003   1.39    bouyer 	/*
   2004   1.39    bouyer 	 * Not an asynchronous command; wait for it to complete.
   2005   1.39    bouyer 	 */
   2006   1.39    bouyer 	s = splbio();
   2007   1.39    bouyer 	while ((xs->xs_status & XS_STS_DONE) == 0) {
   2008   1.39    bouyer 		if (poll) {
   2009   1.39    bouyer 			scsipi_printaddr(periph);
   2010   1.39    bouyer 			printf("polling command not done\n");
   2011   1.39    bouyer 			panic("scsipi_execute_xs");
   2012   1.39    bouyer 		}
   2013   1.39    bouyer 		(void) tsleep(xs, PRIBIO, "xscmd", 0);
   2014   1.39    bouyer 	}
   2015   1.39    bouyer 	splx(s);
   2016   1.39    bouyer 
   2017   1.39    bouyer 	/*
   2018   1.39    bouyer 	 * Command is complete.  scsipi_done() has awakened us to perform
   2019   1.39    bouyer 	 * the error handling.
   2020   1.39    bouyer 	 */
   2021   1.39    bouyer 	error = scsipi_complete(xs);
   2022   1.39    bouyer 	if (error == ERESTART)
   2023   1.39    bouyer 		goto restarted;
   2024   1.39    bouyer 
   2025   1.69    bouyer 	/*
   2026  1.128     perry 	 * If it was meant to run async and we cleared aync ourselve,
   2027   1.69    bouyer 	 * don't return an error here. It has already been handled
   2028   1.69    bouyer 	 */
   2029   1.69    bouyer 	if (oasync)
   2030  1.118   mycroft 		error = 0;
   2031   1.39    bouyer 	/*
   2032   1.39    bouyer 	 * Command completed successfully or fatal error occurred.  Fall
   2033   1.39    bouyer 	 * into....
   2034   1.39    bouyer 	 */
   2035   1.39    bouyer  free_xs:
   2036   1.39    bouyer 	s = splbio();
   2037   1.39    bouyer 	scsipi_put_xs(xs);
   2038   1.39    bouyer 	splx(s);
   2039   1.39    bouyer 
   2040   1.39    bouyer 	/*
   2041   1.39    bouyer 	 * Kick the queue, keep it running in case it stopped for some
   2042   1.39    bouyer 	 * reason.
   2043   1.39    bouyer 	 */
   2044   1.39    bouyer 	scsipi_run_queue(chan);
   2045   1.39    bouyer 
   2046   1.39    bouyer 	return (error);
   2047   1.39    bouyer }
   2048   1.39    bouyer 
   2049   1.39    bouyer /*
   2050   1.39    bouyer  * scsipi_completion_thread:
   2051   1.39    bouyer  *
   2052   1.39    bouyer  *	This is the completion thread.  We wait for errors on
   2053   1.39    bouyer  *	asynchronous xfers, and perform the error handling
   2054   1.39    bouyer  *	function, restarting the command, if necessary.
   2055   1.39    bouyer  */
   2056  1.108   thorpej static void
   2057  1.108   thorpej scsipi_completion_thread(void *arg)
   2058   1.39    bouyer {
   2059   1.39    bouyer 	struct scsipi_channel *chan = arg;
   2060   1.39    bouyer 	struct scsipi_xfer *xs;
   2061   1.39    bouyer 	int s;
   2062   1.79       jmc 
   2063   1.79       jmc 	if (chan->chan_init_cb)
   2064   1.79       jmc 		(*chan->chan_init_cb)(chan, chan->chan_init_cb_arg);
   2065   1.39    bouyer 
   2066   1.58    mjacob 	s = splbio();
   2067   1.58    mjacob 	chan->chan_flags |= SCSIPI_CHAN_TACTIVE;
   2068   1.58    mjacob 	splx(s);
   2069   1.39    bouyer 	for (;;) {
   2070   1.11    scottr 		s = splbio();
   2071   1.39    bouyer 		xs = TAILQ_FIRST(&chan->chan_complete);
   2072   1.60    bouyer 		if (xs == NULL && chan->chan_tflags  == 0) {
   2073   1.60    bouyer 			/* nothing to do; wait */
   2074   1.39    bouyer 			(void) tsleep(&chan->chan_complete, PRIBIO,
   2075   1.39    bouyer 			    "sccomp", 0);
   2076   1.39    bouyer 			splx(s);
   2077   1.39    bouyer 			continue;
   2078   1.39    bouyer 		}
   2079   1.59    bouyer 		if (chan->chan_tflags & SCSIPI_CHANT_CALLBACK) {
   2080   1.51    bouyer 			/* call chan_callback from thread context */
   2081   1.59    bouyer 			chan->chan_tflags &= ~SCSIPI_CHANT_CALLBACK;
   2082   1.51    bouyer 			chan->chan_callback(chan, chan->chan_callback_arg);
   2083   1.60    bouyer 			splx(s);
   2084   1.60    bouyer 			continue;
   2085   1.60    bouyer 		}
   2086   1.60    bouyer 		if (chan->chan_tflags & SCSIPI_CHANT_GROWRES) {
   2087   1.60    bouyer 			/* attempt to get more openings for this channel */
   2088   1.60    bouyer 			chan->chan_tflags &= ~SCSIPI_CHANT_GROWRES;
   2089   1.60    bouyer 			scsipi_adapter_request(chan,
   2090   1.60    bouyer 			    ADAPTER_REQ_GROW_RESOURCES, NULL);
   2091   1.60    bouyer 			scsipi_channel_thaw(chan, 1);
   2092   1.58    mjacob 			splx(s);
   2093  1.143        ad 			if (chan->chan_tflags & SCSIPI_CHANT_GROWRES)
   2094  1.143        ad 				kpause("scsizzz", FALSE, hz/10, NULL);
   2095   1.58    mjacob 			continue;
   2096   1.58    mjacob 		}
   2097   1.59    bouyer 		if (chan->chan_tflags & SCSIPI_CHANT_KICK) {
   2098   1.58    mjacob 			/* explicitly run the queues for this channel */
   2099   1.59    bouyer 			chan->chan_tflags &= ~SCSIPI_CHANT_KICK;
   2100   1.58    mjacob 			scsipi_run_queue(chan);
   2101   1.51    bouyer 			splx(s);
   2102   1.51    bouyer 			continue;
   2103   1.51    bouyer 		}
   2104   1.59    bouyer 		if (chan->chan_tflags & SCSIPI_CHANT_SHUTDOWN) {
   2105   1.39    bouyer 			splx(s);
   2106   1.39    bouyer 			break;
   2107   1.39    bouyer 		}
   2108   1.51    bouyer 		if (xs) {
   2109   1.51    bouyer 			TAILQ_REMOVE(&chan->chan_complete, xs, channel_q);
   2110   1.51    bouyer 			splx(s);
   2111    1.2    bouyer 
   2112   1.51    bouyer 			/*
   2113   1.51    bouyer 			 * Have an xfer with an error; process it.
   2114   1.51    bouyer 			 */
   2115   1.51    bouyer 			(void) scsipi_complete(xs);
   2116    1.2    bouyer 
   2117   1.51    bouyer 			/*
   2118   1.51    bouyer 			 * Kick the queue; keep it running if it was stopped
   2119   1.51    bouyer 			 * for some reason.
   2120   1.51    bouyer 			 */
   2121   1.51    bouyer 			scsipi_run_queue(chan);
   2122   1.51    bouyer 		} else {
   2123   1.51    bouyer 			splx(s);
   2124   1.51    bouyer 		}
   2125    1.2    bouyer 	}
   2126    1.2    bouyer 
   2127   1.39    bouyer 	chan->chan_thread = NULL;
   2128   1.39    bouyer 
   2129   1.39    bouyer 	/* In case parent is waiting for us to exit. */
   2130   1.39    bouyer 	wakeup(&chan->chan_thread);
   2131   1.39    bouyer 
   2132   1.39    bouyer 	kthread_exit(0);
   2133    1.2    bouyer }
   2134   1.39    bouyer /*
   2135   1.51    bouyer  * scsipi_thread_call_callback:
   2136   1.51    bouyer  *
   2137   1.51    bouyer  * 	request to call a callback from the completion thread
   2138   1.51    bouyer  */
   2139   1.51    bouyer int
   2140  1.108   thorpej scsipi_thread_call_callback(struct scsipi_channel *chan,
   2141  1.108   thorpej     void (*callback)(struct scsipi_channel *, void *), void *arg)
   2142   1.51    bouyer {
   2143   1.51    bouyer 	int s;
   2144   1.51    bouyer 
   2145   1.51    bouyer 	s = splbio();
   2146   1.61    bouyer 	if ((chan->chan_flags & SCSIPI_CHAN_TACTIVE) == 0) {
   2147   1.61    bouyer 		/* kernel thread doesn't exist yet */
   2148   1.61    bouyer 		splx(s);
   2149   1.61    bouyer 		return ESRCH;
   2150   1.61    bouyer 	}
   2151   1.59    bouyer 	if (chan->chan_tflags & SCSIPI_CHANT_CALLBACK) {
   2152   1.51    bouyer 		splx(s);
   2153   1.51    bouyer 		return EBUSY;
   2154   1.51    bouyer 	}
   2155   1.51    bouyer 	scsipi_channel_freeze(chan, 1);
   2156   1.51    bouyer 	chan->chan_callback = callback;
   2157   1.51    bouyer 	chan->chan_callback_arg = arg;
   2158   1.59    bouyer 	chan->chan_tflags |= SCSIPI_CHANT_CALLBACK;
   2159   1.51    bouyer 	wakeup(&chan->chan_complete);
   2160   1.51    bouyer 	splx(s);
   2161   1.51    bouyer 	return(0);
   2162   1.51    bouyer }
   2163   1.51    bouyer 
   2164   1.51    bouyer /*
   2165   1.39    bouyer  * scsipi_async_event:
   2166   1.39    bouyer  *
   2167   1.39    bouyer  *	Handle an asynchronous event from an adapter.
   2168   1.39    bouyer  */
   2169   1.39    bouyer void
   2170  1.108   thorpej scsipi_async_event(struct scsipi_channel *chan, scsipi_async_event_t event,
   2171  1.108   thorpej     void *arg)
   2172   1.39    bouyer {
   2173   1.39    bouyer 	int s;
   2174   1.39    bouyer 
   2175   1.39    bouyer 	s = splbio();
   2176   1.39    bouyer 	switch (event) {
   2177   1.39    bouyer 	case ASYNC_EVENT_MAX_OPENINGS:
   2178   1.39    bouyer 		scsipi_async_event_max_openings(chan,
   2179   1.39    bouyer 		    (struct scsipi_max_openings *)arg);
   2180    1.2    bouyer 		break;
   2181    1.2    bouyer 
   2182   1.39    bouyer 	case ASYNC_EVENT_XFER_MODE:
   2183  1.159    bouyer 		if (chan->chan_bustype->bustype_async_event_xfer_mode) {
   2184  1.159    bouyer 			chan->chan_bustype->bustype_async_event_xfer_mode(
   2185  1.159    bouyer 			    chan, arg);
   2186  1.159    bouyer 		}
   2187   1.39    bouyer 		break;
   2188   1.39    bouyer 	case ASYNC_EVENT_RESET:
   2189   1.39    bouyer 		scsipi_async_event_channel_reset(chan);
   2190    1.2    bouyer 		break;
   2191   1.39    bouyer 	}
   2192   1.39    bouyer 	splx(s);
   2193   1.39    bouyer }
   2194   1.39    bouyer 
   2195   1.39    bouyer /*
   2196   1.39    bouyer  * scsipi_async_event_max_openings:
   2197   1.39    bouyer  *
   2198   1.39    bouyer  *	Update the maximum number of outstanding commands a
   2199   1.39    bouyer  *	device may have.
   2200   1.39    bouyer  */
   2201  1.108   thorpej static void
   2202  1.108   thorpej scsipi_async_event_max_openings(struct scsipi_channel *chan,
   2203  1.108   thorpej     struct scsipi_max_openings *mo)
   2204   1.39    bouyer {
   2205   1.39    bouyer 	struct scsipi_periph *periph;
   2206   1.39    bouyer 	int minlun, maxlun;
   2207   1.39    bouyer 
   2208   1.39    bouyer 	if (mo->mo_lun == -1) {
   2209   1.39    bouyer 		/*
   2210   1.39    bouyer 		 * Wildcarded; apply it to all LUNs.
   2211   1.39    bouyer 		 */
   2212   1.39    bouyer 		minlun = 0;
   2213   1.39    bouyer 		maxlun = chan->chan_nluns - 1;
   2214   1.39    bouyer 	} else
   2215   1.39    bouyer 		minlun = maxlun = mo->mo_lun;
   2216   1.39    bouyer 
   2217   1.74   thorpej 	/* XXX This could really suck with a large LUN space. */
   2218   1.39    bouyer 	for (; minlun <= maxlun; minlun++) {
   2219   1.39    bouyer 		periph = scsipi_lookup_periph(chan, mo->mo_target, minlun);
   2220   1.39    bouyer 		if (periph == NULL)
   2221   1.39    bouyer 			continue;
   2222   1.39    bouyer 
   2223   1.39    bouyer 		if (mo->mo_openings < periph->periph_openings)
   2224   1.39    bouyer 			periph->periph_openings = mo->mo_openings;
   2225   1.39    bouyer 		else if (mo->mo_openings > periph->periph_openings &&
   2226   1.39    bouyer 		    (periph->periph_flags & PERIPH_GROW_OPENINGS) != 0)
   2227   1.39    bouyer 			periph->periph_openings = mo->mo_openings;
   2228   1.39    bouyer 	}
   2229   1.39    bouyer }
   2230   1.39    bouyer 
   2231   1.39    bouyer /*
   2232   1.39    bouyer  * scsipi_set_xfer_mode:
   2233   1.39    bouyer  *
   2234   1.39    bouyer  *	Set the xfer mode for the specified I_T Nexus.
   2235   1.39    bouyer  */
   2236   1.39    bouyer void
   2237  1.108   thorpej scsipi_set_xfer_mode(struct scsipi_channel *chan, int target, int immed)
   2238   1.39    bouyer {
   2239   1.39    bouyer 	struct scsipi_xfer_mode xm;
   2240   1.39    bouyer 	struct scsipi_periph *itperiph;
   2241   1.39    bouyer 	int lun, s;
   2242   1.39    bouyer 
   2243   1.39    bouyer 	/*
   2244   1.39    bouyer 	 * Go to the minimal xfer mode.
   2245   1.39    bouyer 	 */
   2246   1.39    bouyer 	xm.xm_target = target;
   2247   1.39    bouyer 	xm.xm_mode = 0;
   2248   1.39    bouyer 	xm.xm_period = 0;			/* ignored */
   2249   1.39    bouyer 	xm.xm_offset = 0;			/* ignored */
   2250   1.39    bouyer 
   2251   1.39    bouyer 	/*
   2252   1.39    bouyer 	 * Find the first LUN we know about on this I_T Nexus.
   2253   1.39    bouyer 	 */
   2254   1.82       scw 	for (itperiph = NULL, lun = 0; lun < chan->chan_nluns; lun++) {
   2255   1.39    bouyer 		itperiph = scsipi_lookup_periph(chan, target, lun);
   2256   1.39    bouyer 		if (itperiph != NULL)
   2257   1.39    bouyer 			break;
   2258   1.39    bouyer 	}
   2259   1.49    bouyer 	if (itperiph != NULL) {
   2260   1.39    bouyer 		xm.xm_mode = itperiph->periph_cap;
   2261   1.49    bouyer 		/*
   2262   1.49    bouyer 		 * Now issue the request to the adapter.
   2263   1.49    bouyer 		 */
   2264   1.49    bouyer 		s = splbio();
   2265   1.49    bouyer 		scsipi_adapter_request(chan, ADAPTER_REQ_SET_XFER_MODE, &xm);
   2266   1.49    bouyer 		splx(s);
   2267   1.49    bouyer 		/*
   2268   1.49    bouyer 		 * If we want this to happen immediately, issue a dummy
   2269   1.49    bouyer 		 * command, since most adapters can't really negotiate unless
   2270   1.49    bouyer 		 * they're executing a job.
   2271   1.49    bouyer 		 */
   2272   1.49    bouyer 		if (immed != 0) {
   2273   1.49    bouyer 			(void) scsipi_test_unit_ready(itperiph,
   2274   1.49    bouyer 			    XS_CTL_DISCOVERY | XS_CTL_IGNORE_ILLEGAL_REQUEST |
   2275   1.49    bouyer 			    XS_CTL_IGNORE_NOT_READY |
   2276   1.49    bouyer 			    XS_CTL_IGNORE_MEDIA_CHANGE);
   2277   1.49    bouyer 		}
   2278    1.2    bouyer 	}
   2279   1.39    bouyer }
   2280    1.2    bouyer 
   2281   1.39    bouyer /*
   2282   1.39    bouyer  * scsipi_channel_reset:
   2283   1.39    bouyer  *
   2284   1.39    bouyer  *	handle scsi bus reset
   2285   1.39    bouyer  * called at splbio
   2286   1.39    bouyer  */
   2287  1.108   thorpej static void
   2288  1.108   thorpej scsipi_async_event_channel_reset(struct scsipi_channel *chan)
   2289   1.39    bouyer {
   2290   1.39    bouyer 	struct scsipi_xfer *xs, *xs_next;
   2291   1.39    bouyer 	struct scsipi_periph *periph;
   2292   1.39    bouyer 	int target, lun;
   2293   1.39    bouyer 
   2294   1.39    bouyer 	/*
   2295   1.39    bouyer 	 * Channel has been reset. Also mark as reset pending REQUEST_SENSE
   2296   1.39    bouyer 	 * commands; as the sense is not available any more.
   2297   1.39    bouyer 	 * can't call scsipi_done() from here, as the command has not been
   2298   1.39    bouyer 	 * sent to the adapter yet (this would corrupt accounting).
   2299   1.39    bouyer 	 */
   2300   1.39    bouyer 
   2301   1.39    bouyer 	for (xs = TAILQ_FIRST(&chan->chan_queue); xs != NULL; xs = xs_next) {
   2302   1.39    bouyer 		xs_next = TAILQ_NEXT(xs, channel_q);
   2303   1.39    bouyer 		if (xs->xs_control & XS_CTL_REQSENSE) {
   2304   1.39    bouyer 			TAILQ_REMOVE(&chan->chan_queue, xs, channel_q);
   2305   1.39    bouyer 			xs->error = XS_RESET;
   2306   1.39    bouyer 			if ((xs->xs_control & XS_CTL_ASYNC) != 0)
   2307   1.39    bouyer 				TAILQ_INSERT_TAIL(&chan->chan_complete, xs,
   2308   1.39    bouyer 				    channel_q);
   2309   1.39    bouyer 		}
   2310   1.39    bouyer 	}
   2311   1.39    bouyer 	wakeup(&chan->chan_complete);
   2312   1.39    bouyer 	/* Catch xs with pending sense which may not have a REQSENSE xs yet */
   2313   1.39    bouyer 	for (target = 0; target < chan->chan_ntargets; target++) {
   2314   1.39    bouyer 		if (target == chan->chan_id)
   2315   1.39    bouyer 			continue;
   2316   1.39    bouyer 		for (lun = 0; lun <  chan->chan_nluns; lun++) {
   2317   1.76    bouyer 			periph = scsipi_lookup_periph(chan, target, lun);
   2318   1.39    bouyer 			if (periph) {
   2319   1.39    bouyer 				xs = periph->periph_xscheck;
   2320   1.39    bouyer 				if (xs)
   2321   1.39    bouyer 					xs->error = XS_RESET;
   2322   1.39    bouyer 			}
   2323   1.39    bouyer 		}
   2324   1.39    bouyer 	}
   2325    1.2    bouyer }
   2326    1.2    bouyer 
   2327   1.51    bouyer /*
   2328   1.51    bouyer  * scsipi_target_detach:
   2329   1.51    bouyer  *
   2330   1.51    bouyer  *	detach all periph associated with a I_T
   2331   1.51    bouyer  * 	must be called from valid thread context
   2332   1.51    bouyer  */
   2333   1.51    bouyer int
   2334  1.108   thorpej scsipi_target_detach(struct scsipi_channel *chan, int target, int lun,
   2335  1.108   thorpej     int flags)
   2336   1.51    bouyer {
   2337   1.51    bouyer 	struct scsipi_periph *periph;
   2338   1.51    bouyer 	int ctarget, mintarget, maxtarget;
   2339   1.51    bouyer 	int clun, minlun, maxlun;
   2340   1.51    bouyer 	int error;
   2341   1.51    bouyer 
   2342   1.51    bouyer 	if (target == -1) {
   2343   1.51    bouyer 		mintarget = 0;
   2344   1.51    bouyer 		maxtarget = chan->chan_ntargets;
   2345   1.51    bouyer 	} else {
   2346   1.51    bouyer 		if (target == chan->chan_id)
   2347   1.51    bouyer 			return EINVAL;
   2348   1.51    bouyer 		if (target < 0 || target >= chan->chan_ntargets)
   2349   1.51    bouyer 			return EINVAL;
   2350   1.51    bouyer 		mintarget = target;
   2351   1.51    bouyer 		maxtarget = target + 1;
   2352   1.51    bouyer 	}
   2353   1.51    bouyer 
   2354   1.51    bouyer 	if (lun == -1) {
   2355   1.51    bouyer 		minlun = 0;
   2356   1.51    bouyer 		maxlun = chan->chan_nluns;
   2357   1.51    bouyer 	} else {
   2358   1.51    bouyer 		if (lun < 0 || lun >= chan->chan_nluns)
   2359   1.51    bouyer 			return EINVAL;
   2360   1.51    bouyer 		minlun = lun;
   2361   1.51    bouyer 		maxlun = lun + 1;
   2362   1.51    bouyer 	}
   2363   1.51    bouyer 
   2364   1.52      yamt 	for (ctarget = mintarget; ctarget < maxtarget; ctarget++) {
   2365   1.51    bouyer 		if (ctarget == chan->chan_id)
   2366   1.51    bouyer 			continue;
   2367   1.51    bouyer 
   2368   1.51    bouyer 		for (clun = minlun; clun < maxlun; clun++) {
   2369   1.52      yamt 			periph = scsipi_lookup_periph(chan, ctarget, clun);
   2370   1.51    bouyer 			if (periph == NULL)
   2371   1.51    bouyer 				continue;
   2372   1.51    bouyer 			error = config_detach(periph->periph_dev, flags);
   2373   1.51    bouyer 			if (error)
   2374   1.51    bouyer 				return (error);
   2375   1.51    bouyer 		}
   2376   1.51    bouyer 	}
   2377   1.51    bouyer 	return(0);
   2378   1.51    bouyer }
   2379   1.39    bouyer 
   2380   1.14   thorpej /*
   2381   1.39    bouyer  * scsipi_adapter_addref:
   2382   1.39    bouyer  *
   2383   1.39    bouyer  *	Add a reference to the adapter pointed to by the provided
   2384   1.39    bouyer  *	link, enabling the adapter if necessary.
   2385   1.14   thorpej  */
   2386   1.14   thorpej int
   2387  1.108   thorpej scsipi_adapter_addref(struct scsipi_adapter *adapt)
   2388   1.14   thorpej {
   2389   1.14   thorpej 	int s, error = 0;
   2390   1.14   thorpej 
   2391   1.14   thorpej 	s = splbio();
   2392   1.39    bouyer 	if (adapt->adapt_refcnt++ == 0 && adapt->adapt_enable != NULL) {
   2393   1.39    bouyer 		error = (*adapt->adapt_enable)(adapt->adapt_dev, 1);
   2394   1.14   thorpej 		if (error)
   2395   1.39    bouyer 			adapt->adapt_refcnt--;
   2396   1.14   thorpej 	}
   2397   1.14   thorpej 	splx(s);
   2398   1.14   thorpej 	return (error);
   2399   1.14   thorpej }
   2400   1.14   thorpej 
   2401   1.14   thorpej /*
   2402   1.39    bouyer  * scsipi_adapter_delref:
   2403   1.39    bouyer  *
   2404   1.39    bouyer  *	Delete a reference to the adapter pointed to by the provided
   2405   1.39    bouyer  *	link, disabling the adapter if possible.
   2406   1.14   thorpej  */
   2407   1.14   thorpej void
   2408  1.108   thorpej scsipi_adapter_delref(struct scsipi_adapter *adapt)
   2409   1.14   thorpej {
   2410   1.14   thorpej 	int s;
   2411   1.14   thorpej 
   2412   1.14   thorpej 	s = splbio();
   2413   1.39    bouyer 	if (adapt->adapt_refcnt-- == 1 && adapt->adapt_enable != NULL)
   2414   1.39    bouyer 		(void) (*adapt->adapt_enable)(adapt->adapt_dev, 0);
   2415   1.14   thorpej 	splx(s);
   2416   1.14   thorpej }
   2417   1.14   thorpej 
   2418  1.108   thorpej static struct scsipi_syncparam {
   2419   1.39    bouyer 	int	ss_factor;
   2420   1.86   thorpej 	int	ss_period;	/* ns * 100 */
   2421   1.39    bouyer } scsipi_syncparams[] = {
   2422   1.86   thorpej 	{ 0x08,		 625 },	/* FAST-160 (Ultra320) */
   2423   1.86   thorpej 	{ 0x09,		1250 },	/* FAST-80 (Ultra160) */
   2424   1.86   thorpej 	{ 0x0a,		2500 },	/* FAST-40 40MHz (Ultra2) */
   2425   1.86   thorpej 	{ 0x0b,		3030 },	/* FAST-40 33MHz (Ultra2) */
   2426   1.86   thorpej 	{ 0x0c,		5000 },	/* FAST-20 (Ultra) */
   2427   1.39    bouyer };
   2428  1.108   thorpej static const int scsipi_nsyncparams =
   2429   1.39    bouyer     sizeof(scsipi_syncparams) / sizeof(scsipi_syncparams[0]);
   2430   1.39    bouyer 
   2431   1.39    bouyer int
   2432  1.108   thorpej scsipi_sync_period_to_factor(int period /* ns * 100 */)
   2433   1.39    bouyer {
   2434   1.39    bouyer 	int i;
   2435   1.39    bouyer 
   2436   1.39    bouyer 	for (i = 0; i < scsipi_nsyncparams; i++) {
   2437   1.39    bouyer 		if (period <= scsipi_syncparams[i].ss_period)
   2438   1.39    bouyer 			return (scsipi_syncparams[i].ss_factor);
   2439   1.39    bouyer 	}
   2440   1.39    bouyer 
   2441   1.86   thorpej 	return ((period / 100) / 4);
   2442   1.39    bouyer }
   2443   1.39    bouyer 
   2444   1.39    bouyer int
   2445  1.108   thorpej scsipi_sync_factor_to_period(int factor)
   2446   1.39    bouyer {
   2447   1.39    bouyer 	int i;
   2448   1.39    bouyer 
   2449   1.39    bouyer 	for (i = 0; i < scsipi_nsyncparams; i++) {
   2450   1.39    bouyer 		if (factor == scsipi_syncparams[i].ss_factor)
   2451   1.39    bouyer 			return (scsipi_syncparams[i].ss_period);
   2452   1.39    bouyer 	}
   2453   1.39    bouyer 
   2454   1.87   nathanw 	return ((factor * 4) * 100);
   2455   1.39    bouyer }
   2456   1.39    bouyer 
   2457   1.39    bouyer int
   2458  1.108   thorpej scsipi_sync_factor_to_freq(int factor)
   2459   1.39    bouyer {
   2460   1.39    bouyer 	int i;
   2461   1.39    bouyer 
   2462   1.39    bouyer 	for (i = 0; i < scsipi_nsyncparams; i++) {
   2463   1.39    bouyer 		if (factor == scsipi_syncparams[i].ss_factor)
   2464   1.86   thorpej 			return (100000000 / scsipi_syncparams[i].ss_period);
   2465   1.39    bouyer 	}
   2466   1.39    bouyer 
   2467   1.39    bouyer 	return (10000000 / ((factor * 4) * 10));
   2468   1.39    bouyer }
   2469   1.39    bouyer 
   2470   1.39    bouyer #ifdef SCSIPI_DEBUG
   2471    1.2    bouyer /*
   2472  1.162       snj  * Given a scsipi_xfer, dump the request, in all its glory
   2473    1.2    bouyer  */
   2474    1.2    bouyer void
   2475  1.108   thorpej show_scsipi_xs(struct scsipi_xfer *xs)
   2476    1.2    bouyer {
   2477    1.3     enami 
   2478    1.2    bouyer 	printf("xs(%p): ", xs);
   2479   1.24   thorpej 	printf("xs_control(0x%08x)", xs->xs_control);
   2480   1.24   thorpej 	printf("xs_status(0x%08x)", xs->xs_status);
   2481   1.39    bouyer 	printf("periph(%p)", xs->xs_periph);
   2482   1.39    bouyer 	printf("retr(0x%x)", xs->xs_retries);
   2483    1.2    bouyer 	printf("timo(0x%x)", xs->timeout);
   2484    1.2    bouyer 	printf("cmd(%p)", xs->cmd);
   2485    1.2    bouyer 	printf("len(0x%x)", xs->cmdlen);
   2486    1.2    bouyer 	printf("data(%p)", xs->data);
   2487    1.2    bouyer 	printf("len(0x%x)", xs->datalen);
   2488    1.2    bouyer 	printf("res(0x%x)", xs->resid);
   2489    1.2    bouyer 	printf("err(0x%x)", xs->error);
   2490    1.2    bouyer 	printf("bp(%p)", xs->bp);
   2491    1.2    bouyer 	show_scsipi_cmd(xs);
   2492    1.2    bouyer }
   2493    1.2    bouyer 
   2494    1.2    bouyer void
   2495  1.109    bouyer show_scsipi_cmd(struct scsipi_xfer *xs)
   2496    1.2    bouyer {
   2497  1.126   reinoud 	u_char *b = (u_char *) xs->cmd;
   2498    1.3     enami 	int i = 0;
   2499    1.2    bouyer 
   2500   1.39    bouyer 	scsipi_printaddr(xs->xs_periph);
   2501   1.39    bouyer 	printf(" command: ");
   2502    1.2    bouyer 
   2503   1.24   thorpej 	if ((xs->xs_control & XS_CTL_RESET) == 0) {
   2504    1.2    bouyer 		while (i < xs->cmdlen) {
   2505    1.2    bouyer 			if (i)
   2506    1.2    bouyer 				printf(",");
   2507    1.2    bouyer 			printf("0x%x", b[i++]);
   2508    1.2    bouyer 		}
   2509    1.2    bouyer 		printf("-[%d bytes]\n", xs->datalen);
   2510    1.2    bouyer 		if (xs->datalen)
   2511    1.2    bouyer 			show_mem(xs->data, min(64, xs->datalen));
   2512    1.2    bouyer 	} else
   2513    1.2    bouyer 		printf("-RESET-\n");
   2514    1.2    bouyer }
   2515    1.2    bouyer 
   2516    1.2    bouyer void
   2517  1.126   reinoud show_mem(u_char *address, int num)
   2518    1.2    bouyer {
   2519    1.2    bouyer 	int x;
   2520    1.2    bouyer 
   2521    1.2    bouyer 	printf("------------------------------");
   2522    1.2    bouyer 	for (x = 0; x < num; x++) {
   2523    1.2    bouyer 		if ((x % 16) == 0)
   2524    1.2    bouyer 			printf("\n%03d: ", x);
   2525    1.2    bouyer 		printf("%02x ", *address++);
   2526    1.2    bouyer 	}
   2527    1.2    bouyer 	printf("\n------------------------------\n");
   2528    1.2    bouyer }
   2529   1.39    bouyer #endif /* SCSIPI_DEBUG */
   2530