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