xref: /freebsd/sys/compat/linuxkpi/common/src/linux_compat.c (revision 1125dbc04961ccd5f99543a455e44a7e551440ba)
18d59ecb2SHans Petter Selasky /*-
28d59ecb2SHans Petter Selasky  * Copyright (c) 2010 Isilon Systems, Inc.
38d59ecb2SHans Petter Selasky  * Copyright (c) 2010 iX Systems, Inc.
48d59ecb2SHans Petter Selasky  * Copyright (c) 2010 Panasas, Inc.
5e10c4cc0SHans Petter Selasky  * Copyright (c) 2013-2016 Mellanox Technologies, Ltd.
68d59ecb2SHans Petter Selasky  * All rights reserved.
78d59ecb2SHans Petter Selasky  *
88d59ecb2SHans Petter Selasky  * Redistribution and use in source and binary forms, with or without
98d59ecb2SHans Petter Selasky  * modification, are permitted provided that the following conditions
108d59ecb2SHans Petter Selasky  * are met:
118d59ecb2SHans Petter Selasky  * 1. Redistributions of source code must retain the above copyright
128d59ecb2SHans Petter Selasky  *    notice unmodified, this list of conditions, and the following
138d59ecb2SHans Petter Selasky  *    disclaimer.
148d59ecb2SHans Petter Selasky  * 2. Redistributions in binary form must reproduce the above copyright
158d59ecb2SHans Petter Selasky  *    notice, this list of conditions and the following disclaimer in the
168d59ecb2SHans Petter Selasky  *    documentation and/or other materials provided with the distribution.
178d59ecb2SHans Petter Selasky  *
188d59ecb2SHans Petter Selasky  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
198d59ecb2SHans Petter Selasky  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
208d59ecb2SHans Petter Selasky  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
218d59ecb2SHans Petter Selasky  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
228d59ecb2SHans Petter Selasky  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
238d59ecb2SHans Petter Selasky  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
248d59ecb2SHans Petter Selasky  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
258d59ecb2SHans Petter Selasky  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
268d59ecb2SHans Petter Selasky  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
278d59ecb2SHans Petter Selasky  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
288d59ecb2SHans Petter Selasky  */
298d59ecb2SHans Petter Selasky 
308d59ecb2SHans Petter Selasky #include <sys/cdefs.h>
318d59ecb2SHans Petter Selasky __FBSDID("$FreeBSD$");
328d59ecb2SHans Petter Selasky 
338d59ecb2SHans Petter Selasky #include <sys/param.h>
348d59ecb2SHans Petter Selasky #include <sys/systm.h>
358d59ecb2SHans Petter Selasky #include <sys/malloc.h>
368d59ecb2SHans Petter Selasky #include <sys/kernel.h>
378d59ecb2SHans Petter Selasky #include <sys/sysctl.h>
388d59ecb2SHans Petter Selasky #include <sys/proc.h>
398d59ecb2SHans Petter Selasky #include <sys/sglist.h>
408d59ecb2SHans Petter Selasky #include <sys/sleepqueue.h>
418d59ecb2SHans Petter Selasky #include <sys/lock.h>
428d59ecb2SHans Petter Selasky #include <sys/mutex.h>
438d59ecb2SHans Petter Selasky #include <sys/bus.h>
448d59ecb2SHans Petter Selasky #include <sys/fcntl.h>
458d59ecb2SHans Petter Selasky #include <sys/file.h>
468d59ecb2SHans Petter Selasky #include <sys/filio.h>
478d59ecb2SHans Petter Selasky #include <sys/rwlock.h>
488d59ecb2SHans Petter Selasky 
498d59ecb2SHans Petter Selasky #include <vm/vm.h>
508d59ecb2SHans Petter Selasky #include <vm/pmap.h>
518d59ecb2SHans Petter Selasky 
528d59ecb2SHans Petter Selasky #include <machine/stdarg.h>
538d59ecb2SHans Petter Selasky 
5403219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
5503219fbaSHans Petter Selasky #include <machine/md_var.h>
5603219fbaSHans Petter Selasky #endif
5703219fbaSHans Petter Selasky 
588d59ecb2SHans Petter Selasky #include <linux/kobject.h>
598d59ecb2SHans Petter Selasky #include <linux/device.h>
608d59ecb2SHans Petter Selasky #include <linux/slab.h>
618d59ecb2SHans Petter Selasky #include <linux/module.h>
621d9b99e5SHans Petter Selasky #include <linux/moduleparam.h>
638d59ecb2SHans Petter Selasky #include <linux/cdev.h>
648d59ecb2SHans Petter Selasky #include <linux/file.h>
658d59ecb2SHans Petter Selasky #include <linux/sysfs.h>
668d59ecb2SHans Petter Selasky #include <linux/mm.h>
678d59ecb2SHans Petter Selasky #include <linux/io.h>
688d59ecb2SHans Petter Selasky #include <linux/vmalloc.h>
698d59ecb2SHans Petter Selasky #include <linux/netdevice.h>
708d59ecb2SHans Petter Selasky #include <linux/timer.h>
7155d445d3SHans Petter Selasky #include <linux/workqueue.h>
72e10c4cc0SHans Petter Selasky #include <linux/rcupdate.h>
730c510167SHans Petter Selasky #include <linux/interrupt.h>
743a8bec33SHans Petter Selasky #include <linux/uaccess.h>
7503219fbaSHans Petter Selasky #include <linux/kernel.h>
76aad02fb4SHans Petter Selasky #include <linux/list.h>
773ce12630SHans Petter Selasky #include <linux/compat.h>
788d59ecb2SHans Petter Selasky 
798d59ecb2SHans Petter Selasky #include <vm/vm_pager.h>
808d59ecb2SHans Petter Selasky 
811d9b99e5SHans Petter Selasky SYSCTL_NODE(_compat, OID_AUTO, linuxkpi, CTLFLAG_RW, 0, "LinuxKPI parameters");
821d9b99e5SHans Petter Selasky 
838d59ecb2SHans Petter Selasky MALLOC_DEFINE(M_KMALLOC, "linux", "Linux kmalloc compat");
848d59ecb2SHans Petter Selasky 
858d59ecb2SHans Petter Selasky #include <linux/rbtree.h>
868d59ecb2SHans Petter Selasky /* Undo Linux compat changes. */
878d59ecb2SHans Petter Selasky #undef RB_ROOT
888d59ecb2SHans Petter Selasky #undef file
898d59ecb2SHans Petter Selasky #undef cdev
908d59ecb2SHans Petter Selasky #define	RB_ROOT(head)	(head)->rbh_root
918d59ecb2SHans Petter Selasky 
9206204f8eSHans Petter Selasky struct kobject linux_class_root;
9306204f8eSHans Petter Selasky struct device linux_root_device;
9406204f8eSHans Petter Selasky struct class linux_class_misc;
958d59ecb2SHans Petter Selasky struct list_head pci_drivers;
968d59ecb2SHans Petter Selasky struct list_head pci_devices;
978d59ecb2SHans Petter Selasky struct net init_net;
988d59ecb2SHans Petter Selasky spinlock_t pci_lock;
99e10c4cc0SHans Petter Selasky struct sx linux_global_rcu_lock;
1008d59ecb2SHans Petter Selasky 
1018d59ecb2SHans Petter Selasky unsigned long linux_timer_hz_mask;
1028d59ecb2SHans Petter Selasky 
1038d59ecb2SHans Petter Selasky int
1048d59ecb2SHans Petter Selasky panic_cmp(struct rb_node *one, struct rb_node *two)
1058d59ecb2SHans Petter Selasky {
1068d59ecb2SHans Petter Selasky 	panic("no cmp");
1078d59ecb2SHans Petter Selasky }
1088d59ecb2SHans Petter Selasky 
1098d59ecb2SHans Petter Selasky RB_GENERATE(linux_root, rb_node, __entry, panic_cmp);
1108d59ecb2SHans Petter Selasky 
11126019405SHans Petter Selasky int
11226019405SHans Petter Selasky kobject_set_name_vargs(struct kobject *kobj, const char *fmt, va_list args)
11326019405SHans Petter Selasky {
11426019405SHans Petter Selasky 	va_list tmp_va;
11526019405SHans Petter Selasky 	int len;
11626019405SHans Petter Selasky 	char *old;
11726019405SHans Petter Selasky 	char *name;
11826019405SHans Petter Selasky 	char dummy;
11926019405SHans Petter Selasky 
12026019405SHans Petter Selasky 	old = kobj->name;
12126019405SHans Petter Selasky 
12226019405SHans Petter Selasky 	if (old && fmt == NULL)
12326019405SHans Petter Selasky 		return (0);
12426019405SHans Petter Selasky 
12526019405SHans Petter Selasky 	/* compute length of string */
12626019405SHans Petter Selasky 	va_copy(tmp_va, args);
12726019405SHans Petter Selasky 	len = vsnprintf(&dummy, 0, fmt, tmp_va);
12826019405SHans Petter Selasky 	va_end(tmp_va);
12926019405SHans Petter Selasky 
13026019405SHans Petter Selasky 	/* account for zero termination */
13126019405SHans Petter Selasky 	len++;
13226019405SHans Petter Selasky 
13326019405SHans Petter Selasky 	/* check for error */
13426019405SHans Petter Selasky 	if (len < 1)
13526019405SHans Petter Selasky 		return (-EINVAL);
13626019405SHans Petter Selasky 
13726019405SHans Petter Selasky 	/* allocate memory for string */
13826019405SHans Petter Selasky 	name = kzalloc(len, GFP_KERNEL);
13926019405SHans Petter Selasky 	if (name == NULL)
14026019405SHans Petter Selasky 		return (-ENOMEM);
14126019405SHans Petter Selasky 	vsnprintf(name, len, fmt, args);
14226019405SHans Petter Selasky 	kobj->name = name;
14326019405SHans Petter Selasky 
14426019405SHans Petter Selasky 	/* free old string */
14526019405SHans Petter Selasky 	kfree(old);
14626019405SHans Petter Selasky 
14726019405SHans Petter Selasky 	/* filter new string */
14826019405SHans Petter Selasky 	for (; *name != '\0'; name++)
14926019405SHans Petter Selasky 		if (*name == '/')
15026019405SHans Petter Selasky 			*name = '!';
15126019405SHans Petter Selasky 	return (0);
15226019405SHans Petter Selasky }
15326019405SHans Petter Selasky 
1548d59ecb2SHans Petter Selasky int
1558d59ecb2SHans Petter Selasky kobject_set_name(struct kobject *kobj, const char *fmt, ...)
1568d59ecb2SHans Petter Selasky {
1578d59ecb2SHans Petter Selasky 	va_list args;
1588d59ecb2SHans Petter Selasky 	int error;
1598d59ecb2SHans Petter Selasky 
1608d59ecb2SHans Petter Selasky 	va_start(args, fmt);
1618d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
1628d59ecb2SHans Petter Selasky 	va_end(args);
1638d59ecb2SHans Petter Selasky 
1648d59ecb2SHans Petter Selasky 	return (error);
1658d59ecb2SHans Petter Selasky }
1668d59ecb2SHans Petter Selasky 
16706204f8eSHans Petter Selasky static int
1688d59ecb2SHans Petter Selasky kobject_add_complete(struct kobject *kobj, struct kobject *parent)
1698d59ecb2SHans Petter Selasky {
17006204f8eSHans Petter Selasky 	const struct kobj_type *t;
1718d59ecb2SHans Petter Selasky 	int error;
1728d59ecb2SHans Petter Selasky 
173337cb9f0SHans Petter Selasky 	kobj->parent = parent;
1748d59ecb2SHans Petter Selasky 	error = sysfs_create_dir(kobj);
1758d59ecb2SHans Petter Selasky 	if (error == 0 && kobj->ktype && kobj->ktype->default_attrs) {
1768d59ecb2SHans Petter Selasky 		struct attribute **attr;
1778d59ecb2SHans Petter Selasky 		t = kobj->ktype;
1788d59ecb2SHans Petter Selasky 
1798d59ecb2SHans Petter Selasky 		for (attr = t->default_attrs; *attr != NULL; attr++) {
1808d59ecb2SHans Petter Selasky 			error = sysfs_create_file(kobj, *attr);
1818d59ecb2SHans Petter Selasky 			if (error)
1828d59ecb2SHans Petter Selasky 				break;
1838d59ecb2SHans Petter Selasky 		}
1848d59ecb2SHans Petter Selasky 		if (error)
1858d59ecb2SHans Petter Selasky 			sysfs_remove_dir(kobj);
1868d59ecb2SHans Petter Selasky 
1878d59ecb2SHans Petter Selasky 	}
1888d59ecb2SHans Petter Selasky 	return (error);
1898d59ecb2SHans Petter Selasky }
1908d59ecb2SHans Petter Selasky 
1918d59ecb2SHans Petter Selasky int
1928d59ecb2SHans Petter Selasky kobject_add(struct kobject *kobj, struct kobject *parent, const char *fmt, ...)
1938d59ecb2SHans Petter Selasky {
1948d59ecb2SHans Petter Selasky 	va_list args;
1958d59ecb2SHans Petter Selasky 	int error;
1968d59ecb2SHans Petter Selasky 
1978d59ecb2SHans Petter Selasky 	va_start(args, fmt);
1988d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
1998d59ecb2SHans Petter Selasky 	va_end(args);
2008d59ecb2SHans Petter Selasky 	if (error)
2018d59ecb2SHans Petter Selasky 		return (error);
2028d59ecb2SHans Petter Selasky 
2038d59ecb2SHans Petter Selasky 	return kobject_add_complete(kobj, parent);
2048d59ecb2SHans Petter Selasky }
2058d59ecb2SHans Petter Selasky 
2068d59ecb2SHans Petter Selasky void
20706204f8eSHans Petter Selasky linux_kobject_release(struct kref *kref)
2088d59ecb2SHans Petter Selasky {
2098d59ecb2SHans Petter Selasky 	struct kobject *kobj;
2108d59ecb2SHans Petter Selasky 	char *name;
2118d59ecb2SHans Petter Selasky 
2128d59ecb2SHans Petter Selasky 	kobj = container_of(kref, struct kobject, kref);
2138d59ecb2SHans Petter Selasky 	sysfs_remove_dir(kobj);
2148d59ecb2SHans Petter Selasky 	name = kobj->name;
2158d59ecb2SHans Petter Selasky 	if (kobj->ktype && kobj->ktype->release)
2168d59ecb2SHans Petter Selasky 		kobj->ktype->release(kobj);
2178d59ecb2SHans Petter Selasky 	kfree(name);
2188d59ecb2SHans Petter Selasky }
2198d59ecb2SHans Petter Selasky 
2208d59ecb2SHans Petter Selasky static void
22106204f8eSHans Petter Selasky linux_kobject_kfree(struct kobject *kobj)
2228d59ecb2SHans Petter Selasky {
2238d59ecb2SHans Petter Selasky 	kfree(kobj);
2248d59ecb2SHans Petter Selasky }
2258d59ecb2SHans Petter Selasky 
2268d59ecb2SHans Petter Selasky static void
22706204f8eSHans Petter Selasky linux_kobject_kfree_name(struct kobject *kobj)
2288d59ecb2SHans Petter Selasky {
2298d59ecb2SHans Petter Selasky 	if (kobj) {
2308d59ecb2SHans Petter Selasky 		kfree(kobj->name);
2318d59ecb2SHans Petter Selasky 	}
2328d59ecb2SHans Petter Selasky }
2338d59ecb2SHans Petter Selasky 
23406204f8eSHans Petter Selasky const struct kobj_type linux_kfree_type = {
23506204f8eSHans Petter Selasky 	.release = linux_kobject_kfree
23606204f8eSHans Petter Selasky };
2378d59ecb2SHans Petter Selasky 
2388d59ecb2SHans Petter Selasky static void
23906204f8eSHans Petter Selasky linux_device_release(struct device *dev)
2408d59ecb2SHans Petter Selasky {
24106204f8eSHans Petter Selasky 	pr_debug("linux_device_release: %s\n", dev_name(dev));
2428d59ecb2SHans Petter Selasky 	kfree(dev);
2438d59ecb2SHans Petter Selasky }
2448d59ecb2SHans Petter Selasky 
24506204f8eSHans Petter Selasky static ssize_t
24606204f8eSHans Petter Selasky linux_class_show(struct kobject *kobj, struct attribute *attr, char *buf)
24706204f8eSHans Petter Selasky {
24806204f8eSHans Petter Selasky 	struct class_attribute *dattr;
24906204f8eSHans Petter Selasky 	ssize_t error;
25006204f8eSHans Petter Selasky 
25106204f8eSHans Petter Selasky 	dattr = container_of(attr, struct class_attribute, attr);
25206204f8eSHans Petter Selasky 	error = -EIO;
25306204f8eSHans Petter Selasky 	if (dattr->show)
25406204f8eSHans Petter Selasky 		error = dattr->show(container_of(kobj, struct class, kobj),
25506204f8eSHans Petter Selasky 		    dattr, buf);
25606204f8eSHans Petter Selasky 	return (error);
25706204f8eSHans Petter Selasky }
25806204f8eSHans Petter Selasky 
25906204f8eSHans Petter Selasky static ssize_t
26006204f8eSHans Petter Selasky linux_class_store(struct kobject *kobj, struct attribute *attr, const char *buf,
26106204f8eSHans Petter Selasky     size_t count)
26206204f8eSHans Petter Selasky {
26306204f8eSHans Petter Selasky 	struct class_attribute *dattr;
26406204f8eSHans Petter Selasky 	ssize_t error;
26506204f8eSHans Petter Selasky 
26606204f8eSHans Petter Selasky 	dattr = container_of(attr, struct class_attribute, attr);
26706204f8eSHans Petter Selasky 	error = -EIO;
26806204f8eSHans Petter Selasky 	if (dattr->store)
26906204f8eSHans Petter Selasky 		error = dattr->store(container_of(kobj, struct class, kobj),
27006204f8eSHans Petter Selasky 		    dattr, buf, count);
27106204f8eSHans Petter Selasky 	return (error);
27206204f8eSHans Petter Selasky }
27306204f8eSHans Petter Selasky 
27406204f8eSHans Petter Selasky static void
27506204f8eSHans Petter Selasky linux_class_release(struct kobject *kobj)
27606204f8eSHans Petter Selasky {
27706204f8eSHans Petter Selasky 	struct class *class;
27806204f8eSHans Petter Selasky 
27906204f8eSHans Petter Selasky 	class = container_of(kobj, struct class, kobj);
28006204f8eSHans Petter Selasky 	if (class->class_release)
28106204f8eSHans Petter Selasky 		class->class_release(class);
28206204f8eSHans Petter Selasky }
28306204f8eSHans Petter Selasky 
28406204f8eSHans Petter Selasky static const struct sysfs_ops linux_class_sysfs = {
28506204f8eSHans Petter Selasky 	.show  = linux_class_show,
28606204f8eSHans Petter Selasky 	.store = linux_class_store,
28706204f8eSHans Petter Selasky };
28806204f8eSHans Petter Selasky 
28906204f8eSHans Petter Selasky const struct kobj_type linux_class_ktype = {
29006204f8eSHans Petter Selasky 	.release = linux_class_release,
29106204f8eSHans Petter Selasky 	.sysfs_ops = &linux_class_sysfs
29206204f8eSHans Petter Selasky };
29306204f8eSHans Petter Selasky 
29406204f8eSHans Petter Selasky static void
29506204f8eSHans Petter Selasky linux_dev_release(struct kobject *kobj)
29606204f8eSHans Petter Selasky {
29706204f8eSHans Petter Selasky 	struct device *dev;
29806204f8eSHans Petter Selasky 
29906204f8eSHans Petter Selasky 	dev = container_of(kobj, struct device, kobj);
30006204f8eSHans Petter Selasky 	/* This is the precedence defined by linux. */
30106204f8eSHans Petter Selasky 	if (dev->release)
30206204f8eSHans Petter Selasky 		dev->release(dev);
30306204f8eSHans Petter Selasky 	else if (dev->class && dev->class->dev_release)
30406204f8eSHans Petter Selasky 		dev->class->dev_release(dev);
30506204f8eSHans Petter Selasky }
30606204f8eSHans Petter Selasky 
30706204f8eSHans Petter Selasky static ssize_t
30806204f8eSHans Petter Selasky linux_dev_show(struct kobject *kobj, struct attribute *attr, char *buf)
30906204f8eSHans Petter Selasky {
31006204f8eSHans Petter Selasky 	struct device_attribute *dattr;
31106204f8eSHans Petter Selasky 	ssize_t error;
31206204f8eSHans Petter Selasky 
31306204f8eSHans Petter Selasky 	dattr = container_of(attr, struct device_attribute, attr);
31406204f8eSHans Petter Selasky 	error = -EIO;
31506204f8eSHans Petter Selasky 	if (dattr->show)
31606204f8eSHans Petter Selasky 		error = dattr->show(container_of(kobj, struct device, kobj),
31706204f8eSHans Petter Selasky 		    dattr, buf);
31806204f8eSHans Petter Selasky 	return (error);
31906204f8eSHans Petter Selasky }
32006204f8eSHans Petter Selasky 
32106204f8eSHans Petter Selasky static ssize_t
32206204f8eSHans Petter Selasky linux_dev_store(struct kobject *kobj, struct attribute *attr, const char *buf,
32306204f8eSHans Petter Selasky     size_t count)
32406204f8eSHans Petter Selasky {
32506204f8eSHans Petter Selasky 	struct device_attribute *dattr;
32606204f8eSHans Petter Selasky 	ssize_t error;
32706204f8eSHans Petter Selasky 
32806204f8eSHans Petter Selasky 	dattr = container_of(attr, struct device_attribute, attr);
32906204f8eSHans Petter Selasky 	error = -EIO;
33006204f8eSHans Petter Selasky 	if (dattr->store)
33106204f8eSHans Petter Selasky 		error = dattr->store(container_of(kobj, struct device, kobj),
33206204f8eSHans Petter Selasky 		    dattr, buf, count);
33306204f8eSHans Petter Selasky 	return (error);
33406204f8eSHans Petter Selasky }
33506204f8eSHans Petter Selasky 
33606204f8eSHans Petter Selasky static const struct sysfs_ops linux_dev_sysfs = {
33706204f8eSHans Petter Selasky 	.show  = linux_dev_show,
33806204f8eSHans Petter Selasky 	.store = linux_dev_store,
33906204f8eSHans Petter Selasky };
34006204f8eSHans Petter Selasky 
34106204f8eSHans Petter Selasky const struct kobj_type linux_dev_ktype = {
34206204f8eSHans Petter Selasky 	.release = linux_dev_release,
34306204f8eSHans Petter Selasky 	.sysfs_ops = &linux_dev_sysfs
34406204f8eSHans Petter Selasky };
34506204f8eSHans Petter Selasky 
3468d59ecb2SHans Petter Selasky struct device *
3478d59ecb2SHans Petter Selasky device_create(struct class *class, struct device *parent, dev_t devt,
3488d59ecb2SHans Petter Selasky     void *drvdata, const char *fmt, ...)
3498d59ecb2SHans Petter Selasky {
3508d59ecb2SHans Petter Selasky 	struct device *dev;
3518d59ecb2SHans Petter Selasky 	va_list args;
3528d59ecb2SHans Petter Selasky 
3538d59ecb2SHans Petter Selasky 	dev = kzalloc(sizeof(*dev), M_WAITOK);
3548d59ecb2SHans Petter Selasky 	dev->parent = parent;
3558d59ecb2SHans Petter Selasky 	dev->class = class;
3568d59ecb2SHans Petter Selasky 	dev->devt = devt;
3578d59ecb2SHans Petter Selasky 	dev->driver_data = drvdata;
35806204f8eSHans Petter Selasky 	dev->release = linux_device_release;
3598d59ecb2SHans Petter Selasky 	va_start(args, fmt);
3608d59ecb2SHans Petter Selasky 	kobject_set_name_vargs(&dev->kobj, fmt, args);
3618d59ecb2SHans Petter Selasky 	va_end(args);
3628d59ecb2SHans Petter Selasky 	device_register(dev);
3638d59ecb2SHans Petter Selasky 
3648d59ecb2SHans Petter Selasky 	return (dev);
3658d59ecb2SHans Petter Selasky }
3668d59ecb2SHans Petter Selasky 
3678d59ecb2SHans Petter Selasky int
36806204f8eSHans Petter Selasky kobject_init_and_add(struct kobject *kobj, const struct kobj_type *ktype,
3698d59ecb2SHans Petter Selasky     struct kobject *parent, const char *fmt, ...)
3708d59ecb2SHans Petter Selasky {
3718d59ecb2SHans Petter Selasky 	va_list args;
3728d59ecb2SHans Petter Selasky 	int error;
3738d59ecb2SHans Petter Selasky 
3748d59ecb2SHans Petter Selasky 	kobject_init(kobj, ktype);
3758d59ecb2SHans Petter Selasky 	kobj->ktype = ktype;
3768d59ecb2SHans Petter Selasky 	kobj->parent = parent;
3778d59ecb2SHans Petter Selasky 	kobj->name = NULL;
3788d59ecb2SHans Petter Selasky 
3798d59ecb2SHans Petter Selasky 	va_start(args, fmt);
3808d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
3818d59ecb2SHans Petter Selasky 	va_end(args);
3828d59ecb2SHans Petter Selasky 	if (error)
3838d59ecb2SHans Petter Selasky 		return (error);
3848d59ecb2SHans Petter Selasky 	return kobject_add_complete(kobj, parent);
3858d59ecb2SHans Petter Selasky }
3868d59ecb2SHans Petter Selasky 
3873ce12630SHans Petter Selasky void
388464d20bcSHans Petter Selasky linux_set_current(struct thread *td, struct task_struct *t)
389464d20bcSHans Petter Selasky {
390464d20bcSHans Petter Selasky 	memset(t, 0, sizeof(*t));
391464d20bcSHans Petter Selasky 	task_struct_fill(td, t);
392464d20bcSHans Petter Selasky 	task_struct_set(td, t);
393464d20bcSHans Petter Selasky }
394464d20bcSHans Petter Selasky 
3953ce12630SHans Petter Selasky void
396464d20bcSHans Petter Selasky linux_clear_current(struct thread *td)
397464d20bcSHans Petter Selasky {
398464d20bcSHans Petter Selasky 	task_struct_set(td, NULL);
399464d20bcSHans Petter Selasky }
400464d20bcSHans Petter Selasky 
401464d20bcSHans Petter Selasky static void
4028d59ecb2SHans Petter Selasky linux_file_dtor(void *cdp)
4038d59ecb2SHans Petter Selasky {
4048d59ecb2SHans Petter Selasky 	struct linux_file *filp;
405464d20bcSHans Petter Selasky 	struct task_struct t;
406464d20bcSHans Petter Selasky 	struct thread *td;
4078d59ecb2SHans Petter Selasky 
408464d20bcSHans Petter Selasky 	td = curthread;
4098d59ecb2SHans Petter Selasky 	filp = cdp;
410464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
4118d59ecb2SHans Petter Selasky 	filp->f_op->release(filp->f_vnode, filp);
412464d20bcSHans Petter Selasky 	linux_clear_current(td);
4138d59ecb2SHans Petter Selasky 	vdrop(filp->f_vnode);
4148d59ecb2SHans Petter Selasky 	kfree(filp);
4158d59ecb2SHans Petter Selasky }
4168d59ecb2SHans Petter Selasky 
4178d59ecb2SHans Petter Selasky static int
4188d59ecb2SHans Petter Selasky linux_dev_open(struct cdev *dev, int oflags, int devtype, struct thread *td)
4198d59ecb2SHans Petter Selasky {
4208d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
4218d59ecb2SHans Petter Selasky 	struct linux_file *filp;
422464d20bcSHans Petter Selasky 	struct task_struct t;
4238d59ecb2SHans Petter Selasky 	struct file *file;
4248d59ecb2SHans Petter Selasky 	int error;
4258d59ecb2SHans Petter Selasky 
426464d20bcSHans Petter Selasky 	file = td->td_fpop;
4278d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
4288d59ecb2SHans Petter Selasky 	if (ldev == NULL)
4298d59ecb2SHans Petter Selasky 		return (ENODEV);
4308d59ecb2SHans Petter Selasky 	filp = kzalloc(sizeof(*filp), GFP_KERNEL);
4318d59ecb2SHans Petter Selasky 	filp->f_dentry = &filp->f_dentry_store;
4328d59ecb2SHans Petter Selasky 	filp->f_op = ldev->ops;
4338d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
4348d59ecb2SHans Petter Selasky 	vhold(file->f_vnode);
4358d59ecb2SHans Petter Selasky 	filp->f_vnode = file->f_vnode;
436464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
4378d59ecb2SHans Petter Selasky 	if (filp->f_op->open) {
4388d59ecb2SHans Petter Selasky 		error = -filp->f_op->open(file->f_vnode, filp);
4398d59ecb2SHans Petter Selasky 		if (error) {
4408d59ecb2SHans Petter Selasky 			kfree(filp);
441464d20bcSHans Petter Selasky 			goto done;
4428d59ecb2SHans Petter Selasky 		}
4438d59ecb2SHans Petter Selasky 	}
4448d59ecb2SHans Petter Selasky 	error = devfs_set_cdevpriv(filp, linux_file_dtor);
4458d59ecb2SHans Petter Selasky 	if (error) {
4468d59ecb2SHans Petter Selasky 		filp->f_op->release(file->f_vnode, filp);
4478d59ecb2SHans Petter Selasky 		kfree(filp);
4488d59ecb2SHans Petter Selasky 	}
449464d20bcSHans Petter Selasky done:
450464d20bcSHans Petter Selasky 	linux_clear_current(td);
451464d20bcSHans Petter Selasky 	return (error);
4528d59ecb2SHans Petter Selasky }
4538d59ecb2SHans Petter Selasky 
4548d59ecb2SHans Petter Selasky static int
4558d59ecb2SHans Petter Selasky linux_dev_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
4568d59ecb2SHans Petter Selasky {
4578d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
4588d59ecb2SHans Petter Selasky 	struct linux_file *filp;
4598d59ecb2SHans Petter Selasky 	struct file *file;
4608d59ecb2SHans Petter Selasky 	int error;
4618d59ecb2SHans Petter Selasky 
462464d20bcSHans Petter Selasky 	file = td->td_fpop;
4638d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
4648d59ecb2SHans Petter Selasky 	if (ldev == NULL)
4658d59ecb2SHans Petter Selasky 		return (0);
4668d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
4678d59ecb2SHans Petter Selasky 		return (error);
4688d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
4698d59ecb2SHans Petter Selasky         devfs_clear_cdevpriv();
4708d59ecb2SHans Petter Selasky 
4718d59ecb2SHans Petter Selasky 
4728d59ecb2SHans Petter Selasky 	return (0);
4738d59ecb2SHans Petter Selasky }
4748d59ecb2SHans Petter Selasky 
4753a8bec33SHans Petter Selasky #define	LINUX_IOCTL_MIN_PTR 0x10000UL
4763a8bec33SHans Petter Selasky #define	LINUX_IOCTL_MAX_PTR (LINUX_IOCTL_MIN_PTR + IOCPARM_MAX)
4773a8bec33SHans Petter Selasky 
4783a8bec33SHans Petter Selasky static inline int
4793a8bec33SHans Petter Selasky linux_remap_address(void **uaddr, size_t len)
4803a8bec33SHans Petter Selasky {
4813a8bec33SHans Petter Selasky 	uintptr_t uaddr_val = (uintptr_t)(*uaddr);
4823a8bec33SHans Petter Selasky 
4833a8bec33SHans Petter Selasky 	if (unlikely(uaddr_val >= LINUX_IOCTL_MIN_PTR &&
4843a8bec33SHans Petter Selasky 	    uaddr_val < LINUX_IOCTL_MAX_PTR)) {
4853a8bec33SHans Petter Selasky 		struct task_struct *pts = current;
4863a8bec33SHans Petter Selasky 		if (pts == NULL) {
4873a8bec33SHans Petter Selasky 			*uaddr = NULL;
4883a8bec33SHans Petter Selasky 			return (1);
4893a8bec33SHans Petter Selasky 		}
4903a8bec33SHans Petter Selasky 
4913a8bec33SHans Petter Selasky 		/* compute data offset */
4923a8bec33SHans Petter Selasky 		uaddr_val -= LINUX_IOCTL_MIN_PTR;
4933a8bec33SHans Petter Selasky 
4943a8bec33SHans Petter Selasky 		/* check that length is within bounds */
4953a8bec33SHans Petter Selasky 		if ((len > IOCPARM_MAX) ||
4963a8bec33SHans Petter Selasky 		    (uaddr_val + len) > pts->bsd_ioctl_len) {
4973a8bec33SHans Petter Selasky 			*uaddr = NULL;
4983a8bec33SHans Petter Selasky 			return (1);
4993a8bec33SHans Petter Selasky 		}
5003a8bec33SHans Petter Selasky 
5013a8bec33SHans Petter Selasky 		/* re-add kernel buffer address */
5023a8bec33SHans Petter Selasky 		uaddr_val += (uintptr_t)pts->bsd_ioctl_data;
5033a8bec33SHans Petter Selasky 
5043a8bec33SHans Petter Selasky 		/* update address location */
5053a8bec33SHans Petter Selasky 		*uaddr = (void *)uaddr_val;
5063a8bec33SHans Petter Selasky 		return (1);
5073a8bec33SHans Petter Selasky 	}
5083a8bec33SHans Petter Selasky 	return (0);
5093a8bec33SHans Petter Selasky }
5103a8bec33SHans Petter Selasky 
5113a8bec33SHans Petter Selasky int
5123a8bec33SHans Petter Selasky linux_copyin(const void *uaddr, void *kaddr, size_t len)
5133a8bec33SHans Petter Selasky {
5143a8bec33SHans Petter Selasky 	if (linux_remap_address(__DECONST(void **, &uaddr), len)) {
5153a8bec33SHans Petter Selasky 		if (uaddr == NULL)
5163a8bec33SHans Petter Selasky 			return (-EFAULT);
5173a8bec33SHans Petter Selasky 		memcpy(kaddr, uaddr, len);
5183a8bec33SHans Petter Selasky 		return (0);
5193a8bec33SHans Petter Selasky 	}
5203a8bec33SHans Petter Selasky 	return (-copyin(uaddr, kaddr, len));
5213a8bec33SHans Petter Selasky }
5223a8bec33SHans Petter Selasky 
5233a8bec33SHans Petter Selasky int
5243a8bec33SHans Petter Selasky linux_copyout(const void *kaddr, void *uaddr, size_t len)
5253a8bec33SHans Petter Selasky {
5263a8bec33SHans Petter Selasky 	if (linux_remap_address(&uaddr, len)) {
5273a8bec33SHans Petter Selasky 		if (uaddr == NULL)
5283a8bec33SHans Petter Selasky 			return (-EFAULT);
5293a8bec33SHans Petter Selasky 		memcpy(uaddr, kaddr, len);
5303a8bec33SHans Petter Selasky 		return (0);
5313a8bec33SHans Petter Selasky 	}
5323a8bec33SHans Petter Selasky 	return (-copyout(kaddr, uaddr, len));
5333a8bec33SHans Petter Selasky }
5343a8bec33SHans Petter Selasky 
5358d59ecb2SHans Petter Selasky static int
5368d59ecb2SHans Petter Selasky linux_dev_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag,
5378d59ecb2SHans Petter Selasky     struct thread *td)
5388d59ecb2SHans Petter Selasky {
5398d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
5408d59ecb2SHans Petter Selasky 	struct linux_file *filp;
541464d20bcSHans Petter Selasky 	struct task_struct t;
5428d59ecb2SHans Petter Selasky 	struct file *file;
5433a8bec33SHans Petter Selasky 	unsigned size;
5448d59ecb2SHans Petter Selasky 	int error;
5458d59ecb2SHans Petter Selasky 
546464d20bcSHans Petter Selasky 	file = td->td_fpop;
5478d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
5488d59ecb2SHans Petter Selasky 	if (ldev == NULL)
5498d59ecb2SHans Petter Selasky 		return (0);
5508d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
5518d59ecb2SHans Petter Selasky 		return (error);
5528d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
553464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
5543a8bec33SHans Petter Selasky 	size = IOCPARM_LEN(cmd);
5553a8bec33SHans Petter Selasky 	/* refer to logic in sys_ioctl() */
5563a8bec33SHans Petter Selasky 	if (size > 0) {
5578d59ecb2SHans Petter Selasky 		/*
5583a8bec33SHans Petter Selasky 		 * Setup hint for linux_copyin() and linux_copyout().
5593a8bec33SHans Petter Selasky 		 *
5603a8bec33SHans Petter Selasky 		 * Background: Linux code expects a user-space address
5613a8bec33SHans Petter Selasky 		 * while FreeBSD supplies a kernel-space address.
5628d59ecb2SHans Petter Selasky 		 */
5633a8bec33SHans Petter Selasky 		t.bsd_ioctl_data = data;
5643a8bec33SHans Petter Selasky 		t.bsd_ioctl_len = size;
5653a8bec33SHans Petter Selasky 		data = (void *)LINUX_IOCTL_MIN_PTR;
5663a8bec33SHans Petter Selasky 	} else {
5673a8bec33SHans Petter Selasky 		/* fetch user-space pointer */
5688d59ecb2SHans Petter Selasky 		data = *(void **)data;
5693a8bec33SHans Petter Selasky 	}
5708d59ecb2SHans Petter Selasky 	if (filp->f_op->unlocked_ioctl)
5718d59ecb2SHans Petter Selasky 		error = -filp->f_op->unlocked_ioctl(filp, cmd, (u_long)data);
5728d59ecb2SHans Petter Selasky 	else
5738d59ecb2SHans Petter Selasky 		error = ENOTTY;
574464d20bcSHans Petter Selasky 	linux_clear_current(td);
5758d59ecb2SHans Petter Selasky 
5768d59ecb2SHans Petter Selasky 	return (error);
5778d59ecb2SHans Petter Selasky }
5788d59ecb2SHans Petter Selasky 
5798d59ecb2SHans Petter Selasky static int
5808d59ecb2SHans Petter Selasky linux_dev_read(struct cdev *dev, struct uio *uio, int ioflag)
5818d59ecb2SHans Petter Selasky {
5828d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
5838d59ecb2SHans Petter Selasky 	struct linux_file *filp;
584464d20bcSHans Petter Selasky 	struct task_struct t;
585464d20bcSHans Petter Selasky 	struct thread *td;
5868d59ecb2SHans Petter Selasky 	struct file *file;
5878d59ecb2SHans Petter Selasky 	ssize_t bytes;
5888d59ecb2SHans Petter Selasky 	int error;
5898d59ecb2SHans Petter Selasky 
590464d20bcSHans Petter Selasky 	td = curthread;
591464d20bcSHans Petter Selasky 	file = td->td_fpop;
5928d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
5938d59ecb2SHans Petter Selasky 	if (ldev == NULL)
5948d59ecb2SHans Petter Selasky 		return (0);
5958d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
5968d59ecb2SHans Petter Selasky 		return (error);
5978d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
598b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
5998d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
600b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
601464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
6028d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
6038d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
6048d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
6058d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
6068d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
6078d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
6088d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
6098d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
6108d59ecb2SHans Petter Selasky 		} else
6118d59ecb2SHans Petter Selasky 			error = -bytes;
6128d59ecb2SHans Petter Selasky 	} else
6138d59ecb2SHans Petter Selasky 		error = ENXIO;
614464d20bcSHans Petter Selasky 	linux_clear_current(td);
6158d59ecb2SHans Petter Selasky 
6168d59ecb2SHans Petter Selasky 	return (error);
6178d59ecb2SHans Petter Selasky }
6188d59ecb2SHans Petter Selasky 
6198d59ecb2SHans Petter Selasky static int
6208d59ecb2SHans Petter Selasky linux_dev_write(struct cdev *dev, struct uio *uio, int ioflag)
6218d59ecb2SHans Petter Selasky {
6228d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
6238d59ecb2SHans Petter Selasky 	struct linux_file *filp;
624464d20bcSHans Petter Selasky 	struct task_struct t;
625464d20bcSHans Petter Selasky 	struct thread *td;
6268d59ecb2SHans Petter Selasky 	struct file *file;
6278d59ecb2SHans Petter Selasky 	ssize_t bytes;
6288d59ecb2SHans Petter Selasky 	int error;
6298d59ecb2SHans Petter Selasky 
630464d20bcSHans Petter Selasky 	td = curthread;
631464d20bcSHans Petter Selasky 	file = td->td_fpop;
6328d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
6338d59ecb2SHans Petter Selasky 	if (ldev == NULL)
6348d59ecb2SHans Petter Selasky 		return (0);
6358d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
6368d59ecb2SHans Petter Selasky 		return (error);
6378d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
638b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
6398d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
640b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
641464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
6428d59ecb2SHans Petter Selasky 	if (filp->f_op->write) {
6438d59ecb2SHans Petter Selasky 		bytes = filp->f_op->write(filp, uio->uio_iov->iov_base,
6448d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
6458d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
6468d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
6478d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
6488d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
6498d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
6508d59ecb2SHans Petter Selasky 		} else
6518d59ecb2SHans Petter Selasky 			error = -bytes;
6528d59ecb2SHans Petter Selasky 	} else
6538d59ecb2SHans Petter Selasky 		error = ENXIO;
654464d20bcSHans Petter Selasky 	linux_clear_current(td);
6558d59ecb2SHans Petter Selasky 
6568d59ecb2SHans Petter Selasky 	return (error);
6578d59ecb2SHans Petter Selasky }
6588d59ecb2SHans Petter Selasky 
6598d59ecb2SHans Petter Selasky static int
6608d59ecb2SHans Petter Selasky linux_dev_poll(struct cdev *dev, int events, struct thread *td)
6618d59ecb2SHans Petter Selasky {
6628d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
6638d59ecb2SHans Petter Selasky 	struct linux_file *filp;
664464d20bcSHans Petter Selasky 	struct task_struct t;
6658d59ecb2SHans Petter Selasky 	struct file *file;
6668d59ecb2SHans Petter Selasky 	int revents;
6678d59ecb2SHans Petter Selasky 	int error;
6688d59ecb2SHans Petter Selasky 
669464d20bcSHans Petter Selasky 	file = td->td_fpop;
6708d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
6718d59ecb2SHans Petter Selasky 	if (ldev == NULL)
6728d59ecb2SHans Petter Selasky 		return (0);
6738d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
6748d59ecb2SHans Petter Selasky 		return (error);
6758d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
676464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
6778d59ecb2SHans Petter Selasky 	if (filp->f_op->poll)
6788d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
6798d59ecb2SHans Petter Selasky 	else
6808d59ecb2SHans Petter Selasky 		revents = 0;
681464d20bcSHans Petter Selasky 	linux_clear_current(td);
6828d59ecb2SHans Petter Selasky 
6838d59ecb2SHans Petter Selasky 	return (revents);
6848d59ecb2SHans Petter Selasky }
6858d59ecb2SHans Petter Selasky 
6868d59ecb2SHans Petter Selasky static int
6878d59ecb2SHans Petter Selasky linux_dev_mmap_single(struct cdev *dev, vm_ooffset_t *offset,
6888d59ecb2SHans Petter Selasky     vm_size_t size, struct vm_object **object, int nprot)
6898d59ecb2SHans Petter Selasky {
6908d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
6918d59ecb2SHans Petter Selasky 	struct linux_file *filp;
692464d20bcSHans Petter Selasky 	struct thread *td;
693464d20bcSHans Petter Selasky 	struct task_struct t;
6948d59ecb2SHans Petter Selasky 	struct file *file;
6958d59ecb2SHans Petter Selasky 	struct vm_area_struct vma;
6968d59ecb2SHans Petter Selasky 	int error;
6978d59ecb2SHans Petter Selasky 
698464d20bcSHans Petter Selasky 	td = curthread;
699464d20bcSHans Petter Selasky 	file = td->td_fpop;
7008d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
7018d59ecb2SHans Petter Selasky 	if (ldev == NULL)
7028d59ecb2SHans Petter Selasky 		return (ENODEV);
7038d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
7048d59ecb2SHans Petter Selasky 		return (error);
7058d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
706464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
7078d59ecb2SHans Petter Selasky 	vma.vm_start = 0;
7088d59ecb2SHans Petter Selasky 	vma.vm_end = size;
7098d59ecb2SHans Petter Selasky 	vma.vm_pgoff = *offset / PAGE_SIZE;
7108d59ecb2SHans Petter Selasky 	vma.vm_pfn = 0;
711e23cd1b9SJohn Baldwin 	vma.vm_page_prot = VM_MEMATTR_DEFAULT;
7128d59ecb2SHans Petter Selasky 	if (filp->f_op->mmap) {
7138d59ecb2SHans Petter Selasky 		error = -filp->f_op->mmap(filp, &vma);
7148d59ecb2SHans Petter Selasky 		if (error == 0) {
7158d59ecb2SHans Petter Selasky 			struct sglist *sg;
7168d59ecb2SHans Petter Selasky 
7178d59ecb2SHans Petter Selasky 			sg = sglist_alloc(1, M_WAITOK);
7188d59ecb2SHans Petter Selasky 			sglist_append_phys(sg,
7198d59ecb2SHans Petter Selasky 			    (vm_paddr_t)vma.vm_pfn << PAGE_SHIFT, vma.vm_len);
7208d59ecb2SHans Petter Selasky 			*object = vm_pager_allocate(OBJT_SG, sg, vma.vm_len,
721464d20bcSHans Petter Selasky 			    nprot, 0, td->td_ucred);
7228d59ecb2SHans Petter Selasky 		        if (*object == NULL) {
7238d59ecb2SHans Petter Selasky 				sglist_free(sg);
724464d20bcSHans Petter Selasky 				error = EINVAL;
725464d20bcSHans Petter Selasky 				goto done;
7268d59ecb2SHans Petter Selasky 			}
7278d59ecb2SHans Petter Selasky 			*offset = 0;
7288d59ecb2SHans Petter Selasky 			if (vma.vm_page_prot != VM_MEMATTR_DEFAULT) {
7298d59ecb2SHans Petter Selasky 				VM_OBJECT_WLOCK(*object);
7308d59ecb2SHans Petter Selasky 				vm_object_set_memattr(*object,
7318d59ecb2SHans Petter Selasky 				    vma.vm_page_prot);
7328d59ecb2SHans Petter Selasky 				VM_OBJECT_WUNLOCK(*object);
7338d59ecb2SHans Petter Selasky 			}
7348d59ecb2SHans Petter Selasky 		}
7358d59ecb2SHans Petter Selasky 	} else
7368d59ecb2SHans Petter Selasky 		error = ENODEV;
737464d20bcSHans Petter Selasky done:
738464d20bcSHans Petter Selasky 	linux_clear_current(td);
7398d59ecb2SHans Petter Selasky 	return (error);
7408d59ecb2SHans Petter Selasky }
7418d59ecb2SHans Petter Selasky 
7428d59ecb2SHans Petter Selasky struct cdevsw linuxcdevsw = {
7438d59ecb2SHans Petter Selasky 	.d_version = D_VERSION,
7448d59ecb2SHans Petter Selasky 	.d_flags = D_TRACKCLOSE,
7458d59ecb2SHans Petter Selasky 	.d_open = linux_dev_open,
7468d59ecb2SHans Petter Selasky 	.d_close = linux_dev_close,
7478d59ecb2SHans Petter Selasky 	.d_read = linux_dev_read,
7488d59ecb2SHans Petter Selasky 	.d_write = linux_dev_write,
7498d59ecb2SHans Petter Selasky 	.d_ioctl = linux_dev_ioctl,
7508d59ecb2SHans Petter Selasky 	.d_mmap_single = linux_dev_mmap_single,
7518d59ecb2SHans Petter Selasky 	.d_poll = linux_dev_poll,
7528d59ecb2SHans Petter Selasky };
7538d59ecb2SHans Petter Selasky 
7548d59ecb2SHans Petter Selasky static int
7558d59ecb2SHans Petter Selasky linux_file_read(struct file *file, struct uio *uio, struct ucred *active_cred,
7568d59ecb2SHans Petter Selasky     int flags, struct thread *td)
7578d59ecb2SHans Petter Selasky {
7588d59ecb2SHans Petter Selasky 	struct linux_file *filp;
759464d20bcSHans Petter Selasky 	struct task_struct t;
7608d59ecb2SHans Petter Selasky 	ssize_t bytes;
7618d59ecb2SHans Petter Selasky 	int error;
7628d59ecb2SHans Petter Selasky 
7638d59ecb2SHans Petter Selasky 	error = 0;
7648d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
7658d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
766b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
7678d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
768b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
769464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
7708d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
7718d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
7728d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
7738d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
7748d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
7758d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
7768d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
7778d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
7788d59ecb2SHans Petter Selasky 		} else
7798d59ecb2SHans Petter Selasky 			error = -bytes;
7808d59ecb2SHans Petter Selasky 	} else
7818d59ecb2SHans Petter Selasky 		error = ENXIO;
782464d20bcSHans Petter Selasky 	linux_clear_current(td);
7838d59ecb2SHans Petter Selasky 
7848d59ecb2SHans Petter Selasky 	return (error);
7858d59ecb2SHans Petter Selasky }
7868d59ecb2SHans Petter Selasky 
7878d59ecb2SHans Petter Selasky static int
7888d59ecb2SHans Petter Selasky linux_file_poll(struct file *file, int events, struct ucred *active_cred,
7898d59ecb2SHans Petter Selasky     struct thread *td)
7908d59ecb2SHans Petter Selasky {
7918d59ecb2SHans Petter Selasky 	struct linux_file *filp;
792464d20bcSHans Petter Selasky 	struct task_struct t;
7938d59ecb2SHans Petter Selasky 	int revents;
7948d59ecb2SHans Petter Selasky 
7958d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
7968d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
797464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
7988d59ecb2SHans Petter Selasky 	if (filp->f_op->poll)
7998d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
8008d59ecb2SHans Petter Selasky 	else
8018d59ecb2SHans Petter Selasky 		revents = 0;
802464d20bcSHans Petter Selasky 	linux_clear_current(td);
8038d59ecb2SHans Petter Selasky 
8040754e66cSHans Petter Selasky 	return (revents);
8058d59ecb2SHans Petter Selasky }
8068d59ecb2SHans Petter Selasky 
8078d59ecb2SHans Petter Selasky static int
8088d59ecb2SHans Petter Selasky linux_file_close(struct file *file, struct thread *td)
8098d59ecb2SHans Petter Selasky {
8108d59ecb2SHans Petter Selasky 	struct linux_file *filp;
811464d20bcSHans Petter Selasky 	struct task_struct t;
8128d59ecb2SHans Petter Selasky 	int error;
8138d59ecb2SHans Petter Selasky 
8148d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
8158d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
816464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
8178d59ecb2SHans Petter Selasky 	error = -filp->f_op->release(NULL, filp);
818464d20bcSHans Petter Selasky 	linux_clear_current(td);
8198d59ecb2SHans Petter Selasky 	funsetown(&filp->f_sigio);
8208d59ecb2SHans Petter Selasky 	kfree(filp);
8218d59ecb2SHans Petter Selasky 
8228d59ecb2SHans Petter Selasky 	return (error);
8238d59ecb2SHans Petter Selasky }
8248d59ecb2SHans Petter Selasky 
8258d59ecb2SHans Petter Selasky static int
8268d59ecb2SHans Petter Selasky linux_file_ioctl(struct file *fp, u_long cmd, void *data, struct ucred *cred,
8278d59ecb2SHans Petter Selasky     struct thread *td)
8288d59ecb2SHans Petter Selasky {
8298d59ecb2SHans Petter Selasky 	struct linux_file *filp;
830464d20bcSHans Petter Selasky 	struct task_struct t;
8318d59ecb2SHans Petter Selasky 	int error;
8328d59ecb2SHans Petter Selasky 
8338d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)fp->f_data;
8348d59ecb2SHans Petter Selasky 	filp->f_flags = fp->f_flag;
8358d59ecb2SHans Petter Selasky 	error = 0;
8368d59ecb2SHans Petter Selasky 
837464d20bcSHans Petter Selasky 	linux_set_current(td, &t);
8388d59ecb2SHans Petter Selasky 	switch (cmd) {
8398d59ecb2SHans Petter Selasky 	case FIONBIO:
8408d59ecb2SHans Petter Selasky 		break;
8418d59ecb2SHans Petter Selasky 	case FIOASYNC:
8428d59ecb2SHans Petter Selasky 		if (filp->f_op->fasync == NULL)
8438d59ecb2SHans Petter Selasky 			break;
8448d59ecb2SHans Petter Selasky 		error = filp->f_op->fasync(0, filp, fp->f_flag & FASYNC);
8458d59ecb2SHans Petter Selasky 		break;
8468d59ecb2SHans Petter Selasky 	case FIOSETOWN:
8478d59ecb2SHans Petter Selasky 		error = fsetown(*(int *)data, &filp->f_sigio);
8488d59ecb2SHans Petter Selasky 		if (error == 0)
8498d59ecb2SHans Petter Selasky 			error = filp->f_op->fasync(0, filp,
8508d59ecb2SHans Petter Selasky 			    fp->f_flag & FASYNC);
8518d59ecb2SHans Petter Selasky 		break;
8528d59ecb2SHans Petter Selasky 	case FIOGETOWN:
8538d59ecb2SHans Petter Selasky 		*(int *)data = fgetown(&filp->f_sigio);
8548d59ecb2SHans Petter Selasky 		break;
8558d59ecb2SHans Petter Selasky 	default:
8568d59ecb2SHans Petter Selasky 		error = ENOTTY;
8578d59ecb2SHans Petter Selasky 		break;
8588d59ecb2SHans Petter Selasky 	}
859464d20bcSHans Petter Selasky 	linux_clear_current(td);
8608d59ecb2SHans Petter Selasky 	return (error);
8618d59ecb2SHans Petter Selasky }
8628d59ecb2SHans Petter Selasky 
8638d59ecb2SHans Petter Selasky static int
8648d59ecb2SHans Petter Selasky linux_file_stat(struct file *fp, struct stat *sb, struct ucred *active_cred,
8658d59ecb2SHans Petter Selasky     struct thread *td)
8668d59ecb2SHans Petter Selasky {
8678d59ecb2SHans Petter Selasky 
8688d59ecb2SHans Petter Selasky 	return (EOPNOTSUPP);
8698d59ecb2SHans Petter Selasky }
8708d59ecb2SHans Petter Selasky 
8718d59ecb2SHans Petter Selasky static int
8728d59ecb2SHans Petter Selasky linux_file_fill_kinfo(struct file *fp, struct kinfo_file *kif,
8738d59ecb2SHans Petter Selasky     struct filedesc *fdp)
8748d59ecb2SHans Petter Selasky {
8758d59ecb2SHans Petter Selasky 
8768d59ecb2SHans Petter Selasky 	return (0);
8778d59ecb2SHans Petter Selasky }
8788d59ecb2SHans Petter Selasky 
8798d59ecb2SHans Petter Selasky struct fileops linuxfileops = {
8808d59ecb2SHans Petter Selasky 	.fo_read = linux_file_read,
8818d59ecb2SHans Petter Selasky 	.fo_write = invfo_rdwr,
8828d59ecb2SHans Petter Selasky 	.fo_truncate = invfo_truncate,
8838d59ecb2SHans Petter Selasky 	.fo_kqfilter = invfo_kqfilter,
8848d59ecb2SHans Petter Selasky 	.fo_stat = linux_file_stat,
8858d59ecb2SHans Petter Selasky 	.fo_fill_kinfo = linux_file_fill_kinfo,
8868d59ecb2SHans Petter Selasky 	.fo_poll = linux_file_poll,
8878d59ecb2SHans Petter Selasky 	.fo_close = linux_file_close,
8888d59ecb2SHans Petter Selasky 	.fo_ioctl = linux_file_ioctl,
8898d59ecb2SHans Petter Selasky 	.fo_chmod = invfo_chmod,
8908d59ecb2SHans Petter Selasky 	.fo_chown = invfo_chown,
8918d59ecb2SHans Petter Selasky 	.fo_sendfile = invfo_sendfile,
8928d59ecb2SHans Petter Selasky };
8938d59ecb2SHans Petter Selasky 
8948d59ecb2SHans Petter Selasky /*
8958d59ecb2SHans Petter Selasky  * Hash of vmmap addresses.  This is infrequently accessed and does not
8968d59ecb2SHans Petter Selasky  * need to be particularly large.  This is done because we must store the
8978d59ecb2SHans Petter Selasky  * caller's idea of the map size to properly unmap.
8988d59ecb2SHans Petter Selasky  */
8998d59ecb2SHans Petter Selasky struct vmmap {
9008d59ecb2SHans Petter Selasky 	LIST_ENTRY(vmmap)	vm_next;
9018d59ecb2SHans Petter Selasky 	void 			*vm_addr;
9028d59ecb2SHans Petter Selasky 	unsigned long		vm_size;
9038d59ecb2SHans Petter Selasky };
9048d59ecb2SHans Petter Selasky 
9058d59ecb2SHans Petter Selasky struct vmmaphd {
9068d59ecb2SHans Petter Selasky 	struct vmmap *lh_first;
9078d59ecb2SHans Petter Selasky };
9088d59ecb2SHans Petter Selasky #define	VMMAP_HASH_SIZE	64
9098d59ecb2SHans Petter Selasky #define	VMMAP_HASH_MASK	(VMMAP_HASH_SIZE - 1)
9108d59ecb2SHans Petter Selasky #define	VM_HASH(addr)	((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK
9118d59ecb2SHans Petter Selasky static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE];
9128d59ecb2SHans Petter Selasky static struct mtx vmmaplock;
9138d59ecb2SHans Petter Selasky 
9148d59ecb2SHans Petter Selasky static void
9158d59ecb2SHans Petter Selasky vmmap_add(void *addr, unsigned long size)
9168d59ecb2SHans Petter Selasky {
9178d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
9188d59ecb2SHans Petter Selasky 
9198d59ecb2SHans Petter Selasky 	vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL);
9208d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
9218d59ecb2SHans Petter Selasky 	vmmap->vm_size = size;
9228d59ecb2SHans Petter Selasky 	vmmap->vm_addr = addr;
9238d59ecb2SHans Petter Selasky 	LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next);
9248d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
9258d59ecb2SHans Petter Selasky }
9268d59ecb2SHans Petter Selasky 
9278d59ecb2SHans Petter Selasky static struct vmmap *
9288d59ecb2SHans Petter Selasky vmmap_remove(void *addr)
9298d59ecb2SHans Petter Selasky {
9308d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
9318d59ecb2SHans Petter Selasky 
9328d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
9338d59ecb2SHans Petter Selasky 	LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next)
9348d59ecb2SHans Petter Selasky 		if (vmmap->vm_addr == addr)
9358d59ecb2SHans Petter Selasky 			break;
9368d59ecb2SHans Petter Selasky 	if (vmmap)
9378d59ecb2SHans Petter Selasky 		LIST_REMOVE(vmmap, vm_next);
9388d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
9398d59ecb2SHans Petter Selasky 
9408d59ecb2SHans Petter Selasky 	return (vmmap);
9418d59ecb2SHans Petter Selasky }
9428d59ecb2SHans Petter Selasky 
94386845417SHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
9448d59ecb2SHans Petter Selasky void *
9458d59ecb2SHans Petter Selasky _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr)
9468d59ecb2SHans Petter Selasky {
9478d59ecb2SHans Petter Selasky 	void *addr;
9488d59ecb2SHans Petter Selasky 
9498d59ecb2SHans Petter Selasky 	addr = pmap_mapdev_attr(phys_addr, size, attr);
9508d59ecb2SHans Petter Selasky 	if (addr == NULL)
9518d59ecb2SHans Petter Selasky 		return (NULL);
9528d59ecb2SHans Petter Selasky 	vmmap_add(addr, size);
9538d59ecb2SHans Petter Selasky 
9548d59ecb2SHans Petter Selasky 	return (addr);
9558d59ecb2SHans Petter Selasky }
95686845417SHans Petter Selasky #endif
9578d59ecb2SHans Petter Selasky 
9588d59ecb2SHans Petter Selasky void
9598d59ecb2SHans Petter Selasky iounmap(void *addr)
9608d59ecb2SHans Petter Selasky {
9618d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
9628d59ecb2SHans Petter Selasky 
9638d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
9648d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
9658d59ecb2SHans Petter Selasky 		return;
9668d59ecb2SHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
9678d59ecb2SHans Petter Selasky 	pmap_unmapdev((vm_offset_t)addr, vmmap->vm_size);
9688d59ecb2SHans Petter Selasky #endif
9698d59ecb2SHans Petter Selasky 	kfree(vmmap);
9708d59ecb2SHans Petter Selasky }
9718d59ecb2SHans Petter Selasky 
9728d59ecb2SHans Petter Selasky 
9738d59ecb2SHans Petter Selasky void *
9748d59ecb2SHans Petter Selasky vmap(struct page **pages, unsigned int count, unsigned long flags, int prot)
9758d59ecb2SHans Petter Selasky {
9768d59ecb2SHans Petter Selasky 	vm_offset_t off;
9778d59ecb2SHans Petter Selasky 	size_t size;
9788d59ecb2SHans Petter Selasky 
9798d59ecb2SHans Petter Selasky 	size = count * PAGE_SIZE;
9808d59ecb2SHans Petter Selasky 	off = kva_alloc(size);
9818d59ecb2SHans Petter Selasky 	if (off == 0)
9828d59ecb2SHans Petter Selasky 		return (NULL);
9838d59ecb2SHans Petter Selasky 	vmmap_add((void *)off, size);
9848d59ecb2SHans Petter Selasky 	pmap_qenter(off, pages, count);
9858d59ecb2SHans Petter Selasky 
9868d59ecb2SHans Petter Selasky 	return ((void *)off);
9878d59ecb2SHans Petter Selasky }
9888d59ecb2SHans Petter Selasky 
9898d59ecb2SHans Petter Selasky void
9908d59ecb2SHans Petter Selasky vunmap(void *addr)
9918d59ecb2SHans Petter Selasky {
9928d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
9938d59ecb2SHans Petter Selasky 
9948d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
9958d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
9968d59ecb2SHans Petter Selasky 		return;
9978d59ecb2SHans Petter Selasky 	pmap_qremove((vm_offset_t)addr, vmmap->vm_size / PAGE_SIZE);
9988d59ecb2SHans Petter Selasky 	kva_free((vm_offset_t)addr, vmmap->vm_size);
9998d59ecb2SHans Petter Selasky 	kfree(vmmap);
10008d59ecb2SHans Petter Selasky }
10018d59ecb2SHans Petter Selasky 
10028d59ecb2SHans Petter Selasky char *
10038d59ecb2SHans Petter Selasky kvasprintf(gfp_t gfp, const char *fmt, va_list ap)
10048d59ecb2SHans Petter Selasky {
10058d59ecb2SHans Petter Selasky 	unsigned int len;
10068d59ecb2SHans Petter Selasky 	char *p;
10078d59ecb2SHans Petter Selasky 	va_list aq;
10088d59ecb2SHans Petter Selasky 
10098d59ecb2SHans Petter Selasky 	va_copy(aq, ap);
10108d59ecb2SHans Petter Selasky 	len = vsnprintf(NULL, 0, fmt, aq);
10118d59ecb2SHans Petter Selasky 	va_end(aq);
10128d59ecb2SHans Petter Selasky 
10138d59ecb2SHans Petter Selasky 	p = kmalloc(len + 1, gfp);
10148d59ecb2SHans Petter Selasky 	if (p != NULL)
10158d59ecb2SHans Petter Selasky 		vsnprintf(p, len + 1, fmt, ap);
10168d59ecb2SHans Petter Selasky 
10178d59ecb2SHans Petter Selasky 	return (p);
10188d59ecb2SHans Petter Selasky }
10198d59ecb2SHans Petter Selasky 
10208d59ecb2SHans Petter Selasky char *
10218d59ecb2SHans Petter Selasky kasprintf(gfp_t gfp, const char *fmt, ...)
10228d59ecb2SHans Petter Selasky {
10238d59ecb2SHans Petter Selasky 	va_list ap;
10248d59ecb2SHans Petter Selasky 	char *p;
10258d59ecb2SHans Petter Selasky 
10268d59ecb2SHans Petter Selasky 	va_start(ap, fmt);
10278d59ecb2SHans Petter Selasky 	p = kvasprintf(gfp, fmt, ap);
10288d59ecb2SHans Petter Selasky 	va_end(ap);
10298d59ecb2SHans Petter Selasky 
10308d59ecb2SHans Petter Selasky 	return (p);
10318d59ecb2SHans Petter Selasky }
10328d59ecb2SHans Petter Selasky 
10338d59ecb2SHans Petter Selasky static void
10348d59ecb2SHans Petter Selasky linux_timer_callback_wrapper(void *context)
10358d59ecb2SHans Petter Selasky {
10368d59ecb2SHans Petter Selasky 	struct timer_list *timer;
10378d59ecb2SHans Petter Selasky 
10388d59ecb2SHans Petter Selasky 	timer = context;
10398d59ecb2SHans Petter Selasky 	timer->function(timer->data);
10408d59ecb2SHans Petter Selasky }
10418d59ecb2SHans Petter Selasky 
10428d59ecb2SHans Petter Selasky void
10438d59ecb2SHans Petter Selasky mod_timer(struct timer_list *timer, unsigned long expires)
10448d59ecb2SHans Petter Selasky {
10458d59ecb2SHans Petter Selasky 
10468d59ecb2SHans Petter Selasky 	timer->expires = expires;
10478d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
10488d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(expires),
10498d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
10508d59ecb2SHans Petter Selasky }
10518d59ecb2SHans Petter Selasky 
10528d59ecb2SHans Petter Selasky void
10538d59ecb2SHans Petter Selasky add_timer(struct timer_list *timer)
10548d59ecb2SHans Petter Selasky {
10558d59ecb2SHans Petter Selasky 
10568d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
10578d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
10588d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
10598d59ecb2SHans Petter Selasky }
10608d59ecb2SHans Petter Selasky 
10618d59ecb2SHans Petter Selasky static void
10628d59ecb2SHans Petter Selasky linux_timer_init(void *arg)
10638d59ecb2SHans Petter Selasky {
10648d59ecb2SHans Petter Selasky 
10658d59ecb2SHans Petter Selasky 	/*
10668d59ecb2SHans Petter Selasky 	 * Compute an internal HZ value which can divide 2**32 to
10678d59ecb2SHans Petter Selasky 	 * avoid timer rounding problems when the tick value wraps
10688d59ecb2SHans Petter Selasky 	 * around 2**32:
10698d59ecb2SHans Petter Selasky 	 */
10708d59ecb2SHans Petter Selasky 	linux_timer_hz_mask = 1;
10718d59ecb2SHans Petter Selasky 	while (linux_timer_hz_mask < (unsigned long)hz)
10728d59ecb2SHans Petter Selasky 		linux_timer_hz_mask *= 2;
10738d59ecb2SHans Petter Selasky 	linux_timer_hz_mask--;
10748d59ecb2SHans Petter Selasky }
10758d59ecb2SHans Petter Selasky SYSINIT(linux_timer, SI_SUB_DRIVERS, SI_ORDER_FIRST, linux_timer_init, NULL);
10768d59ecb2SHans Petter Selasky 
10778d59ecb2SHans Petter Selasky void
10788d59ecb2SHans Petter Selasky linux_complete_common(struct completion *c, int all)
10798d59ecb2SHans Petter Selasky {
10808d59ecb2SHans Petter Selasky 	int wakeup_swapper;
10818d59ecb2SHans Petter Selasky 
10828d59ecb2SHans Petter Selasky 	sleepq_lock(c);
10838d59ecb2SHans Petter Selasky 	c->done++;
10848d59ecb2SHans Petter Selasky 	if (all)
10858d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_broadcast(c, SLEEPQ_SLEEP, 0, 0);
10868d59ecb2SHans Petter Selasky 	else
10878d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_signal(c, SLEEPQ_SLEEP, 0, 0);
10888d59ecb2SHans Petter Selasky 	sleepq_release(c);
10898d59ecb2SHans Petter Selasky 	if (wakeup_swapper)
10908d59ecb2SHans Petter Selasky 		kick_proc0();
10918d59ecb2SHans Petter Selasky }
10928d59ecb2SHans Petter Selasky 
10938d59ecb2SHans Petter Selasky /*
10948d59ecb2SHans Petter Selasky  * Indefinite wait for done != 0 with or without signals.
10958d59ecb2SHans Petter Selasky  */
10968d59ecb2SHans Petter Selasky long
10978d59ecb2SHans Petter Selasky linux_wait_for_common(struct completion *c, int flags)
10988d59ecb2SHans Petter Selasky {
10998eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
110085714218SHans Petter Selasky 		return (0);
11018d59ecb2SHans Petter Selasky 
11028d59ecb2SHans Petter Selasky 	if (flags != 0)
11038d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
11048d59ecb2SHans Petter Selasky 	else
11058d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
11068d59ecb2SHans Petter Selasky 	for (;;) {
11078d59ecb2SHans Petter Selasky 		sleepq_lock(c);
11088d59ecb2SHans Petter Selasky 		if (c->done)
11098d59ecb2SHans Petter Selasky 			break;
11108d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
11118d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE) {
11128d59ecb2SHans Petter Selasky 			if (sleepq_wait_sig(c, 0) != 0)
11138d59ecb2SHans Petter Selasky 				return (-ERESTARTSYS);
11148d59ecb2SHans Petter Selasky 		} else
11158d59ecb2SHans Petter Selasky 			sleepq_wait(c, 0);
11168d59ecb2SHans Petter Selasky 	}
11178d59ecb2SHans Petter Selasky 	c->done--;
11188d59ecb2SHans Petter Selasky 	sleepq_release(c);
11198d59ecb2SHans Petter Selasky 
11208d59ecb2SHans Petter Selasky 	return (0);
11218d59ecb2SHans Petter Selasky }
11228d59ecb2SHans Petter Selasky 
11238d59ecb2SHans Petter Selasky /*
11248d59ecb2SHans Petter Selasky  * Time limited wait for done != 0 with or without signals.
11258d59ecb2SHans Petter Selasky  */
11268d59ecb2SHans Petter Selasky long
11278d59ecb2SHans Petter Selasky linux_wait_for_timeout_common(struct completion *c, long timeout, int flags)
11288d59ecb2SHans Petter Selasky {
11298d59ecb2SHans Petter Selasky 	long end = jiffies + timeout;
11308d59ecb2SHans Petter Selasky 
11318eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
113285714218SHans Petter Selasky 		return (0);
113385714218SHans Petter Selasky 
11348d59ecb2SHans Petter Selasky 	if (flags != 0)
11358d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
11368d59ecb2SHans Petter Selasky 	else
11378d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
11388d59ecb2SHans Petter Selasky 	for (;;) {
11398d59ecb2SHans Petter Selasky 		int ret;
11408d59ecb2SHans Petter Selasky 
11418d59ecb2SHans Petter Selasky 		sleepq_lock(c);
11428d59ecb2SHans Petter Selasky 		if (c->done)
11438d59ecb2SHans Petter Selasky 			break;
11448d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
11458d59ecb2SHans Petter Selasky 		sleepq_set_timeout(c, linux_timer_jiffies_until(end));
11468d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE)
11478d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait_sig(c, 0);
11488d59ecb2SHans Petter Selasky 		else
11498d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait(c, 0);
11508d59ecb2SHans Petter Selasky 		if (ret != 0) {
11518d59ecb2SHans Petter Selasky 			/* check for timeout or signal */
11528d59ecb2SHans Petter Selasky 			if (ret == EWOULDBLOCK)
11538d59ecb2SHans Petter Selasky 				return (0);
11548d59ecb2SHans Petter Selasky 			else
11558d59ecb2SHans Petter Selasky 				return (-ERESTARTSYS);
11568d59ecb2SHans Petter Selasky 		}
11578d59ecb2SHans Petter Selasky 	}
11588d59ecb2SHans Petter Selasky 	c->done--;
11598d59ecb2SHans Petter Selasky 	sleepq_release(c);
11608d59ecb2SHans Petter Selasky 
11618d59ecb2SHans Petter Selasky 	/* return how many jiffies are left */
11628d59ecb2SHans Petter Selasky 	return (linux_timer_jiffies_until(end));
11638d59ecb2SHans Petter Selasky }
11648d59ecb2SHans Petter Selasky 
11658d59ecb2SHans Petter Selasky int
11668d59ecb2SHans Petter Selasky linux_try_wait_for_completion(struct completion *c)
11678d59ecb2SHans Petter Selasky {
11688d59ecb2SHans Petter Selasky 	int isdone;
11698d59ecb2SHans Petter Selasky 
11708d59ecb2SHans Petter Selasky 	isdone = 1;
11718d59ecb2SHans Petter Selasky 	sleepq_lock(c);
11728d59ecb2SHans Petter Selasky 	if (c->done)
11738d59ecb2SHans Petter Selasky 		c->done--;
11748d59ecb2SHans Petter Selasky 	else
11758d59ecb2SHans Petter Selasky 		isdone = 0;
11768d59ecb2SHans Petter Selasky 	sleepq_release(c);
11778d59ecb2SHans Petter Selasky 	return (isdone);
11788d59ecb2SHans Petter Selasky }
11798d59ecb2SHans Petter Selasky 
11808d59ecb2SHans Petter Selasky int
11818d59ecb2SHans Petter Selasky linux_completion_done(struct completion *c)
11828d59ecb2SHans Petter Selasky {
11838d59ecb2SHans Petter Selasky 	int isdone;
11848d59ecb2SHans Petter Selasky 
11858d59ecb2SHans Petter Selasky 	isdone = 1;
11868d59ecb2SHans Petter Selasky 	sleepq_lock(c);
11878d59ecb2SHans Petter Selasky 	if (c->done == 0)
11888d59ecb2SHans Petter Selasky 		isdone = 0;
11898d59ecb2SHans Petter Selasky 	sleepq_release(c);
11908d59ecb2SHans Petter Selasky 	return (isdone);
11918d59ecb2SHans Petter Selasky }
11928d59ecb2SHans Petter Selasky 
119355d445d3SHans Petter Selasky void
119455d445d3SHans Petter Selasky linux_delayed_work_fn(void *arg)
119555d445d3SHans Petter Selasky {
119655d445d3SHans Petter Selasky 	struct delayed_work *work;
119755d445d3SHans Petter Selasky 
119855d445d3SHans Petter Selasky 	work = arg;
119955d445d3SHans Petter Selasky 	taskqueue_enqueue(work->work.taskqueue, &work->work.work_task);
120055d445d3SHans Petter Selasky }
120155d445d3SHans Petter Selasky 
120255d445d3SHans Petter Selasky void
120355d445d3SHans Petter Selasky linux_work_fn(void *context, int pending)
120455d445d3SHans Petter Selasky {
120555d445d3SHans Petter Selasky 	struct work_struct *work;
120655d445d3SHans Petter Selasky 
120755d445d3SHans Petter Selasky 	work = context;
120855d445d3SHans Petter Selasky 	work->fn(work);
120955d445d3SHans Petter Selasky }
121055d445d3SHans Petter Selasky 
121155d445d3SHans Petter Selasky void
121255d445d3SHans Petter Selasky linux_flush_fn(void *context, int pending)
121355d445d3SHans Petter Selasky {
121455d445d3SHans Petter Selasky }
121555d445d3SHans Petter Selasky 
121655d445d3SHans Petter Selasky struct workqueue_struct *
121755d445d3SHans Petter Selasky linux_create_workqueue_common(const char *name, int cpus)
121855d445d3SHans Petter Selasky {
121955d445d3SHans Petter Selasky 	struct workqueue_struct *wq;
122055d445d3SHans Petter Selasky 
122155d445d3SHans Petter Selasky 	wq = kmalloc(sizeof(*wq), M_WAITOK);
122255d445d3SHans Petter Selasky 	wq->taskqueue = taskqueue_create(name, M_WAITOK,
122355d445d3SHans Petter Selasky 	    taskqueue_thread_enqueue,  &wq->taskqueue);
1224c4e58b4eSHans Petter Selasky 	atomic_set(&wq->draining, 0);
122555d445d3SHans Petter Selasky 	taskqueue_start_threads(&wq->taskqueue, cpus, PWAIT, "%s", name);
122655d445d3SHans Petter Selasky 
122755d445d3SHans Petter Selasky 	return (wq);
122855d445d3SHans Petter Selasky }
122955d445d3SHans Petter Selasky 
123055d445d3SHans Petter Selasky void
123155d445d3SHans Petter Selasky destroy_workqueue(struct workqueue_struct *wq)
123255d445d3SHans Petter Selasky {
123355d445d3SHans Petter Selasky 	taskqueue_free(wq->taskqueue);
123455d445d3SHans Petter Selasky 	kfree(wq);
123555d445d3SHans Petter Selasky }
123655d445d3SHans Petter Selasky 
12378d59ecb2SHans Petter Selasky static void
123806204f8eSHans Petter Selasky linux_cdev_release(struct kobject *kobj)
123906204f8eSHans Petter Selasky {
124006204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
124106204f8eSHans Petter Selasky 	struct kobject *parent;
124206204f8eSHans Petter Selasky 
124306204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
124406204f8eSHans Petter Selasky 	parent = kobj->parent;
124506204f8eSHans Petter Selasky 	if (cdev->cdev)
124606204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
124706204f8eSHans Petter Selasky 	kfree(cdev);
124806204f8eSHans Petter Selasky 	kobject_put(parent);
124906204f8eSHans Petter Selasky }
125006204f8eSHans Petter Selasky 
125106204f8eSHans Petter Selasky static void
125206204f8eSHans Petter Selasky linux_cdev_static_release(struct kobject *kobj)
125306204f8eSHans Petter Selasky {
125406204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
125506204f8eSHans Petter Selasky 	struct kobject *parent;
125606204f8eSHans Petter Selasky 
125706204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
125806204f8eSHans Petter Selasky 	parent = kobj->parent;
125906204f8eSHans Petter Selasky 	if (cdev->cdev)
126006204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
126106204f8eSHans Petter Selasky 	kobject_put(parent);
126206204f8eSHans Petter Selasky }
126306204f8eSHans Petter Selasky 
126406204f8eSHans Petter Selasky const struct kobj_type linux_cdev_ktype = {
126506204f8eSHans Petter Selasky 	.release = linux_cdev_release,
126606204f8eSHans Petter Selasky };
126706204f8eSHans Petter Selasky 
126806204f8eSHans Petter Selasky const struct kobj_type linux_cdev_static_ktype = {
126906204f8eSHans Petter Selasky 	.release = linux_cdev_static_release,
127006204f8eSHans Petter Selasky };
127106204f8eSHans Petter Selasky 
127206204f8eSHans Petter Selasky static void
12730c510167SHans Petter Selasky linux_handle_ifnet_link_event(void *arg, struct ifnet *ifp, int linkstate)
12740c510167SHans Petter Selasky {
12750c510167SHans Petter Selasky 	struct notifier_block *nb;
12760c510167SHans Petter Selasky 
12770c510167SHans Petter Selasky 	nb = arg;
12780c510167SHans Petter Selasky 	if (linkstate == LINK_STATE_UP)
12790c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_UP, ifp);
12800c510167SHans Petter Selasky 	else
12810c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_DOWN, ifp);
12820c510167SHans Petter Selasky }
12830c510167SHans Petter Selasky 
12840c510167SHans Petter Selasky static void
12850c510167SHans Petter Selasky linux_handle_ifnet_arrival_event(void *arg, struct ifnet *ifp)
12860c510167SHans Petter Selasky {
12870c510167SHans Petter Selasky 	struct notifier_block *nb;
12880c510167SHans Petter Selasky 
12890c510167SHans Petter Selasky 	nb = arg;
12900c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_REGISTER, ifp);
12910c510167SHans Petter Selasky }
12920c510167SHans Petter Selasky 
12930c510167SHans Petter Selasky static void
12940c510167SHans Petter Selasky linux_handle_ifnet_departure_event(void *arg, struct ifnet *ifp)
12950c510167SHans Petter Selasky {
12960c510167SHans Petter Selasky 	struct notifier_block *nb;
12970c510167SHans Petter Selasky 
12980c510167SHans Petter Selasky 	nb = arg;
12990c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_UNREGISTER, ifp);
13000c510167SHans Petter Selasky }
13010c510167SHans Petter Selasky 
13020c510167SHans Petter Selasky static void
13030c510167SHans Petter Selasky linux_handle_iflladdr_event(void *arg, struct ifnet *ifp)
13040c510167SHans Petter Selasky {
13050c510167SHans Petter Selasky 	struct notifier_block *nb;
13060c510167SHans Petter Selasky 
13070c510167SHans Petter Selasky 	nb = arg;
13080c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEADDR, ifp);
13090c510167SHans Petter Selasky }
13100c510167SHans Petter Selasky 
13110c510167SHans Petter Selasky static void
13120c510167SHans Petter Selasky linux_handle_ifaddr_event(void *arg, struct ifnet *ifp)
13130c510167SHans Petter Selasky {
13140c510167SHans Petter Selasky 	struct notifier_block *nb;
13150c510167SHans Petter Selasky 
13160c510167SHans Petter Selasky 	nb = arg;
13170c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEIFADDR, ifp);
13180c510167SHans Petter Selasky }
13190c510167SHans Petter Selasky 
13200c510167SHans Petter Selasky int
13210c510167SHans Petter Selasky register_netdevice_notifier(struct notifier_block *nb)
13220c510167SHans Petter Selasky {
13230c510167SHans Petter Selasky 
13240c510167SHans Petter Selasky 	nb->tags[NETDEV_UP] = EVENTHANDLER_REGISTER(
13250c510167SHans Petter Selasky 	    ifnet_link_event, linux_handle_ifnet_link_event, nb, 0);
13260c510167SHans Petter Selasky 	nb->tags[NETDEV_REGISTER] = EVENTHANDLER_REGISTER(
13270c510167SHans Petter Selasky 	    ifnet_arrival_event, linux_handle_ifnet_arrival_event, nb, 0);
13280c510167SHans Petter Selasky 	nb->tags[NETDEV_UNREGISTER] = EVENTHANDLER_REGISTER(
13290c510167SHans Petter Selasky 	    ifnet_departure_event, linux_handle_ifnet_departure_event, nb, 0);
13300c510167SHans Petter Selasky 	nb->tags[NETDEV_CHANGEADDR] = EVENTHANDLER_REGISTER(
13310c510167SHans Petter Selasky 	    iflladdr_event, linux_handle_iflladdr_event, nb, 0);
13320c510167SHans Petter Selasky 
13330c510167SHans Petter Selasky 	return (0);
13340c510167SHans Petter Selasky }
13350c510167SHans Petter Selasky 
13360c510167SHans Petter Selasky int
13370c510167SHans Petter Selasky register_inetaddr_notifier(struct notifier_block *nb)
13380c510167SHans Petter Selasky {
13390c510167SHans Petter Selasky 
13400c510167SHans Petter Selasky         nb->tags[NETDEV_CHANGEIFADDR] = EVENTHANDLER_REGISTER(
13410c510167SHans Petter Selasky             ifaddr_event, linux_handle_ifaddr_event, nb, 0);
13420c510167SHans Petter Selasky         return (0);
13430c510167SHans Petter Selasky }
13440c510167SHans Petter Selasky 
13450c510167SHans Petter Selasky int
13460c510167SHans Petter Selasky unregister_netdevice_notifier(struct notifier_block *nb)
13470c510167SHans Petter Selasky {
13480c510167SHans Petter Selasky 
13490c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_link_event,
13500c510167SHans Petter Selasky 	    nb->tags[NETDEV_UP]);
13510c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_arrival_event,
13520c510167SHans Petter Selasky 	    nb->tags[NETDEV_REGISTER]);
13530c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_departure_event,
13540c510167SHans Petter Selasky 	    nb->tags[NETDEV_UNREGISTER]);
13550c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(iflladdr_event,
13560c510167SHans Petter Selasky 	    nb->tags[NETDEV_CHANGEADDR]);
13570c510167SHans Petter Selasky 
13580c510167SHans Petter Selasky 	return (0);
13590c510167SHans Petter Selasky }
13600c510167SHans Petter Selasky 
13610c510167SHans Petter Selasky int
13620c510167SHans Petter Selasky unregister_inetaddr_notifier(struct notifier_block *nb)
13630c510167SHans Petter Selasky {
13640c510167SHans Petter Selasky 
13650c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifaddr_event,
13660c510167SHans Petter Selasky             nb->tags[NETDEV_CHANGEIFADDR]);
13670c510167SHans Petter Selasky 
13680c510167SHans Petter Selasky         return (0);
13690c510167SHans Petter Selasky }
13700c510167SHans Petter Selasky 
1371aad02fb4SHans Petter Selasky struct list_sort_thunk {
1372aad02fb4SHans Petter Selasky 	int (*cmp)(void *, struct list_head *, struct list_head *);
1373aad02fb4SHans Petter Selasky 	void *priv;
1374aad02fb4SHans Petter Selasky };
1375aad02fb4SHans Petter Selasky 
1376aad02fb4SHans Petter Selasky static inline int
1377aad02fb4SHans Petter Selasky linux_le_cmp(void *priv, const void *d1, const void *d2)
1378aad02fb4SHans Petter Selasky {
1379aad02fb4SHans Petter Selasky 	struct list_head *le1, *le2;
1380aad02fb4SHans Petter Selasky 	struct list_sort_thunk *thunk;
1381aad02fb4SHans Petter Selasky 
1382aad02fb4SHans Petter Selasky 	thunk = priv;
1383aad02fb4SHans Petter Selasky 	le1 = *(__DECONST(struct list_head **, d1));
1384aad02fb4SHans Petter Selasky 	le2 = *(__DECONST(struct list_head **, d2));
1385aad02fb4SHans Petter Selasky 	return ((thunk->cmp)(thunk->priv, le1, le2));
1386aad02fb4SHans Petter Selasky }
1387aad02fb4SHans Petter Selasky 
1388aad02fb4SHans Petter Selasky void
1389aad02fb4SHans Petter Selasky list_sort(void *priv, struct list_head *head, int (*cmp)(void *priv,
1390aad02fb4SHans Petter Selasky     struct list_head *a, struct list_head *b))
1391aad02fb4SHans Petter Selasky {
1392aad02fb4SHans Petter Selasky 	struct list_sort_thunk thunk;
1393aad02fb4SHans Petter Selasky 	struct list_head **ar, *le;
1394aad02fb4SHans Petter Selasky 	size_t count, i;
1395aad02fb4SHans Petter Selasky 
1396aad02fb4SHans Petter Selasky 	count = 0;
1397aad02fb4SHans Petter Selasky 	list_for_each(le, head)
1398aad02fb4SHans Petter Selasky 		count++;
1399aad02fb4SHans Petter Selasky 	ar = malloc(sizeof(struct list_head *) * count, M_KMALLOC, M_WAITOK);
1400aad02fb4SHans Petter Selasky 	i = 0;
1401aad02fb4SHans Petter Selasky 	list_for_each(le, head)
1402aad02fb4SHans Petter Selasky 		ar[i++] = le;
1403aad02fb4SHans Petter Selasky 	thunk.cmp = cmp;
1404aad02fb4SHans Petter Selasky 	thunk.priv = priv;
1405aad02fb4SHans Petter Selasky 	qsort_r(ar, count, sizeof(struct list_head *), &thunk, linux_le_cmp);
1406aad02fb4SHans Petter Selasky 	INIT_LIST_HEAD(head);
1407aad02fb4SHans Petter Selasky 	for (i = 0; i < count; i++)
1408aad02fb4SHans Petter Selasky 		list_add_tail(ar[i], head);
1409aad02fb4SHans Petter Selasky 	free(ar, M_KMALLOC);
1410aad02fb4SHans Petter Selasky }
1411aad02fb4SHans Petter Selasky 
14120c510167SHans Petter Selasky void
14130c510167SHans Petter Selasky linux_irq_handler(void *ent)
14140c510167SHans Petter Selasky {
14150c510167SHans Petter Selasky 	struct irq_ent *irqe;
14160c510167SHans Petter Selasky 
14170c510167SHans Petter Selasky 	irqe = ent;
14180c510167SHans Petter Selasky 	irqe->handler(irqe->irq, irqe->arg);
14190c510167SHans Petter Selasky }
14200c510167SHans Petter Selasky 
1421*1125dbc0SHans Petter Selasky struct linux_cdev *
1422*1125dbc0SHans Petter Selasky linux_find_cdev(const char *name, unsigned major, unsigned minor)
1423*1125dbc0SHans Petter Selasky {
1424*1125dbc0SHans Petter Selasky 	int unit = MKDEV(major, minor);
1425*1125dbc0SHans Petter Selasky 	struct cdev *cdev;
1426*1125dbc0SHans Petter Selasky 
1427*1125dbc0SHans Petter Selasky 	dev_lock();
1428*1125dbc0SHans Petter Selasky 	LIST_FOREACH(cdev, &linuxcdevsw.d_devs, si_list) {
1429*1125dbc0SHans Petter Selasky 		struct linux_cdev *ldev = cdev->si_drv1;
1430*1125dbc0SHans Petter Selasky 		if (dev2unit(cdev) == unit &&
1431*1125dbc0SHans Petter Selasky 		    strcmp(kobject_name(&ldev->kobj), name) == 0) {
1432*1125dbc0SHans Petter Selasky 			break;
1433*1125dbc0SHans Petter Selasky 		}
1434*1125dbc0SHans Petter Selasky 	}
1435*1125dbc0SHans Petter Selasky 	dev_unlock();
1436*1125dbc0SHans Petter Selasky 
1437*1125dbc0SHans Petter Selasky 	return (cdev != NULL ? cdev->si_drv1 : NULL);
1438*1125dbc0SHans Petter Selasky }
1439*1125dbc0SHans Petter Selasky 
1440*1125dbc0SHans Petter Selasky int
1441*1125dbc0SHans Petter Selasky __register_chrdev(unsigned int major, unsigned int baseminor,
1442*1125dbc0SHans Petter Selasky     unsigned int count, const char *name,
1443*1125dbc0SHans Petter Selasky     const struct file_operations *fops)
1444*1125dbc0SHans Petter Selasky {
1445*1125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
1446*1125dbc0SHans Petter Selasky 	int ret = 0;
1447*1125dbc0SHans Petter Selasky 	int i;
1448*1125dbc0SHans Petter Selasky 
1449*1125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
1450*1125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
1451*1125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
1452*1125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
1453*1125dbc0SHans Petter Selasky 
1454*1125dbc0SHans Petter Selasky 		ret = cdev_add(cdev, makedev(major, i), 1);
1455*1125dbc0SHans Petter Selasky 		if (ret != 0)
1456*1125dbc0SHans Petter Selasky 			break;
1457*1125dbc0SHans Petter Selasky 	}
1458*1125dbc0SHans Petter Selasky 	return (ret);
1459*1125dbc0SHans Petter Selasky }
1460*1125dbc0SHans Petter Selasky 
1461*1125dbc0SHans Petter Selasky int
1462*1125dbc0SHans Petter Selasky __register_chrdev_p(unsigned int major, unsigned int baseminor,
1463*1125dbc0SHans Petter Selasky     unsigned int count, const char *name,
1464*1125dbc0SHans Petter Selasky     const struct file_operations *fops, uid_t uid,
1465*1125dbc0SHans Petter Selasky     gid_t gid, int mode)
1466*1125dbc0SHans Petter Selasky {
1467*1125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
1468*1125dbc0SHans Petter Selasky 	int ret = 0;
1469*1125dbc0SHans Petter Selasky 	int i;
1470*1125dbc0SHans Petter Selasky 
1471*1125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
1472*1125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
1473*1125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
1474*1125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
1475*1125dbc0SHans Petter Selasky 
1476*1125dbc0SHans Petter Selasky 		ret = cdev_add_ext(cdev, makedev(major, i), uid, gid, mode);
1477*1125dbc0SHans Petter Selasky 		if (ret != 0)
1478*1125dbc0SHans Petter Selasky 			break;
1479*1125dbc0SHans Petter Selasky 	}
1480*1125dbc0SHans Petter Selasky 	return (ret);
1481*1125dbc0SHans Petter Selasky }
1482*1125dbc0SHans Petter Selasky 
1483*1125dbc0SHans Petter Selasky void
1484*1125dbc0SHans Petter Selasky __unregister_chrdev(unsigned int major, unsigned int baseminor,
1485*1125dbc0SHans Petter Selasky     unsigned int count, const char *name)
1486*1125dbc0SHans Petter Selasky {
1487*1125dbc0SHans Petter Selasky 	struct linux_cdev *cdevp;
1488*1125dbc0SHans Petter Selasky 	int i;
1489*1125dbc0SHans Petter Selasky 
1490*1125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
1491*1125dbc0SHans Petter Selasky 		cdevp = linux_find_cdev(name, major, i);
1492*1125dbc0SHans Petter Selasky 		if (cdevp != NULL)
1493*1125dbc0SHans Petter Selasky 			cdev_del(cdevp);
1494*1125dbc0SHans Petter Selasky 	}
1495*1125dbc0SHans Petter Selasky }
1496*1125dbc0SHans Petter Selasky 
149703219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
149803219fbaSHans Petter Selasky bool linux_cpu_has_clflush;
149903219fbaSHans Petter Selasky #endif
150003219fbaSHans Petter Selasky 
15010c510167SHans Petter Selasky static void
15028d59ecb2SHans Petter Selasky linux_compat_init(void *arg)
15038d59ecb2SHans Petter Selasky {
15048d59ecb2SHans Petter Selasky 	struct sysctl_oid *rootoid;
15058d59ecb2SHans Petter Selasky 	int i;
15068d59ecb2SHans Petter Selasky 
150703219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
150803219fbaSHans Petter Selasky 	linux_cpu_has_clflush = (cpu_feature & CPUID_CLFSH);
150903219fbaSHans Petter Selasky #endif
1510e10c4cc0SHans Petter Selasky 	sx_init(&linux_global_rcu_lock, "LinuxGlobalRCU");
1511e10c4cc0SHans Petter Selasky 
15128d59ecb2SHans Petter Selasky 	rootoid = SYSCTL_ADD_ROOT_NODE(NULL,
15138d59ecb2SHans Petter Selasky 	    OID_AUTO, "sys", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "sys");
151406204f8eSHans Petter Selasky 	kobject_init(&linux_class_root, &linux_class_ktype);
151506204f8eSHans Petter Selasky 	kobject_set_name(&linux_class_root, "class");
151606204f8eSHans Petter Selasky 	linux_class_root.oidp = SYSCTL_ADD_NODE(NULL, SYSCTL_CHILDREN(rootoid),
15178d59ecb2SHans Petter Selasky 	    OID_AUTO, "class", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "class");
151806204f8eSHans Petter Selasky 	kobject_init(&linux_root_device.kobj, &linux_dev_ktype);
151906204f8eSHans Petter Selasky 	kobject_set_name(&linux_root_device.kobj, "device");
152006204f8eSHans Petter Selasky 	linux_root_device.kobj.oidp = SYSCTL_ADD_NODE(NULL,
15218d59ecb2SHans Petter Selasky 	    SYSCTL_CHILDREN(rootoid), OID_AUTO, "device", CTLFLAG_RD, NULL,
15228d59ecb2SHans Petter Selasky 	    "device");
152306204f8eSHans Petter Selasky 	linux_root_device.bsddev = root_bus;
152406204f8eSHans Petter Selasky 	linux_class_misc.name = "misc";
152506204f8eSHans Petter Selasky 	class_register(&linux_class_misc);
15268d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_drivers);
15278d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_devices);
15288d59ecb2SHans Petter Selasky 	spin_lock_init(&pci_lock);
15298d59ecb2SHans Petter Selasky 	mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF);
15308d59ecb2SHans Petter Selasky 	for (i = 0; i < VMMAP_HASH_SIZE; i++)
15318d59ecb2SHans Petter Selasky 		LIST_INIT(&vmmaphead[i]);
15328d59ecb2SHans Petter Selasky }
15338d59ecb2SHans Petter Selasky SYSINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_init, NULL);
15348d59ecb2SHans Petter Selasky 
15358d59ecb2SHans Petter Selasky static void
15368d59ecb2SHans Petter Selasky linux_compat_uninit(void *arg)
15378d59ecb2SHans Petter Selasky {
153806204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_root);
153906204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_root_device.kobj);
154006204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_misc.kobj);
1541e10c4cc0SHans Petter Selasky 
1542e10c4cc0SHans Petter Selasky 	synchronize_rcu();
1543e10c4cc0SHans Petter Selasky 	sx_destroy(&linux_global_rcu_lock);
15448d59ecb2SHans Petter Selasky }
15458d59ecb2SHans Petter Selasky SYSUNINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_uninit, NULL);
1546f727a767SHans Petter Selasky 
1547f727a767SHans Petter Selasky /*
1548f727a767SHans Petter Selasky  * NOTE: Linux frequently uses "unsigned long" for pointer to integer
1549f727a767SHans Petter Selasky  * conversion and vice versa, where in FreeBSD "uintptr_t" would be
1550f727a767SHans Petter Selasky  * used. Assert these types have the same size, else some parts of the
1551f727a767SHans Petter Selasky  * LinuxKPI may not work like expected:
1552f727a767SHans Petter Selasky  */
1553f727a767SHans Petter Selasky CTASSERT(sizeof(unsigned long) == sizeof(uintptr_t));
1554