1129473Spjd/*- 2142727Spjd * Copyright (c) 2004-2005 Pawel Jakub Dawidek <pjd@FreeBSD.org> 3129473Spjd * All rights reserved. 4129473Spjd * 5129473Spjd * Redistribution and use in source and binary forms, with or without 6129473Spjd * modification, are permitted provided that the following conditions 7129473Spjd * are met: 8129473Spjd * 1. Redistributions of source code must retain the above copyright 9129473Spjd * notice, this list of conditions and the following disclaimer. 10129473Spjd * 2. Redistributions in binary form must reproduce the above copyright 11129473Spjd * notice, this list of conditions and the following disclaimer in the 12129473Spjd * documentation and/or other materials provided with the distribution. 13155174Spjd * 14129473Spjd * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND 15129473Spjd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16129473Spjd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17129473Spjd * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE 18129473Spjd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19129473Spjd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20129473Spjd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21129473Spjd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22129473Spjd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23129473Spjd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24129473Spjd * SUCH DAMAGE. 25129473Spjd */ 26129473Spjd 27129473Spjd#include <sys/cdefs.h> 28129473Spjd__FBSDID("$FreeBSD: stable/11/sys/geom/stripe/g_stripe.c 332640 2018-04-17 02:18:04Z kevans $"); 29129473Spjd 30129473Spjd#include <sys/param.h> 31129473Spjd#include <sys/systm.h> 32129473Spjd#include <sys/kernel.h> 33129473Spjd#include <sys/module.h> 34129473Spjd#include <sys/lock.h> 35129473Spjd#include <sys/mutex.h> 36129473Spjd#include <sys/bio.h> 37223921Sae#include <sys/sbuf.h> 38129473Spjd#include <sys/sysctl.h> 39129473Spjd#include <sys/malloc.h> 40131878Spjd#include <vm/uma.h> 41129473Spjd#include <geom/geom.h> 42129473Spjd#include <geom/stripe/g_stripe.h> 43129473Spjd 44219029SnetchildFEATURE(geom_stripe, "GEOM striping support"); 45129473Spjd 46151897Srwatsonstatic MALLOC_DEFINE(M_STRIPE, "stripe_data", "GEOM_STRIPE Data"); 47129473Spjd 48131878Spjdstatic uma_zone_t g_stripe_zone; 49129473Spjd 50129473Spjdstatic int g_stripe_destroy(struct g_stripe_softc *sc, boolean_t force); 51129473Spjdstatic int g_stripe_destroy_geom(struct gctl_req *req, struct g_class *mp, 52129473Spjd struct g_geom *gp); 53129473Spjd 54129473Spjdstatic g_taste_t g_stripe_taste; 55129473Spjdstatic g_ctl_req_t g_stripe_config; 56129473Spjdstatic g_dumpconf_t g_stripe_dumpconf; 57131878Spjdstatic g_init_t g_stripe_init; 58131878Spjdstatic g_fini_t g_stripe_fini; 59129473Spjd 60129473Spjdstruct g_class g_stripe_class = { 61129473Spjd .name = G_STRIPE_CLASS_NAME, 62133318Sphk .version = G_VERSION, 63129473Spjd .ctlreq = g_stripe_config, 64129473Spjd .taste = g_stripe_taste, 65131878Spjd .destroy_geom = g_stripe_destroy_geom, 66131878Spjd .init = g_stripe_init, 67131878Spjd .fini = g_stripe_fini 68129473Spjd}; 69129473Spjd 70131878SpjdSYSCTL_DECL(_kern_geom); 71227309Sedstatic SYSCTL_NODE(_kern_geom, OID_AUTO, stripe, CTLFLAG_RW, 0, 72227309Sed "GEOM_STRIPE stuff"); 73131878Spjdstatic u_int g_stripe_debug = 0; 74267992ShselaskySYSCTL_UINT(_kern_geom_stripe, OID_AUTO, debug, CTLFLAG_RWTUN, &g_stripe_debug, 0, 75131878Spjd "Debug level"); 76138623Spjdstatic int g_stripe_fast = 0; 77131878Spjdstatic int 78131878Spjdg_sysctl_stripe_fast(SYSCTL_HANDLER_ARGS) 79131878Spjd{ 80131878Spjd int error, fast; 81129473Spjd 82131878Spjd fast = g_stripe_fast; 83170289Sdwmalone error = sysctl_handle_int(oidp, &fast, 0, req); 84131878Spjd if (error == 0 && req->newptr != NULL) 85131878Spjd g_stripe_fast = fast; 86131878Spjd return (error); 87131878Spjd} 88267992ShselaskySYSCTL_PROC(_kern_geom_stripe, OID_AUTO, fast, CTLTYPE_INT | CTLFLAG_RWTUN, 89132095Spjd NULL, 0, g_sysctl_stripe_fast, "I", "Fast, but memory-consuming, mode"); 90196837Smavstatic u_int g_stripe_maxmem = MAXPHYS * 100; 91267992ShselaskySYSCTL_UINT(_kern_geom_stripe, OID_AUTO, maxmem, CTLFLAG_RDTUN, &g_stripe_maxmem, 92132095Spjd 0, "Maximum memory that can be allocated in \"fast\" mode (in bytes)"); 93133205Spjdstatic u_int g_stripe_fast_failed = 0; 94133205SpjdSYSCTL_UINT(_kern_geom_stripe, OID_AUTO, fast_failed, CTLFLAG_RD, 95133205Spjd &g_stripe_fast_failed, 0, "How many times \"fast\" mode failed"); 96131878Spjd 97129473Spjd/* 98129473Spjd * Greatest Common Divisor. 99129473Spjd */ 100129473Spjdstatic u_int 101129473Spjdgcd(u_int a, u_int b) 102129473Spjd{ 103129473Spjd u_int c; 104129473Spjd 105129473Spjd while (b != 0) { 106129473Spjd c = a; 107129473Spjd a = b; 108129473Spjd b = (c % b); 109129473Spjd } 110129473Spjd return (a); 111129473Spjd} 112129473Spjd 113129473Spjd/* 114129473Spjd * Least Common Multiple. 115129473Spjd */ 116129473Spjdstatic u_int 117129473Spjdlcm(u_int a, u_int b) 118129473Spjd{ 119129473Spjd 120129473Spjd return ((a * b) / gcd(a, b)); 121129473Spjd} 122129473Spjd 123131878Spjdstatic void 124131878Spjdg_stripe_init(struct g_class *mp __unused) 125131878Spjd{ 126131878Spjd 127196837Smav g_stripe_zone = uma_zcreate("g_stripe_zone", MAXPHYS, NULL, NULL, 128131878Spjd NULL, NULL, 0, 0); 129196837Smav g_stripe_maxmem -= g_stripe_maxmem % MAXPHYS; 130196837Smav uma_zone_set_max(g_stripe_zone, g_stripe_maxmem / MAXPHYS); 131131878Spjd} 132131878Spjd 133131878Spjdstatic void 134131878Spjdg_stripe_fini(struct g_class *mp __unused) 135131878Spjd{ 136131878Spjd 137131878Spjd uma_zdestroy(g_stripe_zone); 138131878Spjd} 139131878Spjd 140129473Spjd/* 141129473Spjd * Return the number of valid disks. 142129473Spjd */ 143129473Spjdstatic u_int 144129473Spjdg_stripe_nvalid(struct g_stripe_softc *sc) 145129473Spjd{ 146129473Spjd u_int i, no; 147129473Spjd 148129473Spjd no = 0; 149129473Spjd for (i = 0; i < sc->sc_ndisks; i++) { 150129473Spjd if (sc->sc_disks[i] != NULL) 151129473Spjd no++; 152129473Spjd } 153129473Spjd 154129473Spjd return (no); 155129473Spjd} 156129473Spjd 157129473Spjdstatic void 158129473Spjdg_stripe_remove_disk(struct g_consumer *cp) 159129473Spjd{ 160129473Spjd struct g_stripe_softc *sc; 161129473Spjd 162226998Smav g_topology_assert(); 163129473Spjd KASSERT(cp != NULL, ("Non-valid disk in %s.", __func__)); 164226998Smav sc = (struct g_stripe_softc *)cp->geom->softc; 165129473Spjd KASSERT(sc != NULL, ("NULL sc in %s.", __func__)); 166129473Spjd 167226998Smav if (cp->private == NULL) { 168226998Smav G_STRIPE_DEBUG(0, "Disk %s removed from %s.", 169226998Smav cp->provider->name, sc->sc_name); 170226998Smav cp->private = (void *)(uintptr_t)-1; 171226998Smav } 172129473Spjd 173129473Spjd if (sc->sc_provider != NULL) { 174226998Smav G_STRIPE_DEBUG(0, "Device %s deactivated.", 175226998Smav sc->sc_provider->name); 176306764Smav g_wither_provider(sc->sc_provider, ENXIO); 177129473Spjd sc->sc_provider = NULL; 178129473Spjd } 179129473Spjd 180129473Spjd if (cp->acr > 0 || cp->acw > 0 || cp->ace > 0) 181226998Smav return; 182226998Smav sc->sc_disks[cp->index] = NULL; 183226998Smav cp->index = 0; 184129473Spjd g_detach(cp); 185129473Spjd g_destroy_consumer(cp); 186226998Smav /* If there are no valid disks anymore, remove device. */ 187226998Smav if (LIST_EMPTY(&sc->sc_geom->consumer)) 188226998Smav g_stripe_destroy(sc, 1); 189129473Spjd} 190129473Spjd 191129473Spjdstatic void 192129473Spjdg_stripe_orphan(struct g_consumer *cp) 193129473Spjd{ 194129473Spjd struct g_stripe_softc *sc; 195129473Spjd struct g_geom *gp; 196129473Spjd 197129473Spjd g_topology_assert(); 198129473Spjd gp = cp->geom; 199129473Spjd sc = gp->softc; 200129473Spjd if (sc == NULL) 201129473Spjd return; 202129473Spjd 203129473Spjd g_stripe_remove_disk(cp); 204129473Spjd} 205129473Spjd 206129473Spjdstatic int 207129473Spjdg_stripe_access(struct g_provider *pp, int dr, int dw, int de) 208129473Spjd{ 209226998Smav struct g_consumer *cp1, *cp2, *tmp; 210129473Spjd struct g_stripe_softc *sc; 211129473Spjd struct g_geom *gp; 212129473Spjd int error; 213129473Spjd 214226998Smav g_topology_assert(); 215129473Spjd gp = pp->geom; 216129473Spjd sc = gp->softc; 217226998Smav KASSERT(sc != NULL, ("NULL sc in %s.", __func__)); 218129473Spjd 219129473Spjd /* On first open, grab an extra "exclusive" bit */ 220129473Spjd if (pp->acr == 0 && pp->acw == 0 && pp->ace == 0) 221129473Spjd de++; 222129473Spjd /* ... and let go of it on last close */ 223129473Spjd if ((pp->acr + dr) == 0 && (pp->acw + dw) == 0 && (pp->ace + de) == 0) 224129473Spjd de--; 225129473Spjd 226226998Smav LIST_FOREACH_SAFE(cp1, &gp->consumer, consumer, tmp) { 227129473Spjd error = g_access(cp1, dr, dw, de); 228226998Smav if (error != 0) 229226998Smav goto fail; 230226998Smav if (cp1->acr == 0 && cp1->acw == 0 && cp1->ace == 0 && 231226998Smav cp1->private != NULL) { 232226998Smav g_stripe_remove_disk(cp1); /* May destroy geom. */ 233129473Spjd } 234129473Spjd } 235226998Smav return (0); 236129473Spjd 237226998Smavfail: 238226998Smav LIST_FOREACH(cp2, &gp->consumer, consumer) { 239226998Smav if (cp1 == cp2) 240226998Smav break; 241226998Smav g_access(cp2, -dr, -dw, -de); 242226998Smav } 243129473Spjd return (error); 244129473Spjd} 245129473Spjd 246129473Spjdstatic void 247131878Spjdg_stripe_copy(struct g_stripe_softc *sc, char *src, char *dst, off_t offset, 248131878Spjd off_t length, int mode) 249129473Spjd{ 250131878Spjd u_int stripesize; 251131878Spjd size_t len; 252131878Spjd 253131878Spjd stripesize = sc->sc_stripesize; 254131878Spjd len = (size_t)(stripesize - (offset & (stripesize - 1))); 255131878Spjd do { 256131878Spjd bcopy(src, dst, len); 257131878Spjd if (mode) { 258131878Spjd dst += len + stripesize * (sc->sc_ndisks - 1); 259131878Spjd src += len; 260131878Spjd } else { 261131878Spjd dst += len; 262131878Spjd src += len + stripesize * (sc->sc_ndisks - 1); 263131878Spjd } 264131878Spjd length -= len; 265131878Spjd KASSERT(length >= 0, 266131878Spjd ("Length < 0 (stripesize=%zu, offset=%jd, length=%jd).", 267131878Spjd (size_t)stripesize, (intmax_t)offset, (intmax_t)length)); 268131878Spjd if (length > stripesize) 269131878Spjd len = stripesize; 270131878Spjd else 271131878Spjd len = length; 272131878Spjd } while (length > 0); 273131878Spjd} 274131878Spjd 275131878Spjdstatic void 276131878Spjdg_stripe_done(struct bio *bp) 277131878Spjd{ 278129473Spjd struct g_stripe_softc *sc; 279131878Spjd struct bio *pbp; 280131878Spjd 281131878Spjd pbp = bp->bio_parent; 282131878Spjd sc = pbp->bio_to->geom->softc; 283133204Spjd if (bp->bio_cmd == BIO_READ && bp->bio_caller1 != NULL) { 284133204Spjd g_stripe_copy(sc, bp->bio_data, bp->bio_caller1, bp->bio_offset, 285131878Spjd bp->bio_length, 1); 286133204Spjd bp->bio_data = bp->bio_caller1; 287133204Spjd bp->bio_caller1 = NULL; 288131878Spjd } 289256880Smav mtx_lock(&sc->sc_lock); 290256880Smav if (pbp->bio_error == 0) 291256880Smav pbp->bio_error = bp->bio_error; 292256880Smav pbp->bio_completed += bp->bio_completed; 293131878Spjd pbp->bio_inbed++; 294131878Spjd if (pbp->bio_children == pbp->bio_inbed) { 295256880Smav mtx_unlock(&sc->sc_lock); 296133204Spjd if (pbp->bio_driver1 != NULL) 297133204Spjd uma_zfree(g_stripe_zone, pbp->bio_driver1); 298131878Spjd g_io_deliver(pbp, pbp->bio_error); 299256880Smav } else 300256880Smav mtx_unlock(&sc->sc_lock); 301256880Smav g_destroy_bio(bp); 302131878Spjd} 303131878Spjd 304131878Spjdstatic int 305131878Spjdg_stripe_start_fast(struct bio *bp, u_int no, off_t offset, off_t length) 306131878Spjd{ 307131878Spjd TAILQ_HEAD(, bio) queue = TAILQ_HEAD_INITIALIZER(queue); 308131878Spjd u_int nparts = 0, stripesize; 309131878Spjd struct g_stripe_softc *sc; 310131878Spjd char *addr, *data = NULL; 311129473Spjd struct bio *cbp; 312131878Spjd int error; 313131878Spjd 314131878Spjd sc = bp->bio_to->geom->softc; 315131878Spjd 316131878Spjd addr = bp->bio_data; 317131878Spjd stripesize = sc->sc_stripesize; 318131878Spjd 319131878Spjd cbp = g_clone_bio(bp); 320131878Spjd if (cbp == NULL) { 321131878Spjd error = ENOMEM; 322131878Spjd goto failure; 323131878Spjd } 324131878Spjd TAILQ_INSERT_TAIL(&queue, cbp, bio_queue); 325131878Spjd nparts++; 326131878Spjd /* 327131878Spjd * Fill in the component buf structure. 328131878Spjd */ 329131878Spjd cbp->bio_done = g_stripe_done; 330131878Spjd cbp->bio_offset = offset; 331131878Spjd cbp->bio_data = addr; 332133204Spjd cbp->bio_caller1 = NULL; 333131878Spjd cbp->bio_length = length; 334133204Spjd cbp->bio_caller2 = sc->sc_disks[no]; 335131878Spjd 336131878Spjd /* offset -= offset % stripesize; */ 337131878Spjd offset -= offset & (stripesize - 1); 338131878Spjd addr += length; 339131878Spjd length = bp->bio_length - length; 340131878Spjd for (no++; length > 0; no++, length -= stripesize, addr += stripesize) { 341131878Spjd if (no > sc->sc_ndisks - 1) { 342131878Spjd no = 0; 343131878Spjd offset += stripesize; 344131878Spjd } 345131878Spjd if (nparts >= sc->sc_ndisks) { 346131878Spjd cbp = TAILQ_NEXT(cbp, bio_queue); 347131878Spjd if (cbp == NULL) 348131878Spjd cbp = TAILQ_FIRST(&queue); 349131878Spjd nparts++; 350131878Spjd /* 351131878Spjd * Update bio structure. 352131878Spjd */ 353131878Spjd /* 354131878Spjd * MIN() is in case when 355131878Spjd * (bp->bio_length % sc->sc_stripesize) != 0. 356131878Spjd */ 357131878Spjd cbp->bio_length += MIN(stripesize, length); 358133204Spjd if (cbp->bio_caller1 == NULL) { 359133204Spjd cbp->bio_caller1 = cbp->bio_data; 360131878Spjd cbp->bio_data = NULL; 361131878Spjd if (data == NULL) { 362131878Spjd data = uma_zalloc(g_stripe_zone, 363131878Spjd M_NOWAIT); 364131878Spjd if (data == NULL) { 365131878Spjd error = ENOMEM; 366131878Spjd goto failure; 367131878Spjd } 368131878Spjd } 369131878Spjd } 370131878Spjd } else { 371131878Spjd cbp = g_clone_bio(bp); 372131878Spjd if (cbp == NULL) { 373131878Spjd error = ENOMEM; 374131878Spjd goto failure; 375131878Spjd } 376131878Spjd TAILQ_INSERT_TAIL(&queue, cbp, bio_queue); 377131878Spjd nparts++; 378131878Spjd /* 379131878Spjd * Fill in the component buf structure. 380131878Spjd */ 381131878Spjd cbp->bio_done = g_stripe_done; 382131878Spjd cbp->bio_offset = offset; 383131878Spjd cbp->bio_data = addr; 384133204Spjd cbp->bio_caller1 = NULL; 385131878Spjd /* 386131878Spjd * MIN() is in case when 387131878Spjd * (bp->bio_length % sc->sc_stripesize) != 0. 388131878Spjd */ 389131878Spjd cbp->bio_length = MIN(stripesize, length); 390133204Spjd cbp->bio_caller2 = sc->sc_disks[no]; 391131878Spjd } 392131878Spjd } 393131878Spjd if (data != NULL) 394133444Spjd bp->bio_driver1 = data; 395131878Spjd /* 396131878Spjd * Fire off all allocated requests! 397131878Spjd */ 398131878Spjd while ((cbp = TAILQ_FIRST(&queue)) != NULL) { 399131878Spjd struct g_consumer *cp; 400131878Spjd 401131878Spjd TAILQ_REMOVE(&queue, cbp, bio_queue); 402133204Spjd cp = cbp->bio_caller2; 403133204Spjd cbp->bio_caller2 = NULL; 404131878Spjd cbp->bio_to = cp->provider; 405133204Spjd if (cbp->bio_caller1 != NULL) { 406131878Spjd cbp->bio_data = data; 407131878Spjd if (bp->bio_cmd == BIO_WRITE) { 408133204Spjd g_stripe_copy(sc, cbp->bio_caller1, data, 409131878Spjd cbp->bio_offset, cbp->bio_length, 0); 410131878Spjd } 411131878Spjd data += cbp->bio_length; 412131878Spjd } 413131878Spjd G_STRIPE_LOGREQ(cbp, "Sending request."); 414131878Spjd g_io_request(cbp, cp); 415131878Spjd } 416131878Spjd return (0); 417131878Spjdfailure: 418131878Spjd if (data != NULL) 419131878Spjd uma_zfree(g_stripe_zone, data); 420131878Spjd while ((cbp = TAILQ_FIRST(&queue)) != NULL) { 421131878Spjd TAILQ_REMOVE(&queue, cbp, bio_queue); 422133204Spjd if (cbp->bio_caller1 != NULL) { 423133204Spjd cbp->bio_data = cbp->bio_caller1; 424133204Spjd cbp->bio_caller1 = NULL; 425131878Spjd } 426133201Spjd bp->bio_children--; 427131878Spjd g_destroy_bio(cbp); 428131878Spjd } 429131878Spjd return (error); 430131878Spjd} 431131878Spjd 432131878Spjdstatic int 433131878Spjdg_stripe_start_economic(struct bio *bp, u_int no, off_t offset, off_t length) 434131878Spjd{ 435131878Spjd TAILQ_HEAD(, bio) queue = TAILQ_HEAD_INITIALIZER(queue); 436131878Spjd struct g_stripe_softc *sc; 437129473Spjd uint32_t stripesize; 438131878Spjd struct bio *cbp; 439129473Spjd char *addr; 440131878Spjd int error; 441129473Spjd 442131878Spjd sc = bp->bio_to->geom->softc; 443131878Spjd 444131878Spjd stripesize = sc->sc_stripesize; 445131878Spjd 446131878Spjd cbp = g_clone_bio(bp); 447131878Spjd if (cbp == NULL) { 448131878Spjd error = ENOMEM; 449131878Spjd goto failure; 450131878Spjd } 451131878Spjd TAILQ_INSERT_TAIL(&queue, cbp, bio_queue); 452129473Spjd /* 453131878Spjd * Fill in the component buf structure. 454131878Spjd */ 455256880Smav if (bp->bio_length == length) 456256880Smav cbp->bio_done = g_std_done; /* Optimized lockless case. */ 457256880Smav else 458256880Smav cbp->bio_done = g_stripe_done; 459131878Spjd cbp->bio_offset = offset; 460131878Spjd cbp->bio_length = length; 461256880Smav if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 462256880Smav bp->bio_ma_n = round_page(bp->bio_ma_offset + 463256880Smav bp->bio_length) / PAGE_SIZE; 464256880Smav addr = NULL; 465256880Smav } else 466256880Smav addr = bp->bio_data; 467133204Spjd cbp->bio_caller2 = sc->sc_disks[no]; 468131878Spjd 469131878Spjd /* offset -= offset % stripesize; */ 470131878Spjd offset -= offset & (stripesize - 1); 471264313Smav if (bp->bio_cmd != BIO_DELETE) 472264313Smav addr += length; 473131878Spjd length = bp->bio_length - length; 474264313Smav for (no++; length > 0; no++, length -= stripesize) { 475131878Spjd if (no > sc->sc_ndisks - 1) { 476131878Spjd no = 0; 477131878Spjd offset += stripesize; 478131878Spjd } 479131878Spjd cbp = g_clone_bio(bp); 480131878Spjd if (cbp == NULL) { 481131878Spjd error = ENOMEM; 482131878Spjd goto failure; 483131878Spjd } 484131878Spjd TAILQ_INSERT_TAIL(&queue, cbp, bio_queue); 485131878Spjd 486131878Spjd /* 487131878Spjd * Fill in the component buf structure. 488131878Spjd */ 489256880Smav cbp->bio_done = g_stripe_done; 490131878Spjd cbp->bio_offset = offset; 491131878Spjd /* 492131878Spjd * MIN() is in case when 493131878Spjd * (bp->bio_length % sc->sc_stripesize) != 0. 494131878Spjd */ 495131878Spjd cbp->bio_length = MIN(stripesize, length); 496256880Smav if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 497256880Smav cbp->bio_ma_offset += (uintptr_t)addr; 498256880Smav cbp->bio_ma += cbp->bio_ma_offset / PAGE_SIZE; 499256880Smav cbp->bio_ma_offset %= PAGE_SIZE; 500256880Smav cbp->bio_ma_n = round_page(cbp->bio_ma_offset + 501256880Smav cbp->bio_length) / PAGE_SIZE; 502256880Smav } else 503256880Smav cbp->bio_data = addr; 504131878Spjd 505133204Spjd cbp->bio_caller2 = sc->sc_disks[no]; 506264313Smav 507264313Smav if (bp->bio_cmd != BIO_DELETE) 508264313Smav addr += stripesize; 509131878Spjd } 510131878Spjd /* 511131878Spjd * Fire off all allocated requests! 512131878Spjd */ 513131878Spjd while ((cbp = TAILQ_FIRST(&queue)) != NULL) { 514131878Spjd struct g_consumer *cp; 515131878Spjd 516131878Spjd TAILQ_REMOVE(&queue, cbp, bio_queue); 517133204Spjd cp = cbp->bio_caller2; 518133204Spjd cbp->bio_caller2 = NULL; 519131878Spjd cbp->bio_to = cp->provider; 520131878Spjd G_STRIPE_LOGREQ(cbp, "Sending request."); 521131878Spjd g_io_request(cbp, cp); 522131878Spjd } 523131878Spjd return (0); 524131878Spjdfailure: 525131878Spjd while ((cbp = TAILQ_FIRST(&queue)) != NULL) { 526131878Spjd TAILQ_REMOVE(&queue, cbp, bio_queue); 527133201Spjd bp->bio_children--; 528131878Spjd g_destroy_bio(cbp); 529131878Spjd } 530131878Spjd return (error); 531131878Spjd} 532131878Spjd 533131878Spjdstatic void 534163836Spjdg_stripe_flush(struct g_stripe_softc *sc, struct bio *bp) 535163836Spjd{ 536163836Spjd struct bio_queue_head queue; 537163836Spjd struct g_consumer *cp; 538163836Spjd struct bio *cbp; 539163836Spjd u_int no; 540163836Spjd 541163836Spjd bioq_init(&queue); 542163836Spjd for (no = 0; no < sc->sc_ndisks; no++) { 543163836Spjd cbp = g_clone_bio(bp); 544163836Spjd if (cbp == NULL) { 545163836Spjd for (cbp = bioq_first(&queue); cbp != NULL; 546163836Spjd cbp = bioq_first(&queue)) { 547163836Spjd bioq_remove(&queue, cbp); 548163836Spjd g_destroy_bio(cbp); 549163836Spjd } 550163836Spjd if (bp->bio_error == 0) 551163836Spjd bp->bio_error = ENOMEM; 552163836Spjd g_io_deliver(bp, bp->bio_error); 553163836Spjd return; 554163836Spjd } 555163836Spjd bioq_insert_tail(&queue, cbp); 556256880Smav cbp->bio_done = g_stripe_done; 557256880Smav cbp->bio_caller2 = sc->sc_disks[no]; 558163836Spjd cbp->bio_to = sc->sc_disks[no]->provider; 559163836Spjd } 560163836Spjd for (cbp = bioq_first(&queue); cbp != NULL; cbp = bioq_first(&queue)) { 561163836Spjd bioq_remove(&queue, cbp); 562163836Spjd G_STRIPE_LOGREQ(cbp, "Sending request."); 563256880Smav cp = cbp->bio_caller2; 564256880Smav cbp->bio_caller2 = NULL; 565163836Spjd g_io_request(cbp, cp); 566163836Spjd } 567163836Spjd} 568163836Spjd 569163836Spjdstatic void 570131878Spjdg_stripe_start(struct bio *bp) 571131878Spjd{ 572131878Spjd off_t offset, start, length, nstripe; 573131878Spjd struct g_stripe_softc *sc; 574131878Spjd u_int no, stripesize; 575131878Spjd int error, fast = 0; 576131878Spjd 577131878Spjd sc = bp->bio_to->geom->softc; 578131878Spjd /* 579129473Spjd * If sc == NULL, provider's error should be set and g_stripe_start() 580129473Spjd * should not be called at all. 581129473Spjd */ 582129473Spjd KASSERT(sc != NULL, 583129473Spjd ("Provider's error should be set (error=%d)(device=%s).", 584129473Spjd bp->bio_to->error, bp->bio_to->name)); 585129473Spjd 586129473Spjd G_STRIPE_LOGREQ(bp, "Request received."); 587129473Spjd 588129473Spjd switch (bp->bio_cmd) { 589129473Spjd case BIO_READ: 590129473Spjd case BIO_WRITE: 591129473Spjd case BIO_DELETE: 592129473Spjd break; 593163886Spjd case BIO_FLUSH: 594163886Spjd g_stripe_flush(sc, bp); 595163886Spjd return; 596129473Spjd case BIO_GETATTR: 597129473Spjd /* To which provider it should be delivered? */ 598129473Spjd default: 599129473Spjd g_io_deliver(bp, EOPNOTSUPP); 600129473Spjd return; 601129473Spjd } 602129473Spjd 603129473Spjd stripesize = sc->sc_stripesize; 604129473Spjd 605129473Spjd /* 606131878Spjd * Calculations are quite messy, but fast I hope. 607129473Spjd */ 608129473Spjd 609129473Spjd /* Stripe number. */ 610129473Spjd /* nstripe = bp->bio_offset / stripesize; */ 611129473Spjd nstripe = bp->bio_offset >> (off_t)sc->sc_stripebits; 612129473Spjd /* Disk number. */ 613129473Spjd no = nstripe % sc->sc_ndisks; 614129473Spjd /* Start position in stripe. */ 615129473Spjd /* start = bp->bio_offset % stripesize; */ 616129473Spjd start = bp->bio_offset & (stripesize - 1); 617129473Spjd /* Start position in disk. */ 618131878Spjd /* offset = (nstripe / sc->sc_ndisks) * stripesize + start; */ 619131878Spjd offset = ((nstripe / sc->sc_ndisks) << sc->sc_stripebits) + start; 620129473Spjd /* Length of data to operate. */ 621129473Spjd length = MIN(bp->bio_length, stripesize - start); 622129473Spjd 623131878Spjd /* 624131878Spjd * Do use "fast" mode when: 625131878Spjd * 1. "Fast" mode is ON. 626131878Spjd * and 627196837Smav * 2. Request size is less than or equal to MAXPHYS, 628131878Spjd * which should always be true. 629131878Spjd * and 630131878Spjd * 3. Request size is bigger than stripesize * ndisks. If it isn't, 631131878Spjd * there will be no need to send more than one I/O request to 632131878Spjd * a provider, so there is nothing to optmize. 633256880Smav * and 634256880Smav * 4. Request is not unmapped. 635264313Smav * and 636264313Smav * 5. It is not a BIO_DELETE. 637131878Spjd */ 638196837Smav if (g_stripe_fast && bp->bio_length <= MAXPHYS && 639256880Smav bp->bio_length >= stripesize * sc->sc_ndisks && 640264313Smav (bp->bio_flags & BIO_UNMAPPED) == 0 && 641264313Smav bp->bio_cmd != BIO_DELETE) { 642131878Spjd fast = 1; 643129473Spjd } 644131878Spjd error = 0; 645133205Spjd if (fast) { 646131878Spjd error = g_stripe_start_fast(bp, no, offset, length); 647133205Spjd if (error != 0) 648133205Spjd g_stripe_fast_failed++; 649133205Spjd } 650129473Spjd /* 651131878Spjd * Do use "economic" when: 652131878Spjd * 1. "Economic" mode is ON. 653131878Spjd * or 654204070Spjd * 2. "Fast" mode failed. It can only fail if there is no memory. 655129473Spjd */ 656131878Spjd if (!fast || error != 0) 657131878Spjd error = g_stripe_start_economic(bp, no, offset, length); 658131878Spjd if (error != 0) { 659131878Spjd if (bp->bio_error == 0) 660131878Spjd bp->bio_error = error; 661131878Spjd g_io_deliver(bp, bp->bio_error); 662129473Spjd } 663129473Spjd} 664129473Spjd 665129473Spjdstatic void 666129473Spjdg_stripe_check_and_run(struct g_stripe_softc *sc) 667129473Spjd{ 668256880Smav struct g_provider *dp; 669129473Spjd off_t mediasize, ms; 670129473Spjd u_int no, sectorsize = 0; 671129473Spjd 672226998Smav g_topology_assert(); 673129473Spjd if (g_stripe_nvalid(sc) != sc->sc_ndisks) 674129473Spjd return; 675129473Spjd 676132664Spjd sc->sc_provider = g_new_providerf(sc->sc_geom, "stripe/%s", 677132664Spjd sc->sc_name); 678256880Smav sc->sc_provider->flags |= G_PF_DIRECT_SEND | G_PF_DIRECT_RECEIVE; 679256880Smav if (g_stripe_fast == 0) 680256880Smav sc->sc_provider->flags |= G_PF_ACCEPT_UNMAPPED; 681129473Spjd /* 682129473Spjd * Find the smallest disk. 683129473Spjd */ 684129473Spjd mediasize = sc->sc_disks[0]->provider->mediasize; 685129473Spjd if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC) 686129473Spjd mediasize -= sc->sc_disks[0]->provider->sectorsize; 687129473Spjd mediasize -= mediasize % sc->sc_stripesize; 688129473Spjd sectorsize = sc->sc_disks[0]->provider->sectorsize; 689129473Spjd for (no = 1; no < sc->sc_ndisks; no++) { 690256880Smav dp = sc->sc_disks[no]->provider; 691256880Smav ms = dp->mediasize; 692129473Spjd if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC) 693256880Smav ms -= dp->sectorsize; 694129473Spjd ms -= ms % sc->sc_stripesize; 695129473Spjd if (ms < mediasize) 696129473Spjd mediasize = ms; 697256880Smav sectorsize = lcm(sectorsize, dp->sectorsize); 698256880Smav 699256880Smav /* A provider underneath us doesn't support unmapped */ 700256880Smav if ((dp->flags & G_PF_ACCEPT_UNMAPPED) == 0) { 701256880Smav G_STRIPE_DEBUG(1, "Cancelling unmapped " 702256880Smav "because of %s.", dp->name); 703256880Smav sc->sc_provider->flags &= ~G_PF_ACCEPT_UNMAPPED; 704256880Smav } 705129473Spjd } 706129473Spjd sc->sc_provider->sectorsize = sectorsize; 707129473Spjd sc->sc_provider->mediasize = mediasize * sc->sc_ndisks; 708200933Smav sc->sc_provider->stripesize = sc->sc_stripesize; 709200933Smav sc->sc_provider->stripeoffset = 0; 710129473Spjd g_error_provider(sc->sc_provider, 0); 711129473Spjd 712226998Smav G_STRIPE_DEBUG(0, "Device %s activated.", sc->sc_provider->name); 713129473Spjd} 714129473Spjd 715129473Spjdstatic int 716129473Spjdg_stripe_read_metadata(struct g_consumer *cp, struct g_stripe_metadata *md) 717129473Spjd{ 718129473Spjd struct g_provider *pp; 719129473Spjd u_char *buf; 720129473Spjd int error; 721129473Spjd 722129473Spjd g_topology_assert(); 723129473Spjd 724129473Spjd error = g_access(cp, 1, 0, 0); 725129473Spjd if (error != 0) 726129473Spjd return (error); 727129473Spjd pp = cp->provider; 728129473Spjd g_topology_unlock(); 729129473Spjd buf = g_read_data(cp, pp->mediasize - pp->sectorsize, pp->sectorsize, 730129473Spjd &error); 731129473Spjd g_topology_lock(); 732129473Spjd g_access(cp, -1, 0, 0); 733129473Spjd if (buf == NULL) 734129473Spjd return (error); 735129473Spjd 736129473Spjd /* Decode metadata. */ 737129473Spjd stripe_metadata_decode(buf, md); 738129473Spjd g_free(buf); 739129473Spjd 740129473Spjd return (0); 741129473Spjd} 742129473Spjd 743129473Spjd/* 744129473Spjd * Add disk to given device. 745129473Spjd */ 746129473Spjdstatic int 747129473Spjdg_stripe_add_disk(struct g_stripe_softc *sc, struct g_provider *pp, u_int no) 748129473Spjd{ 749129473Spjd struct g_consumer *cp, *fcp; 750129473Spjd struct g_geom *gp; 751129473Spjd int error; 752129473Spjd 753226998Smav g_topology_assert(); 754129473Spjd /* Metadata corrupted? */ 755129473Spjd if (no >= sc->sc_ndisks) 756129473Spjd return (EINVAL); 757129473Spjd 758129473Spjd /* Check if disk is not already attached. */ 759129473Spjd if (sc->sc_disks[no] != NULL) 760129473Spjd return (EEXIST); 761129473Spjd 762129473Spjd gp = sc->sc_geom; 763129473Spjd fcp = LIST_FIRST(&gp->consumer); 764129473Spjd 765129473Spjd cp = g_new_consumer(gp); 766256880Smav cp->flags |= G_CF_DIRECT_SEND | G_CF_DIRECT_RECEIVE; 767226998Smav cp->private = NULL; 768226998Smav cp->index = no; 769129473Spjd error = g_attach(cp, pp); 770129473Spjd if (error != 0) { 771129473Spjd g_destroy_consumer(cp); 772129473Spjd return (error); 773129473Spjd } 774129473Spjd 775129473Spjd if (fcp != NULL && (fcp->acr > 0 || fcp->acw > 0 || fcp->ace > 0)) { 776129473Spjd error = g_access(cp, fcp->acr, fcp->acw, fcp->ace); 777129473Spjd if (error != 0) { 778129473Spjd g_detach(cp); 779129473Spjd g_destroy_consumer(cp); 780129473Spjd return (error); 781129473Spjd } 782129473Spjd } 783129473Spjd if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC) { 784129473Spjd struct g_stripe_metadata md; 785129473Spjd 786129473Spjd /* Reread metadata. */ 787129473Spjd error = g_stripe_read_metadata(cp, &md); 788129473Spjd if (error != 0) 789129473Spjd goto fail; 790129473Spjd 791129473Spjd if (strcmp(md.md_magic, G_STRIPE_MAGIC) != 0 || 792129473Spjd strcmp(md.md_name, sc->sc_name) != 0 || 793129473Spjd md.md_id != sc->sc_id) { 794129473Spjd G_STRIPE_DEBUG(0, "Metadata on %s changed.", pp->name); 795129473Spjd goto fail; 796129473Spjd } 797129473Spjd } 798129473Spjd 799129473Spjd sc->sc_disks[no] = cp; 800132664Spjd G_STRIPE_DEBUG(0, "Disk %s attached to %s.", pp->name, sc->sc_name); 801129473Spjd g_stripe_check_and_run(sc); 802129473Spjd 803129473Spjd return (0); 804129473Spjdfail: 805129473Spjd if (fcp != NULL && (fcp->acr > 0 || fcp->acw > 0 || fcp->ace > 0)) 806129473Spjd g_access(cp, -fcp->acr, -fcp->acw, -fcp->ace); 807129473Spjd g_detach(cp); 808129473Spjd g_destroy_consumer(cp); 809129473Spjd return (error); 810129473Spjd} 811129473Spjd 812129473Spjdstatic struct g_geom * 813129473Spjdg_stripe_create(struct g_class *mp, const struct g_stripe_metadata *md, 814129473Spjd u_int type) 815129473Spjd{ 816129473Spjd struct g_stripe_softc *sc; 817129473Spjd struct g_geom *gp; 818129473Spjd u_int no; 819129473Spjd 820226998Smav g_topology_assert(); 821132664Spjd G_STRIPE_DEBUG(1, "Creating device %s (id=%u).", md->md_name, 822129473Spjd md->md_id); 823129473Spjd 824129473Spjd /* Two disks is minimum. */ 825132664Spjd if (md->md_all < 2) { 826132664Spjd G_STRIPE_DEBUG(0, "Too few disks defined for %s.", md->md_name); 827129473Spjd return (NULL); 828129473Spjd } 829129473Spjd#if 0 830129473Spjd /* Stripe size have to be grater than or equal to sector size. */ 831129473Spjd if (md->md_stripesize < sectorsize) { 832132664Spjd G_STRIPE_DEBUG(0, "Invalid stripe size for %s.", md->md_name); 833129473Spjd return (NULL); 834129473Spjd } 835129473Spjd#endif 836129473Spjd /* Stripe size have to be power of 2. */ 837129473Spjd if (!powerof2(md->md_stripesize)) { 838132664Spjd G_STRIPE_DEBUG(0, "Invalid stripe size for %s.", md->md_name); 839129473Spjd return (NULL); 840129473Spjd } 841129473Spjd 842129473Spjd /* Check for duplicate unit */ 843129473Spjd LIST_FOREACH(gp, &mp->geom, geom) { 844129473Spjd sc = gp->softc; 845129473Spjd if (sc != NULL && strcmp(sc->sc_name, md->md_name) == 0) { 846129473Spjd G_STRIPE_DEBUG(0, "Device %s already configured.", 847132664Spjd sc->sc_name); 848129473Spjd return (NULL); 849129473Spjd } 850129473Spjd } 851132664Spjd gp = g_new_geomf(mp, "%s", md->md_name); 852132662Spjd sc = malloc(sizeof(*sc), M_STRIPE, M_WAITOK | M_ZERO); 853129473Spjd gp->start = g_stripe_start; 854129473Spjd gp->spoiled = g_stripe_orphan; 855129473Spjd gp->orphan = g_stripe_orphan; 856129473Spjd gp->access = g_stripe_access; 857129473Spjd gp->dumpconf = g_stripe_dumpconf; 858129473Spjd 859129473Spjd sc->sc_id = md->md_id; 860129473Spjd sc->sc_stripesize = md->md_stripesize; 861149300Spjd sc->sc_stripebits = bitcount32(sc->sc_stripesize - 1); 862129473Spjd sc->sc_ndisks = md->md_all; 863129473Spjd sc->sc_disks = malloc(sizeof(struct g_consumer *) * sc->sc_ndisks, 864129473Spjd M_STRIPE, M_WAITOK | M_ZERO); 865129473Spjd for (no = 0; no < sc->sc_ndisks; no++) 866129473Spjd sc->sc_disks[no] = NULL; 867129473Spjd sc->sc_type = type; 868256880Smav mtx_init(&sc->sc_lock, "gstripe lock", NULL, MTX_DEF); 869129473Spjd 870129473Spjd gp->softc = sc; 871129473Spjd sc->sc_geom = gp; 872129473Spjd sc->sc_provider = NULL; 873129473Spjd 874132664Spjd G_STRIPE_DEBUG(0, "Device %s created (id=%u).", sc->sc_name, sc->sc_id); 875129473Spjd 876129473Spjd return (gp); 877129473Spjd} 878129473Spjd 879129473Spjdstatic int 880129473Spjdg_stripe_destroy(struct g_stripe_softc *sc, boolean_t force) 881129473Spjd{ 882129473Spjd struct g_provider *pp; 883226998Smav struct g_consumer *cp, *cp1; 884129473Spjd struct g_geom *gp; 885129473Spjd 886129473Spjd g_topology_assert(); 887129473Spjd 888129473Spjd if (sc == NULL) 889129473Spjd return (ENXIO); 890129473Spjd 891129473Spjd pp = sc->sc_provider; 892129473Spjd if (pp != NULL && (pp->acr != 0 || pp->acw != 0 || pp->ace != 0)) { 893129473Spjd if (force) { 894129473Spjd G_STRIPE_DEBUG(0, "Device %s is still open, so it " 895129473Spjd "can't be definitely removed.", pp->name); 896129473Spjd } else { 897129473Spjd G_STRIPE_DEBUG(1, 898129473Spjd "Device %s is still open (r%dw%de%d).", pp->name, 899129473Spjd pp->acr, pp->acw, pp->ace); 900129473Spjd return (EBUSY); 901129473Spjd } 902129473Spjd } 903129473Spjd 904226998Smav gp = sc->sc_geom; 905226998Smav LIST_FOREACH_SAFE(cp, &gp->consumer, consumer, cp1) { 906226998Smav g_stripe_remove_disk(cp); 907226998Smav if (cp1 == NULL) 908226998Smav return (0); /* Recursion happened. */ 909129473Spjd } 910226998Smav if (!LIST_EMPTY(&gp->consumer)) 911226998Smav return (EINPROGRESS); 912129473Spjd 913129473Spjd gp->softc = NULL; 914129473Spjd KASSERT(sc->sc_provider == NULL, ("Provider still exists? (device=%s)", 915129473Spjd gp->name)); 916129473Spjd free(sc->sc_disks, M_STRIPE); 917256880Smav mtx_destroy(&sc->sc_lock); 918129473Spjd free(sc, M_STRIPE); 919226998Smav G_STRIPE_DEBUG(0, "Device %s destroyed.", gp->name); 920129473Spjd g_wither_geom(gp, ENXIO); 921129473Spjd return (0); 922129473Spjd} 923129473Spjd 924129473Spjdstatic int 925129473Spjdg_stripe_destroy_geom(struct gctl_req *req __unused, 926129473Spjd struct g_class *mp __unused, struct g_geom *gp) 927129473Spjd{ 928129473Spjd struct g_stripe_softc *sc; 929129473Spjd 930129473Spjd sc = gp->softc; 931129473Spjd return (g_stripe_destroy(sc, 0)); 932129473Spjd} 933129473Spjd 934129473Spjdstatic struct g_geom * 935129473Spjdg_stripe_taste(struct g_class *mp, struct g_provider *pp, int flags __unused) 936129473Spjd{ 937129473Spjd struct g_stripe_metadata md; 938129473Spjd struct g_stripe_softc *sc; 939129473Spjd struct g_consumer *cp; 940129473Spjd struct g_geom *gp; 941129473Spjd int error; 942129473Spjd 943129473Spjd g_trace(G_T_TOPOLOGY, "%s(%s, %s)", __func__, mp->name, pp->name); 944129473Spjd g_topology_assert(); 945129473Spjd 946197898Spjd /* Skip providers that are already open for writing. */ 947197898Spjd if (pp->acw > 0) 948197898Spjd return (NULL); 949197898Spjd 950129473Spjd G_STRIPE_DEBUG(3, "Tasting %s.", pp->name); 951129473Spjd 952129473Spjd gp = g_new_geomf(mp, "stripe:taste"); 953129473Spjd gp->start = g_stripe_start; 954129473Spjd gp->access = g_stripe_access; 955129473Spjd gp->orphan = g_stripe_orphan; 956129473Spjd cp = g_new_consumer(gp); 957129473Spjd g_attach(cp, pp); 958129473Spjd error = g_stripe_read_metadata(cp, &md); 959133371Spjd g_detach(cp); 960133371Spjd g_destroy_consumer(cp); 961133371Spjd g_destroy_geom(gp); 962129473Spjd if (error != 0) 963129473Spjd return (NULL); 964129473Spjd gp = NULL; 965129473Spjd 966129473Spjd if (strcmp(md.md_magic, G_STRIPE_MAGIC) != 0) 967129473Spjd return (NULL); 968129473Spjd if (md.md_version > G_STRIPE_VERSION) { 969129473Spjd printf("geom_stripe.ko module is too old to handle %s.\n", 970129473Spjd pp->name); 971129473Spjd return (NULL); 972129473Spjd } 973133373Spjd /* 974133373Spjd * Backward compatibility: 975133373Spjd */ 976142727Spjd /* There was no md_provider field in earlier versions of metadata. */ 977133373Spjd if (md.md_version < 2) 978133373Spjd bzero(md.md_provider, sizeof(md.md_provider)); 979142727Spjd /* There was no md_provsize field in earlier versions of metadata. */ 980142727Spjd if (md.md_version < 3) 981142727Spjd md.md_provsize = pp->mediasize; 982129473Spjd 983221101Smav if (md.md_provider[0] != '\0' && 984221101Smav !g_compare_names(md.md_provider, pp->name)) 985133373Spjd return (NULL); 986142727Spjd if (md.md_provsize != pp->mediasize) 987142727Spjd return (NULL); 988133373Spjd 989129473Spjd /* 990129473Spjd * Let's check if device already exists. 991129473Spjd */ 992129473Spjd sc = NULL; 993129473Spjd LIST_FOREACH(gp, &mp->geom, geom) { 994129473Spjd sc = gp->softc; 995129473Spjd if (sc == NULL) 996129473Spjd continue; 997129473Spjd if (sc->sc_type != G_STRIPE_TYPE_AUTOMATIC) 998129473Spjd continue; 999129473Spjd if (strcmp(md.md_name, sc->sc_name) != 0) 1000129473Spjd continue; 1001129473Spjd if (md.md_id != sc->sc_id) 1002129473Spjd continue; 1003129473Spjd break; 1004129473Spjd } 1005129473Spjd if (gp != NULL) { 1006129473Spjd G_STRIPE_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name); 1007129473Spjd error = g_stripe_add_disk(sc, pp, md.md_no); 1008129473Spjd if (error != 0) { 1009129473Spjd G_STRIPE_DEBUG(0, 1010129473Spjd "Cannot add disk %s to %s (error=%d).", pp->name, 1011129473Spjd gp->name, error); 1012129473Spjd return (NULL); 1013129473Spjd } 1014129473Spjd } else { 1015129473Spjd gp = g_stripe_create(mp, &md, G_STRIPE_TYPE_AUTOMATIC); 1016129473Spjd if (gp == NULL) { 1017132664Spjd G_STRIPE_DEBUG(0, "Cannot create device %s.", 1018129473Spjd md.md_name); 1019129473Spjd return (NULL); 1020129473Spjd } 1021129473Spjd sc = gp->softc; 1022129473Spjd G_STRIPE_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name); 1023129473Spjd error = g_stripe_add_disk(sc, pp, md.md_no); 1024129473Spjd if (error != 0) { 1025129473Spjd G_STRIPE_DEBUG(0, 1026129473Spjd "Cannot add disk %s to %s (error=%d).", pp->name, 1027129473Spjd gp->name, error); 1028129473Spjd g_stripe_destroy(sc, 1); 1029129473Spjd return (NULL); 1030129473Spjd } 1031129473Spjd } 1032129473Spjd 1033129473Spjd return (gp); 1034129473Spjd} 1035129473Spjd 1036129473Spjdstatic void 1037129473Spjdg_stripe_ctl_create(struct gctl_req *req, struct g_class *mp) 1038129473Spjd{ 1039129473Spjd u_int attached, no; 1040129473Spjd struct g_stripe_metadata md; 1041129473Spjd struct g_provider *pp; 1042129473Spjd struct g_stripe_softc *sc; 1043129473Spjd struct g_geom *gp; 1044129473Spjd struct sbuf *sb; 1045129473Spjd intmax_t *stripesize; 1046129473Spjd const char *name; 1047129473Spjd char param[16]; 1048129473Spjd int *nargs; 1049129473Spjd 1050129473Spjd g_topology_assert(); 1051129473Spjd nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs)); 1052129473Spjd if (nargs == NULL) { 1053129473Spjd gctl_error(req, "No '%s' argument.", "nargs"); 1054129473Spjd return; 1055129473Spjd } 1056129473Spjd if (*nargs <= 2) { 1057129473Spjd gctl_error(req, "Too few arguments."); 1058129473Spjd return; 1059129473Spjd } 1060129473Spjd 1061129473Spjd strlcpy(md.md_magic, G_STRIPE_MAGIC, sizeof(md.md_magic)); 1062129473Spjd md.md_version = G_STRIPE_VERSION; 1063129473Spjd name = gctl_get_asciiparam(req, "arg0"); 1064129473Spjd if (name == NULL) { 1065129473Spjd gctl_error(req, "No 'arg%u' argument.", 0); 1066129473Spjd return; 1067129473Spjd } 1068129473Spjd strlcpy(md.md_name, name, sizeof(md.md_name)); 1069129473Spjd md.md_id = arc4random(); 1070129473Spjd md.md_no = 0; 1071129473Spjd md.md_all = *nargs - 1; 1072129473Spjd stripesize = gctl_get_paraml(req, "stripesize", sizeof(*stripesize)); 1073129473Spjd if (stripesize == NULL) { 1074129473Spjd gctl_error(req, "No '%s' argument.", "stripesize"); 1075129473Spjd return; 1076129473Spjd } 1077129473Spjd md.md_stripesize = *stripesize; 1078133373Spjd bzero(md.md_provider, sizeof(md.md_provider)); 1079142727Spjd /* This field is not important here. */ 1080142727Spjd md.md_provsize = 0; 1081129473Spjd 1082129473Spjd /* Check all providers are valid */ 1083129473Spjd for (no = 1; no < *nargs; no++) { 1084129473Spjd snprintf(param, sizeof(param), "arg%u", no); 1085129473Spjd name = gctl_get_asciiparam(req, param); 1086129473Spjd if (name == NULL) { 1087129473Spjd gctl_error(req, "No 'arg%u' argument.", no); 1088129473Spjd return; 1089129473Spjd } 1090129473Spjd if (strncmp(name, "/dev/", strlen("/dev/")) == 0) 1091129473Spjd name += strlen("/dev/"); 1092129473Spjd pp = g_provider_by_name(name); 1093129473Spjd if (pp == NULL) { 1094129473Spjd G_STRIPE_DEBUG(1, "Disk %s is invalid.", name); 1095129473Spjd gctl_error(req, "Disk %s is invalid.", name); 1096129473Spjd return; 1097129473Spjd } 1098129473Spjd } 1099129473Spjd 1100129473Spjd gp = g_stripe_create(mp, &md, G_STRIPE_TYPE_MANUAL); 1101129473Spjd if (gp == NULL) { 1102132664Spjd gctl_error(req, "Can't configure %s.", md.md_name); 1103129473Spjd return; 1104129473Spjd } 1105129473Spjd 1106129473Spjd sc = gp->softc; 1107181463Sdes sb = sbuf_new_auto(); 1108129473Spjd sbuf_printf(sb, "Can't attach disk(s) to %s:", gp->name); 1109129473Spjd for (attached = 0, no = 1; no < *nargs; no++) { 1110129473Spjd snprintf(param, sizeof(param), "arg%u", no); 1111129473Spjd name = gctl_get_asciiparam(req, param); 1112146109Spjd if (name == NULL) { 1113146109Spjd gctl_error(req, "No 'arg%u' argument.", no); 1114146109Spjd continue; 1115146109Spjd } 1116129473Spjd if (strncmp(name, "/dev/", strlen("/dev/")) == 0) 1117129473Spjd name += strlen("/dev/"); 1118129473Spjd pp = g_provider_by_name(name); 1119129473Spjd KASSERT(pp != NULL, ("Provider %s disappear?!", name)); 1120129473Spjd if (g_stripe_add_disk(sc, pp, no - 1) != 0) { 1121129473Spjd G_STRIPE_DEBUG(1, "Disk %u (%s) not attached to %s.", 1122129473Spjd no, pp->name, gp->name); 1123129473Spjd sbuf_printf(sb, " %s", pp->name); 1124129473Spjd continue; 1125129473Spjd } 1126129473Spjd attached++; 1127129473Spjd } 1128129473Spjd sbuf_finish(sb); 1129129473Spjd if (md.md_all != attached) { 1130129473Spjd g_stripe_destroy(gp->softc, 1); 1131129473Spjd gctl_error(req, "%s", sbuf_data(sb)); 1132129473Spjd } 1133129473Spjd sbuf_delete(sb); 1134129473Spjd} 1135129473Spjd 1136129473Spjdstatic struct g_stripe_softc * 1137129473Spjdg_stripe_find_device(struct g_class *mp, const char *name) 1138129473Spjd{ 1139129473Spjd struct g_stripe_softc *sc; 1140129473Spjd struct g_geom *gp; 1141129473Spjd 1142129473Spjd LIST_FOREACH(gp, &mp->geom, geom) { 1143129473Spjd sc = gp->softc; 1144129473Spjd if (sc == NULL) 1145129473Spjd continue; 1146132664Spjd if (strcmp(sc->sc_name, name) == 0) 1147129473Spjd return (sc); 1148129473Spjd } 1149129473Spjd return (NULL); 1150129473Spjd} 1151129473Spjd 1152129473Spjdstatic void 1153129473Spjdg_stripe_ctl_destroy(struct gctl_req *req, struct g_class *mp) 1154129473Spjd{ 1155129473Spjd struct g_stripe_softc *sc; 1156129473Spjd int *force, *nargs, error; 1157129473Spjd const char *name; 1158129473Spjd char param[16]; 1159129473Spjd u_int i; 1160129473Spjd 1161129473Spjd g_topology_assert(); 1162129473Spjd 1163129473Spjd nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs)); 1164129473Spjd if (nargs == NULL) { 1165129473Spjd gctl_error(req, "No '%s' argument.", "nargs"); 1166129473Spjd return; 1167129473Spjd } 1168129473Spjd if (*nargs <= 0) { 1169129473Spjd gctl_error(req, "Missing device(s)."); 1170129473Spjd return; 1171129473Spjd } 1172129473Spjd force = gctl_get_paraml(req, "force", sizeof(*force)); 1173129473Spjd if (force == NULL) { 1174129473Spjd gctl_error(req, "No '%s' argument.", "force"); 1175129473Spjd return; 1176129473Spjd } 1177129473Spjd 1178129473Spjd for (i = 0; i < (u_int)*nargs; i++) { 1179129473Spjd snprintf(param, sizeof(param), "arg%u", i); 1180129473Spjd name = gctl_get_asciiparam(req, param); 1181129473Spjd if (name == NULL) { 1182129473Spjd gctl_error(req, "No 'arg%u' argument.", i); 1183129473Spjd return; 1184129473Spjd } 1185129473Spjd sc = g_stripe_find_device(mp, name); 1186129473Spjd if (sc == NULL) { 1187129473Spjd gctl_error(req, "No such device: %s.", name); 1188129473Spjd return; 1189129473Spjd } 1190129473Spjd error = g_stripe_destroy(sc, *force); 1191129473Spjd if (error != 0) { 1192129473Spjd gctl_error(req, "Cannot destroy device %s (error=%d).", 1193132664Spjd sc->sc_name, error); 1194129473Spjd return; 1195129473Spjd } 1196129473Spjd } 1197129473Spjd} 1198129473Spjd 1199129473Spjdstatic void 1200129473Spjdg_stripe_config(struct gctl_req *req, struct g_class *mp, const char *verb) 1201129473Spjd{ 1202129473Spjd uint32_t *version; 1203129473Spjd 1204129473Spjd g_topology_assert(); 1205129473Spjd 1206129473Spjd version = gctl_get_paraml(req, "version", sizeof(*version)); 1207129473Spjd if (version == NULL) { 1208129473Spjd gctl_error(req, "No '%s' argument.", "version"); 1209129473Spjd return; 1210129473Spjd } 1211129473Spjd if (*version != G_STRIPE_VERSION) { 1212129473Spjd gctl_error(req, "Userland and kernel parts are out of sync."); 1213129473Spjd return; 1214129473Spjd } 1215129473Spjd 1216129473Spjd if (strcmp(verb, "create") == 0) { 1217129473Spjd g_stripe_ctl_create(req, mp); 1218129473Spjd return; 1219131649Spjd } else if (strcmp(verb, "destroy") == 0 || 1220131649Spjd strcmp(verb, "stop") == 0) { 1221129473Spjd g_stripe_ctl_destroy(req, mp); 1222129473Spjd return; 1223129473Spjd } 1224129473Spjd 1225129473Spjd gctl_error(req, "Unknown verb."); 1226129473Spjd} 1227129473Spjd 1228129473Spjdstatic void 1229129473Spjdg_stripe_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, 1230129473Spjd struct g_consumer *cp, struct g_provider *pp) 1231129473Spjd{ 1232129473Spjd struct g_stripe_softc *sc; 1233129473Spjd 1234129473Spjd sc = gp->softc; 1235132665Spjd if (sc == NULL) 1236129473Spjd return; 1237132665Spjd if (pp != NULL) { 1238132665Spjd /* Nothing here. */ 1239132665Spjd } else if (cp != NULL) { 1240134292Spjd sbuf_printf(sb, "%s<Number>%u</Number>\n", indent, 1241134292Spjd (u_int)cp->index); 1242132665Spjd } else { 1243132665Spjd sbuf_printf(sb, "%s<ID>%u</ID>\n", indent, (u_int)sc->sc_id); 1244132665Spjd sbuf_printf(sb, "%s<Stripesize>%u</Stripesize>\n", indent, 1245132665Spjd (u_int)sc->sc_stripesize); 1246132665Spjd sbuf_printf(sb, "%s<Type>", indent); 1247132665Spjd switch (sc->sc_type) { 1248132665Spjd case G_STRIPE_TYPE_AUTOMATIC: 1249132665Spjd sbuf_printf(sb, "AUTOMATIC"); 1250132665Spjd break; 1251132665Spjd case G_STRIPE_TYPE_MANUAL: 1252132665Spjd sbuf_printf(sb, "MANUAL"); 1253132665Spjd break; 1254132665Spjd default: 1255132665Spjd sbuf_printf(sb, "UNKNOWN"); 1256132665Spjd break; 1257132665Spjd } 1258132665Spjd sbuf_printf(sb, "</Type>\n"); 1259132665Spjd sbuf_printf(sb, "%s<Status>Total=%u, Online=%u</Status>\n", 1260132665Spjd indent, sc->sc_ndisks, g_stripe_nvalid(sc)); 1261132665Spjd sbuf_printf(sb, "%s<State>", indent); 1262132665Spjd if (sc->sc_provider != NULL && sc->sc_provider->error == 0) 1263132665Spjd sbuf_printf(sb, "UP"); 1264132665Spjd else 1265132665Spjd sbuf_printf(sb, "DOWN"); 1266132665Spjd sbuf_printf(sb, "</State>\n"); 1267129473Spjd } 1268129473Spjd} 1269129473Spjd 1270129473SpjdDECLARE_GEOM_CLASS(g_stripe_class, g_stripe); 1271332640SkevansMODULE_VERSION(geom_stripe, 0); 1272