xref: /netbsd-src/sys/dev/ic/ciss.c (revision 946379e7b37692fc43f68eb0d1c10daa0a7f3b6c)
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