Home | History | Annotate | Line # | Download | only in ic
icp.c revision 1.27
      1  1.27    cegger /*	$NetBSD: icp.c,v 1.27 2008/04/08 12:07:26 cegger Exp $	*/
      2   1.1        ad 
      3   1.1        ad /*-
      4   1.8   thorpej  * Copyright (c) 2002, 2003 The NetBSD Foundation, Inc.
      5   1.1        ad  * All rights reserved.
      6   1.1        ad  *
      7   1.1        ad  * This code is derived from software contributed to The NetBSD Foundation
      8   1.8   thorpej  * by Andrew Doran, and by Jason R. Thorpe of Wasabi Systems, Inc.
      9   1.1        ad  *
     10   1.1        ad  * Redistribution and use in source and binary forms, with or without
     11   1.1        ad  * modification, are permitted provided that the following conditions
     12   1.1        ad  * are met:
     13   1.1        ad  * 1. Redistributions of source code must retain the above copyright
     14   1.1        ad  *    notice, this list of conditions and the following disclaimer.
     15   1.1        ad  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1        ad  *    notice, this list of conditions and the following disclaimer in the
     17   1.1        ad  *    documentation and/or other materials provided with the distribution.
     18   1.1        ad  * 3. All advertising materials mentioning features or use of this software
     19   1.1        ad  *    must display the following acknowledgement:
     20   1.1        ad  *        This product includes software developed by the NetBSD
     21   1.1        ad  *        Foundation, Inc. and its contributors.
     22   1.1        ad  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23   1.1        ad  *    contributors may be used to endorse or promote products derived
     24   1.1        ad  *    from this software without specific prior written permission.
     25   1.1        ad  *
     26   1.1        ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27   1.1        ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28   1.1        ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29   1.1        ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30   1.1        ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31   1.1        ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32   1.1        ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33   1.1        ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34   1.1        ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35   1.1        ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36   1.1        ad  * POSSIBILITY OF SUCH DAMAGE.
     37   1.1        ad  */
     38   1.1        ad 
     39   1.1        ad /*
     40   1.1        ad  * Copyright (c) 1999, 2000 Niklas Hallqvist.  All rights reserved.
     41   1.1        ad  *
     42   1.1        ad  * Redistribution and use in source and binary forms, with or without
     43   1.1        ad  * modification, are permitted provided that the following conditions
     44   1.1        ad  * are met:
     45   1.1        ad  * 1. Redistributions of source code must retain the above copyright
     46   1.1        ad  *    notice, this list of conditions and the following disclaimer.
     47   1.1        ad  * 2. Redistributions in binary form must reproduce the above copyright
     48   1.1        ad  *    notice, this list of conditions and the following disclaimer in the
     49   1.1        ad  *    documentation and/or other materials provided with the distribution.
     50   1.1        ad  * 3. All advertising materials mentioning features or use of this software
     51   1.1        ad  *    must display the following acknowledgement:
     52   1.1        ad  *	This product includes software developed by Niklas Hallqvist.
     53   1.1        ad  * 4. The name of the author may not be used to endorse or promote products
     54   1.1        ad  *    derived from this software without specific prior written permission.
     55   1.1        ad  *
     56   1.1        ad  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     57   1.1        ad  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     58   1.1        ad  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     59   1.1        ad  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     60   1.1        ad  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     61   1.1        ad   * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     62   1.1        ad  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     63   1.1        ad  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     64   1.1        ad  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     65   1.1        ad  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     66   1.1        ad  *
     67   1.1        ad  * from OpenBSD: gdt_common.c,v 1.12 2001/07/04 06:43:18 niklas Exp
     68   1.1        ad  */
     69   1.1        ad 
     70   1.1        ad /*
     71   1.1        ad  * This driver would not have written if it was not for the hardware donations
     72   1.1        ad  * from both ICP-Vortex and ko.neT.  I want to thank them for their support.
     73   1.1        ad  *
     74   1.1        ad  * Re-worked for NetBSD by Andrew Doran.  Test hardware kindly supplied by
     75   1.1        ad  * Intel.
     76   1.8   thorpej  *
     77   1.8   thorpej  * Support for the ICP-Vortex management tools added by
     78   1.8   thorpej  * Jason R. Thorpe of Wasabi Systems, Inc., based on code
     79  1.10   thorpej  * provided by Achim Leubner <achim.leubner (at) intel.com>.
     80  1.10   thorpej  *
     81  1.10   thorpej  * Additional support for dynamic rescan of cacheservice drives by
     82  1.10   thorpej  * Jason R. Thorpe of Wasabi Systems, Inc.
     83   1.1        ad  */
     84   1.1        ad 
     85   1.1        ad #include <sys/cdefs.h>
     86  1.27    cegger __KERNEL_RCSID(0, "$NetBSD: icp.c,v 1.27 2008/04/08 12:07:26 cegger Exp $");
     87   1.1        ad 
     88   1.1        ad #include <sys/param.h>
     89   1.1        ad #include <sys/systm.h>
     90   1.1        ad #include <sys/kernel.h>
     91   1.1        ad #include <sys/device.h>
     92   1.1        ad #include <sys/queue.h>
     93   1.1        ad #include <sys/proc.h>
     94   1.1        ad #include <sys/buf.h>
     95   1.1        ad #include <sys/endian.h>
     96   1.1        ad #include <sys/malloc.h>
     97   1.1        ad #include <sys/disk.h>
     98   1.1        ad 
     99   1.1        ad #include <uvm/uvm_extern.h>
    100   1.1        ad 
    101  1.18       dsl #include <sys/bswap.h>
    102  1.26        ad #include <sys/bus.h>
    103   1.1        ad 
    104   1.1        ad #include <dev/pci/pcireg.h>
    105   1.1        ad #include <dev/pci/pcivar.h>
    106   1.1        ad #include <dev/pci/pcidevs.h>
    107   1.1        ad 
    108   1.1        ad #include <dev/ic/icpreg.h>
    109   1.1        ad #include <dev/ic/icpvar.h>
    110   1.1        ad 
    111   1.8   thorpej #include <dev/scsipi/scsipi_all.h>
    112   1.8   thorpej #include <dev/scsipi/scsiconf.h>
    113   1.8   thorpej 
    114  1.13  drochner #include "locators.h"
    115  1.13  drochner 
    116   1.1        ad int	icp_async_event(struct icp_softc *, int);
    117   1.1        ad void	icp_ccb_submit(struct icp_softc *icp, struct icp_ccb *ic);
    118   1.1        ad void	icp_chain(struct icp_softc *);
    119   1.1        ad int	icp_print(void *, const char *);
    120   1.1        ad void	icp_watchdog(void *);
    121   1.8   thorpej void	icp_ucmd_intr(struct icp_ccb *);
    122  1.10   thorpej void	icp_recompute_openings(struct icp_softc *);
    123   1.8   thorpej 
    124   1.8   thorpej int	icp_count;	/* total # of controllers, for ioctl interface */
    125   1.8   thorpej 
    126   1.8   thorpej /*
    127   1.8   thorpej  * Statistics for the ioctl interface to query.
    128   1.8   thorpej  *
    129   1.8   thorpej  * XXX Global.  They should probably be made per-controller
    130   1.8   thorpej  * XXX at some point.
    131   1.8   thorpej  */
    132   1.8   thorpej gdt_statist_t icp_stats;
    133   1.1        ad 
    134   1.1        ad int
    135   1.1        ad icp_init(struct icp_softc *icp, const char *intrstr)
    136   1.1        ad {
    137   1.1        ad 	struct icp_attach_args icpa;
    138   1.1        ad 	struct icp_binfo binfo;
    139   1.1        ad 	struct icp_ccb *ic;
    140   1.1        ad 	u_int16_t cdev_cnt;
    141  1.12   mycroft 	int i, j, state, feat, nsegs, rv;
    142  1.15  drochner 	int locs[ICPCF_NLOCS];
    143   1.1        ad 
    144   1.5    simonb 	state = 0;
    145   1.1        ad 
    146   1.1        ad 	if (intrstr != NULL)
    147  1.27    cegger 		aprint_normal_dev(&icp->icp_dv, "interrupting at %s\n",
    148   1.1        ad 		    intrstr);
    149   1.1        ad 
    150   1.1        ad 	SIMPLEQ_INIT(&icp->icp_ccb_queue);
    151   1.1        ad 	SIMPLEQ_INIT(&icp->icp_ccb_freelist);
    152   1.8   thorpej 	SIMPLEQ_INIT(&icp->icp_ucmd_queue);
    153  1.25        ad 	callout_init(&icp->icp_wdog_callout, 0);
    154   1.1        ad 
    155   1.1        ad 	/*
    156   1.1        ad 	 * Allocate a scratch area.
    157   1.1        ad 	 */
    158   1.1        ad 	if (bus_dmamap_create(icp->icp_dmat, ICP_SCRATCH_SIZE, 1,
    159   1.1        ad 	    ICP_SCRATCH_SIZE, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
    160   1.1        ad 	    &icp->icp_scr_dmamap) != 0) {
    161  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "cannot create scratch dmamap\n");
    162   1.1        ad 		return (1);
    163   1.1        ad 	}
    164   1.1        ad 	state++;
    165   1.1        ad 
    166   1.1        ad 	if (bus_dmamem_alloc(icp->icp_dmat, ICP_SCRATCH_SIZE, PAGE_SIZE, 0,
    167   1.1        ad 	    icp->icp_scr_seg, 1, &nsegs, BUS_DMA_NOWAIT) != 0) {
    168  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "cannot alloc scratch dmamem\n");
    169   1.1        ad 		goto bail_out;
    170   1.1        ad 	}
    171   1.1        ad 	state++;
    172   1.1        ad 
    173   1.1        ad 	if (bus_dmamem_map(icp->icp_dmat, icp->icp_scr_seg, nsegs,
    174   1.1        ad 	    ICP_SCRATCH_SIZE, &icp->icp_scr, 0)) {
    175  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "cannot map scratch dmamem\n");
    176   1.1        ad 		goto bail_out;
    177   1.1        ad 	}
    178   1.1        ad 	state++;
    179   1.1        ad 
    180   1.1        ad 	if (bus_dmamap_load(icp->icp_dmat, icp->icp_scr_dmamap, icp->icp_scr,
    181   1.1        ad 	    ICP_SCRATCH_SIZE, NULL, BUS_DMA_NOWAIT)) {
    182  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "cannot load scratch dmamap\n");
    183   1.1        ad 		goto bail_out;
    184   1.1        ad 	}
    185   1.1        ad 	state++;
    186   1.1        ad 
    187   1.1        ad 	/*
    188   1.1        ad 	 * Allocate and initialize the command control blocks.
    189   1.1        ad 	 */
    190   1.1        ad 	ic = malloc(sizeof(*ic) * ICP_NCCBS, M_DEVBUF, M_NOWAIT | M_ZERO);
    191   1.1        ad 	if ((icp->icp_ccbs = ic) == NULL) {
    192  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "malloc() failed\n");
    193   1.1        ad 		goto bail_out;
    194   1.1        ad 	}
    195   1.1        ad 	state++;
    196   1.1        ad 
    197   1.1        ad 	for (i = 0; i < ICP_NCCBS; i++, ic++) {
    198   1.1        ad 		/*
    199   1.1        ad 		 * The first two command indexes have special meanings, so
    200   1.1        ad 		 * we can't use them.
    201   1.1        ad 		 */
    202   1.1        ad 		ic->ic_ident = i + 2;
    203   1.1        ad 		rv = bus_dmamap_create(icp->icp_dmat, ICP_MAX_XFER,
    204   1.1        ad 		    ICP_MAXSG, ICP_MAX_XFER, 0,
    205   1.1        ad 		    BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
    206   1.1        ad 		    &ic->ic_xfer_map);
    207   1.1        ad 		if (rv != 0)
    208   1.1        ad 			break;
    209   1.1        ad 		icp->icp_nccbs++;
    210   1.1        ad 		icp_ccb_free(icp, ic);
    211   1.1        ad 	}
    212   1.1        ad #ifdef DIAGNOSTIC
    213   1.1        ad 	if (icp->icp_nccbs != ICP_NCCBS)
    214  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "%d/%d CCBs usable\n",
    215   1.1        ad 		    icp->icp_nccbs, ICP_NCCBS);
    216   1.1        ad #endif
    217   1.1        ad 
    218   1.1        ad 	/*
    219   1.1        ad 	 * Initalize the controller.
    220   1.1        ad 	 */
    221   1.1        ad 	if (!icp_cmd(icp, ICP_SCREENSERVICE, ICP_INIT, 0, 0, 0)) {
    222  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "screen service init error %d\n",
    223  1.27    cegger 		    icp->icp_status);
    224   1.1        ad 		goto bail_out;
    225   1.1        ad 	}
    226   1.1        ad 
    227   1.1        ad 	if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INIT, ICP_LINUX_OS, 0, 0)) {
    228  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "cache service init error %d\n",
    229  1.27    cegger 		    icp->icp_status);
    230   1.1        ad 		goto bail_out;
    231   1.1        ad 	}
    232   1.1        ad 
    233   1.1        ad 	icp_cmd(icp, ICP_CACHESERVICE, ICP_UNFREEZE_IO, 0, 0, 0);
    234   1.1        ad 
    235   1.1        ad 	if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_MOUNT, 0xffff, 1, 0)) {
    236  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "cache service mount error %d\n",
    237  1.27    cegger 		    icp->icp_status);
    238   1.1        ad 		goto bail_out;
    239   1.1        ad 	}
    240   1.1        ad 
    241   1.1        ad 	if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INIT, ICP_LINUX_OS, 0, 0)) {
    242  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "cache service post-mount init error %d\n",
    243  1.27    cegger 		    icp->icp_status);
    244   1.1        ad 		goto bail_out;
    245   1.1        ad 	}
    246   1.1        ad 	cdev_cnt = (u_int16_t)icp->icp_info;
    247   1.8   thorpej 	icp->icp_fw_vers = icp->icp_service;
    248   1.1        ad 
    249   1.1        ad 	if (!icp_cmd(icp, ICP_SCSIRAWSERVICE, ICP_INIT, 0, 0, 0)) {
    250  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "raw service init error %d\n",
    251  1.27    cegger 		    icp->icp_status);
    252   1.1        ad 		goto bail_out;
    253   1.1        ad 	}
    254   1.1        ad 
    255   1.1        ad 	/*
    256   1.1        ad 	 * Set/get raw service features (scatter/gather).
    257   1.1        ad 	 */
    258   1.1        ad 	feat = 0;
    259   1.1        ad 	if (icp_cmd(icp, ICP_SCSIRAWSERVICE, ICP_SET_FEAT, ICP_SCATTER_GATHER,
    260   1.1        ad 	    0, 0))
    261   1.1        ad 		if (icp_cmd(icp, ICP_SCSIRAWSERVICE, ICP_GET_FEAT, 0, 0, 0))
    262   1.1        ad 			feat = icp->icp_info;
    263   1.1        ad 
    264   1.1        ad 	if ((feat & ICP_SCATTER_GATHER) == 0) {
    265   1.1        ad #ifdef DIAGNOSTIC
    266  1.27    cegger 		aprint_normal_dev(&icp->icp_dv,
    267  1.27    cegger 		    "scatter/gather not supported (raw service)\n");
    268   1.1        ad #endif
    269  1.10   thorpej 	} else
    270  1.10   thorpej 		icp->icp_features |= ICP_FEAT_RAWSERVICE;
    271   1.1        ad 
    272   1.1        ad 	/*
    273   1.1        ad 	 * Set/get cache service features (scatter/gather).
    274   1.1        ad 	 */
    275   1.1        ad 	feat = 0;
    276   1.1        ad 	if (icp_cmd(icp, ICP_CACHESERVICE, ICP_SET_FEAT, 0,
    277   1.1        ad 	    ICP_SCATTER_GATHER, 0))
    278   1.1        ad 		if (icp_cmd(icp, ICP_CACHESERVICE, ICP_GET_FEAT, 0, 0, 0))
    279   1.1        ad 			feat = icp->icp_info;
    280   1.1        ad 
    281   1.1        ad 	if ((feat & ICP_SCATTER_GATHER) == 0) {
    282   1.1        ad #ifdef DIAGNOSTIC
    283  1.27    cegger 		aprint_normal_dev(&icp->icp_dv,
    284  1.27    cegger 		    "scatter/gather not supported (cache service)\n");
    285   1.1        ad #endif
    286  1.10   thorpej 	} else
    287  1.10   thorpej 		icp->icp_features |= ICP_FEAT_CACHESERVICE;
    288   1.1        ad 
    289   1.1        ad 	/*
    290   1.1        ad 	 * Pull some information from the board and dump.
    291   1.1        ad 	 */
    292   1.1        ad 	if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_IOCTL, ICP_BOARD_INFO,
    293   1.1        ad 	    ICP_INVALID_CHANNEL, sizeof(struct icp_binfo))) {
    294  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "unable to retrive board info\n");
    295   1.1        ad 		goto bail_out;
    296   1.1        ad 	}
    297   1.1        ad 	memcpy(&binfo, icp->icp_scr, sizeof(binfo));
    298   1.1        ad 
    299  1.27    cegger 	aprint_normal_dev(&icp->icp_dv,
    300  1.27    cegger 	    "model <%s>, firmware <%s>, %d channel(s), %dMB memory\n",
    301  1.27    cegger 	    binfo.bi_type_string, binfo.bi_raid_string,
    302   1.1        ad 	    binfo.bi_chan_count, le32toh(binfo.bi_memsize) >> 20);
    303   1.1        ad 
    304   1.1        ad 	/*
    305   1.1        ad 	 * Determine the number of devices, and number of openings per
    306   1.1        ad 	 * device.
    307   1.1        ad 	 */
    308  1.10   thorpej 	if (icp->icp_features & ICP_FEAT_CACHESERVICE) {
    309   1.1        ad 		for (j = 0; j < cdev_cnt && j < ICP_MAX_HDRIVES; j++) {
    310   1.1        ad 			if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INFO, j, 0,
    311   1.1        ad 			    0))
    312   1.1        ad 				continue;
    313   1.1        ad 
    314   1.1        ad 			icp->icp_cdr[j].cd_size = icp->icp_info;
    315  1.10   thorpej 			if (icp->icp_cdr[j].cd_size != 0)
    316  1.10   thorpej 				icp->icp_ndevs++;
    317   1.1        ad 
    318   1.1        ad 			if (icp_cmd(icp, ICP_CACHESERVICE, ICP_DEVTYPE, j, 0,
    319   1.1        ad 			    0))
    320   1.1        ad 				icp->icp_cdr[j].cd_type = icp->icp_info;
    321   1.1        ad 		}
    322   1.1        ad 	}
    323   1.1        ad 
    324  1.10   thorpej 	if (icp->icp_features & ICP_FEAT_RAWSERVICE) {
    325  1.10   thorpej 		icp->icp_nchan = binfo.bi_chan_count;
    326  1.10   thorpej 		icp->icp_ndevs += icp->icp_nchan;
    327  1.10   thorpej 	}
    328   1.1        ad 
    329  1.10   thorpej 	icp_recompute_openings(icp);
    330   1.1        ad 
    331   1.1        ad 	/*
    332   1.1        ad 	 * Attach SCSI channels.
    333   1.1        ad 	 */
    334  1.10   thorpej 	if (icp->icp_features & ICP_FEAT_RAWSERVICE) {
    335   1.1        ad 		struct icp_ioc_version *iv;
    336   1.1        ad 		struct icp_rawioc *ri;
    337   1.1        ad 		struct icp_getch *gc;
    338   1.1        ad 
    339   1.1        ad 		iv = (struct icp_ioc_version *)icp->icp_scr;
    340   1.1        ad 		iv->iv_version = htole32(ICP_IOC_NEWEST);
    341   1.1        ad 		iv->iv_listents = ICP_MAXBUS;
    342   1.1        ad 		iv->iv_firstchan = 0;
    343   1.1        ad 		iv->iv_lastchan = ICP_MAXBUS - 1;
    344   1.1        ad 		iv->iv_listoffset = htole32(sizeof(*iv));
    345   1.1        ad 
    346   1.1        ad 		if (icp_cmd(icp, ICP_CACHESERVICE, ICP_IOCTL,
    347   1.1        ad 		    ICP_IOCHAN_RAW_DESC, ICP_INVALID_CHANNEL,
    348   1.1        ad 		    sizeof(*iv) + ICP_MAXBUS * sizeof(*ri))) {
    349   1.1        ad 			ri = (struct icp_rawioc *)(iv + 1);
    350   1.1        ad 			for (j = 0; j < binfo.bi_chan_count; j++, ri++)
    351   1.1        ad 				icp->icp_bus_id[j] = ri->ri_procid;
    352   1.1        ad 		} else {
    353   1.1        ad 			/*
    354   1.1        ad 			 * Fall back to the old method.
    355   1.1        ad 			 */
    356   1.1        ad 			gc = (struct icp_getch *)icp->icp_scr;
    357   1.1        ad 
    358  1.12   mycroft 			for (j = 0; j < binfo.bi_chan_count; j++) {
    359   1.1        ad 				if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_IOCTL,
    360   1.1        ad 				    ICP_SCSI_CHAN_CNT | ICP_L_CTRL_PATTERN,
    361   1.1        ad 				    ICP_IO_CHANNEL | ICP_INVALID_CHANNEL,
    362   1.1        ad 				    sizeof(*gc))) {
    363  1.27    cegger 				    	aprint_error_dev(&icp->icp_dv,
    364  1.27    cegger 					    "unable to get chan info");
    365   1.1        ad 					goto bail_out;
    366   1.1        ad 				}
    367   1.1        ad 				icp->icp_bus_id[j] = gc->gc_scsiid;
    368   1.1        ad 			}
    369   1.1        ad 		}
    370   1.1        ad 
    371   1.1        ad 		for (j = 0; j < binfo.bi_chan_count; j++) {
    372   1.1        ad 			if (icp->icp_bus_id[j] > ICP_MAXID_FC)
    373   1.1        ad 				icp->icp_bus_id[j] = ICP_MAXID_FC;
    374   1.1        ad 
    375   1.1        ad 			icpa.icpa_unit = j + ICPA_UNIT_SCSI;
    376  1.13  drochner 
    377  1.15  drochner 			locs[ICPCF_UNIT] = j + ICPA_UNIT_SCSI;
    378  1.13  drochner 
    379  1.10   thorpej 			icp->icp_children[icpa.icpa_unit] =
    380  1.15  drochner 				config_found_sm_loc(&icp->icp_dv, "icp", locs,
    381  1.16  drochner 					&icpa, icp_print, config_stdsubmatch);
    382   1.1        ad 		}
    383   1.1        ad 	}
    384   1.1        ad 
    385   1.1        ad 	/*
    386   1.1        ad 	 * Attach cache devices.
    387   1.1        ad 	 */
    388  1.10   thorpej 	if (icp->icp_features & ICP_FEAT_CACHESERVICE) {
    389   1.1        ad 		for (j = 0; j < cdev_cnt && j < ICP_MAX_HDRIVES; j++) {
    390   1.1        ad 			if (icp->icp_cdr[j].cd_size == 0)
    391   1.1        ad 				continue;
    392  1.14     perry 
    393   1.1        ad 			icpa.icpa_unit = j;
    394  1.13  drochner 
    395  1.15  drochner 			locs[ICPCF_UNIT] = j;
    396  1.13  drochner 
    397  1.10   thorpej 			icp->icp_children[icpa.icpa_unit] =
    398  1.15  drochner 			    config_found_sm_loc(&icp->icp_dv, "icp", locs,
    399  1.16  drochner 				&icpa, icp_print, config_stdsubmatch);
    400   1.1        ad 		}
    401   1.1        ad 	}
    402   1.1        ad 
    403   1.1        ad 	/*
    404   1.1        ad 	 * Start the watchdog.
    405   1.1        ad 	 */
    406   1.1        ad 	icp_watchdog(icp);
    407   1.8   thorpej 
    408   1.8   thorpej 	/*
    409   1.8   thorpej 	 * Count the controller, and we're done!
    410   1.8   thorpej 	 */
    411  1.24        ad 	if (icp_count++ == 0)
    412  1.24        ad 		mutex_init(&icp_ioctl_mutex, MUTEX_DEFAULT, IPL_NONE);
    413   1.8   thorpej 
    414   1.1        ad 	return (0);
    415   1.1        ad 
    416   1.1        ad  bail_out:
    417   1.1        ad 	if (state > 4)
    418   1.1        ad 		for (j = 0; j < i; j++)
    419   1.1        ad 			bus_dmamap_destroy(icp->icp_dmat,
    420   1.1        ad 			    icp->icp_ccbs[j].ic_xfer_map);
    421   1.1        ad  	if (state > 3)
    422   1.1        ad 		free(icp->icp_ccbs, M_DEVBUF);
    423   1.1        ad 	if (state > 2)
    424   1.1        ad 		bus_dmamap_unload(icp->icp_dmat, icp->icp_scr_dmamap);
    425   1.1        ad 	if (state > 1)
    426   1.1        ad 		bus_dmamem_unmap(icp->icp_dmat, icp->icp_scr,
    427   1.1        ad 		    ICP_SCRATCH_SIZE);
    428   1.1        ad 	if (state > 0)
    429   1.1        ad 		bus_dmamem_free(icp->icp_dmat, icp->icp_scr_seg, nsegs);
    430   1.1        ad 	bus_dmamap_destroy(icp->icp_dmat, icp->icp_scr_dmamap);
    431   1.1        ad 
    432   1.1        ad 	return (1);
    433   1.1        ad }
    434   1.1        ad 
    435   1.1        ad void
    436  1.10   thorpej icp_register_servicecb(struct icp_softc *icp, int unit,
    437  1.10   thorpej     const struct icp_servicecb *cb)
    438  1.10   thorpej {
    439  1.10   thorpej 
    440  1.10   thorpej 	icp->icp_servicecb[unit] = cb;
    441  1.10   thorpej }
    442  1.10   thorpej 
    443  1.10   thorpej void
    444  1.10   thorpej icp_rescan(struct icp_softc *icp, int unit)
    445  1.10   thorpej {
    446  1.10   thorpej 	struct icp_attach_args icpa;
    447  1.10   thorpej 	u_int newsize, newtype;
    448  1.15  drochner 	int locs[ICPCF_NLOCS];
    449  1.10   thorpej 
    450  1.10   thorpej 	/*
    451  1.10   thorpej 	 * NOTE: It is very important that the queue be frozen and not
    452  1.10   thorpej 	 * commands running when this is called.  The ioctl mutex must
    453  1.10   thorpej 	 * also be held.
    454  1.10   thorpej 	 */
    455  1.10   thorpej 
    456  1.10   thorpej 	KASSERT(icp->icp_qfreeze != 0);
    457  1.10   thorpej 	KASSERT(icp->icp_running == 0);
    458  1.10   thorpej 	KASSERT(unit < ICP_MAX_HDRIVES);
    459  1.10   thorpej 
    460  1.10   thorpej 	if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INFO, unit, 0, 0)) {
    461  1.10   thorpej #ifdef ICP_DEBUG
    462  1.10   thorpej 		printf("%s: rescan: unit %d ICP_INFO failed -> 0x%04x\n",
    463  1.27    cegger 		    device_xname(&icp->icp_dv), unit, icp->icp_status);
    464  1.10   thorpej #endif
    465  1.10   thorpej 		goto gone;
    466  1.10   thorpej 	}
    467  1.10   thorpej 	if ((newsize = icp->icp_info) == 0) {
    468  1.10   thorpej #ifdef ICP_DEBUG
    469  1.10   thorpej 		printf("%s: rescan: unit %d has zero size\n",
    470  1.27    cegger 		    device-xname(&icp->icp_dv), unit);
    471  1.10   thorpej #endif
    472  1.10   thorpej  gone:
    473  1.10   thorpej 		/*
    474  1.10   thorpej 		 * Host drive is no longer present; detach if a child
    475  1.10   thorpej 		 * is currently there.
    476  1.10   thorpej 		 */
    477  1.10   thorpej 		if (icp->icp_cdr[unit].cd_size != 0)
    478  1.10   thorpej 			icp->icp_ndevs--;
    479  1.10   thorpej 		icp->icp_cdr[unit].cd_size = 0;
    480  1.10   thorpej 		if (icp->icp_children[unit] != NULL) {
    481  1.10   thorpej 			(void) config_detach(icp->icp_children[unit],
    482  1.10   thorpej 			    DETACH_FORCE);
    483  1.10   thorpej 			icp->icp_children[unit] = NULL;
    484  1.10   thorpej 		}
    485  1.10   thorpej 		return;
    486  1.10   thorpej 	}
    487  1.10   thorpej 
    488  1.10   thorpej 	if (icp_cmd(icp, ICP_CACHESERVICE, ICP_DEVTYPE, unit, 0, 0))
    489  1.10   thorpej 		newtype = icp->icp_info;
    490  1.10   thorpej 	else {
    491  1.10   thorpej #ifdef ICP_DEBUG
    492  1.10   thorpej 		printf("%s: rescan: unit %d ICP_DEVTYPE failed\n",
    493  1.27    cegger 		    device_xname(&icp->icp_dv), unit);
    494  1.10   thorpej #endif
    495  1.10   thorpej 		newtype = 0;	/* XXX? */
    496  1.10   thorpej 	}
    497  1.10   thorpej 
    498  1.10   thorpej #ifdef ICP_DEBUG
    499  1.10   thorpej 	printf("%s: rescan: unit %d old %u/%u, new %u/%u\n",
    500  1.27    cegger 	    device_xname(&icp->icp_dv), unit, icp->icp_cdr[unit].cd_size,
    501  1.10   thorpej 	    icp->icp_cdr[unit].cd_type, newsize, newtype);
    502  1.10   thorpej #endif
    503  1.10   thorpej 
    504  1.10   thorpej 	/*
    505  1.10   thorpej 	 * If the type or size changed, detach any old child (if it exists)
    506  1.10   thorpej 	 * and attach a new one.
    507  1.10   thorpej 	 */
    508  1.10   thorpej 	if (icp->icp_children[unit] == NULL ||
    509  1.10   thorpej 	    newsize != icp->icp_cdr[unit].cd_size ||
    510  1.10   thorpej 	    newtype != icp->icp_cdr[unit].cd_type) {
    511  1.10   thorpej 		if (icp->icp_cdr[unit].cd_size == 0)
    512  1.10   thorpej 			icp->icp_ndevs++;
    513  1.10   thorpej 		icp->icp_cdr[unit].cd_size = newsize;
    514  1.10   thorpej 		icp->icp_cdr[unit].cd_type = newtype;
    515  1.10   thorpej 		if (icp->icp_children[unit] != NULL)
    516  1.10   thorpej 			(void) config_detach(icp->icp_children[unit],
    517  1.10   thorpej 			    DETACH_FORCE);
    518  1.10   thorpej 
    519  1.10   thorpej 		icpa.icpa_unit = unit;
    520  1.13  drochner 
    521  1.15  drochner 		locs[ICPCF_UNIT] = unit;
    522  1.13  drochner 
    523  1.13  drochner 		icp->icp_children[unit] = config_found_sm_loc(&icp->icp_dv,
    524  1.16  drochner 			"icp", locs, &icpa, icp_print, config_stdsubmatch);
    525  1.10   thorpej 	}
    526  1.10   thorpej 
    527  1.10   thorpej 	icp_recompute_openings(icp);
    528  1.10   thorpej }
    529  1.10   thorpej 
    530  1.10   thorpej void
    531  1.10   thorpej icp_rescan_all(struct icp_softc *icp)
    532  1.10   thorpej {
    533  1.10   thorpej 	int unit;
    534  1.10   thorpej 	u_int16_t cdev_cnt;
    535  1.10   thorpej 
    536  1.10   thorpej 	/*
    537  1.10   thorpej 	 * This is the old method of rescanning the host drives.  We
    538  1.10   thorpej 	 * start by reinitializing the cache service.
    539  1.10   thorpej 	 */
    540  1.10   thorpej 	if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INIT, ICP_LINUX_OS, 0, 0)) {
    541  1.10   thorpej 		printf("%s: unable to re-initialize cache service for rescan\n",
    542  1.27    cegger 		    device_xname(&icp->icp_dv));
    543  1.10   thorpej 		return;
    544  1.10   thorpej 	}
    545  1.10   thorpej 	cdev_cnt = (u_int16_t) icp->icp_info;
    546  1.10   thorpej 
    547  1.10   thorpej 	/* For each host drive, do the new-style rescan. */
    548  1.10   thorpej 	for (unit = 0; unit < cdev_cnt && unit < ICP_MAX_HDRIVES; unit++)
    549  1.10   thorpej 		icp_rescan(icp, unit);
    550  1.10   thorpej 
    551  1.10   thorpej 	/* Now detach anything in the slots after cdev_cnt. */
    552  1.10   thorpej 	for (; unit < ICP_MAX_HDRIVES; unit++) {
    553  1.10   thorpej 		if (icp->icp_cdr[unit].cd_size != 0) {
    554  1.10   thorpej #ifdef ICP_DEBUG
    555  1.10   thorpej 			printf("%s: rescan all: unit %d < new cdev_cnt (%d)\n",
    556  1.27    cegger 			    device_xname(&icp->icp_dv), unit, cdev_cnt);
    557  1.10   thorpej #endif
    558  1.10   thorpej 			icp->icp_ndevs--;
    559  1.10   thorpej 			icp->icp_cdr[unit].cd_size = 0;
    560  1.10   thorpej 			if (icp->icp_children[unit] != NULL) {
    561  1.10   thorpej 				(void) config_detach(icp->icp_children[unit],
    562  1.10   thorpej 				    DETACH_FORCE);
    563  1.10   thorpej 				icp->icp_children[unit] = NULL;
    564  1.10   thorpej 			}
    565  1.10   thorpej 		}
    566  1.10   thorpej 	}
    567  1.10   thorpej 
    568  1.10   thorpej 	icp_recompute_openings(icp);
    569  1.10   thorpej }
    570  1.10   thorpej 
    571  1.10   thorpej void
    572  1.10   thorpej icp_recompute_openings(struct icp_softc *icp)
    573  1.10   thorpej {
    574  1.10   thorpej 	int unit, openings;
    575  1.10   thorpej 
    576  1.10   thorpej 	if (icp->icp_ndevs != 0)
    577  1.10   thorpej 		openings =
    578  1.10   thorpej 		    (icp->icp_nccbs - ICP_NCCB_RESERVE) / icp->icp_ndevs;
    579  1.10   thorpej 	else
    580  1.10   thorpej 		openings = 0;
    581  1.10   thorpej 	if (openings == icp->icp_openings)
    582  1.10   thorpej 		return;
    583  1.10   thorpej 	icp->icp_openings = openings;
    584  1.10   thorpej 
    585  1.10   thorpej #ifdef ICP_DEBUG
    586  1.10   thorpej 	printf("%s: %d device%s, %d openings per device\n",
    587  1.27    cegger 	    device_xname(&icp->icp_dv), icp->icp_ndevs,
    588  1.10   thorpej 	    icp->icp_ndevs == 1 ? "" : "s", icp->icp_openings);
    589  1.10   thorpej #endif
    590  1.10   thorpej 
    591  1.10   thorpej 	for (unit = 0; unit < ICP_MAX_HDRIVES + ICP_MAXBUS; unit++) {
    592  1.10   thorpej 		if (icp->icp_children[unit] != NULL)
    593  1.10   thorpej 			(*icp->icp_servicecb[unit]->iscb_openings)(
    594  1.10   thorpej 			    icp->icp_children[unit], icp->icp_openings);
    595  1.10   thorpej 	}
    596  1.10   thorpej }
    597  1.10   thorpej 
    598  1.10   thorpej void
    599   1.1        ad icp_watchdog(void *cookie)
    600   1.1        ad {
    601   1.1        ad 	struct icp_softc *icp;
    602   1.1        ad 	int s;
    603   1.1        ad 
    604   1.1        ad 	icp = cookie;
    605   1.1        ad 
    606   1.1        ad 	s = splbio();
    607   1.1        ad 	icp_intr(icp);
    608   1.8   thorpej 	if (ICP_HAS_WORK(icp))
    609   1.1        ad 		icp_ccb_enqueue(icp, NULL);
    610   1.1        ad 	splx(s);
    611   1.1        ad 
    612   1.1        ad 	callout_reset(&icp->icp_wdog_callout, hz * ICP_WATCHDOG_FREQ,
    613   1.1        ad 	    icp_watchdog, icp);
    614   1.1        ad }
    615   1.1        ad 
    616   1.1        ad int
    617   1.1        ad icp_print(void *aux, const char *pnp)
    618   1.1        ad {
    619   1.1        ad 	struct icp_attach_args *icpa;
    620   1.1        ad 	const char *str;
    621   1.1        ad 
    622   1.1        ad 	icpa = (struct icp_attach_args *)aux;
    623   1.1        ad 
    624   1.1        ad 	if (pnp != NULL) {
    625   1.1        ad 		if (icpa->icpa_unit < ICPA_UNIT_SCSI)
    626   1.1        ad 			str = "block device";
    627   1.1        ad 		else
    628   1.1        ad 			str = "SCSI channel";
    629   1.6   thorpej 		aprint_normal("%s at %s", str, pnp);
    630   1.1        ad 	}
    631   1.6   thorpej 	aprint_normal(" unit %d", icpa->icpa_unit);
    632   1.1        ad 
    633   1.1        ad 	return (UNCONF);
    634   1.1        ad }
    635   1.1        ad 
    636   1.1        ad int
    637   1.8   thorpej icp_async_event(struct icp_softc *icp, int service)
    638   1.1        ad {
    639   1.1        ad 
    640   1.8   thorpej 	if (service == ICP_SCREENSERVICE) {
    641   1.8   thorpej 		if (icp->icp_status == ICP_S_MSG_REQUEST) {
    642   1.8   thorpej 			/* XXX */
    643   1.8   thorpej 		}
    644   1.8   thorpej 	} else {
    645   1.8   thorpej 		if ((icp->icp_fw_vers & 0xff) >= 0x1a) {
    646   1.8   thorpej 			icp->icp_evt.size = 0;
    647  1.19   thorpej 			icp->icp_evt.eu.async.ionode =
    648  1.19   thorpej 			    device_unit(&icp->icp_dv);
    649   1.8   thorpej 			icp->icp_evt.eu.async.status = icp->icp_status;
    650   1.8   thorpej 			/*
    651   1.8   thorpej 			 * Severity and event string are filled in by the
    652   1.8   thorpej 			 * hardware interface interrupt handler.
    653   1.8   thorpej 			 */
    654  1.27    cegger 			printf("%s: %s\n", device_xname(&icp->icp_dv),
    655   1.8   thorpej 			    icp->icp_evt.event_string);
    656   1.8   thorpej 		} else {
    657   1.8   thorpej 			icp->icp_evt.size = sizeof(icp->icp_evt.eu.async);
    658  1.19   thorpej 			icp->icp_evt.eu.async.ionode =
    659  1.19   thorpej 			    device_unit(&icp->icp_dv);
    660   1.8   thorpej 			icp->icp_evt.eu.async.service = service;
    661   1.8   thorpej 			icp->icp_evt.eu.async.status = icp->icp_status;
    662   1.8   thorpej 			icp->icp_evt.eu.async.info = icp->icp_info;
    663   1.8   thorpej 			/* XXXJRT FIX THIS */
    664  1.14     perry 			*(u_int32_t *) icp->icp_evt.eu.async.scsi_coord =
    665   1.8   thorpej 			    icp->icp_info2;
    666   1.8   thorpej 		}
    667   1.8   thorpej 		icp_store_event(icp, GDT_ES_ASYNC, service, &icp->icp_evt);
    668   1.8   thorpej 	}
    669   1.8   thorpej 
    670   1.8   thorpej 	return (0);
    671   1.1        ad }
    672   1.1        ad 
    673   1.1        ad int
    674   1.1        ad icp_intr(void *cookie)
    675   1.1        ad {
    676   1.1        ad 	struct icp_softc *icp;
    677   1.1        ad 	struct icp_intr_ctx ctx;
    678   1.1        ad 	struct icp_ccb *ic;
    679   1.1        ad 
    680   1.1        ad 	icp = cookie;
    681   1.1        ad 
    682   1.1        ad 	ctx.istatus = (*icp->icp_get_status)(icp);
    683   1.1        ad 	if (!ctx.istatus) {
    684   1.1        ad 		icp->icp_status = ICP_S_NO_STATUS;
    685   1.1        ad 		return (0);
    686   1.1        ad 	}
    687   1.1        ad 
    688   1.1        ad 	(*icp->icp_intr)(icp, &ctx);
    689   1.1        ad 
    690   1.1        ad 	icp->icp_status = ctx.cmd_status;
    691   1.8   thorpej 	icp->icp_service = ctx.service;
    692   1.1        ad 	icp->icp_info = ctx.info;
    693   1.1        ad 	icp->icp_info2 = ctx.info2;
    694   1.1        ad 
    695   1.1        ad 	switch (ctx.istatus) {
    696   1.1        ad 	case ICP_ASYNCINDEX:
    697   1.1        ad 		icp_async_event(icp, ctx.service);
    698   1.1        ad 		return (1);
    699   1.1        ad 
    700   1.1        ad 	case ICP_SPEZINDEX:
    701  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "uninitialized or unknown service (%d/%d)\n",
    702  1.27    cegger 		    ctx.info, ctx.info2);
    703   1.8   thorpej 		icp->icp_evt.size = sizeof(icp->icp_evt.eu.driver);
    704  1.19   thorpej 		icp->icp_evt.eu.driver.ionode = device_unit(&icp->icp_dv);
    705   1.8   thorpej 		icp_store_event(icp, GDT_ES_DRIVER, 4, &icp->icp_evt);
    706   1.1        ad 		return (1);
    707   1.1        ad 	}
    708   1.1        ad 
    709   1.1        ad 	if ((ctx.istatus - 2) > icp->icp_nccbs)
    710   1.1        ad 		panic("icp_intr: bad command index returned");
    711   1.1        ad 
    712   1.1        ad 	ic = &icp->icp_ccbs[ctx.istatus - 2];
    713   1.1        ad 	ic->ic_status = icp->icp_status;
    714   1.1        ad 
    715   1.8   thorpej 	if ((ic->ic_flags & IC_ALLOCED) == 0) {
    716   1.8   thorpej 		/* XXX ICP's "iir" driver just sends an event here. */
    717   1.1        ad 		panic("icp_intr: inactive CCB identified");
    718   1.8   thorpej 	}
    719   1.1        ad 
    720  1.10   thorpej 	/*
    721  1.10   thorpej 	 * Try to protect ourselves from the running command count already
    722  1.10   thorpej 	 * being 0 (e.g. if a polled command times out).
    723  1.10   thorpej 	 */
    724  1.10   thorpej 	KDASSERT(icp->icp_running != 0);
    725  1.10   thorpej 	if (--icp->icp_running == 0 &&
    726  1.10   thorpej 	    (icp->icp_flags & ICP_F_WAIT_FREEZE) != 0) {
    727  1.10   thorpej 		icp->icp_flags &= ~ICP_F_WAIT_FREEZE;
    728  1.10   thorpej 		wakeup(&icp->icp_qfreeze);
    729  1.10   thorpej 	}
    730  1.10   thorpej 
    731   1.1        ad 	switch (icp->icp_status) {
    732   1.1        ad 	case ICP_S_BSY:
    733   1.1        ad #ifdef ICP_DEBUG
    734  1.27    cegger 		printf("%s: ICP_S_BSY received\n", device_xname(&icp->icp_dv));
    735   1.1        ad #endif
    736   1.8   thorpej 		if (__predict_false((ic->ic_flags & IC_UCMD) != 0))
    737   1.8   thorpej 			SIMPLEQ_INSERT_HEAD(&icp->icp_ucmd_queue, ic, ic_chain);
    738   1.8   thorpej 		else
    739   1.8   thorpej 			SIMPLEQ_INSERT_HEAD(&icp->icp_ccb_queue, ic, ic_chain);
    740   1.1        ad 		break;
    741   1.1        ad 
    742   1.1        ad 	default:
    743   1.1        ad 		ic->ic_flags |= IC_COMPLETE;
    744   1.1        ad 
    745   1.1        ad 		if ((ic->ic_flags & IC_WAITING) != 0)
    746   1.1        ad 			wakeup(ic);
    747   1.1        ad 		else if (ic->ic_intr != NULL)
    748   1.1        ad 			(*ic->ic_intr)(ic);
    749   1.1        ad 
    750   1.8   thorpej 		if (ICP_HAS_WORK(icp))
    751   1.1        ad 			icp_ccb_enqueue(icp, NULL);
    752   1.1        ad 
    753   1.1        ad 		break;
    754   1.1        ad 	}
    755   1.1        ad 
    756   1.1        ad 	return (1);
    757   1.1        ad }
    758   1.1        ad 
    759   1.8   thorpej struct icp_ucmd_ctx {
    760   1.8   thorpej 	gdt_ucmd_t *iu_ucmd;
    761   1.8   thorpej 	u_int32_t iu_cnt;
    762   1.8   thorpej };
    763   1.8   thorpej 
    764   1.8   thorpej void
    765   1.8   thorpej icp_ucmd_intr(struct icp_ccb *ic)
    766   1.8   thorpej {
    767   1.8   thorpej 	struct icp_softc *icp = (void *) ic->ic_dv;
    768   1.8   thorpej 	struct icp_ucmd_ctx *iu = ic->ic_context;
    769   1.8   thorpej 	gdt_ucmd_t *ucmd = iu->iu_ucmd;
    770   1.8   thorpej 
    771   1.8   thorpej 	ucmd->status = icp->icp_status;
    772   1.8   thorpej 	ucmd->info = icp->icp_info;
    773   1.8   thorpej 
    774   1.8   thorpej 	if (iu->iu_cnt != 0) {
    775   1.8   thorpej 		bus_dmamap_sync(icp->icp_dmat,
    776   1.8   thorpej 		    icp->icp_scr_dmamap,
    777   1.8   thorpej 		    ICP_SCRATCH_UCMD, iu->iu_cnt,
    778   1.8   thorpej 		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
    779   1.8   thorpej 		memcpy(ucmd->data,
    780  1.23  christos 		    (char *)icp->icp_scr + ICP_SCRATCH_UCMD, iu->iu_cnt);
    781   1.8   thorpej 	}
    782   1.8   thorpej 
    783   1.8   thorpej 	icp->icp_ucmd_ccb = NULL;
    784   1.8   thorpej 
    785   1.8   thorpej 	ic->ic_flags |= IC_COMPLETE;
    786   1.8   thorpej 	wakeup(ic);
    787   1.8   thorpej }
    788   1.8   thorpej 
    789   1.8   thorpej /*
    790   1.8   thorpej  * NOTE: We assume that it is safe to sleep here!
    791   1.8   thorpej  */
    792   1.1        ad int
    793   1.1        ad icp_cmd(struct icp_softc *icp, u_int8_t service, u_int16_t opcode,
    794   1.1        ad 	u_int32_t arg1, u_int32_t arg2, u_int32_t arg3)
    795   1.1        ad {
    796   1.1        ad 	struct icp_ioctlcmd *icmd;
    797   1.1        ad 	struct icp_cachecmd *cc;
    798   1.1        ad 	struct icp_rawcmd *rc;
    799   1.1        ad 	int retries, rv;
    800   1.1        ad 	struct icp_ccb *ic;
    801   1.1        ad 
    802   1.1        ad 	retries = ICP_RETRIES;
    803   1.1        ad 
    804   1.1        ad 	do {
    805   1.8   thorpej 		ic = icp_ccb_alloc_wait(icp);
    806   1.1        ad 		memset(&ic->ic_cmd, 0, sizeof(ic->ic_cmd));
    807   1.1        ad 		ic->ic_cmd.cmd_opcode = htole16(opcode);
    808   1.1        ad 
    809   1.1        ad 		switch (service) {
    810   1.1        ad 		case ICP_CACHESERVICE:
    811   1.1        ad 			if (opcode == ICP_IOCTL) {
    812   1.1        ad 				icmd = &ic->ic_cmd.cmd_packet.ic;
    813   1.1        ad 				icmd->ic_subfunc = htole16(arg1);
    814   1.1        ad 				icmd->ic_channel = htole32(arg2);
    815   1.1        ad 				icmd->ic_bufsize = htole32(arg3);
    816   1.1        ad 				icmd->ic_addr =
    817   1.1        ad 				    htole32(icp->icp_scr_seg[0].ds_addr);
    818   1.1        ad 
    819   1.1        ad 				bus_dmamap_sync(icp->icp_dmat,
    820   1.1        ad 				    icp->icp_scr_dmamap, 0, arg3,
    821   1.1        ad 				    BUS_DMASYNC_PREWRITE |
    822   1.1        ad 				    BUS_DMASYNC_PREREAD);
    823   1.1        ad 			} else {
    824   1.1        ad 				cc = &ic->ic_cmd.cmd_packet.cc;
    825   1.1        ad 				cc->cc_deviceno = htole16(arg1);
    826   1.1        ad 				cc->cc_blockno = htole32(arg2);
    827   1.1        ad 			}
    828   1.1        ad 			break;
    829   1.1        ad 
    830   1.1        ad 		case ICP_SCSIRAWSERVICE:
    831   1.1        ad 			rc = &ic->ic_cmd.cmd_packet.rc;
    832   1.1        ad 			rc->rc_direction = htole32(arg1);
    833   1.1        ad 			rc->rc_bus = arg2;
    834   1.1        ad 			rc->rc_target = arg3;
    835   1.1        ad 			rc->rc_lun = arg3 >> 8;
    836   1.1        ad 			break;
    837   1.1        ad 		}
    838   1.1        ad 
    839   1.1        ad 		ic->ic_service = service;
    840   1.1        ad 		ic->ic_cmdlen = sizeof(ic->ic_cmd);
    841   1.1        ad 		rv = icp_ccb_poll(icp, ic, 10000);
    842   1.1        ad 
    843   1.1        ad 		switch (service) {
    844   1.1        ad 		case ICP_CACHESERVICE:
    845   1.1        ad 			if (opcode == ICP_IOCTL) {
    846   1.1        ad 				bus_dmamap_sync(icp->icp_dmat,
    847   1.1        ad 				    icp->icp_scr_dmamap, 0, arg3,
    848   1.1        ad 				    BUS_DMASYNC_POSTWRITE |
    849   1.1        ad 				    BUS_DMASYNC_POSTREAD);
    850   1.1        ad 			}
    851   1.1        ad 			break;
    852   1.1        ad 		}
    853   1.1        ad 
    854   1.1        ad 		icp_ccb_free(icp, ic);
    855   1.1        ad 	} while (rv != 0 && --retries > 0);
    856   1.1        ad 
    857   1.1        ad 	return (icp->icp_status == ICP_S_OK);
    858   1.1        ad }
    859   1.1        ad 
    860   1.8   thorpej int
    861   1.8   thorpej icp_ucmd(struct icp_softc *icp, gdt_ucmd_t *ucmd)
    862   1.8   thorpej {
    863   1.8   thorpej 	struct icp_ccb *ic;
    864   1.8   thorpej 	struct icp_ucmd_ctx iu;
    865   1.8   thorpej 	u_int32_t cnt;
    866   1.8   thorpej 	int error;
    867   1.8   thorpej 
    868   1.8   thorpej 	if (ucmd->service == ICP_CACHESERVICE) {
    869   1.8   thorpej 		if (ucmd->command.cmd_opcode == ICP_IOCTL) {
    870   1.8   thorpej 			cnt = ucmd->command.cmd_packet.ic.ic_bufsize;
    871   1.8   thorpej 			if (cnt > GDT_SCRATCH_SZ) {
    872  1.27    cegger 				aprint_error_dev(&icp->icp_dv, "scratch buffer too small (%d/%d)\n",
    873  1.27    cegger 				    GDT_SCRATCH_SZ, cnt);
    874   1.8   thorpej 				return (EINVAL);
    875   1.8   thorpej 			}
    876   1.8   thorpej 		} else {
    877   1.8   thorpej 			cnt = ucmd->command.cmd_packet.cc.cc_blockcnt *
    878   1.8   thorpej 			    ICP_SECTOR_SIZE;
    879   1.8   thorpej 			if (cnt > GDT_SCRATCH_SZ) {
    880  1.27    cegger 				aprint_error_dev(&icp->icp_dv, "scratch buffer too small (%d/%d)\n",
    881  1.27    cegger 				    GDT_SCRATCH_SZ, cnt);
    882   1.8   thorpej 				return (EINVAL);
    883   1.8   thorpej 			}
    884   1.8   thorpej 		}
    885   1.8   thorpej 	} else {
    886   1.8   thorpej 		cnt = ucmd->command.cmd_packet.rc.rc_sdlen +
    887   1.8   thorpej 		    ucmd->command.cmd_packet.rc.rc_sense_len;
    888   1.8   thorpej 		if (cnt > GDT_SCRATCH_SZ) {
    889  1.27    cegger 			aprint_error_dev(&icp->icp_dv, "scratch buffer too small (%d/%d)\n",
    890  1.27    cegger 			    GDT_SCRATCH_SZ, cnt);
    891   1.8   thorpej 			return (EINVAL);
    892   1.8   thorpej 		}
    893   1.8   thorpej 	}
    894   1.8   thorpej 
    895   1.8   thorpej 	iu.iu_ucmd = ucmd;
    896   1.8   thorpej 	iu.iu_cnt = cnt;
    897   1.8   thorpej 
    898   1.8   thorpej 	ic = icp_ccb_alloc_wait(icp);
    899   1.8   thorpej 	memset(&ic->ic_cmd, 0, sizeof(ic->ic_cmd));
    900   1.8   thorpej 	ic->ic_cmd.cmd_opcode = htole16(ucmd->command.cmd_opcode);
    901   1.8   thorpej 
    902   1.8   thorpej 	if (ucmd->service == ICP_CACHESERVICE) {
    903   1.8   thorpej 		if (ucmd->command.cmd_opcode == ICP_IOCTL) {
    904   1.8   thorpej 			struct icp_ioctlcmd *icmd, *uicmd;
    905   1.8   thorpej 
    906   1.8   thorpej 			icmd = &ic->ic_cmd.cmd_packet.ic;
    907   1.8   thorpej 			uicmd = &ucmd->command.cmd_packet.ic;
    908   1.8   thorpej 
    909   1.8   thorpej 			icmd->ic_subfunc = htole16(uicmd->ic_subfunc);
    910   1.8   thorpej 			icmd->ic_channel = htole32(uicmd->ic_channel);
    911   1.8   thorpej 			icmd->ic_bufsize = htole32(uicmd->ic_bufsize);
    912   1.8   thorpej 			icmd->ic_addr =
    913   1.8   thorpej 			    htole32(icp->icp_scr_seg[0].ds_addr +
    914   1.8   thorpej 				    ICP_SCRATCH_UCMD);
    915   1.8   thorpej 		} else {
    916   1.8   thorpej 			struct icp_cachecmd *cc, *ucc;
    917   1.8   thorpej 
    918   1.8   thorpej 			cc = &ic->ic_cmd.cmd_packet.cc;
    919   1.8   thorpej 			ucc = &ucmd->command.cmd_packet.cc;
    920   1.8   thorpej 
    921   1.8   thorpej 			cc->cc_deviceno = htole16(ucc->cc_deviceno);
    922   1.8   thorpej 			cc->cc_blockno = htole32(ucc->cc_blockno);
    923   1.8   thorpej 			cc->cc_blockcnt = htole32(ucc->cc_blockcnt);
    924   1.8   thorpej 			cc->cc_addr = htole32(0xffffffffU);
    925   1.8   thorpej 			cc->cc_nsgent = htole32(1);
    926   1.8   thorpej 			cc->cc_sg[0].sg_addr =
    927   1.8   thorpej 			    htole32(icp->icp_scr_seg[0].ds_addr +
    928   1.8   thorpej 				    ICP_SCRATCH_UCMD);
    929   1.8   thorpej 			cc->cc_sg[0].sg_len = htole32(cnt);
    930   1.8   thorpej 		}
    931   1.8   thorpej 	} else {
    932   1.8   thorpej 		struct icp_rawcmd *rc, *urc;
    933   1.8   thorpej 
    934   1.8   thorpej 		rc = &ic->ic_cmd.cmd_packet.rc;
    935   1.8   thorpej 		urc = &ucmd->command.cmd_packet.rc;
    936   1.8   thorpej 
    937   1.8   thorpej 		rc->rc_direction = htole32(urc->rc_direction);
    938   1.8   thorpej 		rc->rc_sdata = htole32(0xffffffffU);
    939   1.8   thorpej 		rc->rc_sdlen = htole32(urc->rc_sdlen);
    940   1.8   thorpej 		rc->rc_clen = htole32(urc->rc_clen);
    941   1.8   thorpej 		memcpy(rc->rc_cdb, urc->rc_cdb, sizeof(rc->rc_cdb));
    942   1.8   thorpej 		rc->rc_target = urc->rc_target;
    943   1.8   thorpej 		rc->rc_lun = urc->rc_lun;
    944   1.8   thorpej 		rc->rc_bus = urc->rc_bus;
    945   1.8   thorpej 		rc->rc_sense_len = htole32(urc->rc_sense_len);
    946   1.8   thorpej 		rc->rc_sense_addr =
    947   1.8   thorpej 		    htole32(icp->icp_scr_seg[0].ds_addr +
    948   1.8   thorpej 			    ICP_SCRATCH_UCMD + urc->rc_sdlen);
    949   1.8   thorpej 		rc->rc_nsgent = htole32(1);
    950   1.8   thorpej 		rc->rc_sg[0].sg_addr =
    951   1.8   thorpej 		    htole32(icp->icp_scr_seg[0].ds_addr + ICP_SCRATCH_UCMD);
    952   1.8   thorpej 		rc->rc_sg[0].sg_len = htole32(cnt - urc->rc_sense_len);
    953   1.8   thorpej 	}
    954   1.8   thorpej 
    955   1.8   thorpej 	ic->ic_service = ucmd->service;
    956   1.8   thorpej 	ic->ic_cmdlen = sizeof(ic->ic_cmd);
    957   1.8   thorpej 	ic->ic_context = &iu;
    958   1.8   thorpej 
    959   1.8   thorpej 	/*
    960   1.8   thorpej 	 * XXX What units are ucmd->timeout in?  Until we know, we
    961   1.8   thorpej 	 * XXX just pull a number out of thin air.
    962   1.8   thorpej 	 */
    963   1.8   thorpej 	if (__predict_false((error = icp_ccb_wait_user(icp, ic, 30000)) != 0))
    964  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "error %d waiting for ucmd to complete\n",
    965  1.27    cegger 		    error);
    966   1.8   thorpej 
    967   1.8   thorpej 	/* icp_ucmd_intr() has updated ucmd. */
    968   1.8   thorpej 	icp_ccb_free(icp, ic);
    969   1.8   thorpej 
    970   1.8   thorpej 	return (error);
    971   1.8   thorpej }
    972   1.8   thorpej 
    973   1.1        ad struct icp_ccb *
    974   1.1        ad icp_ccb_alloc(struct icp_softc *icp)
    975   1.1        ad {
    976   1.1        ad 	struct icp_ccb *ic;
    977   1.1        ad 	int s;
    978   1.1        ad 
    979   1.1        ad 	s = splbio();
    980   1.8   thorpej 	if (__predict_false((ic =
    981   1.8   thorpej 			     SIMPLEQ_FIRST(&icp->icp_ccb_freelist)) == NULL)) {
    982   1.8   thorpej 		splx(s);
    983   1.8   thorpej 		return (NULL);
    984   1.8   thorpej 	}
    985   1.8   thorpej 	SIMPLEQ_REMOVE_HEAD(&icp->icp_ccb_freelist, ic_chain);
    986   1.8   thorpej 	splx(s);
    987   1.8   thorpej 
    988   1.8   thorpej 	ic->ic_flags = IC_ALLOCED;
    989   1.8   thorpej 	return (ic);
    990   1.8   thorpej }
    991   1.8   thorpej 
    992   1.8   thorpej struct icp_ccb *
    993   1.8   thorpej icp_ccb_alloc_wait(struct icp_softc *icp)
    994   1.8   thorpej {
    995   1.8   thorpej 	struct icp_ccb *ic;
    996   1.8   thorpej 	int s;
    997   1.8   thorpej 
    998   1.8   thorpej 	s = splbio();
    999   1.8   thorpej 	while ((ic = SIMPLEQ_FIRST(&icp->icp_ccb_freelist)) == NULL) {
   1000   1.8   thorpej 		icp->icp_flags |= ICP_F_WAIT_CCB;
   1001   1.8   thorpej 		(void) tsleep(&icp->icp_ccb_freelist, PRIBIO, "icpccb", 0);
   1002   1.8   thorpej 	}
   1003   1.2     lukem 	SIMPLEQ_REMOVE_HEAD(&icp->icp_ccb_freelist, ic_chain);
   1004   1.1        ad 	splx(s);
   1005   1.1        ad 
   1006   1.1        ad 	ic->ic_flags = IC_ALLOCED;
   1007   1.1        ad 	return (ic);
   1008   1.1        ad }
   1009   1.1        ad 
   1010   1.1        ad void
   1011   1.1        ad icp_ccb_free(struct icp_softc *icp, struct icp_ccb *ic)
   1012   1.1        ad {
   1013   1.1        ad 	int s;
   1014   1.1        ad 
   1015   1.1        ad 	s = splbio();
   1016   1.1        ad 	ic->ic_flags = 0;
   1017   1.1        ad 	ic->ic_intr = NULL;
   1018   1.1        ad 	SIMPLEQ_INSERT_HEAD(&icp->icp_ccb_freelist, ic, ic_chain);
   1019   1.8   thorpej 	if (__predict_false((icp->icp_flags & ICP_F_WAIT_CCB) != 0)) {
   1020   1.8   thorpej 		icp->icp_flags &= ~ICP_F_WAIT_CCB;
   1021   1.8   thorpej 		wakeup(&icp->icp_ccb_freelist);
   1022   1.8   thorpej 	}
   1023   1.1        ad 	splx(s);
   1024   1.1        ad }
   1025   1.1        ad 
   1026   1.1        ad void
   1027   1.1        ad icp_ccb_enqueue(struct icp_softc *icp, struct icp_ccb *ic)
   1028   1.1        ad {
   1029   1.1        ad 	int s;
   1030   1.1        ad 
   1031   1.1        ad 	s = splbio();
   1032   1.1        ad 
   1033   1.8   thorpej 	if (ic != NULL) {
   1034   1.8   thorpej 		if (__predict_false((ic->ic_flags & IC_UCMD) != 0))
   1035   1.8   thorpej 			SIMPLEQ_INSERT_TAIL(&icp->icp_ucmd_queue, ic, ic_chain);
   1036   1.8   thorpej 		else
   1037   1.8   thorpej 			SIMPLEQ_INSERT_TAIL(&icp->icp_ccb_queue, ic, ic_chain);
   1038   1.8   thorpej 	}
   1039   1.8   thorpej 
   1040  1.10   thorpej 	for (; icp->icp_qfreeze == 0;) {
   1041   1.8   thorpej 		if (__predict_false((ic =
   1042   1.8   thorpej 			    SIMPLEQ_FIRST(&icp->icp_ucmd_queue)) != NULL)) {
   1043   1.8   thorpej 			struct icp_ucmd_ctx *iu = ic->ic_context;
   1044   1.8   thorpej 			gdt_ucmd_t *ucmd = iu->iu_ucmd;
   1045   1.1        ad 
   1046   1.8   thorpej 			/*
   1047   1.8   thorpej 			 * All user-generated commands share the same
   1048   1.8   thorpej 			 * scratch space, so if one is already running,
   1049   1.8   thorpej 			 * we have to stall the command queue.
   1050   1.8   thorpej 			 */
   1051   1.8   thorpej 			if (icp->icp_ucmd_ccb != NULL)
   1052   1.8   thorpej 				break;
   1053   1.9   thorpej 			if ((*icp->icp_test_busy)(icp))
   1054   1.9   thorpej 				break;
   1055   1.8   thorpej 			icp->icp_ucmd_ccb = ic;
   1056   1.8   thorpej 
   1057   1.8   thorpej 			if (iu->iu_cnt != 0) {
   1058  1.23  christos 				memcpy((char *)icp->icp_scr + ICP_SCRATCH_UCMD,
   1059   1.8   thorpej 				    ucmd->data, iu->iu_cnt);
   1060   1.8   thorpej 				bus_dmamap_sync(icp->icp_dmat,
   1061   1.8   thorpej 				    icp->icp_scr_dmamap,
   1062   1.8   thorpej 				    ICP_SCRATCH_UCMD, iu->iu_cnt,
   1063   1.8   thorpej 				    BUS_DMASYNC_PREREAD |
   1064   1.8   thorpej 				    BUS_DMASYNC_PREWRITE);
   1065   1.8   thorpej 			}
   1066   1.9   thorpej 		} else if (__predict_true((ic =
   1067   1.9   thorpej 				SIMPLEQ_FIRST(&icp->icp_ccb_queue)) != NULL)) {
   1068   1.9   thorpej 			if ((*icp->icp_test_busy)(icp))
   1069   1.9   thorpej 				break;
   1070   1.9   thorpej 		} else {
   1071   1.9   thorpej 			/* no command found */
   1072   1.1        ad 			break;
   1073   1.9   thorpej 		}
   1074   1.1        ad 		icp_ccb_submit(icp, ic);
   1075   1.8   thorpej 		if (__predict_false((ic->ic_flags & IC_UCMD) != 0))
   1076   1.8   thorpej 			SIMPLEQ_REMOVE_HEAD(&icp->icp_ucmd_queue, ic_chain);
   1077   1.8   thorpej 		else
   1078   1.8   thorpej 			SIMPLEQ_REMOVE_HEAD(&icp->icp_ccb_queue, ic_chain);
   1079   1.1        ad 	}
   1080   1.1        ad 
   1081   1.1        ad 	splx(s);
   1082   1.1        ad }
   1083   1.1        ad 
   1084   1.1        ad int
   1085   1.1        ad icp_ccb_map(struct icp_softc *icp, struct icp_ccb *ic, void *data, int size,
   1086   1.1        ad 	    int dir)
   1087   1.1        ad {
   1088   1.1        ad 	struct icp_sg *sg;
   1089   1.1        ad 	int nsegs, i, rv;
   1090   1.1        ad 	bus_dmamap_t xfer;
   1091   1.1        ad 
   1092   1.1        ad 	xfer = ic->ic_xfer_map;
   1093   1.1        ad 
   1094   1.1        ad 	rv = bus_dmamap_load(icp->icp_dmat, xfer, data, size, NULL,
   1095   1.1        ad 	    BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
   1096   1.1        ad 	    ((dir & IC_XFER_IN) ? BUS_DMA_READ : BUS_DMA_WRITE));
   1097   1.1        ad 	if (rv != 0)
   1098   1.1        ad 		return (rv);
   1099   1.1        ad 
   1100   1.1        ad 	nsegs = xfer->dm_nsegs;
   1101   1.1        ad 	ic->ic_xfer_size = size;
   1102   1.1        ad 	ic->ic_nsgent = nsegs;
   1103   1.1        ad 	ic->ic_flags |= dir;
   1104   1.1        ad 	sg = ic->ic_sg;
   1105   1.1        ad 
   1106   1.1        ad 	if (sg != NULL) {
   1107   1.1        ad 		for (i = 0; i < nsegs; i++, sg++) {
   1108   1.1        ad 			sg->sg_addr = htole32(xfer->dm_segs[i].ds_addr);
   1109   1.1        ad 			sg->sg_len = htole32(xfer->dm_segs[i].ds_len);
   1110   1.1        ad 		}
   1111   1.1        ad 	} else if (nsegs > 1)
   1112   1.4    provos 		panic("icp_ccb_map: no SG list specified, but nsegs > 1");
   1113   1.1        ad 
   1114   1.1        ad 	if ((dir & IC_XFER_OUT) != 0)
   1115   1.1        ad 		i = BUS_DMASYNC_PREWRITE;
   1116   1.1        ad 	else /* if ((dir & IC_XFER_IN) != 0) */
   1117   1.1        ad 		i = BUS_DMASYNC_PREREAD;
   1118   1.1        ad 
   1119   1.1        ad 	bus_dmamap_sync(icp->icp_dmat, xfer, 0, ic->ic_xfer_size, i);
   1120   1.1        ad 	return (0);
   1121   1.1        ad }
   1122   1.1        ad 
   1123   1.1        ad void
   1124   1.1        ad icp_ccb_unmap(struct icp_softc *icp, struct icp_ccb *ic)
   1125   1.1        ad {
   1126   1.1        ad 	int i;
   1127   1.1        ad 
   1128   1.1        ad 	if ((ic->ic_flags & IC_XFER_OUT) != 0)
   1129   1.1        ad 		i = BUS_DMASYNC_POSTWRITE;
   1130   1.1        ad 	else /* if ((ic->ic_flags & IC_XFER_IN) != 0) */
   1131   1.1        ad 		i = BUS_DMASYNC_POSTREAD;
   1132   1.1        ad 
   1133   1.1        ad 	bus_dmamap_sync(icp->icp_dmat, ic->ic_xfer_map, 0, ic->ic_xfer_size, i);
   1134   1.1        ad 	bus_dmamap_unload(icp->icp_dmat, ic->ic_xfer_map);
   1135   1.1        ad }
   1136   1.1        ad 
   1137   1.1        ad int
   1138   1.1        ad icp_ccb_poll(struct icp_softc *icp, struct icp_ccb *ic, int timo)
   1139   1.1        ad {
   1140  1.10   thorpej 	int s, rv;
   1141  1.10   thorpej 
   1142  1.10   thorpej 	s = splbio();
   1143   1.1        ad 
   1144   1.1        ad 	for (timo = ICP_BUSY_WAIT_MS * 100; timo != 0; timo--) {
   1145   1.1        ad 		if (!(*icp->icp_test_busy)(icp))
   1146   1.1        ad 			break;
   1147   1.1        ad 		DELAY(10);
   1148   1.1        ad 	}
   1149   1.1        ad 	if (timo == 0) {
   1150  1.27    cegger 		printf("%s: submit: busy\n", device_xname(&icp->icp_dv));
   1151   1.1        ad 		return (EAGAIN);
   1152   1.1        ad 	}
   1153   1.1        ad 
   1154   1.1        ad 	icp_ccb_submit(icp, ic);
   1155   1.1        ad 
   1156  1.10   thorpej 	if (cold) {
   1157  1.10   thorpej 		for (timo *= 10; timo != 0; timo--) {
   1158  1.10   thorpej 			DELAY(100);
   1159  1.10   thorpej 			icp_intr(icp);
   1160  1.10   thorpej 			if ((ic->ic_flags & IC_COMPLETE) != 0)
   1161  1.10   thorpej 				break;
   1162  1.10   thorpej 		}
   1163  1.10   thorpej 	} else {
   1164  1.10   thorpej 		ic->ic_flags |= IC_WAITING;
   1165  1.10   thorpej 		while ((ic->ic_flags & IC_COMPLETE) == 0) {
   1166  1.10   thorpej 			if ((rv = tsleep(ic, PRIBIO, "icpwccb",
   1167  1.10   thorpej 					 mstohz(timo))) != 0) {
   1168  1.10   thorpej 				timo = 0;
   1169  1.10   thorpej 				break;
   1170  1.10   thorpej 			}
   1171  1.10   thorpej 		}
   1172   1.1        ad 	}
   1173   1.1        ad 
   1174   1.1        ad 	if (timo != 0) {
   1175   1.1        ad 		if (ic->ic_status != ICP_S_OK) {
   1176   1.1        ad #ifdef ICP_DEBUG
   1177   1.1        ad 			printf("%s: request failed; status=0x%04x\n",
   1178  1.27    cegger 			    device_xname(&icp->icp_dv), ic->ic_status);
   1179   1.1        ad #endif
   1180   1.1        ad 			rv = EIO;
   1181   1.1        ad 		} else
   1182   1.1        ad 			rv = 0;
   1183   1.1        ad 	} else {
   1184  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "command timed out\n");
   1185   1.1        ad 		rv = EIO;
   1186   1.1        ad 	}
   1187   1.1        ad 
   1188   1.1        ad 	while ((*icp->icp_test_busy)(icp) != 0)
   1189   1.1        ad 		DELAY(10);
   1190   1.1        ad 
   1191  1.10   thorpej 	splx(s);
   1192  1.10   thorpej 
   1193   1.1        ad 	return (rv);
   1194   1.1        ad }
   1195   1.1        ad 
   1196   1.1        ad int
   1197   1.1        ad icp_ccb_wait(struct icp_softc *icp, struct icp_ccb *ic, int timo)
   1198   1.1        ad {
   1199   1.1        ad 	int s, rv;
   1200   1.1        ad 
   1201   1.1        ad 	ic->ic_flags |= IC_WAITING;
   1202   1.1        ad 
   1203   1.1        ad 	s = splbio();
   1204   1.1        ad 	icp_ccb_enqueue(icp, ic);
   1205   1.8   thorpej 	while ((ic->ic_flags & IC_COMPLETE) == 0) {
   1206   1.8   thorpej 		if ((rv = tsleep(ic, PRIBIO, "icpwccb", mstohz(timo))) != 0) {
   1207   1.8   thorpej 			splx(s);
   1208   1.8   thorpej 			return (rv);
   1209   1.8   thorpej 		}
   1210   1.1        ad 	}
   1211   1.1        ad 	splx(s);
   1212   1.1        ad 
   1213   1.1        ad 	if (ic->ic_status != ICP_S_OK) {
   1214  1.27    cegger 		aprint_error_dev(&icp->icp_dv, "command failed; status=%x\n",
   1215   1.1        ad 		    ic->ic_status);
   1216   1.1        ad 		return (EIO);
   1217   1.1        ad 	}
   1218   1.1        ad 
   1219   1.1        ad 	return (0);
   1220   1.1        ad }
   1221   1.1        ad 
   1222   1.8   thorpej int
   1223   1.8   thorpej icp_ccb_wait_user(struct icp_softc *icp, struct icp_ccb *ic, int timo)
   1224   1.8   thorpej {
   1225   1.8   thorpej 	int s, rv;
   1226   1.8   thorpej 
   1227   1.8   thorpej 	ic->ic_dv = &icp->icp_dv;
   1228   1.8   thorpej 	ic->ic_intr = icp_ucmd_intr;
   1229   1.8   thorpej 	ic->ic_flags |= IC_UCMD;
   1230   1.8   thorpej 
   1231   1.8   thorpej 	s = splbio();
   1232   1.8   thorpej 	icp_ccb_enqueue(icp, ic);
   1233   1.8   thorpej 	while ((ic->ic_flags & IC_COMPLETE) == 0) {
   1234   1.8   thorpej 		if ((rv = tsleep(ic, PRIBIO, "icpwuccb", mstohz(timo))) != 0) {
   1235   1.8   thorpej 			splx(s);
   1236   1.8   thorpej 			return (rv);
   1237   1.8   thorpej 		}
   1238   1.8   thorpej 	}
   1239   1.8   thorpej 	splx(s);
   1240   1.8   thorpej 
   1241   1.8   thorpej 	return (0);
   1242   1.8   thorpej }
   1243   1.8   thorpej 
   1244   1.1        ad void
   1245   1.1        ad icp_ccb_submit(struct icp_softc *icp, struct icp_ccb *ic)
   1246   1.1        ad {
   1247   1.1        ad 
   1248   1.1        ad 	ic->ic_cmdlen = (ic->ic_cmdlen + 3) & ~3;
   1249   1.1        ad 
   1250   1.1        ad 	(*icp->icp_set_sema0)(icp);
   1251   1.1        ad 	DELAY(10);
   1252   1.1        ad 
   1253   1.1        ad 	ic->ic_cmd.cmd_boardnode = htole32(ICP_LOCALBOARD);
   1254   1.1        ad 	ic->ic_cmd.cmd_cmdindex = htole32(ic->ic_ident);
   1255   1.1        ad 
   1256  1.10   thorpej 	icp->icp_running++;
   1257  1.10   thorpej 
   1258   1.1        ad 	(*icp->icp_copy_cmd)(icp, ic);
   1259   1.1        ad 	(*icp->icp_release_event)(icp, ic);
   1260  1.10   thorpej }
   1261  1.10   thorpej 
   1262  1.10   thorpej int
   1263  1.10   thorpej icp_freeze(struct icp_softc *icp)
   1264  1.10   thorpej {
   1265  1.10   thorpej 	int s, error = 0;
   1266  1.10   thorpej 
   1267  1.10   thorpej 	s = splbio();
   1268  1.10   thorpej 	if (icp->icp_qfreeze++ == 0) {
   1269  1.10   thorpej 		while (icp->icp_running != 0) {
   1270  1.10   thorpej 			icp->icp_flags |= ICP_F_WAIT_FREEZE;
   1271  1.10   thorpej 			error = tsleep(&icp->icp_qfreeze, PRIBIO|PCATCH,
   1272  1.10   thorpej 			    "icpqfrz", 0);
   1273  1.10   thorpej 			if (error != 0 && --icp->icp_qfreeze == 0 &&
   1274  1.10   thorpej 			    ICP_HAS_WORK(icp)) {
   1275  1.10   thorpej 				icp_ccb_enqueue(icp, NULL);
   1276  1.10   thorpej 				break;
   1277  1.10   thorpej 			}
   1278  1.10   thorpej 		}
   1279  1.10   thorpej 	}
   1280  1.10   thorpej 	splx(s);
   1281  1.10   thorpej 
   1282  1.10   thorpej 	return (error);
   1283  1.10   thorpej }
   1284  1.10   thorpej 
   1285  1.10   thorpej void
   1286  1.10   thorpej icp_unfreeze(struct icp_softc *icp)
   1287  1.10   thorpej {
   1288  1.10   thorpej 	int s;
   1289  1.10   thorpej 
   1290  1.10   thorpej 	s = splbio();
   1291  1.10   thorpej 	KDASSERT(icp->icp_qfreeze != 0);
   1292  1.10   thorpej 	if (--icp->icp_qfreeze == 0 && ICP_HAS_WORK(icp))
   1293  1.10   thorpej 		icp_ccb_enqueue(icp, NULL);
   1294  1.10   thorpej 	splx(s);
   1295   1.8   thorpej }
   1296   1.8   thorpej 
   1297   1.8   thorpej /* XXX Global - should be per-controller? XXX */
   1298   1.8   thorpej static gdt_evt_str icp_event_buffer[ICP_MAX_EVENTS];
   1299   1.8   thorpej static int icp_event_oldidx;
   1300   1.8   thorpej static int icp_event_lastidx;
   1301   1.8   thorpej 
   1302   1.8   thorpej gdt_evt_str *
   1303  1.22  christos icp_store_event(struct icp_softc *icp, u_int16_t source, u_int16_t idx,
   1304   1.8   thorpej     gdt_evt_data *evt)
   1305   1.8   thorpej {
   1306   1.8   thorpej 	gdt_evt_str *e;
   1307   1.8   thorpej 
   1308   1.8   thorpej 	/* no source == no event */
   1309   1.8   thorpej 	if (source == 0)
   1310   1.8   thorpej 		return (NULL);
   1311   1.8   thorpej 
   1312   1.8   thorpej 	e = &icp_event_buffer[icp_event_lastidx];
   1313   1.8   thorpej 	if (e->event_source == source && e->event_idx == idx &&
   1314   1.8   thorpej 	    ((evt->size != 0 && e->event_data.size != 0 &&
   1315   1.8   thorpej 	      memcmp(&e->event_data.eu, &evt->eu, evt->size) == 0) ||
   1316   1.8   thorpej 	     (evt->size == 0 && e->event_data.size == 0 &&
   1317   1.8   thorpej 	      strcmp((char *) e->event_data.event_string,
   1318   1.8   thorpej 	      	     (char *) evt->event_string) == 0))) {
   1319  1.20    kardel 		e->last_stamp = time_second;
   1320   1.8   thorpej 		e->same_count++;
   1321   1.8   thorpej 	} else {
   1322   1.8   thorpej 		if (icp_event_buffer[icp_event_lastidx].event_source != 0) {
   1323   1.8   thorpej 			icp_event_lastidx++;
   1324   1.8   thorpej 			if (icp_event_lastidx == ICP_MAX_EVENTS)
   1325   1.8   thorpej 				icp_event_lastidx = 0;
   1326   1.8   thorpej 			if (icp_event_lastidx == icp_event_oldidx) {
   1327   1.8   thorpej 				icp_event_oldidx++;
   1328   1.8   thorpej 				if (icp_event_oldidx == ICP_MAX_EVENTS)
   1329   1.8   thorpej 					icp_event_oldidx = 0;
   1330   1.8   thorpej 			}
   1331   1.8   thorpej 		}
   1332   1.8   thorpej 		e = &icp_event_buffer[icp_event_lastidx];
   1333   1.8   thorpej 		e->event_source = source;
   1334   1.8   thorpej 		e->event_idx = idx;
   1335  1.20    kardel 		e->first_stamp = e->last_stamp = time_second;
   1336   1.8   thorpej 		e->same_count = 1;
   1337   1.8   thorpej 		e->event_data = *evt;
   1338   1.8   thorpej 		e->application = 0;
   1339   1.8   thorpej 	}
   1340   1.8   thorpej 	return (e);
   1341   1.8   thorpej }
   1342   1.8   thorpej 
   1343   1.8   thorpej int
   1344  1.22  christos icp_read_event(struct icp_softc *icp, int handle, gdt_evt_str *estr)
   1345   1.8   thorpej {
   1346   1.8   thorpej 	gdt_evt_str *e;
   1347   1.8   thorpej 	int eindex, s;
   1348   1.8   thorpej 
   1349   1.8   thorpej 	s = splbio();
   1350   1.8   thorpej 
   1351   1.8   thorpej 	if (handle == -1)
   1352   1.8   thorpej 		eindex = icp_event_oldidx;
   1353   1.8   thorpej 	else
   1354   1.8   thorpej 		eindex = handle;
   1355   1.8   thorpej 
   1356   1.8   thorpej 	estr->event_source = 0;
   1357   1.8   thorpej 
   1358   1.8   thorpej 	if (eindex < 0 || eindex >= ICP_MAX_EVENTS) {
   1359   1.8   thorpej 		splx(s);
   1360   1.8   thorpej 		return (eindex);
   1361   1.8   thorpej 	}
   1362   1.8   thorpej 
   1363   1.8   thorpej 	e = &icp_event_buffer[eindex];
   1364   1.8   thorpej 	if (e->event_source != 0) {
   1365   1.8   thorpej 		if (eindex != icp_event_lastidx) {
   1366   1.8   thorpej 			eindex++;
   1367   1.8   thorpej 			if (eindex == ICP_MAX_EVENTS)
   1368   1.8   thorpej 				eindex = 0;
   1369   1.8   thorpej 		} else
   1370   1.8   thorpej 			eindex = -1;
   1371   1.8   thorpej 		memcpy(estr, e, sizeof(gdt_evt_str));
   1372   1.8   thorpej 	}
   1373   1.8   thorpej 
   1374   1.8   thorpej 	splx(s);
   1375   1.8   thorpej 
   1376   1.8   thorpej 	return (eindex);
   1377   1.8   thorpej }
   1378   1.8   thorpej 
   1379   1.8   thorpej void
   1380  1.22  christos icp_readapp_event(struct icp_softc *icp, u_int8_t application,
   1381   1.8   thorpej     gdt_evt_str *estr)
   1382   1.8   thorpej {
   1383   1.8   thorpej 	gdt_evt_str *e;
   1384   1.8   thorpej 	int found = 0, eindex, s;
   1385   1.8   thorpej 
   1386   1.8   thorpej 	s = splbio();
   1387   1.8   thorpej 
   1388   1.8   thorpej 	eindex = icp_event_oldidx;
   1389   1.8   thorpej 	for (;;) {
   1390   1.8   thorpej 		e = &icp_event_buffer[eindex];
   1391   1.8   thorpej 		if (e->event_source == 0)
   1392   1.8   thorpej 			break;
   1393   1.8   thorpej 		if ((e->application & application) == 0) {
   1394   1.8   thorpej 			e->application |= application;
   1395   1.8   thorpej 			found = 1;
   1396   1.8   thorpej 			break;
   1397   1.8   thorpej 		}
   1398   1.8   thorpej 		if (eindex == icp_event_lastidx)
   1399   1.8   thorpej 			break;
   1400   1.8   thorpej 		eindex++;
   1401   1.8   thorpej 		if (eindex == ICP_MAX_EVENTS)
   1402   1.8   thorpej 			eindex = 0;
   1403   1.8   thorpej 	}
   1404   1.8   thorpej 	if (found)
   1405   1.8   thorpej 		memcpy(estr, e, sizeof(gdt_evt_str));
   1406   1.8   thorpej 	else
   1407   1.8   thorpej 		estr->event_source = 0;
   1408   1.8   thorpej 
   1409   1.8   thorpej 	splx(s);
   1410   1.8   thorpej }
   1411   1.8   thorpej 
   1412   1.8   thorpej void
   1413  1.22  christos icp_clear_events(struct icp_softc *icp)
   1414   1.8   thorpej {
   1415   1.8   thorpej 	int s;
   1416   1.8   thorpej 
   1417   1.8   thorpej 	s = splbio();
   1418   1.8   thorpej 	icp_event_oldidx = icp_event_lastidx = 0;
   1419   1.8   thorpej 	memset(icp_event_buffer, 0, sizeof(icp_event_buffer));
   1420   1.8   thorpej 	splx(s);
   1421   1.1        ad }
   1422