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