Home | History | Annotate | Line # | Download | only in ic
ciss.c revision 1.30
      1 /*	$NetBSD: ciss.c,v 1.30 2013/10/12 16:52:21 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.30 2013/10/12 16:52:21 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 /*
    441  * submit a command and optionally wait for completition.
    442  * wait arg abuses XS_CTL_POLL|XS_CTL_NOSLEEP flags to request
    443  * to wait (XS_CTL_POLL) and to allow tsleep() (!XS_CTL_NOSLEEP)
    444  * instead of busy loop waiting
    445  */
    446 static int
    447 ciss_cmd(struct ciss_ccb *ccb, int flags, int wait)
    448 {
    449 	struct ciss_softc *sc = ccb->ccb_sc;
    450 	struct ciss_cmd *cmd = &ccb->ccb_cmd;
    451 	struct ciss_ccb *ccb1;
    452 	bus_dmamap_t dmap = ccb->ccb_dmamap;
    453 	u_int32_t id;
    454 	u_int64_t addr;
    455 	int i, tohz, error = 0;
    456 
    457 	if (ccb->ccb_state != CISS_CCB_READY) {
    458 		printf("%s: ccb %d not ready state=0x%x\n", device_xname(sc->sc_dev),
    459 		    cmd->id, ccb->ccb_state);
    460 		return (EINVAL);
    461 	}
    462 
    463 	if (ccb->ccb_data) {
    464 		bus_dma_segment_t *sgd;
    465 
    466 		if ((error = bus_dmamap_load(sc->sc_dmat, dmap, ccb->ccb_data,
    467 		    ccb->ccb_len, NULL, flags))) {
    468 			if (error == EFBIG)
    469 				printf("more than %d dma segs\n", sc->maxsg);
    470 			else
    471 				printf("error %d loading dma map\n", error);
    472 			ciss_put_ccb(ccb);
    473 			return (error);
    474 		}
    475 		cmd->sgin = dmap->dm_nsegs;
    476 
    477 		sgd = dmap->dm_segs;
    478 		CISS_DPRINTF(CISS_D_DMA, ("data=%p/%zu<%#" PRIxPADDR "/%zu",
    479 		    ccb->ccb_data, ccb->ccb_len, sgd->ds_addr, sgd->ds_len));
    480 
    481 		for (i = 0; i < dmap->dm_nsegs; sgd++, i++) {
    482 			cmd->sgl[i].addr_lo = htole32(sgd->ds_addr);
    483 			cmd->sgl[i].addr_hi =
    484 			    htole32((u_int64_t)sgd->ds_addr >> 32);
    485 			cmd->sgl[i].len = htole32(sgd->ds_len);
    486 			cmd->sgl[i].flags = htole32(0);
    487 			if (i) {
    488 				CISS_DPRINTF(CISS_D_DMA,
    489 				    (",%#" PRIxPADDR "/%zu", sgd->ds_addr,
    490 				    sgd->ds_len));
    491 			}
    492 		}
    493 
    494 		CISS_DPRINTF(CISS_D_DMA, ("> "));
    495 
    496 		bus_dmamap_sync(sc->sc_dmat, dmap, 0, dmap->dm_mapsize,
    497 		    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
    498 	} else
    499 		cmd->sgin = 0;
    500 	cmd->sglen = htole16((u_int16_t)cmd->sgin);
    501 	memset(&ccb->ccb_err, 0, sizeof(ccb->ccb_err));
    502 
    503 	bus_dmamap_sync(sc->sc_dmat, sc->cmdmap, 0, sc->cmdmap->dm_mapsize,
    504 	    BUS_DMASYNC_PREWRITE);
    505 
    506 	if ((wait & (XS_CTL_POLL|XS_CTL_NOSLEEP)) == (XS_CTL_POLL|XS_CTL_NOSLEEP))
    507 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_IMR,
    508 		    bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_IMR) | sc->iem);
    509 
    510 	mutex_enter(&sc->sc_mutex);
    511 	TAILQ_INSERT_TAIL(&sc->sc_ccbq, ccb, ccb_link);
    512 	mutex_exit(&sc->sc_mutex);
    513 	ccb->ccb_state = CISS_CCB_ONQ;
    514 	CISS_DPRINTF(CISS_D_CMD, ("submit=0x%x ", cmd->id));
    515 	if (sc->cfg.methods & (CISS_METH_FIFO64|CISS_METH_FIFO64_RRO)) {
    516 		/*
    517 		 * Write the upper 32bits immediately before the lower
    518 		 * 32bits and set bit 63 to indicate 64bit FIFO mode.
    519 		 */
    520 		addr = (u_int64_t)ccb->ccb_cmdpa;
    521 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_INQ64_HI,
    522 		    (addr >> 32) | 0x80000000);
    523 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_INQ64_LO,
    524 		    addr & 0x00000000ffffffffULL);
    525 	} else
    526 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_INQ,
    527 		    ccb->ccb_cmdpa);
    528 
    529 	if (wait & XS_CTL_POLL) {
    530 		int etick;
    531 		CISS_DPRINTF(CISS_D_CMD, ("waiting "));
    532 
    533 		i = ccb->ccb_xs? ccb->ccb_xs->timeout : 60000;
    534 		tohz = (i / 1000) * hz + (i % 1000) * (hz / 1000);
    535 		if (tohz == 0)
    536 			tohz = 1;
    537 		for (i *= 100, etick = tick + tohz; i--; ) {
    538 			if (!(wait & XS_CTL_NOSLEEP)) {
    539 				ccb->ccb_state = CISS_CCB_POLL;
    540 				CISS_DPRINTF(CISS_D_CMD, ("cv_timedwait(%d) ", tohz));
    541 				mutex_enter(&sc->sc_mutex);
    542 				if (cv_timedwait(&sc->sc_condvar,
    543 				    &sc->sc_mutex, tohz) == EWOULDBLOCK) {
    544 					mutex_exit(&sc->sc_mutex);
    545 					break;
    546 				}
    547 				mutex_exit(&sc->sc_mutex);
    548 				if (ccb->ccb_state != CISS_CCB_ONQ) {
    549 					tohz = etick - tick;
    550 					if (tohz <= 0)
    551 						break;
    552 					CISS_DPRINTF(CISS_D_CMD, ("T"));
    553 					continue;
    554 				}
    555 				ccb1 = ccb;
    556 			} else {
    557 				DELAY(10);
    558 
    559 				if (!(bus_space_read_4(sc->sc_iot, sc->sc_ioh,
    560 				    CISS_ISR) & sc->iem)) {
    561 					CISS_DPRINTF(CISS_D_CMD, ("N"));
    562 					continue;
    563 				}
    564 
    565 				if (sc->cfg.methods & CISS_METH_FIFO64) {
    566 					if (bus_space_read_4(sc->sc_iot,
    567 					    sc->sc_ioh,
    568 					    CISS_OUTQ64_HI) == 0xffffffff) {
    569 						CISS_DPRINTF(CISS_D_CMD, ("Q"));
    570 						continue;
    571 					}
    572 					id = bus_space_read_4(sc->sc_iot,
    573 					    sc->sc_ioh, CISS_OUTQ64_LO);
    574 				} else if (sc->cfg.methods &
    575 				    CISS_METH_FIFO64_RRO) {
    576 					id = bus_space_read_4(sc->sc_iot,
    577 					    sc->sc_ioh, CISS_OUTQ64_LO);
    578 					if (id == 0xffffffff) {
    579 						CISS_DPRINTF(CISS_D_CMD, ("Q"));
    580 						continue;
    581 					}
    582 					(void)bus_space_read_4(sc->sc_iot,
    583 					    sc->sc_ioh, CISS_OUTQ64_HI);
    584 				} else {
    585 					id = bus_space_read_4(sc->sc_iot,
    586 					    sc->sc_ioh, CISS_OUTQ);
    587 					if (id == 0xffffffff) {
    588 						CISS_DPRINTF(CISS_D_CMD, ("Q"));
    589 						continue;
    590 					}
    591 				}
    592 
    593 				CISS_DPRINTF(CISS_D_CMD, ("got=0x%x ", id));
    594 				ccb1 = (struct ciss_ccb *)
    595 					((char *)sc->ccbs + (id >> 2) * sc->ccblen);
    596 				ccb1->ccb_cmd.id = htole32(id);
    597 				ccb1->ccb_cmd.id_hi = htole32(0);
    598 			}
    599 
    600 			error = ciss_done(ccb1);
    601 			if (ccb1 == ccb)
    602 				return error;
    603 		}
    604 
    605 		/* if never got a chance to be done above... */
    606 		if (ccb->ccb_state != CISS_CCB_FREE) {
    607 			ccb->ccb_err.cmd_stat = CISS_ERR_TMO;
    608 			error = ciss_done(ccb);
    609 		}
    610 
    611 		CISS_DPRINTF(CISS_D_CMD, ("done %d:%d",
    612 		    ccb->ccb_err.cmd_stat, ccb->ccb_err.scsi_stat));
    613 	}
    614 
    615 	if ((wait & (XS_CTL_POLL|XS_CTL_NOSLEEP)) == (XS_CTL_POLL|XS_CTL_NOSLEEP))
    616 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, CISS_IMR,
    617 		    bus_space_read_4(sc->sc_iot, sc->sc_ioh, CISS_IMR) & ~sc->iem);
    618 
    619 	return (error);
    620 }
    621 
    622 static int
    623 ciss_done(struct ciss_ccb *ccb)
    624 {
    625 	struct ciss_softc *sc = ccb->ccb_sc;
    626 	struct scsipi_xfer *xs = ccb->ccb_xs;
    627 	struct ciss_cmd *cmd;
    628 	int error = 0;
    629 
    630 	CISS_DPRINTF(CISS_D_CMD, ("ciss_done(%p) ", ccb));
    631 
    632 	if (ccb->ccb_state != CISS_CCB_ONQ) {
    633 		printf("%s: unqueued ccb %p ready, state=0x%x\n",
    634 		    device_xname(sc->sc_dev), ccb, ccb->ccb_state);
    635 		return 1;
    636 	}
    637 
    638 	ccb->ccb_state = CISS_CCB_READY;
    639 	mutex_enter(&sc->sc_mutex);
    640 	TAILQ_REMOVE(&sc->sc_ccbq, ccb, ccb_link);
    641 	mutex_exit(&sc->sc_mutex);
    642 
    643 	if (ccb->ccb_cmd.id & CISS_CMD_ERR)
    644 		error = ciss_error(ccb);
    645 
    646 	cmd = &ccb->ccb_cmd;
    647 	if (ccb->ccb_data) {
    648 		bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap, 0,
    649 		    ccb->ccb_dmamap->dm_mapsize, (cmd->flags & CISS_CDB_IN) ?
    650 		    BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
    651 		bus_dmamap_unload(sc->sc_dmat, ccb->ccb_dmamap);
    652 		ccb->ccb_xs = NULL;
    653 		ccb->ccb_data = NULL;
    654 	}
    655 
    656 	ciss_put_ccb(ccb);
    657 
    658 	if (xs) {
    659 		xs->resid = 0;
    660 		CISS_DPRINTF(CISS_D_CMD, ("scsipi_done(%p) ", xs));
    661 		if (xs->cmd->opcode == INQUIRY) {
    662 			struct scsipi_inquiry_data *inq;
    663 			inq = (struct scsipi_inquiry_data *)xs->data;
    664 			if ((inq->version & SID_ANSII) == 0 &&
    665 			    (inq->flags3 & SID_CmdQue) != 0) {
    666 				inq->version |= 2;
    667 			}
    668 		}
    669 		scsipi_done(xs);
    670 	}
    671 
    672 	return error;
    673 }
    674 
    675 static int
    676 ciss_error(struct ciss_ccb *ccb)
    677 {
    678 	struct ciss_softc *sc = ccb->ccb_sc;
    679 	struct ciss_error *err = &ccb->ccb_err;
    680 	struct scsipi_xfer *xs = ccb->ccb_xs;
    681 	int rv;
    682 
    683 	switch ((rv = le16toh(err->cmd_stat))) {
    684 	case CISS_ERR_OK:
    685 		rv = 0;
    686 		break;
    687 
    688 	case CISS_ERR_INVCMD:
    689 		if (xs == NULL ||
    690 		    xs->cmd->opcode != SCSI_SYNCHRONIZE_CACHE_10)
    691 			printf("%s: invalid cmd 0x%x: 0x%x is not valid @ 0x%x[%d]\n",
    692 			    device_xname(sc->sc_dev), ccb->ccb_cmd.id,
    693 			    err->err_info, err->err_type[3], err->err_type[2]);
    694 		if (xs) {
    695 			memset(&xs->sense, 0, sizeof(xs->sense));
    696 			xs->sense.scsi_sense.response_code =
    697 				SSD_RCODE_CURRENT | SSD_RCODE_VALID;
    698 			xs->sense.scsi_sense.flags = SKEY_ILLEGAL_REQUEST;
    699 			xs->sense.scsi_sense.asc = 0x24; /* ill field */
    700 			xs->sense.scsi_sense.ascq = 0x0;
    701 			xs->error = XS_SENSE;
    702 		}
    703 		rv = EIO;
    704 		break;
    705 
    706 	case CISS_ERR_TMO:
    707 		xs->error = XS_TIMEOUT;
    708 		rv = ETIMEDOUT;
    709 		break;
    710 
    711 	case CISS_ERR_UNRUN:
    712 		/* Underrun */
    713 		xs->resid = le32toh(err->resid);
    714 		CISS_DPRINTF(CISS_D_CMD, (" underrun resid=0x%x ",
    715 					  xs->resid));
    716 		rv = EIO;
    717 		break;
    718 	default:
    719 		if (xs) {
    720 			CISS_DPRINTF(CISS_D_CMD, ("scsi_stat=%x ", err->scsi_stat));
    721 			switch (err->scsi_stat) {
    722 			case SCSI_CHECK:
    723 				xs->error = XS_SENSE;
    724 				memcpy(&xs->sense, &err->sense[0],
    725 				    sizeof(xs->sense));
    726 				CISS_DPRINTF(CISS_D_CMD, (" sense=%02x %02x %02x %02x ",
    727 					     err->sense[0], err->sense[1], err->sense[2], err->sense[3]));
    728 				rv = EIO;
    729 				break;
    730 
    731 			case XS_BUSY:
    732 				xs->error = XS_BUSY;
    733 				rv = EBUSY;
    734 				break;
    735 
    736 			default:
    737 				CISS_DPRINTF(CISS_D_ERR, ("%s: "
    738 				    "cmd_stat=%x scsi_stat=0x%x resid=0x%x\n",
    739 				    device_xname(sc->sc_dev), rv, err->scsi_stat,
    740 				    le32toh(err->resid)));
    741 				printf("ciss driver stuffup in %s:%d: %s()\n",
    742 				       __FILE__, __LINE__, __func__);
    743 				xs->error = XS_DRIVER_STUFFUP;
    744 				rv = EIO;
    745 				break;
    746 			}
    747 			xs->resid = le32toh(err->resid);
    748 		} else
    749 			rv = EIO;
    750 	}
    751 	ccb->ccb_cmd.id &= htole32(~3);
    752 
    753 	return rv;
    754 }
    755 
    756 static int
    757 ciss_inq(struct ciss_softc *sc, struct ciss_inquiry *inq)
    758 {
    759 	struct ciss_ccb *ccb;
    760 	struct ciss_cmd *cmd;
    761 
    762 	ccb = ciss_get_ccb(sc);
    763 	ccb->ccb_len = sizeof(*inq);
    764 	ccb->ccb_data = inq;
    765 	ccb->ccb_xs = NULL;
    766 	cmd = &ccb->ccb_cmd;
    767 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
    768 	cmd->tgt2 = 0;
    769 	cmd->cdblen = 10;
    770 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    771 	cmd->tmo = htole16(0);
    772 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    773 	cmd->cdb[0] = CISS_CMD_CTRL_GET;
    774 	cmd->cdb[6] = CISS_CMS_CTRL_CTRL;
    775 	cmd->cdb[7] = sizeof(*inq) >> 8;	/* biiiig endian */
    776 	cmd->cdb[8] = sizeof(*inq) & 0xff;
    777 
    778 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL|XS_CTL_NOSLEEP);
    779 }
    780 
    781 static int
    782 ciss_ldmap(struct ciss_softc *sc)
    783 {
    784 	struct ciss_ccb *ccb;
    785 	struct ciss_cmd *cmd;
    786 	struct ciss_ldmap *lmap;
    787 	int total, rv;
    788 
    789 	mutex_enter(&sc->sc_mutex_scratch);
    790 	lmap = sc->scratch;
    791 	lmap->size = htobe32(sc->maxunits * sizeof(lmap->map));
    792 	total = sizeof(*lmap) + (sc->maxunits - 1) * sizeof(lmap->map);
    793 
    794 	ccb = ciss_get_ccb(sc);
    795 	ccb->ccb_len = total;
    796 	ccb->ccb_data = lmap;
    797 	ccb->ccb_xs = NULL;
    798 	cmd = &ccb->ccb_cmd;
    799 	cmd->tgt = CISS_CMD_MODE_PERIPH;
    800 	cmd->tgt2 = 0;
    801 	cmd->cdblen = 12;
    802 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    803 	cmd->tmo = htole16(30);
    804 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    805 	cmd->cdb[0] = CISS_CMD_LDMAP;
    806 	cmd->cdb[8] = total >> 8;	/* biiiig endian */
    807 	cmd->cdb[9] = total & 0xff;
    808 
    809 	rv = ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL|XS_CTL_NOSLEEP);
    810 
    811 	if (rv) {
    812 		mutex_exit(&sc->sc_mutex_scratch);
    813 		return rv;
    814 	}
    815 
    816 	CISS_DPRINTF(CISS_D_MISC, ("lmap %x:%x\n",
    817 	    lmap->map[0].tgt, lmap->map[0].tgt2));
    818 
    819 	mutex_exit(&sc->sc_mutex_scratch);
    820 	return 0;
    821 }
    822 
    823 static int
    824 ciss_sync(struct ciss_softc *sc)
    825 {
    826 	struct ciss_ccb *ccb;
    827 	struct ciss_cmd *cmd;
    828 	struct ciss_flush *flush;
    829 	int rv;
    830 
    831 	mutex_enter(&sc->sc_mutex_scratch);
    832 	flush = sc->scratch;
    833 	memset(flush, 0, sizeof(*flush));
    834 	flush->flush = sc->sc_flush;
    835 
    836 	ccb = ciss_get_ccb(sc);
    837 	ccb->ccb_len = sizeof(*flush);
    838 	ccb->ccb_data = flush;
    839 	ccb->ccb_xs = NULL;
    840 	cmd = &ccb->ccb_cmd;
    841 	cmd->tgt = CISS_CMD_MODE_PERIPH;
    842 	cmd->tgt2 = 0;
    843 	cmd->cdblen = 10;
    844 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_OUT;
    845 	cmd->tmo = 0;
    846 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    847 	cmd->cdb[0] = CISS_CMD_CTRL_SET;
    848 	cmd->cdb[6] = CISS_CMS_CTRL_FLUSH;
    849 	cmd->cdb[7] = sizeof(*flush) >> 8;	/* biiiig endian */
    850 	cmd->cdb[8] = sizeof(*flush) & 0xff;
    851 
    852 	rv = ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL|XS_CTL_NOSLEEP);
    853 	mutex_exit(&sc->sc_mutex_scratch);
    854 
    855 	return rv;
    856 }
    857 
    858 int
    859 ciss_ldid(struct ciss_softc *sc, int target, struct ciss_ldid *id)
    860 {
    861 	struct ciss_ccb *ccb;
    862 	struct ciss_cmd *cmd;
    863 
    864 	ccb = ciss_get_ccb(sc);
    865 	if (ccb == NULL)
    866 		return ENOMEM;
    867 	ccb->ccb_len = sizeof(*id);
    868 	ccb->ccb_data = id;
    869 	ccb->ccb_xs = NULL;
    870 	cmd = &ccb->ccb_cmd;
    871 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
    872 	cmd->tgt2 = 0;
    873 	cmd->cdblen = 10;
    874 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    875 	cmd->tmo = htole16(0);
    876 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    877 	cmd->cdb[0] = CISS_CMD_CTRL_GET;
    878 	cmd->cdb[1] = target;
    879 	cmd->cdb[6] = CISS_CMS_CTRL_LDIDEXT;
    880 	cmd->cdb[7] = sizeof(*id) >> 8;	/* biiiig endian */
    881 	cmd->cdb[8] = sizeof(*id) & 0xff;
    882 
    883 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL | sc->sc_waitflag);
    884 }
    885 
    886 int
    887 ciss_ldstat(struct ciss_softc *sc, int target, struct ciss_ldstat *stat)
    888 {
    889 	struct ciss_ccb *ccb;
    890 	struct ciss_cmd *cmd;
    891 
    892 	ccb = ciss_get_ccb(sc);
    893 	if (ccb == NULL)
    894 		return ENOMEM;
    895 	ccb->ccb_len = sizeof(*stat);
    896 	ccb->ccb_data = stat;
    897 	ccb->ccb_xs = NULL;
    898 	cmd = &ccb->ccb_cmd;
    899 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
    900 	cmd->tgt2 = 0;
    901 	cmd->cdblen = 10;
    902 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    903 	cmd->tmo = htole16(0);
    904 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    905 	cmd->cdb[0] = CISS_CMD_CTRL_GET;
    906 	cmd->cdb[1] = target;
    907 	cmd->cdb[6] = CISS_CMS_CTRL_LDSTAT;
    908 	cmd->cdb[7] = sizeof(*stat) >> 8;	/* biiiig endian */
    909 	cmd->cdb[8] = sizeof(*stat) & 0xff;
    910 
    911 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL | sc->sc_waitflag);
    912 }
    913 
    914 int
    915 ciss_pdid(struct ciss_softc *sc, u_int8_t drv, struct ciss_pdid *id, int wait)
    916 {
    917 	struct ciss_ccb *ccb;
    918 	struct ciss_cmd *cmd;
    919 
    920 	ccb = ciss_get_ccb(sc);
    921 	if (ccb == NULL)
    922 		return ENOMEM;
    923 	ccb->ccb_len = sizeof(*id);
    924 	ccb->ccb_data = id;
    925 	ccb->ccb_xs = NULL;
    926 	cmd = &ccb->ccb_cmd;
    927 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
    928 	cmd->tgt2 = 0;
    929 	cmd->cdblen = 10;
    930 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_IN;
    931 	cmd->tmo = htole16(0);
    932 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
    933 	cmd->cdb[0] = CISS_CMD_CTRL_GET;
    934 	cmd->cdb[2] = drv;
    935 	cmd->cdb[6] = CISS_CMS_CTRL_PDID;
    936 	cmd->cdb[7] = sizeof(*id) >> 8;	/* biiiig endian */
    937 	cmd->cdb[8] = sizeof(*id) & 0xff;
    938 
    939 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, wait);
    940 }
    941 
    942 
    943 struct ciss_ld *
    944 ciss_pdscan(struct ciss_softc *sc, int ld)
    945 {
    946 	struct ciss_pdid *pdid;
    947 	struct ciss_ld *ldp;
    948 	u_int8_t drv, buf[128];
    949 	int i, j, k = 0;
    950 
    951 	mutex_enter(&sc->sc_mutex_scratch);
    952 	pdid = sc->scratch;
    953 	if (sc->ndrives == 256) {
    954 		for (i = 0; i < CISS_BIGBIT; i++)
    955 			if (!ciss_pdid(sc, i, pdid,
    956 					XS_CTL_POLL|XS_CTL_NOSLEEP) &&
    957 			    (pdid->present & CISS_PD_PRESENT))
    958 				buf[k++] = i;
    959 	} else
    960 		for (i = 0; i < sc->nbus; i++)
    961 			for (j = 0; j < sc->ndrives; j++) {
    962 				drv = CISS_BIGBIT + i * sc->ndrives + j;
    963 				if (!ciss_pdid(sc, drv, pdid,
    964 						XS_CTL_POLL|XS_CTL_NOSLEEP))
    965 					buf[k++] = drv;
    966 			}
    967 	mutex_exit(&sc->sc_mutex_scratch);
    968 
    969 	if (!k)
    970 		return NULL;
    971 
    972 	ldp = malloc(sizeof(*ldp) + (k-1), M_DEVBUF, M_NOWAIT);
    973 	if (!ldp)
    974 		return NULL;
    975 
    976 	memset(&ldp->bling, 0, sizeof(ldp->bling));
    977 	ldp->ndrives = k;
    978 	ldp->xname[0] = 0;
    979 	memcpy(ldp->tgts, buf, k);
    980 	return ldp;
    981 }
    982 
    983 #if 0
    984 static void
    985 ciss_scsi_raw_cmd(struct scsipi_channel *chan, scsipi_adapter_req_t req,
    986 	void *arg)				/* TODO */
    987 {
    988 	struct scsipi_xfer *xs = (struct scsipi_xfer *) arg;
    989 	struct ciss_rawsoftc *rsc =
    990 		(struct ciss_rawsoftc *) chan->chan_adapter->adapt_dev;
    991 	struct ciss_softc *sc = rsc->sc_softc;
    992 	struct ciss_ccb *ccb;
    993 	struct ciss_cmd *cmd;
    994 	int error;
    995 
    996 	CISS_DPRINTF(CISS_D_CMD, ("ciss_scsi_raw_cmd "));
    997 
    998 	switch (req)
    999 	{
   1000 	case ADAPTER_REQ_RUN_XFER:
   1001 		if (xs->cmdlen > CISS_MAX_CDB) {
   1002 			CISS_DPRINTF(CISS_D_CMD, ("CDB too big %p ", xs));
   1003 			memset(&xs->sense, 0, sizeof(xs->sense));
   1004 			printf("ciss driver stuffup in %s:%d: %s()\n",
   1005 			       __FILE__, __LINE__, __func__);
   1006 			xs->error = XS_DRIVER_STUFFUP;
   1007 			scsipi_done(xs);
   1008 			break;
   1009 		}
   1010 
   1011 		error = 0;
   1012 		xs->error = XS_NOERROR;
   1013 
   1014 		/* TODO check this target has not yet employed w/ any volume */
   1015 
   1016 		ccb = ciss_get_ccb(sc);
   1017 		cmd = &ccb->ccb_cmd;
   1018 		ccb->ccb_len = xs->datalen;
   1019 		ccb->ccb_data = xs->data;
   1020 		ccb->ccb_xs = xs;
   1021 
   1022 		cmd->cdblen = xs->cmdlen;
   1023 		cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL;
   1024 		if (xs->xs_control & XS_CTL_DATA_IN)
   1025 			cmd->flags |= CISS_CDB_IN;
   1026 		else if (xs->xs_control & XS_CTL_DATA_OUT)
   1027 			cmd->flags |= CISS_CDB_OUT;
   1028 		cmd->tmo = xs->timeout < 1000? 1 : xs->timeout / 1000;
   1029 		memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
   1030 		memcpy(&cmd->cdb[0], xs->cmd, CISS_MAX_CDB);
   1031 
   1032 		if (ciss_cmd(ccb, BUS_DMA_WAITOK,
   1033 		    xs->xs_control & (XS_CTL_POLL|XS_CTL_NOSLEEP))) {
   1034 			printf("ciss driver stuffup in %s:%d: %s()\n",
   1035 			       __FILE__, __LINE__, __func__);
   1036 			xs->error = XS_DRIVER_STUFFUP;
   1037 			scsipi_done(xs);
   1038 			break;
   1039 		}
   1040 
   1041 		break;
   1042 
   1043 	case ADAPTER_REQ_GROW_RESOURCES:
   1044 		/*
   1045 		 * Not supported.
   1046 		 */
   1047 		break;
   1048 
   1049 	case ADAPTER_REQ_SET_XFER_MODE:
   1050 		/*
   1051 		 * We can't change the transfer mode, but at least let
   1052 		 * scsipi know what the adapter has negociated.
   1053 		 */
   1054 		 /* Get xfer mode and return it */
   1055 		break;
   1056 	}
   1057 }
   1058 #endif
   1059 
   1060 static void
   1061 ciss_scsi_cmd(struct scsipi_channel *chan, scsipi_adapter_req_t req,
   1062 	void *arg)
   1063 {
   1064 	struct scsipi_xfer *xs;
   1065 	struct scsipi_xfer_mode *xm;
   1066 	struct ciss_softc *sc =
   1067 		(struct ciss_softc *) chan->chan_adapter->adapt_dev;
   1068 	u_int8_t target;
   1069 	struct ciss_ccb *ccb;
   1070 	struct ciss_cmd *cmd;
   1071 	int error;
   1072 
   1073 	CISS_DPRINTF(CISS_D_CMD, ("ciss_scsi_cmd "));
   1074 
   1075 	switch (req)
   1076 	{
   1077 	case ADAPTER_REQ_RUN_XFER:
   1078 		xs = (struct scsipi_xfer *) arg;
   1079 		target = xs->xs_periph->periph_target;
   1080 		CISS_DPRINTF(CISS_D_CMD, ("targ=%d ", target));
   1081 		if (xs->cmdlen > CISS_MAX_CDB) {
   1082 			CISS_DPRINTF(CISS_D_CMD, ("CDB too big %p ", xs));
   1083 			memset(&xs->sense, 0, sizeof(xs->sense));
   1084 			xs->error = XS_SENSE;
   1085 			printf("ciss driver stuffup in %s:%d: %s()\n",
   1086 			       __FILE__, __LINE__, __func__);
   1087 			scsipi_done(xs);
   1088 			break;
   1089 		}
   1090 
   1091 		error = 0;
   1092 		xs->error = XS_NOERROR;
   1093 
   1094 		/* XXX emulate SYNCHRONIZE_CACHE ??? */
   1095 
   1096 		ccb = ciss_get_ccb(sc);
   1097 		cmd = &ccb->ccb_cmd;
   1098 		ccb->ccb_len = xs->datalen;
   1099 		ccb->ccb_data = xs->data;
   1100 		ccb->ccb_xs = xs;
   1101 		cmd->tgt = CISS_CMD_MODE_LD | target;
   1102 		cmd->tgt2 = 0;
   1103 		cmd->cdblen = xs->cmdlen;
   1104 		cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL;
   1105 		if (xs->xs_control & XS_CTL_DATA_IN)
   1106 			cmd->flags |= CISS_CDB_IN;
   1107 		else if (xs->xs_control & XS_CTL_DATA_OUT)
   1108 			cmd->flags |= CISS_CDB_OUT;
   1109 		cmd->tmo = htole16(xs->timeout < 1000? 1 : xs->timeout / 1000);
   1110 		memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
   1111 		memcpy(&cmd->cdb[0], xs->cmd, CISS_MAX_CDB);
   1112 		CISS_DPRINTF(CISS_D_CMD, ("cmd=%02x %02x %02x %02x %02x %02x ",
   1113 			     cmd->cdb[0], cmd->cdb[1], cmd->cdb[2],
   1114 			     cmd->cdb[3], cmd->cdb[4], cmd->cdb[5]));
   1115 
   1116 		if (ciss_cmd(ccb, BUS_DMA_WAITOK,
   1117 		    xs->xs_control & (XS_CTL_POLL|XS_CTL_NOSLEEP))) {
   1118 			printf("ciss driver stuffup in %s:%d: %s()\n",
   1119 			       __FILE__, __LINE__, __func__);
   1120 			xs->error = XS_DRIVER_STUFFUP;
   1121 			scsipi_done(xs);
   1122 			return;
   1123 		}
   1124 
   1125 		break;
   1126 	case ADAPTER_REQ_GROW_RESOURCES:
   1127 		/*
   1128 		 * Not supported.
   1129 		 */
   1130 		break;
   1131 	case ADAPTER_REQ_SET_XFER_MODE:
   1132 		/*
   1133 		 * We can't change the transfer mode, but at least let
   1134 		 * scsipi know what the adapter has negociated.
   1135 		 */
   1136 		xm = (struct scsipi_xfer_mode *)arg;
   1137 		xm->xm_mode |= PERIPH_CAP_TQING;
   1138 		scsipi_async_event(chan, ASYNC_EVENT_XFER_MODE, xm);
   1139 		break;
   1140 	}
   1141 }
   1142 
   1143 int
   1144 ciss_intr(void *v)
   1145 {
   1146 	struct ciss_softc *sc = v;
   1147 	struct ciss_ccb *ccb;
   1148 	u_int32_t id;
   1149 	bus_size_t reg;
   1150 	int hit = 0;
   1151 
   1152 	CISS_DPRINTF(CISS_D_INTR, ("intr "));
   1153 
   1154 	if (sc->cfg.methods & CISS_METH_FIFO64)
   1155 		reg = CISS_OUTQ64_HI;
   1156 	else if (sc->cfg.methods & CISS_METH_FIFO64_RRO)
   1157 		reg = CISS_OUTQ64_LO;
   1158 	else
   1159 		reg = CISS_OUTQ;
   1160 	while ((id = bus_space_read_4(sc->sc_iot, sc->sc_ioh, reg)) !=
   1161 	    0xffffffff) {
   1162 		if (reg == CISS_OUTQ64_HI)
   1163 			id = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
   1164 			    CISS_OUTQ64_LO);
   1165 		else if (reg == CISS_OUTQ64_LO)
   1166 			(void)bus_space_read_4(sc->sc_iot, sc->sc_ioh,
   1167 			    CISS_OUTQ64_HI);
   1168 
   1169 		ccb = (struct ciss_ccb *) ((char *)sc->ccbs + (id >> 2) * sc->ccblen);
   1170 		ccb->ccb_cmd.id = htole32(id);
   1171 		ccb->ccb_cmd.id_hi = htole32(0); /* ignore the upper 32bits */
   1172 		if (ccb->ccb_state == CISS_CCB_POLL) {
   1173 			ccb->ccb_state = CISS_CCB_ONQ;
   1174 			mutex_enter(&sc->sc_mutex);
   1175 			cv_broadcast(&sc->sc_condvar);
   1176 			mutex_exit(&sc->sc_mutex);
   1177 		} else
   1178 			ciss_done(ccb);
   1179 
   1180 		hit = 1;
   1181 	}
   1182 
   1183 	CISS_DPRINTF(CISS_D_INTR, ("exit\n"));
   1184 	return hit;
   1185 }
   1186 
   1187 static void
   1188 ciss_heartbeat(void *v)
   1189 {
   1190 	struct ciss_softc *sc = v;
   1191 	u_int32_t hb;
   1192 
   1193 	hb = bus_space_read_4(sc->sc_iot, sc->cfg_ioh,
   1194 	    sc->cfgoff + offsetof(struct ciss_config, heartbeat));
   1195 	if (hb == sc->heartbeat) {
   1196 		sc->fibrillation++;
   1197 		CISS_DPRINTF(CISS_D_ERR, ("%s: fibrillation #%d (value=%d)\n",
   1198 		    device_xname(sc->sc_dev), sc->fibrillation, hb));
   1199 		if (sc->fibrillation >= 11) {
   1200 			/* No heartbeat for 33 seconds */
   1201 			panic("%s: dead", device_xname(sc->sc_dev));	/* XXX reset! */
   1202 		}
   1203 	} else {
   1204 		sc->heartbeat = hb;
   1205 		if (sc->fibrillation) {
   1206 			CISS_DPRINTF(CISS_D_ERR, ("%s: "
   1207 			    "fibrillation ended (value=%d)\n",
   1208 			    device_xname(sc->sc_dev), hb));
   1209 		}
   1210 		sc->fibrillation = 0;
   1211 	}
   1212 
   1213 	callout_schedule(&sc->sc_hb, hz * 3);
   1214 }
   1215 
   1216 static int
   1217 ciss_scsi_ioctl(struct scsipi_channel *chan, u_long cmd,
   1218     void *addr, int flag, struct proc *p)
   1219 {
   1220 #if NBIO > 0
   1221 	return ciss_ioctl(chan->chan_adapter->adapt_dev, cmd, addr);
   1222 #else
   1223 	return ENOTTY;
   1224 #endif
   1225 }
   1226 
   1227 #if NBIO > 0
   1228 const int ciss_level[] = { 0, 4, 1, 5, 51, 7 };
   1229 const int ciss_stat[] = { BIOC_SVONLINE, BIOC_SVOFFLINE, BIOC_SVOFFLINE,
   1230     BIOC_SVDEGRADED, BIOC_SVREBUILD, BIOC_SVREBUILD, BIOC_SVDEGRADED,
   1231     BIOC_SVDEGRADED, BIOC_SVINVALID, BIOC_SVINVALID, BIOC_SVBUILDING,
   1232     BIOC_SVOFFLINE, BIOC_SVBUILDING };
   1233 
   1234 int
   1235 ciss_ioctl(device_t dev, u_long cmd, void *addr)
   1236 {
   1237 	struct ciss_softc	*sc = (struct ciss_softc *)dev;
   1238 	struct bioc_inq *bi;
   1239 	struct bioc_disk *bd;
   1240 	struct bioc_blink *bb;
   1241 	struct ciss_ldstat *ldstat;
   1242 	struct ciss_pdid *pdid;
   1243 	struct ciss_blink *blink;
   1244 	struct ciss_ld *ldp;
   1245 	u_int8_t drv;
   1246 	int ld, pd, error = 0;
   1247 
   1248 	switch (cmd) {
   1249 	case BIOCINQ:
   1250 		bi = (struct bioc_inq *)addr;
   1251 		strlcpy(bi->bi_dev, device_xname(sc->sc_dev), sizeof(bi->bi_dev));
   1252 		bi->bi_novol = sc->maxunits;
   1253 		bi->bi_nodisk = sc->sc_lds[0]->ndrives;
   1254 		break;
   1255 
   1256 	case BIOCVOL:
   1257 		error = ciss_ioctl_vol(sc, (struct bioc_vol *)addr);
   1258 		break;
   1259 
   1260 	case BIOCDISK_NOVOL:
   1261 /*
   1262  * XXX since we don't know how to associate physical drives with logical drives
   1263  * yet, BIOCDISK_NOVOL is equivalent to BIOCDISK to the volume that we've
   1264  * associated all physical drives to.
   1265  * Maybe assoicate all physical drives to all logical volumes, but only return
   1266  * physical drives on one logical volume.  Which one?  Either 1st volume that
   1267  * is degraded, rebuilding, or failed?
   1268  */
   1269 		bd = (struct bioc_disk *)addr;
   1270 		bd->bd_volid = 0;
   1271 		bd->bd_disknovol = true;
   1272 		/* FALLTHROUGH */
   1273 	case BIOCDISK:
   1274 		bd = (struct bioc_disk *)addr;
   1275 		if (bd->bd_volid > sc->maxunits) {
   1276 			error = EINVAL;
   1277 			break;
   1278 		}
   1279 		ldp = sc->sc_lds[0];
   1280 		if (!ldp || (pd = bd->bd_diskid) > ldp->ndrives) {
   1281 			error = EINVAL;
   1282 			break;
   1283 		}
   1284 		ldstat = sc->scratch;
   1285 		if ((error = ciss_ldstat(sc, bd->bd_volid, ldstat))) {
   1286 			break;
   1287 		}
   1288 		bd->bd_status = -1;
   1289 		if (ldstat->stat == CISS_LD_REBLD &&
   1290 		    ldstat->bigrebuild == ldp->tgts[pd])
   1291 			bd->bd_status = BIOC_SDREBUILD;
   1292 		if (ciss_bitset(ldp->tgts[pd] & (~CISS_BIGBIT),
   1293 		    ldstat->bigfailed)) {
   1294 			bd->bd_status = BIOC_SDFAILED;
   1295 			bd->bd_size = 0;
   1296 			bd->bd_channel = (ldp->tgts[pd] & (~CISS_BIGBIT)) /
   1297 			    sc->ndrives;
   1298 			bd->bd_target = ldp->tgts[pd] % sc->ndrives;
   1299 			bd->bd_lun = 0;
   1300 			bd->bd_vendor[0] = '\0';
   1301 			bd->bd_serial[0] = '\0';
   1302 			bd->bd_procdev[0] = '\0';
   1303 		} else {
   1304 			pdid = sc->scratch;
   1305 			if ((error = ciss_pdid(sc, ldp->tgts[pd], pdid,
   1306 			    XS_CTL_POLL))) {
   1307 				bd->bd_status = BIOC_SDFAILED;
   1308 				bd->bd_size = 0;
   1309 				bd->bd_channel = (ldp->tgts[pd] & (~CISS_BIGBIT)) /
   1310 				    sc->ndrives;
   1311 				bd->bd_target = ldp->tgts[pd] % sc->ndrives;
   1312 				bd->bd_lun = 0;
   1313 				bd->bd_vendor[0] = '\0';
   1314 				bd->bd_serial[0] = '\0';
   1315 				bd->bd_procdev[0] = '\0';
   1316 				error = 0;
   1317 				break;
   1318 			}
   1319 			if (bd->bd_status < 0) {
   1320 				if (pdid->config & CISS_PD_SPARE)
   1321 					bd->bd_status = BIOC_SDHOTSPARE;
   1322 				else if (pdid->present & CISS_PD_PRESENT)
   1323 					bd->bd_status = BIOC_SDONLINE;
   1324 				else
   1325 					bd->bd_status = BIOC_SDINVALID;
   1326 			}
   1327 			bd->bd_size = (u_int64_t)le32toh(pdid->nblocks) *
   1328 			    le16toh(pdid->blksz);
   1329 			bd->bd_channel = pdid->bus;
   1330 			bd->bd_target = pdid->target;
   1331 			bd->bd_lun = 0;
   1332 			strlcpy(bd->bd_vendor, pdid->model,
   1333 			    sizeof(bd->bd_vendor));
   1334 			strlcpy(bd->bd_serial, pdid->serial,
   1335 			    sizeof(bd->bd_serial));
   1336 			bd->bd_procdev[0] = '\0';
   1337 		}
   1338 		break;
   1339 
   1340 	case BIOCBLINK:
   1341 		bb = (struct bioc_blink *)addr;
   1342 		blink = sc->scratch;
   1343 		error = EINVAL;
   1344 		/* XXX workaround completely dumb scsi addressing */
   1345 		for (ld = 0; ld < sc->maxunits; ld++) {
   1346 			ldp = sc->sc_lds[ld];
   1347 			if (!ldp)
   1348 				continue;
   1349 			if (sc->ndrives == 256)
   1350 				drv = bb->bb_target;
   1351 			else
   1352 				drv = CISS_BIGBIT +
   1353 				    bb->bb_channel * sc->ndrives +
   1354 				    bb->bb_target;
   1355 			for (pd = 0; pd < ldp->ndrives; pd++)
   1356 				if (ldp->tgts[pd] == drv)
   1357 					error = ciss_blink(sc, ld, pd,
   1358 					    bb->bb_status, blink);
   1359 		}
   1360 		break;
   1361 
   1362 	case BIOCALARM:
   1363 	case BIOCSETSTATE:
   1364 	default:
   1365 		error = EINVAL;
   1366 	}
   1367 
   1368 	return (error);
   1369 }
   1370 
   1371 int
   1372 ciss_ioctl_vol(struct ciss_softc *sc, struct bioc_vol *bv)
   1373 {
   1374 	struct ciss_ldid *ldid;
   1375 	struct ciss_ld *ldp;
   1376 	struct ciss_ldstat *ldstat;
   1377 	struct ciss_pdid *pdid;
   1378 	int error = 0;
   1379 	u_int blks;
   1380 
   1381 	if (bv->bv_volid > sc->maxunits) {
   1382 		return EINVAL;
   1383 	}
   1384 	ldp = sc->sc_lds[bv->bv_volid];
   1385 	ldid = sc->scratch;
   1386 	if ((error = ciss_ldid(sc, bv->bv_volid, ldid))) {
   1387 		return error;
   1388 	}
   1389 	bv->bv_status = BIOC_SVINVALID;
   1390 	blks = (u_int)le16toh(ldid->nblocks[1]) << 16 |
   1391 	    le16toh(ldid->nblocks[0]);
   1392 	bv->bv_size = blks * (u_quad_t)le16toh(ldid->blksize);
   1393 	bv->bv_level = ciss_level[ldid->type];
   1394 /*
   1395  * XXX Should only return bv_nodisk for logigal volume that we've associated
   1396  * the physical drives to:  either the 1st degraded, rebuilding, or failed
   1397  * volume else volume 0?
   1398  */
   1399 	if (ldp) {
   1400 		bv->bv_nodisk = ldp->ndrives;
   1401 		strlcpy(bv->bv_dev, ldp->xname, sizeof(bv->bv_dev));
   1402 	}
   1403 	strlcpy(bv->bv_vendor, "CISS", sizeof(bv->bv_vendor));
   1404 	ldstat = sc->scratch;
   1405 	memset(ldstat, 0, sizeof(*ldstat));
   1406 	if ((error = ciss_ldstat(sc, bv->bv_volid, ldstat))) {
   1407 		return error;
   1408 	}
   1409 	bv->bv_percent = -1;
   1410 	bv->bv_seconds = 0;
   1411 	if (ldstat->stat < sizeof(ciss_stat)/sizeof(ciss_stat[0]))
   1412 		bv->bv_status = ciss_stat[ldstat->stat];
   1413 	if (bv->bv_status == BIOC_SVREBUILD ||
   1414 	    bv->bv_status == BIOC_SVBUILDING) {
   1415 	 	u_int64_t prog;
   1416 
   1417 		ldp = sc->sc_lds[0];
   1418 		if (ldp) {
   1419 			bv->bv_nodisk = ldp->ndrives;
   1420 			strlcpy(bv->bv_dev, ldp->xname, sizeof(bv->bv_dev));
   1421 		}
   1422 /*
   1423  * XXX ldstat->prog is blocks remaining on physical drive being rebuilt
   1424  * blks is only correct for a RAID1 set;  RAID5 needs to determine the
   1425  * size of the physical device - which we don't yet know.
   1426  * ldstat->bigrebuild has physical device target, so could be used with
   1427  * pdid to get size.   Another way is to save pd information in sc so it's
   1428  * easy to reference.
   1429  */
   1430 		prog = (u_int64_t)((ldstat->prog[3] << 24) |
   1431 		    (ldstat->prog[2] << 16) | (ldstat->prog[1] << 8) |
   1432 		    ldstat->prog[0]);
   1433 		pdid = sc->scratch;
   1434 		if (!ciss_pdid(sc, ldstat->bigrebuild, pdid, XS_CTL_POLL)) {
   1435 			blks = le32toh(pdid->nblocks);
   1436 			bv->bv_percent = (blks - prog) * 1000ULL / blks;
   1437 		 }
   1438 	}
   1439 	return 0;
   1440 }
   1441 
   1442 int
   1443 ciss_blink(struct ciss_softc *sc, int ld, int pd, int stat,
   1444     struct ciss_blink *blink)
   1445 {
   1446 	struct ciss_ccb *ccb;
   1447 	struct ciss_cmd *cmd;
   1448 	struct ciss_ld *ldp;
   1449 
   1450 	if (ld > sc->maxunits)
   1451 		return EINVAL;
   1452 
   1453 	ldp = sc->sc_lds[ld];
   1454 	if (!ldp || pd > ldp->ndrives)
   1455 		return EINVAL;
   1456 
   1457 	ldp->bling.pdtab[ldp->tgts[pd]] = stat == BIOC_SBUNBLINK? 0 :
   1458 	    CISS_BLINK_ALL;
   1459 	memcpy(blink, &ldp->bling, sizeof(*blink));
   1460 
   1461 	ccb = ciss_get_ccb(sc);
   1462 	if (ccb == NULL)
   1463 		return ENOMEM;
   1464 	ccb->ccb_len = sizeof(*blink);
   1465 	ccb->ccb_data = blink;
   1466 	ccb->ccb_xs = NULL;
   1467 	cmd = &ccb->ccb_cmd;
   1468 	cmd->tgt = htole32(CISS_CMD_MODE_PERIPH);
   1469 	cmd->tgt2 = 0;
   1470 	cmd->cdblen = 10;
   1471 	cmd->flags = CISS_CDB_CMD | CISS_CDB_SIMPL | CISS_CDB_OUT;
   1472 	cmd->tmo = htole16(0);
   1473 	memset(&cmd->cdb[0], 0, sizeof(cmd->cdb));
   1474 	cmd->cdb[0] = CISS_CMD_CTRL_SET;
   1475 	cmd->cdb[6] = CISS_CMS_CTRL_PDBLINK;
   1476 	cmd->cdb[7] = sizeof(*blink) >> 8;	/* biiiig endian */
   1477 	cmd->cdb[8] = sizeof(*blink) & 0xff;
   1478 
   1479 	return ciss_cmd(ccb, BUS_DMA_NOWAIT, XS_CTL_POLL);
   1480 }
   1481 
   1482 int
   1483 ciss_create_sensors(struct ciss_softc *sc)
   1484 {
   1485 	int			i;
   1486 	int nsensors = sc->maxunits;
   1487 
   1488 	if (nsensors == 0) {
   1489 		return 0;
   1490 	}
   1491 
   1492 	sc->sc_sme = sysmon_envsys_create();
   1493 	sc->sc_sensor = malloc(sizeof(envsys_data_t) * nsensors,
   1494 		M_DEVBUF, M_NOWAIT | M_ZERO);
   1495 	if (sc->sc_sensor == NULL) {
   1496 		aprint_error_dev(sc->sc_dev, "can't allocate envsys_data");
   1497 		return(ENOMEM);
   1498 	}
   1499 
   1500 	for (i = 0; i < nsensors; i++) {
   1501 		sc->sc_sensor[i].units = ENVSYS_DRIVE;
   1502 		sc->sc_sensor[i].state = ENVSYS_SINVALID;
   1503 		sc->sc_sensor[i].value_cur = ENVSYS_DRIVE_EMPTY;
   1504 		/* Enable monitoring for drive state changes */
   1505 		sc->sc_sensor[i].flags |= ENVSYS_FMONSTCHANGED;
   1506 		/* logical drives */
   1507 		snprintf(sc->sc_sensor[i].desc,
   1508 		    sizeof(sc->sc_sensor[i].desc), "%s:%d",
   1509 		    device_xname(sc->sc_dev), i);
   1510 		if (sysmon_envsys_sensor_attach(sc->sc_sme,
   1511 		    &sc->sc_sensor[i]))
   1512 			goto out;
   1513 	}
   1514 
   1515 	sc->sc_sme->sme_name = device_xname(sc->sc_dev);
   1516 	sc->sc_sme->sme_cookie = sc;
   1517 	sc->sc_sme->sme_refresh = ciss_sensor_refresh;
   1518 	if (sysmon_envsys_register(sc->sc_sme)) {
   1519 		printf("%s: unable to register with sysmon\n",
   1520 		    device_xname(sc->sc_dev));
   1521 		return(1);
   1522 	}
   1523 	return (0);
   1524 
   1525 out:
   1526 	free(sc->sc_sensor, M_DEVBUF);
   1527 	sysmon_envsys_destroy(sc->sc_sme);
   1528 	return EINVAL;
   1529 }
   1530 
   1531 void
   1532 ciss_sensor_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
   1533 {
   1534 	struct ciss_softc	*sc = sme->sme_cookie;
   1535 	struct bioc_vol		bv;
   1536 
   1537 	if (edata->sensor >= sc->maxunits)
   1538 		return;
   1539 
   1540 	memset(&bv, 0, sizeof(bv));
   1541 	bv.bv_volid = edata->sensor;
   1542 	if (ciss_ioctl_vol(sc, &bv)) {
   1543 		return;
   1544 	}
   1545 
   1546 	switch(bv.bv_status) {
   1547 	case BIOC_SVOFFLINE:
   1548 		edata->value_cur = ENVSYS_DRIVE_FAIL;
   1549 		edata->state = ENVSYS_SCRITICAL;
   1550 		break;
   1551 
   1552 	case BIOC_SVDEGRADED:
   1553 		edata->value_cur = ENVSYS_DRIVE_PFAIL;
   1554 		edata->state = ENVSYS_SCRITICAL;
   1555 		break;
   1556 
   1557 	case BIOC_SVSCRUB:
   1558 	case BIOC_SVONLINE:
   1559 		edata->value_cur = ENVSYS_DRIVE_ONLINE;
   1560 		edata->state = ENVSYS_SVALID;
   1561 		break;
   1562 
   1563 	case BIOC_SVREBUILD:
   1564 	case BIOC_SVBUILDING:
   1565 		edata->value_cur = ENVSYS_DRIVE_REBUILD;
   1566 		edata->state = ENVSYS_SVALID;
   1567 		break;
   1568 
   1569 	case BIOC_SVINVALID:
   1570 		/* FALLTRHOUGH */
   1571 	default:
   1572 		edata->value_cur = 0; /* unknown */
   1573 		edata->state = ENVSYS_SINVALID;
   1574 	}
   1575 }
   1576 #endif /* NBIO > 0 */
   1577