1dd84a43cSPoul-Henning Kamp /*- 2dd84a43cSPoul-Henning Kamp * Copyright (c) 2002 Poul-Henning Kamp 3dd84a43cSPoul-Henning Kamp * Copyright (c) 2002 Networks Associates Technology, Inc. 4dd84a43cSPoul-Henning Kamp * All rights reserved. 5dd84a43cSPoul-Henning Kamp * 6dd84a43cSPoul-Henning Kamp * This software was developed for the FreeBSD Project by Poul-Henning Kamp 7dd84a43cSPoul-Henning Kamp * and NAI Labs, the Security Research Division of Network Associates, Inc. 8dd84a43cSPoul-Henning Kamp * under DARPA/SPAWAR contract N66001-01-C-8035 ("CBOSS"), as part of the 9dd84a43cSPoul-Henning Kamp * DARPA CHATS research program. 10dd84a43cSPoul-Henning Kamp * 11dd84a43cSPoul-Henning Kamp * Redistribution and use in source and binary forms, with or without 12dd84a43cSPoul-Henning Kamp * modification, are permitted provided that the following conditions 13dd84a43cSPoul-Henning Kamp * are met: 14dd84a43cSPoul-Henning Kamp * 1. Redistributions of source code must retain the above copyright 15dd84a43cSPoul-Henning Kamp * notice, this list of conditions and the following disclaimer. 16dd84a43cSPoul-Henning Kamp * 2. Redistributions in binary form must reproduce the above copyright 17dd84a43cSPoul-Henning Kamp * notice, this list of conditions and the following disclaimer in the 18dd84a43cSPoul-Henning Kamp * documentation and/or other materials provided with the distribution. 19dd84a43cSPoul-Henning Kamp * 3. The names of the authors may not be used to endorse or promote 20dd84a43cSPoul-Henning Kamp * products derived from this software without specific prior written 21dd84a43cSPoul-Henning Kamp * permission. 22dd84a43cSPoul-Henning Kamp * 23dd84a43cSPoul-Henning Kamp * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 24dd84a43cSPoul-Henning Kamp * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 25dd84a43cSPoul-Henning Kamp * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 26dd84a43cSPoul-Henning Kamp * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 27dd84a43cSPoul-Henning Kamp * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 28dd84a43cSPoul-Henning Kamp * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 29dd84a43cSPoul-Henning Kamp * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 30dd84a43cSPoul-Henning Kamp * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 31dd84a43cSPoul-Henning Kamp * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 32dd84a43cSPoul-Henning Kamp * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 33dd84a43cSPoul-Henning Kamp * SUCH DAMAGE. 34dd84a43cSPoul-Henning Kamp */ 35dd84a43cSPoul-Henning Kamp 3650b1faefSDavid E. O'Brien #include <sys/cdefs.h> 3750b1faefSDavid E. O'Brien __FBSDID("$FreeBSD$"); 3850b1faefSDavid E. O'Brien 393bd65612SPoul-Henning Kamp #include "opt_geom.h" 403bd65612SPoul-Henning Kamp 41dd84a43cSPoul-Henning Kamp #include <sys/param.h> 42dd84a43cSPoul-Henning Kamp #include <sys/systm.h> 43dd84a43cSPoul-Henning Kamp #include <sys/kernel.h> 44dd84a43cSPoul-Henning Kamp #include <sys/sysctl.h> 45dd84a43cSPoul-Henning Kamp #include <sys/bio.h> 4642f42c99SAlan Somers #include <sys/bus.h> 47e93f5e4dSPawel Jakub Dawidek #include <sys/ctype.h> 4831a1093fSPoul-Henning Kamp #include <sys/fcntl.h> 49dd84a43cSPoul-Henning Kamp #include <sys/malloc.h> 505d807a0eSAndrey V. Elsukov #include <sys/sbuf.h> 5160794e04SPoul-Henning Kamp #include <sys/devicestat.h> 52dd84a43cSPoul-Henning Kamp #include <machine/md_var.h> 53dd84a43cSPoul-Henning Kamp 54dd84a43cSPoul-Henning Kamp #include <sys/lock.h> 55dd84a43cSPoul-Henning Kamp #include <sys/mutex.h> 56dd84a43cSPoul-Henning Kamp #include <geom/geom.h> 574752f757SPoul-Henning Kamp #include <geom/geom_disk.h> 587da1ebfdSPoul-Henning Kamp #include <geom/geom_int.h> 59dd84a43cSPoul-Henning Kamp 60c6d4ed3aSAlexander Motin #include <dev/led/led.h> 61c6d4ed3aSAlexander Motin 62a9934668SKenneth D. Merry #include <machine/bus.h> 63a9934668SKenneth D. Merry 64c6d4ed3aSAlexander Motin struct g_disk_softc { 6530ba7471SAlexander Motin struct mtx done_mtx; 66c6d4ed3aSAlexander Motin struct disk *dp; 67c6d4ed3aSAlexander Motin struct sysctl_ctx_list sysctl_ctx; 68c6d4ed3aSAlexander Motin struct sysctl_oid *sysctl_tree; 69c6d4ed3aSAlexander Motin char led[64]; 70c6d4ed3aSAlexander Motin uint32_t state; 7140ea77a0SAlexander Motin struct mtx start_mtx; 72c6d4ed3aSAlexander Motin }; 73c6d4ed3aSAlexander Motin 74dd84a43cSPoul-Henning Kamp static g_access_t g_disk_access; 75650ee351SPoul-Henning Kamp static g_start_t g_disk_start; 76650ee351SPoul-Henning Kamp static g_ioctl_t g_disk_ioctl; 77650ee351SPoul-Henning Kamp static g_dumpconf_t g_disk_dumpconf; 78c3fb2891SKenneth D. Merry static g_provgone_t g_disk_providergone; 79dd84a43cSPoul-Henning Kamp 8007e95ed6SPoul-Henning Kamp static struct g_class g_disk_class = { 81252c094eSIvan Voras .name = G_DISK_CLASS_NAME, 825721c9c7SPoul-Henning Kamp .version = G_VERSION, 83650ee351SPoul-Henning Kamp .start = g_disk_start, 84650ee351SPoul-Henning Kamp .access = g_disk_access, 85650ee351SPoul-Henning Kamp .ioctl = g_disk_ioctl, 86c3fb2891SKenneth D. Merry .providergone = g_disk_providergone, 87650ee351SPoul-Henning Kamp .dumpconf = g_disk_dumpconf, 88dd84a43cSPoul-Henning Kamp }; 89dd84a43cSPoul-Henning Kamp 90c6d4ed3aSAlexander Motin SYSCTL_DECL(_kern_geom); 916472ac3dSEd Schouten static SYSCTL_NODE(_kern_geom, OID_AUTO, disk, CTLFLAG_RW, 0, 926472ac3dSEd Schouten "GEOM_DISK stuff"); 93c6d4ed3aSAlexander Motin 946c87f8d5SPoul-Henning Kamp DECLARE_GEOM_CLASS(g_disk_class, g_disk); 958523987bSPoul-Henning Kamp 96dd84a43cSPoul-Henning Kamp static int 97dd84a43cSPoul-Henning Kamp g_disk_access(struct g_provider *pp, int r, int w, int e) 98dd84a43cSPoul-Henning Kamp { 99dd84a43cSPoul-Henning Kamp struct disk *dp; 100c6d4ed3aSAlexander Motin struct g_disk_softc *sc; 101dd84a43cSPoul-Henning Kamp int error; 102dd84a43cSPoul-Henning Kamp 103dd84a43cSPoul-Henning Kamp g_trace(G_T_ACCESS, "g_disk_access(%s, %d, %d, %d)", 104dd84a43cSPoul-Henning Kamp pp->name, r, w, e); 105dd84a43cSPoul-Henning Kamp g_topology_assert(); 10630ba7471SAlexander Motin sc = pp->private; 107c6d4ed3aSAlexander Motin if (sc == NULL || (dp = sc->dp) == NULL || dp->d_destroyed) { 10812047230SPawel Jakub Dawidek /* 10912047230SPawel Jakub Dawidek * Allow decreasing access count even if disk is not 110e8d57122SPedro F. Giffuni * available anymore. 11112047230SPawel Jakub Dawidek */ 11212047230SPawel Jakub Dawidek if (r <= 0 && w <= 0 && e <= 0) 11312047230SPawel Jakub Dawidek return (0); 11412047230SPawel Jakub Dawidek return (ENXIO); 11512047230SPawel Jakub Dawidek } 116dd84a43cSPoul-Henning Kamp r += pp->acr; 117dd84a43cSPoul-Henning Kamp w += pp->acw; 118dd84a43cSPoul-Henning Kamp e += pp->ace; 11931a1093fSPoul-Henning Kamp error = 0; 120dd84a43cSPoul-Henning Kamp if ((pp->acr + pp->acw + pp->ace) == 0 && (r + w + e) > 0) { 12198bbd7aaSPoul-Henning Kamp if (dp->d_open != NULL) { 12251dd8980SPoul-Henning Kamp error = dp->d_open(dp); 12355fe33a3SNick Hibma if (bootverbose && error != 0) 12431a1093fSPoul-Henning Kamp printf("Opened disk %s -> %d\n", 12531a1093fSPoul-Henning Kamp pp->name, error); 126c145d600SAlexander Motin if (error != 0) 127c145d600SAlexander Motin return (error); 12831a1093fSPoul-Henning Kamp } 1293f12caa1SPoul-Henning Kamp pp->mediasize = dp->d_mediasize; 1303f12caa1SPoul-Henning Kamp pp->sectorsize = dp->d_sectorsize; 13199af707cSPoul-Henning Kamp if (dp->d_maxsize == 0) { 13299af707cSPoul-Henning Kamp printf("WARNING: Disk drive %s%d has no d_maxsize\n", 13399af707cSPoul-Henning Kamp dp->d_name, dp->d_unit); 13499af707cSPoul-Henning Kamp dp->d_maxsize = DFLTPHYS; 13599af707cSPoul-Henning Kamp } 1368383a92eSSteven Hartland if (dp->d_delmaxsize == 0) { 1378383a92eSSteven Hartland if (bootverbose && dp->d_flags & DISKFLAG_CANDELETE) { 1388383a92eSSteven Hartland printf("WARNING: Disk drive %s%d has no " 1398383a92eSSteven Hartland "d_delmaxsize\n", dp->d_name, dp->d_unit); 1409fe9ba5bSSteven Hartland } 1418383a92eSSteven Hartland dp->d_delmaxsize = dp->d_maxsize; 1429fe9ba5bSSteven Hartland } 1439fe9ba5bSSteven Hartland pp->stripeoffset = dp->d_stripeoffset; 1449fe9ba5bSSteven Hartland pp->stripesize = dp->d_stripesize; 1459fe9ba5bSSteven Hartland dp->d_flags |= DISKFLAG_OPEN; 146dd84a43cSPoul-Henning Kamp } else if ((pp->acr + pp->acw + pp->ace) > 0 && (r + w + e) == 0) { 14798bbd7aaSPoul-Henning Kamp if (dp->d_close != NULL) { 14851dd8980SPoul-Henning Kamp error = dp->d_close(dp); 149dd84a43cSPoul-Henning Kamp if (error != 0) 15031a1093fSPoul-Henning Kamp printf("Closed disk %s -> %d\n", 15131a1093fSPoul-Henning Kamp pp->name, error); 15231a1093fSPoul-Henning Kamp } 153c6d4ed3aSAlexander Motin sc->state = G_STATE_ACTIVE; 154c6d4ed3aSAlexander Motin if (sc->led[0] != 0) 155c6d4ed3aSAlexander Motin led_set(sc->led, "0"); 15631a1093fSPoul-Henning Kamp dp->d_flags &= ~DISKFLAG_OPEN; 157dd84a43cSPoul-Henning Kamp } 158dd84a43cSPoul-Henning Kamp return (error); 159dd84a43cSPoul-Henning Kamp } 160dd84a43cSPoul-Henning Kamp 161dd84a43cSPoul-Henning Kamp static void 16295c24b31SPoul-Henning Kamp g_disk_kerneldump(struct bio *bp, struct disk *dp) 16395c24b31SPoul-Henning Kamp { 16495c24b31SPoul-Henning Kamp struct g_kerneldump *gkd; 1658be2bc5cSPoul-Henning Kamp struct g_geom *gp; 16695c24b31SPoul-Henning Kamp 16795c24b31SPoul-Henning Kamp gkd = (struct g_kerneldump*)bp->bio_data; 1688be2bc5cSPoul-Henning Kamp gp = bp->bio_to->geom; 1691e4b22b4SBryan Drewery g_trace(G_T_TOPOLOGY, "g_disk_kerneldump(%s, %jd, %jd)", 1708be2bc5cSPoul-Henning Kamp gp->name, (intmax_t)gkd->offset, (intmax_t)gkd->length); 1715774ceadSPoul-Henning Kamp if (dp->d_dump == NULL) { 1725774ceadSPoul-Henning Kamp g_io_deliver(bp, ENODEV); 1735774ceadSPoul-Henning Kamp return; 1745774ceadSPoul-Henning Kamp } 17506f4c96dSAlexander Motin gkd->di.dumper = dp->d_dump; 17606f4c96dSAlexander Motin gkd->di.priv = dp; 17706f4c96dSAlexander Motin gkd->di.blocksize = dp->d_sectorsize; 17806f4c96dSAlexander Motin gkd->di.maxiosize = dp->d_maxsize; 17906f4c96dSAlexander Motin gkd->di.mediaoffset = gkd->offset; 1803ad9f7c2SPoul-Henning Kamp if ((gkd->offset + gkd->length) > dp->d_mediasize) 1813ad9f7c2SPoul-Henning Kamp gkd->length = dp->d_mediasize - gkd->offset; 18206f4c96dSAlexander Motin gkd->di.mediasize = gkd->length; 18306f4c96dSAlexander Motin g_io_deliver(bp, 0); 18495c24b31SPoul-Henning Kamp } 18595c24b31SPoul-Henning Kamp 18695c24b31SPoul-Henning Kamp static void 187c6d4ed3aSAlexander Motin g_disk_setstate(struct bio *bp, struct g_disk_softc *sc) 188c6d4ed3aSAlexander Motin { 189c6d4ed3aSAlexander Motin const char *cmd; 190c6d4ed3aSAlexander Motin 191c6d4ed3aSAlexander Motin memcpy(&sc->state, bp->bio_data, sizeof(sc->state)); 192c6d4ed3aSAlexander Motin if (sc->led[0] != 0) { 193c6d4ed3aSAlexander Motin switch (sc->state) { 194c6d4ed3aSAlexander Motin case G_STATE_FAILED: 195c6d4ed3aSAlexander Motin cmd = "1"; 196c6d4ed3aSAlexander Motin break; 197c6d4ed3aSAlexander Motin case G_STATE_REBUILD: 198c6d4ed3aSAlexander Motin cmd = "f5"; 199c6d4ed3aSAlexander Motin break; 200c6d4ed3aSAlexander Motin case G_STATE_RESYNC: 201c6d4ed3aSAlexander Motin cmd = "f1"; 202c6d4ed3aSAlexander Motin break; 203c6d4ed3aSAlexander Motin default: 204c6d4ed3aSAlexander Motin cmd = "0"; 205c6d4ed3aSAlexander Motin break; 206c6d4ed3aSAlexander Motin } 207c6d4ed3aSAlexander Motin led_set(sc->led, cmd); 208c6d4ed3aSAlexander Motin } 209c6d4ed3aSAlexander Motin g_io_deliver(bp, 0); 210c6d4ed3aSAlexander Motin } 211c6d4ed3aSAlexander Motin 212c6d4ed3aSAlexander Motin static void 213dd84a43cSPoul-Henning Kamp g_disk_done(struct bio *bp) 214dd84a43cSPoul-Henning Kamp { 215e431d66cSAlexander Motin struct bintime now; 21660794e04SPoul-Henning Kamp struct bio *bp2; 217c6d4ed3aSAlexander Motin struct g_disk_softc *sc; 218dd84a43cSPoul-Henning Kamp 21915c672a3SPoul-Henning Kamp /* See "notes" for why we need a mutex here */ 22015c672a3SPoul-Henning Kamp /* XXX: will witness accept a mix of Giant/unGiant drivers here ? */ 22160794e04SPoul-Henning Kamp bp2 = bp->bio_parent; 22230ba7471SAlexander Motin sc = bp2->bio_to->private; 22330ba7471SAlexander Motin bp->bio_completed = bp->bio_length - bp->bio_resid; 224e431d66cSAlexander Motin binuptime(&now); 22530ba7471SAlexander Motin mtx_lock(&sc->done_mtx); 22660794e04SPoul-Henning Kamp if (bp2->bio_error == 0) 22760794e04SPoul-Henning Kamp bp2->bio_error = bp->bio_error; 22860794e04SPoul-Henning Kamp bp2->bio_completed += bp->bio_completed; 2299a6844d5SKenneth D. Merry 2308076d204SWarner Losh switch (bp->bio_cmd) { 2319a6844d5SKenneth D. Merry case BIO_ZONE: 2329a6844d5SKenneth D. Merry bcopy(&bp->bio_zone, &bp2->bio_zone, sizeof(bp->bio_zone)); 2339a6844d5SKenneth D. Merry /*FALLTHROUGH*/ 2348076d204SWarner Losh case BIO_READ: 2358076d204SWarner Losh case BIO_WRITE: 2368076d204SWarner Losh case BIO_DELETE: 2378076d204SWarner Losh case BIO_FLUSH: 238e431d66cSAlexander Motin devstat_end_transaction_bio_bt(sc->dp->d_devstat, bp, &now); 2398076d204SWarner Losh break; 2408076d204SWarner Losh default: 2418076d204SWarner Losh break; 2428076d204SWarner Losh } 24360794e04SPoul-Henning Kamp bp2->bio_inbed++; 24460794e04SPoul-Henning Kamp if (bp2->bio_children == bp2->bio_inbed) { 2450fd2511aSAlexander Motin mtx_unlock(&sc->done_mtx); 24681876757SPoul-Henning Kamp bp2->bio_resid = bp2->bio_bcount - bp2->bio_completed; 24760794e04SPoul-Henning Kamp g_io_deliver(bp2, bp2->bio_error); 2480fd2511aSAlexander Motin } else 24930ba7471SAlexander Motin mtx_unlock(&sc->done_mtx); 2500fd2511aSAlexander Motin g_destroy_bio(bp); 251dd84a43cSPoul-Henning Kamp } 252dd84a43cSPoul-Henning Kamp 253497c3347SPoul-Henning Kamp static int 2542221dbebSPoul-Henning Kamp g_disk_ioctl(struct g_provider *pp, u_long cmd, void * data, int fflag, struct thread *td) 255497c3347SPoul-Henning Kamp { 256497c3347SPoul-Henning Kamp struct disk *dp; 257c6d4ed3aSAlexander Motin struct g_disk_softc *sc; 258497c3347SPoul-Henning Kamp int error; 259497c3347SPoul-Henning Kamp 26030ba7471SAlexander Motin sc = pp->private; 261c6d4ed3aSAlexander Motin dp = sc->dp; 262497c3347SPoul-Henning Kamp 263497c3347SPoul-Henning Kamp if (dp->d_ioctl == NULL) 264497c3347SPoul-Henning Kamp return (ENOIOCTL); 2652221dbebSPoul-Henning Kamp error = dp->d_ioctl(dp, cmd, data, fflag, td); 266497c3347SPoul-Henning Kamp return (error); 267497c3347SPoul-Henning Kamp } 268497c3347SPoul-Henning Kamp 26942fbdde4SKenneth D. Merry static off_t 27042fbdde4SKenneth D. Merry g_disk_maxsize(struct disk *dp, struct bio *bp) 271a9934668SKenneth D. Merry { 27242fbdde4SKenneth D. Merry if (bp->bio_cmd == BIO_DELETE) 27342fbdde4SKenneth D. Merry return (dp->d_delmaxsize); 27442fbdde4SKenneth D. Merry return (dp->d_maxsize); 27542fbdde4SKenneth D. Merry } 27642fbdde4SKenneth D. Merry 27742fbdde4SKenneth D. Merry static int 27842fbdde4SKenneth D. Merry g_disk_maxsegs(struct disk *dp, struct bio *bp) 27942fbdde4SKenneth D. Merry { 28042fbdde4SKenneth D. Merry return ((g_disk_maxsize(dp, bp) / PAGE_SIZE) + 1); 281a9934668SKenneth D. Merry } 282a9934668SKenneth D. Merry 283a9934668SKenneth D. Merry static void 284a9934668SKenneth D. Merry g_disk_advance(struct disk *dp, struct bio *bp, off_t off) 285a9934668SKenneth D. Merry { 286a9934668SKenneth D. Merry 287a9934668SKenneth D. Merry bp->bio_offset += off; 288a9934668SKenneth D. Merry bp->bio_length -= off; 289a9934668SKenneth D. Merry 290a9934668SKenneth D. Merry if ((bp->bio_flags & BIO_VLIST) != 0) { 291a9934668SKenneth D. Merry bus_dma_segment_t *seg, *end; 292a9934668SKenneth D. Merry 293a9934668SKenneth D. Merry seg = (bus_dma_segment_t *)bp->bio_data; 294a9934668SKenneth D. Merry end = (bus_dma_segment_t *)bp->bio_data + bp->bio_ma_n; 295a9934668SKenneth D. Merry off += bp->bio_ma_offset; 296a9934668SKenneth D. Merry while (off >= seg->ds_len) { 297a9934668SKenneth D. Merry KASSERT((seg != end), 298a9934668SKenneth D. Merry ("vlist request runs off the end")); 299a9934668SKenneth D. Merry off -= seg->ds_len; 300a9934668SKenneth D. Merry seg++; 301a9934668SKenneth D. Merry } 302a9934668SKenneth D. Merry bp->bio_ma_offset = off; 303a9934668SKenneth D. Merry bp->bio_ma_n = end - seg; 304a9934668SKenneth D. Merry bp->bio_data = (void *)seg; 305a9934668SKenneth D. Merry } else if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 306a9934668SKenneth D. Merry bp->bio_ma += off / PAGE_SIZE; 307a9934668SKenneth D. Merry bp->bio_ma_offset += off; 308a9934668SKenneth D. Merry bp->bio_ma_offset %= PAGE_SIZE; 309a9934668SKenneth D. Merry bp->bio_ma_n -= off / PAGE_SIZE; 310a9934668SKenneth D. Merry } else { 311a9934668SKenneth D. Merry bp->bio_data += off; 312a9934668SKenneth D. Merry } 313a9934668SKenneth D. Merry } 314a9934668SKenneth D. Merry 315a9934668SKenneth D. Merry static void 316a9934668SKenneth D. Merry g_disk_seg_limit(bus_dma_segment_t *seg, off_t *poffset, 317a9934668SKenneth D. Merry off_t *plength, int *ppages) 318a9934668SKenneth D. Merry { 319a9934668SKenneth D. Merry uintptr_t seg_page_base; 320a9934668SKenneth D. Merry uintptr_t seg_page_end; 321a9934668SKenneth D. Merry off_t offset; 322a9934668SKenneth D. Merry off_t length; 323a9934668SKenneth D. Merry int seg_pages; 324a9934668SKenneth D. Merry 325a9934668SKenneth D. Merry offset = *poffset; 326a9934668SKenneth D. Merry length = *plength; 327a9934668SKenneth D. Merry 328a9934668SKenneth D. Merry if (length > seg->ds_len - offset) 329a9934668SKenneth D. Merry length = seg->ds_len - offset; 330a9934668SKenneth D. Merry 331a9934668SKenneth D. Merry seg_page_base = trunc_page(seg->ds_addr + offset); 332a9934668SKenneth D. Merry seg_page_end = round_page(seg->ds_addr + offset + length); 333a9934668SKenneth D. Merry seg_pages = (seg_page_end - seg_page_base) >> PAGE_SHIFT; 334a9934668SKenneth D. Merry 335a9934668SKenneth D. Merry if (seg_pages > *ppages) { 336a9934668SKenneth D. Merry seg_pages = *ppages; 337a9934668SKenneth D. Merry length = (seg_page_base + (seg_pages << PAGE_SHIFT)) - 338a9934668SKenneth D. Merry (seg->ds_addr + offset); 339a9934668SKenneth D. Merry } 340a9934668SKenneth D. Merry 341a9934668SKenneth D. Merry *poffset = 0; 342a9934668SKenneth D. Merry *plength -= length; 343a9934668SKenneth D. Merry *ppages -= seg_pages; 344a9934668SKenneth D. Merry } 345a9934668SKenneth D. Merry 346a9934668SKenneth D. Merry static off_t 347a9934668SKenneth D. Merry g_disk_vlist_limit(struct disk *dp, struct bio *bp, bus_dma_segment_t **pendseg) 348a9934668SKenneth D. Merry { 349a9934668SKenneth D. Merry bus_dma_segment_t *seg, *end; 350a9934668SKenneth D. Merry off_t residual; 351a9934668SKenneth D. Merry off_t offset; 352a9934668SKenneth D. Merry int pages; 353a9934668SKenneth D. Merry 354a9934668SKenneth D. Merry seg = (bus_dma_segment_t *)bp->bio_data; 355a9934668SKenneth D. Merry end = (bus_dma_segment_t *)bp->bio_data + bp->bio_ma_n; 356a9934668SKenneth D. Merry residual = bp->bio_length; 357a9934668SKenneth D. Merry offset = bp->bio_ma_offset; 35842fbdde4SKenneth D. Merry pages = g_disk_maxsegs(dp, bp); 359a9934668SKenneth D. Merry while (residual != 0 && pages != 0) { 360a9934668SKenneth D. Merry KASSERT((seg != end), 361a9934668SKenneth D. Merry ("vlist limit runs off the end")); 362a9934668SKenneth D. Merry g_disk_seg_limit(seg, &offset, &residual, &pages); 363a9934668SKenneth D. Merry seg++; 364a9934668SKenneth D. Merry } 365a9934668SKenneth D. Merry if (pendseg != NULL) 366a9934668SKenneth D. Merry *pendseg = seg; 367a9934668SKenneth D. Merry return (residual); 368a9934668SKenneth D. Merry } 369a9934668SKenneth D. Merry 370a9934668SKenneth D. Merry static bool 371a9934668SKenneth D. Merry g_disk_limit(struct disk *dp, struct bio *bp) 372a9934668SKenneth D. Merry { 373a9934668SKenneth D. Merry bool limited = false; 374985108aeSKenneth D. Merry off_t maxsz; 375985108aeSKenneth D. Merry 376985108aeSKenneth D. Merry maxsz = g_disk_maxsize(dp, bp); 377a9934668SKenneth D. Merry 378a9934668SKenneth D. Merry /* 379a9934668SKenneth D. Merry * XXX: If we have a stripesize we should really use it here. 380a9934668SKenneth D. Merry * Care should be taken in the delete case if this is done 381a9934668SKenneth D. Merry * as deletes can be very sensitive to size given how they 382a9934668SKenneth D. Merry * are processed. 383a9934668SKenneth D. Merry */ 38442fbdde4SKenneth D. Merry if (bp->bio_length > maxsz) { 38542fbdde4SKenneth D. Merry bp->bio_length = maxsz; 386a9934668SKenneth D. Merry limited = true; 387a9934668SKenneth D. Merry } 388a9934668SKenneth D. Merry 389a9934668SKenneth D. Merry if ((bp->bio_flags & BIO_VLIST) != 0) { 390a9934668SKenneth D. Merry bus_dma_segment_t *firstseg, *endseg; 391a9934668SKenneth D. Merry off_t residual; 392a9934668SKenneth D. Merry 393a9934668SKenneth D. Merry firstseg = (bus_dma_segment_t*)bp->bio_data; 394a9934668SKenneth D. Merry residual = g_disk_vlist_limit(dp, bp, &endseg); 395a9934668SKenneth D. Merry if (residual != 0) { 396a9934668SKenneth D. Merry bp->bio_ma_n = endseg - firstseg; 397a9934668SKenneth D. Merry bp->bio_length -= residual; 398a9934668SKenneth D. Merry limited = true; 399a9934668SKenneth D. Merry } 400a9934668SKenneth D. Merry } else if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 401a9934668SKenneth D. Merry bp->bio_ma_n = 402a9934668SKenneth D. Merry howmany(bp->bio_ma_offset + bp->bio_length, PAGE_SIZE); 403a9934668SKenneth D. Merry } 404a9934668SKenneth D. Merry 405a9934668SKenneth D. Merry return (limited); 406a9934668SKenneth D. Merry } 407a9934668SKenneth D. Merry 408dd84a43cSPoul-Henning Kamp static void 409dd84a43cSPoul-Henning Kamp g_disk_start(struct bio *bp) 410dd84a43cSPoul-Henning Kamp { 41115c672a3SPoul-Henning Kamp struct bio *bp2, *bp3; 412dd84a43cSPoul-Henning Kamp struct disk *dp; 413c6d4ed3aSAlexander Motin struct g_disk_softc *sc; 414a5b2e75dSPoul-Henning Kamp int error; 415ccf8a568SAlexander Motin off_t off; 416dd84a43cSPoul-Henning Kamp 41730ba7471SAlexander Motin sc = bp->bio_to->private; 418c6d4ed3aSAlexander Motin if (sc == NULL || (dp = sc->dp) == NULL || dp->d_destroyed) { 41967fd2837SPoul-Henning Kamp g_io_deliver(bp, ENXIO); 420b3fd9b46SPoul-Henning Kamp return; 421b3fd9b46SPoul-Henning Kamp } 422b362694cSPoul-Henning Kamp error = EJUSTRETURN; 423dd84a43cSPoul-Henning Kamp switch(bp->bio_cmd) { 424b362694cSPoul-Henning Kamp case BIO_DELETE: 42531a1093fSPoul-Henning Kamp if (!(dp->d_flags & DISKFLAG_CANDELETE)) { 42692f84a9fSPawel Jakub Dawidek error = EOPNOTSUPP; 427b362694cSPoul-Henning Kamp break; 428b362694cSPoul-Henning Kamp } 429b362694cSPoul-Henning Kamp /* fall-through */ 430dd84a43cSPoul-Henning Kamp case BIO_READ: 431dd84a43cSPoul-Henning Kamp case BIO_WRITE: 432a9934668SKenneth D. Merry KASSERT((dp->d_flags & DISKFLAG_UNMAPPED_BIO) != 0 || 433a9934668SKenneth D. Merry (bp->bio_flags & BIO_UNMAPPED) == 0, 434a9934668SKenneth D. Merry ("unmapped bio not supported by disk %s", dp->d_name)); 43515c672a3SPoul-Henning Kamp off = 0; 43615c672a3SPoul-Henning Kamp bp3 = NULL; 437dd84a43cSPoul-Henning Kamp bp2 = g_clone_bio(bp); 438a4210653SPoul-Henning Kamp if (bp2 == NULL) { 439a4210653SPoul-Henning Kamp error = ENOMEM; 440a4210653SPoul-Henning Kamp break; 441a4210653SPoul-Henning Kamp } 442a9934668SKenneth D. Merry for (;;) { 443a9934668SKenneth D. Merry if (g_disk_limit(dp, bp2)) { 444a9934668SKenneth D. Merry off += bp2->bio_length; 445ccf8a568SAlexander Motin 44615c672a3SPoul-Henning Kamp /* 44715c672a3SPoul-Henning Kamp * To avoid a race, we need to grab the next bio 44815c672a3SPoul-Henning Kamp * before we schedule this one. See "notes". 44915c672a3SPoul-Henning Kamp */ 45015c672a3SPoul-Henning Kamp bp3 = g_clone_bio(bp); 45115c672a3SPoul-Henning Kamp if (bp3 == NULL) 45215c672a3SPoul-Henning Kamp bp->bio_error = ENOMEM; 45315c672a3SPoul-Henning Kamp } 454dd84a43cSPoul-Henning Kamp bp2->bio_done = g_disk_done; 455b362694cSPoul-Henning Kamp bp2->bio_pblkno = bp2->bio_offset / dp->d_sectorsize; 456dd84a43cSPoul-Henning Kamp bp2->bio_bcount = bp2->bio_length; 457ffa91881SPoul-Henning Kamp bp2->bio_disk = dp; 45840ea77a0SAlexander Motin mtx_lock(&sc->start_mtx); 4592e93e909STor Egge devstat_start_transaction_bio(dp->d_devstat, bp2); 46040ea77a0SAlexander Motin mtx_unlock(&sc->start_mtx); 46131a1093fSPoul-Henning Kamp dp->d_strategy(bp2); 462a9934668SKenneth D. Merry 463a9934668SKenneth D. Merry if (bp3 == NULL) 464a9934668SKenneth D. Merry break; 465a9934668SKenneth D. Merry 46615c672a3SPoul-Henning Kamp bp2 = bp3; 46715c672a3SPoul-Henning Kamp bp3 = NULL; 468a9934668SKenneth D. Merry g_disk_advance(dp, bp2, off); 469a9934668SKenneth D. Merry } 470dd84a43cSPoul-Henning Kamp break; 471dd84a43cSPoul-Henning Kamp case BIO_GETATTR: 472416494d7SJustin T. Gibbs /* Give the driver a chance to override */ 473416494d7SJustin T. Gibbs if (dp->d_getattr != NULL) { 474416494d7SJustin T. Gibbs if (bp->bio_disk == NULL) 475416494d7SJustin T. Gibbs bp->bio_disk = dp; 476416494d7SJustin T. Gibbs error = dp->d_getattr(bp); 477416494d7SJustin T. Gibbs if (error != -1) 478416494d7SJustin T. Gibbs break; 479416494d7SJustin T. Gibbs error = EJUSTRETURN; 480416494d7SJustin T. Gibbs } 481d91e813cSKonstantin Belousov if (g_handleattr_int(bp, "GEOM::candelete", 482d91e813cSKonstantin Belousov (dp->d_flags & DISKFLAG_CANDELETE) != 0)) 483d91e813cSKonstantin Belousov break; 484d91e813cSKonstantin Belousov else if (g_handleattr_int(bp, "GEOM::fwsectors", 485d91e813cSKonstantin Belousov dp->d_fwsectors)) 486a5b2e75dSPoul-Henning Kamp break; 4877812d86fSPoul-Henning Kamp else if (g_handleattr_int(bp, "GEOM::fwheads", dp->d_fwheads)) 488a5b2e75dSPoul-Henning Kamp break; 489503abe45SPoul-Henning Kamp else if (g_handleattr_off_t(bp, "GEOM::frontstuff", 0)) 4901bdb20a6SPoul-Henning Kamp break; 491d0c11f9eSPawel Jakub Dawidek else if (g_handleattr_str(bp, "GEOM::ident", dp->d_ident)) 492d0c11f9eSPawel Jakub Dawidek break; 493c28078e9SSteven Hartland else if (g_handleattr_uint16_t(bp, "GEOM::hba_vendor", 494c28078e9SSteven Hartland dp->d_hba_vendor)) 4958edcf694SAlexander Motin break; 496c28078e9SSteven Hartland else if (g_handleattr_uint16_t(bp, "GEOM::hba_device", 497c28078e9SSteven Hartland dp->d_hba_device)) 4988edcf694SAlexander Motin break; 499c28078e9SSteven Hartland else if (g_handleattr_uint16_t(bp, "GEOM::hba_subvendor", 500c28078e9SSteven Hartland dp->d_hba_subvendor)) 5018edcf694SAlexander Motin break; 502c28078e9SSteven Hartland else if (g_handleattr_uint16_t(bp, "GEOM::hba_subdevice", 503c28078e9SSteven Hartland dp->d_hba_subdevice)) 5048edcf694SAlexander Motin break; 50595c24b31SPoul-Henning Kamp else if (!strcmp(bp->bio_attribute, "GEOM::kerneldump")) 50695c24b31SPoul-Henning Kamp g_disk_kerneldump(bp, dp); 507c6d4ed3aSAlexander Motin else if (!strcmp(bp->bio_attribute, "GEOM::setstate")) 508c6d4ed3aSAlexander Motin g_disk_setstate(bp, sc); 509c28078e9SSteven Hartland else if (g_handleattr_uint16_t(bp, "GEOM::rotation_rate", 510c28078e9SSteven Hartland dp->d_rotation_rate)) 511c28078e9SSteven Hartland break; 512497c3347SPoul-Henning Kamp else 513a5b2e75dSPoul-Henning Kamp error = ENOIOCTL; 514a5b2e75dSPoul-Henning Kamp break; 5151d2aee20SPawel Jakub Dawidek case BIO_FLUSH: 51685f5b9aaSAndriy Gapon g_trace(G_T_BIO, "g_disk_flushcache(%s)", 5171d2aee20SPawel Jakub Dawidek bp->bio_to->name); 5181d2aee20SPawel Jakub Dawidek if (!(dp->d_flags & DISKFLAG_CANFLUSHCACHE)) { 51992f84a9fSPawel Jakub Dawidek error = EOPNOTSUPP; 52092f84a9fSPawel Jakub Dawidek break; 5211d2aee20SPawel Jakub Dawidek } 5229a6844d5SKenneth D. Merry /*FALLTHROUGH*/ 5239a6844d5SKenneth D. Merry case BIO_ZONE: 5249a6844d5SKenneth D. Merry if (bp->bio_cmd == BIO_ZONE) { 5259a6844d5SKenneth D. Merry if (!(dp->d_flags & DISKFLAG_CANZONE)) { 5269a6844d5SKenneth D. Merry error = EOPNOTSUPP; 5279a6844d5SKenneth D. Merry break; 5289a6844d5SKenneth D. Merry } 5299a6844d5SKenneth D. Merry g_trace(G_T_BIO, "g_disk_zone(%s)", 5309a6844d5SKenneth D. Merry bp->bio_to->name); 5319a6844d5SKenneth D. Merry } 532ccf8a568SAlexander Motin bp2 = g_clone_bio(bp); 533ccf8a568SAlexander Motin if (bp2 == NULL) { 534ccf8a568SAlexander Motin g_io_deliver(bp, ENOMEM); 535ccf8a568SAlexander Motin return; 536ccf8a568SAlexander Motin } 537ccf8a568SAlexander Motin bp2->bio_done = g_disk_done; 538ccf8a568SAlexander Motin bp2->bio_disk = dp; 539413037c8SAlexander Motin mtx_lock(&sc->start_mtx); 540ccf8a568SAlexander Motin devstat_start_transaction_bio(dp->d_devstat, bp2); 541413037c8SAlexander Motin mtx_unlock(&sc->start_mtx); 542ccf8a568SAlexander Motin dp->d_strategy(bp2); 5431d2aee20SPawel Jakub Dawidek break; 544dd84a43cSPoul-Henning Kamp default: 545a5b2e75dSPoul-Henning Kamp error = EOPNOTSUPP; 546a5b2e75dSPoul-Henning Kamp break; 547dd84a43cSPoul-Henning Kamp } 548b362694cSPoul-Henning Kamp if (error != EJUSTRETURN) 54972840432SPoul-Henning Kamp g_io_deliver(bp, error); 550a5b2e75dSPoul-Henning Kamp return; 551dd84a43cSPoul-Henning Kamp } 552dd84a43cSPoul-Henning Kamp 5538523987bSPoul-Henning Kamp static void 5540f9d3dbaSPoul-Henning Kamp g_disk_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, struct g_consumer *cp, struct g_provider *pp) 5558f9628a1SPoul-Henning Kamp { 556ccba7102SAlexander Motin struct bio *bp; 5578f9628a1SPoul-Henning Kamp struct disk *dp; 558c6d4ed3aSAlexander Motin struct g_disk_softc *sc; 559ccba7102SAlexander Motin char *buf; 560ccba7102SAlexander Motin int res = 0; 5618f9628a1SPoul-Henning Kamp 562c6d4ed3aSAlexander Motin sc = gp->softc; 563c6d4ed3aSAlexander Motin if (sc == NULL || (dp = sc->dp) == NULL) 564eb98005fSPoul-Henning Kamp return; 565d518e539SPoul-Henning Kamp if (indent == NULL) { 566d518e539SPoul-Henning Kamp sbuf_printf(sb, " hd %u", dp->d_fwheads); 567d518e539SPoul-Henning Kamp sbuf_printf(sb, " sc %u", dp->d_fwsectors); 568d518e539SPoul-Henning Kamp return; 569d518e539SPoul-Henning Kamp } 5709e2ebaa0SPoul-Henning Kamp if (pp != NULL) { 5718f9628a1SPoul-Henning Kamp sbuf_printf(sb, "%s<fwheads>%u</fwheads>\n", 5728f9628a1SPoul-Henning Kamp indent, dp->d_fwheads); 5738f9628a1SPoul-Henning Kamp sbuf_printf(sb, "%s<fwsectors>%u</fwsectors>\n", 5748f9628a1SPoul-Henning Kamp indent, dp->d_fwsectors); 575cb03a502SRavi Pokala 576cb03a502SRavi Pokala /* 577cb03a502SRavi Pokala * "rotationrate" is a little complicated, because the value 578cb03a502SRavi Pokala * returned by the drive might not be the RPM; 0 and 1 are 579cb03a502SRavi Pokala * special cases, and there's also a valid range. 580cb03a502SRavi Pokala */ 581cb03a502SRavi Pokala sbuf_printf(sb, "%s<rotationrate>", indent); 582cb03a502SRavi Pokala if (dp->d_rotation_rate == 0) /* Old drives don't */ 583cb03a502SRavi Pokala sbuf_printf(sb, "unknown"); /* report RPM. */ 584cb03a502SRavi Pokala else if (dp->d_rotation_rate == 1) /* Since 0 is used */ 585cb03a502SRavi Pokala sbuf_printf(sb, "0"); /* above, SSDs use 1. */ 586cb03a502SRavi Pokala else if ((dp->d_rotation_rate >= 0x041) && 587cb03a502SRavi Pokala (dp->d_rotation_rate <= 0xfffe)) 588cb03a502SRavi Pokala sbuf_printf(sb, "%u", dp->d_rotation_rate); 589cb03a502SRavi Pokala else 590cb03a502SRavi Pokala sbuf_printf(sb, "invalid"); 591cb03a502SRavi Pokala sbuf_printf(sb, "</rotationrate>\n"); 592ccba7102SAlexander Motin if (dp->d_getattr != NULL) { 593ccba7102SAlexander Motin buf = g_malloc(DISK_IDENT_SIZE, M_WAITOK); 594ccba7102SAlexander Motin bp = g_alloc_bio(); 595ccba7102SAlexander Motin bp->bio_disk = dp; 596ccba7102SAlexander Motin bp->bio_attribute = "GEOM::ident"; 597ccba7102SAlexander Motin bp->bio_length = DISK_IDENT_SIZE; 598ccba7102SAlexander Motin bp->bio_data = buf; 599ccba7102SAlexander Motin res = dp->d_getattr(bp); 6007ae1a87bSAlexander Motin sbuf_printf(sb, "%s<ident>", indent); 6017ae1a87bSAlexander Motin g_conf_printf_escaped(sb, "%s", 602ccba7102SAlexander Motin res == 0 ? buf: dp->d_ident); 6037ae1a87bSAlexander Motin sbuf_printf(sb, "</ident>\n"); 604ccba7102SAlexander Motin bp->bio_attribute = "GEOM::lunid"; 605ccba7102SAlexander Motin bp->bio_length = DISK_IDENT_SIZE; 606ccba7102SAlexander Motin bp->bio_data = buf; 6077ae1a87bSAlexander Motin if (dp->d_getattr(bp) == 0) { 6087ae1a87bSAlexander Motin sbuf_printf(sb, "%s<lunid>", indent); 6097ae1a87bSAlexander Motin g_conf_printf_escaped(sb, "%s", buf); 6107ae1a87bSAlexander Motin sbuf_printf(sb, "</lunid>\n"); 6117ae1a87bSAlexander Motin } 61240f27d7cSAlexander Motin bp->bio_attribute = "GEOM::lunname"; 61340f27d7cSAlexander Motin bp->bio_length = DISK_IDENT_SIZE; 61440f27d7cSAlexander Motin bp->bio_data = buf; 6157ae1a87bSAlexander Motin if (dp->d_getattr(bp) == 0) { 6167ae1a87bSAlexander Motin sbuf_printf(sb, "%s<lunname>", indent); 6177ae1a87bSAlexander Motin g_conf_printf_escaped(sb, "%s", buf); 6187ae1a87bSAlexander Motin sbuf_printf(sb, "</lunname>\n"); 6197ae1a87bSAlexander Motin } 620ccba7102SAlexander Motin g_destroy_bio(bp); 621ccba7102SAlexander Motin g_free(buf); 6227ae1a87bSAlexander Motin } else { 6237ae1a87bSAlexander Motin sbuf_printf(sb, "%s<ident>", indent); 6247ae1a87bSAlexander Motin g_conf_printf_escaped(sb, "%s", dp->d_ident); 6257ae1a87bSAlexander Motin sbuf_printf(sb, "</ident>\n"); 6267ae1a87bSAlexander Motin } 6277ae1a87bSAlexander Motin sbuf_printf(sb, "%s<descr>", indent); 6287ae1a87bSAlexander Motin g_conf_printf_escaped(sb, "%s", dp->d_descr); 6297ae1a87bSAlexander Motin sbuf_printf(sb, "</descr>\n"); 6308f9628a1SPoul-Henning Kamp } 6318f9628a1SPoul-Henning Kamp } 6328f9628a1SPoul-Henning Kamp 6338f9628a1SPoul-Henning Kamp static void 6341af2d09bSEdward Tomasz Napierala g_disk_resize(void *ptr, int flag) 635bc97ce36SEdward Tomasz Napierala { 6361af2d09bSEdward Tomasz Napierala struct disk *dp; 637bc97ce36SEdward Tomasz Napierala struct g_geom *gp; 638bc97ce36SEdward Tomasz Napierala struct g_provider *pp; 639bc97ce36SEdward Tomasz Napierala 6401af2d09bSEdward Tomasz Napierala if (flag == EV_CANCEL) 6411af2d09bSEdward Tomasz Napierala return; 6421af2d09bSEdward Tomasz Napierala g_topology_assert(); 6431af2d09bSEdward Tomasz Napierala 6441af2d09bSEdward Tomasz Napierala dp = ptr; 645bc97ce36SEdward Tomasz Napierala gp = dp->d_geom; 646bc97ce36SEdward Tomasz Napierala 6471af2d09bSEdward Tomasz Napierala if (dp->d_destroyed || gp == NULL) 6481af2d09bSEdward Tomasz Napierala return; 6491af2d09bSEdward Tomasz Napierala 650bc97ce36SEdward Tomasz Napierala LIST_FOREACH(pp, &gp->provider, provider) { 651bc97ce36SEdward Tomasz Napierala if (pp->sectorsize != 0 && 652bc97ce36SEdward Tomasz Napierala pp->sectorsize != dp->d_sectorsize) 653bc97ce36SEdward Tomasz Napierala g_wither_provider(pp, ENXIO); 654bc97ce36SEdward Tomasz Napierala else 655bc97ce36SEdward Tomasz Napierala g_resize_provider(pp, dp->d_mediasize); 656bc97ce36SEdward Tomasz Napierala } 657bc97ce36SEdward Tomasz Napierala } 658bc97ce36SEdward Tomasz Napierala 659bc97ce36SEdward Tomasz Napierala static void 66043f0db6cSPoul-Henning Kamp g_disk_create(void *arg, int flag) 661dd84a43cSPoul-Henning Kamp { 662dd84a43cSPoul-Henning Kamp struct g_geom *gp; 663dd84a43cSPoul-Henning Kamp struct g_provider *pp; 664bb17c5f6SPoul-Henning Kamp struct disk *dp; 665c6d4ed3aSAlexander Motin struct g_disk_softc *sc; 666c6d4ed3aSAlexander Motin char tmpstr[80]; 667dd84a43cSPoul-Henning Kamp 66843f0db6cSPoul-Henning Kamp if (flag == EV_CANCEL) 66943f0db6cSPoul-Henning Kamp return; 6708523987bSPoul-Henning Kamp g_topology_assert(); 671bb17c5f6SPoul-Henning Kamp dp = arg; 672*1ff824e7SKenneth D. Merry 673*1ff824e7SKenneth D. Merry mtx_lock(&dp->d_mtx); 674*1ff824e7SKenneth D. Merry dp->d_init_level = DISK_INIT_START; 675*1ff824e7SKenneth D. Merry 676*1ff824e7SKenneth D. Merry /* 677*1ff824e7SKenneth D. Merry * If the disk has already gone away, we can just stop here and 678*1ff824e7SKenneth D. Merry * call the user's callback to tell him we've cleaned things up. 679*1ff824e7SKenneth D. Merry */ 680*1ff824e7SKenneth D. Merry if (dp->d_goneflag != 0) { 681*1ff824e7SKenneth D. Merry mtx_unlock(&dp->d_mtx); 682*1ff824e7SKenneth D. Merry if (dp->d_gone != NULL) 683*1ff824e7SKenneth D. Merry dp->d_gone(dp); 684*1ff824e7SKenneth D. Merry return; 685*1ff824e7SKenneth D. Merry } 686*1ff824e7SKenneth D. Merry mtx_unlock(&dp->d_mtx); 687*1ff824e7SKenneth D. Merry 688c6d4ed3aSAlexander Motin sc = g_malloc(sizeof(*sc), M_WAITOK | M_ZERO); 68940ea77a0SAlexander Motin mtx_init(&sc->start_mtx, "g_disk_start", NULL, MTX_DEF); 69030ba7471SAlexander Motin mtx_init(&sc->done_mtx, "g_disk_done", NULL, MTX_DEF); 691c6d4ed3aSAlexander Motin sc->dp = dp; 692bb17c5f6SPoul-Henning Kamp gp = g_new_geomf(&g_disk_class, "%s%d", dp->d_name, dp->d_unit); 693c6d4ed3aSAlexander Motin gp->softc = sc; 6948523987bSPoul-Henning Kamp pp = g_new_providerf(gp, "%s", gp->name); 69540ea77a0SAlexander Motin devstat_remove_entry(pp->stat); 69640ea77a0SAlexander Motin pp->stat = NULL; 69740ea77a0SAlexander Motin dp->d_devstat->id = pp; 698bb17c5f6SPoul-Henning Kamp pp->mediasize = dp->d_mediasize; 699bb17c5f6SPoul-Henning Kamp pp->sectorsize = dp->d_sectorsize; 7008a63edc3SPoul-Henning Kamp pp->stripeoffset = dp->d_stripeoffset; 7018a63edc3SPoul-Henning Kamp pp->stripesize = dp->d_stripesize; 702f8c19ba4SKonstantin Belousov if ((dp->d_flags & DISKFLAG_UNMAPPED_BIO) != 0) 703f8c19ba4SKonstantin Belousov pp->flags |= G_PF_ACCEPT_UNMAPPED; 70440ea77a0SAlexander Motin if ((dp->d_flags & DISKFLAG_DIRECT_COMPLETION) != 0) 70540ea77a0SAlexander Motin pp->flags |= G_PF_DIRECT_SEND; 70640ea77a0SAlexander Motin pp->flags |= G_PF_DIRECT_RECEIVE; 7073d5500fcSPoul-Henning Kamp if (bootverbose) 7083d5500fcSPoul-Henning Kamp printf("GEOM: new disk %s\n", gp->name); 709c6d4ed3aSAlexander Motin sysctl_ctx_init(&sc->sysctl_ctx); 710c6d4ed3aSAlexander Motin snprintf(tmpstr, sizeof(tmpstr), "GEOM disk %s", gp->name); 711c6d4ed3aSAlexander Motin sc->sysctl_tree = SYSCTL_ADD_NODE(&sc->sysctl_ctx, 712c6d4ed3aSAlexander Motin SYSCTL_STATIC_CHILDREN(_kern_geom_disk), OID_AUTO, gp->name, 713c6d4ed3aSAlexander Motin CTLFLAG_RD, 0, tmpstr); 714c6d4ed3aSAlexander Motin if (sc->sysctl_tree != NULL) { 715c6d4ed3aSAlexander Motin SYSCTL_ADD_STRING(&sc->sysctl_ctx, 716c6d4ed3aSAlexander Motin SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO, "led", 717af3b2549SHans Petter Selasky CTLFLAG_RWTUN, sc->led, sizeof(sc->led), 718c6d4ed3aSAlexander Motin "LED name"); 719c6d4ed3aSAlexander Motin } 720c6d4ed3aSAlexander Motin pp->private = sc; 721316aed03SPoul-Henning Kamp dp->d_geom = gp; 722316aed03SPoul-Henning Kamp g_error_provider(pp, 0); 723*1ff824e7SKenneth D. Merry 724*1ff824e7SKenneth D. Merry mtx_lock(&dp->d_mtx); 725*1ff824e7SKenneth D. Merry dp->d_init_level = DISK_INIT_DONE; 726*1ff824e7SKenneth D. Merry 727*1ff824e7SKenneth D. Merry /* 728*1ff824e7SKenneth D. Merry * If the disk has gone away at this stage, start the withering 729*1ff824e7SKenneth D. Merry * process for it. 730*1ff824e7SKenneth D. Merry */ 731*1ff824e7SKenneth D. Merry if (dp->d_goneflag != 0) { 732*1ff824e7SKenneth D. Merry mtx_unlock(&dp->d_mtx); 733*1ff824e7SKenneth D. Merry g_wither_provider(pp, ENXIO); 734*1ff824e7SKenneth D. Merry return; 735*1ff824e7SKenneth D. Merry } 736*1ff824e7SKenneth D. Merry mtx_unlock(&dp->d_mtx); 737*1ff824e7SKenneth D. Merry 738dd84a43cSPoul-Henning Kamp } 7398523987bSPoul-Henning Kamp 740c3fb2891SKenneth D. Merry /* 741c3fb2891SKenneth D. Merry * We get this callback after all of the consumers have gone away, and just 742c3fb2891SKenneth D. Merry * before the provider is freed. If the disk driver provided a d_gone 743c3fb2891SKenneth D. Merry * callback, let them know that it is okay to free resources -- they won't 744c3fb2891SKenneth D. Merry * be getting any more accesses from GEOM. 745c3fb2891SKenneth D. Merry */ 746c3fb2891SKenneth D. Merry static void 747c3fb2891SKenneth D. Merry g_disk_providergone(struct g_provider *pp) 748c3fb2891SKenneth D. Merry { 749c3fb2891SKenneth D. Merry struct disk *dp; 750c3fb2891SKenneth D. Merry struct g_disk_softc *sc; 751c3fb2891SKenneth D. Merry 75230ba7471SAlexander Motin sc = (struct g_disk_softc *)pp->private; 753c3fb2891SKenneth D. Merry dp = sc->dp; 75430ba7471SAlexander Motin if (dp != NULL && dp->d_gone != NULL) 755c3fb2891SKenneth D. Merry dp->d_gone(dp); 75630ba7471SAlexander Motin if (sc->sysctl_tree != NULL) { 75730ba7471SAlexander Motin sysctl_ctx_free(&sc->sysctl_ctx); 75830ba7471SAlexander Motin sc->sysctl_tree = NULL; 75930ba7471SAlexander Motin } 76030ba7471SAlexander Motin if (sc->led[0] != 0) { 76130ba7471SAlexander Motin led_set(sc->led, "0"); 76230ba7471SAlexander Motin sc->led[0] = 0; 76330ba7471SAlexander Motin } 76430ba7471SAlexander Motin pp->private = NULL; 76530ba7471SAlexander Motin pp->geom->softc = NULL; 76630ba7471SAlexander Motin mtx_destroy(&sc->done_mtx); 76740ea77a0SAlexander Motin mtx_destroy(&sc->start_mtx); 76830ba7471SAlexander Motin g_free(sc); 769c3fb2891SKenneth D. Merry } 770c3fb2891SKenneth D. Merry 771ce1ee789SPoul-Henning Kamp static void 772ce1ee789SPoul-Henning Kamp g_disk_destroy(void *ptr, int flag) 773ce1ee789SPoul-Henning Kamp { 7740b7ed341SPoul-Henning Kamp struct disk *dp; 775ce1ee789SPoul-Henning Kamp struct g_geom *gp; 776c6d4ed3aSAlexander Motin struct g_disk_softc *sc; 7778523987bSPoul-Henning Kamp 778ce1ee789SPoul-Henning Kamp g_topology_assert(); 7790b7ed341SPoul-Henning Kamp dp = ptr; 7800b7ed341SPoul-Henning Kamp gp = dp->d_geom; 781032bc81dSPoul-Henning Kamp if (gp != NULL) { 782c6d4ed3aSAlexander Motin sc = gp->softc; 78330ba7471SAlexander Motin if (sc != NULL) 78430ba7471SAlexander Motin sc->dp = NULL; 78530ba7471SAlexander Motin dp->d_geom = NULL; 786ce1ee789SPoul-Henning Kamp g_wither_geom(gp, ENXIO); 787032bc81dSPoul-Henning Kamp } 788*1ff824e7SKenneth D. Merry 789*1ff824e7SKenneth D. Merry mtx_destroy(&dp->d_mtx); 790*1ff824e7SKenneth D. Merry 7910b7ed341SPoul-Henning Kamp g_free(dp); 7920b7ed341SPoul-Henning Kamp } 7930b7ed341SPoul-Henning Kamp 7945e16a486SPawel Jakub Dawidek /* 795e93f5e4dSPawel Jakub Dawidek * We only allow printable characters in disk ident, 796e93f5e4dSPawel Jakub Dawidek * the rest is converted to 'x<HH>'. 7975e16a486SPawel Jakub Dawidek */ 7985e16a486SPawel Jakub Dawidek static void 7995e16a486SPawel Jakub Dawidek g_disk_ident_adjust(char *ident, size_t size) 8005e16a486SPawel Jakub Dawidek { 801e93f5e4dSPawel Jakub Dawidek char *p, tmp[4], newid[DISK_IDENT_SIZE]; 8025e16a486SPawel Jakub Dawidek 803e93f5e4dSPawel Jakub Dawidek newid[0] = '\0'; 804e93f5e4dSPawel Jakub Dawidek for (p = ident; *p != '\0'; p++) { 805e93f5e4dSPawel Jakub Dawidek if (isprint(*p)) { 806e93f5e4dSPawel Jakub Dawidek tmp[0] = *p; 807e93f5e4dSPawel Jakub Dawidek tmp[1] = '\0'; 808e93f5e4dSPawel Jakub Dawidek } else { 809e93f5e4dSPawel Jakub Dawidek snprintf(tmp, sizeof(tmp), "x%02hhx", 810e93f5e4dSPawel Jakub Dawidek *(unsigned char *)p); 8115e16a486SPawel Jakub Dawidek } 812e93f5e4dSPawel Jakub Dawidek if (strlcat(newid, tmp, sizeof(newid)) >= sizeof(newid)) 8135e16a486SPawel Jakub Dawidek break; 8145e16a486SPawel Jakub Dawidek } 8155e16a486SPawel Jakub Dawidek bzero(ident, size); 8165e16a486SPawel Jakub Dawidek strlcpy(ident, newid, size); 8175e16a486SPawel Jakub Dawidek } 8185e16a486SPawel Jakub Dawidek 8190b7ed341SPoul-Henning Kamp struct disk * 82094954762SPawel Jakub Dawidek disk_alloc(void) 8210b7ed341SPoul-Henning Kamp { 8220b7ed341SPoul-Henning Kamp 82394954762SPawel Jakub Dawidek return (g_malloc(sizeof(struct disk), M_WAITOK | M_ZERO)); 824ce1ee789SPoul-Henning Kamp } 8258523987bSPoul-Henning Kamp 82698bbd7aaSPoul-Henning Kamp void 8270b7ed341SPoul-Henning Kamp disk_create(struct disk *dp, int version) 8288523987bSPoul-Henning Kamp { 82937f0f0a7SPawel Jakub Dawidek 8308383a92eSSteven Hartland if (version != DISK_VERSION) { 8310b7ed341SPoul-Henning Kamp printf("WARNING: Attempt to add disk %s%d %s", 8320b7ed341SPoul-Henning Kamp dp->d_name, dp->d_unit, 8330b7ed341SPoul-Henning Kamp " using incompatible ABI version of disk(9)\n"); 8340b7ed341SPoul-Henning Kamp printf("WARNING: Ignoring disk %s%d\n", 8350b7ed341SPoul-Henning Kamp dp->d_name, dp->d_unit); 8360b7ed341SPoul-Henning Kamp return; 8370b7ed341SPoul-Henning Kamp } 838d6d78db5SJohn Baldwin if (dp->d_flags & DISKFLAG_RESERVED) { 839d6d78db5SJohn Baldwin printf("WARNING: Attempt to add non-MPSAFE disk %s%d\n", 840d6d78db5SJohn Baldwin dp->d_name, dp->d_unit); 841d6d78db5SJohn Baldwin printf("WARNING: Ignoring disk %s%d\n", 842d6d78db5SJohn Baldwin dp->d_name, dp->d_unit); 843d6d78db5SJohn Baldwin return; 844d6d78db5SJohn Baldwin } 84531a1093fSPoul-Henning Kamp KASSERT(dp->d_strategy != NULL, ("disk_create need d_strategy")); 84631a1093fSPoul-Henning Kamp KASSERT(dp->d_name != NULL, ("disk_create need d_name")); 84731a1093fSPoul-Henning Kamp KASSERT(*dp->d_name != 0, ("disk_create need d_name")); 848237d2765SPoul-Henning Kamp KASSERT(strlen(dp->d_name) < SPECNAMELEN - 4, ("disk name too long")); 849eb98005fSPoul-Henning Kamp if (dp->d_devstat == NULL) 85009f95804SPoul-Henning Kamp dp->d_devstat = devstat_new_entry(dp->d_name, dp->d_unit, 85160794e04SPoul-Henning Kamp dp->d_sectorsize, DEVSTAT_ALL_SUPPORTED, 85260794e04SPoul-Henning Kamp DEVSTAT_TYPE_DIRECT, DEVSTAT_PRIORITY_MAX); 853316aed03SPoul-Henning Kamp dp->d_geom = NULL; 854*1ff824e7SKenneth D. Merry 855*1ff824e7SKenneth D. Merry snprintf(dp->d_mtx_name, sizeof(dp->d_mtx_name), "%s%ddlk", 856*1ff824e7SKenneth D. Merry dp->d_name, dp->d_unit); 857*1ff824e7SKenneth D. Merry mtx_init(&dp->d_mtx, dp->d_mtx_name, NULL, MTX_DEF); 858*1ff824e7SKenneth D. Merry dp->d_init_level = DISK_INIT_NONE; 859*1ff824e7SKenneth D. Merry 8605e16a486SPawel Jakub Dawidek g_disk_ident_adjust(dp->d_ident, sizeof(dp->d_ident)); 8618cd1535aSPoul-Henning Kamp g_post_event(g_disk_create, dp, M_WAITOK, dp, NULL); 862dd84a43cSPoul-Henning Kamp } 863dd84a43cSPoul-Henning Kamp 864dd84a43cSPoul-Henning Kamp void 865b82ff758SPoul-Henning Kamp disk_destroy(struct disk *dp) 866dd84a43cSPoul-Henning Kamp { 867dd84a43cSPoul-Henning Kamp 868316aed03SPoul-Henning Kamp g_cancel_event(dp); 8690b7ed341SPoul-Henning Kamp dp->d_destroyed = 1; 87052c583feSPoul-Henning Kamp if (dp->d_devstat != NULL) 87152c583feSPoul-Henning Kamp devstat_remove_entry(dp->d_devstat); 87211e9a679SPoul-Henning Kamp g_post_event(g_disk_destroy, dp, M_WAITOK, NULL); 873dd84a43cSPoul-Henning Kamp } 874dd84a43cSPoul-Henning Kamp 875a7e69e8bSJohn Polstra void 876a7e69e8bSJohn Polstra disk_gone(struct disk *dp) 877a7e69e8bSJohn Polstra { 878a7e69e8bSJohn Polstra struct g_geom *gp; 879a7e69e8bSJohn Polstra struct g_provider *pp; 880a7e69e8bSJohn Polstra 881*1ff824e7SKenneth D. Merry mtx_lock(&dp->d_mtx); 882*1ff824e7SKenneth D. Merry dp->d_goneflag = 1; 883*1ff824e7SKenneth D. Merry 884*1ff824e7SKenneth D. Merry /* 885*1ff824e7SKenneth D. Merry * If we're still in the process of creating this disk (the 886*1ff824e7SKenneth D. Merry * g_disk_create() function is still queued, or is in 887*1ff824e7SKenneth D. Merry * progress), the init level will not yet be DISK_INIT_DONE. 888*1ff824e7SKenneth D. Merry * 889*1ff824e7SKenneth D. Merry * If that is the case, g_disk_create() will see d_goneflag 890*1ff824e7SKenneth D. Merry * and take care of cleaning things up. 891*1ff824e7SKenneth D. Merry * 892*1ff824e7SKenneth D. Merry * If the disk has already been created, we default to 893*1ff824e7SKenneth D. Merry * withering the provider as usual below. 894*1ff824e7SKenneth D. Merry * 895*1ff824e7SKenneth D. Merry * If the caller has not set a d_gone() callback, he will 896*1ff824e7SKenneth D. Merry * not be any worse off by returning here, because the geom 897*1ff824e7SKenneth D. Merry * has not been fully setup in any case. 898*1ff824e7SKenneth D. Merry */ 899*1ff824e7SKenneth D. Merry if (dp->d_init_level < DISK_INIT_DONE) { 900*1ff824e7SKenneth D. Merry mtx_unlock(&dp->d_mtx); 901*1ff824e7SKenneth D. Merry return; 902*1ff824e7SKenneth D. Merry } 903*1ff824e7SKenneth D. Merry mtx_unlock(&dp->d_mtx); 904*1ff824e7SKenneth D. Merry 905a7e69e8bSJohn Polstra gp = dp->d_geom; 906171f6b3aSPawel Jakub Dawidek if (gp != NULL) { 9075d8a6a10SPawel Jakub Dawidek pp = LIST_FIRST(&gp->provider); 9085d8a6a10SPawel Jakub Dawidek if (pp != NULL) { 9095d8a6a10SPawel Jakub Dawidek KASSERT(LIST_NEXT(pp, provider) == NULL, 9105d8a6a10SPawel Jakub Dawidek ("geom %p has more than one provider", gp)); 911d99c1559SMarcel Moolenaar g_wither_provider(pp, ENXIO); 912a7e69e8bSJohn Polstra } 9135d8a6a10SPawel Jakub Dawidek } 914171f6b3aSPawel Jakub Dawidek } 915a7e69e8bSJohn Polstra 916416494d7SJustin T. Gibbs void 917416494d7SJustin T. Gibbs disk_attr_changed(struct disk *dp, const char *attr, int flag) 918416494d7SJustin T. Gibbs { 919416494d7SJustin T. Gibbs struct g_geom *gp; 920416494d7SJustin T. Gibbs struct g_provider *pp; 92142f42c99SAlan Somers char devnamebuf[128]; 922416494d7SJustin T. Gibbs 923416494d7SJustin T. Gibbs gp = dp->d_geom; 924416494d7SJustin T. Gibbs if (gp != NULL) 925416494d7SJustin T. Gibbs LIST_FOREACH(pp, &gp->provider, provider) 926416494d7SJustin T. Gibbs (void)g_attr_changed(pp, attr, flag); 9271c2c346fSAlan Somers snprintf(devnamebuf, sizeof(devnamebuf), "devname=%s%d", dp->d_name, 9281c2c346fSAlan Somers dp->d_unit); 92942f42c99SAlan Somers devctl_notify("GEOM", "disk", attr, devnamebuf); 930416494d7SJustin T. Gibbs } 931416494d7SJustin T. Gibbs 932bc97ce36SEdward Tomasz Napierala void 9333631c638SAlexander Motin disk_media_changed(struct disk *dp, int flag) 9343631c638SAlexander Motin { 9353631c638SAlexander Motin struct g_geom *gp; 9363631c638SAlexander Motin struct g_provider *pp; 9373631c638SAlexander Motin 9383631c638SAlexander Motin gp = dp->d_geom; 9393631c638SAlexander Motin if (gp != NULL) { 9400fb832fdSAlexander Motin pp = LIST_FIRST(&gp->provider); 9410fb832fdSAlexander Motin if (pp != NULL) { 9420fb832fdSAlexander Motin KASSERT(LIST_NEXT(pp, provider) == NULL, 9430fb832fdSAlexander Motin ("geom %p has more than one provider", gp)); 9443631c638SAlexander Motin g_media_changed(pp, flag); 9453631c638SAlexander Motin } 9463631c638SAlexander Motin } 9470fb832fdSAlexander Motin } 9483631c638SAlexander Motin 9493631c638SAlexander Motin void 9503631c638SAlexander Motin disk_media_gone(struct disk *dp, int flag) 9513631c638SAlexander Motin { 9523631c638SAlexander Motin struct g_geom *gp; 9533631c638SAlexander Motin struct g_provider *pp; 9543631c638SAlexander Motin 9553631c638SAlexander Motin gp = dp->d_geom; 9563631c638SAlexander Motin if (gp != NULL) { 9570fb832fdSAlexander Motin pp = LIST_FIRST(&gp->provider); 9580fb832fdSAlexander Motin if (pp != NULL) { 9590fb832fdSAlexander Motin KASSERT(LIST_NEXT(pp, provider) == NULL, 9600fb832fdSAlexander Motin ("geom %p has more than one provider", gp)); 9613631c638SAlexander Motin g_media_gone(pp, flag); 9623631c638SAlexander Motin } 9633631c638SAlexander Motin } 9640fb832fdSAlexander Motin } 9653631c638SAlexander Motin 9661af2d09bSEdward Tomasz Napierala int 9671af2d09bSEdward Tomasz Napierala disk_resize(struct disk *dp, int flag) 968bc97ce36SEdward Tomasz Napierala { 969bc97ce36SEdward Tomasz Napierala 9701af2d09bSEdward Tomasz Napierala if (dp->d_destroyed || dp->d_geom == NULL) 9711af2d09bSEdward Tomasz Napierala return (0); 972bc97ce36SEdward Tomasz Napierala 9731af2d09bSEdward Tomasz Napierala return (g_post_event(g_disk_resize, dp, flag, NULL)); 974bc97ce36SEdward Tomasz Napierala } 975bc97ce36SEdward Tomasz Napierala 9760cc3011dSPoul-Henning Kamp static void 977afcbcfaeSPoul-Henning Kamp g_kern_disks(void *p, int flag __unused) 9780cc3011dSPoul-Henning Kamp { 9790cc3011dSPoul-Henning Kamp struct sbuf *sb; 9800cc3011dSPoul-Henning Kamp struct g_geom *gp; 9810cc3011dSPoul-Henning Kamp char *sp; 9820cc3011dSPoul-Henning Kamp 9830cc3011dSPoul-Henning Kamp sb = p; 9840cc3011dSPoul-Henning Kamp sp = ""; 9850cc3011dSPoul-Henning Kamp g_topology_assert(); 9860cc3011dSPoul-Henning Kamp LIST_FOREACH(gp, &g_disk_class.geom, geom) { 9870cc3011dSPoul-Henning Kamp sbuf_printf(sb, "%s%s", sp, gp->name); 9880cc3011dSPoul-Henning Kamp sp = " "; 9890cc3011dSPoul-Henning Kamp } 9900cc3011dSPoul-Henning Kamp sbuf_finish(sb); 9910cc3011dSPoul-Henning Kamp } 9920cc3011dSPoul-Henning Kamp 9930cc3011dSPoul-Henning Kamp static int 9940cc3011dSPoul-Henning Kamp sysctl_disks(SYSCTL_HANDLER_ARGS) 9950cc3011dSPoul-Henning Kamp { 9960cc3011dSPoul-Henning Kamp int error; 9970cc3011dSPoul-Henning Kamp struct sbuf *sb; 9980cc3011dSPoul-Henning Kamp 9992616144eSDag-Erling Smørgrav sb = sbuf_new_auto(); 10000a9c130cSPoul-Henning Kamp g_waitfor_event(g_kern_disks, sb, M_WAITOK, NULL); 1001aed99af2SPoul-Henning Kamp error = SYSCTL_OUT(req, sbuf_data(sb), sbuf_len(sb) + 1); 10020cc3011dSPoul-Henning Kamp sbuf_delete(sb); 10030cc3011dSPoul-Henning Kamp return error; 10040cc3011dSPoul-Henning Kamp } 10050cc3011dSPoul-Henning Kamp 100673d6f851SMatthew D Fleming SYSCTL_PROC(_kern, OID_AUTO, disks, 100773d6f851SMatthew D Fleming CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, 0, 10080cc3011dSPoul-Henning Kamp sysctl_disks, "A", "names of available disks"); 1009