xref: /freebsd/sys/geom/gate/g_gate.c (revision 5d807a0e1a1c76740e5fc2bf871fb2dfb98ebe51)
1fe27e772SPawel Jakub Dawidek /*-
2fc024f7aSPawel Jakub Dawidek  * Copyright (c) 2004-2006 Pawel Jakub Dawidek <pjd@FreeBSD.org>
332115b10SPawel Jakub Dawidek  * Copyright (c) 2009-2010 The FreeBSD Foundation
4fe27e772SPawel Jakub Dawidek  * All rights reserved.
5fe27e772SPawel Jakub Dawidek  *
632115b10SPawel Jakub Dawidek  * Portions of this software were developed by Pawel Jakub Dawidek
732115b10SPawel Jakub Dawidek  * under sponsorship from the FreeBSD Foundation.
832115b10SPawel Jakub Dawidek  *
9fe27e772SPawel Jakub Dawidek  * Redistribution and use in source and binary forms, with or without
10fe27e772SPawel Jakub Dawidek  * modification, are permitted provided that the following conditions
11fe27e772SPawel Jakub Dawidek  * are met:
12fe27e772SPawel Jakub Dawidek  * 1. Redistributions of source code must retain the above copyright
13fe27e772SPawel Jakub Dawidek  *    notice, this list of conditions and the following disclaimer.
14fe27e772SPawel Jakub Dawidek  * 2. Redistributions in binary form must reproduce the above copyright
15fe27e772SPawel Jakub Dawidek  *    notice, this list of conditions and the following disclaimer in the
16fe27e772SPawel Jakub Dawidek  *    documentation and/or other materials provided with the distribution.
17fe27e772SPawel Jakub Dawidek  *
18fe27e772SPawel Jakub Dawidek  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
19fe27e772SPawel Jakub Dawidek  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20fe27e772SPawel Jakub Dawidek  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21fe27e772SPawel Jakub Dawidek  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE
22fe27e772SPawel Jakub Dawidek  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23fe27e772SPawel Jakub Dawidek  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24fe27e772SPawel Jakub Dawidek  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25fe27e772SPawel Jakub Dawidek  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26fe27e772SPawel Jakub Dawidek  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27fe27e772SPawel Jakub Dawidek  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28fe27e772SPawel Jakub Dawidek  * SUCH DAMAGE.
29fe27e772SPawel Jakub Dawidek  */
30fe27e772SPawel Jakub Dawidek 
31c0767902SPawel Jakub Dawidek #include <sys/cdefs.h>
32c0767902SPawel Jakub Dawidek __FBSDID("$FreeBSD$");
33c0767902SPawel Jakub Dawidek 
34fe27e772SPawel Jakub Dawidek #include <sys/param.h>
35fe27e772SPawel Jakub Dawidek #include <sys/systm.h>
36fe27e772SPawel Jakub Dawidek #include <sys/bio.h>
37fe27e772SPawel Jakub Dawidek #include <sys/conf.h>
38fe27e772SPawel Jakub Dawidek #include <sys/kernel.h>
39fe27e772SPawel Jakub Dawidek #include <sys/kthread.h>
40fe27e772SPawel Jakub Dawidek #include <sys/fcntl.h>
41fe27e772SPawel Jakub Dawidek #include <sys/linker.h>
42fe27e772SPawel Jakub Dawidek #include <sys/lock.h>
43fe27e772SPawel Jakub Dawidek #include <sys/malloc.h>
44fe27e772SPawel Jakub Dawidek #include <sys/mutex.h>
45fe27e772SPawel Jakub Dawidek #include <sys/proc.h>
46fe27e772SPawel Jakub Dawidek #include <sys/limits.h>
47fe27e772SPawel Jakub Dawidek #include <sys/queue.h>
48*5d807a0eSAndrey V. Elsukov #include <sys/sbuf.h>
49fe27e772SPawel Jakub Dawidek #include <sys/sysctl.h>
50fe27e772SPawel Jakub Dawidek #include <sys/signalvar.h>
51fe27e772SPawel Jakub Dawidek #include <sys/time.h>
52fe27e772SPawel Jakub Dawidek #include <machine/atomic.h>
53fe27e772SPawel Jakub Dawidek 
54fe27e772SPawel Jakub Dawidek #include <geom/geom.h>
55fe27e772SPawel Jakub Dawidek #include <geom/gate/g_gate.h>
56fe27e772SPawel Jakub Dawidek 
57cb08c2ccSAlexander Leidinger FEATURE(geom_gate, "GEOM Gate module");
58cb08c2ccSAlexander Leidinger 
595bb84bc8SRobert Watson static MALLOC_DEFINE(M_GATE, "gg_data", "GEOM Gate Data");
60fe27e772SPawel Jakub Dawidek 
61fe27e772SPawel Jakub Dawidek SYSCTL_DECL(_kern_geom);
62fe27e772SPawel Jakub Dawidek SYSCTL_NODE(_kern_geom, OID_AUTO, gate, CTLFLAG_RW, 0, "GEOM_GATE stuff");
6332115b10SPawel Jakub Dawidek static int g_gate_debug = 0;
6432115b10SPawel Jakub Dawidek TUNABLE_INT("kern.geom.gate.debug", &g_gate_debug);
6532115b10SPawel Jakub Dawidek SYSCTL_INT(_kern_geom_gate, OID_AUTO, debug, CTLFLAG_RW, &g_gate_debug, 0,
66fe27e772SPawel Jakub Dawidek     "Debug level");
6732115b10SPawel Jakub Dawidek static u_int g_gate_maxunits = 256;
6832115b10SPawel Jakub Dawidek TUNABLE_INT("kern.geom.gate.maxunits", &g_gate_maxunits);
6932115b10SPawel Jakub Dawidek SYSCTL_UINT(_kern_geom_gate, OID_AUTO, maxunits, CTLFLAG_RDTUN,
7032115b10SPawel Jakub Dawidek     &g_gate_maxunits, 0, "Maximum number of ggate devices");
71fe27e772SPawel Jakub Dawidek 
72fe27e772SPawel Jakub Dawidek struct g_class g_gate_class = {
73fe27e772SPawel Jakub Dawidek 	.name = G_GATE_CLASS_NAME,
745721c9c7SPoul-Henning Kamp 	.version = G_VERSION,
75fe27e772SPawel Jakub Dawidek };
76fe27e772SPawel Jakub Dawidek 
7789c9c53dSPoul-Henning Kamp static struct cdev *status_dev;
78fe27e772SPawel Jakub Dawidek static d_ioctl_t g_gate_ioctl;
79fe27e772SPawel Jakub Dawidek static struct cdevsw g_gate_cdevsw = {
80fe27e772SPawel Jakub Dawidek 	.d_version =	D_VERSION,
81fe27e772SPawel Jakub Dawidek 	.d_ioctl =	g_gate_ioctl,
82fe27e772SPawel Jakub Dawidek 	.d_name =	G_GATE_CTL_NAME
83fe27e772SPawel Jakub Dawidek };
84fe27e772SPawel Jakub Dawidek 
85fe27e772SPawel Jakub Dawidek 
8632115b10SPawel Jakub Dawidek static struct g_gate_softc **g_gate_units;
8732115b10SPawel Jakub Dawidek static u_int g_gate_nunits;
8832115b10SPawel Jakub Dawidek static struct mtx g_gate_units_lock;
89fe27e772SPawel Jakub Dawidek 
90fe27e772SPawel Jakub Dawidek static int
91fe27e772SPawel Jakub Dawidek g_gate_destroy(struct g_gate_softc *sc, boolean_t force)
92fe27e772SPawel Jakub Dawidek {
93fe27e772SPawel Jakub Dawidek 	struct g_provider *pp;
947ffb6e0fSPawel Jakub Dawidek 	struct g_geom *gp;
95fe27e772SPawel Jakub Dawidek 	struct bio *bp;
96fe27e772SPawel Jakub Dawidek 
97fe27e772SPawel Jakub Dawidek 	g_topology_assert();
9832115b10SPawel Jakub Dawidek 	mtx_assert(&g_gate_units_lock, MA_OWNED);
99fe27e772SPawel Jakub Dawidek 	pp = sc->sc_provider;
100fe27e772SPawel Jakub Dawidek 	if (!force && (pp->acr != 0 || pp->acw != 0 || pp->ace != 0)) {
10132115b10SPawel Jakub Dawidek 		mtx_unlock(&g_gate_units_lock);
102fe27e772SPawel Jakub Dawidek 		return (EBUSY);
103fe27e772SPawel Jakub Dawidek 	}
10432115b10SPawel Jakub Dawidek 	mtx_unlock(&g_gate_units_lock);
105e35d3a78SPawel Jakub Dawidek 	mtx_lock(&sc->sc_queue_mtx);
1067ffb6e0fSPawel Jakub Dawidek 	if ((sc->sc_flags & G_GATE_FLAG_DESTROY) == 0)
1077ffb6e0fSPawel Jakub Dawidek 		sc->sc_flags |= G_GATE_FLAG_DESTROY;
108fe27e772SPawel Jakub Dawidek 	wakeup(sc);
109e35d3a78SPawel Jakub Dawidek 	mtx_unlock(&sc->sc_queue_mtx);
1107ffb6e0fSPawel Jakub Dawidek 	gp = pp->geom;
1117ffb6e0fSPawel Jakub Dawidek 	pp->flags |= G_PF_WITHER;
1127ffb6e0fSPawel Jakub Dawidek 	g_orphan_provider(pp, ENXIO);
113fe27e772SPawel Jakub Dawidek 	callout_drain(&sc->sc_callout);
114e35d3a78SPawel Jakub Dawidek 	mtx_lock(&sc->sc_queue_mtx);
115b0990a1dSPawel Jakub Dawidek 	while ((bp = bioq_first(&sc->sc_inqueue)) != NULL) {
116fe27e772SPawel Jakub Dawidek 		bioq_remove(&sc->sc_inqueue, bp);
117e35d3a78SPawel Jakub Dawidek 		sc->sc_queue_count--;
118fe27e772SPawel Jakub Dawidek 		G_GATE_LOGREQ(1, bp, "Request canceled.");
119fe27e772SPawel Jakub Dawidek 		g_io_deliver(bp, ENXIO);
120fe27e772SPawel Jakub Dawidek 	}
121b0990a1dSPawel Jakub Dawidek 	while ((bp = bioq_first(&sc->sc_outqueue)) != NULL) {
122fe27e772SPawel Jakub Dawidek 		bioq_remove(&sc->sc_outqueue, bp);
123e35d3a78SPawel Jakub Dawidek 		sc->sc_queue_count--;
124fe27e772SPawel Jakub Dawidek 		G_GATE_LOGREQ(1, bp, "Request canceled.");
125fe27e772SPawel Jakub Dawidek 		g_io_deliver(bp, ENXIO);
126fe27e772SPawel Jakub Dawidek 	}
1277ffb6e0fSPawel Jakub Dawidek 	mtx_unlock(&sc->sc_queue_mtx);
1287ffb6e0fSPawel Jakub Dawidek 	g_topology_unlock();
12932115b10SPawel Jakub Dawidek 	mtx_lock(&g_gate_units_lock);
1307ffb6e0fSPawel Jakub Dawidek 	/* One reference is ours. */
1317ffb6e0fSPawel Jakub Dawidek 	sc->sc_ref--;
13232115b10SPawel Jakub Dawidek 	while (sc->sc_ref > 0)
13332115b10SPawel Jakub Dawidek 		msleep(&sc->sc_ref, &g_gate_units_lock, 0, "gg:destroy", 0);
13432115b10SPawel Jakub Dawidek 	g_gate_units[sc->sc_unit] = NULL;
13532115b10SPawel Jakub Dawidek 	KASSERT(g_gate_nunits > 0, ("negative g_gate_nunits?"));
13632115b10SPawel Jakub Dawidek 	g_gate_nunits--;
13732115b10SPawel Jakub Dawidek 	mtx_unlock(&g_gate_units_lock);
138e35d3a78SPawel Jakub Dawidek 	mtx_destroy(&sc->sc_queue_mtx);
1397ffb6e0fSPawel Jakub Dawidek 	g_topology_lock();
140bd119384SMikolaj Golub 	G_GATE_DEBUG(1, "Device %s destroyed.", gp->name);
1417ffb6e0fSPawel Jakub Dawidek 	gp->softc = NULL;
1427ffb6e0fSPawel Jakub Dawidek 	g_wither_geom(gp, ENXIO);
143fe27e772SPawel Jakub Dawidek 	sc->sc_provider = NULL;
144fe27e772SPawel Jakub Dawidek 	free(sc, M_GATE);
145fe27e772SPawel Jakub Dawidek 	return (0);
146fe27e772SPawel Jakub Dawidek }
147fe27e772SPawel Jakub Dawidek 
148fe27e772SPawel Jakub Dawidek static int
149fe27e772SPawel Jakub Dawidek g_gate_access(struct g_provider *pp, int dr, int dw, int de)
150fe27e772SPawel Jakub Dawidek {
151fe27e772SPawel Jakub Dawidek 	struct g_gate_softc *sc;
152fe27e772SPawel Jakub Dawidek 
153fe27e772SPawel Jakub Dawidek 	if (dr <= 0 && dw <= 0 && de <= 0)
154fe27e772SPawel Jakub Dawidek 		return (0);
155fe27e772SPawel Jakub Dawidek 	sc = pp->geom->softc;
156fe27e772SPawel Jakub Dawidek 	if (sc == NULL || (sc->sc_flags & G_GATE_FLAG_DESTROY) != 0)
157fe27e772SPawel Jakub Dawidek 		return (ENXIO);
15855336b83SPawel Jakub Dawidek 	/* XXX: Hack to allow read-only mounts. */
15955336b83SPawel Jakub Dawidek #if 0
160fe27e772SPawel Jakub Dawidek 	if ((sc->sc_flags & G_GATE_FLAG_READONLY) != 0 && dw > 0)
161fe27e772SPawel Jakub Dawidek 		return (EPERM);
16255336b83SPawel Jakub Dawidek #endif
163fe27e772SPawel Jakub Dawidek 	if ((sc->sc_flags & G_GATE_FLAG_WRITEONLY) != 0 && dr > 0)
164fe27e772SPawel Jakub Dawidek 		return (EPERM);
165fe27e772SPawel Jakub Dawidek 	return (0);
166fe27e772SPawel Jakub Dawidek }
167fe27e772SPawel Jakub Dawidek 
168fe27e772SPawel Jakub Dawidek static void
169fe27e772SPawel Jakub Dawidek g_gate_start(struct bio *bp)
170fe27e772SPawel Jakub Dawidek {
171fe27e772SPawel Jakub Dawidek 	struct g_gate_softc *sc;
172fe27e772SPawel Jakub Dawidek 
173fe27e772SPawel Jakub Dawidek 	sc = bp->bio_to->geom->softc;
174fe27e772SPawel Jakub Dawidek 	if (sc == NULL || (sc->sc_flags & G_GATE_FLAG_DESTROY) != 0) {
175fe27e772SPawel Jakub Dawidek 		g_io_deliver(bp, ENXIO);
176fe27e772SPawel Jakub Dawidek 		return;
177fe27e772SPawel Jakub Dawidek 	}
178fe27e772SPawel Jakub Dawidek 	G_GATE_LOGREQ(2, bp, "Request received.");
179fe27e772SPawel Jakub Dawidek 	switch (bp->bio_cmd) {
180fe27e772SPawel Jakub Dawidek 	case BIO_READ:
18155336b83SPawel Jakub Dawidek 		break;
182fe27e772SPawel Jakub Dawidek 	case BIO_DELETE:
183fe27e772SPawel Jakub Dawidek 	case BIO_WRITE:
184204a4e19SPawel Jakub Dawidek 	case BIO_FLUSH:
18555336b83SPawel Jakub Dawidek 		/* XXX: Hack to allow read-only mounts. */
18655336b83SPawel Jakub Dawidek 		if ((sc->sc_flags & G_GATE_FLAG_READONLY) != 0) {
18755336b83SPawel Jakub Dawidek 			g_io_deliver(bp, EPERM);
18855336b83SPawel Jakub Dawidek 			return;
18955336b83SPawel Jakub Dawidek 		}
190fe27e772SPawel Jakub Dawidek 		break;
191fe27e772SPawel Jakub Dawidek 	case BIO_GETATTR:
192fe27e772SPawel Jakub Dawidek 	default:
193fe27e772SPawel Jakub Dawidek 		G_GATE_LOGREQ(2, bp, "Ignoring request.");
194fe27e772SPawel Jakub Dawidek 		g_io_deliver(bp, EOPNOTSUPP);
195fe27e772SPawel Jakub Dawidek 		return;
196fe27e772SPawel Jakub Dawidek 	}
197fe27e772SPawel Jakub Dawidek 
198e35d3a78SPawel Jakub Dawidek 	mtx_lock(&sc->sc_queue_mtx);
19963a6c5c1SPawel Jakub Dawidek 	if (sc->sc_queue_size > 0 && sc->sc_queue_count > sc->sc_queue_size) {
20035f855d9SPawel Jakub Dawidek 		mtx_unlock(&sc->sc_queue_mtx);
201fe27e772SPawel Jakub Dawidek 		G_GATE_LOGREQ(1, bp, "Queue full, request canceled.");
20232115b10SPawel Jakub Dawidek 		g_io_deliver(bp, ENOMEM);
203fe27e772SPawel Jakub Dawidek 		return;
204fe27e772SPawel Jakub Dawidek 	}
205e35d3a78SPawel Jakub Dawidek 
206fe27e772SPawel Jakub Dawidek 	bp->bio_driver1 = (void *)sc->sc_seq;
207fe27e772SPawel Jakub Dawidek 	sc->sc_seq++;
208e35d3a78SPawel Jakub Dawidek 	sc->sc_queue_count++;
209fe27e772SPawel Jakub Dawidek 
210662a4e58SPawel Jakub Dawidek 	bioq_insert_tail(&sc->sc_inqueue, bp);
211fe27e772SPawel Jakub Dawidek 	wakeup(sc);
212e35d3a78SPawel Jakub Dawidek 
213e35d3a78SPawel Jakub Dawidek 	mtx_unlock(&sc->sc_queue_mtx);
214fe27e772SPawel Jakub Dawidek }
215fe27e772SPawel Jakub Dawidek 
216fe27e772SPawel Jakub Dawidek static struct g_gate_softc *
2172aa15ffdSPawel Jakub Dawidek g_gate_hold(int unit, const char *name)
218fe27e772SPawel Jakub Dawidek {
21932115b10SPawel Jakub Dawidek 	struct g_gate_softc *sc = NULL;
220fe27e772SPawel Jakub Dawidek 
22132115b10SPawel Jakub Dawidek 	mtx_lock(&g_gate_units_lock);
22232115b10SPawel Jakub Dawidek 	if (unit >= 0 && unit < g_gate_maxunits)
22332115b10SPawel Jakub Dawidek 		sc = g_gate_units[unit];
22432115b10SPawel Jakub Dawidek 	else if (unit == G_GATE_NAME_GIVEN) {
22532115b10SPawel Jakub Dawidek 		KASSERT(name != NULL, ("name is NULL"));
22632115b10SPawel Jakub Dawidek 		for (unit = 0; unit < g_gate_maxunits; unit++) {
22732115b10SPawel Jakub Dawidek 			if (g_gate_units[unit] == NULL)
22832115b10SPawel Jakub Dawidek 				continue;
22932115b10SPawel Jakub Dawidek 			if (strcmp(name,
23032115b10SPawel Jakub Dawidek 			    g_gate_units[unit]->sc_provider->name) != 0) {
23132115b10SPawel Jakub Dawidek 				continue;
23232115b10SPawel Jakub Dawidek 			}
23332115b10SPawel Jakub Dawidek 			sc = g_gate_units[unit];
2347ffb6e0fSPawel Jakub Dawidek 			break;
235fe27e772SPawel Jakub Dawidek 		}
23632115b10SPawel Jakub Dawidek 	}
2377ffb6e0fSPawel Jakub Dawidek 	if (sc != NULL)
2387ffb6e0fSPawel Jakub Dawidek 		sc->sc_ref++;
23932115b10SPawel Jakub Dawidek 	mtx_unlock(&g_gate_units_lock);
240fe27e772SPawel Jakub Dawidek 	return (sc);
241fe27e772SPawel Jakub Dawidek }
242fe27e772SPawel Jakub Dawidek 
243fe27e772SPawel Jakub Dawidek static void
244fe27e772SPawel Jakub Dawidek g_gate_release(struct g_gate_softc *sc)
245fe27e772SPawel Jakub Dawidek {
246fe27e772SPawel Jakub Dawidek 
247fe27e772SPawel Jakub Dawidek 	g_topology_assert_not();
24832115b10SPawel Jakub Dawidek 	mtx_lock(&g_gate_units_lock);
249fe27e772SPawel Jakub Dawidek 	sc->sc_ref--;
250fe27e772SPawel Jakub Dawidek 	KASSERT(sc->sc_ref >= 0, ("Negative sc_ref for %s.", sc->sc_name));
25132115b10SPawel Jakub Dawidek 	if (sc->sc_ref == 0 && (sc->sc_flags & G_GATE_FLAG_DESTROY) != 0)
2527ffb6e0fSPawel Jakub Dawidek 		wakeup(&sc->sc_ref);
25332115b10SPawel Jakub Dawidek 	mtx_unlock(&g_gate_units_lock);
254fe27e772SPawel Jakub Dawidek }
255fe27e772SPawel Jakub Dawidek 
256fe27e772SPawel Jakub Dawidek static int
25732115b10SPawel Jakub Dawidek g_gate_getunit(int unit, int *errorp)
258fe27e772SPawel Jakub Dawidek {
259fe27e772SPawel Jakub Dawidek 
26032115b10SPawel Jakub Dawidek 	mtx_assert(&g_gate_units_lock, MA_OWNED);
261fe27e772SPawel Jakub Dawidek 	if (unit >= 0) {
26232115b10SPawel Jakub Dawidek 		if (unit >= g_gate_maxunits)
26332115b10SPawel Jakub Dawidek 			*errorp = EINVAL;
26432115b10SPawel Jakub Dawidek 		else if (g_gate_units[unit] == NULL)
265fe27e772SPawel Jakub Dawidek 			return (unit);
26632115b10SPawel Jakub Dawidek 		else
26732115b10SPawel Jakub Dawidek 			*errorp = EEXIST;
26832115b10SPawel Jakub Dawidek 	} else {
26932115b10SPawel Jakub Dawidek 		for (unit = 0; unit < g_gate_maxunits; unit++) {
27032115b10SPawel Jakub Dawidek 			if (g_gate_units[unit] == NULL)
27132115b10SPawel Jakub Dawidek 				return (unit);
27232115b10SPawel Jakub Dawidek 		}
27332115b10SPawel Jakub Dawidek 		*errorp = ENFILE;
27432115b10SPawel Jakub Dawidek 	}
27532115b10SPawel Jakub Dawidek 	return (-1);
276fe27e772SPawel Jakub Dawidek }
277fe27e772SPawel Jakub Dawidek 
278fe27e772SPawel Jakub Dawidek static void
279fe27e772SPawel Jakub Dawidek g_gate_guard(void *arg)
280fe27e772SPawel Jakub Dawidek {
281fe27e772SPawel Jakub Dawidek 	struct g_gate_softc *sc;
282fe27e772SPawel Jakub Dawidek 	struct bintime curtime;
283fe27e772SPawel Jakub Dawidek 	struct bio *bp, *bp2;
284fe27e772SPawel Jakub Dawidek 
285fe27e772SPawel Jakub Dawidek 	sc = arg;
286fe27e772SPawel Jakub Dawidek 	binuptime(&curtime);
28732115b10SPawel Jakub Dawidek 	g_gate_hold(sc->sc_unit, NULL);
288e35d3a78SPawel Jakub Dawidek 	mtx_lock(&sc->sc_queue_mtx);
289fe27e772SPawel Jakub Dawidek 	TAILQ_FOREACH_SAFE(bp, &sc->sc_inqueue.queue, bio_queue, bp2) {
290fe27e772SPawel Jakub Dawidek 		if (curtime.sec - bp->bio_t0.sec < 5)
291fe27e772SPawel Jakub Dawidek 			continue;
292fe27e772SPawel Jakub Dawidek 		bioq_remove(&sc->sc_inqueue, bp);
293e35d3a78SPawel Jakub Dawidek 		sc->sc_queue_count--;
294fe27e772SPawel Jakub Dawidek 		G_GATE_LOGREQ(1, bp, "Request timeout.");
295fe27e772SPawel Jakub Dawidek 		g_io_deliver(bp, EIO);
296fe27e772SPawel Jakub Dawidek 	}
297fe27e772SPawel Jakub Dawidek 	TAILQ_FOREACH_SAFE(bp, &sc->sc_outqueue.queue, bio_queue, bp2) {
298fe27e772SPawel Jakub Dawidek 		if (curtime.sec - bp->bio_t0.sec < 5)
299fe27e772SPawel Jakub Dawidek 			continue;
300fe27e772SPawel Jakub Dawidek 		bioq_remove(&sc->sc_outqueue, bp);
301e35d3a78SPawel Jakub Dawidek 		sc->sc_queue_count--;
302fe27e772SPawel Jakub Dawidek 		G_GATE_LOGREQ(1, bp, "Request timeout.");
303fe27e772SPawel Jakub Dawidek 		g_io_deliver(bp, EIO);
304fe27e772SPawel Jakub Dawidek 	}
305e35d3a78SPawel Jakub Dawidek 	mtx_unlock(&sc->sc_queue_mtx);
306fe27e772SPawel Jakub Dawidek 	if ((sc->sc_flags & G_GATE_FLAG_DESTROY) == 0) {
307fe27e772SPawel Jakub Dawidek 		callout_reset(&sc->sc_callout, sc->sc_timeout * hz,
308fe27e772SPawel Jakub Dawidek 		    g_gate_guard, sc);
309fe27e772SPawel Jakub Dawidek 	}
310fe27e772SPawel Jakub Dawidek 	g_gate_release(sc);
311fe27e772SPawel Jakub Dawidek }
312fe27e772SPawel Jakub Dawidek 
313fe27e772SPawel Jakub Dawidek static void
314fe27e772SPawel Jakub Dawidek g_gate_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp,
315fe27e772SPawel Jakub Dawidek     struct g_consumer *cp, struct g_provider *pp)
316fe27e772SPawel Jakub Dawidek {
317fe27e772SPawel Jakub Dawidek 	struct g_gate_softc *sc;
318fe27e772SPawel Jakub Dawidek 
319fe27e772SPawel Jakub Dawidek 	sc = gp->softc;
320fe27e772SPawel Jakub Dawidek 	if (sc == NULL || pp != NULL || cp != NULL)
321fe27e772SPawel Jakub Dawidek 		return;
32232115b10SPawel Jakub Dawidek 	g_gate_hold(sc->sc_unit, NULL);
323fe27e772SPawel Jakub Dawidek 	if ((sc->sc_flags & G_GATE_FLAG_READONLY) != 0) {
324fe27e772SPawel Jakub Dawidek 		sbuf_printf(sb, "%s<access>%s</access>\n", indent, "read-only");
325fe27e772SPawel Jakub Dawidek 	} else if ((sc->sc_flags & G_GATE_FLAG_WRITEONLY) != 0) {
326fe27e772SPawel Jakub Dawidek 		sbuf_printf(sb, "%s<access>%s</access>\n", indent,
327fe27e772SPawel Jakub Dawidek 		    "write-only");
328fe27e772SPawel Jakub Dawidek 	} else {
329fe27e772SPawel Jakub Dawidek 		sbuf_printf(sb, "%s<access>%s</access>\n", indent,
330fe27e772SPawel Jakub Dawidek 		    "read-write");
331fe27e772SPawel Jakub Dawidek 	}
332fe27e772SPawel Jakub Dawidek 	sbuf_printf(sb, "%s<timeout>%u</timeout>\n", indent, sc->sc_timeout);
333fe27e772SPawel Jakub Dawidek 	sbuf_printf(sb, "%s<info>%s</info>\n", indent, sc->sc_info);
334fe27e772SPawel Jakub Dawidek 	sbuf_printf(sb, "%s<queue_count>%u</queue_count>\n", indent,
335fe27e772SPawel Jakub Dawidek 	    sc->sc_queue_count);
336fe27e772SPawel Jakub Dawidek 	sbuf_printf(sb, "%s<queue_size>%u</queue_size>\n", indent,
337fe27e772SPawel Jakub Dawidek 	    sc->sc_queue_size);
338fe27e772SPawel Jakub Dawidek 	sbuf_printf(sb, "%s<ref>%u</ref>\n", indent, sc->sc_ref);
33932115b10SPawel Jakub Dawidek 	sbuf_printf(sb, "%s<unit>%d</unit>\n", indent, sc->sc_unit);
34047f44cb7SPawel Jakub Dawidek 	g_topology_unlock();
341fe27e772SPawel Jakub Dawidek 	g_gate_release(sc);
34247f44cb7SPawel Jakub Dawidek 	g_topology_lock();
343fe27e772SPawel Jakub Dawidek }
344fe27e772SPawel Jakub Dawidek 
345fe27e772SPawel Jakub Dawidek static int
346fe27e772SPawel Jakub Dawidek g_gate_create(struct g_gate_ctl_create *ggio)
347fe27e772SPawel Jakub Dawidek {
348fe27e772SPawel Jakub Dawidek 	struct g_gate_softc *sc;
349fe27e772SPawel Jakub Dawidek 	struct g_geom *gp;
350fe27e772SPawel Jakub Dawidek 	struct g_provider *pp;
35132115b10SPawel Jakub Dawidek 	char name[NAME_MAX];
35232115b10SPawel Jakub Dawidek 	int error = 0, unit;
353fe27e772SPawel Jakub Dawidek 
354fe27e772SPawel Jakub Dawidek 	if (ggio->gctl_mediasize == 0) {
355fe27e772SPawel Jakub Dawidek 		G_GATE_DEBUG(1, "Invalid media size.");
356fe27e772SPawel Jakub Dawidek 		return (EINVAL);
357fe27e772SPawel Jakub Dawidek 	}
358fe27e772SPawel Jakub Dawidek 	if (ggio->gctl_sectorsize > 0 && !powerof2(ggio->gctl_sectorsize)) {
359fe27e772SPawel Jakub Dawidek 		G_GATE_DEBUG(1, "Invalid sector size.");
360fe27e772SPawel Jakub Dawidek 		return (EINVAL);
361fe27e772SPawel Jakub Dawidek 	}
362662a4e58SPawel Jakub Dawidek 	if ((ggio->gctl_mediasize % ggio->gctl_sectorsize) != 0) {
363662a4e58SPawel Jakub Dawidek 		G_GATE_DEBUG(1, "Invalid media size.");
364662a4e58SPawel Jakub Dawidek 		return (EINVAL);
365662a4e58SPawel Jakub Dawidek 	}
366fe27e772SPawel Jakub Dawidek 	if ((ggio->gctl_flags & G_GATE_FLAG_READONLY) != 0 &&
367fe27e772SPawel Jakub Dawidek 	    (ggio->gctl_flags & G_GATE_FLAG_WRITEONLY) != 0) {
368fe27e772SPawel Jakub Dawidek 		G_GATE_DEBUG(1, "Invalid flags.");
369fe27e772SPawel Jakub Dawidek 		return (EINVAL);
370fe27e772SPawel Jakub Dawidek 	}
37132115b10SPawel Jakub Dawidek 	if (ggio->gctl_unit != G_GATE_UNIT_AUTO &&
37232115b10SPawel Jakub Dawidek 	    ggio->gctl_unit != G_GATE_NAME_GIVEN &&
37332115b10SPawel Jakub Dawidek 	    ggio->gctl_unit < 0) {
374fe27e772SPawel Jakub Dawidek 		G_GATE_DEBUG(1, "Invalid unit number.");
375fe27e772SPawel Jakub Dawidek 		return (EINVAL);
376fe27e772SPawel Jakub Dawidek 	}
37732115b10SPawel Jakub Dawidek 	if (ggio->gctl_unit == G_GATE_NAME_GIVEN &&
37832115b10SPawel Jakub Dawidek 	    ggio->gctl_name[0] == '\0') {
37932115b10SPawel Jakub Dawidek 		G_GATE_DEBUG(1, "No device name.");
38032115b10SPawel Jakub Dawidek 		return (EINVAL);
38132115b10SPawel Jakub Dawidek 	}
382fe27e772SPawel Jakub Dawidek 
383fe27e772SPawel Jakub Dawidek 	sc = malloc(sizeof(*sc), M_GATE, M_WAITOK | M_ZERO);
384fe27e772SPawel Jakub Dawidek 	sc->sc_flags = (ggio->gctl_flags & G_GATE_USERFLAGS);
385fe27e772SPawel Jakub Dawidek 	strlcpy(sc->sc_info, ggio->gctl_info, sizeof(sc->sc_info));
38632115b10SPawel Jakub Dawidek 	sc->sc_seq = 1;
387fe27e772SPawel Jakub Dawidek 	bioq_init(&sc->sc_inqueue);
388fe27e772SPawel Jakub Dawidek 	bioq_init(&sc->sc_outqueue);
389e35d3a78SPawel Jakub Dawidek 	mtx_init(&sc->sc_queue_mtx, "gg:queue", NULL, MTX_DEF);
390fe27e772SPawel Jakub Dawidek 	sc->sc_queue_count = 0;
391fe27e772SPawel Jakub Dawidek 	sc->sc_queue_size = ggio->gctl_maxcount;
392fe27e772SPawel Jakub Dawidek 	if (sc->sc_queue_size > G_GATE_MAX_QUEUE_SIZE)
393fe27e772SPawel Jakub Dawidek 		sc->sc_queue_size = G_GATE_MAX_QUEUE_SIZE;
394fe27e772SPawel Jakub Dawidek 	sc->sc_timeout = ggio->gctl_timeout;
395fe27e772SPawel Jakub Dawidek 	callout_init(&sc->sc_callout, CALLOUT_MPSAFE);
39632115b10SPawel Jakub Dawidek 	mtx_lock(&g_gate_units_lock);
39732115b10SPawel Jakub Dawidek 	sc->sc_unit = g_gate_getunit(ggio->gctl_unit, &error);
39832115b10SPawel Jakub Dawidek 	if (sc->sc_unit < 0) {
39932115b10SPawel Jakub Dawidek 		mtx_unlock(&g_gate_units_lock);
400e35d3a78SPawel Jakub Dawidek 		mtx_destroy(&sc->sc_queue_mtx);
4014d1e1bf3SPawel Jakub Dawidek 		free(sc, M_GATE);
40232115b10SPawel Jakub Dawidek 		return (error);
4034d1e1bf3SPawel Jakub Dawidek 	}
40432115b10SPawel Jakub Dawidek 	if (ggio->gctl_unit == G_GATE_NAME_GIVEN)
40532115b10SPawel Jakub Dawidek 		snprintf(name, sizeof(name), "%s", ggio->gctl_name);
40632115b10SPawel Jakub Dawidek 	else {
40732115b10SPawel Jakub Dawidek 		snprintf(name, sizeof(name), "%s%d", G_GATE_PROVIDER_NAME,
40832115b10SPawel Jakub Dawidek 		    sc->sc_unit);
40932115b10SPawel Jakub Dawidek 	}
41032115b10SPawel Jakub Dawidek 	/* Check for name collision. */
41132115b10SPawel Jakub Dawidek 	for (unit = 0; unit < g_gate_maxunits; unit++) {
41232115b10SPawel Jakub Dawidek 		if (g_gate_units[unit] == NULL)
41332115b10SPawel Jakub Dawidek 			continue;
414baf63f65SMikolaj Golub 		if (strcmp(name, g_gate_units[unit]->sc_name) != 0)
41532115b10SPawel Jakub Dawidek 			continue;
41632115b10SPawel Jakub Dawidek 		mtx_unlock(&g_gate_units_lock);
41732115b10SPawel Jakub Dawidek 		mtx_destroy(&sc->sc_queue_mtx);
41832115b10SPawel Jakub Dawidek 		free(sc, M_GATE);
41932115b10SPawel Jakub Dawidek 		return (EEXIST);
42032115b10SPawel Jakub Dawidek 	}
421baf63f65SMikolaj Golub 	sc->sc_name = name;
42232115b10SPawel Jakub Dawidek 	g_gate_units[sc->sc_unit] = sc;
42332115b10SPawel Jakub Dawidek 	g_gate_nunits++;
42432115b10SPawel Jakub Dawidek 	mtx_unlock(&g_gate_units_lock);
42532115b10SPawel Jakub Dawidek 
42632115b10SPawel Jakub Dawidek 	ggio->gctl_unit = sc->sc_unit;
427fe27e772SPawel Jakub Dawidek 
428fe27e772SPawel Jakub Dawidek 	g_topology_lock();
42932115b10SPawel Jakub Dawidek 	gp = g_new_geomf(&g_gate_class, "%s", name);
430fe27e772SPawel Jakub Dawidek 	gp->start = g_gate_start;
431fe27e772SPawel Jakub Dawidek 	gp->access = g_gate_access;
432fe27e772SPawel Jakub Dawidek 	gp->dumpconf = g_gate_dumpconf;
433fe27e772SPawel Jakub Dawidek 	gp->softc = sc;
43432115b10SPawel Jakub Dawidek 	pp = g_new_providerf(gp, "%s", name);
435fe27e772SPawel Jakub Dawidek 	pp->mediasize = ggio->gctl_mediasize;
436fe27e772SPawel Jakub Dawidek 	pp->sectorsize = ggio->gctl_sectorsize;
437fe27e772SPawel Jakub Dawidek 	sc->sc_provider = pp;
438fe27e772SPawel Jakub Dawidek 	g_error_provider(pp, 0);
439fe27e772SPawel Jakub Dawidek 	g_topology_unlock();
440baf63f65SMikolaj Golub 	mtx_lock(&g_gate_units_lock);
441baf63f65SMikolaj Golub 	sc->sc_name = sc->sc_provider->name;
442baf63f65SMikolaj Golub 	mtx_unlock(&g_gate_units_lock);
443bd119384SMikolaj Golub 	G_GATE_DEBUG(1, "Device %s created.", gp->name);
444fe27e772SPawel Jakub Dawidek 
445fe27e772SPawel Jakub Dawidek 	if (sc->sc_timeout > 0) {
446fe27e772SPawel Jakub Dawidek 		callout_reset(&sc->sc_callout, sc->sc_timeout * hz,
447fe27e772SPawel Jakub Dawidek 		    g_gate_guard, sc);
448fe27e772SPawel Jakub Dawidek 	}
449fe27e772SPawel Jakub Dawidek 	return (0);
450fe27e772SPawel Jakub Dawidek }
451fe27e772SPawel Jakub Dawidek 
452fe27e772SPawel Jakub Dawidek #define	G_GATE_CHECK_VERSION(ggio)	do {				\
45384436f14SPawel Jakub Dawidek 	if ((ggio)->gctl_version != G_GATE_VERSION) {			\
45484436f14SPawel Jakub Dawidek 		printf("Version mismatch %d != %d.\n",			\
45584436f14SPawel Jakub Dawidek 		    ggio->gctl_version, G_GATE_VERSION);		\
456fe27e772SPawel Jakub Dawidek 		return (EINVAL);					\
45784436f14SPawel Jakub Dawidek 	}								\
458fe27e772SPawel Jakub Dawidek } while (0)
459fe27e772SPawel Jakub Dawidek static int
46089c9c53dSPoul-Henning Kamp g_gate_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags, struct thread *td)
461fe27e772SPawel Jakub Dawidek {
462fe27e772SPawel Jakub Dawidek 	struct g_gate_softc *sc;
463fe27e772SPawel Jakub Dawidek 	struct bio *bp;
464fe27e772SPawel Jakub Dawidek 	int error = 0;
465fe27e772SPawel Jakub Dawidek 
466fe27e772SPawel Jakub Dawidek 	G_GATE_DEBUG(4, "ioctl(%s, %lx, %p, %x, %p)", devtoname(dev), cmd, addr,
467fe27e772SPawel Jakub Dawidek 	    flags, td);
468fe27e772SPawel Jakub Dawidek 
469fe27e772SPawel Jakub Dawidek 	switch (cmd) {
470fe27e772SPawel Jakub Dawidek 	case G_GATE_CMD_CREATE:
471fe27e772SPawel Jakub Dawidek 	    {
472fe27e772SPawel Jakub Dawidek 		struct g_gate_ctl_create *ggio = (void *)addr;
473fe27e772SPawel Jakub Dawidek 
474fe27e772SPawel Jakub Dawidek 		G_GATE_CHECK_VERSION(ggio);
475a17dd95fSPawel Jakub Dawidek 		error = g_gate_create(ggio);
476f9065812SPawel Jakub Dawidek 		/*
477f9065812SPawel Jakub Dawidek 		 * Reset TDP_GEOM flag.
478f9065812SPawel Jakub Dawidek 		 * There are pending events for sure, because we just created
479f9065812SPawel Jakub Dawidek 		 * new provider and other classes want to taste it, but we
480f9065812SPawel Jakub Dawidek 		 * cannot answer on I/O requests until we're here.
481f9065812SPawel Jakub Dawidek 		 */
482f9065812SPawel Jakub Dawidek 		td->td_pflags &= ~TDP_GEOM;
483a17dd95fSPawel Jakub Dawidek 		return (error);
484fe27e772SPawel Jakub Dawidek 	    }
485fe27e772SPawel Jakub Dawidek 	case G_GATE_CMD_DESTROY:
486fe27e772SPawel Jakub Dawidek 	    {
487fe27e772SPawel Jakub Dawidek 		struct g_gate_ctl_destroy *ggio = (void *)addr;
488fe27e772SPawel Jakub Dawidek 
489fe27e772SPawel Jakub Dawidek 		G_GATE_CHECK_VERSION(ggio);
49032115b10SPawel Jakub Dawidek 		sc = g_gate_hold(ggio->gctl_unit, ggio->gctl_name);
491fe27e772SPawel Jakub Dawidek 		if (sc == NULL)
492fe27e772SPawel Jakub Dawidek 			return (ENXIO);
493fe27e772SPawel Jakub Dawidek 		g_topology_lock();
49432115b10SPawel Jakub Dawidek 		mtx_lock(&g_gate_units_lock);
495fe27e772SPawel Jakub Dawidek 		error = g_gate_destroy(sc, ggio->gctl_force);
496fe27e772SPawel Jakub Dawidek 		g_topology_unlock();
4977ffb6e0fSPawel Jakub Dawidek 		if (error != 0)
498fe27e772SPawel Jakub Dawidek 			g_gate_release(sc);
499fe27e772SPawel Jakub Dawidek 		return (error);
500fe27e772SPawel Jakub Dawidek 	    }
50184436f14SPawel Jakub Dawidek 	case G_GATE_CMD_CANCEL:
50284436f14SPawel Jakub Dawidek 	    {
50384436f14SPawel Jakub Dawidek 		struct g_gate_ctl_cancel *ggio = (void *)addr;
50484436f14SPawel Jakub Dawidek 		struct bio *tbp, *lbp;
50584436f14SPawel Jakub Dawidek 
50684436f14SPawel Jakub Dawidek 		G_GATE_CHECK_VERSION(ggio);
50732115b10SPawel Jakub Dawidek 		sc = g_gate_hold(ggio->gctl_unit, ggio->gctl_name);
50884436f14SPawel Jakub Dawidek 		if (sc == NULL)
50984436f14SPawel Jakub Dawidek 			return (ENXIO);
51084436f14SPawel Jakub Dawidek 		lbp = NULL;
51184436f14SPawel Jakub Dawidek 		mtx_lock(&sc->sc_queue_mtx);
51284436f14SPawel Jakub Dawidek 		TAILQ_FOREACH_SAFE(bp, &sc->sc_outqueue.queue, bio_queue, tbp) {
51384436f14SPawel Jakub Dawidek 			if (ggio->gctl_seq == 0 ||
51484436f14SPawel Jakub Dawidek 			    ggio->gctl_seq == (uintptr_t)bp->bio_driver1) {
51584436f14SPawel Jakub Dawidek 				G_GATE_LOGREQ(1, bp, "Request canceled.");
51684436f14SPawel Jakub Dawidek 				bioq_remove(&sc->sc_outqueue, bp);
51784436f14SPawel Jakub Dawidek 				/*
51884436f14SPawel Jakub Dawidek 				 * Be sure to put requests back onto incoming
51984436f14SPawel Jakub Dawidek 				 * queue in the proper order.
52084436f14SPawel Jakub Dawidek 				 */
52184436f14SPawel Jakub Dawidek 				if (lbp == NULL)
52284436f14SPawel Jakub Dawidek 					bioq_insert_head(&sc->sc_inqueue, bp);
52384436f14SPawel Jakub Dawidek 				else {
52484436f14SPawel Jakub Dawidek 					TAILQ_INSERT_AFTER(&sc->sc_inqueue.queue,
52584436f14SPawel Jakub Dawidek 					    lbp, bp, bio_queue);
52684436f14SPawel Jakub Dawidek 				}
52784436f14SPawel Jakub Dawidek 				lbp = bp;
52884436f14SPawel Jakub Dawidek 				/*
52984436f14SPawel Jakub Dawidek 				 * If only one request was canceled, leave now.
53084436f14SPawel Jakub Dawidek 				 */
53184436f14SPawel Jakub Dawidek 				if (ggio->gctl_seq != 0)
53284436f14SPawel Jakub Dawidek 					break;
53384436f14SPawel Jakub Dawidek 			}
53484436f14SPawel Jakub Dawidek 		}
53532115b10SPawel Jakub Dawidek 		if (ggio->gctl_unit == G_GATE_NAME_GIVEN)
53632115b10SPawel Jakub Dawidek 			ggio->gctl_unit = sc->sc_unit;
53784436f14SPawel Jakub Dawidek 		mtx_unlock(&sc->sc_queue_mtx);
53884436f14SPawel Jakub Dawidek 		g_gate_release(sc);
53984436f14SPawel Jakub Dawidek 		return (error);
54084436f14SPawel Jakub Dawidek 	    }
541fe27e772SPawel Jakub Dawidek 	case G_GATE_CMD_START:
542fe27e772SPawel Jakub Dawidek 	    {
543fe27e772SPawel Jakub Dawidek 		struct g_gate_ctl_io *ggio = (void *)addr;
544fe27e772SPawel Jakub Dawidek 
545fe27e772SPawel Jakub Dawidek 		G_GATE_CHECK_VERSION(ggio);
54632115b10SPawel Jakub Dawidek 		sc = g_gate_hold(ggio->gctl_unit, NULL);
547fe27e772SPawel Jakub Dawidek 		if (sc == NULL)
548fe27e772SPawel Jakub Dawidek 			return (ENXIO);
5497ffb6e0fSPawel Jakub Dawidek 		error = 0;
550fe27e772SPawel Jakub Dawidek 		for (;;) {
551e35d3a78SPawel Jakub Dawidek 			mtx_lock(&sc->sc_queue_mtx);
552fe27e772SPawel Jakub Dawidek 			bp = bioq_first(&sc->sc_inqueue);
553fe27e772SPawel Jakub Dawidek 			if (bp != NULL)
554fe27e772SPawel Jakub Dawidek 				break;
5557ffb6e0fSPawel Jakub Dawidek 			if ((sc->sc_flags & G_GATE_FLAG_DESTROY) != 0) {
5567ffb6e0fSPawel Jakub Dawidek 				ggio->gctl_error = ECANCELED;
5577ffb6e0fSPawel Jakub Dawidek 				mtx_unlock(&sc->sc_queue_mtx);
5587ffb6e0fSPawel Jakub Dawidek 				goto start_end;
5597ffb6e0fSPawel Jakub Dawidek 			}
560e35d3a78SPawel Jakub Dawidek 			if (msleep(sc, &sc->sc_queue_mtx,
561fe27e772SPawel Jakub Dawidek 			    PPAUSE | PDROP | PCATCH, "ggwait", 0) != 0) {
562fe27e772SPawel Jakub Dawidek 				ggio->gctl_error = ECANCELED;
5637ffb6e0fSPawel Jakub Dawidek 				goto start_end;
564fe27e772SPawel Jakub Dawidek 			}
565fe27e772SPawel Jakub Dawidek 		}
5664d1e1bf3SPawel Jakub Dawidek 		ggio->gctl_cmd = bp->bio_cmd;
567fe27e772SPawel Jakub Dawidek 		if ((bp->bio_cmd == BIO_DELETE || bp->bio_cmd == BIO_WRITE) &&
568fe27e772SPawel Jakub Dawidek 		    bp->bio_length > ggio->gctl_length) {
569e35d3a78SPawel Jakub Dawidek 			mtx_unlock(&sc->sc_queue_mtx);
570fe27e772SPawel Jakub Dawidek 			ggio->gctl_length = bp->bio_length;
571fe27e772SPawel Jakub Dawidek 			ggio->gctl_error = ENOMEM;
5727ffb6e0fSPawel Jakub Dawidek 			goto start_end;
573fe27e772SPawel Jakub Dawidek 		}
574fe27e772SPawel Jakub Dawidek 		bioq_remove(&sc->sc_inqueue, bp);
575e35d3a78SPawel Jakub Dawidek 		bioq_insert_tail(&sc->sc_outqueue, bp);
576e35d3a78SPawel Jakub Dawidek 		mtx_unlock(&sc->sc_queue_mtx);
577e35d3a78SPawel Jakub Dawidek 
5780d785336SPawel Jakub Dawidek 		ggio->gctl_seq = (uintptr_t)bp->bio_driver1;
579fe27e772SPawel Jakub Dawidek 		ggio->gctl_offset = bp->bio_offset;
580fe27e772SPawel Jakub Dawidek 		ggio->gctl_length = bp->bio_length;
58184436f14SPawel Jakub Dawidek 
582fe27e772SPawel Jakub Dawidek 		switch (bp->bio_cmd) {
583fe27e772SPawel Jakub Dawidek 		case BIO_READ:
584fe27e772SPawel Jakub Dawidek 		case BIO_DELETE:
585204a4e19SPawel Jakub Dawidek 		case BIO_FLUSH:
58615725379SPawel Jakub Dawidek 			break;
587fe27e772SPawel Jakub Dawidek 		case BIO_WRITE:
588fe27e772SPawel Jakub Dawidek 			error = copyout(bp->bio_data, ggio->gctl_data,
589fe27e772SPawel Jakub Dawidek 			    bp->bio_length);
590fe27e772SPawel Jakub Dawidek 			if (error != 0) {
591e35d3a78SPawel Jakub Dawidek 				mtx_lock(&sc->sc_queue_mtx);
592e35d3a78SPawel Jakub Dawidek 				bioq_remove(&sc->sc_outqueue, bp);
593662a4e58SPawel Jakub Dawidek 				bioq_insert_head(&sc->sc_inqueue, bp);
594e35d3a78SPawel Jakub Dawidek 				mtx_unlock(&sc->sc_queue_mtx);
5957ffb6e0fSPawel Jakub Dawidek 				goto start_end;
596fe27e772SPawel Jakub Dawidek 			}
597fe27e772SPawel Jakub Dawidek 			break;
598fe27e772SPawel Jakub Dawidek 		}
5997ffb6e0fSPawel Jakub Dawidek start_end:
6007ffb6e0fSPawel Jakub Dawidek 		g_gate_release(sc);
6017ffb6e0fSPawel Jakub Dawidek 		return (error);
602fe27e772SPawel Jakub Dawidek 	    }
603fe27e772SPawel Jakub Dawidek 	case G_GATE_CMD_DONE:
604fe27e772SPawel Jakub Dawidek 	    {
605fe27e772SPawel Jakub Dawidek 		struct g_gate_ctl_io *ggio = (void *)addr;
606fe27e772SPawel Jakub Dawidek 
607fe27e772SPawel Jakub Dawidek 		G_GATE_CHECK_VERSION(ggio);
60832115b10SPawel Jakub Dawidek 		sc = g_gate_hold(ggio->gctl_unit, NULL);
609fe27e772SPawel Jakub Dawidek 		if (sc == NULL)
610fe27e772SPawel Jakub Dawidek 			return (ENOENT);
6117ffb6e0fSPawel Jakub Dawidek 		error = 0;
612e35d3a78SPawel Jakub Dawidek 		mtx_lock(&sc->sc_queue_mtx);
613fe27e772SPawel Jakub Dawidek 		TAILQ_FOREACH(bp, &sc->sc_outqueue.queue, bio_queue) {
6140d785336SPawel Jakub Dawidek 			if (ggio->gctl_seq == (uintptr_t)bp->bio_driver1)
615fe27e772SPawel Jakub Dawidek 				break;
616fe27e772SPawel Jakub Dawidek 		}
617fe27e772SPawel Jakub Dawidek 		if (bp != NULL) {
618fe27e772SPawel Jakub Dawidek 			bioq_remove(&sc->sc_outqueue, bp);
619e35d3a78SPawel Jakub Dawidek 			sc->sc_queue_count--;
620fe27e772SPawel Jakub Dawidek 		}
621e35d3a78SPawel Jakub Dawidek 		mtx_unlock(&sc->sc_queue_mtx);
622fe27e772SPawel Jakub Dawidek 		if (bp == NULL) {
623fe27e772SPawel Jakub Dawidek 			/*
624fe27e772SPawel Jakub Dawidek 			 * Request was probably canceled.
625fe27e772SPawel Jakub Dawidek 			 */
6267ffb6e0fSPawel Jakub Dawidek 			goto done_end;
627fe27e772SPawel Jakub Dawidek 		}
628fe27e772SPawel Jakub Dawidek 		if (ggio->gctl_error == EAGAIN) {
629fe27e772SPawel Jakub Dawidek 			bp->bio_error = 0;
630fe27e772SPawel Jakub Dawidek 			G_GATE_LOGREQ(1, bp, "Request desisted.");
631e35d3a78SPawel Jakub Dawidek 			mtx_lock(&sc->sc_queue_mtx);
632e35d3a78SPawel Jakub Dawidek 			sc->sc_queue_count++;
633662a4e58SPawel Jakub Dawidek 			bioq_insert_head(&sc->sc_inqueue, bp);
634fe27e772SPawel Jakub Dawidek 			wakeup(sc);
635e35d3a78SPawel Jakub Dawidek 			mtx_unlock(&sc->sc_queue_mtx);
636fe27e772SPawel Jakub Dawidek 		} else {
637fe27e772SPawel Jakub Dawidek 			bp->bio_error = ggio->gctl_error;
638fe27e772SPawel Jakub Dawidek 			if (bp->bio_error == 0) {
639fe27e772SPawel Jakub Dawidek 				bp->bio_completed = bp->bio_length;
640fe27e772SPawel Jakub Dawidek 				switch (bp->bio_cmd) {
641fe27e772SPawel Jakub Dawidek 				case BIO_READ:
642fe27e772SPawel Jakub Dawidek 					error = copyin(ggio->gctl_data,
643fe27e772SPawel Jakub Dawidek 					    bp->bio_data, bp->bio_length);
644fe27e772SPawel Jakub Dawidek 					if (error != 0)
645fe27e772SPawel Jakub Dawidek 						bp->bio_error = error;
646fe27e772SPawel Jakub Dawidek 					break;
647fe27e772SPawel Jakub Dawidek 				case BIO_DELETE:
648fe27e772SPawel Jakub Dawidek 				case BIO_WRITE:
649204a4e19SPawel Jakub Dawidek 				case BIO_FLUSH:
650fe27e772SPawel Jakub Dawidek 					break;
651fe27e772SPawel Jakub Dawidek 				}
652fe27e772SPawel Jakub Dawidek 			}
653fe27e772SPawel Jakub Dawidek 			G_GATE_LOGREQ(2, bp, "Request done.");
654fe27e772SPawel Jakub Dawidek 			g_io_deliver(bp, bp->bio_error);
655fe27e772SPawel Jakub Dawidek 		}
6567ffb6e0fSPawel Jakub Dawidek done_end:
6577ffb6e0fSPawel Jakub Dawidek 		g_gate_release(sc);
658fe27e772SPawel Jakub Dawidek 		return (error);
659fe27e772SPawel Jakub Dawidek 	    }
660fe27e772SPawel Jakub Dawidek 	}
661fe27e772SPawel Jakub Dawidek 	return (ENOIOCTL);
662fe27e772SPawel Jakub Dawidek }
663fe27e772SPawel Jakub Dawidek 
664fe27e772SPawel Jakub Dawidek static void
6659ecdd506SPawel Jakub Dawidek g_gate_device(void)
666fe27e772SPawel Jakub Dawidek {
667fe27e772SPawel Jakub Dawidek 
668fe27e772SPawel Jakub Dawidek 	status_dev = make_dev(&g_gate_cdevsw, 0x0, UID_ROOT, GID_WHEEL, 0600,
669fe27e772SPawel Jakub Dawidek 	    G_GATE_CTL_NAME);
670fe27e772SPawel Jakub Dawidek }
671fe27e772SPawel Jakub Dawidek 
672fe27e772SPawel Jakub Dawidek static int
673fe27e772SPawel Jakub Dawidek g_gate_modevent(module_t mod, int type, void *data)
674fe27e772SPawel Jakub Dawidek {
675fe27e772SPawel Jakub Dawidek 	int error = 0;
676fe27e772SPawel Jakub Dawidek 
677fe27e772SPawel Jakub Dawidek 	switch (type) {
678fe27e772SPawel Jakub Dawidek 	case MOD_LOAD:
67932115b10SPawel Jakub Dawidek 		mtx_init(&g_gate_units_lock, "gg_units_lock", NULL, MTX_DEF);
68032115b10SPawel Jakub Dawidek 		g_gate_units = malloc(g_gate_maxunits * sizeof(g_gate_units[0]),
68132115b10SPawel Jakub Dawidek 		    M_GATE, M_WAITOK | M_ZERO);
68232115b10SPawel Jakub Dawidek 		g_gate_nunits = 0;
6839ecdd506SPawel Jakub Dawidek 		g_gate_device();
684fe27e772SPawel Jakub Dawidek 		break;
685fe27e772SPawel Jakub Dawidek 	case MOD_UNLOAD:
68632115b10SPawel Jakub Dawidek 		mtx_lock(&g_gate_units_lock);
68732115b10SPawel Jakub Dawidek 		if (g_gate_nunits > 0) {
68832115b10SPawel Jakub Dawidek 			mtx_unlock(&g_gate_units_lock);
689fe27e772SPawel Jakub Dawidek 			error = EBUSY;
690fe27e772SPawel Jakub Dawidek 			break;
691fe27e772SPawel Jakub Dawidek 		}
69232115b10SPawel Jakub Dawidek 		mtx_unlock(&g_gate_units_lock);
69332115b10SPawel Jakub Dawidek 		mtx_destroy(&g_gate_units_lock);
694fe27e772SPawel Jakub Dawidek 		if (status_dev != 0)
695fe27e772SPawel Jakub Dawidek 			destroy_dev(status_dev);
69632115b10SPawel Jakub Dawidek 		free(g_gate_units, M_GATE);
697fe27e772SPawel Jakub Dawidek 		break;
698fe27e772SPawel Jakub Dawidek 	default:
6993e019deaSPoul-Henning Kamp 		return (EOPNOTSUPP);
700fe27e772SPawel Jakub Dawidek 		break;
701fe27e772SPawel Jakub Dawidek 	}
702fe27e772SPawel Jakub Dawidek 
703fe27e772SPawel Jakub Dawidek 	return (error);
704fe27e772SPawel Jakub Dawidek }
705fe27e772SPawel Jakub Dawidek static moduledata_t g_gate_module = {
706fe27e772SPawel Jakub Dawidek 	G_GATE_MOD_NAME,
707fe27e772SPawel Jakub Dawidek 	g_gate_modevent,
708fe27e772SPawel Jakub Dawidek 	NULL
709fe27e772SPawel Jakub Dawidek };
710fe27e772SPawel Jakub Dawidek DECLARE_MODULE(geom_gate, g_gate_module, SI_SUB_DRIVERS, SI_ORDER_MIDDLE);
711fe27e772SPawel Jakub Dawidek DECLARE_GEOM_CLASS(g_gate_class, g_gate);
712