xref: /openbsd-src/sys/dev/softraid.c (revision f763167468dba5339ed4b14b7ecaca2a397ab0f6)
1 /* $OpenBSD: softraid.c,v 1.385 2017/09/06 21:08:01 patrick Exp $ */
2 /*
3  * Copyright (c) 2007, 2008, 2009 Marco Peereboom <marco@peereboom.us>
4  * Copyright (c) 2008 Chris Kuethe <ckuethe@openbsd.org>
5  * Copyright (c) 2009 Joel Sing <jsing@openbsd.org>
6  *
7  * Permission to use, copy, modify, and distribute this software for any
8  * purpose with or without fee is hereby granted, provided that the above
9  * copyright notice and this permission notice appear in all copies.
10  *
11  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18  */
19 
20 #include "bio.h"
21 
22 #include <sys/param.h>
23 #include <sys/systm.h>
24 #include <sys/buf.h>
25 #include <sys/device.h>
26 #include <sys/ioctl.h>
27 #include <sys/malloc.h>
28 #include <sys/pool.h>
29 #include <sys/kernel.h>
30 #include <sys/disk.h>
31 #include <sys/rwlock.h>
32 #include <sys/queue.h>
33 #include <sys/fcntl.h>
34 #include <sys/disklabel.h>
35 #include <sys/vnode.h>
36 #include <sys/lock.h>
37 #include <sys/mount.h>
38 #include <sys/sensors.h>
39 #include <sys/stat.h>
40 #include <sys/conf.h>
41 #include <sys/uio.h>
42 #include <sys/task.h>
43 #include <sys/kthread.h>
44 #include <sys/dkio.h>
45 #include <sys/stdint.h>
46 
47 #include <scsi/scsi_all.h>
48 #include <scsi/scsiconf.h>
49 #include <scsi/scsi_disk.h>
50 
51 #include <dev/softraidvar.h>
52 
53 #ifdef HIBERNATE
54 #include <lib/libsa/aes_xts.h>
55 #include <sys/hibernate.h>
56 #include <scsi/sdvar.h>
57 #endif /* HIBERNATE */
58 
59 /* #define SR_FANCY_STATS */
60 
61 #ifdef SR_DEBUG
62 #define SR_FANCY_STATS
63 uint32_t	sr_debug = 0
64 		    /* | SR_D_CMD */
65 		    /* | SR_D_MISC */
66 		    /* | SR_D_INTR */
67 		    /* | SR_D_IOCTL */
68 		    /* | SR_D_CCB */
69 		    /* | SR_D_WU */
70 		    /* | SR_D_META */
71 		    /* | SR_D_DIS */
72 		    /* | SR_D_STATE */
73 		    /* | SR_D_REBUILD */
74 		;
75 #endif
76 
77 struct sr_softc	*softraid0;
78 struct sr_uuid	sr_bootuuid;
79 u_int8_t	sr_bootkey[SR_CRYPTO_MAXKEYBYTES];
80 
81 int		sr_match(struct device *, void *, void *);
82 void		sr_attach(struct device *, struct device *, void *);
83 int		sr_detach(struct device *, int);
84 void		sr_map_root(void);
85 
86 struct cfattach softraid_ca = {
87 	sizeof(struct sr_softc), sr_match, sr_attach, sr_detach,
88 };
89 
90 struct cfdriver softraid_cd = {
91 	NULL, "softraid", DV_DULL
92 };
93 
94 /* scsi & discipline */
95 void			sr_scsi_cmd(struct scsi_xfer *);
96 void			sr_minphys(struct buf *, struct scsi_link *);
97 int			sr_scsi_probe(struct scsi_link *);
98 void			sr_copy_internal_data(struct scsi_xfer *,
99 			    void *, size_t);
100 int			sr_scsi_ioctl(struct scsi_link *, u_long,
101 			    caddr_t, int);
102 int			sr_bio_ioctl(struct device *, u_long, caddr_t);
103 int			sr_bio_handler(struct sr_softc *,
104 			    struct sr_discipline *, u_long, struct bio *);
105 int			sr_ioctl_inq(struct sr_softc *, struct bioc_inq *);
106 int			sr_ioctl_vol(struct sr_softc *, struct bioc_vol *);
107 int			sr_ioctl_disk(struct sr_softc *, struct bioc_disk *);
108 int			sr_ioctl_setstate(struct sr_softc *,
109 			    struct bioc_setstate *);
110 int			sr_ioctl_createraid(struct sr_softc *,
111 			    struct bioc_createraid *, int, void *);
112 int			sr_ioctl_deleteraid(struct sr_softc *,
113 			    struct sr_discipline *, struct bioc_deleteraid *);
114 int			sr_ioctl_discipline(struct sr_softc *,
115 			    struct sr_discipline *, struct bioc_discipline *);
116 int			sr_ioctl_installboot(struct sr_softc *,
117 			    struct sr_discipline *, struct bioc_installboot *);
118 void			sr_chunks_unwind(struct sr_softc *,
119 			    struct sr_chunk_head *);
120 void			sr_discipline_free(struct sr_discipline *);
121 void			sr_discipline_shutdown(struct sr_discipline *, int);
122 int			sr_discipline_init(struct sr_discipline *, int);
123 int			sr_alloc_resources(struct sr_discipline *);
124 void			sr_free_resources(struct sr_discipline *);
125 void			sr_set_chunk_state(struct sr_discipline *, int, int);
126 void			sr_set_vol_state(struct sr_discipline *);
127 
128 /* utility functions */
129 void			sr_shutdown(void);
130 void			sr_uuid_generate(struct sr_uuid *);
131 char			*sr_uuid_format(struct sr_uuid *);
132 void			sr_uuid_print(struct sr_uuid *, int);
133 void			sr_checksum_print(u_int8_t *);
134 int			sr_boot_assembly(struct sr_softc *);
135 int			sr_already_assembled(struct sr_discipline *);
136 int			sr_hotspare(struct sr_softc *, dev_t);
137 void			sr_hotspare_rebuild(struct sr_discipline *);
138 int			sr_rebuild_init(struct sr_discipline *, dev_t, int);
139 void			sr_rebuild_start(void *);
140 void			sr_rebuild_thread(void *);
141 void			sr_rebuild(struct sr_discipline *);
142 void			sr_roam_chunks(struct sr_discipline *);
143 int			sr_chunk_in_use(struct sr_softc *, dev_t);
144 int			sr_rw(struct sr_softc *, dev_t, char *, size_t,
145 			    daddr_t, long);
146 void			sr_wu_done_callback(void *);
147 
148 /* don't include these on RAMDISK */
149 #ifndef SMALL_KERNEL
150 void			sr_sensors_refresh(void *);
151 int			sr_sensors_create(struct sr_discipline *);
152 void			sr_sensors_delete(struct sr_discipline *);
153 #endif
154 
155 /* metadata */
156 int			sr_meta_probe(struct sr_discipline *, dev_t *, int);
157 int			sr_meta_attach(struct sr_discipline *, int, int);
158 int			sr_meta_rw(struct sr_discipline *, dev_t, void *, long);
159 int			sr_meta_clear(struct sr_discipline *);
160 void			sr_meta_init(struct sr_discipline *, int, int);
161 void			sr_meta_init_complete(struct sr_discipline *);
162 void			sr_meta_opt_handler(struct sr_discipline *,
163 			    struct sr_meta_opt_hdr *);
164 
165 /* hotplug magic */
166 void			sr_disk_attach(struct disk *, int);
167 
168 struct sr_hotplug_list {
169 	void			(*sh_hotplug)(struct sr_discipline *,
170 				    struct disk *, int);
171 	struct sr_discipline	*sh_sd;
172 
173 	SLIST_ENTRY(sr_hotplug_list) shl_link;
174 };
175 SLIST_HEAD(sr_hotplug_list_head, sr_hotplug_list);
176 
177 struct			sr_hotplug_list_head	sr_hotplug_callbacks;
178 extern void		(*softraid_disk_attach)(struct disk *, int);
179 
180 /* scsi glue */
181 struct scsi_adapter sr_switch = {
182 	sr_scsi_cmd, sr_minphys, sr_scsi_probe, NULL, sr_scsi_ioctl
183 };
184 
185 /* native metadata format */
186 int			sr_meta_native_bootprobe(struct sr_softc *, dev_t,
187 			    struct sr_boot_chunk_head *);
188 #define SR_META_NOTCLAIMED	(0)
189 #define SR_META_CLAIMED		(1)
190 int			sr_meta_native_probe(struct sr_softc *,
191 			   struct sr_chunk *);
192 int			sr_meta_native_attach(struct sr_discipline *, int);
193 int			sr_meta_native_write(struct sr_discipline *, dev_t,
194 			    struct sr_metadata *,void *);
195 
196 #ifdef SR_DEBUG
197 void			sr_meta_print(struct sr_metadata *);
198 #else
199 #define			sr_meta_print(m)
200 #endif
201 
202 /* the metadata driver should remain stateless */
203 struct sr_meta_driver {
204 	daddr_t			smd_offset;	/* metadata location */
205 	u_int32_t		smd_size;	/* size of metadata */
206 
207 	int			(*smd_probe)(struct sr_softc *,
208 				   struct sr_chunk *);
209 	int			(*smd_attach)(struct sr_discipline *, int);
210 	int			(*smd_detach)(struct sr_discipline *);
211 	int			(*smd_read)(struct sr_discipline *, dev_t,
212 				    struct sr_metadata *, void *);
213 	int			(*smd_write)(struct sr_discipline *, dev_t,
214 				    struct sr_metadata *, void *);
215 	int			(*smd_validate)(struct sr_discipline *,
216 				    struct sr_metadata *, void *);
217 } smd[] = {
218 	{ SR_META_OFFSET, SR_META_SIZE * DEV_BSIZE,
219 	  sr_meta_native_probe, sr_meta_native_attach, NULL,
220 	  sr_meta_native_read, sr_meta_native_write, NULL },
221 	{ 0, 0, NULL, NULL, NULL, NULL }
222 };
223 
224 int
225 sr_meta_attach(struct sr_discipline *sd, int chunk_no, int force)
226 {
227 	struct sr_softc		*sc = sd->sd_sc;
228 	struct sr_chunk_head	*cl;
229 	struct sr_chunk		*ch_entry, *chunk1, *chunk2;
230 	int			rv = 1, i = 0;
231 
232 	DNPRINTF(SR_D_META, "%s: sr_meta_attach(%d)\n", DEVNAME(sc), chunk_no);
233 
234 	/* in memory copy of metadata */
235 	sd->sd_meta = malloc(SR_META_SIZE * DEV_BSIZE, M_DEVBUF,
236 	    M_ZERO | M_NOWAIT);
237 	if (!sd->sd_meta) {
238 		sr_error(sc, "could not allocate memory for metadata");
239 		goto bad;
240 	}
241 
242 	if (sd->sd_meta_type != SR_META_F_NATIVE) {
243 		/* in memory copy of foreign metadata */
244 		sd->sd_meta_foreign = malloc(smd[sd->sd_meta_type].smd_size,
245 		    M_DEVBUF, M_ZERO | M_NOWAIT);
246 		if (!sd->sd_meta_foreign) {
247 			/* unwind frees sd_meta */
248 			sr_error(sc, "could not allocate memory for foreign "
249 			    "metadata");
250 			goto bad;
251 		}
252 	}
253 
254 	/* we have a valid list now create an array index */
255 	cl = &sd->sd_vol.sv_chunk_list;
256 	sd->sd_vol.sv_chunks = mallocarray(chunk_no, sizeof(struct sr_chunk *),
257 	    M_DEVBUF, M_WAITOK | M_ZERO);
258 
259 	/* fill out chunk array */
260 	i = 0;
261 	SLIST_FOREACH(ch_entry, cl, src_link)
262 		sd->sd_vol.sv_chunks[i++] = ch_entry;
263 
264 	/* attach metadata */
265 	if (smd[sd->sd_meta_type].smd_attach(sd, force))
266 		goto bad;
267 
268 	/* Force chunks into correct order now that metadata is attached. */
269 	SLIST_INIT(cl);
270 	for (i = 0; i < chunk_no; i++) {
271 		ch_entry = sd->sd_vol.sv_chunks[i];
272 		chunk2 = NULL;
273 		SLIST_FOREACH(chunk1, cl, src_link) {
274 			if (chunk1->src_meta.scmi.scm_chunk_id >
275 			    ch_entry->src_meta.scmi.scm_chunk_id)
276 				break;
277 			chunk2 = chunk1;
278 		}
279 		if (chunk2 == NULL)
280 			SLIST_INSERT_HEAD(cl, ch_entry, src_link);
281 		else
282 			SLIST_INSERT_AFTER(chunk2, ch_entry, src_link);
283 	}
284 	i = 0;
285 	SLIST_FOREACH(ch_entry, cl, src_link)
286 		sd->sd_vol.sv_chunks[i++] = ch_entry;
287 
288 	rv = 0;
289 bad:
290 	return (rv);
291 }
292 
293 int
294 sr_meta_probe(struct sr_discipline *sd, dev_t *dt, int no_chunk)
295 {
296 	struct sr_softc		*sc = sd->sd_sc;
297 	struct vnode		*vn;
298 	struct sr_chunk		*ch_entry, *ch_prev = NULL;
299 	struct sr_chunk_head	*cl;
300 	char			devname[32];
301 	int			i, d, type, found, prevf, error;
302 	dev_t			dev;
303 
304 	DNPRINTF(SR_D_META, "%s: sr_meta_probe(%d)\n", DEVNAME(sc), no_chunk);
305 
306 	if (no_chunk == 0)
307 		goto unwind;
308 
309 	cl = &sd->sd_vol.sv_chunk_list;
310 
311 	for (d = 0, prevf = SR_META_F_INVALID; d < no_chunk; d++) {
312 		ch_entry = malloc(sizeof(struct sr_chunk), M_DEVBUF,
313 		    M_WAITOK | M_ZERO);
314 		/* keep disks in user supplied order */
315 		if (ch_prev)
316 			SLIST_INSERT_AFTER(ch_prev, ch_entry, src_link);
317 		else
318 			SLIST_INSERT_HEAD(cl, ch_entry, src_link);
319 		ch_prev = ch_entry;
320 		dev = dt[d];
321 		ch_entry->src_dev_mm = dev;
322 
323 		if (dev == NODEV) {
324 			ch_entry->src_meta.scm_status = BIOC_SDOFFLINE;
325 			continue;
326 		} else {
327 			sr_meta_getdevname(sc, dev, devname, sizeof(devname));
328 			if (bdevvp(dev, &vn)) {
329 				sr_error(sc, "sr_meta_probe: cannot allocate "
330 				    "vnode");
331 				goto unwind;
332 			}
333 
334 			/*
335 			 * XXX leaving dev open for now; move this to attach
336 			 * and figure out the open/close dance for unwind.
337 			 */
338 			error = VOP_OPEN(vn, FREAD | FWRITE, NOCRED, curproc);
339 			if (error) {
340 				DNPRINTF(SR_D_META,"%s: sr_meta_probe can't "
341 				    "open %s\n", DEVNAME(sc), devname);
342 				vput(vn);
343 				goto unwind;
344 			}
345 
346 			strlcpy(ch_entry->src_devname, devname,
347 			    sizeof(ch_entry->src_devname));
348 			ch_entry->src_vn = vn;
349 		}
350 
351 		/* determine if this is a device we understand */
352 		for (i = 0, found = SR_META_F_INVALID; smd[i].smd_probe; i++) {
353 			type = smd[i].smd_probe(sc, ch_entry);
354 			if (type == SR_META_F_INVALID)
355 				continue;
356 			else {
357 				found = type;
358 				break;
359 			}
360 		}
361 
362 		if (found == SR_META_F_INVALID)
363 			goto unwind;
364 		if (prevf == SR_META_F_INVALID)
365 			prevf = found;
366 		if (prevf != found) {
367 			DNPRINTF(SR_D_META, "%s: prevf != found\n",
368 			    DEVNAME(sc));
369 			goto unwind;
370 		}
371 	}
372 
373 	return (prevf);
374 unwind:
375 	return (SR_META_F_INVALID);
376 }
377 
378 void
379 sr_meta_getdevname(struct sr_softc *sc, dev_t dev, char *buf, int size)
380 {
381 	int			maj, unit, part;
382 	char			*name;
383 
384 	DNPRINTF(SR_D_META, "%s: sr_meta_getdevname(%p, %d)\n",
385 	    DEVNAME(sc), buf, size);
386 
387 	if (!buf)
388 		return;
389 
390 	maj = major(dev);
391 	part = DISKPART(dev);
392 	unit = DISKUNIT(dev);
393 
394 	name = findblkname(maj);
395 	if (name == NULL)
396 		return;
397 
398 	snprintf(buf, size, "%s%d%c", name, unit, part + 'a');
399 }
400 
401 int
402 sr_rw(struct sr_softc *sc, dev_t dev, char *buf, size_t size, daddr_t blkno,
403     long flags)
404 {
405 	struct vnode		*vp;
406 	struct buf		b;
407 	size_t			bufsize, dma_bufsize;
408 	int			rv = 1;
409 	char			*dma_buf;
410 
411 	DNPRINTF(SR_D_MISC, "%s: sr_rw(0x%x, %p, %zu, %lld 0x%lx)\n",
412 	    DEVNAME(sc), dev, buf, size, (long long)blkno, flags);
413 
414 	dma_bufsize = (size > MAXPHYS) ? MAXPHYS : size;
415 	dma_buf = dma_alloc(dma_bufsize, PR_WAITOK);
416 
417 	if (bdevvp(dev, &vp)) {
418 		printf("%s: sr_rw: failed to allocate vnode\n", DEVNAME(sc));
419 		goto done;
420 	}
421 
422 	while (size > 0) {
423 		DNPRINTF(SR_D_MISC, "%s: dma_buf %p, size %zu, blkno %lld)\n",
424 		    DEVNAME(sc), dma_buf, size, (long long)blkno);
425 
426 		bufsize = (size > MAXPHYS) ? MAXPHYS : size;
427 		if (flags == B_WRITE)
428 			memcpy(dma_buf, buf, bufsize);
429 
430 		bzero(&b, sizeof(b));
431 		b.b_flags = flags | B_PHYS;
432 		b.b_proc = curproc;
433 		b.b_dev = dev;
434 		b.b_iodone = NULL;
435 		b.b_error = 0;
436 		b.b_blkno = blkno;
437 		b.b_data = dma_buf;
438 		b.b_bcount = bufsize;
439 		b.b_bufsize = bufsize;
440 		b.b_resid = bufsize;
441 		b.b_vp = vp;
442 
443 		if ((b.b_flags & B_READ) == 0)
444 			vp->v_numoutput++;
445 
446 		LIST_INIT(&b.b_dep);
447 		VOP_STRATEGY(&b);
448 		biowait(&b);
449 
450 		if (b.b_flags & B_ERROR) {
451 			printf("%s: I/O error %d on dev 0x%x at block %llu\n",
452 			    DEVNAME(sc), b.b_error, dev, b.b_blkno);
453 			goto done;
454 		}
455 
456 		if (flags == B_READ)
457 			memcpy(buf, dma_buf, bufsize);
458 
459 		size -= bufsize;
460 		buf += bufsize;
461 		blkno += howmany(bufsize, DEV_BSIZE);
462 	}
463 
464 	rv = 0;
465 
466 done:
467 	if (vp)
468 		vput(vp);
469 
470 	dma_free(dma_buf, dma_bufsize);
471 
472 	return (rv);
473 }
474 
475 int
476 sr_meta_rw(struct sr_discipline *sd, dev_t dev, void *md, long flags)
477 {
478 	int			rv = 1;
479 
480 	DNPRINTF(SR_D_META, "%s: sr_meta_rw(0x%x, %p, 0x%lx)\n",
481 	    DEVNAME(sd->sd_sc), dev, md, flags);
482 
483 	if (md == NULL) {
484 		printf("%s: sr_meta_rw: invalid metadata pointer\n",
485 		    DEVNAME(sd->sd_sc));
486 		goto done;
487 	}
488 
489 	rv = sr_rw(sd->sd_sc, dev, md, SR_META_SIZE * DEV_BSIZE,
490 	    SR_META_OFFSET, flags);
491 
492 done:
493 	return (rv);
494 }
495 
496 int
497 sr_meta_clear(struct sr_discipline *sd)
498 {
499 	struct sr_softc		*sc = sd->sd_sc;
500 	struct sr_chunk_head	*cl = &sd->sd_vol.sv_chunk_list;
501 	struct sr_chunk		*ch_entry;
502 	void			*m;
503 	int			rv = 1;
504 
505 	DNPRINTF(SR_D_META, "%s: sr_meta_clear\n", DEVNAME(sc));
506 
507 	if (sd->sd_meta_type != SR_META_F_NATIVE) {
508 		sr_error(sc, "cannot clear foreign metadata");
509 		goto done;
510 	}
511 
512 	m = malloc(SR_META_SIZE * DEV_BSIZE, M_DEVBUF, M_WAITOK | M_ZERO);
513 	SLIST_FOREACH(ch_entry, cl, src_link) {
514 		if (sr_meta_native_write(sd, ch_entry->src_dev_mm, m, NULL)) {
515 			/* XXX mark disk offline */
516 			DNPRINTF(SR_D_META, "%s: sr_meta_clear failed to "
517 			    "clear %s\n", DEVNAME(sc), ch_entry->src_devname);
518 			rv++;
519 			continue;
520 		}
521 		bzero(&ch_entry->src_meta, sizeof(ch_entry->src_meta));
522 	}
523 
524 	bzero(sd->sd_meta, SR_META_SIZE * DEV_BSIZE);
525 
526 	free(m, M_DEVBUF, SR_META_SIZE * DEV_BSIZE);
527 	rv = 0;
528 done:
529 	return (rv);
530 }
531 
532 void
533 sr_meta_init(struct sr_discipline *sd, int level, int no_chunk)
534 {
535 	struct sr_softc		*sc = sd->sd_sc;
536 	struct sr_metadata	*sm = sd->sd_meta;
537 	struct sr_chunk_head	*cl = &sd->sd_vol.sv_chunk_list;
538 	struct sr_meta_chunk	*scm;
539 	struct sr_chunk		*chunk;
540 	int			cid = 0;
541 	u_int64_t		max_chunk_sz = 0, min_chunk_sz = 0;
542 	u_int32_t		secsize = DEV_BSIZE;
543 
544 	DNPRINTF(SR_D_META, "%s: sr_meta_init\n", DEVNAME(sc));
545 
546 	if (!sm)
547 		return;
548 
549 	/* Initialise volume metadata. */
550 	sm->ssdi.ssd_magic = SR_MAGIC;
551 	sm->ssdi.ssd_version = SR_META_VERSION;
552 	sm->ssdi.ssd_vol_flags = sd->sd_meta_flags;
553 	sm->ssdi.ssd_volid = 0;
554 	sm->ssdi.ssd_chunk_no = no_chunk;
555 	sm->ssdi.ssd_level = level;
556 
557 	sm->ssd_data_blkno = SR_DATA_OFFSET;
558 	sm->ssd_ondisk = 0;
559 
560 	sr_uuid_generate(&sm->ssdi.ssd_uuid);
561 
562 	/* Initialise chunk metadata and get min/max chunk sizes & secsize. */
563 	SLIST_FOREACH(chunk, cl, src_link) {
564 		scm = &chunk->src_meta;
565 		scm->scmi.scm_size = chunk->src_size;
566 		scm->scmi.scm_chunk_id = cid++;
567 		scm->scm_status = BIOC_SDONLINE;
568 		scm->scmi.scm_volid = 0;
569 		strlcpy(scm->scmi.scm_devname, chunk->src_devname,
570 		    sizeof(scm->scmi.scm_devname));
571 		memcpy(&scm->scmi.scm_uuid, &sm->ssdi.ssd_uuid,
572 		    sizeof(scm->scmi.scm_uuid));
573 		sr_checksum(sc, scm, &scm->scm_checksum,
574 		    sizeof(scm->scm_checksum));
575 
576 		if (min_chunk_sz == 0)
577 			min_chunk_sz = scm->scmi.scm_size;
578 		if (chunk->src_secsize > secsize)
579 			secsize = chunk->src_secsize;
580 		min_chunk_sz = MIN(min_chunk_sz, scm->scmi.scm_size);
581 		max_chunk_sz = MAX(max_chunk_sz, scm->scmi.scm_size);
582 	}
583 
584 	sm->ssdi.ssd_secsize = secsize;
585 
586 	/* Equalize chunk sizes. */
587 	SLIST_FOREACH(chunk, cl, src_link)
588 		chunk->src_meta.scmi.scm_coerced_size = min_chunk_sz;
589 
590 	sd->sd_vol.sv_chunk_minsz = min_chunk_sz;
591 	sd->sd_vol.sv_chunk_maxsz = max_chunk_sz;
592 }
593 
594 void
595 sr_meta_init_complete(struct sr_discipline *sd)
596 {
597 #ifdef SR_DEBUG
598 	struct sr_softc		*sc = sd->sd_sc;
599 #endif
600 	struct sr_metadata	*sm = sd->sd_meta;
601 
602 	DNPRINTF(SR_D_META, "%s: sr_meta_complete\n", DEVNAME(sc));
603 
604 	/* Complete initialisation of volume metadata. */
605 	strlcpy(sm->ssdi.ssd_vendor, "OPENBSD", sizeof(sm->ssdi.ssd_vendor));
606 	snprintf(sm->ssdi.ssd_product, sizeof(sm->ssdi.ssd_product),
607 	    "SR %s", sd->sd_name);
608 	snprintf(sm->ssdi.ssd_revision, sizeof(sm->ssdi.ssd_revision),
609 	    "%03d", sm->ssdi.ssd_version);
610 }
611 
612 void
613 sr_meta_opt_handler(struct sr_discipline *sd, struct sr_meta_opt_hdr *om)
614 {
615 	if (om->som_type != SR_OPT_BOOT)
616 		panic("unknown optional metadata type");
617 }
618 
619 void
620 sr_meta_save_callback(void *xsd)
621 {
622 	struct sr_discipline	*sd = xsd;
623 	int			s;
624 
625 	s = splbio();
626 
627 	if (sr_meta_save(sd, SR_META_DIRTY))
628 		printf("%s: save metadata failed\n", DEVNAME(sd->sd_sc));
629 
630 	sd->sd_must_flush = 0;
631 	splx(s);
632 }
633 
634 int
635 sr_meta_save(struct sr_discipline *sd, u_int32_t flags)
636 {
637 	struct sr_softc		*sc = sd->sd_sc;
638 	struct sr_metadata	*sm = sd->sd_meta, *m;
639 	struct sr_meta_driver	*s;
640 	struct sr_chunk		*src;
641 	struct sr_meta_chunk	*cm;
642 	struct sr_workunit	wu;
643 	struct sr_meta_opt_hdr	*omh;
644 	struct sr_meta_opt_item *omi;
645 	int			i;
646 
647 	DNPRINTF(SR_D_META, "%s: sr_meta_save %s\n",
648 	    DEVNAME(sc), sd->sd_meta->ssd_devname);
649 
650 	if (!sm) {
651 		printf("%s: no in memory copy of metadata\n", DEVNAME(sc));
652 		goto bad;
653 	}
654 
655 	/* meta scratchpad */
656 	s = &smd[sd->sd_meta_type];
657 	m = malloc(SR_META_SIZE * DEV_BSIZE, M_DEVBUF, M_ZERO | M_NOWAIT);
658 	if (!m) {
659 		printf("%s: could not allocate metadata scratch area\n",
660 		    DEVNAME(sc));
661 		goto bad;
662 	}
663 
664 	/* from here on out metadata is updated */
665 restart:
666 	sm->ssd_ondisk++;
667 	sm->ssd_meta_flags = flags;
668 	memcpy(m, sm, sizeof(*m));
669 
670 	/* Chunk metadata. */
671 	cm = (struct sr_meta_chunk *)(m + 1);
672 	for (i = 0; i < sm->ssdi.ssd_chunk_no; i++) {
673 		src = sd->sd_vol.sv_chunks[i];
674 		memcpy(cm, &src->src_meta, sizeof(*cm));
675 		cm++;
676 	}
677 
678 	/* Optional metadata. */
679 	omh = (struct sr_meta_opt_hdr *)(cm);
680 	SLIST_FOREACH(omi, &sd->sd_meta_opt, omi_link) {
681 		DNPRINTF(SR_D_META, "%s: saving optional metadata type %u with "
682 		    "length %u\n", DEVNAME(sc), omi->omi_som->som_type,
683 		    omi->omi_som->som_length);
684 		bzero(&omi->omi_som->som_checksum, MD5_DIGEST_LENGTH);
685 		sr_checksum(sc, omi->omi_som, &omi->omi_som->som_checksum,
686 		    omi->omi_som->som_length);
687 		memcpy(omh, omi->omi_som, omi->omi_som->som_length);
688 		omh = (struct sr_meta_opt_hdr *)((u_int8_t *)omh +
689 		    omi->omi_som->som_length);
690 	}
691 
692 	for (i = 0; i < sm->ssdi.ssd_chunk_no; i++) {
693 		src = sd->sd_vol.sv_chunks[i];
694 
695 		/* skip disks that are offline */
696 		if (src->src_meta.scm_status == BIOC_SDOFFLINE)
697 			continue;
698 
699 		/* calculate metadata checksum for correct chunk */
700 		m->ssdi.ssd_chunk_id = i;
701 		sr_checksum(sc, m, &m->ssd_checksum,
702 		    sizeof(struct sr_meta_invariant));
703 
704 #ifdef SR_DEBUG
705 		DNPRINTF(SR_D_META, "%s: sr_meta_save %s: volid: %d "
706 		    "chunkid: %d checksum: ",
707 		    DEVNAME(sc), src->src_meta.scmi.scm_devname,
708 		    m->ssdi.ssd_volid, m->ssdi.ssd_chunk_id);
709 
710 		if (sr_debug & SR_D_META)
711 			sr_checksum_print((u_int8_t *)&m->ssd_checksum);
712 		DNPRINTF(SR_D_META, "\n");
713 		sr_meta_print(m);
714 #endif
715 
716 		/* translate and write to disk */
717 		if (s->smd_write(sd, src->src_dev_mm, m, NULL /* XXX */)) {
718 			printf("%s: could not write metadata to %s\n",
719 			    DEVNAME(sc), src->src_devname);
720 			/* restart the meta write */
721 			src->src_meta.scm_status = BIOC_SDOFFLINE;
722 			/* XXX recalculate volume status */
723 			goto restart;
724 		}
725 	}
726 
727 	/* not all disciplines have sync */
728 	if (sd->sd_scsi_sync) {
729 		bzero(&wu, sizeof(wu));
730 		wu.swu_flags |= SR_WUF_FAKE;
731 		wu.swu_dis = sd;
732 		sd->sd_scsi_sync(&wu);
733 	}
734 	free(m, M_DEVBUF, SR_META_SIZE * DEV_BSIZE);
735 	return (0);
736 bad:
737 	return (1);
738 }
739 
740 int
741 sr_meta_read(struct sr_discipline *sd)
742 {
743 	struct sr_softc		*sc = sd->sd_sc;
744 	struct sr_chunk_head	*cl = &sd->sd_vol.sv_chunk_list;
745 	struct sr_metadata	*sm;
746 	struct sr_chunk		*ch_entry;
747 	struct sr_meta_chunk	*cp;
748 	struct sr_meta_driver	*s;
749 	void			*fm = NULL;
750 	int			no_disk = 0, got_meta = 0;
751 
752 	DNPRINTF(SR_D_META, "%s: sr_meta_read\n", DEVNAME(sc));
753 
754 	sm = malloc(SR_META_SIZE * DEV_BSIZE, M_DEVBUF, M_WAITOK | M_ZERO);
755 	s = &smd[sd->sd_meta_type];
756 	if (sd->sd_meta_type != SR_META_F_NATIVE)
757 		fm = malloc(s->smd_size, M_DEVBUF, M_WAITOK | M_ZERO);
758 
759 	cp = (struct sr_meta_chunk *)(sm + 1);
760 	SLIST_FOREACH(ch_entry, cl, src_link) {
761 		/* skip disks that are offline */
762 		if (ch_entry->src_meta.scm_status == BIOC_SDOFFLINE) {
763 			DNPRINTF(SR_D_META,
764 			    "%s: %s chunk marked offline, spoofing status\n",
765 			    DEVNAME(sc), ch_entry->src_devname);
766 			cp++; /* adjust chunk pointer to match failure */
767 			continue;
768 		} else if (s->smd_read(sd, ch_entry->src_dev_mm, sm, fm)) {
769 			/* read and translate */
770 			/* XXX mark chunk offline, elsewhere!! */
771 			ch_entry->src_meta.scm_status = BIOC_SDOFFLINE;
772 			cp++; /* adjust chunk pointer to match failure */
773 			DNPRINTF(SR_D_META, "%s: sr_meta_read failed\n",
774 			    DEVNAME(sc));
775 			continue;
776 		}
777 
778 		if (sm->ssdi.ssd_magic != SR_MAGIC) {
779 			DNPRINTF(SR_D_META, "%s: sr_meta_read !SR_MAGIC\n",
780 			    DEVNAME(sc));
781 			continue;
782 		}
783 
784 		/* validate metadata */
785 		if (sr_meta_validate(sd, ch_entry->src_dev_mm, sm, fm)) {
786 			DNPRINTF(SR_D_META, "%s: invalid metadata\n",
787 			    DEVNAME(sc));
788 			no_disk = -1;
789 			goto done;
790 		}
791 
792 		/* assume first chunk contains metadata */
793 		if (got_meta == 0) {
794 			sr_meta_opt_load(sc, sm, &sd->sd_meta_opt);
795 			memcpy(sd->sd_meta, sm, sizeof(*sd->sd_meta));
796 			got_meta = 1;
797 		}
798 
799 		memcpy(&ch_entry->src_meta, cp, sizeof(ch_entry->src_meta));
800 
801 		no_disk++;
802 		cp++;
803 	}
804 
805 	free(sm, M_DEVBUF, SR_META_SIZE * DEV_BSIZE);
806 	free(fm, M_DEVBUF, s->smd_size);
807 
808 done:
809 	DNPRINTF(SR_D_META, "%s: sr_meta_read found %d parts\n", DEVNAME(sc),
810 	    no_disk);
811 	return (no_disk);
812 }
813 
814 void
815 sr_meta_opt_load(struct sr_softc *sc, struct sr_metadata *sm,
816     struct sr_meta_opt_head *som)
817 {
818 	struct sr_meta_opt_hdr	*omh;
819 	struct sr_meta_opt_item *omi;
820 	u_int8_t		checksum[MD5_DIGEST_LENGTH];
821 	int			i;
822 
823 	/* Process optional metadata. */
824 	omh = (struct sr_meta_opt_hdr *)((u_int8_t *)(sm + 1) +
825 	    sizeof(struct sr_meta_chunk) * sm->ssdi.ssd_chunk_no);
826 	for (i = 0; i < sm->ssdi.ssd_opt_no; i++) {
827 
828 		omi = malloc(sizeof(struct sr_meta_opt_item), M_DEVBUF,
829 		    M_WAITOK | M_ZERO);
830 		SLIST_INSERT_HEAD(som, omi, omi_link);
831 
832 		if (omh->som_length == 0) {
833 
834 			/* Load old fixed length optional metadata. */
835 			DNPRINTF(SR_D_META, "%s: old optional metadata of type "
836 			    "%u\n", DEVNAME(sc), omh->som_type);
837 
838 			/* Validate checksum. */
839 			sr_checksum(sc, (void *)omh, &checksum,
840 			    SR_OLD_META_OPT_SIZE - MD5_DIGEST_LENGTH);
841 			if (bcmp(&checksum, (void *)omh + SR_OLD_META_OPT_MD5,
842 			    sizeof(checksum)))
843 				panic("%s: invalid optional metadata "
844 				    "checksum", DEVNAME(sc));
845 
846 			/* Determine correct length. */
847 			switch (omh->som_type) {
848 			case SR_OPT_CRYPTO:
849 				omh->som_length = sizeof(struct sr_meta_crypto);
850 				break;
851 			case SR_OPT_BOOT:
852 				omh->som_length = sizeof(struct sr_meta_boot);
853 				break;
854 			case SR_OPT_KEYDISK:
855 				omh->som_length =
856 				    sizeof(struct sr_meta_keydisk);
857 				break;
858 			default:
859 				panic("unknown old optional metadata "
860 				    "type %u\n", omh->som_type);
861 			}
862 
863 			omi->omi_som = malloc(omh->som_length, M_DEVBUF,
864 			    M_WAITOK | M_ZERO);
865 			memcpy((u_int8_t *)omi->omi_som + sizeof(*omi->omi_som),
866 			    (u_int8_t *)omh + SR_OLD_META_OPT_OFFSET,
867 			    omh->som_length - sizeof(*omi->omi_som));
868 			omi->omi_som->som_type = omh->som_type;
869 			omi->omi_som->som_length = omh->som_length;
870 
871 			omh = (struct sr_meta_opt_hdr *)((void *)omh +
872 			    SR_OLD_META_OPT_SIZE);
873 		} else {
874 
875 			/* Load variable length optional metadata. */
876 			DNPRINTF(SR_D_META, "%s: optional metadata of type %u, "
877 			    "length %u\n", DEVNAME(sc), omh->som_type,
878 			    omh->som_length);
879 			omi->omi_som = malloc(omh->som_length, M_DEVBUF,
880 			    M_WAITOK | M_ZERO);
881 			memcpy(omi->omi_som, omh, omh->som_length);
882 
883 			/* Validate checksum. */
884 			memcpy(&checksum, &omi->omi_som->som_checksum,
885 			    MD5_DIGEST_LENGTH);
886 			bzero(&omi->omi_som->som_checksum, MD5_DIGEST_LENGTH);
887 			sr_checksum(sc, omi->omi_som,
888 			    &omi->omi_som->som_checksum, omh->som_length);
889 			if (bcmp(&checksum, &omi->omi_som->som_checksum,
890 			    sizeof(checksum)))
891 				panic("%s: invalid optional metadata checksum",
892 				    DEVNAME(sc));
893 
894 			omh = (struct sr_meta_opt_hdr *)((void *)omh +
895 			    omh->som_length);
896 		}
897 	}
898 }
899 
900 int
901 sr_meta_validate(struct sr_discipline *sd, dev_t dev, struct sr_metadata *sm,
902     void *fm)
903 {
904 	struct sr_softc		*sc = sd->sd_sc;
905 	struct sr_meta_driver	*s;
906 #ifdef SR_DEBUG
907 	struct sr_meta_chunk	*mc;
908 #endif
909 	u_int8_t		checksum[MD5_DIGEST_LENGTH];
910 	char			devname[32];
911 	int			rv = 1;
912 
913 	DNPRINTF(SR_D_META, "%s: sr_meta_validate(%p)\n", DEVNAME(sc), sm);
914 
915 	sr_meta_getdevname(sc, dev, devname, sizeof(devname));
916 
917 	s = &smd[sd->sd_meta_type];
918 	if (sd->sd_meta_type != SR_META_F_NATIVE)
919 		if (s->smd_validate(sd, sm, fm)) {
920 			sr_error(sc, "invalid foreign metadata");
921 			goto done;
922 		}
923 
924 	/*
925 	 * at this point all foreign metadata has been translated to the native
926 	 * format and will be treated just like the native format
927 	 */
928 
929 	if (sm->ssdi.ssd_magic != SR_MAGIC) {
930 		sr_error(sc, "not valid softraid metadata");
931 		goto done;
932 	}
933 
934 	/* Verify metadata checksum. */
935 	sr_checksum(sc, sm, &checksum, sizeof(struct sr_meta_invariant));
936 	if (bcmp(&checksum, &sm->ssd_checksum, sizeof(checksum))) {
937 		sr_error(sc, "invalid metadata checksum");
938 		goto done;
939 	}
940 
941 	/* Handle changes between versions. */
942 	if (sm->ssdi.ssd_version == 3) {
943 
944 		/*
945 		 * Version 3 - update metadata version and fix up data blkno
946 		 * value since this did not exist in version 3.
947 		 */
948 		if (sm->ssd_data_blkno == 0)
949 			sm->ssd_data_blkno = SR_META_V3_DATA_OFFSET;
950 		sm->ssdi.ssd_secsize = DEV_BSIZE;
951 
952 	} else if (sm->ssdi.ssd_version == 4) {
953 
954 		/*
955 		 * Version 4 - original metadata format did not store
956 		 * data blkno so fix this up if necessary.
957 		 */
958 		if (sm->ssd_data_blkno == 0)
959 			sm->ssd_data_blkno = SR_DATA_OFFSET;
960 		sm->ssdi.ssd_secsize = DEV_BSIZE;
961 
962 	} else if (sm->ssdi.ssd_version == 5) {
963 
964 		/*
965 		 * Version 5 - variable length optional metadata. Migration
966 		 * from earlier fixed length optional metadata is handled
967 		 * in sr_meta_read().
968 		 */
969 		sm->ssdi.ssd_secsize = DEV_BSIZE;
970 
971 	} else if (sm->ssdi.ssd_version == SR_META_VERSION) {
972 
973 		/*
974 		 * Version 6 - store & report a sector size.
975 		 */
976 
977 	} else {
978 
979 		sr_error(sc, "cannot read metadata version %u on %s, "
980 		    "expected version %u or earlier",
981 		    sm->ssdi.ssd_version, devname, SR_META_VERSION);
982 		goto done;
983 
984 	}
985 
986 	/* Update version number and revision string. */
987 	sm->ssdi.ssd_version = SR_META_VERSION;
988 	snprintf(sm->ssdi.ssd_revision, sizeof(sm->ssdi.ssd_revision),
989 	    "%03d", SR_META_VERSION);
990 
991 #ifdef SR_DEBUG
992 	/* warn if disk changed order */
993 	mc = (struct sr_meta_chunk *)(sm + 1);
994 	if (strncmp(mc[sm->ssdi.ssd_chunk_id].scmi.scm_devname, devname,
995 	    sizeof(mc[sm->ssdi.ssd_chunk_id].scmi.scm_devname)))
996 		DNPRINTF(SR_D_META, "%s: roaming device %s -> %s\n",
997 		    DEVNAME(sc), mc[sm->ssdi.ssd_chunk_id].scmi.scm_devname,
998 		    devname);
999 #endif
1000 
1001 	/* we have meta data on disk */
1002 	DNPRINTF(SR_D_META, "%s: sr_meta_validate valid metadata %s\n",
1003 	    DEVNAME(sc), devname);
1004 
1005 	rv = 0;
1006 done:
1007 	return (rv);
1008 }
1009 
1010 int
1011 sr_meta_native_bootprobe(struct sr_softc *sc, dev_t devno,
1012     struct sr_boot_chunk_head *bch)
1013 {
1014 	struct vnode		*vn;
1015 	struct disklabel	label;
1016 	struct sr_metadata	*md = NULL;
1017 	struct sr_discipline	*fake_sd = NULL;
1018 	struct sr_boot_chunk	*bc;
1019 	char			devname[32];
1020 	dev_t			chrdev, rawdev;
1021 	int			error, i;
1022 	int			rv = SR_META_NOTCLAIMED;
1023 
1024 	DNPRINTF(SR_D_META, "%s: sr_meta_native_bootprobe\n", DEVNAME(sc));
1025 
1026 	/*
1027 	 * Use character raw device to avoid SCSI complaints about missing
1028 	 * media on removable media devices.
1029 	 */
1030 	chrdev = blktochr(devno);
1031 	rawdev = MAKEDISKDEV(major(chrdev), DISKUNIT(devno), RAW_PART);
1032 	if (cdevvp(rawdev, &vn)) {
1033 		sr_error(sc, "sr_meta_native_bootprobe: cannot allocate vnode");
1034 		goto done;
1035 	}
1036 
1037 	/* open device */
1038 	error = VOP_OPEN(vn, FREAD, NOCRED, curproc);
1039 	if (error) {
1040 		DNPRINTF(SR_D_META, "%s: sr_meta_native_bootprobe open "
1041 		    "failed\n", DEVNAME(sc));
1042 		vput(vn);
1043 		goto done;
1044 	}
1045 
1046 	/* get disklabel */
1047 	error = VOP_IOCTL(vn, DIOCGDINFO, (caddr_t)&label, FREAD, NOCRED,
1048 	    curproc);
1049 	if (error) {
1050 		DNPRINTF(SR_D_META, "%s: sr_meta_native_bootprobe ioctl "
1051 		    "failed\n", DEVNAME(sc));
1052 		VOP_CLOSE(vn, FREAD, NOCRED, curproc);
1053 		vput(vn);
1054 		goto done;
1055 	}
1056 
1057 	/* we are done, close device */
1058 	error = VOP_CLOSE(vn, FREAD, NOCRED, curproc);
1059 	if (error) {
1060 		DNPRINTF(SR_D_META, "%s: sr_meta_native_bootprobe close "
1061 		    "failed\n", DEVNAME(sc));
1062 		vput(vn);
1063 		goto done;
1064 	}
1065 	vput(vn);
1066 
1067 	md = malloc(SR_META_SIZE * DEV_BSIZE, M_DEVBUF, M_ZERO | M_NOWAIT);
1068 	if (md == NULL) {
1069 		sr_error(sc, "not enough memory for metadata buffer");
1070 		goto done;
1071 	}
1072 
1073 	/* create fake sd to use utility functions */
1074 	fake_sd = malloc(sizeof(struct sr_discipline), M_DEVBUF,
1075 	    M_ZERO | M_NOWAIT);
1076 	if (fake_sd == NULL) {
1077 		sr_error(sc, "not enough memory for fake discipline");
1078 		goto done;
1079 	}
1080 	fake_sd->sd_sc = sc;
1081 	fake_sd->sd_meta_type = SR_META_F_NATIVE;
1082 
1083 	for (i = 0; i < MAXPARTITIONS; i++) {
1084 		if (label.d_partitions[i].p_fstype != FS_RAID)
1085 			continue;
1086 
1087 		/* open partition */
1088 		rawdev = MAKEDISKDEV(major(devno), DISKUNIT(devno), i);
1089 		if (bdevvp(rawdev, &vn)) {
1090 			sr_error(sc, "sr_meta_native_bootprobe: cannot "
1091 			    "allocate vnode for partition");
1092 			goto done;
1093 		}
1094 		error = VOP_OPEN(vn, FREAD, NOCRED, curproc);
1095 		if (error) {
1096 			DNPRINTF(SR_D_META, "%s: sr_meta_native_bootprobe "
1097 			    "open failed, partition %d\n",
1098 			    DEVNAME(sc), i);
1099 			vput(vn);
1100 			continue;
1101 		}
1102 
1103 		if (sr_meta_native_read(fake_sd, rawdev, md, NULL)) {
1104 			sr_error(sc, "native bootprobe could not read native "
1105 			    "metadata");
1106 			VOP_CLOSE(vn, FREAD, NOCRED, curproc);
1107 			vput(vn);
1108 			continue;
1109 		}
1110 
1111 		/* are we a softraid partition? */
1112 		if (md->ssdi.ssd_magic != SR_MAGIC) {
1113 			VOP_CLOSE(vn, FREAD, NOCRED, curproc);
1114 			vput(vn);
1115 			continue;
1116 		}
1117 
1118 		sr_meta_getdevname(sc, rawdev, devname, sizeof(devname));
1119 		if (sr_meta_validate(fake_sd, rawdev, md, NULL) == 0) {
1120 			/* XXX fix M_WAITOK, this is boot time */
1121 			bc = malloc(sizeof(struct sr_boot_chunk),
1122 			    M_DEVBUF, M_WAITOK | M_ZERO);
1123 			bc->sbc_metadata = malloc(sizeof(struct sr_metadata),
1124 			    M_DEVBUF, M_WAITOK | M_ZERO);
1125 			memcpy(bc->sbc_metadata, md, sizeof(struct sr_metadata));
1126 			bc->sbc_mm = rawdev;
1127 			SLIST_INSERT_HEAD(bch, bc, sbc_link);
1128 			rv = SR_META_CLAIMED;
1129 		}
1130 
1131 		/* we are done, close partition */
1132 		VOP_CLOSE(vn, FREAD, NOCRED, curproc);
1133 		vput(vn);
1134 	}
1135 
1136 done:
1137 	free(fake_sd, M_DEVBUF, sizeof(struct sr_discipline));
1138 	free(md, M_DEVBUF, SR_META_SIZE * DEV_BSIZE);
1139 
1140 	return (rv);
1141 }
1142 
1143 int
1144 sr_boot_assembly(struct sr_softc *sc)
1145 {
1146 	struct sr_boot_volume_head bvh;
1147 	struct sr_boot_chunk_head bch, kdh;
1148 	struct sr_boot_volume	*bv, *bv1, *bv2;
1149 	struct sr_boot_chunk	*bc, *bcnext, *bc1, *bc2;
1150 	struct sr_disk_head	sdklist;
1151 	struct sr_disk		*sdk;
1152 	struct disk		*dk;
1153 	struct bioc_createraid	bcr;
1154 	struct sr_meta_chunk	*hm;
1155 	struct sr_chunk_head	*cl;
1156 	struct sr_chunk		*hotspare, *chunk, *last;
1157 	u_int64_t		*ondisk = NULL;
1158 	dev_t			*devs = NULL;
1159 	void			*data;
1160 	char			devname[32];
1161 	int			rv = 0, i;
1162 
1163 	DNPRINTF(SR_D_META, "%s: sr_boot_assembly\n", DEVNAME(sc));
1164 
1165 	SLIST_INIT(&sdklist);
1166 	SLIST_INIT(&bvh);
1167 	SLIST_INIT(&bch);
1168 	SLIST_INIT(&kdh);
1169 
1170 	dk = TAILQ_FIRST(&disklist);
1171 	while (dk != NULL) {
1172 
1173 		/* See if this disk has been checked. */
1174 		SLIST_FOREACH(sdk, &sdklist, sdk_link)
1175 			if (sdk->sdk_devno == dk->dk_devno)
1176 				break;
1177 
1178 		if (sdk != NULL || dk->dk_devno == NODEV) {
1179 			dk = TAILQ_NEXT(dk, dk_link);
1180 			continue;
1181 		}
1182 
1183 		/* Add this disk to the list that we've checked. */
1184 		sdk = malloc(sizeof(struct sr_disk), M_DEVBUF,
1185 		    M_NOWAIT | M_ZERO);
1186 		if (sdk == NULL)
1187 			goto unwind;
1188 		sdk->sdk_devno = dk->dk_devno;
1189 		SLIST_INSERT_HEAD(&sdklist, sdk, sdk_link);
1190 
1191 		/* Only check sd(4) and wd(4) devices. */
1192 		if (strncmp(dk->dk_name, "sd", 2) &&
1193 		    strncmp(dk->dk_name, "wd", 2)) {
1194 			dk = TAILQ_NEXT(dk, dk_link);
1195 			continue;
1196 		}
1197 
1198 		/* native softraid uses partitions */
1199 		rw_enter_write(&sc->sc_lock);
1200 		bio_status_init(&sc->sc_status, &sc->sc_dev);
1201 		sr_meta_native_bootprobe(sc, dk->dk_devno, &bch);
1202 		rw_exit_write(&sc->sc_lock);
1203 
1204 		/* probe non-native disks if native failed. */
1205 
1206 		/* Restart scan since we may have slept. */
1207 		dk = TAILQ_FIRST(&disklist);
1208 	}
1209 
1210 	/*
1211 	 * Create a list of volumes and associate chunks with each volume.
1212 	 */
1213 	for (bc = SLIST_FIRST(&bch); bc != NULL; bc = bcnext) {
1214 
1215 		bcnext = SLIST_NEXT(bc, sbc_link);
1216 		SLIST_REMOVE(&bch, bc, sr_boot_chunk, sbc_link);
1217 		bc->sbc_chunk_id = bc->sbc_metadata->ssdi.ssd_chunk_id;
1218 
1219 		/* Handle key disks separately. */
1220 		if (bc->sbc_metadata->ssdi.ssd_level == SR_KEYDISK_LEVEL) {
1221 			SLIST_INSERT_HEAD(&kdh, bc, sbc_link);
1222 			continue;
1223 		}
1224 
1225 		SLIST_FOREACH(bv, &bvh, sbv_link) {
1226 			if (bcmp(&bc->sbc_metadata->ssdi.ssd_uuid,
1227 			    &bv->sbv_uuid,
1228 			    sizeof(bc->sbc_metadata->ssdi.ssd_uuid)) == 0)
1229 				break;
1230 		}
1231 
1232 		if (bv == NULL) {
1233 			bv = malloc(sizeof(struct sr_boot_volume),
1234 			    M_DEVBUF, M_NOWAIT | M_ZERO);
1235 			if (bv == NULL) {
1236 				printf("%s: failed to allocate boot volume\n",
1237 				    DEVNAME(sc));
1238 				goto unwind;
1239 			}
1240 
1241 			bv->sbv_level = bc->sbc_metadata->ssdi.ssd_level;
1242 			bv->sbv_volid = bc->sbc_metadata->ssdi.ssd_volid;
1243 			bv->sbv_chunk_no = bc->sbc_metadata->ssdi.ssd_chunk_no;
1244 			bv->sbv_flags = bc->sbc_metadata->ssdi.ssd_vol_flags;
1245 			memcpy(&bv->sbv_uuid, &bc->sbc_metadata->ssdi.ssd_uuid,
1246 			    sizeof(bc->sbc_metadata->ssdi.ssd_uuid));
1247 			SLIST_INIT(&bv->sbv_chunks);
1248 
1249 			/* Maintain volume order. */
1250 			bv2 = NULL;
1251 			SLIST_FOREACH(bv1, &bvh, sbv_link) {
1252 				if (bv1->sbv_volid > bv->sbv_volid)
1253 					break;
1254 				bv2 = bv1;
1255 			}
1256 			if (bv2 == NULL) {
1257 				DNPRINTF(SR_D_META, "%s: insert volume %u "
1258 				    "at head\n", DEVNAME(sc), bv->sbv_volid);
1259 				SLIST_INSERT_HEAD(&bvh, bv, sbv_link);
1260 			} else {
1261 				DNPRINTF(SR_D_META, "%s: insert volume %u "
1262 				    "after %u\n", DEVNAME(sc), bv->sbv_volid,
1263 				    bv2->sbv_volid);
1264 				SLIST_INSERT_AFTER(bv2, bv, sbv_link);
1265 			}
1266 		}
1267 
1268 		/* Maintain chunk order. */
1269 		bc2 = NULL;
1270 		SLIST_FOREACH(bc1, &bv->sbv_chunks, sbc_link) {
1271 			if (bc1->sbc_chunk_id > bc->sbc_chunk_id)
1272 				break;
1273 			bc2 = bc1;
1274 		}
1275 		if (bc2 == NULL) {
1276 			DNPRINTF(SR_D_META, "%s: volume %u insert chunk %u "
1277 			    "at head\n", DEVNAME(sc), bv->sbv_volid,
1278 			    bc->sbc_chunk_id);
1279 			SLIST_INSERT_HEAD(&bv->sbv_chunks, bc, sbc_link);
1280 		} else {
1281 			DNPRINTF(SR_D_META, "%s: volume %u insert chunk %u "
1282 			    "after %u\n", DEVNAME(sc), bv->sbv_volid,
1283 			    bc->sbc_chunk_id, bc2->sbc_chunk_id);
1284 			SLIST_INSERT_AFTER(bc2, bc, sbc_link);
1285 		}
1286 
1287 		bv->sbv_chunks_found++;
1288 	}
1289 
1290 	/* Allocate memory for device and ondisk version arrays. */
1291 	devs = mallocarray(BIOC_CRMAXLEN, sizeof(dev_t), M_DEVBUF,
1292 	    M_NOWAIT);
1293 	if (devs == NULL) {
1294 		printf("%s: failed to allocate device array\n", DEVNAME(sc));
1295 		goto unwind;
1296 	}
1297 	ondisk = mallocarray(BIOC_CRMAXLEN, sizeof(u_int64_t), M_DEVBUF,
1298 	    M_NOWAIT);
1299 	if (ondisk == NULL) {
1300 		printf("%s: failed to allocate ondisk array\n", DEVNAME(sc));
1301 		goto unwind;
1302 	}
1303 
1304 	/*
1305 	 * Assemble hotspare "volumes".
1306 	 */
1307 	SLIST_FOREACH(bv, &bvh, sbv_link) {
1308 
1309 		/* Check if this is a hotspare "volume". */
1310 		if (bv->sbv_level != SR_HOTSPARE_LEVEL ||
1311 		    bv->sbv_chunk_no != 1)
1312 			continue;
1313 
1314 #ifdef SR_DEBUG
1315 		DNPRINTF(SR_D_META, "%s: assembling hotspare volume ",
1316 		    DEVNAME(sc));
1317 		if (sr_debug & SR_D_META)
1318 			sr_uuid_print(&bv->sbv_uuid, 0);
1319 		DNPRINTF(SR_D_META, " volid %u with %u chunks\n",
1320 		    bv->sbv_volid, bv->sbv_chunk_no);
1321 #endif
1322 
1323 		/* Create hotspare chunk metadata. */
1324 		hotspare = malloc(sizeof(struct sr_chunk), M_DEVBUF,
1325 		    M_NOWAIT | M_ZERO);
1326 		if (hotspare == NULL) {
1327 			printf("%s: failed to allocate hotspare\n",
1328 			    DEVNAME(sc));
1329 			goto unwind;
1330 		}
1331 
1332 		bc = SLIST_FIRST(&bv->sbv_chunks);
1333 		sr_meta_getdevname(sc, bc->sbc_mm, devname, sizeof(devname));
1334 		hotspare->src_dev_mm = bc->sbc_mm;
1335 		strlcpy(hotspare->src_devname, devname,
1336 		    sizeof(hotspare->src_devname));
1337 		hotspare->src_size = bc->sbc_metadata->ssdi.ssd_size;
1338 
1339 		hm = &hotspare->src_meta;
1340 		hm->scmi.scm_volid = SR_HOTSPARE_VOLID;
1341 		hm->scmi.scm_chunk_id = 0;
1342 		hm->scmi.scm_size = bc->sbc_metadata->ssdi.ssd_size;
1343 		hm->scmi.scm_coerced_size = bc->sbc_metadata->ssdi.ssd_size;
1344 		strlcpy(hm->scmi.scm_devname, devname,
1345 		    sizeof(hm->scmi.scm_devname));
1346 		memcpy(&hm->scmi.scm_uuid, &bc->sbc_metadata->ssdi.ssd_uuid,
1347 		    sizeof(struct sr_uuid));
1348 
1349 		sr_checksum(sc, hm, &hm->scm_checksum,
1350 		    sizeof(struct sr_meta_chunk_invariant));
1351 
1352 		hm->scm_status = BIOC_SDHOTSPARE;
1353 
1354 		/* Add chunk to hotspare list. */
1355 		rw_enter_write(&sc->sc_hs_lock);
1356 		cl = &sc->sc_hotspare_list;
1357 		if (SLIST_EMPTY(cl))
1358 			SLIST_INSERT_HEAD(cl, hotspare, src_link);
1359 		else {
1360 			SLIST_FOREACH(chunk, cl, src_link)
1361 				last = chunk;
1362 			SLIST_INSERT_AFTER(last, hotspare, src_link);
1363 		}
1364 		sc->sc_hotspare_no++;
1365 		rw_exit_write(&sc->sc_hs_lock);
1366 
1367 	}
1368 
1369 	/*
1370 	 * Assemble RAID volumes.
1371 	 */
1372 	SLIST_FOREACH(bv, &bvh, sbv_link) {
1373 
1374 		bzero(&bcr, sizeof(bcr));
1375 		data = NULL;
1376 
1377 		/* Check if this is a hotspare "volume". */
1378 		if (bv->sbv_level == SR_HOTSPARE_LEVEL &&
1379 		    bv->sbv_chunk_no == 1)
1380 			continue;
1381 
1382 		/*
1383 		 * Skip volumes that are marked as no auto assemble, unless
1384 		 * this was the volume which we actually booted from.
1385 		 */
1386 		if (bcmp(&sr_bootuuid, &bv->sbv_uuid, sizeof(sr_bootuuid)) != 0)
1387 			if (bv->sbv_flags & BIOC_SCNOAUTOASSEMBLE)
1388 				continue;
1389 
1390 #ifdef SR_DEBUG
1391 		DNPRINTF(SR_D_META, "%s: assembling volume ", DEVNAME(sc));
1392 		if (sr_debug & SR_D_META)
1393 			sr_uuid_print(&bv->sbv_uuid, 0);
1394 		DNPRINTF(SR_D_META, " volid %u with %u chunks\n",
1395 		    bv->sbv_volid, bv->sbv_chunk_no);
1396 #endif
1397 
1398 		/*
1399 		 * If this is a crypto volume, try to find a matching
1400 		 * key disk...
1401 		 */
1402 		bcr.bc_key_disk = NODEV;
1403 		if (bv->sbv_level == 'C') {
1404 			SLIST_FOREACH(bc, &kdh, sbc_link) {
1405 				if (bcmp(&bc->sbc_metadata->ssdi.ssd_uuid,
1406 				    &bv->sbv_uuid,
1407 				    sizeof(bc->sbc_metadata->ssdi.ssd_uuid))
1408 				    == 0)
1409 					bcr.bc_key_disk = bc->sbc_mm;
1410 			}
1411 		}
1412 
1413 		for (i = 0; i < BIOC_CRMAXLEN; i++) {
1414 			devs[i] = NODEV; /* mark device as illegal */
1415 			ondisk[i] = 0;
1416 		}
1417 
1418 		SLIST_FOREACH(bc, &bv->sbv_chunks, sbc_link) {
1419 			if (devs[bc->sbc_chunk_id] != NODEV) {
1420 				bv->sbv_chunks_found--;
1421 				sr_meta_getdevname(sc, bc->sbc_mm, devname,
1422 				    sizeof(devname));
1423 				printf("%s: found duplicate chunk %u for "
1424 				    "volume %u on device %s\n", DEVNAME(sc),
1425 				    bc->sbc_chunk_id, bv->sbv_volid, devname);
1426 			}
1427 
1428 			if (devs[bc->sbc_chunk_id] == NODEV ||
1429 			    bc->sbc_metadata->ssd_ondisk >
1430 			    ondisk[bc->sbc_chunk_id]) {
1431 				devs[bc->sbc_chunk_id] = bc->sbc_mm;
1432 				ondisk[bc->sbc_chunk_id] =
1433 				    bc->sbc_metadata->ssd_ondisk;
1434 				DNPRINTF(SR_D_META, "%s: using ondisk "
1435 				    "metadata version %llu for chunk %u\n",
1436 				    DEVNAME(sc), ondisk[bc->sbc_chunk_id],
1437 				    bc->sbc_chunk_id);
1438 			}
1439 		}
1440 
1441 		if (bv->sbv_chunk_no != bv->sbv_chunks_found) {
1442 			printf("%s: not all chunks were provided; "
1443 			    "attempting to bring volume %d online\n",
1444 			    DEVNAME(sc), bv->sbv_volid);
1445 		}
1446 
1447 		bcr.bc_level = bv->sbv_level;
1448 		bcr.bc_dev_list_len = bv->sbv_chunk_no * sizeof(dev_t);
1449 		bcr.bc_dev_list = devs;
1450 		bcr.bc_flags = BIOC_SCDEVT |
1451 		    (bv->sbv_flags & BIOC_SCNOAUTOASSEMBLE);
1452 
1453 		if (bv->sbv_level == 'C' &&
1454 		    bcmp(&sr_bootuuid, &bv->sbv_uuid, sizeof(sr_bootuuid)) == 0)
1455 			data = sr_bootkey;
1456 
1457 		rw_enter_write(&sc->sc_lock);
1458 		bio_status_init(&sc->sc_status, &sc->sc_dev);
1459 		sr_ioctl_createraid(sc, &bcr, 0, data);
1460 		rw_exit_write(&sc->sc_lock);
1461 
1462 		rv++;
1463 	}
1464 
1465 	/* done with metadata */
1466 unwind:
1467 	/* Free boot volumes and associated chunks. */
1468 	for (bv1 = SLIST_FIRST(&bvh); bv1 != NULL; bv1 = bv2) {
1469 		bv2 = SLIST_NEXT(bv1, sbv_link);
1470 		for (bc1 = SLIST_FIRST(&bv1->sbv_chunks); bc1 != NULL;
1471 		    bc1 = bc2) {
1472 			bc2 = SLIST_NEXT(bc1, sbc_link);
1473 			free(bc1->sbc_metadata, M_DEVBUF, 0);
1474 			free(bc1, M_DEVBUF, 0);
1475 		}
1476 		free(bv1, M_DEVBUF, 0);
1477 	}
1478 	/* Free keydisks chunks. */
1479 	for (bc1 = SLIST_FIRST(&kdh); bc1 != NULL; bc1 = bc2) {
1480 		bc2 = SLIST_NEXT(bc1, sbc_link);
1481 		free(bc1->sbc_metadata, M_DEVBUF, 0);
1482 		free(bc1, M_DEVBUF, 0);
1483 	}
1484 	/* Free unallocated chunks. */
1485 	for (bc1 = SLIST_FIRST(&bch); bc1 != NULL; bc1 = bc2) {
1486 		bc2 = SLIST_NEXT(bc1, sbc_link);
1487 		free(bc1->sbc_metadata, M_DEVBUF, 0);
1488 		free(bc1, M_DEVBUF, 0);
1489 	}
1490 
1491 	while (!SLIST_EMPTY(&sdklist)) {
1492 		sdk = SLIST_FIRST(&sdklist);
1493 		SLIST_REMOVE_HEAD(&sdklist, sdk_link);
1494 		free(sdk, M_DEVBUF, 0);
1495 	}
1496 
1497 	free(devs, M_DEVBUF, BIOC_CRMAXLEN * sizeof(dev_t));
1498 	free(ondisk, M_DEVBUF, BIOC_CRMAXLEN * sizeof(u_int64_t));
1499 
1500 	return (rv);
1501 }
1502 
1503 void
1504 sr_map_root(void)
1505 {
1506 	struct sr_softc		*sc = softraid0;
1507 	struct sr_discipline	*sd;
1508 	struct sr_meta_opt_item	*omi;
1509 	struct sr_meta_boot	*sbm;
1510 	u_char			duid[8];
1511 	int			i;
1512 
1513 	DNPRINTF(SR_D_MISC, "%s: sr_map_root\n", DEVNAME(sc));
1514 
1515 	if (sc == NULL)
1516 		return;
1517 
1518 	bzero(duid, sizeof(duid));
1519 	if (bcmp(rootduid, duid, sizeof(duid)) == 0) {
1520 		DNPRINTF(SR_D_MISC, "%s: root duid is zero\n", DEVNAME(sc));
1521 		return;
1522 	}
1523 
1524 	TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
1525 		SLIST_FOREACH(omi, &sd->sd_meta_opt, omi_link) {
1526 			if (omi->omi_som->som_type != SR_OPT_BOOT)
1527 				continue;
1528 			sbm = (struct sr_meta_boot *)omi->omi_som;
1529 			for (i = 0; i < SR_MAX_BOOT_DISKS; i++) {
1530 				if (bcmp(rootduid, sbm->sbm_boot_duid[i],
1531 				    sizeof(rootduid)) == 0) {
1532 					memcpy(rootduid, sbm->sbm_root_duid,
1533 					    sizeof(rootduid));
1534 					DNPRINTF(SR_D_MISC, "%s: root duid "
1535 					    "mapped to %02hx%02hx%02hx%02hx"
1536 					    "%02hx%02hx%02hx%02hx\n",
1537 					    DEVNAME(sc), rootduid[0],
1538 					    rootduid[1], rootduid[2],
1539 					    rootduid[3], rootduid[4],
1540 					    rootduid[5], rootduid[6],
1541 					    rootduid[7]);
1542 					return;
1543 				}
1544 			}
1545 		}
1546 	}
1547 }
1548 
1549 int
1550 sr_meta_native_probe(struct sr_softc *sc, struct sr_chunk *ch_entry)
1551 {
1552 	struct disklabel	label;
1553 	char			*devname;
1554 	int			error, part;
1555 	u_int64_t		size;
1556 
1557 	DNPRINTF(SR_D_META, "%s: sr_meta_native_probe(%s)\n",
1558 	   DEVNAME(sc), ch_entry->src_devname);
1559 
1560 	devname = ch_entry->src_devname;
1561 	part = DISKPART(ch_entry->src_dev_mm);
1562 
1563 	/* get disklabel */
1564 	error = VOP_IOCTL(ch_entry->src_vn, DIOCGDINFO, (caddr_t)&label, FREAD,
1565 	    NOCRED, curproc);
1566 	if (error) {
1567 		DNPRINTF(SR_D_META, "%s: %s can't obtain disklabel\n",
1568 		    DEVNAME(sc), devname);
1569 		goto unwind;
1570 	}
1571 	memcpy(ch_entry->src_duid, label.d_uid, sizeof(ch_entry->src_duid));
1572 
1573 	/* make sure the partition is of the right type */
1574 	if (label.d_partitions[part].p_fstype != FS_RAID) {
1575 		DNPRINTF(SR_D_META,
1576 		    "%s: %s partition not of type RAID (%d)\n", DEVNAME(sc),
1577 		    devname,
1578 		    label.d_partitions[part].p_fstype);
1579 		goto unwind;
1580 	}
1581 
1582 	size = DL_SECTOBLK(&label, DL_GETPSIZE(&label.d_partitions[part]));
1583 	if (size <= SR_DATA_OFFSET) {
1584 		DNPRINTF(SR_D_META, "%s: %s partition too small\n", DEVNAME(sc),
1585 		    devname);
1586 		goto unwind;
1587 	}
1588 	size -= SR_DATA_OFFSET;
1589 	if (size > INT64_MAX) {
1590 		DNPRINTF(SR_D_META, "%s: %s partition too large\n", DEVNAME(sc),
1591 		    devname);
1592 		goto unwind;
1593 	}
1594 	ch_entry->src_size = size;
1595 	ch_entry->src_secsize = label.d_secsize;
1596 
1597 	DNPRINTF(SR_D_META, "%s: probe found %s size %lld\n", DEVNAME(sc),
1598 	    devname, (long long)size);
1599 
1600 	return (SR_META_F_NATIVE);
1601 unwind:
1602 	DNPRINTF(SR_D_META, "%s: invalid device: %s\n", DEVNAME(sc),
1603 	    devname ? devname : "nodev");
1604 	return (SR_META_F_INVALID);
1605 }
1606 
1607 int
1608 sr_meta_native_attach(struct sr_discipline *sd, int force)
1609 {
1610 	struct sr_softc		*sc = sd->sd_sc;
1611 	struct sr_chunk_head	*cl = &sd->sd_vol.sv_chunk_list;
1612 	struct sr_metadata	*md = NULL;
1613 	struct sr_chunk		*ch_entry, *ch_next;
1614 	struct sr_uuid		uuid;
1615 	u_int64_t		version = 0;
1616 	int			sr, not_sr, rv = 1, d, expected = -1, old_meta = 0;
1617 
1618 	DNPRINTF(SR_D_META, "%s: sr_meta_native_attach\n", DEVNAME(sc));
1619 
1620 	md = malloc(SR_META_SIZE * DEV_BSIZE, M_DEVBUF, M_ZERO | M_NOWAIT);
1621 	if (md == NULL) {
1622 		sr_error(sc, "not enough memory for metadata buffer");
1623 		goto bad;
1624 	}
1625 
1626 	bzero(&uuid, sizeof uuid);
1627 
1628 	sr = not_sr = d = 0;
1629 	SLIST_FOREACH(ch_entry, cl, src_link) {
1630 		if (ch_entry->src_dev_mm == NODEV)
1631 			continue;
1632 
1633 		if (sr_meta_native_read(sd, ch_entry->src_dev_mm, md, NULL)) {
1634 			sr_error(sc, "could not read native metadata");
1635 			goto bad;
1636 		}
1637 
1638 		if (md->ssdi.ssd_magic == SR_MAGIC) {
1639 			sr++;
1640 			ch_entry->src_meta.scmi.scm_chunk_id =
1641 			    md->ssdi.ssd_chunk_id;
1642 			if (d == 0) {
1643 				memcpy(&uuid, &md->ssdi.ssd_uuid, sizeof uuid);
1644 				expected = md->ssdi.ssd_chunk_no;
1645 				version = md->ssd_ondisk;
1646 				d++;
1647 				continue;
1648 			} else if (bcmp(&md->ssdi.ssd_uuid, &uuid,
1649 			    sizeof uuid)) {
1650 				sr_error(sc, "not part of the same volume");
1651 				goto bad;
1652 			}
1653 			if (md->ssd_ondisk != version) {
1654 				old_meta++;
1655 				version = MAX(md->ssd_ondisk, version);
1656 			}
1657 		} else
1658 			not_sr++;
1659 	}
1660 
1661 	if (sr && not_sr && !force) {
1662 		sr_error(sc, "not all chunks are of the native metadata "
1663 		    "format");
1664 		goto bad;
1665 	}
1666 
1667 	/* mixed metadata versions; mark bad disks offline */
1668 	if (old_meta) {
1669 		d = 0;
1670 		for (ch_entry = SLIST_FIRST(cl); ch_entry != NULL;
1671 		    ch_entry = ch_next, d++) {
1672 			ch_next = SLIST_NEXT(ch_entry, src_link);
1673 
1674 			/* XXX do we want to read this again? */
1675 			if (ch_entry->src_dev_mm == NODEV)
1676 				panic("src_dev_mm == NODEV");
1677 			if (sr_meta_native_read(sd, ch_entry->src_dev_mm, md,
1678 			    NULL))
1679 				sr_warn(sc, "could not read native metadata");
1680 			if (md->ssd_ondisk != version)
1681 				sd->sd_vol.sv_chunks[d]->src_meta.scm_status =
1682 				    BIOC_SDOFFLINE;
1683 		}
1684 	}
1685 
1686 	if (expected != sr && !force && expected != -1) {
1687 		DNPRINTF(SR_D_META, "%s: not all chunks were provided, trying "
1688 		    "anyway\n", DEVNAME(sc));
1689 	}
1690 
1691 	rv = 0;
1692 bad:
1693 	free(md, M_DEVBUF, SR_META_SIZE * DEV_BSIZE);
1694 	return (rv);
1695 }
1696 
1697 int
1698 sr_meta_native_read(struct sr_discipline *sd, dev_t dev,
1699     struct sr_metadata *md, void *fm)
1700 {
1701 #ifdef SR_DEBUG
1702 	struct sr_softc		*sc = sd->sd_sc;
1703 #endif
1704 	DNPRINTF(SR_D_META, "%s: sr_meta_native_read(0x%x, %p)\n",
1705 	    DEVNAME(sc), dev, md);
1706 
1707 	return (sr_meta_rw(sd, dev, md, B_READ));
1708 }
1709 
1710 int
1711 sr_meta_native_write(struct sr_discipline *sd, dev_t dev,
1712     struct sr_metadata *md, void *fm)
1713 {
1714 #ifdef SR_DEBUG
1715 	struct sr_softc		*sc = sd->sd_sc;
1716 #endif
1717 	DNPRINTF(SR_D_META, "%s: sr_meta_native_write(0x%x, %p)\n",
1718 	    DEVNAME(sc), dev, md);
1719 
1720 	return (sr_meta_rw(sd, dev, md, B_WRITE));
1721 }
1722 
1723 void
1724 sr_hotplug_register(struct sr_discipline *sd, void *func)
1725 {
1726 	struct sr_hotplug_list	*mhe;
1727 
1728 	DNPRINTF(SR_D_MISC, "%s: sr_hotplug_register: %p\n",
1729 	    DEVNAME(sd->sd_sc), func);
1730 
1731 	/* make sure we aren't on the list yet */
1732 	SLIST_FOREACH(mhe, &sr_hotplug_callbacks, shl_link)
1733 		if (mhe->sh_hotplug == func)
1734 			return;
1735 
1736 	mhe = malloc(sizeof(struct sr_hotplug_list), M_DEVBUF,
1737 	    M_WAITOK | M_ZERO);
1738 	mhe->sh_hotplug = func;
1739 	mhe->sh_sd = sd;
1740 	SLIST_INSERT_HEAD(&sr_hotplug_callbacks, mhe, shl_link);
1741 }
1742 
1743 void
1744 sr_hotplug_unregister(struct sr_discipline *sd, void *func)
1745 {
1746 	struct sr_hotplug_list	*mhe;
1747 
1748 	DNPRINTF(SR_D_MISC, "%s: sr_hotplug_unregister: %s %p\n",
1749 	    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname, func);
1750 
1751 	/* make sure we are on the list yet */
1752 	SLIST_FOREACH(mhe, &sr_hotplug_callbacks, shl_link) {
1753 		if (mhe->sh_hotplug == func)
1754 			break;
1755 	}
1756 	if (mhe != NULL) {
1757 		SLIST_REMOVE(&sr_hotplug_callbacks, mhe,
1758 		    sr_hotplug_list, shl_link);
1759 		free(mhe, M_DEVBUF, 0);
1760 	}
1761 }
1762 
1763 void
1764 sr_disk_attach(struct disk *diskp, int action)
1765 {
1766 	struct sr_hotplug_list	*mhe;
1767 
1768 	SLIST_FOREACH(mhe, &sr_hotplug_callbacks, shl_link)
1769 		if (mhe->sh_sd->sd_ready)
1770 			mhe->sh_hotplug(mhe->sh_sd, diskp, action);
1771 }
1772 
1773 int
1774 sr_match(struct device *parent, void *match, void *aux)
1775 {
1776 	return (1);
1777 }
1778 
1779 void
1780 sr_attach(struct device *parent, struct device *self, void *aux)
1781 {
1782 	struct sr_softc		*sc = (void *)self;
1783 	struct scsibus_attach_args saa;
1784 
1785 	DNPRINTF(SR_D_MISC, "\n%s: sr_attach", DEVNAME(sc));
1786 
1787 	if (softraid0 == NULL)
1788 		softraid0 = sc;
1789 
1790 	rw_init(&sc->sc_lock, "sr_lock");
1791 	rw_init(&sc->sc_hs_lock, "sr_hs_lock");
1792 
1793 	SLIST_INIT(&sr_hotplug_callbacks);
1794 	TAILQ_INIT(&sc->sc_dis_list);
1795 	SLIST_INIT(&sc->sc_hotspare_list);
1796 
1797 #if NBIO > 0
1798 	if (bio_register(&sc->sc_dev, sr_bio_ioctl) != 0)
1799 		printf("%s: controller registration failed", DEVNAME(sc));
1800 #endif /* NBIO > 0 */
1801 
1802 #ifndef SMALL_KERNEL
1803 	strlcpy(sc->sc_sensordev.xname, DEVNAME(sc),
1804 	    sizeof(sc->sc_sensordev.xname));
1805 	sensordev_install(&sc->sc_sensordev);
1806 #endif /* SMALL_KERNEL */
1807 
1808 	printf("\n");
1809 
1810 	sc->sc_link.adapter_softc = sc;
1811 	sc->sc_link.adapter = &sr_switch;
1812 	sc->sc_link.adapter_target = SR_MAX_LD;
1813 	sc->sc_link.adapter_buswidth = SR_MAX_LD;
1814 	sc->sc_link.luns = 1;
1815 
1816 	bzero(&saa, sizeof(saa));
1817 	saa.saa_sc_link = &sc->sc_link;
1818 
1819 	sc->sc_scsibus = (struct scsibus_softc *)config_found(&sc->sc_dev,
1820 	    &saa, scsiprint);
1821 
1822 	softraid_disk_attach = sr_disk_attach;
1823 
1824 	sr_boot_assembly(sc);
1825 
1826 	explicit_bzero(sr_bootkey, sizeof(sr_bootkey));
1827 }
1828 
1829 int
1830 sr_detach(struct device *self, int flags)
1831 {
1832 	struct sr_softc		*sc = (void *)self;
1833 	int			rv;
1834 
1835 	DNPRINTF(SR_D_MISC, "%s: sr_detach\n", DEVNAME(sc));
1836 
1837 	softraid_disk_attach = NULL;
1838 
1839 	sr_shutdown();
1840 
1841 #ifndef SMALL_KERNEL
1842 	if (sc->sc_sensor_task != NULL)
1843 		sensor_task_unregister(sc->sc_sensor_task);
1844 	sensordev_deinstall(&sc->sc_sensordev);
1845 #endif /* SMALL_KERNEL */
1846 
1847 	if (sc->sc_scsibus != NULL) {
1848 		rv = config_detach((struct device *)sc->sc_scsibus, flags);
1849 		if (rv != 0)
1850 			return (rv);
1851 		sc->sc_scsibus = NULL;
1852 	}
1853 
1854 	return (0);
1855 }
1856 
1857 void
1858 sr_info(struct sr_softc *sc, const char *fmt, ...)
1859 {
1860 	va_list			ap;
1861 
1862 	rw_assert_wrlock(&sc->sc_lock);
1863 
1864 	va_start(ap, fmt);
1865 	bio_status(&sc->sc_status, 0, BIO_MSG_INFO, fmt, &ap);
1866 	va_end(ap);
1867 }
1868 
1869 void
1870 sr_warn(struct sr_softc *sc, const char *fmt, ...)
1871 {
1872 	va_list			ap;
1873 
1874 	rw_assert_wrlock(&sc->sc_lock);
1875 
1876 	va_start(ap, fmt);
1877 	bio_status(&sc->sc_status, 1, BIO_MSG_WARN, fmt, &ap);
1878 	va_end(ap);
1879 }
1880 
1881 void
1882 sr_error(struct sr_softc *sc, const char *fmt, ...)
1883 {
1884 	va_list			ap;
1885 
1886 	rw_assert_wrlock(&sc->sc_lock);
1887 
1888 	va_start(ap, fmt);
1889 	bio_status(&sc->sc_status, 1, BIO_MSG_ERROR, fmt, &ap);
1890 	va_end(ap);
1891 }
1892 
1893 void
1894 sr_minphys(struct buf *bp, struct scsi_link *sl)
1895 {
1896 	DNPRINTF(SR_D_MISC, "sr_minphys: %ld\n", bp->b_bcount);
1897 
1898 	/* XXX currently using SR_MAXFER = MAXPHYS */
1899 	if (bp->b_bcount > SR_MAXFER)
1900 		bp->b_bcount = SR_MAXFER;
1901 	minphys(bp);
1902 }
1903 
1904 void
1905 sr_copy_internal_data(struct scsi_xfer *xs, void *v, size_t size)
1906 {
1907 	size_t			copy_cnt;
1908 
1909 	DNPRINTF(SR_D_MISC, "sr_copy_internal_data xs: %p size: %zu\n",
1910 	    xs, size);
1911 
1912 	if (xs->datalen) {
1913 		copy_cnt = MIN(size, xs->datalen);
1914 		memcpy(xs->data, v, copy_cnt);
1915 	}
1916 }
1917 
1918 int
1919 sr_ccb_alloc(struct sr_discipline *sd)
1920 {
1921 	struct sr_ccb		*ccb;
1922 	int			i;
1923 
1924 	if (!sd)
1925 		return (1);
1926 
1927 	DNPRINTF(SR_D_CCB, "%s: sr_ccb_alloc\n", DEVNAME(sd->sd_sc));
1928 
1929 	if (sd->sd_ccb)
1930 		return (1);
1931 
1932 	sd->sd_ccb = mallocarray(sd->sd_max_wu,
1933 	    sd->sd_max_ccb_per_wu * sizeof(struct sr_ccb),
1934 	    M_DEVBUF, M_WAITOK | M_ZERO);
1935 	TAILQ_INIT(&sd->sd_ccb_freeq);
1936 	for (i = 0; i < sd->sd_max_wu * sd->sd_max_ccb_per_wu; i++) {
1937 		ccb = &sd->sd_ccb[i];
1938 		ccb->ccb_dis = sd;
1939 		sr_ccb_put(ccb);
1940 	}
1941 
1942 	DNPRINTF(SR_D_CCB, "%s: sr_ccb_alloc ccb: %d\n",
1943 	    DEVNAME(sd->sd_sc), sd->sd_max_wu * sd->sd_max_ccb_per_wu);
1944 
1945 	return (0);
1946 }
1947 
1948 void
1949 sr_ccb_free(struct sr_discipline *sd)
1950 {
1951 	struct sr_ccb		*ccb;
1952 
1953 	if (!sd)
1954 		return;
1955 
1956 	DNPRINTF(SR_D_CCB, "%s: sr_ccb_free %p\n", DEVNAME(sd->sd_sc), sd);
1957 
1958 	while ((ccb = TAILQ_FIRST(&sd->sd_ccb_freeq)) != NULL)
1959 		TAILQ_REMOVE(&sd->sd_ccb_freeq, ccb, ccb_link);
1960 
1961 	free(sd->sd_ccb, M_DEVBUF, 0);
1962 }
1963 
1964 struct sr_ccb *
1965 sr_ccb_get(struct sr_discipline *sd)
1966 {
1967 	struct sr_ccb		*ccb;
1968 	int			s;
1969 
1970 	s = splbio();
1971 
1972 	ccb = TAILQ_FIRST(&sd->sd_ccb_freeq);
1973 	if (ccb) {
1974 		TAILQ_REMOVE(&sd->sd_ccb_freeq, ccb, ccb_link);
1975 		ccb->ccb_state = SR_CCB_INPROGRESS;
1976 	}
1977 
1978 	splx(s);
1979 
1980 	DNPRINTF(SR_D_CCB, "%s: sr_ccb_get: %p\n", DEVNAME(sd->sd_sc),
1981 	    ccb);
1982 
1983 	return (ccb);
1984 }
1985 
1986 void
1987 sr_ccb_put(struct sr_ccb *ccb)
1988 {
1989 	struct sr_discipline	*sd = ccb->ccb_dis;
1990 	int			s;
1991 
1992 	DNPRINTF(SR_D_CCB, "%s: sr_ccb_put: %p\n", DEVNAME(sd->sd_sc),
1993 	    ccb);
1994 
1995 	s = splbio();
1996 
1997 	ccb->ccb_wu = NULL;
1998 	ccb->ccb_state = SR_CCB_FREE;
1999 	ccb->ccb_target = -1;
2000 	ccb->ccb_opaque = NULL;
2001 
2002 	TAILQ_INSERT_TAIL(&sd->sd_ccb_freeq, ccb, ccb_link);
2003 
2004 	splx(s);
2005 }
2006 
2007 struct sr_ccb *
2008 sr_ccb_rw(struct sr_discipline *sd, int chunk, daddr_t blkno,
2009     long len, u_int8_t *data, int xsflags, int ccbflags)
2010 {
2011 	struct sr_chunk		*sc = sd->sd_vol.sv_chunks[chunk];
2012 	struct sr_ccb		*ccb = NULL;
2013 
2014 	ccb = sr_ccb_get(sd);
2015 	if (ccb == NULL)
2016 		goto out;
2017 
2018 	ccb->ccb_flags = ccbflags;
2019 	ccb->ccb_target = chunk;
2020 
2021 	ccb->ccb_buf.b_flags = B_PHYS | B_CALL;
2022 	if (ISSET(xsflags, SCSI_DATA_IN))
2023 		ccb->ccb_buf.b_flags |= B_READ;
2024 	else
2025 		ccb->ccb_buf.b_flags |= B_WRITE;
2026 
2027 	ccb->ccb_buf.b_blkno = blkno + sd->sd_meta->ssd_data_blkno;
2028 	ccb->ccb_buf.b_bcount = len;
2029 	ccb->ccb_buf.b_bufsize = len;
2030 	ccb->ccb_buf.b_resid = len;
2031 	ccb->ccb_buf.b_data = data;
2032 	ccb->ccb_buf.b_error = 0;
2033 	ccb->ccb_buf.b_iodone = sd->sd_scsi_intr;
2034 	ccb->ccb_buf.b_proc = curproc;
2035 	ccb->ccb_buf.b_dev = sc->src_dev_mm;
2036 	ccb->ccb_buf.b_vp = sc->src_vn;
2037 	ccb->ccb_buf.b_bq = NULL;
2038 
2039 	if (!ISSET(ccb->ccb_buf.b_flags, B_READ))
2040 		ccb->ccb_buf.b_vp->v_numoutput++;
2041 
2042 	LIST_INIT(&ccb->ccb_buf.b_dep);
2043 
2044 	DNPRINTF(SR_D_DIS, "%s: %s %s ccb "
2045 	    "b_bcount %ld b_blkno %lld b_flags 0x%0lx b_data %p\n",
2046 	    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname, sd->sd_name,
2047 	    ccb->ccb_buf.b_bcount, (long long)ccb->ccb_buf.b_blkno,
2048 	    ccb->ccb_buf.b_flags, ccb->ccb_buf.b_data);
2049 
2050 out:
2051 	return ccb;
2052 }
2053 
2054 void
2055 sr_ccb_done(struct sr_ccb *ccb)
2056 {
2057 	struct sr_workunit	*wu = ccb->ccb_wu;
2058 	struct sr_discipline	*sd = wu->swu_dis;
2059 	struct sr_softc		*sc = sd->sd_sc;
2060 
2061 	DNPRINTF(SR_D_INTR, "%s: %s %s ccb done b_bcount %ld b_resid %zu"
2062 	    " b_flags 0x%0lx block %lld target %d\n",
2063 	    DEVNAME(sc), sd->sd_meta->ssd_devname, sd->sd_name,
2064 	    ccb->ccb_buf.b_bcount, ccb->ccb_buf.b_resid, ccb->ccb_buf.b_flags,
2065 	    (long long)ccb->ccb_buf.b_blkno, ccb->ccb_target);
2066 
2067 	splassert(IPL_BIO);
2068 
2069 	if (ccb->ccb_target == -1)
2070 		panic("%s: invalid target on wu: %p", DEVNAME(sc), wu);
2071 
2072 	if (ccb->ccb_buf.b_flags & B_ERROR) {
2073 		DNPRINTF(SR_D_INTR, "%s: i/o error on block %lld target %d\n",
2074 		    DEVNAME(sc), (long long)ccb->ccb_buf.b_blkno,
2075 		    ccb->ccb_target);
2076 		if (ISSET(sd->sd_capabilities, SR_CAP_REDUNDANT))
2077 			sd->sd_set_chunk_state(sd, ccb->ccb_target,
2078 			    BIOC_SDOFFLINE);
2079 		else
2080 			printf("%s: %s: i/o error %d @ %s block %lld\n",
2081 			    DEVNAME(sc), sd->sd_meta->ssd_devname,
2082 			    ccb->ccb_buf.b_error, sd->sd_name,
2083 			    (long long)ccb->ccb_buf.b_blkno);
2084 		ccb->ccb_state = SR_CCB_FAILED;
2085 		wu->swu_ios_failed++;
2086 	} else {
2087 		ccb->ccb_state = SR_CCB_OK;
2088 		wu->swu_ios_succeeded++;
2089 	}
2090 
2091 	wu->swu_ios_complete++;
2092 }
2093 
2094 int
2095 sr_wu_alloc(struct sr_discipline *sd, int wu_size)
2096 {
2097 	struct sr_workunit	*wu;
2098 	int			i, no_wu;
2099 
2100 	DNPRINTF(SR_D_WU, "%s: sr_wu_alloc %p %d\n", DEVNAME(sd->sd_sc),
2101 	    sd, sd->sd_max_wu);
2102 
2103 	no_wu = sd->sd_max_wu;
2104 	sd->sd_wu_pending = no_wu;
2105 
2106 	mtx_init(&sd->sd_wu_mtx, IPL_BIO);
2107 	TAILQ_INIT(&sd->sd_wu);
2108 	TAILQ_INIT(&sd->sd_wu_freeq);
2109 	TAILQ_INIT(&sd->sd_wu_pendq);
2110 	TAILQ_INIT(&sd->sd_wu_defq);
2111 
2112 	for (i = 0; i < no_wu; i++) {
2113 		wu = malloc(wu_size, M_DEVBUF, M_WAITOK | M_ZERO);
2114 		TAILQ_INSERT_TAIL(&sd->sd_wu, wu, swu_next);
2115 		TAILQ_INIT(&wu->swu_ccb);
2116 		wu->swu_dis = sd;
2117 		task_set(&wu->swu_task, sr_wu_done_callback, wu);
2118 		sr_wu_put(sd, wu);
2119 	}
2120 
2121 	return (0);
2122 }
2123 
2124 void
2125 sr_wu_free(struct sr_discipline *sd)
2126 {
2127 	struct sr_workunit	*wu;
2128 
2129 	DNPRINTF(SR_D_WU, "%s: sr_wu_free %p\n", DEVNAME(sd->sd_sc), sd);
2130 
2131 	while ((wu = TAILQ_FIRST(&sd->sd_wu_freeq)) != NULL)
2132 		TAILQ_REMOVE(&sd->sd_wu_freeq, wu, swu_link);
2133 	while ((wu = TAILQ_FIRST(&sd->sd_wu_pendq)) != NULL)
2134 		TAILQ_REMOVE(&sd->sd_wu_pendq, wu, swu_link);
2135 	while ((wu = TAILQ_FIRST(&sd->sd_wu_defq)) != NULL)
2136 		TAILQ_REMOVE(&sd->sd_wu_defq, wu, swu_link);
2137 
2138 	while ((wu = TAILQ_FIRST(&sd->sd_wu)) != NULL) {
2139 		TAILQ_REMOVE(&sd->sd_wu, wu, swu_next);
2140 		free(wu, M_DEVBUF, 0);
2141 	}
2142 }
2143 
2144 void *
2145 sr_wu_get(void *xsd)
2146 {
2147 	struct sr_discipline	*sd = (struct sr_discipline *)xsd;
2148 	struct sr_workunit	*wu;
2149 
2150 	mtx_enter(&sd->sd_wu_mtx);
2151 	wu = TAILQ_FIRST(&sd->sd_wu_freeq);
2152 	if (wu) {
2153 		TAILQ_REMOVE(&sd->sd_wu_freeq, wu, swu_link);
2154 		sd->sd_wu_pending++;
2155 	}
2156 	mtx_leave(&sd->sd_wu_mtx);
2157 
2158 	DNPRINTF(SR_D_WU, "%s: sr_wu_get: %p\n", DEVNAME(sd->sd_sc), wu);
2159 
2160 	return (wu);
2161 }
2162 
2163 void
2164 sr_wu_put(void *xsd, void *xwu)
2165 {
2166 	struct sr_discipline	*sd = (struct sr_discipline *)xsd;
2167 	struct sr_workunit	*wu = (struct sr_workunit *)xwu;
2168 
2169 	DNPRINTF(SR_D_WU, "%s: sr_wu_put: %p\n", DEVNAME(sd->sd_sc), wu);
2170 
2171 	sr_wu_release_ccbs(wu);
2172 	sr_wu_init(sd, wu);
2173 
2174 	mtx_enter(&sd->sd_wu_mtx);
2175 	TAILQ_INSERT_TAIL(&sd->sd_wu_freeq, wu, swu_link);
2176 	sd->sd_wu_pending--;
2177 	mtx_leave(&sd->sd_wu_mtx);
2178 }
2179 
2180 void
2181 sr_wu_init(struct sr_discipline *sd, struct sr_workunit *wu)
2182 {
2183 	int			s;
2184 
2185 	s = splbio();
2186 	if (wu->swu_cb_active == 1)
2187 		panic("%s: sr_wu_init got active wu", DEVNAME(sd->sd_sc));
2188 	splx(s);
2189 
2190 	wu->swu_xs = NULL;
2191 	wu->swu_state = SR_WU_FREE;
2192 	wu->swu_flags = 0;
2193 	wu->swu_blk_start = 0;
2194 	wu->swu_blk_end = 0;
2195 	wu->swu_collider = NULL;
2196 }
2197 
2198 void
2199 sr_wu_enqueue_ccb(struct sr_workunit *wu, struct sr_ccb *ccb)
2200 {
2201 	struct sr_discipline	*sd = wu->swu_dis;
2202 	int			s;
2203 
2204 	s = splbio();
2205 	if (wu->swu_cb_active == 1)
2206 		panic("%s: sr_wu_enqueue_ccb got active wu",
2207 		    DEVNAME(sd->sd_sc));
2208 	ccb->ccb_wu = wu;
2209 	wu->swu_io_count++;
2210 	TAILQ_INSERT_TAIL(&wu->swu_ccb, ccb, ccb_link);
2211 	splx(s);
2212 }
2213 
2214 void
2215 sr_wu_release_ccbs(struct sr_workunit *wu)
2216 {
2217 	struct sr_ccb		*ccb;
2218 
2219 	/* Return all ccbs that are associated with this workunit. */
2220 	while ((ccb = TAILQ_FIRST(&wu->swu_ccb)) != NULL) {
2221 		TAILQ_REMOVE(&wu->swu_ccb, ccb, ccb_link);
2222 		sr_ccb_put(ccb);
2223 	}
2224 
2225 	wu->swu_io_count = 0;
2226 	wu->swu_ios_complete = 0;
2227 	wu->swu_ios_failed = 0;
2228 	wu->swu_ios_succeeded = 0;
2229 }
2230 
2231 void
2232 sr_wu_done(struct sr_workunit *wu)
2233 {
2234 	struct sr_discipline	*sd = wu->swu_dis;
2235 
2236 	DNPRINTF(SR_D_INTR, "%s: sr_wu_done count %d completed %d failed %d\n",
2237 	    DEVNAME(sd->sd_sc), wu->swu_io_count, wu->swu_ios_complete,
2238 	    wu->swu_ios_failed);
2239 
2240 	if (wu->swu_ios_complete < wu->swu_io_count)
2241 		return;
2242 
2243 	task_add(sd->sd_taskq, &wu->swu_task);
2244 }
2245 
2246 void
2247 sr_wu_done_callback(void *xwu)
2248 {
2249 	struct sr_workunit	*wu = xwu;
2250 	struct sr_discipline	*sd = wu->swu_dis;
2251 	struct scsi_xfer	*xs = wu->swu_xs;
2252 	struct sr_workunit	*wup;
2253 	int			s;
2254 
2255 	/*
2256 	 * The SR_WUF_DISCIPLINE or SR_WUF_REBUILD flag must be set if
2257 	 * the work unit is not associated with a scsi_xfer.
2258 	 */
2259 	KASSERT(xs != NULL ||
2260 	    (wu->swu_flags & (SR_WUF_DISCIPLINE|SR_WUF_REBUILD)));
2261 
2262 	s = splbio();
2263 
2264 	if (xs != NULL) {
2265 		if (wu->swu_ios_failed)
2266 			xs->error = XS_DRIVER_STUFFUP;
2267 		else
2268 			xs->error = XS_NOERROR;
2269 	}
2270 
2271 	if (sd->sd_scsi_wu_done) {
2272 		if (sd->sd_scsi_wu_done(wu) == SR_WU_RESTART)
2273 			goto done;
2274 	}
2275 
2276 	/* Remove work unit from pending queue. */
2277 	TAILQ_FOREACH(wup, &sd->sd_wu_pendq, swu_link)
2278 		if (wup == wu)
2279 			break;
2280 	if (wup == NULL)
2281 		panic("%s: wu %p not on pending queue",
2282 		    DEVNAME(sd->sd_sc), wu);
2283 	TAILQ_REMOVE(&sd->sd_wu_pendq, wu, swu_link);
2284 
2285 	if (wu->swu_collider) {
2286 		if (wu->swu_ios_failed)
2287 			sr_raid_recreate_wu(wu->swu_collider);
2288 
2289 		/* XXX Should the collider be failed if this xs failed? */
2290 		sr_raid_startwu(wu->swu_collider);
2291 	}
2292 
2293 	/*
2294 	 * If a discipline provides its own sd_scsi_done function, then it
2295 	 * is responsible for calling sr_scsi_done() once I/O is complete.
2296 	 */
2297 	if (wu->swu_flags & SR_WUF_REBUILD)
2298 		wu->swu_flags |= SR_WUF_REBUILDIOCOMP;
2299 	if (wu->swu_flags & SR_WUF_WAKEUP)
2300 		wakeup(wu);
2301 	if (sd->sd_scsi_done)
2302 		sd->sd_scsi_done(wu);
2303 	else if (wu->swu_flags & SR_WUF_DISCIPLINE)
2304 		sr_scsi_wu_put(sd, wu);
2305 	else if (!(wu->swu_flags & SR_WUF_REBUILD))
2306 		sr_scsi_done(sd, xs);
2307 
2308 done:
2309 	splx(s);
2310 }
2311 
2312 struct sr_workunit *
2313 sr_scsi_wu_get(struct sr_discipline *sd, int flags)
2314 {
2315 	return scsi_io_get(&sd->sd_iopool, flags);
2316 }
2317 
2318 void
2319 sr_scsi_wu_put(struct sr_discipline *sd, struct sr_workunit *wu)
2320 {
2321 	scsi_io_put(&sd->sd_iopool, wu);
2322 
2323 	if (sd->sd_sync && sd->sd_wu_pending == 0)
2324 		wakeup(sd);
2325 }
2326 
2327 void
2328 sr_scsi_done(struct sr_discipline *sd, struct scsi_xfer *xs)
2329 {
2330 	DNPRINTF(SR_D_DIS, "%s: sr_scsi_done: xs %p\n", DEVNAME(sd->sd_sc), xs);
2331 
2332 	if (xs->error == XS_NOERROR)
2333 		xs->resid = 0;
2334 
2335 	scsi_done(xs);
2336 
2337 	if (sd->sd_sync && sd->sd_wu_pending == 0)
2338 		wakeup(sd);
2339 }
2340 
2341 void
2342 sr_scsi_cmd(struct scsi_xfer *xs)
2343 {
2344 	struct scsi_link	*link = xs->sc_link;
2345 	struct sr_softc		*sc = link->adapter_softc;
2346 	struct sr_workunit	*wu = xs->io;
2347 	struct sr_discipline	*sd;
2348 
2349 	DNPRINTF(SR_D_CMD, "%s: sr_scsi_cmd target %d xs %p flags %#x\n",
2350 	    DEVNAME(sc), link->target, xs, xs->flags);
2351 
2352 	sd = sc->sc_targets[link->target];
2353 	if (sd == NULL)
2354 		panic("%s: sr_scsi_cmd NULL discipline", DEVNAME(sc));
2355 
2356 	if (sd->sd_deleted) {
2357 		printf("%s: %s device is being deleted, failing io\n",
2358 		    DEVNAME(sc), sd->sd_meta->ssd_devname);
2359 		goto stuffup;
2360 	}
2361 
2362 	/* scsi layer *can* re-send wu without calling sr_wu_put(). */
2363 	sr_wu_release_ccbs(wu);
2364 	sr_wu_init(sd, wu);
2365 	wu->swu_state = SR_WU_INPROGRESS;
2366 	wu->swu_xs = xs;
2367 
2368 	switch (xs->cmd->opcode) {
2369 	case READ_COMMAND:
2370 	case READ_BIG:
2371 	case READ_16:
2372 	case WRITE_COMMAND:
2373 	case WRITE_BIG:
2374 	case WRITE_16:
2375 		DNPRINTF(SR_D_CMD, "%s: sr_scsi_cmd: READ/WRITE %02x\n",
2376 		    DEVNAME(sc), xs->cmd->opcode);
2377 		if (sd->sd_scsi_rw(wu))
2378 			goto stuffup;
2379 		break;
2380 
2381 	case SYNCHRONIZE_CACHE:
2382 		DNPRINTF(SR_D_CMD, "%s: sr_scsi_cmd: SYNCHRONIZE_CACHE\n",
2383 		    DEVNAME(sc));
2384 		if (sd->sd_scsi_sync(wu))
2385 			goto stuffup;
2386 		goto complete;
2387 
2388 	case TEST_UNIT_READY:
2389 		DNPRINTF(SR_D_CMD, "%s: sr_scsi_cmd: TEST_UNIT_READY\n",
2390 		    DEVNAME(sc));
2391 		if (sd->sd_scsi_tur(wu))
2392 			goto stuffup;
2393 		goto complete;
2394 
2395 	case START_STOP:
2396 		DNPRINTF(SR_D_CMD, "%s: sr_scsi_cmd: START_STOP\n",
2397 		    DEVNAME(sc));
2398 		if (sd->sd_scsi_start_stop(wu))
2399 			goto stuffup;
2400 		goto complete;
2401 
2402 	case INQUIRY:
2403 		DNPRINTF(SR_D_CMD, "%s: sr_scsi_cmd: INQUIRY\n",
2404 		    DEVNAME(sc));
2405 		if (sd->sd_scsi_inquiry(wu))
2406 			goto stuffup;
2407 		goto complete;
2408 
2409 	case READ_CAPACITY:
2410 	case READ_CAPACITY_16:
2411 		DNPRINTF(SR_D_CMD, "%s: sr_scsi_cmd READ CAPACITY 0x%02x\n",
2412 		    DEVNAME(sc), xs->cmd->opcode);
2413 		if (sd->sd_scsi_read_cap(wu))
2414 			goto stuffup;
2415 		goto complete;
2416 
2417 	case REQUEST_SENSE:
2418 		DNPRINTF(SR_D_CMD, "%s: sr_scsi_cmd REQUEST SENSE\n",
2419 		    DEVNAME(sc));
2420 		if (sd->sd_scsi_req_sense(wu))
2421 			goto stuffup;
2422 		goto complete;
2423 
2424 	default:
2425 		DNPRINTF(SR_D_CMD, "%s: unsupported scsi command %x\n",
2426 		    DEVNAME(sc), xs->cmd->opcode);
2427 		/* XXX might need to add generic function to handle others */
2428 		goto stuffup;
2429 	}
2430 
2431 	return;
2432 stuffup:
2433 	if (sd->sd_scsi_sense.error_code) {
2434 		xs->error = XS_SENSE;
2435 		memcpy(&xs->sense, &sd->sd_scsi_sense, sizeof(xs->sense));
2436 		bzero(&sd->sd_scsi_sense, sizeof(sd->sd_scsi_sense));
2437 	} else {
2438 		xs->error = XS_DRIVER_STUFFUP;
2439 	}
2440 complete:
2441 	sr_scsi_done(sd, xs);
2442 }
2443 
2444 int
2445 sr_scsi_probe(struct scsi_link *link)
2446 {
2447 	struct sr_softc		*sc = link->adapter_softc;
2448 	struct sr_discipline	*sd;
2449 
2450 	KASSERT(link->target < SR_MAX_LD && link->lun == 0);
2451 
2452 	sd = sc->sc_targets[link->target];
2453 	if (sd == NULL)
2454 		return (ENODEV);
2455 
2456 	link->pool = &sd->sd_iopool;
2457 	if (sd->sd_openings)
2458 		link->openings = sd->sd_openings(sd);
2459 	else
2460 		link->openings = sd->sd_max_wu;
2461 
2462 	return (0);
2463 }
2464 
2465 int
2466 sr_scsi_ioctl(struct scsi_link *link, u_long cmd, caddr_t addr, int flag)
2467 {
2468 	struct sr_softc		*sc = link->adapter_softc;
2469 	struct sr_discipline	*sd;
2470 
2471 	sd = sc->sc_targets[link->target];
2472 	if (sd == NULL)
2473 		return (ENODEV);
2474 
2475 	DNPRINTF(SR_D_IOCTL, "%s: %s sr_scsi_ioctl cmd: %#lx\n",
2476 	    DEVNAME(sc), sd->sd_meta->ssd_devname, cmd);
2477 
2478 	/* Pass bio ioctls through to the bio handler. */
2479 	if (IOCGROUP(cmd) == 'B')
2480 		return (sr_bio_handler(sc, sd, cmd, (struct bio *)addr));
2481 
2482 	switch (cmd) {
2483 	case DIOCGCACHE:
2484 	case DIOCSCACHE:
2485 		return (EOPNOTSUPP);
2486 	default:
2487 		return (ENOTTY);
2488 	}
2489 }
2490 
2491 int
2492 sr_bio_ioctl(struct device *dev, u_long cmd, caddr_t addr)
2493 {
2494 	struct sr_softc *sc = (struct sr_softc *) dev;
2495 	DNPRINTF(SR_D_IOCTL, "%s: sr_bio_ioctl\n", DEVNAME(sc));
2496 
2497 	return sr_bio_handler(sc, NULL, cmd, (struct bio *)addr);
2498 }
2499 
2500 int
2501 sr_bio_handler(struct sr_softc *sc, struct sr_discipline *sd, u_long cmd,
2502     struct bio *bio)
2503 {
2504 	int			rv = 0;
2505 
2506 	DNPRINTF(SR_D_IOCTL, "%s: sr_bio_handler ", DEVNAME(sc));
2507 
2508 	rw_enter_write(&sc->sc_lock);
2509 
2510 	bio_status_init(&sc->sc_status, &sc->sc_dev);
2511 
2512 	switch (cmd) {
2513 	case BIOCINQ:
2514 		DNPRINTF(SR_D_IOCTL, "inq\n");
2515 		rv = sr_ioctl_inq(sc, (struct bioc_inq *)bio);
2516 		break;
2517 
2518 	case BIOCVOL:
2519 		DNPRINTF(SR_D_IOCTL, "vol\n");
2520 		rv = sr_ioctl_vol(sc, (struct bioc_vol *)bio);
2521 		break;
2522 
2523 	case BIOCDISK:
2524 		DNPRINTF(SR_D_IOCTL, "disk\n");
2525 		rv = sr_ioctl_disk(sc, (struct bioc_disk *)bio);
2526 		break;
2527 
2528 	case BIOCALARM:
2529 		DNPRINTF(SR_D_IOCTL, "alarm\n");
2530 		/*rv = sr_ioctl_alarm(sc, (struct bioc_alarm *)bio); */
2531 		break;
2532 
2533 	case BIOCBLINK:
2534 		DNPRINTF(SR_D_IOCTL, "blink\n");
2535 		/*rv = sr_ioctl_blink(sc, (struct bioc_blink *)bio); */
2536 		break;
2537 
2538 	case BIOCSETSTATE:
2539 		DNPRINTF(SR_D_IOCTL, "setstate\n");
2540 		rv = sr_ioctl_setstate(sc, (struct bioc_setstate *)bio);
2541 		break;
2542 
2543 	case BIOCCREATERAID:
2544 		DNPRINTF(SR_D_IOCTL, "createraid\n");
2545 		rv = sr_ioctl_createraid(sc, (struct bioc_createraid *)bio,
2546 		    1, NULL);
2547 		break;
2548 
2549 	case BIOCDELETERAID:
2550 		DNPRINTF(SR_D_IOCTL, "deleteraid\n");
2551 		rv = sr_ioctl_deleteraid(sc, sd, (struct bioc_deleteraid *)bio);
2552 		break;
2553 
2554 	case BIOCDISCIPLINE:
2555 		DNPRINTF(SR_D_IOCTL, "discipline\n");
2556 		rv = sr_ioctl_discipline(sc, sd, (struct bioc_discipline *)bio);
2557 		break;
2558 
2559 	case BIOCINSTALLBOOT:
2560 		DNPRINTF(SR_D_IOCTL, "installboot\n");
2561 		rv = sr_ioctl_installboot(sc, sd,
2562 		    (struct bioc_installboot *)bio);
2563 		break;
2564 
2565 	default:
2566 		DNPRINTF(SR_D_IOCTL, "invalid ioctl\n");
2567 		rv = ENOTTY;
2568 	}
2569 
2570 	sc->sc_status.bs_status = (rv ? BIO_STATUS_ERROR : BIO_STATUS_SUCCESS);
2571 
2572 	if (sc->sc_status.bs_msg_count > 0)
2573 		rv = 0;
2574 
2575 	memcpy(&bio->bio_status, &sc->sc_status, sizeof(struct bio_status));
2576 
2577 	rw_exit_write(&sc->sc_lock);
2578 
2579 	return (rv);
2580 }
2581 
2582 int
2583 sr_ioctl_inq(struct sr_softc *sc, struct bioc_inq *bi)
2584 {
2585 	struct sr_discipline	*sd;
2586 	int			vol = 0, disk = 0;
2587 
2588 	TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
2589 		vol++;
2590 		disk += sd->sd_meta->ssdi.ssd_chunk_no;
2591 	}
2592 
2593 	strlcpy(bi->bi_dev, sc->sc_dev.dv_xname, sizeof(bi->bi_dev));
2594 	bi->bi_novol = vol + sc->sc_hotspare_no;
2595 	bi->bi_nodisk = disk + sc->sc_hotspare_no;
2596 
2597 	return (0);
2598 }
2599 
2600 int
2601 sr_ioctl_vol(struct sr_softc *sc, struct bioc_vol *bv)
2602 {
2603 	int			vol = -1, rv = EINVAL;
2604 	struct sr_discipline	*sd;
2605 	struct sr_chunk		*hotspare;
2606 
2607 	TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
2608 		vol++;
2609 		if (vol != bv->bv_volid)
2610 			continue;
2611 
2612 		bv->bv_status = sd->sd_vol_status;
2613 		bv->bv_size = sd->sd_meta->ssdi.ssd_size << DEV_BSHIFT;
2614 		bv->bv_level = sd->sd_meta->ssdi.ssd_level;
2615 		bv->bv_nodisk = sd->sd_meta->ssdi.ssd_chunk_no;
2616 
2617 #ifdef CRYPTO
2618 		if (sd->sd_meta->ssdi.ssd_level == 'C' &&
2619 		    sd->mds.mdd_crypto.key_disk != NULL)
2620 			bv->bv_nodisk++;
2621 #endif
2622 		if (bv->bv_status == BIOC_SVREBUILD)
2623 			bv->bv_percent = sr_rebuild_percent(sd);
2624 
2625 		strlcpy(bv->bv_dev, sd->sd_meta->ssd_devname,
2626 		    sizeof(bv->bv_dev));
2627 		strlcpy(bv->bv_vendor, sd->sd_meta->ssdi.ssd_vendor,
2628 		    sizeof(bv->bv_vendor));
2629 		rv = 0;
2630 		goto done;
2631 	}
2632 
2633 	/* Check hotspares list. */
2634 	SLIST_FOREACH(hotspare, &sc->sc_hotspare_list, src_link) {
2635 		vol++;
2636 		if (vol != bv->bv_volid)
2637 			continue;
2638 
2639 		bv->bv_status = BIOC_SVONLINE;
2640 		bv->bv_size = hotspare->src_meta.scmi.scm_size << DEV_BSHIFT;
2641 		bv->bv_level = -1;	/* Hotspare. */
2642 		bv->bv_nodisk = 1;
2643 		strlcpy(bv->bv_dev, hotspare->src_meta.scmi.scm_devname,
2644 		    sizeof(bv->bv_dev));
2645 		strlcpy(bv->bv_vendor, hotspare->src_meta.scmi.scm_devname,
2646 		    sizeof(bv->bv_vendor));
2647 		rv = 0;
2648 		goto done;
2649 	}
2650 
2651 done:
2652 	return (rv);
2653 }
2654 
2655 int
2656 sr_ioctl_disk(struct sr_softc *sc, struct bioc_disk *bd)
2657 {
2658 	struct sr_discipline	*sd;
2659 	struct sr_chunk		*src, *hotspare;
2660 	int			vol = -1, rv = EINVAL;
2661 
2662 	if (bd->bd_diskid < 0)
2663 		goto done;
2664 
2665 	TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
2666 		vol++;
2667 		if (vol != bd->bd_volid)
2668 			continue;
2669 
2670 		if (bd->bd_diskid < sd->sd_meta->ssdi.ssd_chunk_no)
2671 			src = sd->sd_vol.sv_chunks[bd->bd_diskid];
2672 #ifdef CRYPTO
2673 		else if (bd->bd_diskid == sd->sd_meta->ssdi.ssd_chunk_no &&
2674 		    sd->sd_meta->ssdi.ssd_level == 'C' &&
2675 		    sd->mds.mdd_crypto.key_disk != NULL)
2676 			src = sd->mds.mdd_crypto.key_disk;
2677 #endif
2678 		else
2679 			break;
2680 
2681 		bd->bd_status = src->src_meta.scm_status;
2682 		bd->bd_size = src->src_meta.scmi.scm_size << DEV_BSHIFT;
2683 		bd->bd_channel = vol;
2684 		bd->bd_target = bd->bd_diskid;
2685 		strlcpy(bd->bd_vendor, src->src_meta.scmi.scm_devname,
2686 		    sizeof(bd->bd_vendor));
2687 		rv = 0;
2688 		goto done;
2689 	}
2690 
2691 	/* Check hotspares list. */
2692 	SLIST_FOREACH(hotspare, &sc->sc_hotspare_list, src_link) {
2693 		vol++;
2694 		if (vol != bd->bd_volid)
2695 			continue;
2696 
2697 		if (bd->bd_diskid != 0)
2698 			break;
2699 
2700 		bd->bd_status = hotspare->src_meta.scm_status;
2701 		bd->bd_size = hotspare->src_meta.scmi.scm_size << DEV_BSHIFT;
2702 		bd->bd_channel = vol;
2703 		bd->bd_target = bd->bd_diskid;
2704 		strlcpy(bd->bd_vendor, hotspare->src_meta.scmi.scm_devname,
2705 		    sizeof(bd->bd_vendor));
2706 		rv = 0;
2707 		goto done;
2708 	}
2709 
2710 done:
2711 	return (rv);
2712 }
2713 
2714 int
2715 sr_ioctl_setstate(struct sr_softc *sc, struct bioc_setstate *bs)
2716 {
2717 	int			rv = EINVAL;
2718 	int			vol = -1, found, c;
2719 	struct sr_discipline	*sd;
2720 	struct sr_chunk		*ch_entry;
2721 	struct sr_chunk_head	*cl;
2722 
2723 	if (bs->bs_other_id_type == BIOC_SSOTHER_UNUSED)
2724 		goto done;
2725 
2726 	if (bs->bs_status == BIOC_SSHOTSPARE) {
2727 		rv = sr_hotspare(sc, (dev_t)bs->bs_other_id);
2728 		goto done;
2729 	}
2730 
2731 	TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
2732 		vol++;
2733 		if (vol == bs->bs_volid)
2734 			break;
2735 	}
2736 	if (sd == NULL)
2737 		goto done;
2738 
2739 	switch (bs->bs_status) {
2740 	case BIOC_SSOFFLINE:
2741 		/* Take chunk offline */
2742 		found = c = 0;
2743 		cl = &sd->sd_vol.sv_chunk_list;
2744 		SLIST_FOREACH(ch_entry, cl, src_link) {
2745 			if (ch_entry->src_dev_mm == bs->bs_other_id) {
2746 				found = 1;
2747 				break;
2748 			}
2749 			c++;
2750 		}
2751 		if (found == 0) {
2752 			sr_error(sc, "chunk not part of array");
2753 			goto done;
2754 		}
2755 
2756 		/* XXX: check current state first */
2757 		sd->sd_set_chunk_state(sd, c, BIOC_SDOFFLINE);
2758 
2759 		if (sr_meta_save(sd, SR_META_DIRTY)) {
2760 			sr_error(sc, "could not save metadata for %s",
2761 			    sd->sd_meta->ssd_devname);
2762 			goto done;
2763 		}
2764 		rv = 0;
2765 		break;
2766 
2767 	case BIOC_SDSCRUB:
2768 		break;
2769 
2770 	case BIOC_SSREBUILD:
2771 		rv = sr_rebuild_init(sd, (dev_t)bs->bs_other_id, 0);
2772 		break;
2773 
2774 	default:
2775 		sr_error(sc, "unsupported state request %d", bs->bs_status);
2776 	}
2777 
2778 done:
2779 	return (rv);
2780 }
2781 
2782 int
2783 sr_chunk_in_use(struct sr_softc *sc, dev_t dev)
2784 {
2785 	struct sr_discipline	*sd;
2786 	struct sr_chunk		*chunk;
2787 	int			i;
2788 
2789 	DNPRINTF(SR_D_MISC, "%s: sr_chunk_in_use(%d)\n", DEVNAME(sc), dev);
2790 
2791 	if (dev == NODEV)
2792 		return BIOC_SDINVALID;
2793 
2794 	/* See if chunk is already in use. */
2795 	TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
2796 		for (i = 0; i < sd->sd_meta->ssdi.ssd_chunk_no; i++) {
2797 			chunk = sd->sd_vol.sv_chunks[i];
2798 			if (chunk->src_dev_mm == dev)
2799 				return chunk->src_meta.scm_status;
2800 		}
2801 	}
2802 
2803 	/* Check hotspares list. */
2804 	SLIST_FOREACH(chunk, &sc->sc_hotspare_list, src_link)
2805 		if (chunk->src_dev_mm == dev)
2806 			return chunk->src_meta.scm_status;
2807 
2808 	return BIOC_SDINVALID;
2809 }
2810 
2811 int
2812 sr_hotspare(struct sr_softc *sc, dev_t dev)
2813 {
2814 	struct sr_discipline	*sd = NULL;
2815 	struct sr_metadata	*sm = NULL;
2816 	struct sr_meta_chunk    *hm;
2817 	struct sr_chunk_head	*cl;
2818 	struct sr_chunk		*chunk, *last, *hotspare = NULL;
2819 	struct sr_uuid		uuid;
2820 	struct disklabel	label;
2821 	struct vnode		*vn;
2822 	u_int64_t		size;
2823 	char			devname[32];
2824 	int			rv = EINVAL;
2825 	int			c, part, open = 0;
2826 
2827 	/*
2828 	 * Add device to global hotspares list.
2829 	 */
2830 
2831 	sr_meta_getdevname(sc, dev, devname, sizeof(devname));
2832 
2833 	/* Make sure chunk is not already in use. */
2834 	c = sr_chunk_in_use(sc, dev);
2835 	if (c != BIOC_SDINVALID && c != BIOC_SDOFFLINE) {
2836 		if (c == BIOC_SDHOTSPARE)
2837 			sr_error(sc, "%s is already a hotspare", devname);
2838 		else
2839 			sr_error(sc, "%s is already in use", devname);
2840 		goto done;
2841 	}
2842 
2843 	/* XXX - See if there is an existing degraded volume... */
2844 
2845 	/* Open device. */
2846 	if (bdevvp(dev, &vn)) {
2847 		sr_error(sc, "sr_hotspare: cannot allocate vnode");
2848 		goto done;
2849 	}
2850 	if (VOP_OPEN(vn, FREAD | FWRITE, NOCRED, curproc)) {
2851 		DNPRINTF(SR_D_META,"%s: sr_hotspare cannot open %s\n",
2852 		    DEVNAME(sc), devname);
2853 		vput(vn);
2854 		goto fail;
2855 	}
2856 	open = 1; /* close dev on error */
2857 
2858 	/* Get partition details. */
2859 	part = DISKPART(dev);
2860 	if (VOP_IOCTL(vn, DIOCGDINFO, (caddr_t)&label, FREAD,
2861 	    NOCRED, curproc)) {
2862 		DNPRINTF(SR_D_META, "%s: sr_hotspare ioctl failed\n",
2863 		    DEVNAME(sc));
2864 		VOP_CLOSE(vn, FREAD | FWRITE, NOCRED, curproc);
2865 		vput(vn);
2866 		goto fail;
2867 	}
2868 	if (label.d_partitions[part].p_fstype != FS_RAID) {
2869 		sr_error(sc, "%s partition not of type RAID (%d)",
2870 		    devname, label.d_partitions[part].p_fstype);
2871 		goto fail;
2872 	}
2873 
2874 	/* Calculate partition size. */
2875 	size = DL_SECTOBLK(&label, DL_GETPSIZE(&label.d_partitions[part]));
2876 	if (size <= SR_DATA_OFFSET) {
2877 		DNPRINTF(SR_D_META, "%s: %s partition too small\n", DEVNAME(sc),
2878 		    devname);
2879 		goto fail;
2880 	}
2881 	size -= SR_DATA_OFFSET;
2882 	if (size > INT64_MAX) {
2883 		DNPRINTF(SR_D_META, "%s: %s partition too large\n", DEVNAME(sc),
2884 		    devname);
2885 		goto fail;
2886 	}
2887 
2888 	/*
2889 	 * Create and populate chunk metadata.
2890 	 */
2891 
2892 	sr_uuid_generate(&uuid);
2893 	hotspare = malloc(sizeof(struct sr_chunk), M_DEVBUF, M_WAITOK | M_ZERO);
2894 
2895 	hotspare->src_dev_mm = dev;
2896 	hotspare->src_vn = vn;
2897 	strlcpy(hotspare->src_devname, devname, sizeof(hm->scmi.scm_devname));
2898 	hotspare->src_size = size;
2899 
2900 	hm = &hotspare->src_meta;
2901 	hm->scmi.scm_volid = SR_HOTSPARE_VOLID;
2902 	hm->scmi.scm_chunk_id = 0;
2903 	hm->scmi.scm_size = size;
2904 	hm->scmi.scm_coerced_size = size;
2905 	strlcpy(hm->scmi.scm_devname, devname, sizeof(hm->scmi.scm_devname));
2906 	memcpy(&hm->scmi.scm_uuid, &uuid, sizeof(struct sr_uuid));
2907 
2908 	sr_checksum(sc, hm, &hm->scm_checksum,
2909 	    sizeof(struct sr_meta_chunk_invariant));
2910 
2911 	hm->scm_status = BIOC_SDHOTSPARE;
2912 
2913 	/*
2914 	 * Create and populate our own discipline and metadata.
2915 	 */
2916 
2917 	sm = malloc(sizeof(struct sr_metadata), M_DEVBUF, M_WAITOK | M_ZERO);
2918 	sm->ssdi.ssd_magic = SR_MAGIC;
2919 	sm->ssdi.ssd_version = SR_META_VERSION;
2920 	sm->ssd_ondisk = 0;
2921 	sm->ssdi.ssd_vol_flags = 0;
2922 	memcpy(&sm->ssdi.ssd_uuid, &uuid, sizeof(struct sr_uuid));
2923 	sm->ssdi.ssd_chunk_no = 1;
2924 	sm->ssdi.ssd_volid = SR_HOTSPARE_VOLID;
2925 	sm->ssdi.ssd_level = SR_HOTSPARE_LEVEL;
2926 	sm->ssdi.ssd_size = size;
2927 	sm->ssdi.ssd_secsize = label.d_secsize;
2928 	strlcpy(sm->ssdi.ssd_vendor, "OPENBSD", sizeof(sm->ssdi.ssd_vendor));
2929 	snprintf(sm->ssdi.ssd_product, sizeof(sm->ssdi.ssd_product),
2930 	    "SR %s", "HOTSPARE");
2931 	snprintf(sm->ssdi.ssd_revision, sizeof(sm->ssdi.ssd_revision),
2932 	    "%03d", SR_META_VERSION);
2933 
2934 	sd = malloc(sizeof(struct sr_discipline), M_DEVBUF, M_WAITOK | M_ZERO);
2935 	sd->sd_sc = sc;
2936 	sd->sd_meta = sm;
2937 	sd->sd_meta_type = SR_META_F_NATIVE;
2938 	sd->sd_vol_status = BIOC_SVONLINE;
2939 	strlcpy(sd->sd_name, "HOTSPARE", sizeof(sd->sd_name));
2940 	SLIST_INIT(&sd->sd_meta_opt);
2941 
2942 	/* Add chunk to volume. */
2943 	sd->sd_vol.sv_chunks = malloc(sizeof(struct sr_chunk *), M_DEVBUF,
2944 	    M_WAITOK | M_ZERO);
2945 	sd->sd_vol.sv_chunks[0] = hotspare;
2946 	SLIST_INIT(&sd->sd_vol.sv_chunk_list);
2947 	SLIST_INSERT_HEAD(&sd->sd_vol.sv_chunk_list, hotspare, src_link);
2948 
2949 	/* Save metadata. */
2950 	if (sr_meta_save(sd, SR_META_DIRTY)) {
2951 		sr_error(sc, "could not save metadata to %s", devname);
2952 		goto fail;
2953 	}
2954 
2955 	/*
2956 	 * Add chunk to hotspare list.
2957 	 */
2958 	rw_enter_write(&sc->sc_hs_lock);
2959 	cl = &sc->sc_hotspare_list;
2960 	if (SLIST_EMPTY(cl))
2961 		SLIST_INSERT_HEAD(cl, hotspare, src_link);
2962 	else {
2963 		SLIST_FOREACH(chunk, cl, src_link)
2964 			last = chunk;
2965 		SLIST_INSERT_AFTER(last, hotspare, src_link);
2966 	}
2967 	sc->sc_hotspare_no++;
2968 	rw_exit_write(&sc->sc_hs_lock);
2969 
2970 	rv = 0;
2971 	goto done;
2972 
2973 fail:
2974 	free(hotspare, M_DEVBUF, 0);
2975 
2976 done:
2977 	if (sd)
2978 		free(sd->sd_vol.sv_chunks, M_DEVBUF, 0);
2979 	free(sd, M_DEVBUF, 0);
2980 	free(sm, M_DEVBUF, 0);
2981 	if (open) {
2982 		VOP_CLOSE(vn, FREAD | FWRITE, NOCRED, curproc);
2983 		vput(vn);
2984 	}
2985 
2986 	return (rv);
2987 }
2988 
2989 void
2990 sr_hotspare_rebuild_callback(void *xsd)
2991 {
2992 	struct sr_discipline *sd = xsd;
2993 	sr_hotspare_rebuild(sd);
2994 }
2995 
2996 void
2997 sr_hotspare_rebuild(struct sr_discipline *sd)
2998 {
2999 	struct sr_softc		*sc = sd->sd_sc;
3000 	struct sr_chunk_head	*cl;
3001 	struct sr_chunk		*hotspare, *chunk = NULL;
3002 	struct sr_workunit	*wu;
3003 	struct sr_ccb		*ccb;
3004 	int			i, s, cid, busy;
3005 
3006 	/*
3007 	 * Attempt to locate a hotspare and initiate rebuild.
3008 	 */
3009 
3010 	/* Find first offline chunk. */
3011 	for (cid = 0; cid < sd->sd_meta->ssdi.ssd_chunk_no; cid++) {
3012 		if (sd->sd_vol.sv_chunks[cid]->src_meta.scm_status ==
3013 		    BIOC_SDOFFLINE) {
3014 			chunk = sd->sd_vol.sv_chunks[cid];
3015 			break;
3016 		}
3017 	}
3018 	if (chunk == NULL) {
3019 		printf("%s: no offline chunk found on %s!\n",
3020 		    DEVNAME(sc), sd->sd_meta->ssd_devname);
3021 		return;
3022 	}
3023 
3024 	/* See if we have a suitable hotspare... */
3025 	rw_enter_write(&sc->sc_hs_lock);
3026 	cl = &sc->sc_hotspare_list;
3027 	SLIST_FOREACH(hotspare, cl, src_link)
3028 		if (hotspare->src_size >= chunk->src_size &&
3029 		    hotspare->src_secsize <= sd->sd_meta->ssdi.ssd_secsize)
3030 			break;
3031 
3032 	if (hotspare != NULL) {
3033 
3034 		printf("%s: %s volume degraded, will attempt to "
3035 		    "rebuild on hotspare %s\n", DEVNAME(sc),
3036 		    sd->sd_meta->ssd_devname, hotspare->src_devname);
3037 
3038 		/*
3039 		 * Ensure that all pending I/O completes on the failed chunk
3040 		 * before trying to initiate a rebuild.
3041 		 */
3042 		i = 0;
3043 		do {
3044 			busy = 0;
3045 
3046 			s = splbio();
3047 			TAILQ_FOREACH(wu, &sd->sd_wu_pendq, swu_link) {
3048 				TAILQ_FOREACH(ccb, &wu->swu_ccb, ccb_link) {
3049 					if (ccb->ccb_target == cid)
3050 						busy = 1;
3051 				}
3052 			}
3053 			TAILQ_FOREACH(wu, &sd->sd_wu_defq, swu_link) {
3054 				TAILQ_FOREACH(ccb, &wu->swu_ccb, ccb_link) {
3055 					if (ccb->ccb_target == cid)
3056 						busy = 1;
3057 				}
3058 			}
3059 			splx(s);
3060 
3061 			if (busy) {
3062 				tsleep(sd, PRIBIO, "sr_hotspare", hz);
3063 				i++;
3064 			}
3065 
3066 		} while (busy && i < 120);
3067 
3068 		DNPRINTF(SR_D_META, "%s: waited %i seconds for I/O to "
3069 		    "complete on failed chunk %s\n", DEVNAME(sc),
3070 		    i, chunk->src_devname);
3071 
3072 		if (busy) {
3073 			printf("%s: pending I/O failed to complete on "
3074 			    "failed chunk %s, hotspare rebuild aborted...\n",
3075 			    DEVNAME(sc), chunk->src_devname);
3076 			goto done;
3077 		}
3078 
3079 		s = splbio();
3080 		rw_enter_write(&sc->sc_lock);
3081 		bio_status_init(&sc->sc_status, &sc->sc_dev);
3082 		if (sr_rebuild_init(sd, hotspare->src_dev_mm, 1) == 0) {
3083 
3084 			/* Remove hotspare from available list. */
3085 			sc->sc_hotspare_no--;
3086 			SLIST_REMOVE(cl, hotspare, sr_chunk, src_link);
3087 			free(hotspare, M_DEVBUF, 0);
3088 
3089 		}
3090 		rw_exit_write(&sc->sc_lock);
3091 		splx(s);
3092 	}
3093 done:
3094 	rw_exit_write(&sc->sc_hs_lock);
3095 }
3096 
3097 int
3098 sr_rebuild_init(struct sr_discipline *sd, dev_t dev, int hotspare)
3099 {
3100 	struct sr_softc		*sc = sd->sd_sc;
3101 	struct sr_chunk		*chunk = NULL;
3102 	struct sr_meta_chunk	*meta;
3103 	struct disklabel	label;
3104 	struct vnode		*vn;
3105 	u_int64_t		size;
3106 	int64_t			csize;
3107 	char			devname[32];
3108 	int			rv = EINVAL, open = 0;
3109 	int			cid, i, part, status;
3110 
3111 	/*
3112 	 * Attempt to initiate a rebuild onto the specified device.
3113 	 */
3114 
3115 	if (!(sd->sd_capabilities & SR_CAP_REBUILD)) {
3116 		sr_error(sc, "discipline does not support rebuild");
3117 		goto done;
3118 	}
3119 
3120 	/* make sure volume is in the right state */
3121 	if (sd->sd_vol_status == BIOC_SVREBUILD) {
3122 		sr_error(sc, "rebuild already in progress");
3123 		goto done;
3124 	}
3125 	if (sd->sd_vol_status != BIOC_SVDEGRADED) {
3126 		sr_error(sc, "volume not degraded");
3127 		goto done;
3128 	}
3129 
3130 	/* Find first offline chunk. */
3131 	for (cid = 0; cid < sd->sd_meta->ssdi.ssd_chunk_no; cid++) {
3132 		if (sd->sd_vol.sv_chunks[cid]->src_meta.scm_status ==
3133 		    BIOC_SDOFFLINE) {
3134 			chunk = sd->sd_vol.sv_chunks[cid];
3135 			break;
3136 		}
3137 	}
3138 	if (chunk == NULL) {
3139 		sr_error(sc, "no offline chunks available to rebuild");
3140 		goto done;
3141 	}
3142 
3143 	/* Get coerced size from another online chunk. */
3144 	csize = 0;
3145 	for (i = 0; i < sd->sd_meta->ssdi.ssd_chunk_no; i++) {
3146 		if (sd->sd_vol.sv_chunks[i]->src_meta.scm_status ==
3147 		    BIOC_SDONLINE) {
3148 			meta = &sd->sd_vol.sv_chunks[i]->src_meta;
3149 			csize = meta->scmi.scm_coerced_size;
3150 			break;
3151 		}
3152 	}
3153 	if (csize == 0) {
3154 		sr_error(sc, "no online chunks available for rebuild");
3155 		goto done;
3156 	}
3157 
3158 	sr_meta_getdevname(sc, dev, devname, sizeof(devname));
3159 	if (bdevvp(dev, &vn)) {
3160 		printf("%s: sr_rebuild_init: can't allocate vnode\n",
3161 		    DEVNAME(sc));
3162 		goto done;
3163 	}
3164 	if (VOP_OPEN(vn, FREAD | FWRITE, NOCRED, curproc)) {
3165 		DNPRINTF(SR_D_META,"%s: sr_ioctl_setstate can't "
3166 		    "open %s\n", DEVNAME(sc), devname);
3167 		vput(vn);
3168 		goto done;
3169 	}
3170 	open = 1; /* close dev on error */
3171 
3172 	/* Get disklabel and check partition. */
3173 	part = DISKPART(dev);
3174 	if (VOP_IOCTL(vn, DIOCGDINFO, (caddr_t)&label, FREAD,
3175 	    NOCRED, curproc)) {
3176 		DNPRINTF(SR_D_META, "%s: sr_ioctl_setstate ioctl failed\n",
3177 		    DEVNAME(sc));
3178 		goto done;
3179 	}
3180 	if (label.d_partitions[part].p_fstype != FS_RAID) {
3181 		sr_error(sc, "%s partition not of type RAID (%d)",
3182 		    devname, label.d_partitions[part].p_fstype);
3183 		goto done;
3184 	}
3185 
3186 	/* Is the partition large enough? */
3187 	size = DL_SECTOBLK(&label, DL_GETPSIZE(&label.d_partitions[part]));
3188 	if (size <= sd->sd_meta->ssd_data_blkno) {
3189 		sr_error(sc, "%s: %s partition too small", DEVNAME(sc),
3190 		    devname);
3191 		goto done;
3192 	}
3193 	size -= sd->sd_meta->ssd_data_blkno;
3194 	if (size > INT64_MAX) {
3195 		sr_error(sc, "%s: %s partition too large", DEVNAME(sc),
3196 		    devname);
3197 		goto done;
3198 	}
3199 	if (size < csize) {
3200 		sr_error(sc, "%s partition too small, at least %lld bytes "
3201 		    "required", devname, (long long)(csize << DEV_BSHIFT));
3202 		goto done;
3203 	} else if (size > csize)
3204 		sr_warn(sc, "%s partition too large, wasting %lld bytes",
3205 		    devname, (long long)((size - csize) << DEV_BSHIFT));
3206 	if (label.d_secsize > sd->sd_meta->ssdi.ssd_secsize) {
3207 		sr_error(sc, "%s sector size too large, <= %u bytes "
3208 		    "required", devname, sd->sd_meta->ssdi.ssd_secsize);
3209 		goto done;
3210 	}
3211 
3212 	/* Ensure that this chunk is not already in use. */
3213 	status = sr_chunk_in_use(sc, dev);
3214 	if (status != BIOC_SDINVALID && status != BIOC_SDOFFLINE &&
3215 	    !(hotspare && status == BIOC_SDHOTSPARE)) {
3216 		sr_error(sc, "%s is already in use", devname);
3217 		goto done;
3218 	}
3219 
3220 	/* Reset rebuild counter since we rebuilding onto a new chunk. */
3221 	sd->sd_meta->ssd_rebuild = 0;
3222 
3223 	open = 0; /* leave dev open from here on out */
3224 
3225 	/* Fix up chunk. */
3226 	memcpy(chunk->src_duid, label.d_uid, sizeof(chunk->src_duid));
3227 	chunk->src_dev_mm = dev;
3228 	chunk->src_vn = vn;
3229 
3230 	/* Reconstruct metadata. */
3231 	meta = &chunk->src_meta;
3232 	meta->scmi.scm_volid = sd->sd_meta->ssdi.ssd_volid;
3233 	meta->scmi.scm_chunk_id = cid;
3234 	strlcpy(meta->scmi.scm_devname, devname,
3235 	    sizeof(meta->scmi.scm_devname));
3236 	meta->scmi.scm_size = size;
3237 	meta->scmi.scm_coerced_size = csize;
3238 	memcpy(&meta->scmi.scm_uuid, &sd->sd_meta->ssdi.ssd_uuid,
3239 	    sizeof(meta->scmi.scm_uuid));
3240 	sr_checksum(sc, meta, &meta->scm_checksum,
3241 	    sizeof(struct sr_meta_chunk_invariant));
3242 
3243 	sd->sd_set_chunk_state(sd, cid, BIOC_SDREBUILD);
3244 
3245 	if (sr_meta_save(sd, SR_META_DIRTY)) {
3246 		sr_error(sc, "could not save metadata to %s", devname);
3247 		open = 1;
3248 		goto done;
3249 	}
3250 
3251 	sr_warn(sc, "rebuild of %s started on %s",
3252 	    sd->sd_meta->ssd_devname, devname);
3253 
3254 	sd->sd_reb_abort = 0;
3255 	kthread_create_deferred(sr_rebuild_start, sd);
3256 
3257 	rv = 0;
3258 done:
3259 	if (open) {
3260 		VOP_CLOSE(vn, FREAD | FWRITE, NOCRED, curproc);
3261 		vput(vn);
3262 	}
3263 
3264 	return (rv);
3265 }
3266 
3267 int
3268 sr_rebuild_percent(struct sr_discipline *sd)
3269 {
3270 	daddr_t			rb, sz;
3271 
3272 	sz = sd->sd_meta->ssdi.ssd_size;
3273 	rb = sd->sd_meta->ssd_rebuild;
3274 
3275 	if (rb > 0)
3276 		return (100 - ((sz * 100 - rb * 100) / sz) - 1);
3277 
3278 	return (0);
3279 }
3280 
3281 void
3282 sr_roam_chunks(struct sr_discipline *sd)
3283 {
3284 	struct sr_softc		*sc = sd->sd_sc;
3285 	struct sr_chunk		*chunk;
3286 	struct sr_meta_chunk	*meta;
3287 	int			roamed = 0;
3288 
3289 	/* Have any chunks roamed? */
3290 	SLIST_FOREACH(chunk, &sd->sd_vol.sv_chunk_list, src_link) {
3291 		meta = &chunk->src_meta;
3292 		if (strncmp(meta->scmi.scm_devname, chunk->src_devname,
3293 		    sizeof(meta->scmi.scm_devname))) {
3294 
3295 			printf("%s: roaming device %s -> %s\n", DEVNAME(sc),
3296 			    meta->scmi.scm_devname, chunk->src_devname);
3297 
3298 			strlcpy(meta->scmi.scm_devname, chunk->src_devname,
3299 			    sizeof(meta->scmi.scm_devname));
3300 
3301 			roamed++;
3302 		}
3303 	}
3304 
3305 	if (roamed)
3306 		sr_meta_save(sd, SR_META_DIRTY);
3307 }
3308 
3309 int
3310 sr_ioctl_createraid(struct sr_softc *sc, struct bioc_createraid *bc,
3311     int user, void *data)
3312 {
3313 	struct sr_meta_opt_item *omi;
3314 	struct sr_chunk_head	*cl;
3315 	struct sr_discipline	*sd = NULL;
3316 	struct sr_chunk		*ch_entry;
3317 	struct scsi_link	*link;
3318 	struct device		*dev;
3319 	char			*uuid, devname[32];
3320 	dev_t			*dt = NULL;
3321 	int			i, no_chunk, rv = EINVAL, target, vol;
3322 	int			no_meta;
3323 
3324 	DNPRINTF(SR_D_IOCTL, "%s: sr_ioctl_createraid(%d)\n",
3325 	    DEVNAME(sc), user);
3326 
3327 	/* user input */
3328 	if (bc->bc_dev_list_len > BIOC_CRMAXLEN)
3329 		goto unwind;
3330 
3331 	dt = malloc(bc->bc_dev_list_len, M_DEVBUF, M_WAITOK | M_ZERO);
3332 	if (user) {
3333 		if (copyin(bc->bc_dev_list, dt, bc->bc_dev_list_len) != 0)
3334 			goto unwind;
3335 	} else
3336 		memcpy(dt, bc->bc_dev_list, bc->bc_dev_list_len);
3337 
3338 	/* Initialise discipline. */
3339 	sd = malloc(sizeof(struct sr_discipline), M_DEVBUF, M_WAITOK | M_ZERO);
3340 	sd->sd_sc = sc;
3341 	SLIST_INIT(&sd->sd_meta_opt);
3342 	sd->sd_taskq = taskq_create("srdis", 1, IPL_BIO, 0);
3343 	if (sd->sd_taskq == NULL) {
3344 		sr_error(sc, "could not create discipline taskq");
3345 		goto unwind;
3346 	}
3347 	if (sr_discipline_init(sd, bc->bc_level)) {
3348 		sr_error(sc, "could not initialize discipline");
3349 		goto unwind;
3350 	}
3351 
3352 	no_chunk = bc->bc_dev_list_len / sizeof(dev_t);
3353 	cl = &sd->sd_vol.sv_chunk_list;
3354 	SLIST_INIT(cl);
3355 
3356 	/* Ensure that chunks are not already in use. */
3357 	for (i = 0; i < no_chunk; i++) {
3358 		if (sr_chunk_in_use(sc, dt[i]) != BIOC_SDINVALID) {
3359 			sr_meta_getdevname(sc, dt[i], devname, sizeof(devname));
3360 			sr_error(sc, "chunk %s already in use", devname);
3361 			goto unwind;
3362 		}
3363 	}
3364 
3365 	sd->sd_meta_type = sr_meta_probe(sd, dt, no_chunk);
3366 	if (sd->sd_meta_type == SR_META_F_INVALID) {
3367 		sr_error(sc, "invalid metadata format");
3368 		goto unwind;
3369 	}
3370 
3371 	if (sr_meta_attach(sd, no_chunk, bc->bc_flags & BIOC_SCFORCE))
3372 		goto unwind;
3373 
3374 	/* force the raid volume by clearing metadata region */
3375 	if (bc->bc_flags & BIOC_SCFORCE) {
3376 		/* make sure disk isn't up and running */
3377 		if (sr_meta_read(sd))
3378 			if (sr_already_assembled(sd)) {
3379 				uuid = sr_uuid_format(
3380 				    &sd->sd_meta->ssdi.ssd_uuid);
3381 				sr_error(sc, "disk %s is currently in use; "
3382 				    "cannot force create", uuid);
3383 				free(uuid, M_DEVBUF, 0);
3384 				goto unwind;
3385 			}
3386 
3387 		if (sr_meta_clear(sd)) {
3388 			sr_error(sc, "failed to clear metadata");
3389 			goto unwind;
3390 		}
3391 	}
3392 
3393 	no_meta = sr_meta_read(sd);
3394 	if (no_meta == -1) {
3395 
3396 		/* Corrupt metadata on one or more chunks. */
3397 		sr_error(sc, "one of the chunks has corrupt metadata; "
3398 		    "aborting assembly");
3399 		goto unwind;
3400 
3401 	} else if (no_meta == 0) {
3402 
3403 		/* Initialise volume and chunk metadata. */
3404 		sr_meta_init(sd, bc->bc_level, no_chunk);
3405 		sd->sd_vol_status = BIOC_SVONLINE;
3406 		sd->sd_meta_flags = bc->bc_flags & BIOC_SCNOAUTOASSEMBLE;
3407 		if (sd->sd_create) {
3408 			if ((i = sd->sd_create(sd, bc, no_chunk,
3409 			    sd->sd_vol.sv_chunk_minsz))) {
3410 				rv = i;
3411 				goto unwind;
3412 			}
3413 		}
3414 		sr_meta_init_complete(sd);
3415 
3416 		DNPRINTF(SR_D_IOCTL,
3417 		    "%s: sr_ioctl_createraid: vol_size: %lld\n",
3418 		    DEVNAME(sc), sd->sd_meta->ssdi.ssd_size);
3419 
3420 		/* Warn if we've wasted chunk space due to coercing. */
3421 		if ((sd->sd_capabilities & SR_CAP_NON_COERCED) == 0 &&
3422 		    sd->sd_vol.sv_chunk_minsz != sd->sd_vol.sv_chunk_maxsz)
3423 			sr_warn(sc, "chunk sizes are not equal; up to %llu "
3424 			    "blocks wasted per chunk",
3425 			    sd->sd_vol.sv_chunk_maxsz -
3426 			    sd->sd_vol.sv_chunk_minsz);
3427 
3428 	} else {
3429 
3430 		/* Ensure metadata level matches requested assembly level. */
3431 		if (sd->sd_meta->ssdi.ssd_level != bc->bc_level) {
3432 			sr_error(sc, "volume level does not match metadata "
3433 			    "level");
3434 			goto unwind;
3435 		}
3436 
3437 		if (sr_already_assembled(sd)) {
3438 			uuid = sr_uuid_format(&sd->sd_meta->ssdi.ssd_uuid);
3439 			sr_error(sc, "disk %s already assembled", uuid);
3440 			free(uuid, M_DEVBUF, 0);
3441 			goto unwind;
3442 		}
3443 
3444 		if (user == 0 && sd->sd_meta_flags & BIOC_SCNOAUTOASSEMBLE) {
3445 			DNPRINTF(SR_D_META, "%s: disk not auto assembled from "
3446 			    "metadata\n", DEVNAME(sc));
3447 			goto unwind;
3448 		}
3449 
3450 		if (no_meta != no_chunk)
3451 			sr_warn(sc, "trying to bring up %s degraded",
3452 			    sd->sd_meta->ssd_devname);
3453 
3454 		if (sd->sd_meta->ssd_meta_flags & SR_META_DIRTY)
3455 			sr_warn(sc, "%s was not shutdown properly",
3456 			    sd->sd_meta->ssd_devname);
3457 
3458 		SLIST_FOREACH(omi, &sd->sd_meta_opt, omi_link)
3459 			if (sd->sd_meta_opt_handler == NULL ||
3460 			    sd->sd_meta_opt_handler(sd, omi->omi_som) != 0)
3461 				sr_meta_opt_handler(sd, omi->omi_som);
3462 
3463 		if (sd->sd_assemble) {
3464 			if ((i = sd->sd_assemble(sd, bc, no_chunk, data))) {
3465 				rv = i;
3466 				goto unwind;
3467 			}
3468 		}
3469 
3470 		DNPRINTF(SR_D_META, "%s: disk assembled from metadata\n",
3471 		    DEVNAME(sc));
3472 
3473 	}
3474 
3475 	/* Metadata MUST be fully populated by this point. */
3476 	TAILQ_INSERT_TAIL(&sc->sc_dis_list, sd, sd_link);
3477 
3478 	/* Allocate all resources. */
3479 	if ((rv = sd->sd_alloc_resources(sd)))
3480 		goto unwind;
3481 
3482 	/* Adjust flags if necessary. */
3483 	if ((sd->sd_capabilities & SR_CAP_AUTO_ASSEMBLE) &&
3484 	    (bc->bc_flags & BIOC_SCNOAUTOASSEMBLE) !=
3485 	    (sd->sd_meta->ssdi.ssd_vol_flags & BIOC_SCNOAUTOASSEMBLE)) {
3486 		sd->sd_meta->ssdi.ssd_vol_flags &= ~BIOC_SCNOAUTOASSEMBLE;
3487 		sd->sd_meta->ssdi.ssd_vol_flags |=
3488 		    bc->bc_flags & BIOC_SCNOAUTOASSEMBLE;
3489 	}
3490 
3491 	if (sd->sd_capabilities & SR_CAP_SYSTEM_DISK) {
3492 		/* Initialise volume state. */
3493 		sd->sd_set_vol_state(sd);
3494 		if (sd->sd_vol_status == BIOC_SVOFFLINE) {
3495 			sr_error(sc, "%s is offline, will not be brought "
3496 			    "online", sd->sd_meta->ssd_devname);
3497 			goto unwind;
3498 		}
3499 
3500 		/* Setup SCSI iopool. */
3501 		scsi_iopool_init(&sd->sd_iopool, sd, sr_wu_get, sr_wu_put);
3502 
3503 		/*
3504 		 * All checks passed - return ENXIO if volume cannot be created.
3505 		 */
3506 		rv = ENXIO;
3507 
3508 		/*
3509 		 * Find a free target.
3510 		 *
3511 		 * XXX: We reserve sd_target == 0 to indicate the
3512 		 * discipline is not linked into sc->sc_targets, so begin
3513 		 * the search with target = 1.
3514 		 */
3515 		for (target = 1; target < SR_MAX_LD; target++)
3516 			if (sc->sc_targets[target] == NULL)
3517 				break;
3518 		if (target == SR_MAX_LD) {
3519 			sr_error(sc, "no free target for %s",
3520 			    sd->sd_meta->ssd_devname);
3521 			goto unwind;
3522 		}
3523 
3524 		/* Clear sense data. */
3525 		bzero(&sd->sd_scsi_sense, sizeof(sd->sd_scsi_sense));
3526 
3527 		/* Attach discipline and get midlayer to probe it. */
3528 		sd->sd_target = target;
3529 		sc->sc_targets[target] = sd;
3530 		if (scsi_probe_lun(sc->sc_scsibus, target, 0) != 0) {
3531 			sr_error(sc, "scsi_probe_lun failed");
3532 			sc->sc_targets[target] = NULL;
3533 			sd->sd_target = 0;
3534 			goto unwind;
3535 		}
3536 
3537 		link = scsi_get_link(sc->sc_scsibus, target, 0);
3538 		if (link == NULL)
3539 			goto unwind;
3540 
3541 		dev = link->device_softc;
3542 		DNPRINTF(SR_D_IOCTL, "%s: sr device added: %s at target %d\n",
3543 		    DEVNAME(sc), dev->dv_xname, sd->sd_target);
3544 
3545 		/* XXX - Count volumes, not targets. */
3546 		for (i = 0, vol = -1; i <= sd->sd_target; i++)
3547 			if (sc->sc_targets[i])
3548 				vol++;
3549 
3550 		rv = 0;
3551 
3552 		if (sd->sd_meta->ssd_devname[0] != '\0' &&
3553 		    strncmp(sd->sd_meta->ssd_devname, dev->dv_xname,
3554 		    sizeof(dev->dv_xname)))
3555 			sr_warn(sc, "volume %s is roaming, it used to be %s, "
3556 			    "updating metadata", dev->dv_xname,
3557 			    sd->sd_meta->ssd_devname);
3558 
3559 		/* Populate remaining volume metadata. */
3560 		sd->sd_meta->ssdi.ssd_volid = vol;
3561 		strlcpy(sd->sd_meta->ssd_devname, dev->dv_xname,
3562 		    sizeof(sd->sd_meta->ssd_devname));
3563 
3564 		sr_info(sc, "%s volume attached as %s",
3565 		    sd->sd_name, sd->sd_meta->ssd_devname);
3566 
3567 		/* Update device name on any roaming chunks. */
3568 		sr_roam_chunks(sd);
3569 
3570 #ifndef SMALL_KERNEL
3571 		if (sr_sensors_create(sd))
3572 			sr_warn(sc, "unable to create sensor for %s",
3573 			    dev->dv_xname);
3574 #endif /* SMALL_KERNEL */
3575 	} else {
3576 		/* This volume does not attach as a system disk. */
3577 		ch_entry = SLIST_FIRST(cl); /* XXX */
3578 		strlcpy(sd->sd_meta->ssd_devname, ch_entry->src_devname,
3579 		    sizeof(sd->sd_meta->ssd_devname));
3580 
3581 		if (sd->sd_start_discipline(sd))
3582 			goto unwind;
3583 	}
3584 
3585 	/* Save current metadata to disk. */
3586 	rv = sr_meta_save(sd, SR_META_DIRTY);
3587 
3588 	if (sd->sd_vol_status == BIOC_SVREBUILD)
3589 		kthread_create_deferred(sr_rebuild_start, sd);
3590 
3591 	sd->sd_ready = 1;
3592 
3593 	free(dt, M_DEVBUF, bc->bc_dev_list_len);
3594 
3595 	return (rv);
3596 
3597 unwind:
3598 	free(dt, M_DEVBUF, bc->bc_dev_list_len);
3599 
3600 	sr_discipline_shutdown(sd, 0);
3601 
3602 	if (rv == EAGAIN)
3603 		rv = 0;
3604 
3605 	return (rv);
3606 }
3607 
3608 int
3609 sr_ioctl_deleteraid(struct sr_softc *sc, struct sr_discipline *sd,
3610     struct bioc_deleteraid *bd)
3611 {
3612 	int			rv = 1;
3613 
3614 	DNPRINTF(SR_D_IOCTL, "%s: sr_ioctl_deleteraid %s\n",
3615 	    DEVNAME(sc), bd->bd_dev);
3616 
3617 	if (sd == NULL) {
3618 		TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
3619 			if (!strncmp(sd->sd_meta->ssd_devname, bd->bd_dev,
3620 			    sizeof(sd->sd_meta->ssd_devname)))
3621 				break;
3622 		}
3623 		if (sd == NULL) {
3624 			sr_error(sc, "volume %s not found", bd->bd_dev);
3625 			goto bad;
3626 		}
3627 	}
3628 
3629 	sd->sd_deleted = 1;
3630 	sd->sd_meta->ssdi.ssd_vol_flags = BIOC_SCNOAUTOASSEMBLE;
3631 	sr_discipline_shutdown(sd, 1);
3632 
3633 	rv = 0;
3634 bad:
3635 	return (rv);
3636 }
3637 
3638 int
3639 sr_ioctl_discipline(struct sr_softc *sc, struct sr_discipline *sd,
3640     struct bioc_discipline *bd)
3641 {
3642 	int			rv = 1;
3643 
3644 	/* Dispatch a discipline specific ioctl. */
3645 
3646 	DNPRINTF(SR_D_IOCTL, "%s: sr_ioctl_discipline %s\n", DEVNAME(sc),
3647 	    bd->bd_dev);
3648 
3649 	if (sd == NULL) {
3650 		TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
3651 			if (!strncmp(sd->sd_meta->ssd_devname, bd->bd_dev,
3652 			    sizeof(sd->sd_meta->ssd_devname)))
3653 				break;
3654 		}
3655 		if (sd == NULL) {
3656 			sr_error(sc, "volume %s not found", bd->bd_dev);
3657 			goto bad;
3658 		}
3659 	}
3660 
3661 	if (sd->sd_ioctl_handler)
3662 		rv = sd->sd_ioctl_handler(sd, bd);
3663 
3664 bad:
3665 	return (rv);
3666 }
3667 
3668 int
3669 sr_ioctl_installboot(struct sr_softc *sc, struct sr_discipline *sd,
3670     struct bioc_installboot *bb)
3671 {
3672 	void			*bootblk = NULL, *bootldr = NULL;
3673 	struct sr_chunk		*chunk;
3674 	struct sr_meta_opt_item *omi;
3675 	struct sr_meta_boot	*sbm;
3676 	struct disk		*dk;
3677 	u_int32_t		bbs, bls, secsize;
3678 	u_char			duid[8];
3679 	int			rv = EINVAL;
3680 	int			i;
3681 
3682 	DNPRINTF(SR_D_IOCTL, "%s: sr_ioctl_installboot %s\n", DEVNAME(sc),
3683 	    bb->bb_dev);
3684 
3685 	if (sd == NULL) {
3686 		TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
3687 			if (!strncmp(sd->sd_meta->ssd_devname, bb->bb_dev,
3688 			    sizeof(sd->sd_meta->ssd_devname)))
3689 				break;
3690 		}
3691 		if (sd == NULL) {
3692 			sr_error(sc, "volume %s not found", bb->bb_dev);
3693 			goto done;
3694 		}
3695 	}
3696 
3697 	bzero(duid, sizeof(duid));
3698 	TAILQ_FOREACH(dk, &disklist,  dk_link)
3699 		if (!strncmp(dk->dk_name, bb->bb_dev, sizeof(bb->bb_dev)))
3700 			break;
3701 	if (dk == NULL || dk->dk_label == NULL ||
3702 	    (dk->dk_flags & DKF_LABELVALID) == 0 ||
3703 	    bcmp(dk->dk_label->d_uid, &duid, sizeof(duid)) == 0) {
3704 		sr_error(sc, "failed to get DUID for softraid volume");
3705 		goto done;
3706 	}
3707 	memcpy(duid, dk->dk_label->d_uid, sizeof(duid));
3708 
3709 	/* Ensure that boot storage area is large enough. */
3710 	if (sd->sd_meta->ssd_data_blkno < (SR_BOOT_OFFSET + SR_BOOT_SIZE)) {
3711 		sr_error(sc, "insufficient boot storage");
3712 		goto done;
3713 	}
3714 
3715 	if (bb->bb_bootblk_size > SR_BOOT_BLOCKS_SIZE * DEV_BSIZE)
3716 		goto done;
3717 
3718 	if (bb->bb_bootldr_size > SR_BOOT_LOADER_SIZE * DEV_BSIZE)
3719 		goto done;
3720 
3721 	secsize = sd->sd_meta->ssdi.ssd_secsize;
3722 
3723 	/* Copy in boot block. */
3724 	bbs = howmany(bb->bb_bootblk_size, secsize) * secsize;
3725 	bootblk = malloc(bbs, M_DEVBUF, M_WAITOK | M_ZERO);
3726 	if (copyin(bb->bb_bootblk, bootblk, bb->bb_bootblk_size) != 0)
3727 		goto done;
3728 
3729 	/* Copy in boot loader. */
3730 	bls = howmany(bb->bb_bootldr_size, secsize) * secsize;
3731 	bootldr = malloc(bls, M_DEVBUF, M_WAITOK | M_ZERO);
3732 	if (copyin(bb->bb_bootldr, bootldr, bb->bb_bootldr_size) != 0)
3733 		goto done;
3734 
3735 	/* Create or update optional meta for bootable volumes. */
3736 	SLIST_FOREACH(omi, &sd->sd_meta_opt, omi_link)
3737 		if (omi->omi_som->som_type == SR_OPT_BOOT)
3738 			break;
3739 	if (omi == NULL) {
3740 		omi = malloc(sizeof(struct sr_meta_opt_item), M_DEVBUF,
3741 		    M_WAITOK | M_ZERO);
3742 		omi->omi_som = malloc(sizeof(struct sr_meta_crypto), M_DEVBUF,
3743 		    M_WAITOK | M_ZERO);
3744 		omi->omi_som->som_type = SR_OPT_BOOT;
3745 		omi->omi_som->som_length = sizeof(struct sr_meta_boot);
3746 		SLIST_INSERT_HEAD(&sd->sd_meta_opt, omi, omi_link);
3747 		sd->sd_meta->ssdi.ssd_opt_no++;
3748 	}
3749 	sbm = (struct sr_meta_boot *)omi->omi_som;
3750 
3751 	memcpy(sbm->sbm_root_duid, duid, sizeof(sbm->sbm_root_duid));
3752 	bzero(&sbm->sbm_boot_duid, sizeof(sbm->sbm_boot_duid));
3753 	sbm->sbm_bootblk_size = bbs;
3754 	sbm->sbm_bootldr_size = bls;
3755 
3756 	DNPRINTF(SR_D_IOCTL, "sr_ioctl_installboot: root duid is "
3757 	    "%02x%02x%02x%02x%02x%02x%02x%02x\n", sbm->sbm_root_duid[0],
3758 	    sbm->sbm_root_duid[1], sbm->sbm_root_duid[2], sbm->sbm_root_duid[3],
3759 	    sbm->sbm_root_duid[4], sbm->sbm_root_duid[5], sbm->sbm_root_duid[6],
3760 	    sbm->sbm_root_duid[7]);
3761 
3762 	/* Save boot block and boot loader to each chunk. */
3763 	for (i = 0; i < sd->sd_meta->ssdi.ssd_chunk_no; i++) {
3764 
3765 		chunk = sd->sd_vol.sv_chunks[i];
3766 		if (chunk->src_meta.scm_status != BIOC_SDONLINE &&
3767 		    chunk->src_meta.scm_status != BIOC_SDREBUILD)
3768 			continue;
3769 
3770 		if (i < SR_MAX_BOOT_DISKS)
3771 			memcpy(&sbm->sbm_boot_duid[i], chunk->src_duid,
3772 			    sizeof(sbm->sbm_boot_duid[i]));
3773 
3774 		/* Save boot blocks. */
3775 		DNPRINTF(SR_D_IOCTL,
3776 		    "sr_ioctl_installboot: saving boot block to %s "
3777 		    "(%u bytes)\n", chunk->src_devname, bbs);
3778 
3779 		if (sr_rw(sc, chunk->src_dev_mm, bootblk, bbs,
3780 		    SR_BOOT_BLOCKS_OFFSET, B_WRITE)) {
3781 			sr_error(sc, "failed to write boot block", DEVNAME(sc));
3782 			goto done;
3783 		}
3784 
3785 		/* Save boot loader.*/
3786 		DNPRINTF(SR_D_IOCTL,
3787 		    "sr_ioctl_installboot: saving boot loader to %s "
3788 		    "(%u bytes)\n", chunk->src_devname, bls);
3789 
3790 		if (sr_rw(sc, chunk->src_dev_mm, bootldr, bls,
3791 		    SR_BOOT_LOADER_OFFSET, B_WRITE)) {
3792 			sr_error(sc, "failed to write boot loader");
3793 			goto done;
3794 		}
3795 	}
3796 
3797 	/* XXX - Install boot block on disk - MD code. */
3798 
3799 	/* Mark volume as bootable and save metadata. */
3800 	sd->sd_meta->ssdi.ssd_vol_flags |= BIOC_SCBOOTABLE;
3801 	if (sr_meta_save(sd, SR_META_DIRTY)) {
3802 		sr_error(sc, "could not save metadata to %s", DEVNAME(sc));
3803 		goto done;
3804 	}
3805 
3806 	rv = 0;
3807 
3808 done:
3809 	free(bootblk, M_DEVBUF, 0);
3810 	free(bootldr, M_DEVBUF, 0);
3811 
3812 	return (rv);
3813 }
3814 
3815 void
3816 sr_chunks_unwind(struct sr_softc *sc, struct sr_chunk_head *cl)
3817 {
3818 	struct sr_chunk		*ch_entry, *ch_next;
3819 
3820 	DNPRINTF(SR_D_IOCTL, "%s: sr_chunks_unwind\n", DEVNAME(sc));
3821 
3822 	if (!cl)
3823 		return;
3824 
3825 	for (ch_entry = SLIST_FIRST(cl); ch_entry != NULL; ch_entry = ch_next) {
3826 		ch_next = SLIST_NEXT(ch_entry, src_link);
3827 
3828 		DNPRINTF(SR_D_IOCTL, "%s: sr_chunks_unwind closing: %s\n",
3829 		    DEVNAME(sc), ch_entry->src_devname);
3830 		if (ch_entry->src_vn) {
3831 			/*
3832 			 * XXX - explicitly lock the vnode until we can resolve
3833 			 * the problem introduced by vnode aliasing... specfs
3834 			 * has no locking, whereas ufs/ffs does!
3835 			 */
3836 			vn_lock(ch_entry->src_vn, LK_EXCLUSIVE |
3837 			    LK_RETRY, curproc);
3838 			VOP_CLOSE(ch_entry->src_vn, FREAD | FWRITE, NOCRED,
3839 			    curproc);
3840 			vput(ch_entry->src_vn);
3841 		}
3842 		free(ch_entry, M_DEVBUF, 0);
3843 	}
3844 	SLIST_INIT(cl);
3845 }
3846 
3847 void
3848 sr_discipline_free(struct sr_discipline *sd)
3849 {
3850 	struct sr_softc		*sc;
3851 	struct sr_discipline	*sdtmp1;
3852 	struct sr_meta_opt_head *som;
3853 	struct sr_meta_opt_item	*omi, *omi_next;
3854 
3855 	if (!sd)
3856 		return;
3857 
3858 	sc = sd->sd_sc;
3859 
3860 	DNPRINTF(SR_D_DIS, "%s: sr_discipline_free %s\n",
3861 	    DEVNAME(sc),
3862 	    sd->sd_meta ? sd->sd_meta->ssd_devname : "nodev");
3863 	if (sd->sd_free_resources)
3864 		sd->sd_free_resources(sd);
3865 	free(sd->sd_vol.sv_chunks, M_DEVBUF, 0);
3866 	free(sd->sd_meta, M_DEVBUF, 0);
3867 	free(sd->sd_meta_foreign, M_DEVBUF, 0);
3868 
3869 	som = &sd->sd_meta_opt;
3870 	for (omi = SLIST_FIRST(som); omi != NULL; omi = omi_next) {
3871 		omi_next = SLIST_NEXT(omi, omi_link);
3872 		free(omi->omi_som, M_DEVBUF, 0);
3873 		free(omi, M_DEVBUF, 0);
3874 	}
3875 
3876 	if (sd->sd_target != 0) {
3877 		KASSERT(sc->sc_targets[sd->sd_target] == sd);
3878 		sc->sc_targets[sd->sd_target] = NULL;
3879 	}
3880 
3881 	TAILQ_FOREACH(sdtmp1, &sc->sc_dis_list, sd_link) {
3882 		if (sdtmp1 == sd)
3883 			break;
3884 	}
3885 	if (sdtmp1 != NULL)
3886 		TAILQ_REMOVE(&sc->sc_dis_list, sd, sd_link);
3887 
3888 	explicit_bzero(sd, sizeof *sd);
3889 	free(sd, M_DEVBUF, 0);
3890 }
3891 
3892 void
3893 sr_discipline_shutdown(struct sr_discipline *sd, int meta_save)
3894 {
3895 	struct sr_softc		*sc;
3896 	int			s;
3897 
3898 	if (!sd)
3899 		return;
3900 	sc = sd->sd_sc;
3901 
3902 	DNPRINTF(SR_D_DIS, "%s: sr_discipline_shutdown %s\n", DEVNAME(sc),
3903 	    sd->sd_meta ? sd->sd_meta->ssd_devname : "nodev");
3904 
3905 	/* If rebuilding, abort rebuild and drain I/O. */
3906 	if (sd->sd_reb_active) {
3907 		sd->sd_reb_abort = 1;
3908 		while (sd->sd_reb_active)
3909 			tsleep(sd, PWAIT, "sr_shutdown", 1);
3910 	}
3911 
3912 	if (meta_save)
3913 		sr_meta_save(sd, 0);
3914 
3915 	s = splbio();
3916 
3917 	sd->sd_ready = 0;
3918 
3919 	/* make sure there isn't a sync pending and yield */
3920 	wakeup(sd);
3921 	while (sd->sd_sync || sd->sd_must_flush)
3922 		if (tsleep(&sd->sd_sync, MAXPRI, "sr_down", 60 * hz) ==
3923 		    EWOULDBLOCK)
3924 			break;
3925 
3926 #ifndef SMALL_KERNEL
3927 	sr_sensors_delete(sd);
3928 #endif /* SMALL_KERNEL */
3929 
3930 	if (sd->sd_target != 0)
3931 		scsi_detach_lun(sc->sc_scsibus, sd->sd_target, 0, DETACH_FORCE);
3932 
3933 	sr_chunks_unwind(sc, &sd->sd_vol.sv_chunk_list);
3934 
3935 	if (sd->sd_taskq)
3936 		taskq_destroy(sd->sd_taskq);
3937 
3938 	sr_discipline_free(sd);
3939 
3940 	splx(s);
3941 }
3942 
3943 int
3944 sr_discipline_init(struct sr_discipline *sd, int level)
3945 {
3946 	int			rv = 1;
3947 
3948 	/* Initialise discipline function pointers with defaults. */
3949 	sd->sd_alloc_resources = sr_alloc_resources;
3950 	sd->sd_assemble = NULL;
3951 	sd->sd_create = NULL;
3952 	sd->sd_free_resources = sr_free_resources;
3953 	sd->sd_ioctl_handler = NULL;
3954 	sd->sd_openings = NULL;
3955 	sd->sd_meta_opt_handler = NULL;
3956 	sd->sd_rebuild = sr_rebuild;
3957 	sd->sd_scsi_inquiry = sr_raid_inquiry;
3958 	sd->sd_scsi_read_cap = sr_raid_read_cap;
3959 	sd->sd_scsi_tur = sr_raid_tur;
3960 	sd->sd_scsi_req_sense = sr_raid_request_sense;
3961 	sd->sd_scsi_start_stop = sr_raid_start_stop;
3962 	sd->sd_scsi_sync = sr_raid_sync;
3963 	sd->sd_scsi_rw = NULL;
3964 	sd->sd_scsi_intr = sr_raid_intr;
3965 	sd->sd_scsi_wu_done = NULL;
3966 	sd->sd_scsi_done = NULL;
3967 	sd->sd_set_chunk_state = sr_set_chunk_state;
3968 	sd->sd_set_vol_state = sr_set_vol_state;
3969 	sd->sd_start_discipline = NULL;
3970 
3971 	task_set(&sd->sd_meta_save_task, sr_meta_save_callback, sd);
3972 	task_set(&sd->sd_hotspare_rebuild_task, sr_hotspare_rebuild_callback,
3973 	    sd);
3974 
3975 	switch (level) {
3976 	case 0:
3977 		sr_raid0_discipline_init(sd);
3978 		break;
3979 	case 1:
3980 		sr_raid1_discipline_init(sd);
3981 		break;
3982 	case 5:
3983 		sr_raid5_discipline_init(sd);
3984 		break;
3985 	case 6:
3986 		sr_raid6_discipline_init(sd);
3987 		break;
3988 #ifdef CRYPTO
3989 	case 'C':
3990 		sr_crypto_discipline_init(sd);
3991 		break;
3992 #endif
3993 	case 'c':
3994 		sr_concat_discipline_init(sd);
3995 		break;
3996 	default:
3997 		goto bad;
3998 	}
3999 
4000 	rv = 0;
4001 bad:
4002 	return (rv);
4003 }
4004 
4005 int
4006 sr_raid_inquiry(struct sr_workunit *wu)
4007 {
4008 	struct sr_discipline	*sd = wu->swu_dis;
4009 	struct scsi_xfer	*xs = wu->swu_xs;
4010 	struct scsi_inquiry	*cdb = (struct scsi_inquiry *)xs->cmd;
4011 	struct scsi_inquiry_data inq;
4012 
4013 	DNPRINTF(SR_D_DIS, "%s: sr_raid_inquiry\n", DEVNAME(sd->sd_sc));
4014 
4015 	if (xs->cmdlen != sizeof(*cdb))
4016 		return (EINVAL);
4017 
4018 	if (ISSET(cdb->flags, SI_EVPD))
4019 		return (EOPNOTSUPP);
4020 
4021 	bzero(&inq, sizeof(inq));
4022 	inq.device = T_DIRECT;
4023 	inq.dev_qual2 = 0;
4024 	inq.version = 2;
4025 	inq.response_format = 2;
4026 	inq.additional_length = 32;
4027 	inq.flags |= SID_CmdQue;
4028 	strlcpy(inq.vendor, sd->sd_meta->ssdi.ssd_vendor,
4029 	    sizeof(inq.vendor));
4030 	strlcpy(inq.product, sd->sd_meta->ssdi.ssd_product,
4031 	    sizeof(inq.product));
4032 	strlcpy(inq.revision, sd->sd_meta->ssdi.ssd_revision,
4033 	    sizeof(inq.revision));
4034 	sr_copy_internal_data(xs, &inq, sizeof(inq));
4035 
4036 	return (0);
4037 }
4038 
4039 int
4040 sr_raid_read_cap(struct sr_workunit *wu)
4041 {
4042 	struct sr_discipline	*sd = wu->swu_dis;
4043 	struct scsi_xfer	*xs = wu->swu_xs;
4044 	struct scsi_read_cap_data rcd;
4045 	struct scsi_read_cap_data_16 rcd16;
4046 	u_int64_t		addr;
4047 	int			rv = 1;
4048 	u_int32_t		secsize;
4049 
4050 	DNPRINTF(SR_D_DIS, "%s: sr_raid_read_cap\n", DEVNAME(sd->sd_sc));
4051 
4052 	secsize = sd->sd_meta->ssdi.ssd_secsize;
4053 
4054 	addr = ((sd->sd_meta->ssdi.ssd_size * DEV_BSIZE) / secsize) - 1;
4055 	if (xs->cmd->opcode == READ_CAPACITY) {
4056 		bzero(&rcd, sizeof(rcd));
4057 		if (addr > 0xffffffffllu)
4058 			_lto4b(0xffffffff, rcd.addr);
4059 		else
4060 			_lto4b(addr, rcd.addr);
4061 		_lto4b(secsize, rcd.length);
4062 		sr_copy_internal_data(xs, &rcd, sizeof(rcd));
4063 		rv = 0;
4064 	} else if (xs->cmd->opcode == READ_CAPACITY_16) {
4065 		bzero(&rcd16, sizeof(rcd16));
4066 		_lto8b(addr, rcd16.addr);
4067 		_lto4b(secsize, rcd16.length);
4068 		sr_copy_internal_data(xs, &rcd16, sizeof(rcd16));
4069 		rv = 0;
4070 	}
4071 
4072 	return (rv);
4073 }
4074 
4075 int
4076 sr_raid_tur(struct sr_workunit *wu)
4077 {
4078 	struct sr_discipline	*sd = wu->swu_dis;
4079 
4080 	DNPRINTF(SR_D_DIS, "%s: sr_raid_tur\n", DEVNAME(sd->sd_sc));
4081 
4082 	if (sd->sd_vol_status == BIOC_SVOFFLINE) {
4083 		sd->sd_scsi_sense.error_code = SSD_ERRCODE_CURRENT;
4084 		sd->sd_scsi_sense.flags = SKEY_NOT_READY;
4085 		sd->sd_scsi_sense.add_sense_code = 0x04;
4086 		sd->sd_scsi_sense.add_sense_code_qual = 0x11;
4087 		sd->sd_scsi_sense.extra_len = 4;
4088 		return (1);
4089 	} else if (sd->sd_vol_status == BIOC_SVINVALID) {
4090 		sd->sd_scsi_sense.error_code = SSD_ERRCODE_CURRENT;
4091 		sd->sd_scsi_sense.flags = SKEY_HARDWARE_ERROR;
4092 		sd->sd_scsi_sense.add_sense_code = 0x05;
4093 		sd->sd_scsi_sense.add_sense_code_qual = 0x00;
4094 		sd->sd_scsi_sense.extra_len = 4;
4095 		return (1);
4096 	}
4097 
4098 	return (0);
4099 }
4100 
4101 int
4102 sr_raid_request_sense(struct sr_workunit *wu)
4103 {
4104 	struct sr_discipline	*sd = wu->swu_dis;
4105 	struct scsi_xfer	*xs = wu->swu_xs;
4106 
4107 	DNPRINTF(SR_D_DIS, "%s: sr_raid_request_sense\n",
4108 	    DEVNAME(sd->sd_sc));
4109 
4110 	/* use latest sense data */
4111 	memcpy(&xs->sense, &sd->sd_scsi_sense, sizeof(xs->sense));
4112 
4113 	/* clear sense data */
4114 	bzero(&sd->sd_scsi_sense, sizeof(sd->sd_scsi_sense));
4115 
4116 	return (0);
4117 }
4118 
4119 int
4120 sr_raid_start_stop(struct sr_workunit *wu)
4121 {
4122 	struct scsi_xfer	*xs = wu->swu_xs;
4123 	struct scsi_start_stop	*ss = (struct scsi_start_stop *)xs->cmd;
4124 
4125 	DNPRINTF(SR_D_DIS, "%s: sr_raid_start_stop\n",
4126 	    DEVNAME(wu->swu_dis->sd_sc));
4127 
4128 	if (!ss)
4129 		return (1);
4130 
4131 	/*
4132 	 * do nothing!
4133 	 * a softraid discipline should always reflect correct status
4134 	 */
4135 	return (0);
4136 }
4137 
4138 int
4139 sr_raid_sync(struct sr_workunit *wu)
4140 {
4141 	struct sr_discipline	*sd = wu->swu_dis;
4142 	int			s, rv = 0, ios;
4143 
4144 	DNPRINTF(SR_D_DIS, "%s: sr_raid_sync\n", DEVNAME(sd->sd_sc));
4145 
4146 	/* when doing a fake sync don't count the wu */
4147 	ios = (wu->swu_flags & SR_WUF_FAKE) ? 0 : 1;
4148 
4149 	s = splbio();
4150 	sd->sd_sync = 1;
4151 	while (sd->sd_wu_pending > ios) {
4152 		if (tsleep(sd, PRIBIO, "sr_sync", 15 * hz) == EWOULDBLOCK) {
4153 			DNPRINTF(SR_D_DIS, "%s: sr_raid_sync timeout\n",
4154 			    DEVNAME(sd->sd_sc));
4155 			rv = 1;
4156 			break;
4157 		}
4158 	}
4159 	sd->sd_sync = 0;
4160 	splx(s);
4161 
4162 	wakeup(&sd->sd_sync);
4163 
4164 	return (rv);
4165 }
4166 
4167 void
4168 sr_raid_intr(struct buf *bp)
4169 {
4170 	struct sr_ccb		*ccb = (struct sr_ccb *)bp;
4171 	struct sr_workunit	*wu = ccb->ccb_wu;
4172 #ifdef SR_DEBUG
4173 	struct sr_discipline	*sd = wu->swu_dis;
4174 	struct scsi_xfer	*xs = wu->swu_xs;
4175 #endif
4176 	int			s;
4177 
4178 	DNPRINTF(SR_D_INTR, "%s: %s %s intr bp %p xs %p\n",
4179 	    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname, sd->sd_name, bp, xs);
4180 
4181 	s = splbio();
4182 	sr_ccb_done(ccb);
4183 	sr_wu_done(wu);
4184 	splx(s);
4185 }
4186 
4187 void
4188 sr_schedule_wu(struct sr_workunit *wu)
4189 {
4190 	struct sr_discipline	*sd = wu->swu_dis;
4191 	struct sr_workunit	*wup;
4192 	int			s;
4193 
4194 	DNPRINTF(SR_D_WU, "sr_schedule_wu: schedule wu %p state %i "
4195 	    "flags 0x%x\n", wu, wu->swu_state, wu->swu_flags);
4196 
4197 	KASSERT(wu->swu_io_count > 0);
4198 
4199 	s = splbio();
4200 
4201 	/* Construct the work unit, do not schedule it. */
4202 	if (wu->swu_state == SR_WU_CONSTRUCT)
4203 		goto queued;
4204 
4205 	/* Deferred work unit being reconstructed, do not start. */
4206 	if (wu->swu_state == SR_WU_REQUEUE)
4207 		goto queued;
4208 
4209 	/* Current work unit failed, restart. */
4210 	if (wu->swu_state == SR_WU_RESTART)
4211 		goto start;
4212 
4213 	if (wu->swu_state != SR_WU_INPROGRESS)
4214 		panic("sr_schedule_wu: work unit not in progress (state %i)\n",
4215 		    wu->swu_state);
4216 
4217 	/* Walk queue backwards and fill in collider if we have one. */
4218 	TAILQ_FOREACH_REVERSE(wup, &sd->sd_wu_pendq, sr_wu_list, swu_link) {
4219 		if (wu->swu_blk_end < wup->swu_blk_start ||
4220 		    wup->swu_blk_end < wu->swu_blk_start)
4221 			continue;
4222 
4223 		/* Defer work unit due to LBA collision. */
4224 		DNPRINTF(SR_D_WU, "sr_schedule_wu: deferring work unit %p\n",
4225 		    wu);
4226 		wu->swu_state = SR_WU_DEFERRED;
4227 		while (wup->swu_collider)
4228 			wup = wup->swu_collider;
4229 		wup->swu_collider = wu;
4230 		TAILQ_INSERT_TAIL(&sd->sd_wu_defq, wu, swu_link);
4231 		sd->sd_wu_collisions++;
4232 		goto queued;
4233 	}
4234 
4235 start:
4236 	sr_raid_startwu(wu);
4237 
4238 queued:
4239 	splx(s);
4240 }
4241 
4242 void
4243 sr_raid_startwu(struct sr_workunit *wu)
4244 {
4245 	struct sr_discipline	*sd = wu->swu_dis;
4246 	struct sr_ccb		*ccb;
4247 
4248 	DNPRINTF(SR_D_WU, "sr_raid_startwu: start wu %p\n", wu);
4249 
4250 	splassert(IPL_BIO);
4251 
4252 	if (wu->swu_state == SR_WU_DEFERRED) {
4253 		TAILQ_REMOVE(&sd->sd_wu_defq, wu, swu_link);
4254 		wu->swu_state = SR_WU_INPROGRESS;
4255 	}
4256 
4257 	if (wu->swu_state != SR_WU_RESTART)
4258 		TAILQ_INSERT_TAIL(&sd->sd_wu_pendq, wu, swu_link);
4259 
4260 	/* Start all of the individual I/Os. */
4261 	if (wu->swu_cb_active == 1)
4262 		panic("%s: sr_startwu_callback", DEVNAME(sd->sd_sc));
4263 	wu->swu_cb_active = 1;
4264 
4265 	TAILQ_FOREACH(ccb, &wu->swu_ccb, ccb_link)
4266 		VOP_STRATEGY(&ccb->ccb_buf);
4267 
4268 	wu->swu_cb_active = 0;
4269 }
4270 
4271 void
4272 sr_raid_recreate_wu(struct sr_workunit *wu)
4273 {
4274 	struct sr_discipline	*sd = wu->swu_dis;
4275 	struct sr_workunit	*wup = wu;
4276 
4277 	/*
4278 	 * Recreate a work unit by releasing the associated CCBs and reissuing
4279 	 * the SCSI I/O request. This process is then repeated for all of the
4280 	 * colliding work units.
4281 	 */
4282 	do {
4283 		sr_wu_release_ccbs(wup);
4284 
4285 		wup->swu_state = SR_WU_REQUEUE;
4286 		if (sd->sd_scsi_rw(wup))
4287 			panic("could not requeue I/O");
4288 
4289 		wup = wup->swu_collider;
4290 	} while (wup);
4291 }
4292 
4293 int
4294 sr_alloc_resources(struct sr_discipline *sd)
4295 {
4296 	if (sr_wu_alloc(sd, sizeof(struct sr_workunit))) {
4297 		sr_error(sd->sd_sc, "unable to allocate work units");
4298 		return (ENOMEM);
4299 	}
4300 	if (sr_ccb_alloc(sd)) {
4301 		sr_error(sd->sd_sc, "unable to allocate ccbs");
4302 		return (ENOMEM);
4303 	}
4304 
4305 	return (0);
4306 }
4307 
4308 void
4309 sr_free_resources(struct sr_discipline *sd)
4310 {
4311 	sr_wu_free(sd);
4312 	sr_ccb_free(sd);
4313 }
4314 
4315 void
4316 sr_set_chunk_state(struct sr_discipline *sd, int c, int new_state)
4317 {
4318 	int			old_state, s;
4319 
4320 	DNPRINTF(SR_D_STATE, "%s: %s: %s: sr_set_chunk_state %d -> %d\n",
4321 	    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname,
4322 	    sd->sd_vol.sv_chunks[c]->src_meta.scmi.scm_devname, c, new_state);
4323 
4324 	/* ok to go to splbio since this only happens in error path */
4325 	s = splbio();
4326 	old_state = sd->sd_vol.sv_chunks[c]->src_meta.scm_status;
4327 
4328 	/* multiple IOs to the same chunk that fail will come through here */
4329 	if (old_state == new_state)
4330 		goto done;
4331 
4332 	switch (old_state) {
4333 	case BIOC_SDONLINE:
4334 		if (new_state == BIOC_SDOFFLINE)
4335 			break;
4336 		else
4337 			goto die;
4338 		break;
4339 
4340 	case BIOC_SDOFFLINE:
4341 		goto die;
4342 
4343 	default:
4344 die:
4345 		splx(s); /* XXX */
4346 		panic("%s: %s: %s: invalid chunk state transition "
4347 		    "%d -> %d", DEVNAME(sd->sd_sc),
4348 		    sd->sd_meta->ssd_devname,
4349 		    sd->sd_vol.sv_chunks[c]->src_meta.scmi.scm_devname,
4350 		    old_state, new_state);
4351 		/* NOTREACHED */
4352 	}
4353 
4354 	sd->sd_vol.sv_chunks[c]->src_meta.scm_status = new_state;
4355 	sd->sd_set_vol_state(sd);
4356 
4357 	sd->sd_must_flush = 1;
4358 	task_add(systq, &sd->sd_meta_save_task);
4359 done:
4360 	splx(s);
4361 }
4362 
4363 void
4364 sr_set_vol_state(struct sr_discipline *sd)
4365 {
4366 	int			states[SR_MAX_STATES];
4367 	int			new_state, i, nd;
4368 	int			old_state = sd->sd_vol_status;
4369 	u_int32_t		s;
4370 
4371 	DNPRINTF(SR_D_STATE, "%s: %s: sr_set_vol_state\n",
4372 	    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname);
4373 
4374 	nd = sd->sd_meta->ssdi.ssd_chunk_no;
4375 
4376 	for (i = 0; i < SR_MAX_STATES; i++)
4377 		states[i] = 0;
4378 
4379 	for (i = 0; i < nd; i++) {
4380 		s = sd->sd_vol.sv_chunks[i]->src_meta.scm_status;
4381 		if (s >= SR_MAX_STATES)
4382 			panic("%s: %s: %s: invalid chunk state",
4383 			    DEVNAME(sd->sd_sc),
4384 			    sd->sd_meta->ssd_devname,
4385 			    sd->sd_vol.sv_chunks[i]->src_meta.scmi.scm_devname);
4386 		states[s]++;
4387 	}
4388 
4389 	if (states[BIOC_SDONLINE] == nd)
4390 		new_state = BIOC_SVONLINE;
4391 	else
4392 		new_state = BIOC_SVOFFLINE;
4393 
4394 	DNPRINTF(SR_D_STATE, "%s: %s: sr_set_vol_state %d -> %d\n",
4395 	    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname,
4396 	    old_state, new_state);
4397 
4398 	switch (old_state) {
4399 	case BIOC_SVONLINE:
4400 		if (new_state == BIOC_SVOFFLINE || new_state == BIOC_SVONLINE)
4401 			break;
4402 		else
4403 			goto die;
4404 		break;
4405 
4406 	case BIOC_SVOFFLINE:
4407 		/* XXX this might be a little too much */
4408 		goto die;
4409 
4410 	default:
4411 die:
4412 		panic("%s: %s: invalid volume state transition "
4413 		    "%d -> %d", DEVNAME(sd->sd_sc),
4414 		    sd->sd_meta->ssd_devname,
4415 		    old_state, new_state);
4416 		/* NOTREACHED */
4417 	}
4418 
4419 	sd->sd_vol_status = new_state;
4420 }
4421 
4422 void *
4423 sr_block_get(struct sr_discipline *sd, long length)
4424 {
4425 	return dma_alloc(length, PR_NOWAIT | PR_ZERO);
4426 }
4427 
4428 void
4429 sr_block_put(struct sr_discipline *sd, void *ptr, int length)
4430 {
4431 	dma_free(ptr, length);
4432 }
4433 
4434 void
4435 sr_checksum_print(u_int8_t *md5)
4436 {
4437 	int			i;
4438 
4439 	for (i = 0; i < MD5_DIGEST_LENGTH; i++)
4440 		printf("%02x", md5[i]);
4441 }
4442 
4443 void
4444 sr_checksum(struct sr_softc *sc, void *src, void *md5, u_int32_t len)
4445 {
4446 	MD5_CTX			ctx;
4447 
4448 	DNPRINTF(SR_D_MISC, "%s: sr_checksum(%p %p %d)\n", DEVNAME(sc), src,
4449 	    md5, len);
4450 
4451 	MD5Init(&ctx);
4452 	MD5Update(&ctx, src, len);
4453 	MD5Final(md5, &ctx);
4454 }
4455 
4456 void
4457 sr_uuid_generate(struct sr_uuid *uuid)
4458 {
4459 	arc4random_buf(uuid->sui_id, sizeof(uuid->sui_id));
4460 	/* UUID version 4: random */
4461 	uuid->sui_id[6] &= 0x0f;
4462 	uuid->sui_id[6] |= 0x40;
4463 	/* RFC4122 variant */
4464 	uuid->sui_id[8] &= 0x3f;
4465 	uuid->sui_id[8] |= 0x80;
4466 }
4467 
4468 char *
4469 sr_uuid_format(struct sr_uuid *uuid)
4470 {
4471 	char *uuidstr;
4472 
4473 	uuidstr = malloc(37, M_DEVBUF, M_WAITOK);
4474 
4475 	snprintf(uuidstr, 37,
4476 	    "%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-"
4477 	    "%02x%02x%02x%02x%02x%02x",
4478 	    uuid->sui_id[0], uuid->sui_id[1],
4479 	    uuid->sui_id[2], uuid->sui_id[3],
4480 	    uuid->sui_id[4], uuid->sui_id[5],
4481 	    uuid->sui_id[6], uuid->sui_id[7],
4482 	    uuid->sui_id[8], uuid->sui_id[9],
4483 	    uuid->sui_id[10], uuid->sui_id[11],
4484 	    uuid->sui_id[12], uuid->sui_id[13],
4485 	    uuid->sui_id[14], uuid->sui_id[15]);
4486 
4487 	return uuidstr;
4488 }
4489 
4490 void
4491 sr_uuid_print(struct sr_uuid *uuid, int cr)
4492 {
4493 	char *uuidstr;
4494 
4495 	uuidstr = sr_uuid_format(uuid);
4496 	printf("%s%s", uuidstr, (cr ? "\n" : ""));
4497 	free(uuidstr, M_DEVBUF, 37);
4498 }
4499 
4500 int
4501 sr_already_assembled(struct sr_discipline *sd)
4502 {
4503 	struct sr_softc		*sc = sd->sd_sc;
4504 	struct sr_discipline	*sdtmp;
4505 
4506 	TAILQ_FOREACH(sdtmp, &sc->sc_dis_list, sd_link) {
4507 		if (!bcmp(&sd->sd_meta->ssdi.ssd_uuid,
4508 		    &sdtmp->sd_meta->ssdi.ssd_uuid,
4509 		    sizeof(sd->sd_meta->ssdi.ssd_uuid)))
4510 			return (1);
4511 	}
4512 
4513 	return (0);
4514 }
4515 
4516 int32_t
4517 sr_validate_stripsize(u_int32_t b)
4518 {
4519 	int			s = 0;
4520 
4521 	if (b % DEV_BSIZE)
4522 		return (-1);
4523 
4524 	while ((b & 1) == 0) {
4525 		b >>= 1;
4526 		s++;
4527 	}
4528 
4529 	/* only multiple of twos */
4530 	b >>= 1;
4531 	if (b)
4532 		return(-1);
4533 
4534 	return (s);
4535 }
4536 
4537 void
4538 sr_shutdown(void)
4539 {
4540 	struct sr_softc		*sc = softraid0;
4541 	struct sr_discipline	*sd;
4542 
4543 	DNPRINTF(SR_D_MISC, "%s: sr_shutdown\n", DEVNAME(sc));
4544 
4545 	/*
4546 	 * Since softraid is not under mainbus, we have to explicitly
4547 	 * notify its children that the power is going down, so they
4548 	 * can execute their shutdown hooks.
4549 	 */
4550 	config_suspend((struct device *)sc, DVACT_POWERDOWN);
4551 
4552 	/* Shutdown disciplines in reverse attach order. */
4553 	while ((sd = TAILQ_LAST(&sc->sc_dis_list, sr_discipline_list)) != NULL)
4554 		sr_discipline_shutdown(sd, 1);
4555 }
4556 
4557 int
4558 sr_validate_io(struct sr_workunit *wu, daddr_t *blkno, char *func)
4559 {
4560 	struct sr_discipline	*sd = wu->swu_dis;
4561 	struct scsi_xfer	*xs = wu->swu_xs;
4562 	int			rv = 1;
4563 
4564 	DNPRINTF(SR_D_DIS, "%s: %s 0x%02x\n", DEVNAME(sd->sd_sc), func,
4565 	    xs->cmd->opcode);
4566 
4567 	if (sd->sd_meta->ssd_data_blkno == 0)
4568 		panic("invalid data blkno");
4569 
4570 	if (sd->sd_vol_status == BIOC_SVOFFLINE) {
4571 		DNPRINTF(SR_D_DIS, "%s: %s device offline\n",
4572 		    DEVNAME(sd->sd_sc), func);
4573 		goto bad;
4574 	}
4575 
4576 	if (xs->datalen == 0) {
4577 		printf("%s: %s: illegal block count for %s\n",
4578 		    DEVNAME(sd->sd_sc), func, sd->sd_meta->ssd_devname);
4579 		goto bad;
4580 	}
4581 
4582 	if (xs->cmdlen == 10)
4583 		*blkno = _4btol(((struct scsi_rw_big *)xs->cmd)->addr);
4584 	else if (xs->cmdlen == 16)
4585 		*blkno = _8btol(((struct scsi_rw_16 *)xs->cmd)->addr);
4586 	else if (xs->cmdlen == 6)
4587 		*blkno = _3btol(((struct scsi_rw *)xs->cmd)->addr);
4588 	else {
4589 		printf("%s: %s: illegal cmdlen for %s\n",
4590 		    DEVNAME(sd->sd_sc), func, sd->sd_meta->ssd_devname);
4591 		goto bad;
4592 	}
4593 
4594 	*blkno *= (sd->sd_meta->ssdi.ssd_secsize / DEV_BSIZE);
4595 
4596 	wu->swu_blk_start = *blkno;
4597 	wu->swu_blk_end = *blkno + (xs->datalen >> DEV_BSHIFT) - 1;
4598 
4599 	if (wu->swu_blk_end > sd->sd_meta->ssdi.ssd_size) {
4600 		DNPRINTF(SR_D_DIS, "%s: %s out of bounds start: %lld "
4601 		    "end: %lld length: %d\n",
4602 		    DEVNAME(sd->sd_sc), func, (long long)wu->swu_blk_start,
4603 		    (long long)wu->swu_blk_end, xs->datalen);
4604 
4605 		sd->sd_scsi_sense.error_code = SSD_ERRCODE_CURRENT |
4606 		    SSD_ERRCODE_VALID;
4607 		sd->sd_scsi_sense.flags = SKEY_ILLEGAL_REQUEST;
4608 		sd->sd_scsi_sense.add_sense_code = 0x21;
4609 		sd->sd_scsi_sense.add_sense_code_qual = 0x00;
4610 		sd->sd_scsi_sense.extra_len = 4;
4611 		goto bad;
4612 	}
4613 
4614 	rv = 0;
4615 bad:
4616 	return (rv);
4617 }
4618 
4619 void
4620 sr_rebuild_start(void *arg)
4621 {
4622 	struct sr_discipline	*sd = arg;
4623 	struct sr_softc		*sc = sd->sd_sc;
4624 
4625 	DNPRINTF(SR_D_REBUILD, "%s: %s starting rebuild thread\n",
4626 	    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname);
4627 
4628 	if (kthread_create(sr_rebuild_thread, sd, &sd->sd_background_proc,
4629 	    DEVNAME(sc)) != 0)
4630 		printf("%s: unable to start background operation\n",
4631 		    DEVNAME(sc));
4632 }
4633 
4634 void
4635 sr_rebuild_thread(void *arg)
4636 {
4637 	struct sr_discipline	*sd = arg;
4638 
4639 	DNPRINTF(SR_D_REBUILD, "%s: %s rebuild thread started\n",
4640 	    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname);
4641 
4642 	sd->sd_reb_active = 1;
4643 	sd->sd_rebuild(sd);
4644 	sd->sd_reb_active = 0;
4645 
4646 	kthread_exit(0);
4647 }
4648 
4649 void
4650 sr_rebuild(struct sr_discipline *sd)
4651 {
4652 	struct sr_softc		*sc = sd->sd_sc;
4653 	u_int64_t		sz, whole_blk, partial_blk, blk, restart;
4654 	daddr_t			lba;
4655 	struct sr_workunit	*wu_r, *wu_w;
4656 	struct scsi_xfer	xs_r, xs_w;
4657 	struct scsi_rw_16	*cr, *cw;
4658 	int			c, s, slept, percent = 0, old_percent = -1;
4659 	u_int8_t		*buf;
4660 
4661 	whole_blk = sd->sd_meta->ssdi.ssd_size / SR_REBUILD_IO_SIZE;
4662 	partial_blk = sd->sd_meta->ssdi.ssd_size % SR_REBUILD_IO_SIZE;
4663 
4664 	restart = sd->sd_meta->ssd_rebuild / SR_REBUILD_IO_SIZE;
4665 	if (restart > whole_blk) {
4666 		printf("%s: bogus rebuild restart offset, starting from 0\n",
4667 		    DEVNAME(sc));
4668 		restart = 0;
4669 	}
4670 	if (restart) {
4671 		/*
4672 		 * XXX there is a hole here; there is a posibility that we
4673 		 * had a restart however the chunk that was supposed to
4674 		 * be rebuilt is no longer valid; we can reach this situation
4675 		 * when a rebuild is in progress and the box crashes and
4676 		 * on reboot the rebuild chunk is different (like zero'd or
4677 		 * replaced).  We need to check the uuid of the chunk that is
4678 		 * being rebuilt to assert this.
4679 		 */
4680 		percent = sr_rebuild_percent(sd);
4681 		printf("%s: resuming rebuild on %s at %d%%\n",
4682 		    DEVNAME(sc), sd->sd_meta->ssd_devname, percent);
4683 	}
4684 
4685 	/* currently this is 64k therefore we can use dma_alloc */
4686 	buf = dma_alloc(SR_REBUILD_IO_SIZE << DEV_BSHIFT, PR_WAITOK);
4687 	for (blk = restart; blk <= whole_blk; blk++) {
4688 		lba = blk * SR_REBUILD_IO_SIZE;
4689 		sz = SR_REBUILD_IO_SIZE;
4690 		if (blk == whole_blk) {
4691 			if (partial_blk == 0)
4692 				break;
4693 			sz = partial_blk;
4694 		}
4695 
4696 		/* get some wu */
4697 		wu_r = sr_scsi_wu_get(sd, 0);
4698 		wu_w = sr_scsi_wu_get(sd, 0);
4699 
4700 		DNPRINTF(SR_D_REBUILD, "%s: %s rebuild wu_r %p, wu_w %p\n",
4701 		    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname, wu_r, wu_w);
4702 
4703 		/* setup read io */
4704 		bzero(&xs_r, sizeof xs_r);
4705 		xs_r.error = XS_NOERROR;
4706 		xs_r.flags = SCSI_DATA_IN;
4707 		xs_r.datalen = sz << DEV_BSHIFT;
4708 		xs_r.data = buf;
4709 		xs_r.cmdlen = sizeof(*cr);
4710 		xs_r.cmd = &xs_r.cmdstore;
4711 		cr = (struct scsi_rw_16 *)xs_r.cmd;
4712 		cr->opcode = READ_16;
4713 		_lto4b(sz, cr->length);
4714 		_lto8b(lba, cr->addr);
4715 		wu_r->swu_state = SR_WU_CONSTRUCT;
4716 		wu_r->swu_flags |= SR_WUF_REBUILD;
4717 		wu_r->swu_xs = &xs_r;
4718 		if (sd->sd_scsi_rw(wu_r)) {
4719 			printf("%s: could not create read io\n",
4720 			    DEVNAME(sc));
4721 			goto fail;
4722 		}
4723 
4724 		/* setup write io */
4725 		bzero(&xs_w, sizeof xs_w);
4726 		xs_w.error = XS_NOERROR;
4727 		xs_w.flags = SCSI_DATA_OUT;
4728 		xs_w.datalen = sz << DEV_BSHIFT;
4729 		xs_w.data = buf;
4730 		xs_w.cmdlen = sizeof(*cw);
4731 		xs_w.cmd = &xs_w.cmdstore;
4732 		cw = (struct scsi_rw_16 *)xs_w.cmd;
4733 		cw->opcode = WRITE_16;
4734 		_lto4b(sz, cw->length);
4735 		_lto8b(lba, cw->addr);
4736 		wu_w->swu_state = SR_WU_CONSTRUCT;
4737 		wu_w->swu_flags |= SR_WUF_REBUILD | SR_WUF_WAKEUP;
4738 		wu_w->swu_xs = &xs_w;
4739 		if (sd->sd_scsi_rw(wu_w)) {
4740 			printf("%s: could not create write io\n",
4741 			    DEVNAME(sc));
4742 			goto fail;
4743 		}
4744 
4745 		/*
4746 		 * collide with the read io so that we get automatically
4747 		 * started when the read is done
4748 		 */
4749 		wu_w->swu_state = SR_WU_DEFERRED;
4750 		wu_r->swu_collider = wu_w;
4751 		s = splbio();
4752 		TAILQ_INSERT_TAIL(&sd->sd_wu_defq, wu_w, swu_link);
4753 		splx(s);
4754 
4755 		DNPRINTF(SR_D_REBUILD, "%s: %s rebuild scheduling wu_r %p\n",
4756 		    DEVNAME(sd->sd_sc), sd->sd_meta->ssd_devname, wu_r);
4757 
4758 		wu_r->swu_state = SR_WU_INPROGRESS;
4759 		sr_schedule_wu(wu_r);
4760 
4761 		/* wait for write completion */
4762 		slept = 0;
4763 		while ((wu_w->swu_flags & SR_WUF_REBUILDIOCOMP) == 0) {
4764 			tsleep(wu_w, PRIBIO, "sr_rebuild", 0);
4765 			slept = 1;
4766 		}
4767 		/* yield if we didn't sleep */
4768 		if (slept == 0)
4769 			tsleep(sc, PWAIT, "sr_yield", 1);
4770 
4771 		sr_scsi_wu_put(sd, wu_r);
4772 		sr_scsi_wu_put(sd, wu_w);
4773 
4774 		sd->sd_meta->ssd_rebuild = lba;
4775 
4776 		/* XXX - this should be based on size, not percentage. */
4777 		/* save metadata every percent */
4778 		percent = sr_rebuild_percent(sd);
4779 		if (percent != old_percent && blk != whole_blk) {
4780 			if (sr_meta_save(sd, SR_META_DIRTY))
4781 				printf("%s: could not save metadata to %s\n",
4782 				    DEVNAME(sc), sd->sd_meta->ssd_devname);
4783 			old_percent = percent;
4784 		}
4785 
4786 		if (sd->sd_reb_abort)
4787 			goto abort;
4788 	}
4789 
4790 	/* all done */
4791 	sd->sd_meta->ssd_rebuild = 0;
4792 	for (c = 0; c < sd->sd_meta->ssdi.ssd_chunk_no; c++) {
4793 		if (sd->sd_vol.sv_chunks[c]->src_meta.scm_status ==
4794 		    BIOC_SDREBUILD) {
4795 			sd->sd_set_chunk_state(sd, c, BIOC_SDONLINE);
4796 			break;
4797 		}
4798 	}
4799 
4800 abort:
4801 	if (sr_meta_save(sd, SR_META_DIRTY))
4802 		printf("%s: could not save metadata to %s\n",
4803 		    DEVNAME(sc), sd->sd_meta->ssd_devname);
4804 fail:
4805 	dma_free(buf, SR_REBUILD_IO_SIZE << DEV_BSHIFT);
4806 }
4807 
4808 #ifndef SMALL_KERNEL
4809 int
4810 sr_sensors_create(struct sr_discipline *sd)
4811 {
4812 	struct sr_softc		*sc = sd->sd_sc;
4813 	int			rv = 1;
4814 
4815 	DNPRINTF(SR_D_STATE, "%s: %s: sr_sensors_create\n",
4816 	    DEVNAME(sc), sd->sd_meta->ssd_devname);
4817 
4818 	sd->sd_vol.sv_sensor.type = SENSOR_DRIVE;
4819 	sd->sd_vol.sv_sensor.status = SENSOR_S_UNKNOWN;
4820 	strlcpy(sd->sd_vol.sv_sensor.desc, sd->sd_meta->ssd_devname,
4821 	    sizeof(sd->sd_vol.sv_sensor.desc));
4822 
4823 	sensor_attach(&sc->sc_sensordev, &sd->sd_vol.sv_sensor);
4824 	sd->sd_vol.sv_sensor_attached = 1;
4825 
4826 	if (sc->sc_sensor_task == NULL) {
4827 		sc->sc_sensor_task = sensor_task_register(sc,
4828 		    sr_sensors_refresh, 10);
4829 		if (sc->sc_sensor_task == NULL)
4830 			goto bad;
4831 	}
4832 
4833 	rv = 0;
4834 bad:
4835 	return (rv);
4836 }
4837 
4838 void
4839 sr_sensors_delete(struct sr_discipline *sd)
4840 {
4841 	DNPRINTF(SR_D_STATE, "%s: sr_sensors_delete\n", DEVNAME(sd->sd_sc));
4842 
4843 	if (sd->sd_vol.sv_sensor_attached)
4844 		sensor_detach(&sd->sd_sc->sc_sensordev, &sd->sd_vol.sv_sensor);
4845 }
4846 
4847 void
4848 sr_sensors_refresh(void *arg)
4849 {
4850 	struct sr_softc		*sc = arg;
4851 	struct sr_volume	*sv;
4852 	struct sr_discipline	*sd;
4853 
4854 	DNPRINTF(SR_D_STATE, "%s: sr_sensors_refresh\n", DEVNAME(sc));
4855 
4856 	TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
4857 		sv = &sd->sd_vol;
4858 
4859 		switch(sd->sd_vol_status) {
4860 		case BIOC_SVOFFLINE:
4861 			sv->sv_sensor.value = SENSOR_DRIVE_FAIL;
4862 			sv->sv_sensor.status = SENSOR_S_CRIT;
4863 			break;
4864 
4865 		case BIOC_SVDEGRADED:
4866 			sv->sv_sensor.value = SENSOR_DRIVE_PFAIL;
4867 			sv->sv_sensor.status = SENSOR_S_WARN;
4868 			break;
4869 
4870 		case BIOC_SVREBUILD:
4871 			sv->sv_sensor.value = SENSOR_DRIVE_REBUILD;
4872 			sv->sv_sensor.status = SENSOR_S_WARN;
4873 			break;
4874 
4875 		case BIOC_SVSCRUB:
4876 		case BIOC_SVONLINE:
4877 			sv->sv_sensor.value = SENSOR_DRIVE_ONLINE;
4878 			sv->sv_sensor.status = SENSOR_S_OK;
4879 			break;
4880 
4881 		default:
4882 			sv->sv_sensor.value = 0; /* unknown */
4883 			sv->sv_sensor.status = SENSOR_S_UNKNOWN;
4884 		}
4885 	}
4886 }
4887 #endif /* SMALL_KERNEL */
4888 
4889 #ifdef SR_FANCY_STATS
4890 void				sr_print_stats(void);
4891 
4892 void
4893 sr_print_stats(void)
4894 {
4895 	struct sr_softc		*sc = softraid0;
4896 	struct sr_discipline	*sd;
4897 
4898 	if (sc == NULL) {
4899 		printf("no softraid softc found\n");
4900 		return;
4901 	}
4902 
4903 	TAILQ_FOREACH(sd, &sc->sc_dis_list, sd_link) {
4904 		printf("%s: ios pending %d, collisions %llu\n",
4905 		    sd->sd_meta->ssd_devname,
4906 		    sd->sd_wu_pending,
4907 		    sd->sd_wu_collisions);
4908 	}
4909 }
4910 #endif /* SR_FANCY_STATS */
4911 
4912 #ifdef SR_DEBUG
4913 void
4914 sr_meta_print(struct sr_metadata *m)
4915 {
4916 	int			i;
4917 	struct sr_meta_chunk	*mc;
4918 	struct sr_meta_opt_hdr	*omh;
4919 
4920 	if (!(sr_debug & SR_D_META))
4921 		return;
4922 
4923 	printf("\tssd_magic 0x%llx\n", m->ssdi.ssd_magic);
4924 	printf("\tssd_version %d\n", m->ssdi.ssd_version);
4925 	printf("\tssd_vol_flags 0x%x\n", m->ssdi.ssd_vol_flags);
4926 	printf("\tssd_uuid ");
4927 	sr_uuid_print(&m->ssdi.ssd_uuid, 1);
4928 	printf("\tssd_chunk_no %d\n", m->ssdi.ssd_chunk_no);
4929 	printf("\tssd_chunk_id %d\n", m->ssdi.ssd_chunk_id);
4930 	printf("\tssd_opt_no %d\n", m->ssdi.ssd_opt_no);
4931 	printf("\tssd_volid %d\n", m->ssdi.ssd_volid);
4932 	printf("\tssd_level %d\n", m->ssdi.ssd_level);
4933 	printf("\tssd_size %lld\n", m->ssdi.ssd_size);
4934 	printf("\tssd_devname %s\n", m->ssd_devname);
4935 	printf("\tssd_vendor %s\n", m->ssdi.ssd_vendor);
4936 	printf("\tssd_product %s\n", m->ssdi.ssd_product);
4937 	printf("\tssd_revision %s\n", m->ssdi.ssd_revision);
4938 	printf("\tssd_strip_size %d\n", m->ssdi.ssd_strip_size);
4939 	printf("\tssd_checksum ");
4940 	sr_checksum_print(m->ssd_checksum);
4941 	printf("\n");
4942 	printf("\tssd_meta_flags 0x%x\n", m->ssd_meta_flags);
4943 	printf("\tssd_ondisk %llu\n", m->ssd_ondisk);
4944 
4945 	mc = (struct sr_meta_chunk *)(m + 1);
4946 	for (i = 0; i < m->ssdi.ssd_chunk_no; i++, mc++) {
4947 		printf("\t\tscm_volid %d\n", mc->scmi.scm_volid);
4948 		printf("\t\tscm_chunk_id %d\n", mc->scmi.scm_chunk_id);
4949 		printf("\t\tscm_devname %s\n", mc->scmi.scm_devname);
4950 		printf("\t\tscm_size %lld\n", mc->scmi.scm_size);
4951 		printf("\t\tscm_coerced_size %lld\n",mc->scmi.scm_coerced_size);
4952 		printf("\t\tscm_uuid ");
4953 		sr_uuid_print(&mc->scmi.scm_uuid, 1);
4954 		printf("\t\tscm_checksum ");
4955 		sr_checksum_print(mc->scm_checksum);
4956 		printf("\n");
4957 		printf("\t\tscm_status %d\n", mc->scm_status);
4958 	}
4959 
4960 	omh = (struct sr_meta_opt_hdr *)((u_int8_t *)(m + 1) +
4961 	    sizeof(struct sr_meta_chunk) * m->ssdi.ssd_chunk_no);
4962 	for (i = 0; i < m->ssdi.ssd_opt_no; i++) {
4963 		printf("\t\t\tsom_type %d\n", omh->som_type);
4964 		printf("\t\t\tsom_checksum ");
4965 		sr_checksum_print(omh->som_checksum);
4966 		printf("\n");
4967 		omh = (struct sr_meta_opt_hdr *)((void *)omh +
4968 		    omh->som_length);
4969 	}
4970 }
4971 
4972 void
4973 sr_dump_block(void *blk, int len)
4974 {
4975 	uint8_t			*b = blk;
4976 	int			i, j, c;
4977 
4978 	for (i = 0; i < len; i += 16) {
4979 		for (j = 0; j < 16; j++)
4980 			printf("%.2x ", b[i + j]);
4981 		printf("  ");
4982 		for (j = 0; j < 16; j++) {
4983 			c = b[i + j];
4984 			if (c < ' ' || c > 'z' || i + j > len)
4985 				c = '.';
4986 			printf("%c", c);
4987 		}
4988 		printf("\n");
4989 	}
4990 }
4991 
4992 void
4993 sr_dump_mem(u_int8_t *p, int len)
4994 {
4995 	int			i;
4996 
4997 	for (i = 0; i < len; i++)
4998 		printf("%02x ", *p++);
4999 	printf("\n");
5000 }
5001 
5002 #endif /* SR_DEBUG */
5003 
5004 #ifdef HIBERNATE
5005 /*
5006  * Side-effect free (no malloc, printf, pool, splx) softraid crypto writer.
5007  *
5008  * This function must perform the following:
5009  * 1. Determine the underlying device's own side-effect free I/O function
5010  *    (eg, ahci_hibernate_io, wd_hibernate_io, etc).
5011  * 2. Store enough information in the provided page argument for subsequent
5012  *    I/O calls (such as the crypto discipline structure for the keys, the
5013  *    offset of the softraid partition on the underlying disk, as well as
5014  *    the offset of the swap partition within the crypto volume.
5015  * 3. Encrypt the incoming data using the sr_discipline keys, then pass
5016  *    the request to the underlying device's own I/O function.
5017  */
5018 int
5019 sr_hibernate_io(dev_t dev, daddr_t blkno, vaddr_t addr, size_t size, int op, void *page)
5020 {
5021 	/* Struct for stashing data obtained on HIB_INIT.
5022 	 * XXX
5023 	 * We share the page with the underlying device's own
5024 	 * side-effect free I/O function, so we pad our data to
5025 	 * the end of the page. Presently this does not overlap
5026 	 * with either of the two other side-effect free i/o
5027 	 * functions (ahci/wd).
5028 	 */
5029 	struct {
5030 		char pad[3072];
5031 		struct sr_discipline *srd;
5032 		hibio_fn subfn;		/* underlying device i/o fn */
5033 		dev_t subdev;		/* underlying device dev_t */
5034 		daddr_t sr_swapoff;	/* ofs of swap part in sr volume */
5035 		char buf[DEV_BSIZE];	/* encryption performed into this buf */
5036 	} *my = page;
5037 	extern struct cfdriver sd_cd;
5038 	char errstr[128], *dl_ret;
5039 	struct sr_chunk *schunk;
5040 	struct sd_softc *sd;
5041 	struct aes_xts_ctx ctx;
5042 	struct sr_softc *sc;
5043 	struct device *dv;
5044 	daddr_t key_blkno;
5045 	uint32_t sub_raidoff;  /* ofs of sr part in underlying dev */
5046 	struct disklabel dl;
5047 	struct partition *pp;
5048 	size_t i, j;
5049 	u_char iv[8];
5050 
5051 	/*
5052 	 * In HIB_INIT, we are passed the swap partition size and offset
5053 	 * in 'size' and 'blkno' respectively. These are relative to the
5054 	 * start of the softraid partition, and we need to save these
5055 	 * for later translation to the underlying device's layout.
5056 	 */
5057 	if (op == HIB_INIT) {
5058 		dv = disk_lookup(&sd_cd, DISKUNIT(dev));
5059 		sd = (struct sd_softc *)dv;
5060 		sc = (struct sr_softc *)dv->dv_parent->dv_parent;
5061 
5062 		/*
5063 		 * Look up the sr discipline. This is used to determine
5064 		 * if we are SR crypto and what the underlying device is.
5065 		 */
5066 		my->srd = sc->sc_targets[sd->sc_link->target];
5067 		DNPRINTF(SR_D_MISC, "sr_hibernate_io: discipline is %s\n",
5068 			my->srd->sd_name);
5069 		if (strncmp(my->srd->sd_name, "CRYPTO",
5070 		    sizeof(my->srd->sd_name)))
5071 			return (ENOTSUP);
5072 
5073 		/* Find the underlying device */
5074 		schunk = my->srd->sd_vol.sv_chunks[0];
5075 		my->subdev = schunk->src_dev_mm;
5076 
5077 		/*
5078 		 * Find the appropriate underlying device side effect free
5079 		 * I/O function, based on the type of device it is.
5080 		 */
5081 		my->subfn = get_hibernate_io_function(my->subdev);
5082 		if (!my->subfn)
5083 			return (ENODEV);
5084 
5085 		/*
5086 		 * Find blkno where this raid partition starts on
5087 		 * the underlying disk.
5088 		 */
5089 		dl_ret = disk_readlabel(&dl, my->subdev, errstr,
5090 		    sizeof(errstr));
5091 		if (dl_ret) {
5092 			printf("Hibernate error reading disklabel: %s\n", dl_ret);
5093 			return (ENOTSUP);
5094 		}
5095 
5096 		pp = &dl.d_partitions[DISKPART(my->subdev)];
5097 		if (pp->p_fstype != FS_RAID || DL_GETPSIZE(pp) == 0)
5098 			return (ENOTSUP);
5099 
5100 		/* Find the blkno of the SR part in the underlying device */
5101 		sub_raidoff = my->srd->sd_meta->ssd_data_blkno +
5102 		    DL_SECTOBLK(&dl, DL_GETPOFFSET(pp));
5103 		DNPRINTF(SR_D_MISC,"sr_hibernate_io: blk trans ofs: %d blks\n",
5104 		    sub_raidoff);
5105 
5106 		/* Save the blkno of the swap partition in the SR disk */
5107 		my->sr_swapoff = blkno;
5108 
5109 		/* Initialize the sub-device */
5110 		return my->subfn(my->subdev, sub_raidoff + blkno,
5111 		    addr, size, op, page);
5112 	}
5113 
5114 	/* Hibernate only uses (and we only support) writes */
5115 	if (op != HIB_W)
5116 		return (ENOTSUP);
5117 
5118 	/*
5119 	 * Blocks act as the IV for the encryption. These block numbers
5120 	 * are relative to the start of the sr partition, but the 'blkno'
5121 	 * passed above is relative to the start of the swap partition
5122 	 * inside the sr partition, so bias appropriately.
5123 	 */
5124 	key_blkno = my->sr_swapoff + blkno;
5125 
5126 	/* Process each disk block one at a time. */
5127 	for (i = 0; i < size; i += DEV_BSIZE) {
5128 		int res;
5129 
5130 		bzero(&ctx, sizeof(ctx));
5131 
5132 		/*
5133 		 * Set encryption key (from the sr discipline stashed
5134 		 * during HIB_INIT. This code is based on the softraid
5135 		 * bootblock code.
5136 		 */
5137 		aes_xts_setkey(&ctx, my->srd->mds.mdd_crypto.scr_key[0], 64);
5138 		/* We encrypt DEV_BSIZE bytes at a time in my->buf */
5139 		memcpy(my->buf, ((char *)addr) + i, DEV_BSIZE);
5140 
5141 		/* Block number is the IV */
5142 		memcpy(&iv, &key_blkno, sizeof(key_blkno));
5143 		aes_xts_reinit(&ctx, iv);
5144 
5145 		/* Encrypt DEV_BSIZE bytes, AES_XTS_BLOCKSIZE bytes at a time */
5146 		for (j = 0; j < DEV_BSIZE; j += AES_XTS_BLOCKSIZE)
5147 			aes_xts_encrypt(&ctx, my->buf + j);
5148 
5149 		/*
5150 		 * Write one block out from my->buf to the underlying device
5151 		 * using its own side-effect free I/O function.
5152 		 */
5153 		res = my->subfn(my->subdev, blkno + (i / DEV_BSIZE),
5154 		    (vaddr_t)(my->buf), DEV_BSIZE, op, page);
5155 		if (res != 0)
5156 			return (res);
5157 		key_blkno++;
5158 	}
5159 	return (0);
5160 }
5161 #endif /* HIBERNATE */
5162