sys/vfs/devfs/devfs_core.c

   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/msgport2.h>
  43 #include <sys/spinlock2.h>
  44 #include <sys/sysctl.h>
  45 #include <sys/ucred.h>
  46 #include <sys/param.h>
  47 #include <sys/sysref2.h>
  48 #include <vfs/devfs/devfs.h>
  49 #include <vfs/devfs/devfs_rules.h>
  50
  51 MALLOC_DEFINE(M_DEVFS, "devfs", "Device File System (devfs) allocations");
  52
  53 /*
  54  * SYSREF Integration - reference counting, allocation,
  55  * sysid and syslink integration.
  56  */
  57 static void devfs_cdev_terminate(cdev_t dev);
  58 static struct sysref_class     cdev_sysref_class = {
  59         .name =         "cdev",
  60         .mtype =        M_DEVFS,
  61         .proto =        SYSREF_PROTO_DEV,
  62         .offset =       offsetof(struct cdev, si_sysref),
  63         .objsize =      sizeof(struct cdev),
  64         .mag_capacity = 32,
  65         .flags =        0,
  66         .ops =  {
  67                 .terminate = (sysref_terminate_func_t)devfs_cdev_terminate
  68         }
  69 };
  70
  71 static struct objcache  *devfs_node_cache;
  72 static struct objcache  *devfs_msg_cache;
  73 static struct objcache  *devfs_dev_cache;
  74
  75 static struct objcache_malloc_args devfs_node_malloc_args = {
  76         sizeof(struct devfs_node), M_DEVFS };
  77 struct objcache_malloc_args devfs_msg_malloc_args = {
  78         sizeof(struct devfs_msg), M_DEVFS };
  79 struct objcache_malloc_args devfs_dev_malloc_args = {
  80         sizeof(struct cdev), M_DEVFS };
  81
  82 static struct devfs_dev_head devfs_dev_list = TAILQ_HEAD_INITIALIZER(devfs_dev_list);
  83 static struct devfs_mnt_head devfs_mnt_list = TAILQ_HEAD_INITIALIZER(devfs_mnt_list);
  84 static struct devfs_chandler_head devfs_chandler_list = TAILQ_HEAD_INITIALIZER(devfs_chandler_list);
  85 static struct devfs_alias_head devfs_alias_list = TAILQ_HEAD_INITIALIZER(devfs_alias_list);
  86
  87 struct lock             devfs_lock;
  88 static struct lwkt_port devfs_dispose_port;
  89 static struct lwkt_port devfs_msg_port;
  90 static struct thread    *td_core;
  91 //static void *devfs_id = (void *)0xDE33A;
  92
  93 static ino_t    d_ino = 0;
  94 static __uint32_t       msg_id = 0;
  95 static struct spinlock  ino_lock;
  96 static int devfs_debug_enable = 0;
  97
  98 static ino_t devfs_fetch_ino(void);
  99 static int devfs_gc_dirs(struct devfs_node *);
 100 static int devfs_gc_links(struct devfs_node *, struct devfs_node *, size_t);
 101 static int devfs_create_all_dev_worker(struct devfs_node *);
 102 static int devfs_create_dev_worker(cdev_t, uid_t, gid_t, int);
 103 static int devfs_destroy_dev_worker(cdev_t);
 104 static int devfs_destroy_subnames_worker(char *);
 105 static int devfs_destroy_dev_by_ops_worker(struct dev_ops *, int);
 106 static int devfs_propagate_dev(cdev_t, int);
 107 static int devfs_unlink_dev(cdev_t dev);
 108
 109 static int devfs_chandler_add_worker(char *, d_clone_t *);
 110 static int devfs_chandler_del_worker(char *);
 111
 112 static void devfs_msg_autofree_reply(lwkt_port_t, lwkt_msg_t);
 113 static void devfs_msg_core(void *);
 114
 115 static int devfs_find_device_by_name_worker(devfs_msg_t);
 116 static int devfs_find_device_by_udev_worker(devfs_msg_t);
 117
 118 static int devfs_apply_reset_rules_caller(char *, int);
 119 static int devfs_apply_reset_rules_worker(struct devfs_node *, int);
 120
 121 static int devfs_scan_callback_worker(devfs_scan_t *);
 122
 123 static struct devfs_node *devfs_resolve_or_create_dir(struct devfs_node *, char *, size_t, int);
 124
 125 static int devfs_make_alias_worker(struct devfs_alias *);
 126 static int devfs_alias_remove(cdev_t);
 127 static int devfs_alias_reap(void);
 128 static int devfs_alias_propagate(struct devfs_alias *);
 129 static int devfs_alias_apply(struct devfs_node *, struct devfs_alias *);
 130 static int devfs_alias_check_create(struct devfs_node *);
 131
 132 static int devfs_clr_subnames_flag_worker(char *, uint32_t);
 133 static int devfs_destroy_subnames_without_flag_worker(char *, uint32_t);
 134
 135 /*
 136  * devfs_debug() is a SYSCTL and TUNABLE controlled debug output function using kvprintf
 137  */
 138 int
 139 devfs_debug(int level, char *fmt, ...)
 140 {
 141         __va_list ap;
 142
 143         __va_start(ap, fmt);
 144         if (level <= devfs_debug_enable)
 145                 kvprintf(fmt, ap);
 146         __va_end(ap);
 147
 148         return 0;
 149 }
 150
 151 /*
 152  * devfs_allocp() Allocates a new devfs node with the specified
 153  * parameters. The node is also automatically linked into the topology
 154  * if a parent is specified. It also calls the rule and alias stuff to
 155  * be applied on the new node
 156  */
 157 struct devfs_node *
 158 devfs_allocp(devfs_nodetype devfsnodetype, char *name,
 159              struct devfs_node *parent, struct mount *mp, cdev_t dev)
 160 {
 161         struct devfs_node *node = NULL;
 162         size_t namlen = strlen(name);
 163         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocp -1- for %s\n", name?name:"NULL");
 164
 165         node = objcache_get(devfs_node_cache, M_WAITOK);
 166
 167         bzero(node, sizeof(*node));
 168
 169         atomic_add_int(&(DEVFS_MNTDATA(mp)->leak_count), 1);
 170
 171         node->d_dev = NULL;
 172         node->nchildren = 1;
 173         node->mp = mp;
 174         node->d_dir.d_ino = devfs_fetch_ino();
 175         node->cookie_jar = 2; /* Leave 0 and 1 for '.' and '..', respectively */
 176
 177         /* Access Control members */
 178         node->mode = DEVFS_DEFAULT_MODE;        /* files access mode and type */
 179         node->uid = DEVFS_DEFAULT_UID;          /* owner user id */
 180         node->gid = DEVFS_DEFAULT_GID;          /* owner group id */
 181
 182         switch (devfsnodetype) {
 183         case Proot:
 184                 node->flags |= DEVFS_NODE_LINKED; //Make sure we don't recycle the root vnode
 185         case Pdir:
 186                 TAILQ_INIT(DEVFS_DENODE_HEAD(node));
 187                 node->d_dir.d_type = DT_DIR;
 188                 node->nchildren = 2;
 189                 break;
 190
 191         case Plink:
 192                 node->d_dir.d_type = DT_LNK;
 193                 break;
 194
 195         case Preg:
 196                 node->d_dir.d_type = DT_REG;
 197                 break;
 198
 199         case Pdev:
 200                 if (dev != NULL) {
 201                         node->d_dir.d_type = DT_CHR;
 202                         node->d_dev = dev;
 203                         node->d_dir.d_ino = dev->si_inode;
 204
 205                         node->mode = dev->si_perms;     /* files access mode and type */
 206                         node->uid = dev->si_uid;                /* owner user id */
 207                         node->gid = dev->si_gid;                /* owner group id */
 208
 209                         devfs_alias_check_create(node);
 210                 }
 211                 break;
 212
 213         default:
 214                 panic("devfs_allocp: unknown node type");
 215         }
 216
 217         node->v_node = NULL;
 218         node->node_type = devfsnodetype;
 219
 220         /* Init the dirent structure of each devfs vnode */
 221         KKASSERT(namlen < 256);
 222
 223         node->d_dir.d_namlen = namlen;
 224         node->d_dir.d_name = kmalloc(namlen+1, M_DEVFS, M_WAITOK);
 225         memcpy(node->d_dir.d_name, name, namlen);
 226         node->d_dir.d_name[namlen] = '\0';
 227
 228         /* Initialize the parent node element */
 229         node->parent = parent;
 230
 231         /* Apply rules */
 232         devfs_rule_check_apply(node);
 233
 234         /* xtime members */
 235         nanotime(&node->atime);
 236         node->mtime = node->ctime = node->atime;
 237
 238         /*
 239          * Associate with parent as last step, clean out namecache
 240          * reference.
 241          */
 242         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocp: about to insert node\n");
 243         if ((parent != NULL) &&
 244             ((parent->node_type == Proot) || (parent->node_type == Pdir))) {
 245                 devfs_debug(DEVFS_DEBUG_DEBUG,
 246                             "devfs_allocp: node inserted %p\n",
 247                             node);
 248                 parent->nchildren++;
 249                 node->cookie = parent->cookie_jar++;
 250                 node->flags |= DEVFS_NODE_LINKED;
 251                 TAILQ_INSERT_TAIL(DEVFS_DENODE_HEAD(parent), node, link);
 252
 253                 /* This forces negative namecache lookups to clear */
 254                 ++mp->mnt_namecache_gen;
 255         }
 256
 257         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocp -end:2-\n");
 258         return node;
 259 }
 260
 261 /*
 262  * devfs_allocv() allocates a new vnode based on a devfs node.
 263  */
 264 int
 265 devfs_allocv(struct vnode **vpp, struct devfs_node *node)
 266 {
 267         struct vnode *vp;
 268         int error = 0;
 269
 270         KKASSERT(node);
 271
 272         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -1-\n");
 273
 274 try_again:
 275         while ((vp = node->v_node) != NULL) {
 276                 error = vget(vp, LK_EXCLUSIVE);
 277                 if (error != ENOENT) {
 278                         *vpp = vp;
 279                         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv, code path 2...\n");
 280                         goto out;
 281                 }
 282         }
 283         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -3-\n");
 284
 285         //XXX: afaik getnewvnode doesn't return anything but 0.
 286
 287         if ((error = getnewvnode(VT_DEVFS, node->mp, vpp, 0, 0)) != 0)
 288                 goto out;
 289
 290         vp = *vpp;
 291
 292         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -4-\n");
 293
 294         if (node->v_node != NULL) {
 295                 vp->v_type = VBAD;
 296                 vx_put(vp);
 297                 goto try_again;
 298         }
 299
 300         vp->v_data = node;
 301         node->v_node = vp;
 302         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -5-\n");
 303
 304         switch (node->node_type) {
 305         case Proot:
 306                 vp->v_flag |= VROOT;
 307         case Pdir:
 308                 vp->v_type = VDIR;
 309                 break;
 310
 311         case Plink:
 312                 vp->v_type = VLNK;
 313                 break;
 314
 315         case Preg:
 316                 vp->v_type = VREG;
 317                 break;
 318
 319         case Pdev:
 320                 vp->v_type = VCHR;
 321                 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -6-\n");
 322                 KKASSERT(node->d_dev);
 323
 324                 if (node->d_dev) {
 325                         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -7-\n");
 326                         vp->v_uminor = node->d_dev->si_uminor;
 327                         vp->v_umajor = 0;
 328                         vp->v_rdev = node->d_dev;
 329                         vp->v_ops = &node->mp->mnt_vn_spec_ops;
 330                         //v_associate_rdev(vp, node->d_dev);
 331                         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -8-\n");
 332                 } else {
 333                         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv: type is Pdev but d_dev is not set!!!!\n");
 334                 }
 335                 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -9-\n");
 336                 break;
 337
 338         default:
 339                 panic("devfs_allocv: unknown node type");
 340         }
 341
 342 out:
 343         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -10-\n");
 344         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocv -end:11-\n");
 345         return error;
 346 }
 347
 348 /*
 349  * devfs_allocvp allocates both a devfs node (with the given settings) and a vnode
 350  * based on the newly created devfs node.
 351  */
 352 int
 353 devfs_allocvp(struct mount *mp, struct vnode **vpp, devfs_nodetype devfsnodetype,
 354                                 char *name, struct devfs_node *parent, cdev_t dev)
 355 {
 356         struct devfs_node *node;
 357
 358         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocvp -1-\n");
 359         node = devfs_allocp(devfsnodetype, name, parent, mp, dev);
 360         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocvp -2-\n");
 361         if (node != NULL)
 362                 devfs_allocv(vpp, node);
 363         else
 364                 *vpp = NULL;
 365
 366         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_allocvp -end:3-\n");
 367
 368         return 0;
 369 }
 370
 371 /*
 372  * Destroy the devfs_node.  The node must be unlinked from the topology.
 373  *
 374  * This function will also destroy any vnode association with the node
 375  * and device.
 376  *
 377  * The cdev_t itself remains intact.
 378  */
 379 int
 380 devfs_freep(struct devfs_node *node)
 381 {
 382         struct vnode *vp;
 383
 384         KKASSERT(node);
 385         KKASSERT(((node->flags & DEVFS_NODE_LINKED) == 0) ||
 386                  (node->node_type == Proot));
 387         KKASSERT((node->flags & DEVFS_DESTROYED) == 0);
 388
 389         atomic_subtract_int(&(DEVFS_MNTDATA(node->mp)->leak_count), 1);
 390         if (node->symlink_name) {
 391                 kfree(node->symlink_name, M_DEVFS);
 392                 node->symlink_name = NULL;
 393         }
 394
 395         /*
 396          * Remove the node from the orphan list if it is still on it.
 397          */
 398         if (node->flags & DEVFS_ORPHANED)
 399                 devfs_tracer_del_orphan(node);
 400
 401         /*
 402          * Disassociate the vnode from the node.  This also prevents the
 403          * vnode's reclaim code from double-freeing the node.
 404          */
 405         if ((vp = node->v_node) != NULL) {
 406                 vp->v_rdev = NULL;
 407                 vp->v_data = NULL;
 408                 node->v_node = NULL;
 409         }
 410         if (node->d_dir.d_name)
 411                 kfree(node->d_dir.d_name, M_DEVFS);
 412         node->flags |= DEVFS_DESTROYED;
 413
 414         objcache_put(devfs_node_cache, node);
 415
 416         return 0;
 417 }
 418
 419 /*
 420  * Unlink the devfs node from the topology and add it to the orphan list.
 421  * The node will later be destroyed by freep.
 422  *
 423  * Any vnode association, including the v_rdev and v_data, remains intact
 424  * until the freep.
 425  */
 426 int
 427 devfs_unlinkp(struct devfs_node *node)
 428 {
 429         struct devfs_node *parent;
 430         KKASSERT(node);
 431
 432         devfs_tracer_add_orphan(node);
 433         devfs_debug(DEVFS_DEBUG_DEBUG,
 434                     "devfs_unlinkp for %s\n", node->d_dir.d_name);
 435         parent = node->parent;
 436
 437         /*
 438          * If the parent is known we can unlink the node out of the topology
 439          */
 440         if (parent)     {
 441                 TAILQ_REMOVE(DEVFS_DENODE_HEAD(parent), node, link);
 442                 parent->nchildren--;
 443                 KKASSERT((parent->nchildren >= 0));
 444                 node->flags &= ~DEVFS_NODE_LINKED;
 445         }
 446         node->parent = NULL;
 447         return 0;
 448 }
 449
 450 /*
 451  * devfs_reaperp() is a recursive function that iterates through all the
 452  * topology, unlinking and freeing all devfs nodes.
 453  */
 454 int
 455 devfs_reaperp(struct devfs_node *node)
 456 {
 457         struct devfs_node *node1, *node2;
 458
 459         if ((node->node_type == Proot) || (node->node_type == Pdir)) {
 460                 devfs_debug(DEVFS_DEBUG_DEBUG,
 461                             "This node is Pdir or Proot; has %d children\n",
 462                             node->nchildren);
 463                 if (node->nchildren > 2) {
 464                         TAILQ_FOREACH_MUTABLE(node1, DEVFS_DENODE_HEAD(node),
 465                                               link, node2) {
 466                                 devfs_reaperp(node1);
 467                         }
 468                 }
 469         }
 470         devfs_unlinkp(node);
 471         devfs_freep(node);
 472
 473         return 0;
 474 }
 475
 476 /*
 477  * devfs_gc() is devfs garbage collector. It takes care of unlinking and
 478  * freeing a node, but also removes empty directories and links that link
 479  * via devfs auto-link mechanism to the node being deleted.
 480  */
 481 int
 482 devfs_gc(struct devfs_node *node)
 483 {
 484         struct devfs_node *root_node = DEVFS_MNTDATA(node->mp)->root_node;
 485
 486         devfs_gc_links(root_node, node, node->nlinks);
 487         devfs_unlinkp(node);
 488         devfs_gc_dirs(root_node);
 489
 490         devfs_freep(node);
 491
 492         return 0;
 493 }
 494
 495 /*
 496  * devfs_gc_dirs() is a helper function for devfs_gc, unlinking and freeing
 497  * empty directories.
 498  */
 499 static int
 500 devfs_gc_dirs(struct devfs_node *node)
 501 {
 502         struct devfs_node *node1, *node2;
 503
 504         if ((node->node_type == Proot) || (node->node_type == Pdir)) {
 505                 devfs_debug(DEVFS_DEBUG_DEBUG,
 506                             "This node is Pdir or Proot; has %d children\n",
 507                             node->nchildren);
 508                 if (node->nchildren > 2) {
 509                         TAILQ_FOREACH_MUTABLE(node1, DEVFS_DENODE_HEAD(node),
 510                                               link, node2) {
 511                                 devfs_gc_dirs(node1);
 512                         }
 513                 }
 514
 515                 if (node->nchildren == 2) {
 516                         devfs_debug(DEVFS_DEBUG_DEBUG,
 517                                     "This node is called %s and it is empty\n",
 518                                     node->d_dir.d_name);
 519                         devfs_unlinkp(node);
 520                         devfs_freep(node);
 521                 }
 522         }
 523
 524         return 0;
 525 }
 526
 527 /*
 528  * devfs_gc_links() is a helper function for devfs_gc, unlinking and freeing
 529  * eauto-linked nodes linking to the node being deleted.
 530  */
 531 static int
 532 devfs_gc_links(struct devfs_node *node, struct devfs_node *target,
 533                size_t nlinks)
 534 {
 535         struct devfs_node *node1, *node2;
 536
 537         if (nlinks > 0) {
 538                 if ((node->node_type == Proot) || (node->node_type == Pdir)) {
 539                         devfs_debug(DEVFS_DEBUG_DEBUG, "This node is Pdir or Proot; has %d children\n", node->nchildren);
 540                         if (node->nchildren > 2) {
 541                                 TAILQ_FOREACH_MUTABLE(node1, DEVFS_DENODE_HEAD(node), link, node2)      {
 542                                         nlinks = devfs_gc_links(node1, target, nlinks);
 543                                 }
 544                         }
 545                 } else if (node->link_target == target) {
 546                         nlinks--;
 547                         devfs_unlinkp(node);
 548                         devfs_freep(node);
 549                 }
 550         }
 551
 552         KKASSERT(nlinks >= 0);
 553
 554         return nlinks;
 555 }
 556
 557 /*
 558  * devfs_create_dev() is the asynchronous entry point for device creation.
 559  * It just sends a message with the relevant details to the devfs core.
 560  *
 561  * This function will reference the passed device.  The reference is owned
 562  * by devfs and represents all of the device's node associations.
 563  */
 564 int
 565 devfs_create_dev(cdev_t dev, uid_t uid, gid_t gid, int perms)
 566 {
 567         __uint64_t id;
 568         devfs_debug(DEVFS_DEBUG_DEBUG,
 569                     "devfs_create_dev -1-, name: %s (%p)\n",
 570                     dev->si_name, dev);
 571         reference_dev(dev);
 572         id = devfs_msg_send_dev(DEVFS_DEVICE_CREATE, dev, uid, gid, perms);
 573         devfs_debug(DEVFS_DEBUG_DEBUG,
 574                     "devfs_create_dev -end:2- (unique id: %x) / (%p)\n",
 575                     id, dev);
 576         return 0;
 577 }
 578
 579 /*
 580  * devfs_destroy_dev() is the asynchronous entry point for device destruction.
 581  * It just sends a message with the relevant details to the devfs core.
 582  */
 583 int
 584 devfs_destroy_dev(cdev_t dev)
 585 {
 586         devfs_msg_send_dev(DEVFS_DEVICE_DESTROY, dev, 0, 0, 0);
 587         return 0;
 588 }
 589
 590 /*
 591  * devfs_mount_add() is the synchronous entry point for adding a new devfs
 592  * mount.  It sends a synchronous message with the relevant details to the
 593  * devfs core.
 594  */
 595 int
 596 devfs_mount_add(struct devfs_mnt_data *mnt)
 597 {
 598         devfs_msg_t msg;
 599
 600         msg = devfs_msg_get();
 601         msg->mdv_mnt = mnt;
 602         msg = devfs_msg_send_sync(DEVFS_MOUNT_ADD, msg);
 603         devfs_msg_put(msg);
 604
 605         return 0;
 606 }
 607
 608 /*
 609  * devfs_mount_del() is the synchronous entry point for removing a devfs mount.
 610  * It sends a synchronous message with the relevant details to the devfs core.
 611  */
 612 int
 613 devfs_mount_del(struct devfs_mnt_data *mnt)
 614 {
 615         devfs_msg_t msg;
 616
 617         msg = devfs_msg_get();
 618         msg->mdv_mnt = mnt;
 619         msg = devfs_msg_send_sync(DEVFS_MOUNT_DEL, msg);
 620         devfs_msg_put(msg);
 621
 622         return 0;
 623 }
 624
 625 /*
 626  * devfs_destroy_subnames() is the synchronous entry point for device destruction
 627  * by subname. It just sends a message with the relevant details to the devfs core.
 628  */
 629 int
 630 devfs_destroy_subnames(char *name)
 631 {
 632         devfs_msg_t msg;
 633
 634         msg = devfs_msg_get();
 635         msg->mdv_load = name;
 636         msg = devfs_msg_send_sync(DEVFS_DESTROY_SUBNAMES, msg);
 637         devfs_msg_put(msg);
 638         return 0;
 639 }
 640
 641 int
 642 devfs_clr_subnames_flag(char *name, uint32_t flag)
 643 {
 644         devfs_msg_t msg;
 645
 646         msg = devfs_msg_get();
 647         msg->mdv_flags.name = name;
 648         msg->mdv_flags.flag = flag;
 649         msg = devfs_msg_send_sync(DEVFS_CLR_SUBNAMES_FLAG, msg);
 650         devfs_msg_put(msg);
 651
 652         return 0;
 653 }
 654
 655 int
 656 devfs_destroy_subnames_without_flag(char *name, uint32_t flag)
 657 {
 658         devfs_msg_t msg;
 659
 660         msg = devfs_msg_get();
 661         msg->mdv_flags.name = name;
 662         msg->mdv_flags.flag = flag;
 663         msg = devfs_msg_send_sync(DEVFS_DESTROY_SUBNAMES_WO_FLAG, msg);
 664         devfs_msg_put(msg);
 665
 666         return 0;
 667 }
 668
 669 /*
 670  * devfs_create_all_dev is the asynchronous entry point to trigger device
 671  * node creation.  It just sends a message with the relevant details to
 672  * the devfs core.
 673  */
 674 int
 675 devfs_create_all_dev(struct devfs_node *root)
 676 {
 677         devfs_msg_send_generic(DEVFS_CREATE_ALL_DEV, root);
 678         return 0;
 679 }
 680
 681 /*
 682  * devfs_destroy_dev_by_ops is the asynchronous entry point to destroy all
 683  * devices with a specific set of dev_ops and minor.  It just sends a
 684  * message with the relevant details to the devfs core.
 685  */
 686 int
 687 devfs_destroy_dev_by_ops(struct dev_ops *ops, int minor)
 688 {
 689         devfs_msg_send_ops(DEVFS_DESTROY_DEV_BY_OPS, ops, minor);
 690         return 0;
 691 }
 692
 693 /*
 694  * devfs_clone_handler_add is the synchronous entry point to add a new
 695  * clone handler.  It just sends a message with the relevant details to
 696  * the devfs core.
 697  */
 698 int
 699 devfs_clone_handler_add(char *name, d_clone_t *nhandler)
 700 {
 701         devfs_msg_t msg;
 702
 703         msg = devfs_msg_get();
 704     msg->mdv_chandler.name = name;
 705         msg->mdv_chandler.nhandler = nhandler;
 706         msg = devfs_msg_send_sync(DEVFS_CHANDLER_ADD, msg);
 707         devfs_msg_put(msg);
 708         return 0;
 709 }
 710
 711 /*
 712  * devfs_clone_handler_del is the synchronous entry point to remove a
 713  * clone handler.  It just sends a message with the relevant details to
 714  * the devfs core.
 715  */
 716 int
 717 devfs_clone_handler_del(char *name)
 718 {
 719         devfs_msg_t msg;
 720
 721         msg = devfs_msg_get();
 722     msg->mdv_chandler.name = name;
 723         msg->mdv_chandler.nhandler = NULL;
 724         msg = devfs_msg_send_sync(DEVFS_CHANDLER_DEL, msg);
 725         devfs_msg_put(msg);
 726         return 0;
 727 }
 728
 729 /*
 730  * devfs_find_device_by_name is the synchronous entry point to find a
 731  * device given its name.  It sends a synchronous message with the
 732  * relevant details to the devfs core and returns the answer.
 733  */
 734 cdev_t
 735 devfs_find_device_by_name(const char *fmt, ...)
 736 {
 737         cdev_t found = NULL;
 738         devfs_msg_t msg;
 739         char target[PATH_MAX+1];
 740         __va_list ap;
 741         int i;
 742
 743         if (fmt == NULL)
 744                 return NULL;
 745
 746
 747         __va_start(ap, fmt);
 748         i = kvcprintf(fmt, NULL, target, 10, ap);
 749         target[i] = '\0';
 750         __va_end(ap);
 751
 752
 753         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_find_device_by_name: %s -1-\n", target);
 754         msg = devfs_msg_get();
 755         msg->mdv_name = target;
 756         msg = devfs_msg_send_sync(DEVFS_FIND_DEVICE_BY_NAME, msg);
 757         found = msg->mdv_cdev;
 758         devfs_msg_put(msg);
 759
 760         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_find_device_by_name found? %s  -end:2-\n", (found)?"YES":"NO");
 761         return found;
 762 }
 763
 764 /*
 765  * devfs_find_device_by_udev is the synchronous entry point to find a
 766  * device given its udev number.  It sends a synchronous message with
 767  * the relevant details to the devfs core and returns the answer.
 768  */
 769 cdev_t
 770 devfs_find_device_by_udev(udev_t udev)
 771 {
 772         cdev_t found = NULL;
 773         devfs_msg_t msg;
 774
 775         msg = devfs_msg_get();
 776         msg->mdv_udev = udev;
 777         msg = devfs_msg_send_sync(DEVFS_FIND_DEVICE_BY_UDEV, msg);
 778         found = msg->mdv_cdev;
 779         devfs_msg_put(msg);
 780
 781         devfs_debug(DEVFS_DEBUG_DEBUG,
 782                     "devfs_find_device_by_udev found? %s  -end:3-\n",
 783                     ((found) ? found->si_name:"NO"));
 784         return found;
 785 }
 786
 787 /*
 788  * devfs_make_alias is the asynchronous entry point to register an alias
 789  * for a device.  It just sends a message with the relevant details to the
 790  * devfs core.
 791  */
 792 int
 793 devfs_make_alias(char *name, cdev_t dev_target)
 794 {
 795         struct devfs_alias *alias;
 796
 797         alias = kmalloc(sizeof(struct devfs_alias), M_DEVFS, M_WAITOK);
 798         memcpy(alias->name, name, strlen(name) + 1);
 799         alias->dev_target = dev_target;
 800
 801         devfs_msg_send_generic(DEVFS_MAKE_ALIAS, alias);
 802         return 0;
 803 }
 804
 805 /*
 806  * devfs_apply_rules is the asynchronous entry point to trigger application
 807  * of all rules.  It just sends a message with the relevant details to the
 808  * devfs core.
 809  */
 810 int
 811 devfs_apply_rules(char *mntto)
 812 {
 813         char *new_name;
 814         size_t  namelen;
 815
 816         namelen = strlen(mntto) + 1;
 817
 818         new_name = kmalloc(namelen, M_DEVFS, M_WAITOK);
 819
 820         memcpy(new_name, mntto, namelen);
 821
 822         devfs_msg_send_name(DEVFS_APPLY_RULES, new_name);
 823         return 0;
 824 }
 825
 826 /*
 827  * devfs_reset_rules is the asynchronous entry point to trigger reset of all rules.
 828  * It just sends a message with the relevant details to the devfs core.
 829  */
 830 int
 831 devfs_reset_rules(char *mntto)
 832 {
 833         char *new_name;
 834         size_t  namelen;
 835
 836         namelen = strlen(mntto) + 1;
 837
 838         new_name = kmalloc(namelen, M_DEVFS, M_WAITOK);
 839
 840         memcpy(new_name, mntto, namelen);
 841
 842         devfs_msg_send_name(DEVFS_RESET_RULES, new_name);
 843         return 0;
 844 }
 845
 846
 847 /*
 848  * devfs_scan_callback is the asynchronous entry point to call a callback
 849  * on all cdevs.
 850  * It just sends a message with the relevant details to the devfs core.
 851  */
 852 int
 853 devfs_scan_callback(devfs_scan_t *callback)
 854 {
 855         devfs_msg_t msg;
 856
 857         /* Make sure that function pointers have the size of a generic pointer (innecessary) */
 858         KKASSERT(sizeof(callback) == sizeof(void *));
 859
 860         msg = devfs_msg_get();
 861         msg->mdv_load = callback;
 862         msg = devfs_msg_send_sync(DEVFS_SCAN_CALLBACK, msg);
 863         devfs_msg_put(msg);
 864
 865         return 0;
 866 }
 867
 868
 869 /*
 870  * Acts as a message drain. Any message that is replied to here gets destroyed and
 871  * the memory freed.
 872  */
 873 static void
 874 devfs_msg_autofree_reply(lwkt_port_t port, lwkt_msg_t msg)
 875 {
 876         devfs_msg_put((devfs_msg_t)msg);
 877 }
 878
 879 /*
 880  * devfs_msg_get allocates a new devfs msg and returns it.
 881  */
 882 devfs_msg_t
 883 devfs_msg_get()
 884 {
 885         return objcache_get(devfs_msg_cache, M_WAITOK);
 886 }
 887
 888 /*
 889  * devfs_msg_put deallocates a given devfs msg.
 890  */
 891 int
 892 devfs_msg_put(devfs_msg_t msg)
 893 {
 894         objcache_put(devfs_msg_cache, msg);
 895         return 0;
 896 }
 897
 898 /*
 899  * devfs_msg_send is the generic asynchronous message sending facility
 900  * for devfs. By default the reply port is the automatic disposal port.
 901  */
 902 __uint32_t
 903 devfs_msg_send(uint32_t cmd, devfs_msg_t devfs_msg)
 904 {
 905         lwkt_port_t port = &devfs_msg_port;
 906
 907     lwkt_initmsg(&devfs_msg->hdr, &devfs_dispose_port, 0);
 908
 909     devfs_msg->hdr.u.ms_result = cmd;
 910         devfs_msg->id = atomic_fetchadd_int(&msg_id, 1);
 911
 912     lwkt_sendmsg(port, (lwkt_msg_t)devfs_msg);
 913
 914         return devfs_msg->id;
 915 }
 916
 917 /*
 918  * devfs_msg_send_sync is the generic synchronous message sending
 919  * facility for devfs. It initializes a local reply port and waits
 920  * for the core's answer. This answer is then returned.
 921  */
 922 devfs_msg_t
 923 devfs_msg_send_sync(uint32_t cmd, devfs_msg_t devfs_msg)
 924 {
 925         struct lwkt_port rep_port;
 926         devfs_msg_t     msg_incoming;
 927         lwkt_port_t port = &devfs_msg_port;
 928
 929         lwkt_initport_thread(&rep_port, curthread);
 930     lwkt_initmsg(&devfs_msg->hdr, &rep_port, 0);
 931
 932     devfs_msg->hdr.u.ms_result = cmd;
 933         devfs_msg->id = atomic_fetchadd_int(&msg_id, 1);
 934
 935     lwkt_sendmsg(port, (lwkt_msg_t)devfs_msg);
 936         msg_incoming = lwkt_waitport(&rep_port, 0);
 937
 938         return msg_incoming;
 939 }
 940
 941 /*
 942  * sends a message with a generic argument.
 943  */
 944 __uint32_t
 945 devfs_msg_send_generic(uint32_t cmd, void *load)
 946 {
 947     devfs_msg_t devfs_msg = devfs_msg_get();
 948     devfs_msg->mdv_load = load;
 949
 950         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_send_generic -1- (%p)\n", load);
 951
 952         return devfs_msg_send(cmd, devfs_msg);
 953 }
 954
 955 /*
 956  * sends a message with a name argument.
 957  */
 958 __uint32_t
 959 devfs_msg_send_name(uint32_t cmd, char *name)
 960 {
 961     devfs_msg_t devfs_msg = devfs_msg_get();
 962     devfs_msg->mdv_name = name;
 963
 964         return devfs_msg_send(cmd, devfs_msg);
 965 }
 966
 967 /*
 968  * sends a message with a mount argument.
 969  */
 970 __uint32_t
 971 devfs_msg_send_mount(uint32_t cmd, struct devfs_mnt_data *mnt)
 972 {
 973     devfs_msg_t devfs_msg = devfs_msg_get();
 974     devfs_msg->mdv_mnt = mnt;
 975
 976         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_send_mp -1- (%p)\n", mnt);
 977
 978         return devfs_msg_send(cmd, devfs_msg);
 979 }
 980
 981 /*
 982  * sends a message with an ops argument.
 983  */
 984 __uint32_t
 985 devfs_msg_send_ops(uint32_t cmd, struct dev_ops *ops, int minor)
 986 {
 987     devfs_msg_t devfs_msg = devfs_msg_get();
 988     devfs_msg->mdv_ops.ops = ops;
 989         devfs_msg->mdv_ops.minor = minor;
 990
 991         return devfs_msg_send(cmd, devfs_msg);
 992 }
 993
 994 /*
 995  * sends a message with a clone handler argument.
 996  */
 997 __uint32_t
 998 devfs_msg_send_chandler(uint32_t cmd, char *name, d_clone_t handler)
 999 {
1000     devfs_msg_t devfs_msg = devfs_msg_get();
1001     devfs_msg->mdv_chandler.name = name;
1002         devfs_msg->mdv_chandler.nhandler = handler;
1003
1004         return devfs_msg_send(cmd, devfs_msg);
1005 }
1006
1007 /*
1008  * sends a message with a device argument.
1009  */
1010 __uint32_t
1011 devfs_msg_send_dev(uint32_t cmd, cdev_t dev, uid_t uid, gid_t gid, int perms)
1012 {
1013     devfs_msg_t devfs_msg = devfs_msg_get();
1014     devfs_msg->mdv_dev.dev = dev;
1015         devfs_msg->mdv_dev.uid = uid;
1016         devfs_msg->mdv_dev.gid = gid;
1017         devfs_msg->mdv_dev.perms = perms;
1018
1019         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_send_dev -1- (%p)\n", dev);
1020
1021         return devfs_msg_send(cmd, devfs_msg);
1022 }
1023
1024 /*
1025  * sends a message with a link argument.
1026  */
1027 //XXX: dead code!
1028 __uint32_t
1029 devfs_msg_send_link(uint32_t cmd, char *name, char *target, struct mount *mp)
1030 {
1031     devfs_msg_t devfs_msg = devfs_msg_get();
1032     devfs_msg->mdv_link.name = name;
1033         devfs_msg->mdv_link.target = target;
1034         devfs_msg->mdv_link.mp = mp;
1035
1036
1037         return devfs_msg_send(cmd, devfs_msg);
1038 }
1039
1040 /*
1041  * devfs_msg_core is the main devfs thread. It handles all incoming messages
1042  * and calls the relevant worker functions. By using messages it's assured
1043  * that events occur in the correct order.
1044  */
1045 static void
1046 devfs_msg_core(void *arg)
1047 {
1048         uint8_t  run = 1;
1049         devfs_msg_t msg;
1050         cdev_t  dev;
1051         struct devfs_mnt_data *mnt;
1052         struct devfs_node *node;
1053
1054         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_core -1-\n");
1055         lwkt_initport_thread(&devfs_msg_port, curthread);
1056         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_core -2-\n");
1057         wakeup(td_core/*devfs_id*/);
1058         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_core -3-\n");
1059
1060         while (run) {
1061                 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_core -loop:4-\n");
1062                 msg = (devfs_msg_t)lwkt_waitport(&devfs_msg_port, 0);
1063                 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_core, new msg: %x (unique id: %x)\n", (unsigned int)msg->hdr.u.ms_result, msg->id);
1064                 lockmgr(&devfs_lock, LK_EXCLUSIVE);
1065                 switch (msg->hdr.u.ms_result) {
1066
1067                 case DEVFS_DEVICE_CREATE:
1068                         dev = msg->mdv_dev.dev;
1069                         devfs_debug(DEVFS_DEBUG_DEBUG,
1070                                     "devfs_msg_core device create msg %s(%p)\n",
1071                                     dev->si_name, dev);
1072                         devfs_create_dev_worker(dev,
1073                                                 msg->mdv_dev.uid,
1074                                                 msg->mdv_dev.gid,
1075                                                 msg->mdv_dev.perms);
1076                         break;
1077
1078                 case DEVFS_DEVICE_DESTROY:
1079                         devfs_debug(DEVFS_DEBUG_DEBUG,
1080                                     "devfs_msg_core device destroy msg\n");
1081                         dev = msg->mdv_dev.dev;
1082                         devfs_destroy_dev_worker(dev);
1083                         break;
1084
1085                 case DEVFS_DESTROY_SUBNAMES:
1086                         devfs_destroy_subnames_worker(msg->mdv_load);
1087                         break;
1088
1089                 case DEVFS_DESTROY_DEV_BY_OPS:
1090                         devfs_destroy_dev_by_ops_worker(msg->mdv_ops.ops,
1091                                                         msg->mdv_ops.minor);
1092                         break;
1093
1094                 case DEVFS_CREATE_ALL_DEV:
1095                         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_msg_core device create ALL msg\n");
1096                         node = (struct devfs_node *)msg->mdv_load;
1097                         devfs_create_all_dev_worker(node);
1098                         break;
1099
1100                 case DEVFS_MOUNT_ADD:
1101                         mnt = msg->mdv_mnt;
1102                         TAILQ_INSERT_TAIL(&devfs_mnt_list, mnt, link);
1103                         devfs_create_all_dev_worker(mnt->root_node);
1104                         break;
1105
1106                 case DEVFS_MOUNT_DEL:
1107                         mnt = msg->mdv_mnt;
1108                         TAILQ_REMOVE(&devfs_mnt_list, mnt, link);
1109                         devfs_debug(DEVFS_DEBUG_SHOW, "There are still %d devfs_node elements!!!\n", mnt->leak_count);
1110                         devfs_reaperp(mnt->root_node);
1111                         devfs_debug(DEVFS_DEBUG_SHOW, "Leaked %d devfs_node elements!!!\n", mnt->leak_count);
1112                         break;
1113
1114                 case DEVFS_CHANDLER_ADD:
1115                         devfs_chandler_add_worker(msg->mdv_chandler.name, msg->mdv_chandler.nhandler);
1116                         break;
1117
1118                 case DEVFS_CHANDLER_DEL:
1119                         devfs_chandler_del_worker(msg->mdv_chandler.name);
1120                         break;
1121
1122                 case DEVFS_FIND_DEVICE_BY_NAME:
1123                         devfs_find_device_by_name_worker(msg);
1124                         break;
1125
1126                 case DEVFS_FIND_DEVICE_BY_UDEV:
1127                         devfs_find_device_by_udev_worker(msg);
1128                         break;
1129
1130                 case DEVFS_MAKE_ALIAS:
1131                         devfs_make_alias_worker((struct devfs_alias *)msg->mdv_load);
1132                         break;
1133
1134                 case DEVFS_APPLY_RULES:
1135                         devfs_apply_reset_rules_caller(msg->mdv_name, 1);
1136                         break;
1137
1138                 case DEVFS_RESET_RULES:
1139                         devfs_apply_reset_rules_caller(msg->mdv_name, 0);
1140                         break;
1141
1142                 case DEVFS_SCAN_CALLBACK:
1143                         devfs_scan_callback_worker((devfs_scan_t *)msg->mdv_load);
1144                         break;
1145
1146                 case DEVFS_CLR_SUBNAMES_FLAG:
1147                         devfs_clr_subnames_flag_worker(msg->mdv_flags.name,
1148                                                                                         msg->mdv_flags.flag);
1149                         break;
1150
1151                 case DEVFS_DESTROY_SUBNAMES_WO_FLAG:
1152                         devfs_destroy_subnames_without_flag_worker(msg->mdv_flags.name,
1153                                                                                                                 msg->mdv_flags.flag);
1154                         break;
1155
1156                 case DEVFS_TERMINATE_CORE:
1157                         run = 0;
1158                         break;
1159                 case DEVFS_SYNC:
1160                         break;
1161                 default:
1162                         devfs_debug(DEVFS_DEBUG_DEBUG,
1163                                     "devfs_msg_core: unknown message "
1164                                     "received at core\n");
1165                         break;
1166                 }
1167                 lockmgr(&devfs_lock, LK_RELEASE);
1168
1169                 lwkt_replymsg((lwkt_msg_t)msg, 0);
1170         }
1171         wakeup(td_core/*devfs_id*/);
1172         lwkt_exit();
1173 }
1174
1175 /*
1176  * Worker function to insert a new dev into the dev list and initialize its
1177  * permissions. It also calls devfs_propagate_dev which in turn propagates
1178  * the change to all mount points.
1179  *
1180  * The passed dev is already referenced.  This reference is eaten by this
1181  * function and represents the dev's linkage into devfs_dev_list.
1182  */
1183 static int
1184 devfs_create_dev_worker(cdev_t dev, uid_t uid, gid_t gid, int perms)
1185 {
1186         KKASSERT(dev);
1187         devfs_debug(DEVFS_DEBUG_DEBUG,
1188                     "devfs_create_dev_worker -1- -%s- (%p)\n",
1189                     dev->si_name, dev);
1190
1191         dev->si_uid = uid;
1192         dev->si_gid = gid;
1193         dev->si_perms = perms;
1194
1195         devfs_link_dev(dev);
1196         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_dev_worker -2-\n");
1197         devfs_propagate_dev(dev, 1);
1198
1199         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_dev_worker -end:3-\n");
1200         return 0;
1201 }
1202
1203 /*
1204  * Worker function to delete a dev from the dev list and free the cdev.
1205  * It also calls devfs_propagate_dev which in turn propagates the change
1206  * to all mount points.
1207  */
1208 static int
1209 devfs_destroy_dev_worker(cdev_t dev)
1210 {
1211         int error;
1212
1213         KKASSERT(dev);
1214         KKASSERT((lockstatus(&devfs_lock, curthread)) == LK_EXCLUSIVE);
1215
1216         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_destroy_dev_worker -1- %s\n", dev->si_name);
1217         error = devfs_unlink_dev(dev);
1218         devfs_propagate_dev(dev, 0);
1219         if (error == 0)
1220                 release_dev(dev);       /* link ref */
1221         release_dev(dev);
1222         release_dev(dev);
1223
1224         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_destroy_dev_worker -end:5-\n");
1225         return 0;
1226 }
1227
1228 /*
1229  * Worker function to destroy all devices with a certain basename.
1230  * Calls devfs_destroy_dev_worker for the actual destruction.
1231  */
1232 static int
1233 devfs_destroy_subnames_worker(char *name)
1234 {
1235         cdev_t dev, dev1;
1236         size_t len = strlen(name);
1237
1238         TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) {
1239                 if (!strncmp(dev->si_name, name, len)) {
1240                         if (dev->si_name[len] != '\0') {
1241                                 devfs_destroy_dev_worker(dev);
1242                                 /* release_dev(dev); */
1243                         }
1244                 }
1245         }
1246         return 0;
1247 }
1248
1249 static int
1250 devfs_clr_subnames_flag_worker(char *name, uint32_t flag)
1251 {
1252         cdev_t dev, dev1;
1253         size_t len = strlen(name);
1254
1255         TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) {
1256                 if (!strncmp(dev->si_name, name, len)) {
1257                         if (dev->si_name[len] != '\0') {
1258                                 dev->si_flags &= ~flag;
1259                         }
1260                 }
1261         }
1262
1263         return 0;
1264 }
1265
1266 static int
1267 devfs_destroy_subnames_without_flag_worker(char *name, uint32_t flag)
1268 {
1269         cdev_t dev, dev1;
1270         size_t len = strlen(name);
1271
1272         TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) {
1273                 if (!strncmp(dev->si_name, name, len)) {
1274                         if (dev->si_name[len] != '\0') {
1275                                 if (!(dev->si_flags & flag)) {
1276                                         devfs_destroy_dev_worker(dev);
1277                                 }
1278                         }
1279                 }
1280         }
1281
1282         return 0;
1283 }
1284
1285 /*
1286  * Worker function that creates all device nodes on top of a devfs
1287  * root node.
1288  */
1289 static int
1290 devfs_create_all_dev_worker(struct devfs_node *root)
1291 {
1292         cdev_t dev;
1293
1294         KKASSERT(root);
1295         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_all_dev_worker -1-\n");
1296
1297     TAILQ_FOREACH(dev, &devfs_dev_list, link) {
1298                 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_all_dev_worker -loop:2- -%s-\n", dev->si_name);
1299                 devfs_create_device_node(root, dev, NULL, NULL);
1300     }
1301         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_all_dev_worker -end:3-\n");
1302         return 0;
1303 }
1304
1305 /*
1306  * Worker function that destroys all devices that match a specific
1307  * dev_ops and/or minor. If minor is less than 0, it is not matched
1308  * against. It also propagates all changes.
1309  */
1310 static int
1311 devfs_destroy_dev_by_ops_worker(struct dev_ops *ops, int minor)
1312 {
1313         cdev_t dev, dev1;
1314
1315         KKASSERT(ops);
1316         devfs_debug(DEVFS_DEBUG_DEBUG,
1317                     "devfs_destroy_dev_by_ops_worker -1-\n");
1318
1319         TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) {
1320                 if (dev->si_ops != ops)
1321                         continue;
1322                 if ((minor < 0) || (dev->si_uminor == minor)) {
1323                         devfs_debug(DEVFS_DEBUG_DEBUG,
1324                                     "devfs_destroy_dev_by_ops_worker "
1325                                     "-loop:2- -%s-\n",
1326                                     dev->si_name);
1327                         devfs_destroy_dev_worker(dev);
1328                 }
1329         }
1330         devfs_debug(DEVFS_DEBUG_DEBUG,
1331                     "devfs_destroy_dev_by_ops_worker -end:3-\n");
1332         return 0;
1333 }
1334
1335 /*
1336  * Worker function that registers a new clone handler in devfs.
1337  */
1338 static int
1339 devfs_chandler_add_worker(char *name, d_clone_t *nhandler)
1340 {
1341         struct devfs_clone_handler *chandler = NULL;
1342         u_char len = strlen(name);
1343
1344         if (len == 0)
1345                 return 1;
1346
1347         TAILQ_FOREACH(chandler, &devfs_chandler_list, link) {
1348                 if (chandler->namlen == len) {
1349                         if (!memcmp(chandler->name, name, len)) {
1350                                 /* Clonable basename already exists */
1351                                 return 1;
1352                         }
1353                 }
1354         }
1355
1356         chandler = kmalloc(sizeof(*chandler), M_DEVFS, M_WAITOK | M_ZERO);
1357         memcpy(chandler->name, name, len+1);
1358         chandler->namlen = len;
1359         chandler->nhandler = nhandler;
1360
1361         TAILQ_INSERT_TAIL(&devfs_chandler_list, chandler, link);
1362         return 0;
1363 }
1364
1365 /*
1366  * Worker function that removes a given clone handler from the
1367  * clone handler list.
1368  */
1369 static int
1370 devfs_chandler_del_worker(char *name)
1371 {
1372         struct devfs_clone_handler *chandler, *chandler2;
1373         u_char len = strlen(name);
1374
1375         if (len == 0)
1376                 return 1;
1377
1378         TAILQ_FOREACH_MUTABLE(chandler, &devfs_chandler_list, link, chandler2) {
1379                 if (chandler->namlen != len)
1380                         continue;
1381                 if (memcmp(chandler->name, name, len))
1382                         continue;
1383                 TAILQ_REMOVE(&devfs_chandler_list, chandler, link);
1384                 kfree(chandler, M_DEVFS);
1385         }
1386
1387         return 0;
1388 }
1389
1390 /*
1391  * Worker function that finds a given device name and changes
1392  * the message received accordingly so that when replied to,
1393  * the answer is returned to the caller.
1394  */
1395 static int
1396 devfs_find_device_by_name_worker(devfs_msg_t devfs_msg)
1397 {
1398         cdev_t dev, dev1;
1399         cdev_t found = NULL;
1400
1401         TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) {
1402                 if (!strcmp(devfs_msg->mdv_name, dev->si_name)) {
1403                         found = dev;
1404                         break;
1405                 }
1406         }
1407         devfs_msg->mdv_cdev = found;
1408
1409         return 0;
1410 }
1411
1412 /*
1413  * Worker function that finds a given device udev and changes
1414  * the message received accordingly so that when replied to,
1415  * the answer is returned to the caller.
1416  */
1417 static int
1418 devfs_find_device_by_udev_worker(devfs_msg_t devfs_msg)
1419 {
1420         cdev_t dev, dev1;
1421         cdev_t found = NULL;
1422
1423         TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) {
1424                 if (((udev_t)dev->si_inode) == devfs_msg->mdv_udev) {
1425                         found = dev;
1426                         break;
1427                 }
1428         }
1429         devfs_msg->mdv_cdev = found;
1430
1431         return 0;
1432 }
1433
1434 /*
1435  * Worker function that inserts a given alias into the
1436  * alias list, and propagates the alias to all mount
1437  * points.
1438  */
1439 static int
1440 devfs_make_alias_worker(struct devfs_alias *alias)
1441 {
1442         struct devfs_alias *alias2;
1443         size_t len = strlen(alias->name);
1444         int found = 0;
1445
1446         TAILQ_FOREACH(alias2, &devfs_alias_list, link) {
1447                 if (!memcmp(alias->name, alias2->name, len)) {
1448                         found = 1;
1449                         break;
1450                 }
1451         }
1452
1453         if (!found) {
1454                 TAILQ_INSERT_TAIL(&devfs_alias_list, alias, link);
1455                 devfs_alias_propagate(alias);
1456         } else {
1457                 devfs_debug(DEVFS_DEBUG_DEBUG,
1458                             "Warning: duplicate devfs_make_alias for %s\n",
1459                             alias->name);
1460                 kfree(alias, M_DEVFS);
1461         }
1462
1463         return 0;
1464 }
1465
1466 /*
1467  * Function that removes and frees all aliases.
1468  */
1469 static int
1470 devfs_alias_reap(void)
1471 {
1472         struct devfs_alias *alias, *alias2;
1473
1474         TAILQ_FOREACH_MUTABLE(alias, &devfs_alias_list, link, alias2) {
1475                 TAILQ_REMOVE(&devfs_alias_list, alias, link);
1476                 kfree(alias, M_DEVFS);
1477         }
1478         return 0;
1479 }
1480
1481 /*
1482  * Function that removes an alias matching a specific cdev and frees
1483  * it accordingly.
1484  */
1485 static int
1486 devfs_alias_remove(cdev_t dev)
1487 {
1488         struct devfs_alias *alias, *alias2;
1489
1490         TAILQ_FOREACH_MUTABLE(alias, &devfs_alias_list, link, alias2) {
1491                 if (alias->dev_target == dev) {
1492                         TAILQ_REMOVE(&devfs_alias_list, alias, link);
1493                         kfree(alias, M_DEVFS);
1494                 }
1495         }
1496         return 0;
1497 }
1498
1499 /*
1500  * This function propagates a new alias to all mount points.
1501  */
1502 static int
1503 devfs_alias_propagate(struct devfs_alias *alias)
1504 {
1505         struct devfs_mnt_data *mnt;
1506
1507         TAILQ_FOREACH(mnt, &devfs_mnt_list, link) {
1508                 devfs_alias_apply(mnt->root_node, alias);
1509         }
1510         return 0;
1511 }
1512
1513 /*
1514  * This function is a recursive function iterating through
1515  * all device nodes in the topology and, if applicable,
1516  * creating the relevant alias for a device node.
1517  */
1518 static int
1519 devfs_alias_apply(struct devfs_node *node, struct devfs_alias *alias)
1520 {
1521         struct devfs_node *node1, *node2;
1522
1523         KKASSERT(alias != NULL);
1524
1525         if ((node->node_type == Proot) || (node->node_type == Pdir)) {
1526                 devfs_debug(DEVFS_DEBUG_DEBUG, "This node is Pdir or Proot; has %d children\n", node->nchildren);
1527                 if (node->nchildren > 2) {
1528                         TAILQ_FOREACH_MUTABLE(node1, DEVFS_DENODE_HEAD(node), link, node2) {
1529                                 devfs_alias_apply(node1, alias);
1530                         }
1531                 }
1532         } else {
1533                 if (node->d_dev == alias->dev_target)
1534                         devfs_alias_create(alias->name, node);
1535         }
1536         return 0;
1537 }
1538
1539 /*
1540  * This function checks if any alias possibly is applicable
1541  * to the given node. If so, the alias is created.
1542  */
1543 static int
1544 devfs_alias_check_create(struct devfs_node *node)
1545 {
1546         struct devfs_alias *alias;
1547
1548         TAILQ_FOREACH(alias, &devfs_alias_list, link) {
1549                 if (node->d_dev == alias->dev_target)
1550                         devfs_alias_create(alias->name, node);
1551         }
1552         return 0;
1553 }
1554
1555 /*
1556  * This function creates an alias with a given name
1557  * linking to a given devfs node. It also increments
1558  * the link count on the target node.
1559  */
1560 int
1561 devfs_alias_create(char *name_orig, struct devfs_node *target)
1562 {
1563         struct mount *mp = target->mp;
1564         struct devfs_node *parent = DEVFS_MNTDATA(mp)->root_node;
1565         struct devfs_node *linknode;
1566         char *create_path = NULL;
1567         char *name, name_buf[PATH_MAX];
1568
1569         KKASSERT((lockstatus(&devfs_lock, curthread)) == LK_EXCLUSIVE);
1570
1571         devfs_resolve_name_path(name_orig, name_buf, &create_path, &name);
1572
1573         if (create_path)
1574                 parent = devfs_resolve_or_create_path(parent, create_path, 1);
1575
1576
1577         if (devfs_find_device_node_by_name(parent, name)) {
1578                 devfs_debug(DEVFS_DEBUG_DEBUG,
1579                             "Node already exists: %s "
1580                             "(devfs_make_alias_worker)!\n",
1581                             name);
1582                 return 1;
1583         }
1584
1585
1586         linknode = devfs_allocp(Plink, name, parent, mp, NULL);
1587         if (linknode == NULL)
1588                 return 1;
1589
1590         linknode->link_target = target;
1591         target->nlinks++;
1592         //linknode->flags |= DEVFS_LINK;
1593
1594         return 0;
1595 }
1596
1597 /*
1598  * This function is called by the core and handles mount point
1599  * strings. It either calls the relevant worker (devfs_apply_
1600  * reset_rules_worker) on all mountpoints or only a specific
1601  * one.
1602  */
1603 static int
1604 devfs_apply_reset_rules_caller(char *mountto, int apply)
1605 {
1606         //int found = 0;
1607         struct devfs_mnt_data *mnt;
1608         size_t len = strlen(mountto);
1609
1610         if (mountto[0] != '*') {
1611                 TAILQ_FOREACH(mnt, &devfs_mnt_list, link) {
1612                         if ((len == mnt->mntonnamelen) &&
1613                                 (!memcmp(mnt->mp->mnt_stat.f_mntonname, mountto, len))) {
1614                                 devfs_apply_reset_rules_worker(mnt->root_node, apply);
1615                                 break;
1616                         }
1617                 }
1618         } else {
1619                 TAILQ_FOREACH(mnt, &devfs_mnt_list, link) {
1620                         devfs_apply_reset_rules_worker(mnt->root_node, apply);
1621                 }
1622         }
1623
1624         kfree(mountto, M_DEVFS);
1625         return 0;
1626 }
1627
1628 /*
1629  * This worker function applies or resets, depending on the arguments, a rule
1630  * to the whole given topology. *RECURSIVE*
1631  */
1632 static int
1633 devfs_apply_reset_rules_worker(struct devfs_node *node, int apply)
1634 {
1635         struct devfs_node *node1, *node2;
1636
1637         if ((node->node_type == Proot) || (node->node_type == Pdir)) {
1638                 devfs_debug(DEVFS_DEBUG_DEBUG, "This node is Pdir or Proot; has %d children\n", node->nchildren);
1639                 if (node->nchildren > 2) {
1640                         TAILQ_FOREACH_MUTABLE(node1, DEVFS_DENODE_HEAD(node), link, node2)      {
1641                                 devfs_apply_reset_rules_worker(node1, apply);
1642                         }
1643                 }
1644         }
1645
1646         if (apply)
1647                 devfs_rule_check_apply(node);
1648         else
1649                 devfs_rule_reset_node(node);
1650
1651         return 0;
1652 }
1653
1654
1655 /*
1656  * This function calls a given callback function for
1657  * every dev node in the devfs dev list.
1658  */
1659 static int
1660 devfs_scan_callback_worker(devfs_scan_t *callback)
1661 {
1662         cdev_t dev, dev1;
1663
1664         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_scan_callback: %p -1-\n", callback);
1665
1666     TAILQ_FOREACH_MUTABLE(dev, &devfs_dev_list, link, dev1) {
1667                 callback(dev);
1668     }
1669
1670         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_scan_callback: finished\n");
1671         return 0;
1672 }
1673
1674
1675 /*
1676  * This function tries to resolve a given directory, or if not
1677  * found and creation requested, creates the given directory.
1678  */
1679 static struct devfs_node *
1680 devfs_resolve_or_create_dir(struct devfs_node *parent, char *dir_name,
1681                             size_t name_len, int create)
1682 {
1683         struct devfs_node *node, *found = NULL;
1684
1685         TAILQ_FOREACH(node, DEVFS_DENODE_HEAD(parent), link) {
1686                 if (name_len == node->d_dir.d_namlen) {
1687                         if (!memcmp(dir_name, node->d_dir.d_name, name_len)) {
1688                                 found = node;
1689                                 break;
1690                         }
1691                 }
1692         }
1693
1694         if ((found == NULL) && (create)) {
1695                 found = devfs_allocp(Pdir, dir_name, parent, parent->mp, NULL);
1696         }
1697
1698         return found;
1699 }
1700
1701 /*
1702  * This function tries to resolve a complete path. If creation is requested,
1703  * if a given part of the path cannot be resolved (because it doesn't exist),
1704  * it is created.
1705  */
1706 struct devfs_node *
1707 devfs_resolve_or_create_path(struct devfs_node *parent, char *path, int create)
1708 {
1709         struct devfs_node *node = parent;
1710         char buf[PATH_MAX];
1711         size_t idx = 0;
1712
1713
1714         if (path == NULL)
1715                 return parent;
1716
1717
1718         for (; *path != '\0' ; path++) {
1719                 if (*path != '/') {
1720                         buf[idx++] = *path;
1721                 } else {
1722                         buf[idx] = '\0';
1723                         node = devfs_resolve_or_create_dir(node, buf, idx, create);
1724                         if (node == NULL)
1725                                 return NULL;
1726                         idx = 0;
1727                 }
1728         }
1729         buf[idx] = '\0';
1730         return devfs_resolve_or_create_dir(node, buf, idx, create);
1731 }
1732
1733 /*
1734  * Takes a full path and strips it into a directory path and a name.
1735  * For a/b/c/foo, it returns foo in namep and a/b/c in pathp. It
1736  * requires a working buffer with enough size to keep the whole
1737  * fullpath.
1738  */
1739 int
1740 devfs_resolve_name_path(char *fullpath, char *buf, char **pathp, char **namep)
1741 {
1742         char *name = NULL;
1743         char *path = NULL;
1744         size_t len = strlen(fullpath) + 1;
1745         int i;
1746
1747         KKASSERT((fullpath != NULL) && (buf != NULL) && (pathp != NULL) && (namep != NULL));
1748
1749         memcpy(buf, fullpath, len);
1750
1751         for (i = len-1; i>= 0; i--) {
1752                 if (buf[i] == '/') {
1753                         buf[i] = '\0';
1754                         name = &(buf[i+1]);
1755                         path = buf;
1756                         break;
1757                 }
1758         }
1759
1760         *pathp = path;
1761
1762         if (name) {
1763                 *namep = name;
1764         } else {
1765                 *namep = buf;
1766         }
1767
1768         return 0;
1769 }
1770
1771 /*
1772  * This function creates a new devfs node for a given device.  It can
1773  * handle a complete path as device name, and accordingly creates
1774  * the path and the final device node.
1775  *
1776  * The reference count on the passed dev remains unchanged.
1777  */
1778 struct devfs_node *
1779 devfs_create_device_node(struct devfs_node *root, cdev_t dev,
1780                          char *dev_name, char *path_fmt, ...)
1781 {
1782         struct devfs_node *parent, *node = NULL;
1783         char *path = NULL;
1784         char *name, name_buf[PATH_MAX];
1785         __va_list ap;
1786         int i, found;
1787
1788         char *create_path = NULL;
1789         char *names = "pqrsPQRS";
1790
1791         if (path_fmt != NULL) {
1792                 path = kmalloc(PATH_MAX+1, M_DEVFS, M_WAITOK);
1793
1794                 __va_start(ap, path_fmt);
1795                 i = kvcprintf(path_fmt, NULL, path, 10, ap);
1796                 path[i] = '\0';
1797                 __va_end(ap);
1798         }
1799
1800         parent = devfs_resolve_or_create_path(root, path, 1);
1801         KKASSERT(parent);
1802
1803         devfs_resolve_name_path(((dev_name == NULL) && (dev))?(dev->si_name):(dev_name), name_buf, &create_path, &name);
1804
1805         if (create_path)
1806                 parent = devfs_resolve_or_create_path(parent, create_path, 1);
1807
1808
1809         if (devfs_find_device_node_by_name(parent, name)) {
1810                 devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_device_node: DEVICE %s ALREADY EXISTS!!! Ignoring creation request.\n", name);
1811                 goto out;
1812         }
1813         devfs_debug(DEVFS_DEBUG_DEBUG, "parent->d_dir.d_name=%s\n", parent->d_dir.d_name);
1814         node = devfs_allocp(Pdev, name, parent, parent->mp, dev);
1815         devfs_debug(DEVFS_DEBUG_DEBUG, "node->d_dir.d_name=%s\n", node->d_dir.d_name);
1816
1817         /* Ugly unix98 pty magic, to hide pty master (ptm) devices and their directory */
1818         if ((dev) && (strlen(dev->si_name) >= 4) && (!memcmp(dev->si_name, "ptm/", 4))) {
1819                 //node->parent->flags |= DEVFS_HIDDEN;
1820                 //node->flags |= DEVFS_HIDDEN;
1821         }
1822         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_device_node: marker A\n");
1823         /* Ugly pty magic, to tag pty devices as such and hide them if needed */
1824         if ((strlen(name) >= 3) && (!memcmp(name, "pty", 3)))
1825                 node->flags |= (DEVFS_PTY | DEVFS_INVISIBLE);
1826
1827         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_device_node: marker B\n");
1828         if ((strlen(name) >= 3) && (!memcmp(name, "tty", 3))) {
1829                 found = 0;
1830                 for (i = 0; i < strlen(names); i++) {
1831                         if (name[3] == names[i]) {
1832                                 found = 1;
1833                                 break;
1834                         }
1835                 }
1836                 if (found)
1837                         node->flags |= (DEVFS_PTY | DEVFS_INVISIBLE);
1838         }
1839         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_create_device_node: marker C\n");
1840
1841 out:
1842         if (path_fmt != NULL)
1843                 kfree(path, M_DEVFS);
1844
1845         return node;
1846 }
1847
1848 /*
1849  * This function finds a given device node in the topology with a given
1850  * cdev.
1851  */
1852 struct devfs_node *
1853 devfs_find_device_node(struct devfs_node *node, cdev_t target)
1854 {
1855         struct devfs_node *node1, *node2, *found = NULL;
1856
1857         if ((node->node_type == Proot) || (node->node_type == Pdir)) {
1858                 devfs_debug(DEVFS_DEBUG_DEBUG, "This node is Pdir or Proot; has %d children\n", node->nchildren);
1859                 if (node->nchildren > 2) {
1860                         TAILQ_FOREACH_MUTABLE(node1, DEVFS_DENODE_HEAD(node), link, node2)      {
1861                                 if ((found = devfs_find_device_node(node1, target)))
1862                                         return found;
1863                         }
1864                 }
1865         } else if (node->node_type == Pdev) {
1866                 if (node->d_dev == target)
1867                         return node;
1868         }
1869         //devfs_debug(DEVFS_DEBUG_DEBUG, "This node is called %s\n", (found)?found->d_dir.d_name:"NOTFOUND");
1870
1871         return NULL;
1872 }
1873
1874 /*
1875  * This function finds a device node in the topology by its
1876  * name and returns it.
1877  */
1878 struct devfs_node *
1879 devfs_find_device_node_by_name(struct devfs_node *parent, char *target)
1880 {
1881         struct devfs_node *node, *found = NULL;
1882         size_t len = strlen(target);
1883
1884         TAILQ_FOREACH(node, DEVFS_DENODE_HEAD(parent), link) {
1885                 if ((len == node->d_dir.d_namlen) && (!memcmp(node->d_dir.d_name, target, len))) {
1886                         found = node;
1887                         break;
1888                 }
1889         }
1890
1891         return found;
1892 }
1893
1894 /*
1895  * This function takes a cdev and removes its devfs node in the
1896  * given topology.  The cdev remains intact.
1897  */
1898 int
1899 devfs_destroy_device_node(struct devfs_node *root, cdev_t target)
1900 {
1901         struct devfs_node *node, *parent;
1902         char *name, name_buf[PATH_MAX];
1903         char *create_path = NULL;
1904
1905         KKASSERT(target);
1906
1907         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_destroy_device_node\n");
1908         memcpy(name_buf, target->si_name, strlen(target->si_name)+1);
1909
1910         devfs_resolve_name_path(target->si_name, name_buf, &create_path, &name);
1911         devfs_debug(DEVFS_DEBUG_DEBUG, "create_path: %s\n", create_path);
1912         devfs_debug(DEVFS_DEBUG_DEBUG, "name: %s\n", name);
1913
1914         if (create_path)
1915                 parent = devfs_resolve_or_create_path(root, create_path, 0);
1916         else
1917                 parent = root;
1918         devfs_debug(DEVFS_DEBUG_DEBUG, "-> marker <-\n");
1919         if (parent == NULL)
1920                 return 1;
1921         devfs_debug(DEVFS_DEBUG_DEBUG, "->d_dir.d_name=%s\n", parent->d_dir.d_name);
1922         node = devfs_find_device_node_by_name(parent, name);
1923         devfs_debug(DEVFS_DEBUG_DEBUG,
1924                     "->d_dir.d_name=%s\n",
1925                     ((node) ? (node->d_dir.d_name) : "SHIT!"));
1926         if (node)
1927                 devfs_gc(node);
1928
1929         return 0;
1930 }
1931
1932 /*
1933  * Just set perms and ownership for given node.
1934  */
1935 int
1936 devfs_set_perms(struct devfs_node *node, uid_t uid, gid_t gid, u_short mode, u_long flags)
1937 {
1938         node->mode = mode;              /* files access mode and type */
1939         node->uid = uid;                /* owner user id */
1940         node->gid = gid;                /* owner group id */
1941         //node->flags = flags;
1942
1943         return 0;
1944 }
1945
1946 /*
1947  * Propagates a device attach/detach to all mount
1948  * points. Also takes care of automatic alias removal
1949  * for a deleted cdev.
1950  */
1951 static int
1952 devfs_propagate_dev(cdev_t dev, int attach)
1953 {
1954         struct devfs_mnt_data *mnt;
1955
1956         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_propagate_dev -1-\n");
1957         TAILQ_FOREACH(mnt, &devfs_mnt_list, link) {
1958                 devfs_debug(DEVFS_DEBUG_DEBUG,
1959                             "devfs_propagate_dev -loop:2-\n");
1960                 if (attach) {
1961                         /* Device is being attached */
1962                         devfs_create_device_node(mnt->root_node, dev,
1963                                                  NULL, NULL );
1964                 } else {
1965                         /* Device is being detached */
1966                         devfs_alias_remove(dev);
1967                         devfs_destroy_device_node(mnt->root_node, dev);
1968                 }
1969         }
1970         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_propagate_dev -end:3-\n");
1971         return 0;
1972 }
1973
1974 /*
1975  * devfs_node_to_path takes a node and a buffer of a size of
1976  * at least PATH_MAX, resolves the full path from the root
1977  * node and writes it in a humanly-readable format into the
1978  * buffer.
1979  * If DEVFS_STASH_DEPTH is less than the directory level up
1980  * to the root node, only the last DEVFS_STASH_DEPTH levels
1981  * of the path are resolved.
1982  */
1983 int
1984 devfs_node_to_path(struct devfs_node *node, char *buffer)
1985 {
1986 #define DEVFS_STASH_DEPTH       32
1987         struct devfs_node *node_stash[DEVFS_STASH_DEPTH];
1988         int i, offset;
1989         memset(buffer, 0, PATH_MAX);
1990
1991         for (i = 0; (i < DEVFS_STASH_DEPTH) && (node->node_type != Proot); i++) {
1992                 node_stash[i] = node;
1993                 node = node->parent;
1994         }
1995         i--;
1996
1997         for (offset = 0; i >= 0; i--) {
1998                 memcpy(buffer+offset, node_stash[i]->d_dir.d_name, node_stash[i]->d_dir.d_namlen);
1999                 offset += node_stash[i]->d_dir.d_namlen;
2000                 if (i > 0) {
2001                         *(buffer+offset) = '/';
2002                         offset++;
2003                 }
2004         }
2005 #undef DEVFS_STASH_DEPTH
2006         return 0;
2007 }
2008
2009 /*
2010  * devfs_clone either returns a basename from a complete name by
2011  * returning the length of the name without trailing digits, or,
2012  * if clone != 0, calls the device's clone handler to get a new
2013  * device, which in turn is returned in devp.
2014  */
2015 int
2016 devfs_clone(char *name, size_t *namlenp, cdev_t *devp, int clone, struct ucred *cred)
2017 {
2018         KKASSERT(namlenp);
2019
2020         size_t len = *namlenp;
2021         int error = 1;
2022         struct devfs_clone_handler *chandler;
2023         struct dev_clone_args ap;
2024
2025         if (!clone) {
2026                 for (; (len > 0) && (DEVFS_ISDIGIT(name[len-1])); len--);
2027         }
2028
2029     TAILQ_FOREACH(chandler, &devfs_chandler_list, link) {
2030                 devfs_debug(DEVFS_DEBUG_DEBUG, "len=%d, chandler->namlen=%d\n", len, chandler->namlen);
2031                 devfs_debug(DEVFS_DEBUG_DEBUG, "name=%s, chandler->name=%s\n", name, chandler->name);
2032                 if ((chandler->namlen == len) &&
2033                         (!memcmp(chandler->name, name, len)) &&
2034                         (chandler->nhandler)) {
2035                         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_nclone: found clone handler for the base name at %p\n", chandler->nhandler);
2036                         if (clone) {
2037                                 ap.a_dev = NULL;
2038                                 ap.a_name = name;
2039                                 ap.a_namelen = len;
2040                                 ap.a_cred = cred;
2041                                 error = (chandler->nhandler)(&ap);
2042                                 KKASSERT(devp);
2043                                 *devp = ap.a_dev;
2044                         } else {
2045                                 *namlenp = len;
2046                                 error = 0;
2047                         }
2048
2049                         break;
2050                 }
2051         }
2052
2053         return error;
2054 }
2055
2056
2057 /*
2058  * Registers a new orphan in the orphan list.
2059  */
2060 void
2061 devfs_tracer_add_orphan(struct devfs_node *node)
2062 {
2063         struct devfs_orphan *orphan;
2064
2065         KKASSERT(node);
2066         orphan = kmalloc(sizeof(struct devfs_orphan), M_DEVFS, M_WAITOK);
2067         orphan->node = node;
2068
2069         KKASSERT((node->flags & DEVFS_ORPHANED) == 0);
2070         node->flags |= DEVFS_ORPHANED;
2071         TAILQ_INSERT_TAIL(DEVFS_ORPHANLIST(node->mp), orphan, link);
2072 }
2073
2074 /*
2075  * Removes an orphan from the orphan list.
2076  */
2077 void
2078 devfs_tracer_del_orphan(struct devfs_node *node)
2079 {
2080         struct devfs_orphan *orphan;
2081
2082         KKASSERT(node);
2083
2084         TAILQ_FOREACH(orphan, DEVFS_ORPHANLIST(node->mp), link) {
2085                 if (orphan->node == node) {
2086                         node->flags &= ~DEVFS_ORPHANED;
2087                         TAILQ_REMOVE(DEVFS_ORPHANLIST(node->mp), orphan, link);
2088                         kfree(orphan, M_DEVFS);
2089                         break;
2090                 }
2091         }
2092 }
2093
2094 /*
2095  * Counts the orphans in the orphan list, and if cleanup
2096  * is specified, also frees the orphan and removes it from
2097  * the list.
2098  */
2099 size_t
2100 devfs_tracer_orphan_count(struct mount *mp, int cleanup)
2101 {
2102         struct devfs_orphan *orphan, *orphan2;
2103         size_t count = 0;
2104
2105         TAILQ_FOREACH_MUTABLE(orphan, DEVFS_ORPHANLIST(mp), link, orphan2)      {
2106                 count++;
2107                 if (cleanup) {
2108                         TAILQ_REMOVE(DEVFS_ORPHANLIST(mp), orphan, link);
2109                         orphan->node->flags &= ~DEVFS_ORPHANED;
2110                         devfs_freep(orphan->node);
2111                         kfree(orphan, M_DEVFS);
2112                 }
2113         }
2114
2115         return count;
2116 }
2117
2118 /*
2119  * Fetch an ino_t from the global d_ino by increasing it
2120  * while spinlocked.
2121  */
2122 static ino_t
2123 devfs_fetch_ino(void)
2124 {
2125         ino_t   ret;
2126
2127         spin_lock_wr(&ino_lock);
2128         ret = d_ino++;
2129         spin_unlock_wr(&ino_lock);
2130
2131         return ret;
2132 }
2133
2134 /*
2135  * Allocates a new cdev and initializes it's most basic
2136  * fields.
2137  */
2138 cdev_t
2139 devfs_new_cdev(struct dev_ops *ops, int minor)
2140 {
2141         cdev_t dev = sysref_alloc(&cdev_sysref_class);
2142         sysref_activate(&dev->si_sysref);
2143         reference_dev(dev);
2144         devfs_debug(DEVFS_DEBUG_DEBUG,
2145                     "new_cdev: clearing first %d bytes\n",
2146                     offsetof(struct cdev, si_sysref));
2147         memset(dev, 0, offsetof(struct cdev, si_sysref));
2148
2149         dev->si_uid = 0;
2150         dev->si_gid = 0;
2151         dev->si_perms = 0;
2152         dev->si_drv1 = NULL;
2153         dev->si_drv2 = NULL;
2154         dev->si_lastread = 0;           /* time_second */
2155         dev->si_lastwrite = 0;          /* time_second */
2156
2157         dev->si_ops = ops;
2158         dev->si_flags = SI_HASHED | SI_ADHOC; //XXX: any real use?
2159         dev->si_umajor = 0;
2160         dev->si_uminor = minor;
2161         dev->si_inode = devfs_fetch_ino();
2162
2163         return dev;
2164 }
2165
2166 static void
2167 devfs_cdev_terminate(cdev_t dev)
2168 {
2169         int locked = 0;
2170
2171         /* Check if it is locked already. if not, we acquire the devfs lock */
2172         if (!(lockstatus(&devfs_lock, curthread)) == LK_EXCLUSIVE) {
2173                 lockmgr(&devfs_lock, LK_EXCLUSIVE);
2174                 locked = 1;
2175         }
2176
2177         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_cdev_terminate: Taking care of dev->si_name=%s\n", dev->si_name);
2178
2179         /* Propagate destruction, just in case */
2180         devfs_propagate_dev(dev, 0);
2181
2182         /* If we acquired the lock, we also get rid of it */
2183         if (locked)
2184                 lockmgr(&devfs_lock, LK_RELEASE);
2185
2186         /* Finally destroy the device */
2187         sysref_put(&dev->si_sysref);
2188 }
2189
2190 /*
2191  * Links a given cdev into the dev list.
2192  */
2193 int
2194 devfs_link_dev(cdev_t dev)
2195 {
2196         KKASSERT((dev->si_flags & SI_DEVFS_LINKED) == 0);
2197         dev->si_flags |= SI_DEVFS_LINKED;
2198         TAILQ_INSERT_TAIL(&devfs_dev_list, dev, link);
2199
2200         return 0;
2201 }
2202
2203 /*
2204  * Removes a given cdev from the dev list.  The caller is responsible for
2205  * releasing the reference on the device associated with the linkage.
2206  *
2207  * Returns EALREADY if the dev has already been unlinked.
2208  */
2209 static int
2210 devfs_unlink_dev(cdev_t dev)
2211 {
2212         if ((dev->si_flags & SI_DEVFS_LINKED)) {
2213                 TAILQ_REMOVE(&devfs_dev_list, dev, link);
2214                 dev->si_flags &= ~SI_DEVFS_LINKED;
2215                 return (0);
2216         }
2217         return (EALREADY);
2218 }
2219
2220 void
2221 devfs_config(void *arg)
2222 {
2223         devfs_msg_t msg;
2224
2225         msg = devfs_msg_get();
2226
2227         kprintf("devfs_config: sync'ing up\n");
2228         msg = devfs_msg_send_sync(DEVFS_SYNC, msg);
2229         devfs_msg_put(msg);
2230 }
2231
2232 /*
2233  * Called on init of devfs; creates the objcaches and
2234  * spawns off the devfs core thread. Also initializes
2235  * locks.
2236  */
2237 static void
2238 devfs_init(void)
2239 {
2240         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_init() called\n");
2241         /* Create objcaches for nodes, msgs and devs */
2242     devfs_node_cache = objcache_create("devfs-node-cache", 0, 0,
2243                         NULL, NULL, NULL,
2244                         objcache_malloc_alloc,
2245                         objcache_malloc_free,
2246                         &devfs_node_malloc_args );
2247
2248     devfs_msg_cache = objcache_create("devfs-msg-cache", 0, 0,
2249                         NULL, NULL, NULL,
2250                         objcache_malloc_alloc,
2251                         objcache_malloc_free,
2252                         &devfs_msg_malloc_args );
2253
2254     devfs_dev_cache = objcache_create("devfs-dev-cache", 0, 0,
2255                         NULL, NULL, NULL,
2256                         objcache_malloc_alloc,
2257                         objcache_malloc_free,
2258                         &devfs_dev_malloc_args );
2259
2260         /* Initialize the reply-only port which acts as a message drain */
2261         lwkt_initport_replyonly(&devfs_dispose_port, devfs_msg_autofree_reply);
2262
2263         /* Initialize *THE* devfs lock */
2264         lockinit(&devfs_lock, "devfs_core lock", 0, 0);
2265
2266
2267         lwkt_create(devfs_msg_core, /*args*/NULL, &td_core, NULL,
2268                     0, 0, "devfs_msg_core");
2269
2270         tsleep(td_core/*devfs_id*/, 0, "devfsc", 0);
2271
2272         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_init finished\n");
2273 }
2274
2275 /*
2276  * Called on unload of devfs; takes care of destroying the core
2277  * and the objcaches. Also removes aliases that are no longer needed.
2278  */
2279 static void
2280 devfs_uninit(void)
2281 {
2282         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs_uninit() called\n");
2283
2284         devfs_msg_send(DEVFS_TERMINATE_CORE, NULL);
2285
2286         tsleep(td_core/*devfs_id*/, 0, "devfsc", 0);
2287         tsleep(td_core/*devfs_id*/, 0, "devfsc", 10000);
2288
2289         /* Destroy the objcaches */
2290         objcache_destroy(devfs_msg_cache);
2291         objcache_destroy(devfs_node_cache);
2292         objcache_destroy(devfs_dev_cache);
2293
2294         devfs_alias_reap();
2295 }
2296
2297 /*
2298  * This is a sysctl handler to assist userland devname(3) to
2299  * find the device name for a given udev.
2300  */
2301 static int
2302 devfs_sysctl_devname_helper(SYSCTL_HANDLER_ARGS)
2303 {
2304         udev_t  udev;
2305         cdev_t  found;
2306         int             error;
2307
2308
2309         if ((error = SYSCTL_IN(req, &udev, sizeof(udev_t))))
2310                 return (error);
2311
2312         devfs_debug(DEVFS_DEBUG_DEBUG, "devfs sysctl, received udev: %d\n", udev);
2313
2314         if (udev == NOUDEV)
2315                 return(EINVAL);
2316
2317         if ((found = devfs_find_device_by_udev(udev)) == NULL)
2318                 return(ENOENT);
2319
2320         return(SYSCTL_OUT(req, found->si_name, strlen(found->si_name) + 1));
2321 }
2322
2323
2324 SYSCTL_PROC(_kern, OID_AUTO, devname, CTLTYPE_OPAQUE|CTLFLAG_RW|CTLFLAG_ANYBODY,
2325                         NULL, 0, devfs_sysctl_devname_helper, "", "helper for devname(3)");
2326
2327 static SYSCTL_NODE(_vfs, OID_AUTO, devfs, CTLFLAG_RW, 0, "devfs");
2328 TUNABLE_INT("vfs.devfs.debug", &devfs_debug_enable);
2329 SYSCTL_INT(_vfs_devfs, OID_AUTO, debug, CTLFLAG_RW, &devfs_debug_enable, 0, "Enable DevFS debugging");
2330
2331 SYSINIT(vfs_devfs_register, SI_SUB_PRE_DRIVERS, SI_ORDER_FIRST, devfs_init, NULL);
2332 SYSUNINIT(vfs_devfs_register, SI_SUB_PRE_DRIVERS, SI_ORDER_ANY, devfs_uninit, NULL);