1 /* 2 * Copyright (c) 2009 The DragonFly Project. All rights reserved. 3 * 4 * This code is derived from software contributed to The DragonFly Project 5 * by Alex Hornung <ahornung@gmail.com> 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in 15 * the documentation and/or other materials provided with the 16 * distribution. 17 * 3. Neither the name of The DragonFly Project nor the names of its 18 * contributors may be used to endorse or promote products derived 19 * from this software without specific, prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 22 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 23 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 24 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 25 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 26 * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING, 27 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 28 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 29 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 30 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 31 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32 * SUCH DAMAGE. 33 */ 34 #include <sys/param.h> 35 #include <sys/systm.h> 36 #include <sys/kernel.h> 37 #include <sys/mount.h> 38 #include <sys/vnode.h> 39 #include <sys/types.h> 40 #include <sys/lock.h> 41 #include <sys/msgport.h> 42 #include <sys/sysctl.h> 43 #include <sys/ucred.h> 44 #include <sys/param.h> 45 #include <sys/systm.h> 46 #include <sys/devfs.h> 47 #include <sys/devfs_rules.h> 48 #include <sys/udev.h> 49 50 #include <sys/msgport2.h> 51 #include <sys/spinlock2.h> 52 #include <sys/mplock2.h> 53 #include <sys/sysref2.h> 54 55 MALLOC_DEFINE(M_DEVFS, "devfs", "Device File System (devfs) allocations"); 56 DEVFS_DECLARE_CLONE_BITMAP(ops_id); 57 /* 58 * SYSREF Integration - reference counting, allocation, 59 * sysid and syslink integration. 60 */ 61 static void devfs_cdev_terminate(cdev_t dev); 62 static void devfs_cdev_lock(cdev_t dev); 63 static void devfs_cdev_unlock(cdev_t dev); 64 static struct sysref_class cdev_sysref_class = { 65 .name = "cdev", 66 .mtype = M_DEVFS, 67 .proto = SYSREF_PROTO_DEV, 68 .offset = offsetof(struct cdev, si_sysref), 69 .objsize = sizeof(struct cdev), 70 .nom_cache = 32, 71 .flags = 0, 72 .ops = { 73 .terminate = (sysref_terminate_func_t)devfs_cdev_terminate, 74 .lock = (sysref_lock_func_t)devfs_cdev_lock, 75 .unlock = (sysref_unlock_func_t)devfs_cdev_unlock 76 } 77 }; 78 79 static struct objcache *devfs_node_cache; 80 static struct objcache *devfs_msg_cache; 81 static struct objcache *devfs_dev_cache; 82 83 static struct objcache_malloc_args devfs_node_malloc_args = { 84 sizeof(struct devfs_node), M_DEVFS }; 85 struct objcache_malloc_args devfs_msg_malloc_args = { 86 sizeof(struct devfs_msg), M_DEVFS }; 87 struct objcache_malloc_args devfs_dev_malloc_args = { 88 sizeof(struct cdev), M_DEVFS }; 89 90 static struct devfs_dev_head devfs_dev_list = 91 TAILQ_HEAD_INITIALIZER(devfs_dev_list); 92 static struct devfs_mnt_head devfs_mnt_list = 93 TAILQ_HEAD_INITIALIZER(devfs_mnt_list); 94 static struct devfs_chandler_head devfs_chandler_list = 95 TAILQ_HEAD_INITIALIZER(devfs_chandler_list); 96 static struct devfs_alias_head devfs_alias_list = 97 TAILQ_HEAD_INITIALIZER(devfs_alias_list); 98 static struct devfs_dev_ops_head devfs_dev_ops_list = 99 TAILQ_HEAD_INITIALIZER(devfs_dev_ops_list); 100 101 struct lock devfs_lock; 102 static struct lwkt_port devfs_dispose_port; 103 static struct lwkt_port devfs_msg_port; 104 static struct thread *td_core; 105 106 static struct spinlock ino_lock; 107 static ino_t d_ino; 108 static int devfs_debug_enable; 109 static int devfs_run; 110 111 static ino_t devfs_fetch_ino(void); 112 static int devfs_create_all_dev_worker(struct devfs_node *); 113 static int devfs_create_dev_worker(cdev_t, uid_t, gid_t, int); 114 static int devfs_destroy_dev_worker(cdev_t); 115 static int devfs_destroy_related_worker(cdev_t); 116 static int devfs_destroy_dev_by_ops_worker(struct dev_ops *, int); 117 static int devfs_propagate_dev(cdev_t, int); 118 static int devfs_unlink_dev(cdev_t dev); 119 static void devfs_msg_exec(devfs_msg_t msg); 120 121 static int devfs_chandler_add_worker(const char *, d_clone_t *); 122 static int devfs_chandler_del_worker(const char *); 123 124 static void devfs_msg_autofree_reply(lwkt_port_t, lwkt_msg_t); 125 static void devfs_msg_core(void *); 126 127 static int devfs_find_device_by_name_worker(devfs_msg_t); 128 static int devfs_find_device_by_udev_worker(devfs_msg_t); 129 130 static int devfs_apply_reset_rules_caller(char *, int); 131 132 static int devfs_scan_callback_worker(devfs_scan_t *, void *); 133 134 static struct devfs_node *devfs_resolve_or_create_dir(struct devfs_node *, 135 char *, size_t, int); 136 137 static int devfs_make_alias_worker(struct devfs_alias *); 138 static int devfs_destroy_alias_worker(struct devfs_alias *); 139 static int devfs_alias_remove(cdev_t); 140 static int devfs_alias_reap(void); 141 static int devfs_alias_propagate(struct devfs_alias *, int); 142 static int devfs_alias_apply(struct devfs_node *, struct devfs_alias *); 143 static int devfs_alias_check_create(struct devfs_node *); 144 145 static int devfs_clr_related_flag_worker(cdev_t, uint32_t); 146 static int devfs_destroy_related_without_flag_worker(cdev_t, uint32_t); 147 148 static void *devfs_reaperp_callback(struct devfs_node *, void *); 149 static void *devfs_gc_dirs_callback(struct devfs_node *, void *); 150 static void *devfs_gc_links_callback(struct devfs_node *, struct devfs_node *); 151 static void * 152 devfs_inode_to_vnode_worker_callback(struct devfs_node *, ino_t *); 153 154 /* 155 * devfs_debug() is a SYSCTL and TUNABLE controlled debug output function 156 * using kvprintf 157 */ 158 int 159 devfs_debug(int level, char *fmt, ...) 160 { 161 __va_list ap; 162 163 __va_start(ap, fmt); 164 if (level <= devfs_debug_enable) 165 kvprintf(fmt, ap); 166 __va_end(ap); 167 168 return 0; 169 } 170 171 /* 172 * devfs_allocp() Allocates a new devfs node with the specified 173 * parameters. The node is also automatically linked into the topology 174 * if a parent is specified. It also calls the rule and alias stuff to 175 * be applied on the new node 176 */ 177 struct devfs_node * 178 devfs_allocp(devfs_nodetype devfsnodetype, char *name, 179 struct devfs_node *parent, struct mount *mp, cdev_t dev) 180 { 181 struct devfs_node *node = NULL; 182 size_t namlen = strlen(name); 183 184 node = objcache_get(devfs_node_cache, M_WAITOK); 185 bzero(node, sizeof(*node)); 186 187 atomic_add_long(&DEVFS_MNTDATA(mp)->leak_count, 1); 188 189 node->d_dev = NULL; 190 node->nchildren = 1; 191 node->mp = mp; 192 node->d_dir.d_ino = devfs_fetch_ino(); 193 194 /* 195 * Cookie jar for children. Leave 0 and 1 for '.' and '..' entries 196 * respectively. 197 */ 198 node->cookie_jar = 2; 199 200 /* 201 * Access Control members 202 */ 203 node->mode = DEVFS_DEFAULT_MODE; 204 node->uid = DEVFS_DEFAULT_UID; 205 node->gid = DEVFS_DEFAULT_GID; 206 207 switch (devfsnodetype) { 208 case Proot: 209 /* 210 * Ensure that we don't recycle the root vnode by marking it as 211 * linked into the topology. 212 */ 213 node->flags |= DEVFS_NODE_LINKED; 214 case Pdir: 215 TAILQ_INIT(DEVFS_DENODE_HEAD(node)); 216 node->d_dir.d_type = DT_DIR; 217 node->nchildren = 2; 218 break; 219 220 case Plink: 221 node->d_dir.d_type = DT_LNK; 222 break; 223 224 case Preg: 225 node->d_dir.d_type = DT_REG; 226 break; 227 228 case Pdev: 229 if (dev != NULL) { 230 node->d_dir.d_type = DT_CHR; 231 node->d_dev = dev; 232 233 node->mode = dev->si_perms; 234 node->uid = dev->si_uid; 235 node->gid = dev->si_gid; 236 237 devfs_alias_check_create(node); 238 } 239 break; 240 241 default: 242 panic("devfs_allocp: unknown node type"); 243 } 244 245 node->v_node = NULL; 246 node->node_type = devfsnodetype; 247 248 /* Initialize the dirent structure of each devfs vnode */ 249 node->d_dir.d_namlen = namlen; 250 node->d_dir.d_name = kmalloc(namlen+1, M_DEVFS, M_WAITOK); 251 memcpy(node->d_dir.d_name, name, namlen); 252 node->d_dir.d_name[namlen] = '\0'; 253 254 /* Initialize the parent node element */ 255 node->parent = parent; 256 257 /* Initialize *time members */ 258 nanotime(&node->atime); 259 node->mtime = node->ctime = node->atime; 260 261 /* 262 * Associate with parent as last step, clean out namecache 263 * reference. 264 */ 265 if ((parent != NULL) && 266 ((parent->node_type == Proot) || (parent->node_type == Pdir))) { 267 parent->nchildren++; 268 node->cookie = parent->cookie_jar++; 269 node->flags |= DEVFS_NODE_LINKED; 270 TAILQ_INSERT_TAIL(DEVFS_DENODE_HEAD(parent), node, link); 271 272 /* This forces negative namecache lookups to clear */ 273 ++mp->mnt_namecache_gen; 274 } 275 276 /* Apply rules */ 277 devfs_rule_check_apply(node, NULL); 278 279 atomic_add_long(&DEVFS_MNTDATA(mp)->file_count, 1); 280 281 return node; 282 } 283 284 /* 285 * devfs_allocv() allocates a new vnode based on a devfs node. 286 */ 287 int 288 devfs_allocv(struct vnode **vpp, struct devfs_node *node) 289 { 290 struct vnode *vp; 291 int error = 0; 292 293 KKASSERT(node); 294 295 try_again: 296 while ((vp = node->v_node) != NULL) { 297 error = vget(vp, LK_EXCLUSIVE); 298 if (error != ENOENT) { 299 *vpp = vp; 300 goto out; 301 } 302 } 303 304 if ((error = getnewvnode(VT_DEVFS, node->mp, vpp, 0, 0)) != 0) 305 goto out; 306 307 vp = *vpp; 308 309 if (node->v_node != NULL) { 310 vp->v_type = VBAD; 311 vx_put(vp); 312 goto try_again; 313 } 314 315 vp->v_data = node; 316 node->v_node = vp; 317 318 switch (node->node_type) { 319 case Proot: 320 vsetflags(vp, VROOT); 321 /* fall through */ 322 case Pdir: 323 vp->v_type = VDIR; 324 break; 325 326 case Plink: 327 vp->v_type = VLNK; 328 break; 329 330 case Preg: 331 vp->v_type = VREG; 332 break; 333 334 case Pdev: 335 vp->v_type = VCHR; 336 KKASSERT(node->d_dev); 337 338 vp->v_uminor = node->d_dev->si_uminor; 339 vp->v_umajor = 0; 340 341 v_associate_rdev(vp, node->d_dev); 342 vp->v_ops = &node->mp->mnt_vn_spec_ops; 343 break; 344 345 default: 346 panic("devfs_allocv: unknown node type"); 347 } 348 349 out: 350 return error; 351 } 352 353 /* 354 * devfs_allocvp allocates both a devfs node (with the given settings) and a vnode 355 * based on the newly created devfs node. 356 */ 357 int 358 devfs_allocvp(struct mount *mp, struct vnode **vpp, devfs_nodetype devfsnodetype, 359 char *name, struct devfs_node *parent, cdev_t dev) 360 { 361 struct devfs_node *node; 362 363 node = devfs_allocp(devfsnodetype, name, parent, mp, dev); 364 365 if (node != NULL) 366 devfs_allocv(vpp, node); 367 else 368 *vpp = NULL; 369 370 return 0; 371 } 372 373 /* 374 * Destroy the devfs_node. The node must be unlinked from the topology. 375 * 376 * This function will also destroy any vnode association with the node 377 * and device. 378 * 379 * The cdev_t itself remains intact. 380 * 381 * The core lock is not necessarily held on call and must be temporarily 382 * released if it is to avoid a deadlock. 383 */ 384 int 385 devfs_freep(struct devfs_node *node) 386 { 387 struct vnode *vp; 388 int relock; 389 390 KKASSERT(node); 391 KKASSERT(((node->flags & DEVFS_NODE_LINKED) == 0) || 392 (node->node_type == Proot)); 393 394 /* 395 * Protect against double frees 396 */ 397 KKASSERT((node->flags & DEVFS_DESTROYED) == 0); 398 node->flags |= DEVFS_DESTROYED; 399 400 /* 401 * Avoid deadlocks between devfs_lock and the vnode lock when 402 * disassociating the vnode (stress2 pty vs ls -la /dev/pts). 403 * 404 * This also prevents the vnode reclaim code from double-freeing 405 * the node. The vget() is required to safely modified the vp 406 * and cycle the refs to terminate an inactive vp. 407 */ 408 if (lockstatus(&devfs_lock, curthread) == LK_EXCLUSIVE) { 409 lockmgr(&devfs_lock, LK_RELEASE); 410 relock = 1; 411 } else { 412 relock = 0; 413 } 414 415 while ((vp = node->v_node) != NULL) { 416 if (vget(vp, LK_EXCLUSIVE | LK_RETRY) != 0) 417 break; 418 v_release_rdev(vp); 419 vp->v_data = NULL; 420 node->v_node = NULL; 421 cache_inval_vp(vp, CINV_DESTROY); 422 vput(vp); 423 } 424 425 /* 426 * Remaining cleanup 427 */ 428 atomic_subtract_long(&DEVFS_MNTDATA(node->mp)->leak_count, 1); 429 if (node->symlink_name) { 430 kfree(node->symlink_name, M_DEVFS); 431 node->symlink_name = NULL; 432 } 433 434 /* 435 * Remove the node from the orphan list if it is still on it. 436 */ 437 if (node->flags & DEVFS_ORPHANED) 438 devfs_tracer_del_orphan(node); 439 440 if (node->d_dir.d_name) { 441 kfree(node->d_dir.d_name, M_DEVFS); 442 node->d_dir.d_name = NULL; 443 } 444 atomic_subtract_long(&DEVFS_MNTDATA(node->mp)->file_count, 1); 445 objcache_put(devfs_node_cache, node); 446 447 if (relock) 448 lockmgr(&devfs_lock, LK_EXCLUSIVE); 449 450 return 0; 451 } 452 453 /* 454 * Unlink the devfs node from the topology and add it to the orphan list. 455 * The node will later be destroyed by freep. 456 * 457 * Any vnode association, including the v_rdev and v_data, remains intact 458 * until the freep. 459 */ 460 int 461 devfs_unlinkp(struct devfs_node *node) 462 { 463 struct devfs_node *parent; 464 KKASSERT(node); 465 466 /* 467 * Add the node to the orphan list, so it is referenced somewhere, to 468 * so we don't leak it. 469 */ 470 devfs_tracer_add_orphan(node); 471 472 parent = node->parent; 473 474 /* 475 * If the parent is known we can unlink the node out of the topology 476 */ 477 if (parent) { 478 TAILQ_REMOVE(DEVFS_DENODE_HEAD(parent), node, link); 479 parent->nchildren--; 480 node->flags &= ~DEVFS_NODE_LINKED; 481 } 482 483 node->parent = NULL; 484 return 0; 485 } 486 487 void * 488 devfs_iterate_topology(struct devfs_node *node, 489 devfs_iterate_callback_t *callback, void *arg1) 490 { 491 struct devfs_node *node1, *node2; 492 void *ret = NULL; 493 494 if ((node->node_type == Proot) || (node->node_type == Pdir)) { 495 if (node->nchildren > 2) { 496 TAILQ_FOREACH_MUTABLE(node1, DEVFS_DENODE_HEAD(node), 497 link, node2) { 498 if ((ret = devfs_iterate_topology(node1, callback, arg1))) 499 return ret; 500 } 501 } 502 } 503 504 ret = callback(node, arg1); 505 return ret; 506 } 507 508 /* 509 * devfs_reaperp() is a recursive function that iterates through all the 510 * topology, unlinking and freeing all devfs nodes. 511 */ 512 static void * 513 devfs_reaperp_callback(struct devfs_node *node, void *unused) 514 { 515 devfs_unlinkp(node); 516 devfs_freep(node); 517 518 return NULL; 519 } 520 521 static void * 522 devfs_gc_dirs_callback(struct devfs_node *node, void *unused) 523 { 524 if (node->node_type == Pdir) { 525 if ((node->nchildren == 2) && 526 !(node->flags & DEVFS_USER_CREATED)) { 527 devfs_unlinkp(node); 528 devfs_freep(node); 529 } 530 } 531 532 return NULL; 533 } 534 535 static void * 536 devfs_gc_links_callback(struct devfs_node *node, struct devfs_node *target) 537 { 538 if ((node->node_type == Plink) && (node->link_target == target)) { 539 devfs_unlinkp(node); 540 devfs_freep(node); 541 } 542 543 return NULL; 544 } 545 546 /* 547 * devfs_gc() is devfs garbage collector. It takes care of unlinking and 548 * freeing a node, but also removes empty directories and links that link 549 * via devfs auto-link mechanism to the node being deleted. 550 */ 551 int 552 devfs_gc(struct devfs_node *node) 553 { 554 struct devfs_node *root_node = DEVFS_MNTDATA(node->mp)->root_node; 555 556 if (node->nlinks > 0) 557 devfs_iterate_topology(root_node, 558 (devfs_iterate_callback_t *)devfs_gc_links_callback, node); 559 560 devfs_unlinkp(node); 561 devfs_iterate_topology(root_node, 562 (devfs_iterate_callback_t *)devfs_gc_dirs_callback, NULL); 563 564 devfs_freep(node); 565 566 return 0; 567 } 568 569 /* 570 * devfs_create_dev() is the asynchronous entry point for device creation. 571 * It just sends a message with the relevant details to the devfs core. 572 * 573 * This function will reference the passed device. The reference is owned 574 * by devfs and represents all of the device's node associations. 575 */ 576 int 577 devfs_create_dev(cdev_t dev, uid_t uid, gid_t gid, int perms) 578 { 579 reference_dev(dev); 580 devfs_msg_send_dev(DEVFS_DEVICE_CREATE, dev, uid, gid, perms); 581 582 return 0; 583 } 584 585 /* 586 * devfs_destroy_dev() is the asynchronous entry point for device destruction. 587 * It just sends a message with the relevant details to the devfs core. 588 */ 589 int 590 devfs_destroy_dev(cdev_t dev) 591 { 592 devfs_msg_send_dev(DEVFS_DEVICE_DESTROY, dev, 0, 0, 0); 593 return 0; 594 } 595 596 /* 597 * devfs_mount_add() is the synchronous entry point for adding a new devfs 598 * mount. It sends a synchronous message with the relevant details to the 599 * devfs core. 600 */ 601 int 602 devfs_mount_add(struct devfs_mnt_data *mnt) 603 { 604 devfs_msg_t msg; 605 606 msg = devfs_msg_get(); 607 msg->mdv_mnt = mnt; 608 msg = devfs_msg_send_sync(DEVFS_MOUNT_ADD, msg); 609 devfs_msg_put(msg); 610 611 return 0; 612 } 613 614 /* 615 * devfs_mount_del() is the synchronous entry point for removing a devfs mount. 616 * It sends a synchronous message with the relevant details to the devfs core. 617 */ 618 int 619 devfs_mount_del(struct devfs_mnt_data *mnt) 620 { 621 devfs_msg_t msg; 622 623 msg = devfs_msg_get(); 624 msg->mdv_mnt = mnt; 625 msg = devfs_msg_send_sync(DEVFS_MOUNT_DEL, msg); 626 devfs_msg_put(msg); 627 628 return 0; 629 } 630 631 /* 632 * devfs_destroy_related() is the synchronous entry point for device 633 * destruction by subname. It just sends a message with the relevant details to 634 * the devfs core. 635 */ 636 int 637 devfs_destroy_related(cdev_t dev) 638 { 639 devfs_msg_t msg; 640 641 msg = devfs_msg_get(); 642 msg->mdv_load = dev; 643 msg = devfs_msg_send_sync(DEVFS_DESTROY_RELATED, msg); 644 devfs_msg_put(msg); 645 return 0; 646 } 647 648 int 649 devfs_clr_related_flag(cdev_t dev, uint32_t flag) 650 { 651 devfs_msg_t msg; 652 653 msg = devfs_msg_get(); 654 msg->mdv_flags.dev = dev; 655 msg->mdv_flags.flag = flag; 656 msg = devfs_msg_send_sync(DEVFS_CLR_RELATED_FLAG, msg); 657 devfs_msg_put(msg); 658 659 return 0; 660 } 661 662 int 663 devfs_destroy_related_without_flag(cdev_t dev, uint32_t flag) 664 { 665 devfs_msg_t msg; 666 667 msg = devfs_msg_get(); 668 msg->mdv_flags.dev = dev; 669 msg->mdv_flags.flag = flag; 670 msg = devfs_msg_send_sync(DEVFS_DESTROY_RELATED_WO_FLAG, msg); 671 devfs_msg_put(msg); 672 673 return 0; 674 } 675 676 /* 677 * devfs_create_all_dev is the asynchronous entry point to trigger device 678 * node creation. It just sends a message with the relevant details to 679 * the devfs core. 680 */ 681 int 682 devfs_create_all_dev(struct devfs_node *root) 683 { 684 devfs_msg_send_generic(DEVFS_CREATE_ALL_DEV, root); 685 return 0; 686 } 687 688 /* 689 * devfs_destroy_dev_by_ops is the asynchronous entry point to destroy all 690 * devices with a specific set of dev_ops and minor. It just sends a 691 * message with the relevant details to the devfs core. 692 */ 693 int 694 devfs_destroy_dev_by_ops(struct dev_ops *ops, int minor) 695 { 696 devfs_msg_send_ops(DEVFS_DESTROY_DEV_BY_OPS, ops, minor); 697 return 0; 698 } 699 700 /* 701 * devfs_clone_handler_add is the synchronous entry point to add a new 702 * clone handler. It just sends a message with the relevant details to 703 * the devfs core. 704 */ 705 int 706 devfs_clone_handler_add(const char *name, d_clone_t *nhandler) 707 { 708 devfs_msg_t msg; 709 710 msg = devfs_msg_get(); 711 msg->mdv_chandler.name = name; 712 msg->mdv_chandler.nhandler = nhandler; 713 msg = devfs_msg_send_sync(DEVFS_CHANDLER_ADD, msg); 714 devfs_msg_put(msg); 715 return 0; 716 } 717 718 /* 719 * devfs_clone_handler_del is the synchronous entry point to remove a 720 * clone handler. It just sends a message with the relevant details to 721 * the devfs core. 722 */ 723 int 724 devfs_clone_handler_del(const char *name) 725 { 726 devfs_msg_t msg; 727 728 msg = devfs_msg_get(); 729 msg->mdv_chandler.name = name; 730 msg->mdv_chandler.nhandler = NULL; 731 msg = devfs_msg_send_sync(DEVFS_CHANDLER_DEL, msg); 732 devfs_msg_put(msg); 733 return 0; 734 } 735 736 /* 737 * devfs_find_device_by_name is the synchronous entry point to find a 738 * device given its name. It sends a synchronous message with the 739 * relevant details to the devfs core and returns the answer. 740 */ 741 cdev_t 742 devfs_find_device_by_name(const char *fmt, ...) 743 { 744 cdev_t found = NULL; 745 devfs_msg_t msg; 746 char *target; 747 __va_list ap; 748 749 if (fmt == NULL) 750 return NULL; 751 752 __va_start(ap, fmt); 753 kvasnrprintf(&target, PATH_MAX, 10, fmt, ap); 754 __va_end(ap); 755 756 msg = devfs_msg_get(); 757 msg->mdv_name = target; 758 msg = devfs_msg_send_sync(DEVFS_FIND_DEVICE_BY_NAME, msg); 759 found = msg->mdv_cdev; 760 devfs_msg_put(msg); 761 kvasfree(&target); 762 763 return found; 764 } 765 766 /* 767 * devfs_find_device_by_udev is the synchronous entry point to find a 768 * device given its udev number. It sends a synchronous message with 769 * the relevant details to the devfs core and returns the answer. 770 */ 771 cdev_t 772 devfs_find_device_by_udev(udev_t udev) 773 { 774 cdev_t found = NULL; 775 devfs_msg_t msg; 776 777 msg = devfs_msg_get(); 778 msg->mdv_udev = udev; 779 msg = devfs_msg_send_sync(DEVFS_FIND_DEVICE_BY_UDEV, msg); 780 found = msg->mdv_cdev; 781 devfs_msg_put(msg); 782 783 devfs_debug(DEVFS_DEBUG_DEBUG, 784 "devfs_find_device_by_udev found? %s -end:3-\n", 785 ((found) ? found->si_name:"NO")); 786 return found; 787 } 788 789 struct vnode * 790 devfs_inode_to_vnode(struct mount *mp, ino_t target) 791 { 792 struct vnode *vp = NULL; 793 devfs_msg_t msg; 794 795 if (mp == NULL) 796 return NULL; 797 798 msg = devfs_msg_get(); 799 msg->mdv_ino.mp = mp; 800 msg->mdv_ino.ino = target; 801 msg = devfs_msg_send_sync(DEVFS_INODE_TO_VNODE, msg); 802 vp = msg->mdv_ino.vp; 803 vn_lock(vp, LK_EXCLUSIVE | LK_RETRY); 804 devfs_msg_put(msg); 805 806 return vp; 807 } 808 809 /* 810 * devfs_make_alias is the asynchronous entry point to register an alias 811 * for a device. It just sends a message with the relevant details to the 812 * devfs core. 813 */ 814 int 815 devfs_make_alias(const char *name, cdev_t dev_target) 816 { 817 struct devfs_alias *alias; 818 size_t len; 819 820 len = strlen(name); 821 822 alias = kmalloc(sizeof(struct devfs_alias), M_DEVFS, M_WAITOK); 823 alias->name = kstrdup(name, M_DEVFS); 824 alias->namlen = len; 825 alias->dev_target = dev_target; 826 827 devfs_msg_send_generic(DEVFS_MAKE_ALIAS, alias); 828 return 0; 829 } 830 831 /* 832 * devfs_destroy_alias is the asynchronous entry point to deregister an alias 833 * for a device. It just sends a message with the relevant details to the 834 * devfs core. 835 */ 836 int 837 devfs_destroy_alias(const char *name, cdev_t dev_target) 838 { 839 struct devfs_alias *alias; 840 size_t len; 841 842 len = strlen(name); 843 844 alias = kmalloc(sizeof(struct devfs_alias), M_DEVFS, M_WAITOK); 845 alias->name = kstrdup(name, M_DEVFS); 846 alias->namlen = len; 847 alias->dev_target = dev_target; 848 849 devfs_msg_send_generic(DEVFS_DESTROY_ALIAS, alias); 850 return 0; 851 } 852 853 /* 854 * devfs_apply_rules is the asynchronous entry point to trigger application 855 * of all rules. It just sends a message with the relevant details to the 856 * devfs core. 857 */ 858 int 859 devfs_apply_rules(char *mntto) 860 { 861 char *new_name; 862 863 new_name = kstrdup(mntto, M_DEVFS); 864 devfs_msg_send_name(DEVFS_APPLY_RULES, new_name); 865 866 return 0; 867 } 868 869 /* 870 * devfs_reset_rules is the asynchronous entry point to trigger reset of all 871 * rules. It just sends a message with the relevant details to the devfs core. 872 */ 873 int 874 devfs_reset_rules(char *mntto) 875 { 876 char *new_name; 877 878 new_name = kstrdup(mntto, M_DEVFS); 879 devfs_msg_send_name(DEVFS_RESET_RULES, new_name); 880 881 return 0; 882 } 883 884 885 /* 886 * devfs_scan_callback is the asynchronous entry point to call a callback 887 * on all cdevs. 888 * It just sends a message with the relevant details to the devfs core. 889 */ 890 int 891 devfs_scan_callback(devfs_scan_t *callback, void *arg) 892 { 893 devfs_msg_t msg; 894 895 KKASSERT(sizeof(callback) == sizeof(void *)); 896 897 msg = devfs_msg_get(); 898 msg->mdv_load = callback; 899 msg->mdv_load2 = arg; 900 msg = devfs_msg_send_sync(DEVFS_SCAN_CALLBACK, msg); 901 devfs_msg_put(msg); 902 903 return 0; 904 } 905 906 907 /* 908 * Acts as a message drain. Any message that is replied to here gets destroyed 909 * and the memory freed. 910 */ 911 static void 912 devfs_msg_autofree_reply(lwkt_port_t port, lwkt_msg_t msg) 913 { 914 devfs_msg_put((devfs_msg_t)msg); 915 } 916 917 /* 918 * devfs_msg_get allocates a new devfs msg and returns it. 919 */ 920 devfs_msg_t 921 devfs_msg_get(void) 922 { 923 return objcache_get(devfs_msg_cache, M_WAITOK); 924 } 925 926 /* 927 * devfs_msg_put deallocates a given devfs msg. 928 */ 929 int 930 devfs_msg_put(devfs_msg_t msg) 931 { 932 objcache_put(devfs_msg_cache, msg); 933 return 0; 934 } 935 936 /* 937 * devfs_msg_send is the generic asynchronous message sending facility 938 * for devfs. By default the reply port is the automatic disposal port. 939 * 940 * If the current thread is the devfs_msg_port thread we execute the 941 * operation synchronously. 942 */ 943 void 944 devfs_msg_send(uint32_t cmd, devfs_msg_t devfs_msg) 945 { 946 lwkt_port_t port = &devfs_msg_port; 947 948 lwkt_initmsg(&devfs_msg->hdr, &devfs_dispose_port, 0); 949 950 devfs_msg->hdr.u.ms_result = cmd; 951 952 if (port->mpu_td == curthread) { 953 devfs_msg_exec(devfs_msg); 954 lwkt_replymsg(&devfs_msg->hdr, 0); 955 } else { 956 lwkt_sendmsg(port, (lwkt_msg_t)devfs_msg); 957 } 958 } 959 960 /* 961 * devfs_msg_send_sync is the generic synchronous message sending 962 * facility for devfs. It initializes a local reply port and waits 963 * for the core's answer. This answer is then returned. 964 */ 965 devfs_msg_t 966 devfs_msg_send_sync(uint32_t cmd, devfs_msg_t devfs_msg) 967 { 968 struct lwkt_port rep_port; 969 devfs_msg_t msg_incoming; 970 lwkt_port_t port = &devfs_msg_port; 971 972 lwkt_initport_thread(&rep_port, curthread); 973 lwkt_initmsg(&devfs_msg->hdr, &rep_port, 0); 974 975 devfs_msg->hdr.u.ms_result = cmd; 976 977 lwkt_sendmsg(port, (lwkt_msg_t)devfs_msg); 978 msg_incoming = lwkt_waitport(&rep_port, 0); 979 980 return msg_incoming; 981 } 982 983 /* 984 * sends a message with a generic argument. 985 */ 986 void 987 devfs_msg_send_generic(uint32_t cmd, void *load) 988 { 989 devfs_msg_t devfs_msg = devfs_msg_get(); 990 991 devfs_msg->mdv_load = load; 992 devfs_msg_send(cmd, devfs_msg); 993 } 994 995 /* 996 * sends a message with a name argument. 997 */ 998 void 999 devfs_msg_send_name(uint32_t cmd, char *name) 1000 { 1001 devfs_msg_t devfs_msg = devfs_msg_get(); 1002 1003 devfs_msg->mdv_name = name; 1004 devfs_msg_send(cmd, devfs_msg); 1005 } 1006 1007 /* 1008 * sends a message with a mount argument. 1009 */ 1010 void 1011 devfs_msg_send_mount(uint32_t cmd, struct devfs_mnt_data *mnt) 1012 { 1013 devfs_msg_t devfs_msg = devfs_msg_get(); 1014 1015 devfs_msg->mdv_mnt = mnt; 1016 devfs_msg_send(cmd, devfs_msg); 1017 } 1018 1019 /* 1020 * sends a message with an ops argument. 1021 */ 1022 void 1023 devfs_msg_send_ops(uint32_t cmd, struct dev_ops *ops, int minor) 1024 { 1025 devfs_msg_t devfs_msg = devfs_msg_get(); 1026 1027 devfs_msg->mdv_ops.ops = ops; 1028 devfs_msg->mdv_ops.minor = minor; 1029 devfs_msg_send(cmd, devfs_msg); 1030 } 1031 1032 /* 1033 * sends a message with a clone handler argument. 1034 */ 1035 void 1036 devfs_msg_send_chandler(uint32_t cmd, char *name, d_clone_t handler) 1037 { 1038 devfs_msg_t devfs_msg = devfs_msg_get(); 1039 1040 devfs_msg->mdv_chandler.name = name; 1041 devfs_msg->mdv_chandler.nhandler = handler; 1042 devfs_msg_send(cmd, devfs_msg); 1043 } 1044 1045 /* 1046 * sends a message with a device argument. 1047 */ 1048 void 1049 devfs_msg_send_dev(uint32_t cmd, cdev_t dev, uid_t uid, gid_t gid, int perms) 1050 { 1051 devfs_msg_t devfs_msg = devfs_msg_get(); 1052 1053 devfs_msg->mdv_dev.dev = dev; 1054 devfs_msg->mdv_dev.uid = uid; 1055 devfs_msg->mdv_dev.gid = gid; 1056 devfs_msg->mdv_dev.perms = perms; 1057 1058 devfs_msg_send(cmd, devfs_msg); 1059 } 1060 1061 /* 1062 * sends a message with a link argument. 1063 */ 1064 void 1065 devfs_msg_send_link(uint32_t cmd, char *name, char *target, struct mount *mp) 1066 { 1067 devfs_msg_t devfs_msg = devfs_msg_get(); 1068 1069 devfs_msg->mdv_link.name = name; 1070 devfs_msg->mdv_link.target = target; 1071 devfs_msg->mdv_link.mp = mp; 1072 devfs_msg_send(cmd, devfs_msg); 1073 } 1074 1075 /* 1076 * devfs_msg_core is the main devfs thread. It handles all incoming messages 1077 * and calls the relevant worker functions. By using messages it's assured 1078 * that events occur in the correct order. 1079 */ 1080 static void 1081 devfs_msg_core(void *arg) 1082 { 1083 devfs_msg_t msg; 1084 1085 lwkt_initport_thread(&devfs_msg_port, curthread); 1086 1087 lockmgr(&devfs_lock, LK_EXCLUSIVE); 1088 devfs_run = 1; 1089 wakeup(td_core); 1090 lockmgr(&devfs_lock, LK_RELEASE); 1091 1092 get_mplock(); /* mpsafe yet? */ 1093 1094 while (devfs_run) { 1095 msg = (devfs_msg_t)lwkt_waitport(&devfs_msg_port, 0); 1096 devfs_debug(DEVFS_DEBUG_DEBUG, 1097 "devfs_msg_core, new msg: %x\n", 1098 (unsigned int)msg->hdr.u.ms_result); 1099 devfs_msg_exec(msg); 1100 lwkt_replymsg(&msg->hdr, 0); 1101 } 1102 1103 rel_mplock(); 1104 wakeup(td_core); 1105 1106 lwkt_exit(); 1107 } 1108 1109 static void 1110 devfs_msg_exec(devfs_msg_t msg) 1111 { 1112 struct devfs_mnt_data *mnt; 1113 struct devfs_node *node; 1114 cdev_t dev; 1115 1116 /* 1117 * Acquire the devfs lock to ensure safety of all called functions 1118 */ 1119 lockmgr(&devfs_lock, LK_EXCLUSIVE); 1120 1121 switch (msg->hdr.u.ms_result) { 1122 case DEVFS_DEVICE_CREATE: 1123 dev = msg->mdv_dev.dev; 1124 devfs_create_dev_worker(dev, 1125 msg->mdv_dev.uid, 1126 msg->mdv_dev.gid, 1127 msg->mdv_dev.perms); 1128 break; 1129 case DEVFS_DEVICE_DESTROY: 1130 dev = msg->mdv_dev.dev; 1131 devfs_destroy_dev_worker(dev); 1132 break; 1133 case DEVFS_DESTROY_RELATED: 1134 devfs_destroy_related_worker(msg->mdv_load); 1135 break; 1136 case DEVFS_DESTROY_DEV_BY_OPS: 1137 devfs_destroy_dev_by_ops_worker(msg->mdv_ops.ops, 1138 msg->mdv_ops.minor); 1139 break; 1140 case DEVFS_CREATE_ALL_DEV: 1141 node = (struct devfs_node *)msg->mdv_load; 1142 devfs_create_all_dev_worker(node); 1143 break; 1144 case DEVFS_MOUNT_ADD: 1145 mnt = msg->mdv_mnt; 1146 TAILQ_INSERT_TAIL(&devfs_mnt_list, mnt, link); 1147 devfs_create_all_dev_worker(mnt->root_node); 1148 break; 1149 case DEVFS_MOUNT_DEL: 1150 mnt = msg->mdv_mnt; 1151 TAILQ_REMOVE(&devfs_mnt_list, mnt, link); 1152 devfs_iterate_topology(mnt->root_node, devfs_reaperp_callback, 1153 NULL); 1154 if (mnt->leak_count) { 1155 devfs_debug(DEVFS_DEBUG_SHOW, 1156 "Leaked %ld devfs_node elements!\n", 1157 mnt->leak_count); 1158 } 1159 break; 1160 case DEVFS_CHANDLER_ADD: 1161 devfs_chandler_add_worker(msg->mdv_chandler.name, 1162 msg->mdv_chandler.nhandler); 1163 break; 1164 case DEVFS_CHANDLER_DEL: 1165 devfs_chandler_del_worker(msg->mdv_chandler.name); 1166 break; 1167 case DEVFS_FIND_DEVICE_BY_NAME: 1168 devfs_find_device_by_name_worker(msg); 1169 break; 1170 case DEVFS_FIND_DEVICE_BY_UDEV: 1171 devfs_find_device_by_udev_worker(msg); 1172 break; 1173 case DEVFS_MAKE_ALIAS: 1174 devfs_make_alias_worker((struct devfs_alias *)msg->mdv_load); 1175 break; 1176 case DEVFS_DESTROY_ALIAS: 1177 devfs_destroy_alias_worker((struct devfs_alias *)msg->mdv_load); 1178 break; 1179 case DEVFS_APPLY_RULES: 1180 devfs_apply_reset_rules_caller(msg->mdv_name, 1); 1181 break; 1182 case DEVFS_RESET_RULES: 1183 devfs_apply_reset_rules_caller(msg->mdv_name, 0); 1184 break; 1185 case DEVFS_SCAN_CALLBACK: 1186 devfs_scan_callback_worker((devfs_scan_t *)msg->mdv_load, 1187 msg->mdv_load2); 1188 break; 1189 case DEVFS_CLR_RELATED_FLAG: 1190 devfs_clr_related_flag_worker(msg->mdv_flags.dev, 1191 msg->mdv_flags.flag); 1192 break; 1193 case DEVFS_DESTROY_RELATED_WO_FLAG: 1194 devfs_destroy_related_without_flag_worker(msg->mdv_flags.dev, 1195 msg->mdv_flags.flag); 1196 break; 1197 case DEVFS_INODE_TO_VNODE: 1198 msg->mdv_ino.vp = devfs_iterate_topology( 1199 DEVFS_MNTDATA(msg->mdv_ino.mp)->root_node, 1200 (devfs_iterate_callback_t *)devfs_inode_to_vnode_worker_callback, 1201 &msg->mdv_ino.ino); 1202 break; 1203 case DEVFS_TERMINATE_CORE: 1204 devfs_run = 0; 1205 break; 1206 case DEVFS_SYNC: 1207 break; 1208 default: 1209 devfs_debug(DEVFS_DEBUG_WARNING, 1210 "devfs_msg_core: unknown message " 1211 "received at core\n"); 1212 break; 1213 } 1214 lockmgr(&devfs_lock, LK_RELEASE); 1215 } 1216 1217 /* 1218 * Worker function to insert a new dev into the dev list and initialize its 1219 * permissions. It also calls devfs_propagate_dev which in turn propagates 1220 * the change to all mount points. 1221 * 1222 * The passed dev is already referenced. This reference is eaten by this 1223 * function and represents the dev's linkage into devfs_dev_list. 1224 */ 1225 static int 1226 devfs_create_dev_worker(cdev_t dev, uid_t uid, gid_t gid, int perms) 1227 { 1228 KKASSERT(dev); 1229 1230 dev->si_uid = uid; 1231 dev->si_gid = gid; 1232 dev->si_perms = perms; 1233 1234 devfs_link_dev(dev); 1235 devfs_propagate_dev(dev, 1); 1236 1237 udev_event_attach(dev, NULL, 0); 1238 1239 return 0; 1240 } 1241 1242 /* 1243 * Worker function to delete a dev from the dev list and free the cdev. 1244 * It also calls devfs_propagate_dev which in turn propagates the change 1245 * to all mount points. 1246 */ 1247 static int 1248 devfs_destroy_dev_worker(cdev_t dev) 1249 { 1250 int error; 1251 1252 KKASSERT(dev); 1253 KKASSERT((lockstatus(&devfs_lock, curthread)) == LK_EXCLUSIVE); 1254 1255 error = devfs_unlink_dev(dev); 1256 devfs_propagate_dev(dev, 0); 1257 1258 udev_event_detach(dev, NULL, 0); 1259 1260 if (error == 0) 1261 release_dev(dev); /* link ref */ 1262 release_dev(dev); 1263 release_dev(dev); 1264 1265 return 0; 1266 } 1267 1268 /* 1269 * Worker function to destroy all devices with a certain basename. 1270 * Calls devfs_destroy_dev_worker for the actual destruction. 1271 */ 1272 static int 1273 devfs_destroy_related_worker(cdev_t needle) 1274 { 1275 cdev_t dev; 1276 1277 restart: 1278 devfs_debug(DEVFS_DEBUG_DEBUG, "related worker: %s\n", 1279 needle->si_name); 1280 TAILQ_FOREACH(dev, &devfs_dev_list, link) { 1281 if (dev->si_parent == needle) { 1282 devfs_destroy_related_worker(dev); 1283 devfs_destroy_dev_worker(dev); 1284 goto restart; 1285 } 1286 } 1287 return 0; 1288 } 1289 1290 static int 1291 devfs_clr_related_flag_worker(cdev_t needle, uint32_t flag) 1292 { 1293 cdev_t dev, dev1; 1294 1295 TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) { 1296 if (dev->si_parent == needle) { 1297 devfs_clr_related_flag_worker(dev, flag); 1298 dev->si_flags &= ~flag; 1299 } 1300 } 1301 1302 return 0; 1303 } 1304 1305 static int 1306 devfs_destroy_related_without_flag_worker(cdev_t needle, uint32_t flag) 1307 { 1308 cdev_t dev; 1309 1310 restart: 1311 devfs_debug(DEVFS_DEBUG_DEBUG, "related_wo_flag: %s\n", 1312 needle->si_name); 1313 1314 TAILQ_FOREACH(dev, &devfs_dev_list, link) { 1315 if (dev->si_parent == needle) { 1316 devfs_destroy_related_without_flag_worker(dev, flag); 1317 if (!(dev->si_flags & flag)) { 1318 devfs_destroy_dev_worker(dev); 1319 devfs_debug(DEVFS_DEBUG_DEBUG, 1320 "related_wo_flag: %s restart\n", dev->si_name); 1321 goto restart; 1322 } 1323 } 1324 } 1325 1326 return 0; 1327 } 1328 1329 /* 1330 * Worker function that creates all device nodes on top of a devfs 1331 * root node. 1332 */ 1333 static int 1334 devfs_create_all_dev_worker(struct devfs_node *root) 1335 { 1336 cdev_t dev; 1337 1338 KKASSERT(root); 1339 1340 TAILQ_FOREACH(dev, &devfs_dev_list, link) { 1341 devfs_create_device_node(root, dev, NULL, NULL); 1342 } 1343 1344 return 0; 1345 } 1346 1347 /* 1348 * Worker function that destroys all devices that match a specific 1349 * dev_ops and/or minor. If minor is less than 0, it is not matched 1350 * against. It also propagates all changes. 1351 */ 1352 static int 1353 devfs_destroy_dev_by_ops_worker(struct dev_ops *ops, int minor) 1354 { 1355 cdev_t dev, dev1; 1356 1357 KKASSERT(ops); 1358 1359 TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) { 1360 if (dev->si_ops != ops) 1361 continue; 1362 if ((minor < 0) || (dev->si_uminor == minor)) { 1363 devfs_destroy_dev_worker(dev); 1364 } 1365 } 1366 1367 return 0; 1368 } 1369 1370 /* 1371 * Worker function that registers a new clone handler in devfs. 1372 */ 1373 static int 1374 devfs_chandler_add_worker(const char *name, d_clone_t *nhandler) 1375 { 1376 struct devfs_clone_handler *chandler = NULL; 1377 u_char len = strlen(name); 1378 1379 if (len == 0) 1380 return 1; 1381 1382 TAILQ_FOREACH(chandler, &devfs_chandler_list, link) { 1383 if (chandler->namlen != len) 1384 continue; 1385 1386 if (!memcmp(chandler->name, name, len)) { 1387 /* Clonable basename already exists */ 1388 return 1; 1389 } 1390 } 1391 1392 chandler = kmalloc(sizeof(*chandler), M_DEVFS, M_WAITOK | M_ZERO); 1393 chandler->name = kstrdup(name, M_DEVFS); 1394 chandler->namlen = len; 1395 chandler->nhandler = nhandler; 1396 1397 TAILQ_INSERT_TAIL(&devfs_chandler_list, chandler, link); 1398 return 0; 1399 } 1400 1401 /* 1402 * Worker function that removes a given clone handler from the 1403 * clone handler list. 1404 */ 1405 static int 1406 devfs_chandler_del_worker(const char *name) 1407 { 1408 struct devfs_clone_handler *chandler, *chandler2; 1409 u_char len = strlen(name); 1410 1411 if (len == 0) 1412 return 1; 1413 1414 TAILQ_FOREACH_MUTABLE(chandler, &devfs_chandler_list, link, chandler2) { 1415 if (chandler->namlen != len) 1416 continue; 1417 if (memcmp(chandler->name, name, len)) 1418 continue; 1419 1420 TAILQ_REMOVE(&devfs_chandler_list, chandler, link); 1421 kfree(chandler->name, M_DEVFS); 1422 kfree(chandler, M_DEVFS); 1423 break; 1424 } 1425 1426 return 0; 1427 } 1428 1429 /* 1430 * Worker function that finds a given device name and changes 1431 * the message received accordingly so that when replied to, 1432 * the answer is returned to the caller. 1433 */ 1434 static int 1435 devfs_find_device_by_name_worker(devfs_msg_t devfs_msg) 1436 { 1437 struct devfs_alias *alias; 1438 cdev_t dev; 1439 cdev_t found = NULL; 1440 1441 TAILQ_FOREACH(dev, &devfs_dev_list, link) { 1442 if (strcmp(devfs_msg->mdv_name, dev->si_name) == 0) { 1443 found = dev; 1444 break; 1445 } 1446 } 1447 if (found == NULL) { 1448 TAILQ_FOREACH(alias, &devfs_alias_list, link) { 1449 if (strcmp(devfs_msg->mdv_name, alias->name) == 0) { 1450 found = alias->dev_target; 1451 break; 1452 } 1453 } 1454 } 1455 devfs_msg->mdv_cdev = found; 1456 1457 return 0; 1458 } 1459 1460 /* 1461 * Worker function that finds a given device udev and changes 1462 * the message received accordingly so that when replied to, 1463 * the answer is returned to the caller. 1464 */ 1465 static int 1466 devfs_find_device_by_udev_worker(devfs_msg_t devfs_msg) 1467 { 1468 cdev_t dev, dev1; 1469 cdev_t found = NULL; 1470 1471 TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) { 1472 if (((udev_t)dev->si_inode) == devfs_msg->mdv_udev) { 1473 found = dev; 1474 break; 1475 } 1476 } 1477 devfs_msg->mdv_cdev = found; 1478 1479 return 0; 1480 } 1481 1482 /* 1483 * Worker function that inserts a given alias into the 1484 * alias list, and propagates the alias to all mount 1485 * points. 1486 */ 1487 static int 1488 devfs_make_alias_worker(struct devfs_alias *alias) 1489 { 1490 struct devfs_alias *alias2; 1491 size_t len = strlen(alias->name); 1492 int found = 0; 1493 1494 TAILQ_FOREACH(alias2, &devfs_alias_list, link) { 1495 if (len != alias2->namlen) 1496 continue; 1497 1498 if (!memcmp(alias->name, alias2->name, len)) { 1499 found = 1; 1500 break; 1501 } 1502 } 1503 1504 if (!found) { 1505 /* 1506 * The alias doesn't exist yet, so we add it to the alias list 1507 */ 1508 TAILQ_INSERT_TAIL(&devfs_alias_list, alias, link); 1509 devfs_alias_propagate(alias, 0); 1510 udev_event_attach(alias->dev_target, alias->name, 1); 1511 } else { 1512 devfs_debug(DEVFS_DEBUG_WARNING, 1513 "Warning: duplicate devfs_make_alias for %s\n", 1514 alias->name); 1515 kfree(alias->name, M_DEVFS); 1516 kfree(alias, M_DEVFS); 1517 } 1518 1519 return 0; 1520 } 1521 1522 /* 1523 * Worker function that delete a given alias from the 1524 * alias list, and propagates the removal to all mount 1525 * points. 1526 */ 1527 static int 1528 devfs_destroy_alias_worker(struct devfs_alias *alias) 1529 { 1530 struct devfs_alias *alias2; 1531 int found = 0; 1532 1533 TAILQ_FOREACH(alias2, &devfs_alias_list, link) { 1534 if (alias->dev_target != alias2->dev_target) 1535 continue; 1536 1537 if (devfs_WildCmp(alias->name, alias2->name) == 0) { 1538 found = 1; 1539 break; 1540 } 1541 } 1542 1543 if (!found) { 1544 devfs_debug(DEVFS_DEBUG_WARNING, 1545 "Warning: devfs_destroy_alias for inexistant alias: %s\n", 1546 alias->name); 1547 kfree(alias->name, M_DEVFS); 1548 kfree(alias, M_DEVFS); 1549 } else { 1550 /* 1551 * The alias exists, so we delete it from the alias list 1552 */ 1553 TAILQ_REMOVE(&devfs_alias_list, alias2, link); 1554 devfs_alias_propagate(alias2, 1); 1555 udev_event_detach(alias2->dev_target, alias2->name, 1); 1556 kfree(alias->name, M_DEVFS); 1557 kfree(alias, M_DEVFS); 1558 kfree(alias2->name, M_DEVFS); 1559 kfree(alias2, M_DEVFS); 1560 } 1561 1562 return 0; 1563 } 1564 1565 /* 1566 * Function that removes and frees all aliases. 1567 */ 1568 static int 1569 devfs_alias_reap(void) 1570 { 1571 struct devfs_alias *alias, *alias2; 1572 1573 TAILQ_FOREACH_MUTABLE(alias, &devfs_alias_list, link, alias2) { 1574 TAILQ_REMOVE(&devfs_alias_list, alias, link); 1575 kfree(alias->name, M_DEVFS); 1576 kfree(alias, M_DEVFS); 1577 } 1578 return 0; 1579 } 1580 1581 /* 1582 * Function that removes an alias matching a specific cdev and frees 1583 * it accordingly. 1584 */ 1585 static int 1586 devfs_alias_remove(cdev_t dev) 1587 { 1588 struct devfs_alias *alias, *alias2; 1589 1590 TAILQ_FOREACH_MUTABLE(alias, &devfs_alias_list, link, alias2) { 1591 if (alias->dev_target == dev) { 1592 TAILQ_REMOVE(&devfs_alias_list, alias, link); 1593 udev_event_detach(alias->dev_target, alias->name, 1); 1594 kfree(alias->name, M_DEVFS); 1595 kfree(alias, M_DEVFS); 1596 } 1597 } 1598 return 0; 1599 } 1600 1601 /* 1602 * This function propagates an alias addition or removal to 1603 * all mount points. 1604 */ 1605 static int 1606 devfs_alias_propagate(struct devfs_alias *alias, int remove) 1607 { 1608 struct devfs_mnt_data *mnt; 1609 1610 TAILQ_FOREACH(mnt, &devfs_mnt_list, link) { 1611 if (remove) { 1612 devfs_destroy_node(mnt->root_node, alias->name); 1613 } else { 1614 devfs_alias_apply(mnt->root_node, alias); 1615 } 1616 } 1617 return 0; 1618 } 1619 1620 /* 1621 * This function is a recursive function iterating through 1622 * all device nodes in the topology and, if applicable, 1623 * creating the relevant alias for a device node. 1624 */ 1625 static int 1626 devfs_alias_apply(struct devfs_node *node, struct devfs_alias *alias) 1627 { 1628 struct devfs_node *node1, *node2; 1629 1630 KKASSERT(alias != NULL); 1631 1632 if ((node->node_type == Proot) || (node->node_type == Pdir)) { 1633 if (node->nchildren > 2) { 1634 TAILQ_FOREACH_MUTABLE(node1, DEVFS_DENODE_HEAD(node), link, node2) { 1635 devfs_alias_apply(node1, alias); 1636 } 1637 } 1638 } else { 1639 if (node->d_dev == alias->dev_target) 1640 devfs_alias_create(alias->name, node, 0); 1641 } 1642 return 0; 1643 } 1644 1645 /* 1646 * This function checks if any alias possibly is applicable 1647 * to the given node. If so, the alias is created. 1648 */ 1649 static int 1650 devfs_alias_check_create(struct devfs_node *node) 1651 { 1652 struct devfs_alias *alias; 1653 1654 TAILQ_FOREACH(alias, &devfs_alias_list, link) { 1655 if (node->d_dev == alias->dev_target) 1656 devfs_alias_create(alias->name, node, 0); 1657 } 1658 return 0; 1659 } 1660 1661 /* 1662 * This function creates an alias with a given name 1663 * linking to a given devfs node. It also increments 1664 * the link count on the target node. 1665 */ 1666 int 1667 devfs_alias_create(char *name_orig, struct devfs_node *target, int rule_based) 1668 { 1669 struct mount *mp = target->mp; 1670 struct devfs_node *parent = DEVFS_MNTDATA(mp)->root_node; 1671 struct devfs_node *linknode; 1672 char *create_path = NULL; 1673 char *name; 1674 char *name_buf; 1675 int result = 0; 1676 1677 KKASSERT((lockstatus(&devfs_lock, curthread)) == LK_EXCLUSIVE); 1678 1679 name_buf = kmalloc(PATH_MAX, M_TEMP, M_WAITOK); 1680 devfs_resolve_name_path(name_orig, name_buf, &create_path, &name); 1681 1682 if (create_path) 1683 parent = devfs_resolve_or_create_path(parent, create_path, 1); 1684 1685 1686 if (devfs_find_device_node_by_name(parent, name)) { 1687 devfs_debug(DEVFS_DEBUG_WARNING, 1688 "Node already exists: %s " 1689 "(devfs_make_alias_worker)!\n", 1690 name); 1691 result = 1; 1692 goto done; 1693 } 1694 1695 linknode = devfs_allocp(Plink, name, parent, mp, NULL); 1696 if (linknode == NULL) { 1697 result = 1; 1698 goto done; 1699 } 1700 1701 linknode->link_target = target; 1702 target->nlinks++; 1703 1704 if (rule_based) 1705 linknode->flags |= DEVFS_RULE_CREATED; 1706 1707 done: 1708 kfree(name_buf, M_TEMP); 1709 return (result); 1710 } 1711 1712 /* 1713 * This function is called by the core and handles mount point 1714 * strings. It either calls the relevant worker (devfs_apply_ 1715 * reset_rules_worker) on all mountpoints or only a specific 1716 * one. 1717 */ 1718 static int 1719 devfs_apply_reset_rules_caller(char *mountto, int apply) 1720 { 1721 struct devfs_mnt_data *mnt; 1722 1723 if (mountto[0] == '*') { 1724 TAILQ_FOREACH(mnt, &devfs_mnt_list, link) { 1725 devfs_iterate_topology(mnt->root_node, 1726 (apply)?(devfs_rule_check_apply):(devfs_rule_reset_node), 1727 NULL); 1728 } 1729 } else { 1730 TAILQ_FOREACH(mnt, &devfs_mnt_list, link) { 1731 if (!strcmp(mnt->mp->mnt_stat.f_mntonname, mountto)) { 1732 devfs_iterate_topology(mnt->root_node, 1733 (apply)?(devfs_rule_check_apply):(devfs_rule_reset_node), 1734 NULL); 1735 break; 1736 } 1737 } 1738 } 1739 1740 kfree(mountto, M_DEVFS); 1741 return 0; 1742 } 1743 1744 /* 1745 * This function calls a given callback function for 1746 * every dev node in the devfs dev list. 1747 */ 1748 static int 1749 devfs_scan_callback_worker(devfs_scan_t *callback, void *arg) 1750 { 1751 cdev_t dev, dev1; 1752 1753 TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) { 1754 callback(dev, arg); 1755 } 1756 1757 return 0; 1758 } 1759 1760 /* 1761 * This function tries to resolve a given directory, or if not 1762 * found and creation requested, creates the given directory. 1763 */ 1764 static struct devfs_node * 1765 devfs_resolve_or_create_dir(struct devfs_node *parent, char *dir_name, 1766 size_t name_len, int create) 1767 { 1768 struct devfs_node *node, *found = NULL; 1769 1770 TAILQ_FOREACH(node, DEVFS_DENODE_HEAD(parent), link) { 1771 if (name_len != node->d_dir.d_namlen) 1772 continue; 1773 1774 if (!memcmp(dir_name, node->d_dir.d_name, name_len)) { 1775 found = node; 1776 break; 1777 } 1778 } 1779 1780 if ((found == NULL) && (create)) { 1781 found = devfs_allocp(Pdir, dir_name, parent, parent->mp, NULL); 1782 } 1783 1784 return found; 1785 } 1786 1787 /* 1788 * This function tries to resolve a complete path. If creation is requested, 1789 * if a given part of the path cannot be resolved (because it doesn't exist), 1790 * it is created. 1791 */ 1792 struct devfs_node * 1793 devfs_resolve_or_create_path(struct devfs_node *parent, char *path, int create) 1794 { 1795 struct devfs_node *node = parent; 1796 char *buf; 1797 size_t idx = 0; 1798 1799 if (path == NULL) 1800 return parent; 1801 1802 buf = kmalloc(PATH_MAX, M_TEMP, M_WAITOK); 1803 1804 while (*path && idx < PATH_MAX - 1) { 1805 if (*path != '/') { 1806 buf[idx++] = *path; 1807 } else { 1808 buf[idx] = '\0'; 1809 node = devfs_resolve_or_create_dir(node, buf, idx, create); 1810 if (node == NULL) { 1811 kfree(buf, M_TEMP); 1812 return NULL; 1813 } 1814 idx = 0; 1815 } 1816 ++path; 1817 } 1818 buf[idx] = '\0'; 1819 node = devfs_resolve_or_create_dir(node, buf, idx, create); 1820 kfree (buf, M_TEMP); 1821 return (node); 1822 } 1823 1824 /* 1825 * Takes a full path and strips it into a directory path and a name. 1826 * For a/b/c/foo, it returns foo in namep and a/b/c in pathp. It 1827 * requires a working buffer with enough size to keep the whole 1828 * fullpath. 1829 */ 1830 int 1831 devfs_resolve_name_path(char *fullpath, char *buf, char **pathp, char **namep) 1832 { 1833 char *name = NULL; 1834 char *path = NULL; 1835 size_t len = strlen(fullpath) + 1; 1836 int i; 1837 1838 KKASSERT((fullpath != NULL) && (buf != NULL)); 1839 KKASSERT((pathp != NULL) && (namep != NULL)); 1840 1841 memcpy(buf, fullpath, len); 1842 1843 for (i = len-1; i>= 0; i--) { 1844 if (buf[i] == '/') { 1845 buf[i] = '\0'; 1846 name = &(buf[i+1]); 1847 path = buf; 1848 break; 1849 } 1850 } 1851 1852 *pathp = path; 1853 1854 if (name) { 1855 *namep = name; 1856 } else { 1857 *namep = buf; 1858 } 1859 1860 return 0; 1861 } 1862 1863 /* 1864 * This function creates a new devfs node for a given device. It can 1865 * handle a complete path as device name, and accordingly creates 1866 * the path and the final device node. 1867 * 1868 * The reference count on the passed dev remains unchanged. 1869 */ 1870 struct devfs_node * 1871 devfs_create_device_node(struct devfs_node *root, cdev_t dev, 1872 char *dev_name, char *path_fmt, ...) 1873 { 1874 struct devfs_node *parent, *node = NULL; 1875 char *path = NULL; 1876 char *name; 1877 char *name_buf; 1878 __va_list ap; 1879 int i, found; 1880 char *create_path = NULL; 1881 char *names = "pqrsPQRS"; 1882 1883 name_buf = kmalloc(PATH_MAX, M_TEMP, M_WAITOK); 1884 1885 if (path_fmt != NULL) { 1886 __va_start(ap, path_fmt); 1887 kvasnrprintf(&path, PATH_MAX, 10, path_fmt, ap); 1888 __va_end(ap); 1889 } 1890 1891 parent = devfs_resolve_or_create_path(root, path, 1); 1892 KKASSERT(parent); 1893 1894 devfs_resolve_name_path( 1895 ((dev_name == NULL) && (dev))?(dev->si_name):(dev_name), 1896 name_buf, &create_path, &name); 1897 1898 if (create_path) 1899 parent = devfs_resolve_or_create_path(parent, create_path, 1); 1900 1901 1902 if (devfs_find_device_node_by_name(parent, name)) { 1903 devfs_debug(DEVFS_DEBUG_WARNING, "devfs_create_device_node: " 1904 "DEVICE %s ALREADY EXISTS!!! Ignoring creation request.\n", name); 1905 goto out; 1906 } 1907 1908 node = devfs_allocp(Pdev, name, parent, parent->mp, dev); 1909 nanotime(&parent->mtime); 1910 1911 /* 1912 * Ugly unix98 pty magic, to hide pty master (ptm) devices and their 1913 * directory 1914 */ 1915 if ((dev) && (strlen(dev->si_name) >= 4) && 1916 (!memcmp(dev->si_name, "ptm/", 4))) { 1917 node->parent->flags |= DEVFS_HIDDEN; 1918 node->flags |= DEVFS_HIDDEN; 1919 } 1920 1921 /* 1922 * Ugly pty magic, to tag pty devices as such and hide them if needed. 1923 */ 1924 if ((strlen(name) >= 3) && (!memcmp(name, "pty", 3))) 1925 node->flags |= (DEVFS_PTY | DEVFS_INVISIBLE); 1926 1927 if ((strlen(name) >= 3) && (!memcmp(name, "tty", 3))) { 1928 found = 0; 1929 for (i = 0; i < strlen(names); i++) { 1930 if (name[3] == names[i]) { 1931 found = 1; 1932 break; 1933 } 1934 } 1935 if (found) 1936 node->flags |= (DEVFS_PTY | DEVFS_INVISIBLE); 1937 } 1938 1939 out: 1940 kfree(name_buf, M_TEMP); 1941 kvasfree(&path); 1942 return node; 1943 } 1944 1945 /* 1946 * This function finds a given device node in the topology with a given 1947 * cdev. 1948 */ 1949 void * 1950 devfs_find_device_node_callback(struct devfs_node *node, cdev_t target) 1951 { 1952 if ((node->node_type == Pdev) && (node->d_dev == target)) { 1953 return node; 1954 } 1955 1956 return NULL; 1957 } 1958 1959 /* 1960 * This function finds a device node in the given parent directory by its 1961 * name and returns it. 1962 */ 1963 struct devfs_node * 1964 devfs_find_device_node_by_name(struct devfs_node *parent, char *target) 1965 { 1966 struct devfs_node *node, *found = NULL; 1967 size_t len = strlen(target); 1968 1969 TAILQ_FOREACH(node, DEVFS_DENODE_HEAD(parent), link) { 1970 if (len != node->d_dir.d_namlen) 1971 continue; 1972 1973 if (!memcmp(node->d_dir.d_name, target, len)) { 1974 found = node; 1975 break; 1976 } 1977 } 1978 1979 return found; 1980 } 1981 1982 static void * 1983 devfs_inode_to_vnode_worker_callback(struct devfs_node *node, ino_t *inop) 1984 { 1985 struct vnode *vp = NULL; 1986 ino_t target = *inop; 1987 1988 if (node->d_dir.d_ino == target) { 1989 if (node->v_node) { 1990 vp = node->v_node; 1991 vget(vp, LK_EXCLUSIVE | LK_RETRY); 1992 vn_unlock(vp); 1993 } else { 1994 devfs_allocv(&vp, node); 1995 vn_unlock(vp); 1996 } 1997 } 1998 1999 return vp; 2000 } 2001 2002 /* 2003 * This function takes a cdev and removes its devfs node in the 2004 * given topology. The cdev remains intact. 2005 */ 2006 int 2007 devfs_destroy_device_node(struct devfs_node *root, cdev_t target) 2008 { 2009 KKASSERT(target != NULL); 2010 return devfs_destroy_node(root, target->si_name); 2011 } 2012 2013 /* 2014 * This function takes a path to a devfs node, resolves it and 2015 * removes the devfs node from the given topology. 2016 */ 2017 int 2018 devfs_destroy_node(struct devfs_node *root, char *target) 2019 { 2020 struct devfs_node *node, *parent; 2021 char *name; 2022 char *name_buf; 2023 char *create_path = NULL; 2024 2025 KKASSERT(target); 2026 2027 name_buf = kmalloc(PATH_MAX, M_TEMP, M_WAITOK); 2028 ksnprintf(name_buf, PATH_MAX, "%s", target); 2029 2030 devfs_resolve_name_path(target, name_buf, &create_path, &name); 2031 2032 if (create_path) 2033 parent = devfs_resolve_or_create_path(root, create_path, 0); 2034 else 2035 parent = root; 2036 2037 if (parent == NULL) { 2038 kfree(name_buf, M_TEMP); 2039 return 1; 2040 } 2041 2042 node = devfs_find_device_node_by_name(parent, name); 2043 2044 if (node) { 2045 nanotime(&node->parent->mtime); 2046 devfs_gc(node); 2047 } 2048 2049 kfree(name_buf, M_TEMP); 2050 2051 return 0; 2052 } 2053 2054 /* 2055 * Just set perms and ownership for given node. 2056 */ 2057 int 2058 devfs_set_perms(struct devfs_node *node, uid_t uid, gid_t gid, 2059 u_short mode, u_long flags) 2060 { 2061 node->mode = mode; 2062 node->uid = uid; 2063 node->gid = gid; 2064 2065 return 0; 2066 } 2067 2068 /* 2069 * Propagates a device attach/detach to all mount 2070 * points. Also takes care of automatic alias removal 2071 * for a deleted cdev. 2072 */ 2073 static int 2074 devfs_propagate_dev(cdev_t dev, int attach) 2075 { 2076 struct devfs_mnt_data *mnt; 2077 2078 TAILQ_FOREACH(mnt, &devfs_mnt_list, link) { 2079 if (attach) { 2080 /* Device is being attached */ 2081 devfs_create_device_node(mnt->root_node, dev, 2082 NULL, NULL ); 2083 } else { 2084 /* Device is being detached */ 2085 devfs_alias_remove(dev); 2086 devfs_destroy_device_node(mnt->root_node, dev); 2087 } 2088 } 2089 return 0; 2090 } 2091 2092 /* 2093 * devfs_clone either returns a basename from a complete name by 2094 * returning the length of the name without trailing digits, or, 2095 * if clone != 0, calls the device's clone handler to get a new 2096 * device, which in turn is returned in devp. 2097 */ 2098 cdev_t 2099 devfs_clone(cdev_t dev, const char *name, size_t len, int mode, 2100 struct ucred *cred) 2101 { 2102 int error; 2103 struct devfs_clone_handler *chandler; 2104 struct dev_clone_args ap; 2105 2106 TAILQ_FOREACH(chandler, &devfs_chandler_list, link) { 2107 if (chandler->namlen != len) 2108 continue; 2109 if ((!memcmp(chandler->name, name, len)) && (chandler->nhandler)) { 2110 lockmgr(&devfs_lock, LK_RELEASE); 2111 devfs_config(); 2112 lockmgr(&devfs_lock, LK_EXCLUSIVE); 2113 2114 ap.a_head.a_dev = dev; 2115 ap.a_dev = NULL; 2116 ap.a_name = name; 2117 ap.a_namelen = len; 2118 ap.a_mode = mode; 2119 ap.a_cred = cred; 2120 error = (chandler->nhandler)(&ap); 2121 if (error) 2122 continue; 2123 2124 return ap.a_dev; 2125 } 2126 } 2127 2128 return NULL; 2129 } 2130 2131 2132 /* 2133 * Registers a new orphan in the orphan list. 2134 */ 2135 void 2136 devfs_tracer_add_orphan(struct devfs_node *node) 2137 { 2138 struct devfs_orphan *orphan; 2139 2140 KKASSERT(node); 2141 orphan = kmalloc(sizeof(struct devfs_orphan), M_DEVFS, M_WAITOK); 2142 orphan->node = node; 2143 2144 KKASSERT((node->flags & DEVFS_ORPHANED) == 0); 2145 node->flags |= DEVFS_ORPHANED; 2146 TAILQ_INSERT_TAIL(DEVFS_ORPHANLIST(node->mp), orphan, link); 2147 } 2148 2149 /* 2150 * Removes an orphan from the orphan list. 2151 */ 2152 void 2153 devfs_tracer_del_orphan(struct devfs_node *node) 2154 { 2155 struct devfs_orphan *orphan; 2156 2157 KKASSERT(node); 2158 2159 TAILQ_FOREACH(orphan, DEVFS_ORPHANLIST(node->mp), link) { 2160 if (orphan->node == node) { 2161 node->flags &= ~DEVFS_ORPHANED; 2162 TAILQ_REMOVE(DEVFS_ORPHANLIST(node->mp), orphan, link); 2163 kfree(orphan, M_DEVFS); 2164 break; 2165 } 2166 } 2167 } 2168 2169 /* 2170 * Counts the orphans in the orphan list, and if cleanup 2171 * is specified, also frees the orphan and removes it from 2172 * the list. 2173 */ 2174 size_t 2175 devfs_tracer_orphan_count(struct mount *mp, int cleanup) 2176 { 2177 struct devfs_orphan *orphan, *orphan2; 2178 size_t count = 0; 2179 2180 TAILQ_FOREACH_MUTABLE(orphan, DEVFS_ORPHANLIST(mp), link, orphan2) { 2181 count++; 2182 /* 2183 * If we are instructed to clean up, we do so. 2184 */ 2185 if (cleanup) { 2186 TAILQ_REMOVE(DEVFS_ORPHANLIST(mp), orphan, link); 2187 orphan->node->flags &= ~DEVFS_ORPHANED; 2188 devfs_freep(orphan->node); 2189 kfree(orphan, M_DEVFS); 2190 } 2191 } 2192 2193 return count; 2194 } 2195 2196 /* 2197 * Fetch an ino_t from the global d_ino by increasing it 2198 * while spinlocked. 2199 */ 2200 static ino_t 2201 devfs_fetch_ino(void) 2202 { 2203 ino_t ret; 2204 2205 spin_lock(&ino_lock); 2206 ret = d_ino++; 2207 spin_unlock(&ino_lock); 2208 2209 return ret; 2210 } 2211 2212 /* 2213 * Allocates a new cdev and initializes it's most basic 2214 * fields. 2215 */ 2216 cdev_t 2217 devfs_new_cdev(struct dev_ops *ops, int minor, struct dev_ops *bops) 2218 { 2219 cdev_t dev = sysref_alloc(&cdev_sysref_class); 2220 2221 sysref_activate(&dev->si_sysref); 2222 reference_dev(dev); 2223 bzero(dev, offsetof(struct cdev, si_sysref)); 2224 2225 dev->si_uid = 0; 2226 dev->si_gid = 0; 2227 dev->si_perms = 0; 2228 dev->si_drv1 = NULL; 2229 dev->si_drv2 = NULL; 2230 dev->si_lastread = 0; /* time_second */ 2231 dev->si_lastwrite = 0; /* time_second */ 2232 2233 dev->si_dict = NULL; 2234 dev->si_parent = NULL; 2235 dev->si_ops = ops; 2236 dev->si_flags = 0; 2237 dev->si_umajor = 0; 2238 dev->si_uminor = minor; 2239 dev->si_bops = bops; 2240 2241 /* 2242 * Since the disk subsystem is in the way, we need to 2243 * propagate the D_CANFREE from bops (and ops) to 2244 * si_flags. 2245 */ 2246 if (bops && (bops->head.flags & D_CANFREE)) { 2247 dev->si_flags |= SI_CANFREE; 2248 } else if (ops->head.flags & D_CANFREE) { 2249 dev->si_flags |= SI_CANFREE; 2250 } 2251 2252 /* If there is a backing device, we reference its ops */ 2253 dev->si_inode = makeudev( 2254 devfs_reference_ops((bops)?(bops):(ops)), 2255 minor ); 2256 2257 return dev; 2258 } 2259 2260 static void 2261 devfs_cdev_terminate(cdev_t dev) 2262 { 2263 int locked = 0; 2264 2265 /* Check if it is locked already. if not, we acquire the devfs lock */ 2266 if (!(lockstatus(&devfs_lock, curthread)) == LK_EXCLUSIVE) { 2267 lockmgr(&devfs_lock, LK_EXCLUSIVE); 2268 locked = 1; 2269 } 2270 2271 /* 2272 * Make sure the node isn't linked anymore. Otherwise we've screwed 2273 * up somewhere, since normal devs are unlinked on the call to 2274 * destroy_dev and only-cdevs that have not been used for cloning 2275 * are not linked in the first place. only-cdevs used for cloning 2276 * will be linked in, too, and should only be destroyed via 2277 * destroy_dev, not destroy_only_dev, so we catch that problem, too. 2278 */ 2279 KKASSERT((dev->si_flags & SI_DEVFS_LINKED) == 0); 2280 2281 /* If we acquired the lock, we also get rid of it */ 2282 if (locked) 2283 lockmgr(&devfs_lock, LK_RELEASE); 2284 2285 /* If there is a backing device, we release the backing device's ops */ 2286 devfs_release_ops((dev->si_bops)?(dev->si_bops):(dev->si_ops)); 2287 2288 /* Finally destroy the device */ 2289 sysref_put(&dev->si_sysref); 2290 } 2291 2292 /* 2293 * Dummies for now (individual locks for MPSAFE) 2294 */ 2295 static void 2296 devfs_cdev_lock(cdev_t dev) 2297 { 2298 } 2299 2300 static void 2301 devfs_cdev_unlock(cdev_t dev) 2302 { 2303 } 2304 2305 static int 2306 devfs_detached_filter_eof(struct knote *kn, long hint) 2307 { 2308 kn->kn_flags |= EV_EOF; 2309 return (1); 2310 } 2311 2312 static void 2313 devfs_detached_filter_detach(struct knote *kn) 2314 { 2315 cdev_t dev = (cdev_t)kn->kn_hook; 2316 2317 knote_remove(&dev->si_kqinfo.ki_note, kn); 2318 } 2319 2320 static struct filterops devfs_detached_filterops = 2321 { FILTEROP_ISFD, NULL, 2322 devfs_detached_filter_detach, 2323 devfs_detached_filter_eof }; 2324 2325 /* 2326 * Delegates knote filter handling responsibility to devfs 2327 * 2328 * Any device that implements kqfilter event handling and could be detached 2329 * or shut down out from under the kevent subsystem must allow devfs to 2330 * assume responsibility for any knotes it may hold. 2331 */ 2332 void 2333 devfs_assume_knotes(cdev_t dev, struct kqinfo *kqi) 2334 { 2335 /* 2336 * Let kern/kern_event.c do the heavy lifting. 2337 */ 2338 knote_assume_knotes(kqi, &dev->si_kqinfo, 2339 &devfs_detached_filterops, (void *)dev); 2340 2341 /* 2342 * These should probably be activated individually, but doing so 2343 * would require refactoring kq's public in-kernel interface. 2344 */ 2345 KNOTE(&dev->si_kqinfo.ki_note, 0); 2346 } 2347 2348 /* 2349 * Links a given cdev into the dev list. 2350 */ 2351 int 2352 devfs_link_dev(cdev_t dev) 2353 { 2354 KKASSERT((dev->si_flags & SI_DEVFS_LINKED) == 0); 2355 dev->si_flags |= SI_DEVFS_LINKED; 2356 TAILQ_INSERT_TAIL(&devfs_dev_list, dev, link); 2357 2358 return 0; 2359 } 2360 2361 /* 2362 * Removes a given cdev from the dev list. The caller is responsible for 2363 * releasing the reference on the device associated with the linkage. 2364 * 2365 * Returns EALREADY if the dev has already been unlinked. 2366 */ 2367 static int 2368 devfs_unlink_dev(cdev_t dev) 2369 { 2370 if ((dev->si_flags & SI_DEVFS_LINKED)) { 2371 TAILQ_REMOVE(&devfs_dev_list, dev, link); 2372 dev->si_flags &= ~SI_DEVFS_LINKED; 2373 return (0); 2374 } 2375 return (EALREADY); 2376 } 2377 2378 int 2379 devfs_node_is_accessible(struct devfs_node *node) 2380 { 2381 if ((node) && (!(node->flags & DEVFS_HIDDEN))) 2382 return 1; 2383 else 2384 return 0; 2385 } 2386 2387 int 2388 devfs_reference_ops(struct dev_ops *ops) 2389 { 2390 int unit; 2391 struct devfs_dev_ops *found = NULL; 2392 struct devfs_dev_ops *devops; 2393 2394 TAILQ_FOREACH(devops, &devfs_dev_ops_list, link) { 2395 if (devops->ops == ops) { 2396 found = devops; 2397 break; 2398 } 2399 } 2400 2401 if (!found) { 2402 found = kmalloc(sizeof(struct devfs_dev_ops), M_DEVFS, M_WAITOK); 2403 found->ops = ops; 2404 found->ref_count = 0; 2405 TAILQ_INSERT_TAIL(&devfs_dev_ops_list, found, link); 2406 } 2407 2408 KKASSERT(found); 2409 2410 if (found->ref_count == 0) { 2411 found->id = devfs_clone_bitmap_get(&DEVFS_CLONE_BITMAP(ops_id), 255); 2412 if (found->id == -1) { 2413 /* Ran out of unique ids */ 2414 devfs_debug(DEVFS_DEBUG_WARNING, 2415 "devfs_reference_ops: WARNING: ran out of unique ids\n"); 2416 } 2417 } 2418 unit = found->id; 2419 ++found->ref_count; 2420 2421 return unit; 2422 } 2423 2424 void 2425 devfs_release_ops(struct dev_ops *ops) 2426 { 2427 struct devfs_dev_ops *found = NULL; 2428 struct devfs_dev_ops *devops; 2429 2430 TAILQ_FOREACH(devops, &devfs_dev_ops_list, link) { 2431 if (devops->ops == ops) { 2432 found = devops; 2433 break; 2434 } 2435 } 2436 2437 KKASSERT(found); 2438 2439 --found->ref_count; 2440 2441 if (found->ref_count == 0) { 2442 TAILQ_REMOVE(&devfs_dev_ops_list, found, link); 2443 devfs_clone_bitmap_put(&DEVFS_CLONE_BITMAP(ops_id), found->id); 2444 kfree(found, M_DEVFS); 2445 } 2446 } 2447 2448 /* 2449 * Wait for asynchronous messages to complete in the devfs helper 2450 * thread, then return. Do nothing if the helper thread is dead 2451 * or we are being indirectly called from the helper thread itself. 2452 */ 2453 void 2454 devfs_config(void) 2455 { 2456 devfs_msg_t msg; 2457 2458 if (devfs_run && curthread != td_core) { 2459 msg = devfs_msg_get(); 2460 msg = devfs_msg_send_sync(DEVFS_SYNC, msg); 2461 devfs_msg_put(msg); 2462 } 2463 } 2464 2465 /* 2466 * Called on init of devfs; creates the objcaches and 2467 * spawns off the devfs core thread. Also initializes 2468 * locks. 2469 */ 2470 static void 2471 devfs_init(void) 2472 { 2473 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_init() called\n"); 2474 /* Create objcaches for nodes, msgs and devs */ 2475 devfs_node_cache = objcache_create("devfs-node-cache", 0, 0, 2476 NULL, NULL, NULL, 2477 objcache_malloc_alloc, 2478 objcache_malloc_free, 2479 &devfs_node_malloc_args ); 2480 2481 devfs_msg_cache = objcache_create("devfs-msg-cache", 0, 0, 2482 NULL, NULL, NULL, 2483 objcache_malloc_alloc, 2484 objcache_malloc_free, 2485 &devfs_msg_malloc_args ); 2486 2487 devfs_dev_cache = objcache_create("devfs-dev-cache", 0, 0, 2488 NULL, NULL, NULL, 2489 objcache_malloc_alloc, 2490 objcache_malloc_free, 2491 &devfs_dev_malloc_args ); 2492 2493 devfs_clone_bitmap_init(&DEVFS_CLONE_BITMAP(ops_id)); 2494 2495 /* Initialize the reply-only port which acts as a message drain */ 2496 lwkt_initport_replyonly(&devfs_dispose_port, devfs_msg_autofree_reply); 2497 2498 /* Initialize *THE* devfs lock */ 2499 lockinit(&devfs_lock, "devfs_core lock", 0, 0); 2500 2501 lockmgr(&devfs_lock, LK_EXCLUSIVE); 2502 lwkt_create(devfs_msg_core, /*args*/NULL, &td_core, NULL, 2503 0, 0, "devfs_msg_core"); 2504 while (devfs_run == 0) 2505 lksleep(td_core, &devfs_lock, 0, "devfsc", 0); 2506 lockmgr(&devfs_lock, LK_RELEASE); 2507 2508 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_init finished\n"); 2509 } 2510 2511 /* 2512 * Called on unload of devfs; takes care of destroying the core 2513 * and the objcaches. Also removes aliases that are no longer needed. 2514 */ 2515 static void 2516 devfs_uninit(void) 2517 { 2518 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_uninit() called\n"); 2519 2520 devfs_msg_send(DEVFS_TERMINATE_CORE, NULL); 2521 while (devfs_run) 2522 tsleep(td_core, 0, "devfsc", hz*10); 2523 tsleep(td_core, 0, "devfsc", hz); 2524 2525 devfs_clone_bitmap_uninit(&DEVFS_CLONE_BITMAP(ops_id)); 2526 2527 /* Destroy the objcaches */ 2528 objcache_destroy(devfs_msg_cache); 2529 objcache_destroy(devfs_node_cache); 2530 objcache_destroy(devfs_dev_cache); 2531 2532 devfs_alias_reap(); 2533 } 2534 2535 /* 2536 * This is a sysctl handler to assist userland devname(3) to 2537 * find the device name for a given udev. 2538 */ 2539 static int 2540 devfs_sysctl_devname_helper(SYSCTL_HANDLER_ARGS) 2541 { 2542 udev_t udev; 2543 cdev_t found; 2544 int error; 2545 2546 2547 if ((error = SYSCTL_IN(req, &udev, sizeof(udev_t)))) 2548 return (error); 2549 2550 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs sysctl, received udev: %d\n", udev); 2551 2552 if (udev == NOUDEV) 2553 return(EINVAL); 2554 2555 if ((found = devfs_find_device_by_udev(udev)) == NULL) 2556 return(ENOENT); 2557 2558 return(SYSCTL_OUT(req, found->si_name, strlen(found->si_name) + 1)); 2559 } 2560 2561 2562 SYSCTL_PROC(_kern, OID_AUTO, devname, CTLTYPE_OPAQUE|CTLFLAG_RW|CTLFLAG_ANYBODY, 2563 NULL, 0, devfs_sysctl_devname_helper, "", "helper for devname(3)"); 2564 2565 SYSCTL_NODE(_vfs, OID_AUTO, devfs, CTLFLAG_RW, 0, "devfs"); 2566 TUNABLE_INT("vfs.devfs.debug", &devfs_debug_enable); 2567 SYSCTL_INT(_vfs_devfs, OID_AUTO, debug, CTLFLAG_RW, &devfs_debug_enable, 2568 0, "Enable DevFS debugging"); 2569 2570 SYSINIT(vfs_devfs_register, SI_SUB_PRE_DRIVERS, SI_ORDER_FIRST, 2571 devfs_init, NULL); 2572 SYSUNINIT(vfs_devfs_register, SI_SUB_PRE_DRIVERS, SI_ORDER_ANY, 2573 devfs_uninit, NULL); 2574 2575 /* 2576 * WildCmp() - compare wild string to sane string 2577 * 2578 * Returns 0 on success, -1 on failure. 2579 */ 2580 static int 2581 wildCmp(const char **mary, int d, const char *w, const char *s) 2582 { 2583 int i; 2584 2585 /* 2586 * skip fixed portion 2587 */ 2588 for (;;) { 2589 switch(*w) { 2590 case '*': 2591 /* 2592 * optimize terminator 2593 */ 2594 if (w[1] == 0) 2595 return(0); 2596 if (w[1] != '?' && w[1] != '*') { 2597 /* 2598 * optimize * followed by non-wild 2599 */ 2600 for (i = 0; s + i < mary[d]; ++i) { 2601 if (s[i] == w[1] && wildCmp(mary, d + 1, w + 1, s + i) == 0) 2602 return(0); 2603 } 2604 } else { 2605 /* 2606 * less-optimal 2607 */ 2608 for (i = 0; s + i < mary[d]; ++i) { 2609 if (wildCmp(mary, d + 1, w + 1, s + i) == 0) 2610 return(0); 2611 } 2612 } 2613 mary[d] = s; 2614 return(-1); 2615 case '?': 2616 if (*s == 0) 2617 return(-1); 2618 ++w; 2619 ++s; 2620 break; 2621 default: 2622 if (*w != *s) 2623 return(-1); 2624 if (*w == 0) /* terminator */ 2625 return(0); 2626 ++w; 2627 ++s; 2628 break; 2629 } 2630 } 2631 /* not reached */ 2632 return(-1); 2633 } 2634 2635 2636 /* 2637 * WildCaseCmp() - compare wild string to sane string, case insensitive 2638 * 2639 * Returns 0 on success, -1 on failure. 2640 */ 2641 static int 2642 wildCaseCmp(const char **mary, int d, const char *w, const char *s) 2643 { 2644 int i; 2645 2646 /* 2647 * skip fixed portion 2648 */ 2649 for (;;) { 2650 switch(*w) { 2651 case '*': 2652 /* 2653 * optimize terminator 2654 */ 2655 if (w[1] == 0) 2656 return(0); 2657 if (w[1] != '?' && w[1] != '*') { 2658 /* 2659 * optimize * followed by non-wild 2660 */ 2661 for (i = 0; s + i < mary[d]; ++i) { 2662 if (s[i] == w[1] && wildCaseCmp(mary, d + 1, w + 1, s + i) == 0) 2663 return(0); 2664 } 2665 } else { 2666 /* 2667 * less-optimal 2668 */ 2669 for (i = 0; s + i < mary[d]; ++i) { 2670 if (wildCaseCmp(mary, d + 1, w + 1, s + i) == 0) 2671 return(0); 2672 } 2673 } 2674 mary[d] = s; 2675 return(-1); 2676 case '?': 2677 if (*s == 0) 2678 return(-1); 2679 ++w; 2680 ++s; 2681 break; 2682 default: 2683 if (*w != *s) { 2684 #define tolower(x) ((x >= 'A' && x <= 'Z')?(x+('a'-'A')):(x)) 2685 if (tolower(*w) != tolower(*s)) 2686 return(-1); 2687 } 2688 if (*w == 0) /* terminator */ 2689 return(0); 2690 ++w; 2691 ++s; 2692 break; 2693 } 2694 } 2695 /* not reached */ 2696 return(-1); 2697 } 2698 2699 int 2700 devfs_WildCmp(const char *w, const char *s) 2701 { 2702 int i; 2703 int c; 2704 int slen = strlen(s); 2705 const char **mary; 2706 2707 for (i = c = 0; w[i]; ++i) { 2708 if (w[i] == '*') 2709 ++c; 2710 } 2711 mary = kmalloc(sizeof(char *) * (c + 1), M_DEVFS, M_WAITOK); 2712 for (i = 0; i < c; ++i) 2713 mary[i] = s + slen; 2714 i = wildCmp(mary, 0, w, s); 2715 kfree(mary, M_DEVFS); 2716 return(i); 2717 } 2718 2719 int 2720 devfs_WildCaseCmp(const char *w, const char *s) 2721 { 2722 int i; 2723 int c; 2724 int slen = strlen(s); 2725 const char **mary; 2726 2727 for (i = c = 0; w[i]; ++i) { 2728 if (w[i] == '*') 2729 ++c; 2730 } 2731 mary = kmalloc(sizeof(char *) * (c + 1), M_DEVFS, M_WAITOK); 2732 for (i = 0; i < c; ++i) 2733 mary[i] = s + slen; 2734 i = wildCaseCmp(mary, 0, w, s); 2735 kfree(mary, M_DEVFS); 2736 return(i); 2737 } 2738 2739