1 /*- 2 * Copyright (c) 1999-2002 Poul-Henning Kamp 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27 #include <sys/cdefs.h> 28 __FBSDID("$FreeBSD$"); 29 30 #include <sys/param.h> 31 #include <sys/kernel.h> 32 #include <sys/systm.h> 33 #include <sys/bio.h> 34 #include <sys/lock.h> 35 #include <sys/mutex.h> 36 #include <sys/module.h> 37 #include <sys/malloc.h> 38 #include <sys/conf.h> 39 #include <sys/vnode.h> 40 #include <sys/queue.h> 41 #include <sys/poll.h> 42 #include <sys/ctype.h> 43 #include <sys/tty.h> 44 #include <sys/ucred.h> 45 #include <machine/stdarg.h> 46 47 #include <fs/devfs/devfs_int.h> 48 49 static MALLOC_DEFINE(M_DEVT, "cdev", "cdev storage"); 50 51 struct mtx devmtx; 52 static void destroy_devl(struct cdev *dev); 53 static struct cdev *make_dev_credv(struct cdevsw *devsw, int minornr, 54 struct ucred *cr, uid_t uid, gid_t gid, int mode, const char *fmt, 55 va_list ap); 56 57 void 58 dev_lock(void) 59 { 60 if (!mtx_initialized(&devmtx)) 61 mtx_init(&devmtx, "cdev", NULL, MTX_DEF); 62 mtx_lock(&devmtx); 63 } 64 65 void 66 dev_unlock(void) 67 { 68 69 mtx_unlock(&devmtx); 70 } 71 72 void 73 dev_ref(struct cdev *dev) 74 { 75 76 mtx_assert(&devmtx, MA_NOTOWNED); 77 mtx_lock(&devmtx); 78 dev->si_refcount++; 79 mtx_unlock(&devmtx); 80 } 81 82 void 83 dev_refl(struct cdev *dev) 84 { 85 86 mtx_assert(&devmtx, MA_OWNED); 87 dev->si_refcount++; 88 } 89 90 void 91 dev_rel(struct cdev *dev) 92 { 93 int flag = 0; 94 95 mtx_assert(&devmtx, MA_NOTOWNED); 96 dev_lock(); 97 dev->si_refcount--; 98 KASSERT(dev->si_refcount >= 0, 99 ("dev_rel(%s) gave negative count", devtoname(dev))); 100 #if 0 101 if (dev->si_usecount == 0 && 102 (dev->si_flags & SI_CHEAPCLONE) && (dev->si_flags & SI_NAMED)) 103 ; 104 else 105 #endif 106 if (dev->si_devsw == NULL && dev->si_refcount == 0) { 107 LIST_REMOVE(dev, si_list); 108 flag = 1; 109 } 110 dev_unlock(); 111 if (flag) 112 devfs_free(dev); 113 } 114 115 struct cdevsw * 116 dev_refthread(struct cdev *dev) 117 { 118 struct cdevsw *csw; 119 120 mtx_assert(&devmtx, MA_NOTOWNED); 121 dev_lock(); 122 csw = dev->si_devsw; 123 if (csw != NULL) 124 dev->si_threadcount++; 125 dev_unlock(); 126 return (csw); 127 } 128 129 void 130 dev_relthread(struct cdev *dev) 131 { 132 133 mtx_assert(&devmtx, MA_NOTOWNED); 134 dev_lock(); 135 dev->si_threadcount--; 136 dev_unlock(); 137 } 138 139 int 140 nullop(void) 141 { 142 143 return (0); 144 } 145 146 int 147 eopnotsupp(void) 148 { 149 150 return (EOPNOTSUPP); 151 } 152 153 static int 154 enxio(void) 155 { 156 return (ENXIO); 157 } 158 159 static int 160 enodev(void) 161 { 162 return (ENODEV); 163 } 164 165 /* Define a dead_cdevsw for use when devices leave unexpectedly. */ 166 167 #define dead_open (d_open_t *)enxio 168 #define dead_close (d_close_t *)enxio 169 #define dead_read (d_read_t *)enxio 170 #define dead_write (d_write_t *)enxio 171 #define dead_ioctl (d_ioctl_t *)enxio 172 #define dead_poll (d_poll_t *)enodev 173 #define dead_mmap (d_mmap_t *)enodev 174 175 static void 176 dead_strategy(struct bio *bp) 177 { 178 179 biofinish(bp, NULL, ENXIO); 180 } 181 182 #define dead_dump (dumper_t *)enxio 183 #define dead_kqfilter (d_kqfilter_t *)enxio 184 185 static struct cdevsw dead_cdevsw = { 186 .d_version = D_VERSION, 187 .d_flags = D_NEEDGIANT, /* XXX: does dead_strategy need this ? */ 188 .d_open = dead_open, 189 .d_close = dead_close, 190 .d_read = dead_read, 191 .d_write = dead_write, 192 .d_ioctl = dead_ioctl, 193 .d_poll = dead_poll, 194 .d_mmap = dead_mmap, 195 .d_strategy = dead_strategy, 196 .d_name = "dead", 197 .d_dump = dead_dump, 198 .d_kqfilter = dead_kqfilter 199 }; 200 201 /* Default methods if driver does not specify method */ 202 203 #define null_open (d_open_t *)nullop 204 #define null_close (d_close_t *)nullop 205 #define no_read (d_read_t *)enodev 206 #define no_write (d_write_t *)enodev 207 #define no_ioctl (d_ioctl_t *)enodev 208 #define no_mmap (d_mmap_t *)enodev 209 #define no_kqfilter (d_kqfilter_t *)enodev 210 211 static void 212 no_strategy(struct bio *bp) 213 { 214 215 biofinish(bp, NULL, ENODEV); 216 } 217 218 static int 219 no_poll(struct cdev *dev __unused, int events, struct thread *td __unused) 220 { 221 /* 222 * Return true for read/write. If the user asked for something 223 * special, return POLLNVAL, so that clients have a way of 224 * determining reliably whether or not the extended 225 * functionality is present without hard-coding knowledge 226 * of specific filesystem implementations. 227 * Stay in sync with vop_nopoll(). 228 */ 229 if (events & ~POLLSTANDARD) 230 return (POLLNVAL); 231 232 return (events & (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM)); 233 } 234 235 #define no_dump (dumper_t *)enodev 236 237 static int 238 giant_open(struct cdev *dev, int oflags, int devtype, struct thread *td) 239 { 240 int retval; 241 242 mtx_lock(&Giant); 243 retval = dev->si_devsw->d_gianttrick-> 244 d_open(dev, oflags, devtype, td); 245 mtx_unlock(&Giant); 246 return (retval); 247 } 248 249 static int 250 giant_fdopen(struct cdev *dev, int oflags, struct thread *td, int fdidx) 251 { 252 int retval; 253 254 mtx_lock(&Giant); 255 retval = dev->si_devsw->d_gianttrick-> 256 d_fdopen(dev, oflags, td, fdidx); 257 mtx_unlock(&Giant); 258 return (retval); 259 } 260 261 static int 262 giant_close(struct cdev *dev, int fflag, int devtype, struct thread *td) 263 { 264 int retval; 265 266 mtx_lock(&Giant); 267 retval = dev->si_devsw->d_gianttrick-> 268 d_close(dev, fflag, devtype, td); 269 mtx_unlock(&Giant); 270 return (retval); 271 } 272 273 static void 274 giant_strategy(struct bio *bp) 275 { 276 277 mtx_lock(&Giant); 278 bp->bio_dev->si_devsw->d_gianttrick-> 279 d_strategy(bp); 280 mtx_unlock(&Giant); 281 } 282 283 static int 284 giant_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag, struct thread *td) 285 { 286 int retval; 287 288 mtx_lock(&Giant); 289 retval = dev->si_devsw->d_gianttrick-> 290 d_ioctl(dev, cmd, data, fflag, td); 291 mtx_unlock(&Giant); 292 return (retval); 293 } 294 295 static int 296 giant_read(struct cdev *dev, struct uio *uio, int ioflag) 297 { 298 int retval; 299 300 mtx_lock(&Giant); 301 retval = dev->si_devsw->d_gianttrick-> 302 d_read(dev, uio, ioflag); 303 mtx_unlock(&Giant); 304 return (retval); 305 } 306 307 static int 308 giant_write(struct cdev *dev, struct uio *uio, int ioflag) 309 { 310 int retval; 311 312 mtx_lock(&Giant); 313 retval = dev->si_devsw->d_gianttrick-> 314 d_write(dev, uio, ioflag); 315 mtx_unlock(&Giant); 316 return (retval); 317 } 318 319 static int 320 giant_poll(struct cdev *dev, int events, struct thread *td) 321 { 322 int retval; 323 324 mtx_lock(&Giant); 325 retval = dev->si_devsw->d_gianttrick-> 326 d_poll(dev, events, td); 327 mtx_unlock(&Giant); 328 return (retval); 329 } 330 331 static int 332 giant_kqfilter(struct cdev *dev, struct knote *kn) 333 { 334 int retval; 335 336 mtx_lock(&Giant); 337 retval = dev->si_devsw->d_gianttrick-> 338 d_kqfilter(dev, kn); 339 mtx_unlock(&Giant); 340 return (retval); 341 } 342 343 static int 344 giant_mmap(struct cdev *dev, vm_offset_t offset, vm_paddr_t *paddr, int nprot) 345 { 346 int retval; 347 348 mtx_lock(&Giant); 349 retval = dev->si_devsw->d_gianttrick-> 350 d_mmap(dev, offset, paddr, nprot); 351 mtx_unlock(&Giant); 352 return (retval); 353 } 354 355 356 /* 357 * struct cdev * and u_dev_t primitives 358 */ 359 360 int 361 minor(struct cdev *x) 362 { 363 if (x == NULL) 364 return NODEV; 365 return(x->si_drv0 & MAXMINOR); 366 } 367 368 int 369 dev2unit(struct cdev *x) 370 { 371 372 if (x == NULL) 373 return NODEV; 374 return (minor2unit(minor(x))); 375 } 376 377 u_int 378 minor2unit(u_int _minor) 379 { 380 381 KASSERT((_minor & ~MAXMINOR) == 0, ("Illegal minor %x", _minor)); 382 return ((_minor & 0xff) | ((_minor >> 8) & 0xffff00)); 383 } 384 385 int 386 unit2minor(int unit) 387 { 388 389 KASSERT(unit <= 0xffffff, ("Invalid unit (%d) in unit2minor", unit)); 390 return ((unit & 0xff) | ((unit << 8) & ~0xffff)); 391 } 392 393 static struct cdev * 394 newdev(struct cdevsw *csw, int y, struct cdev *si) 395 { 396 struct cdev *si2; 397 dev_t udev; 398 399 mtx_assert(&devmtx, MA_OWNED); 400 udev = y; 401 LIST_FOREACH(si2, &csw->d_devs, si_list) { 402 if (si2->si_drv0 == udev) { 403 devfs_free(si); 404 return (si2); 405 } 406 } 407 si->si_drv0 = udev; 408 si->si_devsw = csw; 409 LIST_INSERT_HEAD(&csw->d_devs, si, si_list); 410 return (si); 411 } 412 413 int 414 uminor(dev_t dev) 415 { 416 return (dev & MAXMINOR); 417 } 418 419 int 420 umajor(dev_t dev) 421 { 422 return ((dev & ~MAXMINOR) >> 8); 423 } 424 425 static void 426 fini_cdevsw(struct cdevsw *devsw) 427 { 428 struct cdevsw *gt; 429 430 if (devsw->d_gianttrick != NULL) { 431 gt = devsw->d_gianttrick; 432 memcpy(devsw, gt, sizeof *devsw); 433 free(gt, M_DEVT); 434 devsw->d_gianttrick = NULL; 435 } 436 devsw->d_flags &= ~D_INIT; 437 } 438 439 static void 440 prep_cdevsw(struct cdevsw *devsw) 441 { 442 struct cdevsw *dsw2; 443 444 if (devsw->d_flags & D_NEEDGIANT) 445 dsw2 = malloc(sizeof *dsw2, M_DEVT, M_WAITOK); 446 else 447 dsw2 = NULL; 448 dev_lock(); 449 450 if (devsw->d_version != D_VERSION_01) { 451 printf( 452 "WARNING: Device driver \"%s\" has wrong version %s\n", 453 devsw->d_name, "and is disabled. Recompile KLD module."); 454 devsw->d_open = dead_open; 455 devsw->d_close = dead_close; 456 devsw->d_read = dead_read; 457 devsw->d_write = dead_write; 458 devsw->d_ioctl = dead_ioctl; 459 devsw->d_poll = dead_poll; 460 devsw->d_mmap = dead_mmap; 461 devsw->d_strategy = dead_strategy; 462 devsw->d_dump = dead_dump; 463 devsw->d_kqfilter = dead_kqfilter; 464 } 465 466 if (devsw->d_flags & D_TTY) { 467 if (devsw->d_ioctl == NULL) devsw->d_ioctl = ttyioctl; 468 if (devsw->d_read == NULL) devsw->d_read = ttyread; 469 if (devsw->d_write == NULL) devsw->d_write = ttywrite; 470 if (devsw->d_kqfilter == NULL) devsw->d_kqfilter = ttykqfilter; 471 if (devsw->d_poll == NULL) devsw->d_poll = ttypoll; 472 } 473 474 if (devsw->d_flags & D_NEEDGIANT) { 475 if (devsw->d_gianttrick == NULL) { 476 memcpy(dsw2, devsw, sizeof *dsw2); 477 devsw->d_gianttrick = dsw2; 478 } else 479 free(dsw2, M_DEVT); 480 } 481 482 #define FIXUP(member, noop, giant) \ 483 do { \ 484 if (devsw->member == NULL) { \ 485 devsw->member = noop; \ 486 } else if (devsw->d_flags & D_NEEDGIANT) \ 487 devsw->member = giant; \ 488 } \ 489 while (0) 490 491 FIXUP(d_open, null_open, giant_open); 492 FIXUP(d_fdopen, NULL, giant_fdopen); 493 FIXUP(d_close, null_close, giant_close); 494 FIXUP(d_read, no_read, giant_read); 495 FIXUP(d_write, no_write, giant_write); 496 FIXUP(d_ioctl, no_ioctl, giant_ioctl); 497 FIXUP(d_poll, no_poll, giant_poll); 498 FIXUP(d_mmap, no_mmap, giant_mmap); 499 FIXUP(d_strategy, no_strategy, giant_strategy); 500 FIXUP(d_kqfilter, no_kqfilter, giant_kqfilter); 501 502 if (devsw->d_dump == NULL) devsw->d_dump = no_dump; 503 504 LIST_INIT(&devsw->d_devs); 505 506 devsw->d_flags |= D_INIT; 507 508 dev_unlock(); 509 } 510 511 static struct cdev * 512 make_dev_credv(struct cdevsw *devsw, int minornr, struct ucred *cr, uid_t uid, 513 gid_t gid, int mode, const char *fmt, va_list ap) 514 { 515 struct cdev *dev; 516 int i; 517 518 KASSERT((minornr & ~MAXMINOR) == 0, 519 ("Invalid minor (0x%x) in make_dev", minornr)); 520 521 if (!(devsw->d_flags & D_INIT)) 522 prep_cdevsw(devsw); 523 dev = devfs_alloc(); 524 dev_lock(); 525 dev = newdev(devsw, minornr, dev); 526 if (dev->si_flags & SI_CHEAPCLONE && 527 dev->si_flags & SI_NAMED) { 528 /* 529 * This is allowed as it removes races and generally 530 * simplifies cloning devices. 531 * XXX: still ?? 532 */ 533 dev_unlock(); 534 return (dev); 535 } 536 KASSERT(!(dev->si_flags & SI_NAMED), 537 ("make_dev() by driver %s on pre-existing device (min=%x, name=%s)", 538 devsw->d_name, minor(dev), devtoname(dev))); 539 540 i = vsnrprintf(dev->__si_namebuf, sizeof dev->__si_namebuf, 32, fmt, ap); 541 if (i > (sizeof dev->__si_namebuf - 1)) { 542 printf("WARNING: Device name truncated! (%s)\n", 543 dev->__si_namebuf); 544 } 545 546 dev->si_flags |= SI_NAMED; 547 if (cr != NULL) 548 dev->si_cred = crhold(cr); 549 else 550 dev->si_cred = NULL; 551 dev->si_uid = uid; 552 dev->si_gid = gid; 553 dev->si_mode = mode; 554 555 devfs_create(dev); 556 dev_unlock(); 557 return (dev); 558 } 559 560 struct cdev * 561 make_dev(struct cdevsw *devsw, int minornr, uid_t uid, gid_t gid, int mode, 562 const char *fmt, ...) 563 { 564 struct cdev *dev; 565 va_list ap; 566 567 va_start(ap, fmt); 568 dev = make_dev_credv(devsw, minornr, NULL, uid, gid, mode, fmt, ap); 569 va_end(ap); 570 return (dev); 571 } 572 573 struct cdev * 574 make_dev_cred(struct cdevsw *devsw, int minornr, struct ucred *cr, uid_t uid, 575 gid_t gid, int mode, const char *fmt, ...) 576 { 577 struct cdev *dev; 578 va_list ap; 579 580 va_start(ap, fmt); 581 dev = make_dev_credv(devsw, minornr, cr, uid, gid, mode, fmt, ap); 582 va_end(ap); 583 584 return (dev); 585 } 586 587 static void 588 dev_dependsl(struct cdev *pdev, struct cdev *cdev) 589 { 590 591 cdev->si_parent = pdev; 592 cdev->si_flags |= SI_CHILD; 593 LIST_INSERT_HEAD(&pdev->si_children, cdev, si_siblings); 594 } 595 596 597 void 598 dev_depends(struct cdev *pdev, struct cdev *cdev) 599 { 600 601 dev_lock(); 602 dev_dependsl(pdev, cdev); 603 dev_unlock(); 604 } 605 606 struct cdev * 607 make_dev_alias(struct cdev *pdev, const char *fmt, ...) 608 { 609 struct cdev *dev; 610 va_list ap; 611 int i; 612 613 dev = devfs_alloc(); 614 dev_lock(); 615 dev->si_flags |= SI_ALIAS; 616 dev->si_flags |= SI_NAMED; 617 va_start(ap, fmt); 618 i = vsnrprintf(dev->__si_namebuf, sizeof dev->__si_namebuf, 32, fmt, ap); 619 if (i > (sizeof dev->__si_namebuf - 1)) { 620 printf("WARNING: Device name truncated! (%s)\n", 621 dev->__si_namebuf); 622 } 623 va_end(ap); 624 625 devfs_create(dev); 626 dev_unlock(); 627 dev_depends(pdev, dev); 628 return (dev); 629 } 630 631 static void 632 destroy_devl(struct cdev *dev) 633 { 634 struct cdevsw *csw; 635 636 mtx_assert(&devmtx, MA_OWNED); 637 KASSERT(dev->si_flags & SI_NAMED, 638 ("WARNING: Driver mistake: destroy_dev on %d\n", minor(dev))); 639 640 devfs_destroy(dev); 641 642 /* Remove name marking */ 643 dev->si_flags &= ~SI_NAMED; 644 645 /* If we are a child, remove us from the parents list */ 646 if (dev->si_flags & SI_CHILD) { 647 LIST_REMOVE(dev, si_siblings); 648 dev->si_flags &= ~SI_CHILD; 649 } 650 651 /* Kill our children */ 652 while (!LIST_EMPTY(&dev->si_children)) 653 destroy_devl(LIST_FIRST(&dev->si_children)); 654 655 /* Remove from clone list */ 656 if (dev->si_flags & SI_CLONELIST) { 657 LIST_REMOVE(dev, si_clone); 658 dev->si_flags &= ~SI_CLONELIST; 659 } 660 661 csw = dev->si_devsw; 662 dev->si_devsw = NULL; /* already NULL for SI_ALIAS */ 663 while (csw != NULL && csw->d_purge != NULL && dev->si_threadcount) { 664 printf("Purging %lu threads from %s\n", 665 dev->si_threadcount, devtoname(dev)); 666 csw->d_purge(dev); 667 msleep(csw, &devmtx, PRIBIO, "devprg", hz/10); 668 } 669 if (csw != NULL && csw->d_purge != NULL) 670 printf("All threads purged from %s\n", devtoname(dev)); 671 672 dev->si_drv1 = 0; 673 dev->si_drv2 = 0; 674 bzero(&dev->__si_u, sizeof(dev->__si_u)); 675 676 if (!(dev->si_flags & SI_ALIAS)) { 677 /* Remove from cdevsw list */ 678 LIST_REMOVE(dev, si_list); 679 680 /* If cdevsw has no more struct cdev *'s, clean it */ 681 if (LIST_EMPTY(&csw->d_devs)) 682 fini_cdevsw(csw); 683 } 684 dev->si_flags &= ~SI_ALIAS; 685 686 if (dev->si_refcount > 0) { 687 LIST_INSERT_HEAD(&dead_cdevsw.d_devs, dev, si_list); 688 } else { 689 devfs_free(dev); 690 } 691 } 692 693 void 694 destroy_dev(struct cdev *dev) 695 { 696 697 dev_lock(); 698 destroy_devl(dev); 699 dev_unlock(); 700 } 701 702 const char * 703 devtoname(struct cdev *dev) 704 { 705 char *p; 706 struct cdevsw *csw; 707 int mynor; 708 709 if (dev->si_name[0] == '#' || dev->si_name[0] == '\0') { 710 p = dev->si_name; 711 csw = dev_refthread(dev); 712 if (csw != NULL) { 713 sprintf(p, "(%s)", csw->d_name); 714 dev_relthread(dev); 715 } 716 p += strlen(p); 717 mynor = minor(dev); 718 if (mynor < 0 || mynor > 255) 719 sprintf(p, "/%#x", (u_int)mynor); 720 else 721 sprintf(p, "/%d", mynor); 722 } 723 return (dev->si_name); 724 } 725 726 int 727 dev_stdclone(char *name, char **namep, const char *stem, int *unit) 728 { 729 int u, i; 730 731 i = strlen(stem); 732 if (bcmp(stem, name, i) != 0) 733 return (0); 734 if (!isdigit(name[i])) 735 return (0); 736 u = 0; 737 if (name[i] == '0' && isdigit(name[i+1])) 738 return (0); 739 while (isdigit(name[i])) { 740 u *= 10; 741 u += name[i++] - '0'; 742 } 743 if (u > 0xffffff) 744 return (0); 745 *unit = u; 746 if (namep) 747 *namep = &name[i]; 748 if (name[i]) 749 return (2); 750 return (1); 751 } 752 753 /* 754 * Helper functions for cloning device drivers. 755 * 756 * The objective here is to make it unnecessary for the device drivers to 757 * use rman or similar to manage their unit number space. Due to the way 758 * we do "on-demand" devices, using rman or other "private" methods 759 * will be very tricky to lock down properly once we lock down this file. 760 * 761 * Instead we give the drivers these routines which puts the struct cdev *'s 762 * that are to be managed on their own list, and gives the driver the ability 763 * to ask for the first free unit number or a given specified unit number. 764 * 765 * In addition these routines support paired devices (pty, nmdm and similar) 766 * by respecting a number of "flag" bits in the minor number. 767 * 768 */ 769 770 struct clonedevs { 771 LIST_HEAD(,cdev) head; 772 }; 773 774 void 775 clone_setup(struct clonedevs **cdp) 776 { 777 778 *cdp = malloc(sizeof **cdp, M_DEVBUF, M_WAITOK | M_ZERO); 779 LIST_INIT(&(*cdp)->head); 780 } 781 782 int 783 clone_create(struct clonedevs **cdp, struct cdevsw *csw, int *up, struct cdev **dp, u_int extra) 784 { 785 struct clonedevs *cd; 786 struct cdev *dev, *ndev, *dl, *de; 787 int unit, low, u; 788 789 KASSERT(*cdp != NULL, 790 ("clone_setup() not called in driver \"%s\"", csw->d_name)); 791 KASSERT(!(extra & CLONE_UNITMASK), 792 ("Illegal extra bits (0x%x) in clone_create", extra)); 793 KASSERT(*up <= CLONE_UNITMASK, 794 ("Too high unit (0x%x) in clone_create", *up)); 795 796 if (!(csw->d_flags & D_INIT)) 797 prep_cdevsw(csw); 798 799 /* 800 * Search the list for a lot of things in one go: 801 * A preexisting match is returned immediately. 802 * The lowest free unit number if we are passed -1, and the place 803 * in the list where we should insert that new element. 804 * The place to insert a specified unit number, if applicable 805 * the end of the list. 806 */ 807 unit = *up; 808 ndev = devfs_alloc(); 809 dev_lock(); 810 low = extra; 811 de = dl = NULL; 812 cd = *cdp; 813 LIST_FOREACH(dev, &cd->head, si_clone) { 814 KASSERT(dev->si_flags & SI_CLONELIST, 815 ("Dev %p(%s) should be on clonelist", dev, dev->si_name)); 816 u = dev2unit(dev); 817 if (u == (unit | extra)) { 818 *dp = dev; 819 devfs_free(ndev); 820 dev_unlock(); 821 return (0); 822 } 823 if (unit == -1 && u == low) { 824 low++; 825 de = dev; 826 continue; 827 } 828 if (u > (unit | extra)) { 829 dl = dev; 830 break; 831 } 832 } 833 if (unit == -1) 834 unit = low & CLONE_UNITMASK; 835 dev = newdev(csw, unit2minor(unit | extra), ndev); 836 if (dev->si_flags & SI_CLONELIST) { 837 printf("dev %p (%s) is on clonelist\n", dev, dev->si_name); 838 printf("unit=%d\n", unit); 839 LIST_FOREACH(dev, &cd->head, si_clone) { 840 printf("\t%p %s\n", dev, dev->si_name); 841 } 842 panic("foo"); 843 } 844 KASSERT(!(dev->si_flags & SI_CLONELIST), 845 ("Dev %p(%s) should not be on clonelist", dev, dev->si_name)); 846 if (dl != NULL) 847 LIST_INSERT_BEFORE(dl, dev, si_clone); 848 else if (de != NULL) 849 LIST_INSERT_AFTER(de, dev, si_clone); 850 else 851 LIST_INSERT_HEAD(&cd->head, dev, si_clone); 852 dev->si_flags |= SI_CLONELIST; 853 *up = unit; 854 dev_unlock(); 855 return (1); 856 } 857 858 /* 859 * Kill everything still on the list. The driver should already have 860 * disposed of any softc hung of the struct cdev *'s at this time. 861 */ 862 void 863 clone_cleanup(struct clonedevs **cdp) 864 { 865 struct cdev *dev, *tdev; 866 struct clonedevs *cd; 867 868 cd = *cdp; 869 if (cd == NULL) 870 return; 871 dev_lock(); 872 LIST_FOREACH_SAFE(dev, &cd->head, si_clone, tdev) { 873 KASSERT(dev->si_flags & SI_CLONELIST, 874 ("Dev %p(%s) should be on clonelist", dev, dev->si_name)); 875 KASSERT(dev->si_flags & SI_NAMED, 876 ("Driver has goofed in cloning underways udev %x", dev->si_drv0)); 877 destroy_devl(dev); 878 } 879 dev_unlock(); 880 free(cd, M_DEVBUF); 881 *cdp = NULL; 882 } 883