xref: /freebsd/sys/geom/raid/md_promise.c (revision 5956d97f4b3204318ceb6aa9c77bd0bc6ea87a41)
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 2011 Alexander Motin <mav@FreeBSD.org>
5  * Copyright (c) 2000 - 2008 Søren Schmidt <sos@FreeBSD.org>
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE
21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  */
29 
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
32 
33 #include <sys/param.h>
34 #include <sys/bio.h>
35 #include <sys/endian.h>
36 #include <sys/kernel.h>
37 #include <sys/kobj.h>
38 #include <sys/limits.h>
39 #include <sys/lock.h>
40 #include <sys/malloc.h>
41 #include <sys/mutex.h>
42 #include <sys/systm.h>
43 #include <geom/geom.h>
44 #include <geom/geom_dbg.h>
45 #include "geom/raid/g_raid.h"
46 #include "g_raid_md_if.h"
47 
48 static MALLOC_DEFINE(M_MD_PROMISE, "md_promise_data", "GEOM_RAID Promise metadata");
49 
50 #define	PROMISE_MAX_DISKS	8
51 #define	PROMISE_MAX_SUBDISKS	2
52 #define	PROMISE_META_OFFSET	14
53 
54 struct promise_raid_disk {
55 	uint8_t		flags;			/* Subdisk status. */
56 #define PROMISE_F_VALID		0x01
57 #define PROMISE_F_ONLINE	0x02
58 #define PROMISE_F_ASSIGNED	0x04
59 #define PROMISE_F_SPARE		0x08
60 #define PROMISE_F_DUPLICATE	0x10
61 #define PROMISE_F_REDIR		0x20
62 #define PROMISE_F_DOWN		0x40
63 #define PROMISE_F_READY		0x80
64 
65 	uint8_t		number;			/* Position in a volume. */
66 	uint8_t		channel;		/* ATA channel number. */
67 	uint8_t		device;			/* ATA device number. */
68 	uint64_t	id __packed;		/* Subdisk ID. */
69 } __packed;
70 
71 struct promise_raid_conf {
72 	char		promise_id[24];
73 #define PROMISE_MAGIC		"Promise Technology, Inc."
74 #define FREEBSD_MAGIC		"FreeBSD ATA driver RAID "
75 
76 	uint32_t	dummy_0;
77 	uint64_t	magic_0;
78 #define PROMISE_MAGIC0(x)	(((uint64_t)(x.channel) << 48) | \
79 				((uint64_t)(x.device != 0) << 56))
80 	uint16_t	magic_1;
81 	uint32_t	magic_2;
82 	uint8_t		filler1[470];
83 
84 	uint32_t	integrity;
85 #define PROMISE_I_VALID		0x00000080
86 
87 	struct promise_raid_disk	disk;	/* This subdisk info. */
88 	uint32_t	disk_offset;		/* Subdisk offset. */
89 	uint32_t	disk_sectors;		/* Subdisk size */
90 	uint32_t	disk_rebuild;		/* Rebuild position. */
91 	uint16_t	generation;		/* Generation number. */
92 	uint8_t		status;			/* Volume status. */
93 #define PROMISE_S_VALID		0x01
94 #define PROMISE_S_ONLINE	0x02
95 #define PROMISE_S_INITED	0x04
96 #define PROMISE_S_READY		0x08
97 #define PROMISE_S_DEGRADED	0x10
98 #define PROMISE_S_MARKED	0x20
99 #define PROMISE_S_MIGRATING	0x40
100 #define PROMISE_S_FUNCTIONAL	0x80
101 
102 	uint8_t		type;			/* Voluem type. */
103 #define PROMISE_T_RAID0		0x00
104 #define PROMISE_T_RAID1		0x01
105 #define PROMISE_T_RAID3		0x02
106 #define PROMISE_T_RAID5		0x04
107 #define PROMISE_T_SPAN		0x08
108 #define PROMISE_T_JBOD		0x10
109 
110 	uint8_t		total_disks;		/* Disks in this volume. */
111 	uint8_t		stripe_shift;		/* Strip size. */
112 	uint8_t		array_width;		/* Number of RAID0 stripes. */
113 	uint8_t		array_number;		/* Global volume number. */
114 	uint32_t	total_sectors;		/* Volume size. */
115 	uint16_t	cylinders;		/* Volume geometry: C. */
116 	uint8_t		heads;			/* Volume geometry: H. */
117 	uint8_t		sectors;		/* Volume geometry: S. */
118 	uint64_t	volume_id __packed;	/* Volume ID, */
119 	struct promise_raid_disk	disks[PROMISE_MAX_DISKS];
120 						/* Subdisks in this volume. */
121 	char		name[32];		/* Volume label. */
122 
123 	uint32_t	filler2[8];
124 	uint32_t	magic_3;	/* Something related to rebuild. */
125 	uint64_t	rebuild_lba64;	/* Per-volume rebuild position. */
126 	uint32_t	magic_4;
127 	uint32_t	magic_5;
128 	uint32_t	total_sectors_high;
129 	uint8_t		magic_6;
130 	uint8_t		sector_size;
131 	uint16_t	magic_7;
132 	uint32_t	magic_8[31];
133 	uint32_t	backup_time;
134 	uint16_t	magic_9;
135 	uint32_t	disk_offset_high;
136 	uint32_t	disk_sectors_high;
137 	uint32_t	disk_rebuild_high;
138 	uint16_t	magic_10;
139 	uint32_t	magic_11[3];
140 	uint32_t	filler3[284];
141 	uint32_t	checksum;
142 } __packed;
143 
144 struct g_raid_md_promise_perdisk {
145 	int		 pd_updated;
146 	int		 pd_subdisks;
147 	struct promise_raid_conf	*pd_meta[PROMISE_MAX_SUBDISKS];
148 };
149 
150 struct g_raid_md_promise_pervolume {
151 	struct promise_raid_conf	*pv_meta;
152 	uint64_t			 pv_id;
153 	uint16_t			 pv_generation;
154 	int				 pv_disks_present;
155 	int				 pv_started;
156 	struct callout			 pv_start_co;	/* STARTING state timer. */
157 };
158 
159 static g_raid_md_create_t g_raid_md_create_promise;
160 static g_raid_md_taste_t g_raid_md_taste_promise;
161 static g_raid_md_event_t g_raid_md_event_promise;
162 static g_raid_md_volume_event_t g_raid_md_volume_event_promise;
163 static g_raid_md_ctl_t g_raid_md_ctl_promise;
164 static g_raid_md_write_t g_raid_md_write_promise;
165 static g_raid_md_fail_disk_t g_raid_md_fail_disk_promise;
166 static g_raid_md_free_disk_t g_raid_md_free_disk_promise;
167 static g_raid_md_free_volume_t g_raid_md_free_volume_promise;
168 static g_raid_md_free_t g_raid_md_free_promise;
169 
170 static kobj_method_t g_raid_md_promise_methods[] = {
171 	KOBJMETHOD(g_raid_md_create,	g_raid_md_create_promise),
172 	KOBJMETHOD(g_raid_md_taste,	g_raid_md_taste_promise),
173 	KOBJMETHOD(g_raid_md_event,	g_raid_md_event_promise),
174 	KOBJMETHOD(g_raid_md_volume_event,	g_raid_md_volume_event_promise),
175 	KOBJMETHOD(g_raid_md_ctl,	g_raid_md_ctl_promise),
176 	KOBJMETHOD(g_raid_md_write,	g_raid_md_write_promise),
177 	KOBJMETHOD(g_raid_md_fail_disk,	g_raid_md_fail_disk_promise),
178 	KOBJMETHOD(g_raid_md_free_disk,	g_raid_md_free_disk_promise),
179 	KOBJMETHOD(g_raid_md_free_volume,	g_raid_md_free_volume_promise),
180 	KOBJMETHOD(g_raid_md_free,	g_raid_md_free_promise),
181 	{ 0, 0 }
182 };
183 
184 static struct g_raid_md_class g_raid_md_promise_class = {
185 	"Promise",
186 	g_raid_md_promise_methods,
187 	sizeof(struct g_raid_md_object),
188 	.mdc_enable = 1,
189 	.mdc_priority = 100
190 };
191 
192 static void
193 g_raid_md_promise_print(struct promise_raid_conf *meta)
194 {
195 	int i;
196 
197 	if (g_raid_debug < 1)
198 		return;
199 
200 	printf("********* ATA Promise Metadata *********\n");
201 	printf("promise_id          <%.24s>\n", meta->promise_id);
202 	printf("disk                %02x %02x %02x %02x %016jx\n",
203 	    meta->disk.flags, meta->disk.number, meta->disk.channel,
204 	    meta->disk.device, meta->disk.id);
205 	printf("disk_offset         %u\n", meta->disk_offset);
206 	printf("disk_sectors        %u\n", meta->disk_sectors);
207 	printf("disk_rebuild        %u\n", meta->disk_rebuild);
208 	printf("generation          %u\n", meta->generation);
209 	printf("status              0x%02x\n", meta->status);
210 	printf("type                %u\n", meta->type);
211 	printf("total_disks         %u\n", meta->total_disks);
212 	printf("stripe_shift        %u\n", meta->stripe_shift);
213 	printf("array_width         %u\n", meta->array_width);
214 	printf("array_number        %u\n", meta->array_number);
215 	printf("total_sectors       %u\n", meta->total_sectors);
216 	printf("cylinders           %u\n", meta->cylinders);
217 	printf("heads               %u\n", meta->heads);
218 	printf("sectors             %u\n", meta->sectors);
219 	printf("volume_id           0x%016jx\n", meta->volume_id);
220 	printf("disks:\n");
221 	for (i = 0; i < PROMISE_MAX_DISKS; i++ ) {
222 		printf("                    %02x %02x %02x %02x %016jx\n",
223 		    meta->disks[i].flags, meta->disks[i].number,
224 		    meta->disks[i].channel, meta->disks[i].device,
225 		    meta->disks[i].id);
226 	}
227 	printf("name                <%.32s>\n", meta->name);
228 	printf("magic_3             0x%08x\n", meta->magic_3);
229 	printf("rebuild_lba64       %ju\n", meta->rebuild_lba64);
230 	printf("magic_4             0x%08x\n", meta->magic_4);
231 	printf("magic_5             0x%08x\n", meta->magic_5);
232 	printf("total_sectors_high  0x%08x\n", meta->total_sectors_high);
233 	printf("sector_size         %u\n", meta->sector_size);
234 	printf("backup_time         %d\n", meta->backup_time);
235 	printf("disk_offset_high    0x%08x\n", meta->disk_offset_high);
236 	printf("disk_sectors_high   0x%08x\n", meta->disk_sectors_high);
237 	printf("disk_rebuild_high   0x%08x\n", meta->disk_rebuild_high);
238 	printf("=================================================\n");
239 }
240 
241 static struct promise_raid_conf *
242 promise_meta_copy(struct promise_raid_conf *meta)
243 {
244 	struct promise_raid_conf *nmeta;
245 
246 	nmeta = malloc(sizeof(*nmeta), M_MD_PROMISE, M_WAITOK);
247 	memcpy(nmeta, meta, sizeof(*nmeta));
248 	return (nmeta);
249 }
250 
251 static int
252 promise_meta_find_disk(struct promise_raid_conf *meta, uint64_t id)
253 {
254 	int pos;
255 
256 	for (pos = 0; pos < meta->total_disks; pos++) {
257 		if (meta->disks[pos].id == id)
258 			return (pos);
259 	}
260 	return (-1);
261 }
262 
263 static int
264 promise_meta_unused_range(struct promise_raid_conf **metaarr, int nsd,
265     off_t sectors, off_t *off, off_t *size)
266 {
267 	off_t coff, csize, tmp;
268 	int i, j;
269 
270 	sectors -= 131072;
271 	*off = 0;
272 	*size = 0;
273 	coff = 0;
274 	csize = sectors;
275 	i = 0;
276 	while (1) {
277 		for (j = 0; j < nsd; j++) {
278 			tmp = ((off_t)metaarr[j]->disk_offset_high << 32) +
279 			    metaarr[j]->disk_offset;
280 			if (tmp >= coff)
281 				csize = MIN(csize, tmp - coff);
282 		}
283 		if (csize > *size) {
284 			*off = coff;
285 			*size = csize;
286 		}
287 		if (i >= nsd)
288 			break;
289 		coff = ((off_t)metaarr[i]->disk_offset_high << 32) +
290 		     metaarr[i]->disk_offset +
291 		    ((off_t)metaarr[i]->disk_sectors_high << 32) +
292 		     metaarr[i]->disk_sectors;
293 		csize = sectors - coff;
294 		i++;
295 	}
296 	return ((*size > 0) ? 1 : 0);
297 }
298 
299 static int
300 promise_meta_translate_disk(struct g_raid_volume *vol, int md_disk_pos)
301 {
302 	int disk_pos, width;
303 
304 	if (md_disk_pos >= 0 && vol->v_raid_level == G_RAID_VOLUME_RL_RAID1E) {
305 		width = vol->v_disks_count / 2;
306 		disk_pos = (md_disk_pos / width) +
307 		    (md_disk_pos % width) * width;
308 	} else
309 		disk_pos = md_disk_pos;
310 	return (disk_pos);
311 }
312 
313 static void
314 promise_meta_get_name(struct promise_raid_conf *meta, char *buf)
315 {
316 	int i;
317 
318 	strncpy(buf, meta->name, 32);
319 	buf[32] = 0;
320 	for (i = 31; i >= 0; i--) {
321 		if (buf[i] > 0x20)
322 			break;
323 		buf[i] = 0;
324 	}
325 }
326 
327 static void
328 promise_meta_put_name(struct promise_raid_conf *meta, char *buf)
329 {
330 
331 	memset(meta->name, 0x20, 32);
332 	memcpy(meta->name, buf, MIN(strlen(buf), 32));
333 }
334 
335 static int
336 promise_meta_read(struct g_consumer *cp, struct promise_raid_conf **metaarr)
337 {
338 	struct g_provider *pp;
339 	struct promise_raid_conf *meta;
340 	char *buf;
341 	int error, i, subdisks;
342 	uint32_t checksum, *ptr;
343 
344 	pp = cp->provider;
345 	subdisks = 0;
346 
347 	if (pp->sectorsize * 4 < sizeof(*meta))
348 		return (subdisks);
349 	if (pp->sectorsize * 4 > maxphys) {
350 		G_RAID_DEBUG(1, "%s: Blocksize is too big.", pp->name);
351 		return (subdisks);
352 	}
353 next:
354 	/* Read metadata block. */
355 	buf = g_read_data(cp, pp->mediasize - pp->sectorsize *
356 	    (63 - subdisks * PROMISE_META_OFFSET),
357 	    pp->sectorsize * 4, &error);
358 	if (buf == NULL) {
359 		G_RAID_DEBUG(1, "Cannot read metadata from %s (error=%d).",
360 		    pp->name, error);
361 		return (subdisks);
362 	}
363 	meta = (struct promise_raid_conf *)buf;
364 
365 	/* Check if this is an Promise RAID struct */
366 	if (strncmp(meta->promise_id, PROMISE_MAGIC, strlen(PROMISE_MAGIC)) &&
367 	    strncmp(meta->promise_id, FREEBSD_MAGIC, strlen(FREEBSD_MAGIC))) {
368 		if (subdisks == 0)
369 			G_RAID_DEBUG(1,
370 			    "Promise signature check failed on %s", pp->name);
371 		g_free(buf);
372 		return (subdisks);
373 	}
374 	meta = malloc(sizeof(*meta), M_MD_PROMISE, M_WAITOK);
375 	memcpy(meta, buf, MIN(sizeof(*meta), pp->sectorsize * 4));
376 	g_free(buf);
377 
378 	/* Check metadata checksum. */
379 	for (checksum = 0, ptr = (uint32_t *)meta, i = 0; i < 511; i++)
380 		checksum += *ptr++;
381 	if (checksum != meta->checksum) {
382 		G_RAID_DEBUG(1, "Promise checksum check failed on %s", pp->name);
383 		free(meta, M_MD_PROMISE);
384 		return (subdisks);
385 	}
386 
387 	if ((meta->integrity & PROMISE_I_VALID) == 0) {
388 		G_RAID_DEBUG(1, "Promise metadata is invalid on %s", pp->name);
389 		free(meta, M_MD_PROMISE);
390 		return (subdisks);
391 	}
392 
393 	if (meta->total_disks > PROMISE_MAX_DISKS) {
394 		G_RAID_DEBUG(1, "Wrong number of disks on %s (%d)",
395 		    pp->name, meta->total_disks);
396 		free(meta, M_MD_PROMISE);
397 		return (subdisks);
398 	}
399 
400 	/* Remove filler garbage from fields used in newer metadata. */
401 	if (meta->disk_offset_high == 0x8b8c8d8e &&
402 	    meta->disk_sectors_high == 0x8788898a &&
403 	    meta->disk_rebuild_high == 0x83848586) {
404 		meta->disk_offset_high = 0;
405 		meta->disk_sectors_high = 0;
406 		if (meta->disk_rebuild == UINT32_MAX)
407 			meta->disk_rebuild_high = UINT32_MAX;
408 		else
409 			meta->disk_rebuild_high = 0;
410 		if (meta->total_sectors_high == 0x15161718) {
411 			meta->total_sectors_high = 0;
412 			meta->backup_time = 0;
413 			if (meta->rebuild_lba64 == 0x2122232425262728)
414 				meta->rebuild_lba64 = UINT64_MAX;
415 		}
416 	}
417 	if (meta->sector_size < 1 || meta->sector_size > 8)
418 		meta->sector_size = 1;
419 
420 	/* Save this part and look for next. */
421 	*metaarr = meta;
422 	metaarr++;
423 	subdisks++;
424 	if (subdisks < PROMISE_MAX_SUBDISKS)
425 		goto next;
426 
427 	return (subdisks);
428 }
429 
430 static int
431 promise_meta_write(struct g_consumer *cp,
432     struct promise_raid_conf **metaarr, int nsd)
433 {
434 	struct g_provider *pp;
435 	struct promise_raid_conf *meta;
436 	char *buf;
437 	off_t off, size;
438 	int error, i, subdisk, fake;
439 	uint32_t checksum, *ptr;
440 
441 	pp = cp->provider;
442 	subdisk = 0;
443 	fake = 0;
444 next:
445 	buf = malloc(pp->sectorsize * 4, M_MD_PROMISE, M_WAITOK | M_ZERO);
446 	meta = NULL;
447 	if (subdisk < nsd) {
448 		meta = metaarr[subdisk];
449 	} else if (!fake && promise_meta_unused_range(metaarr, nsd,
450 	    cp->provider->mediasize / cp->provider->sectorsize,
451 	    &off, &size)) {
452 		/* Optionally add record for unused space. */
453 		meta = (struct promise_raid_conf *)buf;
454 		memcpy(&meta->promise_id[0], PROMISE_MAGIC,
455 		    sizeof(PROMISE_MAGIC) - 1);
456 		meta->dummy_0 = 0x00020000;
457 		meta->integrity = PROMISE_I_VALID;
458 		meta->disk.flags = PROMISE_F_ONLINE | PROMISE_F_VALID;
459 		meta->disk.number = 0xff;
460 		arc4rand(&meta->disk.id, sizeof(meta->disk.id), 0);
461 		meta->disk_offset_high = off >> 32;
462 		meta->disk_offset = (uint32_t)off;
463 		meta->disk_sectors_high = size >> 32;
464 		meta->disk_sectors = (uint32_t)size;
465 		meta->disk_rebuild_high = UINT32_MAX;
466 		meta->disk_rebuild = UINT32_MAX;
467 		fake = 1;
468 	}
469 	if (meta != NULL) {
470 		/* Recalculate checksum for case if metadata were changed. */
471 		meta->checksum = 0;
472 		for (checksum = 0, ptr = (uint32_t *)meta, i = 0; i < 511; i++)
473 			checksum += *ptr++;
474 		meta->checksum = checksum;
475 		memcpy(buf, meta, MIN(pp->sectorsize * 4, sizeof(*meta)));
476 	}
477 	error = g_write_data(cp, pp->mediasize - pp->sectorsize *
478 	    (63 - subdisk * PROMISE_META_OFFSET),
479 	    buf, pp->sectorsize * 4);
480 	if (error != 0) {
481 		G_RAID_DEBUG(1, "Cannot write metadata to %s (error=%d).",
482 		    pp->name, error);
483 	}
484 	free(buf, M_MD_PROMISE);
485 
486 	subdisk++;
487 	if (subdisk < PROMISE_MAX_SUBDISKS)
488 		goto next;
489 
490 	return (error);
491 }
492 
493 static int
494 promise_meta_erase(struct g_consumer *cp)
495 {
496 	struct g_provider *pp;
497 	char *buf;
498 	int error, subdisk;
499 
500 	pp = cp->provider;
501 	buf = malloc(4 * pp->sectorsize, M_MD_PROMISE, M_WAITOK | M_ZERO);
502 	for (subdisk = 0; subdisk < PROMISE_MAX_SUBDISKS; subdisk++) {
503 		error = g_write_data(cp, pp->mediasize - pp->sectorsize *
504 		    (63 - subdisk * PROMISE_META_OFFSET),
505 		    buf, 4 * pp->sectorsize);
506 		if (error != 0) {
507 			G_RAID_DEBUG(1, "Cannot erase metadata on %s (error=%d).",
508 			    pp->name, error);
509 		}
510 	}
511 	free(buf, M_MD_PROMISE);
512 	return (error);
513 }
514 
515 static int
516 promise_meta_write_spare(struct g_consumer *cp)
517 {
518 	struct promise_raid_conf *meta;
519 	off_t tmp;
520 	int error;
521 
522 	meta = malloc(sizeof(*meta), M_MD_PROMISE, M_WAITOK | M_ZERO);
523 	memcpy(&meta->promise_id[0], PROMISE_MAGIC, sizeof(PROMISE_MAGIC) - 1);
524 	meta->dummy_0 = 0x00020000;
525 	meta->integrity = PROMISE_I_VALID;
526 	meta->disk.flags = PROMISE_F_SPARE | PROMISE_F_ONLINE | PROMISE_F_VALID;
527 	meta->disk.number = 0xff;
528 	arc4rand(&meta->disk.id, sizeof(meta->disk.id), 0);
529 	tmp = cp->provider->mediasize / cp->provider->sectorsize - 131072;
530 	meta->disk_sectors_high = tmp >> 32;
531 	meta->disk_sectors = (uint32_t)tmp;
532 	meta->disk_rebuild_high = UINT32_MAX;
533 	meta->disk_rebuild = UINT32_MAX;
534 	error = promise_meta_write(cp, &meta, 1);
535 	free(meta, M_MD_PROMISE);
536 	return (error);
537 }
538 
539 static struct g_raid_volume *
540 g_raid_md_promise_get_volume(struct g_raid_softc *sc, uint64_t id)
541 {
542 	struct g_raid_volume	*vol;
543 	struct g_raid_md_promise_pervolume *pv;
544 
545 	TAILQ_FOREACH(vol, &sc->sc_volumes, v_next) {
546 		pv = vol->v_md_data;
547 		if (pv->pv_id == id)
548 			break;
549 	}
550 	return (vol);
551 }
552 
553 static int
554 g_raid_md_promise_purge_volumes(struct g_raid_softc *sc)
555 {
556 	struct g_raid_volume	*vol, *tvol;
557 	struct g_raid_md_promise_pervolume *pv;
558 	int i, res;
559 
560 	res = 0;
561 	TAILQ_FOREACH_SAFE(vol, &sc->sc_volumes, v_next, tvol) {
562 		pv = vol->v_md_data;
563 		if (!pv->pv_started || vol->v_stopping)
564 			continue;
565 		for (i = 0; i < vol->v_disks_count; i++) {
566 			if (vol->v_subdisks[i].sd_state != G_RAID_SUBDISK_S_NONE)
567 				break;
568 		}
569 		if (i >= vol->v_disks_count) {
570 			g_raid_destroy_volume(vol);
571 			res = 1;
572 		}
573 	}
574 	return (res);
575 }
576 
577 static int
578 g_raid_md_promise_purge_disks(struct g_raid_softc *sc)
579 {
580 	struct g_raid_disk	*disk, *tdisk;
581 	struct g_raid_volume	*vol;
582 	struct g_raid_md_promise_perdisk *pd;
583 	int i, j, res;
584 
585 	res = 0;
586 	TAILQ_FOREACH_SAFE(disk, &sc->sc_disks, d_next, tdisk) {
587 		if (disk->d_state == G_RAID_DISK_S_SPARE)
588 			continue;
589 		pd = (struct g_raid_md_promise_perdisk *)disk->d_md_data;
590 
591 		/* Scan for deleted volumes. */
592 		for (i = 0; i < pd->pd_subdisks; ) {
593 			vol = g_raid_md_promise_get_volume(sc,
594 			    pd->pd_meta[i]->volume_id);
595 			if (vol != NULL && !vol->v_stopping) {
596 				i++;
597 				continue;
598 			}
599 			free(pd->pd_meta[i], M_MD_PROMISE);
600 			for (j = i; j < pd->pd_subdisks - 1; j++)
601 				pd->pd_meta[j] = pd->pd_meta[j + 1];
602 			pd->pd_meta[pd->pd_subdisks - 1] = NULL;
603 			pd->pd_subdisks--;
604 			pd->pd_updated = 1;
605 		}
606 
607 		/* If there is no metadata left - erase and delete disk. */
608 		if (pd->pd_subdisks == 0) {
609 			promise_meta_erase(disk->d_consumer);
610 			g_raid_destroy_disk(disk);
611 			res = 1;
612 		}
613 	}
614 	return (res);
615 }
616 
617 static int
618 g_raid_md_promise_supported(int level, int qual, int disks, int force)
619 {
620 
621 	if (disks > PROMISE_MAX_DISKS)
622 		return (0);
623 	switch (level) {
624 	case G_RAID_VOLUME_RL_RAID0:
625 		if (disks < 1)
626 			return (0);
627 		if (!force && disks < 2)
628 			return (0);
629 		break;
630 	case G_RAID_VOLUME_RL_RAID1:
631 		if (disks < 1)
632 			return (0);
633 		if (!force && (disks != 2))
634 			return (0);
635 		break;
636 	case G_RAID_VOLUME_RL_RAID1E:
637 		if (disks < 2)
638 			return (0);
639 		if (disks % 2 != 0)
640 			return (0);
641 		if (!force && (disks != 4))
642 			return (0);
643 		break;
644 	case G_RAID_VOLUME_RL_SINGLE:
645 		if (disks != 1)
646 			return (0);
647 		break;
648 	case G_RAID_VOLUME_RL_CONCAT:
649 		if (disks < 2)
650 			return (0);
651 		break;
652 	case G_RAID_VOLUME_RL_RAID5:
653 		if (disks < 3)
654 			return (0);
655 		if (qual != G_RAID_VOLUME_RLQ_R5LA)
656 			return (0);
657 		break;
658 	default:
659 		return (0);
660 	}
661 	if (level != G_RAID_VOLUME_RL_RAID5 && qual != G_RAID_VOLUME_RLQ_NONE)
662 		return (0);
663 	return (1);
664 }
665 
666 static int
667 g_raid_md_promise_start_disk(struct g_raid_disk *disk, int sdn,
668     struct g_raid_volume *vol)
669 {
670 	struct g_raid_softc *sc;
671 	struct g_raid_subdisk *sd;
672 	struct g_raid_md_promise_perdisk *pd;
673 	struct g_raid_md_promise_pervolume *pv;
674 	struct promise_raid_conf *meta;
675 	off_t eoff, esize, size;
676 	int disk_pos, md_disk_pos, i, resurrection = 0;
677 
678 	sc = disk->d_softc;
679 	pd = (struct g_raid_md_promise_perdisk *)disk->d_md_data;
680 
681 	pv = vol->v_md_data;
682 	meta = pv->pv_meta;
683 
684 	if (sdn >= 0) {
685 		/* Find disk position in metadata by its serial. */
686 		md_disk_pos = promise_meta_find_disk(meta, pd->pd_meta[sdn]->disk.id);
687 		/* For RAID0+1 we need to translate order. */
688 		disk_pos = promise_meta_translate_disk(vol, md_disk_pos);
689 	} else {
690 		md_disk_pos = -1;
691 		disk_pos = -1;
692 	}
693 	if (disk_pos < 0) {
694 		G_RAID_DEBUG1(1, sc, "Disk %s is not part of the volume %s",
695 		    g_raid_get_diskname(disk), vol->v_name);
696 		/* Failed stale disk is useless for us. */
697 		if (sdn >= 0 &&
698 		    pd->pd_meta[sdn]->disk.flags & PROMISE_F_DOWN) {
699 			g_raid_change_disk_state(disk, G_RAID_DISK_S_STALE_FAILED);
700 			return (0);
701 		}
702 		/* If we were given specific metadata subdisk - erase it. */
703 		if (sdn >= 0) {
704 			free(pd->pd_meta[sdn], M_MD_PROMISE);
705 			for (i = sdn; i < pd->pd_subdisks - 1; i++)
706 				pd->pd_meta[i] = pd->pd_meta[i + 1];
707 			pd->pd_meta[pd->pd_subdisks - 1] = NULL;
708 			pd->pd_subdisks--;
709 		}
710 		/* If we are in the start process, that's all for now. */
711 		if (!pv->pv_started)
712 			goto nofit;
713 		/*
714 		 * If we have already started - try to get use of the disk.
715 		 * Try to replace OFFLINE disks first, then FAILED.
716 		 */
717 		promise_meta_unused_range(pd->pd_meta, pd->pd_subdisks,
718 		    disk->d_consumer->provider->mediasize /
719 		    disk->d_consumer->provider->sectorsize,
720 		    &eoff, &esize);
721 		if (esize == 0) {
722 			G_RAID_DEBUG1(1, sc, "No free space on disk %s",
723 			    g_raid_get_diskname(disk));
724 			goto nofit;
725 		}
726 		size = INT64_MAX;
727 		for (i = 0; i < vol->v_disks_count; i++) {
728 			sd = &vol->v_subdisks[i];
729 			if (sd->sd_state != G_RAID_SUBDISK_S_NONE)
730 				size = sd->sd_size;
731 			if (sd->sd_state <= G_RAID_SUBDISK_S_FAILED &&
732 			    (disk_pos < 0 ||
733 			     vol->v_subdisks[i].sd_state < sd->sd_state))
734 				disk_pos = i;
735 		}
736 		if (disk_pos >= 0 &&
737 		    vol->v_raid_level != G_RAID_VOLUME_RL_CONCAT &&
738 		    (off_t)esize * 512 < size) {
739 			G_RAID_DEBUG1(1, sc, "Disk %s free space "
740 			    "is too small (%ju < %ju)",
741 			    g_raid_get_diskname(disk),
742 			    (off_t)esize * 512, size);
743 			disk_pos = -1;
744 		}
745 		if (disk_pos >= 0) {
746 			if (vol->v_raid_level != G_RAID_VOLUME_RL_CONCAT)
747 				esize = size / 512;
748 			/* For RAID0+1 we need to translate order. */
749 			md_disk_pos = promise_meta_translate_disk(vol, disk_pos);
750 		} else {
751 nofit:
752 			if (pd->pd_subdisks == 0) {
753 				g_raid_change_disk_state(disk,
754 				    G_RAID_DISK_S_SPARE);
755 			}
756 			return (0);
757 		}
758 		G_RAID_DEBUG1(1, sc, "Disk %s takes pos %d in the volume %s",
759 		    g_raid_get_diskname(disk), disk_pos, vol->v_name);
760 		resurrection = 1;
761 	}
762 
763 	sd = &vol->v_subdisks[disk_pos];
764 
765 	if (resurrection && sd->sd_disk != NULL) {
766 		g_raid_change_disk_state(sd->sd_disk,
767 		    G_RAID_DISK_S_STALE_FAILED);
768 		TAILQ_REMOVE(&sd->sd_disk->d_subdisks,
769 		    sd, sd_next);
770 	}
771 	vol->v_subdisks[disk_pos].sd_disk = disk;
772 	TAILQ_INSERT_TAIL(&disk->d_subdisks, sd, sd_next);
773 
774 	/* Welcome the new disk. */
775 	if (resurrection)
776 		g_raid_change_disk_state(disk, G_RAID_DISK_S_ACTIVE);
777 	else if (meta->disks[md_disk_pos].flags & PROMISE_F_DOWN)
778 		g_raid_change_disk_state(disk, G_RAID_DISK_S_FAILED);
779 	else
780 		g_raid_change_disk_state(disk, G_RAID_DISK_S_ACTIVE);
781 
782 	if (resurrection) {
783 		sd->sd_offset = (off_t)eoff * 512;
784 		sd->sd_size = (off_t)esize * 512;
785 	} else {
786 		sd->sd_offset = (((off_t)pd->pd_meta[sdn]->disk_offset_high
787 		    << 32) + pd->pd_meta[sdn]->disk_offset) * 512;
788 		sd->sd_size = (((off_t)pd->pd_meta[sdn]->disk_sectors_high
789 		    << 32) + pd->pd_meta[sdn]->disk_sectors) * 512;
790 	}
791 
792 	if (resurrection) {
793 		/* Stale disk, almost same as new. */
794 		g_raid_change_subdisk_state(sd,
795 		    G_RAID_SUBDISK_S_NEW);
796 	} else if (meta->disks[md_disk_pos].flags & PROMISE_F_DOWN) {
797 		/* Failed disk. */
798 		g_raid_change_subdisk_state(sd,
799 		    G_RAID_SUBDISK_S_FAILED);
800 	} else if (meta->disks[md_disk_pos].flags & PROMISE_F_REDIR) {
801 		/* Rebuilding disk. */
802 		g_raid_change_subdisk_state(sd,
803 		    G_RAID_SUBDISK_S_REBUILD);
804 		if (pd->pd_meta[sdn]->generation != meta->generation)
805 			sd->sd_rebuild_pos = 0;
806 		else {
807 			sd->sd_rebuild_pos =
808 			    (((off_t)pd->pd_meta[sdn]->disk_rebuild_high << 32) +
809 			     pd->pd_meta[sdn]->disk_rebuild) * 512;
810 		}
811 	} else if (!(meta->disks[md_disk_pos].flags & PROMISE_F_ONLINE)) {
812 		/* Rebuilding disk. */
813 		g_raid_change_subdisk_state(sd,
814 		    G_RAID_SUBDISK_S_NEW);
815 	} else if (pd->pd_meta[sdn]->generation != meta->generation ||
816 	    (meta->status & PROMISE_S_MARKED)) {
817 		/* Stale disk or dirty volume (unclean shutdown). */
818 		g_raid_change_subdisk_state(sd,
819 		    G_RAID_SUBDISK_S_STALE);
820 	} else {
821 		/* Up to date disk. */
822 		g_raid_change_subdisk_state(sd,
823 		    G_RAID_SUBDISK_S_ACTIVE);
824 	}
825 	g_raid_event_send(sd, G_RAID_SUBDISK_E_NEW,
826 	    G_RAID_EVENT_SUBDISK);
827 
828 	return (resurrection);
829 }
830 
831 static void
832 g_raid_md_promise_refill(struct g_raid_softc *sc)
833 {
834 	struct g_raid_volume *vol;
835 	struct g_raid_subdisk *sd;
836 	struct g_raid_disk *disk;
837 	struct g_raid_md_object *md;
838 	struct g_raid_md_promise_perdisk *pd;
839 	struct g_raid_md_promise_pervolume *pv;
840 	int update, updated, i, bad;
841 
842 	md = sc->sc_md;
843 restart:
844 	updated = 0;
845 	TAILQ_FOREACH(vol, &sc->sc_volumes, v_next) {
846 		pv = vol->v_md_data;
847 		if (!pv->pv_started || vol->v_stopping)
848 			continue;
849 
850 		/* Search for subdisk that needs replacement. */
851 		bad = 0;
852 		for (i = 0; i < vol->v_disks_count; i++) {
853 			sd = &vol->v_subdisks[i];
854 			if (sd->sd_state == G_RAID_SUBDISK_S_NONE ||
855 			    sd->sd_state == G_RAID_SUBDISK_S_FAILED)
856 			        bad = 1;
857 		}
858 		if (!bad)
859 			continue;
860 
861 		G_RAID_DEBUG1(1, sc, "Volume %s is not complete, "
862 		    "trying to refill.", vol->v_name);
863 
864 		TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
865 			/* Skip failed. */
866 			if (disk->d_state < G_RAID_DISK_S_SPARE)
867 				continue;
868 			/* Skip already used by this volume. */
869 			for (i = 0; i < vol->v_disks_count; i++) {
870 				sd = &vol->v_subdisks[i];
871 				if (sd->sd_disk == disk)
872 					break;
873 			}
874 			if (i < vol->v_disks_count)
875 				continue;
876 
877 			/* Try to use disk if it has empty extents. */
878 			pd = disk->d_md_data;
879 			if (pd->pd_subdisks < PROMISE_MAX_SUBDISKS) {
880 				update =
881 				    g_raid_md_promise_start_disk(disk, -1, vol);
882 			} else
883 				update = 0;
884 			if (update) {
885 				updated = 1;
886 				g_raid_md_write_promise(md, vol, NULL, disk);
887 				break;
888 			}
889 		}
890 	}
891 	if (updated)
892 		goto restart;
893 }
894 
895 static void
896 g_raid_md_promise_start(struct g_raid_volume *vol)
897 {
898 	struct g_raid_softc *sc;
899 	struct g_raid_subdisk *sd;
900 	struct g_raid_disk *disk;
901 	struct g_raid_md_object *md;
902 	struct g_raid_md_promise_perdisk *pd;
903 	struct g_raid_md_promise_pervolume *pv;
904 	struct promise_raid_conf *meta;
905 	u_int i;
906 
907 	sc = vol->v_softc;
908 	md = sc->sc_md;
909 	pv = vol->v_md_data;
910 	meta = pv->pv_meta;
911 
912 	vol->v_raid_level_qualifier = G_RAID_VOLUME_RLQ_NONE;
913 	if (meta->type == PROMISE_T_RAID0)
914 		vol->v_raid_level = G_RAID_VOLUME_RL_RAID0;
915 	else if (meta->type == PROMISE_T_RAID1) {
916 		if (meta->array_width == 1)
917 			vol->v_raid_level = G_RAID_VOLUME_RL_RAID1;
918 		else
919 			vol->v_raid_level = G_RAID_VOLUME_RL_RAID1E;
920 	} else if (meta->type == PROMISE_T_RAID3)
921 		vol->v_raid_level = G_RAID_VOLUME_RL_RAID3;
922 	else if (meta->type == PROMISE_T_RAID5) {
923 		vol->v_raid_level = G_RAID_VOLUME_RL_RAID5;
924 		vol->v_raid_level_qualifier = G_RAID_VOLUME_RLQ_R5LA;
925 	} else if (meta->type == PROMISE_T_SPAN)
926 		vol->v_raid_level = G_RAID_VOLUME_RL_CONCAT;
927 	else if (meta->type == PROMISE_T_JBOD)
928 		vol->v_raid_level = G_RAID_VOLUME_RL_SINGLE;
929 	else
930 		vol->v_raid_level = G_RAID_VOLUME_RL_UNKNOWN;
931 	vol->v_strip_size = 512 << meta->stripe_shift; //ZZZ
932 	vol->v_disks_count = meta->total_disks;
933 	vol->v_mediasize = (off_t)meta->total_sectors * 512; //ZZZ
934 	if (meta->total_sectors_high < 256) /* If value looks sane. */
935 		vol->v_mediasize +=
936 		    ((off_t)meta->total_sectors_high << 32) * 512; //ZZZ
937 	vol->v_sectorsize = 512 * meta->sector_size;
938 	for (i = 0; i < vol->v_disks_count; i++) {
939 		sd = &vol->v_subdisks[i];
940 		sd->sd_offset = (((off_t)meta->disk_offset_high << 32) +
941 		    meta->disk_offset) * 512;
942 		sd->sd_size = (((off_t)meta->disk_sectors_high << 32) +
943 		    meta->disk_sectors) * 512;
944 	}
945 	g_raid_start_volume(vol);
946 
947 	/* Make all disks found till the moment take their places. */
948 	TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
949 		pd = disk->d_md_data;
950 		for (i = 0; i < pd->pd_subdisks; i++) {
951 			if (pd->pd_meta[i]->volume_id == meta->volume_id)
952 				g_raid_md_promise_start_disk(disk, i, vol);
953 		}
954 	}
955 
956 	pv->pv_started = 1;
957 	callout_stop(&pv->pv_start_co);
958 	G_RAID_DEBUG1(0, sc, "Volume started.");
959 	g_raid_md_write_promise(md, vol, NULL, NULL);
960 
961 	/* Pickup any STALE/SPARE disks to refill array if needed. */
962 	g_raid_md_promise_refill(sc);
963 
964 	g_raid_event_send(vol, G_RAID_VOLUME_E_START, G_RAID_EVENT_VOLUME);
965 }
966 
967 static void
968 g_raid_promise_go(void *arg)
969 {
970 	struct g_raid_volume *vol;
971 	struct g_raid_softc *sc;
972 	struct g_raid_md_promise_pervolume *pv;
973 
974 	vol = arg;
975 	pv = vol->v_md_data;
976 	sc = vol->v_softc;
977 	if (!pv->pv_started) {
978 		G_RAID_DEBUG1(0, sc, "Force volume start due to timeout.");
979 		g_raid_event_send(vol, G_RAID_VOLUME_E_STARTMD,
980 		    G_RAID_EVENT_VOLUME);
981 	}
982 }
983 
984 static void
985 g_raid_md_promise_new_disk(struct g_raid_disk *disk)
986 {
987 	struct g_raid_softc *sc;
988 	struct g_raid_md_object *md;
989 	struct promise_raid_conf *pdmeta;
990 	struct g_raid_md_promise_perdisk *pd;
991 	struct g_raid_md_promise_pervolume *pv;
992 	struct g_raid_volume *vol;
993 	int i;
994 	char buf[33];
995 
996 	sc = disk->d_softc;
997 	md = sc->sc_md;
998 	pd = (struct g_raid_md_promise_perdisk *)disk->d_md_data;
999 
1000 	if (pd->pd_subdisks == 0) {
1001 		g_raid_change_disk_state(disk, G_RAID_DISK_S_SPARE);
1002 		g_raid_md_promise_refill(sc);
1003 		return;
1004 	}
1005 
1006 	for (i = 0; i < pd->pd_subdisks; i++) {
1007 		pdmeta = pd->pd_meta[i];
1008 
1009 		/* Look for volume with matching ID. */
1010 		vol = g_raid_md_promise_get_volume(sc, pdmeta->volume_id);
1011 		if (vol == NULL) {
1012 			promise_meta_get_name(pdmeta, buf);
1013 			vol = g_raid_create_volume(sc, buf, pdmeta->array_number);
1014 			pv = malloc(sizeof(*pv), M_MD_PROMISE, M_WAITOK | M_ZERO);
1015 			pv->pv_id = pdmeta->volume_id;
1016 			vol->v_md_data = pv;
1017 			callout_init(&pv->pv_start_co, 1);
1018 			callout_reset(&pv->pv_start_co,
1019 			    g_raid_start_timeout * hz,
1020 			    g_raid_promise_go, vol);
1021 		} else
1022 			pv = vol->v_md_data;
1023 
1024 		/* If we haven't started yet - check metadata freshness. */
1025 		if (pv->pv_meta == NULL || !pv->pv_started) {
1026 			if (pv->pv_meta == NULL ||
1027 			    ((int16_t)(pdmeta->generation - pv->pv_generation)) > 0) {
1028 				G_RAID_DEBUG1(1, sc, "Newer disk");
1029 				if (pv->pv_meta != NULL)
1030 					free(pv->pv_meta, M_MD_PROMISE);
1031 				pv->pv_meta = promise_meta_copy(pdmeta);
1032 				pv->pv_generation = pv->pv_meta->generation;
1033 				pv->pv_disks_present = 1;
1034 			} else if (pdmeta->generation == pv->pv_generation) {
1035 				pv->pv_disks_present++;
1036 				G_RAID_DEBUG1(1, sc, "Matching disk (%d of %d up)",
1037 				    pv->pv_disks_present,
1038 				    pv->pv_meta->total_disks);
1039 			} else {
1040 				G_RAID_DEBUG1(1, sc, "Older disk");
1041 			}
1042 		}
1043 	}
1044 
1045 	for (i = 0; i < pd->pd_subdisks; i++) {
1046 		pdmeta = pd->pd_meta[i];
1047 
1048 		/* Look for volume with matching ID. */
1049 		vol = g_raid_md_promise_get_volume(sc, pdmeta->volume_id);
1050 		if (vol == NULL)
1051 			continue;
1052 		pv = vol->v_md_data;
1053 
1054 		if (pv->pv_started) {
1055 			if (g_raid_md_promise_start_disk(disk, i, vol))
1056 				g_raid_md_write_promise(md, vol, NULL, NULL);
1057 		} else {
1058 			/* If we collected all needed disks - start array. */
1059 			if (pv->pv_disks_present == pv->pv_meta->total_disks)
1060 				g_raid_md_promise_start(vol);
1061 		}
1062 	}
1063 }
1064 
1065 static int
1066 g_raid_md_create_promise(struct g_raid_md_object *md, struct g_class *mp,
1067     struct g_geom **gp)
1068 {
1069 	struct g_geom *geom;
1070 	struct g_raid_softc *sc;
1071 
1072 	/* Search for existing node. */
1073 	LIST_FOREACH(geom, &mp->geom, geom) {
1074 		sc = geom->softc;
1075 		if (sc == NULL)
1076 			continue;
1077 		if (sc->sc_stopping != 0)
1078 			continue;
1079 		if (sc->sc_md->mdo_class != md->mdo_class)
1080 			continue;
1081 		break;
1082 	}
1083 	if (geom != NULL) {
1084 		*gp = geom;
1085 		return (G_RAID_MD_TASTE_EXISTING);
1086 	}
1087 
1088 	/* Create new one if not found. */
1089 	sc = g_raid_create_node(mp, "Promise", md);
1090 	if (sc == NULL)
1091 		return (G_RAID_MD_TASTE_FAIL);
1092 	md->mdo_softc = sc;
1093 	*gp = sc->sc_geom;
1094 	return (G_RAID_MD_TASTE_NEW);
1095 }
1096 
1097 static int
1098 g_raid_md_taste_promise(struct g_raid_md_object *md, struct g_class *mp,
1099                               struct g_consumer *cp, struct g_geom **gp)
1100 {
1101 	struct g_consumer *rcp;
1102 	struct g_provider *pp;
1103 	struct g_raid_softc *sc;
1104 	struct g_raid_disk *disk;
1105 	struct promise_raid_conf *metaarr[4];
1106 	struct g_raid_md_promise_perdisk *pd;
1107 	struct g_geom *geom;
1108 	int i, j, result, len, subdisks;
1109 	char name[16];
1110 	uint16_t vendor;
1111 
1112 	G_RAID_DEBUG(1, "Tasting Promise on %s", cp->provider->name);
1113 	pp = cp->provider;
1114 
1115 	/* Read metadata from device. */
1116 	g_topology_unlock();
1117 	vendor = 0xffff;
1118 	len = sizeof(vendor);
1119 	if (pp->geom->rank == 1)
1120 		g_io_getattr("GEOM::hba_vendor", cp, &len, &vendor);
1121 	subdisks = promise_meta_read(cp, metaarr);
1122 	g_topology_lock();
1123 	if (subdisks == 0) {
1124 		if (g_raid_aggressive_spare) {
1125 			if (vendor == 0x105a || vendor == 0x1002) {
1126 				G_RAID_DEBUG(1,
1127 				    "No Promise metadata, forcing spare.");
1128 				goto search;
1129 			} else {
1130 				G_RAID_DEBUG(1,
1131 				    "Promise/ATI vendor mismatch "
1132 				    "0x%04x != 0x105a/0x1002",
1133 				    vendor);
1134 			}
1135 		}
1136 		return (G_RAID_MD_TASTE_FAIL);
1137 	}
1138 
1139 	/* Metadata valid. Print it. */
1140 	for (i = 0; i < subdisks; i++)
1141 		g_raid_md_promise_print(metaarr[i]);
1142 
1143 	/* Purge meaningless (empty/spare) records. */
1144 	for (i = 0; i < subdisks; ) {
1145 		if (metaarr[i]->disk.flags & PROMISE_F_ASSIGNED) {
1146 			i++;
1147 			continue;
1148 		}
1149 		free(metaarr[i], M_MD_PROMISE);
1150 		for (j = i; j < subdisks - 1; j++)
1151 			metaarr[i] = metaarr[j + 1];
1152 		metaarr[subdisks - 1] = NULL;
1153 		subdisks--;
1154 	}
1155 
1156 search:
1157 	/* Search for matching node. */
1158 	sc = NULL;
1159 	LIST_FOREACH(geom, &mp->geom, geom) {
1160 		sc = geom->softc;
1161 		if (sc == NULL)
1162 			continue;
1163 		if (sc->sc_stopping != 0)
1164 			continue;
1165 		if (sc->sc_md->mdo_class != md->mdo_class)
1166 			continue;
1167 		break;
1168 	}
1169 
1170 	/* Found matching node. */
1171 	if (geom != NULL) {
1172 		G_RAID_DEBUG(1, "Found matching array %s", sc->sc_name);
1173 		result = G_RAID_MD_TASTE_EXISTING;
1174 
1175 	} else { /* Not found matching node -- create one. */
1176 		result = G_RAID_MD_TASTE_NEW;
1177 		snprintf(name, sizeof(name), "Promise");
1178 		sc = g_raid_create_node(mp, name, md);
1179 		md->mdo_softc = sc;
1180 		geom = sc->sc_geom;
1181 	}
1182 
1183 	/* There is no return after this point, so we close passed consumer. */
1184 	g_access(cp, -1, 0, 0);
1185 
1186 	rcp = g_new_consumer(geom);
1187 	rcp->flags |= G_CF_DIRECT_RECEIVE;
1188 	g_attach(rcp, pp);
1189 	if (g_access(rcp, 1, 1, 1) != 0)
1190 		; //goto fail1;
1191 
1192 	g_topology_unlock();
1193 	sx_xlock(&sc->sc_lock);
1194 
1195 	pd = malloc(sizeof(*pd), M_MD_PROMISE, M_WAITOK | M_ZERO);
1196 	pd->pd_subdisks = subdisks;
1197 	for (i = 0; i < subdisks; i++)
1198 		pd->pd_meta[i] = metaarr[i];
1199 	disk = g_raid_create_disk(sc);
1200 	disk->d_md_data = (void *)pd;
1201 	disk->d_consumer = rcp;
1202 	rcp->private = disk;
1203 
1204 	g_raid_get_disk_info(disk);
1205 
1206 	g_raid_md_promise_new_disk(disk);
1207 
1208 	sx_xunlock(&sc->sc_lock);
1209 	g_topology_lock();
1210 	*gp = geom;
1211 	return (result);
1212 }
1213 
1214 static int
1215 g_raid_md_event_promise(struct g_raid_md_object *md,
1216     struct g_raid_disk *disk, u_int event)
1217 {
1218 	struct g_raid_softc *sc;
1219 
1220 	sc = md->mdo_softc;
1221 	if (disk == NULL)
1222 		return (-1);
1223 	switch (event) {
1224 	case G_RAID_DISK_E_DISCONNECTED:
1225 		/* Delete disk. */
1226 		g_raid_change_disk_state(disk, G_RAID_DISK_S_NONE);
1227 		g_raid_destroy_disk(disk);
1228 		g_raid_md_promise_purge_volumes(sc);
1229 
1230 		/* Write updated metadata to all disks. */
1231 		g_raid_md_write_promise(md, NULL, NULL, NULL);
1232 
1233 		/* Check if anything left. */
1234 		if (g_raid_ndisks(sc, -1) == 0)
1235 			g_raid_destroy_node(sc, 0);
1236 		else
1237 			g_raid_md_promise_refill(sc);
1238 		return (0);
1239 	}
1240 	return (-2);
1241 }
1242 
1243 static int
1244 g_raid_md_volume_event_promise(struct g_raid_md_object *md,
1245     struct g_raid_volume *vol, u_int event)
1246 {
1247 	struct g_raid_md_promise_pervolume *pv;
1248 
1249 	pv = (struct g_raid_md_promise_pervolume *)vol->v_md_data;
1250 	switch (event) {
1251 	case G_RAID_VOLUME_E_STARTMD:
1252 		if (!pv->pv_started)
1253 			g_raid_md_promise_start(vol);
1254 		return (0);
1255 	}
1256 	return (-2);
1257 }
1258 
1259 static int
1260 g_raid_md_ctl_promise(struct g_raid_md_object *md,
1261     struct gctl_req *req)
1262 {
1263 	struct g_raid_softc *sc;
1264 	struct g_raid_volume *vol, *vol1;
1265 	struct g_raid_subdisk *sd;
1266 	struct g_raid_disk *disk, *disks[PROMISE_MAX_DISKS];
1267 	struct g_raid_md_promise_perdisk *pd;
1268 	struct g_raid_md_promise_pervolume *pv;
1269 	struct g_consumer *cp;
1270 	struct g_provider *pp;
1271 	char arg[16];
1272 	const char *nodename, *verb, *volname, *levelname, *diskname;
1273 	char *tmp;
1274 	int *nargs, *force;
1275 	off_t esize, offs[PROMISE_MAX_DISKS], size, sectorsize, strip;
1276 	intmax_t *sizearg, *striparg;
1277 	int numdisks, i, len, level, qual;
1278 	int error;
1279 
1280 	sc = md->mdo_softc;
1281 	verb = gctl_get_param(req, "verb", NULL);
1282 	nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs));
1283 	error = 0;
1284 	if (strcmp(verb, "label") == 0) {
1285 		if (*nargs < 4) {
1286 			gctl_error(req, "Invalid number of arguments.");
1287 			return (-1);
1288 		}
1289 		volname = gctl_get_asciiparam(req, "arg1");
1290 		if (volname == NULL) {
1291 			gctl_error(req, "No volume name.");
1292 			return (-2);
1293 		}
1294 		levelname = gctl_get_asciiparam(req, "arg2");
1295 		if (levelname == NULL) {
1296 			gctl_error(req, "No RAID level.");
1297 			return (-3);
1298 		}
1299 		if (strcasecmp(levelname, "RAID5") == 0)
1300 			levelname = "RAID5-LA";
1301 		if (g_raid_volume_str2level(levelname, &level, &qual)) {
1302 			gctl_error(req, "Unknown RAID level '%s'.", levelname);
1303 			return (-4);
1304 		}
1305 		numdisks = *nargs - 3;
1306 		force = gctl_get_paraml(req, "force", sizeof(*force));
1307 		if (!g_raid_md_promise_supported(level, qual, numdisks,
1308 		    force ? *force : 0)) {
1309 			gctl_error(req, "Unsupported RAID level "
1310 			    "(0x%02x/0x%02x), or number of disks (%d).",
1311 			    level, qual, numdisks);
1312 			return (-5);
1313 		}
1314 
1315 		/* Search for disks, connect them and probe. */
1316 		size = INT64_MAX;
1317 		sectorsize = 0;
1318 		bzero(disks, sizeof(disks));
1319 		bzero(offs, sizeof(offs));
1320 		for (i = 0; i < numdisks; i++) {
1321 			snprintf(arg, sizeof(arg), "arg%d", i + 3);
1322 			diskname = gctl_get_asciiparam(req, arg);
1323 			if (diskname == NULL) {
1324 				gctl_error(req, "No disk name (%s).", arg);
1325 				error = -6;
1326 				break;
1327 			}
1328 			if (strcmp(diskname, "NONE") == 0)
1329 				continue;
1330 
1331 			TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1332 				if (disk->d_consumer != NULL &&
1333 				    disk->d_consumer->provider != NULL &&
1334 				    strcmp(disk->d_consumer->provider->name,
1335 				     diskname) == 0)
1336 					break;
1337 			}
1338 			if (disk != NULL) {
1339 				if (disk->d_state != G_RAID_DISK_S_ACTIVE) {
1340 					gctl_error(req, "Disk '%s' is in a "
1341 					    "wrong state (%s).", diskname,
1342 					    g_raid_disk_state2str(disk->d_state));
1343 					error = -7;
1344 					break;
1345 				}
1346 				pd = disk->d_md_data;
1347 				if (pd->pd_subdisks >= PROMISE_MAX_SUBDISKS) {
1348 					gctl_error(req, "Disk '%s' already "
1349 					    "used by %d volumes.",
1350 					    diskname, pd->pd_subdisks);
1351 					error = -7;
1352 					break;
1353 				}
1354 				pp = disk->d_consumer->provider;
1355 				disks[i] = disk;
1356 				promise_meta_unused_range(pd->pd_meta,
1357 				    pd->pd_subdisks,
1358 				    pp->mediasize / pp->sectorsize,
1359 				    &offs[i], &esize);
1360 				size = MIN(size, (off_t)esize * pp->sectorsize);
1361 				sectorsize = MAX(sectorsize, pp->sectorsize);
1362 				continue;
1363 			}
1364 
1365 			g_topology_lock();
1366 			cp = g_raid_open_consumer(sc, diskname);
1367 			if (cp == NULL) {
1368 				gctl_error(req, "Can't open disk '%s'.",
1369 				    diskname);
1370 				g_topology_unlock();
1371 				error = -8;
1372 				break;
1373 			}
1374 			pp = cp->provider;
1375 			pd = malloc(sizeof(*pd), M_MD_PROMISE, M_WAITOK | M_ZERO);
1376 			disk = g_raid_create_disk(sc);
1377 			disk->d_md_data = (void *)pd;
1378 			disk->d_consumer = cp;
1379 			disks[i] = disk;
1380 			cp->private = disk;
1381 			g_topology_unlock();
1382 
1383 			g_raid_get_disk_info(disk);
1384 
1385 			/* Reserve some space for metadata. */
1386 			size = MIN(size, pp->mediasize - 131072llu * pp->sectorsize);
1387 			sectorsize = MAX(sectorsize, pp->sectorsize);
1388 		}
1389 		if (error != 0) {
1390 			for (i = 0; i < numdisks; i++) {
1391 				if (disks[i] != NULL &&
1392 				    disks[i]->d_state == G_RAID_DISK_S_NONE)
1393 					g_raid_destroy_disk(disks[i]);
1394 			}
1395 			return (error);
1396 		}
1397 
1398 		if (sectorsize <= 0) {
1399 			gctl_error(req, "Can't get sector size.");
1400 			return (-8);
1401 		}
1402 
1403 		/* Handle size argument. */
1404 		len = sizeof(*sizearg);
1405 		sizearg = gctl_get_param(req, "size", &len);
1406 		if (sizearg != NULL && len == sizeof(*sizearg) &&
1407 		    *sizearg > 0) {
1408 			if (*sizearg > size) {
1409 				gctl_error(req, "Size too big %lld > %lld.",
1410 				    (long long)*sizearg, (long long)size);
1411 				return (-9);
1412 			}
1413 			size = *sizearg;
1414 		}
1415 
1416 		/* Handle strip argument. */
1417 		strip = 131072;
1418 		len = sizeof(*striparg);
1419 		striparg = gctl_get_param(req, "strip", &len);
1420 		if (striparg != NULL && len == sizeof(*striparg) &&
1421 		    *striparg > 0) {
1422 			if (*striparg < sectorsize) {
1423 				gctl_error(req, "Strip size too small.");
1424 				return (-10);
1425 			}
1426 			if (*striparg % sectorsize != 0) {
1427 				gctl_error(req, "Incorrect strip size.");
1428 				return (-11);
1429 			}
1430 			strip = *striparg;
1431 		}
1432 
1433 		/* Round size down to strip or sector. */
1434 		if (level == G_RAID_VOLUME_RL_RAID1 ||
1435 		    level == G_RAID_VOLUME_RL_SINGLE ||
1436 		    level == G_RAID_VOLUME_RL_CONCAT)
1437 			size -= (size % sectorsize);
1438 		else if (level == G_RAID_VOLUME_RL_RAID1E &&
1439 		    (numdisks & 1) != 0)
1440 			size -= (size % (2 * strip));
1441 		else
1442 			size -= (size % strip);
1443 		if (size <= 0) {
1444 			gctl_error(req, "Size too small.");
1445 			return (-13);
1446 		}
1447 
1448 		/* We have all we need, create things: volume, ... */
1449 		pv = malloc(sizeof(*pv), M_MD_PROMISE, M_WAITOK | M_ZERO);
1450 		arc4rand(&pv->pv_id, sizeof(pv->pv_id), 0);
1451 		pv->pv_generation = 0;
1452 		pv->pv_started = 1;
1453 		vol = g_raid_create_volume(sc, volname, -1);
1454 		vol->v_md_data = pv;
1455 		vol->v_raid_level = level;
1456 		vol->v_raid_level_qualifier = qual;
1457 		vol->v_strip_size = strip;
1458 		vol->v_disks_count = numdisks;
1459 		if (level == G_RAID_VOLUME_RL_RAID0 ||
1460 		    level == G_RAID_VOLUME_RL_CONCAT ||
1461 		    level == G_RAID_VOLUME_RL_SINGLE)
1462 			vol->v_mediasize = size * numdisks;
1463 		else if (level == G_RAID_VOLUME_RL_RAID1)
1464 			vol->v_mediasize = size;
1465 		else if (level == G_RAID_VOLUME_RL_RAID3 ||
1466 		    level == G_RAID_VOLUME_RL_RAID5)
1467 			vol->v_mediasize = size * (numdisks - 1);
1468 		else { /* RAID1E */
1469 			vol->v_mediasize = ((size * numdisks) / strip / 2) *
1470 			    strip;
1471 		}
1472 		vol->v_sectorsize = sectorsize;
1473 		g_raid_start_volume(vol);
1474 
1475 		/* , and subdisks. */
1476 		for (i = 0; i < numdisks; i++) {
1477 			disk = disks[i];
1478 			sd = &vol->v_subdisks[i];
1479 			sd->sd_disk = disk;
1480 			sd->sd_offset = (off_t)offs[i] * 512;
1481 			sd->sd_size = size;
1482 			if (disk == NULL)
1483 				continue;
1484 			TAILQ_INSERT_TAIL(&disk->d_subdisks, sd, sd_next);
1485 			g_raid_change_disk_state(disk,
1486 			    G_RAID_DISK_S_ACTIVE);
1487 			g_raid_change_subdisk_state(sd,
1488 			    G_RAID_SUBDISK_S_ACTIVE);
1489 			g_raid_event_send(sd, G_RAID_SUBDISK_E_NEW,
1490 			    G_RAID_EVENT_SUBDISK);
1491 		}
1492 
1493 		/* Write metadata based on created entities. */
1494 		G_RAID_DEBUG1(0, sc, "Array started.");
1495 		g_raid_md_write_promise(md, vol, NULL, NULL);
1496 
1497 		/* Pickup any STALE/SPARE disks to refill array if needed. */
1498 		g_raid_md_promise_refill(sc);
1499 
1500 		g_raid_event_send(vol, G_RAID_VOLUME_E_START,
1501 		    G_RAID_EVENT_VOLUME);
1502 		return (0);
1503 	}
1504 	if (strcmp(verb, "add") == 0) {
1505 		gctl_error(req, "`add` command is not applicable, "
1506 		    "use `label` instead.");
1507 		return (-99);
1508 	}
1509 	if (strcmp(verb, "delete") == 0) {
1510 		nodename = gctl_get_asciiparam(req, "arg0");
1511 		if (nodename != NULL && strcasecmp(sc->sc_name, nodename) != 0)
1512 			nodename = NULL;
1513 
1514 		/* Full node destruction. */
1515 		if (*nargs == 1 && nodename != NULL) {
1516 			/* Check if some volume is still open. */
1517 			force = gctl_get_paraml(req, "force", sizeof(*force));
1518 			if (force != NULL && *force == 0 &&
1519 			    g_raid_nopens(sc) != 0) {
1520 				gctl_error(req, "Some volume is still open.");
1521 				return (-4);
1522 			}
1523 
1524 			TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1525 				if (disk->d_consumer)
1526 					promise_meta_erase(disk->d_consumer);
1527 			}
1528 			g_raid_destroy_node(sc, 0);
1529 			return (0);
1530 		}
1531 
1532 		/* Destroy specified volume. If it was last - all node. */
1533 		if (*nargs > 2) {
1534 			gctl_error(req, "Invalid number of arguments.");
1535 			return (-1);
1536 		}
1537 		volname = gctl_get_asciiparam(req,
1538 		    nodename != NULL ? "arg1" : "arg0");
1539 		if (volname == NULL) {
1540 			gctl_error(req, "No volume name.");
1541 			return (-2);
1542 		}
1543 
1544 		/* Search for volume. */
1545 		TAILQ_FOREACH(vol, &sc->sc_volumes, v_next) {
1546 			if (strcmp(vol->v_name, volname) == 0)
1547 				break;
1548 			pp = vol->v_provider;
1549 			if (pp == NULL)
1550 				continue;
1551 			if (strcmp(pp->name, volname) == 0)
1552 				break;
1553 			if (strncmp(pp->name, "raid/", 5) == 0 &&
1554 			    strcmp(pp->name + 5, volname) == 0)
1555 				break;
1556 		}
1557 		if (vol == NULL) {
1558 			i = strtol(volname, &tmp, 10);
1559 			if (verb != volname && tmp[0] == 0) {
1560 				TAILQ_FOREACH(vol, &sc->sc_volumes, v_next) {
1561 					if (vol->v_global_id == i)
1562 						break;
1563 				}
1564 			}
1565 		}
1566 		if (vol == NULL) {
1567 			gctl_error(req, "Volume '%s' not found.", volname);
1568 			return (-3);
1569 		}
1570 
1571 		/* Check if volume is still open. */
1572 		force = gctl_get_paraml(req, "force", sizeof(*force));
1573 		if (force != NULL && *force == 0 &&
1574 		    vol->v_provider_open != 0) {
1575 			gctl_error(req, "Volume is still open.");
1576 			return (-4);
1577 		}
1578 
1579 		/* Destroy volume and potentially node. */
1580 		i = 0;
1581 		TAILQ_FOREACH(vol1, &sc->sc_volumes, v_next)
1582 			i++;
1583 		if (i >= 2) {
1584 			g_raid_destroy_volume(vol);
1585 			g_raid_md_promise_purge_disks(sc);
1586 			g_raid_md_write_promise(md, NULL, NULL, NULL);
1587 		} else {
1588 			TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1589 				if (disk->d_consumer)
1590 					promise_meta_erase(disk->d_consumer);
1591 			}
1592 			g_raid_destroy_node(sc, 0);
1593 		}
1594 		return (0);
1595 	}
1596 	if (strcmp(verb, "remove") == 0 ||
1597 	    strcmp(verb, "fail") == 0) {
1598 		if (*nargs < 2) {
1599 			gctl_error(req, "Invalid number of arguments.");
1600 			return (-1);
1601 		}
1602 		for (i = 1; i < *nargs; i++) {
1603 			snprintf(arg, sizeof(arg), "arg%d", i);
1604 			diskname = gctl_get_asciiparam(req, arg);
1605 			if (diskname == NULL) {
1606 				gctl_error(req, "No disk name (%s).", arg);
1607 				error = -2;
1608 				break;
1609 			}
1610 			if (strncmp(diskname, _PATH_DEV, 5) == 0)
1611 				diskname += 5;
1612 
1613 			TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1614 				if (disk->d_consumer != NULL &&
1615 				    disk->d_consumer->provider != NULL &&
1616 				    strcmp(disk->d_consumer->provider->name,
1617 				     diskname) == 0)
1618 					break;
1619 			}
1620 			if (disk == NULL) {
1621 				gctl_error(req, "Disk '%s' not found.",
1622 				    diskname);
1623 				error = -3;
1624 				break;
1625 			}
1626 
1627 			if (strcmp(verb, "fail") == 0) {
1628 				g_raid_md_fail_disk_promise(md, NULL, disk);
1629 				continue;
1630 			}
1631 
1632 			/* Erase metadata on deleting disk and destroy it. */
1633 			promise_meta_erase(disk->d_consumer);
1634 			g_raid_destroy_disk(disk);
1635 		}
1636 		g_raid_md_promise_purge_volumes(sc);
1637 
1638 		/* Write updated metadata to remaining disks. */
1639 		g_raid_md_write_promise(md, NULL, NULL, NULL);
1640 
1641 		/* Check if anything left. */
1642 		if (g_raid_ndisks(sc, -1) == 0)
1643 			g_raid_destroy_node(sc, 0);
1644 		else
1645 			g_raid_md_promise_refill(sc);
1646 		return (error);
1647 	}
1648 	if (strcmp(verb, "insert") == 0) {
1649 		if (*nargs < 2) {
1650 			gctl_error(req, "Invalid number of arguments.");
1651 			return (-1);
1652 		}
1653 		for (i = 1; i < *nargs; i++) {
1654 			/* Get disk name. */
1655 			snprintf(arg, sizeof(arg), "arg%d", i);
1656 			diskname = gctl_get_asciiparam(req, arg);
1657 			if (diskname == NULL) {
1658 				gctl_error(req, "No disk name (%s).", arg);
1659 				error = -3;
1660 				break;
1661 			}
1662 
1663 			/* Try to find provider with specified name. */
1664 			g_topology_lock();
1665 			cp = g_raid_open_consumer(sc, diskname);
1666 			if (cp == NULL) {
1667 				gctl_error(req, "Can't open disk '%s'.",
1668 				    diskname);
1669 				g_topology_unlock();
1670 				error = -4;
1671 				break;
1672 			}
1673 			pp = cp->provider;
1674 			g_topology_unlock();
1675 
1676 			pd = malloc(sizeof(*pd), M_MD_PROMISE, M_WAITOK | M_ZERO);
1677 
1678 			disk = g_raid_create_disk(sc);
1679 			disk->d_consumer = cp;
1680 			disk->d_md_data = (void *)pd;
1681 			cp->private = disk;
1682 
1683 			g_raid_get_disk_info(disk);
1684 
1685 			/* Welcome the "new" disk. */
1686 			g_raid_change_disk_state(disk, G_RAID_DISK_S_SPARE);
1687 			promise_meta_write_spare(cp);
1688 			g_raid_md_promise_refill(sc);
1689 		}
1690 		return (error);
1691 	}
1692 	return (-100);
1693 }
1694 
1695 static int
1696 g_raid_md_write_promise(struct g_raid_md_object *md, struct g_raid_volume *tvol,
1697     struct g_raid_subdisk *tsd, struct g_raid_disk *tdisk)
1698 {
1699 	struct g_raid_softc *sc;
1700 	struct g_raid_volume *vol;
1701 	struct g_raid_subdisk *sd;
1702 	struct g_raid_disk *disk;
1703 	struct g_raid_md_promise_perdisk *pd;
1704 	struct g_raid_md_promise_pervolume *pv;
1705 	struct promise_raid_conf *meta;
1706 	off_t rebuild_lba64;
1707 	int i, j, pos, rebuild;
1708 
1709 	sc = md->mdo_softc;
1710 
1711 	if (sc->sc_stopping == G_RAID_DESTROY_HARD)
1712 		return (0);
1713 
1714 	/* Generate new per-volume metadata for affected volumes. */
1715 	TAILQ_FOREACH(vol, &sc->sc_volumes, v_next) {
1716 		if (vol->v_stopping)
1717 			continue;
1718 
1719 		/* Skip volumes not related to specified targets. */
1720 		if (tvol != NULL && vol != tvol)
1721 			continue;
1722 		if (tsd != NULL && vol != tsd->sd_volume)
1723 			continue;
1724 		if (tdisk != NULL) {
1725 			for (i = 0; i < vol->v_disks_count; i++) {
1726 				if (vol->v_subdisks[i].sd_disk == tdisk)
1727 					break;
1728 			}
1729 			if (i >= vol->v_disks_count)
1730 				continue;
1731 		}
1732 
1733 		pv = (struct g_raid_md_promise_pervolume *)vol->v_md_data;
1734 		pv->pv_generation++;
1735 
1736 		meta = malloc(sizeof(*meta), M_MD_PROMISE, M_WAITOK | M_ZERO);
1737 		if (pv->pv_meta != NULL)
1738 			memcpy(meta, pv->pv_meta, sizeof(*meta));
1739 		memcpy(meta->promise_id, PROMISE_MAGIC,
1740 		    sizeof(PROMISE_MAGIC) - 1);
1741 		meta->dummy_0 = 0x00020000;
1742 		meta->integrity = PROMISE_I_VALID;
1743 
1744 		meta->generation = pv->pv_generation;
1745 		meta->status = PROMISE_S_VALID | PROMISE_S_ONLINE |
1746 		    PROMISE_S_INITED | PROMISE_S_READY;
1747 		if (vol->v_state <= G_RAID_VOLUME_S_DEGRADED)
1748 			meta->status |= PROMISE_S_DEGRADED;
1749 		if (vol->v_dirty)
1750 			meta->status |= PROMISE_S_MARKED; /* XXX: INVENTED! */
1751 		if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID0 ||
1752 		    vol->v_raid_level == G_RAID_VOLUME_RL_SINGLE)
1753 			meta->type = PROMISE_T_RAID0;
1754 		else if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID1 ||
1755 		    vol->v_raid_level == G_RAID_VOLUME_RL_RAID1E)
1756 			meta->type = PROMISE_T_RAID1;
1757 		else if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID3)
1758 			meta->type = PROMISE_T_RAID3;
1759 		else if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID5)
1760 			meta->type = PROMISE_T_RAID5;
1761 		else if (vol->v_raid_level == G_RAID_VOLUME_RL_CONCAT)
1762 			meta->type = PROMISE_T_SPAN;
1763 		else
1764 			meta->type = PROMISE_T_JBOD;
1765 		meta->total_disks = vol->v_disks_count;
1766 		meta->stripe_shift = ffs(vol->v_strip_size / 1024);
1767 		meta->array_width = vol->v_disks_count;
1768 		if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID1 ||
1769 		    vol->v_raid_level == G_RAID_VOLUME_RL_RAID1E)
1770 			meta->array_width /= 2;
1771 		meta->array_number = vol->v_global_id;
1772 		meta->total_sectors = vol->v_mediasize / 512;
1773 		meta->total_sectors_high = (vol->v_mediasize / 512) >> 32;
1774 		meta->sector_size = vol->v_sectorsize / 512;
1775 		meta->cylinders = meta->total_sectors / (255 * 63) - 1;
1776 		meta->heads = 254;
1777 		meta->sectors = 63;
1778 		meta->volume_id = pv->pv_id;
1779 		rebuild_lba64 = UINT64_MAX;
1780 		rebuild = 0;
1781 		for (i = 0; i < vol->v_disks_count; i++) {
1782 			sd = &vol->v_subdisks[i];
1783 			/* For RAID0+1 we need to translate order. */
1784 			pos = promise_meta_translate_disk(vol, i);
1785 			meta->disks[pos].flags = PROMISE_F_VALID |
1786 			    PROMISE_F_ASSIGNED;
1787 			if (sd->sd_state == G_RAID_SUBDISK_S_NONE) {
1788 				meta->disks[pos].flags |= 0;
1789 			} else if (sd->sd_state == G_RAID_SUBDISK_S_FAILED) {
1790 				meta->disks[pos].flags |=
1791 				    PROMISE_F_DOWN | PROMISE_F_REDIR;
1792 			} else if (sd->sd_state <= G_RAID_SUBDISK_S_REBUILD) {
1793 				meta->disks[pos].flags |=
1794 				    PROMISE_F_ONLINE | PROMISE_F_REDIR;
1795 				if (sd->sd_state == G_RAID_SUBDISK_S_REBUILD) {
1796 					rebuild_lba64 = MIN(rebuild_lba64,
1797 					    sd->sd_rebuild_pos / 512);
1798 				} else
1799 					rebuild_lba64 = 0;
1800 				rebuild = 1;
1801 			} else {
1802 				meta->disks[pos].flags |= PROMISE_F_ONLINE;
1803 				if (sd->sd_state < G_RAID_SUBDISK_S_ACTIVE) {
1804 					meta->status |= PROMISE_S_MARKED;
1805 					if (sd->sd_state == G_RAID_SUBDISK_S_RESYNC) {
1806 						rebuild_lba64 = MIN(rebuild_lba64,
1807 						    sd->sd_rebuild_pos / 512);
1808 					} else
1809 						rebuild_lba64 = 0;
1810 				}
1811 			}
1812 			if (pv->pv_meta != NULL) {
1813 				meta->disks[pos].id = pv->pv_meta->disks[pos].id;
1814 			} else {
1815 				meta->disks[pos].number = i * 2;
1816 				arc4rand(&meta->disks[pos].id,
1817 				    sizeof(meta->disks[pos].id), 0);
1818 			}
1819 		}
1820 		promise_meta_put_name(meta, vol->v_name);
1821 
1822 		/* Try to mimic AMD BIOS rebuild/resync behavior. */
1823 		if (rebuild_lba64 != UINT64_MAX) {
1824 			if (rebuild)
1825 				meta->magic_3 = 0x03040010UL; /* Rebuild? */
1826 			else
1827 				meta->magic_3 = 0x03040008UL; /* Resync? */
1828 			/* Translate from per-disk to per-volume LBA. */
1829 			if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID1 ||
1830 			    vol->v_raid_level == G_RAID_VOLUME_RL_RAID1E) {
1831 				rebuild_lba64 *= meta->array_width;
1832 			} else if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID3 ||
1833 			    vol->v_raid_level == G_RAID_VOLUME_RL_RAID5) {
1834 				rebuild_lba64 *= meta->array_width - 1;
1835 			} else
1836 				rebuild_lba64 = 0;
1837 		} else
1838 			meta->magic_3 = 0x03000000UL;
1839 		meta->rebuild_lba64 = rebuild_lba64;
1840 		meta->magic_4 = 0x04010101UL;
1841 
1842 		/* Replace per-volume metadata with new. */
1843 		if (pv->pv_meta != NULL)
1844 			free(pv->pv_meta, M_MD_PROMISE);
1845 		pv->pv_meta = meta;
1846 
1847 		/* Copy new metadata to the disks, adding or replacing old. */
1848 		for (i = 0; i < vol->v_disks_count; i++) {
1849 			sd = &vol->v_subdisks[i];
1850 			disk = sd->sd_disk;
1851 			if (disk == NULL)
1852 				continue;
1853 			/* For RAID0+1 we need to translate order. */
1854 			pos = promise_meta_translate_disk(vol, i);
1855 			pd = (struct g_raid_md_promise_perdisk *)disk->d_md_data;
1856 			for (j = 0; j < pd->pd_subdisks; j++) {
1857 				if (pd->pd_meta[j]->volume_id == meta->volume_id)
1858 					break;
1859 			}
1860 			if (j == pd->pd_subdisks)
1861 				pd->pd_subdisks++;
1862 			if (pd->pd_meta[j] != NULL)
1863 				free(pd->pd_meta[j], M_MD_PROMISE);
1864 			pd->pd_meta[j] = promise_meta_copy(meta);
1865 			pd->pd_meta[j]->disk = meta->disks[pos];
1866 			pd->pd_meta[j]->disk.number = pos;
1867 			pd->pd_meta[j]->disk_offset_high =
1868 			    (sd->sd_offset / 512) >> 32;
1869 			pd->pd_meta[j]->disk_offset = sd->sd_offset / 512;
1870 			pd->pd_meta[j]->disk_sectors_high =
1871 			    (sd->sd_size / 512) >> 32;
1872 			pd->pd_meta[j]->disk_sectors = sd->sd_size / 512;
1873 			if (sd->sd_state == G_RAID_SUBDISK_S_REBUILD) {
1874 				pd->pd_meta[j]->disk_rebuild_high =
1875 				    (sd->sd_rebuild_pos / 512) >> 32;
1876 				pd->pd_meta[j]->disk_rebuild =
1877 				    sd->sd_rebuild_pos / 512;
1878 			} else if (sd->sd_state < G_RAID_SUBDISK_S_REBUILD) {
1879 				pd->pd_meta[j]->disk_rebuild_high = 0;
1880 				pd->pd_meta[j]->disk_rebuild = 0;
1881 			} else {
1882 				pd->pd_meta[j]->disk_rebuild_high = UINT32_MAX;
1883 				pd->pd_meta[j]->disk_rebuild = UINT32_MAX;
1884 			}
1885 			pd->pd_updated = 1;
1886 		}
1887 	}
1888 
1889 	TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1890 		pd = (struct g_raid_md_promise_perdisk *)disk->d_md_data;
1891 		if (disk->d_state != G_RAID_DISK_S_ACTIVE)
1892 			continue;
1893 		if (!pd->pd_updated)
1894 			continue;
1895 		G_RAID_DEBUG(1, "Writing Promise metadata to %s",
1896 		    g_raid_get_diskname(disk));
1897 		for (i = 0; i < pd->pd_subdisks; i++)
1898 			g_raid_md_promise_print(pd->pd_meta[i]);
1899 		promise_meta_write(disk->d_consumer,
1900 		    pd->pd_meta, pd->pd_subdisks);
1901 		pd->pd_updated = 0;
1902 	}
1903 
1904 	return (0);
1905 }
1906 
1907 static int
1908 g_raid_md_fail_disk_promise(struct g_raid_md_object *md,
1909     struct g_raid_subdisk *tsd, struct g_raid_disk *tdisk)
1910 {
1911 	struct g_raid_softc *sc;
1912 	struct g_raid_md_promise_perdisk *pd;
1913 	struct g_raid_subdisk *sd;
1914 	int i, pos;
1915 
1916 	sc = md->mdo_softc;
1917 	pd = (struct g_raid_md_promise_perdisk *)tdisk->d_md_data;
1918 
1919 	/* We can't fail disk that is not a part of array now. */
1920 	if (tdisk->d_state != G_RAID_DISK_S_ACTIVE)
1921 		return (-1);
1922 
1923 	/*
1924 	 * Mark disk as failed in metadata and try to write that metadata
1925 	 * to the disk itself to prevent it's later resurrection as STALE.
1926 	 */
1927 	if (pd->pd_subdisks > 0 && tdisk->d_consumer != NULL)
1928 		G_RAID_DEBUG(1, "Writing Promise metadata to %s",
1929 		    g_raid_get_diskname(tdisk));
1930 	for (i = 0; i < pd->pd_subdisks; i++) {
1931 		pd->pd_meta[i]->disk.flags |=
1932 		    PROMISE_F_DOWN | PROMISE_F_REDIR;
1933 		pos = pd->pd_meta[i]->disk.number;
1934 		if (pos >= 0 && pos < PROMISE_MAX_DISKS) {
1935 			pd->pd_meta[i]->disks[pos].flags |=
1936 			    PROMISE_F_DOWN | PROMISE_F_REDIR;
1937 		}
1938 		g_raid_md_promise_print(pd->pd_meta[i]);
1939 	}
1940 	if (tdisk->d_consumer != NULL)
1941 		promise_meta_write(tdisk->d_consumer,
1942 		    pd->pd_meta, pd->pd_subdisks);
1943 
1944 	/* Change states. */
1945 	g_raid_change_disk_state(tdisk, G_RAID_DISK_S_FAILED);
1946 	TAILQ_FOREACH(sd, &tdisk->d_subdisks, sd_next) {
1947 		g_raid_change_subdisk_state(sd,
1948 		    G_RAID_SUBDISK_S_FAILED);
1949 		g_raid_event_send(sd, G_RAID_SUBDISK_E_FAILED,
1950 		    G_RAID_EVENT_SUBDISK);
1951 	}
1952 
1953 	/* Write updated metadata to remaining disks. */
1954 	g_raid_md_write_promise(md, NULL, NULL, tdisk);
1955 
1956 	g_raid_md_promise_refill(sc);
1957 	return (0);
1958 }
1959 
1960 static int
1961 g_raid_md_free_disk_promise(struct g_raid_md_object *md,
1962     struct g_raid_disk *disk)
1963 {
1964 	struct g_raid_md_promise_perdisk *pd;
1965 	int i;
1966 
1967 	pd = (struct g_raid_md_promise_perdisk *)disk->d_md_data;
1968 	for (i = 0; i < pd->pd_subdisks; i++) {
1969 		if (pd->pd_meta[i] != NULL) {
1970 			free(pd->pd_meta[i], M_MD_PROMISE);
1971 			pd->pd_meta[i] = NULL;
1972 		}
1973 	}
1974 	free(pd, M_MD_PROMISE);
1975 	disk->d_md_data = NULL;
1976 	return (0);
1977 }
1978 
1979 static int
1980 g_raid_md_free_volume_promise(struct g_raid_md_object *md,
1981     struct g_raid_volume *vol)
1982 {
1983 	struct g_raid_md_promise_pervolume *pv;
1984 
1985 	pv = (struct g_raid_md_promise_pervolume *)vol->v_md_data;
1986 	if (pv && pv->pv_meta != NULL) {
1987 		free(pv->pv_meta, M_MD_PROMISE);
1988 		pv->pv_meta = NULL;
1989 	}
1990 	if (pv && !pv->pv_started) {
1991 		pv->pv_started = 1;
1992 		callout_stop(&pv->pv_start_co);
1993 	}
1994 	free(pv, M_MD_PROMISE);
1995 	vol->v_md_data = NULL;
1996 	return (0);
1997 }
1998 
1999 static int
2000 g_raid_md_free_promise(struct g_raid_md_object *md)
2001 {
2002 
2003 	return (0);
2004 }
2005 
2006 G_RAID_MD_DECLARE(promise, "Promise");
2007