md_jmicron.c revision 220209
1/*-
2 * Copyright (c) 2010 Alexander Motin <mav@FreeBSD.org>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 *    notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 *    notice, this list of conditions and the following disclaimer in the
12 *    documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27#include <sys/cdefs.h>
28__FBSDID("$FreeBSD: head/sys/geom/raid/md_jmicron.c 220209 2011-03-31 16:14:35Z mav $");
29
30#include <sys/param.h>
31#include <sys/bio.h>
32#include <sys/endian.h>
33#include <sys/kernel.h>
34#include <sys/kobj.h>
35#include <sys/limits.h>
36#include <sys/lock.h>
37#include <sys/malloc.h>
38#include <sys/mutex.h>
39#include <sys/systm.h>
40#include <sys/taskqueue.h>
41#include <geom/geom.h>
42#include "geom/raid/g_raid.h"
43#include "g_raid_md_if.h"
44
45static MALLOC_DEFINE(M_MD_JMICRON, "md_jmicron_data", "GEOM_RAID JMicron metadata");
46
47#define	JMICRON_MAX_DISKS	8
48#define	JMICRON_MAX_SPARE	2
49
50struct jmicron_raid_conf {
51    u_int8_t		signature[2];
52#define	JMICRON_MAGIC		"JM"
53
54    u_int16_t		version;
55#define	JMICRON_VERSION		0x0001
56
57    u_int16_t		checksum;
58    u_int8_t		filler_1[10];
59    u_int32_t		disk_id;
60    u_int32_t		offset;
61    u_int32_t		disk_sectors_high;
62    u_int16_t		disk_sectors_low;
63    u_int8_t		filler_2[2];
64    u_int8_t		name[16];
65    u_int8_t		type;
66#define	JMICRON_T_RAID0		0
67#define	JMICRON_T_RAID1		1
68#define	JMICRON_T_RAID01	2
69#define	JMICRON_T_CONCAT	3
70#define	JMICRON_T_RAID5		5
71
72    u_int8_t		stripe_shift;
73    u_int16_t		flags;
74#define	JMICRON_F_READY		0x0001
75#define	JMICRON_F_BOOTABLE	0x0002
76#define	JMICRON_F_BADSEC	0x0004
77#define	JMICRON_F_ACTIVE	0x0010
78#define	JMICRON_F_UNSYNC	0x0020
79#define	JMICRON_F_NEWEST	0x0040
80
81    u_int8_t		filler_3[4];
82    u_int32_t		spare[JMICRON_MAX_SPARE];
83    u_int32_t		disks[JMICRON_MAX_DISKS];
84#define	JMICRON_DISK_MASK	0xFFFFFFF0
85#define	JMICRON_SEG_MASK	0x0000000F
86    u_int8_t		filler_4[32];
87    u_int8_t		filler_5[384];
88};
89
90struct g_raid_md_jmicron_perdisk {
91	struct jmicron_raid_conf	*pd_meta;
92	int				 pd_disk_pos;
93	int				 pd_disk_id;
94	off_t				 pd_disk_size;
95};
96
97struct g_raid_md_jmicron_object {
98	struct g_raid_md_object	 mdio_base;
99	uint32_t		 mdio_config_id;
100	struct jmicron_raid_conf	*mdio_meta;
101	struct callout		 mdio_start_co;	/* STARTING state timer. */
102	int			 mdio_total_disks;
103	int			 mdio_disks_present;
104	int			 mdio_started;
105	int			 mdio_incomplete;
106	struct root_hold_token	*mdio_rootmount; /* Root mount delay token. */
107};
108
109static g_raid_md_create_t g_raid_md_create_jmicron;
110static g_raid_md_taste_t g_raid_md_taste_jmicron;
111static g_raid_md_event_t g_raid_md_event_jmicron;
112static g_raid_md_ctl_t g_raid_md_ctl_jmicron;
113static g_raid_md_write_t g_raid_md_write_jmicron;
114static g_raid_md_fail_disk_t g_raid_md_fail_disk_jmicron;
115static g_raid_md_free_disk_t g_raid_md_free_disk_jmicron;
116static g_raid_md_free_t g_raid_md_free_jmicron;
117
118static kobj_method_t g_raid_md_jmicron_methods[] = {
119	KOBJMETHOD(g_raid_md_create,	g_raid_md_create_jmicron),
120	KOBJMETHOD(g_raid_md_taste,	g_raid_md_taste_jmicron),
121	KOBJMETHOD(g_raid_md_event,	g_raid_md_event_jmicron),
122	KOBJMETHOD(g_raid_md_ctl,	g_raid_md_ctl_jmicron),
123	KOBJMETHOD(g_raid_md_write,	g_raid_md_write_jmicron),
124	KOBJMETHOD(g_raid_md_fail_disk,	g_raid_md_fail_disk_jmicron),
125	KOBJMETHOD(g_raid_md_free_disk,	g_raid_md_free_disk_jmicron),
126	KOBJMETHOD(g_raid_md_free,	g_raid_md_free_jmicron),
127	{ 0, 0 }
128};
129
130static struct g_raid_md_class g_raid_md_jmicron_class = {
131	"JMicron",
132	g_raid_md_jmicron_methods,
133	sizeof(struct g_raid_md_jmicron_object),
134	.mdc_priority = 100
135};
136
137static void
138g_raid_md_jmicron_print(struct jmicron_raid_conf *meta)
139{
140	int k;
141
142	if (g_raid_debug < 1)
143		return;
144
145	printf("********* ATA JMicron RAID Metadata *********\n");
146	printf("signature           <%c%c>\n", meta->signature[0], meta->signature[1]);
147	printf("version             %04x\n", meta->version);
148	printf("checksum            0x%04x\n", meta->checksum);
149	printf("disk_id             0x%08x\n", meta->disk_id);
150	printf("offset              0x%08x\n", meta->offset);
151	printf("disk_sectors_high   0x%08x\n", meta->disk_sectors_high);
152	printf("disk_sectors_low    0x%04x\n", meta->disk_sectors_low);
153	printf("name                <%.16s>\n", meta->name);
154	printf("type                %d\n", meta->type);
155	printf("stripe_shift        %d\n", meta->stripe_shift);
156	printf("flags               %04x\n", meta->flags);
157	printf("spare              ");
158	for (k = 0; k < JMICRON_MAX_SPARE; k++)
159		printf(" 0x%08x", meta->spare[k]);
160	printf("\n");
161	printf("disks              ");
162	for (k = 0; k < JMICRON_MAX_DISKS; k++)
163		printf(" 0x%08x", meta->disks[k]);
164	printf("\n");
165	printf("=================================================\n");
166}
167
168static struct jmicron_raid_conf *
169jmicron_meta_copy(struct jmicron_raid_conf *meta)
170{
171	struct jmicron_raid_conf *nmeta;
172
173	nmeta = malloc(sizeof(*meta), M_MD_JMICRON, M_WAITOK);
174	memcpy(nmeta, meta, sizeof(*meta));
175	return (nmeta);
176}
177
178static int
179jmicron_meta_total_disks(struct jmicron_raid_conf *meta)
180{
181	int pos;
182
183	for (pos = 0; pos < JMICRON_MAX_DISKS; pos++) {
184		if (meta->disks[pos] == 0)
185			break;
186	}
187	return (pos);
188}
189
190static int
191jmicron_meta_total_spare(struct jmicron_raid_conf *meta)
192{
193	int pos, n;
194
195	n = 0;
196	for (pos = 0; pos < JMICRON_MAX_SPARE; pos++) {
197		if (meta->spare[pos] != 0)
198			n++;
199	}
200	return (n);
201}
202
203/*
204 * Generate fake Configuration ID based on disk IDs.
205 * Note: it will change after each disk set change.
206 */
207static uint32_t
208jmicron_meta_config_id(struct jmicron_raid_conf *meta)
209{
210	int pos;
211	uint32_t config_id;
212
213	config_id = 0;
214	for (pos = 0; pos < JMICRON_MAX_DISKS; pos++)
215		config_id += meta->disks[pos] << pos;
216	return (config_id);
217}
218
219static void
220jmicron_meta_get_name(struct jmicron_raid_conf *meta, char *buf)
221{
222	int i;
223
224	strncpy(buf, meta->name, 16);
225	buf[16] = 0;
226	for (i = 15; i >= 0; i--) {
227		if (buf[i] > 0x20)
228			break;
229		buf[i] = 0;
230	}
231}
232
233static void
234jmicron_meta_put_name(struct jmicron_raid_conf *meta, char *buf)
235{
236
237	memset(meta->name, 0x20, 16);
238	memcpy(meta->name, buf, MIN(strlen(buf), 16));
239}
240
241static int
242jmicron_meta_find_disk(struct jmicron_raid_conf *meta, uint32_t id)
243{
244	int pos;
245
246	id &= JMICRON_DISK_MASK;
247	for (pos = 0; pos < JMICRON_MAX_DISKS; pos++) {
248		if ((meta->disks[pos] & JMICRON_DISK_MASK) == id)
249			return (pos);
250	}
251	for (pos = 0; pos < JMICRON_MAX_SPARE; pos++) {
252		if ((meta->spare[pos] & JMICRON_DISK_MASK) == id)
253			return (-3);
254	}
255	return (-1);
256}
257
258static struct jmicron_raid_conf *
259jmicron_meta_read(struct g_consumer *cp)
260{
261	struct g_provider *pp;
262	struct jmicron_raid_conf *meta;
263	char *buf;
264	int error, i;
265	uint16_t checksum, *ptr;
266
267	pp = cp->provider;
268
269	/* Read the anchor sector. */
270	buf = g_read_data(cp,
271	    pp->mediasize - pp->sectorsize, pp->sectorsize, &error);
272	if (buf == NULL) {
273		G_RAID_DEBUG(1, "Cannot read metadata from %s (error=%d).",
274		    pp->name, error);
275		return (NULL);
276	}
277	meta = (struct jmicron_raid_conf *)buf;
278
279	/* Check if this is an JMicron RAID struct */
280	if (strncmp(meta->signature, JMICRON_MAGIC, strlen(JMICRON_MAGIC))) {
281		G_RAID_DEBUG(1, "JMicron signature check failed on %s", pp->name);
282		g_free(buf);
283		return (NULL);
284	}
285	meta = malloc(sizeof(*meta), M_MD_JMICRON, M_WAITOK);
286	memcpy(meta, buf, min(sizeof(*meta), pp->sectorsize));
287	g_free(buf);
288
289	/* Check metadata checksum. */
290	for (checksum = 0, ptr = (uint16_t *)meta, i = 0; i < 64; i++)
291		checksum += *ptr++;
292	if (checksum != 0) {
293		G_RAID_DEBUG(1, "JMicron checksum check failed on %s", pp->name);
294		free(meta, M_MD_JMICRON);
295		return (NULL);
296	}
297
298	return (meta);
299}
300
301static int
302jmicron_meta_write(struct g_consumer *cp, struct jmicron_raid_conf *meta)
303{
304	struct g_provider *pp;
305	char *buf;
306	int error, i;
307	uint16_t checksum, *ptr;
308
309	pp = cp->provider;
310
311	/* Recalculate checksum for case if metadata were changed. */
312	meta->checksum = 0;
313	for (checksum = 0, ptr = (uint16_t *)meta, i = 0; i < 64; i++)
314		checksum += *ptr++;
315	meta->checksum -= checksum;
316
317	/* Create and fill buffer. */
318	buf = malloc(pp->sectorsize, M_MD_JMICRON, M_WAITOK | M_ZERO);
319	memcpy(buf, meta, sizeof(*meta));
320
321	error = g_write_data(cp,
322	    pp->mediasize - pp->sectorsize, buf, pp->sectorsize);
323	if (error != 0) {
324		G_RAID_DEBUG(1, "Cannot write metadata to %s (error=%d).",
325		    pp->name, error);
326	}
327
328	free(buf, M_MD_JMICRON);
329	return (error);
330}
331
332static int
333jmicron_meta_erase(struct g_consumer *cp)
334{
335	struct g_provider *pp;
336	char *buf;
337	int error;
338
339	pp = cp->provider;
340	buf = malloc(pp->sectorsize, M_MD_JMICRON, M_WAITOK | M_ZERO);
341	error = g_write_data(cp,
342	    pp->mediasize - pp->sectorsize, buf, pp->sectorsize);
343	if (error != 0) {
344		G_RAID_DEBUG(1, "Cannot erase metadata on %s (error=%d).",
345		    pp->name, error);
346	}
347	free(buf, M_MD_JMICRON);
348	return (error);
349}
350
351static struct g_raid_disk *
352g_raid_md_jmicron_get_disk(struct g_raid_softc *sc, int id)
353{
354	struct g_raid_disk	*disk;
355	struct g_raid_md_jmicron_perdisk *pd;
356
357	TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
358		pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
359		if (pd->pd_disk_pos == id)
360			break;
361	}
362	return (disk);
363}
364
365static int
366g_raid_md_jmicron_supported(int level, int qual, int disks, int force)
367{
368
369	if (disks > 8)
370		return (0);
371	switch (level) {
372	case G_RAID_VOLUME_RL_RAID0:
373		if (disks < 1)
374			return (0);
375		if (!force && (disks < 2 || disks > 6))
376			return (0);
377		break;
378	case G_RAID_VOLUME_RL_RAID1:
379		if (disks < 1)
380			return (0);
381		if (!force && (disks != 2))
382			return (0);
383		break;
384	case G_RAID_VOLUME_RL_RAID1E:
385		if (disks < 2)
386			return (0);
387		if (!force && (disks != 4))
388			return (0);
389		break;
390	case G_RAID_VOLUME_RL_SINGLE:
391		if (disks != 1)
392			return (0);
393		if (!force)
394			return (0);
395		break;
396	case G_RAID_VOLUME_RL_CONCAT:
397		if (disks < 2)
398			return (0);
399		break;
400	case G_RAID_VOLUME_RL_RAID5:
401		if (disks < 3)
402			return (0);
403		if (!force)
404			return (0);
405		break;
406	default:
407		return (0);
408	}
409	if (qual != G_RAID_VOLUME_RLQ_NONE)
410		return (0);
411	return (1);
412}
413
414static int
415g_raid_md_jmicron_start_disk(struct g_raid_disk *disk)
416{
417	struct g_raid_softc *sc;
418	struct g_raid_subdisk *sd, *tmpsd;
419	struct g_raid_disk *olddisk, *tmpdisk;
420	struct g_raid_md_object *md;
421	struct g_raid_md_jmicron_object *mdi;
422	struct g_raid_md_jmicron_perdisk *pd, *oldpd;
423	struct jmicron_raid_conf *meta;
424	int disk_pos, resurrection = 0;
425
426	sc = disk->d_softc;
427	md = sc->sc_md;
428	mdi = (struct g_raid_md_jmicron_object *)md;
429	meta = mdi->mdio_meta;
430	pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
431	olddisk = NULL;
432
433	/* Find disk position in metadata by it's serial. */
434	if (pd->pd_meta != NULL)
435		disk_pos = jmicron_meta_find_disk(meta, pd->pd_disk_id);
436	else
437		disk_pos = -1;
438	if (disk_pos < 0) {
439		G_RAID_DEBUG1(1, sc, "Unknown, probably new or stale disk");
440		/* If we are in the start process, that's all for now. */
441		if (!mdi->mdio_started)
442			goto nofit;
443		/*
444		 * If we have already started - try to get use of the disk.
445		 * Try to replace OFFLINE disks first, then FAILED.
446		 */
447		TAILQ_FOREACH(tmpdisk, &sc->sc_disks, d_next) {
448			if (tmpdisk->d_state != G_RAID_DISK_S_OFFLINE &&
449			    tmpdisk->d_state != G_RAID_DISK_S_FAILED)
450				continue;
451			/* Make sure this disk is big enough. */
452			TAILQ_FOREACH(sd, &tmpdisk->d_subdisks, sd_next) {
453				if (sd->sd_offset + sd->sd_size + 512 >
454				    pd->pd_disk_size) {
455					G_RAID_DEBUG1(1, sc,
456					    "Disk too small (%ju < %ju)",
457					    pd->pd_disk_size,
458					    sd->sd_offset + sd->sd_size + 512);
459					break;
460				}
461			}
462			if (sd != NULL)
463				continue;
464			if (tmpdisk->d_state == G_RAID_DISK_S_OFFLINE) {
465				olddisk = tmpdisk;
466				break;
467			} else if (olddisk == NULL)
468				olddisk = tmpdisk;
469		}
470		if (olddisk == NULL) {
471nofit:
472			if (disk_pos == -3 || pd->pd_disk_pos == -3) {
473				g_raid_change_disk_state(disk,
474				    G_RAID_DISK_S_SPARE);
475				return (1);
476			} else {
477				g_raid_change_disk_state(disk,
478				    G_RAID_DISK_S_STALE);
479				return (0);
480			}
481		}
482		oldpd = (struct g_raid_md_jmicron_perdisk *)olddisk->d_md_data;
483		disk_pos = oldpd->pd_disk_pos;
484		resurrection = 1;
485	}
486
487	if (olddisk == NULL) {
488		/* Find placeholder by position. */
489		olddisk = g_raid_md_jmicron_get_disk(sc, disk_pos);
490		if (olddisk == NULL)
491			panic("No disk at position %d!", disk_pos);
492		if (olddisk->d_state != G_RAID_DISK_S_OFFLINE) {
493			G_RAID_DEBUG1(1, sc, "More then one disk for pos %d",
494			    disk_pos);
495			g_raid_change_disk_state(disk, G_RAID_DISK_S_STALE);
496			return (0);
497		}
498		oldpd = (struct g_raid_md_jmicron_perdisk *)olddisk->d_md_data;
499	}
500
501	/* Replace failed disk or placeholder with new disk. */
502	TAILQ_FOREACH_SAFE(sd, &olddisk->d_subdisks, sd_next, tmpsd) {
503		TAILQ_REMOVE(&olddisk->d_subdisks, sd, sd_next);
504		TAILQ_INSERT_TAIL(&disk->d_subdisks, sd, sd_next);
505		sd->sd_disk = disk;
506	}
507	oldpd->pd_disk_pos = -2;
508	pd->pd_disk_pos = disk_pos;
509	/* Update global metadata just in case. */
510	meta->disks[disk_pos] = pd->pd_disk_id;
511
512	/* If it was placeholder -- destroy it. */
513	if (olddisk->d_state == G_RAID_DISK_S_OFFLINE) {
514		g_raid_destroy_disk(olddisk);
515	} else {
516		/* Otherwise, make it STALE_FAILED. */
517		g_raid_change_disk_state(olddisk, G_RAID_DISK_S_STALE_FAILED);
518	}
519
520	/* Welcome the new disk. */
521	g_raid_change_disk_state(disk, G_RAID_DISK_S_ACTIVE);
522	TAILQ_FOREACH(sd, &disk->d_subdisks, sd_next) {
523
524		/*
525		 * Different disks may have different sizes/offsets,
526		 * especially in concat mode. Update.
527		 */
528		if (!resurrection) {
529			sd->sd_offset =
530			    (off_t)pd->pd_meta->offset * 16 * 512; //ZZZ
531			sd->sd_size =
532			    (((off_t)pd->pd_meta->disk_sectors_high << 16) +
533			      pd->pd_meta->disk_sectors_low) * 512;
534		}
535
536		if (resurrection) {
537			/* Stale disk, almost same as new. */
538			g_raid_change_subdisk_state(sd,
539			    G_RAID_SUBDISK_S_NEW);
540		} else if ((meta->flags & JMICRON_F_BADSEC) != 0 &&
541		    (pd->pd_meta->flags & JMICRON_F_BADSEC) == 0) {
542			/* Cold-inserted or rebuilding disk. */
543			g_raid_change_subdisk_state(sd,
544			    G_RAID_SUBDISK_S_NEW);
545		} else if (pd->pd_meta->flags & JMICRON_F_UNSYNC) {
546			/* Dirty or resyncing disk.. */
547			g_raid_change_subdisk_state(sd,
548			    G_RAID_SUBDISK_S_STALE);
549		} else {
550			/* Up to date disk. */
551			g_raid_change_subdisk_state(sd,
552			    G_RAID_SUBDISK_S_ACTIVE);
553		}
554		g_raid_event_send(sd, G_RAID_SUBDISK_E_NEW,
555		    G_RAID_EVENT_SUBDISK);
556	}
557
558	/* Update status of our need for spare. */
559	if (mdi->mdio_started) {
560		mdi->mdio_incomplete =
561		    (g_raid_ndisks(sc, G_RAID_DISK_S_ACTIVE) <
562		     mdi->mdio_total_disks);
563	}
564
565	return (resurrection);
566}
567
568static void
569g_disk_md_jmicron_retaste(void *arg, int pending)
570{
571
572	G_RAID_DEBUG(1, "Array is not complete, trying to retaste.");
573	g_retaste(&g_raid_class);
574	free(arg, M_MD_JMICRON);
575}
576
577static void
578g_raid_md_jmicron_refill(struct g_raid_softc *sc)
579{
580	struct g_raid_md_object *md;
581	struct g_raid_md_jmicron_object *mdi;
582	struct jmicron_raid_conf *meta;
583	struct g_raid_disk *disk;
584	struct task *task;
585	int update, na;
586
587	md = sc->sc_md;
588	mdi = (struct g_raid_md_jmicron_object *)md;
589	meta = mdi->mdio_meta;
590	update = 0;
591	do {
592		/* Make sure we miss anything. */
593		na = g_raid_ndisks(sc, G_RAID_DISK_S_ACTIVE);
594		if (na == mdi->mdio_total_disks)
595			break;
596
597		G_RAID_DEBUG1(1, md->mdo_softc,
598		    "Array is not complete (%d of %d), "
599		    "trying to refill.", na, mdi->mdio_total_disks);
600
601		/* Try to get use some of STALE disks. */
602		TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
603			if (disk->d_state == G_RAID_DISK_S_STALE) {
604				update += g_raid_md_jmicron_start_disk(disk);
605				if (disk->d_state == G_RAID_DISK_S_ACTIVE)
606					break;
607			}
608		}
609		if (disk != NULL)
610			continue;
611
612		/* Try to get use some of SPARE disks. */
613		TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
614			if (disk->d_state == G_RAID_DISK_S_SPARE) {
615				update += g_raid_md_jmicron_start_disk(disk);
616				if (disk->d_state == G_RAID_DISK_S_ACTIVE)
617					break;
618			}
619		}
620	} while (disk != NULL);
621
622	/* Write new metadata if we changed something. */
623	if (update) {
624		g_raid_md_write_jmicron(md, NULL, NULL, NULL);
625		meta = mdi->mdio_meta;
626	}
627
628	/* Update status of our need for spare. */
629	mdi->mdio_incomplete = (g_raid_ndisks(sc, G_RAID_DISK_S_ACTIVE) <
630	    mdi->mdio_total_disks);
631
632	/* Request retaste hoping to find spare. */
633	if (mdi->mdio_incomplete) {
634		task = malloc(sizeof(struct task),
635		    M_MD_JMICRON, M_WAITOK | M_ZERO);
636		TASK_INIT(task, 0, g_disk_md_jmicron_retaste, task);
637		taskqueue_enqueue(taskqueue_swi, task);
638	}
639}
640
641static void
642g_raid_md_jmicron_start(struct g_raid_softc *sc)
643{
644	struct g_raid_md_object *md;
645	struct g_raid_md_jmicron_object *mdi;
646	struct g_raid_md_jmicron_perdisk *pd;
647	struct jmicron_raid_conf *meta;
648	struct g_raid_volume *vol;
649	struct g_raid_subdisk *sd;
650	struct g_raid_disk *disk;
651	off_t size;
652	int j, disk_pos;
653	char buf[17];
654
655	md = sc->sc_md;
656	mdi = (struct g_raid_md_jmicron_object *)md;
657	meta = mdi->mdio_meta;
658
659	/* Create volumes and subdisks. */
660	jmicron_meta_get_name(meta, buf);
661	vol = g_raid_create_volume(sc, buf, -1);
662	size = ((off_t)meta->disk_sectors_high << 16) + meta->disk_sectors_low;
663	size *= 512; //ZZZ
664	if (meta->type == JMICRON_T_RAID0) {
665		vol->v_raid_level = G_RAID_VOLUME_RL_RAID0;
666		vol->v_mediasize = size * mdi->mdio_total_disks;
667	} else if (meta->type == JMICRON_T_RAID1) {
668		vol->v_raid_level = G_RAID_VOLUME_RL_RAID1;
669		vol->v_mediasize = size;
670	} else if (meta->type == JMICRON_T_RAID01) {
671		vol->v_raid_level = G_RAID_VOLUME_RL_RAID1E;
672		vol->v_mediasize = size * mdi->mdio_total_disks / 2;
673	} else if (meta->type == JMICRON_T_CONCAT) {
674		if (mdi->mdio_total_disks == 1)
675			vol->v_raid_level = G_RAID_VOLUME_RL_SINGLE;
676		else
677			vol->v_raid_level = G_RAID_VOLUME_RL_CONCAT;
678		vol->v_mediasize = 0;
679	} else if (meta->type == JMICRON_T_RAID5) {
680		vol->v_raid_level = G_RAID_VOLUME_RL_RAID5;
681		vol->v_mediasize = size * (mdi->mdio_total_disks - 1);
682	} else {
683		vol->v_raid_level = G_RAID_VOLUME_RL_UNKNOWN;
684		vol->v_mediasize = 0;
685	}
686	vol->v_raid_level_qualifier = G_RAID_VOLUME_RLQ_NONE;
687	vol->v_strip_size = 1024 << meta->stripe_shift; //ZZZ
688	vol->v_disks_count = mdi->mdio_total_disks;
689	vol->v_sectorsize = 512; //ZZZ
690	for (j = 0; j < vol->v_disks_count; j++) {
691		sd = &vol->v_subdisks[j];
692		sd->sd_offset = (off_t)meta->offset * 16 * 512; //ZZZ
693		sd->sd_size = size;
694	}
695	g_raid_start_volume(vol);
696
697	/* Create disk placeholders to store data for later writing. */
698	for (disk_pos = 0; disk_pos < mdi->mdio_total_disks; disk_pos++) {
699		pd = malloc(sizeof(*pd), M_MD_JMICRON, M_WAITOK | M_ZERO);
700		pd->pd_disk_pos = disk_pos;
701		pd->pd_disk_id = meta->disks[disk_pos];
702		disk = g_raid_create_disk(sc);
703		disk->d_md_data = (void *)pd;
704		disk->d_state = G_RAID_DISK_S_OFFLINE;
705		sd = &vol->v_subdisks[disk_pos];
706		sd->sd_disk = disk;
707		TAILQ_INSERT_TAIL(&disk->d_subdisks, sd, sd_next);
708	}
709
710	/* Make all disks found till the moment take their places. */
711	do {
712		TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
713			if (disk->d_state == G_RAID_DISK_S_NONE) {
714				g_raid_md_jmicron_start_disk(disk);
715				break;
716			}
717		}
718	} while (disk != NULL);
719
720	mdi->mdio_started = 1;
721	G_RAID_DEBUG1(0, sc, "Array started.");
722	g_raid_md_write_jmicron(md, NULL, NULL, NULL);
723
724	/* Pickup any STALE/SPARE disks to refill array if needed. */
725	g_raid_md_jmicron_refill(sc);
726
727	g_raid_event_send(vol, G_RAID_VOLUME_E_START, G_RAID_EVENT_VOLUME);
728
729	callout_stop(&mdi->mdio_start_co);
730	G_RAID_DEBUG1(1, sc, "root_mount_rel %p", mdi->mdio_rootmount);
731	root_mount_rel(mdi->mdio_rootmount);
732	mdi->mdio_rootmount = NULL;
733}
734
735static void
736g_raid_md_jmicron_new_disk(struct g_raid_disk *disk)
737{
738	struct g_raid_softc *sc;
739	struct g_raid_md_object *md;
740	struct g_raid_md_jmicron_object *mdi;
741	struct jmicron_raid_conf *pdmeta;
742	struct g_raid_md_jmicron_perdisk *pd;
743
744	sc = disk->d_softc;
745	md = sc->sc_md;
746	mdi = (struct g_raid_md_jmicron_object *)md;
747	pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
748	pdmeta = pd->pd_meta;
749
750	if (mdi->mdio_started) {
751		if (g_raid_md_jmicron_start_disk(disk))
752			g_raid_md_write_jmicron(md, NULL, NULL, NULL);
753	} else {
754		/*
755		 * If we haven't started yet - update common metadata
756		 * to get subdisks details, avoiding data from spare disks.
757		 */
758		if (mdi->mdio_meta == NULL ||
759		    jmicron_meta_find_disk(mdi->mdio_meta,
760		     mdi->mdio_meta->disk_id) == -3) {
761			if (mdi->mdio_meta != NULL)
762				free(mdi->mdio_meta, M_MD_JMICRON);
763			mdi->mdio_meta = jmicron_meta_copy(pdmeta);
764			mdi->mdio_total_disks = jmicron_meta_total_disks(pdmeta);
765		}
766		mdi->mdio_meta->flags |= pdmeta->flags & JMICRON_F_BADSEC;
767
768		mdi->mdio_disks_present++;
769		G_RAID_DEBUG1(1, sc, "Matching disk (%d of %d+%d up)",
770		    mdi->mdio_disks_present,
771		    mdi->mdio_total_disks,
772		    jmicron_meta_total_spare(mdi->mdio_meta));
773
774		/* If we collected all needed disks - start array. */
775		if (mdi->mdio_disks_present == mdi->mdio_total_disks +
776		    jmicron_meta_total_spare(mdi->mdio_meta))
777			g_raid_md_jmicron_start(sc);
778	}
779}
780
781static void
782g_raid_jmicron_go(void *arg)
783{
784	struct g_raid_softc *sc;
785	struct g_raid_md_object *md;
786	struct g_raid_md_jmicron_object *mdi;
787
788	sc = arg;
789	md = sc->sc_md;
790	mdi = (struct g_raid_md_jmicron_object *)md;
791	if (!mdi->mdio_started) {
792		G_RAID_DEBUG1(0, sc, "Force array start due to timeout.");
793		g_raid_event_send(sc, G_RAID_NODE_E_START, 0);
794	}
795}
796
797static int
798g_raid_md_create_jmicron(struct g_raid_md_object *md, struct g_class *mp,
799    struct g_geom **gp)
800{
801	struct g_raid_softc *sc;
802	struct g_raid_md_jmicron_object *mdi;
803	char name[16];
804
805	mdi = (struct g_raid_md_jmicron_object *)md;
806	mdi->mdio_config_id = arc4random();
807	snprintf(name, sizeof(name), "JMicron-%08x", mdi->mdio_config_id);
808	sc = g_raid_create_node(mp, name, md);
809	if (sc == NULL)
810		return (G_RAID_MD_TASTE_FAIL);
811	md->mdo_softc = sc;
812	*gp = sc->sc_geom;
813	return (G_RAID_MD_TASTE_NEW);
814}
815
816static int
817g_raid_md_taste_jmicron(struct g_raid_md_object *md, struct g_class *mp,
818                              struct g_consumer *cp, struct g_geom **gp)
819{
820	struct g_consumer *rcp;
821	struct g_provider *pp;
822	struct g_raid_md_jmicron_object *mdi, *mdi1;
823	struct g_raid_softc *sc;
824	struct g_raid_disk *disk;
825	struct jmicron_raid_conf *meta;
826	struct g_raid_md_jmicron_perdisk *pd;
827	struct g_geom *geom;
828	int error, disk_pos, result, spare, len;
829	char name[16];
830	uint16_t vendor;
831
832	G_RAID_DEBUG(1, "Tasting JMicron on %s", cp->provider->name);
833	mdi = (struct g_raid_md_jmicron_object *)md;
834	pp = cp->provider;
835
836	/* Read metadata from device. */
837	meta = NULL;
838	spare = 0;
839	vendor = 0xffff;
840	disk_pos = 0;
841	if (g_access(cp, 1, 0, 0) != 0)
842		return (G_RAID_MD_TASTE_FAIL);
843	g_topology_unlock();
844	len = 2;
845	if (pp->geom->rank == 1)
846		g_io_getattr("GEOM::hba_vendor", cp, &len, &vendor);
847	meta = jmicron_meta_read(cp);
848	g_topology_lock();
849	g_access(cp, -1, 0, 0);
850	if (meta == NULL) {
851		if (g_raid_aggressive_spare) {
852			if (vendor == 0x197b) {
853				G_RAID_DEBUG(1,
854				    "No JMicron metadata, forcing spare.");
855				spare = 2;
856				goto search;
857			} else {
858				G_RAID_DEBUG(1,
859				    "JMicron vendor mismatch 0x%04x != 0x197b",
860				    vendor);
861			}
862		}
863		return (G_RAID_MD_TASTE_FAIL);
864	}
865
866	/* Check this disk position in obtained metadata. */
867	disk_pos = jmicron_meta_find_disk(meta, meta->disk_id);
868	if (disk_pos == -1) {
869		G_RAID_DEBUG(1, "JMicron disk_id %08x not found",
870		    meta->disk_id);
871		goto fail1;
872	}
873
874	/* Metadata valid. Print it. */
875	g_raid_md_jmicron_print(meta);
876	G_RAID_DEBUG(1, "JMicron disk position %d", disk_pos);
877	spare = (disk_pos == -2) ? 1 : 0;
878
879search:
880	/* Search for matching node. */
881	sc = NULL;
882	mdi1 = NULL;
883	LIST_FOREACH(geom, &mp->geom, geom) {
884		sc = geom->softc;
885		if (sc == NULL)
886			continue;
887		if (sc->sc_stopping != 0)
888			continue;
889		if (sc->sc_md->mdo_class != md->mdo_class)
890			continue;
891		mdi1 = (struct g_raid_md_jmicron_object *)sc->sc_md;
892		if (spare == 2) {
893			if (mdi1->mdio_incomplete)
894				break;
895		} else {
896			if (mdi1->mdio_config_id ==
897			    jmicron_meta_config_id(meta))
898				break;
899		}
900	}
901
902	/* Found matching node. */
903	if (geom != NULL) {
904		G_RAID_DEBUG(1, "Found matching array %s", sc->sc_name);
905		result = G_RAID_MD_TASTE_EXISTING;
906
907	} else if (spare) { /* Not found needy node -- left for later. */
908		G_RAID_DEBUG(1, "Spare is not needed at this time");
909		goto fail1;
910
911	} else { /* Not found matching node -- create one. */
912		result = G_RAID_MD_TASTE_NEW;
913		mdi->mdio_config_id = jmicron_meta_config_id(meta);
914		snprintf(name, sizeof(name), "JMicron-%08x",
915		    mdi->mdio_config_id);
916		sc = g_raid_create_node(mp, name, md);
917		md->mdo_softc = sc;
918		geom = sc->sc_geom;
919		callout_init(&mdi->mdio_start_co, 1);
920		callout_reset(&mdi->mdio_start_co, g_raid_start_timeout * hz,
921		    g_raid_jmicron_go, sc);
922		mdi->mdio_rootmount = root_mount_hold("GRAID-JMicron");
923		G_RAID_DEBUG1(1, sc, "root_mount_hold %p", mdi->mdio_rootmount);
924	}
925
926	rcp = g_new_consumer(geom);
927	g_attach(rcp, pp);
928	if (g_access(rcp, 1, 1, 1) != 0)
929		; //goto fail1;
930
931	g_topology_unlock();
932	sx_xlock(&sc->sc_lock);
933
934	pd = malloc(sizeof(*pd), M_MD_JMICRON, M_WAITOK | M_ZERO);
935	pd->pd_meta = meta;
936	if (spare == 2) {
937		pd->pd_disk_pos = -3;
938		pd->pd_disk_id = arc4random() & JMICRON_DISK_MASK;
939	} else {
940		pd->pd_disk_pos = -1;
941		pd->pd_disk_id = meta->disk_id;
942	}
943	pd->pd_disk_size = pp->mediasize;
944	disk = g_raid_create_disk(sc);
945	disk->d_md_data = (void *)pd;
946	disk->d_consumer = rcp;
947	rcp->private = disk;
948
949	/* Read kernel dumping information. */
950	disk->d_kd.offset = 0;
951	disk->d_kd.length = OFF_MAX;
952	len = sizeof(disk->d_kd);
953	error = g_io_getattr("GEOM::kerneldump", rcp, &len, &disk->d_kd);
954	if (disk->d_kd.di.dumper == NULL)
955		G_RAID_DEBUG1(2, sc, "Dumping not supported by %s: %d.",
956		    rcp->provider->name, error);
957
958	g_raid_md_jmicron_new_disk(disk);
959
960	sx_xunlock(&sc->sc_lock);
961	g_topology_lock();
962	*gp = geom;
963	return (result);
964fail1:
965	free(meta, M_MD_JMICRON);
966	return (G_RAID_MD_TASTE_FAIL);
967}
968
969static int
970g_raid_md_event_jmicron(struct g_raid_md_object *md,
971    struct g_raid_disk *disk, u_int event)
972{
973	struct g_raid_softc *sc;
974	struct g_raid_subdisk *sd;
975	struct g_raid_md_jmicron_object *mdi;
976	struct g_raid_md_jmicron_perdisk *pd;
977
978	sc = md->mdo_softc;
979	mdi = (struct g_raid_md_jmicron_object *)md;
980	if (disk == NULL) {
981		switch (event) {
982		case G_RAID_NODE_E_START:
983			if (!mdi->mdio_started)
984				g_raid_md_jmicron_start(sc);
985			return (0);
986		}
987		return (-1);
988	}
989	pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
990	switch (event) {
991	case G_RAID_DISK_E_DISCONNECTED:
992		/* If disk was assigned, just update statuses. */
993		if (pd->pd_disk_pos >= 0) {
994			g_raid_change_disk_state(disk, G_RAID_DISK_S_OFFLINE);
995			if (disk->d_consumer) {
996				g_raid_kill_consumer(sc, disk->d_consumer);
997				disk->d_consumer = NULL;
998			}
999			TAILQ_FOREACH(sd, &disk->d_subdisks, sd_next) {
1000				g_raid_change_subdisk_state(sd,
1001				    G_RAID_SUBDISK_S_NONE);
1002				g_raid_event_send(sd, G_RAID_SUBDISK_E_DISCONNECTED,
1003				    G_RAID_EVENT_SUBDISK);
1004			}
1005		} else {
1006			/* Otherwise -- delete. */
1007			g_raid_change_disk_state(disk, G_RAID_DISK_S_NONE);
1008			g_raid_destroy_disk(disk);
1009		}
1010
1011		/* Write updated metadata to all disks. */
1012		g_raid_md_write_jmicron(md, NULL, NULL, NULL);
1013
1014		/* Check if anything left except placeholders. */
1015		if (g_raid_ndisks(sc, -1) ==
1016		    g_raid_ndisks(sc, G_RAID_DISK_S_OFFLINE))
1017			g_raid_destroy_node(sc, 0);
1018		else
1019			g_raid_md_jmicron_refill(sc);
1020		return (0);
1021	}
1022	return (-2);
1023}
1024
1025static int
1026g_raid_md_ctl_jmicron(struct g_raid_md_object *md,
1027    struct gctl_req *req)
1028{
1029	struct g_raid_softc *sc;
1030	struct g_raid_volume *vol;
1031	struct g_raid_subdisk *sd;
1032	struct g_raid_disk *disk;
1033	struct g_raid_md_jmicron_object *mdi;
1034	struct g_raid_md_jmicron_perdisk *pd;
1035	struct g_consumer *cp;
1036	struct g_provider *pp;
1037	char arg[16];
1038	const char *verb, *volname, *levelname, *diskname;
1039	int *nargs, *force;
1040	off_t size, sectorsize, strip;
1041	intmax_t *sizearg, *striparg;
1042	int numdisks, i, len, level, qual, update;
1043	int error;
1044
1045	sc = md->mdo_softc;
1046	mdi = (struct g_raid_md_jmicron_object *)md;
1047	verb = gctl_get_param(req, "verb", NULL);
1048	nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs));
1049	error = 0;
1050	if (strcmp(verb, "label") == 0) {
1051
1052		if (*nargs < 4) {
1053			gctl_error(req, "Invalid number of arguments.");
1054			return (-1);
1055		}
1056		volname = gctl_get_asciiparam(req, "arg1");
1057		if (volname == NULL) {
1058			gctl_error(req, "No volume name.");
1059			return (-2);
1060		}
1061		levelname = gctl_get_asciiparam(req, "arg2");
1062		if (levelname == NULL) {
1063			gctl_error(req, "No RAID level.");
1064			return (-3);
1065		}
1066		if (g_raid_volume_str2level(levelname, &level, &qual)) {
1067			gctl_error(req, "Unknown RAID level '%s'.", levelname);
1068			return (-4);
1069		}
1070		numdisks = *nargs - 3;
1071		force = gctl_get_paraml(req, "force", sizeof(*force));
1072		if (!g_raid_md_jmicron_supported(level, qual, numdisks,
1073		    force ? *force : 0)) {
1074			gctl_error(req, "Unsupported RAID level "
1075			    "(0x%02x/0x%02x), or number of disks (%d).",
1076			    level, qual, numdisks);
1077			return (-5);
1078		}
1079
1080		/* Search for disks, connect them and probe. */
1081		size = 0x7fffffffffffffffllu;
1082		sectorsize = 0;
1083		for (i = 0; i < numdisks; i++) {
1084			snprintf(arg, sizeof(arg), "arg%d", i + 3);
1085			diskname = gctl_get_asciiparam(req, arg);
1086			if (diskname == NULL) {
1087				gctl_error(req, "No disk name (%s).", arg);
1088				error = -6;
1089				break;
1090			}
1091			if (strcmp(diskname, "NONE") == 0) {
1092				cp = NULL;
1093				pp = NULL;
1094			} else {
1095				g_topology_lock();
1096				cp = g_raid_open_consumer(sc, diskname);
1097				if (cp == NULL) {
1098					gctl_error(req, "Can't open '%s'.",
1099					    diskname);
1100					g_topology_unlock();
1101					error = -7;
1102					break;
1103				}
1104				pp = cp->provider;
1105			}
1106			pd = malloc(sizeof(*pd), M_MD_JMICRON, M_WAITOK | M_ZERO);
1107			pd->pd_disk_pos = i;
1108			pd->pd_disk_id = arc4random() & JMICRON_DISK_MASK;
1109			disk = g_raid_create_disk(sc);
1110			disk->d_md_data = (void *)pd;
1111			disk->d_consumer = cp;
1112			if (cp == NULL)
1113				continue;
1114			cp->private = disk;
1115			g_topology_unlock();
1116
1117			/* Read kernel dumping information. */
1118			disk->d_kd.offset = 0;
1119			disk->d_kd.length = OFF_MAX;
1120			len = sizeof(disk->d_kd);
1121			g_io_getattr("GEOM::kerneldump", cp, &len, &disk->d_kd);
1122			if (disk->d_kd.di.dumper == NULL)
1123				G_RAID_DEBUG1(2, sc,
1124				    "Dumping not supported by %s.",
1125				    cp->provider->name);
1126
1127			pd->pd_disk_size = pp->mediasize;
1128			if (size > pp->mediasize)
1129				size = pp->mediasize;
1130			if (sectorsize < pp->sectorsize)
1131				sectorsize = pp->sectorsize;
1132		}
1133		if (error != 0)
1134			return (error);
1135
1136		/* Reserve space for metadata. */
1137		size -= sectorsize;
1138
1139		/* Handle size argument. */
1140		len = sizeof(*sizearg);
1141		sizearg = gctl_get_param(req, "size", &len);
1142		if (sizearg != NULL && len == sizeof(*sizearg) &&
1143		    *sizearg > 0) {
1144			if (*sizearg > size) {
1145				gctl_error(req, "Size too big %lld > %lld.",
1146				    (long long)*sizearg, (long long)size);
1147				return (-9);
1148			}
1149			size = *sizearg;
1150		}
1151
1152		/* Handle strip argument. */
1153		strip = 131072;
1154		len = sizeof(*striparg);
1155		striparg = gctl_get_param(req, "strip", &len);
1156		if (striparg != NULL && len == sizeof(*striparg) &&
1157		    *striparg > 0) {
1158			if (*striparg < sectorsize) {
1159				gctl_error(req, "Strip size too small.");
1160				return (-10);
1161			}
1162			if (*striparg % sectorsize != 0) {
1163				gctl_error(req, "Incorrect strip size.");
1164				return (-11);
1165			}
1166			if (strip > 65535 * sectorsize) {
1167				gctl_error(req, "Strip size too big.");
1168				return (-12);
1169			}
1170			strip = *striparg;
1171		}
1172
1173		/* Round size down to strip or sector. */
1174		if (level == G_RAID_VOLUME_RL_RAID1)
1175			size -= (size % sectorsize);
1176		else if (level == G_RAID_VOLUME_RL_RAID1E &&
1177		    (numdisks & 1) != 0)
1178			size -= (size % (2 * strip));
1179		else
1180			size -= (size % strip);
1181		if (size <= 0) {
1182			gctl_error(req, "Size too small.");
1183			return (-13);
1184		}
1185		if (size > 0xffffffffffffllu * sectorsize) {
1186			gctl_error(req, "Size too big.");
1187			return (-14);
1188		}
1189
1190		/* We have all we need, create things: volume, ... */
1191		mdi->mdio_total_disks = numdisks;
1192		mdi->mdio_started = 1;
1193		vol = g_raid_create_volume(sc, volname, -1);
1194		vol->v_md_data = (void *)(intptr_t)0;
1195		vol->v_raid_level = level;
1196		vol->v_raid_level_qualifier = G_RAID_VOLUME_RLQ_NONE;
1197		vol->v_strip_size = strip;
1198		vol->v_disks_count = numdisks;
1199		if (level == G_RAID_VOLUME_RL_RAID0 ||
1200		    level == G_RAID_VOLUME_RL_CONCAT ||
1201		    level == G_RAID_VOLUME_RL_SINGLE)
1202			vol->v_mediasize = size * numdisks;
1203		else if (level == G_RAID_VOLUME_RL_RAID1)
1204			vol->v_mediasize = size;
1205		else if (level == G_RAID_VOLUME_RL_RAID5)
1206			vol->v_mediasize = size * (numdisks - 1);
1207		else { /* RAID1E */
1208			vol->v_mediasize = ((size * numdisks) / strip / 2) *
1209			    strip;
1210		}
1211		vol->v_sectorsize = sectorsize;
1212		g_raid_start_volume(vol);
1213
1214		/* , and subdisks. */
1215		TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1216			pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
1217			sd = &vol->v_subdisks[pd->pd_disk_pos];
1218			sd->sd_disk = disk;
1219			sd->sd_offset = 0;
1220			sd->sd_size = size;
1221			TAILQ_INSERT_TAIL(&disk->d_subdisks, sd, sd_next);
1222			if (sd->sd_disk->d_consumer != NULL) {
1223				g_raid_change_disk_state(disk,
1224				    G_RAID_DISK_S_ACTIVE);
1225				g_raid_change_subdisk_state(sd,
1226				    G_RAID_SUBDISK_S_ACTIVE);
1227				g_raid_event_send(sd, G_RAID_SUBDISK_E_NEW,
1228				    G_RAID_EVENT_SUBDISK);
1229			} else {
1230				g_raid_change_disk_state(disk, G_RAID_DISK_S_OFFLINE);
1231			}
1232		}
1233
1234		/* Write metadata based on created entities. */
1235		G_RAID_DEBUG1(0, sc, "Array started.");
1236		g_raid_md_write_jmicron(md, NULL, NULL, NULL);
1237
1238		/* Pickup any STALE/SPARE disks to refill array if needed. */
1239		g_raid_md_jmicron_refill(sc);
1240
1241		g_raid_event_send(vol, G_RAID_VOLUME_E_START,
1242		    G_RAID_EVENT_VOLUME);
1243		return (0);
1244	}
1245	if (strcmp(verb, "delete") == 0) {
1246
1247		/* Check if some volume is still open. */
1248		force = gctl_get_paraml(req, "force", sizeof(*force));
1249		if (force != NULL && *force == 0 &&
1250		    g_raid_nopens(sc) != 0) {
1251			gctl_error(req, "Some volume is still open.");
1252			return (-4);
1253		}
1254
1255		TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1256			if (disk->d_consumer)
1257				jmicron_meta_erase(disk->d_consumer);
1258		}
1259		g_raid_destroy_node(sc, 0);
1260		return (0);
1261	}
1262	if (strcmp(verb, "remove") == 0 ||
1263	    strcmp(verb, "fail") == 0) {
1264		if (*nargs < 2) {
1265			gctl_error(req, "Invalid number of arguments.");
1266			return (-1);
1267		}
1268		for (i = 1; i < *nargs; i++) {
1269			snprintf(arg, sizeof(arg), "arg%d", i);
1270			diskname = gctl_get_asciiparam(req, arg);
1271			if (diskname == NULL) {
1272				gctl_error(req, "No disk name (%s).", arg);
1273				error = -2;
1274				break;
1275			}
1276			if (strncmp(diskname, "/dev/", 5) == 0)
1277				diskname += 5;
1278
1279			TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1280				if (disk->d_consumer != NULL &&
1281				    disk->d_consumer->provider != NULL &&
1282				    strcmp(disk->d_consumer->provider->name,
1283				     diskname) == 0)
1284					break;
1285			}
1286			if (disk == NULL) {
1287				gctl_error(req, "Disk '%s' not found.",
1288				    diskname);
1289				error = -3;
1290				break;
1291			}
1292
1293			if (strcmp(verb, "fail") == 0) {
1294				g_raid_md_fail_disk_jmicron(md, NULL, disk);
1295				continue;
1296			}
1297
1298			pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
1299
1300			/* Erase metadata on deleting disk. */
1301			jmicron_meta_erase(disk->d_consumer);
1302
1303			/* If disk was assigned, just update statuses. */
1304			if (pd->pd_disk_pos >= 0) {
1305				g_raid_change_disk_state(disk, G_RAID_DISK_S_OFFLINE);
1306				g_raid_kill_consumer(sc, disk->d_consumer);
1307				disk->d_consumer = NULL;
1308				TAILQ_FOREACH(sd, &disk->d_subdisks, sd_next) {
1309					g_raid_change_subdisk_state(sd,
1310					    G_RAID_SUBDISK_S_NONE);
1311					g_raid_event_send(sd, G_RAID_SUBDISK_E_DISCONNECTED,
1312					    G_RAID_EVENT_SUBDISK);
1313				}
1314			} else {
1315				/* Otherwise -- delete. */
1316				g_raid_change_disk_state(disk, G_RAID_DISK_S_NONE);
1317				g_raid_destroy_disk(disk);
1318			}
1319		}
1320
1321		/* Write updated metadata to remaining disks. */
1322		g_raid_md_write_jmicron(md, NULL, NULL, NULL);
1323
1324		/* Check if anything left except placeholders. */
1325		if (g_raid_ndisks(sc, -1) ==
1326		    g_raid_ndisks(sc, G_RAID_DISK_S_OFFLINE))
1327			g_raid_destroy_node(sc, 0);
1328		else
1329			g_raid_md_jmicron_refill(sc);
1330		return (error);
1331	}
1332	if (strcmp(verb, "insert") == 0) {
1333		if (*nargs < 2) {
1334			gctl_error(req, "Invalid number of arguments.");
1335			return (-1);
1336		}
1337		update = 0;
1338		for (i = 1; i < *nargs; i++) {
1339			/* Get disk name. */
1340			snprintf(arg, sizeof(arg), "arg%d", i);
1341			diskname = gctl_get_asciiparam(req, arg);
1342			if (diskname == NULL) {
1343				gctl_error(req, "No disk name (%s).", arg);
1344				error = -3;
1345				break;
1346			}
1347
1348			/* Try to find provider with specified name. */
1349			g_topology_lock();
1350			cp = g_raid_open_consumer(sc, diskname);
1351			if (cp == NULL) {
1352				gctl_error(req, "Can't open disk '%s'.",
1353				    diskname);
1354				g_topology_unlock();
1355				error = -4;
1356				break;
1357			}
1358			pp = cp->provider;
1359
1360			pd = malloc(sizeof(*pd), M_MD_JMICRON, M_WAITOK | M_ZERO);
1361			pd->pd_disk_pos = -3;
1362			pd->pd_disk_id = arc4random() & JMICRON_DISK_MASK;
1363			pd->pd_disk_size = pp->mediasize;
1364
1365			disk = g_raid_create_disk(sc);
1366			disk->d_consumer = cp;
1367			disk->d_consumer->private = disk;
1368			disk->d_md_data = (void *)pd;
1369			cp->private = disk;
1370			g_topology_unlock();
1371
1372			/* Read kernel dumping information. */
1373			disk->d_kd.offset = 0;
1374			disk->d_kd.length = OFF_MAX;
1375			len = sizeof(disk->d_kd);
1376			g_io_getattr("GEOM::kerneldump", cp, &len, &disk->d_kd);
1377			if (disk->d_kd.di.dumper == NULL)
1378				G_RAID_DEBUG1(2, sc,
1379				    "Dumping not supported by %s.",
1380				    cp->provider->name);
1381
1382			/* Welcome the "new" disk. */
1383			update += g_raid_md_jmicron_start_disk(disk);
1384			if (disk->d_state != G_RAID_DISK_S_ACTIVE &&
1385			    disk->d_state != G_RAID_DISK_S_SPARE) {
1386				gctl_error(req, "Disk '%s' doesn't fit.",
1387				    diskname);
1388				g_raid_destroy_disk(disk);
1389				error = -8;
1390				break;
1391			}
1392		}
1393
1394		/* Write new metadata if we changed something. */
1395		if (update)
1396			g_raid_md_write_jmicron(md, NULL, NULL, NULL);
1397		return (error);
1398	}
1399	gctl_error(req, "Command '%s' is not supported.", verb);
1400	return (-100);
1401}
1402
1403static int
1404g_raid_md_write_jmicron(struct g_raid_md_object *md, struct g_raid_volume *tvol,
1405    struct g_raid_subdisk *tsd, struct g_raid_disk *tdisk)
1406{
1407	struct g_raid_softc *sc;
1408	struct g_raid_volume *vol;
1409	struct g_raid_subdisk *sd;
1410	struct g_raid_disk *disk;
1411	struct g_raid_md_jmicron_object *mdi;
1412	struct g_raid_md_jmicron_perdisk *pd;
1413	struct jmicron_raid_conf *meta;
1414	int i, spares;
1415
1416	sc = md->mdo_softc;
1417	mdi = (struct g_raid_md_jmicron_object *)md;
1418
1419	if (sc->sc_stopping == G_RAID_DESTROY_HARD)
1420		return (0);
1421
1422	/* There is only one volume. */
1423	vol = TAILQ_FIRST(&sc->sc_volumes);
1424
1425	/* Fill global fields. */
1426	meta = malloc(sizeof(*meta), M_MD_JMICRON, M_WAITOK | M_ZERO);
1427	strncpy(meta->signature, JMICRON_MAGIC, 2);
1428	meta->version = JMICRON_VERSION;
1429	jmicron_meta_put_name(meta, vol->v_name);
1430	if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID0)
1431		meta->type = JMICRON_T_RAID0;
1432	else if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID1)
1433		meta->type = JMICRON_T_RAID1;
1434	else if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID1E)
1435		meta->type = JMICRON_T_RAID01;
1436	else if (vol->v_raid_level == G_RAID_VOLUME_RL_CONCAT ||
1437	    vol->v_raid_level == G_RAID_VOLUME_RL_SINGLE)
1438		meta->type = JMICRON_T_CONCAT;
1439	else
1440		meta->type = JMICRON_T_RAID5;
1441	meta->stripe_shift = fls(vol->v_strip_size / 2048);
1442	meta->flags = JMICRON_F_READY | JMICRON_F_BOOTABLE;
1443	for (i = 0; i < vol->v_disks_count; i++) {
1444		sd = &vol->v_subdisks[i];
1445		if (sd->sd_disk == NULL || sd->sd_disk->d_md_data == NULL)
1446			meta->disks[i] = 0xffffffff;
1447		else {
1448			pd = (struct g_raid_md_jmicron_perdisk *)
1449			    sd->sd_disk->d_md_data;
1450			meta->disks[i] = pd->pd_disk_id;
1451		}
1452		if (sd->sd_state < G_RAID_SUBDISK_S_STALE)
1453			meta->flags |= JMICRON_F_BADSEC;
1454		if (vol->v_dirty)
1455			meta->flags |= JMICRON_F_UNSYNC;
1456	}
1457
1458	/* Put spares to their slots. */
1459	spares = 0;
1460	TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1461		pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
1462		if (disk->d_state != G_RAID_DISK_S_SPARE)
1463			continue;
1464		meta->spare[spares] = pd->pd_disk_id;
1465		if (++spares >= 2)
1466			break;
1467	}
1468
1469	/* We are done. Print meta data and store them to disks. */
1470	if (mdi->mdio_meta != NULL)
1471		free(mdi->mdio_meta, M_MD_JMICRON);
1472	mdi->mdio_meta = meta;
1473	i = 0;
1474	TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
1475		pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
1476		if (disk->d_state != G_RAID_DISK_S_ACTIVE &&
1477		    disk->d_state != G_RAID_DISK_S_SPARE)
1478			continue;
1479		if (pd->pd_meta != NULL) {
1480			free(pd->pd_meta, M_MD_JMICRON);
1481			pd->pd_meta = NULL;
1482		}
1483		pd->pd_meta = jmicron_meta_copy(meta);
1484		pd->pd_meta->disk_id = pd->pd_disk_id;
1485		if ((sd = TAILQ_FIRST(&disk->d_subdisks)) != NULL) {
1486			pd->pd_meta->offset =
1487			    (sd->sd_offset / 512) / 16;
1488			pd->pd_meta->disk_sectors_high =
1489			    (sd->sd_size / 512) >> 16;
1490			pd->pd_meta->disk_sectors_low =
1491			    (sd->sd_size / 512) & 0xffff;
1492			if (sd->sd_state < G_RAID_SUBDISK_S_STALE)
1493				pd->pd_meta->flags &= ~JMICRON_F_BADSEC;
1494			else if (sd->sd_state < G_RAID_SUBDISK_S_ACTIVE)
1495				pd->pd_meta->flags |= JMICRON_F_UNSYNC;
1496		}
1497		G_RAID_DEBUG(1, "Writing JMicron metadata to %s",
1498		    g_raid_get_diskname(disk));
1499		g_raid_md_jmicron_print(pd->pd_meta);
1500		jmicron_meta_write(disk->d_consumer, pd->pd_meta);
1501	}
1502	return (0);
1503}
1504
1505static int
1506g_raid_md_fail_disk_jmicron(struct g_raid_md_object *md,
1507    struct g_raid_subdisk *tsd, struct g_raid_disk *tdisk)
1508{
1509	struct g_raid_softc *sc;
1510	struct g_raid_md_jmicron_object *mdi;
1511	struct g_raid_md_jmicron_perdisk *pd;
1512	struct g_raid_subdisk *sd;
1513
1514	sc = md->mdo_softc;
1515	mdi = (struct g_raid_md_jmicron_object *)md;
1516	pd = (struct g_raid_md_jmicron_perdisk *)tdisk->d_md_data;
1517
1518	/* We can't fail disk that is not a part of array now. */
1519	if (pd->pd_disk_pos < 0)
1520		return (-1);
1521
1522	if (tdisk->d_consumer)
1523		jmicron_meta_erase(tdisk->d_consumer);
1524
1525	/* Change states. */
1526	g_raid_change_disk_state(tdisk, G_RAID_DISK_S_FAILED);
1527	TAILQ_FOREACH(sd, &tdisk->d_subdisks, sd_next) {
1528		g_raid_change_subdisk_state(sd,
1529		    G_RAID_SUBDISK_S_FAILED);
1530		g_raid_event_send(sd, G_RAID_SUBDISK_E_FAILED,
1531		    G_RAID_EVENT_SUBDISK);
1532	}
1533
1534	/* Write updated metadata to remaining disks. */
1535	g_raid_md_write_jmicron(md, NULL, NULL, tdisk);
1536
1537	/* Check if anything left except placeholders. */
1538	if (g_raid_ndisks(sc, -1) ==
1539	    g_raid_ndisks(sc, G_RAID_DISK_S_OFFLINE))
1540		g_raid_destroy_node(sc, 0);
1541	else
1542		g_raid_md_jmicron_refill(sc);
1543	return (0);
1544}
1545
1546static int
1547g_raid_md_free_disk_jmicron(struct g_raid_md_object *md,
1548    struct g_raid_disk *disk)
1549{
1550	struct g_raid_md_jmicron_perdisk *pd;
1551
1552	pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
1553	if (pd->pd_meta != NULL) {
1554		free(pd->pd_meta, M_MD_JMICRON);
1555		pd->pd_meta = NULL;
1556	}
1557	free(pd, M_MD_JMICRON);
1558	disk->d_md_data = NULL;
1559	return (0);
1560}
1561
1562static int
1563g_raid_md_free_jmicron(struct g_raid_md_object *md)
1564{
1565	struct g_raid_md_jmicron_object *mdi;
1566
1567	mdi = (struct g_raid_md_jmicron_object *)md;
1568	if (!mdi->mdio_started) {
1569		mdi->mdio_started = 0;
1570		callout_stop(&mdi->mdio_start_co);
1571		G_RAID_DEBUG1(1, md->mdo_softc,
1572		    "root_mount_rel %p", mdi->mdio_rootmount);
1573		root_mount_rel(mdi->mdio_rootmount);
1574		mdi->mdio_rootmount = NULL;
1575	}
1576	if (mdi->mdio_meta != NULL) {
1577		free(mdi->mdio_meta, M_MD_JMICRON);
1578		mdi->mdio_meta = NULL;
1579	}
1580	return (0);
1581}
1582
1583G_RAID_MD_DECLARE(g_raid_md_jmicron);
1584