126453f35SJulian Elischer /*- 266cdbc28SPoul-Henning Kamp * Copyright (c) 1999-2002 Poul-Henning Kamp 326453f35SJulian Elischer * All rights reserved. 426453f35SJulian Elischer * 526453f35SJulian Elischer * Redistribution and use in source and binary forms, with or without 626453f35SJulian Elischer * modification, are permitted provided that the following conditions 726453f35SJulian Elischer * are met: 826453f35SJulian Elischer * 1. Redistributions of source code must retain the above copyright 926453f35SJulian Elischer * notice, this list of conditions and the following disclaimer. 1026453f35SJulian Elischer * 2. Redistributions in binary form must reproduce the above copyright 1126453f35SJulian Elischer * notice, this list of conditions and the following disclaimer in the 1226453f35SJulian Elischer * documentation and/or other materials provided with the distribution. 1326453f35SJulian Elischer * 1466cdbc28SPoul-Henning Kamp * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1566cdbc28SPoul-Henning Kamp * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1626453f35SJulian Elischer * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1766cdbc28SPoul-Henning Kamp * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1826453f35SJulian Elischer * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1926453f35SJulian Elischer * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2026453f35SJulian Elischer * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2126453f35SJulian Elischer * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2226453f35SJulian Elischer * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2326453f35SJulian Elischer * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2426453f35SJulian Elischer * SUCH DAMAGE. 2526453f35SJulian Elischer */ 2626453f35SJulian Elischer 27677b542eSDavid E. O'Brien #include <sys/cdefs.h> 28677b542eSDavid E. O'Brien __FBSDID("$FreeBSD$"); 29677b542eSDavid E. O'Brien 3026453f35SJulian Elischer #include <sys/param.h> 31698bfad7SPoul-Henning Kamp #include <sys/kernel.h> 32f8a760b3SJulian Elischer #include <sys/systm.h> 3302574b19SPoul-Henning Kamp #include <sys/bio.h> 341b567820SBrian Feldman #include <sys/lock.h> 351b567820SBrian Feldman #include <sys/mutex.h> 36b40ce416SJulian Elischer #include <sys/sysctl.h> 37ecbb00a2SDoug Rabson #include <sys/module.h> 38698bfad7SPoul-Henning Kamp #include <sys/malloc.h> 3926453f35SJulian Elischer #include <sys/conf.h> 401dfcbb0cSJulian Elischer #include <sys/vnode.h> 41698bfad7SPoul-Henning Kamp #include <sys/queue.h> 42b2941431SPoul-Henning Kamp #include <sys/poll.h> 43db901281SPoul-Henning Kamp #include <sys/ctype.h> 448e1f1df0SPoul-Henning Kamp #include <sys/tty.h> 450ef1c826SPoul-Henning Kamp #include <machine/stdarg.h> 461dfcbb0cSJulian Elischer 479ef295b7SPoul-Henning Kamp static MALLOC_DEFINE(M_DEVT, "cdev", "cdev storage"); 48698bfad7SPoul-Henning Kamp 49beea48b2SPoul-Henning Kamp /* Built at compile time from sys/conf/majors */ 50beea48b2SPoul-Henning Kamp extern unsigned char reserved_majors[256]; 51beea48b2SPoul-Henning Kamp 52a87b5350SPoul-Henning Kamp /* 539a98ae94SLukas Ertl * This is the number of hash-buckets. Experiments with 'real-life' 54f3732fd1SPoul-Henning Kamp * dev_t's show that a prime halfway between two powers of two works 55a87b5350SPoul-Henning Kamp * best. 56a87b5350SPoul-Henning Kamp */ 57698bfad7SPoul-Henning Kamp #define DEVT_HASH 83 58a87b5350SPoul-Henning Kamp 5989c9c53dSPoul-Henning Kamp /* The number of struct cdev *'s we can create before malloc(9) kick in. */ 60698bfad7SPoul-Henning Kamp #define DEVT_STASH 50 61698bfad7SPoul-Henning Kamp 62ca916247SPoul-Henning Kamp static struct cdev devt_stash[DEVT_STASH]; 63698bfad7SPoul-Henning Kamp 64ca916247SPoul-Henning Kamp static LIST_HEAD(, cdev) dev_hash[DEVT_HASH]; 65d137acccSPoul-Henning Kamp 66ca916247SPoul-Henning Kamp static LIST_HEAD(, cdev) dev_free; 6746eede00SPoul-Henning Kamp 68d137acccSPoul-Henning Kamp static int free_devt; 69d137acccSPoul-Henning Kamp SYSCTL_INT(_debug, OID_AUTO, free_devt, CTLFLAG_RW, &free_devt, 0, ""); 709dcbe240SPoul-Henning Kamp 71cd690b60SPoul-Henning Kamp static struct mtx devmtx; 7289c9c53dSPoul-Henning Kamp static void freedev(struct cdev *dev); 73f3732fd1SPoul-Henning Kamp static struct cdev *newdev(int x, int y); 74f3732fd1SPoul-Henning Kamp 75cd690b60SPoul-Henning Kamp 76a0e78d2eSPoul-Henning Kamp void 77a0e78d2eSPoul-Henning Kamp dev_lock(void) 78cd690b60SPoul-Henning Kamp { 79cd690b60SPoul-Henning Kamp if (!mtx_initialized(&devmtx)) 809ef295b7SPoul-Henning Kamp mtx_init(&devmtx, "cdev", NULL, MTX_DEF); 81cd690b60SPoul-Henning Kamp mtx_lock(&devmtx); 82cd690b60SPoul-Henning Kamp } 83cd690b60SPoul-Henning Kamp 84a0e78d2eSPoul-Henning Kamp void 85a0e78d2eSPoul-Henning Kamp dev_unlock(void) 86cd690b60SPoul-Henning Kamp { 872c15afd8SPoul-Henning Kamp 88cd690b60SPoul-Henning Kamp mtx_unlock(&devmtx); 89cd690b60SPoul-Henning Kamp } 90cd690b60SPoul-Henning Kamp 91cd690b60SPoul-Henning Kamp void 9289c9c53dSPoul-Henning Kamp dev_ref(struct cdev *dev) 93cd690b60SPoul-Henning Kamp { 942c15afd8SPoul-Henning Kamp 95a0e78d2eSPoul-Henning Kamp dev_lock(); 96cd690b60SPoul-Henning Kamp dev->si_refcount++; 97a0e78d2eSPoul-Henning Kamp dev_unlock(); 98cd690b60SPoul-Henning Kamp } 99cd690b60SPoul-Henning Kamp 100cd690b60SPoul-Henning Kamp void 10189c9c53dSPoul-Henning Kamp dev_rel(struct cdev *dev) 102cd690b60SPoul-Henning Kamp { 103a0e78d2eSPoul-Henning Kamp 104cd690b60SPoul-Henning Kamp dev->si_refcount--; 105cd690b60SPoul-Henning Kamp KASSERT(dev->si_refcount >= 0, 106cd690b60SPoul-Henning Kamp ("dev_rel(%s) gave negative count", devtoname(dev))); 107cd690b60SPoul-Henning Kamp if (dev->si_devsw == NULL && dev->si_refcount == 0) { 108cd690b60SPoul-Henning Kamp LIST_REMOVE(dev, si_list); 109cd690b60SPoul-Henning Kamp freedev(dev); 110cd690b60SPoul-Henning Kamp } 111cd690b60SPoul-Henning Kamp } 1122c15afd8SPoul-Henning Kamp struct cdevsw * 1132c15afd8SPoul-Henning Kamp dev_refthread(struct cdev *dev) 1142c15afd8SPoul-Henning Kamp { 1152c15afd8SPoul-Henning Kamp struct cdevsw *csw; 1162c15afd8SPoul-Henning Kamp 1172c15afd8SPoul-Henning Kamp mtx_assert(&devmtx, MA_NOTOWNED); 1182c15afd8SPoul-Henning Kamp dev_lock(); 1192c15afd8SPoul-Henning Kamp csw = dev->si_devsw; 1202c15afd8SPoul-Henning Kamp if (csw != NULL) 1212c15afd8SPoul-Henning Kamp dev->si_threadcount++; 1222c15afd8SPoul-Henning Kamp dev_unlock(); 1232c15afd8SPoul-Henning Kamp return (csw); 1242c15afd8SPoul-Henning Kamp } 1252c15afd8SPoul-Henning Kamp 1262c15afd8SPoul-Henning Kamp void 1272c15afd8SPoul-Henning Kamp dev_relthread(struct cdev *dev) 1282c15afd8SPoul-Henning Kamp { 1292c15afd8SPoul-Henning Kamp 1302c15afd8SPoul-Henning Kamp mtx_assert(&devmtx, MA_NOTOWNED); 1312c15afd8SPoul-Henning Kamp dev_lock(); 1322c15afd8SPoul-Henning Kamp dev->si_threadcount--; 1332c15afd8SPoul-Henning Kamp dev_unlock(); 1342c15afd8SPoul-Henning Kamp } 135cd690b60SPoul-Henning Kamp 136b2941431SPoul-Henning Kamp int 137b2941431SPoul-Henning Kamp nullop(void) 138b2941431SPoul-Henning Kamp { 139b2941431SPoul-Henning Kamp 140b2941431SPoul-Henning Kamp return (0); 141b2941431SPoul-Henning Kamp } 142b2941431SPoul-Henning Kamp 143b2941431SPoul-Henning Kamp int 144b2941431SPoul-Henning Kamp eopnotsupp(void) 145b2941431SPoul-Henning Kamp { 146b2941431SPoul-Henning Kamp 147b2941431SPoul-Henning Kamp return (EOPNOTSUPP); 148b2941431SPoul-Henning Kamp } 14902574b19SPoul-Henning Kamp 15002574b19SPoul-Henning Kamp static int 15102574b19SPoul-Henning Kamp enxio(void) 15202574b19SPoul-Henning Kamp { 15302574b19SPoul-Henning Kamp return (ENXIO); 15402574b19SPoul-Henning Kamp } 15502574b19SPoul-Henning Kamp 156b2941431SPoul-Henning Kamp static int 157b2941431SPoul-Henning Kamp enodev(void) 158b2941431SPoul-Henning Kamp { 159b2941431SPoul-Henning Kamp return (ENODEV); 160b2941431SPoul-Henning Kamp } 161b2941431SPoul-Henning Kamp 162b2941431SPoul-Henning Kamp /* Define a dead_cdevsw for use when devices leave unexpectedly. */ 163b2941431SPoul-Henning Kamp 16402574b19SPoul-Henning Kamp #define dead_open (d_open_t *)enxio 16502574b19SPoul-Henning Kamp #define dead_close (d_close_t *)enxio 16602574b19SPoul-Henning Kamp #define dead_read (d_read_t *)enxio 16702574b19SPoul-Henning Kamp #define dead_write (d_write_t *)enxio 16802574b19SPoul-Henning Kamp #define dead_ioctl (d_ioctl_t *)enxio 169b2941431SPoul-Henning Kamp #define dead_poll (d_poll_t *)enodev 170b2941431SPoul-Henning Kamp #define dead_mmap (d_mmap_t *)enodev 17102574b19SPoul-Henning Kamp 17202574b19SPoul-Henning Kamp static void 17302574b19SPoul-Henning Kamp dead_strategy(struct bio *bp) 17402574b19SPoul-Henning Kamp { 17502574b19SPoul-Henning Kamp 17602574b19SPoul-Henning Kamp biofinish(bp, NULL, ENXIO); 17702574b19SPoul-Henning Kamp } 17802574b19SPoul-Henning Kamp 1792c6b49f6SPoul-Henning Kamp #define dead_dump (dumper_t *)enxio 18002574b19SPoul-Henning Kamp #define dead_kqfilter (d_kqfilter_t *)enxio 18102574b19SPoul-Henning Kamp 18202574b19SPoul-Henning Kamp static struct cdevsw dead_cdevsw = { 183dc08ffecSPoul-Henning Kamp .d_version = D_VERSION, 184dc08ffecSPoul-Henning Kamp .d_flags = D_NEEDGIANT, /* XXX: does dead_strategy need this ? */ 1857ac40f5fSPoul-Henning Kamp .d_open = dead_open, 1867ac40f5fSPoul-Henning Kamp .d_close = dead_close, 1877ac40f5fSPoul-Henning Kamp .d_read = dead_read, 1887ac40f5fSPoul-Henning Kamp .d_write = dead_write, 1897ac40f5fSPoul-Henning Kamp .d_ioctl = dead_ioctl, 1907ac40f5fSPoul-Henning Kamp .d_poll = dead_poll, 1917ac40f5fSPoul-Henning Kamp .d_mmap = dead_mmap, 1927ac40f5fSPoul-Henning Kamp .d_strategy = dead_strategy, 1937ac40f5fSPoul-Henning Kamp .d_name = "dead", 1947ac40f5fSPoul-Henning Kamp .d_maj = 255, 1957ac40f5fSPoul-Henning Kamp .d_dump = dead_dump, 1967ac40f5fSPoul-Henning Kamp .d_kqfilter = dead_kqfilter 19702574b19SPoul-Henning Kamp }; 19802574b19SPoul-Henning Kamp 199b2941431SPoul-Henning Kamp /* Default methods if driver does not specify method */ 200b2941431SPoul-Henning Kamp 201b2941431SPoul-Henning Kamp #define null_open (d_open_t *)nullop 202b2941431SPoul-Henning Kamp #define null_close (d_close_t *)nullop 203b2941431SPoul-Henning Kamp #define no_read (d_read_t *)enodev 204b2941431SPoul-Henning Kamp #define no_write (d_write_t *)enodev 205b2941431SPoul-Henning Kamp #define no_ioctl (d_ioctl_t *)enodev 206b2941431SPoul-Henning Kamp #define no_mmap (d_mmap_t *)enodev 207ad3b9257SJohn-Mark Gurney #define no_kqfilter (d_kqfilter_t *)enodev 208b2941431SPoul-Henning Kamp 209b2941431SPoul-Henning Kamp static void 210b2941431SPoul-Henning Kamp no_strategy(struct bio *bp) 211b2941431SPoul-Henning Kamp { 212b2941431SPoul-Henning Kamp 213b2941431SPoul-Henning Kamp biofinish(bp, NULL, ENODEV); 214b2941431SPoul-Henning Kamp } 215b2941431SPoul-Henning Kamp 216b2941431SPoul-Henning Kamp static int 21789c9c53dSPoul-Henning Kamp no_poll(struct cdev *dev __unused, int events, struct thread *td __unused) 218b2941431SPoul-Henning Kamp { 219b2941431SPoul-Henning Kamp /* 220b2941431SPoul-Henning Kamp * Return true for read/write. If the user asked for something 221b2941431SPoul-Henning Kamp * special, return POLLNVAL, so that clients have a way of 222b2941431SPoul-Henning Kamp * determining reliably whether or not the extended 223b2941431SPoul-Henning Kamp * functionality is present without hard-coding knowledge 224b2941431SPoul-Henning Kamp * of specific filesystem implementations. 225b2941431SPoul-Henning Kamp * Stay in sync with vop_nopoll(). 226b2941431SPoul-Henning Kamp */ 227b2941431SPoul-Henning Kamp if (events & ~POLLSTANDARD) 228b2941431SPoul-Henning Kamp return (POLLNVAL); 229b2941431SPoul-Henning Kamp 230b2941431SPoul-Henning Kamp return (events & (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM)); 231b2941431SPoul-Henning Kamp } 232b2941431SPoul-Henning Kamp 233b2941431SPoul-Henning Kamp #define no_dump (dumper_t *)enodev 2344e4a7663SPoul-Henning Kamp 2352447bec8SPoul-Henning Kamp /* 23689c9c53dSPoul-Henning Kamp * struct cdev * and u_dev_t primitives 237bfbb9ce6SPoul-Henning Kamp */ 238bfbb9ce6SPoul-Henning Kamp 239bfbb9ce6SPoul-Henning Kamp int 24089c9c53dSPoul-Henning Kamp major(struct cdev *x) 241bfbb9ce6SPoul-Henning Kamp { 242f3732fd1SPoul-Henning Kamp if (x == NULL) 243f3732fd1SPoul-Henning Kamp return NODEV; 244698bfad7SPoul-Henning Kamp return((x->si_udev >> 8) & 0xff); 245bfbb9ce6SPoul-Henning Kamp } 246bfbb9ce6SPoul-Henning Kamp 247bfbb9ce6SPoul-Henning Kamp int 24889c9c53dSPoul-Henning Kamp minor(struct cdev *x) 249bfbb9ce6SPoul-Henning Kamp { 250f3732fd1SPoul-Henning Kamp if (x == NULL) 251f3732fd1SPoul-Henning Kamp return NODEV; 252698bfad7SPoul-Henning Kamp return(x->si_udev & 0xffff00ff); 253bfbb9ce6SPoul-Henning Kamp } 254bfbb9ce6SPoul-Henning Kamp 2559a27d579SPoul-Henning Kamp int 25689c9c53dSPoul-Henning Kamp dev2unit(struct cdev *x) 2579a27d579SPoul-Henning Kamp { 2589a27d579SPoul-Henning Kamp int i; 2599a27d579SPoul-Henning Kamp 260f3732fd1SPoul-Henning Kamp if (x == NULL) 261f3732fd1SPoul-Henning Kamp return NODEV; 2629a27d579SPoul-Henning Kamp i = minor(x); 2639a27d579SPoul-Henning Kamp return ((i & 0xff) | (i >> 8)); 2649a27d579SPoul-Henning Kamp } 2659a27d579SPoul-Henning Kamp 266b0d17ba6SPoul-Henning Kamp int 267b0d17ba6SPoul-Henning Kamp unit2minor(int unit) 268b0d17ba6SPoul-Henning Kamp { 269b0d17ba6SPoul-Henning Kamp 27015b6f00fSPoul-Henning Kamp KASSERT(unit <= 0xffffff, ("Invalid unit (%d) in unit2minor", unit)); 271b0d17ba6SPoul-Henning Kamp return ((unit & 0xff) | ((unit << 8) & ~0xffff)); 272b0d17ba6SPoul-Henning Kamp } 273b0d17ba6SPoul-Henning Kamp 27489c9c53dSPoul-Henning Kamp static struct cdev * 2753f54a085SPoul-Henning Kamp allocdev(void) 276bfbb9ce6SPoul-Henning Kamp { 277698bfad7SPoul-Henning Kamp static int stashed; 278ca916247SPoul-Henning Kamp struct cdev *si; 279698bfad7SPoul-Henning Kamp 2805ea98f59SPoul-Henning Kamp if (LIST_FIRST(&dev_free)) { 281d137acccSPoul-Henning Kamp si = LIST_FIRST(&dev_free); 282652d0472SPoul-Henning Kamp LIST_REMOVE(si, si_hash); 2835ea98f59SPoul-Henning Kamp } else if (stashed >= DEVT_STASH) { 284ca916247SPoul-Henning Kamp MALLOC(si, struct cdev *, sizeof(*si), M_DEVT, 2850c977c9cSPoul-Henning Kamp M_USE_RESERVE | M_ZERO | M_WAITOK); 286698bfad7SPoul-Henning Kamp } else { 287698bfad7SPoul-Henning Kamp si = devt_stash + stashed++; 2883344c5a1SPoul-Henning Kamp bzero(si, sizeof *si); 289d137acccSPoul-Henning Kamp si->si_flags |= SI_STASHED; 290698bfad7SPoul-Henning Kamp } 291237d2765SPoul-Henning Kamp si->__si_namebuf[0] = '\0'; 292237d2765SPoul-Henning Kamp si->si_name = si->__si_namebuf; 2933344c5a1SPoul-Henning Kamp LIST_INIT(&si->si_children); 2943f54a085SPoul-Henning Kamp return (si); 2953f54a085SPoul-Henning Kamp } 2963f54a085SPoul-Henning Kamp 29789c9c53dSPoul-Henning Kamp static struct cdev * 298f3732fd1SPoul-Henning Kamp newdev(int x, int y) 2993f54a085SPoul-Henning Kamp { 300ca916247SPoul-Henning Kamp struct cdev *si; 301f3732fd1SPoul-Henning Kamp dev_t udev; 3023f54a085SPoul-Henning Kamp int hash; 3033f54a085SPoul-Henning Kamp 304f3732fd1SPoul-Henning Kamp if (x == umajor(NODEV) && y == uminor(NODEV)) 305f3732fd1SPoul-Henning Kamp panic("newdev of NODEV"); 3063f54a085SPoul-Henning Kamp udev = (x << 8) | y; 3073f54a085SPoul-Henning Kamp hash = udev % DEVT_HASH; 3083f54a085SPoul-Henning Kamp LIST_FOREACH(si, &dev_hash[hash], si_hash) { 3093f54a085SPoul-Henning Kamp if (si->si_udev == udev) 3103f54a085SPoul-Henning Kamp return (si); 3113f54a085SPoul-Henning Kamp } 3123f54a085SPoul-Henning Kamp si = allocdev(); 313698bfad7SPoul-Henning Kamp si->si_udev = udev; 314d137acccSPoul-Henning Kamp LIST_INSERT_HEAD(&dev_hash[hash], si, si_hash); 315698bfad7SPoul-Henning Kamp return (si); 316bfbb9ce6SPoul-Henning Kamp } 317bfbb9ce6SPoul-Henning Kamp 318cd690b60SPoul-Henning Kamp static void 31989c9c53dSPoul-Henning Kamp freedev(struct cdev *dev) 320d137acccSPoul-Henning Kamp { 321d137acccSPoul-Henning Kamp 322d137acccSPoul-Henning Kamp if (dev->si_flags & SI_STASHED) { 323d137acccSPoul-Henning Kamp bzero(dev, sizeof(*dev)); 3243344c5a1SPoul-Henning Kamp dev->si_flags |= SI_STASHED; 325d137acccSPoul-Henning Kamp LIST_INSERT_HEAD(&dev_free, dev, si_hash); 326d137acccSPoul-Henning Kamp } else { 327d137acccSPoul-Henning Kamp FREE(dev, M_DEVT); 328d137acccSPoul-Henning Kamp } 329d137acccSPoul-Henning Kamp } 330d137acccSPoul-Henning Kamp 331f3732fd1SPoul-Henning Kamp dev_t 33289c9c53dSPoul-Henning Kamp dev2udev(struct cdev *x) 333bfbb9ce6SPoul-Henning Kamp { 334f3732fd1SPoul-Henning Kamp if (x == NULL) 335f3732fd1SPoul-Henning Kamp return (NODEV); 336698bfad7SPoul-Henning Kamp return (x->si_udev); 337bfbb9ce6SPoul-Henning Kamp } 338bfbb9ce6SPoul-Henning Kamp 33989c9c53dSPoul-Henning Kamp struct cdev * 340f3732fd1SPoul-Henning Kamp findcdev(dev_t udev) 341bfbb9ce6SPoul-Henning Kamp { 342816d62bbSPoul-Henning Kamp struct cdev *si; 343816d62bbSPoul-Henning Kamp int hash; 344fb01c24cSPoul-Henning Kamp 345f3732fd1SPoul-Henning Kamp if (udev == NODEV) 346f3732fd1SPoul-Henning Kamp return (NULL); 347816d62bbSPoul-Henning Kamp hash = udev % DEVT_HASH; 348816d62bbSPoul-Henning Kamp LIST_FOREACH(si, &dev_hash[hash], si_hash) { 349816d62bbSPoul-Henning Kamp if (si->si_udev == udev) 350816d62bbSPoul-Henning Kamp return (si); 351d21c632cSPoul-Henning Kamp } 352f3732fd1SPoul-Henning Kamp return (NULL); 353bfbb9ce6SPoul-Henning Kamp } 354bfbb9ce6SPoul-Henning Kamp 355bfbb9ce6SPoul-Henning Kamp int 356f3732fd1SPoul-Henning Kamp uminor(dev_t dev) 357bfbb9ce6SPoul-Henning Kamp { 358bfbb9ce6SPoul-Henning Kamp return (dev & 0xffff00ff); 359bfbb9ce6SPoul-Henning Kamp } 360bfbb9ce6SPoul-Henning Kamp 361bfbb9ce6SPoul-Henning Kamp int 362f3732fd1SPoul-Henning Kamp umajor(dev_t dev) 363bfbb9ce6SPoul-Henning Kamp { 364bfbb9ce6SPoul-Henning Kamp return ((dev & 0xff00) >> 8); 365bfbb9ce6SPoul-Henning Kamp } 366bfbb9ce6SPoul-Henning Kamp 3672a3faf2fSPoul-Henning Kamp static void 368b0b03348SPoul-Henning Kamp find_major(struct cdevsw *devsw) 3690ef1c826SPoul-Henning Kamp { 3700ef1c826SPoul-Henning Kamp int i; 3710ef1c826SPoul-Henning Kamp 372b0b03348SPoul-Henning Kamp for (i = NUMCDEVSW - 1; i > 0; i--) 373b0b03348SPoul-Henning Kamp if (reserved_majors[i] != i) 374b0b03348SPoul-Henning Kamp break; 375b0b03348SPoul-Henning Kamp KASSERT(i > 0, ("Out of major numbers (%s)", devsw->d_name)); 376b0b03348SPoul-Henning Kamp devsw->d_maj = i; 377b0b03348SPoul-Henning Kamp reserved_majors[i] = i; 378cd690b60SPoul-Henning Kamp devsw->d_flags |= D_ALLOCMAJ; 379cd690b60SPoul-Henning Kamp } 380cd690b60SPoul-Henning Kamp 381cd690b60SPoul-Henning Kamp static void 382cd690b60SPoul-Henning Kamp fini_cdevsw(struct cdevsw *devsw) 383cd690b60SPoul-Henning Kamp { 384cd690b60SPoul-Henning Kamp if (devsw->d_flags & D_ALLOCMAJ) { 385cd690b60SPoul-Henning Kamp reserved_majors[devsw->d_maj] = 0; 386cd690b60SPoul-Henning Kamp devsw->d_maj = MAJOR_AUTO; 387cd690b60SPoul-Henning Kamp devsw->d_flags &= ~D_ALLOCMAJ; 388652d0472SPoul-Henning Kamp } else if (devsw->d_maj == 0) 389652d0472SPoul-Henning Kamp devsw->d_maj = 256; 390652d0472SPoul-Henning Kamp devsw->d_flags &= ~D_INIT; 391b0b03348SPoul-Henning Kamp } 392b0b03348SPoul-Henning Kamp 393b0b03348SPoul-Henning Kamp static void 394b0b03348SPoul-Henning Kamp prep_cdevsw(struct cdevsw *devsw) 395b0b03348SPoul-Henning Kamp { 396b0b03348SPoul-Henning Kamp 397a0e78d2eSPoul-Henning Kamp dev_lock(); 398cd690b60SPoul-Henning Kamp 399cd690b60SPoul-Henning Kamp if (devsw->d_version != D_VERSION_00) { 400cd690b60SPoul-Henning Kamp printf( 401cd690b60SPoul-Henning Kamp "WARNING: Device driver \"%s\" has wrong version %s\n", 402cd690b60SPoul-Henning Kamp devsw->d_name, "and is disabled. Recompile KLD module."); 403cd690b60SPoul-Henning Kamp devsw->d_open = dead_open; 404cd690b60SPoul-Henning Kamp devsw->d_close = dead_close; 405cd690b60SPoul-Henning Kamp devsw->d_read = dead_read; 406cd690b60SPoul-Henning Kamp devsw->d_write = dead_write; 407cd690b60SPoul-Henning Kamp devsw->d_ioctl = dead_ioctl; 408cd690b60SPoul-Henning Kamp devsw->d_poll = dead_poll; 409cd690b60SPoul-Henning Kamp devsw->d_mmap = dead_mmap; 410cd690b60SPoul-Henning Kamp devsw->d_strategy = dead_strategy; 411cd690b60SPoul-Henning Kamp devsw->d_dump = dead_dump; 412cd690b60SPoul-Henning Kamp devsw->d_kqfilter = dead_kqfilter; 413cd690b60SPoul-Henning Kamp } 414cd690b60SPoul-Henning Kamp 4158e1f1df0SPoul-Henning Kamp if (devsw->d_flags & D_TTY) { 4163a95025fSPoul-Henning Kamp if (devsw->d_ioctl == NULL) devsw->d_ioctl = ttyioctl; 4178e1f1df0SPoul-Henning Kamp if (devsw->d_read == NULL) devsw->d_read = ttyread; 4188e1f1df0SPoul-Henning Kamp if (devsw->d_write == NULL) devsw->d_write = ttywrite; 4198e1f1df0SPoul-Henning Kamp if (devsw->d_kqfilter == NULL) devsw->d_kqfilter = ttykqfilter; 4208e1f1df0SPoul-Henning Kamp if (devsw->d_poll == NULL) devsw->d_poll = ttypoll; 4218e1f1df0SPoul-Henning Kamp } 4228e1f1df0SPoul-Henning Kamp 423b2941431SPoul-Henning Kamp if (devsw->d_open == NULL) devsw->d_open = null_open; 424b2941431SPoul-Henning Kamp if (devsw->d_close == NULL) devsw->d_close = null_close; 425b2941431SPoul-Henning Kamp if (devsw->d_read == NULL) devsw->d_read = no_read; 426b2941431SPoul-Henning Kamp if (devsw->d_write == NULL) devsw->d_write = no_write; 427b2941431SPoul-Henning Kamp if (devsw->d_ioctl == NULL) devsw->d_ioctl = no_ioctl; 428b2941431SPoul-Henning Kamp if (devsw->d_poll == NULL) devsw->d_poll = no_poll; 429b2941431SPoul-Henning Kamp if (devsw->d_mmap == NULL) devsw->d_mmap = no_mmap; 430b2941431SPoul-Henning Kamp if (devsw->d_strategy == NULL) devsw->d_strategy = no_strategy; 431b2941431SPoul-Henning Kamp if (devsw->d_dump == NULL) devsw->d_dump = no_dump; 432b2941431SPoul-Henning Kamp if (devsw->d_kqfilter == NULL) devsw->d_kqfilter = no_kqfilter; 433cd690b60SPoul-Henning Kamp 434cd690b60SPoul-Henning Kamp LIST_INIT(&devsw->d_devs); 435cd690b60SPoul-Henning Kamp 436cd690b60SPoul-Henning Kamp devsw->d_flags |= D_INIT; 437cd690b60SPoul-Henning Kamp 438beea48b2SPoul-Henning Kamp if (devsw->d_maj == MAJOR_AUTO) { 439b0b03348SPoul-Henning Kamp find_major(devsw); 44085f19dccSPoul-Henning Kamp } else { 44106a8bb90SPoul-Henning Kamp if (devsw->d_maj == 256) /* XXX: tty_cons.c is magic */ 44206a8bb90SPoul-Henning Kamp devsw->d_maj = 0; 44385f19dccSPoul-Henning Kamp KASSERT(devsw->d_maj >= 0 && devsw->d_maj < 256, 44485f19dccSPoul-Henning Kamp ("Invalid major (%d) in make_dev", devsw->d_maj)); 44585f19dccSPoul-Henning Kamp if (reserved_majors[devsw->d_maj] != devsw->d_maj) { 44685f19dccSPoul-Henning Kamp printf("WARNING: driver \"%s\" used %s %d\n", 44785f19dccSPoul-Henning Kamp devsw->d_name, "unreserved major device number", 44885f19dccSPoul-Henning Kamp devsw->d_maj); 44985f19dccSPoul-Henning Kamp reserved_majors[devsw->d_maj] = devsw->d_maj; 45085f19dccSPoul-Henning Kamp } 451beea48b2SPoul-Henning Kamp } 452a0e78d2eSPoul-Henning Kamp dev_unlock(); 4532a3faf2fSPoul-Henning Kamp } 45411586717SBrian Somers 45589c9c53dSPoul-Henning Kamp struct cdev * 456cd690b60SPoul-Henning Kamp make_dev(struct cdevsw *devsw, int minornr, uid_t uid, gid_t gid, int perms, const char *fmt, ...) 4572a3faf2fSPoul-Henning Kamp { 45889c9c53dSPoul-Henning Kamp struct cdev *dev; 4592a3faf2fSPoul-Henning Kamp va_list ap; 4602a3faf2fSPoul-Henning Kamp int i; 4612a3faf2fSPoul-Henning Kamp 462cd690b60SPoul-Henning Kamp KASSERT((minornr & ~0xffff00ff) == 0, 463cd690b60SPoul-Henning Kamp ("Invalid minor (0x%x) in make_dev", minornr)); 464cd690b60SPoul-Henning Kamp 465cd690b60SPoul-Henning Kamp if (!(devsw->d_flags & D_INIT)) 4662a3faf2fSPoul-Henning Kamp prep_cdevsw(devsw); 467f3732fd1SPoul-Henning Kamp dev = newdev(devsw->d_maj, minornr); 46898c469d4SPoul-Henning Kamp if (dev->si_flags & SI_CHEAPCLONE && 46998c469d4SPoul-Henning Kamp dev->si_flags & SI_NAMED && 47098c469d4SPoul-Henning Kamp dev->si_devsw == devsw) { 47198c469d4SPoul-Henning Kamp /* 47298c469d4SPoul-Henning Kamp * This is allowed as it removes races and generally 47398c469d4SPoul-Henning Kamp * simplifies cloning devices. 474cd690b60SPoul-Henning Kamp * XXX: still ?? 47598c469d4SPoul-Henning Kamp */ 47698c469d4SPoul-Henning Kamp return (dev); 47798c469d4SPoul-Henning Kamp } 478a0e78d2eSPoul-Henning Kamp dev_lock(); 479cd690b60SPoul-Henning Kamp KASSERT(!(dev->si_flags & SI_NAMED), 480cd690b60SPoul-Henning Kamp ("make_dev() by driver %s on pre-existing device (maj=%d, min=%d, name=%s)", 481cd690b60SPoul-Henning Kamp devsw->d_name, major(dev), minor(dev), devtoname(dev))); 482cd690b60SPoul-Henning Kamp 4830ef1c826SPoul-Henning Kamp va_start(ap, fmt); 4846334a663SPoul-Henning Kamp i = vsnrprintf(dev->__si_namebuf, sizeof dev->__si_namebuf, 32, fmt, ap); 4856334a663SPoul-Henning Kamp if (i > (sizeof dev->__si_namebuf - 1)) { 4862e4db7cfSPawel Jakub Dawidek printf("WARNING: Device name truncated! (%s)\n", 4876334a663SPoul-Henning Kamp dev->__si_namebuf); 4886334a663SPoul-Henning Kamp } 4890ef1c826SPoul-Henning Kamp va_end(ap); 4900ef1c826SPoul-Henning Kamp dev->si_devsw = devsw; 4913f54a085SPoul-Henning Kamp dev->si_uid = uid; 4923f54a085SPoul-Henning Kamp dev->si_gid = gid; 4933f54a085SPoul-Henning Kamp dev->si_mode = perms; 4945ef2707eSPoul-Henning Kamp dev->si_flags |= SI_NAMED; 4951744fcd0SJulian Elischer 496cd690b60SPoul-Henning Kamp LIST_INSERT_HEAD(&devsw->d_devs, dev, si_list); 4979285a87eSPoul-Henning Kamp devfs_create(dev); 498a0e78d2eSPoul-Henning Kamp dev_unlock(); 4993f54a085SPoul-Henning Kamp return (dev); 5003f54a085SPoul-Henning Kamp } 5013f54a085SPoul-Henning Kamp 5027e7c3f3fSJonathan Lemon int 50389c9c53dSPoul-Henning Kamp dev_named(struct cdev *pdev, const char *name) 5047e7c3f3fSJonathan Lemon { 50589c9c53dSPoul-Henning Kamp struct cdev *cdev; 5067e7c3f3fSJonathan Lemon 5077e7c3f3fSJonathan Lemon if (strcmp(devtoname(pdev), name) == 0) 5087e7c3f3fSJonathan Lemon return (1); 5097e7c3f3fSJonathan Lemon LIST_FOREACH(cdev, &pdev->si_children, si_siblings) 5107e7c3f3fSJonathan Lemon if (strcmp(devtoname(cdev), name) == 0) 5117e7c3f3fSJonathan Lemon return (1); 5127e7c3f3fSJonathan Lemon return (0); 5137e7c3f3fSJonathan Lemon } 5147e7c3f3fSJonathan Lemon 5153344c5a1SPoul-Henning Kamp void 51689c9c53dSPoul-Henning Kamp dev_depends(struct cdev *pdev, struct cdev *cdev) 5173344c5a1SPoul-Henning Kamp { 5183344c5a1SPoul-Henning Kamp 519a0e78d2eSPoul-Henning Kamp dev_lock(); 5203344c5a1SPoul-Henning Kamp cdev->si_parent = pdev; 5213344c5a1SPoul-Henning Kamp cdev->si_flags |= SI_CHILD; 5223344c5a1SPoul-Henning Kamp LIST_INSERT_HEAD(&pdev->si_children, cdev, si_siblings); 523a0e78d2eSPoul-Henning Kamp dev_unlock(); 5243344c5a1SPoul-Henning Kamp } 5253344c5a1SPoul-Henning Kamp 52689c9c53dSPoul-Henning Kamp struct cdev * 52789c9c53dSPoul-Henning Kamp make_dev_alias(struct cdev *pdev, const char *fmt, ...) 5283f54a085SPoul-Henning Kamp { 52989c9c53dSPoul-Henning Kamp struct cdev *dev; 5303f54a085SPoul-Henning Kamp va_list ap; 5313f54a085SPoul-Henning Kamp int i; 5323f54a085SPoul-Henning Kamp 5333f54a085SPoul-Henning Kamp dev = allocdev(); 534a0e78d2eSPoul-Henning Kamp dev_lock(); 5353f54a085SPoul-Henning Kamp dev->si_flags |= SI_ALIAS; 5365ef2707eSPoul-Henning Kamp dev->si_flags |= SI_NAMED; 5373f54a085SPoul-Henning Kamp va_start(ap, fmt); 5386334a663SPoul-Henning Kamp i = vsnrprintf(dev->__si_namebuf, sizeof dev->__si_namebuf, 32, fmt, ap); 5396334a663SPoul-Henning Kamp if (i > (sizeof dev->__si_namebuf - 1)) { 5402e4db7cfSPawel Jakub Dawidek printf("WARNING: Device name truncated! (%s)\n", 5416334a663SPoul-Henning Kamp dev->__si_namebuf); 5426334a663SPoul-Henning Kamp } 5433f54a085SPoul-Henning Kamp va_end(ap); 5443f54a085SPoul-Henning Kamp 5459285a87eSPoul-Henning Kamp devfs_create(dev); 546a0e78d2eSPoul-Henning Kamp dev_unlock(); 547cd690b60SPoul-Henning Kamp dev_depends(pdev, dev); 5480ef1c826SPoul-Henning Kamp return (dev); 5490ef1c826SPoul-Henning Kamp } 5500ef1c826SPoul-Henning Kamp 551cd690b60SPoul-Henning Kamp static void 55289c9c53dSPoul-Henning Kamp idestroy_dev(struct cdev *dev) 553d137acccSPoul-Henning Kamp { 554743cd76aSPoul-Henning Kamp struct cdevsw *csw; 555743cd76aSPoul-Henning Kamp 556743cd76aSPoul-Henning Kamp KASSERT(dev->si_flags & SI_NAMED, 557743cd76aSPoul-Henning Kamp ("WARNING: Driver mistake: destroy_dev on %d/%d\n", 558743cd76aSPoul-Henning Kamp major(dev), minor(dev))); 5595ef2707eSPoul-Henning Kamp 5609285a87eSPoul-Henning Kamp devfs_destroy(dev); 561cd690b60SPoul-Henning Kamp 562cd690b60SPoul-Henning Kamp /* Remove name marking */ 563b0b03348SPoul-Henning Kamp dev->si_flags &= ~SI_NAMED; 564b0b03348SPoul-Henning Kamp 565cd690b60SPoul-Henning Kamp /* If we are a child, remove us from the parents list */ 5663344c5a1SPoul-Henning Kamp if (dev->si_flags & SI_CHILD) { 5673344c5a1SPoul-Henning Kamp LIST_REMOVE(dev, si_siblings); 5683344c5a1SPoul-Henning Kamp dev->si_flags &= ~SI_CHILD; 5693344c5a1SPoul-Henning Kamp } 570cd690b60SPoul-Henning Kamp 571cd690b60SPoul-Henning Kamp /* Kill our children */ 5723344c5a1SPoul-Henning Kamp while (!LIST_EMPTY(&dev->si_children)) 573cd690b60SPoul-Henning Kamp idestroy_dev(LIST_FIRST(&dev->si_children)); 574cd690b60SPoul-Henning Kamp 575cd690b60SPoul-Henning Kamp /* Remove from clone list */ 576b0b03348SPoul-Henning Kamp if (dev->si_flags & SI_CLONELIST) { 577b0b03348SPoul-Henning Kamp LIST_REMOVE(dev, si_clone); 578b0b03348SPoul-Henning Kamp dev->si_flags &= ~SI_CLONELIST; 579b0b03348SPoul-Henning Kamp } 580cd690b60SPoul-Henning Kamp 581743cd76aSPoul-Henning Kamp csw = dev->si_devsw; 5821abf2c36SBrian Feldman dev->si_devsw = NULL; /* already NULL for SI_ALIAS */ 5831abf2c36SBrian Feldman while (csw != NULL && csw->d_purge != NULL && dev->si_threadcount) { 584743cd76aSPoul-Henning Kamp printf("Purging %lu threads from %s\n", 585743cd76aSPoul-Henning Kamp dev->si_threadcount, devtoname(dev)); 586743cd76aSPoul-Henning Kamp csw->d_purge(dev); 587743cd76aSPoul-Henning Kamp msleep(csw, &devmtx, PRIBIO, "devprg", hz/10); 588743cd76aSPoul-Henning Kamp } 5891abf2c36SBrian Feldman if (csw != NULL && csw->d_purge != NULL) 590a5993c33SPoul-Henning Kamp printf("All threads purged from %s\n", devtoname(dev)); 591743cd76aSPoul-Henning Kamp 592743cd76aSPoul-Henning Kamp dev->si_drv1 = 0; 593743cd76aSPoul-Henning Kamp dev->si_drv2 = 0; 594743cd76aSPoul-Henning Kamp bzero(&dev->__si_u, sizeof(dev->__si_u)); 595743cd76aSPoul-Henning Kamp 596cd690b60SPoul-Henning Kamp if (!(dev->si_flags & SI_ALIAS)) { 597cd690b60SPoul-Henning Kamp /* Remove from cdevsw list */ 598cd690b60SPoul-Henning Kamp LIST_REMOVE(dev, si_list); 599cd690b60SPoul-Henning Kamp 60089c9c53dSPoul-Henning Kamp /* If cdevsw has no struct cdev *'s, clean it */ 601a5993c33SPoul-Henning Kamp if (LIST_EMPTY(&csw->d_devs)) 602a5993c33SPoul-Henning Kamp fini_cdevsw(csw); 603cd690b60SPoul-Henning Kamp 604cd690b60SPoul-Henning Kamp LIST_REMOVE(dev, si_hash); 605cd690b60SPoul-Henning Kamp } 6065ef2707eSPoul-Henning Kamp dev->si_flags &= ~SI_ALIAS; 607743cd76aSPoul-Henning Kamp 608cd690b60SPoul-Henning Kamp if (dev->si_refcount > 0) { 609cd690b60SPoul-Henning Kamp LIST_INSERT_HEAD(&dead_cdevsw.d_devs, dev, si_list); 610cd690b60SPoul-Henning Kamp } else { 611d137acccSPoul-Henning Kamp freedev(dev); 612d137acccSPoul-Henning Kamp } 613cd690b60SPoul-Henning Kamp } 614cd690b60SPoul-Henning Kamp 615cd690b60SPoul-Henning Kamp void 61689c9c53dSPoul-Henning Kamp destroy_dev(struct cdev *dev) 617cd690b60SPoul-Henning Kamp { 618cd690b60SPoul-Henning Kamp 619a0e78d2eSPoul-Henning Kamp dev_lock(); 620cd690b60SPoul-Henning Kamp idestroy_dev(dev); 621a0e78d2eSPoul-Henning Kamp dev_unlock(); 622cd690b60SPoul-Henning Kamp } 623d137acccSPoul-Henning Kamp 624c32cc149SBruce Evans const char * 62589c9c53dSPoul-Henning Kamp devtoname(struct cdev *dev) 626b8e49f68SBill Fumerola { 627d137acccSPoul-Henning Kamp char *p; 6288ff33adbSPoul-Henning Kamp struct cdevsw *csw; 629c32cc149SBruce Evans int mynor; 630b8e49f68SBill Fumerola 631d137acccSPoul-Henning Kamp if (dev->si_name[0] == '#' || dev->si_name[0] == '\0') { 632d137acccSPoul-Henning Kamp p = dev->si_name; 6338ff33adbSPoul-Henning Kamp sprintf(p, "#%d", major(dev)); 6348ff33adbSPoul-Henning Kamp p += strlen(p); 6358ff33adbSPoul-Henning Kamp csw = dev_refthread(dev); 6368ff33adbSPoul-Henning Kamp if (csw != NULL) { 6378ff33adbSPoul-Henning Kamp sprintf(p, "(%s)", csw->d_name); 6388ff33adbSPoul-Henning Kamp dev_relthread(dev); 6398ff33adbSPoul-Henning Kamp } 640d137acccSPoul-Henning Kamp p += strlen(p); 641c32cc149SBruce Evans mynor = minor(dev); 642c32cc149SBruce Evans if (mynor < 0 || mynor > 255) 6438ff33adbSPoul-Henning Kamp sprintf(p, "/%#x", (u_int)mynor); 644c32cc149SBruce Evans else 6458ff33adbSPoul-Henning Kamp sprintf(p, "/%d", mynor); 646d137acccSPoul-Henning Kamp } 647b8e49f68SBill Fumerola return (dev->si_name); 648b8e49f68SBill Fumerola } 649db901281SPoul-Henning Kamp 650db901281SPoul-Henning Kamp int 65101de1b13SPoul-Henning Kamp dev_stdclone(char *name, char **namep, const char *stem, int *unit) 652db901281SPoul-Henning Kamp { 653db901281SPoul-Henning Kamp int u, i; 654db901281SPoul-Henning Kamp 655db901281SPoul-Henning Kamp i = strlen(stem); 65656700d46SBrian Somers if (bcmp(stem, name, i) != 0) 65756700d46SBrian Somers return (0); 658db901281SPoul-Henning Kamp if (!isdigit(name[i])) 659db901281SPoul-Henning Kamp return (0); 660db901281SPoul-Henning Kamp u = 0; 66110786074SPoul-Henning Kamp if (name[i] == '0' && isdigit(name[i+1])) 66210786074SPoul-Henning Kamp return (0); 663db901281SPoul-Henning Kamp while (isdigit(name[i])) { 664db901281SPoul-Henning Kamp u *= 10; 665db901281SPoul-Henning Kamp u += name[i++] - '0'; 666db901281SPoul-Henning Kamp } 667dab3d85fSBrian Feldman if (u > 0xffffff) 668dab3d85fSBrian Feldman return (0); 669db901281SPoul-Henning Kamp *unit = u; 670db901281SPoul-Henning Kamp if (namep) 671db901281SPoul-Henning Kamp *namep = &name[i]; 672db901281SPoul-Henning Kamp if (name[i]) 673db901281SPoul-Henning Kamp return (2); 674db901281SPoul-Henning Kamp return (1); 675db901281SPoul-Henning Kamp } 6768d25eb2cSPoul-Henning Kamp 6778d25eb2cSPoul-Henning Kamp /* 678b0b03348SPoul-Henning Kamp * Helper functions for cloning device drivers. 679b0b03348SPoul-Henning Kamp * 680b0b03348SPoul-Henning Kamp * The objective here is to make it unnecessary for the device drivers to 681b0b03348SPoul-Henning Kamp * use rman or similar to manage their unit number space. Due to the way 682b0b03348SPoul-Henning Kamp * we do "on-demand" devices, using rman or other "private" methods 683b0b03348SPoul-Henning Kamp * will be very tricky to lock down properly once we lock down this file. 684b0b03348SPoul-Henning Kamp * 6859a98ae94SLukas Ertl * Instead we give the drivers these routines which puts the struct cdev *'s 6869a98ae94SLukas Ertl * that are to be managed on their own list, and gives the driver the ability 687b0b03348SPoul-Henning Kamp * to ask for the first free unit number or a given specified unit number. 688b0b03348SPoul-Henning Kamp * 689b0b03348SPoul-Henning Kamp * In addition these routines support paired devices (pty, nmdm and similar) 690b0b03348SPoul-Henning Kamp * by respecting a number of "flag" bits in the minor number. 691b0b03348SPoul-Henning Kamp * 692b0b03348SPoul-Henning Kamp */ 693b0b03348SPoul-Henning Kamp 694b0b03348SPoul-Henning Kamp struct clonedevs { 695b0b03348SPoul-Henning Kamp LIST_HEAD(,cdev) head; 696b0b03348SPoul-Henning Kamp }; 697b0b03348SPoul-Henning Kamp 6989397290eSPoul-Henning Kamp void 6999397290eSPoul-Henning Kamp clone_setup(struct clonedevs **cdp) 7009397290eSPoul-Henning Kamp { 7019397290eSPoul-Henning Kamp 7029397290eSPoul-Henning Kamp *cdp = malloc(sizeof **cdp, M_DEVBUF, M_WAITOK | M_ZERO); 7039397290eSPoul-Henning Kamp LIST_INIT(&(*cdp)->head); 7049397290eSPoul-Henning Kamp } 7059397290eSPoul-Henning Kamp 706b0b03348SPoul-Henning Kamp int 70789c9c53dSPoul-Henning Kamp clone_create(struct clonedevs **cdp, struct cdevsw *csw, int *up, struct cdev **dp, u_int extra) 708b0b03348SPoul-Henning Kamp { 709b0b03348SPoul-Henning Kamp struct clonedevs *cd; 71089c9c53dSPoul-Henning Kamp struct cdev *dev, *dl, *de; 711b0b03348SPoul-Henning Kamp int unit, low, u; 712b0b03348SPoul-Henning Kamp 7139397290eSPoul-Henning Kamp KASSERT(*cdp != NULL, 7149397290eSPoul-Henning Kamp ("clone_setup() not called in driver \"%s\"", csw->d_name)); 715b0b03348SPoul-Henning Kamp KASSERT(!(extra & CLONE_UNITMASK), 716b0b03348SPoul-Henning Kamp ("Illegal extra bits (0x%x) in clone_create", extra)); 717b0b03348SPoul-Henning Kamp KASSERT(*up <= CLONE_UNITMASK, 718b0b03348SPoul-Henning Kamp ("Too high unit (0x%x) in clone_create", *up)); 719b0b03348SPoul-Henning Kamp 720b0b03348SPoul-Henning Kamp if (csw->d_maj == MAJOR_AUTO) 721b0b03348SPoul-Henning Kamp find_major(csw); 722b0b03348SPoul-Henning Kamp 723b0b03348SPoul-Henning Kamp /* 724b0b03348SPoul-Henning Kamp * Search the list for a lot of things in one go: 725b0b03348SPoul-Henning Kamp * A preexisting match is returned immediately. 726b0b03348SPoul-Henning Kamp * The lowest free unit number if we are passed -1, and the place 727b0b03348SPoul-Henning Kamp * in the list where we should insert that new element. 728b0b03348SPoul-Henning Kamp * The place to insert a specified unit number, if applicable 729b0b03348SPoul-Henning Kamp * the end of the list. 730b0b03348SPoul-Henning Kamp */ 731b0b03348SPoul-Henning Kamp unit = *up; 7328666b655SPoul-Henning Kamp low = extra; 733b0b03348SPoul-Henning Kamp de = dl = NULL; 7349397290eSPoul-Henning Kamp cd = *cdp; 735b0b03348SPoul-Henning Kamp LIST_FOREACH(dev, &cd->head, si_clone) { 736b0b03348SPoul-Henning Kamp u = dev2unit(dev); 737b0b03348SPoul-Henning Kamp if (u == (unit | extra)) { 738b0b03348SPoul-Henning Kamp *dp = dev; 739b0b03348SPoul-Henning Kamp return (0); 740b0b03348SPoul-Henning Kamp } 741b0b03348SPoul-Henning Kamp if (unit == -1 && u == low) { 742b0b03348SPoul-Henning Kamp low++; 743b0b03348SPoul-Henning Kamp de = dev; 744b0b03348SPoul-Henning Kamp continue; 745b0b03348SPoul-Henning Kamp } 7468666b655SPoul-Henning Kamp if (u > (unit | extra)) { 747b0b03348SPoul-Henning Kamp dl = dev; 748b0b03348SPoul-Henning Kamp break; 749b0b03348SPoul-Henning Kamp } 750b0b03348SPoul-Henning Kamp de = dev; 751b0b03348SPoul-Henning Kamp } 752b0b03348SPoul-Henning Kamp if (unit == -1) 7538666b655SPoul-Henning Kamp unit = low & CLONE_UNITMASK; 754f3732fd1SPoul-Henning Kamp dev = newdev(csw->d_maj, unit2minor(unit | extra)); 755b0b03348SPoul-Henning Kamp KASSERT(!(dev->si_flags & SI_CLONELIST), 756b0b03348SPoul-Henning Kamp ("Dev %p should not be on clonelist", dev)); 757b0b03348SPoul-Henning Kamp if (dl != NULL) 758b0b03348SPoul-Henning Kamp LIST_INSERT_BEFORE(dl, dev, si_clone); 759b0b03348SPoul-Henning Kamp else if (de != NULL) 760b0b03348SPoul-Henning Kamp LIST_INSERT_AFTER(de, dev, si_clone); 761b0b03348SPoul-Henning Kamp else 762b0b03348SPoul-Henning Kamp LIST_INSERT_HEAD(&cd->head, dev, si_clone); 763b0b03348SPoul-Henning Kamp dev->si_flags |= SI_CLONELIST; 764b0b03348SPoul-Henning Kamp *up = unit; 765b0b03348SPoul-Henning Kamp return (1); 766b0b03348SPoul-Henning Kamp } 767b0b03348SPoul-Henning Kamp 768b0b03348SPoul-Henning Kamp /* 769b0b03348SPoul-Henning Kamp * Kill everything still on the list. The driver should already have 77089c9c53dSPoul-Henning Kamp * disposed of any softc hung of the struct cdev *'s at this time. 771b0b03348SPoul-Henning Kamp */ 772b0b03348SPoul-Henning Kamp void 773b0b03348SPoul-Henning Kamp clone_cleanup(struct clonedevs **cdp) 774b0b03348SPoul-Henning Kamp { 77589c9c53dSPoul-Henning Kamp struct cdev *dev, *tdev; 776b0b03348SPoul-Henning Kamp struct clonedevs *cd; 777b0b03348SPoul-Henning Kamp 778b0b03348SPoul-Henning Kamp cd = *cdp; 779b0b03348SPoul-Henning Kamp if (cd == NULL) 780b0b03348SPoul-Henning Kamp return; 781b0b03348SPoul-Henning Kamp LIST_FOREACH_SAFE(dev, &cd->head, si_clone, tdev) { 782b0b03348SPoul-Henning Kamp KASSERT(dev->si_flags & SI_NAMED, 783b0b03348SPoul-Henning Kamp ("Driver has goofed in cloning underways udev %x", dev->si_udev)); 784b0b03348SPoul-Henning Kamp destroy_dev(dev); 785b0b03348SPoul-Henning Kamp } 786b0b03348SPoul-Henning Kamp free(cd, M_DEVBUF); 787b0b03348SPoul-Henning Kamp *cdp = NULL; 788b0b03348SPoul-Henning Kamp } 789b0b03348SPoul-Henning Kamp 790b0b03348SPoul-Henning Kamp /* 7919a98ae94SLukas Ertl * Helper sysctl for devname(3). We're given a struct cdev * and return 7928d25eb2cSPoul-Henning Kamp * the name, if any, registered by the device driver. 7938d25eb2cSPoul-Henning Kamp */ 7948d25eb2cSPoul-Henning Kamp static int 7958d25eb2cSPoul-Henning Kamp sysctl_devname(SYSCTL_HANDLER_ARGS) 7968d25eb2cSPoul-Henning Kamp { 7978d25eb2cSPoul-Henning Kamp int error; 798f3732fd1SPoul-Henning Kamp dev_t ud; 79989c9c53dSPoul-Henning Kamp struct cdev *dev; 8008d25eb2cSPoul-Henning Kamp 8018d25eb2cSPoul-Henning Kamp error = SYSCTL_IN(req, &ud, sizeof (ud)); 8028d25eb2cSPoul-Henning Kamp if (error) 8038d25eb2cSPoul-Henning Kamp return (error); 804f3732fd1SPoul-Henning Kamp if (ud == NODEV) 8051fd7b93fSPoul-Henning Kamp return(EINVAL); 806f3732fd1SPoul-Henning Kamp dev = findcdev(ud); 807f3732fd1SPoul-Henning Kamp if (dev == NULL) 8088d25eb2cSPoul-Henning Kamp error = ENOENT; 8098d25eb2cSPoul-Henning Kamp else 8108d25eb2cSPoul-Henning Kamp error = SYSCTL_OUT(req, dev->si_name, strlen(dev->si_name) + 1); 8118d25eb2cSPoul-Henning Kamp return (error); 8128d25eb2cSPoul-Henning Kamp } 8138d25eb2cSPoul-Henning Kamp 814fe4e3243SPoul-Henning Kamp SYSCTL_PROC(_kern, OID_AUTO, devname, CTLTYPE_OPAQUE|CTLFLAG_RW|CTLFLAG_ANYBODY, 8158d25eb2cSPoul-Henning Kamp NULL, 0, sysctl_devname, "", "devname(3) handler"); 816