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 101ba285125SPoul-Henning Kamp dev_rel(struct vnode *vp) 102cd690b60SPoul-Henning Kamp { 103ba285125SPoul-Henning Kamp struct cdev *dev; 104ba285125SPoul-Henning Kamp int flag; 105a0e78d2eSPoul-Henning Kamp 106ba285125SPoul-Henning Kamp dev = vp->v_rdev; 107ba285125SPoul-Henning Kamp mtx_assert(&devmtx, MA_NOTOWNED); 108ba285125SPoul-Henning Kamp dev_lock(); 109ba285125SPoul-Henning Kamp SLIST_REMOVE(&dev->si_hlist, vp, vnode, v_specnext); 110ba285125SPoul-Henning Kamp dev->si_usecount -= vp->v_usecount; 111ba285125SPoul-Henning Kamp vp->v_rdev = NULL; 112cd690b60SPoul-Henning Kamp dev->si_refcount--; 113cd690b60SPoul-Henning Kamp KASSERT(dev->si_refcount >= 0, 114cd690b60SPoul-Henning Kamp ("dev_rel(%s) gave negative count", devtoname(dev))); 115ba285125SPoul-Henning Kamp flag = 0; 116cd690b60SPoul-Henning Kamp if (dev->si_devsw == NULL && dev->si_refcount == 0) { 117cd690b60SPoul-Henning Kamp LIST_REMOVE(dev, si_list); 118ba285125SPoul-Henning Kamp flag = 1; 119ba285125SPoul-Henning Kamp } 120ba285125SPoul-Henning Kamp dev_unlock(); 121ba285125SPoul-Henning Kamp if (flag) 122cd690b60SPoul-Henning Kamp freedev(dev); 123ba285125SPoul-Henning Kamp return; 124cd690b60SPoul-Henning Kamp } 125ba285125SPoul-Henning Kamp 1262c15afd8SPoul-Henning Kamp struct cdevsw * 1272c15afd8SPoul-Henning Kamp dev_refthread(struct cdev *dev) 1282c15afd8SPoul-Henning Kamp { 1292c15afd8SPoul-Henning Kamp struct cdevsw *csw; 1302c15afd8SPoul-Henning Kamp 1312c15afd8SPoul-Henning Kamp mtx_assert(&devmtx, MA_NOTOWNED); 1322c15afd8SPoul-Henning Kamp dev_lock(); 1332c15afd8SPoul-Henning Kamp csw = dev->si_devsw; 1342c15afd8SPoul-Henning Kamp if (csw != NULL) 1352c15afd8SPoul-Henning Kamp dev->si_threadcount++; 1362c15afd8SPoul-Henning Kamp dev_unlock(); 1372c15afd8SPoul-Henning Kamp return (csw); 1382c15afd8SPoul-Henning Kamp } 1392c15afd8SPoul-Henning Kamp 1402c15afd8SPoul-Henning Kamp void 1412c15afd8SPoul-Henning Kamp dev_relthread(struct cdev *dev) 1422c15afd8SPoul-Henning Kamp { 1432c15afd8SPoul-Henning Kamp 1442c15afd8SPoul-Henning Kamp mtx_assert(&devmtx, MA_NOTOWNED); 1452c15afd8SPoul-Henning Kamp dev_lock(); 1462c15afd8SPoul-Henning Kamp dev->si_threadcount--; 1472c15afd8SPoul-Henning Kamp dev_unlock(); 1482c15afd8SPoul-Henning Kamp } 149cd690b60SPoul-Henning Kamp 150b2941431SPoul-Henning Kamp int 151b2941431SPoul-Henning Kamp nullop(void) 152b2941431SPoul-Henning Kamp { 153b2941431SPoul-Henning Kamp 154b2941431SPoul-Henning Kamp return (0); 155b2941431SPoul-Henning Kamp } 156b2941431SPoul-Henning Kamp 157b2941431SPoul-Henning Kamp int 158b2941431SPoul-Henning Kamp eopnotsupp(void) 159b2941431SPoul-Henning Kamp { 160b2941431SPoul-Henning Kamp 161b2941431SPoul-Henning Kamp return (EOPNOTSUPP); 162b2941431SPoul-Henning Kamp } 16302574b19SPoul-Henning Kamp 16402574b19SPoul-Henning Kamp static int 16502574b19SPoul-Henning Kamp enxio(void) 16602574b19SPoul-Henning Kamp { 16702574b19SPoul-Henning Kamp return (ENXIO); 16802574b19SPoul-Henning Kamp } 16902574b19SPoul-Henning Kamp 170b2941431SPoul-Henning Kamp static int 171b2941431SPoul-Henning Kamp enodev(void) 172b2941431SPoul-Henning Kamp { 173b2941431SPoul-Henning Kamp return (ENODEV); 174b2941431SPoul-Henning Kamp } 175b2941431SPoul-Henning Kamp 176b2941431SPoul-Henning Kamp /* Define a dead_cdevsw for use when devices leave unexpectedly. */ 177b2941431SPoul-Henning Kamp 17802574b19SPoul-Henning Kamp #define dead_open (d_open_t *)enxio 17902574b19SPoul-Henning Kamp #define dead_close (d_close_t *)enxio 18002574b19SPoul-Henning Kamp #define dead_read (d_read_t *)enxio 18102574b19SPoul-Henning Kamp #define dead_write (d_write_t *)enxio 18202574b19SPoul-Henning Kamp #define dead_ioctl (d_ioctl_t *)enxio 183b2941431SPoul-Henning Kamp #define dead_poll (d_poll_t *)enodev 184b2941431SPoul-Henning Kamp #define dead_mmap (d_mmap_t *)enodev 18502574b19SPoul-Henning Kamp 18602574b19SPoul-Henning Kamp static void 18702574b19SPoul-Henning Kamp dead_strategy(struct bio *bp) 18802574b19SPoul-Henning Kamp { 18902574b19SPoul-Henning Kamp 19002574b19SPoul-Henning Kamp biofinish(bp, NULL, ENXIO); 19102574b19SPoul-Henning Kamp } 19202574b19SPoul-Henning Kamp 1932c6b49f6SPoul-Henning Kamp #define dead_dump (dumper_t *)enxio 19402574b19SPoul-Henning Kamp #define dead_kqfilter (d_kqfilter_t *)enxio 19502574b19SPoul-Henning Kamp 19602574b19SPoul-Henning Kamp static struct cdevsw dead_cdevsw = { 197dc08ffecSPoul-Henning Kamp .d_version = D_VERSION, 198dc08ffecSPoul-Henning Kamp .d_flags = D_NEEDGIANT, /* XXX: does dead_strategy need this ? */ 1997ac40f5fSPoul-Henning Kamp .d_open = dead_open, 2007ac40f5fSPoul-Henning Kamp .d_close = dead_close, 2017ac40f5fSPoul-Henning Kamp .d_read = dead_read, 2027ac40f5fSPoul-Henning Kamp .d_write = dead_write, 2037ac40f5fSPoul-Henning Kamp .d_ioctl = dead_ioctl, 2047ac40f5fSPoul-Henning Kamp .d_poll = dead_poll, 2057ac40f5fSPoul-Henning Kamp .d_mmap = dead_mmap, 2067ac40f5fSPoul-Henning Kamp .d_strategy = dead_strategy, 2077ac40f5fSPoul-Henning Kamp .d_name = "dead", 2087ac40f5fSPoul-Henning Kamp .d_maj = 255, 2097ac40f5fSPoul-Henning Kamp .d_dump = dead_dump, 2107ac40f5fSPoul-Henning Kamp .d_kqfilter = dead_kqfilter 21102574b19SPoul-Henning Kamp }; 21202574b19SPoul-Henning Kamp 213b2941431SPoul-Henning Kamp /* Default methods if driver does not specify method */ 214b2941431SPoul-Henning Kamp 215b2941431SPoul-Henning Kamp #define null_open (d_open_t *)nullop 216b2941431SPoul-Henning Kamp #define null_close (d_close_t *)nullop 217b2941431SPoul-Henning Kamp #define no_read (d_read_t *)enodev 218b2941431SPoul-Henning Kamp #define no_write (d_write_t *)enodev 219b2941431SPoul-Henning Kamp #define no_ioctl (d_ioctl_t *)enodev 220b2941431SPoul-Henning Kamp #define no_mmap (d_mmap_t *)enodev 221ad3b9257SJohn-Mark Gurney #define no_kqfilter (d_kqfilter_t *)enodev 222b2941431SPoul-Henning Kamp 223b2941431SPoul-Henning Kamp static void 224b2941431SPoul-Henning Kamp no_strategy(struct bio *bp) 225b2941431SPoul-Henning Kamp { 226b2941431SPoul-Henning Kamp 227b2941431SPoul-Henning Kamp biofinish(bp, NULL, ENODEV); 228b2941431SPoul-Henning Kamp } 229b2941431SPoul-Henning Kamp 230b2941431SPoul-Henning Kamp static int 23189c9c53dSPoul-Henning Kamp no_poll(struct cdev *dev __unused, int events, struct thread *td __unused) 232b2941431SPoul-Henning Kamp { 233b2941431SPoul-Henning Kamp /* 234b2941431SPoul-Henning Kamp * Return true for read/write. If the user asked for something 235b2941431SPoul-Henning Kamp * special, return POLLNVAL, so that clients have a way of 236b2941431SPoul-Henning Kamp * determining reliably whether or not the extended 237b2941431SPoul-Henning Kamp * functionality is present without hard-coding knowledge 238b2941431SPoul-Henning Kamp * of specific filesystem implementations. 239b2941431SPoul-Henning Kamp * Stay in sync with vop_nopoll(). 240b2941431SPoul-Henning Kamp */ 241b2941431SPoul-Henning Kamp if (events & ~POLLSTANDARD) 242b2941431SPoul-Henning Kamp return (POLLNVAL); 243b2941431SPoul-Henning Kamp 244b2941431SPoul-Henning Kamp return (events & (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM)); 245b2941431SPoul-Henning Kamp } 246b2941431SPoul-Henning Kamp 247b2941431SPoul-Henning Kamp #define no_dump (dumper_t *)enodev 2484e4a7663SPoul-Henning Kamp 2492447bec8SPoul-Henning Kamp /* 25089c9c53dSPoul-Henning Kamp * struct cdev * and u_dev_t primitives 251bfbb9ce6SPoul-Henning Kamp */ 252bfbb9ce6SPoul-Henning Kamp 253bfbb9ce6SPoul-Henning Kamp int 25489c9c53dSPoul-Henning Kamp major(struct cdev *x) 255bfbb9ce6SPoul-Henning Kamp { 256f3732fd1SPoul-Henning Kamp if (x == NULL) 257f3732fd1SPoul-Henning Kamp return NODEV; 258698bfad7SPoul-Henning Kamp return((x->si_udev >> 8) & 0xff); 259bfbb9ce6SPoul-Henning Kamp } 260bfbb9ce6SPoul-Henning Kamp 261bfbb9ce6SPoul-Henning Kamp int 26289c9c53dSPoul-Henning Kamp minor(struct cdev *x) 263bfbb9ce6SPoul-Henning Kamp { 264f3732fd1SPoul-Henning Kamp if (x == NULL) 265f3732fd1SPoul-Henning Kamp return NODEV; 266698bfad7SPoul-Henning Kamp return(x->si_udev & 0xffff00ff); 267bfbb9ce6SPoul-Henning Kamp } 268bfbb9ce6SPoul-Henning Kamp 2699a27d579SPoul-Henning Kamp int 27089c9c53dSPoul-Henning Kamp dev2unit(struct cdev *x) 2719a27d579SPoul-Henning Kamp { 2729a27d579SPoul-Henning Kamp int i; 2739a27d579SPoul-Henning Kamp 274f3732fd1SPoul-Henning Kamp if (x == NULL) 275f3732fd1SPoul-Henning Kamp return NODEV; 2769a27d579SPoul-Henning Kamp i = minor(x); 2779a27d579SPoul-Henning Kamp return ((i & 0xff) | (i >> 8)); 2789a27d579SPoul-Henning Kamp } 2799a27d579SPoul-Henning Kamp 280b0d17ba6SPoul-Henning Kamp int 281b0d17ba6SPoul-Henning Kamp unit2minor(int unit) 282b0d17ba6SPoul-Henning Kamp { 283b0d17ba6SPoul-Henning Kamp 28415b6f00fSPoul-Henning Kamp KASSERT(unit <= 0xffffff, ("Invalid unit (%d) in unit2minor", unit)); 285b0d17ba6SPoul-Henning Kamp return ((unit & 0xff) | ((unit << 8) & ~0xffff)); 286b0d17ba6SPoul-Henning Kamp } 287b0d17ba6SPoul-Henning Kamp 28889c9c53dSPoul-Henning Kamp static struct cdev * 2893f54a085SPoul-Henning Kamp allocdev(void) 290bfbb9ce6SPoul-Henning Kamp { 291698bfad7SPoul-Henning Kamp static int stashed; 292ca916247SPoul-Henning Kamp struct cdev *si; 293698bfad7SPoul-Henning Kamp 2945ea98f59SPoul-Henning Kamp if (LIST_FIRST(&dev_free)) { 295d137acccSPoul-Henning Kamp si = LIST_FIRST(&dev_free); 296652d0472SPoul-Henning Kamp LIST_REMOVE(si, si_hash); 2975ea98f59SPoul-Henning Kamp } else if (stashed >= DEVT_STASH) { 298ca916247SPoul-Henning Kamp MALLOC(si, struct cdev *, sizeof(*si), M_DEVT, 2990c977c9cSPoul-Henning Kamp M_USE_RESERVE | M_ZERO | M_WAITOK); 300698bfad7SPoul-Henning Kamp } else { 301698bfad7SPoul-Henning Kamp si = devt_stash + stashed++; 3023344c5a1SPoul-Henning Kamp bzero(si, sizeof *si); 303d137acccSPoul-Henning Kamp si->si_flags |= SI_STASHED; 304698bfad7SPoul-Henning Kamp } 305237d2765SPoul-Henning Kamp si->__si_namebuf[0] = '\0'; 306237d2765SPoul-Henning Kamp si->si_name = si->__si_namebuf; 3073344c5a1SPoul-Henning Kamp LIST_INIT(&si->si_children); 3083f54a085SPoul-Henning Kamp return (si); 3093f54a085SPoul-Henning Kamp } 3103f54a085SPoul-Henning Kamp 31189c9c53dSPoul-Henning Kamp static struct cdev * 312f3732fd1SPoul-Henning Kamp newdev(int x, int y) 3133f54a085SPoul-Henning Kamp { 314ca916247SPoul-Henning Kamp struct cdev *si; 315f3732fd1SPoul-Henning Kamp dev_t udev; 3163f54a085SPoul-Henning Kamp int hash; 3173f54a085SPoul-Henning Kamp 318f3732fd1SPoul-Henning Kamp if (x == umajor(NODEV) && y == uminor(NODEV)) 319f3732fd1SPoul-Henning Kamp panic("newdev of NODEV"); 3203f54a085SPoul-Henning Kamp udev = (x << 8) | y; 3213f54a085SPoul-Henning Kamp hash = udev % DEVT_HASH; 3223f54a085SPoul-Henning Kamp LIST_FOREACH(si, &dev_hash[hash], si_hash) { 3233f54a085SPoul-Henning Kamp if (si->si_udev == udev) 3243f54a085SPoul-Henning Kamp return (si); 3253f54a085SPoul-Henning Kamp } 3263f54a085SPoul-Henning Kamp si = allocdev(); 327698bfad7SPoul-Henning Kamp si->si_udev = udev; 328d137acccSPoul-Henning Kamp LIST_INSERT_HEAD(&dev_hash[hash], si, si_hash); 329698bfad7SPoul-Henning Kamp return (si); 330bfbb9ce6SPoul-Henning Kamp } 331bfbb9ce6SPoul-Henning Kamp 332cd690b60SPoul-Henning Kamp static void 33389c9c53dSPoul-Henning Kamp freedev(struct cdev *dev) 334d137acccSPoul-Henning Kamp { 335d137acccSPoul-Henning Kamp 336d137acccSPoul-Henning Kamp if (dev->si_flags & SI_STASHED) { 337d137acccSPoul-Henning Kamp bzero(dev, sizeof(*dev)); 3383344c5a1SPoul-Henning Kamp dev->si_flags |= SI_STASHED; 339d137acccSPoul-Henning Kamp LIST_INSERT_HEAD(&dev_free, dev, si_hash); 340d137acccSPoul-Henning Kamp } else { 341d137acccSPoul-Henning Kamp FREE(dev, M_DEVT); 342d137acccSPoul-Henning Kamp } 343d137acccSPoul-Henning Kamp } 344d137acccSPoul-Henning Kamp 345f3732fd1SPoul-Henning Kamp dev_t 34689c9c53dSPoul-Henning Kamp dev2udev(struct cdev *x) 347bfbb9ce6SPoul-Henning Kamp { 348f3732fd1SPoul-Henning Kamp if (x == NULL) 349f3732fd1SPoul-Henning Kamp return (NODEV); 350698bfad7SPoul-Henning Kamp return (x->si_udev); 351bfbb9ce6SPoul-Henning Kamp } 352bfbb9ce6SPoul-Henning Kamp 35389c9c53dSPoul-Henning Kamp struct cdev * 354f3732fd1SPoul-Henning Kamp findcdev(dev_t udev) 355bfbb9ce6SPoul-Henning Kamp { 356816d62bbSPoul-Henning Kamp struct cdev *si; 357816d62bbSPoul-Henning Kamp int hash; 358fb01c24cSPoul-Henning Kamp 359f3732fd1SPoul-Henning Kamp if (udev == NODEV) 360f3732fd1SPoul-Henning Kamp return (NULL); 361816d62bbSPoul-Henning Kamp hash = udev % DEVT_HASH; 362816d62bbSPoul-Henning Kamp LIST_FOREACH(si, &dev_hash[hash], si_hash) { 363816d62bbSPoul-Henning Kamp if (si->si_udev == udev) 364816d62bbSPoul-Henning Kamp return (si); 365d21c632cSPoul-Henning Kamp } 366f3732fd1SPoul-Henning Kamp return (NULL); 367bfbb9ce6SPoul-Henning Kamp } 368bfbb9ce6SPoul-Henning Kamp 369bfbb9ce6SPoul-Henning Kamp int 370f3732fd1SPoul-Henning Kamp uminor(dev_t dev) 371bfbb9ce6SPoul-Henning Kamp { 372bfbb9ce6SPoul-Henning Kamp return (dev & 0xffff00ff); 373bfbb9ce6SPoul-Henning Kamp } 374bfbb9ce6SPoul-Henning Kamp 375bfbb9ce6SPoul-Henning Kamp int 376f3732fd1SPoul-Henning Kamp umajor(dev_t dev) 377bfbb9ce6SPoul-Henning Kamp { 378bfbb9ce6SPoul-Henning Kamp return ((dev & 0xff00) >> 8); 379bfbb9ce6SPoul-Henning Kamp } 380bfbb9ce6SPoul-Henning Kamp 3812a3faf2fSPoul-Henning Kamp static void 382b0b03348SPoul-Henning Kamp find_major(struct cdevsw *devsw) 3830ef1c826SPoul-Henning Kamp { 3840ef1c826SPoul-Henning Kamp int i; 3850ef1c826SPoul-Henning Kamp 386b0b03348SPoul-Henning Kamp for (i = NUMCDEVSW - 1; i > 0; i--) 387b0b03348SPoul-Henning Kamp if (reserved_majors[i] != i) 388b0b03348SPoul-Henning Kamp break; 389b0b03348SPoul-Henning Kamp KASSERT(i > 0, ("Out of major numbers (%s)", devsw->d_name)); 390b0b03348SPoul-Henning Kamp devsw->d_maj = i; 391b0b03348SPoul-Henning Kamp reserved_majors[i] = i; 392cd690b60SPoul-Henning Kamp devsw->d_flags |= D_ALLOCMAJ; 393cd690b60SPoul-Henning Kamp } 394cd690b60SPoul-Henning Kamp 395cd690b60SPoul-Henning Kamp static void 396cd690b60SPoul-Henning Kamp fini_cdevsw(struct cdevsw *devsw) 397cd690b60SPoul-Henning Kamp { 398cd690b60SPoul-Henning Kamp if (devsw->d_flags & D_ALLOCMAJ) { 399cd690b60SPoul-Henning Kamp reserved_majors[devsw->d_maj] = 0; 400cd690b60SPoul-Henning Kamp devsw->d_maj = MAJOR_AUTO; 401cd690b60SPoul-Henning Kamp devsw->d_flags &= ~D_ALLOCMAJ; 402652d0472SPoul-Henning Kamp } else if (devsw->d_maj == 0) 403652d0472SPoul-Henning Kamp devsw->d_maj = 256; 404652d0472SPoul-Henning Kamp devsw->d_flags &= ~D_INIT; 405b0b03348SPoul-Henning Kamp } 406b0b03348SPoul-Henning Kamp 407b0b03348SPoul-Henning Kamp static void 408b0b03348SPoul-Henning Kamp prep_cdevsw(struct cdevsw *devsw) 409b0b03348SPoul-Henning Kamp { 410b0b03348SPoul-Henning Kamp 411a0e78d2eSPoul-Henning Kamp dev_lock(); 412cd690b60SPoul-Henning Kamp 413cd690b60SPoul-Henning Kamp if (devsw->d_version != D_VERSION_00) { 414cd690b60SPoul-Henning Kamp printf( 415cd690b60SPoul-Henning Kamp "WARNING: Device driver \"%s\" has wrong version %s\n", 416cd690b60SPoul-Henning Kamp devsw->d_name, "and is disabled. Recompile KLD module."); 417cd690b60SPoul-Henning Kamp devsw->d_open = dead_open; 418cd690b60SPoul-Henning Kamp devsw->d_close = dead_close; 419cd690b60SPoul-Henning Kamp devsw->d_read = dead_read; 420cd690b60SPoul-Henning Kamp devsw->d_write = dead_write; 421cd690b60SPoul-Henning Kamp devsw->d_ioctl = dead_ioctl; 422cd690b60SPoul-Henning Kamp devsw->d_poll = dead_poll; 423cd690b60SPoul-Henning Kamp devsw->d_mmap = dead_mmap; 424cd690b60SPoul-Henning Kamp devsw->d_strategy = dead_strategy; 425cd690b60SPoul-Henning Kamp devsw->d_dump = dead_dump; 426cd690b60SPoul-Henning Kamp devsw->d_kqfilter = dead_kqfilter; 427cd690b60SPoul-Henning Kamp } 428cd690b60SPoul-Henning Kamp 4298e1f1df0SPoul-Henning Kamp if (devsw->d_flags & D_TTY) { 4303a95025fSPoul-Henning Kamp if (devsw->d_ioctl == NULL) devsw->d_ioctl = ttyioctl; 4318e1f1df0SPoul-Henning Kamp if (devsw->d_read == NULL) devsw->d_read = ttyread; 4328e1f1df0SPoul-Henning Kamp if (devsw->d_write == NULL) devsw->d_write = ttywrite; 4338e1f1df0SPoul-Henning Kamp if (devsw->d_kqfilter == NULL) devsw->d_kqfilter = ttykqfilter; 4348e1f1df0SPoul-Henning Kamp if (devsw->d_poll == NULL) devsw->d_poll = ttypoll; 4358e1f1df0SPoul-Henning Kamp } 4368e1f1df0SPoul-Henning Kamp 437b2941431SPoul-Henning Kamp if (devsw->d_open == NULL) devsw->d_open = null_open; 438b2941431SPoul-Henning Kamp if (devsw->d_close == NULL) devsw->d_close = null_close; 439b2941431SPoul-Henning Kamp if (devsw->d_read == NULL) devsw->d_read = no_read; 440b2941431SPoul-Henning Kamp if (devsw->d_write == NULL) devsw->d_write = no_write; 441b2941431SPoul-Henning Kamp if (devsw->d_ioctl == NULL) devsw->d_ioctl = no_ioctl; 442b2941431SPoul-Henning Kamp if (devsw->d_poll == NULL) devsw->d_poll = no_poll; 443b2941431SPoul-Henning Kamp if (devsw->d_mmap == NULL) devsw->d_mmap = no_mmap; 444b2941431SPoul-Henning Kamp if (devsw->d_strategy == NULL) devsw->d_strategy = no_strategy; 445b2941431SPoul-Henning Kamp if (devsw->d_dump == NULL) devsw->d_dump = no_dump; 446b2941431SPoul-Henning Kamp if (devsw->d_kqfilter == NULL) devsw->d_kqfilter = no_kqfilter; 447cd690b60SPoul-Henning Kamp 448cd690b60SPoul-Henning Kamp LIST_INIT(&devsw->d_devs); 449cd690b60SPoul-Henning Kamp 450cd690b60SPoul-Henning Kamp devsw->d_flags |= D_INIT; 451cd690b60SPoul-Henning Kamp 452beea48b2SPoul-Henning Kamp if (devsw->d_maj == MAJOR_AUTO) { 453b0b03348SPoul-Henning Kamp find_major(devsw); 45485f19dccSPoul-Henning Kamp } else { 45506a8bb90SPoul-Henning Kamp if (devsw->d_maj == 256) /* XXX: tty_cons.c is magic */ 45606a8bb90SPoul-Henning Kamp devsw->d_maj = 0; 45785f19dccSPoul-Henning Kamp KASSERT(devsw->d_maj >= 0 && devsw->d_maj < 256, 45885f19dccSPoul-Henning Kamp ("Invalid major (%d) in make_dev", devsw->d_maj)); 45985f19dccSPoul-Henning Kamp if (reserved_majors[devsw->d_maj] != devsw->d_maj) { 46085f19dccSPoul-Henning Kamp printf("WARNING: driver \"%s\" used %s %d\n", 46185f19dccSPoul-Henning Kamp devsw->d_name, "unreserved major device number", 46285f19dccSPoul-Henning Kamp devsw->d_maj); 46385f19dccSPoul-Henning Kamp reserved_majors[devsw->d_maj] = devsw->d_maj; 46485f19dccSPoul-Henning Kamp } 465beea48b2SPoul-Henning Kamp } 466a0e78d2eSPoul-Henning Kamp dev_unlock(); 4672a3faf2fSPoul-Henning Kamp } 46811586717SBrian Somers 46989c9c53dSPoul-Henning Kamp struct cdev * 470cd690b60SPoul-Henning Kamp make_dev(struct cdevsw *devsw, int minornr, uid_t uid, gid_t gid, int perms, const char *fmt, ...) 4712a3faf2fSPoul-Henning Kamp { 47289c9c53dSPoul-Henning Kamp struct cdev *dev; 4732a3faf2fSPoul-Henning Kamp va_list ap; 4742a3faf2fSPoul-Henning Kamp int i; 4752a3faf2fSPoul-Henning Kamp 476cd690b60SPoul-Henning Kamp KASSERT((minornr & ~0xffff00ff) == 0, 477cd690b60SPoul-Henning Kamp ("Invalid minor (0x%x) in make_dev", minornr)); 478cd690b60SPoul-Henning Kamp 479cd690b60SPoul-Henning Kamp if (!(devsw->d_flags & D_INIT)) 4802a3faf2fSPoul-Henning Kamp prep_cdevsw(devsw); 481f3732fd1SPoul-Henning Kamp dev = newdev(devsw->d_maj, minornr); 48298c469d4SPoul-Henning Kamp if (dev->si_flags & SI_CHEAPCLONE && 48398c469d4SPoul-Henning Kamp dev->si_flags & SI_NAMED && 48498c469d4SPoul-Henning Kamp dev->si_devsw == devsw) { 48598c469d4SPoul-Henning Kamp /* 48698c469d4SPoul-Henning Kamp * This is allowed as it removes races and generally 48798c469d4SPoul-Henning Kamp * simplifies cloning devices. 488cd690b60SPoul-Henning Kamp * XXX: still ?? 48998c469d4SPoul-Henning Kamp */ 49098c469d4SPoul-Henning Kamp return (dev); 49198c469d4SPoul-Henning Kamp } 492a0e78d2eSPoul-Henning Kamp dev_lock(); 493cd690b60SPoul-Henning Kamp KASSERT(!(dev->si_flags & SI_NAMED), 494cd690b60SPoul-Henning Kamp ("make_dev() by driver %s on pre-existing device (maj=%d, min=%d, name=%s)", 495cd690b60SPoul-Henning Kamp devsw->d_name, major(dev), minor(dev), devtoname(dev))); 496cd690b60SPoul-Henning Kamp 4970ef1c826SPoul-Henning Kamp va_start(ap, fmt); 4986334a663SPoul-Henning Kamp i = vsnrprintf(dev->__si_namebuf, sizeof dev->__si_namebuf, 32, fmt, ap); 4996334a663SPoul-Henning Kamp if (i > (sizeof dev->__si_namebuf - 1)) { 5002e4db7cfSPawel Jakub Dawidek printf("WARNING: Device name truncated! (%s)\n", 5016334a663SPoul-Henning Kamp dev->__si_namebuf); 5026334a663SPoul-Henning Kamp } 5030ef1c826SPoul-Henning Kamp va_end(ap); 5040ef1c826SPoul-Henning Kamp dev->si_devsw = devsw; 5053f54a085SPoul-Henning Kamp dev->si_uid = uid; 5063f54a085SPoul-Henning Kamp dev->si_gid = gid; 5073f54a085SPoul-Henning Kamp dev->si_mode = perms; 5085ef2707eSPoul-Henning Kamp dev->si_flags |= SI_NAMED; 5091744fcd0SJulian Elischer 510cd690b60SPoul-Henning Kamp LIST_INSERT_HEAD(&devsw->d_devs, dev, si_list); 5119285a87eSPoul-Henning Kamp devfs_create(dev); 512a0e78d2eSPoul-Henning Kamp dev_unlock(); 5133f54a085SPoul-Henning Kamp return (dev); 5143f54a085SPoul-Henning Kamp } 5153f54a085SPoul-Henning Kamp 5167e7c3f3fSJonathan Lemon int 51789c9c53dSPoul-Henning Kamp dev_named(struct cdev *pdev, const char *name) 5187e7c3f3fSJonathan Lemon { 51989c9c53dSPoul-Henning Kamp struct cdev *cdev; 5207e7c3f3fSJonathan Lemon 5217e7c3f3fSJonathan Lemon if (strcmp(devtoname(pdev), name) == 0) 5227e7c3f3fSJonathan Lemon return (1); 5237e7c3f3fSJonathan Lemon LIST_FOREACH(cdev, &pdev->si_children, si_siblings) 5247e7c3f3fSJonathan Lemon if (strcmp(devtoname(cdev), name) == 0) 5257e7c3f3fSJonathan Lemon return (1); 5267e7c3f3fSJonathan Lemon return (0); 5277e7c3f3fSJonathan Lemon } 5287e7c3f3fSJonathan Lemon 5293344c5a1SPoul-Henning Kamp void 53089c9c53dSPoul-Henning Kamp dev_depends(struct cdev *pdev, struct cdev *cdev) 5313344c5a1SPoul-Henning Kamp { 5323344c5a1SPoul-Henning Kamp 533a0e78d2eSPoul-Henning Kamp dev_lock(); 5343344c5a1SPoul-Henning Kamp cdev->si_parent = pdev; 5353344c5a1SPoul-Henning Kamp cdev->si_flags |= SI_CHILD; 5363344c5a1SPoul-Henning Kamp LIST_INSERT_HEAD(&pdev->si_children, cdev, si_siblings); 537a0e78d2eSPoul-Henning Kamp dev_unlock(); 5383344c5a1SPoul-Henning Kamp } 5393344c5a1SPoul-Henning Kamp 54089c9c53dSPoul-Henning Kamp struct cdev * 54189c9c53dSPoul-Henning Kamp make_dev_alias(struct cdev *pdev, const char *fmt, ...) 5423f54a085SPoul-Henning Kamp { 54389c9c53dSPoul-Henning Kamp struct cdev *dev; 5443f54a085SPoul-Henning Kamp va_list ap; 5453f54a085SPoul-Henning Kamp int i; 5463f54a085SPoul-Henning Kamp 5473f54a085SPoul-Henning Kamp dev = allocdev(); 548a0e78d2eSPoul-Henning Kamp dev_lock(); 5493f54a085SPoul-Henning Kamp dev->si_flags |= SI_ALIAS; 5505ef2707eSPoul-Henning Kamp dev->si_flags |= SI_NAMED; 5513f54a085SPoul-Henning Kamp va_start(ap, fmt); 5526334a663SPoul-Henning Kamp i = vsnrprintf(dev->__si_namebuf, sizeof dev->__si_namebuf, 32, fmt, ap); 5536334a663SPoul-Henning Kamp if (i > (sizeof dev->__si_namebuf - 1)) { 5542e4db7cfSPawel Jakub Dawidek printf("WARNING: Device name truncated! (%s)\n", 5556334a663SPoul-Henning Kamp dev->__si_namebuf); 5566334a663SPoul-Henning Kamp } 5573f54a085SPoul-Henning Kamp va_end(ap); 5583f54a085SPoul-Henning Kamp 5599285a87eSPoul-Henning Kamp devfs_create(dev); 560a0e78d2eSPoul-Henning Kamp dev_unlock(); 561cd690b60SPoul-Henning Kamp dev_depends(pdev, dev); 5620ef1c826SPoul-Henning Kamp return (dev); 5630ef1c826SPoul-Henning Kamp } 5640ef1c826SPoul-Henning Kamp 565cd690b60SPoul-Henning Kamp static void 56689c9c53dSPoul-Henning Kamp idestroy_dev(struct cdev *dev) 567d137acccSPoul-Henning Kamp { 568743cd76aSPoul-Henning Kamp struct cdevsw *csw; 569743cd76aSPoul-Henning Kamp 570743cd76aSPoul-Henning Kamp KASSERT(dev->si_flags & SI_NAMED, 571743cd76aSPoul-Henning Kamp ("WARNING: Driver mistake: destroy_dev on %d/%d\n", 572743cd76aSPoul-Henning Kamp major(dev), minor(dev))); 5735ef2707eSPoul-Henning Kamp 5749285a87eSPoul-Henning Kamp devfs_destroy(dev); 575cd690b60SPoul-Henning Kamp 576cd690b60SPoul-Henning Kamp /* Remove name marking */ 577b0b03348SPoul-Henning Kamp dev->si_flags &= ~SI_NAMED; 578b0b03348SPoul-Henning Kamp 579cd690b60SPoul-Henning Kamp /* If we are a child, remove us from the parents list */ 5803344c5a1SPoul-Henning Kamp if (dev->si_flags & SI_CHILD) { 5813344c5a1SPoul-Henning Kamp LIST_REMOVE(dev, si_siblings); 5823344c5a1SPoul-Henning Kamp dev->si_flags &= ~SI_CHILD; 5833344c5a1SPoul-Henning Kamp } 584cd690b60SPoul-Henning Kamp 585cd690b60SPoul-Henning Kamp /* Kill our children */ 5863344c5a1SPoul-Henning Kamp while (!LIST_EMPTY(&dev->si_children)) 587cd690b60SPoul-Henning Kamp idestroy_dev(LIST_FIRST(&dev->si_children)); 588cd690b60SPoul-Henning Kamp 589cd690b60SPoul-Henning Kamp /* Remove from clone list */ 590b0b03348SPoul-Henning Kamp if (dev->si_flags & SI_CLONELIST) { 591b0b03348SPoul-Henning Kamp LIST_REMOVE(dev, si_clone); 592b0b03348SPoul-Henning Kamp dev->si_flags &= ~SI_CLONELIST; 593b0b03348SPoul-Henning Kamp } 594cd690b60SPoul-Henning Kamp 595743cd76aSPoul-Henning Kamp csw = dev->si_devsw; 5961abf2c36SBrian Feldman dev->si_devsw = NULL; /* already NULL for SI_ALIAS */ 5971abf2c36SBrian Feldman while (csw != NULL && csw->d_purge != NULL && dev->si_threadcount) { 598743cd76aSPoul-Henning Kamp printf("Purging %lu threads from %s\n", 599743cd76aSPoul-Henning Kamp dev->si_threadcount, devtoname(dev)); 600743cd76aSPoul-Henning Kamp csw->d_purge(dev); 601743cd76aSPoul-Henning Kamp msleep(csw, &devmtx, PRIBIO, "devprg", hz/10); 602743cd76aSPoul-Henning Kamp } 6031abf2c36SBrian Feldman if (csw != NULL && csw->d_purge != NULL) 604a5993c33SPoul-Henning Kamp printf("All threads purged from %s\n", devtoname(dev)); 605743cd76aSPoul-Henning Kamp 606743cd76aSPoul-Henning Kamp dev->si_drv1 = 0; 607743cd76aSPoul-Henning Kamp dev->si_drv2 = 0; 608743cd76aSPoul-Henning Kamp bzero(&dev->__si_u, sizeof(dev->__si_u)); 609743cd76aSPoul-Henning Kamp 610cd690b60SPoul-Henning Kamp if (!(dev->si_flags & SI_ALIAS)) { 611cd690b60SPoul-Henning Kamp /* Remove from cdevsw list */ 612cd690b60SPoul-Henning Kamp LIST_REMOVE(dev, si_list); 613cd690b60SPoul-Henning Kamp 61489c9c53dSPoul-Henning Kamp /* If cdevsw has no struct cdev *'s, clean it */ 615a5993c33SPoul-Henning Kamp if (LIST_EMPTY(&csw->d_devs)) 616a5993c33SPoul-Henning Kamp fini_cdevsw(csw); 617cd690b60SPoul-Henning Kamp 618cd690b60SPoul-Henning Kamp LIST_REMOVE(dev, si_hash); 619cd690b60SPoul-Henning Kamp } 6205ef2707eSPoul-Henning Kamp dev->si_flags &= ~SI_ALIAS; 621743cd76aSPoul-Henning Kamp 622cd690b60SPoul-Henning Kamp if (dev->si_refcount > 0) { 623cd690b60SPoul-Henning Kamp LIST_INSERT_HEAD(&dead_cdevsw.d_devs, dev, si_list); 624cd690b60SPoul-Henning Kamp } else { 625d137acccSPoul-Henning Kamp freedev(dev); 626d137acccSPoul-Henning Kamp } 627cd690b60SPoul-Henning Kamp } 628cd690b60SPoul-Henning Kamp 629cd690b60SPoul-Henning Kamp void 63089c9c53dSPoul-Henning Kamp destroy_dev(struct cdev *dev) 631cd690b60SPoul-Henning Kamp { 632cd690b60SPoul-Henning Kamp 633a0e78d2eSPoul-Henning Kamp dev_lock(); 634cd690b60SPoul-Henning Kamp idestroy_dev(dev); 635a0e78d2eSPoul-Henning Kamp dev_unlock(); 636cd690b60SPoul-Henning Kamp } 637d137acccSPoul-Henning Kamp 638c32cc149SBruce Evans const char * 63989c9c53dSPoul-Henning Kamp devtoname(struct cdev *dev) 640b8e49f68SBill Fumerola { 641d137acccSPoul-Henning Kamp char *p; 6428ff33adbSPoul-Henning Kamp struct cdevsw *csw; 643c32cc149SBruce Evans int mynor; 644b8e49f68SBill Fumerola 645d137acccSPoul-Henning Kamp if (dev->si_name[0] == '#' || dev->si_name[0] == '\0') { 646d137acccSPoul-Henning Kamp p = dev->si_name; 6478ff33adbSPoul-Henning Kamp sprintf(p, "#%d", major(dev)); 6488ff33adbSPoul-Henning Kamp p += strlen(p); 6498ff33adbSPoul-Henning Kamp csw = dev_refthread(dev); 6508ff33adbSPoul-Henning Kamp if (csw != NULL) { 6518ff33adbSPoul-Henning Kamp sprintf(p, "(%s)", csw->d_name); 6528ff33adbSPoul-Henning Kamp dev_relthread(dev); 6538ff33adbSPoul-Henning Kamp } 654d137acccSPoul-Henning Kamp p += strlen(p); 655c32cc149SBruce Evans mynor = minor(dev); 656c32cc149SBruce Evans if (mynor < 0 || mynor > 255) 6578ff33adbSPoul-Henning Kamp sprintf(p, "/%#x", (u_int)mynor); 658c32cc149SBruce Evans else 6598ff33adbSPoul-Henning Kamp sprintf(p, "/%d", mynor); 660d137acccSPoul-Henning Kamp } 661b8e49f68SBill Fumerola return (dev->si_name); 662b8e49f68SBill Fumerola } 663db901281SPoul-Henning Kamp 664db901281SPoul-Henning Kamp int 66501de1b13SPoul-Henning Kamp dev_stdclone(char *name, char **namep, const char *stem, int *unit) 666db901281SPoul-Henning Kamp { 667db901281SPoul-Henning Kamp int u, i; 668db901281SPoul-Henning Kamp 669db901281SPoul-Henning Kamp i = strlen(stem); 67056700d46SBrian Somers if (bcmp(stem, name, i) != 0) 67156700d46SBrian Somers return (0); 672db901281SPoul-Henning Kamp if (!isdigit(name[i])) 673db901281SPoul-Henning Kamp return (0); 674db901281SPoul-Henning Kamp u = 0; 67510786074SPoul-Henning Kamp if (name[i] == '0' && isdigit(name[i+1])) 67610786074SPoul-Henning Kamp return (0); 677db901281SPoul-Henning Kamp while (isdigit(name[i])) { 678db901281SPoul-Henning Kamp u *= 10; 679db901281SPoul-Henning Kamp u += name[i++] - '0'; 680db901281SPoul-Henning Kamp } 681dab3d85fSBrian Feldman if (u > 0xffffff) 682dab3d85fSBrian Feldman return (0); 683db901281SPoul-Henning Kamp *unit = u; 684db901281SPoul-Henning Kamp if (namep) 685db901281SPoul-Henning Kamp *namep = &name[i]; 686db901281SPoul-Henning Kamp if (name[i]) 687db901281SPoul-Henning Kamp return (2); 688db901281SPoul-Henning Kamp return (1); 689db901281SPoul-Henning Kamp } 6908d25eb2cSPoul-Henning Kamp 6918d25eb2cSPoul-Henning Kamp /* 692b0b03348SPoul-Henning Kamp * Helper functions for cloning device drivers. 693b0b03348SPoul-Henning Kamp * 694b0b03348SPoul-Henning Kamp * The objective here is to make it unnecessary for the device drivers to 695b0b03348SPoul-Henning Kamp * use rman or similar to manage their unit number space. Due to the way 696b0b03348SPoul-Henning Kamp * we do "on-demand" devices, using rman or other "private" methods 697b0b03348SPoul-Henning Kamp * will be very tricky to lock down properly once we lock down this file. 698b0b03348SPoul-Henning Kamp * 6999a98ae94SLukas Ertl * Instead we give the drivers these routines which puts the struct cdev *'s 7009a98ae94SLukas Ertl * that are to be managed on their own list, and gives the driver the ability 701b0b03348SPoul-Henning Kamp * to ask for the first free unit number or a given specified unit number. 702b0b03348SPoul-Henning Kamp * 703b0b03348SPoul-Henning Kamp * In addition these routines support paired devices (pty, nmdm and similar) 704b0b03348SPoul-Henning Kamp * by respecting a number of "flag" bits in the minor number. 705b0b03348SPoul-Henning Kamp * 706b0b03348SPoul-Henning Kamp */ 707b0b03348SPoul-Henning Kamp 708b0b03348SPoul-Henning Kamp struct clonedevs { 709b0b03348SPoul-Henning Kamp LIST_HEAD(,cdev) head; 710b0b03348SPoul-Henning Kamp }; 711b0b03348SPoul-Henning Kamp 7129397290eSPoul-Henning Kamp void 7139397290eSPoul-Henning Kamp clone_setup(struct clonedevs **cdp) 7149397290eSPoul-Henning Kamp { 7159397290eSPoul-Henning Kamp 7169397290eSPoul-Henning Kamp *cdp = malloc(sizeof **cdp, M_DEVBUF, M_WAITOK | M_ZERO); 7179397290eSPoul-Henning Kamp LIST_INIT(&(*cdp)->head); 7189397290eSPoul-Henning Kamp } 7199397290eSPoul-Henning Kamp 720b0b03348SPoul-Henning Kamp int 72189c9c53dSPoul-Henning Kamp clone_create(struct clonedevs **cdp, struct cdevsw *csw, int *up, struct cdev **dp, u_int extra) 722b0b03348SPoul-Henning Kamp { 723b0b03348SPoul-Henning Kamp struct clonedevs *cd; 72489c9c53dSPoul-Henning Kamp struct cdev *dev, *dl, *de; 725b0b03348SPoul-Henning Kamp int unit, low, u; 726b0b03348SPoul-Henning Kamp 7279397290eSPoul-Henning Kamp KASSERT(*cdp != NULL, 7289397290eSPoul-Henning Kamp ("clone_setup() not called in driver \"%s\"", csw->d_name)); 729b0b03348SPoul-Henning Kamp KASSERT(!(extra & CLONE_UNITMASK), 730b0b03348SPoul-Henning Kamp ("Illegal extra bits (0x%x) in clone_create", extra)); 731b0b03348SPoul-Henning Kamp KASSERT(*up <= CLONE_UNITMASK, 732b0b03348SPoul-Henning Kamp ("Too high unit (0x%x) in clone_create", *up)); 733b0b03348SPoul-Henning Kamp 734b0b03348SPoul-Henning Kamp if (csw->d_maj == MAJOR_AUTO) 735b0b03348SPoul-Henning Kamp find_major(csw); 736b0b03348SPoul-Henning Kamp 737b0b03348SPoul-Henning Kamp /* 738b0b03348SPoul-Henning Kamp * Search the list for a lot of things in one go: 739b0b03348SPoul-Henning Kamp * A preexisting match is returned immediately. 740b0b03348SPoul-Henning Kamp * The lowest free unit number if we are passed -1, and the place 741b0b03348SPoul-Henning Kamp * in the list where we should insert that new element. 742b0b03348SPoul-Henning Kamp * The place to insert a specified unit number, if applicable 743b0b03348SPoul-Henning Kamp * the end of the list. 744b0b03348SPoul-Henning Kamp */ 745b0b03348SPoul-Henning Kamp unit = *up; 7468666b655SPoul-Henning Kamp low = extra; 747b0b03348SPoul-Henning Kamp de = dl = NULL; 7489397290eSPoul-Henning Kamp cd = *cdp; 749b0b03348SPoul-Henning Kamp LIST_FOREACH(dev, &cd->head, si_clone) { 750b0b03348SPoul-Henning Kamp u = dev2unit(dev); 751b0b03348SPoul-Henning Kamp if (u == (unit | extra)) { 752b0b03348SPoul-Henning Kamp *dp = dev; 753b0b03348SPoul-Henning Kamp return (0); 754b0b03348SPoul-Henning Kamp } 755b0b03348SPoul-Henning Kamp if (unit == -1 && u == low) { 756b0b03348SPoul-Henning Kamp low++; 757b0b03348SPoul-Henning Kamp de = dev; 758b0b03348SPoul-Henning Kamp continue; 759b0b03348SPoul-Henning Kamp } 7608666b655SPoul-Henning Kamp if (u > (unit | extra)) { 761b0b03348SPoul-Henning Kamp dl = dev; 762b0b03348SPoul-Henning Kamp break; 763b0b03348SPoul-Henning Kamp } 764b0b03348SPoul-Henning Kamp de = dev; 765b0b03348SPoul-Henning Kamp } 766b0b03348SPoul-Henning Kamp if (unit == -1) 7678666b655SPoul-Henning Kamp unit = low & CLONE_UNITMASK; 768f3732fd1SPoul-Henning Kamp dev = newdev(csw->d_maj, unit2minor(unit | extra)); 769b0b03348SPoul-Henning Kamp KASSERT(!(dev->si_flags & SI_CLONELIST), 770b0b03348SPoul-Henning Kamp ("Dev %p should not be on clonelist", dev)); 771b0b03348SPoul-Henning Kamp if (dl != NULL) 772b0b03348SPoul-Henning Kamp LIST_INSERT_BEFORE(dl, dev, si_clone); 773b0b03348SPoul-Henning Kamp else if (de != NULL) 774b0b03348SPoul-Henning Kamp LIST_INSERT_AFTER(de, dev, si_clone); 775b0b03348SPoul-Henning Kamp else 776b0b03348SPoul-Henning Kamp LIST_INSERT_HEAD(&cd->head, dev, si_clone); 777b0b03348SPoul-Henning Kamp dev->si_flags |= SI_CLONELIST; 778b0b03348SPoul-Henning Kamp *up = unit; 779b0b03348SPoul-Henning Kamp return (1); 780b0b03348SPoul-Henning Kamp } 781b0b03348SPoul-Henning Kamp 782b0b03348SPoul-Henning Kamp /* 783b0b03348SPoul-Henning Kamp * Kill everything still on the list. The driver should already have 78489c9c53dSPoul-Henning Kamp * disposed of any softc hung of the struct cdev *'s at this time. 785b0b03348SPoul-Henning Kamp */ 786b0b03348SPoul-Henning Kamp void 787b0b03348SPoul-Henning Kamp clone_cleanup(struct clonedevs **cdp) 788b0b03348SPoul-Henning Kamp { 78989c9c53dSPoul-Henning Kamp struct cdev *dev, *tdev; 790b0b03348SPoul-Henning Kamp struct clonedevs *cd; 791b0b03348SPoul-Henning Kamp 792b0b03348SPoul-Henning Kamp cd = *cdp; 793b0b03348SPoul-Henning Kamp if (cd == NULL) 794b0b03348SPoul-Henning Kamp return; 795b0b03348SPoul-Henning Kamp LIST_FOREACH_SAFE(dev, &cd->head, si_clone, tdev) { 796b0b03348SPoul-Henning Kamp KASSERT(dev->si_flags & SI_NAMED, 797b0b03348SPoul-Henning Kamp ("Driver has goofed in cloning underways udev %x", dev->si_udev)); 798b0b03348SPoul-Henning Kamp destroy_dev(dev); 799b0b03348SPoul-Henning Kamp } 800b0b03348SPoul-Henning Kamp free(cd, M_DEVBUF); 801b0b03348SPoul-Henning Kamp *cdp = NULL; 802b0b03348SPoul-Henning Kamp } 803b0b03348SPoul-Henning Kamp 804b0b03348SPoul-Henning Kamp /* 8059a98ae94SLukas Ertl * Helper sysctl for devname(3). We're given a struct cdev * and return 8068d25eb2cSPoul-Henning Kamp * the name, if any, registered by the device driver. 8078d25eb2cSPoul-Henning Kamp */ 8088d25eb2cSPoul-Henning Kamp static int 8098d25eb2cSPoul-Henning Kamp sysctl_devname(SYSCTL_HANDLER_ARGS) 8108d25eb2cSPoul-Henning Kamp { 8118d25eb2cSPoul-Henning Kamp int error; 812f3732fd1SPoul-Henning Kamp dev_t ud; 81389c9c53dSPoul-Henning Kamp struct cdev *dev; 8148d25eb2cSPoul-Henning Kamp 8158d25eb2cSPoul-Henning Kamp error = SYSCTL_IN(req, &ud, sizeof (ud)); 8168d25eb2cSPoul-Henning Kamp if (error) 8178d25eb2cSPoul-Henning Kamp return (error); 818f3732fd1SPoul-Henning Kamp if (ud == NODEV) 8191fd7b93fSPoul-Henning Kamp return(EINVAL); 820f3732fd1SPoul-Henning Kamp dev = findcdev(ud); 821f3732fd1SPoul-Henning Kamp if (dev == NULL) 8228d25eb2cSPoul-Henning Kamp error = ENOENT; 8238d25eb2cSPoul-Henning Kamp else 8248d25eb2cSPoul-Henning Kamp error = SYSCTL_OUT(req, dev->si_name, strlen(dev->si_name) + 1); 8258d25eb2cSPoul-Henning Kamp return (error); 8268d25eb2cSPoul-Henning Kamp } 8278d25eb2cSPoul-Henning Kamp 828fe4e3243SPoul-Henning Kamp SYSCTL_PROC(_kern, OID_AUTO, devname, CTLTYPE_OPAQUE|CTLFLAG_RW|CTLFLAG_ANYBODY, 8298d25eb2cSPoul-Henning Kamp NULL, 0, sysctl_devname, "", "devname(3) handler"); 830