sys/kern/kern_conf.c

   1 /*-
   2  * Parts Copyright (c) 1995 Terrence R. Lambert
   3  * Copyright (c) 1995 Julian R. Elischer
   4  * All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  * 3. All advertising materials mentioning features or use of this software
  15  *    must display the following acknowledgement:
  16  *      This product includes software developed by Terrence R. Lambert.
  17  * 4. The name Terrence R. Lambert may not be used to endorse or promote
  18  *    products derived from this software without specific prior written
  19  *    permission.
  20  *
  21  * THIS SOFTWARE IS PROVIDED BY Julian R. Elischer ``AS IS'' AND ANY
  22  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE TERRENCE R. LAMBERT BE LIABLE
  25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31  * SUCH DAMAGE.
  32  *
  33  * $FreeBSD$
  34  */
  35
  36 #include <sys/param.h>
  37 #include <sys/kernel.h>
  38 #include <sys/sysctl.h>
  39 #include <sys/systm.h>
  40 #include <sys/module.h>
  41 #include <sys/malloc.h>
  42 #include <sys/conf.h>
  43 #include <sys/vnode.h>
  44 #include <sys/queue.h>
  45 #include <machine/stdarg.h>
  46
  47 #define cdevsw_ALLOCSTART       (NUMCDEVSW/2)
  48
  49 struct cdevsw   *cdevsw[NUMCDEVSW];
  50
  51 static int      bmaj2cmaj[NUMCDEVSW];
  52
  53 MALLOC_DEFINE(M_DEVT, "dev_t", "dev_t storage");
  54
  55 /*
  56  * This is the number of hash-buckets.  Experiements with 'real-life'
  57  * udev_t's show that a prime halfway between two powers of two works
  58  * best.
  59  */
  60 #define DEVT_HASH 83
  61
  62 /* The number of dev_t's we can create before malloc(9) kick in.  */
  63 #define DEVT_STASH 50
  64
  65 static struct specinfo devt_stash[DEVT_STASH];
  66
  67 static LIST_HEAD(, specinfo) dev_hash[DEVT_HASH];
  68
  69 static LIST_HEAD(, specinfo) dev_free;
  70
  71 devfs_create_t *devfs_create_hook;
  72 devfs_remove_t *devfs_remove_hook;
  73
  74 static int free_devt;
  75 SYSCTL_INT(_debug, OID_AUTO, free_devt, CTLFLAG_RW, &free_devt, 0, "");
  76
  77 /*
  78  * Routine to convert from character to block device number.
  79  *
  80  * A minimal stub routine can always return NODEV.
  81  */
  82 dev_t
  83 chrtoblk(dev_t dev)
  84 {
  85         struct cdevsw *cd;
  86
  87         if((cd = devsw(dev)) != NULL) {
  88           if (cd->d_bmaj != -1)
  89             return(makebdev(cd->d_bmaj,minor(dev)));
  90         }
  91         return(NODEV);
  92 }
  93
  94 struct cdevsw *
  95 devsw(dev_t dev)
  96 {
  97         if (dev->si_devsw)
  98                 return (dev->si_devsw);
  99         return(cdevsw[major(dev)]);
 100 }
 101
 102 /*
 103  *  Add a cdevsw entry
 104  */
 105
 106 int
 107 cdevsw_add(struct cdevsw *newentry)
 108 {
 109         int i;
 110         static int setup;
 111
 112         if (!setup) {
 113                 for (i = 0; i < NUMCDEVSW; i++)
 114                         if (!bmaj2cmaj[i])
 115                                 bmaj2cmaj[i] = 254;
 116                 setup++;
 117         }
 118
 119         if (newentry->d_maj < 0 || newentry->d_maj >= NUMCDEVSW) {
 120                 printf("%s: ERROR: driver has bogus cdevsw->d_maj = %d\n",
 121                     newentry->d_name, newentry->d_maj);
 122                 return (EINVAL);
 123         }
 124         if (newentry->d_bmaj >= NUMCDEVSW) {
 125                 printf("%s: ERROR: driver has bogus cdevsw->d_bmaj = %d\n",
 126                     newentry->d_name, newentry->d_bmaj);
 127                 return (EINVAL);
 128         }
 129         if (newentry->d_bmaj >= 0 && (newentry->d_flags & D_DISK) == 0) {
 130                 printf("ERROR: \"%s\" bmaj but is not a disk\n",
 131                     newentry->d_name);
 132                 return (EINVAL);
 133         }
 134
 135         if (cdevsw[newentry->d_maj]) {
 136                 printf("WARNING: \"%s\" is usurping \"%s\"'s cdevsw[]\n",
 137                     newentry->d_name, cdevsw[newentry->d_maj]->d_name);
 138         }
 139
 140         cdevsw[newentry->d_maj] = newentry;
 141
 142         if (newentry->d_bmaj < 0)
 143                 return (0);
 144
 145         if (bmaj2cmaj[newentry->d_bmaj] != 254) {
 146                 printf("WARNING: \"%s\" is usurping \"%s\"'s bmaj\n",
 147                     newentry->d_name,
 148                     cdevsw[bmaj2cmaj[newentry->d_bmaj]]->d_name);
 149         }
 150         bmaj2cmaj[newentry->d_bmaj] = newentry->d_maj;
 151         return (0);
 152 }
 153
 154 /*
 155  *  Remove a cdevsw entry
 156  */
 157
 158 int
 159 cdevsw_remove(struct cdevsw *oldentry)
 160 {
 161         if (oldentry->d_maj < 0 || oldentry->d_maj >= NUMCDEVSW) {
 162                 printf("%s: ERROR: driver has bogus cdevsw->d_maj = %d\n",
 163                     oldentry->d_name, oldentry->d_maj);
 164                 return EINVAL;
 165         }
 166
 167         cdevsw[oldentry->d_maj] = NULL;
 168
 169         if (oldentry->d_bmaj >= 0 && oldentry->d_bmaj < NUMCDEVSW)
 170                 bmaj2cmaj[oldentry->d_bmaj] = 254;
 171
 172         return 0;
 173 }
 174
 175 int
 176 devsw_module_handler(module_t mod, int what, void* arg)
 177 {
 178         struct devsw_module_data* data = (struct devsw_module_data*) arg;
 179         int error = 0;
 180
 181         if (data->chainevh)
 182                 return data->chainevh(mod, what, data->chainarg);
 183         else
 184                 return 0;
 185 }
 186
 187 /*
 188  * dev_t and u_dev_t primitives
 189  */
 190
 191 int
 192 major(dev_t x)
 193 {
 194         if (x == NODEV)
 195                 return NOUDEV;
 196         return((x->si_udev >> 8) & 0xff);
 197 }
 198
 199 int
 200 minor(dev_t x)
 201 {
 202         if (x == NODEV)
 203                 return NOUDEV;
 204         return(x->si_udev & 0xffff00ff);
 205 }
 206
 207 int
 208 lminor(dev_t x)
 209 {
 210         int i;
 211
 212         if (x == NODEV)
 213                 return NOUDEV;
 214         i = minor(x);
 215         return ((i & 0xff) | (i >> 8));
 216 }
 217
 218 dev_t
 219 makebdev(int x, int y)
 220 {
 221         return (makedev(bmaj2cmaj[x], y));
 222 }
 223
 224 dev_t
 225 makedev(int x, int y)
 226 {
 227         struct specinfo *si;
 228         udev_t  udev;
 229         int hash;
 230         static int stashed;
 231
 232         udev = (x << 8) | y;
 233         hash = udev % DEVT_HASH;
 234         LIST_FOREACH(si, &dev_hash[hash], si_hash) {
 235                 if (si->si_udev == udev)
 236                         return (si);
 237         }
 238         if (stashed >= DEVT_STASH) {
 239                 MALLOC(si, struct specinfo *, sizeof(*si), M_DEVT,
 240                     M_USE_RESERVE);
 241                 bzero(si, sizeof(*si));
 242         } else if (LIST_FIRST(&dev_free)) {
 243                 si = LIST_FIRST(&dev_free);
 244                 LIST_REMOVE(si, si_hash);
 245         } else {
 246                 si = devt_stash + stashed++;
 247                 si->si_flags |= SI_STASHED;
 248         }
 249         si->si_udev = udev;
 250         LIST_INSERT_HEAD(&dev_hash[hash], si, si_hash);
 251         return (si);
 252 }
 253
 254 void
 255 freedev(dev_t dev)
 256 {
 257         int hash;
 258
 259         if (!free_devt)
 260                 return;
 261         if (SLIST_FIRST(&dev->si_hlist))
 262                 return;
 263         if (dev->si_devsw || dev->si_drv1 || dev->si_drv2)
 264                 return;
 265         hash = dev->si_udev % DEVT_HASH;
 266         LIST_REMOVE(dev, si_hash);
 267         if (dev->si_flags & SI_STASHED) {
 268                 bzero(dev, sizeof(*dev));
 269                 LIST_INSERT_HEAD(&dev_free, dev, si_hash);
 270         } else {
 271                 FREE(dev, M_DEVT);
 272         }
 273 }
 274
 275 udev_t
 276 dev2udev(dev_t x)
 277 {
 278         if (x == NODEV)
 279                 return NOUDEV;
 280         return (x->si_udev);
 281 }
 282
 283 udev_t
 284 dev2budev(dev_t x)
 285 {
 286         if (x == NODEV)
 287                 return NOUDEV;
 288         else
 289                 return makeudev(devsw(x)->d_bmaj, minor(x));
 290 }
 291
 292 dev_t
 293 udev2dev(udev_t x, int b)
 294 {
 295         switch (b) {
 296                 case 0:
 297                         return makedev(umajor(x), uminor(x));
 298                 case 1:
 299                         return makebdev(umajor(x), uminor(x));
 300                 default:
 301                         Debugger("udev2dev(...,X)");
 302                         return NODEV;
 303         }
 304 }
 305
 306 int
 307 uminor(udev_t dev)
 308 {
 309         return(dev & 0xffff00ff);
 310 }
 311
 312 int
 313 umajor(udev_t dev)
 314 {
 315         return((dev & 0xff00) >> 8);
 316 }
 317
 318 udev_t
 319 makeudev(int x, int y)
 320 {
 321         return ((x << 8) | y);
 322 }
 323
 324 dev_t
 325 make_dev(struct cdevsw *devsw, int minor, uid_t uid, gid_t gid, int perms, char *fmt, ...)
 326 {
 327         dev_t   dev;
 328         va_list ap;
 329         int i;
 330
 331         dev = makedev(devsw->d_maj, minor);
 332         va_start(ap, fmt);
 333         i = kvprintf(fmt, NULL, dev->si_name, 32, ap);
 334         dev->si_name[i] = '\0';
 335         va_end(ap);
 336         dev->si_devsw = devsw;
 337
 338         if (devfs_create_hook)
 339                 devfs_create_hook(dev, uid, gid, perms);
 340         return (dev);
 341 }
 342
 343 void
 344 remove_dev(dev_t dev)
 345 {
 346         if (devfs_remove_hook)
 347                 devfs_remove_hook(dev);
 348         dev->si_drv1 = 0;
 349         dev->si_drv2 = 0;
 350         dev->si_devsw = 0;
 351         freedev(dev);
 352 }
 353
 354 const char *
 355 devtoname(dev_t dev)
 356 {
 357         char *p;
 358         int mynor;
 359
 360         if (dev->si_name[0] == '#' || dev->si_name[0] == '\0') {
 361                 p = dev->si_name;
 362                 if (devsw(dev))
 363                         sprintf(p, "#%s/", devsw(dev)->d_name);
 364                 else
 365                         sprintf(p, "#%d/", major(dev));
 366                 p += strlen(p);
 367                 mynor = minor(dev);
 368                 if (mynor < 0 || mynor > 255)
 369                         sprintf(p, "%#x", (u_int)mynor);
 370                 else
 371                         sprintf(p, "%d", mynor);
 372         }
 373         return (dev->si_name);
 374 }