Home | History | Annotate | Line # | Download | only in ic
ciss.c revision 1.35
      1 /*	$NetBSD: ciss.c,v 1.35 2015/03/12 19:56:51 christos Exp $	*/
      2 /*	$OpenBSD: ciss.c,v 1.68 2013/05/30 16:15:02 deraadt Exp $	*/
      3 
      4 /*
      5  * Copyright (c) 2005,2006 Michael Shalayeff
      6  * All rights reserved.
      7  *
      8  * Permission to use, copy, modify, and distribute this software for any
      9  * purpose with or without fee is hereby granted, provided that the above
     10  * copyright notice and this permission notice appear in all copies.
     11  *
     12  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     13  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     14  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     15  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     16  * WHATSOEVER RESULTING FROM LOSS OF MIND, USE, DATA OR PROFITS, WHETHER IN
     17  * AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT
     18  * OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     19  */
     20 
     21 #include <sys/cdefs.h>
     22 __KERNEL_RCSID(0, "$NetBSD: ciss.c,v 1.35 2015/03/12 19:56:51 christos Exp $");
     23 
     24 #include "bio.h"
     25 
     26 /* #define CISS_DEBUG */
     27 
     28 #include <sys/param.h>
     29 #include <sys/systm.h>
     30 #include <sys/buf.h>
     31 #include <sys/ioctl.h>
     32 #include <sys/device.h>
     33 #include <sys/kernel.h>
     34 #include <sys/malloc.h>
     35 #include <sys/proc.h>
     36 
     37 #include <sys/bus.h>
     38 
     39 #include <dev/scsipi/scsi_all.h>
     40 #include <dev/scsipi/scsi_disk.h>
     41 #include <dev/scsipi/scsiconf.h>
     42 #include <dev/scsipi/scsipi_all.h>
     43 
     44 #include <dev/ic/cissreg.h>
     45 #include <dev/ic/cissvar.h>
     46 
     47 #if NBIO > 0
     48 #include <dev/biovar.h>
     49 #endif /* NBIO > 0 */
     50 
     51 #ifdef CISS_DEBUG
     52 #define	CISS_DPRINTF(m,a)	if (ciss_debug & (m)) printf a
     53 #define	CISS_D_CMD	0x0001
     54 #define	CISS_D_INTR	0x0002
     55 #define	CISS_D_MISC	0x0004
     56 #define	CISS_D_DMA	0x0008
     57 #define	CISS_D_IOCTL	0x0010
     58 #define	CISS_D_ERR	0x0020
     59 int ciss_debug = 0
     60 	| CISS_D_CMD
     61 	| CISS_D_INTR
     62 	| CISS_D_MISC
     63 	| CISS_D_DMA
     64 	| CISS_D_IOCTL
     65 	| CISS_D_ERR
     66 	;
     67 #else
     68 #define	CISS_DPRINTF(m,a)	/* m, a */
     69 #endif
     70 
     71 static void	ciss_scsi_cmd(struct scsipi_channel *chan,
     72 			scsipi_adapter_req_t req, void *arg);
     73 static int	ciss_scsi_ioctl(struct scsipi_channel *chan, u_long cmd,
     74 	    void *addr, int flag, struct proc *p);
     75 static void	cissminphys(struct buf *bp);
     76 
     77 #if 0
     78 static void	ciss_scsi_raw_cmd(struct scsipi_channel *chan,
     79 			scsipi_adapter_req_t req, void *arg);
     80 #endif
     81 
     82 static int	ciss_sync(struct ciss_softc *sc);
     83 static void	ciss_heartbeat(void *v);
     84 static void	ciss_shutdown(void *v);
     85 
     86 static struct ciss_ccb *ciss_get_ccb(struct ciss_softc *sc);
     87 static void	ciss_put_ccb(struct ciss_ccb *ccb);
     88 static int	ciss_cmd(struct ciss_ccb *ccb, int flags, int wait);
     89 static int	ciss_done(struct ciss_ccb *ccb);
     90 static int	ciss_error(struct ciss_ccb *ccb);
     91 struct ciss_ld *ciss_pdscan(struct ciss_softc *sc, int ld);
     92 static int	ciss_inq(struct ciss_softc *sc, struct ciss_inquiry *inq);
     93 int	ciss_ldid(struct ciss_softc *, int, struct ciss_ldid *);
     94 int	ciss_ldstat(struct ciss_softc *, int, struct ciss_ldstat *);
     95 static int	ciss_ldmap(struct ciss_softc *sc);
     96 int	ciss_pdid(struct ciss_softc *, u_int8_t, struct ciss_pdid *, int);
     97 
     98 #if NBIO > 0
     99 int		ciss_ioctl(device_t, u_long, void *);
    100 int		ciss_ioctl_vol(struct ciss_softc *, struct bioc_vol *);
    101 int		ciss_blink(struct ciss_softc *, int, int, int, struct ciss_blink *);
    102 int		ciss_create_sensors(struct ciss_softc *);
    103 void		ciss_sensor_refresh(struct sysmon_envsys *, envsys_data_t *);
    104 #endif /* NBIO > 0 */
    105 
    106 static struct ciss_ccb *
    107 ciss_get_ccb(struct ciss_softc *sc)
    108 {
    109 	struct ciss_ccb *ccb;
    110 
    111 	mutex_enter(&sc->sc_mutex);
    112 	if ((ccb = TAILQ_LAST(&sc->sc_free_ccb, ciss_queue_head))) {
    113 		TAILQ_REMOVE(&sc->sc_free_ccb, ccb, ccb_link);
    114 		ccb->ccb_state = CISS_CCB_READY;
    115 	}
    116 	mutex_exit(&sc->sc_mutex);
    117 	return ccb;
    118 }
    119 
    120 static void
    121 ciss_put_ccb(struct ciss_ccb *ccb)
    122 {
    123 	struct ciss_softc *sc = ccb->ccb_sc;
    124 
    125 	ccb->ccb_state = CISS_CCB_FREE;
    126 	mutex_enter(&sc->sc_mutex);
    127 	TAILQ_INSERT_TAIL(&sc->sc_free_ccb, ccb, ccb_link);
    128 	mutex_exit(&sc->sc_mutex);
    129 }
    130 
    131 int
    132 ciss_attach(struct ciss_softc *sc)
    133 {
    134 	struct ciss_ccb *ccb;
    135 	struct ciss_cmd *cmd;
    136 	struct ciss_inquiry *inq;
    137 	bus_dma_segment_t seg[1];
    138 	int error, i, total, rseg, maxfer;
    139 	paddr_t pa;
    140 
    141 	bus_space_read_region_4(sc->sc_iot, sc->cfg_ioh, sc->cfgoff,
    142 	    (u_int32_t *)&sc->cfg, sizeof(sc->cfg) / 4);
    143 
    144 	if (sc->cfg.signature != CISS_SIGNATURE) {
    145 		printf(": bad sign 0x%08x\n", sc->cfg.signature);
    146 		return -1;
    147 	}
    148 
    149 	if (!(sc->cfg.methods & CISS_METH_SIMPL)) {
    150 		printf(": not simple 0x%08x\n", sc->cfg.methods);
    151 		return -1;
    152 	}
    153 
    154 	sc->cfg.rmethod = CISS_METH_SIMPL;
    155 	sc->cfg.paddr_lim = 0;			/* 32bit addrs */
    156 	sc->cfg.int_delay = 0;			/* disable coalescing */
    157 	sc->cfg.int_count = 0;
    158 	strlcpy(sc->cfg.hostname, "HUMPPA", sizeof(sc->cfg.hostname));
    159 	sc->cfg.driverf |= CISS_DRV_PRF;	/* enable prefetch */
    160 	if (!sc->cfg.maxsg)
    161 		sc->cfg.maxsg = MAXPHYS / PAGE_SIZE + 1;
    162 
    163 	bus_space_write_region_4(sc->sc_iot, sc->cfg_ioh, sc->cfgoff,
    164 	    (u_int32_t *)&sc->cfg, sizeof(sc->cfg) / 4);
    165 	bus_space_barrier(sc->sc_iot, sc->cfg_ioh, sc->cfgoff, sizeof(sc->cfg),
    166 	    BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE);
    167 
    168 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_IDB, CISS_IDB_CFG);
    169 	bus_space_barrier(sc->sc_iot, sc->sc_ioh, CISS_IDB, 4,
    170 	    BUS_SPACE_BARRIER_WRITE);
    171 	for (i = 1000; i--; DELAY(1000)) {
    172 		/* XXX maybe IDB is really 64bit? - hp dl380 needs this */
    173 		(void)bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_IDB + 4);
    174 		if (!(bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_IDB) & CISS_IDB_CFG))
    175 			break;
    176 		bus_space_barrier(sc->sc_iot, sc->sc_ioh, CISS_IDB, 4,
    177 		    BUS_SPACE_BARRIER_READ);
    178 	}
    179 
    180 	if (bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_IDB) & CISS_IDB_CFG) {
    181 		printf(": cannot set config\n");
    182 		return -1;
    183 	}
    184 
    185 	bus_space_read_region_4(sc->sc_iot, sc->cfg_ioh, sc->cfgoff,
    186 	    (u_int32_t *)&sc->cfg, sizeof(sc->cfg) / 4);
    187 
    188 	if (!(sc->cfg.amethod & CISS_METH_SIMPL)) {
    189 		printf(": cannot simplify 0x%08x\n", sc->cfg.amethod);
    190 		return -1;
    191 	}
    192 
    193 	/* i'm ready for you and i hope you're ready for me */
    194 	for (i = 30000; i--; DELAY(1000)) {
    195 		if (bus_space_read_4(sc->sc_iot, sc->cfg_ioh, sc->cfgoff +
    196 		    offsetof(struct ciss_config, amethod)) & CISS_METH_READY)
    197 			break;
    198 		bus_space_barrier(sc->sc_iot, sc->cfg_ioh, sc->cfgoff +
    199 		    offsetof(struct ciss_config, amethod), 4,
    200 		    BUS_SPACE_BARRIER_READ);
    201 	}
    202 
    203 	if (!(bus_space_read_4(sc->sc_iot, sc->cfg_ioh, sc->cfgoff +
    204 	    offsetof(struct ciss_config, amethod)) & CISS_METH_READY)) {
    205 		printf(": she never came ready for me 0x%08x\n",
    206 		    sc->cfg.amethod);
    207 		return -1;
    208 	}
    209 
    210 	mutex_init(&sc->sc_mutex, MUTEX_DEFAULT, IPL_VM);
    211 	mutex_init(&sc->sc_mutex_scratch, MUTEX_DEFAULT, IPL_VM);
    212 	cv_init(&sc->sc_condvar, "ciss_cmd");
    213 	sc->maxcmd = sc->cfg.maxcmd;
    214 	sc->maxsg = sc->cfg.maxsg;
    215 	if (sc->maxsg > MAXPHYS / PAGE_SIZE + 1)
    216 		sc->maxsg = MAXPHYS / PAGE_SIZE + 1;
    217 	i = sizeof(struct ciss_ccb) +
    218 	    sizeof(ccb->ccb_cmd.sgl[0]) * (sc->maxsg - 1);
    219 	for (sc->ccblen = 0x10; sc->ccblen < i; sc->ccblen <<= 1);
    220 
    221 	total = sc->ccblen * sc->maxcmd;
    222 	if ((error = bus_dmamem_alloc(sc->sc_dmat, total, PAGE_SIZE, 0,
    223 	    sc->cmdseg, 1, &rseg, BUS_DMA_NOWAIT))) {
    224 		printf(": cannot allocate CCBs (%d)\n", error);
    225 		return -1;
    226 	}
    227 
    228 	if ((error = bus_dmamem_map(sc->sc_dmat, sc->cmdseg, rseg, total,
    229 	    (void **)&sc->ccbs, BUS_DMA_NOWAIT))) {
    230 		printf(": cannot map CCBs (%d)\n", error);
    231 		return -1;
    232 	}
    233 	memset(sc->ccbs, 0, total);
    234 
    235 	if ((error = bus_dmamap_create(sc->sc_dmat, total, 1,
    236 	    total, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &sc->cmdmap))) {
    237 		printf(": cannot create CCBs dmamap (%d)\n", error);
    238 		bus_dmamem_free(sc->sc_dmat, sc->cmdseg, 1);
    239 		return -1;
    240 	}
    241 
    242 	if ((error = bus_dmamap_load(sc->sc_dmat, sc->cmdmap, sc->ccbs, total,
    243 	    NULL, BUS_DMA_NOWAIT))) {
    244 		printf(": cannot load CCBs dmamap (%d)\n", error);
    245 		bus_dmamem_free(sc->sc_dmat, sc->cmdseg, 1);
    246 		bus_dmamap_destroy(sc->sc_dmat, sc->cmdmap);
    247 		return -1;
    248 	}
    249 
    250 	TAILQ_INIT(&sc->sc_ccbq);
    251 	TAILQ_INIT(&sc->sc_ccbdone);
    252 	TAILQ_INIT(&sc->sc_free_ccb);
    253 
    254 	maxfer = sc->maxsg * PAGE_SIZE;
    255 	for (i = 0; total > 0 && i < sc->maxcmd; i++, total -= sc->ccblen) {
    256 		ccb = (struct ciss_ccb *) ((char *)sc->ccbs + i * sc->ccblen);
    257 		cmd = &ccb->ccb_cmd;
    258 		pa = sc->cmdseg[0].ds_addr + i * sc->ccblen;
    259 
    260 		ccb->ccb_sc = sc;
    261 		ccb->ccb_cmdpa = pa + offsetof(struct ciss_ccb, ccb_cmd);
    262 		ccb->ccb_state = CISS_CCB_FREE;
    263 
    264 		cmd->id = htole32(i << 2);
    265 		cmd->id_hi = htole32(0);
    266 		cmd->sgin = sc->maxsg;
    267 		cmd->sglen = htole16((u_int16_t)cmd->sgin);
    268 		cmd->err_len = htole32(sizeof(ccb->ccb_err));
    269 		pa += offsetof(struct ciss_ccb, ccb_err);
    270 		cmd->err_pa = htole64((u_int64_t)pa);
    271 
    272 		if ((error = bus_dmamap_create(sc->sc_dmat, maxfer, sc->maxsg,
    273 		    maxfer, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
    274 		    &ccb->ccb_dmamap)))
    275 			break;
    276 
    277 		TAILQ_INSERT_TAIL(&sc->sc_free_ccb, ccb, ccb_link);
    278 	}
    279 
    280 	if (i < sc->maxcmd) {
    281 		printf(": cannot create ccb#%d dmamap (%d)\n", i, error);
    282 		if (i == 0) {
    283 			/* TODO leaking cmd's dmamaps and shitz */
    284 			bus_dmamem_free(sc->sc_dmat, sc->cmdseg, 1);
    285 			bus_dmamap_destroy(sc->sc_dmat, sc->cmdmap);
    286 			return -1;
    287 		}
    288 	}
    289 
    290 	if ((error = bus_dmamem_alloc(sc->sc_dmat, PAGE_SIZE, PAGE_SIZE, 0,
    291 	    seg, 1, &rseg, BUS_DMA_NOWAIT))) {
    292 		printf(": cannot allocate scratch buffer (%d)\n", error);
    293 		return -1;
    294 	}
    295 
    296 	if ((error = bus_dmamem_map(sc->sc_dmat, seg, rseg, PAGE_SIZE,
    297 	    (void **)&sc->scratch, BUS_DMA_NOWAIT))) {
    298 		printf(": cannot map scratch buffer (%d)\n", error);
    299 		return -1;
    300 	}
    301 	memset(sc->scratch, 0, PAGE_SIZE);
    302 	sc->sc_waitflag = XS_CTL_NOSLEEP;		/* can't sleep yet */
    303 
    304 	mutex_enter(&sc->sc_mutex_scratch);		/* is this really needed? */
    305 	inq = sc->scratch;
    306 	if (ciss_inq(sc, inq)) {
    307 		printf(": adapter inquiry failed\n");
    308 		mutex_exit(&sc->sc_mutex_scratch);
    309 		bus_dmamem_free(sc->sc_dmat, sc->cmdseg, 1);
    310 		bus_dmamap_destroy(sc->sc_dmat, sc->cmdmap);
    311 		return -1;
    312 	}
    313 
    314 	if (!(inq->flags & CISS_INQ_BIGMAP)) {
    315 		printf(": big map is not supported, flags=0x%x\n",
    316 		    inq->flags);
    317 		mutex_exit(&sc->sc_mutex_scratch);
    318 		bus_dmamem_free(sc->sc_dmat, sc->cmdseg, 1);
    319 		bus_dmamap_destroy(sc->sc_dmat, sc->cmdmap);
    320 		return -1;
    321 	}
    322 
    323 	sc->maxunits = inq->numld;
    324 	sc->nbus = inq->nscsi_bus;
    325 	sc->ndrives = inq->buswidth ? inq->buswidth : 256;
    326 	printf(": %d LD%s, HW rev %d, FW %4.4s/%4.4s",
    327 	    inq->numld, inq->numld == 1? "" : "s",
    328 	    inq->hw_rev, inq->fw_running, inq->fw_stored);
    329 
    330 	if (sc->cfg.methods & CISS_METH_FIFO64)
    331 		printf(", 64bit fifo");
    332 	else if (sc->cfg.methods & CISS_METH_FIFO64_RRO)
    333 		printf(", 64bit fifo rro");
    334 	printf("\n");
    335 
    336 	mutex_exit(&sc->sc_mutex_scratch);
    337 
    338 	callout_init(&sc->sc_hb, 0);
    339 	callout_setfunc(&sc->sc_hb, ciss_heartbeat, sc);
    340 	callout_schedule(&sc->sc_hb, hz * 3);
    341 
    342 	/* map LDs */
    343 	if (ciss_ldmap(sc)) {
    344 		aprint_error_dev(sc->sc_dev, "adapter LD map failed\n");
    345 		bus_dmamem_free(sc->sc_dmat, sc->cmdseg, 1);
    346 		bus_dmamap_destroy(sc->sc_dmat, sc->cmdmap);
    347 		return -1;
    348 	}
    349 
    350 	if (!(sc->sc_lds = malloc(sc->maxunits * sizeof(*sc->sc_lds),
    351 	    M_DEVBUF, M_NOWAIT))) {
    352 		bus_dmamem_free(sc->sc_dmat, sc->cmdseg, 1);
    353 		bus_dmamap_destroy(sc->sc_dmat, sc->cmdmap);
    354 		return -1;
    355 	}
    356 	memset(sc->sc_lds, 0, sc->maxunits * sizeof(*sc->sc_lds));
    357 
    358 	sc->sc_flush = CISS_FLUSH_ENABLE;
    359 	if (!(sc->sc_sh = shutdownhook_establish(ciss_shutdown, sc))) {
    360 		printf(": unable to establish shutdown hook\n");
    361 		bus_dmamem_free(sc->sc_dmat, sc->cmdseg, 1);
    362 		bus_dmamap_destroy(sc->sc_dmat, sc->cmdmap);
    363 		return -1;
    364 	}
    365 
    366 	sc->sc_channel.chan_adapter = &sc->sc_adapter;
    367 	sc->sc_channel.chan_bustype = &scsi_bustype;
    368 	sc->sc_channel.chan_channel = 0;
    369 	sc->sc_channel.chan_ntargets = sc->maxunits;
    370 	sc->sc_channel.chan_nluns = 1;	/* ciss doesn't really have SCSI luns */
    371 	sc->sc_channel.chan_openings = sc->maxcmd;
    372 #if NBIO > 0
    373 	/* XXX Reserve some ccb's for sensor and bioctl. */
    374 	if (sc->sc_channel.chan_openings > 2)
    375 		sc->sc_channel.chan_openings -= 2;
    376 #endif
    377 	sc->sc_channel.chan_flags = 0;
    378 	sc->sc_channel.chan_id = sc->maxunits;
    379 
    380 	sc->sc_adapter.adapt_dev = sc->sc_dev;
    381 	sc->sc_adapter.adapt_openings = sc->sc_channel.chan_openings;
    382 	sc->sc_adapter.adapt_max_periph = min(sc->sc_adapter.adapt_openings, 256);
    383 	sc->sc_adapter.adapt_request = ciss_scsi_cmd;
    384 	sc->sc_adapter.adapt_minphys = cissminphys;
    385 	sc->sc_adapter.adapt_ioctl = ciss_scsi_ioctl;
    386 	sc->sc_adapter.adapt_nchannels = 1;
    387 	config_found(sc->sc_dev, &sc->sc_channel, scsiprint);
    388 
    389 #if 0
    390 	sc->sc_link_raw.adapter_softc = sc;
    391 	sc->sc_link.openings = sc->sc_channel.chan_openings;
    392 	sc->sc_link_raw.adapter = &ciss_raw_switch;
    393 	sc->sc_link_raw.adapter_target = sc->ndrives;
    394 	sc->sc_link_raw.adapter_buswidth = sc->ndrives;
    395 	config_found(sc->sc_dev, &sc->sc_channel, scsiprint);
    396 #endif
    397 
    398 #if NBIO > 0
    399 	/* now map all the physdevs into their lds */
    400 	/* XXX currently we assign all of them into ld0 */
    401 	for (i = 0; i < sc->maxunits && i < 1; i++)
    402 		if (!(sc->sc_lds[i] = ciss_pdscan(sc, i))) {
    403 			sc->sc_waitflag = 0;	/* we can sleep now */
    404 			return 0;
    405 		}
    406 
    407 	if (bio_register(sc->sc_dev, ciss_ioctl) != 0)
    408 		aprint_error_dev(sc->sc_dev, "controller registration failed");
    409 	else
    410 		sc->sc_ioctl = ciss_ioctl;
    411 	if (ciss_create_sensors(sc) != 0)
    412 		aprint_error_dev(sc->sc_dev, "unable to create sensors");
    413 #endif
    414 	sc->sc_waitflag = 0;			/* we can sleep now */
    415 
    416 	return 0;
    417 }
    418 
    419 static void
    420 ciss_shutdown(void *v)
    421 {
    422 	struct ciss_softc *sc = v;
    423 
    424 	sc->sc_flush = CISS_FLUSH_DISABLE;
    425 	/* timeout_del(&sc->sc_hb); */
    426 	ciss_sync(sc);
    427 }
    428 
    429 static void
    430 cissminphys(struct buf *bp)
    431 {
    432 #if 0	/* TODO */
    433 #define	CISS_MAXFER	(PAGE_SIZE * (sc->maxsg + 1))
    434 	if (bp->b_bcount > CISS_MAXFER)
    435 		bp->b_bcount = CISS_MAXFER;
    436 #endif
    437 	minphys(bp);
    438 }
    439 
    440 static struct ciss_ccb *
    441 ciss_poll1(struct ciss_softc *sc)
    442 {
    443 	struct ciss_ccb *ccb;
    444 	uint32_t id;
    445 
    446 	if (!(bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_ISR) & sc->iem)) {
    447 		CISS_DPRINTF(CISS_D_CMD, ("N"));
    448 		return NULL;
    449 	}
    450 
    451 	if (sc->cfg.methods & CISS_METH_FIFO64) {
    452 		if (bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_OUTQ64_HI) ==
    453 		    0xffffffff) {
    454 			CISS_DPRINTF(CISS_D_CMD, ("Q"));
    455 			return NULL;
    456 		}
    457 		id = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_OUTQ64_LO);
    458 	} else if (sc->cfg.methods & CISS_METH_FIFO64_RRO) {
    459 		id = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_OUTQ64_LO);
    460 		if (id == 0xffffffff) {
    461 			CISS_DPRINTF(CISS_D_CMD, ("Q"));
    462 			return NULL;
    463 		}
    464 		(void)bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_OUTQ64_HI);
    465 	} else {
    466 		id = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_OUTQ);
    467 		if (id == 0xffffffff) {
    468 			CISS_DPRINTF(CISS_D_CMD, ("Q"));
    469 			return NULL;
    470 		}
    471 	}
    472 
    473 	CISS_DPRINTF(CISS_D_CMD, ("got=0x%x ", id));
    474 	ccb = (struct ciss_ccb *) ((char *)sc->ccbs + (id >> 2) * sc->ccblen);
    475 	ccb->ccb_cmd.id = htole32(id);
    476 	ccb->ccb_cmd.id_hi = htole32(0);
    477 	return ccb;
    478 }
    479 
    480 static int
    481 ciss_poll(struct ciss_softc *sc, struct ciss_ccb *ccb, int ms)
    482 {
    483 	struct ciss_ccb *ccb1;
    484 
    485 	ms /= 10;
    486 
    487 	while (ms-- > 0) {
    488 		DELAY(10);
    489 		ccb1 = ciss_poll1(sc);
    490 		if (ccb1 == NULL)
    491 			continue;
    492 		ciss_done(ccb1);
    493 		if (ccb1 == ccb)
    494 			return 0;
    495 	}
    496 
    497 	return ETIMEDOUT;
    498 }
    499 
    500 static int
    501 ciss_wait(struct ciss_softc *sc, struct ciss_ccb *ccb, int ms)
    502 {
    503 	int tohz, etick;
    504 
    505 	tohz = mstohz(ms);
    506 	if (tohz == 0)
    507 		tohz = 1;
    508 	etick = hardclock_ticks + tohz;
    509 
    510 	for (;;) {
    511 		ccb->ccb_state = CISS_CCB_POLL;
    512 		CISS_DPRINTF(CISS_D_CMD, ("cv_timedwait(%d) ", tohz));
    513 		mutex_enter(&sc->sc_mutex);
    514 		if (cv_timedwait(&sc->sc_condvar, &sc->sc_mutex, tohz)
    515 		    == EWOULDBLOCK) {
    516 			mutex_exit(&sc->sc_mutex);
    517 			return EWOULDBLOCK;
    518 		}
    519 		mutex_exit(&sc->sc_mutex);
    520 		if (ccb->ccb_state == CISS_CCB_ONQ) {
    521 			ciss_done(ccb);
    522 			return 0;
    523 		}
    524 		tohz = etick - hardclock_ticks;
    525 		if (tohz <= 0)
    526 			return EWOULDBLOCK;
    527 		CISS_DPRINTF(CISS_D_CMD, ("T"));
    528 	}
    529 }
    530 
    531 /*
    532  * submit a command and optionally wait for completition.
    533  * wait arg abuses XS_CTL_POLL|XS_CTL_NOSLEEP flags to request
    534  * to wait (XS_CTL_POLL) and to allow tsleep() (!XS_CTL_NOSLEEP)
    535  * instead of busy loop waiting
    536  */
    537 static int
    538 ciss_cmd(struct ciss_ccb *ccb, int flags, int wait)
    539 {
    540 	struct ciss_softc *sc = ccb->ccb_sc;
    541 	struct ciss_cmd *cmd = &ccb->ccb_cmd;
    542 	bus_dmamap_t dmap = ccb->ccb_dmamap;
    543 	u_int64_t addr;
    544 	int i, error = 0;
    545 
    546 	if (ccb->ccb_state != CISS_CCB_READY) {
    547 		printf("%s: ccb %d not ready state=0x%x\n", device_xname(sc->sc_dev),
    548 		    cmd->id, ccb->ccb_state);
    549 		return (EINVAL);
    550 	}
    551 
    552 	if (ccb->ccb_data) {
    553 		bus_dma_segment_t *sgd;
    554 
    555 		if ((error = bus_dmamap_load(sc->sc_dmat, dmap, ccb->ccb_data,
    556 		    ccb->ccb_len, NULL, flags))) {
    557 			if (error == EFBIG)
    558 				printf("more than %d dma segs\n", sc->maxsg);
    559 			else
    560 				printf("error %d loading dma map\n", error);
    561 			ciss_put_ccb(ccb);
    562 			return (error);
    563 		}
    564 		cmd->sgin = dmap->dm_nsegs;
    565 
    566 		sgd = dmap->dm_segs;
    567 		CISS_DPRINTF(CISS_D_DMA, ("data=%p/%zu<%#" PRIxPADDR "/%zu",
    568 		    ccb->ccb_data, ccb->ccb_len, sgd->ds_addr, sgd->ds_len));
    569 
    570 		for (i = 0; i < dmap->dm_nsegs; sgd++, i++) {
    571 			cmd->sgl[i].addr_lo = htole32(sgd->ds_addr);
    572 			cmd->sgl[i].addr_hi =
    573 			    htole32((u_int64_t)sgd->ds_addr >> 32);
    574 			cmd->sgl[i].len = htole32(sgd->ds_len);
    575 			cmd->sgl[i].flags = htole32(0);
    576 			if (i) {
    577 				CISS_DPRINTF(CISS_D_DMA,
    578 				    (",%#" PRIxPADDR "/%zu", sgd->ds_addr,
    579 				    sgd->ds_len));
    580 			}
    581 		}
    582 
    583 		CISS_DPRINTF(CISS_D_DMA, ("> "));
    584 
    585 		bus_dmamap_sync(sc->sc_dmat, dmap, 0, dmap->dm_mapsize,
    586 		    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
    587 	} else
    588 		cmd->sgin = 0;
    589 	cmd->sglen = htole16((u_int16_t)cmd->sgin);
    590 	memset(&ccb->ccb_err, 0, sizeof(ccb->ccb_err));
    591 
    592 	bus_dmamap_sync(sc->sc_dmat, sc->cmdmap, 0, sc->cmdmap->dm_mapsize,
    593 	    BUS_DMASYNC_PREWRITE);
    594 
    595 	if ((wait & (XS_CTL_POLL|XS_CTL_NOSLEEP)) == (XS_CTL_POLL|XS_CTL_NOSLEEP))
    596 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_IMR,
    597 		    bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_IMR) | sc->iem);
    598 
    599 	mutex_enter(&sc->sc_mutex);
    600 	TAILQ_INSERT_TAIL(&sc->sc_ccbq, ccb, ccb_link);
    601 	mutex_exit(&sc->sc_mutex);
    602 	ccb->ccb_state = CISS_CCB_ONQ;
    603 	CISS_DPRINTF(CISS_D_CMD, ("submit=0x%x ", cmd->id));
    604 	if (sc->cfg.methods & (CISS_METH_FIFO64|CISS_METH_FIFO64_RRO)) {
    605 		/*
    606 		 * Write the upper 32bits immediately before the lower
    607 		 * 32bits and set bit 63 to indicate 64bit FIFO mode.
    608 		 */
    609 		addr = (u_int64_t)ccb->ccb_cmdpa;
    610 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_INQ64_HI,
    611 		    (addr >> 32) | 0x80000000);
    612 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_INQ64_LO,
    613 		    addr & 0x00000000ffffffffULL);
    614 	} else
    615 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_INQ,
    616 		    ccb->ccb_cmdpa);
    617 
    618 	if (wait & XS_CTL_POLL) {
    619 		int ms;
    620 		CISS_DPRINTF(CISS_D_CMD, ("waiting "));
    621 
    622 		ms = ccb->ccb_xs ? ccb->ccb_xs->timeout : 60000;
    623 		if (wait & XS_CTL_NOSLEEP)
    624 			error = ciss_poll(sc, ccb, ms);
    625 		else
    626 			error = ciss_wait(sc, ccb, ms);
    627 
    628 		/* if never got a chance to be done above... */
    629 		if (ccb->ccb_state != CISS_CCB_FREE) {
    630 			KASSERT(error);
    631 			ccb->ccb_err.cmd_stat = CISS_ERR_TMO;
    632 			error = ciss_done(ccb);
    633 		}
    634 
    635 		CISS_DPRINTF(CISS_D_CMD, ("done %d:%d",
    636 		    ccb->ccb_err.cmd_stat, ccb->ccb_err.scsi_stat));
    637 	}
    638 
    639 	if ((wait & (XS_CTL_POLL|XS_CTL_NOSLEEP)) == (XS_CTL_POLL|XS_CTL_NOSLEEP))
    640 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_IMR,
    641 		    bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_IMR) & ~sc->iem);
    642 
    643 	return (error);
    644 }
    645 
    646 static int
    647 ciss_done(struct ciss_ccb *ccb)
    648 {
    649 	struct ciss_softc *sc = ccb->ccb_sc;
    650 	struct scsipi_xfer *xs = ccb->ccb_xs;
    651 	struct ciss_cmd *cmd;
    652 	int error = 0;
    653 
    654 	CISS_DPRINTF(CISS_D_CMD, ("ciss_done(%p) ", ccb));
    655 
    656 	if (ccb->ccb_state != CISS_CCB_ONQ) {
    657 		printf("%s: unqueued ccb %p ready, state=0x%x\n",
    658 		    device_xname(sc->sc_dev), ccb, ccb->ccb_state);
    659 		return 1;
    660 	}
    661 
    662 	ccb->ccb_state = CISS_CCB_READY;
    663 	mutex_enter(&sc->sc_mutex);
    664 	TAILQ_REMOVE(&sc->sc_ccbq, ccb, ccb_link);
    665 	mutex_exit(&sc->sc_mutex);
    666 
    667 	if (ccb->ccb_cmd.id & CISS_CMD_ERR)
    668 		error = ciss_error(ccb);
    669 
    670 	cmd = &ccb->ccb_cmd;
    671 	if (ccb->ccb_data) {
    672 		bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap, 0,
    673 		    ccb->ccb_dmamap->dm_mapsize, (cmd->flags & CISS_CDB_IN) ?
    674 		    BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
    675 		bus_dmamap_unload(sc->sc_dmat, ccb->ccb_dmamap);
    676 		ccb->ccb_xs = NULL;
    677 		ccb->ccb_data = NULL;
    678 	}
    679 
    680 	ciss_put_ccb(ccb);
    681 
    682 	if (xs) {
    683 		xs->resid = 0;
    684 		CISS_DPRINTF(CISS_D_CMD, ("scsipi_done(%p) ", xs));
    685 		if (xs->cmd->opcode == INQUIRY) {
    686 			struct scsipi_inquiry_data *inq;
    687 			inq = (struct scsipi_inquiry_data *)xs->data;
    688 			if ((inq->version & SID_ANSII) == 0 &&
    689 			    (inq->flags3 & SID_CmdQue) != 0) {
    690 				inq->version |= 2;
    691 			}
    692 		}
    693 		scsipi_done(xs);
    694 	}
    695 
    696 	return error;
    697 }
    698 
    699 static int
    700 ciss_error(struct ciss_ccb *ccb)
    701 {
    702 	struct ciss_softc *sc = ccb->ccb_sc;
    703 	struct ciss_error *err = &ccb->ccb_err;
    704 	struct scsipi_xfer *xs = ccb->ccb_xs;
    705 	int rv;
    706 
    707 	switch ((rv = le16toh(err->cmd_stat))) {
    708 	case CISS_ERR_OK:
    709 		rv = 0;
    710 		break;
    711 
    712 	case CISS_ERR_INVCMD:
    713 		if (xs == NULL ||
    714 		    xs->cmd->opcode != SCSI_SYNCHRONIZE_CACHE_10)
    715 			printf("%s: invalid cmd 0x%x: 0x%x is not valid @ 0x%x[%d]\n",
    716 			    device_xname(sc->sc_dev), ccb->ccb_cmd.id,
    717 			    err->err_info, err->err_type[3], err->err_type[2]);
    718 		if (xs) {
    719 			memset(&xs->sense, 0, sizeof(xs->sense));
    720 			xs->sense.scsi_sense.response_code =
    721 				SSD_RCODE_CURRENT | SSD_RCODE_VALID;
    722 			xs->sense.scsi_sense.flags = SKEY_ILLEGAL_REQUEST;
    723 			xs->sense.scsi_sense.asc = 0x24; /* ill field */
    724 			xs->sense.scsi_sense.ascq = 0x0;
    725 			xs->error = XS_SENSE;
    726 		}
    727 		rv = EIO;
    728 		break;
    729 
    730 	case CISS_ERR_TMO:
    731 		xs->error = XS_TIMEOUT;
    732 		rv = ETIMEDOUT;
    733 		break;
    734 
    735 	case CISS_ERR_UNRUN:
    736 		/* Underrun */
    737 		xs->resid = le32toh(err->resid);
    738 		CISS_DPRINTF(CISS_D_CMD, (" underrun resid=0x%x ",
    739 					  xs->resid));
    740 		rv = EIO;
    741 		break;
    742 	default:
    743 		if (xs) {
    744 			CISS_DPRINTF(CISS_D_CMD, ("scsi_stat=%x ", err->scsi_stat));
    745 			switch (err->scsi_stat) {
    746 			case SCSI_CHECK:
    747 				xs->error = XS_SENSE;
    748 				memcpy(&xs->sense, &err->sense[0],
    749 				    sizeof(xs->sense));
    750 				CISS_DPRINTF(CISS_D_CMD, (" sense=%02x %02x %02x %02x ",
    751 					     err->sense[0], err->sense[1], err->sense[2], err->sense[3]));
    752 				rv = EIO;
    753 				break;
    754 
    755 			case XS_BUSY:
    756 				xs->error = XS_BUSY;
    757 				rv = EBUSY;
    758 				break;
    759 
    760 			default:
    761 				CISS_DPRINTF(CISS_D_ERR, ("%s: "
    762 				    "cmd_stat=%x scsi_stat=0x%x resid=0x%x\n",
    763 				    device_xname(sc->sc_dev), rv, err->scsi_stat,
    764 				    le32toh(err->resid)));
    765 				printf("ciss driver stuffup in %s:%d: %s()\n",
    766 				       __FILE__, __LINE__, __func__);
    767 				xs->error = XS_DRIVER_STUFFUP;
    768 				rv = EIO;
    769 				break;
    770 			}
    771 			xs->resid = le32toh(err->resid);
    772 		} else
    773 			rv = EIO;
    774 	}
    775 	ccb->ccb_cmd.id &= htole32(~3);
    776 
    777 	return rv;
    778 }
    779 
    780 static int
    781 ciss_inq(struct ciss_softc *sc, struct ciss_inquiry *inq)
    782 {
    783 	struct ciss_ccb *ccb;
    784 	struct ciss_cmd *cmd;
    785 
    786 	ccb = ciss_get_ccb(sc);
    787 	ccb->ccb_len = sizeof(*inq);
    788 	ccb->ccb_data = inq;
    789 	ccb->ccb_xs = NULL;
    790 	cmd = &ccb->ccb_cmd;
    791 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
    792 	cmd->tgt2 = 0;
    793 	cmd->cdblen = 10;
    794 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    795 	cmd->tmo = htole16(0);
    796 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    797 	cmd->cdb[0] = CISS_CMD_CTRL_GET;
    798 	cmd->cdb[6] = CISS_CMS_CTRL_CTRL;
    799 	cmd->cdb[7] = sizeof(*inq) >> 8;	/* biiiig endian */
    800 	cmd->cdb[8] = sizeof(*inq) & 0xff;
    801 
    802 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL|XS_CTL_NOSLEEP);
    803 }
    804 
    805 static int
    806 ciss_ldmap(struct ciss_softc *sc)
    807 {
    808 	struct ciss_ccb *ccb;
    809 	struct ciss_cmd *cmd;
    810 	struct ciss_ldmap *lmap;
    811 	int total, rv;
    812 
    813 	mutex_enter(&sc->sc_mutex_scratch);
    814 	lmap = sc->scratch;
    815 	lmap->size = htobe32(sc->maxunits * sizeof(lmap->map));
    816 	total = sizeof(*lmap) + (sc->maxunits - 1) * sizeof(lmap->map);
    817 
    818 	ccb = ciss_get_ccb(sc);
    819 	ccb->ccb_len = total;
    820 	ccb->ccb_data = lmap;
    821 	ccb->ccb_xs = NULL;
    822 	cmd = &ccb->ccb_cmd;
    823 	cmd->tgt = CISS_CMD_MODE_PERIPH;
    824 	cmd->tgt2 = 0;
    825 	cmd->cdblen = 12;
    826 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    827 	cmd->tmo = htole16(30);
    828 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    829 	cmd->cdb[0] = CISS_CMD_LDMAP;
    830 	cmd->cdb[8] = total >> 8;	/* biiiig endian */
    831 	cmd->cdb[9] = total & 0xff;
    832 
    833 	rv = ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL|XS_CTL_NOSLEEP);
    834 
    835 	if (rv) {
    836 		mutex_exit(&sc->sc_mutex_scratch);
    837 		return rv;
    838 	}
    839 
    840 	CISS_DPRINTF(CISS_D_MISC, ("lmap %x:%x\n",
    841 	    lmap->map[0].tgt, lmap->map[0].tgt2));
    842 
    843 	mutex_exit(&sc->sc_mutex_scratch);
    844 	return 0;
    845 }
    846 
    847 static int
    848 ciss_sync(struct ciss_softc *sc)
    849 {
    850 	struct ciss_ccb *ccb;
    851 	struct ciss_cmd *cmd;
    852 	struct ciss_flush *flush;
    853 	int rv;
    854 
    855 	mutex_enter(&sc->sc_mutex_scratch);
    856 	flush = sc->scratch;
    857 	memset(flush, 0, sizeof(*flush));
    858 	flush->flush = sc->sc_flush;
    859 
    860 	ccb = ciss_get_ccb(sc);
    861 	ccb->ccb_len = sizeof(*flush);
    862 	ccb->ccb_data = flush;
    863 	ccb->ccb_xs = NULL;
    864 	cmd = &ccb->ccb_cmd;
    865 	cmd->tgt = CISS_CMD_MODE_PERIPH;
    866 	cmd->tgt2 = 0;
    867 	cmd->cdblen = 10;
    868 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_OUT;
    869 	cmd->tmo = 0;
    870 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    871 	cmd->cdb[0] = CISS_CMD_CTRL_SET;
    872 	cmd->cdb[6] = CISS_CMS_CTRL_FLUSH;
    873 	cmd->cdb[7] = sizeof(*flush) >> 8;	/* biiiig endian */
    874 	cmd->cdb[8] = sizeof(*flush) & 0xff;
    875 
    876 	rv = ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL|XS_CTL_NOSLEEP);
    877 	mutex_exit(&sc->sc_mutex_scratch);
    878 
    879 	return rv;
    880 }
    881 
    882 int
    883 ciss_ldid(struct ciss_softc *sc, int target, struct ciss_ldid *id)
    884 {
    885 	struct ciss_ccb *ccb;
    886 	struct ciss_cmd *cmd;
    887 
    888 	ccb = ciss_get_ccb(sc);
    889 	if (ccb == NULL)
    890 		return ENOMEM;
    891 	ccb->ccb_len = sizeof(*id);
    892 	ccb->ccb_data = id;
    893 	ccb->ccb_xs = NULL;
    894 	cmd = &ccb->ccb_cmd;
    895 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
    896 	cmd->tgt2 = 0;
    897 	cmd->cdblen = 10;
    898 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    899 	cmd->tmo = htole16(0);
    900 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    901 	cmd->cdb[0] = CISS_CMD_CTRL_GET;
    902 	cmd->cdb[1] = target;
    903 	cmd->cdb[6] = CISS_CMS_CTRL_LDIDEXT;
    904 	cmd->cdb[7] = sizeof(*id) >> 8;	/* biiiig endian */
    905 	cmd->cdb[8] = sizeof(*id) & 0xff;
    906 
    907 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL | sc->sc_waitflag);
    908 }
    909 
    910 int
    911 ciss_ldstat(struct ciss_softc *sc, int target, struct ciss_ldstat *stat)
    912 {
    913 	struct ciss_ccb *ccb;
    914 	struct ciss_cmd *cmd;
    915 
    916 	ccb = ciss_get_ccb(sc);
    917 	if (ccb == NULL)
    918 		return ENOMEM;
    919 	ccb->ccb_len = sizeof(*stat);
    920 	ccb->ccb_data = stat;
    921 	ccb->ccb_xs = NULL;
    922 	cmd = &ccb->ccb_cmd;
    923 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
    924 	cmd->tgt2 = 0;
    925 	cmd->cdblen = 10;
    926 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    927 	cmd->tmo = htole16(0);
    928 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    929 	cmd->cdb[0] = CISS_CMD_CTRL_GET;
    930 	cmd->cdb[1] = target;
    931 	cmd->cdb[6] = CISS_CMS_CTRL_LDSTAT;
    932 	cmd->cdb[7] = sizeof(*stat) >> 8;	/* biiiig endian */
    933 	cmd->cdb[8] = sizeof(*stat) & 0xff;
    934 
    935 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL | sc->sc_waitflag);
    936 }
    937 
    938 int
    939 ciss_pdid(struct ciss_softc *sc, u_int8_t drv, struct ciss_pdid *id, int wait)
    940 {
    941 	struct ciss_ccb *ccb;
    942 	struct ciss_cmd *cmd;
    943 
    944 	ccb = ciss_get_ccb(sc);
    945 	if (ccb == NULL)
    946 		return ENOMEM;
    947 	ccb->ccb_len = sizeof(*id);
    948 	ccb->ccb_data = id;
    949 	ccb->ccb_xs = NULL;
    950 	cmd = &ccb->ccb_cmd;
    951 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
    952 	cmd->tgt2 = 0;
    953 	cmd->cdblen = 10;
    954 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    955 	cmd->tmo = htole16(0);
    956 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    957 	cmd->cdb[0] = CISS_CMD_CTRL_GET;
    958 	cmd->cdb[2] = drv;
    959 	cmd->cdb[6] = CISS_CMS_CTRL_PDID;
    960 	cmd->cdb[7] = sizeof(*id) >> 8;	/* biiiig endian */
    961 	cmd->cdb[8] = sizeof(*id) & 0xff;
    962 
    963 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, wait);
    964 }
    965 
    966 
    967 struct ciss_ld *
    968 ciss_pdscan(struct ciss_softc *sc, int ld)
    969 {
    970 	struct ciss_pdid *pdid;
    971 	struct ciss_ld *ldp;
    972 	u_int8_t drv, buf[128];
    973 	int i, j, k = 0;
    974 
    975 	mutex_enter(&sc->sc_mutex_scratch);
    976 	pdid = sc->scratch;
    977 	if (sc->ndrives == 256) {
    978 		for (i = 0; i < CISS_BIGBIT; i++)
    979 			if (!ciss_pdid(sc, i, pdid,
    980 					XS_CTL_POLL|XS_CTL_NOSLEEP) &&
    981 			    (pdid->present & CISS_PD_PRESENT))
    982 				buf[k++] = i;
    983 	} else
    984 		for (i = 0; i < sc->nbus; i++)
    985 			for (j = 0; j < sc->ndrives; j++) {
    986 				drv = CISS_BIGBIT + i * sc->ndrives + j;
    987 				if (!ciss_pdid(sc, drv, pdid,
    988 						XS_CTL_POLL|XS_CTL_NOSLEEP))
    989 					buf[k++] = drv;
    990 			}
    991 	mutex_exit(&sc->sc_mutex_scratch);
    992 
    993 	if (!k)
    994 		return NULL;
    995 
    996 	ldp = malloc(sizeof(*ldp) + (k-1), M_DEVBUF, M_NOWAIT);
    997 	if (!ldp)
    998 		return NULL;
    999 
   1000 	memset(&ldp->bling, 0, sizeof(ldp->bling));
   1001 	ldp->ndrives = k;
   1002 	ldp->xname[0] = 0;
   1003 	memcpy(ldp->tgts, buf, k);
   1004 	return ldp;
   1005 }
   1006 
   1007 #if 0
   1008 static void
   1009 ciss_scsi_raw_cmd(struct scsipi_channel *chan, scsipi_adapter_req_t req,
   1010 	void *arg)				/* TODO */
   1011 {
   1012 	struct scsipi_xfer *xs = (struct scsipi_xfer *) arg;
   1013 	struct ciss_rawsoftc *rsc = device_private(
   1014 	    chan->chan_adapter->adapt_dev);
   1015 	struct ciss_softc *sc = rsc->sc_softc;
   1016 	struct ciss_ccb *ccb;
   1017 	struct ciss_cmd *cmd;
   1018 	int error;
   1019 
   1020 	CISS_DPRINTF(CISS_D_CMD, ("ciss_scsi_raw_cmd "));
   1021 
   1022 	switch (req)
   1023 	{
   1024 	case ADAPTER_REQ_RUN_XFER:
   1025 		if (xs->cmdlen > CISS_MAX_CDB) {
   1026 			CISS_DPRINTF(CISS_D_CMD, ("CDB too big %p ", xs));
   1027 			memset(&xs->sense, 0, sizeof(xs->sense));
   1028 			printf("ciss driver stuffup in %s:%d: %s()\n",
   1029 			       __FILE__, __LINE__, __func__);
   1030 			xs->error = XS_DRIVER_STUFFUP;
   1031 			scsipi_done(xs);
   1032 			break;
   1033 		}
   1034 
   1035 		error = 0;
   1036 		xs->error = XS_NOERROR;
   1037 
   1038 		/* TODO check this target has not yet employed w/ any volume */
   1039 
   1040 		ccb = ciss_get_ccb(sc);
   1041 		cmd = &ccb->ccb_cmd;
   1042 		ccb->ccb_len = xs->datalen;
   1043 		ccb->ccb_data = xs->data;
   1044 		ccb->ccb_xs = xs;
   1045 
   1046 		cmd->cdblen = xs->cmdlen;
   1047 		cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL;
   1048 		if (xs->xs_control & XS_CTL_DATA_IN)
   1049 			cmd->flags |= CISS_CDB_IN;
   1050 		else if (xs->xs_control & XS_CTL_DATA_OUT)
   1051 			cmd->flags |= CISS_CDB_OUT;
   1052 		cmd->tmo = xs->timeout < 1000? 1 : xs->timeout / 1000;
   1053 		memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
   1054 		memcpy(&cmd->cdb[0], xs->cmd, CISS_MAX_CDB);
   1055 
   1056 		if (ciss_cmd(ccb, BUS_DMA_WAITOK,
   1057 		    xs->xs_control & (XS_CTL_POLL|XS_CTL_NOSLEEP))) {
   1058 			printf("ciss driver stuffup in %s:%d: %s()\n",
   1059 			       __FILE__, __LINE__, __func__);
   1060 			xs->error = XS_DRIVER_STUFFUP;
   1061 			scsipi_done(xs);
   1062 			break;
   1063 		}
   1064 
   1065 		break;
   1066 
   1067 	case ADAPTER_REQ_GROW_RESOURCES:
   1068 		/*
   1069 		 * Not supported.
   1070 		 */
   1071 		break;
   1072 
   1073 	case ADAPTER_REQ_SET_XFER_MODE:
   1074 		/*
   1075 		 * We can't change the transfer mode, but at least let
   1076 		 * scsipi know what the adapter has negociated.
   1077 		 */
   1078 		 /* Get xfer mode and return it */
   1079 		break;
   1080 	}
   1081 }
   1082 #endif
   1083 
   1084 static void
   1085 ciss_scsi_cmd(struct scsipi_channel *chan, scsipi_adapter_req_t req,
   1086 	void *arg)
   1087 {
   1088 	struct scsipi_xfer *xs;
   1089 	struct scsipi_xfer_mode *xm;
   1090 	struct ciss_softc *sc = device_private(chan->chan_adapter->adapt_dev);
   1091 	u_int8_t target;
   1092 	struct ciss_ccb *ccb;
   1093 	struct ciss_cmd *cmd;
   1094 
   1095 	CISS_DPRINTF(CISS_D_CMD, ("ciss_scsi_cmd "));
   1096 
   1097 	switch (req)
   1098 	{
   1099 	case ADAPTER_REQ_RUN_XFER:
   1100 		xs = (struct scsipi_xfer *) arg;
   1101 		target = xs->xs_periph->periph_target;
   1102 		CISS_DPRINTF(CISS_D_CMD, ("targ=%d ", target));
   1103 		if (xs->cmdlen > CISS_MAX_CDB) {
   1104 			CISS_DPRINTF(CISS_D_CMD, ("CDB too big %p ", xs));
   1105 			memset(&xs->sense, 0, sizeof(xs->sense));
   1106 			xs->error = XS_SENSE;
   1107 			printf("ciss driver stuffup in %s:%d: %s()\n",
   1108 			       __FILE__, __LINE__, __func__);
   1109 			scsipi_done(xs);
   1110 			break;
   1111 		}
   1112 
   1113 		xs->error = XS_NOERROR;
   1114 
   1115 		/* XXX emulate SYNCHRONIZE_CACHE ??? */
   1116 
   1117 		ccb = ciss_get_ccb(sc);
   1118 		cmd = &ccb->ccb_cmd;
   1119 		ccb->ccb_len = xs->datalen;
   1120 		ccb->ccb_data = xs->data;
   1121 		ccb->ccb_xs = xs;
   1122 		cmd->tgt = CISS_CMD_MODE_LD | target;
   1123 		cmd->tgt2 = 0;
   1124 		cmd->cdblen = xs->cmdlen;
   1125 		cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL;
   1126 		if (xs->xs_control & XS_CTL_DATA_IN)
   1127 			cmd->flags |= CISS_CDB_IN;
   1128 		else if (xs->xs_control & XS_CTL_DATA_OUT)
   1129 			cmd->flags |= CISS_CDB_OUT;
   1130 		cmd->tmo = htole16(xs->timeout < 1000? 1 : xs->timeout / 1000);
   1131 		memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
   1132 		memcpy(&cmd->cdb[0], xs->cmd, CISS_MAX_CDB);
   1133 		CISS_DPRINTF(CISS_D_CMD, ("cmd=%02x %02x %02x %02x %02x %02x ",
   1134 			     cmd->cdb[0], cmd->cdb[1], cmd->cdb[2],
   1135 			     cmd->cdb[3], cmd->cdb[4], cmd->cdb[5]));
   1136 
   1137 		if (ciss_cmd(ccb, BUS_DMA_WAITOK,
   1138 		    xs->xs_control & (XS_CTL_POLL|XS_CTL_NOSLEEP))) {
   1139 			printf("ciss driver stuffup in %s:%d: %s()\n",
   1140 			       __FILE__, __LINE__, __func__);
   1141 			xs->error = XS_DRIVER_STUFFUP;
   1142 			scsipi_done(xs);
   1143 			return;
   1144 		}
   1145 
   1146 		break;
   1147 	case ADAPTER_REQ_GROW_RESOURCES:
   1148 		/*
   1149 		 * Not supported.
   1150 		 */
   1151 		break;
   1152 	case ADAPTER_REQ_SET_XFER_MODE:
   1153 		/*
   1154 		 * We can't change the transfer mode, but at least let
   1155 		 * scsipi know what the adapter has negociated.
   1156 		 */
   1157 		xm = (struct scsipi_xfer_mode *)arg;
   1158 		xm->xm_mode |= PERIPH_CAP_TQING;
   1159 		scsipi_async_event(chan, ASYNC_EVENT_XFER_MODE, xm);
   1160 		break;
   1161 	default:
   1162 		printf("%s: %d %d unsupported\n", __func__, __LINE__, req);
   1163 	}
   1164 }
   1165 
   1166 int
   1167 ciss_intr(void *v)
   1168 {
   1169 	struct ciss_softc *sc = v;
   1170 	struct ciss_ccb *ccb;
   1171 	u_int32_t id;
   1172 	bus_size_t reg;
   1173 	int hit = 0;
   1174 
   1175 	CISS_DPRINTF(CISS_D_INTR, ("intr "));
   1176 
   1177 	if (!(bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_ISR) & sc->iem))
   1178 		return 0;
   1179 
   1180 	if (sc->cfg.methods & CISS_METH_FIFO64)
   1181 		reg = CISS_OUTQ64_HI;
   1182 	else if (sc->cfg.methods & CISS_METH_FIFO64_RRO)
   1183 		reg = CISS_OUTQ64_LO;
   1184 	else
   1185 		reg = CISS_OUTQ;
   1186 	while ((id = bus_space_read_4(sc->sc_iot, sc->sc_ioh, reg)) !=
   1187 	    0xffffffff) {
   1188 		if (reg == CISS_OUTQ64_HI)
   1189 			id = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
   1190 			    CISS_OUTQ64_LO);
   1191 		else if (reg == CISS_OUTQ64_LO)
   1192 			(void)bus_space_read_4(sc->sc_iot, sc->sc_ioh,
   1193 			    CISS_OUTQ64_HI);
   1194 
   1195 		ccb = (struct ciss_ccb *) ((char *)sc->ccbs + (id >> 2) * sc->ccblen);
   1196 		ccb->ccb_cmd.id = htole32(id);
   1197 		ccb->ccb_cmd.id_hi = htole32(0); /* ignore the upper 32bits */
   1198 		if (ccb->ccb_state == CISS_CCB_POLL) {
   1199 			ccb->ccb_state = CISS_CCB_ONQ;
   1200 			mutex_enter(&sc->sc_mutex);
   1201 			cv_broadcast(&sc->sc_condvar);
   1202 			mutex_exit(&sc->sc_mutex);
   1203 		} else
   1204 			ciss_done(ccb);
   1205 
   1206 		hit = 1;
   1207 	}
   1208 
   1209 	CISS_DPRINTF(CISS_D_INTR, ("exit\n"));
   1210 	return hit;
   1211 }
   1212 
   1213 static void
   1214 ciss_heartbeat(void *v)
   1215 {
   1216 	struct ciss_softc *sc = v;
   1217 	u_int32_t hb;
   1218 
   1219 	hb = bus_space_read_4(sc->sc_iot, sc->cfg_ioh,
   1220 	    sc->cfgoff + offsetof(struct ciss_config, heartbeat));
   1221 	if (hb == sc->heartbeat) {
   1222 		sc->fibrillation++;
   1223 		CISS_DPRINTF(CISS_D_ERR, ("%s: fibrillation #%d (value=%d)\n",
   1224 		    device_xname(sc->sc_dev), sc->fibrillation, hb));
   1225 		if (sc->fibrillation >= 11) {
   1226 			/* No heartbeat for 33 seconds */
   1227 			panic("%s: dead", device_xname(sc->sc_dev));	/* XXX reset! */
   1228 		}
   1229 	} else {
   1230 		sc->heartbeat = hb;
   1231 		if (sc->fibrillation) {
   1232 			CISS_DPRINTF(CISS_D_ERR, ("%s: "
   1233 			    "fibrillation ended (value=%d)\n",
   1234 			    device_xname(sc->sc_dev), hb));
   1235 		}
   1236 		sc->fibrillation = 0;
   1237 	}
   1238 
   1239 	callout_schedule(&sc->sc_hb, hz * 3);
   1240 }
   1241 
   1242 static int
   1243 ciss_scsi_ioctl(struct scsipi_channel *chan, u_long cmd,
   1244     void *addr, int flag, struct proc *p)
   1245 {
   1246 #if NBIO > 0
   1247 	return ciss_ioctl(chan->chan_adapter->adapt_dev, cmd, addr);
   1248 #else
   1249 	return ENOTTY;
   1250 #endif
   1251 }
   1252 
   1253 #if NBIO > 0
   1254 const int ciss_level[] = { 0, 4, 1, 5, 51, 7 };
   1255 const int ciss_stat[] = { BIOC_SVONLINE, BIOC_SVOFFLINE, BIOC_SVOFFLINE,
   1256     BIOC_SVDEGRADED, BIOC_SVREBUILD, BIOC_SVREBUILD, BIOC_SVDEGRADED,
   1257     BIOC_SVDEGRADED, BIOC_SVINVALID, BIOC_SVINVALID, BIOC_SVBUILDING,
   1258     BIOC_SVOFFLINE, BIOC_SVBUILDING };
   1259 
   1260 int
   1261 ciss_ioctl(device_t dev, u_long cmd, void *addr)
   1262 {
   1263 	struct ciss_softc	*sc = device_private(dev);
   1264 	struct bioc_inq *bi;
   1265 	struct bioc_disk *bd;
   1266 	struct bioc_blink *bb;
   1267 	struct ciss_ldstat *ldstat;
   1268 	struct ciss_pdid *pdid;
   1269 	struct ciss_blink *blink;
   1270 	struct ciss_ld *ldp;
   1271 	u_int8_t drv;
   1272 	int ld, pd, error = 0;
   1273 
   1274 	switch (cmd) {
   1275 	case BIOCINQ:
   1276 		bi = (struct bioc_inq *)addr;
   1277 		strlcpy(bi->bi_dev, device_xname(sc->sc_dev), sizeof(bi->bi_dev));
   1278 		bi->bi_novol = sc->maxunits;
   1279 		bi->bi_nodisk = sc->sc_lds[0]->ndrives;
   1280 		break;
   1281 
   1282 	case BIOCVOL:
   1283 		error = ciss_ioctl_vol(sc, (struct bioc_vol *)addr);
   1284 		break;
   1285 
   1286 	case BIOCDISK_NOVOL:
   1287 /*
   1288  * XXX since we don't know how to associate physical drives with logical drives
   1289  * yet, BIOCDISK_NOVOL is equivalent to BIOCDISK to the volume that we've
   1290  * associated all physical drives to.
   1291  * Maybe assoicate all physical drives to all logical volumes, but only return
   1292  * physical drives on one logical volume.  Which one?  Either 1st volume that
   1293  * is degraded, rebuilding, or failed?
   1294  */
   1295 		bd = (struct bioc_disk *)addr;
   1296 		bd->bd_volid = 0;
   1297 		bd->bd_disknovol = true;
   1298 		/* FALLTHROUGH */
   1299 	case BIOCDISK:
   1300 		bd = (struct bioc_disk *)addr;
   1301 		if (bd->bd_volid > sc->maxunits) {
   1302 			error = EINVAL;
   1303 			break;
   1304 		}
   1305 		ldp = sc->sc_lds[0];
   1306 		if (!ldp || (pd = bd->bd_diskid) > ldp->ndrives) {
   1307 			error = EINVAL;
   1308 			break;
   1309 		}
   1310 		ldstat = sc->scratch;
   1311 		if ((error = ciss_ldstat(sc, bd->bd_volid, ldstat))) {
   1312 			break;
   1313 		}
   1314 		bd->bd_status = -1;
   1315 		if (ldstat->stat == CISS_LD_REBLD &&
   1316 		    ldstat->bigrebuild == ldp->tgts[pd])
   1317 			bd->bd_status = BIOC_SDREBUILD;
   1318 		if (ciss_bitset(ldp->tgts[pd] & (~CISS_BIGBIT),
   1319 		    ldstat->bigfailed)) {
   1320 			bd->bd_status = BIOC_SDFAILED;
   1321 			bd->bd_size = 0;
   1322 			bd->bd_channel = (ldp->tgts[pd] & (~CISS_BIGBIT)) /
   1323 			    sc->ndrives;
   1324 			bd->bd_target = ldp->tgts[pd] % sc->ndrives;
   1325 			bd->bd_lun = 0;
   1326 			bd->bd_vendor[0] = '\0';
   1327 			bd->bd_serial[0] = '\0';
   1328 			bd->bd_procdev[0] = '\0';
   1329 		} else {
   1330 			pdid = sc->scratch;
   1331 			if ((error = ciss_pdid(sc, ldp->tgts[pd], pdid,
   1332 			    XS_CTL_POLL))) {
   1333 				bd->bd_status = BIOC_SDFAILED;
   1334 				bd->bd_size = 0;
   1335 				bd->bd_channel = (ldp->tgts[pd] & (~CISS_BIGBIT)) /
   1336 				    sc->ndrives;
   1337 				bd->bd_target = ldp->tgts[pd] % sc->ndrives;
   1338 				bd->bd_lun = 0;
   1339 				bd->bd_vendor[0] = '\0';
   1340 				bd->bd_serial[0] = '\0';
   1341 				bd->bd_procdev[0] = '\0';
   1342 				error = 0;
   1343 				break;
   1344 			}
   1345 			if (bd->bd_status < 0) {
   1346 				if (pdid->config & CISS_PD_SPARE)
   1347 					bd->bd_status = BIOC_SDHOTSPARE;
   1348 				else if (pdid->present & CISS_PD_PRESENT)
   1349 					bd->bd_status = BIOC_SDONLINE;
   1350 				else
   1351 					bd->bd_status = BIOC_SDINVALID;
   1352 			}
   1353 			bd->bd_size = (u_int64_t)le32toh(pdid->nblocks) *
   1354 			    le16toh(pdid->blksz);
   1355 			bd->bd_channel = pdid->bus;
   1356 			bd->bd_target = pdid->target;
   1357 			bd->bd_lun = 0;
   1358 			strlcpy(bd->bd_vendor, pdid->model,
   1359 			    sizeof(bd->bd_vendor));
   1360 			strlcpy(bd->bd_serial, pdid->serial,
   1361 			    sizeof(bd->bd_serial));
   1362 			bd->bd_procdev[0] = '\0';
   1363 		}
   1364 		break;
   1365 
   1366 	case BIOCBLINK:
   1367 		bb = (struct bioc_blink *)addr;
   1368 		blink = sc->scratch;
   1369 		error = EINVAL;
   1370 		/* XXX workaround completely dumb scsi addressing */
   1371 		for (ld = 0; ld < sc->maxunits; ld++) {
   1372 			ldp = sc->sc_lds[ld];
   1373 			if (!ldp)
   1374 				continue;
   1375 			if (sc->ndrives == 256)
   1376 				drv = bb->bb_target;
   1377 			else
   1378 				drv = CISS_BIGBIT +
   1379 				    bb->bb_channel * sc->ndrives +
   1380 				    bb->bb_target;
   1381 			for (pd = 0; pd < ldp->ndrives; pd++)
   1382 				if (ldp->tgts[pd] == drv)
   1383 					error = ciss_blink(sc, ld, pd,
   1384 					    bb->bb_status, blink);
   1385 		}
   1386 		break;
   1387 
   1388 	case BIOCALARM:
   1389 	case BIOCSETSTATE:
   1390 	default:
   1391 		error = EINVAL;
   1392 	}
   1393 
   1394 	return (error);
   1395 }
   1396 
   1397 int
   1398 ciss_ioctl_vol(struct ciss_softc *sc, struct bioc_vol *bv)
   1399 {
   1400 	struct ciss_ldid *ldid;
   1401 	struct ciss_ld *ldp;
   1402 	struct ciss_ldstat *ldstat;
   1403 	struct ciss_pdid *pdid;
   1404 	int error = 0;
   1405 	u_int blks;
   1406 
   1407 	if (bv->bv_volid > sc->maxunits) {
   1408 		return EINVAL;
   1409 	}
   1410 	ldp = sc->sc_lds[bv->bv_volid];
   1411 	ldid = sc->scratch;
   1412 	if ((error = ciss_ldid(sc, bv->bv_volid, ldid))) {
   1413 		return error;
   1414 	}
   1415 	bv->bv_status = BIOC_SVINVALID;
   1416 	blks = (u_int)le16toh(ldid->nblocks[1]) << 16 |
   1417 	    le16toh(ldid->nblocks[0]);
   1418 	bv->bv_size = blks * (u_quad_t)le16toh(ldid->blksize);
   1419 	bv->bv_level = ciss_level[ldid->type];
   1420 /*
   1421  * XXX Should only return bv_nodisk for logigal volume that we've associated
   1422  * the physical drives to:  either the 1st degraded, rebuilding, or failed
   1423  * volume else volume 0?
   1424  */
   1425 	if (ldp) {
   1426 		bv->bv_nodisk = ldp->ndrives;
   1427 		strlcpy(bv->bv_dev, ldp->xname, sizeof(bv->bv_dev));
   1428 	}
   1429 	strlcpy(bv->bv_vendor, "CISS", sizeof(bv->bv_vendor));
   1430 	ldstat = sc->scratch;
   1431 	memset(ldstat, 0, sizeof(*ldstat));
   1432 	if ((error = ciss_ldstat(sc, bv->bv_volid, ldstat))) {
   1433 		return error;
   1434 	}
   1435 	bv->bv_percent = -1;
   1436 	bv->bv_seconds = 0;
   1437 	if (ldstat->stat < sizeof(ciss_stat)/sizeof(ciss_stat[0]))
   1438 		bv->bv_status = ciss_stat[ldstat->stat];
   1439 	if (bv->bv_status == BIOC_SVREBUILD ||
   1440 	    bv->bv_status == BIOC_SVBUILDING) {
   1441 	 	u_int64_t prog;
   1442 
   1443 		ldp = sc->sc_lds[0];
   1444 		if (ldp) {
   1445 			bv->bv_nodisk = ldp->ndrives;
   1446 			strlcpy(bv->bv_dev, ldp->xname, sizeof(bv->bv_dev));
   1447 		}
   1448 /*
   1449  * XXX ldstat->prog is blocks remaining on physical drive being rebuilt
   1450  * blks is only correct for a RAID1 set;  RAID5 needs to determine the
   1451  * size of the physical device - which we don't yet know.
   1452  * ldstat->bigrebuild has physical device target, so could be used with
   1453  * pdid to get size.   Another way is to save pd information in sc so it's
   1454  * easy to reference.
   1455  */
   1456 		prog = (u_int64_t)((ldstat->prog[3] << 24) |
   1457 		    (ldstat->prog[2] << 16) | (ldstat->prog[1] << 8) |
   1458 		    ldstat->prog[0]);
   1459 		pdid = sc->scratch;
   1460 		if (!ciss_pdid(sc, ldstat->bigrebuild, pdid, XS_CTL_POLL)) {
   1461 			blks = le32toh(pdid->nblocks);
   1462 			bv->bv_percent = (blks - prog) * 1000ULL / blks;
   1463 		 }
   1464 	}
   1465 	return 0;
   1466 }
   1467 
   1468 int
   1469 ciss_blink(struct ciss_softc *sc, int ld, int pd, int stat,
   1470     struct ciss_blink *blink)
   1471 {
   1472 	struct ciss_ccb *ccb;
   1473 	struct ciss_cmd *cmd;
   1474 	struct ciss_ld *ldp;
   1475 
   1476 	if (ld > sc->maxunits)
   1477 		return EINVAL;
   1478 
   1479 	ldp = sc->sc_lds[ld];
   1480 	if (!ldp || pd > ldp->ndrives)
   1481 		return EINVAL;
   1482 
   1483 	ldp->bling.pdtab[ldp->tgts[pd]] = stat == BIOC_SBUNBLINK? 0 :
   1484 	    CISS_BLINK_ALL;
   1485 	memcpy(blink, &ldp->bling, sizeof(*blink));
   1486 
   1487 	ccb = ciss_get_ccb(sc);
   1488 	if (ccb == NULL)
   1489 		return ENOMEM;
   1490 	ccb->ccb_len = sizeof(*blink);
   1491 	ccb->ccb_data = blink;
   1492 	ccb->ccb_xs = NULL;
   1493 	cmd = &ccb->ccb_cmd;
   1494 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
   1495 	cmd->tgt2 = 0;
   1496 	cmd->cdblen = 10;
   1497 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_OUT;
   1498 	cmd->tmo = htole16(0);
   1499 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
   1500 	cmd->cdb[0] = CISS_CMD_CTRL_SET;
   1501 	cmd->cdb[6] = CISS_CMS_CTRL_PDBLINK;
   1502 	cmd->cdb[7] = sizeof(*blink) >> 8;	/* biiiig endian */
   1503 	cmd->cdb[8] = sizeof(*blink) & 0xff;
   1504 
   1505 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL);
   1506 }
   1507 
   1508 int
   1509 ciss_create_sensors(struct ciss_softc *sc)
   1510 {
   1511 	int			i;
   1512 	int nsensors = sc->maxunits;
   1513 
   1514 	if (nsensors == 0) {
   1515 		return 0;
   1516 	}
   1517 
   1518 	sc->sc_sme = sysmon_envsys_create();
   1519 	sc->sc_sensor = malloc(sizeof(envsys_data_t) * nsensors,
   1520 		M_DEVBUF, M_NOWAIT | M_ZERO);
   1521 	if (sc->sc_sensor == NULL) {
   1522 		aprint_error_dev(sc->sc_dev, "can't allocate envsys_data");
   1523 		return(ENOMEM);
   1524 	}
   1525 
   1526 	for (i = 0; i < nsensors; i++) {
   1527 		sc->sc_sensor[i].units = ENVSYS_DRIVE;
   1528 		sc->sc_sensor[i].state = ENVSYS_SINVALID;
   1529 		sc->sc_sensor[i].value_cur = ENVSYS_DRIVE_EMPTY;
   1530 		/* Enable monitoring for drive state changes */
   1531 		sc->sc_sensor[i].flags |= ENVSYS_FMONSTCHANGED;
   1532 		/* logical drives */
   1533 		snprintf(sc->sc_sensor[i].desc,
   1534 		    sizeof(sc->sc_sensor[i].desc), "%s:%d",
   1535 		    device_xname(sc->sc_dev), i);
   1536 		if (sysmon_envsys_sensor_attach(sc->sc_sme,
   1537 		    &sc->sc_sensor[i]))
   1538 			goto out;
   1539 	}
   1540 
   1541 	sc->sc_sme->sme_name = device_xname(sc->sc_dev);
   1542 	sc->sc_sme->sme_cookie = sc;
   1543 	sc->sc_sme->sme_refresh = ciss_sensor_refresh;
   1544 	if (sysmon_envsys_register(sc->sc_sme)) {
   1545 		printf("%s: unable to register with sysmon\n",
   1546 		    device_xname(sc->sc_dev));
   1547 		return(1);
   1548 	}
   1549 	return (0);
   1550 
   1551 out:
   1552 	free(sc->sc_sensor, M_DEVBUF);
   1553 	sysmon_envsys_destroy(sc->sc_sme);
   1554 	return EINVAL;
   1555 }
   1556 
   1557 void
   1558 ciss_sensor_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
   1559 {
   1560 	struct ciss_softc	*sc = sme->sme_cookie;
   1561 	struct bioc_vol		bv;
   1562 
   1563 	if (edata->sensor >= sc->maxunits)
   1564 		return;
   1565 
   1566 	memset(&bv, 0, sizeof(bv));
   1567 	bv.bv_volid = edata->sensor;
   1568 	if (ciss_ioctl_vol(sc, &bv))
   1569 		bv.bv_status = BIOC_SVINVALID;
   1570 
   1571 	bio_vol_to_envsys(edata, &bv);
   1572 }
   1573 #endif /* NBIO > 0 */
   1574