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