1098ca2bdSWarner Losh /*- 200a6a3c6SPoul-Henning Kamp * ---------------------------------------------------------------------------- 300a6a3c6SPoul-Henning Kamp * "THE BEER-WARE LICENSE" (Revision 42): 400a6a3c6SPoul-Henning Kamp * <phk@FreeBSD.ORG> wrote this file. As long as you retain this notice you 500a6a3c6SPoul-Henning Kamp * can do whatever you want with this stuff. If we meet some day, and you think 600a6a3c6SPoul-Henning Kamp * this stuff is worth it, you can buy me a beer in return. Poul-Henning Kamp 700a6a3c6SPoul-Henning Kamp * ---------------------------------------------------------------------------- 800a6a3c6SPoul-Henning Kamp * 900a6a3c6SPoul-Henning Kamp * $FreeBSD$ 1000a6a3c6SPoul-Henning Kamp * 1100a6a3c6SPoul-Henning Kamp */ 1200a6a3c6SPoul-Henning Kamp 13098ca2bdSWarner Losh /*- 14637f671aSPoul-Henning Kamp * The following functions are based in the vn(4) driver: mdstart_swap(), 15637f671aSPoul-Henning Kamp * mdstart_vnode(), mdcreate_swap(), mdcreate_vnode() and mddestroy(), 16637f671aSPoul-Henning Kamp * and as such under the following copyright: 17637f671aSPoul-Henning Kamp * 18637f671aSPoul-Henning Kamp * Copyright (c) 1988 University of Utah. 19637f671aSPoul-Henning Kamp * Copyright (c) 1990, 1993 20637f671aSPoul-Henning Kamp * The Regents of the University of California. All rights reserved. 21*59ec9023SKonstantin Belousov * Copyright (c) 2013 The FreeBSD Foundation 22*59ec9023SKonstantin Belousov * All rights reserved. 23637f671aSPoul-Henning Kamp * 24ed010cdfSWarner Losh * This code is derived from software contributed to Berkeley by 25ed010cdfSWarner Losh * the Systems Programming Group of the University of Utah Computer 26ed010cdfSWarner Losh * Science Department. 27ed010cdfSWarner Losh * 28*59ec9023SKonstantin Belousov * Portions of this software were developed by Konstantin Belousov 29*59ec9023SKonstantin Belousov * under sponsorship from the FreeBSD Foundation. 30*59ec9023SKonstantin Belousov * 31637f671aSPoul-Henning Kamp * Redistribution and use in source and binary forms, with or without 32637f671aSPoul-Henning Kamp * modification, are permitted provided that the following conditions 33637f671aSPoul-Henning Kamp * are met: 34637f671aSPoul-Henning Kamp * 1. Redistributions of source code must retain the above copyright 35637f671aSPoul-Henning Kamp * notice, this list of conditions and the following disclaimer. 36637f671aSPoul-Henning Kamp * 2. Redistributions in binary form must reproduce the above copyright 37637f671aSPoul-Henning Kamp * notice, this list of conditions and the following disclaimer in the 38637f671aSPoul-Henning Kamp * documentation and/or other materials provided with the distribution. 39637f671aSPoul-Henning Kamp * 4. Neither the name of the University nor the names of its contributors 40637f671aSPoul-Henning Kamp * may be used to endorse or promote products derived from this software 41637f671aSPoul-Henning Kamp * without specific prior written permission. 42637f671aSPoul-Henning Kamp * 43637f671aSPoul-Henning Kamp * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 44637f671aSPoul-Henning Kamp * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 45637f671aSPoul-Henning Kamp * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 46637f671aSPoul-Henning Kamp * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 47637f671aSPoul-Henning Kamp * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 48637f671aSPoul-Henning Kamp * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 49637f671aSPoul-Henning Kamp * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 50637f671aSPoul-Henning Kamp * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 51637f671aSPoul-Henning Kamp * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 52637f671aSPoul-Henning Kamp * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 53637f671aSPoul-Henning Kamp * SUCH DAMAGE. 54637f671aSPoul-Henning Kamp * 55637f671aSPoul-Henning Kamp * from: Utah Hdr: vn.c 1.13 94/04/02 56637f671aSPoul-Henning Kamp * 57637f671aSPoul-Henning Kamp * from: @(#)vn.c 8.6 (Berkeley) 4/1/94 58637f671aSPoul-Henning Kamp * From: src/sys/dev/vn/vn.c,v 1.122 2000/12/16 16:06:03 59637f671aSPoul-Henning Kamp */ 60637f671aSPoul-Henning Kamp 616f4f00f1SPoul-Henning Kamp #include "opt_geom.h" 623f54a085SPoul-Henning Kamp #include "opt_md.h" 6371e4fff8SPoul-Henning Kamp 6400a6a3c6SPoul-Henning Kamp #include <sys/param.h> 6500a6a3c6SPoul-Henning Kamp #include <sys/systm.h> 669626b608SPoul-Henning Kamp #include <sys/bio.h> 67*59ec9023SKonstantin Belousov #include <sys/buf.h> 6800a6a3c6SPoul-Henning Kamp #include <sys/conf.h> 69a03be42dSMaxim Sobolev #include <sys/devicestat.h> 708f8def9eSPoul-Henning Kamp #include <sys/fcntl.h> 71fb919e4dSMark Murray #include <sys/kernel.h> 725c97ca54SIan Dowse #include <sys/kthread.h> 7306d425f9SEd Schouten #include <sys/limits.h> 74fb919e4dSMark Murray #include <sys/linker.h> 75fb919e4dSMark Murray #include <sys/lock.h> 76fb919e4dSMark Murray #include <sys/malloc.h> 77fb919e4dSMark Murray #include <sys/mdioctl.h> 78a08d2e7fSJohn Baldwin #include <sys/mount.h> 799dceb26bSJohn Baldwin #include <sys/mutex.h> 809b00ca19SPoul-Henning Kamp #include <sys/sx.h> 81fb919e4dSMark Murray #include <sys/namei.h> 828f8def9eSPoul-Henning Kamp #include <sys/proc.h> 83fb919e4dSMark Murray #include <sys/queue.h> 8489f6b863SAttilio Rao #include <sys/rwlock.h> 85657bd8b1SAndrey V. Elsukov #include <sys/sbuf.h> 8663710c4dSJohn Baldwin #include <sys/sched.h> 877cd53fddSAlan Cox #include <sys/sf_buf.h> 88fb919e4dSMark Murray #include <sys/sysctl.h> 89fb919e4dSMark Murray #include <sys/vnode.h> 90fb919e4dSMark Murray 916f4f00f1SPoul-Henning Kamp #include <geom/geom.h> 926f4f00f1SPoul-Henning Kamp 938f8def9eSPoul-Henning Kamp #include <vm/vm.h> 941c771f92SKonstantin Belousov #include <vm/vm_param.h> 958f8def9eSPoul-Henning Kamp #include <vm/vm_object.h> 968f8def9eSPoul-Henning Kamp #include <vm/vm_page.h> 978f8def9eSPoul-Henning Kamp #include <vm/vm_pager.h> 988f8def9eSPoul-Henning Kamp #include <vm/swap_pager.h> 99f43b2bacSPoul-Henning Kamp #include <vm/uma.h> 1003f54a085SPoul-Henning Kamp 10157e9624eSPoul-Henning Kamp #define MD_MODVER 1 10257e9624eSPoul-Henning Kamp 1035c97ca54SIan Dowse #define MD_SHUTDOWN 0x10000 /* Tell worker thread to terminate. */ 104a08d2e7fSJohn Baldwin #define MD_EXITING 0x20000 /* Worker thread is exiting. */ 1055c97ca54SIan Dowse 106f2744793SSheldon Hearn #ifndef MD_NSECT 107f2744793SSheldon Hearn #define MD_NSECT (10000 * 2) 10833edfabeSPoul-Henning Kamp #endif 10933edfabeSPoul-Henning Kamp 1105bb84bc8SRobert Watson static MALLOC_DEFINE(M_MD, "md_disk", "Memory Disk"); 1115bb84bc8SRobert Watson static MALLOC_DEFINE(M_MDSECT, "md_sectors", "Memory Disk Sectors"); 11200a6a3c6SPoul-Henning Kamp 11371e4fff8SPoul-Henning Kamp static int md_debug; 1143eb9ab52SEitan Adler SYSCTL_INT(_debug, OID_AUTO, mddebug, CTLFLAG_RW, &md_debug, 0, 1153eb9ab52SEitan Adler "Enable md(4) debug messages"); 116c44d423eSKonstantin Belousov static int md_malloc_wait; 1173eb9ab52SEitan Adler SYSCTL_INT(_vm, OID_AUTO, md_malloc_wait, CTLFLAG_RW, &md_malloc_wait, 0, 1183eb9ab52SEitan Adler "Allow malloc to wait for memory allocations"); 11900a6a3c6SPoul-Henning Kamp 12022ff74b2SMarcel Moolenaar #if defined(MD_ROOT) && !defined(MD_ROOT_FSTYPE) 12122ff74b2SMarcel Moolenaar #define MD_ROOT_FSTYPE "ufs" 12222ff74b2SMarcel Moolenaar #endif 12322ff74b2SMarcel Moolenaar 12471e4fff8SPoul-Henning Kamp #if defined(MD_ROOT) && defined(MD_ROOT_SIZE) 125de64f22aSLuigi Rizzo /* 126de64f22aSLuigi Rizzo * Preloaded image gets put here. 127de64f22aSLuigi Rizzo * Applications that patch the object with the image can determine 128de64f22aSLuigi Rizzo * the size looking at the start and end markers (strings), 129de64f22aSLuigi Rizzo * so we want them contiguous. 130de64f22aSLuigi Rizzo */ 131de64f22aSLuigi Rizzo static struct { 132de64f22aSLuigi Rizzo u_char start[MD_ROOT_SIZE*1024]; 133de64f22aSLuigi Rizzo u_char end[128]; 134de64f22aSLuigi Rizzo } mfs_root = { 135de64f22aSLuigi Rizzo .start = "MFS Filesystem goes here", 136de64f22aSLuigi Rizzo .end = "MFS Filesystem had better STOP here", 137de64f22aSLuigi Rizzo }; 13871e4fff8SPoul-Henning Kamp #endif 13971e4fff8SPoul-Henning Kamp 14019945697SPoul-Henning Kamp static g_init_t g_md_init; 14119945697SPoul-Henning Kamp static g_fini_t g_md_fini; 14219945697SPoul-Henning Kamp static g_start_t g_md_start; 14319945697SPoul-Henning Kamp static g_access_t g_md_access; 144b42f40b8SJaakko Heinonen static void g_md_dumpconf(struct sbuf *sb, const char *indent, 145b42f40b8SJaakko Heinonen struct g_geom *gp, struct g_consumer *cp __unused, struct g_provider *pp); 1460eb14309SPoul-Henning Kamp 14789c9c53dSPoul-Henning Kamp static struct cdev *status_dev = 0; 1489b00ca19SPoul-Henning Kamp static struct sx md_sx; 149f4e7c5a8SJaakko Heinonen static struct unrhdr *md_uh; 15057e9624eSPoul-Henning Kamp 151a522a159SPoul-Henning Kamp static d_ioctl_t mdctlioctl; 1528f8def9eSPoul-Henning Kamp 1538f8def9eSPoul-Henning Kamp static struct cdevsw mdctl_cdevsw = { 154dc08ffecSPoul-Henning Kamp .d_version = D_VERSION, 1557ac40f5fSPoul-Henning Kamp .d_ioctl = mdctlioctl, 1567ac40f5fSPoul-Henning Kamp .d_name = MD_NAME, 15700a6a3c6SPoul-Henning Kamp }; 15800a6a3c6SPoul-Henning Kamp 15919945697SPoul-Henning Kamp struct g_class g_md_class = { 16019945697SPoul-Henning Kamp .name = "MD", 1615721c9c7SPoul-Henning Kamp .version = G_VERSION, 16219945697SPoul-Henning Kamp .init = g_md_init, 16319945697SPoul-Henning Kamp .fini = g_md_fini, 16419945697SPoul-Henning Kamp .start = g_md_start, 16519945697SPoul-Henning Kamp .access = g_md_access, 166c27a8954SWojciech A. Koszek .dumpconf = g_md_dumpconf, 16719945697SPoul-Henning Kamp }; 16819945697SPoul-Henning Kamp 16919945697SPoul-Henning Kamp DECLARE_GEOM_CLASS(g_md_class, g_md); 17019945697SPoul-Henning Kamp 1710cfaeeeeSPoul-Henning Kamp 17213e403fdSAntoine Brodin static LIST_HEAD(, md_s) md_softc_list = LIST_HEAD_INITIALIZER(md_softc_list); 1733f54a085SPoul-Henning Kamp 174c6517568SPoul-Henning Kamp #define NINDIR (PAGE_SIZE / sizeof(uintptr_t)) 175c6517568SPoul-Henning Kamp #define NMASK (NINDIR-1) 176c6517568SPoul-Henning Kamp static int nshift; 177c6517568SPoul-Henning Kamp 178*59ec9023SKonstantin Belousov static int md_vnode_pbuf_freecnt; 179*59ec9023SKonstantin Belousov 180c6517568SPoul-Henning Kamp struct indir { 181c6517568SPoul-Henning Kamp uintptr_t *array; 1828b149b51SJohn Baldwin u_int total; 1838b149b51SJohn Baldwin u_int used; 1848b149b51SJohn Baldwin u_int shift; 185c6517568SPoul-Henning Kamp }; 186c6517568SPoul-Henning Kamp 18700a6a3c6SPoul-Henning Kamp struct md_s { 18800a6a3c6SPoul-Henning Kamp int unit; 1893f54a085SPoul-Henning Kamp LIST_ENTRY(md_s) list; 1908177437dSPoul-Henning Kamp struct bio_queue_head bio_queue; 1910f8500a5SPoul-Henning Kamp struct mtx queue_mtx; 19289c9c53dSPoul-Henning Kamp struct cdev *dev; 1938f8def9eSPoul-Henning Kamp enum md_types type; 194b830359bSPawel Jakub Dawidek off_t mediasize; 195b830359bSPawel Jakub Dawidek unsigned sectorsize; 196fe603109SMaxim Sobolev unsigned opencount; 1974e8bfe14SPoul-Henning Kamp unsigned fwheads; 1984e8bfe14SPoul-Henning Kamp unsigned fwsectors; 1998f8def9eSPoul-Henning Kamp unsigned flags; 200f43b2bacSPoul-Henning Kamp char name[20]; 2015c97ca54SIan Dowse struct proc *procp; 2026f4f00f1SPoul-Henning Kamp struct g_geom *gp; 2036f4f00f1SPoul-Henning Kamp struct g_provider *pp; 2049b00ca19SPoul-Henning Kamp int (*start)(struct md_s *sc, struct bio *bp); 205a03be42dSMaxim Sobolev struct devstat *devstat; 20695f1a897SPoul-Henning Kamp 20795f1a897SPoul-Henning Kamp /* MD_MALLOC related fields */ 208c6517568SPoul-Henning Kamp struct indir *indir; 209f43b2bacSPoul-Henning Kamp uma_zone_t uma; 21000a6a3c6SPoul-Henning Kamp 21195f1a897SPoul-Henning Kamp /* MD_PRELOAD related fields */ 21295f1a897SPoul-Henning Kamp u_char *pl_ptr; 213b830359bSPawel Jakub Dawidek size_t pl_len; 21400a6a3c6SPoul-Henning Kamp 2158f8def9eSPoul-Henning Kamp /* MD_VNODE related fields */ 2168f8def9eSPoul-Henning Kamp struct vnode *vnode; 21761a6eb62SPawel Jakub Dawidek char file[PATH_MAX]; 2188f8def9eSPoul-Henning Kamp struct ucred *cred; 2198f8def9eSPoul-Henning Kamp 220e0cebb40SDima Dorfman /* MD_SWAP related fields */ 2218f8def9eSPoul-Henning Kamp vm_object_t object; 2228f8def9eSPoul-Henning Kamp }; 22300a6a3c6SPoul-Henning Kamp 224c6517568SPoul-Henning Kamp static struct indir * 2258b149b51SJohn Baldwin new_indir(u_int shift) 226c6517568SPoul-Henning Kamp { 227c6517568SPoul-Henning Kamp struct indir *ip; 228c6517568SPoul-Henning Kamp 229c44d423eSKonstantin Belousov ip = malloc(sizeof *ip, M_MD, (md_malloc_wait ? M_WAITOK : M_NOWAIT) 230c44d423eSKonstantin Belousov | M_ZERO); 231c6517568SPoul-Henning Kamp if (ip == NULL) 232c6517568SPoul-Henning Kamp return (NULL); 233c6517568SPoul-Henning Kamp ip->array = malloc(sizeof(uintptr_t) * NINDIR, 234c44d423eSKonstantin Belousov M_MDSECT, (md_malloc_wait ? M_WAITOK : M_NOWAIT) | M_ZERO); 235c6517568SPoul-Henning Kamp if (ip->array == NULL) { 236c6517568SPoul-Henning Kamp free(ip, M_MD); 237c6517568SPoul-Henning Kamp return (NULL); 238c6517568SPoul-Henning Kamp } 239c6517568SPoul-Henning Kamp ip->total = NINDIR; 240c6517568SPoul-Henning Kamp ip->shift = shift; 241c6517568SPoul-Henning Kamp return (ip); 242c6517568SPoul-Henning Kamp } 243c6517568SPoul-Henning Kamp 244c6517568SPoul-Henning Kamp static void 245c6517568SPoul-Henning Kamp del_indir(struct indir *ip) 246c6517568SPoul-Henning Kamp { 247c6517568SPoul-Henning Kamp 248f43b2bacSPoul-Henning Kamp free(ip->array, M_MDSECT); 249c6517568SPoul-Henning Kamp free(ip, M_MD); 250c6517568SPoul-Henning Kamp } 251c6517568SPoul-Henning Kamp 252f43b2bacSPoul-Henning Kamp static void 253f43b2bacSPoul-Henning Kamp destroy_indir(struct md_s *sc, struct indir *ip) 254f43b2bacSPoul-Henning Kamp { 255f43b2bacSPoul-Henning Kamp int i; 256f43b2bacSPoul-Henning Kamp 257f43b2bacSPoul-Henning Kamp for (i = 0; i < NINDIR; i++) { 258f43b2bacSPoul-Henning Kamp if (!ip->array[i]) 259f43b2bacSPoul-Henning Kamp continue; 260f43b2bacSPoul-Henning Kamp if (ip->shift) 261f43b2bacSPoul-Henning Kamp destroy_indir(sc, (struct indir*)(ip->array[i])); 262f43b2bacSPoul-Henning Kamp else if (ip->array[i] > 255) 263f43b2bacSPoul-Henning Kamp uma_zfree(sc->uma, (void *)(ip->array[i])); 264f43b2bacSPoul-Henning Kamp } 265f43b2bacSPoul-Henning Kamp del_indir(ip); 266f43b2bacSPoul-Henning Kamp } 267f43b2bacSPoul-Henning Kamp 268c6517568SPoul-Henning Kamp /* 2696c3cd0e2SMaxim Konovalov * This function does the math and allocates the top level "indir" structure 270c6517568SPoul-Henning Kamp * for a device of "size" sectors. 271c6517568SPoul-Henning Kamp */ 272c6517568SPoul-Henning Kamp 273c6517568SPoul-Henning Kamp static struct indir * 274c6517568SPoul-Henning Kamp dimension(off_t size) 275c6517568SPoul-Henning Kamp { 276c6517568SPoul-Henning Kamp off_t rcnt; 277c6517568SPoul-Henning Kamp struct indir *ip; 278d12fc952SKonstantin Belousov int layer; 279c6517568SPoul-Henning Kamp 280c6517568SPoul-Henning Kamp rcnt = size; 281c6517568SPoul-Henning Kamp layer = 0; 282c6517568SPoul-Henning Kamp while (rcnt > NINDIR) { 283c6517568SPoul-Henning Kamp rcnt /= NINDIR; 284c6517568SPoul-Henning Kamp layer++; 285c6517568SPoul-Henning Kamp } 286c6517568SPoul-Henning Kamp 287c6517568SPoul-Henning Kamp /* 288c6517568SPoul-Henning Kamp * XXX: the top layer is probably not fully populated, so we allocate 28983e13864SPoul-Henning Kamp * too much space for ip->array in here. 290c6517568SPoul-Henning Kamp */ 29183e13864SPoul-Henning Kamp ip = malloc(sizeof *ip, M_MD, M_WAITOK | M_ZERO); 29283e13864SPoul-Henning Kamp ip->array = malloc(sizeof(uintptr_t) * NINDIR, 29383e13864SPoul-Henning Kamp M_MDSECT, M_WAITOK | M_ZERO); 29483e13864SPoul-Henning Kamp ip->total = NINDIR; 29583e13864SPoul-Henning Kamp ip->shift = layer * nshift; 296c6517568SPoul-Henning Kamp return (ip); 297c6517568SPoul-Henning Kamp } 298c6517568SPoul-Henning Kamp 299c6517568SPoul-Henning Kamp /* 300c6517568SPoul-Henning Kamp * Read a given sector 301c6517568SPoul-Henning Kamp */ 302c6517568SPoul-Henning Kamp 303c6517568SPoul-Henning Kamp static uintptr_t 304c6517568SPoul-Henning Kamp s_read(struct indir *ip, off_t offset) 305c6517568SPoul-Henning Kamp { 306c6517568SPoul-Henning Kamp struct indir *cip; 307c6517568SPoul-Henning Kamp int idx; 308c6517568SPoul-Henning Kamp uintptr_t up; 309c6517568SPoul-Henning Kamp 310c6517568SPoul-Henning Kamp if (md_debug > 1) 3116569d6f3SMaxime Henrion printf("s_read(%jd)\n", (intmax_t)offset); 312c6517568SPoul-Henning Kamp up = 0; 313c6517568SPoul-Henning Kamp for (cip = ip; cip != NULL;) { 314c6517568SPoul-Henning Kamp if (cip->shift) { 315c6517568SPoul-Henning Kamp idx = (offset >> cip->shift) & NMASK; 316c6517568SPoul-Henning Kamp up = cip->array[idx]; 317c6517568SPoul-Henning Kamp cip = (struct indir *)up; 318c6517568SPoul-Henning Kamp continue; 319c6517568SPoul-Henning Kamp } 320c6517568SPoul-Henning Kamp idx = offset & NMASK; 321c6517568SPoul-Henning Kamp return (cip->array[idx]); 322c6517568SPoul-Henning Kamp } 323c6517568SPoul-Henning Kamp return (0); 324c6517568SPoul-Henning Kamp } 325c6517568SPoul-Henning Kamp 326c6517568SPoul-Henning Kamp /* 327c6517568SPoul-Henning Kamp * Write a given sector, prune the tree if the value is 0 328c6517568SPoul-Henning Kamp */ 329c6517568SPoul-Henning Kamp 330c6517568SPoul-Henning Kamp static int 331fde2a2e4SPoul-Henning Kamp s_write(struct indir *ip, off_t offset, uintptr_t ptr) 332c6517568SPoul-Henning Kamp { 333c6517568SPoul-Henning Kamp struct indir *cip, *lip[10]; 334c6517568SPoul-Henning Kamp int idx, li; 335c6517568SPoul-Henning Kamp uintptr_t up; 336c6517568SPoul-Henning Kamp 337c6517568SPoul-Henning Kamp if (md_debug > 1) 3386569d6f3SMaxime Henrion printf("s_write(%jd, %p)\n", (intmax_t)offset, (void *)ptr); 339c6517568SPoul-Henning Kamp up = 0; 340c6517568SPoul-Henning Kamp li = 0; 341c6517568SPoul-Henning Kamp cip = ip; 342c6517568SPoul-Henning Kamp for (;;) { 343c6517568SPoul-Henning Kamp lip[li++] = cip; 344c6517568SPoul-Henning Kamp if (cip->shift) { 345c6517568SPoul-Henning Kamp idx = (offset >> cip->shift) & NMASK; 346c6517568SPoul-Henning Kamp up = cip->array[idx]; 347c6517568SPoul-Henning Kamp if (up != 0) { 348c6517568SPoul-Henning Kamp cip = (struct indir *)up; 349c6517568SPoul-Henning Kamp continue; 350c6517568SPoul-Henning Kamp } 351c6517568SPoul-Henning Kamp /* Allocate branch */ 352c6517568SPoul-Henning Kamp cip->array[idx] = 353c6517568SPoul-Henning Kamp (uintptr_t)new_indir(cip->shift - nshift); 354c6517568SPoul-Henning Kamp if (cip->array[idx] == 0) 355975b628fSPoul-Henning Kamp return (ENOSPC); 356c6517568SPoul-Henning Kamp cip->used++; 357c6517568SPoul-Henning Kamp up = cip->array[idx]; 358c6517568SPoul-Henning Kamp cip = (struct indir *)up; 359c6517568SPoul-Henning Kamp continue; 360c6517568SPoul-Henning Kamp } 361c6517568SPoul-Henning Kamp /* leafnode */ 362c6517568SPoul-Henning Kamp idx = offset & NMASK; 363c6517568SPoul-Henning Kamp up = cip->array[idx]; 364c6517568SPoul-Henning Kamp if (up != 0) 365c6517568SPoul-Henning Kamp cip->used--; 366c6517568SPoul-Henning Kamp cip->array[idx] = ptr; 367c6517568SPoul-Henning Kamp if (ptr != 0) 368c6517568SPoul-Henning Kamp cip->used++; 369c6517568SPoul-Henning Kamp break; 370c6517568SPoul-Henning Kamp } 371c6517568SPoul-Henning Kamp if (cip->used != 0 || li == 1) 372c6517568SPoul-Henning Kamp return (0); 373c6517568SPoul-Henning Kamp li--; 374c6517568SPoul-Henning Kamp while (cip->used == 0 && cip != ip) { 375c6517568SPoul-Henning Kamp li--; 376c6517568SPoul-Henning Kamp idx = (offset >> lip[li]->shift) & NMASK; 377c6517568SPoul-Henning Kamp up = lip[li]->array[idx]; 378c6517568SPoul-Henning Kamp KASSERT(up == (uintptr_t)cip, ("md screwed up")); 379c6517568SPoul-Henning Kamp del_indir(cip); 3804a6a94d8SArchie Cobbs lip[li]->array[idx] = 0; 381c6517568SPoul-Henning Kamp lip[li]->used--; 382c6517568SPoul-Henning Kamp cip = lip[li]; 383c6517568SPoul-Henning Kamp } 384c6517568SPoul-Henning Kamp return (0); 385c6517568SPoul-Henning Kamp } 386c6517568SPoul-Henning Kamp 3876f4f00f1SPoul-Henning Kamp 3886f4f00f1SPoul-Henning Kamp static int 3896f4f00f1SPoul-Henning Kamp g_md_access(struct g_provider *pp, int r, int w, int e) 3906f4f00f1SPoul-Henning Kamp { 3916f4f00f1SPoul-Henning Kamp struct md_s *sc; 3926f4f00f1SPoul-Henning Kamp 3936f4f00f1SPoul-Henning Kamp sc = pp->geom->softc; 39441c8b468SEdward Tomasz Napierala if (sc == NULL) { 39541c8b468SEdward Tomasz Napierala if (r <= 0 && w <= 0 && e <= 0) 39641c8b468SEdward Tomasz Napierala return (0); 3976b60a2cdSPoul-Henning Kamp return (ENXIO); 39841c8b468SEdward Tomasz Napierala } 3996f4f00f1SPoul-Henning Kamp r += pp->acr; 4006f4f00f1SPoul-Henning Kamp w += pp->acw; 4016f4f00f1SPoul-Henning Kamp e += pp->ace; 40286776891SChristian S.J. Peron if ((sc->flags & MD_READONLY) != 0 && w > 0) 40386776891SChristian S.J. Peron return (EROFS); 4046f4f00f1SPoul-Henning Kamp if ((pp->acr + pp->acw + pp->ace) == 0 && (r + w + e) > 0) { 4056f4f00f1SPoul-Henning Kamp sc->opencount = 1; 4066f4f00f1SPoul-Henning Kamp } else if ((pp->acr + pp->acw + pp->ace) > 0 && (r + w + e) == 0) { 4076f4f00f1SPoul-Henning Kamp sc->opencount = 0; 4086f4f00f1SPoul-Henning Kamp } 4096f4f00f1SPoul-Henning Kamp return (0); 4106f4f00f1SPoul-Henning Kamp } 4116f4f00f1SPoul-Henning Kamp 4126f4f00f1SPoul-Henning Kamp static void 4136f4f00f1SPoul-Henning Kamp g_md_start(struct bio *bp) 4146f4f00f1SPoul-Henning Kamp { 4156f4f00f1SPoul-Henning Kamp struct md_s *sc; 4166f4f00f1SPoul-Henning Kamp 4176f4f00f1SPoul-Henning Kamp sc = bp->bio_to->geom->softc; 418a03be42dSMaxim Sobolev if ((bp->bio_cmd == BIO_READ) || (bp->bio_cmd == BIO_WRITE)) 419a03be42dSMaxim Sobolev devstat_start_transaction_bio(sc->devstat, bp); 4200f8500a5SPoul-Henning Kamp mtx_lock(&sc->queue_mtx); 421891619a6SPoul-Henning Kamp bioq_disksort(&sc->bio_queue, bp); 4224b07ede4SPawel Jakub Dawidek mtx_unlock(&sc->queue_mtx); 423e4cdd0d4SPawel Jakub Dawidek wakeup(sc); 4246f4f00f1SPoul-Henning Kamp } 4256f4f00f1SPoul-Henning Kamp 426*59ec9023SKonstantin Belousov #define MD_MALLOC_MOVE_ZERO 1 427*59ec9023SKonstantin Belousov #define MD_MALLOC_MOVE_FILL 2 428*59ec9023SKonstantin Belousov #define MD_MALLOC_MOVE_READ 3 429*59ec9023SKonstantin Belousov #define MD_MALLOC_MOVE_WRITE 4 430*59ec9023SKonstantin Belousov #define MD_MALLOC_MOVE_CMP 5 431*59ec9023SKonstantin Belousov 432*59ec9023SKonstantin Belousov static int 433*59ec9023SKonstantin Belousov md_malloc_move(vm_page_t **mp, int *ma_offs, unsigned sectorsize, 434*59ec9023SKonstantin Belousov void *ptr, u_char fill, int op) 435*59ec9023SKonstantin Belousov { 436*59ec9023SKonstantin Belousov struct sf_buf *sf; 437*59ec9023SKonstantin Belousov vm_page_t m, *mp1; 438*59ec9023SKonstantin Belousov char *p, first; 439*59ec9023SKonstantin Belousov off_t *uc; 440*59ec9023SKonstantin Belousov unsigned n; 441*59ec9023SKonstantin Belousov int error, i, ma_offs1, sz, first_read; 442*59ec9023SKonstantin Belousov 443*59ec9023SKonstantin Belousov m = NULL; 444*59ec9023SKonstantin Belousov error = 0; 445*59ec9023SKonstantin Belousov sf = NULL; 446*59ec9023SKonstantin Belousov /* if (op == MD_MALLOC_MOVE_CMP) { gcc */ 447*59ec9023SKonstantin Belousov first = 0; 448*59ec9023SKonstantin Belousov first_read = 0; 449*59ec9023SKonstantin Belousov uc = ptr; 450*59ec9023SKonstantin Belousov mp1 = *mp; 451*59ec9023SKonstantin Belousov ma_offs1 = *ma_offs; 452*59ec9023SKonstantin Belousov /* } */ 453*59ec9023SKonstantin Belousov sched_pin(); 454*59ec9023SKonstantin Belousov for (n = sectorsize; n != 0; n -= sz) { 455*59ec9023SKonstantin Belousov sz = imin(PAGE_SIZE - *ma_offs, n); 456*59ec9023SKonstantin Belousov if (m != **mp) { 457*59ec9023SKonstantin Belousov if (sf != NULL) 458*59ec9023SKonstantin Belousov sf_buf_free(sf); 459*59ec9023SKonstantin Belousov m = **mp; 460*59ec9023SKonstantin Belousov sf = sf_buf_alloc(m, SFB_CPUPRIVATE | 461*59ec9023SKonstantin Belousov (md_malloc_wait ? 0 : SFB_NOWAIT)); 462*59ec9023SKonstantin Belousov if (sf == NULL) { 463*59ec9023SKonstantin Belousov error = ENOMEM; 464*59ec9023SKonstantin Belousov break; 465*59ec9023SKonstantin Belousov } 466*59ec9023SKonstantin Belousov } 467*59ec9023SKonstantin Belousov p = (char *)sf_buf_kva(sf) + *ma_offs; 468*59ec9023SKonstantin Belousov switch (op) { 469*59ec9023SKonstantin Belousov case MD_MALLOC_MOVE_ZERO: 470*59ec9023SKonstantin Belousov bzero(p, sz); 471*59ec9023SKonstantin Belousov break; 472*59ec9023SKonstantin Belousov case MD_MALLOC_MOVE_FILL: 473*59ec9023SKonstantin Belousov memset(p, fill, sz); 474*59ec9023SKonstantin Belousov break; 475*59ec9023SKonstantin Belousov case MD_MALLOC_MOVE_READ: 476*59ec9023SKonstantin Belousov bcopy(ptr, p, sz); 477*59ec9023SKonstantin Belousov cpu_flush_dcache(p, sz); 478*59ec9023SKonstantin Belousov break; 479*59ec9023SKonstantin Belousov case MD_MALLOC_MOVE_WRITE: 480*59ec9023SKonstantin Belousov bcopy(p, ptr, sz); 481*59ec9023SKonstantin Belousov break; 482*59ec9023SKonstantin Belousov case MD_MALLOC_MOVE_CMP: 483*59ec9023SKonstantin Belousov for (i = 0; i < sz; i++, p++) { 484*59ec9023SKonstantin Belousov if (!first_read) { 485*59ec9023SKonstantin Belousov *uc = (u_char)*p; 486*59ec9023SKonstantin Belousov first = *p; 487*59ec9023SKonstantin Belousov first_read = 1; 488*59ec9023SKonstantin Belousov } else if (*p != first) { 489*59ec9023SKonstantin Belousov error = EDOOFUS; 490*59ec9023SKonstantin Belousov break; 491*59ec9023SKonstantin Belousov } 492*59ec9023SKonstantin Belousov } 493*59ec9023SKonstantin Belousov break; 494*59ec9023SKonstantin Belousov default: 495*59ec9023SKonstantin Belousov KASSERT(0, ("md_malloc_move unknown op %d\n", op)); 496*59ec9023SKonstantin Belousov break; 497*59ec9023SKonstantin Belousov } 498*59ec9023SKonstantin Belousov if (error != 0) 499*59ec9023SKonstantin Belousov break; 500*59ec9023SKonstantin Belousov *ma_offs += sz; 501*59ec9023SKonstantin Belousov *ma_offs %= PAGE_SIZE; 502*59ec9023SKonstantin Belousov if (*ma_offs == 0) 503*59ec9023SKonstantin Belousov (*mp)++; 504*59ec9023SKonstantin Belousov ptr = (char *)ptr + sz; 505*59ec9023SKonstantin Belousov } 506*59ec9023SKonstantin Belousov 507*59ec9023SKonstantin Belousov if (sf != NULL) 508*59ec9023SKonstantin Belousov sf_buf_free(sf); 509*59ec9023SKonstantin Belousov sched_unpin(); 510*59ec9023SKonstantin Belousov if (op == MD_MALLOC_MOVE_CMP && error != 0) { 511*59ec9023SKonstantin Belousov *mp = mp1; 512*59ec9023SKonstantin Belousov *ma_offs = ma_offs1; 513*59ec9023SKonstantin Belousov } 514*59ec9023SKonstantin Belousov return (error); 515*59ec9023SKonstantin Belousov } 516*59ec9023SKonstantin Belousov 517b4a4f93cSPoul-Henning Kamp static int 518b4a4f93cSPoul-Henning Kamp mdstart_malloc(struct md_s *sc, struct bio *bp) 51900a6a3c6SPoul-Henning Kamp { 520c6517568SPoul-Henning Kamp u_char *dst; 521*59ec9023SKonstantin Belousov vm_page_t *m; 522*59ec9023SKonstantin Belousov int i, error, error1, ma_offs, notmapped; 523b830359bSPawel Jakub Dawidek off_t secno, nsec, uc; 524c6517568SPoul-Henning Kamp uintptr_t sp, osp; 52500a6a3c6SPoul-Henning Kamp 5265541f25eSPawel Jakub Dawidek switch (bp->bio_cmd) { 5275541f25eSPawel Jakub Dawidek case BIO_READ: 5285541f25eSPawel Jakub Dawidek case BIO_WRITE: 5295541f25eSPawel Jakub Dawidek case BIO_DELETE: 5305541f25eSPawel Jakub Dawidek break; 5315541f25eSPawel Jakub Dawidek default: 5325541f25eSPawel Jakub Dawidek return (EOPNOTSUPP); 5335541f25eSPawel Jakub Dawidek } 5345541f25eSPawel Jakub Dawidek 535*59ec9023SKonstantin Belousov notmapped = (bp->bio_flags & BIO_UNMAPPED) != 0; 536*59ec9023SKonstantin Belousov if (notmapped) { 537*59ec9023SKonstantin Belousov m = bp->bio_ma; 538*59ec9023SKonstantin Belousov ma_offs = bp->bio_ma_offset; 539*59ec9023SKonstantin Belousov dst = NULL; 540*59ec9023SKonstantin Belousov } else { 541*59ec9023SKonstantin Belousov dst = bp->bio_data; 542*59ec9023SKonstantin Belousov } 543*59ec9023SKonstantin Belousov 544b830359bSPawel Jakub Dawidek nsec = bp->bio_length / sc->sectorsize; 545b830359bSPawel Jakub Dawidek secno = bp->bio_offset / sc->sectorsize; 546c6517568SPoul-Henning Kamp error = 0; 54700a6a3c6SPoul-Henning Kamp while (nsec--) { 548fde2a2e4SPoul-Henning Kamp osp = s_read(sc->indir, secno); 5498177437dSPoul-Henning Kamp if (bp->bio_cmd == BIO_DELETE) { 550fde2a2e4SPoul-Henning Kamp if (osp != 0) 551fde2a2e4SPoul-Henning Kamp error = s_write(sc->indir, secno, 0); 5528177437dSPoul-Henning Kamp } else if (bp->bio_cmd == BIO_READ) { 553*59ec9023SKonstantin Belousov if (osp == 0) { 554*59ec9023SKonstantin Belousov if (notmapped) { 555*59ec9023SKonstantin Belousov error = md_malloc_move(&m, &ma_offs, 556*59ec9023SKonstantin Belousov sc->sectorsize, NULL, 0, 557*59ec9023SKonstantin Belousov MD_MALLOC_MOVE_ZERO); 558*59ec9023SKonstantin Belousov } else 559b830359bSPawel Jakub Dawidek bzero(dst, sc->sectorsize); 560*59ec9023SKonstantin Belousov } else if (osp <= 255) { 561*59ec9023SKonstantin Belousov if (notmapped) { 562*59ec9023SKonstantin Belousov error = md_malloc_move(&m, &ma_offs, 563*59ec9023SKonstantin Belousov sc->sectorsize, NULL, osp, 564*59ec9023SKonstantin Belousov MD_MALLOC_MOVE_FILL); 565*59ec9023SKonstantin Belousov } else 566dbb95048SMarcel Moolenaar memset(dst, osp, sc->sectorsize); 567*59ec9023SKonstantin Belousov } else { 568*59ec9023SKonstantin Belousov if (notmapped) { 569*59ec9023SKonstantin Belousov error = md_malloc_move(&m, &ma_offs, 570*59ec9023SKonstantin Belousov sc->sectorsize, (void *)osp, 0, 571*59ec9023SKonstantin Belousov MD_MALLOC_MOVE_READ); 572*59ec9023SKonstantin Belousov } else { 573b830359bSPawel Jakub Dawidek bcopy((void *)osp, dst, sc->sectorsize); 574dbb95048SMarcel Moolenaar cpu_flush_dcache(dst, sc->sectorsize); 575dbb95048SMarcel Moolenaar } 576*59ec9023SKonstantin Belousov } 577fde2a2e4SPoul-Henning Kamp osp = 0; 578c6517568SPoul-Henning Kamp } else if (bp->bio_cmd == BIO_WRITE) { 5798f8def9eSPoul-Henning Kamp if (sc->flags & MD_COMPRESS) { 580*59ec9023SKonstantin Belousov if (notmapped) { 581*59ec9023SKonstantin Belousov error1 = md_malloc_move(&m, &ma_offs, 582*59ec9023SKonstantin Belousov sc->sectorsize, &uc, 0, 583*59ec9023SKonstantin Belousov MD_MALLOC_MOVE_CMP); 584*59ec9023SKonstantin Belousov i = error1 == 0 ? sc->sectorsize : 0; 585*59ec9023SKonstantin Belousov } else { 58600a6a3c6SPoul-Henning Kamp uc = dst[0]; 587*59ec9023SKonstantin Belousov for (i = 1; i < sc->sectorsize; i++) { 58800a6a3c6SPoul-Henning Kamp if (dst[i] != uc) 58900a6a3c6SPoul-Henning Kamp break; 590*59ec9023SKonstantin Belousov } 591*59ec9023SKonstantin Belousov } 5928f8def9eSPoul-Henning Kamp } else { 5938f8def9eSPoul-Henning Kamp i = 0; 5948f8def9eSPoul-Henning Kamp uc = 0; 5958f8def9eSPoul-Henning Kamp } 596b830359bSPawel Jakub Dawidek if (i == sc->sectorsize) { 597fde2a2e4SPoul-Henning Kamp if (osp != uc) 598fde2a2e4SPoul-Henning Kamp error = s_write(sc->indir, secno, uc); 59900a6a3c6SPoul-Henning Kamp } else { 600fde2a2e4SPoul-Henning Kamp if (osp <= 255) { 601b830359bSPawel Jakub Dawidek sp = (uintptr_t)uma_zalloc(sc->uma, 602c44d423eSKonstantin Belousov md_malloc_wait ? M_WAITOK : 603b830359bSPawel Jakub Dawidek M_NOWAIT); 604c6517568SPoul-Henning Kamp if (sp == 0) { 605fde2a2e4SPoul-Henning Kamp error = ENOSPC; 606fde2a2e4SPoul-Henning Kamp break; 607fde2a2e4SPoul-Henning Kamp } 608*59ec9023SKonstantin Belousov if (notmapped) { 609*59ec9023SKonstantin Belousov error = md_malloc_move(&m, 610*59ec9023SKonstantin Belousov &ma_offs, sc->sectorsize, 611*59ec9023SKonstantin Belousov (void *)sp, 0, 612*59ec9023SKonstantin Belousov MD_MALLOC_MOVE_WRITE); 613*59ec9023SKonstantin Belousov } else { 614*59ec9023SKonstantin Belousov bcopy(dst, (void *)sp, 615*59ec9023SKonstantin Belousov sc->sectorsize); 616*59ec9023SKonstantin Belousov } 617fde2a2e4SPoul-Henning Kamp error = s_write(sc->indir, secno, sp); 618c6517568SPoul-Henning Kamp } else { 619*59ec9023SKonstantin Belousov if (notmapped) { 620*59ec9023SKonstantin Belousov error = md_malloc_move(&m, 621*59ec9023SKonstantin Belousov &ma_offs, sc->sectorsize, 622*59ec9023SKonstantin Belousov (void *)osp, 0, 623*59ec9023SKonstantin Belousov MD_MALLOC_MOVE_WRITE); 624*59ec9023SKonstantin Belousov } else { 625*59ec9023SKonstantin Belousov bcopy(dst, (void *)osp, 626*59ec9023SKonstantin Belousov sc->sectorsize); 627*59ec9023SKonstantin Belousov } 628fde2a2e4SPoul-Henning Kamp osp = 0; 62900a6a3c6SPoul-Henning Kamp } 63000a6a3c6SPoul-Henning Kamp } 631c6517568SPoul-Henning Kamp } else { 632c6517568SPoul-Henning Kamp error = EOPNOTSUPP; 633c6517568SPoul-Henning Kamp } 634c6517568SPoul-Henning Kamp if (osp > 255) 635f43b2bacSPoul-Henning Kamp uma_zfree(sc->uma, (void*)osp); 636e3ed29a7SPawel Jakub Dawidek if (error != 0) 637c6517568SPoul-Henning Kamp break; 63800a6a3c6SPoul-Henning Kamp secno++; 639*59ec9023SKonstantin Belousov if (!notmapped) 640b830359bSPawel Jakub Dawidek dst += sc->sectorsize; 64100a6a3c6SPoul-Henning Kamp } 6428177437dSPoul-Henning Kamp bp->bio_resid = 0; 643c6517568SPoul-Henning Kamp return (error); 64400a6a3c6SPoul-Henning Kamp } 64500a6a3c6SPoul-Henning Kamp 646b4a4f93cSPoul-Henning Kamp static int 647b4a4f93cSPoul-Henning Kamp mdstart_preload(struct md_s *sc, struct bio *bp) 64871e4fff8SPoul-Henning Kamp { 64971e4fff8SPoul-Henning Kamp 650a8a58d03SPawel Jakub Dawidek switch (bp->bio_cmd) { 651a8a58d03SPawel Jakub Dawidek case BIO_READ: 652a8a58d03SPawel Jakub Dawidek bcopy(sc->pl_ptr + bp->bio_offset, bp->bio_data, 653a8a58d03SPawel Jakub Dawidek bp->bio_length); 654dbb95048SMarcel Moolenaar cpu_flush_dcache(bp->bio_data, bp->bio_length); 655a8a58d03SPawel Jakub Dawidek break; 656a8a58d03SPawel Jakub Dawidek case BIO_WRITE: 657a8a58d03SPawel Jakub Dawidek bcopy(bp->bio_data, sc->pl_ptr + bp->bio_offset, 658a8a58d03SPawel Jakub Dawidek bp->bio_length); 659a8a58d03SPawel Jakub Dawidek break; 66071e4fff8SPoul-Henning Kamp } 6618177437dSPoul-Henning Kamp bp->bio_resid = 0; 662b4a4f93cSPoul-Henning Kamp return (0); 66371e4fff8SPoul-Henning Kamp } 66471e4fff8SPoul-Henning Kamp 665b4a4f93cSPoul-Henning Kamp static int 666b4a4f93cSPoul-Henning Kamp mdstart_vnode(struct md_s *sc, struct bio *bp) 6678f8def9eSPoul-Henning Kamp { 6685050aa86SKonstantin Belousov int error; 6698f8def9eSPoul-Henning Kamp struct uio auio; 6708f8def9eSPoul-Henning Kamp struct iovec aiov; 6718f8def9eSPoul-Henning Kamp struct mount *mp; 6725541f25eSPawel Jakub Dawidek struct vnode *vp; 673*59ec9023SKonstantin Belousov struct buf *pb; 6745541f25eSPawel Jakub Dawidek struct thread *td; 6750abd21bdSDag-Erling Smørgrav off_t end, zerosize; 6765541f25eSPawel Jakub Dawidek 6775541f25eSPawel Jakub Dawidek switch (bp->bio_cmd) { 6785541f25eSPawel Jakub Dawidek case BIO_READ: 6795541f25eSPawel Jakub Dawidek case BIO_WRITE: 6800abd21bdSDag-Erling Smørgrav case BIO_DELETE: 6815541f25eSPawel Jakub Dawidek case BIO_FLUSH: 6825541f25eSPawel Jakub Dawidek break; 6835541f25eSPawel Jakub Dawidek default: 6845541f25eSPawel Jakub Dawidek return (EOPNOTSUPP); 6855541f25eSPawel Jakub Dawidek } 6865541f25eSPawel Jakub Dawidek 6875541f25eSPawel Jakub Dawidek td = curthread; 6885541f25eSPawel Jakub Dawidek vp = sc->vnode; 6898f8def9eSPoul-Henning Kamp 6908f8def9eSPoul-Henning Kamp /* 6918f8def9eSPoul-Henning Kamp * VNODE I/O 6928f8def9eSPoul-Henning Kamp * 6938f8def9eSPoul-Henning Kamp * If an error occurs, we set BIO_ERROR but we do not set 6948f8def9eSPoul-Henning Kamp * B_INVAL because (for a write anyway), the buffer is 6958f8def9eSPoul-Henning Kamp * still valid. 6968f8def9eSPoul-Henning Kamp */ 6978f8def9eSPoul-Henning Kamp 6985541f25eSPawel Jakub Dawidek if (bp->bio_cmd == BIO_FLUSH) { 6995541f25eSPawel Jakub Dawidek (void) vn_start_write(vp, &mp, V_WAIT); 700cb05b60aSAttilio Rao vn_lock(vp, LK_EXCLUSIVE | LK_RETRY); 7015541f25eSPawel Jakub Dawidek error = VOP_FSYNC(vp, MNT_WAIT, td); 70222db15c0SAttilio Rao VOP_UNLOCK(vp, 0); 7035541f25eSPawel Jakub Dawidek vn_finished_write(mp); 7045541f25eSPawel Jakub Dawidek return (error); 7055541f25eSPawel Jakub Dawidek } 7065541f25eSPawel Jakub Dawidek 7078f8def9eSPoul-Henning Kamp bzero(&auio, sizeof(auio)); 7088f8def9eSPoul-Henning Kamp 7090abd21bdSDag-Erling Smørgrav /* 7100abd21bdSDag-Erling Smørgrav * Special case for BIO_DELETE. On the surface, this is very 7110abd21bdSDag-Erling Smørgrav * similar to BIO_WRITE, except that we write from our own 7120abd21bdSDag-Erling Smørgrav * fixed-length buffer, so we have to loop. The net result is 7130abd21bdSDag-Erling Smørgrav * that the two cases end up having very little in common. 7140abd21bdSDag-Erling Smørgrav */ 7150abd21bdSDag-Erling Smørgrav if (bp->bio_cmd == BIO_DELETE) { 71689cb2a19SMatthew D Fleming zerosize = ZERO_REGION_SIZE - 71789cb2a19SMatthew D Fleming (ZERO_REGION_SIZE % sc->sectorsize); 7180abd21bdSDag-Erling Smørgrav auio.uio_iov = &aiov; 7190abd21bdSDag-Erling Smørgrav auio.uio_iovcnt = 1; 7200abd21bdSDag-Erling Smørgrav auio.uio_offset = (vm_ooffset_t)bp->bio_offset; 7210abd21bdSDag-Erling Smørgrav auio.uio_segflg = UIO_SYSSPACE; 7220abd21bdSDag-Erling Smørgrav auio.uio_rw = UIO_WRITE; 7230abd21bdSDag-Erling Smørgrav auio.uio_td = td; 7240abd21bdSDag-Erling Smørgrav end = bp->bio_offset + bp->bio_length; 7250abd21bdSDag-Erling Smørgrav (void) vn_start_write(vp, &mp, V_WAIT); 7260abd21bdSDag-Erling Smørgrav vn_lock(vp, LK_EXCLUSIVE | LK_RETRY); 7270abd21bdSDag-Erling Smørgrav error = 0; 7280abd21bdSDag-Erling Smørgrav while (auio.uio_offset < end) { 72989cb2a19SMatthew D Fleming aiov.iov_base = __DECONST(void *, zero_region); 7300abd21bdSDag-Erling Smørgrav aiov.iov_len = end - auio.uio_offset; 7310abd21bdSDag-Erling Smørgrav if (aiov.iov_len > zerosize) 7320abd21bdSDag-Erling Smørgrav aiov.iov_len = zerosize; 7330abd21bdSDag-Erling Smørgrav auio.uio_resid = aiov.iov_len; 7340abd21bdSDag-Erling Smørgrav error = VOP_WRITE(vp, &auio, 7350abd21bdSDag-Erling Smørgrav sc->flags & MD_ASYNC ? 0 : IO_SYNC, sc->cred); 7360abd21bdSDag-Erling Smørgrav if (error != 0) 7370abd21bdSDag-Erling Smørgrav break; 7380abd21bdSDag-Erling Smørgrav } 7390abd21bdSDag-Erling Smørgrav VOP_UNLOCK(vp, 0); 7400abd21bdSDag-Erling Smørgrav vn_finished_write(mp); 7410abd21bdSDag-Erling Smørgrav bp->bio_resid = end - auio.uio_offset; 7420abd21bdSDag-Erling Smørgrav return (error); 7430abd21bdSDag-Erling Smørgrav } 7440abd21bdSDag-Erling Smørgrav 745*59ec9023SKonstantin Belousov KASSERT(bp->bio_length <= MAXPHYS, ("bio_length %jd", 746*59ec9023SKonstantin Belousov (uintmax_t)bp->bio_length)); 747*59ec9023SKonstantin Belousov if ((bp->bio_flags & BIO_UNMAPPED) == 0) { 748*59ec9023SKonstantin Belousov pb = NULL; 7498f8def9eSPoul-Henning Kamp aiov.iov_base = bp->bio_data; 750*59ec9023SKonstantin Belousov } else { 751*59ec9023SKonstantin Belousov pb = getpbuf(&md_vnode_pbuf_freecnt); 752*59ec9023SKonstantin Belousov pmap_qenter((vm_offset_t)pb->b_data, bp->bio_ma, bp->bio_ma_n); 753*59ec9023SKonstantin Belousov aiov.iov_base = (void *)((vm_offset_t)pb->b_data + 754*59ec9023SKonstantin Belousov bp->bio_ma_offset); 755*59ec9023SKonstantin Belousov } 756a8a58d03SPawel Jakub Dawidek aiov.iov_len = bp->bio_length; 7578f8def9eSPoul-Henning Kamp auio.uio_iov = &aiov; 7588f8def9eSPoul-Henning Kamp auio.uio_iovcnt = 1; 759a8a58d03SPawel Jakub Dawidek auio.uio_offset = (vm_ooffset_t)bp->bio_offset; 7608f8def9eSPoul-Henning Kamp auio.uio_segflg = UIO_SYSSPACE; 7618f8def9eSPoul-Henning Kamp if (bp->bio_cmd == BIO_READ) 7628f8def9eSPoul-Henning Kamp auio.uio_rw = UIO_READ; 7638e28326aSPoul-Henning Kamp else if (bp->bio_cmd == BIO_WRITE) 7648f8def9eSPoul-Henning Kamp auio.uio_rw = UIO_WRITE; 7658e28326aSPoul-Henning Kamp else 7668e28326aSPoul-Henning Kamp panic("wrong BIO_OP in mdstart_vnode"); 767a8a58d03SPawel Jakub Dawidek auio.uio_resid = bp->bio_length; 7685541f25eSPawel Jakub Dawidek auio.uio_td = td; 7697e76bb56SMatthew Dillon /* 7707e76bb56SMatthew Dillon * When reading set IO_DIRECT to try to avoid double-caching 77117a13919SPoul-Henning Kamp * the data. When writing IO_DIRECT is not optimal. 7727e76bb56SMatthew Dillon */ 7738f8def9eSPoul-Henning Kamp if (bp->bio_cmd == BIO_READ) { 774cb05b60aSAttilio Rao vn_lock(vp, LK_EXCLUSIVE | LK_RETRY); 7755541f25eSPawel Jakub Dawidek error = VOP_READ(vp, &auio, IO_DIRECT, sc->cred); 77622db15c0SAttilio Rao VOP_UNLOCK(vp, 0); 7778f8def9eSPoul-Henning Kamp } else { 7785541f25eSPawel Jakub Dawidek (void) vn_start_write(vp, &mp, V_WAIT); 779cb05b60aSAttilio Rao vn_lock(vp, LK_EXCLUSIVE | LK_RETRY); 7805541f25eSPawel Jakub Dawidek error = VOP_WRITE(vp, &auio, sc->flags & MD_ASYNC ? 0 : IO_SYNC, 7815541f25eSPawel Jakub Dawidek sc->cred); 78222db15c0SAttilio Rao VOP_UNLOCK(vp, 0); 7838f8def9eSPoul-Henning Kamp vn_finished_write(mp); 7848f8def9eSPoul-Henning Kamp } 785*59ec9023SKonstantin Belousov if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 786*59ec9023SKonstantin Belousov pmap_qremove((vm_offset_t)pb->b_data, bp->bio_ma_n); 787*59ec9023SKonstantin Belousov relpbuf(pb, &md_vnode_pbuf_freecnt); 788*59ec9023SKonstantin Belousov } 7898f8def9eSPoul-Henning Kamp bp->bio_resid = auio.uio_resid; 790b4a4f93cSPoul-Henning Kamp return (error); 7918f8def9eSPoul-Henning Kamp } 7928f8def9eSPoul-Henning Kamp 793b4a4f93cSPoul-Henning Kamp static int 794b4a4f93cSPoul-Henning Kamp mdstart_swap(struct md_s *sc, struct bio *bp) 7958f8def9eSPoul-Henning Kamp { 7968e28326aSPoul-Henning Kamp vm_page_t m; 7978e28326aSPoul-Henning Kamp u_char *p; 798*59ec9023SKonstantin Belousov vm_pindex_t i, lastp; 799*59ec9023SKonstantin Belousov int rv, ma_offs, offs, len, lastend; 8008f8def9eSPoul-Henning Kamp 8015541f25eSPawel Jakub Dawidek switch (bp->bio_cmd) { 8025541f25eSPawel Jakub Dawidek case BIO_READ: 8035541f25eSPawel Jakub Dawidek case BIO_WRITE: 8045541f25eSPawel Jakub Dawidek case BIO_DELETE: 8055541f25eSPawel Jakub Dawidek break; 8065541f25eSPawel Jakub Dawidek default: 8075541f25eSPawel Jakub Dawidek return (EOPNOTSUPP); 8085541f25eSPawel Jakub Dawidek } 8095541f25eSPawel Jakub Dawidek 8108e28326aSPoul-Henning Kamp p = bp->bio_data; 811*59ec9023SKonstantin Belousov ma_offs = (bp->bio_flags & BIO_UNMAPPED) == 0 ? 0 : bp->bio_ma_offset; 812e07113d6SColin Percival 813e07113d6SColin Percival /* 8146c3cd0e2SMaxim Konovalov * offs is the offset at which to start operating on the 815e07113d6SColin Percival * next (ie, first) page. lastp is the last page on 816e07113d6SColin Percival * which we're going to operate. lastend is the ending 817e07113d6SColin Percival * position within that last page (ie, PAGE_SIZE if 818e07113d6SColin Percival * we're operating on complete aligned pages). 819e07113d6SColin Percival */ 820e07113d6SColin Percival offs = bp->bio_offset % PAGE_SIZE; 821e07113d6SColin Percival lastp = (bp->bio_offset + bp->bio_length - 1) / PAGE_SIZE; 822e07113d6SColin Percival lastend = (bp->bio_offset + bp->bio_length - 1) % PAGE_SIZE + 1; 823e07113d6SColin Percival 824812851b6SBrian Feldman rv = VM_PAGER_OK; 82589f6b863SAttilio Rao VM_OBJECT_WLOCK(sc->object); 8268e28326aSPoul-Henning Kamp vm_object_pip_add(sc->object, 1); 827e07113d6SColin Percival for (i = bp->bio_offset / PAGE_SIZE; i <= lastp; i++) { 828e07113d6SColin Percival len = ((i == lastp) ? lastend : PAGE_SIZE) - offs; 829*59ec9023SKonstantin Belousov m = vm_page_grab(sc->object, i, VM_ALLOC_NORMAL | 830*59ec9023SKonstantin Belousov VM_ALLOC_RETRY); 8318e28326aSPoul-Henning Kamp if (bp->bio_cmd == BIO_READ) { 83207be617fSAlan Cox if (m->valid != VM_PAGE_BITS_ALL) 83307be617fSAlan Cox rv = vm_pager_get_pages(sc->object, &m, 1, 0); 834812851b6SBrian Feldman if (rv == VM_PAGER_ERROR) { 835812851b6SBrian Feldman vm_page_wakeup(m); 836812851b6SBrian Feldman break; 837e9f581baSKonstantin Belousov } else if (rv == VM_PAGER_FAIL) { 838e9f581baSKonstantin Belousov /* 839e9f581baSKonstantin Belousov * Pager does not have the page. Zero 840e9f581baSKonstantin Belousov * the allocated page, and mark it as 841e9f581baSKonstantin Belousov * valid. Do not set dirty, the page 842e9f581baSKonstantin Belousov * can be recreated if thrown out. 843e9f581baSKonstantin Belousov */ 844*59ec9023SKonstantin Belousov pmap_zero_page(m); 845e9f581baSKonstantin Belousov m->valid = VM_PAGE_BITS_ALL; 846812851b6SBrian Feldman } 847*59ec9023SKonstantin Belousov if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 848*59ec9023SKonstantin Belousov pmap_copy_pages(&m, offs, bp->bio_ma, 849*59ec9023SKonstantin Belousov ma_offs, len); 850*59ec9023SKonstantin Belousov } else { 851*59ec9023SKonstantin Belousov physcopyout(VM_PAGE_TO_PHYS(m) + offs, p, len); 852dbb95048SMarcel Moolenaar cpu_flush_dcache(p, len); 853*59ec9023SKonstantin Belousov } 8548e28326aSPoul-Henning Kamp } else if (bp->bio_cmd == BIO_WRITE) { 85507be617fSAlan Cox if (len != PAGE_SIZE && m->valid != VM_PAGE_BITS_ALL) 85607be617fSAlan Cox rv = vm_pager_get_pages(sc->object, &m, 1, 0); 857812851b6SBrian Feldman if (rv == VM_PAGER_ERROR) { 858812851b6SBrian Feldman vm_page_wakeup(m); 859812851b6SBrian Feldman break; 860812851b6SBrian Feldman } 861*59ec9023SKonstantin Belousov if ((bp->bio_flags & BIO_UNMAPPED) != 0) { 862*59ec9023SKonstantin Belousov pmap_copy_pages(bp->bio_ma, ma_offs, &m, 863*59ec9023SKonstantin Belousov offs, len); 864*59ec9023SKonstantin Belousov } else { 865*59ec9023SKonstantin Belousov physcopyin(p, VM_PAGE_TO_PHYS(m) + offs, len); 866*59ec9023SKonstantin Belousov } 8678e28326aSPoul-Henning Kamp m->valid = VM_PAGE_BITS_ALL; 8688e28326aSPoul-Henning Kamp } else if (bp->bio_cmd == BIO_DELETE) { 86907be617fSAlan Cox if (len != PAGE_SIZE && m->valid != VM_PAGE_BITS_ALL) 87007be617fSAlan Cox rv = vm_pager_get_pages(sc->object, &m, 1, 0); 871812851b6SBrian Feldman if (rv == VM_PAGER_ERROR) { 872812851b6SBrian Feldman vm_page_wakeup(m); 873812851b6SBrian Feldman break; 874812851b6SBrian Feldman } 8754a13a769SKonstantin Belousov if (len != PAGE_SIZE) { 876*59ec9023SKonstantin Belousov pmap_zero_page_area(m, offs, len); 8774a13a769SKonstantin Belousov vm_page_clear_dirty(m, offs, len); 8788e28326aSPoul-Henning Kamp m->valid = VM_PAGE_BITS_ALL; 8794a13a769SKonstantin Belousov } else 8804a13a769SKonstantin Belousov vm_pager_page_unswapped(m); 8818e28326aSPoul-Henning Kamp } 8828e28326aSPoul-Henning Kamp vm_page_wakeup(m); 883fc0c3802SKonstantin Belousov vm_page_lock(m); 8844a13a769SKonstantin Belousov if (bp->bio_cmd == BIO_DELETE && len == PAGE_SIZE) 8854a13a769SKonstantin Belousov vm_page_free(m); 8864a13a769SKonstantin Belousov else 8878e28326aSPoul-Henning Kamp vm_page_activate(m); 888ecd5dd95SAlan Cox vm_page_unlock(m); 88907be617fSAlan Cox if (bp->bio_cmd == BIO_WRITE) 8908e28326aSPoul-Henning Kamp vm_page_dirty(m); 891e07113d6SColin Percival 892e07113d6SColin Percival /* Actions on further pages start at offset 0 */ 893e07113d6SColin Percival p += PAGE_SIZE - offs; 894e07113d6SColin Percival offs = 0; 895*59ec9023SKonstantin Belousov ma_offs += len; 8968e28326aSPoul-Henning Kamp } 8978e28326aSPoul-Henning Kamp vm_object_pip_subtract(sc->object, 1); 89889f6b863SAttilio Rao VM_OBJECT_WUNLOCK(sc->object); 899812851b6SBrian Feldman return (rv != VM_PAGER_ERROR ? 0 : ENOSPC); 9008e28326aSPoul-Henning Kamp } 9018f8def9eSPoul-Henning Kamp 9028f8def9eSPoul-Henning Kamp static void 9035c97ca54SIan Dowse md_kthread(void *arg) 9045c97ca54SIan Dowse { 9055c97ca54SIan Dowse struct md_s *sc; 9065c97ca54SIan Dowse struct bio *bp; 907a08d2e7fSJohn Baldwin int error; 9085c97ca54SIan Dowse 9095c97ca54SIan Dowse sc = arg; 910982d11f8SJeff Roberson thread_lock(curthread); 91163710c4dSJohn Baldwin sched_prio(curthread, PRIBIO); 912982d11f8SJeff Roberson thread_unlock(curthread); 9133b7b5496SKonstantin Belousov if (sc->type == MD_VNODE) 9143b7b5496SKonstantin Belousov curthread->td_pflags |= TDP_NORUNNINGBUF; 9155c97ca54SIan Dowse 916b4a4f93cSPoul-Henning Kamp for (;;) { 917a08d2e7fSJohn Baldwin mtx_lock(&sc->queue_mtx); 9185c97ca54SIan Dowse if (sc->flags & MD_SHUTDOWN) { 919a08d2e7fSJohn Baldwin sc->flags |= MD_EXITING; 920a08d2e7fSJohn Baldwin mtx_unlock(&sc->queue_mtx); 9213745c395SJulian Elischer kproc_exit(0); 9225c97ca54SIan Dowse } 9239b00ca19SPoul-Henning Kamp bp = bioq_takefirst(&sc->bio_queue); 9249b00ca19SPoul-Henning Kamp if (!bp) { 9250f8500a5SPoul-Henning Kamp msleep(sc, &sc->queue_mtx, PRIBIO | PDROP, "mdwait", 0); 9265c97ca54SIan Dowse continue; 9275c97ca54SIan Dowse } 9280f8500a5SPoul-Henning Kamp mtx_unlock(&sc->queue_mtx); 9294e8bfe14SPoul-Henning Kamp if (bp->bio_cmd == BIO_GETATTR) { 930d91e813cSKonstantin Belousov if ((sc->fwsectors && sc->fwheads && 9314e8bfe14SPoul-Henning Kamp (g_handleattr_int(bp, "GEOM::fwsectors", 9324e8bfe14SPoul-Henning Kamp sc->fwsectors) || 9334e8bfe14SPoul-Henning Kamp g_handleattr_int(bp, "GEOM::fwheads", 934d91e813cSKonstantin Belousov sc->fwheads))) || 935d91e813cSKonstantin Belousov g_handleattr_int(bp, "GEOM::candelete", 1)) 9364e8bfe14SPoul-Henning Kamp error = -1; 9374e8bfe14SPoul-Henning Kamp else 9384e8bfe14SPoul-Henning Kamp error = EOPNOTSUPP; 9394e8bfe14SPoul-Henning Kamp } else { 9409b00ca19SPoul-Henning Kamp error = sc->start(sc, bp); 9414e8bfe14SPoul-Henning Kamp } 942b4a4f93cSPoul-Henning Kamp 9436f4f00f1SPoul-Henning Kamp if (error != -1) { 9446f4f00f1SPoul-Henning Kamp bp->bio_completed = bp->bio_length; 945a03be42dSMaxim Sobolev if ((bp->bio_cmd == BIO_READ) || (bp->bio_cmd == BIO_WRITE)) 946a03be42dSMaxim Sobolev devstat_end_transaction_bio(sc->devstat, bp); 94796410b95SKonstantin Belousov g_io_deliver(bp, error); 948b4a4f93cSPoul-Henning Kamp } 9498f8def9eSPoul-Henning Kamp } 95026d48b40SPoul-Henning Kamp } 9518f8def9eSPoul-Henning Kamp 9528f8def9eSPoul-Henning Kamp static struct md_s * 9538f8def9eSPoul-Henning Kamp mdfind(int unit) 9548f8def9eSPoul-Henning Kamp { 9558f8def9eSPoul-Henning Kamp struct md_s *sc; 9568f8def9eSPoul-Henning Kamp 9573f54a085SPoul-Henning Kamp LIST_FOREACH(sc, &md_softc_list, list) { 9583f54a085SPoul-Henning Kamp if (sc->unit == unit) 9598f8def9eSPoul-Henning Kamp break; 9608f8def9eSPoul-Henning Kamp } 9618f8def9eSPoul-Henning Kamp return (sc); 9628f8def9eSPoul-Henning Kamp } 9638f8def9eSPoul-Henning Kamp 9648f8def9eSPoul-Henning Kamp static struct md_s * 965947fc8deSPoul-Henning Kamp mdnew(int unit, int *errp, enum md_types type) 9668f8def9eSPoul-Henning Kamp { 967f4e7c5a8SJaakko Heinonen struct md_s *sc; 968f4e7c5a8SJaakko Heinonen int error; 9698f8def9eSPoul-Henning Kamp 9709b00ca19SPoul-Henning Kamp *errp = 0; 971f4e7c5a8SJaakko Heinonen if (unit == -1) 972f4e7c5a8SJaakko Heinonen unit = alloc_unr(md_uh); 973f4e7c5a8SJaakko Heinonen else 974f4e7c5a8SJaakko Heinonen unit = alloc_unr_specific(md_uh, unit); 975f4e7c5a8SJaakko Heinonen 976f4e7c5a8SJaakko Heinonen if (unit == -1) { 9777ee3c044SPawel Jakub Dawidek *errp = EBUSY; 9783f54a085SPoul-Henning Kamp return (NULL); 9793f54a085SPoul-Henning Kamp } 980f4e7c5a8SJaakko Heinonen 9819b00ca19SPoul-Henning Kamp sc = (struct md_s *)malloc(sizeof *sc, M_MD, M_WAITOK | M_ZERO); 982947fc8deSPoul-Henning Kamp sc->type = type; 9839b00ca19SPoul-Henning Kamp bioq_init(&sc->bio_queue); 9849b00ca19SPoul-Henning Kamp mtx_init(&sc->queue_mtx, "md bio queue", NULL, MTX_DEF); 9853f54a085SPoul-Henning Kamp sc->unit = unit; 986f43b2bacSPoul-Henning Kamp sprintf(sc->name, "md%d", unit); 9877ee3c044SPawel Jakub Dawidek LIST_INSERT_HEAD(&md_softc_list, sc, list); 9883745c395SJulian Elischer error = kproc_create(md_kthread, sc, &sc->procp, 0, 0,"%s", sc->name); 9899b00ca19SPoul-Henning Kamp if (error == 0) 9909b00ca19SPoul-Henning Kamp return (sc); 9917ee3c044SPawel Jakub Dawidek LIST_REMOVE(sc, list); 9927ee3c044SPawel Jakub Dawidek mtx_destroy(&sc->queue_mtx); 993f4e7c5a8SJaakko Heinonen free_unr(md_uh, sc->unit); 9945c97ca54SIan Dowse free(sc, M_MD); 9957ee3c044SPawel Jakub Dawidek *errp = error; 9965c97ca54SIan Dowse return (NULL); 9975c97ca54SIan Dowse } 9988f8def9eSPoul-Henning Kamp 9998f8def9eSPoul-Henning Kamp static void 10008f8def9eSPoul-Henning Kamp mdinit(struct md_s *sc) 10018f8def9eSPoul-Henning Kamp { 10026f4f00f1SPoul-Henning Kamp struct g_geom *gp; 10036f4f00f1SPoul-Henning Kamp struct g_provider *pp; 10046f4f00f1SPoul-Henning Kamp 10056f4f00f1SPoul-Henning Kamp g_topology_lock(); 10066f4f00f1SPoul-Henning Kamp gp = g_new_geomf(&g_md_class, "md%d", sc->unit); 10076f4f00f1SPoul-Henning Kamp gp->softc = sc; 10086f4f00f1SPoul-Henning Kamp pp = g_new_providerf(gp, "md%d", sc->unit); 1009b830359bSPawel Jakub Dawidek pp->mediasize = sc->mediasize; 1010b830359bSPawel Jakub Dawidek pp->sectorsize = sc->sectorsize; 1011*59ec9023SKonstantin Belousov pp->flags |= G_PF_ACCEPT_UNMAPPED; 10126f4f00f1SPoul-Henning Kamp sc->gp = gp; 10136f4f00f1SPoul-Henning Kamp sc->pp = pp; 10146f4f00f1SPoul-Henning Kamp g_error_provider(pp, 0); 10156f4f00f1SPoul-Henning Kamp g_topology_unlock(); 1016a03be42dSMaxim Sobolev sc->devstat = devstat_new_entry("md", sc->unit, sc->sectorsize, 1017a03be42dSMaxim Sobolev DEVSTAT_ALL_SUPPORTED, DEVSTAT_TYPE_DIRECT, DEVSTAT_PRIORITY_MAX); 10186f4f00f1SPoul-Henning Kamp } 101971e4fff8SPoul-Henning Kamp 10208f8def9eSPoul-Henning Kamp static int 1021b830359bSPawel Jakub Dawidek mdcreate_malloc(struct md_s *sc, struct md_ioctl *mdio) 102295f1a897SPoul-Henning Kamp { 1023c6517568SPoul-Henning Kamp uintptr_t sp; 1024c6517568SPoul-Henning Kamp int error; 1025b830359bSPawel Jakub Dawidek off_t u; 102695f1a897SPoul-Henning Kamp 1027c6517568SPoul-Henning Kamp error = 0; 10288f8def9eSPoul-Henning Kamp if (mdio->md_options & ~(MD_AUTOUNIT | MD_COMPRESS | MD_RESERVE)) 10298f8def9eSPoul-Henning Kamp return (EINVAL); 1030b830359bSPawel Jakub Dawidek if (mdio->md_sectorsize != 0 && !powerof2(mdio->md_sectorsize)) 1031ebe789d6SPoul-Henning Kamp return (EINVAL); 10328f8def9eSPoul-Henning Kamp /* Compression doesn't make sense if we have reserved space */ 10338f8def9eSPoul-Henning Kamp if (mdio->md_options & MD_RESERVE) 10348f8def9eSPoul-Henning Kamp mdio->md_options &= ~MD_COMPRESS; 10354e8bfe14SPoul-Henning Kamp if (mdio->md_fwsectors != 0) 10364e8bfe14SPoul-Henning Kamp sc->fwsectors = mdio->md_fwsectors; 10374e8bfe14SPoul-Henning Kamp if (mdio->md_fwheads != 0) 10384e8bfe14SPoul-Henning Kamp sc->fwheads = mdio->md_fwheads; 103926a0ee75SDima Dorfman sc->flags = mdio->md_options & (MD_COMPRESS | MD_FORCE); 1040b830359bSPawel Jakub Dawidek sc->indir = dimension(sc->mediasize / sc->sectorsize); 1041b830359bSPawel Jakub Dawidek sc->uma = uma_zcreate(sc->name, sc->sectorsize, NULL, NULL, NULL, NULL, 1042b830359bSPawel Jakub Dawidek 0x1ff, 0); 104396b6a55fSPoul-Henning Kamp if (mdio->md_options & MD_RESERVE) { 1044b830359bSPawel Jakub Dawidek off_t nsectors; 1045b830359bSPawel Jakub Dawidek 1046b830359bSPawel Jakub Dawidek nsectors = sc->mediasize / sc->sectorsize; 1047b830359bSPawel Jakub Dawidek for (u = 0; u < nsectors; u++) { 1048007777f1SKonstantin Belousov sp = (uintptr_t)uma_zalloc(sc->uma, (md_malloc_wait ? 1049007777f1SKonstantin Belousov M_WAITOK : M_NOWAIT) | M_ZERO); 1050c6517568SPoul-Henning Kamp if (sp != 0) 1051fde2a2e4SPoul-Henning Kamp error = s_write(sc->indir, u, sp); 1052c6517568SPoul-Henning Kamp else 1053c6517568SPoul-Henning Kamp error = ENOMEM; 1054b830359bSPawel Jakub Dawidek if (error != 0) 1055c6517568SPoul-Henning Kamp break; 10568f8def9eSPoul-Henning Kamp } 1057c6517568SPoul-Henning Kamp } 1058c6517568SPoul-Henning Kamp return (error); 105900a6a3c6SPoul-Henning Kamp } 106000a6a3c6SPoul-Henning Kamp 10613f54a085SPoul-Henning Kamp 10628f8def9eSPoul-Henning Kamp static int 10638f8def9eSPoul-Henning Kamp mdsetcred(struct md_s *sc, struct ucred *cred) 10648f8def9eSPoul-Henning Kamp { 10658f8def9eSPoul-Henning Kamp char *tmpbuf; 10668f8def9eSPoul-Henning Kamp int error = 0; 10678f8def9eSPoul-Henning Kamp 10683f54a085SPoul-Henning Kamp /* 10698f8def9eSPoul-Henning Kamp * Set credits in our softc 10703f54a085SPoul-Henning Kamp */ 10718f8def9eSPoul-Henning Kamp 10728f8def9eSPoul-Henning Kamp if (sc->cred) 10738f8def9eSPoul-Henning Kamp crfree(sc->cred); 1074bd78ceceSJohn Baldwin sc->cred = crhold(cred); 10758f8def9eSPoul-Henning Kamp 10768f8def9eSPoul-Henning Kamp /* 10778f8def9eSPoul-Henning Kamp * Horrible kludge to establish credentials for NFS XXX. 10788f8def9eSPoul-Henning Kamp */ 10798f8def9eSPoul-Henning Kamp 10808f8def9eSPoul-Henning Kamp if (sc->vnode) { 10818f8def9eSPoul-Henning Kamp struct uio auio; 10828f8def9eSPoul-Henning Kamp struct iovec aiov; 10838f8def9eSPoul-Henning Kamp 1084b830359bSPawel Jakub Dawidek tmpbuf = malloc(sc->sectorsize, M_TEMP, M_WAITOK); 10858f8def9eSPoul-Henning Kamp bzero(&auio, sizeof(auio)); 10868f8def9eSPoul-Henning Kamp 10878f8def9eSPoul-Henning Kamp aiov.iov_base = tmpbuf; 1088b830359bSPawel Jakub Dawidek aiov.iov_len = sc->sectorsize; 10898f8def9eSPoul-Henning Kamp auio.uio_iov = &aiov; 10908f8def9eSPoul-Henning Kamp auio.uio_iovcnt = 1; 10918f8def9eSPoul-Henning Kamp auio.uio_offset = 0; 10928f8def9eSPoul-Henning Kamp auio.uio_rw = UIO_READ; 10938f8def9eSPoul-Henning Kamp auio.uio_segflg = UIO_SYSSPACE; 10948f8def9eSPoul-Henning Kamp auio.uio_resid = aiov.iov_len; 1095cb05b60aSAttilio Rao vn_lock(sc->vnode, LK_EXCLUSIVE | LK_RETRY); 10968f8def9eSPoul-Henning Kamp error = VOP_READ(sc->vnode, &auio, 0, sc->cred); 109722db15c0SAttilio Rao VOP_UNLOCK(sc->vnode, 0); 10988f8def9eSPoul-Henning Kamp free(tmpbuf, M_TEMP); 10998f8def9eSPoul-Henning Kamp } 11008f8def9eSPoul-Henning Kamp return (error); 11018f8def9eSPoul-Henning Kamp } 11028f8def9eSPoul-Henning Kamp 11038f8def9eSPoul-Henning Kamp static int 1104b830359bSPawel Jakub Dawidek mdcreate_vnode(struct md_s *sc, struct md_ioctl *mdio, struct thread *td) 11058f8def9eSPoul-Henning Kamp { 11068f8def9eSPoul-Henning Kamp struct vattr vattr; 11078f8def9eSPoul-Henning Kamp struct nameidata nd; 11083d5c947dSMarcel Moolenaar char *fname; 11095050aa86SKonstantin Belousov int error, flags; 11108f8def9eSPoul-Henning Kamp 11113d5c947dSMarcel Moolenaar /* 11123d5c947dSMarcel Moolenaar * Kernel-originated requests must have the filename appended 11133d5c947dSMarcel Moolenaar * to the mdio structure to protect against malicious software. 11143d5c947dSMarcel Moolenaar */ 11153d5c947dSMarcel Moolenaar fname = mdio->md_file; 11163d5c947dSMarcel Moolenaar if ((void *)fname != (void *)(mdio + 1)) { 11173d5c947dSMarcel Moolenaar error = copyinstr(fname, sc->file, sizeof(sc->file), NULL); 111888b5b78dSPawel Jakub Dawidek if (error != 0) 111988b5b78dSPawel Jakub Dawidek return (error); 11203d5c947dSMarcel Moolenaar } else 11213d5c947dSMarcel Moolenaar strlcpy(sc->file, fname, sizeof(sc->file)); 11223d5c947dSMarcel Moolenaar 112386776891SChristian S.J. Peron /* 11243d5c947dSMarcel Moolenaar * If the user specified that this is a read only device, don't 11253d5c947dSMarcel Moolenaar * set the FWRITE mask before trying to open the backing store. 112686776891SChristian S.J. Peron */ 11273d5c947dSMarcel Moolenaar flags = FREAD | ((mdio->md_options & MD_READONLY) ? 0 : FWRITE); 11285050aa86SKonstantin Belousov NDINIT(&nd, LOOKUP, FOLLOW, UIO_SYSSPACE, sc->file, td); 11299e223287SKonstantin Belousov error = vn_open(&nd, &flags, 0, NULL); 1130e3ed29a7SPawel Jakub Dawidek if (error != 0) 113152c6716fSPawel Jakub Dawidek return (error); 1132b322d85dSPawel Jakub Dawidek NDFREE(&nd, NDF_ONLY_PNBUF); 113333fc3625SJohn Baldwin if (nd.ni_vp->v_type != VREG) { 113433fc3625SJohn Baldwin error = EINVAL; 113533fc3625SJohn Baldwin goto bad; 113633fc3625SJohn Baldwin } 113733fc3625SJohn Baldwin error = VOP_GETATTR(nd.ni_vp, &vattr, td->td_ucred); 113833fc3625SJohn Baldwin if (error != 0) 113933fc3625SJohn Baldwin goto bad; 114033fc3625SJohn Baldwin if (VOP_ISLOCKED(nd.ni_vp) != LK_EXCLUSIVE) { 114133fc3625SJohn Baldwin vn_lock(nd.ni_vp, LK_UPGRADE | LK_RETRY); 114233fc3625SJohn Baldwin if (nd.ni_vp->v_iflag & VI_DOOMED) { 114333fc3625SJohn Baldwin /* Forced unmount. */ 114433fc3625SJohn Baldwin error = EBADF; 114533fc3625SJohn Baldwin goto bad; 114633fc3625SJohn Baldwin } 11478f8def9eSPoul-Henning Kamp } 11483b7b5496SKonstantin Belousov nd.ni_vp->v_vflag |= VV_MD; 114922db15c0SAttilio Rao VOP_UNLOCK(nd.ni_vp, 0); 11509589c256SPoul-Henning Kamp 1151d5a929dcSPoul-Henning Kamp if (mdio->md_fwsectors != 0) 1152d5a929dcSPoul-Henning Kamp sc->fwsectors = mdio->md_fwsectors; 1153d5a929dcSPoul-Henning Kamp if (mdio->md_fwheads != 0) 1154d5a929dcSPoul-Henning Kamp sc->fwheads = mdio->md_fwheads; 11557a6b2b64SPoul-Henning Kamp sc->flags = mdio->md_options & (MD_FORCE | MD_ASYNC); 11569589c256SPoul-Henning Kamp if (!(flags & FWRITE)) 11579589c256SPoul-Henning Kamp sc->flags |= MD_READONLY; 11588f8def9eSPoul-Henning Kamp sc->vnode = nd.ni_vp; 11598f8def9eSPoul-Henning Kamp 1160a854ed98SJohn Baldwin error = mdsetcred(sc, td->td_ucred); 1161b830359bSPawel Jakub Dawidek if (error != 0) { 11623cf74e53SPhilip Paeps sc->vnode = NULL; 1163cb05b60aSAttilio Rao vn_lock(nd.ni_vp, LK_EXCLUSIVE | LK_RETRY); 11643b7b5496SKonstantin Belousov nd.ni_vp->v_vflag &= ~VV_MD; 116533fc3625SJohn Baldwin goto bad; 116633fc3625SJohn Baldwin } 116733fc3625SJohn Baldwin return (0); 116833fc3625SJohn Baldwin bad: 116922db15c0SAttilio Rao VOP_UNLOCK(nd.ni_vp, 0); 117052c6716fSPawel Jakub Dawidek (void)vn_close(nd.ni_vp, flags, td->td_ucred, td); 11718f8def9eSPoul-Henning Kamp return (error); 11728f8def9eSPoul-Henning Kamp } 11738f8def9eSPoul-Henning Kamp 11748f8def9eSPoul-Henning Kamp static int 1175b40ce416SJulian Elischer mddestroy(struct md_s *sc, struct thread *td) 11768f8def9eSPoul-Henning Kamp { 11770cddd8f0SMatthew Dillon 11786f4f00f1SPoul-Henning Kamp if (sc->gp) { 11796f4f00f1SPoul-Henning Kamp sc->gp->softc = NULL; 11809b00ca19SPoul-Henning Kamp g_topology_lock(); 11819b00ca19SPoul-Henning Kamp g_wither_geom(sc->gp, ENXIO); 11829b00ca19SPoul-Henning Kamp g_topology_unlock(); 11836b60a2cdSPoul-Henning Kamp sc->gp = NULL; 11846b60a2cdSPoul-Henning Kamp sc->pp = NULL; 11851f4ee1aaSPoul-Henning Kamp } 1186a03be42dSMaxim Sobolev if (sc->devstat) { 1187a03be42dSMaxim Sobolev devstat_remove_entry(sc->devstat); 1188a03be42dSMaxim Sobolev sc->devstat = NULL; 1189a03be42dSMaxim Sobolev } 1190a08d2e7fSJohn Baldwin mtx_lock(&sc->queue_mtx); 11915c97ca54SIan Dowse sc->flags |= MD_SHUTDOWN; 11925c97ca54SIan Dowse wakeup(sc); 1193a08d2e7fSJohn Baldwin while (!(sc->flags & MD_EXITING)) 1194a08d2e7fSJohn Baldwin msleep(sc->procp, &sc->queue_mtx, PRIBIO, "mddestroy", hz / 10); 1195a08d2e7fSJohn Baldwin mtx_unlock(&sc->queue_mtx); 11969fbea3e3SPoul-Henning Kamp mtx_destroy(&sc->queue_mtx); 11979b00ca19SPoul-Henning Kamp if (sc->vnode != NULL) { 1198cb05b60aSAttilio Rao vn_lock(sc->vnode, LK_EXCLUSIVE | LK_RETRY); 11993b7b5496SKonstantin Belousov sc->vnode->v_vflag &= ~VV_MD; 120022db15c0SAttilio Rao VOP_UNLOCK(sc->vnode, 0); 12019d4b5945SMaxim Sobolev (void)vn_close(sc->vnode, sc->flags & MD_READONLY ? 1202b40ce416SJulian Elischer FREAD : (FREAD|FWRITE), sc->cred, td); 12039b00ca19SPoul-Henning Kamp } 12048f8def9eSPoul-Henning Kamp if (sc->cred != NULL) 12058f8def9eSPoul-Henning Kamp crfree(sc->cred); 12061db17c6dSPawel Jakub Dawidek if (sc->object != NULL) 1207f820bc50SAlan Cox vm_object_deallocate(sc->object); 1208f43b2bacSPoul-Henning Kamp if (sc->indir) 1209f43b2bacSPoul-Henning Kamp destroy_indir(sc, sc->indir); 1210f43b2bacSPoul-Henning Kamp if (sc->uma) 1211f43b2bacSPoul-Henning Kamp uma_zdestroy(sc->uma); 12121f4ee1aaSPoul-Henning Kamp 12131f4ee1aaSPoul-Henning Kamp LIST_REMOVE(sc, list); 1214f4e7c5a8SJaakko Heinonen free_unr(md_uh, sc->unit); 1215c6517568SPoul-Henning Kamp free(sc, M_MD); 12168f8def9eSPoul-Henning Kamp return (0); 12178f8def9eSPoul-Henning Kamp } 12188f8def9eSPoul-Henning Kamp 12198f8def9eSPoul-Henning Kamp static int 1220dc604f0cSEdward Tomasz Napierala mdresize(struct md_s *sc, struct md_ioctl *mdio) 1221dc604f0cSEdward Tomasz Napierala { 1222dc604f0cSEdward Tomasz Napierala int error, res; 1223dc604f0cSEdward Tomasz Napierala vm_pindex_t oldpages, newpages; 1224dc604f0cSEdward Tomasz Napierala 1225dc604f0cSEdward Tomasz Napierala switch (sc->type) { 1226dc604f0cSEdward Tomasz Napierala case MD_VNODE: 1227dc604f0cSEdward Tomasz Napierala break; 1228dc604f0cSEdward Tomasz Napierala case MD_SWAP: 12298cb51643SJaakko Heinonen if (mdio->md_mediasize <= 0 || 1230dc604f0cSEdward Tomasz Napierala (mdio->md_mediasize % PAGE_SIZE) != 0) 1231dc604f0cSEdward Tomasz Napierala return (EDOM); 1232dc604f0cSEdward Tomasz Napierala oldpages = OFF_TO_IDX(round_page(sc->mediasize)); 1233dc604f0cSEdward Tomasz Napierala newpages = OFF_TO_IDX(round_page(mdio->md_mediasize)); 1234dc604f0cSEdward Tomasz Napierala if (newpages < oldpages) { 123589f6b863SAttilio Rao VM_OBJECT_WLOCK(sc->object); 1236dc604f0cSEdward Tomasz Napierala vm_object_page_remove(sc->object, newpages, 0, 0); 1237dc604f0cSEdward Tomasz Napierala swap_pager_freespace(sc->object, newpages, 1238dc604f0cSEdward Tomasz Napierala oldpages - newpages); 1239dc604f0cSEdward Tomasz Napierala swap_release_by_cred(IDX_TO_OFF(oldpages - 1240dc604f0cSEdward Tomasz Napierala newpages), sc->cred); 1241dc604f0cSEdward Tomasz Napierala sc->object->charge = IDX_TO_OFF(newpages); 1242dc604f0cSEdward Tomasz Napierala sc->object->size = newpages; 124389f6b863SAttilio Rao VM_OBJECT_WUNLOCK(sc->object); 1244dc604f0cSEdward Tomasz Napierala } else if (newpages > oldpages) { 1245dc604f0cSEdward Tomasz Napierala res = swap_reserve_by_cred(IDX_TO_OFF(newpages - 1246dc604f0cSEdward Tomasz Napierala oldpages), sc->cred); 1247dc604f0cSEdward Tomasz Napierala if (!res) 1248dc604f0cSEdward Tomasz Napierala return (ENOMEM); 1249dc604f0cSEdward Tomasz Napierala if ((mdio->md_options & MD_RESERVE) || 1250dc604f0cSEdward Tomasz Napierala (sc->flags & MD_RESERVE)) { 1251dc604f0cSEdward Tomasz Napierala error = swap_pager_reserve(sc->object, 1252dc604f0cSEdward Tomasz Napierala oldpages, newpages - oldpages); 1253dc604f0cSEdward Tomasz Napierala if (error < 0) { 1254dc604f0cSEdward Tomasz Napierala swap_release_by_cred( 1255dc604f0cSEdward Tomasz Napierala IDX_TO_OFF(newpages - oldpages), 1256dc604f0cSEdward Tomasz Napierala sc->cred); 1257dc604f0cSEdward Tomasz Napierala return (EDOM); 1258dc604f0cSEdward Tomasz Napierala } 1259dc604f0cSEdward Tomasz Napierala } 126089f6b863SAttilio Rao VM_OBJECT_WLOCK(sc->object); 1261dc604f0cSEdward Tomasz Napierala sc->object->charge = IDX_TO_OFF(newpages); 1262dc604f0cSEdward Tomasz Napierala sc->object->size = newpages; 126389f6b863SAttilio Rao VM_OBJECT_WUNLOCK(sc->object); 1264dc604f0cSEdward Tomasz Napierala } 1265dc604f0cSEdward Tomasz Napierala break; 1266dc604f0cSEdward Tomasz Napierala default: 1267dc604f0cSEdward Tomasz Napierala return (EOPNOTSUPP); 1268dc604f0cSEdward Tomasz Napierala } 1269dc604f0cSEdward Tomasz Napierala 1270dc604f0cSEdward Tomasz Napierala sc->mediasize = mdio->md_mediasize; 1271dc604f0cSEdward Tomasz Napierala g_topology_lock(); 1272dc604f0cSEdward Tomasz Napierala g_resize_provider(sc->pp, sc->mediasize); 1273dc604f0cSEdward Tomasz Napierala g_topology_unlock(); 1274dc604f0cSEdward Tomasz Napierala return (0); 1275dc604f0cSEdward Tomasz Napierala } 1276dc604f0cSEdward Tomasz Napierala 1277dc604f0cSEdward Tomasz Napierala static int 1278b830359bSPawel Jakub Dawidek mdcreate_swap(struct md_s *sc, struct md_ioctl *mdio, struct thread *td) 12798f8def9eSPoul-Henning Kamp { 1280fcd57fbeSPawel Jakub Dawidek vm_ooffset_t npage; 1281fcd57fbeSPawel Jakub Dawidek int error; 12828f8def9eSPoul-Henning Kamp 12838f8def9eSPoul-Henning Kamp /* 12848f8def9eSPoul-Henning Kamp * Range check. Disallow negative sizes or any size less then the 12858f8def9eSPoul-Henning Kamp * size of a page. Then round to a page. 12868f8def9eSPoul-Henning Kamp */ 12878cb51643SJaakko Heinonen if (sc->mediasize <= 0 || (sc->mediasize % PAGE_SIZE) != 0) 12888f8def9eSPoul-Henning Kamp return (EDOM); 12898f8def9eSPoul-Henning Kamp 12908f8def9eSPoul-Henning Kamp /* 12918f8def9eSPoul-Henning Kamp * Allocate an OBJT_SWAP object. 12928f8def9eSPoul-Henning Kamp * 12938f8def9eSPoul-Henning Kamp * Note the truncation. 12948f8def9eSPoul-Henning Kamp */ 12958f8def9eSPoul-Henning Kamp 1296b830359bSPawel Jakub Dawidek npage = mdio->md_mediasize / PAGE_SIZE; 12979ed40643SPoul-Henning Kamp if (mdio->md_fwsectors != 0) 12989ed40643SPoul-Henning Kamp sc->fwsectors = mdio->md_fwsectors; 12999ed40643SPoul-Henning Kamp if (mdio->md_fwheads != 0) 13009ed40643SPoul-Henning Kamp sc->fwheads = mdio->md_fwheads; 1301fcd57fbeSPawel Jakub Dawidek sc->object = vm_pager_allocate(OBJT_SWAP, NULL, PAGE_SIZE * npage, 13023364c323SKonstantin Belousov VM_PROT_DEFAULT, 0, td->td_ucred); 1303812851b6SBrian Feldman if (sc->object == NULL) 1304812851b6SBrian Feldman return (ENOMEM); 1305dc604f0cSEdward Tomasz Napierala sc->flags = mdio->md_options & (MD_FORCE | MD_RESERVE); 13068f8def9eSPoul-Henning Kamp if (mdio->md_options & MD_RESERVE) { 1307fcd57fbeSPawel Jakub Dawidek if (swap_pager_reserve(sc->object, 0, npage) < 0) { 13083364c323SKonstantin Belousov error = EDOM; 13093364c323SKonstantin Belousov goto finish; 13108f8def9eSPoul-Henning Kamp } 13118f8def9eSPoul-Henning Kamp } 1312a854ed98SJohn Baldwin error = mdsetcred(sc, td->td_ucred); 13133364c323SKonstantin Belousov finish: 1314e3ed29a7SPawel Jakub Dawidek if (error != 0) { 13152eafd8b1SPawel Jakub Dawidek vm_object_deallocate(sc->object); 13162eafd8b1SPawel Jakub Dawidek sc->object = NULL; 13178f8def9eSPoul-Henning Kamp } 1318b830359bSPawel Jakub Dawidek return (error); 1319b3b3d1b7SPoul-Henning Kamp } 13208f8def9eSPoul-Henning Kamp 13219d4b5945SMaxim Sobolev 13229d4b5945SMaxim Sobolev static int 13239b00ca19SPoul-Henning Kamp xmdctlioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags, struct thread *td) 13248f8def9eSPoul-Henning Kamp { 13258f8def9eSPoul-Henning Kamp struct md_ioctl *mdio; 13268f8def9eSPoul-Henning Kamp struct md_s *sc; 1327b830359bSPawel Jakub Dawidek int error, i; 13288cb51643SJaakko Heinonen unsigned sectsize; 13298f8def9eSPoul-Henning Kamp 13308f8def9eSPoul-Henning Kamp if (md_debug) 13318f8def9eSPoul-Henning Kamp printf("mdctlioctl(%s %lx %p %x %p)\n", 1332b40ce416SJulian Elischer devtoname(dev), cmd, addr, flags, td); 13338f8def9eSPoul-Henning Kamp 13349b00ca19SPoul-Henning Kamp mdio = (struct md_ioctl *)addr; 13359b00ca19SPoul-Henning Kamp if (mdio->md_version != MDIOVERSION) 13369b00ca19SPoul-Henning Kamp return (EINVAL); 13379b00ca19SPoul-Henning Kamp 133853d745bcSDima Dorfman /* 133953d745bcSDima Dorfman * We assert the version number in the individual ioctl 134053d745bcSDima Dorfman * handlers instead of out here because (a) it is possible we 134153d745bcSDima Dorfman * may add another ioctl in the future which doesn't read an 134253d745bcSDima Dorfman * mdio, and (b) the correct return value for an unknown ioctl 134353d745bcSDima Dorfman * is ENOIOCTL, not EINVAL. 134453d745bcSDima Dorfman */ 13459b00ca19SPoul-Henning Kamp error = 0; 13468f8def9eSPoul-Henning Kamp switch (cmd) { 13478f8def9eSPoul-Henning Kamp case MDIOCATTACH: 13488f8def9eSPoul-Henning Kamp switch (mdio->md_type) { 13498f8def9eSPoul-Henning Kamp case MD_MALLOC: 13508f8def9eSPoul-Henning Kamp case MD_PRELOAD: 13518f8def9eSPoul-Henning Kamp case MD_VNODE: 13528f8def9eSPoul-Henning Kamp case MD_SWAP: 1353b830359bSPawel Jakub Dawidek break; 13548f8def9eSPoul-Henning Kamp default: 13558f8def9eSPoul-Henning Kamp return (EINVAL); 13568f8def9eSPoul-Henning Kamp } 13578cb51643SJaakko Heinonen if (mdio->md_sectorsize == 0) 13588cb51643SJaakko Heinonen sectsize = DEV_BSIZE; 13598cb51643SJaakko Heinonen else 13608cb51643SJaakko Heinonen sectsize = mdio->md_sectorsize; 13618cb51643SJaakko Heinonen if (sectsize > MAXPHYS || mdio->md_mediasize < sectsize) 13628cb51643SJaakko Heinonen return (EINVAL); 13637ee3c044SPawel Jakub Dawidek if (mdio->md_options & MD_AUTOUNIT) 1364947fc8deSPoul-Henning Kamp sc = mdnew(-1, &error, mdio->md_type); 1365f4e7c5a8SJaakko Heinonen else { 1366f4e7c5a8SJaakko Heinonen if (mdio->md_unit > INT_MAX) 1367f4e7c5a8SJaakko Heinonen return (EINVAL); 1368947fc8deSPoul-Henning Kamp sc = mdnew(mdio->md_unit, &error, mdio->md_type); 1369f4e7c5a8SJaakko Heinonen } 1370b830359bSPawel Jakub Dawidek if (sc == NULL) 13717ee3c044SPawel Jakub Dawidek return (error); 13727ee3c044SPawel Jakub Dawidek if (mdio->md_options & MD_AUTOUNIT) 13737ee3c044SPawel Jakub Dawidek mdio->md_unit = sc->unit; 1374b830359bSPawel Jakub Dawidek sc->mediasize = mdio->md_mediasize; 13758cb51643SJaakko Heinonen sc->sectorsize = sectsize; 1376b830359bSPawel Jakub Dawidek error = EDOOFUS; 1377b830359bSPawel Jakub Dawidek switch (sc->type) { 1378b830359bSPawel Jakub Dawidek case MD_MALLOC: 13799b00ca19SPoul-Henning Kamp sc->start = mdstart_malloc; 1380b830359bSPawel Jakub Dawidek error = mdcreate_malloc(sc, mdio); 1381b830359bSPawel Jakub Dawidek break; 1382b830359bSPawel Jakub Dawidek case MD_PRELOAD: 1383734e78dfSJaakko Heinonen /* 1384734e78dfSJaakko Heinonen * We disallow attaching preloaded memory disks via 1385734e78dfSJaakko Heinonen * ioctl. Preloaded memory disks are automatically 1386734e78dfSJaakko Heinonen * attached in g_md_init(). 1387734e78dfSJaakko Heinonen */ 1388734e78dfSJaakko Heinonen error = EOPNOTSUPP; 1389b830359bSPawel Jakub Dawidek break; 1390b830359bSPawel Jakub Dawidek case MD_VNODE: 13919b00ca19SPoul-Henning Kamp sc->start = mdstart_vnode; 1392b830359bSPawel Jakub Dawidek error = mdcreate_vnode(sc, mdio, td); 1393b830359bSPawel Jakub Dawidek break; 1394b830359bSPawel Jakub Dawidek case MD_SWAP: 13959b00ca19SPoul-Henning Kamp sc->start = mdstart_swap; 1396b830359bSPawel Jakub Dawidek error = mdcreate_swap(sc, mdio, td); 1397b830359bSPawel Jakub Dawidek break; 1398b830359bSPawel Jakub Dawidek } 1399b830359bSPawel Jakub Dawidek if (error != 0) { 1400b830359bSPawel Jakub Dawidek mddestroy(sc, td); 1401b830359bSPawel Jakub Dawidek return (error); 1402b830359bSPawel Jakub Dawidek } 14039b00ca19SPoul-Henning Kamp 14049b00ca19SPoul-Henning Kamp /* Prune off any residual fractional sector */ 14059b00ca19SPoul-Henning Kamp i = sc->mediasize % sc->sectorsize; 14069b00ca19SPoul-Henning Kamp sc->mediasize -= i; 14079b00ca19SPoul-Henning Kamp 1408b830359bSPawel Jakub Dawidek mdinit(sc); 1409b830359bSPawel Jakub Dawidek return (0); 14108f8def9eSPoul-Henning Kamp case MDIOCDETACH: 1411a9ebb311SEdward Tomasz Napierala if (mdio->md_mediasize != 0 || 1412a9ebb311SEdward Tomasz Napierala (mdio->md_options & ~MD_FORCE) != 0) 14138f8def9eSPoul-Henning Kamp return (EINVAL); 14149b00ca19SPoul-Henning Kamp 14159b00ca19SPoul-Henning Kamp sc = mdfind(mdio->md_unit); 14169b00ca19SPoul-Henning Kamp if (sc == NULL) 14179b00ca19SPoul-Henning Kamp return (ENOENT); 1418a9ebb311SEdward Tomasz Napierala if (sc->opencount != 0 && !(sc->flags & MD_FORCE) && 1419a9ebb311SEdward Tomasz Napierala !(mdio->md_options & MD_FORCE)) 14209b00ca19SPoul-Henning Kamp return (EBUSY); 14219b00ca19SPoul-Henning Kamp return (mddestroy(sc, td)); 1422dc604f0cSEdward Tomasz Napierala case MDIOCRESIZE: 1423dc604f0cSEdward Tomasz Napierala if ((mdio->md_options & ~(MD_FORCE | MD_RESERVE)) != 0) 1424dc604f0cSEdward Tomasz Napierala return (EINVAL); 1425dc604f0cSEdward Tomasz Napierala 1426dc604f0cSEdward Tomasz Napierala sc = mdfind(mdio->md_unit); 1427dc604f0cSEdward Tomasz Napierala if (sc == NULL) 1428dc604f0cSEdward Tomasz Napierala return (ENOENT); 14298cb51643SJaakko Heinonen if (mdio->md_mediasize < sc->sectorsize) 14308cb51643SJaakko Heinonen return (EINVAL); 1431dc604f0cSEdward Tomasz Napierala if (mdio->md_mediasize < sc->mediasize && 1432dc604f0cSEdward Tomasz Napierala !(sc->flags & MD_FORCE) && 1433dc604f0cSEdward Tomasz Napierala !(mdio->md_options & MD_FORCE)) 1434dc604f0cSEdward Tomasz Napierala return (EBUSY); 1435dc604f0cSEdward Tomasz Napierala return (mdresize(sc, mdio)); 1436174b5e9aSPoul-Henning Kamp case MDIOCQUERY: 1437174b5e9aSPoul-Henning Kamp sc = mdfind(mdio->md_unit); 1438174b5e9aSPoul-Henning Kamp if (sc == NULL) 1439174b5e9aSPoul-Henning Kamp return (ENOENT); 1440174b5e9aSPoul-Henning Kamp mdio->md_type = sc->type; 1441174b5e9aSPoul-Henning Kamp mdio->md_options = sc->flags; 1442b830359bSPawel Jakub Dawidek mdio->md_mediasize = sc->mediasize; 1443b830359bSPawel Jakub Dawidek mdio->md_sectorsize = sc->sectorsize; 14449b00ca19SPoul-Henning Kamp if (sc->type == MD_VNODE) 144588b5b78dSPawel Jakub Dawidek error = copyout(sc->file, mdio->md_file, 144688b5b78dSPawel Jakub Dawidek strlen(sc->file) + 1); 144788b5b78dSPawel Jakub Dawidek return (error); 144816bcbe8cSPoul-Henning Kamp case MDIOCLIST: 144916bcbe8cSPoul-Henning Kamp i = 1; 145016bcbe8cSPoul-Henning Kamp LIST_FOREACH(sc, &md_softc_list, list) { 145116bcbe8cSPoul-Henning Kamp if (i == MDNPAD - 1) 145216bcbe8cSPoul-Henning Kamp mdio->md_pad[i] = -1; 145316bcbe8cSPoul-Henning Kamp else 145416bcbe8cSPoul-Henning Kamp mdio->md_pad[i++] = sc->unit; 145516bcbe8cSPoul-Henning Kamp } 145616bcbe8cSPoul-Henning Kamp mdio->md_pad[0] = i - 1; 145716bcbe8cSPoul-Henning Kamp return (0); 14588f8def9eSPoul-Henning Kamp default: 14598f8def9eSPoul-Henning Kamp return (ENOIOCTL); 14608f8def9eSPoul-Henning Kamp }; 14619b00ca19SPoul-Henning Kamp } 14629b00ca19SPoul-Henning Kamp 14639b00ca19SPoul-Henning Kamp static int 14649b00ca19SPoul-Henning Kamp mdctlioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags, struct thread *td) 14659b00ca19SPoul-Henning Kamp { 14669b00ca19SPoul-Henning Kamp int error; 14679b00ca19SPoul-Henning Kamp 14689b00ca19SPoul-Henning Kamp sx_xlock(&md_sx); 14699b00ca19SPoul-Henning Kamp error = xmdctlioctl(dev, cmd, addr, flags, td); 14709b00ca19SPoul-Henning Kamp sx_xunlock(&md_sx); 14719b00ca19SPoul-Henning Kamp return (error); 14723f54a085SPoul-Henning Kamp } 14733f54a085SPoul-Henning Kamp 147400a6a3c6SPoul-Henning Kamp static void 1475341b240dSJaakko Heinonen md_preloaded(u_char *image, size_t length, const char *name) 1476637f671aSPoul-Henning Kamp { 1477637f671aSPoul-Henning Kamp struct md_s *sc; 14789b00ca19SPoul-Henning Kamp int error; 1479637f671aSPoul-Henning Kamp 1480947fc8deSPoul-Henning Kamp sc = mdnew(-1, &error, MD_PRELOAD); 1481637f671aSPoul-Henning Kamp if (sc == NULL) 1482637f671aSPoul-Henning Kamp return; 1483b830359bSPawel Jakub Dawidek sc->mediasize = length; 1484b830359bSPawel Jakub Dawidek sc->sectorsize = DEV_BSIZE; 1485637f671aSPoul-Henning Kamp sc->pl_ptr = image; 1486637f671aSPoul-Henning Kamp sc->pl_len = length; 14879b00ca19SPoul-Henning Kamp sc->start = mdstart_preload; 14885d4ca75eSLuigi Rizzo #ifdef MD_ROOT 1489637f671aSPoul-Henning Kamp if (sc->unit == 0) 149022ff74b2SMarcel Moolenaar rootdevnames[0] = MD_ROOT_FSTYPE ":/dev/md0"; 14915d4ca75eSLuigi Rizzo #endif 1492637f671aSPoul-Henning Kamp mdinit(sc); 1493341b240dSJaakko Heinonen if (name != NULL) { 1494341b240dSJaakko Heinonen printf("%s%d: Preloaded image <%s> %zd bytes at %p\n", 1495341b240dSJaakko Heinonen MD_NAME, sc->unit, name, length, image); 1496341b240dSJaakko Heinonen } 1497637f671aSPoul-Henning Kamp } 1498637f671aSPoul-Henning Kamp 1499637f671aSPoul-Henning Kamp static void 150019945697SPoul-Henning Kamp g_md_init(struct g_class *mp __unused) 150100a6a3c6SPoul-Henning Kamp { 150295f1a897SPoul-Henning Kamp caddr_t mod; 150395f1a897SPoul-Henning Kamp u_char *ptr, *name, *type; 150495f1a897SPoul-Henning Kamp unsigned len; 1505d12fc952SKonstantin Belousov int i; 1506d12fc952SKonstantin Belousov 1507d12fc952SKonstantin Belousov /* figure out log2(NINDIR) */ 1508d12fc952SKonstantin Belousov for (i = NINDIR, nshift = -1; i; nshift++) 1509d12fc952SKonstantin Belousov i >>= 1; 151095f1a897SPoul-Henning Kamp 15110a937206SPoul-Henning Kamp mod = NULL; 15129b00ca19SPoul-Henning Kamp sx_init(&md_sx, "MD config lock"); 15130a937206SPoul-Henning Kamp g_topology_unlock(); 1514f4e7c5a8SJaakko Heinonen md_uh = new_unrhdr(0, INT_MAX, NULL); 151571e4fff8SPoul-Henning Kamp #ifdef MD_ROOT_SIZE 15169b00ca19SPoul-Henning Kamp sx_xlock(&md_sx); 1517341b240dSJaakko Heinonen md_preloaded(mfs_root.start, sizeof(mfs_root.start), NULL); 15189b00ca19SPoul-Henning Kamp sx_xunlock(&md_sx); 151971e4fff8SPoul-Henning Kamp #endif 15209b00ca19SPoul-Henning Kamp /* XXX: are preload_* static or do they need Giant ? */ 152195f1a897SPoul-Henning Kamp while ((mod = preload_search_next_name(mod)) != NULL) { 152295f1a897SPoul-Henning Kamp name = (char *)preload_search_info(mod, MODINFO_NAME); 152395f1a897SPoul-Henning Kamp if (name == NULL) 152495f1a897SPoul-Henning Kamp continue; 15259b00ca19SPoul-Henning Kamp type = (char *)preload_search_info(mod, MODINFO_TYPE); 152695f1a897SPoul-Henning Kamp if (type == NULL) 152795f1a897SPoul-Henning Kamp continue; 152871e4fff8SPoul-Henning Kamp if (strcmp(type, "md_image") && strcmp(type, "mfs_root")) 152995f1a897SPoul-Henning Kamp continue; 15308d5ac6c3SMarcel Moolenaar ptr = preload_fetch_addr(mod); 15318d5ac6c3SMarcel Moolenaar len = preload_fetch_size(mod); 15328d5ac6c3SMarcel Moolenaar if (ptr != NULL && len != 0) { 15339b00ca19SPoul-Henning Kamp sx_xlock(&md_sx); 1534341b240dSJaakko Heinonen md_preloaded(ptr, len, name); 15359b00ca19SPoul-Henning Kamp sx_xunlock(&md_sx); 153695f1a897SPoul-Henning Kamp } 15378d5ac6c3SMarcel Moolenaar } 1538*59ec9023SKonstantin Belousov md_vnode_pbuf_freecnt = nswbuf / 10; 153906d425f9SEd Schouten status_dev = make_dev(&mdctl_cdevsw, INT_MAX, UID_ROOT, GID_WHEEL, 154010b0e058SDima Dorfman 0600, MDCTL_NAME); 15410eb14309SPoul-Henning Kamp g_topology_lock(); 154200a6a3c6SPoul-Henning Kamp } 154300a6a3c6SPoul-Henning Kamp 154419945697SPoul-Henning Kamp static void 1545c27a8954SWojciech A. Koszek g_md_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, 1546c27a8954SWojciech A. Koszek struct g_consumer *cp __unused, struct g_provider *pp) 1547c27a8954SWojciech A. Koszek { 1548c27a8954SWojciech A. Koszek struct md_s *mp; 1549c27a8954SWojciech A. Koszek char *type; 1550c27a8954SWojciech A. Koszek 1551c27a8954SWojciech A. Koszek mp = gp->softc; 1552c27a8954SWojciech A. Koszek if (mp == NULL) 1553c27a8954SWojciech A. Koszek return; 1554c27a8954SWojciech A. Koszek 1555c27a8954SWojciech A. Koszek switch (mp->type) { 1556c27a8954SWojciech A. Koszek case MD_MALLOC: 1557c27a8954SWojciech A. Koszek type = "malloc"; 1558c27a8954SWojciech A. Koszek break; 1559c27a8954SWojciech A. Koszek case MD_PRELOAD: 1560c27a8954SWojciech A. Koszek type = "preload"; 1561c27a8954SWojciech A. Koszek break; 1562c27a8954SWojciech A. Koszek case MD_VNODE: 1563c27a8954SWojciech A. Koszek type = "vnode"; 1564c27a8954SWojciech A. Koszek break; 1565c27a8954SWojciech A. Koszek case MD_SWAP: 1566c27a8954SWojciech A. Koszek type = "swap"; 1567c27a8954SWojciech A. Koszek break; 1568c27a8954SWojciech A. Koszek default: 1569c27a8954SWojciech A. Koszek type = "unknown"; 1570c27a8954SWojciech A. Koszek break; 1571c27a8954SWojciech A. Koszek } 1572c27a8954SWojciech A. Koszek 1573c27a8954SWojciech A. Koszek if (pp != NULL) { 1574c27a8954SWojciech A. Koszek if (indent == NULL) { 1575c27a8954SWojciech A. Koszek sbuf_printf(sb, " u %d", mp->unit); 1576c27a8954SWojciech A. Koszek sbuf_printf(sb, " s %ju", (uintmax_t) mp->sectorsize); 1577c27a8954SWojciech A. Koszek sbuf_printf(sb, " f %ju", (uintmax_t) mp->fwheads); 1578c27a8954SWojciech A. Koszek sbuf_printf(sb, " fs %ju", (uintmax_t) mp->fwsectors); 1579c27a8954SWojciech A. Koszek sbuf_printf(sb, " l %ju", (uintmax_t) mp->mediasize); 1580c27a8954SWojciech A. Koszek sbuf_printf(sb, " t %s", type); 1581c27a8954SWojciech A. Koszek if (mp->type == MD_VNODE && mp->vnode != NULL) 1582c27a8954SWojciech A. Koszek sbuf_printf(sb, " file %s", mp->file); 1583c27a8954SWojciech A. Koszek } else { 1584c27a8954SWojciech A. Koszek sbuf_printf(sb, "%s<unit>%d</unit>\n", indent, 1585c27a8954SWojciech A. Koszek mp->unit); 1586c27a8954SWojciech A. Koszek sbuf_printf(sb, "%s<sectorsize>%ju</sectorsize>\n", 1587c27a8954SWojciech A. Koszek indent, (uintmax_t) mp->sectorsize); 1588c27a8954SWojciech A. Koszek sbuf_printf(sb, "%s<fwheads>%ju</fwheads>\n", 1589c27a8954SWojciech A. Koszek indent, (uintmax_t) mp->fwheads); 1590c27a8954SWojciech A. Koszek sbuf_printf(sb, "%s<fwsectors>%ju</fwsectors>\n", 1591c27a8954SWojciech A. Koszek indent, (uintmax_t) mp->fwsectors); 1592c27a8954SWojciech A. Koszek sbuf_printf(sb, "%s<length>%ju</length>\n", 1593c27a8954SWojciech A. Koszek indent, (uintmax_t) mp->mediasize); 15941f192809SAndrey V. Elsukov sbuf_printf(sb, "%s<compression>%s</compression>\n", indent, 15951f192809SAndrey V. Elsukov (mp->flags & MD_COMPRESS) == 0 ? "off": "on"); 15961f192809SAndrey V. Elsukov sbuf_printf(sb, "%s<access>%s</access>\n", indent, 15971f192809SAndrey V. Elsukov (mp->flags & MD_READONLY) == 0 ? "read-write": 15981f192809SAndrey V. Elsukov "read-only"); 1599c27a8954SWojciech A. Koszek sbuf_printf(sb, "%s<type>%s</type>\n", indent, 1600c27a8954SWojciech A. Koszek type); 1601c27a8954SWojciech A. Koszek if (mp->type == MD_VNODE && mp->vnode != NULL) 1602c27a8954SWojciech A. Koszek sbuf_printf(sb, "%s<file>%s</file>\n", 1603c27a8954SWojciech A. Koszek indent, mp->file); 1604c27a8954SWojciech A. Koszek } 1605c27a8954SWojciech A. Koszek } 1606c27a8954SWojciech A. Koszek } 1607c27a8954SWojciech A. Koszek 1608c27a8954SWojciech A. Koszek static void 160919945697SPoul-Henning Kamp g_md_fini(struct g_class *mp __unused) 161057e9624eSPoul-Henning Kamp { 16119d4b5945SMaxim Sobolev 16129b00ca19SPoul-Henning Kamp sx_destroy(&md_sx); 161319945697SPoul-Henning Kamp if (status_dev != NULL) 161457e9624eSPoul-Henning Kamp destroy_dev(status_dev); 1615f4e7c5a8SJaakko Heinonen delete_unrhdr(md_uh); 161657e9624eSPoul-Henning Kamp } 1617