xref: /freebsd/sys/geom/stripe/g_stripe.c (revision b09121f9e159d9f63292ee31fc9cc28d37d1f181)
1b09121f9SPawel Jakub Dawidek /*-
2b09121f9SPawel Jakub Dawidek  * Copyright (c) 2003 Pawel Jakub Dawidek <pjd@FreeBSD.org>
3b09121f9SPawel Jakub Dawidek  * All rights reserved.
4b09121f9SPawel Jakub Dawidek  *
5b09121f9SPawel Jakub Dawidek  * Redistribution and use in source and binary forms, with or without
6b09121f9SPawel Jakub Dawidek  * modification, are permitted provided that the following conditions
7b09121f9SPawel Jakub Dawidek  * are met:
8b09121f9SPawel Jakub Dawidek  * 1. Redistributions of source code must retain the above copyright
9b09121f9SPawel Jakub Dawidek  *    notice, this list of conditions and the following disclaimer.
10b09121f9SPawel Jakub Dawidek  * 2. Redistributions in binary form must reproduce the above copyright
11b09121f9SPawel Jakub Dawidek  *    notice, this list of conditions and the following disclaimer in the
12b09121f9SPawel Jakub Dawidek  *    documentation and/or other materials provided with the distribution.
13b09121f9SPawel Jakub Dawidek  *
14b09121f9SPawel Jakub Dawidek  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
15b09121f9SPawel Jakub Dawidek  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16b09121f9SPawel Jakub Dawidek  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17b09121f9SPawel Jakub Dawidek  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE
18b09121f9SPawel Jakub Dawidek  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19b09121f9SPawel Jakub Dawidek  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20b09121f9SPawel Jakub Dawidek  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21b09121f9SPawel Jakub Dawidek  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22b09121f9SPawel Jakub Dawidek  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23b09121f9SPawel Jakub Dawidek  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24b09121f9SPawel Jakub Dawidek  * SUCH DAMAGE.
25b09121f9SPawel Jakub Dawidek  */
26b09121f9SPawel Jakub Dawidek 
27b09121f9SPawel Jakub Dawidek #include <sys/cdefs.h>
28b09121f9SPawel Jakub Dawidek __FBSDID("$FreeBSD$");
29b09121f9SPawel Jakub Dawidek 
30b09121f9SPawel Jakub Dawidek #include <sys/param.h>
31b09121f9SPawel Jakub Dawidek #include <sys/systm.h>
32b09121f9SPawel Jakub Dawidek #include <sys/kernel.h>
33b09121f9SPawel Jakub Dawidek #include <sys/module.h>
34b09121f9SPawel Jakub Dawidek #include <sys/lock.h>
35b09121f9SPawel Jakub Dawidek #include <sys/mutex.h>
36b09121f9SPawel Jakub Dawidek #include <sys/bio.h>
37b09121f9SPawel Jakub Dawidek #include <sys/sysctl.h>
38b09121f9SPawel Jakub Dawidek #include <sys/malloc.h>
39b09121f9SPawel Jakub Dawidek #include <geom/geom.h>
40b09121f9SPawel Jakub Dawidek #include <geom/stripe/g_stripe.h>
41b09121f9SPawel Jakub Dawidek 
42b09121f9SPawel Jakub Dawidek 
43b09121f9SPawel Jakub Dawidek static MALLOC_DEFINE(M_STRIPE, "stripe data", "GEOM_STRIPE Data");
44b09121f9SPawel Jakub Dawidek 
45b09121f9SPawel Jakub Dawidek SYSCTL_DECL(_kern_geom);
46b09121f9SPawel Jakub Dawidek SYSCTL_NODE(_kern_geom, OID_AUTO, stripe, CTLFLAG_RW, 0, "GEOM_STRIPE stuff");
47b09121f9SPawel Jakub Dawidek static u_int g_stripe_debug = 0;
48b09121f9SPawel Jakub Dawidek SYSCTL_UINT(_kern_geom_stripe, OID_AUTO, debug, CTLFLAG_RW, &g_stripe_debug, 0,
49b09121f9SPawel Jakub Dawidek     "Debug level");
50b09121f9SPawel Jakub Dawidek 
51b09121f9SPawel Jakub Dawidek static int g_stripe_destroy(struct g_stripe_softc *sc, boolean_t force);
52b09121f9SPawel Jakub Dawidek static int g_stripe_destroy_geom(struct gctl_req *req, struct g_class *mp,
53b09121f9SPawel Jakub Dawidek     struct g_geom *gp);
54b09121f9SPawel Jakub Dawidek 
55b09121f9SPawel Jakub Dawidek static g_taste_t g_stripe_taste;
56b09121f9SPawel Jakub Dawidek static g_ctl_req_t g_stripe_config;
57b09121f9SPawel Jakub Dawidek static g_dumpconf_t g_stripe_dumpconf;
58b09121f9SPawel Jakub Dawidek 
59b09121f9SPawel Jakub Dawidek struct g_class g_stripe_class = {
60b09121f9SPawel Jakub Dawidek 	.name = G_STRIPE_CLASS_NAME,
61b09121f9SPawel Jakub Dawidek 	.ctlreq = g_stripe_config,
62b09121f9SPawel Jakub Dawidek 	.taste = g_stripe_taste,
63b09121f9SPawel Jakub Dawidek 	.destroy_geom = g_stripe_destroy_geom
64b09121f9SPawel Jakub Dawidek };
65b09121f9SPawel Jakub Dawidek 
66b09121f9SPawel Jakub Dawidek 
67b09121f9SPawel Jakub Dawidek /*
68b09121f9SPawel Jakub Dawidek  * Greatest Common Divisor.
69b09121f9SPawel Jakub Dawidek  */
70b09121f9SPawel Jakub Dawidek static u_int
71b09121f9SPawel Jakub Dawidek gcd(u_int a, u_int b)
72b09121f9SPawel Jakub Dawidek {
73b09121f9SPawel Jakub Dawidek 	u_int c;
74b09121f9SPawel Jakub Dawidek 
75b09121f9SPawel Jakub Dawidek 	while (b != 0) {
76b09121f9SPawel Jakub Dawidek 		c = a;
77b09121f9SPawel Jakub Dawidek 		a = b;
78b09121f9SPawel Jakub Dawidek 		b = (c % b);
79b09121f9SPawel Jakub Dawidek 	}
80b09121f9SPawel Jakub Dawidek 	return (a);
81b09121f9SPawel Jakub Dawidek }
82b09121f9SPawel Jakub Dawidek 
83b09121f9SPawel Jakub Dawidek /*
84b09121f9SPawel Jakub Dawidek  * Least Common Multiple.
85b09121f9SPawel Jakub Dawidek  */
86b09121f9SPawel Jakub Dawidek static u_int
87b09121f9SPawel Jakub Dawidek lcm(u_int a, u_int b)
88b09121f9SPawel Jakub Dawidek {
89b09121f9SPawel Jakub Dawidek 
90b09121f9SPawel Jakub Dawidek 	return ((a * b) / gcd(a, b));
91b09121f9SPawel Jakub Dawidek }
92b09121f9SPawel Jakub Dawidek 
93b09121f9SPawel Jakub Dawidek /*
94b09121f9SPawel Jakub Dawidek  * Return the number of valid disks.
95b09121f9SPawel Jakub Dawidek  */
96b09121f9SPawel Jakub Dawidek static u_int
97b09121f9SPawel Jakub Dawidek g_stripe_nvalid(struct g_stripe_softc *sc)
98b09121f9SPawel Jakub Dawidek {
99b09121f9SPawel Jakub Dawidek 	u_int i, no;
100b09121f9SPawel Jakub Dawidek 
101b09121f9SPawel Jakub Dawidek 	no = 0;
102b09121f9SPawel Jakub Dawidek 	for (i = 0; i < sc->sc_ndisks; i++) {
103b09121f9SPawel Jakub Dawidek 		if (sc->sc_disks[i] != NULL)
104b09121f9SPawel Jakub Dawidek 			no++;
105b09121f9SPawel Jakub Dawidek 	}
106b09121f9SPawel Jakub Dawidek 
107b09121f9SPawel Jakub Dawidek 	return (no);
108b09121f9SPawel Jakub Dawidek }
109b09121f9SPawel Jakub Dawidek 
110b09121f9SPawel Jakub Dawidek static void
111b09121f9SPawel Jakub Dawidek g_stripe_remove_disk(struct g_consumer *cp)
112b09121f9SPawel Jakub Dawidek {
113b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
114b09121f9SPawel Jakub Dawidek 	u_int no;
115b09121f9SPawel Jakub Dawidek 
116b09121f9SPawel Jakub Dawidek 	KASSERT(cp != NULL, ("Non-valid disk in %s.", __func__));
117b09121f9SPawel Jakub Dawidek 	sc = (struct g_stripe_softc *)cp->private;
118b09121f9SPawel Jakub Dawidek 	KASSERT(sc != NULL, ("NULL sc in %s.", __func__));
119b09121f9SPawel Jakub Dawidek 	no = cp->index;
120b09121f9SPawel Jakub Dawidek 
121b09121f9SPawel Jakub Dawidek 	G_STRIPE_DEBUG(0, "Disk %s removed from %s.", cp->provider->name,
122b09121f9SPawel Jakub Dawidek 	    sc->sc_geom->name);
123b09121f9SPawel Jakub Dawidek 
124b09121f9SPawel Jakub Dawidek 	sc->sc_disks[no] = NULL;
125b09121f9SPawel Jakub Dawidek 	if (sc->sc_provider != NULL) {
126b09121f9SPawel Jakub Dawidek 		g_orphan_provider(sc->sc_provider, ENXIO);
127b09121f9SPawel Jakub Dawidek 		sc->sc_provider = NULL;
128b09121f9SPawel Jakub Dawidek 		G_STRIPE_DEBUG(0, "Device %s removed.", sc->sc_geom->name);
129b09121f9SPawel Jakub Dawidek 	}
130b09121f9SPawel Jakub Dawidek 
131b09121f9SPawel Jakub Dawidek 	if (cp->acr > 0 || cp->acw > 0 || cp->ace > 0)
132b09121f9SPawel Jakub Dawidek 		g_access(cp, -cp->acr, -cp->acw, -cp->ace);
133b09121f9SPawel Jakub Dawidek 	g_detach(cp);
134b09121f9SPawel Jakub Dawidek 	g_destroy_consumer(cp);
135b09121f9SPawel Jakub Dawidek }
136b09121f9SPawel Jakub Dawidek 
137b09121f9SPawel Jakub Dawidek static void
138b09121f9SPawel Jakub Dawidek g_stripe_orphan(struct g_consumer *cp)
139b09121f9SPawel Jakub Dawidek {
140b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
141b09121f9SPawel Jakub Dawidek 	struct g_geom *gp;
142b09121f9SPawel Jakub Dawidek 
143b09121f9SPawel Jakub Dawidek 	g_topology_assert();
144b09121f9SPawel Jakub Dawidek 	gp = cp->geom;
145b09121f9SPawel Jakub Dawidek 	sc = gp->softc;
146b09121f9SPawel Jakub Dawidek 	if (sc == NULL)
147b09121f9SPawel Jakub Dawidek 		return;
148b09121f9SPawel Jakub Dawidek 
149b09121f9SPawel Jakub Dawidek 	g_stripe_remove_disk(cp);
150b09121f9SPawel Jakub Dawidek 	/* If there are no valid disks anymore, remove device. */
151b09121f9SPawel Jakub Dawidek 	if (g_stripe_nvalid(sc) == 0)
152b09121f9SPawel Jakub Dawidek 		g_stripe_destroy(sc, 1);
153b09121f9SPawel Jakub Dawidek }
154b09121f9SPawel Jakub Dawidek 
155b09121f9SPawel Jakub Dawidek static int
156b09121f9SPawel Jakub Dawidek g_stripe_access(struct g_provider *pp, int dr, int dw, int de)
157b09121f9SPawel Jakub Dawidek {
158b09121f9SPawel Jakub Dawidek 	struct g_consumer *cp1, *cp2;
159b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
160b09121f9SPawel Jakub Dawidek 	struct g_geom *gp;
161b09121f9SPawel Jakub Dawidek 	int error;
162b09121f9SPawel Jakub Dawidek 
163b09121f9SPawel Jakub Dawidek 	gp = pp->geom;
164b09121f9SPawel Jakub Dawidek 	sc = gp->softc;
165b09121f9SPawel Jakub Dawidek 
166b09121f9SPawel Jakub Dawidek 	if (sc == NULL) {
167b09121f9SPawel Jakub Dawidek 		/*
168b09121f9SPawel Jakub Dawidek 		 * It looks like geom is being withered.
169b09121f9SPawel Jakub Dawidek 		 * In that case we allow only negative requests.
170b09121f9SPawel Jakub Dawidek 		 */
171b09121f9SPawel Jakub Dawidek 		KASSERT(dr <= 0 && dw <= 0 && de <= 0,
172b09121f9SPawel Jakub Dawidek 		    ("Positive access request (device=%s).", pp->name));
173b09121f9SPawel Jakub Dawidek 		if ((pp->acr + dr) == 0 && (pp->acw + dw) == 0 &&
174b09121f9SPawel Jakub Dawidek 		    (pp->ace + de) == 0) {
175b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(0, "Device %s definitely destroyed.",
176b09121f9SPawel Jakub Dawidek 			    gp->name);
177b09121f9SPawel Jakub Dawidek 		}
178b09121f9SPawel Jakub Dawidek 		return (0);
179b09121f9SPawel Jakub Dawidek 	}
180b09121f9SPawel Jakub Dawidek 
181b09121f9SPawel Jakub Dawidek 	/* On first open, grab an extra "exclusive" bit */
182b09121f9SPawel Jakub Dawidek 	if (pp->acr == 0 && pp->acw == 0 && pp->ace == 0)
183b09121f9SPawel Jakub Dawidek 		de++;
184b09121f9SPawel Jakub Dawidek 	/* ... and let go of it on last close */
185b09121f9SPawel Jakub Dawidek 	if ((pp->acr + dr) == 0 && (pp->acw + dw) == 0 && (pp->ace + de) == 0)
186b09121f9SPawel Jakub Dawidek 		de--;
187b09121f9SPawel Jakub Dawidek 
188b09121f9SPawel Jakub Dawidek 	error = ENXIO;
189b09121f9SPawel Jakub Dawidek 	LIST_FOREACH(cp1, &gp->consumer, consumer) {
190b09121f9SPawel Jakub Dawidek 		error = g_access(cp1, dr, dw, de);
191b09121f9SPawel Jakub Dawidek 		if (error == 0)
192b09121f9SPawel Jakub Dawidek 			continue;
193b09121f9SPawel Jakub Dawidek 		/*
194b09121f9SPawel Jakub Dawidek 		 * If we fail here, backout all previous changes.
195b09121f9SPawel Jakub Dawidek 		 */
196b09121f9SPawel Jakub Dawidek 		LIST_FOREACH(cp2, &gp->consumer, consumer) {
197b09121f9SPawel Jakub Dawidek 			if (cp1 == cp2)
198b09121f9SPawel Jakub Dawidek 				return (error);
199b09121f9SPawel Jakub Dawidek 			g_access(cp2, -dr, -dw, -de);
200b09121f9SPawel Jakub Dawidek 		}
201b09121f9SPawel Jakub Dawidek 		/* NOTREACHED */
202b09121f9SPawel Jakub Dawidek 	}
203b09121f9SPawel Jakub Dawidek 
204b09121f9SPawel Jakub Dawidek 	return (error);
205b09121f9SPawel Jakub Dawidek }
206b09121f9SPawel Jakub Dawidek 
207b09121f9SPawel Jakub Dawidek static void
208b09121f9SPawel Jakub Dawidek g_stripe_start(struct bio *bp)
209b09121f9SPawel Jakub Dawidek {
210b09121f9SPawel Jakub Dawidek 	struct g_provider *pp;
211b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
212b09121f9SPawel Jakub Dawidek 	off_t off, start, length, nstripe;
213b09121f9SPawel Jakub Dawidek 	struct bio *cbp;
214b09121f9SPawel Jakub Dawidek 	u_int sectorsize;
215b09121f9SPawel Jakub Dawidek 	uint32_t stripesize;
216b09121f9SPawel Jakub Dawidek 	uint16_t no;
217b09121f9SPawel Jakub Dawidek 	char *addr;
218b09121f9SPawel Jakub Dawidek 
219b09121f9SPawel Jakub Dawidek 	pp = bp->bio_to;
220b09121f9SPawel Jakub Dawidek 	sc = pp->geom->softc;
221b09121f9SPawel Jakub Dawidek 	/*
222b09121f9SPawel Jakub Dawidek 	 * If sc == NULL, provider's error should be set and g_stripe_start()
223b09121f9SPawel Jakub Dawidek 	 * should not be called at all.
224b09121f9SPawel Jakub Dawidek 	 */
225b09121f9SPawel Jakub Dawidek 	KASSERT(sc != NULL,
226b09121f9SPawel Jakub Dawidek 	    ("Provider's error should be set (error=%d)(device=%s).",
227b09121f9SPawel Jakub Dawidek 	    bp->bio_to->error, bp->bio_to->name));
228b09121f9SPawel Jakub Dawidek 
229b09121f9SPawel Jakub Dawidek 	G_STRIPE_LOGREQ(bp, "Request received.");
230b09121f9SPawel Jakub Dawidek 
231b09121f9SPawel Jakub Dawidek 	switch (bp->bio_cmd) {
232b09121f9SPawel Jakub Dawidek 	case BIO_READ:
233b09121f9SPawel Jakub Dawidek 	case BIO_WRITE:
234b09121f9SPawel Jakub Dawidek 	case BIO_DELETE:
235b09121f9SPawel Jakub Dawidek 		/*
236b09121f9SPawel Jakub Dawidek 		 * Only those requests are supported.
237b09121f9SPawel Jakub Dawidek 		 */
238b09121f9SPawel Jakub Dawidek 		break;
239b09121f9SPawel Jakub Dawidek 	case BIO_GETATTR:
240b09121f9SPawel Jakub Dawidek 		/* To which provider it should be delivered? */
241b09121f9SPawel Jakub Dawidek 	default:
242b09121f9SPawel Jakub Dawidek 		g_io_deliver(bp, EOPNOTSUPP);
243b09121f9SPawel Jakub Dawidek 		return;
244b09121f9SPawel Jakub Dawidek 	}
245b09121f9SPawel Jakub Dawidek 
246b09121f9SPawel Jakub Dawidek 	addr = bp->bio_data;
247b09121f9SPawel Jakub Dawidek 	sectorsize = sc->sc_provider->sectorsize;
248b09121f9SPawel Jakub Dawidek 	stripesize = sc->sc_stripesize;
249b09121f9SPawel Jakub Dawidek 
250b09121f9SPawel Jakub Dawidek 	/*
251b09121f9SPawel Jakub Dawidek 	 * Calcucations are quite messy, but fast I hope.
252b09121f9SPawel Jakub Dawidek 	 */
253b09121f9SPawel Jakub Dawidek 
254b09121f9SPawel Jakub Dawidek 	/* Stripe number. */
255b09121f9SPawel Jakub Dawidek 	/* nstripe = bp->bio_offset / stripesize; */
256b09121f9SPawel Jakub Dawidek 	nstripe = bp->bio_offset >> (off_t)sc->sc_stripebits;
257b09121f9SPawel Jakub Dawidek 	/* Disk number. */
258b09121f9SPawel Jakub Dawidek 	no = nstripe % sc->sc_ndisks;
259b09121f9SPawel Jakub Dawidek 	/* Start position in stripe. */
260b09121f9SPawel Jakub Dawidek 	/* start = bp->bio_offset % stripesize; */
261b09121f9SPawel Jakub Dawidek 	start = bp->bio_offset & (stripesize - 1);
262b09121f9SPawel Jakub Dawidek 	/* Start position in disk. */
263b09121f9SPawel Jakub Dawidek 	/* off = (nstripe / sc->sc_ndisks) * stripesize + start; */
264b09121f9SPawel Jakub Dawidek 	off = ((nstripe / sc->sc_ndisks) << sc->sc_stripebits) + start;
265b09121f9SPawel Jakub Dawidek 	/* Length of data to operate. */
266b09121f9SPawel Jakub Dawidek 	length = MIN(bp->bio_length, stripesize - start);
267b09121f9SPawel Jakub Dawidek 
268b09121f9SPawel Jakub Dawidek 	cbp = g_clone_bio(bp);
269b09121f9SPawel Jakub Dawidek 	if (cbp == NULL) {
270b09121f9SPawel Jakub Dawidek 		/*
271b09121f9SPawel Jakub Dawidek 		 * Deny all request. This is pointless
272b09121f9SPawel Jakub Dawidek 		 * to split rest of the request, bacause
273b09121f9SPawel Jakub Dawidek 		 * we're setting bio_error here, so all
274b09121f9SPawel Jakub Dawidek 		 * request will be denied, anyway.
275b09121f9SPawel Jakub Dawidek 		 */
276b09121f9SPawel Jakub Dawidek 		bp->bio_completed = bp->bio_length;
277b09121f9SPawel Jakub Dawidek 		if (bp->bio_error == 0)
278b09121f9SPawel Jakub Dawidek 			bp->bio_error = ENOMEM;
279b09121f9SPawel Jakub Dawidek 		g_io_deliver(bp, bp->bio_error);
280b09121f9SPawel Jakub Dawidek 		return;
281b09121f9SPawel Jakub Dawidek 	}
282b09121f9SPawel Jakub Dawidek 	/*
283b09121f9SPawel Jakub Dawidek 	 * Fill in the component buf structure.
284b09121f9SPawel Jakub Dawidek 	 */
285b09121f9SPawel Jakub Dawidek 	cbp->bio_done = g_std_done;
286b09121f9SPawel Jakub Dawidek 	cbp->bio_offset = off;
287b09121f9SPawel Jakub Dawidek 	cbp->bio_data = addr;
288b09121f9SPawel Jakub Dawidek 	cbp->bio_length = length;
289b09121f9SPawel Jakub Dawidek 	cbp->bio_to = sc->sc_disks[no]->provider;
290b09121f9SPawel Jakub Dawidek 	G_STRIPE_LOGREQ(cbp, "Sending request.");
291b09121f9SPawel Jakub Dawidek 	g_io_request(cbp, sc->sc_disks[no]);
292b09121f9SPawel Jakub Dawidek 
293b09121f9SPawel Jakub Dawidek 	/* off -= off % stripesize; */
294b09121f9SPawel Jakub Dawidek 	off -= off & (stripesize - 1);
295b09121f9SPawel Jakub Dawidek 	addr += length;
296b09121f9SPawel Jakub Dawidek 	length = bp->bio_length - length;
297b09121f9SPawel Jakub Dawidek 	for (no++; length > 0; no++, length -= stripesize, addr += stripesize) {
298b09121f9SPawel Jakub Dawidek 		if (no > sc->sc_ndisks - 1) {
299b09121f9SPawel Jakub Dawidek 			no = 0;
300b09121f9SPawel Jakub Dawidek 			off += stripesize;
301b09121f9SPawel Jakub Dawidek 		}
302b09121f9SPawel Jakub Dawidek 		cbp = g_clone_bio(bp);
303b09121f9SPawel Jakub Dawidek 		if (cbp == NULL) {
304b09121f9SPawel Jakub Dawidek 			/*
305b09121f9SPawel Jakub Dawidek 			 * Deny remaining part. This is pointless
306b09121f9SPawel Jakub Dawidek 			 * to split rest of the request, bacause
307b09121f9SPawel Jakub Dawidek 			 * we're setting bio_error here, so all
308b09121f9SPawel Jakub Dawidek 			 * request will be denied, anyway.
309b09121f9SPawel Jakub Dawidek 			 */
310b09121f9SPawel Jakub Dawidek 			bp->bio_completed += length;
311b09121f9SPawel Jakub Dawidek 			if (bp->bio_error == 0)
312b09121f9SPawel Jakub Dawidek 				bp->bio_error = ENOMEM;
313b09121f9SPawel Jakub Dawidek 			if (bp->bio_completed == bp->bio_length)
314b09121f9SPawel Jakub Dawidek 				g_io_deliver(bp, bp->bio_error);
315b09121f9SPawel Jakub Dawidek 			return;
316b09121f9SPawel Jakub Dawidek 		}
317b09121f9SPawel Jakub Dawidek 
318b09121f9SPawel Jakub Dawidek 		/*
319b09121f9SPawel Jakub Dawidek 		 * Fill in the component buf structure.
320b09121f9SPawel Jakub Dawidek 		 */
321b09121f9SPawel Jakub Dawidek 		cbp->bio_done = g_std_done;
322b09121f9SPawel Jakub Dawidek 		cbp->bio_offset = off;
323b09121f9SPawel Jakub Dawidek 		cbp->bio_data = addr;
324b09121f9SPawel Jakub Dawidek 		/*
325b09121f9SPawel Jakub Dawidek 		 * MIN() is in case when
326b09121f9SPawel Jakub Dawidek 		 * (bp->bio_length % sc->sc_stripesize) != 0.
327b09121f9SPawel Jakub Dawidek 		 */
328b09121f9SPawel Jakub Dawidek 		cbp->bio_length = MIN(stripesize, length);
329b09121f9SPawel Jakub Dawidek 
330b09121f9SPawel Jakub Dawidek 		cbp->bio_to = sc->sc_disks[no]->provider;
331b09121f9SPawel Jakub Dawidek 		G_STRIPE_LOGREQ(cbp, "Sending request.");
332b09121f9SPawel Jakub Dawidek 		g_io_request(cbp, sc->sc_disks[no]);
333b09121f9SPawel Jakub Dawidek 	}
334b09121f9SPawel Jakub Dawidek }
335b09121f9SPawel Jakub Dawidek 
336b09121f9SPawel Jakub Dawidek static void
337b09121f9SPawel Jakub Dawidek g_stripe_check_and_run(struct g_stripe_softc *sc)
338b09121f9SPawel Jakub Dawidek {
339b09121f9SPawel Jakub Dawidek 	off_t mediasize, ms;
340b09121f9SPawel Jakub Dawidek 	u_int no, sectorsize = 0;
341b09121f9SPawel Jakub Dawidek 
342b09121f9SPawel Jakub Dawidek 	if (g_stripe_nvalid(sc) != sc->sc_ndisks)
343b09121f9SPawel Jakub Dawidek 		return;
344b09121f9SPawel Jakub Dawidek 
345b09121f9SPawel Jakub Dawidek 	sc->sc_provider = g_new_providerf(sc->sc_geom, "%s", sc->sc_geom->name);
346b09121f9SPawel Jakub Dawidek 	/*
347b09121f9SPawel Jakub Dawidek 	 * Find the smallest disk.
348b09121f9SPawel Jakub Dawidek 	 */
349b09121f9SPawel Jakub Dawidek 	mediasize = sc->sc_disks[0]->provider->mediasize;
350b09121f9SPawel Jakub Dawidek 	if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC)
351b09121f9SPawel Jakub Dawidek 		mediasize -= sc->sc_disks[0]->provider->sectorsize;
352b09121f9SPawel Jakub Dawidek 	mediasize -= mediasize % sc->sc_stripesize;
353b09121f9SPawel Jakub Dawidek 	sectorsize = sc->sc_disks[0]->provider->sectorsize;
354b09121f9SPawel Jakub Dawidek 	for (no = 1; no < sc->sc_ndisks; no++) {
355b09121f9SPawel Jakub Dawidek 		ms = sc->sc_disks[no]->provider->mediasize;
356b09121f9SPawel Jakub Dawidek 		if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC)
357b09121f9SPawel Jakub Dawidek 			ms -= sc->sc_disks[no]->provider->sectorsize;
358b09121f9SPawel Jakub Dawidek 		ms -= ms % sc->sc_stripesize;
359b09121f9SPawel Jakub Dawidek 		if (ms < mediasize)
360b09121f9SPawel Jakub Dawidek 			mediasize = ms;
361b09121f9SPawel Jakub Dawidek 		sectorsize = lcm(sectorsize,
362b09121f9SPawel Jakub Dawidek 		    sc->sc_disks[no]->provider->sectorsize);
363b09121f9SPawel Jakub Dawidek 	}
364b09121f9SPawel Jakub Dawidek 	sc->sc_provider->sectorsize = sectorsize;
365b09121f9SPawel Jakub Dawidek 	sc->sc_provider->mediasize = mediasize * sc->sc_ndisks;
366b09121f9SPawel Jakub Dawidek 	g_error_provider(sc->sc_provider, 0);
367b09121f9SPawel Jakub Dawidek 
368b09121f9SPawel Jakub Dawidek 	G_STRIPE_DEBUG(0, "Device %s activated.", sc->sc_geom->name);
369b09121f9SPawel Jakub Dawidek }
370b09121f9SPawel Jakub Dawidek 
371b09121f9SPawel Jakub Dawidek static int
372b09121f9SPawel Jakub Dawidek g_stripe_read_metadata(struct g_consumer *cp, struct g_stripe_metadata *md)
373b09121f9SPawel Jakub Dawidek {
374b09121f9SPawel Jakub Dawidek 	struct g_provider *pp;
375b09121f9SPawel Jakub Dawidek 	u_char *buf;
376b09121f9SPawel Jakub Dawidek 	int error;
377b09121f9SPawel Jakub Dawidek 
378b09121f9SPawel Jakub Dawidek 	g_topology_assert();
379b09121f9SPawel Jakub Dawidek 
380b09121f9SPawel Jakub Dawidek 	error = g_access(cp, 1, 0, 0);
381b09121f9SPawel Jakub Dawidek 	if (error != 0)
382b09121f9SPawel Jakub Dawidek 		return (error);
383b09121f9SPawel Jakub Dawidek 	pp = cp->provider;
384b09121f9SPawel Jakub Dawidek 	g_topology_unlock();
385b09121f9SPawel Jakub Dawidek 	buf = g_read_data(cp, pp->mediasize - pp->sectorsize, pp->sectorsize,
386b09121f9SPawel Jakub Dawidek 	    &error);
387b09121f9SPawel Jakub Dawidek 	g_topology_lock();
388b09121f9SPawel Jakub Dawidek 	g_access(cp, -1, 0, 0);
389b09121f9SPawel Jakub Dawidek 	if (buf == NULL)
390b09121f9SPawel Jakub Dawidek 		return (error);
391b09121f9SPawel Jakub Dawidek 
392b09121f9SPawel Jakub Dawidek 	/* Decode metadata. */
393b09121f9SPawel Jakub Dawidek 	stripe_metadata_decode(buf, md);
394b09121f9SPawel Jakub Dawidek 	g_free(buf);
395b09121f9SPawel Jakub Dawidek 
396b09121f9SPawel Jakub Dawidek 	return (0);
397b09121f9SPawel Jakub Dawidek }
398b09121f9SPawel Jakub Dawidek 
399b09121f9SPawel Jakub Dawidek /*
400b09121f9SPawel Jakub Dawidek  * Add disk to given device.
401b09121f9SPawel Jakub Dawidek  */
402b09121f9SPawel Jakub Dawidek static int
403b09121f9SPawel Jakub Dawidek g_stripe_add_disk(struct g_stripe_softc *sc, struct g_provider *pp, u_int no)
404b09121f9SPawel Jakub Dawidek {
405b09121f9SPawel Jakub Dawidek 	struct g_consumer *cp, *fcp;
406b09121f9SPawel Jakub Dawidek 	struct g_geom *gp;
407b09121f9SPawel Jakub Dawidek 	int error;
408b09121f9SPawel Jakub Dawidek 
409b09121f9SPawel Jakub Dawidek 	/* Metadata corrupted? */
410b09121f9SPawel Jakub Dawidek 	if (no >= sc->sc_ndisks)
411b09121f9SPawel Jakub Dawidek 		return (EINVAL);
412b09121f9SPawel Jakub Dawidek 
413b09121f9SPawel Jakub Dawidek 	/* Check if disk is not already attached. */
414b09121f9SPawel Jakub Dawidek 	if (sc->sc_disks[no] != NULL)
415b09121f9SPawel Jakub Dawidek 		return (EEXIST);
416b09121f9SPawel Jakub Dawidek 
417b09121f9SPawel Jakub Dawidek 	gp = sc->sc_geom;
418b09121f9SPawel Jakub Dawidek 	fcp = LIST_FIRST(&gp->consumer);
419b09121f9SPawel Jakub Dawidek 
420b09121f9SPawel Jakub Dawidek 	cp = g_new_consumer(gp);
421b09121f9SPawel Jakub Dawidek 	error = g_attach(cp, pp);
422b09121f9SPawel Jakub Dawidek 	if (error != 0) {
423b09121f9SPawel Jakub Dawidek 		g_destroy_consumer(cp);
424b09121f9SPawel Jakub Dawidek 		return (error);
425b09121f9SPawel Jakub Dawidek 	}
426b09121f9SPawel Jakub Dawidek 
427b09121f9SPawel Jakub Dawidek 	if (fcp != NULL && (fcp->acr > 0 || fcp->acw > 0 || fcp->ace > 0)) {
428b09121f9SPawel Jakub Dawidek 		error = g_access(cp, fcp->acr, fcp->acw, fcp->ace);
429b09121f9SPawel Jakub Dawidek 		if (error != 0) {
430b09121f9SPawel Jakub Dawidek 			g_detach(cp);
431b09121f9SPawel Jakub Dawidek 			g_destroy_consumer(cp);
432b09121f9SPawel Jakub Dawidek 			return (error);
433b09121f9SPawel Jakub Dawidek 		}
434b09121f9SPawel Jakub Dawidek 	}
435b09121f9SPawel Jakub Dawidek 	if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC) {
436b09121f9SPawel Jakub Dawidek 		struct g_stripe_metadata md;
437b09121f9SPawel Jakub Dawidek 
438b09121f9SPawel Jakub Dawidek 		/* Reread metadata. */
439b09121f9SPawel Jakub Dawidek 		error = g_stripe_read_metadata(cp, &md);
440b09121f9SPawel Jakub Dawidek 		if (error != 0)
441b09121f9SPawel Jakub Dawidek 			goto fail;
442b09121f9SPawel Jakub Dawidek 
443b09121f9SPawel Jakub Dawidek 		if (strcmp(md.md_magic, G_STRIPE_MAGIC) != 0 ||
444b09121f9SPawel Jakub Dawidek 		    strcmp(md.md_name, sc->sc_name) != 0 ||
445b09121f9SPawel Jakub Dawidek 		    md.md_id != sc->sc_id) {
446b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(0, "Metadata on %s changed.", pp->name);
447b09121f9SPawel Jakub Dawidek 			goto fail;
448b09121f9SPawel Jakub Dawidek 		}
449b09121f9SPawel Jakub Dawidek 	}
450b09121f9SPawel Jakub Dawidek 
451b09121f9SPawel Jakub Dawidek 	cp->private = sc;
452b09121f9SPawel Jakub Dawidek 	cp->index = no;
453b09121f9SPawel Jakub Dawidek 	sc->sc_disks[no] = cp;
454b09121f9SPawel Jakub Dawidek 
455b09121f9SPawel Jakub Dawidek 	G_STRIPE_DEBUG(0, "Disk %s attached to %s.", pp->name, gp->name);
456b09121f9SPawel Jakub Dawidek 
457b09121f9SPawel Jakub Dawidek 	g_stripe_check_and_run(sc);
458b09121f9SPawel Jakub Dawidek 
459b09121f9SPawel Jakub Dawidek 	return (0);
460b09121f9SPawel Jakub Dawidek fail:
461b09121f9SPawel Jakub Dawidek 	if (fcp != NULL && (fcp->acr > 0 || fcp->acw > 0 || fcp->ace > 0))
462b09121f9SPawel Jakub Dawidek 		g_access(cp, -fcp->acr, -fcp->acw, -fcp->ace);
463b09121f9SPawel Jakub Dawidek 	g_detach(cp);
464b09121f9SPawel Jakub Dawidek 	g_destroy_consumer(cp);
465b09121f9SPawel Jakub Dawidek 	return (error);
466b09121f9SPawel Jakub Dawidek }
467b09121f9SPawel Jakub Dawidek 
468b09121f9SPawel Jakub Dawidek static struct g_geom *
469b09121f9SPawel Jakub Dawidek g_stripe_create(struct g_class *mp, const struct g_stripe_metadata *md,
470b09121f9SPawel Jakub Dawidek     u_int type)
471b09121f9SPawel Jakub Dawidek {
472b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
473b09121f9SPawel Jakub Dawidek 	struct g_geom *gp;
474b09121f9SPawel Jakub Dawidek 	u_int no;
475b09121f9SPawel Jakub Dawidek 
476b09121f9SPawel Jakub Dawidek 	G_STRIPE_DEBUG(1, "Creating device %s.stripe (id=%u).", md->md_name,
477b09121f9SPawel Jakub Dawidek 	    md->md_id);
478b09121f9SPawel Jakub Dawidek 
479b09121f9SPawel Jakub Dawidek 	/* Two disks is minimum. */
480b09121f9SPawel Jakub Dawidek 	if (md->md_all <= 1) {
481b09121f9SPawel Jakub Dawidek 		G_STRIPE_DEBUG(0, "Too few disks defined for %s.stripe.",
482b09121f9SPawel Jakub Dawidek 		    md->md_name);
483b09121f9SPawel Jakub Dawidek 		return (NULL);
484b09121f9SPawel Jakub Dawidek 	}
485b09121f9SPawel Jakub Dawidek #if 0
486b09121f9SPawel Jakub Dawidek 	/* Stripe size have to be grater than or equal to sector size. */
487b09121f9SPawel Jakub Dawidek 	if (md->md_stripesize < sectorsize) {
488b09121f9SPawel Jakub Dawidek 		G_STRIPE_DEBUG(0, "Invalid stripe size for %s.stripe.",
489b09121f9SPawel Jakub Dawidek 		    md->md_name);
490b09121f9SPawel Jakub Dawidek 		return (NULL);
491b09121f9SPawel Jakub Dawidek 	}
492b09121f9SPawel Jakub Dawidek #endif
493b09121f9SPawel Jakub Dawidek 	/* Stripe size have to be power of 2. */
494b09121f9SPawel Jakub Dawidek 	if (!powerof2(md->md_stripesize)) {
495b09121f9SPawel Jakub Dawidek 		G_STRIPE_DEBUG(0, "Invalid stripe size for %s.stripe.",
496b09121f9SPawel Jakub Dawidek 		    md->md_name);
497b09121f9SPawel Jakub Dawidek 		return (NULL);
498b09121f9SPawel Jakub Dawidek 	}
499b09121f9SPawel Jakub Dawidek 
500b09121f9SPawel Jakub Dawidek 	/* Check for duplicate unit */
501b09121f9SPawel Jakub Dawidek 	LIST_FOREACH(gp, &mp->geom, geom) {
502b09121f9SPawel Jakub Dawidek 		sc = gp->softc;
503b09121f9SPawel Jakub Dawidek 		if (sc != NULL && strcmp(sc->sc_name, md->md_name) == 0) {
504b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(0, "Device %s already configured.",
505b09121f9SPawel Jakub Dawidek 			    gp->name);
506b09121f9SPawel Jakub Dawidek 			return (NULL);
507b09121f9SPawel Jakub Dawidek 		}
508b09121f9SPawel Jakub Dawidek 	}
509b09121f9SPawel Jakub Dawidek 	gp = g_new_geomf(mp, "%s.stripe", md->md_name);
510b09121f9SPawel Jakub Dawidek 	gp->softc = NULL;	/* for a moment */
511b09121f9SPawel Jakub Dawidek 
512b09121f9SPawel Jakub Dawidek 	sc = malloc(sizeof(*sc), M_STRIPE, M_NOWAIT | M_ZERO);
513b09121f9SPawel Jakub Dawidek 	if (sc == NULL) {
514b09121f9SPawel Jakub Dawidek 		G_STRIPE_DEBUG(0, "Can't allocate memory for device %s.",
515b09121f9SPawel Jakub Dawidek 		    gp->name);
516b09121f9SPawel Jakub Dawidek 		g_destroy_geom(gp);
517b09121f9SPawel Jakub Dawidek 		return (NULL);
518b09121f9SPawel Jakub Dawidek 	}
519b09121f9SPawel Jakub Dawidek 
520b09121f9SPawel Jakub Dawidek 	gp->start = g_stripe_start;
521b09121f9SPawel Jakub Dawidek 	gp->spoiled = g_stripe_orphan;
522b09121f9SPawel Jakub Dawidek 	gp->orphan = g_stripe_orphan;
523b09121f9SPawel Jakub Dawidek 	gp->access = g_stripe_access;
524b09121f9SPawel Jakub Dawidek 	gp->dumpconf = g_stripe_dumpconf;
525b09121f9SPawel Jakub Dawidek 
526b09121f9SPawel Jakub Dawidek 	strlcpy(sc->sc_name, md->md_name, sizeof(sc->sc_name));
527b09121f9SPawel Jakub Dawidek 	sc->sc_id = md->md_id;
528b09121f9SPawel Jakub Dawidek 	sc->sc_stripesize = md->md_stripesize;
529b09121f9SPawel Jakub Dawidek 	sc->sc_stripebits = BITCOUNT(sc->sc_stripesize - 1);
530b09121f9SPawel Jakub Dawidek 	sc->sc_ndisks = md->md_all;
531b09121f9SPawel Jakub Dawidek 	sc->sc_disks = malloc(sizeof(struct g_consumer *) * sc->sc_ndisks,
532b09121f9SPawel Jakub Dawidek 	    M_STRIPE, M_WAITOK | M_ZERO);
533b09121f9SPawel Jakub Dawidek 	for (no = 0; no < sc->sc_ndisks; no++)
534b09121f9SPawel Jakub Dawidek 		sc->sc_disks[no] = NULL;
535b09121f9SPawel Jakub Dawidek 	sc->sc_type = type;
536b09121f9SPawel Jakub Dawidek 
537b09121f9SPawel Jakub Dawidek 	gp->softc = sc;
538b09121f9SPawel Jakub Dawidek 	sc->sc_geom = gp;
539b09121f9SPawel Jakub Dawidek 	sc->sc_provider = NULL;
540b09121f9SPawel Jakub Dawidek 
541b09121f9SPawel Jakub Dawidek 	G_STRIPE_DEBUG(0, "Device %s created (id=%u).", gp->name, sc->sc_id);
542b09121f9SPawel Jakub Dawidek 
543b09121f9SPawel Jakub Dawidek 	return (gp);
544b09121f9SPawel Jakub Dawidek }
545b09121f9SPawel Jakub Dawidek 
546b09121f9SPawel Jakub Dawidek static int
547b09121f9SPawel Jakub Dawidek g_stripe_destroy(struct g_stripe_softc *sc, boolean_t force)
548b09121f9SPawel Jakub Dawidek {
549b09121f9SPawel Jakub Dawidek 	struct g_provider *pp;
550b09121f9SPawel Jakub Dawidek 	struct g_geom *gp;
551b09121f9SPawel Jakub Dawidek 	u_int no;
552b09121f9SPawel Jakub Dawidek 
553b09121f9SPawel Jakub Dawidek 	g_topology_assert();
554b09121f9SPawel Jakub Dawidek 
555b09121f9SPawel Jakub Dawidek 	if (sc == NULL)
556b09121f9SPawel Jakub Dawidek 		return (ENXIO);
557b09121f9SPawel Jakub Dawidek 
558b09121f9SPawel Jakub Dawidek 	pp = sc->sc_provider;
559b09121f9SPawel Jakub Dawidek 	if (pp != NULL && (pp->acr != 0 || pp->acw != 0 || pp->ace != 0)) {
560b09121f9SPawel Jakub Dawidek 		if (force) {
561b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(0, "Device %s is still open, so it "
562b09121f9SPawel Jakub Dawidek 			    "can't be definitely removed.", pp->name);
563b09121f9SPawel Jakub Dawidek 		} else {
564b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(1,
565b09121f9SPawel Jakub Dawidek 			    "Device %s is still open (r%dw%de%d).", pp->name,
566b09121f9SPawel Jakub Dawidek 			    pp->acr, pp->acw, pp->ace);
567b09121f9SPawel Jakub Dawidek 			return (EBUSY);
568b09121f9SPawel Jakub Dawidek 		}
569b09121f9SPawel Jakub Dawidek 	}
570b09121f9SPawel Jakub Dawidek 
571b09121f9SPawel Jakub Dawidek 	for (no = 0; no < sc->sc_ndisks; no++) {
572b09121f9SPawel Jakub Dawidek 		if (sc->sc_disks[no] != NULL)
573b09121f9SPawel Jakub Dawidek 			g_stripe_remove_disk(sc->sc_disks[no]);
574b09121f9SPawel Jakub Dawidek 	}
575b09121f9SPawel Jakub Dawidek 
576b09121f9SPawel Jakub Dawidek 	gp = sc->sc_geom;
577b09121f9SPawel Jakub Dawidek 	gp->softc = NULL;
578b09121f9SPawel Jakub Dawidek 	KASSERT(sc->sc_provider == NULL, ("Provider still exists? (device=%s)",
579b09121f9SPawel Jakub Dawidek 	    gp->name));
580b09121f9SPawel Jakub Dawidek 	free(sc->sc_disks, M_STRIPE);
581b09121f9SPawel Jakub Dawidek 	free(sc, M_STRIPE);
582b09121f9SPawel Jakub Dawidek 
583b09121f9SPawel Jakub Dawidek 	pp = LIST_FIRST(&gp->provider);
584b09121f9SPawel Jakub Dawidek 	if (pp == NULL || (pp->acr == 0 && pp->acw == 0 && pp->ace == 0))
585b09121f9SPawel Jakub Dawidek 		G_STRIPE_DEBUG(0, "Device %s destroyed.", gp->name);
586b09121f9SPawel Jakub Dawidek 
587b09121f9SPawel Jakub Dawidek 	g_wither_geom(gp, ENXIO);
588b09121f9SPawel Jakub Dawidek 
589b09121f9SPawel Jakub Dawidek 	return (0);
590b09121f9SPawel Jakub Dawidek }
591b09121f9SPawel Jakub Dawidek 
592b09121f9SPawel Jakub Dawidek static int
593b09121f9SPawel Jakub Dawidek g_stripe_destroy_geom(struct gctl_req *req __unused,
594b09121f9SPawel Jakub Dawidek     struct g_class *mp __unused, struct g_geom *gp)
595b09121f9SPawel Jakub Dawidek {
596b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
597b09121f9SPawel Jakub Dawidek 
598b09121f9SPawel Jakub Dawidek 	sc = gp->softc;
599b09121f9SPawel Jakub Dawidek 	return (g_stripe_destroy(sc, 0));
600b09121f9SPawel Jakub Dawidek }
601b09121f9SPawel Jakub Dawidek 
602b09121f9SPawel Jakub Dawidek static struct g_geom *
603b09121f9SPawel Jakub Dawidek g_stripe_taste(struct g_class *mp, struct g_provider *pp, int flags __unused)
604b09121f9SPawel Jakub Dawidek {
605b09121f9SPawel Jakub Dawidek 	struct g_stripe_metadata md;
606b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
607b09121f9SPawel Jakub Dawidek 	struct g_consumer *cp;
608b09121f9SPawel Jakub Dawidek 	struct g_geom *gp;
609b09121f9SPawel Jakub Dawidek 	int error;
610b09121f9SPawel Jakub Dawidek 
611b09121f9SPawel Jakub Dawidek 	g_trace(G_T_TOPOLOGY, "%s(%s, %s)", __func__, mp->name, pp->name);
612b09121f9SPawel Jakub Dawidek 	g_topology_assert();
613b09121f9SPawel Jakub Dawidek 
614b09121f9SPawel Jakub Dawidek 	G_STRIPE_DEBUG(3, "Tasting %s.", pp->name);
615b09121f9SPawel Jakub Dawidek 
616b09121f9SPawel Jakub Dawidek 	gp = g_new_geomf(mp, "stripe:taste");
617b09121f9SPawel Jakub Dawidek 	gp->start = g_stripe_start;
618b09121f9SPawel Jakub Dawidek 	gp->access = g_stripe_access;
619b09121f9SPawel Jakub Dawidek 	gp->orphan = g_stripe_orphan;
620b09121f9SPawel Jakub Dawidek 	cp = g_new_consumer(gp);
621b09121f9SPawel Jakub Dawidek 	g_attach(cp, pp);
622b09121f9SPawel Jakub Dawidek 
623b09121f9SPawel Jakub Dawidek 	error = g_stripe_read_metadata(cp, &md);
624b09121f9SPawel Jakub Dawidek 	g_wither_geom(gp, ENXIO);
625b09121f9SPawel Jakub Dawidek 	if (error != 0)
626b09121f9SPawel Jakub Dawidek 		return (NULL);
627b09121f9SPawel Jakub Dawidek 	gp = NULL;
628b09121f9SPawel Jakub Dawidek 
629b09121f9SPawel Jakub Dawidek 	if (strcmp(md.md_magic, G_STRIPE_MAGIC) != 0)
630b09121f9SPawel Jakub Dawidek 		return (NULL);
631b09121f9SPawel Jakub Dawidek 	if (md.md_version > G_STRIPE_VERSION) {
632b09121f9SPawel Jakub Dawidek 		printf("geom_stripe.ko module is too old to handle %s.\n",
633b09121f9SPawel Jakub Dawidek 		    pp->name);
634b09121f9SPawel Jakub Dawidek 		return (NULL);
635b09121f9SPawel Jakub Dawidek 	}
636b09121f9SPawel Jakub Dawidek 
637b09121f9SPawel Jakub Dawidek 	/*
638b09121f9SPawel Jakub Dawidek 	 * Let's check if device already exists.
639b09121f9SPawel Jakub Dawidek 	 */
640b09121f9SPawel Jakub Dawidek 	sc = NULL;
641b09121f9SPawel Jakub Dawidek 	LIST_FOREACH(gp, &mp->geom, geom) {
642b09121f9SPawel Jakub Dawidek 		sc = gp->softc;
643b09121f9SPawel Jakub Dawidek 		if (sc == NULL)
644b09121f9SPawel Jakub Dawidek 			continue;
645b09121f9SPawel Jakub Dawidek 		if (sc->sc_type != G_STRIPE_TYPE_AUTOMATIC)
646b09121f9SPawel Jakub Dawidek 			continue;
647b09121f9SPawel Jakub Dawidek 		if (strcmp(md.md_name, sc->sc_name) != 0)
648b09121f9SPawel Jakub Dawidek 			continue;
649b09121f9SPawel Jakub Dawidek 		if (md.md_id != sc->sc_id)
650b09121f9SPawel Jakub Dawidek 			continue;
651b09121f9SPawel Jakub Dawidek 		break;
652b09121f9SPawel Jakub Dawidek 	}
653b09121f9SPawel Jakub Dawidek 	if (gp != NULL) {
654b09121f9SPawel Jakub Dawidek 		G_STRIPE_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name);
655b09121f9SPawel Jakub Dawidek 		error = g_stripe_add_disk(sc, pp, md.md_no);
656b09121f9SPawel Jakub Dawidek 		if (error != 0) {
657b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(0,
658b09121f9SPawel Jakub Dawidek 			    "Cannot add disk %s to %s (error=%d).", pp->name,
659b09121f9SPawel Jakub Dawidek 			    gp->name, error);
660b09121f9SPawel Jakub Dawidek 			return (NULL);
661b09121f9SPawel Jakub Dawidek 		}
662b09121f9SPawel Jakub Dawidek 	} else {
663b09121f9SPawel Jakub Dawidek 		gp = g_stripe_create(mp, &md, G_STRIPE_TYPE_AUTOMATIC);
664b09121f9SPawel Jakub Dawidek 		if (gp == NULL) {
665b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(0, "Cannot create device %s.stripe.",
666b09121f9SPawel Jakub Dawidek 			    md.md_name);
667b09121f9SPawel Jakub Dawidek 			return (NULL);
668b09121f9SPawel Jakub Dawidek 		}
669b09121f9SPawel Jakub Dawidek 		sc = gp->softc;
670b09121f9SPawel Jakub Dawidek 		G_STRIPE_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name);
671b09121f9SPawel Jakub Dawidek 		error = g_stripe_add_disk(sc, pp, md.md_no);
672b09121f9SPawel Jakub Dawidek 		if (error != 0) {
673b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(0,
674b09121f9SPawel Jakub Dawidek 			    "Cannot add disk %s to %s (error=%d).", pp->name,
675b09121f9SPawel Jakub Dawidek 			    gp->name, error);
676b09121f9SPawel Jakub Dawidek 			g_stripe_destroy(sc, 1);
677b09121f9SPawel Jakub Dawidek 			return (NULL);
678b09121f9SPawel Jakub Dawidek 		}
679b09121f9SPawel Jakub Dawidek 	}
680b09121f9SPawel Jakub Dawidek 
681b09121f9SPawel Jakub Dawidek 	return (gp);
682b09121f9SPawel Jakub Dawidek }
683b09121f9SPawel Jakub Dawidek 
684b09121f9SPawel Jakub Dawidek static void
685b09121f9SPawel Jakub Dawidek g_stripe_ctl_create(struct gctl_req *req, struct g_class *mp)
686b09121f9SPawel Jakub Dawidek {
687b09121f9SPawel Jakub Dawidek 	u_int attached, no;
688b09121f9SPawel Jakub Dawidek 	struct g_stripe_metadata md;
689b09121f9SPawel Jakub Dawidek 	struct g_provider *pp;
690b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
691b09121f9SPawel Jakub Dawidek 	struct g_geom *gp;
692b09121f9SPawel Jakub Dawidek 	struct sbuf *sb;
693b09121f9SPawel Jakub Dawidek 	intmax_t *stripesize;
694b09121f9SPawel Jakub Dawidek 	const char *name;
695b09121f9SPawel Jakub Dawidek 	char param[16];
696b09121f9SPawel Jakub Dawidek 	int *nargs;
697b09121f9SPawel Jakub Dawidek 
698b09121f9SPawel Jakub Dawidek 	g_topology_assert();
699b09121f9SPawel Jakub Dawidek 	nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs));
700b09121f9SPawel Jakub Dawidek 	if (nargs == NULL) {
701b09121f9SPawel Jakub Dawidek 		gctl_error(req, "No '%s' argument.", "nargs");
702b09121f9SPawel Jakub Dawidek 		return;
703b09121f9SPawel Jakub Dawidek 	}
704b09121f9SPawel Jakub Dawidek 	if (*nargs <= 2) {
705b09121f9SPawel Jakub Dawidek 		gctl_error(req, "Too few arguments.");
706b09121f9SPawel Jakub Dawidek 		return;
707b09121f9SPawel Jakub Dawidek 	}
708b09121f9SPawel Jakub Dawidek 
709b09121f9SPawel Jakub Dawidek 	strlcpy(md.md_magic, G_STRIPE_MAGIC, sizeof(md.md_magic));
710b09121f9SPawel Jakub Dawidek 	md.md_version = G_STRIPE_VERSION;
711b09121f9SPawel Jakub Dawidek 	name = gctl_get_asciiparam(req, "arg0");
712b09121f9SPawel Jakub Dawidek 	if (name == NULL) {
713b09121f9SPawel Jakub Dawidek 		gctl_error(req, "No 'arg%u' argument.", 0);
714b09121f9SPawel Jakub Dawidek 		return;
715b09121f9SPawel Jakub Dawidek 	}
716b09121f9SPawel Jakub Dawidek 	strlcpy(md.md_name, name, sizeof(md.md_name));
717b09121f9SPawel Jakub Dawidek 	md.md_id = arc4random();
718b09121f9SPawel Jakub Dawidek 	md.md_no = 0;
719b09121f9SPawel Jakub Dawidek 	md.md_all = *nargs - 1;
720b09121f9SPawel Jakub Dawidek 	stripesize = gctl_get_paraml(req, "stripesize", sizeof(*stripesize));
721b09121f9SPawel Jakub Dawidek 	if (stripesize == NULL) {
722b09121f9SPawel Jakub Dawidek 		gctl_error(req, "No '%s' argument.", "stripesize");
723b09121f9SPawel Jakub Dawidek 		return;
724b09121f9SPawel Jakub Dawidek 	}
725b09121f9SPawel Jakub Dawidek 	md.md_stripesize = *stripesize;
726b09121f9SPawel Jakub Dawidek 
727b09121f9SPawel Jakub Dawidek 	/* Check all providers are valid */
728b09121f9SPawel Jakub Dawidek 	for (no = 1; no < *nargs; no++) {
729b09121f9SPawel Jakub Dawidek 		snprintf(param, sizeof(param), "arg%u", no);
730b09121f9SPawel Jakub Dawidek 		name = gctl_get_asciiparam(req, param);
731b09121f9SPawel Jakub Dawidek 		if (name == NULL) {
732b09121f9SPawel Jakub Dawidek 			gctl_error(req, "No 'arg%u' argument.", no);
733b09121f9SPawel Jakub Dawidek 			return;
734b09121f9SPawel Jakub Dawidek 		}
735b09121f9SPawel Jakub Dawidek 		if (strncmp(name, "/dev/", strlen("/dev/")) == 0)
736b09121f9SPawel Jakub Dawidek 			name += strlen("/dev/");
737b09121f9SPawel Jakub Dawidek 		pp = g_provider_by_name(name);
738b09121f9SPawel Jakub Dawidek 		if (pp == NULL) {
739b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(1, "Disk %s is invalid.", name);
740b09121f9SPawel Jakub Dawidek 			gctl_error(req, "Disk %s is invalid.", name);
741b09121f9SPawel Jakub Dawidek 			return;
742b09121f9SPawel Jakub Dawidek 		}
743b09121f9SPawel Jakub Dawidek 	}
744b09121f9SPawel Jakub Dawidek 
745b09121f9SPawel Jakub Dawidek 	gp = g_stripe_create(mp, &md, G_STRIPE_TYPE_MANUAL);
746b09121f9SPawel Jakub Dawidek 	if (gp == NULL) {
747b09121f9SPawel Jakub Dawidek 		gctl_error(req, "Can't configure %s.stripe.", md.md_name);
748b09121f9SPawel Jakub Dawidek 		return;
749b09121f9SPawel Jakub Dawidek 	}
750b09121f9SPawel Jakub Dawidek 
751b09121f9SPawel Jakub Dawidek 	sc = gp->softc;
752b09121f9SPawel Jakub Dawidek 	sb = sbuf_new(NULL, NULL, 0, SBUF_AUTOEXTEND);
753b09121f9SPawel Jakub Dawidek 	sbuf_printf(sb, "Can't attach disk(s) to %s:", gp->name);
754b09121f9SPawel Jakub Dawidek 	for (attached = 0, no = 1; no < *nargs; no++) {
755b09121f9SPawel Jakub Dawidek 		snprintf(param, sizeof(param), "arg%u", no);
756b09121f9SPawel Jakub Dawidek 		name = gctl_get_asciiparam(req, param);
757b09121f9SPawel Jakub Dawidek 		if (strncmp(name, "/dev/", strlen("/dev/")) == 0)
758b09121f9SPawel Jakub Dawidek 			name += strlen("/dev/");
759b09121f9SPawel Jakub Dawidek 		pp = g_provider_by_name(name);
760b09121f9SPawel Jakub Dawidek 		KASSERT(pp != NULL, ("Provider %s disappear?!", name));
761b09121f9SPawel Jakub Dawidek 		if (g_stripe_add_disk(sc, pp, no - 1) != 0) {
762b09121f9SPawel Jakub Dawidek 			G_STRIPE_DEBUG(1, "Disk %u (%s) not attached to %s.",
763b09121f9SPawel Jakub Dawidek 			    no, pp->name, gp->name);
764b09121f9SPawel Jakub Dawidek 			sbuf_printf(sb, " %s", pp->name);
765b09121f9SPawel Jakub Dawidek 			continue;
766b09121f9SPawel Jakub Dawidek 		}
767b09121f9SPawel Jakub Dawidek 		attached++;
768b09121f9SPawel Jakub Dawidek 	}
769b09121f9SPawel Jakub Dawidek 	sbuf_finish(sb);
770b09121f9SPawel Jakub Dawidek 	if (md.md_all != attached) {
771b09121f9SPawel Jakub Dawidek 		g_stripe_destroy(gp->softc, 1);
772b09121f9SPawel Jakub Dawidek 		gctl_error(req, "%s", sbuf_data(sb));
773b09121f9SPawel Jakub Dawidek 	}
774b09121f9SPawel Jakub Dawidek 	sbuf_delete(sb);
775b09121f9SPawel Jakub Dawidek }
776b09121f9SPawel Jakub Dawidek 
777b09121f9SPawel Jakub Dawidek static struct g_stripe_softc *
778b09121f9SPawel Jakub Dawidek g_stripe_find_device(struct g_class *mp, const char *name)
779b09121f9SPawel Jakub Dawidek {
780b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
781b09121f9SPawel Jakub Dawidek 	struct g_geom *gp;
782b09121f9SPawel Jakub Dawidek 
783b09121f9SPawel Jakub Dawidek 	LIST_FOREACH(gp, &mp->geom, geom) {
784b09121f9SPawel Jakub Dawidek 		sc = gp->softc;
785b09121f9SPawel Jakub Dawidek 		if (sc == NULL)
786b09121f9SPawel Jakub Dawidek 			continue;
787b09121f9SPawel Jakub Dawidek 		if (strcmp(gp->name, name) == 0 ||
788b09121f9SPawel Jakub Dawidek 		    strcmp(sc->sc_name, name) == 0) {
789b09121f9SPawel Jakub Dawidek 			return (sc);
790b09121f9SPawel Jakub Dawidek 		}
791b09121f9SPawel Jakub Dawidek 	}
792b09121f9SPawel Jakub Dawidek 	return (NULL);
793b09121f9SPawel Jakub Dawidek }
794b09121f9SPawel Jakub Dawidek 
795b09121f9SPawel Jakub Dawidek static void
796b09121f9SPawel Jakub Dawidek g_stripe_ctl_destroy(struct gctl_req *req, struct g_class *mp)
797b09121f9SPawel Jakub Dawidek {
798b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
799b09121f9SPawel Jakub Dawidek 	int *force, *nargs, error;
800b09121f9SPawel Jakub Dawidek 	const char *name;
801b09121f9SPawel Jakub Dawidek 	char param[16];
802b09121f9SPawel Jakub Dawidek 	u_int i;
803b09121f9SPawel Jakub Dawidek 
804b09121f9SPawel Jakub Dawidek 	g_topology_assert();
805b09121f9SPawel Jakub Dawidek 
806b09121f9SPawel Jakub Dawidek 	nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs));
807b09121f9SPawel Jakub Dawidek 	if (nargs == NULL) {
808b09121f9SPawel Jakub Dawidek 		gctl_error(req, "No '%s' argument.", "nargs");
809b09121f9SPawel Jakub Dawidek 		return;
810b09121f9SPawel Jakub Dawidek 	}
811b09121f9SPawel Jakub Dawidek 	if (*nargs <= 0) {
812b09121f9SPawel Jakub Dawidek 		gctl_error(req, "Missing device(s).");
813b09121f9SPawel Jakub Dawidek 		return;
814b09121f9SPawel Jakub Dawidek 	}
815b09121f9SPawel Jakub Dawidek 	force = gctl_get_paraml(req, "force", sizeof(*force));
816b09121f9SPawel Jakub Dawidek 	if (force == NULL) {
817b09121f9SPawel Jakub Dawidek 		gctl_error(req, "No '%s' argument.", "force");
818b09121f9SPawel Jakub Dawidek 		return;
819b09121f9SPawel Jakub Dawidek 	}
820b09121f9SPawel Jakub Dawidek 
821b09121f9SPawel Jakub Dawidek 	for (i = 0; i < (u_int)*nargs; i++) {
822b09121f9SPawel Jakub Dawidek 		snprintf(param, sizeof(param), "arg%u", i);
823b09121f9SPawel Jakub Dawidek 		name = gctl_get_asciiparam(req, param);
824b09121f9SPawel Jakub Dawidek 		if (name == NULL) {
825b09121f9SPawel Jakub Dawidek 			gctl_error(req, "No 'arg%u' argument.", i);
826b09121f9SPawel Jakub Dawidek 			return;
827b09121f9SPawel Jakub Dawidek 		}
828b09121f9SPawel Jakub Dawidek 		sc = g_stripe_find_device(mp, name);
829b09121f9SPawel Jakub Dawidek 		if (sc == NULL) {
830b09121f9SPawel Jakub Dawidek 			gctl_error(req, "No such device: %s.", name);
831b09121f9SPawel Jakub Dawidek 			return;
832b09121f9SPawel Jakub Dawidek 		}
833b09121f9SPawel Jakub Dawidek 		error = g_stripe_destroy(sc, *force);
834b09121f9SPawel Jakub Dawidek 		if (error != 0) {
835b09121f9SPawel Jakub Dawidek 			gctl_error(req, "Cannot destroy device %s (error=%d).",
836b09121f9SPawel Jakub Dawidek 			    sc->sc_geom->name, error);
837b09121f9SPawel Jakub Dawidek 			return;
838b09121f9SPawel Jakub Dawidek 		}
839b09121f9SPawel Jakub Dawidek 	}
840b09121f9SPawel Jakub Dawidek }
841b09121f9SPawel Jakub Dawidek 
842b09121f9SPawel Jakub Dawidek static void
843b09121f9SPawel Jakub Dawidek g_stripe_config(struct gctl_req *req, struct g_class *mp, const char *verb)
844b09121f9SPawel Jakub Dawidek {
845b09121f9SPawel Jakub Dawidek 	uint32_t *version;
846b09121f9SPawel Jakub Dawidek 
847b09121f9SPawel Jakub Dawidek 	g_topology_assert();
848b09121f9SPawel Jakub Dawidek 
849b09121f9SPawel Jakub Dawidek 	version = gctl_get_paraml(req, "version", sizeof(*version));
850b09121f9SPawel Jakub Dawidek 	if (version == NULL) {
851b09121f9SPawel Jakub Dawidek 		gctl_error(req, "No '%s' argument.", "version");
852b09121f9SPawel Jakub Dawidek 		return;
853b09121f9SPawel Jakub Dawidek 	}
854b09121f9SPawel Jakub Dawidek 	if (*version != G_STRIPE_VERSION) {
855b09121f9SPawel Jakub Dawidek 		gctl_error(req, "Userland and kernel parts are out of sync.");
856b09121f9SPawel Jakub Dawidek 		return;
857b09121f9SPawel Jakub Dawidek 	}
858b09121f9SPawel Jakub Dawidek 
859b09121f9SPawel Jakub Dawidek 	if (strcmp(verb, "create") == 0) {
860b09121f9SPawel Jakub Dawidek 		g_stripe_ctl_create(req, mp);
861b09121f9SPawel Jakub Dawidek 		return;
862b09121f9SPawel Jakub Dawidek 	} else if (strcmp(verb, "destroy") == 0) {
863b09121f9SPawel Jakub Dawidek 		g_stripe_ctl_destroy(req, mp);
864b09121f9SPawel Jakub Dawidek 		return;
865b09121f9SPawel Jakub Dawidek 	}
866b09121f9SPawel Jakub Dawidek 
867b09121f9SPawel Jakub Dawidek 	gctl_error(req, "Unknown verb.");
868b09121f9SPawel Jakub Dawidek }
869b09121f9SPawel Jakub Dawidek 
870b09121f9SPawel Jakub Dawidek static void
871b09121f9SPawel Jakub Dawidek g_stripe_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp,
872b09121f9SPawel Jakub Dawidek     struct g_consumer *cp, struct g_provider *pp)
873b09121f9SPawel Jakub Dawidek {
874b09121f9SPawel Jakub Dawidek 	struct g_stripe_softc *sc;
875b09121f9SPawel Jakub Dawidek 
876b09121f9SPawel Jakub Dawidek 	sc = gp->softc;
877b09121f9SPawel Jakub Dawidek 	if (sc == NULL)
878b09121f9SPawel Jakub Dawidek 		return;
879b09121f9SPawel Jakub Dawidek 	if (gp != NULL) {
880b09121f9SPawel Jakub Dawidek 		sbuf_printf(sb, "%s<id>%u</id>\n", indent, (u_int)sc->sc_id);
881b09121f9SPawel Jakub Dawidek 		sbuf_printf(sb, "%s<stripesize>%u</stripesize>\n", indent,
882b09121f9SPawel Jakub Dawidek 		    (u_int)sc->sc_stripesize);
883b09121f9SPawel Jakub Dawidek 		switch (sc->sc_type) {
884b09121f9SPawel Jakub Dawidek 		case G_STRIPE_TYPE_AUTOMATIC:
885b09121f9SPawel Jakub Dawidek 			sbuf_printf(sb, "%s<type>%s</type>\n", indent,
886b09121f9SPawel Jakub Dawidek 			    "automatic");
887b09121f9SPawel Jakub Dawidek 			break;
888b09121f9SPawel Jakub Dawidek 		case G_STRIPE_TYPE_MANUAL:
889b09121f9SPawel Jakub Dawidek 			sbuf_printf(sb, "%s<type>%s</type>\n", indent,
890b09121f9SPawel Jakub Dawidek 			    "manual");
891b09121f9SPawel Jakub Dawidek 			break;
892b09121f9SPawel Jakub Dawidek 		default:
893b09121f9SPawel Jakub Dawidek 			sbuf_printf(sb, "%s<type>%s</type>\n", indent,
894b09121f9SPawel Jakub Dawidek 			    "unknown");
895b09121f9SPawel Jakub Dawidek 			break;
896b09121f9SPawel Jakub Dawidek 		}
897b09121f9SPawel Jakub Dawidek 	}
898b09121f9SPawel Jakub Dawidek }
899b09121f9SPawel Jakub Dawidek 
900b09121f9SPawel Jakub Dawidek DECLARE_GEOM_CLASS(g_stripe_class, g_stripe);
901