119d16e2fSPawel Jakub Dawidek /*- 2e6890985SPawel Jakub Dawidek * Copyright (c) 2004-2005 Pawel Jakub Dawidek <pjd@FreeBSD.org> 319d16e2fSPawel Jakub Dawidek * All rights reserved. 419d16e2fSPawel Jakub Dawidek * 519d16e2fSPawel Jakub Dawidek * Redistribution and use in source and binary forms, with or without 619d16e2fSPawel Jakub Dawidek * modification, are permitted provided that the following conditions 719d16e2fSPawel Jakub Dawidek * are met: 819d16e2fSPawel Jakub Dawidek * 1. Redistributions of source code must retain the above copyright 919d16e2fSPawel Jakub Dawidek * notice, this list of conditions and the following disclaimer. 1019d16e2fSPawel Jakub Dawidek * 2. Redistributions in binary form must reproduce the above copyright 1119d16e2fSPawel Jakub Dawidek * notice, this list of conditions and the following disclaimer in the 1219d16e2fSPawel Jakub Dawidek * documentation and/or other materials provided with the distribution. 1319d16e2fSPawel Jakub Dawidek * 1419d16e2fSPawel Jakub Dawidek * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND 1519d16e2fSPawel Jakub Dawidek * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1619d16e2fSPawel Jakub Dawidek * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1719d16e2fSPawel Jakub Dawidek * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE 1819d16e2fSPawel Jakub Dawidek * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1919d16e2fSPawel Jakub Dawidek * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2019d16e2fSPawel Jakub Dawidek * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2119d16e2fSPawel Jakub Dawidek * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2219d16e2fSPawel Jakub Dawidek * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2319d16e2fSPawel Jakub Dawidek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2419d16e2fSPawel Jakub Dawidek * SUCH DAMAGE. 2519d16e2fSPawel Jakub Dawidek */ 2619d16e2fSPawel Jakub Dawidek 2719d16e2fSPawel Jakub Dawidek #include <sys/cdefs.h> 2819d16e2fSPawel Jakub Dawidek __FBSDID("$FreeBSD$"); 2919d16e2fSPawel Jakub Dawidek 3019d16e2fSPawel Jakub Dawidek #include <sys/param.h> 3119d16e2fSPawel Jakub Dawidek #include <sys/systm.h> 3219d16e2fSPawel Jakub Dawidek #include <sys/kernel.h> 3319d16e2fSPawel Jakub Dawidek #include <sys/module.h> 3419d16e2fSPawel Jakub Dawidek #include <sys/lock.h> 3519d16e2fSPawel Jakub Dawidek #include <sys/mutex.h> 3619d16e2fSPawel Jakub Dawidek #include <sys/bio.h> 375d807a0eSAndrey V. Elsukov #include <sys/sbuf.h> 3819d16e2fSPawel Jakub Dawidek #include <sys/sysctl.h> 3919d16e2fSPawel Jakub Dawidek #include <sys/malloc.h> 4019d16e2fSPawel Jakub Dawidek #include <geom/geom.h> 4119d16e2fSPawel Jakub Dawidek #include <geom/concat/g_concat.h> 4219d16e2fSPawel Jakub Dawidek 43cb08c2ccSAlexander Leidinger FEATURE(geom_concat, "GEOM concatenation support"); 4419d16e2fSPawel Jakub Dawidek 455bb84bc8SRobert Watson static MALLOC_DEFINE(M_CONCAT, "concat_data", "GEOM_CONCAT Data"); 4619d16e2fSPawel Jakub Dawidek 47a88ae49fSPawel Jakub Dawidek SYSCTL_DECL(_kern_geom); 48*6472ac3dSEd Schouten static SYSCTL_NODE(_kern_geom, OID_AUTO, concat, CTLFLAG_RW, 0, 49*6472ac3dSEd Schouten "GEOM_CONCAT stuff"); 5019d16e2fSPawel Jakub Dawidek static u_int g_concat_debug = 0; 516d7b8aecSPawel Jakub Dawidek TUNABLE_INT("kern.geom.concat.debug", &g_concat_debug); 5219d16e2fSPawel Jakub Dawidek SYSCTL_UINT(_kern_geom_concat, OID_AUTO, debug, CTLFLAG_RW, &g_concat_debug, 0, 5319d16e2fSPawel Jakub Dawidek "Debug level"); 5419d16e2fSPawel Jakub Dawidek 5519d16e2fSPawel Jakub Dawidek static int g_concat_destroy(struct g_concat_softc *sc, boolean_t force); 5619d16e2fSPawel Jakub Dawidek static int g_concat_destroy_geom(struct gctl_req *req, struct g_class *mp, 5719d16e2fSPawel Jakub Dawidek struct g_geom *gp); 5819d16e2fSPawel Jakub Dawidek 5919d16e2fSPawel Jakub Dawidek static g_taste_t g_concat_taste; 6019d16e2fSPawel Jakub Dawidek static g_ctl_req_t g_concat_config; 6119d16e2fSPawel Jakub Dawidek static g_dumpconf_t g_concat_dumpconf; 6219d16e2fSPawel Jakub Dawidek 6319d16e2fSPawel Jakub Dawidek struct g_class g_concat_class = { 6419d16e2fSPawel Jakub Dawidek .name = G_CONCAT_CLASS_NAME, 655721c9c7SPoul-Henning Kamp .version = G_VERSION, 6619d16e2fSPawel Jakub Dawidek .ctlreq = g_concat_config, 6719d16e2fSPawel Jakub Dawidek .taste = g_concat_taste, 6819d16e2fSPawel Jakub Dawidek .destroy_geom = g_concat_destroy_geom 6919d16e2fSPawel Jakub Dawidek }; 7019d16e2fSPawel Jakub Dawidek 7119d16e2fSPawel Jakub Dawidek 7219d16e2fSPawel Jakub Dawidek /* 7348fbd94bSPawel Jakub Dawidek * Greatest Common Divisor. 7448fbd94bSPawel Jakub Dawidek */ 7548fbd94bSPawel Jakub Dawidek static u_int 7648fbd94bSPawel Jakub Dawidek gcd(u_int a, u_int b) 7748fbd94bSPawel Jakub Dawidek { 7848fbd94bSPawel Jakub Dawidek u_int c; 7948fbd94bSPawel Jakub Dawidek 8048fbd94bSPawel Jakub Dawidek while (b != 0) { 8148fbd94bSPawel Jakub Dawidek c = a; 8248fbd94bSPawel Jakub Dawidek a = b; 8348fbd94bSPawel Jakub Dawidek b = (c % b); 8448fbd94bSPawel Jakub Dawidek } 8548fbd94bSPawel Jakub Dawidek return (a); 8648fbd94bSPawel Jakub Dawidek } 8748fbd94bSPawel Jakub Dawidek 8848fbd94bSPawel Jakub Dawidek /* 8948fbd94bSPawel Jakub Dawidek * Least Common Multiple. 9048fbd94bSPawel Jakub Dawidek */ 9148fbd94bSPawel Jakub Dawidek static u_int 9248fbd94bSPawel Jakub Dawidek lcm(u_int a, u_int b) 9348fbd94bSPawel Jakub Dawidek { 9448fbd94bSPawel Jakub Dawidek 9548fbd94bSPawel Jakub Dawidek return ((a * b) / gcd(a, b)); 9648fbd94bSPawel Jakub Dawidek } 9748fbd94bSPawel Jakub Dawidek 9848fbd94bSPawel Jakub Dawidek /* 9919d16e2fSPawel Jakub Dawidek * Return the number of valid disks. 10019d16e2fSPawel Jakub Dawidek */ 10119d16e2fSPawel Jakub Dawidek static u_int 10219d16e2fSPawel Jakub Dawidek g_concat_nvalid(struct g_concat_softc *sc) 10319d16e2fSPawel Jakub Dawidek { 10419d16e2fSPawel Jakub Dawidek u_int i, no; 10519d16e2fSPawel Jakub Dawidek 10619d16e2fSPawel Jakub Dawidek no = 0; 10719d16e2fSPawel Jakub Dawidek for (i = 0; i < sc->sc_ndisks; i++) { 108a88ae49fSPawel Jakub Dawidek if (sc->sc_disks[i].d_consumer != NULL) 10919d16e2fSPawel Jakub Dawidek no++; 11019d16e2fSPawel Jakub Dawidek } 11119d16e2fSPawel Jakub Dawidek 11219d16e2fSPawel Jakub Dawidek return (no); 11319d16e2fSPawel Jakub Dawidek } 11419d16e2fSPawel Jakub Dawidek 11519d16e2fSPawel Jakub Dawidek static void 11619d16e2fSPawel Jakub Dawidek g_concat_remove_disk(struct g_concat_disk *disk) 11719d16e2fSPawel Jakub Dawidek { 11819d16e2fSPawel Jakub Dawidek struct g_consumer *cp; 11919d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 12019d16e2fSPawel Jakub Dawidek 121df96fd6eSAlexander Motin g_topology_assert(); 122a88ae49fSPawel Jakub Dawidek KASSERT(disk->d_consumer != NULL, ("Non-valid disk in %s.", __func__)); 12319d16e2fSPawel Jakub Dawidek sc = disk->d_softc; 12419d16e2fSPawel Jakub Dawidek cp = disk->d_consumer; 12519d16e2fSPawel Jakub Dawidek 126df96fd6eSAlexander Motin if (!disk->d_removed) { 127df96fd6eSAlexander Motin G_CONCAT_DEBUG(0, "Disk %s removed from %s.", 128df96fd6eSAlexander Motin cp->provider->name, sc->sc_name); 129df96fd6eSAlexander Motin disk->d_removed = 1; 130df96fd6eSAlexander Motin } 13119d16e2fSPawel Jakub Dawidek 13202637cdcSPawel Jakub Dawidek if (sc->sc_provider != NULL) { 1330499edf4SPawel Jakub Dawidek sc->sc_provider->flags |= G_PF_WITHER; 134df96fd6eSAlexander Motin G_CONCAT_DEBUG(0, "Device %s deactivated.", 135df96fd6eSAlexander Motin sc->sc_provider->name); 13602637cdcSPawel Jakub Dawidek g_orphan_provider(sc->sc_provider, ENXIO); 13702637cdcSPawel Jakub Dawidek sc->sc_provider = NULL; 13802637cdcSPawel Jakub Dawidek } 13919d16e2fSPawel Jakub Dawidek 14019d16e2fSPawel Jakub Dawidek if (cp->acr > 0 || cp->acw > 0 || cp->ace > 0) 141df96fd6eSAlexander Motin return; 142df96fd6eSAlexander Motin disk->d_consumer = NULL; 14319d16e2fSPawel Jakub Dawidek g_detach(cp); 14419d16e2fSPawel Jakub Dawidek g_destroy_consumer(cp); 145df96fd6eSAlexander Motin /* If there are no valid disks anymore, remove device. */ 146df96fd6eSAlexander Motin if (LIST_EMPTY(&sc->sc_geom->consumer)) 147df96fd6eSAlexander Motin g_concat_destroy(sc, 1); 14819d16e2fSPawel Jakub Dawidek } 14919d16e2fSPawel Jakub Dawidek 15019d16e2fSPawel Jakub Dawidek static void 15119d16e2fSPawel Jakub Dawidek g_concat_orphan(struct g_consumer *cp) 15219d16e2fSPawel Jakub Dawidek { 15319d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 15419d16e2fSPawel Jakub Dawidek struct g_concat_disk *disk; 15519d16e2fSPawel Jakub Dawidek struct g_geom *gp; 15619d16e2fSPawel Jakub Dawidek 15719d16e2fSPawel Jakub Dawidek g_topology_assert(); 15819d16e2fSPawel Jakub Dawidek gp = cp->geom; 15919d16e2fSPawel Jakub Dawidek sc = gp->softc; 16019d16e2fSPawel Jakub Dawidek if (sc == NULL) 16119d16e2fSPawel Jakub Dawidek return; 16219d16e2fSPawel Jakub Dawidek 16319d16e2fSPawel Jakub Dawidek disk = cp->private; 16419d16e2fSPawel Jakub Dawidek if (disk == NULL) /* Possible? */ 16519d16e2fSPawel Jakub Dawidek return; 16619d16e2fSPawel Jakub Dawidek g_concat_remove_disk(disk); 16719d16e2fSPawel Jakub Dawidek } 16819d16e2fSPawel Jakub Dawidek 16919d16e2fSPawel Jakub Dawidek static int 17019d16e2fSPawel Jakub Dawidek g_concat_access(struct g_provider *pp, int dr, int dw, int de) 17119d16e2fSPawel Jakub Dawidek { 172df96fd6eSAlexander Motin struct g_consumer *cp1, *cp2, *tmp; 173df96fd6eSAlexander Motin struct g_concat_disk *disk; 17419d16e2fSPawel Jakub Dawidek struct g_geom *gp; 17519d16e2fSPawel Jakub Dawidek int error; 17619d16e2fSPawel Jakub Dawidek 177df96fd6eSAlexander Motin g_topology_assert(); 17819d16e2fSPawel Jakub Dawidek gp = pp->geom; 17919d16e2fSPawel Jakub Dawidek 18019d16e2fSPawel Jakub Dawidek /* On first open, grab an extra "exclusive" bit */ 18119d16e2fSPawel Jakub Dawidek if (pp->acr == 0 && pp->acw == 0 && pp->ace == 0) 18219d16e2fSPawel Jakub Dawidek de++; 18319d16e2fSPawel Jakub Dawidek /* ... and let go of it on last close */ 184be7695cfSPawel Jakub Dawidek if ((pp->acr + dr) == 0 && (pp->acw + dw) == 0 && (pp->ace + de) == 0) 18519d16e2fSPawel Jakub Dawidek de--; 18619d16e2fSPawel Jakub Dawidek 187df96fd6eSAlexander Motin LIST_FOREACH_SAFE(cp1, &gp->consumer, consumer, tmp) { 18819d16e2fSPawel Jakub Dawidek error = g_access(cp1, dr, dw, de); 189df96fd6eSAlexander Motin if (error != 0) 190df96fd6eSAlexander Motin goto fail; 191df96fd6eSAlexander Motin disk = cp1->private; 192df96fd6eSAlexander Motin if (cp1->acr == 0 && cp1->acw == 0 && cp1->ace == 0 && 193df96fd6eSAlexander Motin disk->d_removed) { 194df96fd6eSAlexander Motin g_concat_remove_disk(disk); /* May destroy geom. */ 195df96fd6eSAlexander Motin } 196df96fd6eSAlexander Motin } 197df96fd6eSAlexander Motin return (0); 198df96fd6eSAlexander Motin 199df96fd6eSAlexander Motin fail: 20019d16e2fSPawel Jakub Dawidek LIST_FOREACH(cp2, &gp->consumer, consumer) { 20119d16e2fSPawel Jakub Dawidek if (cp1 == cp2) 202df96fd6eSAlexander Motin break; 20319d16e2fSPawel Jakub Dawidek g_access(cp2, -dr, -dw, -de); 20419d16e2fSPawel Jakub Dawidek } 20519d16e2fSPawel Jakub Dawidek return (error); 20619d16e2fSPawel Jakub Dawidek } 20719d16e2fSPawel Jakub Dawidek 20819d16e2fSPawel Jakub Dawidek static void 209659f684eSAlexander Motin g_concat_kernel_dump(struct bio *bp) 210659f684eSAlexander Motin { 211659f684eSAlexander Motin struct g_concat_softc *sc; 212659f684eSAlexander Motin struct g_concat_disk *disk; 213659f684eSAlexander Motin struct bio *cbp; 214659f684eSAlexander Motin struct g_kerneldump *gkd; 215659f684eSAlexander Motin u_int i; 216659f684eSAlexander Motin 217659f684eSAlexander Motin sc = bp->bio_to->geom->softc; 218659f684eSAlexander Motin gkd = (struct g_kerneldump *)bp->bio_data; 219659f684eSAlexander Motin for (i = 0; i < sc->sc_ndisks; i++) { 220659f684eSAlexander Motin if (sc->sc_disks[i].d_start <= gkd->offset && 221659f684eSAlexander Motin sc->sc_disks[i].d_end > gkd->offset) 222659f684eSAlexander Motin break; 223659f684eSAlexander Motin } 224659f684eSAlexander Motin if (i == sc->sc_ndisks) 225659f684eSAlexander Motin g_io_deliver(bp, EOPNOTSUPP); 226659f684eSAlexander Motin disk = &sc->sc_disks[i]; 227659f684eSAlexander Motin gkd->offset -= disk->d_start; 228659f684eSAlexander Motin if (gkd->length > disk->d_end - disk->d_start - gkd->offset) 229659f684eSAlexander Motin gkd->length = disk->d_end - disk->d_start - gkd->offset; 230659f684eSAlexander Motin cbp = g_clone_bio(bp); 231659f684eSAlexander Motin if (cbp == NULL) { 232659f684eSAlexander Motin g_io_deliver(bp, ENOMEM); 233659f684eSAlexander Motin return; 234659f684eSAlexander Motin } 235659f684eSAlexander Motin cbp->bio_done = g_std_done; 236659f684eSAlexander Motin g_io_request(cbp, disk->d_consumer); 237659f684eSAlexander Motin G_CONCAT_DEBUG(1, "Kernel dump will go to %s.", 238659f684eSAlexander Motin disk->d_consumer->provider->name); 239659f684eSAlexander Motin } 240659f684eSAlexander Motin 241659f684eSAlexander Motin static void 24242461fbaSPawel Jakub Dawidek g_concat_flush(struct g_concat_softc *sc, struct bio *bp) 24342461fbaSPawel Jakub Dawidek { 24442461fbaSPawel Jakub Dawidek struct bio_queue_head queue; 24542461fbaSPawel Jakub Dawidek struct g_consumer *cp; 24642461fbaSPawel Jakub Dawidek struct bio *cbp; 24742461fbaSPawel Jakub Dawidek u_int no; 24842461fbaSPawel Jakub Dawidek 24942461fbaSPawel Jakub Dawidek bioq_init(&queue); 25042461fbaSPawel Jakub Dawidek for (no = 0; no < sc->sc_ndisks; no++) { 25142461fbaSPawel Jakub Dawidek cbp = g_clone_bio(bp); 25242461fbaSPawel Jakub Dawidek if (cbp == NULL) { 25342461fbaSPawel Jakub Dawidek for (cbp = bioq_first(&queue); cbp != NULL; 25442461fbaSPawel Jakub Dawidek cbp = bioq_first(&queue)) { 25542461fbaSPawel Jakub Dawidek bioq_remove(&queue, cbp); 25642461fbaSPawel Jakub Dawidek g_destroy_bio(cbp); 25742461fbaSPawel Jakub Dawidek } 25842461fbaSPawel Jakub Dawidek if (bp->bio_error == 0) 25942461fbaSPawel Jakub Dawidek bp->bio_error = ENOMEM; 26042461fbaSPawel Jakub Dawidek g_io_deliver(bp, bp->bio_error); 26142461fbaSPawel Jakub Dawidek return; 26242461fbaSPawel Jakub Dawidek } 26342461fbaSPawel Jakub Dawidek bioq_insert_tail(&queue, cbp); 26442461fbaSPawel Jakub Dawidek cbp->bio_done = g_std_done; 26542461fbaSPawel Jakub Dawidek cbp->bio_caller1 = sc->sc_disks[no].d_consumer; 26642461fbaSPawel Jakub Dawidek cbp->bio_to = sc->sc_disks[no].d_consumer->provider; 26742461fbaSPawel Jakub Dawidek } 26842461fbaSPawel Jakub Dawidek for (cbp = bioq_first(&queue); cbp != NULL; cbp = bioq_first(&queue)) { 26942461fbaSPawel Jakub Dawidek bioq_remove(&queue, cbp); 27042461fbaSPawel Jakub Dawidek G_CONCAT_LOGREQ(cbp, "Sending request."); 27142461fbaSPawel Jakub Dawidek cp = cbp->bio_caller1; 27242461fbaSPawel Jakub Dawidek cbp->bio_caller1 = NULL; 27342461fbaSPawel Jakub Dawidek g_io_request(cbp, cp); 27442461fbaSPawel Jakub Dawidek } 27542461fbaSPawel Jakub Dawidek } 27642461fbaSPawel Jakub Dawidek 27742461fbaSPawel Jakub Dawidek static void 27819d16e2fSPawel Jakub Dawidek g_concat_start(struct bio *bp) 27919d16e2fSPawel Jakub Dawidek { 2807e0b3120SPawel Jakub Dawidek struct bio_queue_head queue; 28119d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 28219d16e2fSPawel Jakub Dawidek struct g_concat_disk *disk; 28319d16e2fSPawel Jakub Dawidek struct g_provider *pp; 28419d16e2fSPawel Jakub Dawidek off_t offset, end, length, off, len; 28519d16e2fSPawel Jakub Dawidek struct bio *cbp; 28619d16e2fSPawel Jakub Dawidek char *addr; 28719d16e2fSPawel Jakub Dawidek u_int no; 28819d16e2fSPawel Jakub Dawidek 28919d16e2fSPawel Jakub Dawidek pp = bp->bio_to; 29019d16e2fSPawel Jakub Dawidek sc = pp->geom->softc; 29119d16e2fSPawel Jakub Dawidek /* 29219d16e2fSPawel Jakub Dawidek * If sc == NULL, provider's error should be set and g_concat_start() 29319d16e2fSPawel Jakub Dawidek * should not be called at all. 29419d16e2fSPawel Jakub Dawidek */ 29519d16e2fSPawel Jakub Dawidek KASSERT(sc != NULL, 29619d16e2fSPawel Jakub Dawidek ("Provider's error should be set (error=%d)(device=%s).", 29719d16e2fSPawel Jakub Dawidek bp->bio_to->error, bp->bio_to->name)); 29819d16e2fSPawel Jakub Dawidek 29919d16e2fSPawel Jakub Dawidek G_CONCAT_LOGREQ(bp, "Request received."); 30019d16e2fSPawel Jakub Dawidek 30119d16e2fSPawel Jakub Dawidek switch (bp->bio_cmd) { 30219d16e2fSPawel Jakub Dawidek case BIO_READ: 30319d16e2fSPawel Jakub Dawidek case BIO_WRITE: 30419d16e2fSPawel Jakub Dawidek case BIO_DELETE: 30519d16e2fSPawel Jakub Dawidek break; 30642461fbaSPawel Jakub Dawidek case BIO_FLUSH: 30742461fbaSPawel Jakub Dawidek g_concat_flush(sc, bp); 30842461fbaSPawel Jakub Dawidek return; 30919d16e2fSPawel Jakub Dawidek case BIO_GETATTR: 310659f684eSAlexander Motin if (strcmp("GEOM::kerneldump", bp->bio_attribute) == 0) { 311659f684eSAlexander Motin g_concat_kernel_dump(bp); 312659f684eSAlexander Motin return; 313659f684eSAlexander Motin } 31419d16e2fSPawel Jakub Dawidek /* To which provider it should be delivered? */ 315659f684eSAlexander Motin /* FALLTHROUGH */ 31619d16e2fSPawel Jakub Dawidek default: 31719d16e2fSPawel Jakub Dawidek g_io_deliver(bp, EOPNOTSUPP); 31819d16e2fSPawel Jakub Dawidek return; 31919d16e2fSPawel Jakub Dawidek } 32019d16e2fSPawel Jakub Dawidek 32119d16e2fSPawel Jakub Dawidek offset = bp->bio_offset; 32219d16e2fSPawel Jakub Dawidek length = bp->bio_length; 32319d16e2fSPawel Jakub Dawidek addr = bp->bio_data; 32419d16e2fSPawel Jakub Dawidek end = offset + length; 32519d16e2fSPawel Jakub Dawidek 3267e0b3120SPawel Jakub Dawidek bioq_init(&queue); 32719d16e2fSPawel Jakub Dawidek for (no = 0; no < sc->sc_ndisks; no++) { 32819d16e2fSPawel Jakub Dawidek disk = &sc->sc_disks[no]; 32919d16e2fSPawel Jakub Dawidek if (disk->d_end <= offset) 33019d16e2fSPawel Jakub Dawidek continue; 33119d16e2fSPawel Jakub Dawidek if (disk->d_start >= end) 33219d16e2fSPawel Jakub Dawidek break; 33319d16e2fSPawel Jakub Dawidek 33419d16e2fSPawel Jakub Dawidek off = offset - disk->d_start; 33519d16e2fSPawel Jakub Dawidek len = MIN(length, disk->d_end - offset); 33619d16e2fSPawel Jakub Dawidek length -= len; 33719d16e2fSPawel Jakub Dawidek offset += len; 33819d16e2fSPawel Jakub Dawidek 33919d16e2fSPawel Jakub Dawidek cbp = g_clone_bio(bp); 34019d16e2fSPawel Jakub Dawidek if (cbp == NULL) { 3417e0b3120SPawel Jakub Dawidek for (cbp = bioq_first(&queue); cbp != NULL; 3427e0b3120SPawel Jakub Dawidek cbp = bioq_first(&queue)) { 3437e0b3120SPawel Jakub Dawidek bioq_remove(&queue, cbp); 3447e0b3120SPawel Jakub Dawidek g_destroy_bio(cbp); 3457e0b3120SPawel Jakub Dawidek } 34619d16e2fSPawel Jakub Dawidek if (bp->bio_error == 0) 34719d16e2fSPawel Jakub Dawidek bp->bio_error = ENOMEM; 3487e0b3120SPawel Jakub Dawidek g_io_deliver(bp, bp->bio_error); 34919d16e2fSPawel Jakub Dawidek return; 35019d16e2fSPawel Jakub Dawidek } 3517e0b3120SPawel Jakub Dawidek bioq_insert_tail(&queue, cbp); 35219d16e2fSPawel Jakub Dawidek /* 35319d16e2fSPawel Jakub Dawidek * Fill in the component buf structure. 35419d16e2fSPawel Jakub Dawidek */ 35519d16e2fSPawel Jakub Dawidek cbp->bio_done = g_std_done; 35619d16e2fSPawel Jakub Dawidek cbp->bio_offset = off; 35719d16e2fSPawel Jakub Dawidek cbp->bio_data = addr; 35819d16e2fSPawel Jakub Dawidek addr += len; 35919d16e2fSPawel Jakub Dawidek cbp->bio_length = len; 36019d16e2fSPawel Jakub Dawidek cbp->bio_to = disk->d_consumer->provider; 3617e0b3120SPawel Jakub Dawidek cbp->bio_caller1 = disk; 36219d16e2fSPawel Jakub Dawidek 36319d16e2fSPawel Jakub Dawidek if (length == 0) 36419d16e2fSPawel Jakub Dawidek break; 36519d16e2fSPawel Jakub Dawidek } 36619d16e2fSPawel Jakub Dawidek KASSERT(length == 0, 36719d16e2fSPawel Jakub Dawidek ("Length is still greater than 0 (class=%s, name=%s).", 36819d16e2fSPawel Jakub Dawidek bp->bio_to->geom->class->name, bp->bio_to->geom->name)); 3697e0b3120SPawel Jakub Dawidek for (cbp = bioq_first(&queue); cbp != NULL; cbp = bioq_first(&queue)) { 3707e0b3120SPawel Jakub Dawidek bioq_remove(&queue, cbp); 3717e0b3120SPawel Jakub Dawidek G_CONCAT_LOGREQ(cbp, "Sending request."); 3727e0b3120SPawel Jakub Dawidek disk = cbp->bio_caller1; 3737e0b3120SPawel Jakub Dawidek cbp->bio_caller1 = NULL; 3747e0b3120SPawel Jakub Dawidek g_io_request(cbp, disk->d_consumer); 3757e0b3120SPawel Jakub Dawidek } 37619d16e2fSPawel Jakub Dawidek } 37719d16e2fSPawel Jakub Dawidek 37819d16e2fSPawel Jakub Dawidek static void 37919d16e2fSPawel Jakub Dawidek g_concat_check_and_run(struct g_concat_softc *sc) 38019d16e2fSPawel Jakub Dawidek { 38119d16e2fSPawel Jakub Dawidek struct g_concat_disk *disk; 3825f9b1143SAlexander Motin struct g_provider *pp; 38348fbd94bSPawel Jakub Dawidek u_int no, sectorsize = 0; 38419d16e2fSPawel Jakub Dawidek off_t start; 38519d16e2fSPawel Jakub Dawidek 386df96fd6eSAlexander Motin g_topology_assert(); 38719d16e2fSPawel Jakub Dawidek if (g_concat_nvalid(sc) != sc->sc_ndisks) 38819d16e2fSPawel Jakub Dawidek return; 38919d16e2fSPawel Jakub Dawidek 3905f9b1143SAlexander Motin pp = g_new_providerf(sc->sc_geom, "concat/%s", sc->sc_name); 39119d16e2fSPawel Jakub Dawidek start = 0; 39219d16e2fSPawel Jakub Dawidek for (no = 0; no < sc->sc_ndisks; no++) { 39319d16e2fSPawel Jakub Dawidek disk = &sc->sc_disks[no]; 39419d16e2fSPawel Jakub Dawidek disk->d_start = start; 39519d16e2fSPawel Jakub Dawidek disk->d_end = disk->d_start + 39619d16e2fSPawel Jakub Dawidek disk->d_consumer->provider->mediasize; 39719d16e2fSPawel Jakub Dawidek if (sc->sc_type == G_CONCAT_TYPE_AUTOMATIC) 39819d16e2fSPawel Jakub Dawidek disk->d_end -= disk->d_consumer->provider->sectorsize; 39919d16e2fSPawel Jakub Dawidek start = disk->d_end; 40048fbd94bSPawel Jakub Dawidek if (no == 0) 40148fbd94bSPawel Jakub Dawidek sectorsize = disk->d_consumer->provider->sectorsize; 40248fbd94bSPawel Jakub Dawidek else { 40348fbd94bSPawel Jakub Dawidek sectorsize = lcm(sectorsize, 40448fbd94bSPawel Jakub Dawidek disk->d_consumer->provider->sectorsize); 40519d16e2fSPawel Jakub Dawidek } 40648fbd94bSPawel Jakub Dawidek } 4075f9b1143SAlexander Motin pp->sectorsize = sectorsize; 40819d16e2fSPawel Jakub Dawidek /* We have sc->sc_disks[sc->sc_ndisks - 1].d_end in 'start'. */ 4095f9b1143SAlexander Motin pp->mediasize = start; 4105f9b1143SAlexander Motin pp->stripesize = sc->sc_disks[0].d_consumer->provider->stripesize; 4115f9b1143SAlexander Motin pp->stripeoffset = sc->sc_disks[0].d_consumer->provider->stripeoffset; 4125f9b1143SAlexander Motin sc->sc_provider = pp; 4135f9b1143SAlexander Motin g_error_provider(pp, 0); 41419d16e2fSPawel Jakub Dawidek 415df96fd6eSAlexander Motin G_CONCAT_DEBUG(0, "Device %s activated.", sc->sc_provider->name); 41619d16e2fSPawel Jakub Dawidek } 41719d16e2fSPawel Jakub Dawidek 41819d16e2fSPawel Jakub Dawidek static int 41919d16e2fSPawel Jakub Dawidek g_concat_read_metadata(struct g_consumer *cp, struct g_concat_metadata *md) 42019d16e2fSPawel Jakub Dawidek { 42119d16e2fSPawel Jakub Dawidek struct g_provider *pp; 42219d16e2fSPawel Jakub Dawidek u_char *buf; 42319d16e2fSPawel Jakub Dawidek int error; 42419d16e2fSPawel Jakub Dawidek 42519d16e2fSPawel Jakub Dawidek g_topology_assert(); 42619d16e2fSPawel Jakub Dawidek 42719d16e2fSPawel Jakub Dawidek error = g_access(cp, 1, 0, 0); 42819d16e2fSPawel Jakub Dawidek if (error != 0) 42919d16e2fSPawel Jakub Dawidek return (error); 43019d16e2fSPawel Jakub Dawidek pp = cp->provider; 43119d16e2fSPawel Jakub Dawidek g_topology_unlock(); 43219d16e2fSPawel Jakub Dawidek buf = g_read_data(cp, pp->mediasize - pp->sectorsize, pp->sectorsize, 43319d16e2fSPawel Jakub Dawidek &error); 43419d16e2fSPawel Jakub Dawidek g_topology_lock(); 43519d16e2fSPawel Jakub Dawidek g_access(cp, -1, 0, 0); 43619d16e2fSPawel Jakub Dawidek if (buf == NULL) 43719d16e2fSPawel Jakub Dawidek return (error); 43819d16e2fSPawel Jakub Dawidek 43919d16e2fSPawel Jakub Dawidek /* Decode metadata. */ 44019d16e2fSPawel Jakub Dawidek concat_metadata_decode(buf, md); 44119d16e2fSPawel Jakub Dawidek g_free(buf); 44219d16e2fSPawel Jakub Dawidek 44319d16e2fSPawel Jakub Dawidek return (0); 44419d16e2fSPawel Jakub Dawidek } 44519d16e2fSPawel Jakub Dawidek 44619d16e2fSPawel Jakub Dawidek /* 44719d16e2fSPawel Jakub Dawidek * Add disk to given device. 44819d16e2fSPawel Jakub Dawidek */ 44919d16e2fSPawel Jakub Dawidek static int 45019d16e2fSPawel Jakub Dawidek g_concat_add_disk(struct g_concat_softc *sc, struct g_provider *pp, u_int no) 45119d16e2fSPawel Jakub Dawidek { 45219d16e2fSPawel Jakub Dawidek struct g_concat_disk *disk; 45302637cdcSPawel Jakub Dawidek struct g_consumer *cp, *fcp; 45419d16e2fSPawel Jakub Dawidek struct g_geom *gp; 45519d16e2fSPawel Jakub Dawidek int error; 45619d16e2fSPawel Jakub Dawidek 457df96fd6eSAlexander Motin g_topology_assert(); 45819d16e2fSPawel Jakub Dawidek /* Metadata corrupted? */ 45919d16e2fSPawel Jakub Dawidek if (no >= sc->sc_ndisks) 46019d16e2fSPawel Jakub Dawidek return (EINVAL); 46119d16e2fSPawel Jakub Dawidek 46219d16e2fSPawel Jakub Dawidek disk = &sc->sc_disks[no]; 46319d16e2fSPawel Jakub Dawidek /* Check if disk is not already attached. */ 464a88ae49fSPawel Jakub Dawidek if (disk->d_consumer != NULL) 46519d16e2fSPawel Jakub Dawidek return (EEXIST); 46619d16e2fSPawel Jakub Dawidek 46702637cdcSPawel Jakub Dawidek gp = sc->sc_geom; 46802637cdcSPawel Jakub Dawidek fcp = LIST_FIRST(&gp->consumer); 46919d16e2fSPawel Jakub Dawidek 47019d16e2fSPawel Jakub Dawidek cp = g_new_consumer(gp); 47119d16e2fSPawel Jakub Dawidek error = g_attach(cp, pp); 47219d16e2fSPawel Jakub Dawidek if (error != 0) { 47319d16e2fSPawel Jakub Dawidek g_destroy_consumer(cp); 47419d16e2fSPawel Jakub Dawidek return (error); 47519d16e2fSPawel Jakub Dawidek } 47619d16e2fSPawel Jakub Dawidek 47702637cdcSPawel Jakub Dawidek if (fcp != NULL && (fcp->acr > 0 || fcp->acw > 0 || fcp->ace > 0)) { 47802637cdcSPawel Jakub Dawidek error = g_access(cp, fcp->acr, fcp->acw, fcp->ace); 47919d16e2fSPawel Jakub Dawidek if (error != 0) { 48019d16e2fSPawel Jakub Dawidek g_detach(cp); 48119d16e2fSPawel Jakub Dawidek g_destroy_consumer(cp); 48219d16e2fSPawel Jakub Dawidek return (error); 48319d16e2fSPawel Jakub Dawidek } 48419d16e2fSPawel Jakub Dawidek } 48519d16e2fSPawel Jakub Dawidek if (sc->sc_type == G_CONCAT_TYPE_AUTOMATIC) { 48619d16e2fSPawel Jakub Dawidek struct g_concat_metadata md; 48719d16e2fSPawel Jakub Dawidek 48848fbd94bSPawel Jakub Dawidek /* Re-read metadata. */ 48919d16e2fSPawel Jakub Dawidek error = g_concat_read_metadata(cp, &md); 49019d16e2fSPawel Jakub Dawidek if (error != 0) 49119d16e2fSPawel Jakub Dawidek goto fail; 49219d16e2fSPawel Jakub Dawidek 49319d16e2fSPawel Jakub Dawidek if (strcmp(md.md_magic, G_CONCAT_MAGIC) != 0 || 49419d16e2fSPawel Jakub Dawidek strcmp(md.md_name, sc->sc_name) != 0 || 49519d16e2fSPawel Jakub Dawidek md.md_id != sc->sc_id) { 49619d16e2fSPawel Jakub Dawidek G_CONCAT_DEBUG(0, "Metadata on %s changed.", pp->name); 49719d16e2fSPawel Jakub Dawidek goto fail; 49819d16e2fSPawel Jakub Dawidek } 49919d16e2fSPawel Jakub Dawidek } 50019d16e2fSPawel Jakub Dawidek 50119d16e2fSPawel Jakub Dawidek cp->private = disk; 50219d16e2fSPawel Jakub Dawidek disk->d_consumer = cp; 50319d16e2fSPawel Jakub Dawidek disk->d_softc = sc; 50419d16e2fSPawel Jakub Dawidek disk->d_start = 0; /* not yet */ 50519d16e2fSPawel Jakub Dawidek disk->d_end = 0; /* not yet */ 506df96fd6eSAlexander Motin disk->d_removed = 0; 50719d16e2fSPawel Jakub Dawidek 508ba385d00SPawel Jakub Dawidek G_CONCAT_DEBUG(0, "Disk %s attached to %s.", pp->name, sc->sc_name); 50919d16e2fSPawel Jakub Dawidek 51019d16e2fSPawel Jakub Dawidek g_concat_check_and_run(sc); 51119d16e2fSPawel Jakub Dawidek 51219d16e2fSPawel Jakub Dawidek return (0); 51319d16e2fSPawel Jakub Dawidek fail: 51402637cdcSPawel Jakub Dawidek if (fcp != NULL && (fcp->acr > 0 || fcp->acw > 0 || fcp->ace > 0)) 51502637cdcSPawel Jakub Dawidek g_access(cp, -fcp->acr, -fcp->acw, -fcp->ace); 51619d16e2fSPawel Jakub Dawidek g_detach(cp); 51719d16e2fSPawel Jakub Dawidek g_destroy_consumer(cp); 51819d16e2fSPawel Jakub Dawidek return (error); 51919d16e2fSPawel Jakub Dawidek } 52019d16e2fSPawel Jakub Dawidek 52119d16e2fSPawel Jakub Dawidek static struct g_geom * 52219d16e2fSPawel Jakub Dawidek g_concat_create(struct g_class *mp, const struct g_concat_metadata *md, 52348fbd94bSPawel Jakub Dawidek u_int type) 52419d16e2fSPawel Jakub Dawidek { 52519d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 52619d16e2fSPawel Jakub Dawidek struct g_geom *gp; 52719d16e2fSPawel Jakub Dawidek u_int no; 52819d16e2fSPawel Jakub Dawidek 529ba385d00SPawel Jakub Dawidek G_CONCAT_DEBUG(1, "Creating device %s (id=%u).", md->md_name, 53019d16e2fSPawel Jakub Dawidek md->md_id); 53119d16e2fSPawel Jakub Dawidek 532aaf8e186SPawel Jakub Dawidek /* One disks is minimum. */ 533aaf8e186SPawel Jakub Dawidek if (md->md_all < 1) 53419d16e2fSPawel Jakub Dawidek return (NULL); 53519d16e2fSPawel Jakub Dawidek 53619d16e2fSPawel Jakub Dawidek /* Check for duplicate unit */ 53719d16e2fSPawel Jakub Dawidek LIST_FOREACH(gp, &mp->geom, geom) { 53819d16e2fSPawel Jakub Dawidek sc = gp->softc; 53919d16e2fSPawel Jakub Dawidek if (sc != NULL && strcmp(sc->sc_name, md->md_name) == 0) { 54002637cdcSPawel Jakub Dawidek G_CONCAT_DEBUG(0, "Device %s already configured.", 54119d16e2fSPawel Jakub Dawidek gp->name); 54219d16e2fSPawel Jakub Dawidek return (NULL); 54319d16e2fSPawel Jakub Dawidek } 54419d16e2fSPawel Jakub Dawidek } 545ba385d00SPawel Jakub Dawidek gp = g_new_geomf(mp, "%s", md->md_name); 54675cc259dSPawel Jakub Dawidek sc = malloc(sizeof(*sc), M_CONCAT, M_WAITOK | M_ZERO); 54719d16e2fSPawel Jakub Dawidek gp->start = g_concat_start; 54819d16e2fSPawel Jakub Dawidek gp->spoiled = g_concat_orphan; 54919d16e2fSPawel Jakub Dawidek gp->orphan = g_concat_orphan; 55019d16e2fSPawel Jakub Dawidek gp->access = g_concat_access; 55119d16e2fSPawel Jakub Dawidek gp->dumpconf = g_concat_dumpconf; 55219d16e2fSPawel Jakub Dawidek 55319d16e2fSPawel Jakub Dawidek sc->sc_id = md->md_id; 55419d16e2fSPawel Jakub Dawidek sc->sc_ndisks = md->md_all; 55519d16e2fSPawel Jakub Dawidek sc->sc_disks = malloc(sizeof(struct g_concat_disk) * sc->sc_ndisks, 55619d16e2fSPawel Jakub Dawidek M_CONCAT, M_WAITOK | M_ZERO); 55719d16e2fSPawel Jakub Dawidek for (no = 0; no < sc->sc_ndisks; no++) 558a88ae49fSPawel Jakub Dawidek sc->sc_disks[no].d_consumer = NULL; 55919d16e2fSPawel Jakub Dawidek sc->sc_type = type; 56019d16e2fSPawel Jakub Dawidek 56119d16e2fSPawel Jakub Dawidek gp->softc = sc; 56202637cdcSPawel Jakub Dawidek sc->sc_geom = gp; 56302637cdcSPawel Jakub Dawidek sc->sc_provider = NULL; 56419d16e2fSPawel Jakub Dawidek 565ba385d00SPawel Jakub Dawidek G_CONCAT_DEBUG(0, "Device %s created (id=%u).", sc->sc_name, sc->sc_id); 56619d16e2fSPawel Jakub Dawidek 56719d16e2fSPawel Jakub Dawidek return (gp); 56819d16e2fSPawel Jakub Dawidek } 56919d16e2fSPawel Jakub Dawidek 57019d16e2fSPawel Jakub Dawidek static int 57119d16e2fSPawel Jakub Dawidek g_concat_destroy(struct g_concat_softc *sc, boolean_t force) 57219d16e2fSPawel Jakub Dawidek { 57319d16e2fSPawel Jakub Dawidek struct g_provider *pp; 574df96fd6eSAlexander Motin struct g_consumer *cp, *cp1; 57519d16e2fSPawel Jakub Dawidek struct g_geom *gp; 57619d16e2fSPawel Jakub Dawidek 57719d16e2fSPawel Jakub Dawidek g_topology_assert(); 57819d16e2fSPawel Jakub Dawidek 57919d16e2fSPawel Jakub Dawidek if (sc == NULL) 58019d16e2fSPawel Jakub Dawidek return (ENXIO); 58119d16e2fSPawel Jakub Dawidek 58219d16e2fSPawel Jakub Dawidek pp = sc->sc_provider; 58302637cdcSPawel Jakub Dawidek if (pp != NULL && (pp->acr != 0 || pp->acw != 0 || pp->ace != 0)) { 58419d16e2fSPawel Jakub Dawidek if (force) { 58519d16e2fSPawel Jakub Dawidek G_CONCAT_DEBUG(0, "Device %s is still open, so it " 58602637cdcSPawel Jakub Dawidek "can't be definitely removed.", pp->name); 58719d16e2fSPawel Jakub Dawidek } else { 58819d16e2fSPawel Jakub Dawidek G_CONCAT_DEBUG(1, 58902637cdcSPawel Jakub Dawidek "Device %s is still open (r%dw%de%d).", pp->name, 59002637cdcSPawel Jakub Dawidek pp->acr, pp->acw, pp->ace); 59119d16e2fSPawel Jakub Dawidek return (EBUSY); 59219d16e2fSPawel Jakub Dawidek } 59319d16e2fSPawel Jakub Dawidek } 59419d16e2fSPawel Jakub Dawidek 59502637cdcSPawel Jakub Dawidek gp = sc->sc_geom; 596df96fd6eSAlexander Motin LIST_FOREACH_SAFE(cp, &gp->consumer, consumer, cp1) { 597df96fd6eSAlexander Motin g_concat_remove_disk(cp->private); 598df96fd6eSAlexander Motin if (cp1 == NULL) 599df96fd6eSAlexander Motin return (0); /* Recursion happened. */ 600df96fd6eSAlexander Motin } 601df96fd6eSAlexander Motin if (!LIST_EMPTY(&gp->consumer)) 602df96fd6eSAlexander Motin return (EINPROGRESS); 603df96fd6eSAlexander Motin 60419d16e2fSPawel Jakub Dawidek gp->softc = NULL; 60502637cdcSPawel Jakub Dawidek KASSERT(sc->sc_provider == NULL, ("Provider still exists? (device=%s)", 60602637cdcSPawel Jakub Dawidek gp->name)); 60719d16e2fSPawel Jakub Dawidek free(sc->sc_disks, M_CONCAT); 60819d16e2fSPawel Jakub Dawidek free(sc, M_CONCAT); 60919d16e2fSPawel Jakub Dawidek 61002637cdcSPawel Jakub Dawidek G_CONCAT_DEBUG(0, "Device %s destroyed.", gp->name); 61119d16e2fSPawel Jakub Dawidek g_wither_geom(gp, ENXIO); 61219d16e2fSPawel Jakub Dawidek return (0); 61319d16e2fSPawel Jakub Dawidek } 61419d16e2fSPawel Jakub Dawidek 61519d16e2fSPawel Jakub Dawidek static int 61648fbd94bSPawel Jakub Dawidek g_concat_destroy_geom(struct gctl_req *req __unused, 61748fbd94bSPawel Jakub Dawidek struct g_class *mp __unused, struct g_geom *gp) 61819d16e2fSPawel Jakub Dawidek { 61919d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 62019d16e2fSPawel Jakub Dawidek 62119d16e2fSPawel Jakub Dawidek sc = gp->softc; 62219d16e2fSPawel Jakub Dawidek return (g_concat_destroy(sc, 0)); 62319d16e2fSPawel Jakub Dawidek } 62419d16e2fSPawel Jakub Dawidek 62519d16e2fSPawel Jakub Dawidek static struct g_geom * 62619d16e2fSPawel Jakub Dawidek g_concat_taste(struct g_class *mp, struct g_provider *pp, int flags __unused) 62719d16e2fSPawel Jakub Dawidek { 62819d16e2fSPawel Jakub Dawidek struct g_concat_metadata md; 62919d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 63019d16e2fSPawel Jakub Dawidek struct g_consumer *cp; 63119d16e2fSPawel Jakub Dawidek struct g_geom *gp; 63219d16e2fSPawel Jakub Dawidek int error; 63319d16e2fSPawel Jakub Dawidek 63402637cdcSPawel Jakub Dawidek g_trace(G_T_TOPOLOGY, "%s(%s, %s)", __func__, mp->name, pp->name); 63519d16e2fSPawel Jakub Dawidek g_topology_assert(); 63619d16e2fSPawel Jakub Dawidek 637f8727e71SPawel Jakub Dawidek /* Skip providers that are already open for writing. */ 638f8727e71SPawel Jakub Dawidek if (pp->acw > 0) 639f8727e71SPawel Jakub Dawidek return (NULL); 640f8727e71SPawel Jakub Dawidek 64119d16e2fSPawel Jakub Dawidek G_CONCAT_DEBUG(3, "Tasting %s.", pp->name); 64219d16e2fSPawel Jakub Dawidek 64319d16e2fSPawel Jakub Dawidek gp = g_new_geomf(mp, "concat:taste"); 64419d16e2fSPawel Jakub Dawidek gp->start = g_concat_start; 64519d16e2fSPawel Jakub Dawidek gp->access = g_concat_access; 6460e2ff283SPawel Jakub Dawidek gp->orphan = g_concat_orphan; 64719d16e2fSPawel Jakub Dawidek cp = g_new_consumer(gp); 64819d16e2fSPawel Jakub Dawidek g_attach(cp, pp); 64919d16e2fSPawel Jakub Dawidek error = g_concat_read_metadata(cp, &md); 6507e72a708SPawel Jakub Dawidek g_detach(cp); 6517e72a708SPawel Jakub Dawidek g_destroy_consumer(cp); 6527e72a708SPawel Jakub Dawidek g_destroy_geom(gp); 65302637cdcSPawel Jakub Dawidek if (error != 0) 65419d16e2fSPawel Jakub Dawidek return (NULL); 65519d16e2fSPawel Jakub Dawidek gp = NULL; 65619d16e2fSPawel Jakub Dawidek 65719d16e2fSPawel Jakub Dawidek if (strcmp(md.md_magic, G_CONCAT_MAGIC) != 0) 65819d16e2fSPawel Jakub Dawidek return (NULL); 65919d16e2fSPawel Jakub Dawidek if (md.md_version > G_CONCAT_VERSION) { 66019d16e2fSPawel Jakub Dawidek printf("geom_concat.ko module is too old to handle %s.\n", 66119d16e2fSPawel Jakub Dawidek pp->name); 66219d16e2fSPawel Jakub Dawidek return (NULL); 66319d16e2fSPawel Jakub Dawidek } 6646c74f517SPawel Jakub Dawidek /* 6656c74f517SPawel Jakub Dawidek * Backward compatibility: 6666c74f517SPawel Jakub Dawidek */ 667e6890985SPawel Jakub Dawidek /* There was no md_provider field in earlier versions of metadata. */ 6686c74f517SPawel Jakub Dawidek if (md.md_version < 3) 6696c74f517SPawel Jakub Dawidek bzero(md.md_provider, sizeof(md.md_provider)); 670e6890985SPawel Jakub Dawidek /* There was no md_provsize field in earlier versions of metadata. */ 671e6890985SPawel Jakub Dawidek if (md.md_version < 4) 672e6890985SPawel Jakub Dawidek md.md_provsize = pp->mediasize; 6736c74f517SPawel Jakub Dawidek 67490f2be24SAlexander Motin if (md.md_provider[0] != '\0' && 67590f2be24SAlexander Motin !g_compare_names(md.md_provider, pp->name)) 6766c74f517SPawel Jakub Dawidek return (NULL); 677e6890985SPawel Jakub Dawidek if (md.md_provsize != pp->mediasize) 678e6890985SPawel Jakub Dawidek return (NULL); 67919d16e2fSPawel Jakub Dawidek 68019d16e2fSPawel Jakub Dawidek /* 68119d16e2fSPawel Jakub Dawidek * Let's check if device already exists. 68219d16e2fSPawel Jakub Dawidek */ 683c2496c87SPawel Jakub Dawidek sc = NULL; 68419d16e2fSPawel Jakub Dawidek LIST_FOREACH(gp, &mp->geom, geom) { 68519d16e2fSPawel Jakub Dawidek sc = gp->softc; 68619d16e2fSPawel Jakub Dawidek if (sc == NULL) 68719d16e2fSPawel Jakub Dawidek continue; 68819d16e2fSPawel Jakub Dawidek if (sc->sc_type != G_CONCAT_TYPE_AUTOMATIC) 68919d16e2fSPawel Jakub Dawidek continue; 69019d16e2fSPawel Jakub Dawidek if (strcmp(md.md_name, sc->sc_name) != 0) 69119d16e2fSPawel Jakub Dawidek continue; 69219d16e2fSPawel Jakub Dawidek if (md.md_id != sc->sc_id) 69319d16e2fSPawel Jakub Dawidek continue; 69419d16e2fSPawel Jakub Dawidek break; 69519d16e2fSPawel Jakub Dawidek } 69619d16e2fSPawel Jakub Dawidek if (gp != NULL) { 69719d16e2fSPawel Jakub Dawidek G_CONCAT_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name); 69819d16e2fSPawel Jakub Dawidek error = g_concat_add_disk(sc, pp, md.md_no); 69919d16e2fSPawel Jakub Dawidek if (error != 0) { 70002637cdcSPawel Jakub Dawidek G_CONCAT_DEBUG(0, 70102637cdcSPawel Jakub Dawidek "Cannot add disk %s to %s (error=%d).", pp->name, 70202637cdcSPawel Jakub Dawidek gp->name, error); 70319d16e2fSPawel Jakub Dawidek return (NULL); 70419d16e2fSPawel Jakub Dawidek } 70519d16e2fSPawel Jakub Dawidek } else { 70648fbd94bSPawel Jakub Dawidek gp = g_concat_create(mp, &md, G_CONCAT_TYPE_AUTOMATIC); 70719d16e2fSPawel Jakub Dawidek if (gp == NULL) { 708ba385d00SPawel Jakub Dawidek G_CONCAT_DEBUG(0, "Cannot create device %s.", 70919d16e2fSPawel Jakub Dawidek md.md_name); 71019d16e2fSPawel Jakub Dawidek return (NULL); 71119d16e2fSPawel Jakub Dawidek } 71219d16e2fSPawel Jakub Dawidek sc = gp->softc; 71319d16e2fSPawel Jakub Dawidek G_CONCAT_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name); 71419d16e2fSPawel Jakub Dawidek error = g_concat_add_disk(sc, pp, md.md_no); 71519d16e2fSPawel Jakub Dawidek if (error != 0) { 71602637cdcSPawel Jakub Dawidek G_CONCAT_DEBUG(0, 71702637cdcSPawel Jakub Dawidek "Cannot add disk %s to %s (error=%d).", pp->name, 71802637cdcSPawel Jakub Dawidek gp->name, error); 71919d16e2fSPawel Jakub Dawidek g_concat_destroy(sc, 1); 72019d16e2fSPawel Jakub Dawidek return (NULL); 72119d16e2fSPawel Jakub Dawidek } 72219d16e2fSPawel Jakub Dawidek } 72319d16e2fSPawel Jakub Dawidek 72419d16e2fSPawel Jakub Dawidek return (gp); 72519d16e2fSPawel Jakub Dawidek } 72619d16e2fSPawel Jakub Dawidek 72719d16e2fSPawel Jakub Dawidek static void 72819d16e2fSPawel Jakub Dawidek g_concat_ctl_create(struct gctl_req *req, struct g_class *mp) 72919d16e2fSPawel Jakub Dawidek { 73019d16e2fSPawel Jakub Dawidek u_int attached, no; 73102637cdcSPawel Jakub Dawidek struct g_concat_metadata md; 73219d16e2fSPawel Jakub Dawidek struct g_provider *pp; 73319d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 73419d16e2fSPawel Jakub Dawidek struct g_geom *gp; 73519d16e2fSPawel Jakub Dawidek struct sbuf *sb; 73602637cdcSPawel Jakub Dawidek const char *name; 73702637cdcSPawel Jakub Dawidek char param[16]; 73802637cdcSPawel Jakub Dawidek int *nargs; 73919d16e2fSPawel Jakub Dawidek 74019d16e2fSPawel Jakub Dawidek g_topology_assert(); 74102637cdcSPawel Jakub Dawidek nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs)); 74202637cdcSPawel Jakub Dawidek if (nargs == NULL) { 74302637cdcSPawel Jakub Dawidek gctl_error(req, "No '%s' argument.", "nargs"); 74419d16e2fSPawel Jakub Dawidek return; 74519d16e2fSPawel Jakub Dawidek } 746aaf8e186SPawel Jakub Dawidek if (*nargs < 2) { 74702637cdcSPawel Jakub Dawidek gctl_error(req, "Too few arguments."); 74819d16e2fSPawel Jakub Dawidek return; 74919d16e2fSPawel Jakub Dawidek } 75019d16e2fSPawel Jakub Dawidek 75102637cdcSPawel Jakub Dawidek strlcpy(md.md_magic, G_CONCAT_MAGIC, sizeof(md.md_magic)); 75202637cdcSPawel Jakub Dawidek md.md_version = G_CONCAT_VERSION; 75302637cdcSPawel Jakub Dawidek name = gctl_get_asciiparam(req, "arg0"); 75402637cdcSPawel Jakub Dawidek if (name == NULL) { 75502637cdcSPawel Jakub Dawidek gctl_error(req, "No 'arg%u' argument.", 0); 75602637cdcSPawel Jakub Dawidek return; 75702637cdcSPawel Jakub Dawidek } 75802637cdcSPawel Jakub Dawidek strlcpy(md.md_name, name, sizeof(md.md_name)); 75902637cdcSPawel Jakub Dawidek md.md_id = arc4random(); 76002637cdcSPawel Jakub Dawidek md.md_no = 0; 76102637cdcSPawel Jakub Dawidek md.md_all = *nargs - 1; 7626c74f517SPawel Jakub Dawidek bzero(md.md_provider, sizeof(md.md_provider)); 763e6890985SPawel Jakub Dawidek /* This field is not important here. */ 764e6890985SPawel Jakub Dawidek md.md_provsize = 0; 76502637cdcSPawel Jakub Dawidek 76619d16e2fSPawel Jakub Dawidek /* Check all providers are valid */ 76702637cdcSPawel Jakub Dawidek for (no = 1; no < *nargs; no++) { 76802637cdcSPawel Jakub Dawidek snprintf(param, sizeof(param), "arg%u", no); 76902637cdcSPawel Jakub Dawidek name = gctl_get_asciiparam(req, param); 77002637cdcSPawel Jakub Dawidek if (name == NULL) { 77102637cdcSPawel Jakub Dawidek gctl_error(req, "No 'arg%u' argument.", no); 77202637cdcSPawel Jakub Dawidek return; 77302637cdcSPawel Jakub Dawidek } 77402637cdcSPawel Jakub Dawidek if (strncmp(name, "/dev/", strlen("/dev/")) == 0) 77502637cdcSPawel Jakub Dawidek name += strlen("/dev/"); 77602637cdcSPawel Jakub Dawidek pp = g_provider_by_name(name); 77719d16e2fSPawel Jakub Dawidek if (pp == NULL) { 77802637cdcSPawel Jakub Dawidek G_CONCAT_DEBUG(1, "Disk %s is invalid.", name); 77902637cdcSPawel Jakub Dawidek gctl_error(req, "Disk %s is invalid.", name); 78019d16e2fSPawel Jakub Dawidek return; 78119d16e2fSPawel Jakub Dawidek } 78219d16e2fSPawel Jakub Dawidek } 78319d16e2fSPawel Jakub Dawidek 78402637cdcSPawel Jakub Dawidek gp = g_concat_create(mp, &md, G_CONCAT_TYPE_MANUAL); 78519d16e2fSPawel Jakub Dawidek if (gp == NULL) { 786ba385d00SPawel Jakub Dawidek gctl_error(req, "Can't configure %s.", md.md_name); 78719d16e2fSPawel Jakub Dawidek return; 78819d16e2fSPawel Jakub Dawidek } 78919d16e2fSPawel Jakub Dawidek 79019d16e2fSPawel Jakub Dawidek sc = gp->softc; 7912616144eSDag-Erling Smørgrav sb = sbuf_new_auto(); 79219d16e2fSPawel Jakub Dawidek sbuf_printf(sb, "Can't attach disk(s) to %s:", gp->name); 79302637cdcSPawel Jakub Dawidek for (attached = 0, no = 1; no < *nargs; no++) { 79402637cdcSPawel Jakub Dawidek snprintf(param, sizeof(param), "arg%u", no); 79502637cdcSPawel Jakub Dawidek name = gctl_get_asciiparam(req, param); 796916cd41cSEdward Tomasz Napierala if (name == NULL) { 797916cd41cSEdward Tomasz Napierala gctl_error(req, "No 'arg%d' argument.", no); 798916cd41cSEdward Tomasz Napierala return; 799916cd41cSEdward Tomasz Napierala } 80002637cdcSPawel Jakub Dawidek if (strncmp(name, "/dev/", strlen("/dev/")) == 0) 80102637cdcSPawel Jakub Dawidek name += strlen("/dev/"); 80202637cdcSPawel Jakub Dawidek pp = g_provider_by_name(name); 80302637cdcSPawel Jakub Dawidek KASSERT(pp != NULL, ("Provider %s disappear?!", name)); 80402637cdcSPawel Jakub Dawidek if (g_concat_add_disk(sc, pp, no - 1) != 0) { 80519d16e2fSPawel Jakub Dawidek G_CONCAT_DEBUG(1, "Disk %u (%s) not attached to %s.", 80602637cdcSPawel Jakub Dawidek no, pp->name, gp->name); 80719d16e2fSPawel Jakub Dawidek sbuf_printf(sb, " %s", pp->name); 80819d16e2fSPawel Jakub Dawidek continue; 80919d16e2fSPawel Jakub Dawidek } 81019d16e2fSPawel Jakub Dawidek attached++; 81119d16e2fSPawel Jakub Dawidek } 81219d16e2fSPawel Jakub Dawidek sbuf_finish(sb); 81302637cdcSPawel Jakub Dawidek if (md.md_all != attached) { 81419d16e2fSPawel Jakub Dawidek g_concat_destroy(gp->softc, 1); 81519d16e2fSPawel Jakub Dawidek gctl_error(req, "%s", sbuf_data(sb)); 81619d16e2fSPawel Jakub Dawidek } 81719d16e2fSPawel Jakub Dawidek sbuf_delete(sb); 81819d16e2fSPawel Jakub Dawidek } 81919d16e2fSPawel Jakub Dawidek 82002637cdcSPawel Jakub Dawidek static struct g_concat_softc * 82102637cdcSPawel Jakub Dawidek g_concat_find_device(struct g_class *mp, const char *name) 82219d16e2fSPawel Jakub Dawidek { 82319d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 82402637cdcSPawel Jakub Dawidek struct g_geom *gp; 82502637cdcSPawel Jakub Dawidek 82602637cdcSPawel Jakub Dawidek LIST_FOREACH(gp, &mp->geom, geom) { 82702637cdcSPawel Jakub Dawidek sc = gp->softc; 82802637cdcSPawel Jakub Dawidek if (sc == NULL) 82902637cdcSPawel Jakub Dawidek continue; 830ba385d00SPawel Jakub Dawidek if (strcmp(sc->sc_name, name) == 0) 83102637cdcSPawel Jakub Dawidek return (sc); 83202637cdcSPawel Jakub Dawidek } 83302637cdcSPawel Jakub Dawidek return (NULL); 83402637cdcSPawel Jakub Dawidek } 83502637cdcSPawel Jakub Dawidek 83602637cdcSPawel Jakub Dawidek static void 83702637cdcSPawel Jakub Dawidek g_concat_ctl_destroy(struct gctl_req *req, struct g_class *mp) 83802637cdcSPawel Jakub Dawidek { 83902637cdcSPawel Jakub Dawidek struct g_concat_softc *sc; 84002637cdcSPawel Jakub Dawidek int *force, *nargs, error; 84102637cdcSPawel Jakub Dawidek const char *name; 84202637cdcSPawel Jakub Dawidek char param[16]; 84302637cdcSPawel Jakub Dawidek u_int i; 84419d16e2fSPawel Jakub Dawidek 84519d16e2fSPawel Jakub Dawidek g_topology_assert(); 84648fbd94bSPawel Jakub Dawidek 84702637cdcSPawel Jakub Dawidek nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs)); 84802637cdcSPawel Jakub Dawidek if (nargs == NULL) { 84902637cdcSPawel Jakub Dawidek gctl_error(req, "No '%s' argument.", "nargs"); 85002637cdcSPawel Jakub Dawidek return; 85102637cdcSPawel Jakub Dawidek } 85202637cdcSPawel Jakub Dawidek if (*nargs <= 0) { 85302637cdcSPawel Jakub Dawidek gctl_error(req, "Missing device(s)."); 85402637cdcSPawel Jakub Dawidek return; 85502637cdcSPawel Jakub Dawidek } 85619d16e2fSPawel Jakub Dawidek force = gctl_get_paraml(req, "force", sizeof(*force)); 85719d16e2fSPawel Jakub Dawidek if (force == NULL) { 85848fbd94bSPawel Jakub Dawidek gctl_error(req, "No '%s' argument.", "force"); 85919d16e2fSPawel Jakub Dawidek return; 86019d16e2fSPawel Jakub Dawidek } 86102637cdcSPawel Jakub Dawidek 86202637cdcSPawel Jakub Dawidek for (i = 0; i < (u_int)*nargs; i++) { 86302637cdcSPawel Jakub Dawidek snprintf(param, sizeof(param), "arg%u", i); 86402637cdcSPawel Jakub Dawidek name = gctl_get_asciiparam(req, param); 86502637cdcSPawel Jakub Dawidek if (name == NULL) { 86602637cdcSPawel Jakub Dawidek gctl_error(req, "No 'arg%u' argument.", i); 86702637cdcSPawel Jakub Dawidek return; 86802637cdcSPawel Jakub Dawidek } 86902637cdcSPawel Jakub Dawidek sc = g_concat_find_device(mp, name); 87019d16e2fSPawel Jakub Dawidek if (sc == NULL) { 87102637cdcSPawel Jakub Dawidek gctl_error(req, "No such device: %s.", name); 87219d16e2fSPawel Jakub Dawidek return; 87319d16e2fSPawel Jakub Dawidek } 87419d16e2fSPawel Jakub Dawidek error = g_concat_destroy(sc, *force); 87519d16e2fSPawel Jakub Dawidek if (error != 0) { 87619d16e2fSPawel Jakub Dawidek gctl_error(req, "Cannot destroy device %s (error=%d).", 877ba385d00SPawel Jakub Dawidek sc->sc_name, error); 87819d16e2fSPawel Jakub Dawidek return; 87919d16e2fSPawel Jakub Dawidek } 88019d16e2fSPawel Jakub Dawidek } 88102637cdcSPawel Jakub Dawidek } 88219d16e2fSPawel Jakub Dawidek 88319d16e2fSPawel Jakub Dawidek static void 88419d16e2fSPawel Jakub Dawidek g_concat_config(struct gctl_req *req, struct g_class *mp, const char *verb) 88519d16e2fSPawel Jakub Dawidek { 88602637cdcSPawel Jakub Dawidek uint32_t *version; 88719d16e2fSPawel Jakub Dawidek 88819d16e2fSPawel Jakub Dawidek g_topology_assert(); 88919d16e2fSPawel Jakub Dawidek 89002637cdcSPawel Jakub Dawidek version = gctl_get_paraml(req, "version", sizeof(*version)); 89102637cdcSPawel Jakub Dawidek if (version == NULL) { 89202637cdcSPawel Jakub Dawidek gctl_error(req, "No '%s' argument.", "version"); 89302637cdcSPawel Jakub Dawidek return; 89402637cdcSPawel Jakub Dawidek } 89502637cdcSPawel Jakub Dawidek if (*version != G_CONCAT_VERSION) { 89602637cdcSPawel Jakub Dawidek gctl_error(req, "Userland and kernel parts are out of sync."); 89719d16e2fSPawel Jakub Dawidek return; 89819d16e2fSPawel Jakub Dawidek } 89919d16e2fSPawel Jakub Dawidek 90002637cdcSPawel Jakub Dawidek if (strcmp(verb, "create") == 0) { 90102637cdcSPawel Jakub Dawidek g_concat_ctl_create(req, mp); 90219d16e2fSPawel Jakub Dawidek return; 903a2e31b8bSPawel Jakub Dawidek } else if (strcmp(verb, "destroy") == 0 || 904a2e31b8bSPawel Jakub Dawidek strcmp(verb, "stop") == 0) { 90502637cdcSPawel Jakub Dawidek g_concat_ctl_destroy(req, mp); 90619d16e2fSPawel Jakub Dawidek return; 90719d16e2fSPawel Jakub Dawidek } 90848fbd94bSPawel Jakub Dawidek gctl_error(req, "Unknown verb."); 90919d16e2fSPawel Jakub Dawidek } 91019d16e2fSPawel Jakub Dawidek 91119d16e2fSPawel Jakub Dawidek static void 91219d16e2fSPawel Jakub Dawidek g_concat_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, 91319d16e2fSPawel Jakub Dawidek struct g_consumer *cp, struct g_provider *pp) 91419d16e2fSPawel Jakub Dawidek { 91519d16e2fSPawel Jakub Dawidek struct g_concat_softc *sc; 91619d16e2fSPawel Jakub Dawidek 9173fb17452SPawel Jakub Dawidek g_topology_assert(); 91819d16e2fSPawel Jakub Dawidek sc = gp->softc; 9191d723f1dSPawel Jakub Dawidek if (sc == NULL) 92019d16e2fSPawel Jakub Dawidek return; 9211d723f1dSPawel Jakub Dawidek if (pp != NULL) { 9221d723f1dSPawel Jakub Dawidek /* Nothing here. */ 9231d723f1dSPawel Jakub Dawidek } else if (cp != NULL) { 9241d723f1dSPawel Jakub Dawidek struct g_concat_disk *disk; 9251d723f1dSPawel Jakub Dawidek 9261d723f1dSPawel Jakub Dawidek disk = cp->private; 9271d723f1dSPawel Jakub Dawidek if (disk == NULL) 9281d723f1dSPawel Jakub Dawidek return; 9291d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "%s<End>%jd</End>\n", indent, 9301d723f1dSPawel Jakub Dawidek (intmax_t)disk->d_end); 9311d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "%s<Start>%jd</Start>\n", indent, 9321d723f1dSPawel Jakub Dawidek (intmax_t)disk->d_start); 9331d723f1dSPawel Jakub Dawidek } else { 9341d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "%s<ID>%u</ID>\n", indent, (u_int)sc->sc_id); 9351d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "%s<Type>", indent); 93619d16e2fSPawel Jakub Dawidek switch (sc->sc_type) { 93719d16e2fSPawel Jakub Dawidek case G_CONCAT_TYPE_AUTOMATIC: 9381d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "AUTOMATIC"); 93919d16e2fSPawel Jakub Dawidek break; 94019d16e2fSPawel Jakub Dawidek case G_CONCAT_TYPE_MANUAL: 9411d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "MANUAL"); 94219d16e2fSPawel Jakub Dawidek break; 94319d16e2fSPawel Jakub Dawidek default: 9441d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "UNKNOWN"); 94519d16e2fSPawel Jakub Dawidek break; 94619d16e2fSPawel Jakub Dawidek } 9471d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "</Type>\n"); 9481d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "%s<Status>Total=%u, Online=%u</Status>\n", 9491d723f1dSPawel Jakub Dawidek indent, sc->sc_ndisks, g_concat_nvalid(sc)); 9501d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "%s<State>", indent); 9511d723f1dSPawel Jakub Dawidek if (sc->sc_provider != NULL && sc->sc_provider->error == 0) 9521d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "UP"); 9533fb17452SPawel Jakub Dawidek else 9541d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "DOWN"); 9551d723f1dSPawel Jakub Dawidek sbuf_printf(sb, "</State>\n"); 9561d723f1dSPawel Jakub Dawidek } 95719d16e2fSPawel Jakub Dawidek } 95819d16e2fSPawel Jakub Dawidek 95919d16e2fSPawel Jakub Dawidek DECLARE_GEOM_CLASS(g_concat_class, g_concat); 960