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: releng/11.0/sys/geom/stripe/g_stripe.c 267992 2014-06-28 03:56:17Z hselasky $"); 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) { 174148092Spjd sc->sc_provider->flags |= G_PF_WITHER; 175226998Smav G_STRIPE_DEBUG(0, "Device %s deactivated.", 176226998Smav sc->sc_provider->name); 177129473Spjd g_orphan_provider(sc->sc_provider, ENXIO); 178129473Spjd sc->sc_provider = NULL; 179129473Spjd } 180129473Spjd 181129473Spjd if (cp->acr > 0 || cp->acw > 0 || cp->ace > 0) 182226998Smav return; 183226998Smav sc->sc_disks[cp->index] = NULL; 184226998Smav cp->index = 0; 185129473Spjd g_detach(cp); 186129473Spjd g_destroy_consumer(cp); 187226998Smav /* If there are no valid disks anymore, remove device. */ 188226998Smav if (LIST_EMPTY(&sc->sc_geom->consumer)) 189226998Smav g_stripe_destroy(sc, 1); 190129473Spjd} 191129473Spjd 192129473Spjdstatic void 193129473Spjdg_stripe_orphan(struct g_consumer *cp) 194129473Spjd{ 195129473Spjd struct g_stripe_softc *sc; 196129473Spjd struct g_geom *gp; 197129473Spjd 198129473Spjd g_topology_assert(); 199129473Spjd gp = cp->geom; 200129473Spjd sc = gp->softc; 201129473Spjd if (sc == NULL) 202129473Spjd return; 203129473Spjd 204129473Spjd g_stripe_remove_disk(cp); 205129473Spjd} 206129473Spjd 207129473Spjdstatic int 208129473Spjdg_stripe_access(struct g_provider *pp, int dr, int dw, int de) 209129473Spjd{ 210226998Smav struct g_consumer *cp1, *cp2, *tmp; 211129473Spjd struct g_stripe_softc *sc; 212129473Spjd struct g_geom *gp; 213129473Spjd int error; 214129473Spjd 215226998Smav g_topology_assert(); 216129473Spjd gp = pp->geom; 217129473Spjd sc = gp->softc; 218226998Smav KASSERT(sc != NULL, ("NULL sc in %s.", __func__)); 219129473Spjd 220129473Spjd /* On first open, grab an extra "exclusive" bit */ 221129473Spjd if (pp->acr == 0 && pp->acw == 0 && pp->ace == 0) 222129473Spjd de++; 223129473Spjd /* ... and let go of it on last close */ 224129473Spjd if ((pp->acr + dr) == 0 && (pp->acw + dw) == 0 && (pp->ace + de) == 0) 225129473Spjd de--; 226129473Spjd 227226998Smav LIST_FOREACH_SAFE(cp1, &gp->consumer, consumer, tmp) { 228129473Spjd error = g_access(cp1, dr, dw, de); 229226998Smav if (error != 0) 230226998Smav goto fail; 231226998Smav if (cp1->acr == 0 && cp1->acw == 0 && cp1->ace == 0 && 232226998Smav cp1->private != NULL) { 233226998Smav g_stripe_remove_disk(cp1); /* May destroy geom. */ 234129473Spjd } 235129473Spjd } 236226998Smav return (0); 237129473Spjd 238226998Smavfail: 239226998Smav LIST_FOREACH(cp2, &gp->consumer, consumer) { 240226998Smav if (cp1 == cp2) 241226998Smav break; 242226998Smav g_access(cp2, -dr, -dw, -de); 243226998Smav } 244129473Spjd return (error); 245129473Spjd} 246129473Spjd 247129473Spjdstatic void 248131878Spjdg_stripe_copy(struct g_stripe_softc *sc, char *src, char *dst, off_t offset, 249131878Spjd off_t length, int mode) 250129473Spjd{ 251131878Spjd u_int stripesize; 252131878Spjd size_t len; 253131878Spjd 254131878Spjd stripesize = sc->sc_stripesize; 255131878Spjd len = (size_t)(stripesize - (offset & (stripesize - 1))); 256131878Spjd do { 257131878Spjd bcopy(src, dst, len); 258131878Spjd if (mode) { 259131878Spjd dst += len + stripesize * (sc->sc_ndisks - 1); 260131878Spjd src += len; 261131878Spjd } else { 262131878Spjd dst += len; 263131878Spjd src += len + stripesize * (sc->sc_ndisks - 1); 264131878Spjd } 265131878Spjd length -= len; 266131878Spjd KASSERT(length >= 0, 267131878Spjd ("Length < 0 (stripesize=%zu, offset=%jd, length=%jd).", 268131878Spjd (size_t)stripesize, (intmax_t)offset, (intmax_t)length)); 269131878Spjd if (length > stripesize) 270131878Spjd len = stripesize; 271131878Spjd else 272131878Spjd len = length; 273131878Spjd } while (length > 0); 274131878Spjd} 275131878Spjd 276131878Spjdstatic void 277131878Spjdg_stripe_done(struct bio *bp) 278131878Spjd{ 279129473Spjd struct g_stripe_softc *sc; 280131878Spjd struct bio *pbp; 281131878Spjd 282131878Spjd pbp = bp->bio_parent; 283131878Spjd sc = pbp->bio_to->geom->softc; 284133204Spjd if (bp->bio_cmd == BIO_READ && bp->bio_caller1 != NULL) { 285133204Spjd g_stripe_copy(sc, bp->bio_data, bp->bio_caller1, bp->bio_offset, 286131878Spjd bp->bio_length, 1); 287133204Spjd bp->bio_data = bp->bio_caller1; 288133204Spjd bp->bio_caller1 = NULL; 289131878Spjd } 290256880Smav mtx_lock(&sc->sc_lock); 291256880Smav if (pbp->bio_error == 0) 292256880Smav pbp->bio_error = bp->bio_error; 293256880Smav pbp->bio_completed += bp->bio_completed; 294131878Spjd pbp->bio_inbed++; 295131878Spjd if (pbp->bio_children == pbp->bio_inbed) { 296256880Smav mtx_unlock(&sc->sc_lock); 297133204Spjd if (pbp->bio_driver1 != NULL) 298133204Spjd uma_zfree(g_stripe_zone, pbp->bio_driver1); 299131878Spjd g_io_deliver(pbp, pbp->bio_error); 300256880Smav } else 301256880Smav mtx_unlock(&sc->sc_lock); 302256880Smav g_destroy_bio(bp); 303131878Spjd} 304131878Spjd 305131878Spjdstatic int 306131878Spjdg_stripe_start_fast(struct bio *bp, u_int no, off_t offset, off_t length) 307131878Spjd{ 308131878Spjd TAILQ_HEAD(, bio) queue = TAILQ_HEAD_INITIALIZER(queue); 309131878Spjd u_int nparts = 0, stripesize; 310131878Spjd struct g_stripe_softc *sc; 311131878Spjd char *addr, *data = NULL; 312129473Spjd struct bio *cbp; 313131878Spjd int error; 314131878Spjd 315131878Spjd sc = bp->bio_to->geom->softc; 316131878Spjd 317131878Spjd addr = bp->bio_data; 318131878Spjd stripesize = sc->sc_stripesize; 319131878Spjd 320131878Spjd cbp = g_clone_bio(bp); 321131878Spjd if (cbp == NULL) { 322131878Spjd error = ENOMEM; 323131878Spjd goto failure; 324131878Spjd } 325131878Spjd TAILQ_INSERT_TAIL(&queue, cbp, bio_queue); 326131878Spjd nparts++; 327131878Spjd /* 328131878Spjd * Fill in the component buf structure. 329131878Spjd */ 330131878Spjd cbp->bio_done = g_stripe_done; 331131878Spjd cbp->bio_offset = offset; 332131878Spjd cbp->bio_data = addr; 333133204Spjd cbp->bio_caller1 = NULL; 334131878Spjd cbp->bio_length = length; 335133204Spjd cbp->bio_caller2 = sc->sc_disks[no]; 336131878Spjd 337131878Spjd /* offset -= offset % stripesize; */ 338131878Spjd offset -= offset & (stripesize - 1); 339131878Spjd addr += length; 340131878Spjd length = bp->bio_length - length; 341131878Spjd for (no++; length > 0; no++, length -= stripesize, addr += stripesize) { 342131878Spjd if (no > sc->sc_ndisks - 1) { 343131878Spjd no = 0; 344131878Spjd offset += stripesize; 345131878Spjd } 346131878Spjd if (nparts >= sc->sc_ndisks) { 347131878Spjd cbp = TAILQ_NEXT(cbp, bio_queue); 348131878Spjd if (cbp == NULL) 349131878Spjd cbp = TAILQ_FIRST(&queue); 350131878Spjd nparts++; 351131878Spjd /* 352131878Spjd * Update bio structure. 353131878Spjd */ 354131878Spjd /* 355131878Spjd * MIN() is in case when 356131878Spjd * (bp->bio_length % sc->sc_stripesize) != 0. 357131878Spjd */ 358131878Spjd cbp->bio_length += MIN(stripesize, length); 359133204Spjd if (cbp->bio_caller1 == NULL) { 360133204Spjd cbp->bio_caller1 = cbp->bio_data; 361131878Spjd cbp->bio_data = NULL; 362131878Spjd if (data == NULL) { 363131878Spjd data = uma_zalloc(g_stripe_zone, 364131878Spjd M_NOWAIT); 365131878Spjd if (data == NULL) { 366131878Spjd error = ENOMEM; 367131878Spjd goto failure; 368131878Spjd } 369131878Spjd } 370131878Spjd } 371131878Spjd } else { 372131878Spjd cbp = g_clone_bio(bp); 373131878Spjd if (cbp == NULL) { 374131878Spjd error = ENOMEM; 375131878Spjd goto failure; 376131878Spjd } 377131878Spjd TAILQ_INSERT_TAIL(&queue, cbp, bio_queue); 378131878Spjd nparts++; 379131878Spjd /* 380131878Spjd * Fill in the component buf structure. 381131878Spjd */ 382131878Spjd cbp->bio_done = g_stripe_done; 383131878Spjd cbp->bio_offset = offset; 384131878Spjd cbp->bio_data = addr; 385133204Spjd cbp->bio_caller1 = NULL; 386131878Spjd /* 387131878Spjd * MIN() is in case when 388131878Spjd * (bp->bio_length % sc->sc_stripesize) != 0. 389131878Spjd */ 390131878Spjd cbp->bio_length = MIN(stripesize, length); 391133204Spjd cbp->bio_caller2 = sc->sc_disks[no]; 392131878Spjd } 393131878Spjd } 394131878Spjd if (data != NULL) 395133444Spjd bp->bio_driver1 = data; 396131878Spjd /* 397131878Spjd * Fire off all allocated requests! 398131878Spjd */ 399131878Spjd while ((cbp = TAILQ_FIRST(&queue)) != NULL) { 400131878Spjd struct g_consumer *cp; 401131878Spjd 402131878Spjd TAILQ_REMOVE(&queue, cbp, bio_queue); 403133204Spjd cp = cbp->bio_caller2; 404133204Spjd cbp->bio_caller2 = NULL; 405131878Spjd cbp->bio_to = cp->provider; 406133204Spjd if (cbp->bio_caller1 != NULL) { 407131878Spjd cbp->bio_data = data; 408131878Spjd if (bp->bio_cmd == BIO_WRITE) { 409133204Spjd g_stripe_copy(sc, cbp->bio_caller1, data, 410131878Spjd cbp->bio_offset, cbp->bio_length, 0); 411131878Spjd } 412131878Spjd data += cbp->bio_length; 413131878Spjd } 414131878Spjd G_STRIPE_LOGREQ(cbp, "Sending request."); 415131878Spjd g_io_request(cbp, cp); 416131878Spjd } 417131878Spjd return (0); 418131878Spjdfailure: 419131878Spjd if (data != NULL) 420131878Spjd uma_zfree(g_stripe_zone, data); 421131878Spjd while ((cbp = TAILQ_FIRST(&queue)) != NULL) { 422131878Spjd TAILQ_REMOVE(&queue, cbp, bio_queue); 423133204Spjd if (cbp->bio_caller1 != NULL) { 424133204Spjd cbp->bio_data = cbp->bio_caller1; 425133204Spjd cbp->bio_caller1 = NULL; 426131878Spjd } 427133201Spjd bp->bio_children--; 428131878Spjd g_destroy_bio(cbp); 429131878Spjd } 430131878Spjd return (error); 431131878Spjd} 432131878Spjd 433131878Spjdstatic int 434131878Spjdg_stripe_start_economic(struct bio *bp, u_int no, off_t offset, off_t length) 435131878Spjd{ 436131878Spjd TAILQ_HEAD(, bio) queue = TAILQ_HEAD_INITIALIZER(queue); 437131878Spjd struct g_stripe_softc *sc; 438129473Spjd uint32_t stripesize; 439131878Spjd struct bio *cbp; 440129473Spjd char *addr; 441131878Spjd int error; 442129473Spjd 443131878Spjd sc = bp->bio_to->geom->softc; 444131878Spjd 445131878Spjd stripesize = sc->sc_stripesize; 446131878Spjd 447131878Spjd cbp = g_clone_bio(bp); 448131878Spjd if (cbp == NULL) { 449131878Spjd error = ENOMEM; 450131878Spjd goto failure; 451131878Spjd } 452131878Spjd TAILQ_INSERT_TAIL(&queue, cbp, bio_queue); 453129473Spjd /* 454131878Spjd * Fill in the component buf structure. 455131878Spjd */ 456256880Smav if (bp->bio_length == length) 457256880Smav cbp->bio_done = g_std_done; /* Optimized lockless case. */ 458256880Smav else 459256880Smav cbp->bio_done = g_stripe_done; 460131878Spjd cbp->bio_offset = offset; 461131878Spjd cbp->bio_length = length; 462256880Smav if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 463256880Smav bp->bio_ma_n = round_page(bp->bio_ma_offset + 464256880Smav bp->bio_length) / PAGE_SIZE; 465256880Smav addr = NULL; 466256880Smav } else 467256880Smav addr = bp->bio_data; 468133204Spjd cbp->bio_caller2 = sc->sc_disks[no]; 469131878Spjd 470131878Spjd /* offset -= offset % stripesize; */ 471131878Spjd offset -= offset & (stripesize - 1); 472264313Smav if (bp->bio_cmd != BIO_DELETE) 473264313Smav addr += length; 474131878Spjd length = bp->bio_length - length; 475264313Smav for (no++; length > 0; no++, length -= stripesize) { 476131878Spjd if (no > sc->sc_ndisks - 1) { 477131878Spjd no = 0; 478131878Spjd offset += stripesize; 479131878Spjd } 480131878Spjd cbp = g_clone_bio(bp); 481131878Spjd if (cbp == NULL) { 482131878Spjd error = ENOMEM; 483131878Spjd goto failure; 484131878Spjd } 485131878Spjd TAILQ_INSERT_TAIL(&queue, cbp, bio_queue); 486131878Spjd 487131878Spjd /* 488131878Spjd * Fill in the component buf structure. 489131878Spjd */ 490256880Smav cbp->bio_done = g_stripe_done; 491131878Spjd cbp->bio_offset = offset; 492131878Spjd /* 493131878Spjd * MIN() is in case when 494131878Spjd * (bp->bio_length % sc->sc_stripesize) != 0. 495131878Spjd */ 496131878Spjd cbp->bio_length = MIN(stripesize, length); 497256880Smav if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 498256880Smav cbp->bio_ma_offset += (uintptr_t)addr; 499256880Smav cbp->bio_ma += cbp->bio_ma_offset / PAGE_SIZE; 500256880Smav cbp->bio_ma_offset %= PAGE_SIZE; 501256880Smav cbp->bio_ma_n = round_page(cbp->bio_ma_offset + 502256880Smav cbp->bio_length) / PAGE_SIZE; 503256880Smav } else 504256880Smav cbp->bio_data = addr; 505131878Spjd 506133204Spjd cbp->bio_caller2 = sc->sc_disks[no]; 507264313Smav 508264313Smav if (bp->bio_cmd != BIO_DELETE) 509264313Smav addr += stripesize; 510131878Spjd } 511131878Spjd /* 512131878Spjd * Fire off all allocated requests! 513131878Spjd */ 514131878Spjd while ((cbp = TAILQ_FIRST(&queue)) != NULL) { 515131878Spjd struct g_consumer *cp; 516131878Spjd 517131878Spjd TAILQ_REMOVE(&queue, cbp, bio_queue); 518133204Spjd cp = cbp->bio_caller2; 519133204Spjd cbp->bio_caller2 = NULL; 520131878Spjd cbp->bio_to = cp->provider; 521131878Spjd G_STRIPE_LOGREQ(cbp, "Sending request."); 522131878Spjd g_io_request(cbp, cp); 523131878Spjd } 524131878Spjd return (0); 525131878Spjdfailure: 526131878Spjd while ((cbp = TAILQ_FIRST(&queue)) != NULL) { 527131878Spjd TAILQ_REMOVE(&queue, cbp, bio_queue); 528133201Spjd bp->bio_children--; 529131878Spjd g_destroy_bio(cbp); 530131878Spjd } 531131878Spjd return (error); 532131878Spjd} 533131878Spjd 534131878Spjdstatic void 535163836Spjdg_stripe_flush(struct g_stripe_softc *sc, struct bio *bp) 536163836Spjd{ 537163836Spjd struct bio_queue_head queue; 538163836Spjd struct g_consumer *cp; 539163836Spjd struct bio *cbp; 540163836Spjd u_int no; 541163836Spjd 542163836Spjd bioq_init(&queue); 543163836Spjd for (no = 0; no < sc->sc_ndisks; no++) { 544163836Spjd cbp = g_clone_bio(bp); 545163836Spjd if (cbp == NULL) { 546163836Spjd for (cbp = bioq_first(&queue); cbp != NULL; 547163836Spjd cbp = bioq_first(&queue)) { 548163836Spjd bioq_remove(&queue, cbp); 549163836Spjd g_destroy_bio(cbp); 550163836Spjd } 551163836Spjd if (bp->bio_error == 0) 552163836Spjd bp->bio_error = ENOMEM; 553163836Spjd g_io_deliver(bp, bp->bio_error); 554163836Spjd return; 555163836Spjd } 556163836Spjd bioq_insert_tail(&queue, cbp); 557256880Smav cbp->bio_done = g_stripe_done; 558256880Smav cbp->bio_caller2 = sc->sc_disks[no]; 559163836Spjd cbp->bio_to = sc->sc_disks[no]->provider; 560163836Spjd } 561163836Spjd for (cbp = bioq_first(&queue); cbp != NULL; cbp = bioq_first(&queue)) { 562163836Spjd bioq_remove(&queue, cbp); 563163836Spjd G_STRIPE_LOGREQ(cbp, "Sending request."); 564256880Smav cp = cbp->bio_caller2; 565256880Smav cbp->bio_caller2 = NULL; 566163836Spjd g_io_request(cbp, cp); 567163836Spjd } 568163836Spjd} 569163836Spjd 570163836Spjdstatic void 571131878Spjdg_stripe_start(struct bio *bp) 572131878Spjd{ 573131878Spjd off_t offset, start, length, nstripe; 574131878Spjd struct g_stripe_softc *sc; 575131878Spjd u_int no, stripesize; 576131878Spjd int error, fast = 0; 577131878Spjd 578131878Spjd sc = bp->bio_to->geom->softc; 579131878Spjd /* 580129473Spjd * If sc == NULL, provider's error should be set and g_stripe_start() 581129473Spjd * should not be called at all. 582129473Spjd */ 583129473Spjd KASSERT(sc != NULL, 584129473Spjd ("Provider's error should be set (error=%d)(device=%s).", 585129473Spjd bp->bio_to->error, bp->bio_to->name)); 586129473Spjd 587129473Spjd G_STRIPE_LOGREQ(bp, "Request received."); 588129473Spjd 589129473Spjd switch (bp->bio_cmd) { 590129473Spjd case BIO_READ: 591129473Spjd case BIO_WRITE: 592129473Spjd case BIO_DELETE: 593129473Spjd break; 594163886Spjd case BIO_FLUSH: 595163886Spjd g_stripe_flush(sc, bp); 596163886Spjd return; 597129473Spjd case BIO_GETATTR: 598129473Spjd /* To which provider it should be delivered? */ 599129473Spjd default: 600129473Spjd g_io_deliver(bp, EOPNOTSUPP); 601129473Spjd return; 602129473Spjd } 603129473Spjd 604129473Spjd stripesize = sc->sc_stripesize; 605129473Spjd 606129473Spjd /* 607131878Spjd * Calculations are quite messy, but fast I hope. 608129473Spjd */ 609129473Spjd 610129473Spjd /* Stripe number. */ 611129473Spjd /* nstripe = bp->bio_offset / stripesize; */ 612129473Spjd nstripe = bp->bio_offset >> (off_t)sc->sc_stripebits; 613129473Spjd /* Disk number. */ 614129473Spjd no = nstripe % sc->sc_ndisks; 615129473Spjd /* Start position in stripe. */ 616129473Spjd /* start = bp->bio_offset % stripesize; */ 617129473Spjd start = bp->bio_offset & (stripesize - 1); 618129473Spjd /* Start position in disk. */ 619131878Spjd /* offset = (nstripe / sc->sc_ndisks) * stripesize + start; */ 620131878Spjd offset = ((nstripe / sc->sc_ndisks) << sc->sc_stripebits) + start; 621129473Spjd /* Length of data to operate. */ 622129473Spjd length = MIN(bp->bio_length, stripesize - start); 623129473Spjd 624131878Spjd /* 625131878Spjd * Do use "fast" mode when: 626131878Spjd * 1. "Fast" mode is ON. 627131878Spjd * and 628196837Smav * 2. Request size is less than or equal to MAXPHYS, 629131878Spjd * which should always be true. 630131878Spjd * and 631131878Spjd * 3. Request size is bigger than stripesize * ndisks. If it isn't, 632131878Spjd * there will be no need to send more than one I/O request to 633131878Spjd * a provider, so there is nothing to optmize. 634256880Smav * and 635256880Smav * 4. Request is not unmapped. 636264313Smav * and 637264313Smav * 5. It is not a BIO_DELETE. 638131878Spjd */ 639196837Smav if (g_stripe_fast && bp->bio_length <= MAXPHYS && 640256880Smav bp->bio_length >= stripesize * sc->sc_ndisks && 641264313Smav (bp->bio_flags & BIO_UNMAPPED) == 0 && 642264313Smav bp->bio_cmd != BIO_DELETE) { 643131878Spjd fast = 1; 644129473Spjd } 645131878Spjd error = 0; 646133205Spjd if (fast) { 647131878Spjd error = g_stripe_start_fast(bp, no, offset, length); 648133205Spjd if (error != 0) 649133205Spjd g_stripe_fast_failed++; 650133205Spjd } 651129473Spjd /* 652131878Spjd * Do use "economic" when: 653131878Spjd * 1. "Economic" mode is ON. 654131878Spjd * or 655204070Spjd * 2. "Fast" mode failed. It can only fail if there is no memory. 656129473Spjd */ 657131878Spjd if (!fast || error != 0) 658131878Spjd error = g_stripe_start_economic(bp, no, offset, length); 659131878Spjd if (error != 0) { 660131878Spjd if (bp->bio_error == 0) 661131878Spjd bp->bio_error = error; 662131878Spjd g_io_deliver(bp, bp->bio_error); 663129473Spjd } 664129473Spjd} 665129473Spjd 666129473Spjdstatic void 667129473Spjdg_stripe_check_and_run(struct g_stripe_softc *sc) 668129473Spjd{ 669256880Smav struct g_provider *dp; 670129473Spjd off_t mediasize, ms; 671129473Spjd u_int no, sectorsize = 0; 672129473Spjd 673226998Smav g_topology_assert(); 674129473Spjd if (g_stripe_nvalid(sc) != sc->sc_ndisks) 675129473Spjd return; 676129473Spjd 677132664Spjd sc->sc_provider = g_new_providerf(sc->sc_geom, "stripe/%s", 678132664Spjd sc->sc_name); 679256880Smav sc->sc_provider->flags |= G_PF_DIRECT_SEND | G_PF_DIRECT_RECEIVE; 680256880Smav if (g_stripe_fast == 0) 681256880Smav sc->sc_provider->flags |= G_PF_ACCEPT_UNMAPPED; 682129473Spjd /* 683129473Spjd * Find the smallest disk. 684129473Spjd */ 685129473Spjd mediasize = sc->sc_disks[0]->provider->mediasize; 686129473Spjd if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC) 687129473Spjd mediasize -= sc->sc_disks[0]->provider->sectorsize; 688129473Spjd mediasize -= mediasize % sc->sc_stripesize; 689129473Spjd sectorsize = sc->sc_disks[0]->provider->sectorsize; 690129473Spjd for (no = 1; no < sc->sc_ndisks; no++) { 691256880Smav dp = sc->sc_disks[no]->provider; 692256880Smav ms = dp->mediasize; 693129473Spjd if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC) 694256880Smav ms -= dp->sectorsize; 695129473Spjd ms -= ms % sc->sc_stripesize; 696129473Spjd if (ms < mediasize) 697129473Spjd mediasize = ms; 698256880Smav sectorsize = lcm(sectorsize, dp->sectorsize); 699256880Smav 700256880Smav /* A provider underneath us doesn't support unmapped */ 701256880Smav if ((dp->flags & G_PF_ACCEPT_UNMAPPED) == 0) { 702256880Smav G_STRIPE_DEBUG(1, "Cancelling unmapped " 703256880Smav "because of %s.", dp->name); 704256880Smav sc->sc_provider->flags &= ~G_PF_ACCEPT_UNMAPPED; 705256880Smav } 706129473Spjd } 707129473Spjd sc->sc_provider->sectorsize = sectorsize; 708129473Spjd sc->sc_provider->mediasize = mediasize * sc->sc_ndisks; 709200933Smav sc->sc_provider->stripesize = sc->sc_stripesize; 710200933Smav sc->sc_provider->stripeoffset = 0; 711129473Spjd g_error_provider(sc->sc_provider, 0); 712129473Spjd 713226998Smav G_STRIPE_DEBUG(0, "Device %s activated.", sc->sc_provider->name); 714129473Spjd} 715129473Spjd 716129473Spjdstatic int 717129473Spjdg_stripe_read_metadata(struct g_consumer *cp, struct g_stripe_metadata *md) 718129473Spjd{ 719129473Spjd struct g_provider *pp; 720129473Spjd u_char *buf; 721129473Spjd int error; 722129473Spjd 723129473Spjd g_topology_assert(); 724129473Spjd 725129473Spjd error = g_access(cp, 1, 0, 0); 726129473Spjd if (error != 0) 727129473Spjd return (error); 728129473Spjd pp = cp->provider; 729129473Spjd g_topology_unlock(); 730129473Spjd buf = g_read_data(cp, pp->mediasize - pp->sectorsize, pp->sectorsize, 731129473Spjd &error); 732129473Spjd g_topology_lock(); 733129473Spjd g_access(cp, -1, 0, 0); 734129473Spjd if (buf == NULL) 735129473Spjd return (error); 736129473Spjd 737129473Spjd /* Decode metadata. */ 738129473Spjd stripe_metadata_decode(buf, md); 739129473Spjd g_free(buf); 740129473Spjd 741129473Spjd return (0); 742129473Spjd} 743129473Spjd 744129473Spjd/* 745129473Spjd * Add disk to given device. 746129473Spjd */ 747129473Spjdstatic int 748129473Spjdg_stripe_add_disk(struct g_stripe_softc *sc, struct g_provider *pp, u_int no) 749129473Spjd{ 750129473Spjd struct g_consumer *cp, *fcp; 751129473Spjd struct g_geom *gp; 752129473Spjd int error; 753129473Spjd 754226998Smav g_topology_assert(); 755129473Spjd /* Metadata corrupted? */ 756129473Spjd if (no >= sc->sc_ndisks) 757129473Spjd return (EINVAL); 758129473Spjd 759129473Spjd /* Check if disk is not already attached. */ 760129473Spjd if (sc->sc_disks[no] != NULL) 761129473Spjd return (EEXIST); 762129473Spjd 763129473Spjd gp = sc->sc_geom; 764129473Spjd fcp = LIST_FIRST(&gp->consumer); 765129473Spjd 766129473Spjd cp = g_new_consumer(gp); 767256880Smav cp->flags |= G_CF_DIRECT_SEND | G_CF_DIRECT_RECEIVE; 768226998Smav cp->private = NULL; 769226998Smav cp->index = no; 770129473Spjd error = g_attach(cp, pp); 771129473Spjd if (error != 0) { 772129473Spjd g_destroy_consumer(cp); 773129473Spjd return (error); 774129473Spjd } 775129473Spjd 776129473Spjd if (fcp != NULL && (fcp->acr > 0 || fcp->acw > 0 || fcp->ace > 0)) { 777129473Spjd error = g_access(cp, fcp->acr, fcp->acw, fcp->ace); 778129473Spjd if (error != 0) { 779129473Spjd g_detach(cp); 780129473Spjd g_destroy_consumer(cp); 781129473Spjd return (error); 782129473Spjd } 783129473Spjd } 784129473Spjd if (sc->sc_type == G_STRIPE_TYPE_AUTOMATIC) { 785129473Spjd struct g_stripe_metadata md; 786129473Spjd 787129473Spjd /* Reread metadata. */ 788129473Spjd error = g_stripe_read_metadata(cp, &md); 789129473Spjd if (error != 0) 790129473Spjd goto fail; 791129473Spjd 792129473Spjd if (strcmp(md.md_magic, G_STRIPE_MAGIC) != 0 || 793129473Spjd strcmp(md.md_name, sc->sc_name) != 0 || 794129473Spjd md.md_id != sc->sc_id) { 795129473Spjd G_STRIPE_DEBUG(0, "Metadata on %s changed.", pp->name); 796129473Spjd goto fail; 797129473Spjd } 798129473Spjd } 799129473Spjd 800129473Spjd sc->sc_disks[no] = cp; 801132664Spjd G_STRIPE_DEBUG(0, "Disk %s attached to %s.", pp->name, sc->sc_name); 802129473Spjd g_stripe_check_and_run(sc); 803129473Spjd 804129473Spjd return (0); 805129473Spjdfail: 806129473Spjd if (fcp != NULL && (fcp->acr > 0 || fcp->acw > 0 || fcp->ace > 0)) 807129473Spjd g_access(cp, -fcp->acr, -fcp->acw, -fcp->ace); 808129473Spjd g_detach(cp); 809129473Spjd g_destroy_consumer(cp); 810129473Spjd return (error); 811129473Spjd} 812129473Spjd 813129473Spjdstatic struct g_geom * 814129473Spjdg_stripe_create(struct g_class *mp, const struct g_stripe_metadata *md, 815129473Spjd u_int type) 816129473Spjd{ 817129473Spjd struct g_stripe_softc *sc; 818129473Spjd struct g_geom *gp; 819129473Spjd u_int no; 820129473Spjd 821226998Smav g_topology_assert(); 822132664Spjd G_STRIPE_DEBUG(1, "Creating device %s (id=%u).", md->md_name, 823129473Spjd md->md_id); 824129473Spjd 825129473Spjd /* Two disks is minimum. */ 826132664Spjd if (md->md_all < 2) { 827132664Spjd G_STRIPE_DEBUG(0, "Too few disks defined for %s.", md->md_name); 828129473Spjd return (NULL); 829129473Spjd } 830129473Spjd#if 0 831129473Spjd /* Stripe size have to be grater than or equal to sector size. */ 832129473Spjd if (md->md_stripesize < sectorsize) { 833132664Spjd G_STRIPE_DEBUG(0, "Invalid stripe size for %s.", md->md_name); 834129473Spjd return (NULL); 835129473Spjd } 836129473Spjd#endif 837129473Spjd /* Stripe size have to be power of 2. */ 838129473Spjd if (!powerof2(md->md_stripesize)) { 839132664Spjd G_STRIPE_DEBUG(0, "Invalid stripe size for %s.", md->md_name); 840129473Spjd return (NULL); 841129473Spjd } 842129473Spjd 843129473Spjd /* Check for duplicate unit */ 844129473Spjd LIST_FOREACH(gp, &mp->geom, geom) { 845129473Spjd sc = gp->softc; 846129473Spjd if (sc != NULL && strcmp(sc->sc_name, md->md_name) == 0) { 847129473Spjd G_STRIPE_DEBUG(0, "Device %s already configured.", 848132664Spjd sc->sc_name); 849129473Spjd return (NULL); 850129473Spjd } 851129473Spjd } 852132664Spjd gp = g_new_geomf(mp, "%s", md->md_name); 853132662Spjd sc = malloc(sizeof(*sc), M_STRIPE, M_WAITOK | M_ZERO); 854129473Spjd gp->start = g_stripe_start; 855129473Spjd gp->spoiled = g_stripe_orphan; 856129473Spjd gp->orphan = g_stripe_orphan; 857129473Spjd gp->access = g_stripe_access; 858129473Spjd gp->dumpconf = g_stripe_dumpconf; 859129473Spjd 860129473Spjd sc->sc_id = md->md_id; 861129473Spjd sc->sc_stripesize = md->md_stripesize; 862149300Spjd sc->sc_stripebits = bitcount32(sc->sc_stripesize - 1); 863129473Spjd sc->sc_ndisks = md->md_all; 864129473Spjd sc->sc_disks = malloc(sizeof(struct g_consumer *) * sc->sc_ndisks, 865129473Spjd M_STRIPE, M_WAITOK | M_ZERO); 866129473Spjd for (no = 0; no < sc->sc_ndisks; no++) 867129473Spjd sc->sc_disks[no] = NULL; 868129473Spjd sc->sc_type = type; 869256880Smav mtx_init(&sc->sc_lock, "gstripe lock", NULL, MTX_DEF); 870129473Spjd 871129473Spjd gp->softc = sc; 872129473Spjd sc->sc_geom = gp; 873129473Spjd sc->sc_provider = NULL; 874129473Spjd 875132664Spjd G_STRIPE_DEBUG(0, "Device %s created (id=%u).", sc->sc_name, sc->sc_id); 876129473Spjd 877129473Spjd return (gp); 878129473Spjd} 879129473Spjd 880129473Spjdstatic int 881129473Spjdg_stripe_destroy(struct g_stripe_softc *sc, boolean_t force) 882129473Spjd{ 883129473Spjd struct g_provider *pp; 884226998Smav struct g_consumer *cp, *cp1; 885129473Spjd struct g_geom *gp; 886129473Spjd 887129473Spjd g_topology_assert(); 888129473Spjd 889129473Spjd if (sc == NULL) 890129473Spjd return (ENXIO); 891129473Spjd 892129473Spjd pp = sc->sc_provider; 893129473Spjd if (pp != NULL && (pp->acr != 0 || pp->acw != 0 || pp->ace != 0)) { 894129473Spjd if (force) { 895129473Spjd G_STRIPE_DEBUG(0, "Device %s is still open, so it " 896129473Spjd "can't be definitely removed.", pp->name); 897129473Spjd } else { 898129473Spjd G_STRIPE_DEBUG(1, 899129473Spjd "Device %s is still open (r%dw%de%d).", pp->name, 900129473Spjd pp->acr, pp->acw, pp->ace); 901129473Spjd return (EBUSY); 902129473Spjd } 903129473Spjd } 904129473Spjd 905226998Smav gp = sc->sc_geom; 906226998Smav LIST_FOREACH_SAFE(cp, &gp->consumer, consumer, cp1) { 907226998Smav g_stripe_remove_disk(cp); 908226998Smav if (cp1 == NULL) 909226998Smav return (0); /* Recursion happened. */ 910129473Spjd } 911226998Smav if (!LIST_EMPTY(&gp->consumer)) 912226998Smav return (EINPROGRESS); 913129473Spjd 914129473Spjd gp->softc = NULL; 915129473Spjd KASSERT(sc->sc_provider == NULL, ("Provider still exists? (device=%s)", 916129473Spjd gp->name)); 917129473Spjd free(sc->sc_disks, M_STRIPE); 918256880Smav mtx_destroy(&sc->sc_lock); 919129473Spjd free(sc, M_STRIPE); 920226998Smav G_STRIPE_DEBUG(0, "Device %s destroyed.", gp->name); 921129473Spjd g_wither_geom(gp, ENXIO); 922129473Spjd return (0); 923129473Spjd} 924129473Spjd 925129473Spjdstatic int 926129473Spjdg_stripe_destroy_geom(struct gctl_req *req __unused, 927129473Spjd struct g_class *mp __unused, struct g_geom *gp) 928129473Spjd{ 929129473Spjd struct g_stripe_softc *sc; 930129473Spjd 931129473Spjd sc = gp->softc; 932129473Spjd return (g_stripe_destroy(sc, 0)); 933129473Spjd} 934129473Spjd 935129473Spjdstatic struct g_geom * 936129473Spjdg_stripe_taste(struct g_class *mp, struct g_provider *pp, int flags __unused) 937129473Spjd{ 938129473Spjd struct g_stripe_metadata md; 939129473Spjd struct g_stripe_softc *sc; 940129473Spjd struct g_consumer *cp; 941129473Spjd struct g_geom *gp; 942129473Spjd int error; 943129473Spjd 944129473Spjd g_trace(G_T_TOPOLOGY, "%s(%s, %s)", __func__, mp->name, pp->name); 945129473Spjd g_topology_assert(); 946129473Spjd 947197898Spjd /* Skip providers that are already open for writing. */ 948197898Spjd if (pp->acw > 0) 949197898Spjd return (NULL); 950197898Spjd 951129473Spjd G_STRIPE_DEBUG(3, "Tasting %s.", pp->name); 952129473Spjd 953129473Spjd gp = g_new_geomf(mp, "stripe:taste"); 954129473Spjd gp->start = g_stripe_start; 955129473Spjd gp->access = g_stripe_access; 956129473Spjd gp->orphan = g_stripe_orphan; 957129473Spjd cp = g_new_consumer(gp); 958129473Spjd g_attach(cp, pp); 959129473Spjd error = g_stripe_read_metadata(cp, &md); 960133371Spjd g_detach(cp); 961133371Spjd g_destroy_consumer(cp); 962133371Spjd g_destroy_geom(gp); 963129473Spjd if (error != 0) 964129473Spjd return (NULL); 965129473Spjd gp = NULL; 966129473Spjd 967129473Spjd if (strcmp(md.md_magic, G_STRIPE_MAGIC) != 0) 968129473Spjd return (NULL); 969129473Spjd if (md.md_version > G_STRIPE_VERSION) { 970129473Spjd printf("geom_stripe.ko module is too old to handle %s.\n", 971129473Spjd pp->name); 972129473Spjd return (NULL); 973129473Spjd } 974133373Spjd /* 975133373Spjd * Backward compatibility: 976133373Spjd */ 977142727Spjd /* There was no md_provider field in earlier versions of metadata. */ 978133373Spjd if (md.md_version < 2) 979133373Spjd bzero(md.md_provider, sizeof(md.md_provider)); 980142727Spjd /* There was no md_provsize field in earlier versions of metadata. */ 981142727Spjd if (md.md_version < 3) 982142727Spjd md.md_provsize = pp->mediasize; 983129473Spjd 984221101Smav if (md.md_provider[0] != '\0' && 985221101Smav !g_compare_names(md.md_provider, pp->name)) 986133373Spjd return (NULL); 987142727Spjd if (md.md_provsize != pp->mediasize) 988142727Spjd return (NULL); 989133373Spjd 990129473Spjd /* 991129473Spjd * Let's check if device already exists. 992129473Spjd */ 993129473Spjd sc = NULL; 994129473Spjd LIST_FOREACH(gp, &mp->geom, geom) { 995129473Spjd sc = gp->softc; 996129473Spjd if (sc == NULL) 997129473Spjd continue; 998129473Spjd if (sc->sc_type != G_STRIPE_TYPE_AUTOMATIC) 999129473Spjd continue; 1000129473Spjd if (strcmp(md.md_name, sc->sc_name) != 0) 1001129473Spjd continue; 1002129473Spjd if (md.md_id != sc->sc_id) 1003129473Spjd continue; 1004129473Spjd break; 1005129473Spjd } 1006129473Spjd if (gp != NULL) { 1007129473Spjd G_STRIPE_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name); 1008129473Spjd error = g_stripe_add_disk(sc, pp, md.md_no); 1009129473Spjd if (error != 0) { 1010129473Spjd G_STRIPE_DEBUG(0, 1011129473Spjd "Cannot add disk %s to %s (error=%d).", pp->name, 1012129473Spjd gp->name, error); 1013129473Spjd return (NULL); 1014129473Spjd } 1015129473Spjd } else { 1016129473Spjd gp = g_stripe_create(mp, &md, G_STRIPE_TYPE_AUTOMATIC); 1017129473Spjd if (gp == NULL) { 1018132664Spjd G_STRIPE_DEBUG(0, "Cannot create device %s.", 1019129473Spjd md.md_name); 1020129473Spjd return (NULL); 1021129473Spjd } 1022129473Spjd sc = gp->softc; 1023129473Spjd G_STRIPE_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name); 1024129473Spjd error = g_stripe_add_disk(sc, pp, md.md_no); 1025129473Spjd if (error != 0) { 1026129473Spjd G_STRIPE_DEBUG(0, 1027129473Spjd "Cannot add disk %s to %s (error=%d).", pp->name, 1028129473Spjd gp->name, error); 1029129473Spjd g_stripe_destroy(sc, 1); 1030129473Spjd return (NULL); 1031129473Spjd } 1032129473Spjd } 1033129473Spjd 1034129473Spjd return (gp); 1035129473Spjd} 1036129473Spjd 1037129473Spjdstatic void 1038129473Spjdg_stripe_ctl_create(struct gctl_req *req, struct g_class *mp) 1039129473Spjd{ 1040129473Spjd u_int attached, no; 1041129473Spjd struct g_stripe_metadata md; 1042129473Spjd struct g_provider *pp; 1043129473Spjd struct g_stripe_softc *sc; 1044129473Spjd struct g_geom *gp; 1045129473Spjd struct sbuf *sb; 1046129473Spjd intmax_t *stripesize; 1047129473Spjd const char *name; 1048129473Spjd char param[16]; 1049129473Spjd int *nargs; 1050129473Spjd 1051129473Spjd g_topology_assert(); 1052129473Spjd nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs)); 1053129473Spjd if (nargs == NULL) { 1054129473Spjd gctl_error(req, "No '%s' argument.", "nargs"); 1055129473Spjd return; 1056129473Spjd } 1057129473Spjd if (*nargs <= 2) { 1058129473Spjd gctl_error(req, "Too few arguments."); 1059129473Spjd return; 1060129473Spjd } 1061129473Spjd 1062129473Spjd strlcpy(md.md_magic, G_STRIPE_MAGIC, sizeof(md.md_magic)); 1063129473Spjd md.md_version = G_STRIPE_VERSION; 1064129473Spjd name = gctl_get_asciiparam(req, "arg0"); 1065129473Spjd if (name == NULL) { 1066129473Spjd gctl_error(req, "No 'arg%u' argument.", 0); 1067129473Spjd return; 1068129473Spjd } 1069129473Spjd strlcpy(md.md_name, name, sizeof(md.md_name)); 1070129473Spjd md.md_id = arc4random(); 1071129473Spjd md.md_no = 0; 1072129473Spjd md.md_all = *nargs - 1; 1073129473Spjd stripesize = gctl_get_paraml(req, "stripesize", sizeof(*stripesize)); 1074129473Spjd if (stripesize == NULL) { 1075129473Spjd gctl_error(req, "No '%s' argument.", "stripesize"); 1076129473Spjd return; 1077129473Spjd } 1078129473Spjd md.md_stripesize = *stripesize; 1079133373Spjd bzero(md.md_provider, sizeof(md.md_provider)); 1080142727Spjd /* This field is not important here. */ 1081142727Spjd md.md_provsize = 0; 1082129473Spjd 1083129473Spjd /* Check all providers are valid */ 1084129473Spjd for (no = 1; no < *nargs; no++) { 1085129473Spjd snprintf(param, sizeof(param), "arg%u", no); 1086129473Spjd name = gctl_get_asciiparam(req, param); 1087129473Spjd if (name == NULL) { 1088129473Spjd gctl_error(req, "No 'arg%u' argument.", no); 1089129473Spjd return; 1090129473Spjd } 1091129473Spjd if (strncmp(name, "/dev/", strlen("/dev/")) == 0) 1092129473Spjd name += strlen("/dev/"); 1093129473Spjd pp = g_provider_by_name(name); 1094129473Spjd if (pp == NULL) { 1095129473Spjd G_STRIPE_DEBUG(1, "Disk %s is invalid.", name); 1096129473Spjd gctl_error(req, "Disk %s is invalid.", name); 1097129473Spjd return; 1098129473Spjd } 1099129473Spjd } 1100129473Spjd 1101129473Spjd gp = g_stripe_create(mp, &md, G_STRIPE_TYPE_MANUAL); 1102129473Spjd if (gp == NULL) { 1103132664Spjd gctl_error(req, "Can't configure %s.", md.md_name); 1104129473Spjd return; 1105129473Spjd } 1106129473Spjd 1107129473Spjd sc = gp->softc; 1108181463Sdes sb = sbuf_new_auto(); 1109129473Spjd sbuf_printf(sb, "Can't attach disk(s) to %s:", gp->name); 1110129473Spjd for (attached = 0, no = 1; no < *nargs; no++) { 1111129473Spjd snprintf(param, sizeof(param), "arg%u", no); 1112129473Spjd name = gctl_get_asciiparam(req, param); 1113146109Spjd if (name == NULL) { 1114146109Spjd gctl_error(req, "No 'arg%u' argument.", no); 1115146109Spjd continue; 1116146109Spjd } 1117129473Spjd if (strncmp(name, "/dev/", strlen("/dev/")) == 0) 1118129473Spjd name += strlen("/dev/"); 1119129473Spjd pp = g_provider_by_name(name); 1120129473Spjd KASSERT(pp != NULL, ("Provider %s disappear?!", name)); 1121129473Spjd if (g_stripe_add_disk(sc, pp, no - 1) != 0) { 1122129473Spjd G_STRIPE_DEBUG(1, "Disk %u (%s) not attached to %s.", 1123129473Spjd no, pp->name, gp->name); 1124129473Spjd sbuf_printf(sb, " %s", pp->name); 1125129473Spjd continue; 1126129473Spjd } 1127129473Spjd attached++; 1128129473Spjd } 1129129473Spjd sbuf_finish(sb); 1130129473Spjd if (md.md_all != attached) { 1131129473Spjd g_stripe_destroy(gp->softc, 1); 1132129473Spjd gctl_error(req, "%s", sbuf_data(sb)); 1133129473Spjd } 1134129473Spjd sbuf_delete(sb); 1135129473Spjd} 1136129473Spjd 1137129473Spjdstatic struct g_stripe_softc * 1138129473Spjdg_stripe_find_device(struct g_class *mp, const char *name) 1139129473Spjd{ 1140129473Spjd struct g_stripe_softc *sc; 1141129473Spjd struct g_geom *gp; 1142129473Spjd 1143129473Spjd LIST_FOREACH(gp, &mp->geom, geom) { 1144129473Spjd sc = gp->softc; 1145129473Spjd if (sc == NULL) 1146129473Spjd continue; 1147132664Spjd if (strcmp(sc->sc_name, name) == 0) 1148129473Spjd return (sc); 1149129473Spjd } 1150129473Spjd return (NULL); 1151129473Spjd} 1152129473Spjd 1153129473Spjdstatic void 1154129473Spjdg_stripe_ctl_destroy(struct gctl_req *req, struct g_class *mp) 1155129473Spjd{ 1156129473Spjd struct g_stripe_softc *sc; 1157129473Spjd int *force, *nargs, error; 1158129473Spjd const char *name; 1159129473Spjd char param[16]; 1160129473Spjd u_int i; 1161129473Spjd 1162129473Spjd g_topology_assert(); 1163129473Spjd 1164129473Spjd nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs)); 1165129473Spjd if (nargs == NULL) { 1166129473Spjd gctl_error(req, "No '%s' argument.", "nargs"); 1167129473Spjd return; 1168129473Spjd } 1169129473Spjd if (*nargs <= 0) { 1170129473Spjd gctl_error(req, "Missing device(s)."); 1171129473Spjd return; 1172129473Spjd } 1173129473Spjd force = gctl_get_paraml(req, "force", sizeof(*force)); 1174129473Spjd if (force == NULL) { 1175129473Spjd gctl_error(req, "No '%s' argument.", "force"); 1176129473Spjd return; 1177129473Spjd } 1178129473Spjd 1179129473Spjd for (i = 0; i < (u_int)*nargs; i++) { 1180129473Spjd snprintf(param, sizeof(param), "arg%u", i); 1181129473Spjd name = gctl_get_asciiparam(req, param); 1182129473Spjd if (name == NULL) { 1183129473Spjd gctl_error(req, "No 'arg%u' argument.", i); 1184129473Spjd return; 1185129473Spjd } 1186129473Spjd sc = g_stripe_find_device(mp, name); 1187129473Spjd if (sc == NULL) { 1188129473Spjd gctl_error(req, "No such device: %s.", name); 1189129473Spjd return; 1190129473Spjd } 1191129473Spjd error = g_stripe_destroy(sc, *force); 1192129473Spjd if (error != 0) { 1193129473Spjd gctl_error(req, "Cannot destroy device %s (error=%d).", 1194132664Spjd sc->sc_name, error); 1195129473Spjd return; 1196129473Spjd } 1197129473Spjd } 1198129473Spjd} 1199129473Spjd 1200129473Spjdstatic void 1201129473Spjdg_stripe_config(struct gctl_req *req, struct g_class *mp, const char *verb) 1202129473Spjd{ 1203129473Spjd uint32_t *version; 1204129473Spjd 1205129473Spjd g_topology_assert(); 1206129473Spjd 1207129473Spjd version = gctl_get_paraml(req, "version", sizeof(*version)); 1208129473Spjd if (version == NULL) { 1209129473Spjd gctl_error(req, "No '%s' argument.", "version"); 1210129473Spjd return; 1211129473Spjd } 1212129473Spjd if (*version != G_STRIPE_VERSION) { 1213129473Spjd gctl_error(req, "Userland and kernel parts are out of sync."); 1214129473Spjd return; 1215129473Spjd } 1216129473Spjd 1217129473Spjd if (strcmp(verb, "create") == 0) { 1218129473Spjd g_stripe_ctl_create(req, mp); 1219129473Spjd return; 1220131649Spjd } else if (strcmp(verb, "destroy") == 0 || 1221131649Spjd strcmp(verb, "stop") == 0) { 1222129473Spjd g_stripe_ctl_destroy(req, mp); 1223129473Spjd return; 1224129473Spjd } 1225129473Spjd 1226129473Spjd gctl_error(req, "Unknown verb."); 1227129473Spjd} 1228129473Spjd 1229129473Spjdstatic void 1230129473Spjdg_stripe_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, 1231129473Spjd struct g_consumer *cp, struct g_provider *pp) 1232129473Spjd{ 1233129473Spjd struct g_stripe_softc *sc; 1234129473Spjd 1235129473Spjd sc = gp->softc; 1236132665Spjd if (sc == NULL) 1237129473Spjd return; 1238132665Spjd if (pp != NULL) { 1239132665Spjd /* Nothing here. */ 1240132665Spjd } else if (cp != NULL) { 1241134292Spjd sbuf_printf(sb, "%s<Number>%u</Number>\n", indent, 1242134292Spjd (u_int)cp->index); 1243132665Spjd } else { 1244132665Spjd sbuf_printf(sb, "%s<ID>%u</ID>\n", indent, (u_int)sc->sc_id); 1245132665Spjd sbuf_printf(sb, "%s<Stripesize>%u</Stripesize>\n", indent, 1246132665Spjd (u_int)sc->sc_stripesize); 1247132665Spjd sbuf_printf(sb, "%s<Type>", indent); 1248132665Spjd switch (sc->sc_type) { 1249132665Spjd case G_STRIPE_TYPE_AUTOMATIC: 1250132665Spjd sbuf_printf(sb, "AUTOMATIC"); 1251132665Spjd break; 1252132665Spjd case G_STRIPE_TYPE_MANUAL: 1253132665Spjd sbuf_printf(sb, "MANUAL"); 1254132665Spjd break; 1255132665Spjd default: 1256132665Spjd sbuf_printf(sb, "UNKNOWN"); 1257132665Spjd break; 1258132665Spjd } 1259132665Spjd sbuf_printf(sb, "</Type>\n"); 1260132665Spjd sbuf_printf(sb, "%s<Status>Total=%u, Online=%u</Status>\n", 1261132665Spjd indent, sc->sc_ndisks, g_stripe_nvalid(sc)); 1262132665Spjd sbuf_printf(sb, "%s<State>", indent); 1263132665Spjd if (sc->sc_provider != NULL && sc->sc_provider->error == 0) 1264132665Spjd sbuf_printf(sb, "UP"); 1265132665Spjd else 1266132665Spjd sbuf_printf(sb, "DOWN"); 1267132665Spjd sbuf_printf(sb, "</State>\n"); 1268129473Spjd } 1269129473Spjd} 1270129473Spjd 1271129473SpjdDECLARE_GEOM_CLASS(g_stripe_class, g_stripe); 1272