xref: /freebsd/sys/compat/linuxkpi/common/src/linux_compat.c (revision a6b28ee02a9bec5f48b40dab2261e9a797a70d94)
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.
51ea4c857SHans Petter Selasky  * Copyright (c) 2013-2017 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>
51c12488bbSMark Johnston #include <vm/vm_object.h>
52c12488bbSMark Johnston #include <vm/vm_page.h>
53c12488bbSMark Johnston #include <vm/vm_pager.h>
548d59ecb2SHans Petter Selasky 
558d59ecb2SHans Petter Selasky #include <machine/stdarg.h>
568d59ecb2SHans Petter Selasky 
5703219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
5803219fbaSHans Petter Selasky #include <machine/md_var.h>
5903219fbaSHans Petter Selasky #endif
6003219fbaSHans Petter Selasky 
618d59ecb2SHans Petter Selasky #include <linux/kobject.h>
628d59ecb2SHans Petter Selasky #include <linux/device.h>
638d59ecb2SHans Petter Selasky #include <linux/slab.h>
648d59ecb2SHans Petter Selasky #include <linux/module.h>
651d9b99e5SHans Petter Selasky #include <linux/moduleparam.h>
668d59ecb2SHans Petter Selasky #include <linux/cdev.h>
678d59ecb2SHans Petter Selasky #include <linux/file.h>
688d59ecb2SHans Petter Selasky #include <linux/sysfs.h>
698d59ecb2SHans Petter Selasky #include <linux/mm.h>
708d59ecb2SHans Petter Selasky #include <linux/io.h>
718d59ecb2SHans Petter Selasky #include <linux/vmalloc.h>
728d59ecb2SHans Petter Selasky #include <linux/netdevice.h>
738d59ecb2SHans Petter Selasky #include <linux/timer.h>
740c510167SHans Petter Selasky #include <linux/interrupt.h>
753a8bec33SHans Petter Selasky #include <linux/uaccess.h>
76aad02fb4SHans Petter Selasky #include <linux/list.h>
77dff36e69SHans Petter Selasky #include <linux/kthread.h>
78dff36e69SHans Petter Selasky #include <linux/kernel.h>
793ce12630SHans Petter Selasky #include <linux/compat.h>
806e3e6544SHans Petter Selasky #include <linux/poll.h>
81c12488bbSMark Johnston #include <linux/smp.h>
828d59ecb2SHans Petter Selasky 
83c12488bbSMark Johnston #if defined(__i386__) || defined(__amd64__)
84c12488bbSMark Johnston #include <asm/smp.h>
85c12488bbSMark Johnston #endif
868d59ecb2SHans Petter Selasky 
871d9b99e5SHans Petter Selasky SYSCTL_NODE(_compat, OID_AUTO, linuxkpi, CTLFLAG_RW, 0, "LinuxKPI parameters");
881d9b99e5SHans Petter Selasky 
898d59ecb2SHans Petter Selasky MALLOC_DEFINE(M_KMALLOC, "linux", "Linux kmalloc compat");
908d59ecb2SHans Petter Selasky 
918d59ecb2SHans Petter Selasky #include <linux/rbtree.h>
928d59ecb2SHans Petter Selasky /* Undo Linux compat changes. */
938d59ecb2SHans Petter Selasky #undef RB_ROOT
948d59ecb2SHans Petter Selasky #undef file
958d59ecb2SHans Petter Selasky #undef cdev
968d59ecb2SHans Petter Selasky #define	RB_ROOT(head)	(head)->rbh_root
978d59ecb2SHans Petter Selasky 
981ea4c857SHans Petter Selasky static struct vm_area_struct *linux_cdev_handle_find(void *handle);
991ea4c857SHans Petter Selasky 
10006204f8eSHans Petter Selasky struct kobject linux_class_root;
10106204f8eSHans Petter Selasky struct device linux_root_device;
10206204f8eSHans Petter Selasky struct class linux_class_misc;
1038d59ecb2SHans Petter Selasky struct list_head pci_drivers;
1048d59ecb2SHans Petter Selasky struct list_head pci_devices;
1058d59ecb2SHans Petter Selasky spinlock_t pci_lock;
1068d59ecb2SHans Petter Selasky 
1078d59ecb2SHans Petter Selasky unsigned long linux_timer_hz_mask;
1088d59ecb2SHans Petter Selasky 
1098d59ecb2SHans Petter Selasky int
1108d59ecb2SHans Petter Selasky panic_cmp(struct rb_node *one, struct rb_node *two)
1118d59ecb2SHans Petter Selasky {
1128d59ecb2SHans Petter Selasky 	panic("no cmp");
1138d59ecb2SHans Petter Selasky }
1148d59ecb2SHans Petter Selasky 
1158d59ecb2SHans Petter Selasky RB_GENERATE(linux_root, rb_node, __entry, panic_cmp);
1168d59ecb2SHans Petter Selasky 
11726019405SHans Petter Selasky int
11826019405SHans Petter Selasky kobject_set_name_vargs(struct kobject *kobj, const char *fmt, va_list args)
11926019405SHans Petter Selasky {
12026019405SHans Petter Selasky 	va_list tmp_va;
12126019405SHans Petter Selasky 	int len;
12226019405SHans Petter Selasky 	char *old;
12326019405SHans Petter Selasky 	char *name;
12426019405SHans Petter Selasky 	char dummy;
12526019405SHans Petter Selasky 
12626019405SHans Petter Selasky 	old = kobj->name;
12726019405SHans Petter Selasky 
12826019405SHans Petter Selasky 	if (old && fmt == NULL)
12926019405SHans Petter Selasky 		return (0);
13026019405SHans Petter Selasky 
13126019405SHans Petter Selasky 	/* compute length of string */
13226019405SHans Petter Selasky 	va_copy(tmp_va, args);
13326019405SHans Petter Selasky 	len = vsnprintf(&dummy, 0, fmt, tmp_va);
13426019405SHans Petter Selasky 	va_end(tmp_va);
13526019405SHans Petter Selasky 
13626019405SHans Petter Selasky 	/* account for zero termination */
13726019405SHans Petter Selasky 	len++;
13826019405SHans Petter Selasky 
13926019405SHans Petter Selasky 	/* check for error */
14026019405SHans Petter Selasky 	if (len < 1)
14126019405SHans Petter Selasky 		return (-EINVAL);
14226019405SHans Petter Selasky 
14326019405SHans Petter Selasky 	/* allocate memory for string */
14426019405SHans Petter Selasky 	name = kzalloc(len, GFP_KERNEL);
14526019405SHans Petter Selasky 	if (name == NULL)
14626019405SHans Petter Selasky 		return (-ENOMEM);
14726019405SHans Petter Selasky 	vsnprintf(name, len, fmt, args);
14826019405SHans Petter Selasky 	kobj->name = name;
14926019405SHans Petter Selasky 
15026019405SHans Petter Selasky 	/* free old string */
15126019405SHans Petter Selasky 	kfree(old);
15226019405SHans Petter Selasky 
15326019405SHans Petter Selasky 	/* filter new string */
15426019405SHans Petter Selasky 	for (; *name != '\0'; name++)
15526019405SHans Petter Selasky 		if (*name == '/')
15626019405SHans Petter Selasky 			*name = '!';
15726019405SHans Petter Selasky 	return (0);
15826019405SHans Petter Selasky }
15926019405SHans Petter Selasky 
1608d59ecb2SHans Petter Selasky int
1618d59ecb2SHans Petter Selasky kobject_set_name(struct kobject *kobj, const char *fmt, ...)
1628d59ecb2SHans Petter Selasky {
1638d59ecb2SHans Petter Selasky 	va_list args;
1648d59ecb2SHans Petter Selasky 	int error;
1658d59ecb2SHans Petter Selasky 
1668d59ecb2SHans Petter Selasky 	va_start(args, fmt);
1678d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
1688d59ecb2SHans Petter Selasky 	va_end(args);
1698d59ecb2SHans Petter Selasky 
1708d59ecb2SHans Petter Selasky 	return (error);
1718d59ecb2SHans Petter Selasky }
1728d59ecb2SHans Petter Selasky 
17306204f8eSHans Petter Selasky static int
1748d59ecb2SHans Petter Selasky kobject_add_complete(struct kobject *kobj, struct kobject *parent)
1758d59ecb2SHans Petter Selasky {
17606204f8eSHans Petter Selasky 	const struct kobj_type *t;
1778d59ecb2SHans Petter Selasky 	int error;
1788d59ecb2SHans Petter Selasky 
179337cb9f0SHans Petter Selasky 	kobj->parent = parent;
1808d59ecb2SHans Petter Selasky 	error = sysfs_create_dir(kobj);
1818d59ecb2SHans Petter Selasky 	if (error == 0 && kobj->ktype && kobj->ktype->default_attrs) {
1828d59ecb2SHans Petter Selasky 		struct attribute **attr;
1838d59ecb2SHans Petter Selasky 		t = kobj->ktype;
1848d59ecb2SHans Petter Selasky 
1858d59ecb2SHans Petter Selasky 		for (attr = t->default_attrs; *attr != NULL; attr++) {
1868d59ecb2SHans Petter Selasky 			error = sysfs_create_file(kobj, *attr);
1878d59ecb2SHans Petter Selasky 			if (error)
1888d59ecb2SHans Petter Selasky 				break;
1898d59ecb2SHans Petter Selasky 		}
1908d59ecb2SHans Petter Selasky 		if (error)
1918d59ecb2SHans Petter Selasky 			sysfs_remove_dir(kobj);
1928d59ecb2SHans Petter Selasky 
1938d59ecb2SHans Petter Selasky 	}
1948d59ecb2SHans Petter Selasky 	return (error);
1958d59ecb2SHans Petter Selasky }
1968d59ecb2SHans Petter Selasky 
1978d59ecb2SHans Petter Selasky int
1988d59ecb2SHans Petter Selasky kobject_add(struct kobject *kobj, struct kobject *parent, const char *fmt, ...)
1998d59ecb2SHans Petter Selasky {
2008d59ecb2SHans Petter Selasky 	va_list args;
2018d59ecb2SHans Petter Selasky 	int error;
2028d59ecb2SHans Petter Selasky 
2038d59ecb2SHans Petter Selasky 	va_start(args, fmt);
2048d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
2058d59ecb2SHans Petter Selasky 	va_end(args);
2068d59ecb2SHans Petter Selasky 	if (error)
2078d59ecb2SHans Petter Selasky 		return (error);
2088d59ecb2SHans Petter Selasky 
2098d59ecb2SHans Petter Selasky 	return kobject_add_complete(kobj, parent);
2108d59ecb2SHans Petter Selasky }
2118d59ecb2SHans Petter Selasky 
2128d59ecb2SHans Petter Selasky void
21306204f8eSHans Petter Selasky linux_kobject_release(struct kref *kref)
2148d59ecb2SHans Petter Selasky {
2158d59ecb2SHans Petter Selasky 	struct kobject *kobj;
2168d59ecb2SHans Petter Selasky 	char *name;
2178d59ecb2SHans Petter Selasky 
2188d59ecb2SHans Petter Selasky 	kobj = container_of(kref, struct kobject, kref);
2198d59ecb2SHans Petter Selasky 	sysfs_remove_dir(kobj);
2208d59ecb2SHans Petter Selasky 	name = kobj->name;
2218d59ecb2SHans Petter Selasky 	if (kobj->ktype && kobj->ktype->release)
2228d59ecb2SHans Petter Selasky 		kobj->ktype->release(kobj);
2238d59ecb2SHans Petter Selasky 	kfree(name);
2248d59ecb2SHans Petter Selasky }
2258d59ecb2SHans Petter Selasky 
2268d59ecb2SHans Petter Selasky static void
22706204f8eSHans Petter Selasky linux_kobject_kfree(struct kobject *kobj)
2288d59ecb2SHans Petter Selasky {
2298d59ecb2SHans Petter Selasky 	kfree(kobj);
2308d59ecb2SHans Petter Selasky }
2318d59ecb2SHans Petter Selasky 
2328d59ecb2SHans Petter Selasky static void
23306204f8eSHans Petter Selasky linux_kobject_kfree_name(struct kobject *kobj)
2348d59ecb2SHans Petter Selasky {
2358d59ecb2SHans Petter Selasky 	if (kobj) {
2368d59ecb2SHans Petter Selasky 		kfree(kobj->name);
2378d59ecb2SHans Petter Selasky 	}
2388d59ecb2SHans Petter Selasky }
2398d59ecb2SHans Petter Selasky 
24006204f8eSHans Petter Selasky const struct kobj_type linux_kfree_type = {
24106204f8eSHans Petter Selasky 	.release = linux_kobject_kfree
24206204f8eSHans Petter Selasky };
2438d59ecb2SHans Petter Selasky 
2448d59ecb2SHans Petter Selasky static void
24506204f8eSHans Petter Selasky linux_device_release(struct device *dev)
2468d59ecb2SHans Petter Selasky {
24706204f8eSHans Petter Selasky 	pr_debug("linux_device_release: %s\n", dev_name(dev));
2488d59ecb2SHans Petter Selasky 	kfree(dev);
2498d59ecb2SHans Petter Selasky }
2508d59ecb2SHans Petter Selasky 
25106204f8eSHans Petter Selasky static ssize_t
25206204f8eSHans Petter Selasky linux_class_show(struct kobject *kobj, struct attribute *attr, char *buf)
25306204f8eSHans Petter Selasky {
25406204f8eSHans Petter Selasky 	struct class_attribute *dattr;
25506204f8eSHans Petter Selasky 	ssize_t error;
25606204f8eSHans Petter Selasky 
25706204f8eSHans Petter Selasky 	dattr = container_of(attr, struct class_attribute, attr);
25806204f8eSHans Petter Selasky 	error = -EIO;
25906204f8eSHans Petter Selasky 	if (dattr->show)
26006204f8eSHans Petter Selasky 		error = dattr->show(container_of(kobj, struct class, kobj),
26106204f8eSHans Petter Selasky 		    dattr, buf);
26206204f8eSHans Petter Selasky 	return (error);
26306204f8eSHans Petter Selasky }
26406204f8eSHans Petter Selasky 
26506204f8eSHans Petter Selasky static ssize_t
26606204f8eSHans Petter Selasky linux_class_store(struct kobject *kobj, struct attribute *attr, const char *buf,
26706204f8eSHans Petter Selasky     size_t count)
26806204f8eSHans Petter Selasky {
26906204f8eSHans Petter Selasky 	struct class_attribute *dattr;
27006204f8eSHans Petter Selasky 	ssize_t error;
27106204f8eSHans Petter Selasky 
27206204f8eSHans Petter Selasky 	dattr = container_of(attr, struct class_attribute, attr);
27306204f8eSHans Petter Selasky 	error = -EIO;
27406204f8eSHans Petter Selasky 	if (dattr->store)
27506204f8eSHans Petter Selasky 		error = dattr->store(container_of(kobj, struct class, kobj),
27606204f8eSHans Petter Selasky 		    dattr, buf, count);
27706204f8eSHans Petter Selasky 	return (error);
27806204f8eSHans Petter Selasky }
27906204f8eSHans Petter Selasky 
28006204f8eSHans Petter Selasky static void
28106204f8eSHans Petter Selasky linux_class_release(struct kobject *kobj)
28206204f8eSHans Petter Selasky {
28306204f8eSHans Petter Selasky 	struct class *class;
28406204f8eSHans Petter Selasky 
28506204f8eSHans Petter Selasky 	class = container_of(kobj, struct class, kobj);
28606204f8eSHans Petter Selasky 	if (class->class_release)
28706204f8eSHans Petter Selasky 		class->class_release(class);
28806204f8eSHans Petter Selasky }
28906204f8eSHans Petter Selasky 
29006204f8eSHans Petter Selasky static const struct sysfs_ops linux_class_sysfs = {
29106204f8eSHans Petter Selasky 	.show  = linux_class_show,
29206204f8eSHans Petter Selasky 	.store = linux_class_store,
29306204f8eSHans Petter Selasky };
29406204f8eSHans Petter Selasky 
29506204f8eSHans Petter Selasky const struct kobj_type linux_class_ktype = {
29606204f8eSHans Petter Selasky 	.release = linux_class_release,
29706204f8eSHans Petter Selasky 	.sysfs_ops = &linux_class_sysfs
29806204f8eSHans Petter Selasky };
29906204f8eSHans Petter Selasky 
30006204f8eSHans Petter Selasky static void
30106204f8eSHans Petter Selasky linux_dev_release(struct kobject *kobj)
30206204f8eSHans Petter Selasky {
30306204f8eSHans Petter Selasky 	struct device *dev;
30406204f8eSHans Petter Selasky 
30506204f8eSHans Petter Selasky 	dev = container_of(kobj, struct device, kobj);
30606204f8eSHans Petter Selasky 	/* This is the precedence defined by linux. */
30706204f8eSHans Petter Selasky 	if (dev->release)
30806204f8eSHans Petter Selasky 		dev->release(dev);
30906204f8eSHans Petter Selasky 	else if (dev->class && dev->class->dev_release)
31006204f8eSHans Petter Selasky 		dev->class->dev_release(dev);
31106204f8eSHans Petter Selasky }
31206204f8eSHans Petter Selasky 
31306204f8eSHans Petter Selasky static ssize_t
31406204f8eSHans Petter Selasky linux_dev_show(struct kobject *kobj, struct attribute *attr, char *buf)
31506204f8eSHans Petter Selasky {
31606204f8eSHans Petter Selasky 	struct device_attribute *dattr;
31706204f8eSHans Petter Selasky 	ssize_t error;
31806204f8eSHans Petter Selasky 
31906204f8eSHans Petter Selasky 	dattr = container_of(attr, struct device_attribute, attr);
32006204f8eSHans Petter Selasky 	error = -EIO;
32106204f8eSHans Petter Selasky 	if (dattr->show)
32206204f8eSHans Petter Selasky 		error = dattr->show(container_of(kobj, struct device, kobj),
32306204f8eSHans Petter Selasky 		    dattr, buf);
32406204f8eSHans Petter Selasky 	return (error);
32506204f8eSHans Petter Selasky }
32606204f8eSHans Petter Selasky 
32706204f8eSHans Petter Selasky static ssize_t
32806204f8eSHans Petter Selasky linux_dev_store(struct kobject *kobj, struct attribute *attr, const char *buf,
32906204f8eSHans Petter Selasky     size_t count)
33006204f8eSHans Petter Selasky {
33106204f8eSHans Petter Selasky 	struct device_attribute *dattr;
33206204f8eSHans Petter Selasky 	ssize_t error;
33306204f8eSHans Petter Selasky 
33406204f8eSHans Petter Selasky 	dattr = container_of(attr, struct device_attribute, attr);
33506204f8eSHans Petter Selasky 	error = -EIO;
33606204f8eSHans Petter Selasky 	if (dattr->store)
33706204f8eSHans Petter Selasky 		error = dattr->store(container_of(kobj, struct device, kobj),
33806204f8eSHans Petter Selasky 		    dattr, buf, count);
33906204f8eSHans Petter Selasky 	return (error);
34006204f8eSHans Petter Selasky }
34106204f8eSHans Petter Selasky 
34206204f8eSHans Petter Selasky static const struct sysfs_ops linux_dev_sysfs = {
34306204f8eSHans Petter Selasky 	.show  = linux_dev_show,
34406204f8eSHans Petter Selasky 	.store = linux_dev_store,
34506204f8eSHans Petter Selasky };
34606204f8eSHans Petter Selasky 
34706204f8eSHans Petter Selasky const struct kobj_type linux_dev_ktype = {
34806204f8eSHans Petter Selasky 	.release = linux_dev_release,
34906204f8eSHans Petter Selasky 	.sysfs_ops = &linux_dev_sysfs
35006204f8eSHans Petter Selasky };
35106204f8eSHans Petter Selasky 
3528d59ecb2SHans Petter Selasky struct device *
3538d59ecb2SHans Petter Selasky device_create(struct class *class, struct device *parent, dev_t devt,
3548d59ecb2SHans Petter Selasky     void *drvdata, const char *fmt, ...)
3558d59ecb2SHans Petter Selasky {
3568d59ecb2SHans Petter Selasky 	struct device *dev;
3578d59ecb2SHans Petter Selasky 	va_list args;
3588d59ecb2SHans Petter Selasky 
3598d59ecb2SHans Petter Selasky 	dev = kzalloc(sizeof(*dev), M_WAITOK);
3608d59ecb2SHans Petter Selasky 	dev->parent = parent;
3618d59ecb2SHans Petter Selasky 	dev->class = class;
3628d59ecb2SHans Petter Selasky 	dev->devt = devt;
3638d59ecb2SHans Petter Selasky 	dev->driver_data = drvdata;
36406204f8eSHans Petter Selasky 	dev->release = linux_device_release;
3658d59ecb2SHans Petter Selasky 	va_start(args, fmt);
3668d59ecb2SHans Petter Selasky 	kobject_set_name_vargs(&dev->kobj, fmt, args);
3678d59ecb2SHans Petter Selasky 	va_end(args);
3688d59ecb2SHans Petter Selasky 	device_register(dev);
3698d59ecb2SHans Petter Selasky 
3708d59ecb2SHans Petter Selasky 	return (dev);
3718d59ecb2SHans Petter Selasky }
3728d59ecb2SHans Petter Selasky 
3738d59ecb2SHans Petter Selasky int
37406204f8eSHans Petter Selasky kobject_init_and_add(struct kobject *kobj, const struct kobj_type *ktype,
3758d59ecb2SHans Petter Selasky     struct kobject *parent, const char *fmt, ...)
3768d59ecb2SHans Petter Selasky {
3778d59ecb2SHans Petter Selasky 	va_list args;
3788d59ecb2SHans Petter Selasky 	int error;
3798d59ecb2SHans Petter Selasky 
3808d59ecb2SHans Petter Selasky 	kobject_init(kobj, ktype);
3818d59ecb2SHans Petter Selasky 	kobj->ktype = ktype;
3828d59ecb2SHans Petter Selasky 	kobj->parent = parent;
3838d59ecb2SHans Petter Selasky 	kobj->name = NULL;
3848d59ecb2SHans Petter Selasky 
3858d59ecb2SHans Petter Selasky 	va_start(args, fmt);
3868d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
3878d59ecb2SHans Petter Selasky 	va_end(args);
3888d59ecb2SHans Petter Selasky 	if (error)
3898d59ecb2SHans Petter Selasky 		return (error);
3908d59ecb2SHans Petter Selasky 	return kobject_add_complete(kobj, parent);
3918d59ecb2SHans Petter Selasky }
3928d59ecb2SHans Petter Selasky 
393464d20bcSHans Petter Selasky static void
3948d59ecb2SHans Petter Selasky linux_file_dtor(void *cdp)
3958d59ecb2SHans Petter Selasky {
3968d59ecb2SHans Petter Selasky 	struct linux_file *filp;
3978d59ecb2SHans Petter Selasky 
3981e3db1deSHans Petter Selasky 	linux_set_current(curthread);
3998d59ecb2SHans Petter Selasky 	filp = cdp;
4008d59ecb2SHans Petter Selasky 	filp->f_op->release(filp->f_vnode, filp);
4018d59ecb2SHans Petter Selasky 	vdrop(filp->f_vnode);
4028d59ecb2SHans Petter Selasky 	kfree(filp);
4038d59ecb2SHans Petter Selasky }
4048d59ecb2SHans Petter Selasky 
405*a6b28ee0SHans Petter Selasky static void
406*a6b28ee0SHans Petter Selasky linux_kq_lock(void *arg)
407*a6b28ee0SHans Petter Selasky {
408*a6b28ee0SHans Petter Selasky 	spinlock_t *s = arg;
409*a6b28ee0SHans Petter Selasky 
410*a6b28ee0SHans Petter Selasky 	spin_lock(s);
411*a6b28ee0SHans Petter Selasky }
412*a6b28ee0SHans Petter Selasky static void
413*a6b28ee0SHans Petter Selasky linux_kq_unlock(void *arg)
414*a6b28ee0SHans Petter Selasky {
415*a6b28ee0SHans Petter Selasky 	spinlock_t *s = arg;
416*a6b28ee0SHans Petter Selasky 
417*a6b28ee0SHans Petter Selasky 	spin_unlock(s);
418*a6b28ee0SHans Petter Selasky }
419*a6b28ee0SHans Petter Selasky 
420*a6b28ee0SHans Petter Selasky static void
421*a6b28ee0SHans Petter Selasky linux_kq_lock_owned(void *arg)
422*a6b28ee0SHans Petter Selasky {
423*a6b28ee0SHans Petter Selasky #ifdef INVARIANTS
424*a6b28ee0SHans Petter Selasky 	spinlock_t *s = arg;
425*a6b28ee0SHans Petter Selasky 
426*a6b28ee0SHans Petter Selasky 	mtx_assert(&s->m, MA_OWNED);
427*a6b28ee0SHans Petter Selasky #endif
428*a6b28ee0SHans Petter Selasky }
429*a6b28ee0SHans Petter Selasky 
430*a6b28ee0SHans Petter Selasky static void
431*a6b28ee0SHans Petter Selasky linux_kq_lock_unowned(void *arg)
432*a6b28ee0SHans Petter Selasky {
433*a6b28ee0SHans Petter Selasky #ifdef INVARIANTS
434*a6b28ee0SHans Petter Selasky 	spinlock_t *s = arg;
435*a6b28ee0SHans Petter Selasky 
436*a6b28ee0SHans Petter Selasky 	mtx_assert(&s->m, MA_NOTOWNED);
437*a6b28ee0SHans Petter Selasky #endif
438*a6b28ee0SHans Petter Selasky }
439*a6b28ee0SHans Petter Selasky 
440*a6b28ee0SHans Petter Selasky static void
441*a6b28ee0SHans Petter Selasky linux_dev_kqfilter_poll(struct linux_file *);
442*a6b28ee0SHans Petter Selasky 
443*a6b28ee0SHans Petter Selasky struct linux_file *
444*a6b28ee0SHans Petter Selasky linux_file_alloc(void)
445*a6b28ee0SHans Petter Selasky {
446*a6b28ee0SHans Petter Selasky 	struct linux_file *filp;
447*a6b28ee0SHans Petter Selasky 
448*a6b28ee0SHans Petter Selasky 	filp = kzalloc(sizeof(*filp), GFP_KERNEL);
449*a6b28ee0SHans Petter Selasky 
450*a6b28ee0SHans Petter Selasky 	/* set initial refcount */
451*a6b28ee0SHans Petter Selasky 	filp->f_count = 1;
452*a6b28ee0SHans Petter Selasky 
453*a6b28ee0SHans Petter Selasky 	/* setup fields needed by kqueue support */
454*a6b28ee0SHans Petter Selasky 	spin_lock_init(&filp->f_kqlock);
455*a6b28ee0SHans Petter Selasky 	knlist_init(&filp->f_selinfo.si_note, &filp->f_kqlock,
456*a6b28ee0SHans Petter Selasky 	    linux_kq_lock, linux_kq_unlock,
457*a6b28ee0SHans Petter Selasky 	    linux_kq_lock_owned, linux_kq_lock_unowned);
458*a6b28ee0SHans Petter Selasky 
459*a6b28ee0SHans Petter Selasky 	return (filp);
460*a6b28ee0SHans Petter Selasky }
461*a6b28ee0SHans Petter Selasky 
462f5a9867bSHans Petter Selasky void
463f5a9867bSHans Petter Selasky linux_file_free(struct linux_file *filp)
464f5a9867bSHans Petter Selasky {
465f5a9867bSHans Petter Selasky 	if (filp->_file == NULL) {
466f5a9867bSHans Petter Selasky 		kfree(filp);
467f5a9867bSHans Petter Selasky 	} else {
468f5a9867bSHans Petter Selasky 		/*
469f5a9867bSHans Petter Selasky 		 * The close method of the character device or file
470f5a9867bSHans Petter Selasky 		 * will free the linux_file structure:
471f5a9867bSHans Petter Selasky 		 */
472f5a9867bSHans Petter Selasky 		_fdrop(filp->_file, curthread);
473f5a9867bSHans Petter Selasky 	}
474f5a9867bSHans Petter Selasky }
475f5a9867bSHans Petter Selasky 
4768d59ecb2SHans Petter Selasky static int
4771ea4c857SHans Petter Selasky linux_cdev_pager_populate(vm_object_t vm_obj, vm_pindex_t pidx, int fault_type,
4781ea4c857SHans Petter Selasky     vm_prot_t max_prot, vm_pindex_t *first, vm_pindex_t *last)
4791ea4c857SHans Petter Selasky {
4801ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
4811ea4c857SHans Petter Selasky 	struct vm_fault vmf;
4821ea4c857SHans Petter Selasky 	int err;
4831ea4c857SHans Petter Selasky 
4841ea4c857SHans Petter Selasky 	linux_set_current(curthread);
4851ea4c857SHans Petter Selasky 
4861ea4c857SHans Petter Selasky 	/* get VM area structure */
4871ea4c857SHans Petter Selasky 	vmap = linux_cdev_handle_find(vm_obj->handle);
4881ea4c857SHans Petter Selasky 	MPASS(vmap != NULL);
4891ea4c857SHans Petter Selasky 	MPASS(vmap->vm_private_data == vm_obj->handle);
4901ea4c857SHans Petter Selasky 
4911ea4c857SHans Petter Selasky 	/* fill out VM fault structure */
49276fe8c93SHans Petter Selasky 	vmf.virtual_address = (void *)((uintptr_t)pidx << PAGE_SHIFT);
4931ea4c857SHans Petter Selasky 	vmf.flags = (fault_type & VM_PROT_WRITE) ? FAULT_FLAG_WRITE : 0;
4941ea4c857SHans Petter Selasky 	vmf.pgoff = 0;
4951ea4c857SHans Petter Selasky 	vmf.page = NULL;
4961ea4c857SHans Petter Selasky 
4971ea4c857SHans Petter Selasky 	VM_OBJECT_WUNLOCK(vm_obj);
4981ea4c857SHans Petter Selasky 
4991ea4c857SHans Petter Selasky 	down_write(&vmap->vm_mm->mmap_sem);
5001ea4c857SHans Petter Selasky 	if (unlikely(vmap->vm_ops == NULL)) {
5011ea4c857SHans Petter Selasky 		err = VM_FAULT_SIGBUS;
5021ea4c857SHans Petter Selasky 	} else {
5031ea4c857SHans Petter Selasky 		vmap->vm_pfn_count = 0;
5041ea4c857SHans Petter Selasky 		vmap->vm_pfn_pcount = &vmap->vm_pfn_count;
5051ea4c857SHans Petter Selasky 		vmap->vm_obj = vm_obj;
5061ea4c857SHans Petter Selasky 
5071ea4c857SHans Petter Selasky 		err = vmap->vm_ops->fault(vmap, &vmf);
5081ea4c857SHans Petter Selasky 
5091ea4c857SHans Petter Selasky 		while (vmap->vm_pfn_count == 0 && err == VM_FAULT_NOPAGE) {
51002fb845bSMark Johnston 			kern_yield(PRI_USER);
5111ea4c857SHans Petter Selasky 			err = vmap->vm_ops->fault(vmap, &vmf);
5121ea4c857SHans Petter Selasky 		}
5131ea4c857SHans Petter Selasky 	}
5141ea4c857SHans Petter Selasky 
5151ea4c857SHans Petter Selasky 	/* translate return code */
5161ea4c857SHans Petter Selasky 	switch (err) {
5171ea4c857SHans Petter Selasky 	case VM_FAULT_OOM:
5181ea4c857SHans Petter Selasky 		err = VM_PAGER_AGAIN;
5191ea4c857SHans Petter Selasky 		break;
5201ea4c857SHans Petter Selasky 	case VM_FAULT_SIGBUS:
5211ea4c857SHans Petter Selasky 		err = VM_PAGER_BAD;
5221ea4c857SHans Petter Selasky 		break;
5231ea4c857SHans Petter Selasky 	case VM_FAULT_NOPAGE:
5241ea4c857SHans Petter Selasky 		/*
5251ea4c857SHans Petter Selasky 		 * By contract the fault handler will return having
5261ea4c857SHans Petter Selasky 		 * busied all the pages itself. If pidx is already
5271ea4c857SHans Petter Selasky 		 * found in the object, it will simply xbusy the first
5281ea4c857SHans Petter Selasky 		 * page and return with vm_pfn_count set to 1.
5291ea4c857SHans Petter Selasky 		 */
5301ea4c857SHans Petter Selasky 		*first = vmap->vm_pfn_first;
5311ea4c857SHans Petter Selasky 		*last = *first + vmap->vm_pfn_count - 1;
5321ea4c857SHans Petter Selasky 		err = VM_PAGER_OK;
5331ea4c857SHans Petter Selasky 		break;
5341ea4c857SHans Petter Selasky 	default:
5351ea4c857SHans Petter Selasky 		err = VM_PAGER_ERROR;
5361ea4c857SHans Petter Selasky 		break;
5371ea4c857SHans Petter Selasky 	}
5381ea4c857SHans Petter Selasky 	up_write(&vmap->vm_mm->mmap_sem);
5391ea4c857SHans Petter Selasky 	VM_OBJECT_WLOCK(vm_obj);
5401ea4c857SHans Petter Selasky 	return (err);
5411ea4c857SHans Petter Selasky }
5421ea4c857SHans Petter Selasky 
5431ea4c857SHans Petter Selasky static struct rwlock linux_vma_lock;
5441ea4c857SHans Petter Selasky static TAILQ_HEAD(, vm_area_struct) linux_vma_head =
5451ea4c857SHans Petter Selasky     TAILQ_HEAD_INITIALIZER(linux_vma_head);
5461ea4c857SHans Petter Selasky 
547cca15f28SHans Petter Selasky static void
548cca15f28SHans Petter Selasky linux_cdev_handle_free(struct vm_area_struct *vmap)
549cca15f28SHans Petter Selasky {
550d56f1ed8SHans Petter Selasky 	/* Drop reference on vm_file */
551d56f1ed8SHans Petter Selasky 	if (vmap->vm_file != NULL)
552d56f1ed8SHans Petter Selasky 		fput(vmap->vm_file);
553d56f1ed8SHans Petter Selasky 
554cca15f28SHans Petter Selasky 	/* Drop reference on mm_struct */
555cca15f28SHans Petter Selasky 	mmput(vmap->vm_mm);
556cca15f28SHans Petter Selasky 
557cca15f28SHans Petter Selasky 	kfree(vmap);
558cca15f28SHans Petter Selasky }
559cca15f28SHans Petter Selasky 
5601ea4c857SHans Petter Selasky static struct vm_area_struct *
5611ea4c857SHans Petter Selasky linux_cdev_handle_insert(void *handle, struct vm_area_struct *vmap)
5621ea4c857SHans Petter Selasky {
5631ea4c857SHans Petter Selasky 	struct vm_area_struct *ptr;
5641ea4c857SHans Petter Selasky 
5651ea4c857SHans Petter Selasky 	rw_wlock(&linux_vma_lock);
5661ea4c857SHans Petter Selasky 	TAILQ_FOREACH(ptr, &linux_vma_head, vm_entry) {
5671ea4c857SHans Petter Selasky 		if (ptr->vm_private_data == handle) {
5681ea4c857SHans Petter Selasky 			rw_wunlock(&linux_vma_lock);
569cca15f28SHans Petter Selasky 			linux_cdev_handle_free(vmap);
5701ea4c857SHans Petter Selasky 			return (NULL);
5711ea4c857SHans Petter Selasky 		}
5721ea4c857SHans Petter Selasky 	}
5731ea4c857SHans Petter Selasky 	TAILQ_INSERT_TAIL(&linux_vma_head, vmap, vm_entry);
5741ea4c857SHans Petter Selasky 	rw_wunlock(&linux_vma_lock);
5751ea4c857SHans Petter Selasky 	return (vmap);
5761ea4c857SHans Petter Selasky }
5771ea4c857SHans Petter Selasky 
5781ea4c857SHans Petter Selasky static void
5791ea4c857SHans Petter Selasky linux_cdev_handle_remove(struct vm_area_struct *vmap)
5801ea4c857SHans Petter Selasky {
5811ea4c857SHans Petter Selasky 	rw_wlock(&linux_vma_lock);
5821ea4c857SHans Petter Selasky 	TAILQ_REMOVE(&linux_vma_head, vmap, vm_entry);
5831ea4c857SHans Petter Selasky 	rw_wunlock(&linux_vma_lock);
5841ea4c857SHans Petter Selasky }
5851ea4c857SHans Petter Selasky 
5861ea4c857SHans Petter Selasky static struct vm_area_struct *
5871ea4c857SHans Petter Selasky linux_cdev_handle_find(void *handle)
5881ea4c857SHans Petter Selasky {
5891ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
5901ea4c857SHans Petter Selasky 
5911ea4c857SHans Petter Selasky 	rw_rlock(&linux_vma_lock);
5921ea4c857SHans Petter Selasky 	TAILQ_FOREACH(vmap, &linux_vma_head, vm_entry) {
5931ea4c857SHans Petter Selasky 		if (vmap->vm_private_data == handle)
5941ea4c857SHans Petter Selasky 			break;
5951ea4c857SHans Petter Selasky 	}
5961ea4c857SHans Petter Selasky 	rw_runlock(&linux_vma_lock);
5971ea4c857SHans Petter Selasky 	return (vmap);
5981ea4c857SHans Petter Selasky }
5991ea4c857SHans Petter Selasky 
6001ea4c857SHans Petter Selasky static int
6011ea4c857SHans Petter Selasky linux_cdev_pager_ctor(void *handle, vm_ooffset_t size, vm_prot_t prot,
6021ea4c857SHans Petter Selasky 		      vm_ooffset_t foff, struct ucred *cred, u_short *color)
6031ea4c857SHans Petter Selasky {
6041ea4c857SHans Petter Selasky 
605ea67550bSHans Petter Selasky 	MPASS(linux_cdev_handle_find(handle) != NULL);
6061ea4c857SHans Petter Selasky 	*color = 0;
6071ea4c857SHans Petter Selasky 	return (0);
6081ea4c857SHans Petter Selasky }
6091ea4c857SHans Petter Selasky 
6101ea4c857SHans Petter Selasky static void
6111ea4c857SHans Petter Selasky linux_cdev_pager_dtor(void *handle)
6121ea4c857SHans Petter Selasky {
6131ea4c857SHans Petter Selasky 	const struct vm_operations_struct *vm_ops;
6141ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
6151ea4c857SHans Petter Selasky 
6161ea4c857SHans Petter Selasky 	vmap = linux_cdev_handle_find(handle);
6171ea4c857SHans Petter Selasky 	MPASS(vmap != NULL);
6181ea4c857SHans Petter Selasky 
619cca15f28SHans Petter Selasky 	/*
620cca15f28SHans Petter Selasky 	 * Remove handle before calling close operation to prevent
621cca15f28SHans Petter Selasky 	 * other threads from reusing the handle pointer.
622cca15f28SHans Petter Selasky 	 */
623cca15f28SHans Petter Selasky 	linux_cdev_handle_remove(vmap);
624cca15f28SHans Petter Selasky 
6251ea4c857SHans Petter Selasky 	down_write(&vmap->vm_mm->mmap_sem);
6261ea4c857SHans Petter Selasky 	vm_ops = vmap->vm_ops;
6271ea4c857SHans Petter Selasky 	if (likely(vm_ops != NULL))
6281ea4c857SHans Petter Selasky 		vm_ops->close(vmap);
6291ea4c857SHans Petter Selasky 	up_write(&vmap->vm_mm->mmap_sem);
6301ea4c857SHans Petter Selasky 
631cca15f28SHans Petter Selasky 	linux_cdev_handle_free(vmap);
6321ea4c857SHans Petter Selasky }
6331ea4c857SHans Petter Selasky 
6341ea4c857SHans Petter Selasky static struct cdev_pager_ops linux_cdev_pager_ops = {
6351ea4c857SHans Petter Selasky 	.cdev_pg_populate	= linux_cdev_pager_populate,
6361ea4c857SHans Petter Selasky 	.cdev_pg_ctor	= linux_cdev_pager_ctor,
6371ea4c857SHans Petter Selasky 	.cdev_pg_dtor	= linux_cdev_pager_dtor
6381ea4c857SHans Petter Selasky };
6391ea4c857SHans Petter Selasky 
6401ea4c857SHans Petter Selasky static int
6418d59ecb2SHans Petter Selasky linux_dev_open(struct cdev *dev, int oflags, int devtype, struct thread *td)
6428d59ecb2SHans Petter Selasky {
6438d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
6448d59ecb2SHans Petter Selasky 	struct linux_file *filp;
6458d59ecb2SHans Petter Selasky 	struct file *file;
6468d59ecb2SHans Petter Selasky 	int error;
6478d59ecb2SHans Petter Selasky 
648464d20bcSHans Petter Selasky 	file = td->td_fpop;
6498d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
6508d59ecb2SHans Petter Selasky 	if (ldev == NULL)
6518d59ecb2SHans Petter Selasky 		return (ENODEV);
652*a6b28ee0SHans Petter Selasky 
653*a6b28ee0SHans Petter Selasky 	filp = linux_file_alloc();
6548d59ecb2SHans Petter Selasky 	filp->f_dentry = &filp->f_dentry_store;
6558d59ecb2SHans Petter Selasky 	filp->f_op = ldev->ops;
6568d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
6578d59ecb2SHans Petter Selasky 	vhold(file->f_vnode);
6588d59ecb2SHans Petter Selasky 	filp->f_vnode = file->f_vnode;
659f5a9867bSHans Petter Selasky 	filp->_file = file;
660f5a9867bSHans Petter Selasky 
661*a6b28ee0SHans Petter Selasky 	linux_set_current(td);
662*a6b28ee0SHans Petter Selasky 
6638d59ecb2SHans Petter Selasky 	if (filp->f_op->open) {
6648d59ecb2SHans Petter Selasky 		error = -filp->f_op->open(file->f_vnode, filp);
6658d59ecb2SHans Petter Selasky 		if (error) {
666f5a9867bSHans Petter Selasky 			vdrop(filp->f_vnode);
6678d59ecb2SHans Petter Selasky 			kfree(filp);
668464d20bcSHans Petter Selasky 			goto done;
6698d59ecb2SHans Petter Selasky 		}
6708d59ecb2SHans Petter Selasky 	}
6718d59ecb2SHans Petter Selasky 	error = devfs_set_cdevpriv(filp, linux_file_dtor);
6728d59ecb2SHans Petter Selasky 	if (error) {
6738d59ecb2SHans Petter Selasky 		filp->f_op->release(file->f_vnode, filp);
674f5a9867bSHans Petter Selasky 		vdrop(filp->f_vnode);
6758d59ecb2SHans Petter Selasky 		kfree(filp);
6768d59ecb2SHans Petter Selasky 	}
677464d20bcSHans Petter Selasky done:
678464d20bcSHans Petter Selasky 	return (error);
6798d59ecb2SHans Petter Selasky }
6808d59ecb2SHans Petter Selasky 
6818d59ecb2SHans Petter Selasky static int
6828d59ecb2SHans Petter Selasky linux_dev_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
6838d59ecb2SHans Petter Selasky {
6848d59ecb2SHans Petter Selasky 	struct linux_file *filp;
6858d59ecb2SHans Petter Selasky 	struct file *file;
6868d59ecb2SHans Petter Selasky 	int error;
6878d59ecb2SHans Petter Selasky 
688464d20bcSHans Petter Selasky 	file = td->td_fpop;
6896e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
6908d59ecb2SHans Petter Selasky 		return (0);
6918d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
6928d59ecb2SHans Petter Selasky 		return (error);
6938d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
6948d59ecb2SHans Petter Selasky 	devfs_clear_cdevpriv();
6958d59ecb2SHans Petter Selasky 
6968d59ecb2SHans Petter Selasky 	return (0);
6978d59ecb2SHans Petter Selasky }
6988d59ecb2SHans Petter Selasky 
6993a8bec33SHans Petter Selasky #define	LINUX_IOCTL_MIN_PTR 0x10000UL
7003a8bec33SHans Petter Selasky #define	LINUX_IOCTL_MAX_PTR (LINUX_IOCTL_MIN_PTR + IOCPARM_MAX)
7013a8bec33SHans Petter Selasky 
7023a8bec33SHans Petter Selasky static inline int
7033a8bec33SHans Petter Selasky linux_remap_address(void **uaddr, size_t len)
7043a8bec33SHans Petter Selasky {
7053a8bec33SHans Petter Selasky 	uintptr_t uaddr_val = (uintptr_t)(*uaddr);
7063a8bec33SHans Petter Selasky 
7073a8bec33SHans Petter Selasky 	if (unlikely(uaddr_val >= LINUX_IOCTL_MIN_PTR &&
7083a8bec33SHans Petter Selasky 	    uaddr_val < LINUX_IOCTL_MAX_PTR)) {
7093a8bec33SHans Petter Selasky 		struct task_struct *pts = current;
7103a8bec33SHans Petter Selasky 		if (pts == NULL) {
7113a8bec33SHans Petter Selasky 			*uaddr = NULL;
7123a8bec33SHans Petter Selasky 			return (1);
7133a8bec33SHans Petter Selasky 		}
7143a8bec33SHans Petter Selasky 
7153a8bec33SHans Petter Selasky 		/* compute data offset */
7163a8bec33SHans Petter Selasky 		uaddr_val -= LINUX_IOCTL_MIN_PTR;
7173a8bec33SHans Petter Selasky 
7183a8bec33SHans Petter Selasky 		/* check that length is within bounds */
7193a8bec33SHans Petter Selasky 		if ((len > IOCPARM_MAX) ||
7203a8bec33SHans Petter Selasky 		    (uaddr_val + len) > pts->bsd_ioctl_len) {
7213a8bec33SHans Petter Selasky 			*uaddr = NULL;
7223a8bec33SHans Petter Selasky 			return (1);
7233a8bec33SHans Petter Selasky 		}
7243a8bec33SHans Petter Selasky 
7253a8bec33SHans Petter Selasky 		/* re-add kernel buffer address */
7263a8bec33SHans Petter Selasky 		uaddr_val += (uintptr_t)pts->bsd_ioctl_data;
7273a8bec33SHans Petter Selasky 
7283a8bec33SHans Petter Selasky 		/* update address location */
7293a8bec33SHans Petter Selasky 		*uaddr = (void *)uaddr_val;
7303a8bec33SHans Petter Selasky 		return (1);
7313a8bec33SHans Petter Selasky 	}
7323a8bec33SHans Petter Selasky 	return (0);
7333a8bec33SHans Petter Selasky }
7343a8bec33SHans Petter Selasky 
7353a8bec33SHans Petter Selasky int
7363a8bec33SHans Petter Selasky linux_copyin(const void *uaddr, void *kaddr, size_t len)
7373a8bec33SHans Petter Selasky {
7383a8bec33SHans Petter Selasky 	if (linux_remap_address(__DECONST(void **, &uaddr), len)) {
7393a8bec33SHans Petter Selasky 		if (uaddr == NULL)
7403a8bec33SHans Petter Selasky 			return (-EFAULT);
7413a8bec33SHans Petter Selasky 		memcpy(kaddr, uaddr, len);
7423a8bec33SHans Petter Selasky 		return (0);
7433a8bec33SHans Petter Selasky 	}
7443a8bec33SHans Petter Selasky 	return (-copyin(uaddr, kaddr, len));
7453a8bec33SHans Petter Selasky }
7463a8bec33SHans Petter Selasky 
7473a8bec33SHans Petter Selasky int
7483a8bec33SHans Petter Selasky linux_copyout(const void *kaddr, void *uaddr, size_t len)
7493a8bec33SHans Petter Selasky {
7503a8bec33SHans Petter Selasky 	if (linux_remap_address(&uaddr, len)) {
7513a8bec33SHans Petter Selasky 		if (uaddr == NULL)
7523a8bec33SHans Petter Selasky 			return (-EFAULT);
7533a8bec33SHans Petter Selasky 		memcpy(uaddr, kaddr, len);
7543a8bec33SHans Petter Selasky 		return (0);
7553a8bec33SHans Petter Selasky 	}
7563a8bec33SHans Petter Selasky 	return (-copyout(kaddr, uaddr, len));
7573a8bec33SHans Petter Selasky }
7583a8bec33SHans Petter Selasky 
7590e05589bSHans Petter Selasky size_t
7600e05589bSHans Petter Selasky linux_clear_user(void *_uaddr, size_t _len)
7610e05589bSHans Petter Selasky {
7620e05589bSHans Petter Selasky 	uint8_t *uaddr = _uaddr;
7630e05589bSHans Petter Selasky 	size_t len = _len;
7640e05589bSHans Petter Selasky 
7650e05589bSHans Petter Selasky 	/* make sure uaddr is aligned before going into the fast loop */
7660e05589bSHans Petter Selasky 	while (((uintptr_t)uaddr & 7) != 0 && len > 7) {
7670e05589bSHans Petter Selasky 		if (subyte(uaddr, 0))
7680e05589bSHans Petter Selasky 			return (_len);
7690e05589bSHans Petter Selasky 		uaddr++;
7700e05589bSHans Petter Selasky 		len--;
7710e05589bSHans Petter Selasky 	}
7720e05589bSHans Petter Selasky 
7730e05589bSHans Petter Selasky 	/* zero 8 bytes at a time */
7740e05589bSHans Petter Selasky 	while (len > 7) {
7753803a97fSHans Petter Selasky #ifdef __LP64__
7760e05589bSHans Petter Selasky 		if (suword64(uaddr, 0))
7770e05589bSHans Petter Selasky 			return (_len);
7783803a97fSHans Petter Selasky #else
7793803a97fSHans Petter Selasky 		if (suword32(uaddr, 0))
7803803a97fSHans Petter Selasky 			return (_len);
7813803a97fSHans Petter Selasky 		if (suword32(uaddr + 4, 0))
7823803a97fSHans Petter Selasky 			return (_len);
7833803a97fSHans Petter Selasky #endif
7840e05589bSHans Petter Selasky 		uaddr += 8;
7850e05589bSHans Petter Selasky 		len -= 8;
7860e05589bSHans Petter Selasky 	}
7870e05589bSHans Petter Selasky 
7880e05589bSHans Petter Selasky 	/* zero fill end, if any */
7890e05589bSHans Petter Selasky 	while (len > 0) {
7900e05589bSHans Petter Selasky 		if (subyte(uaddr, 0))
7910e05589bSHans Petter Selasky 			return (_len);
7920e05589bSHans Petter Selasky 		uaddr++;
7930e05589bSHans Petter Selasky 		len--;
7940e05589bSHans Petter Selasky 	}
7950e05589bSHans Petter Selasky 	return (0);
7960e05589bSHans Petter Selasky }
7970e05589bSHans Petter Selasky 
7980e05589bSHans Petter Selasky int
7990e05589bSHans Petter Selasky linux_access_ok(int rw, const void *uaddr, size_t len)
8000e05589bSHans Petter Selasky {
8010e05589bSHans Petter Selasky 	uintptr_t saddr;
8020e05589bSHans Petter Selasky 	uintptr_t eaddr;
8030e05589bSHans Petter Selasky 
8040e05589bSHans Petter Selasky 	/* get start and end address */
8050e05589bSHans Petter Selasky 	saddr = (uintptr_t)uaddr;
8060e05589bSHans Petter Selasky 	eaddr = (uintptr_t)uaddr + len;
8070e05589bSHans Petter Selasky 
8080e05589bSHans Petter Selasky 	/* verify addresses are valid for userspace */
8090e05589bSHans Petter Selasky 	return ((saddr == eaddr) ||
8100e05589bSHans Petter Selasky 	    (eaddr > saddr && eaddr <= VM_MAXUSER_ADDRESS));
8110e05589bSHans Petter Selasky }
8120e05589bSHans Petter Selasky 
8138d59ecb2SHans Petter Selasky static int
8148d59ecb2SHans Petter Selasky linux_dev_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag,
8158d59ecb2SHans Petter Selasky     struct thread *td)
8168d59ecb2SHans Petter Selasky {
8178d59ecb2SHans Petter Selasky 	struct linux_file *filp;
8188d59ecb2SHans Petter Selasky 	struct file *file;
8193a8bec33SHans Petter Selasky 	unsigned size;
8208d59ecb2SHans Petter Selasky 	int error;
8218d59ecb2SHans Petter Selasky 
822464d20bcSHans Petter Selasky 	file = td->td_fpop;
8236e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
8246e3e6544SHans Petter Selasky 		return (ENXIO);
8258d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
8268d59ecb2SHans Petter Selasky 		return (error);
8278d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
8281e3db1deSHans Petter Selasky 
8291e3db1deSHans Petter Selasky 	linux_set_current(td);
8303a8bec33SHans Petter Selasky 	size = IOCPARM_LEN(cmd);
8313a8bec33SHans Petter Selasky 	/* refer to logic in sys_ioctl() */
8323a8bec33SHans Petter Selasky 	if (size > 0) {
8338d59ecb2SHans Petter Selasky 		/*
8343a8bec33SHans Petter Selasky 		 * Setup hint for linux_copyin() and linux_copyout().
8353a8bec33SHans Petter Selasky 		 *
8363a8bec33SHans Petter Selasky 		 * Background: Linux code expects a user-space address
8373a8bec33SHans Petter Selasky 		 * while FreeBSD supplies a kernel-space address.
8388d59ecb2SHans Petter Selasky 		 */
8391e3db1deSHans Petter Selasky 		current->bsd_ioctl_data = data;
8401e3db1deSHans Petter Selasky 		current->bsd_ioctl_len = size;
8413a8bec33SHans Petter Selasky 		data = (void *)LINUX_IOCTL_MIN_PTR;
8423a8bec33SHans Petter Selasky 	} else {
8433a8bec33SHans Petter Selasky 		/* fetch user-space pointer */
8448d59ecb2SHans Petter Selasky 		data = *(void **)data;
8453a8bec33SHans Petter Selasky 	}
8468d59ecb2SHans Petter Selasky 	if (filp->f_op->unlocked_ioctl)
8478d59ecb2SHans Petter Selasky 		error = -filp->f_op->unlocked_ioctl(filp, cmd, (u_long)data);
8488d59ecb2SHans Petter Selasky 	else
8498d59ecb2SHans Petter Selasky 		error = ENOTTY;
8501e3db1deSHans Petter Selasky 	if (size > 0) {
8511e3db1deSHans Petter Selasky 		current->bsd_ioctl_data = NULL;
8521e3db1deSHans Petter Selasky 		current->bsd_ioctl_len = 0;
8531e3db1deSHans Petter Selasky 	}
8548d59ecb2SHans Petter Selasky 
855*a6b28ee0SHans Petter Selasky 	if (error == EWOULDBLOCK)
856*a6b28ee0SHans Petter Selasky 		linux_dev_kqfilter_poll(filp);
8578d59ecb2SHans Petter Selasky 	return (error);
8588d59ecb2SHans Petter Selasky }
8598d59ecb2SHans Petter Selasky 
8608d59ecb2SHans Petter Selasky static int
8618d59ecb2SHans Petter Selasky linux_dev_read(struct cdev *dev, struct uio *uio, int ioflag)
8628d59ecb2SHans Petter Selasky {
8638d59ecb2SHans Petter Selasky 	struct linux_file *filp;
864464d20bcSHans Petter Selasky 	struct thread *td;
8658d59ecb2SHans Petter Selasky 	struct file *file;
8668d59ecb2SHans Petter Selasky 	ssize_t bytes;
8678d59ecb2SHans Petter Selasky 	int error;
8688d59ecb2SHans Petter Selasky 
869464d20bcSHans Petter Selasky 	td = curthread;
870464d20bcSHans Petter Selasky 	file = td->td_fpop;
8716e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
8726e3e6544SHans Petter Selasky 		return (ENXIO);
8738d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
8748d59ecb2SHans Petter Selasky 		return (error);
8758d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
876b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
8778d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
878b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
8791e3db1deSHans Petter Selasky 	linux_set_current(td);
8808d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
8818d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
8828d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
8838d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
8848d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
8858d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
8868d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
8878d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
888*a6b28ee0SHans Petter Selasky 		} else {
8898d59ecb2SHans Petter Selasky 			error = -bytes;
890*a6b28ee0SHans Petter Selasky 			if (error == EWOULDBLOCK)
891*a6b28ee0SHans Petter Selasky 				linux_dev_kqfilter_poll(filp);
892*a6b28ee0SHans Petter Selasky 		}
8938d59ecb2SHans Petter Selasky 	} else
8948d59ecb2SHans Petter Selasky 		error = ENXIO;
8958d59ecb2SHans Petter Selasky 
8968d59ecb2SHans Petter Selasky 	return (error);
8978d59ecb2SHans Petter Selasky }
8988d59ecb2SHans Petter Selasky 
8998d59ecb2SHans Petter Selasky static int
9008d59ecb2SHans Petter Selasky linux_dev_write(struct cdev *dev, struct uio *uio, int ioflag)
9018d59ecb2SHans Petter Selasky {
9028d59ecb2SHans Petter Selasky 	struct linux_file *filp;
903464d20bcSHans Petter Selasky 	struct thread *td;
9048d59ecb2SHans Petter Selasky 	struct file *file;
9058d59ecb2SHans Petter Selasky 	ssize_t bytes;
9068d59ecb2SHans Petter Selasky 	int error;
9078d59ecb2SHans Petter Selasky 
908464d20bcSHans Petter Selasky 	td = curthread;
909464d20bcSHans Petter Selasky 	file = td->td_fpop;
9106e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
9116e3e6544SHans Petter Selasky 		return (ENXIO);
9128d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
9138d59ecb2SHans Petter Selasky 		return (error);
9148d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
915b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
9168d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
917b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
9181e3db1deSHans Petter Selasky 	linux_set_current(td);
9198d59ecb2SHans Petter Selasky 	if (filp->f_op->write) {
9208d59ecb2SHans Petter Selasky 		bytes = filp->f_op->write(filp, uio->uio_iov->iov_base,
9218d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
9228d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
9238d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
9248d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
9258d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
9268d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
927*a6b28ee0SHans Petter Selasky 		} else {
9288d59ecb2SHans Petter Selasky 			error = -bytes;
929*a6b28ee0SHans Petter Selasky 			if (error == EWOULDBLOCK)
930*a6b28ee0SHans Petter Selasky 				linux_dev_kqfilter_poll(filp);
931*a6b28ee0SHans Petter Selasky 		}
9328d59ecb2SHans Petter Selasky 	} else
9338d59ecb2SHans Petter Selasky 		error = ENXIO;
9348d59ecb2SHans Petter Selasky 
9358d59ecb2SHans Petter Selasky 	return (error);
9368d59ecb2SHans Petter Selasky }
9378d59ecb2SHans Petter Selasky 
9388d59ecb2SHans Petter Selasky static int
9398d59ecb2SHans Petter Selasky linux_dev_poll(struct cdev *dev, int events, struct thread *td)
9408d59ecb2SHans Petter Selasky {
9418d59ecb2SHans Petter Selasky 	struct linux_file *filp;
9428d59ecb2SHans Petter Selasky 	struct file *file;
9438d59ecb2SHans Petter Selasky 	int revents;
9446e3e6544SHans Petter Selasky 
9456e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
9466e3e6544SHans Petter Selasky 		goto error;
9476e3e6544SHans Petter Selasky 	if (devfs_get_cdevpriv((void **)&filp) != 0)
9486e3e6544SHans Petter Selasky 		goto error;
9498d59ecb2SHans Petter Selasky 
950464d20bcSHans Petter Selasky 	file = td->td_fpop;
9518d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
9521e3db1deSHans Petter Selasky 	linux_set_current(td);
9538d59ecb2SHans Petter Selasky 	if (filp->f_op->poll)
9548d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
9558d59ecb2SHans Petter Selasky 	else
9568d59ecb2SHans Petter Selasky 		revents = 0;
9578d59ecb2SHans Petter Selasky 
9588d59ecb2SHans Petter Selasky 	return (revents);
9596e3e6544SHans Petter Selasky error:
9606e3e6544SHans Petter Selasky 	return (events & (POLLHUP|POLLIN|POLLRDNORM|POLLOUT|POLLWRNORM));
9618d59ecb2SHans Petter Selasky }
9628d59ecb2SHans Petter Selasky 
963*a6b28ee0SHans Petter Selasky void
964*a6b28ee0SHans Petter Selasky linux_poll_wakeup(struct linux_file *filp)
965*a6b28ee0SHans Petter Selasky {
966*a6b28ee0SHans Petter Selasky 	/* this function should be NULL-safe */
967*a6b28ee0SHans Petter Selasky 	if (filp == NULL)
968*a6b28ee0SHans Petter Selasky 		return;
969*a6b28ee0SHans Petter Selasky 
970*a6b28ee0SHans Petter Selasky 	selwakeup(&filp->f_selinfo);
971*a6b28ee0SHans Petter Selasky 
972*a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
973*a6b28ee0SHans Petter Selasky 	filp->f_kqflags |= LINUX_KQ_FLAG_NEED_READ |
974*a6b28ee0SHans Petter Selasky 	    LINUX_KQ_FLAG_NEED_WRITE;
975*a6b28ee0SHans Petter Selasky 
976*a6b28ee0SHans Petter Selasky 	/* make sure the "knote" gets woken up */
977*a6b28ee0SHans Petter Selasky 	KNOTE_LOCKED(&filp->f_selinfo.si_note, 1);
978*a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
979*a6b28ee0SHans Petter Selasky }
980*a6b28ee0SHans Petter Selasky 
981*a6b28ee0SHans Petter Selasky static void
982*a6b28ee0SHans Petter Selasky linux_dev_kqfilter_detach(struct knote *kn)
983*a6b28ee0SHans Petter Selasky {
984*a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
985*a6b28ee0SHans Petter Selasky 
986*a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
987*a6b28ee0SHans Petter Selasky 	knlist_remove(&filp->f_selinfo.si_note, kn, 1);
988*a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
989*a6b28ee0SHans Petter Selasky }
990*a6b28ee0SHans Petter Selasky 
991*a6b28ee0SHans Petter Selasky static int
992*a6b28ee0SHans Petter Selasky linux_dev_kqfilter_read_event(struct knote *kn, long hint)
993*a6b28ee0SHans Petter Selasky {
994*a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
995*a6b28ee0SHans Petter Selasky 
996*a6b28ee0SHans Petter Selasky 	mtx_assert(&filp->f_kqlock.m, MA_OWNED);
997*a6b28ee0SHans Petter Selasky 
998*a6b28ee0SHans Petter Selasky 	return ((filp->f_kqflags & LINUX_KQ_FLAG_NEED_READ) ? 1 : 0);
999*a6b28ee0SHans Petter Selasky }
1000*a6b28ee0SHans Petter Selasky 
1001*a6b28ee0SHans Petter Selasky static int
1002*a6b28ee0SHans Petter Selasky linux_dev_kqfilter_write_event(struct knote *kn, long hint)
1003*a6b28ee0SHans Petter Selasky {
1004*a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
1005*a6b28ee0SHans Petter Selasky 
1006*a6b28ee0SHans Petter Selasky 	mtx_assert(&filp->f_kqlock.m, MA_OWNED);
1007*a6b28ee0SHans Petter Selasky 
1008*a6b28ee0SHans Petter Selasky 	return ((filp->f_kqflags & LINUX_KQ_FLAG_NEED_WRITE) ? 1 : 0);
1009*a6b28ee0SHans Petter Selasky }
1010*a6b28ee0SHans Petter Selasky 
1011*a6b28ee0SHans Petter Selasky static struct filterops linux_dev_kqfiltops_read = {
1012*a6b28ee0SHans Petter Selasky 	.f_isfd = 1,
1013*a6b28ee0SHans Petter Selasky 	.f_detach = linux_dev_kqfilter_detach,
1014*a6b28ee0SHans Petter Selasky 	.f_event = linux_dev_kqfilter_read_event,
1015*a6b28ee0SHans Petter Selasky };
1016*a6b28ee0SHans Petter Selasky 
1017*a6b28ee0SHans Petter Selasky static struct filterops linux_dev_kqfiltops_write = {
1018*a6b28ee0SHans Petter Selasky 	.f_isfd = 1,
1019*a6b28ee0SHans Petter Selasky 	.f_detach = linux_dev_kqfilter_detach,
1020*a6b28ee0SHans Petter Selasky 	.f_event = linux_dev_kqfilter_write_event,
1021*a6b28ee0SHans Petter Selasky };
1022*a6b28ee0SHans Petter Selasky 
1023*a6b28ee0SHans Petter Selasky static void
1024*a6b28ee0SHans Petter Selasky linux_dev_kqfilter_poll(struct linux_file *filp)
1025*a6b28ee0SHans Petter Selasky {
1026*a6b28ee0SHans Petter Selasky 	int temp;
1027*a6b28ee0SHans Petter Selasky 
1028*a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
1029*a6b28ee0SHans Petter Selasky 	temp = (filp->f_kqflags & (LINUX_KQ_FLAG_HAS_READ | LINUX_KQ_FLAG_HAS_WRITE));
1030*a6b28ee0SHans Petter Selasky 	filp->f_kqflags &= ~(LINUX_KQ_FLAG_NEED_READ | LINUX_KQ_FLAG_NEED_WRITE);
1031*a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
1032*a6b28ee0SHans Petter Selasky 
1033*a6b28ee0SHans Petter Selasky 	if (temp != 0) {
1034*a6b28ee0SHans Petter Selasky 		/* get the latest polling state */
1035*a6b28ee0SHans Petter Selasky 		temp = filp->f_op->poll(filp, NULL);
1036*a6b28ee0SHans Petter Selasky 
1037*a6b28ee0SHans Petter Selasky 		if (temp & (POLLIN | POLLOUT)) {
1038*a6b28ee0SHans Petter Selasky 			spin_lock(&filp->f_kqlock);
1039*a6b28ee0SHans Petter Selasky 			if (temp & POLLIN)
1040*a6b28ee0SHans Petter Selasky 				filp->f_kqflags |= LINUX_KQ_FLAG_NEED_READ;
1041*a6b28ee0SHans Petter Selasky 			if (temp & POLLOUT)
1042*a6b28ee0SHans Petter Selasky 				filp->f_kqflags |= LINUX_KQ_FLAG_NEED_WRITE;
1043*a6b28ee0SHans Petter Selasky 
1044*a6b28ee0SHans Petter Selasky 			/* make sure the "knote" gets woken up */
1045*a6b28ee0SHans Petter Selasky 			KNOTE_LOCKED(&filp->f_selinfo.si_note, 0);
1046*a6b28ee0SHans Petter Selasky 			spin_unlock(&filp->f_kqlock);
1047*a6b28ee0SHans Petter Selasky 		}
1048*a6b28ee0SHans Petter Selasky 	}
1049*a6b28ee0SHans Petter Selasky }
1050*a6b28ee0SHans Petter Selasky 
1051*a6b28ee0SHans Petter Selasky static int
1052*a6b28ee0SHans Petter Selasky linux_dev_kqfilter(struct cdev *dev, struct knote *kn)
1053*a6b28ee0SHans Petter Selasky {
1054*a6b28ee0SHans Petter Selasky 	struct linux_file *filp;
1055*a6b28ee0SHans Petter Selasky 	struct file *file;
1056*a6b28ee0SHans Petter Selasky 	struct thread *td;
1057*a6b28ee0SHans Petter Selasky 	int error;
1058*a6b28ee0SHans Petter Selasky 
1059*a6b28ee0SHans Petter Selasky 	td = curthread;
1060*a6b28ee0SHans Petter Selasky 	file = td->td_fpop;
1061*a6b28ee0SHans Petter Selasky 	if (dev->si_drv1 == NULL)
1062*a6b28ee0SHans Petter Selasky 		return (ENXIO);
1063*a6b28ee0SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
1064*a6b28ee0SHans Petter Selasky 		return (error);
1065*a6b28ee0SHans Petter Selasky 	filp->f_flags = file->f_flag;
1066*a6b28ee0SHans Petter Selasky 	if (filp->f_op->poll == NULL)
1067*a6b28ee0SHans Petter Selasky 		return (EINVAL);
1068*a6b28ee0SHans Petter Selasky 
1069*a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
1070*a6b28ee0SHans Petter Selasky 	switch (kn->kn_filter) {
1071*a6b28ee0SHans Petter Selasky 	case EVFILT_READ:
1072*a6b28ee0SHans Petter Selasky 		filp->f_kqflags |= LINUX_KQ_FLAG_HAS_READ;
1073*a6b28ee0SHans Petter Selasky 		kn->kn_fop = &linux_dev_kqfiltops_read;
1074*a6b28ee0SHans Petter Selasky 		kn->kn_hook = filp;
1075*a6b28ee0SHans Petter Selasky 		knlist_add(&filp->f_selinfo.si_note, kn, 1);
1076*a6b28ee0SHans Petter Selasky 		break;
1077*a6b28ee0SHans Petter Selasky 	case EVFILT_WRITE:
1078*a6b28ee0SHans Petter Selasky 		filp->f_kqflags |= LINUX_KQ_FLAG_HAS_WRITE;
1079*a6b28ee0SHans Petter Selasky 		kn->kn_fop = &linux_dev_kqfiltops_write;
1080*a6b28ee0SHans Petter Selasky 		kn->kn_hook = filp;
1081*a6b28ee0SHans Petter Selasky 		knlist_add(&filp->f_selinfo.si_note, kn, 1);
1082*a6b28ee0SHans Petter Selasky 		break;
1083*a6b28ee0SHans Petter Selasky 	default:
1084*a6b28ee0SHans Petter Selasky 		error = EINVAL;
1085*a6b28ee0SHans Petter Selasky 		break;
1086*a6b28ee0SHans Petter Selasky 	}
1087*a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
1088*a6b28ee0SHans Petter Selasky 
1089*a6b28ee0SHans Petter Selasky 	if (error == 0) {
1090*a6b28ee0SHans Petter Selasky 		linux_set_current(td);
1091*a6b28ee0SHans Petter Selasky 		linux_dev_kqfilter_poll(filp);
1092*a6b28ee0SHans Petter Selasky 	}
1093*a6b28ee0SHans Petter Selasky 	return (error);
1094*a6b28ee0SHans Petter Selasky }
1095*a6b28ee0SHans Petter Selasky 
10968d59ecb2SHans Petter Selasky static int
10978d59ecb2SHans Petter Selasky linux_dev_mmap_single(struct cdev *dev, vm_ooffset_t *offset,
10988d59ecb2SHans Petter Selasky     vm_size_t size, struct vm_object **object, int nprot)
10998d59ecb2SHans Petter Selasky {
11001ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
1101cca15f28SHans Petter Selasky 	struct mm_struct *mm;
11028d59ecb2SHans Petter Selasky 	struct linux_file *filp;
1103464d20bcSHans Petter Selasky 	struct thread *td;
11048d59ecb2SHans Petter Selasky 	struct file *file;
11051ea4c857SHans Petter Selasky 	vm_memattr_t attr;
11068d59ecb2SHans Petter Selasky 	int error;
11078d59ecb2SHans Petter Selasky 
1108464d20bcSHans Petter Selasky 	td = curthread;
1109464d20bcSHans Petter Selasky 	file = td->td_fpop;
11106e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
11118d59ecb2SHans Petter Selasky 		return (ENODEV);
11128d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
11138d59ecb2SHans Petter Selasky 		return (error);
11148d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
11151ea4c857SHans Petter Selasky 
11161ea4c857SHans Petter Selasky 	if (filp->f_op->mmap == NULL)
11171ea4c857SHans Petter Selasky 		return (ENODEV);
11181ea4c857SHans Petter Selasky 
11191e3db1deSHans Petter Selasky 	linux_set_current(td);
11201ea4c857SHans Petter Selasky 
1121cca15f28SHans Petter Selasky 	/*
1122cca15f28SHans Petter Selasky 	 * The same VM object might be shared by multiple processes
1123cca15f28SHans Petter Selasky 	 * and the mm_struct is usually freed when a process exits.
1124cca15f28SHans Petter Selasky 	 *
1125cca15f28SHans Petter Selasky 	 * The atomic reference below makes sure the mm_struct is
1126cca15f28SHans Petter Selasky 	 * available as long as the vmap is in the linux_vma_head.
1127cca15f28SHans Petter Selasky 	 */
1128cca15f28SHans Petter Selasky 	mm = current->mm;
1129cca15f28SHans Petter Selasky 	if (atomic_inc_not_zero(&mm->mm_users) == 0)
1130cca15f28SHans Petter Selasky 		return (EINVAL);
1131cca15f28SHans Petter Selasky 
11321ea4c857SHans Petter Selasky 	vmap = kzalloc(sizeof(*vmap), GFP_KERNEL);
11331ea4c857SHans Petter Selasky 	vmap->vm_start = 0;
11341ea4c857SHans Petter Selasky 	vmap->vm_end = size;
11351ea4c857SHans Petter Selasky 	vmap->vm_pgoff = *offset / PAGE_SIZE;
11361ea4c857SHans Petter Selasky 	vmap->vm_pfn = 0;
11371ea4c857SHans Petter Selasky 	vmap->vm_flags = vmap->vm_page_prot = nprot;
11381ea4c857SHans Petter Selasky 	vmap->vm_ops = NULL;
1139d56f1ed8SHans Petter Selasky 	vmap->vm_file = get_file(filp);
1140cca15f28SHans Petter Selasky 	vmap->vm_mm = mm;
11411ea4c857SHans Petter Selasky 
11421ea4c857SHans Petter Selasky 	if (unlikely(down_write_killable(&vmap->vm_mm->mmap_sem))) {
11431ea4c857SHans Petter Selasky 		error = EINTR;
11441ea4c857SHans Petter Selasky 	} else {
11451ea4c857SHans Petter Selasky 		error = -filp->f_op->mmap(filp, vmap);
11461ea4c857SHans Petter Selasky 		up_write(&vmap->vm_mm->mmap_sem);
11471ea4c857SHans Petter Selasky 	}
11481ea4c857SHans Petter Selasky 
11491ea4c857SHans Petter Selasky 	if (error != 0) {
1150cca15f28SHans Petter Selasky 		linux_cdev_handle_free(vmap);
11511ea4c857SHans Petter Selasky 		return (error);
11521ea4c857SHans Petter Selasky 	}
11531ea4c857SHans Petter Selasky 
11541ea4c857SHans Petter Selasky 	attr = pgprot2cachemode(vmap->vm_page_prot);
11551ea4c857SHans Petter Selasky 
11561ea4c857SHans Petter Selasky 	if (vmap->vm_ops != NULL) {
11571ea4c857SHans Petter Selasky 		void *vm_private_data;
11581ea4c857SHans Petter Selasky 
11591ea4c857SHans Petter Selasky 		if (vmap->vm_ops->fault == NULL ||
11601ea4c857SHans Petter Selasky 		    vmap->vm_ops->open == NULL ||
11611ea4c857SHans Petter Selasky 		    vmap->vm_ops->close == NULL ||
11621ea4c857SHans Petter Selasky 		    vmap->vm_private_data == NULL) {
1163cca15f28SHans Petter Selasky 			linux_cdev_handle_free(vmap);
11641ea4c857SHans Petter Selasky 			return (EINVAL);
11651ea4c857SHans Petter Selasky 		}
11661ea4c857SHans Petter Selasky 
11671ea4c857SHans Petter Selasky 		vm_private_data = vmap->vm_private_data;
11681ea4c857SHans Petter Selasky 
11691ea4c857SHans Petter Selasky 		vmap = linux_cdev_handle_insert(vm_private_data, vmap);
11701ea4c857SHans Petter Selasky 
11711ea4c857SHans Petter Selasky 		*object = cdev_pager_allocate(vm_private_data, OBJT_MGTDEVICE,
11721ea4c857SHans Petter Selasky 		    &linux_cdev_pager_ops, size, nprot, *offset, curthread->td_ucred);
11731ea4c857SHans Petter Selasky 
11741ea4c857SHans Petter Selasky 		if (*object == NULL) {
11751ea4c857SHans Petter Selasky 			linux_cdev_handle_remove(vmap);
1176cca15f28SHans Petter Selasky 			linux_cdev_handle_free(vmap);
11771ea4c857SHans Petter Selasky 			return (EINVAL);
11781ea4c857SHans Petter Selasky 		}
11791ea4c857SHans Petter Selasky 	} else {
11808d59ecb2SHans Petter Selasky 		struct sglist *sg;
11818d59ecb2SHans Petter Selasky 
11828d59ecb2SHans Petter Selasky 		sg = sglist_alloc(1, M_WAITOK);
11831ea4c857SHans Petter Selasky 		sglist_append_phys(sg, (vm_paddr_t)vmap->vm_pfn << PAGE_SHIFT, vmap->vm_len);
11841ea4c857SHans Petter Selasky 
11851ea4c857SHans Petter Selasky 		*object = vm_pager_allocate(OBJT_SG, sg, vmap->vm_len,
11861ea4c857SHans Petter Selasky 		    nprot, 0, curthread->td_ucred);
11871ea4c857SHans Petter Selasky 
1188cca15f28SHans Petter Selasky 		linux_cdev_handle_free(vmap);
11891ea4c857SHans Petter Selasky 
11908d59ecb2SHans Petter Selasky 		if (*object == NULL) {
11918d59ecb2SHans Petter Selasky 			sglist_free(sg);
11921ea4c857SHans Petter Selasky 			return (EINVAL);
11938d59ecb2SHans Petter Selasky 		}
11941ea4c857SHans Petter Selasky 	}
11951ea4c857SHans Petter Selasky 
11961ea4c857SHans Petter Selasky 	if (attr != VM_MEMATTR_DEFAULT) {
11978d59ecb2SHans Petter Selasky 		VM_OBJECT_WLOCK(*object);
11981ea4c857SHans Petter Selasky 		vm_object_set_memattr(*object, attr);
11998d59ecb2SHans Petter Selasky 		VM_OBJECT_WUNLOCK(*object);
12008d59ecb2SHans Petter Selasky 	}
12011ea4c857SHans Petter Selasky 	*offset = 0;
12021ea4c857SHans Petter Selasky 	return (0);
12038d59ecb2SHans Petter Selasky }
12048d59ecb2SHans Petter Selasky 
12058d59ecb2SHans Petter Selasky struct cdevsw linuxcdevsw = {
12068d59ecb2SHans Petter Selasky 	.d_version = D_VERSION,
12078d59ecb2SHans Petter Selasky 	.d_flags = D_TRACKCLOSE,
12088d59ecb2SHans Petter Selasky 	.d_open = linux_dev_open,
12098d59ecb2SHans Petter Selasky 	.d_close = linux_dev_close,
12108d59ecb2SHans Petter Selasky 	.d_read = linux_dev_read,
12118d59ecb2SHans Petter Selasky 	.d_write = linux_dev_write,
12128d59ecb2SHans Petter Selasky 	.d_ioctl = linux_dev_ioctl,
12138d59ecb2SHans Petter Selasky 	.d_mmap_single = linux_dev_mmap_single,
12148d59ecb2SHans Petter Selasky 	.d_poll = linux_dev_poll,
1215*a6b28ee0SHans Petter Selasky 	.d_kqfilter = linux_dev_kqfilter,
121690b30e65SHans Petter Selasky 	.d_name = "lkpidev",
12178d59ecb2SHans Petter Selasky };
12188d59ecb2SHans Petter Selasky 
12198d59ecb2SHans Petter Selasky static int
12208d59ecb2SHans Petter Selasky linux_file_read(struct file *file, struct uio *uio, struct ucred *active_cred,
12218d59ecb2SHans Petter Selasky     int flags, struct thread *td)
12228d59ecb2SHans Petter Selasky {
12238d59ecb2SHans Petter Selasky 	struct linux_file *filp;
12248d59ecb2SHans Petter Selasky 	ssize_t bytes;
12258d59ecb2SHans Petter Selasky 	int error;
12268d59ecb2SHans Petter Selasky 
12278d59ecb2SHans Petter Selasky 	error = 0;
12288d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
12298d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
1230b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
12318d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
1232b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
12331e3db1deSHans Petter Selasky 	linux_set_current(td);
12348d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
12358d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
12368d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
12378d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
12388d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
12398d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
12408d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
12418d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
12428d59ecb2SHans Petter Selasky 		} else
12438d59ecb2SHans Petter Selasky 			error = -bytes;
12448d59ecb2SHans Petter Selasky 	} else
12458d59ecb2SHans Petter Selasky 		error = ENXIO;
12468d59ecb2SHans Petter Selasky 
12478d59ecb2SHans Petter Selasky 	return (error);
12488d59ecb2SHans Petter Selasky }
12498d59ecb2SHans Petter Selasky 
12508d59ecb2SHans Petter Selasky static int
12518d59ecb2SHans Petter Selasky linux_file_poll(struct file *file, int events, struct ucred *active_cred,
12528d59ecb2SHans Petter Selasky     struct thread *td)
12538d59ecb2SHans Petter Selasky {
12548d59ecb2SHans Petter Selasky 	struct linux_file *filp;
12558d59ecb2SHans Petter Selasky 	int revents;
12568d59ecb2SHans Petter Selasky 
12578d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
12588d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
12591e3db1deSHans Petter Selasky 	linux_set_current(td);
12608d59ecb2SHans Petter Selasky 	if (filp->f_op->poll)
12618d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
12628d59ecb2SHans Petter Selasky 	else
12638d59ecb2SHans Petter Selasky 		revents = 0;
12648d59ecb2SHans Petter Selasky 
12650754e66cSHans Petter Selasky 	return (revents);
12668d59ecb2SHans Petter Selasky }
12678d59ecb2SHans Petter Selasky 
12688d59ecb2SHans Petter Selasky static int
12698d59ecb2SHans Petter Selasky linux_file_close(struct file *file, struct thread *td)
12708d59ecb2SHans Petter Selasky {
12718d59ecb2SHans Petter Selasky 	struct linux_file *filp;
12728d59ecb2SHans Petter Selasky 	int error;
12738d59ecb2SHans Petter Selasky 
12748d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
12758d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
12761e3db1deSHans Petter Selasky 	linux_set_current(td);
12778d59ecb2SHans Petter Selasky 	error = -filp->f_op->release(NULL, filp);
12788d59ecb2SHans Petter Selasky 	funsetown(&filp->f_sigio);
12798d59ecb2SHans Petter Selasky 	kfree(filp);
12808d59ecb2SHans Petter Selasky 
12818d59ecb2SHans Petter Selasky 	return (error);
12828d59ecb2SHans Petter Selasky }
12838d59ecb2SHans Petter Selasky 
12848d59ecb2SHans Petter Selasky static int
12858d59ecb2SHans Petter Selasky linux_file_ioctl(struct file *fp, u_long cmd, void *data, struct ucred *cred,
12868d59ecb2SHans Petter Selasky     struct thread *td)
12878d59ecb2SHans Petter Selasky {
12888d59ecb2SHans Petter Selasky 	struct linux_file *filp;
12898d59ecb2SHans Petter Selasky 	int error;
12908d59ecb2SHans Petter Selasky 
12918d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)fp->f_data;
12928d59ecb2SHans Petter Selasky 	filp->f_flags = fp->f_flag;
12938d59ecb2SHans Petter Selasky 	error = 0;
12948d59ecb2SHans Petter Selasky 
12951e3db1deSHans Petter Selasky 	linux_set_current(td);
12968d59ecb2SHans Petter Selasky 	switch (cmd) {
12978d59ecb2SHans Petter Selasky 	case FIONBIO:
12988d59ecb2SHans Petter Selasky 		break;
12998d59ecb2SHans Petter Selasky 	case FIOASYNC:
13008d59ecb2SHans Petter Selasky 		if (filp->f_op->fasync == NULL)
13018d59ecb2SHans Petter Selasky 			break;
13028d59ecb2SHans Petter Selasky 		error = filp->f_op->fasync(0, filp, fp->f_flag & FASYNC);
13038d59ecb2SHans Petter Selasky 		break;
13048d59ecb2SHans Petter Selasky 	case FIOSETOWN:
13058d59ecb2SHans Petter Selasky 		error = fsetown(*(int *)data, &filp->f_sigio);
13068d59ecb2SHans Petter Selasky 		if (error == 0)
13078d59ecb2SHans Petter Selasky 			error = filp->f_op->fasync(0, filp,
13088d59ecb2SHans Petter Selasky 			    fp->f_flag & FASYNC);
13098d59ecb2SHans Petter Selasky 		break;
13108d59ecb2SHans Petter Selasky 	case FIOGETOWN:
13118d59ecb2SHans Petter Selasky 		*(int *)data = fgetown(&filp->f_sigio);
13128d59ecb2SHans Petter Selasky 		break;
13138d59ecb2SHans Petter Selasky 	default:
13148d59ecb2SHans Petter Selasky 		error = ENOTTY;
13158d59ecb2SHans Petter Selasky 		break;
13168d59ecb2SHans Petter Selasky 	}
13178d59ecb2SHans Petter Selasky 	return (error);
13188d59ecb2SHans Petter Selasky }
13198d59ecb2SHans Petter Selasky 
13208d59ecb2SHans Petter Selasky static int
13218d59ecb2SHans Petter Selasky linux_file_stat(struct file *fp, struct stat *sb, struct ucred *active_cred,
13228d59ecb2SHans Petter Selasky     struct thread *td)
13238d59ecb2SHans Petter Selasky {
13248d59ecb2SHans Petter Selasky 
13258d59ecb2SHans Petter Selasky 	return (EOPNOTSUPP);
13268d59ecb2SHans Petter Selasky }
13278d59ecb2SHans Petter Selasky 
13288d59ecb2SHans Petter Selasky static int
13298d59ecb2SHans Petter Selasky linux_file_fill_kinfo(struct file *fp, struct kinfo_file *kif,
13308d59ecb2SHans Petter Selasky     struct filedesc *fdp)
13318d59ecb2SHans Petter Selasky {
13328d59ecb2SHans Petter Selasky 
13338d59ecb2SHans Petter Selasky 	return (0);
13348d59ecb2SHans Petter Selasky }
13358d59ecb2SHans Petter Selasky 
13368d59ecb2SHans Petter Selasky struct fileops linuxfileops = {
13378d59ecb2SHans Petter Selasky 	.fo_read = linux_file_read,
13388d59ecb2SHans Petter Selasky 	.fo_write = invfo_rdwr,
13398d59ecb2SHans Petter Selasky 	.fo_truncate = invfo_truncate,
13408d59ecb2SHans Petter Selasky 	.fo_kqfilter = invfo_kqfilter,
13418d59ecb2SHans Petter Selasky 	.fo_stat = linux_file_stat,
13428d59ecb2SHans Petter Selasky 	.fo_fill_kinfo = linux_file_fill_kinfo,
13438d59ecb2SHans Petter Selasky 	.fo_poll = linux_file_poll,
13448d59ecb2SHans Petter Selasky 	.fo_close = linux_file_close,
13458d59ecb2SHans Petter Selasky 	.fo_ioctl = linux_file_ioctl,
13468d59ecb2SHans Petter Selasky 	.fo_chmod = invfo_chmod,
13478d59ecb2SHans Petter Selasky 	.fo_chown = invfo_chown,
13488d59ecb2SHans Petter Selasky 	.fo_sendfile = invfo_sendfile,
13498d59ecb2SHans Petter Selasky };
13508d59ecb2SHans Petter Selasky 
13518d59ecb2SHans Petter Selasky /*
13528d59ecb2SHans Petter Selasky  * Hash of vmmap addresses.  This is infrequently accessed and does not
13538d59ecb2SHans Petter Selasky  * need to be particularly large.  This is done because we must store the
13548d59ecb2SHans Petter Selasky  * caller's idea of the map size to properly unmap.
13558d59ecb2SHans Petter Selasky  */
13568d59ecb2SHans Petter Selasky struct vmmap {
13578d59ecb2SHans Petter Selasky 	LIST_ENTRY(vmmap)	vm_next;
13588d59ecb2SHans Petter Selasky 	void 			*vm_addr;
13598d59ecb2SHans Petter Selasky 	unsigned long		vm_size;
13608d59ecb2SHans Petter Selasky };
13618d59ecb2SHans Petter Selasky 
13628d59ecb2SHans Petter Selasky struct vmmaphd {
13638d59ecb2SHans Petter Selasky 	struct vmmap *lh_first;
13648d59ecb2SHans Petter Selasky };
13658d59ecb2SHans Petter Selasky #define	VMMAP_HASH_SIZE	64
13668d59ecb2SHans Petter Selasky #define	VMMAP_HASH_MASK	(VMMAP_HASH_SIZE - 1)
13678d59ecb2SHans Petter Selasky #define	VM_HASH(addr)	((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK
13688d59ecb2SHans Petter Selasky static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE];
13698d59ecb2SHans Petter Selasky static struct mtx vmmaplock;
13708d59ecb2SHans Petter Selasky 
13718d59ecb2SHans Petter Selasky static void
13728d59ecb2SHans Petter Selasky vmmap_add(void *addr, unsigned long size)
13738d59ecb2SHans Petter Selasky {
13748d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
13758d59ecb2SHans Petter Selasky 
13768d59ecb2SHans Petter Selasky 	vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL);
13778d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
13788d59ecb2SHans Petter Selasky 	vmmap->vm_size = size;
13798d59ecb2SHans Petter Selasky 	vmmap->vm_addr = addr;
13808d59ecb2SHans Petter Selasky 	LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next);
13818d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
13828d59ecb2SHans Petter Selasky }
13838d59ecb2SHans Petter Selasky 
13848d59ecb2SHans Petter Selasky static struct vmmap *
13858d59ecb2SHans Petter Selasky vmmap_remove(void *addr)
13868d59ecb2SHans Petter Selasky {
13878d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
13888d59ecb2SHans Petter Selasky 
13898d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
13908d59ecb2SHans Petter Selasky 	LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next)
13918d59ecb2SHans Petter Selasky 		if (vmmap->vm_addr == addr)
13928d59ecb2SHans Petter Selasky 			break;
13938d59ecb2SHans Petter Selasky 	if (vmmap)
13948d59ecb2SHans Petter Selasky 		LIST_REMOVE(vmmap, vm_next);
13958d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
13968d59ecb2SHans Petter Selasky 
13978d59ecb2SHans Petter Selasky 	return (vmmap);
13988d59ecb2SHans Petter Selasky }
13998d59ecb2SHans Petter Selasky 
140086845417SHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
14018d59ecb2SHans Petter Selasky void *
14028d59ecb2SHans Petter Selasky _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr)
14038d59ecb2SHans Petter Selasky {
14048d59ecb2SHans Petter Selasky 	void *addr;
14058d59ecb2SHans Petter Selasky 
14068d59ecb2SHans Petter Selasky 	addr = pmap_mapdev_attr(phys_addr, size, attr);
14078d59ecb2SHans Petter Selasky 	if (addr == NULL)
14088d59ecb2SHans Petter Selasky 		return (NULL);
14098d59ecb2SHans Petter Selasky 	vmmap_add(addr, size);
14108d59ecb2SHans Petter Selasky 
14118d59ecb2SHans Petter Selasky 	return (addr);
14128d59ecb2SHans Petter Selasky }
141386845417SHans Petter Selasky #endif
14148d59ecb2SHans Petter Selasky 
14158d59ecb2SHans Petter Selasky void
14168d59ecb2SHans Petter Selasky iounmap(void *addr)
14178d59ecb2SHans Petter Selasky {
14188d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
14198d59ecb2SHans Petter Selasky 
14208d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
14218d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
14228d59ecb2SHans Petter Selasky 		return;
14238d59ecb2SHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
14248d59ecb2SHans Petter Selasky 	pmap_unmapdev((vm_offset_t)addr, vmmap->vm_size);
14258d59ecb2SHans Petter Selasky #endif
14268d59ecb2SHans Petter Selasky 	kfree(vmmap);
14278d59ecb2SHans Petter Selasky }
14288d59ecb2SHans Petter Selasky 
14298d59ecb2SHans Petter Selasky 
14308d59ecb2SHans Petter Selasky void *
14318d59ecb2SHans Petter Selasky vmap(struct page **pages, unsigned int count, unsigned long flags, int prot)
14328d59ecb2SHans Petter Selasky {
14338d59ecb2SHans Petter Selasky 	vm_offset_t off;
14348d59ecb2SHans Petter Selasky 	size_t size;
14358d59ecb2SHans Petter Selasky 
14368d59ecb2SHans Petter Selasky 	size = count * PAGE_SIZE;
14378d59ecb2SHans Petter Selasky 	off = kva_alloc(size);
14388d59ecb2SHans Petter Selasky 	if (off == 0)
14398d59ecb2SHans Petter Selasky 		return (NULL);
14408d59ecb2SHans Petter Selasky 	vmmap_add((void *)off, size);
14418d59ecb2SHans Petter Selasky 	pmap_qenter(off, pages, count);
14428d59ecb2SHans Petter Selasky 
14438d59ecb2SHans Petter Selasky 	return ((void *)off);
14448d59ecb2SHans Petter Selasky }
14458d59ecb2SHans Petter Selasky 
14468d59ecb2SHans Petter Selasky void
14478d59ecb2SHans Petter Selasky vunmap(void *addr)
14488d59ecb2SHans Petter Selasky {
14498d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
14508d59ecb2SHans Petter Selasky 
14518d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
14528d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
14538d59ecb2SHans Petter Selasky 		return;
14548d59ecb2SHans Petter Selasky 	pmap_qremove((vm_offset_t)addr, vmmap->vm_size / PAGE_SIZE);
14558d59ecb2SHans Petter Selasky 	kva_free((vm_offset_t)addr, vmmap->vm_size);
14568d59ecb2SHans Petter Selasky 	kfree(vmmap);
14578d59ecb2SHans Petter Selasky }
14588d59ecb2SHans Petter Selasky 
14598d59ecb2SHans Petter Selasky char *
14608d59ecb2SHans Petter Selasky kvasprintf(gfp_t gfp, const char *fmt, va_list ap)
14618d59ecb2SHans Petter Selasky {
14628d59ecb2SHans Petter Selasky 	unsigned int len;
14638d59ecb2SHans Petter Selasky 	char *p;
14648d59ecb2SHans Petter Selasky 	va_list aq;
14658d59ecb2SHans Petter Selasky 
14668d59ecb2SHans Petter Selasky 	va_copy(aq, ap);
14678d59ecb2SHans Petter Selasky 	len = vsnprintf(NULL, 0, fmt, aq);
14688d59ecb2SHans Petter Selasky 	va_end(aq);
14698d59ecb2SHans Petter Selasky 
14708d59ecb2SHans Petter Selasky 	p = kmalloc(len + 1, gfp);
14718d59ecb2SHans Petter Selasky 	if (p != NULL)
14728d59ecb2SHans Petter Selasky 		vsnprintf(p, len + 1, fmt, ap);
14738d59ecb2SHans Petter Selasky 
14748d59ecb2SHans Petter Selasky 	return (p);
14758d59ecb2SHans Petter Selasky }
14768d59ecb2SHans Petter Selasky 
14778d59ecb2SHans Petter Selasky char *
14788d59ecb2SHans Petter Selasky kasprintf(gfp_t gfp, const char *fmt, ...)
14798d59ecb2SHans Petter Selasky {
14808d59ecb2SHans Petter Selasky 	va_list ap;
14818d59ecb2SHans Petter Selasky 	char *p;
14828d59ecb2SHans Petter Selasky 
14838d59ecb2SHans Petter Selasky 	va_start(ap, fmt);
14848d59ecb2SHans Petter Selasky 	p = kvasprintf(gfp, fmt, ap);
14858d59ecb2SHans Petter Selasky 	va_end(ap);
14868d59ecb2SHans Petter Selasky 
14878d59ecb2SHans Petter Selasky 	return (p);
14888d59ecb2SHans Petter Selasky }
14898d59ecb2SHans Petter Selasky 
14908d59ecb2SHans Petter Selasky static void
14918d59ecb2SHans Petter Selasky linux_timer_callback_wrapper(void *context)
14928d59ecb2SHans Petter Selasky {
14938d59ecb2SHans Petter Selasky 	struct timer_list *timer;
14948d59ecb2SHans Petter Selasky 
14955f50a414SHans Petter Selasky 	linux_set_current(curthread);
14965f50a414SHans Petter Selasky 
14978d59ecb2SHans Petter Selasky 	timer = context;
14988d59ecb2SHans Petter Selasky 	timer->function(timer->data);
14998d59ecb2SHans Petter Selasky }
15008d59ecb2SHans Petter Selasky 
15018d59ecb2SHans Petter Selasky void
15028d59ecb2SHans Petter Selasky mod_timer(struct timer_list *timer, unsigned long expires)
15038d59ecb2SHans Petter Selasky {
15048d59ecb2SHans Petter Selasky 
15058d59ecb2SHans Petter Selasky 	timer->expires = expires;
15068d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
15078d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(expires),
15088d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
15098d59ecb2SHans Petter Selasky }
15108d59ecb2SHans Petter Selasky 
15118d59ecb2SHans Petter Selasky void
15128d59ecb2SHans Petter Selasky add_timer(struct timer_list *timer)
15138d59ecb2SHans Petter Selasky {
15148d59ecb2SHans Petter Selasky 
15158d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
15168d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
15178d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
15188d59ecb2SHans Petter Selasky }
15198d59ecb2SHans Petter Selasky 
1520def277d3SHans Petter Selasky void
1521def277d3SHans Petter Selasky add_timer_on(struct timer_list *timer, int cpu)
1522def277d3SHans Petter Selasky {
1523def277d3SHans Petter Selasky 
1524def277d3SHans Petter Selasky 	callout_reset_on(&timer->timer_callout,
1525def277d3SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
1526def277d3SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer, cpu);
1527def277d3SHans Petter Selasky }
1528def277d3SHans Petter Selasky 
15298d59ecb2SHans Petter Selasky static void
15308d59ecb2SHans Petter Selasky linux_timer_init(void *arg)
15318d59ecb2SHans Petter Selasky {
15328d59ecb2SHans Petter Selasky 
15338d59ecb2SHans Petter Selasky 	/*
15348d59ecb2SHans Petter Selasky 	 * Compute an internal HZ value which can divide 2**32 to
15358d59ecb2SHans Petter Selasky 	 * avoid timer rounding problems when the tick value wraps
15368d59ecb2SHans Petter Selasky 	 * around 2**32:
15378d59ecb2SHans Petter Selasky 	 */
15388d59ecb2SHans Petter Selasky 	linux_timer_hz_mask = 1;
15398d59ecb2SHans Petter Selasky 	while (linux_timer_hz_mask < (unsigned long)hz)
15408d59ecb2SHans Petter Selasky 		linux_timer_hz_mask *= 2;
15418d59ecb2SHans Petter Selasky 	linux_timer_hz_mask--;
15428d59ecb2SHans Petter Selasky }
15438d59ecb2SHans Petter Selasky SYSINIT(linux_timer, SI_SUB_DRIVERS, SI_ORDER_FIRST, linux_timer_init, NULL);
15448d59ecb2SHans Petter Selasky 
15458d59ecb2SHans Petter Selasky void
15468d59ecb2SHans Petter Selasky linux_complete_common(struct completion *c, int all)
15478d59ecb2SHans Petter Selasky {
15488d59ecb2SHans Petter Selasky 	int wakeup_swapper;
15498d59ecb2SHans Petter Selasky 
15508d59ecb2SHans Petter Selasky 	sleepq_lock(c);
15518d59ecb2SHans Petter Selasky 	c->done++;
15528d59ecb2SHans Petter Selasky 	if (all)
15538d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_broadcast(c, SLEEPQ_SLEEP, 0, 0);
15548d59ecb2SHans Petter Selasky 	else
15558d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_signal(c, SLEEPQ_SLEEP, 0, 0);
15568d59ecb2SHans Petter Selasky 	sleepq_release(c);
15578d59ecb2SHans Petter Selasky 	if (wakeup_swapper)
15588d59ecb2SHans Petter Selasky 		kick_proc0();
15598d59ecb2SHans Petter Selasky }
15608d59ecb2SHans Petter Selasky 
15618d59ecb2SHans Petter Selasky /*
15628d59ecb2SHans Petter Selasky  * Indefinite wait for done != 0 with or without signals.
15638d59ecb2SHans Petter Selasky  */
15648d59ecb2SHans Petter Selasky long
15658d59ecb2SHans Petter Selasky linux_wait_for_common(struct completion *c, int flags)
15668d59ecb2SHans Petter Selasky {
1567b602c283SMark Johnston 	long error;
1568b602c283SMark Johnston 
15698eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
157085714218SHans Petter Selasky 		return (0);
15718d59ecb2SHans Petter Selasky 
1572b602c283SMark Johnston 	DROP_GIANT();
1573b602c283SMark Johnston 
15748d59ecb2SHans Petter Selasky 	if (flags != 0)
15758d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
15768d59ecb2SHans Petter Selasky 	else
15778d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
1578b602c283SMark Johnston 	error = 0;
15798d59ecb2SHans Petter Selasky 	for (;;) {
15808d59ecb2SHans Petter Selasky 		sleepq_lock(c);
15818d59ecb2SHans Petter Selasky 		if (c->done)
15828d59ecb2SHans Petter Selasky 			break;
15838d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
15848d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE) {
1585b602c283SMark Johnston 			if (sleepq_wait_sig(c, 0) != 0) {
1586b602c283SMark Johnston 				error = -ERESTARTSYS;
1587b602c283SMark Johnston 				goto intr;
1588b602c283SMark Johnston 			}
15898d59ecb2SHans Petter Selasky 		} else
15908d59ecb2SHans Petter Selasky 			sleepq_wait(c, 0);
15918d59ecb2SHans Petter Selasky 	}
15928d59ecb2SHans Petter Selasky 	c->done--;
15938d59ecb2SHans Petter Selasky 	sleepq_release(c);
15948d59ecb2SHans Petter Selasky 
1595b602c283SMark Johnston intr:
1596b602c283SMark Johnston 	PICKUP_GIANT();
1597b602c283SMark Johnston 
1598b602c283SMark Johnston 	return (error);
15998d59ecb2SHans Petter Selasky }
16008d59ecb2SHans Petter Selasky 
16018d59ecb2SHans Petter Selasky /*
16028d59ecb2SHans Petter Selasky  * Time limited wait for done != 0 with or without signals.
16038d59ecb2SHans Petter Selasky  */
16048d59ecb2SHans Petter Selasky long
16058d59ecb2SHans Petter Selasky linux_wait_for_timeout_common(struct completion *c, long timeout, int flags)
16068d59ecb2SHans Petter Selasky {
1607b602c283SMark Johnston 	long end = jiffies + timeout, error;
1608b602c283SMark Johnston 	int ret;
16098d59ecb2SHans Petter Selasky 
16108eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
161185714218SHans Petter Selasky 		return (0);
161285714218SHans Petter Selasky 
1613b602c283SMark Johnston 	DROP_GIANT();
1614b602c283SMark Johnston 
16158d59ecb2SHans Petter Selasky 	if (flags != 0)
16168d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
16178d59ecb2SHans Petter Selasky 	else
16188d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
16198d59ecb2SHans Petter Selasky 
1620b602c283SMark Johnston 	error = 0;
1621b602c283SMark Johnston 	ret = 0;
1622b602c283SMark Johnston 	for (;;) {
16238d59ecb2SHans Petter Selasky 		sleepq_lock(c);
16248d59ecb2SHans Petter Selasky 		if (c->done)
16258d59ecb2SHans Petter Selasky 			break;
16268d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
16278d59ecb2SHans Petter Selasky 		sleepq_set_timeout(c, linux_timer_jiffies_until(end));
16288d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE)
16298d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait_sig(c, 0);
16308d59ecb2SHans Petter Selasky 		else
16318d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait(c, 0);
16328d59ecb2SHans Petter Selasky 		if (ret != 0) {
16338d59ecb2SHans Petter Selasky 			/* check for timeout or signal */
16348d59ecb2SHans Petter Selasky 			if (ret == EWOULDBLOCK)
1635b602c283SMark Johnston 				error = 0;
16368d59ecb2SHans Petter Selasky 			else
1637b602c283SMark Johnston 				error = -ERESTARTSYS;
1638b602c283SMark Johnston 			goto intr;
16398d59ecb2SHans Petter Selasky 		}
16408d59ecb2SHans Petter Selasky 	}
16418d59ecb2SHans Petter Selasky 	c->done--;
16428d59ecb2SHans Petter Selasky 	sleepq_release(c);
16438d59ecb2SHans Petter Selasky 
1644b602c283SMark Johnston intr:
1645b602c283SMark Johnston 	PICKUP_GIANT();
1646b602c283SMark Johnston 
16478d59ecb2SHans Petter Selasky 	/* return how many jiffies are left */
1648b602c283SMark Johnston 	return (ret != 0 ? error : linux_timer_jiffies_until(end));
16498d59ecb2SHans Petter Selasky }
16508d59ecb2SHans Petter Selasky 
16518d59ecb2SHans Petter Selasky int
16528d59ecb2SHans Petter Selasky linux_try_wait_for_completion(struct completion *c)
16538d59ecb2SHans Petter Selasky {
16548d59ecb2SHans Petter Selasky 	int isdone;
16558d59ecb2SHans Petter Selasky 
16568d59ecb2SHans Petter Selasky 	isdone = 1;
16578d59ecb2SHans Petter Selasky 	sleepq_lock(c);
16588d59ecb2SHans Petter Selasky 	if (c->done)
16598d59ecb2SHans Petter Selasky 		c->done--;
16608d59ecb2SHans Petter Selasky 	else
16618d59ecb2SHans Petter Selasky 		isdone = 0;
16628d59ecb2SHans Petter Selasky 	sleepq_release(c);
16638d59ecb2SHans Petter Selasky 	return (isdone);
16648d59ecb2SHans Petter Selasky }
16658d59ecb2SHans Petter Selasky 
16668d59ecb2SHans Petter Selasky int
16678d59ecb2SHans Petter Selasky linux_completion_done(struct completion *c)
16688d59ecb2SHans Petter Selasky {
16698d59ecb2SHans Petter Selasky 	int isdone;
16708d59ecb2SHans Petter Selasky 
16718d59ecb2SHans Petter Selasky 	isdone = 1;
16728d59ecb2SHans Petter Selasky 	sleepq_lock(c);
16738d59ecb2SHans Petter Selasky 	if (c->done == 0)
16748d59ecb2SHans Petter Selasky 		isdone = 0;
16758d59ecb2SHans Petter Selasky 	sleepq_release(c);
16768d59ecb2SHans Petter Selasky 	return (isdone);
16778d59ecb2SHans Petter Selasky }
16788d59ecb2SHans Petter Selasky 
16798d59ecb2SHans Petter Selasky static void
168006204f8eSHans Petter Selasky linux_cdev_release(struct kobject *kobj)
168106204f8eSHans Petter Selasky {
168206204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
168306204f8eSHans Petter Selasky 	struct kobject *parent;
168406204f8eSHans Petter Selasky 
168506204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
168606204f8eSHans Petter Selasky 	parent = kobj->parent;
168706204f8eSHans Petter Selasky 	if (cdev->cdev)
168806204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
168906204f8eSHans Petter Selasky 	kfree(cdev);
169006204f8eSHans Petter Selasky 	kobject_put(parent);
169106204f8eSHans Petter Selasky }
169206204f8eSHans Petter Selasky 
169306204f8eSHans Petter Selasky static void
169406204f8eSHans Petter Selasky linux_cdev_static_release(struct kobject *kobj)
169506204f8eSHans Petter Selasky {
169606204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
169706204f8eSHans Petter Selasky 	struct kobject *parent;
169806204f8eSHans Petter Selasky 
169906204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
170006204f8eSHans Petter Selasky 	parent = kobj->parent;
170106204f8eSHans Petter Selasky 	if (cdev->cdev)
170206204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
170306204f8eSHans Petter Selasky 	kobject_put(parent);
170406204f8eSHans Petter Selasky }
170506204f8eSHans Petter Selasky 
170606204f8eSHans Petter Selasky const struct kobj_type linux_cdev_ktype = {
170706204f8eSHans Petter Selasky 	.release = linux_cdev_release,
170806204f8eSHans Petter Selasky };
170906204f8eSHans Petter Selasky 
171006204f8eSHans Petter Selasky const struct kobj_type linux_cdev_static_ktype = {
171106204f8eSHans Petter Selasky 	.release = linux_cdev_static_release,
171206204f8eSHans Petter Selasky };
171306204f8eSHans Petter Selasky 
171406204f8eSHans Petter Selasky static void
17150c510167SHans Petter Selasky linux_handle_ifnet_link_event(void *arg, struct ifnet *ifp, int linkstate)
17160c510167SHans Petter Selasky {
17170c510167SHans Petter Selasky 	struct notifier_block *nb;
17180c510167SHans Petter Selasky 
17190c510167SHans Petter Selasky 	nb = arg;
17200c510167SHans Petter Selasky 	if (linkstate == LINK_STATE_UP)
17210c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_UP, ifp);
17220c510167SHans Petter Selasky 	else
17230c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_DOWN, ifp);
17240c510167SHans Petter Selasky }
17250c510167SHans Petter Selasky 
17260c510167SHans Petter Selasky static void
17270c510167SHans Petter Selasky linux_handle_ifnet_arrival_event(void *arg, struct ifnet *ifp)
17280c510167SHans Petter Selasky {
17290c510167SHans Petter Selasky 	struct notifier_block *nb;
17300c510167SHans Petter Selasky 
17310c510167SHans Petter Selasky 	nb = arg;
17320c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_REGISTER, ifp);
17330c510167SHans Petter Selasky }
17340c510167SHans Petter Selasky 
17350c510167SHans Petter Selasky static void
17360c510167SHans Petter Selasky linux_handle_ifnet_departure_event(void *arg, struct ifnet *ifp)
17370c510167SHans Petter Selasky {
17380c510167SHans Petter Selasky 	struct notifier_block *nb;
17390c510167SHans Petter Selasky 
17400c510167SHans Petter Selasky 	nb = arg;
17410c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_UNREGISTER, ifp);
17420c510167SHans Petter Selasky }
17430c510167SHans Petter Selasky 
17440c510167SHans Petter Selasky static void
17450c510167SHans Petter Selasky linux_handle_iflladdr_event(void *arg, struct ifnet *ifp)
17460c510167SHans Petter Selasky {
17470c510167SHans Petter Selasky 	struct notifier_block *nb;
17480c510167SHans Petter Selasky 
17490c510167SHans Petter Selasky 	nb = arg;
17500c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEADDR, ifp);
17510c510167SHans Petter Selasky }
17520c510167SHans Petter Selasky 
17530c510167SHans Petter Selasky static void
17540c510167SHans Petter Selasky linux_handle_ifaddr_event(void *arg, struct ifnet *ifp)
17550c510167SHans Petter Selasky {
17560c510167SHans Petter Selasky 	struct notifier_block *nb;
17570c510167SHans Petter Selasky 
17580c510167SHans Petter Selasky 	nb = arg;
17590c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEIFADDR, ifp);
17600c510167SHans Petter Selasky }
17610c510167SHans Petter Selasky 
17620c510167SHans Petter Selasky int
17630c510167SHans Petter Selasky register_netdevice_notifier(struct notifier_block *nb)
17640c510167SHans Petter Selasky {
17650c510167SHans Petter Selasky 
17660c510167SHans Petter Selasky 	nb->tags[NETDEV_UP] = EVENTHANDLER_REGISTER(
17670c510167SHans Petter Selasky 	    ifnet_link_event, linux_handle_ifnet_link_event, nb, 0);
17680c510167SHans Petter Selasky 	nb->tags[NETDEV_REGISTER] = EVENTHANDLER_REGISTER(
17690c510167SHans Petter Selasky 	    ifnet_arrival_event, linux_handle_ifnet_arrival_event, nb, 0);
17700c510167SHans Petter Selasky 	nb->tags[NETDEV_UNREGISTER] = EVENTHANDLER_REGISTER(
17710c510167SHans Petter Selasky 	    ifnet_departure_event, linux_handle_ifnet_departure_event, nb, 0);
17720c510167SHans Petter Selasky 	nb->tags[NETDEV_CHANGEADDR] = EVENTHANDLER_REGISTER(
17730c510167SHans Petter Selasky 	    iflladdr_event, linux_handle_iflladdr_event, nb, 0);
17740c510167SHans Petter Selasky 
17750c510167SHans Petter Selasky 	return (0);
17760c510167SHans Petter Selasky }
17770c510167SHans Petter Selasky 
17780c510167SHans Petter Selasky int
17790c510167SHans Petter Selasky register_inetaddr_notifier(struct notifier_block *nb)
17800c510167SHans Petter Selasky {
17810c510167SHans Petter Selasky 
17820c510167SHans Petter Selasky         nb->tags[NETDEV_CHANGEIFADDR] = EVENTHANDLER_REGISTER(
17830c510167SHans Petter Selasky             ifaddr_event, linux_handle_ifaddr_event, nb, 0);
17840c510167SHans Petter Selasky         return (0);
17850c510167SHans Petter Selasky }
17860c510167SHans Petter Selasky 
17870c510167SHans Petter Selasky int
17880c510167SHans Petter Selasky unregister_netdevice_notifier(struct notifier_block *nb)
17890c510167SHans Petter Selasky {
17900c510167SHans Petter Selasky 
17910c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_link_event,
17920c510167SHans Petter Selasky 	    nb->tags[NETDEV_UP]);
17930c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_arrival_event,
17940c510167SHans Petter Selasky 	    nb->tags[NETDEV_REGISTER]);
17950c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_departure_event,
17960c510167SHans Petter Selasky 	    nb->tags[NETDEV_UNREGISTER]);
17970c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(iflladdr_event,
17980c510167SHans Petter Selasky 	    nb->tags[NETDEV_CHANGEADDR]);
17990c510167SHans Petter Selasky 
18000c510167SHans Petter Selasky 	return (0);
18010c510167SHans Petter Selasky }
18020c510167SHans Petter Selasky 
18030c510167SHans Petter Selasky int
18040c510167SHans Petter Selasky unregister_inetaddr_notifier(struct notifier_block *nb)
18050c510167SHans Petter Selasky {
18060c510167SHans Petter Selasky 
18070c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifaddr_event,
18080c510167SHans Petter Selasky             nb->tags[NETDEV_CHANGEIFADDR]);
18090c510167SHans Petter Selasky 
18100c510167SHans Petter Selasky         return (0);
18110c510167SHans Petter Selasky }
18120c510167SHans Petter Selasky 
1813aad02fb4SHans Petter Selasky struct list_sort_thunk {
1814aad02fb4SHans Petter Selasky 	int (*cmp)(void *, struct list_head *, struct list_head *);
1815aad02fb4SHans Petter Selasky 	void *priv;
1816aad02fb4SHans Petter Selasky };
1817aad02fb4SHans Petter Selasky 
1818aad02fb4SHans Petter Selasky static inline int
1819aad02fb4SHans Petter Selasky linux_le_cmp(void *priv, const void *d1, const void *d2)
1820aad02fb4SHans Petter Selasky {
1821aad02fb4SHans Petter Selasky 	struct list_head *le1, *le2;
1822aad02fb4SHans Petter Selasky 	struct list_sort_thunk *thunk;
1823aad02fb4SHans Petter Selasky 
1824aad02fb4SHans Petter Selasky 	thunk = priv;
1825aad02fb4SHans Petter Selasky 	le1 = *(__DECONST(struct list_head **, d1));
1826aad02fb4SHans Petter Selasky 	le2 = *(__DECONST(struct list_head **, d2));
1827aad02fb4SHans Petter Selasky 	return ((thunk->cmp)(thunk->priv, le1, le2));
1828aad02fb4SHans Petter Selasky }
1829aad02fb4SHans Petter Selasky 
1830aad02fb4SHans Petter Selasky void
1831aad02fb4SHans Petter Selasky list_sort(void *priv, struct list_head *head, int (*cmp)(void *priv,
1832aad02fb4SHans Petter Selasky     struct list_head *a, struct list_head *b))
1833aad02fb4SHans Petter Selasky {
1834aad02fb4SHans Petter Selasky 	struct list_sort_thunk thunk;
1835aad02fb4SHans Petter Selasky 	struct list_head **ar, *le;
1836aad02fb4SHans Petter Selasky 	size_t count, i;
1837aad02fb4SHans Petter Selasky 
1838aad02fb4SHans Petter Selasky 	count = 0;
1839aad02fb4SHans Petter Selasky 	list_for_each(le, head)
1840aad02fb4SHans Petter Selasky 		count++;
1841aad02fb4SHans Petter Selasky 	ar = malloc(sizeof(struct list_head *) * count, M_KMALLOC, M_WAITOK);
1842aad02fb4SHans Petter Selasky 	i = 0;
1843aad02fb4SHans Petter Selasky 	list_for_each(le, head)
1844aad02fb4SHans Petter Selasky 		ar[i++] = le;
1845aad02fb4SHans Petter Selasky 	thunk.cmp = cmp;
1846aad02fb4SHans Petter Selasky 	thunk.priv = priv;
1847aad02fb4SHans Petter Selasky 	qsort_r(ar, count, sizeof(struct list_head *), &thunk, linux_le_cmp);
1848aad02fb4SHans Petter Selasky 	INIT_LIST_HEAD(head);
1849aad02fb4SHans Petter Selasky 	for (i = 0; i < count; i++)
1850aad02fb4SHans Petter Selasky 		list_add_tail(ar[i], head);
1851aad02fb4SHans Petter Selasky 	free(ar, M_KMALLOC);
1852aad02fb4SHans Petter Selasky }
1853aad02fb4SHans Petter Selasky 
18540c510167SHans Petter Selasky void
18550c510167SHans Petter Selasky linux_irq_handler(void *ent)
18560c510167SHans Petter Selasky {
18570c510167SHans Petter Selasky 	struct irq_ent *irqe;
18580c510167SHans Petter Selasky 
18595f50a414SHans Petter Selasky 	linux_set_current(curthread);
18605f50a414SHans Petter Selasky 
18610c510167SHans Petter Selasky 	irqe = ent;
18620c510167SHans Petter Selasky 	irqe->handler(irqe->irq, irqe->arg);
18630c510167SHans Petter Selasky }
18640c510167SHans Petter Selasky 
1865c12488bbSMark Johnston #if defined(__i386__) || defined(__amd64__)
1866c12488bbSMark Johnston int
1867c12488bbSMark Johnston linux_wbinvd_on_all_cpus(void)
1868c12488bbSMark Johnston {
1869c12488bbSMark Johnston 
18706c106233SMark Johnston 	pmap_invalidate_cache();
18716c106233SMark Johnston 	return (0);
1872c12488bbSMark Johnston }
1873c12488bbSMark Johnston #endif
1874c12488bbSMark Johnston 
1875c12488bbSMark Johnston int
1876c12488bbSMark Johnston linux_on_each_cpu(void callback(void *), void *data)
1877c12488bbSMark Johnston {
1878c12488bbSMark Johnston 
1879c12488bbSMark Johnston 	smp_rendezvous(smp_no_rendezvous_barrier, callback,
1880c12488bbSMark Johnston 	    smp_no_rendezvous_barrier, data);
1881c12488bbSMark Johnston 	return (0);
1882c12488bbSMark Johnston }
1883c12488bbSMark Johnston 
1884dff36e69SHans Petter Selasky int
1885dff36e69SHans Petter Selasky linux_in_atomic(void)
1886dff36e69SHans Petter Selasky {
1887dff36e69SHans Petter Selasky 
1888dff36e69SHans Petter Selasky 	return ((curthread->td_pflags & TDP_NOFAULTING) != 0);
1889dff36e69SHans Petter Selasky }
1890dff36e69SHans Petter Selasky 
18911125dbc0SHans Petter Selasky struct linux_cdev *
18921125dbc0SHans Petter Selasky linux_find_cdev(const char *name, unsigned major, unsigned minor)
18931125dbc0SHans Petter Selasky {
18941125dbc0SHans Petter Selasky 	int unit = MKDEV(major, minor);
18951125dbc0SHans Petter Selasky 	struct cdev *cdev;
18961125dbc0SHans Petter Selasky 
18971125dbc0SHans Petter Selasky 	dev_lock();
18981125dbc0SHans Petter Selasky 	LIST_FOREACH(cdev, &linuxcdevsw.d_devs, si_list) {
18991125dbc0SHans Petter Selasky 		struct linux_cdev *ldev = cdev->si_drv1;
19001125dbc0SHans Petter Selasky 		if (dev2unit(cdev) == unit &&
19011125dbc0SHans Petter Selasky 		    strcmp(kobject_name(&ldev->kobj), name) == 0) {
19021125dbc0SHans Petter Selasky 			break;
19031125dbc0SHans Petter Selasky 		}
19041125dbc0SHans Petter Selasky 	}
19051125dbc0SHans Petter Selasky 	dev_unlock();
19061125dbc0SHans Petter Selasky 
19071125dbc0SHans Petter Selasky 	return (cdev != NULL ? cdev->si_drv1 : NULL);
19081125dbc0SHans Petter Selasky }
19091125dbc0SHans Petter Selasky 
19101125dbc0SHans Petter Selasky int
19111125dbc0SHans Petter Selasky __register_chrdev(unsigned int major, unsigned int baseminor,
19121125dbc0SHans Petter Selasky     unsigned int count, const char *name,
19131125dbc0SHans Petter Selasky     const struct file_operations *fops)
19141125dbc0SHans Petter Selasky {
19151125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
19161125dbc0SHans Petter Selasky 	int ret = 0;
19171125dbc0SHans Petter Selasky 	int i;
19181125dbc0SHans Petter Selasky 
19191125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
19201125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
19211125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
19221125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
19231125dbc0SHans Petter Selasky 
19241125dbc0SHans Petter Selasky 		ret = cdev_add(cdev, makedev(major, i), 1);
19251125dbc0SHans Petter Selasky 		if (ret != 0)
19261125dbc0SHans Petter Selasky 			break;
19271125dbc0SHans Petter Selasky 	}
19281125dbc0SHans Petter Selasky 	return (ret);
19291125dbc0SHans Petter Selasky }
19301125dbc0SHans Petter Selasky 
19311125dbc0SHans Petter Selasky int
19321125dbc0SHans Petter Selasky __register_chrdev_p(unsigned int major, unsigned int baseminor,
19331125dbc0SHans Petter Selasky     unsigned int count, const char *name,
19341125dbc0SHans Petter Selasky     const struct file_operations *fops, uid_t uid,
19351125dbc0SHans Petter Selasky     gid_t gid, int mode)
19361125dbc0SHans Petter Selasky {
19371125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
19381125dbc0SHans Petter Selasky 	int ret = 0;
19391125dbc0SHans Petter Selasky 	int i;
19401125dbc0SHans Petter Selasky 
19411125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
19421125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
19431125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
19441125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
19451125dbc0SHans Petter Selasky 
19461125dbc0SHans Petter Selasky 		ret = cdev_add_ext(cdev, makedev(major, i), uid, gid, mode);
19471125dbc0SHans Petter Selasky 		if (ret != 0)
19481125dbc0SHans Petter Selasky 			break;
19491125dbc0SHans Petter Selasky 	}
19501125dbc0SHans Petter Selasky 	return (ret);
19511125dbc0SHans Petter Selasky }
19521125dbc0SHans Petter Selasky 
19531125dbc0SHans Petter Selasky void
19541125dbc0SHans Petter Selasky __unregister_chrdev(unsigned int major, unsigned int baseminor,
19551125dbc0SHans Petter Selasky     unsigned int count, const char *name)
19561125dbc0SHans Petter Selasky {
19571125dbc0SHans Petter Selasky 	struct linux_cdev *cdevp;
19581125dbc0SHans Petter Selasky 	int i;
19591125dbc0SHans Petter Selasky 
19601125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
19611125dbc0SHans Petter Selasky 		cdevp = linux_find_cdev(name, major, i);
19621125dbc0SHans Petter Selasky 		if (cdevp != NULL)
19631125dbc0SHans Petter Selasky 			cdev_del(cdevp);
19641125dbc0SHans Petter Selasky 	}
19651125dbc0SHans Petter Selasky }
19661125dbc0SHans Petter Selasky 
196703219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
196803219fbaSHans Petter Selasky bool linux_cpu_has_clflush;
196903219fbaSHans Petter Selasky #endif
197003219fbaSHans Petter Selasky 
19710c510167SHans Petter Selasky static void
19728d59ecb2SHans Petter Selasky linux_compat_init(void *arg)
19738d59ecb2SHans Petter Selasky {
19748d59ecb2SHans Petter Selasky 	struct sysctl_oid *rootoid;
19758d59ecb2SHans Petter Selasky 	int i;
19768d59ecb2SHans Petter Selasky 
197703219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
197803219fbaSHans Petter Selasky 	linux_cpu_has_clflush = (cpu_feature & CPUID_CLFSH);
197903219fbaSHans Petter Selasky #endif
19801ea4c857SHans Petter Selasky 	rw_init(&linux_vma_lock, "lkpi-vma-lock");
1981e10c4cc0SHans Petter Selasky 
19828d59ecb2SHans Petter Selasky 	rootoid = SYSCTL_ADD_ROOT_NODE(NULL,
19838d59ecb2SHans Petter Selasky 	    OID_AUTO, "sys", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "sys");
198406204f8eSHans Petter Selasky 	kobject_init(&linux_class_root, &linux_class_ktype);
198506204f8eSHans Petter Selasky 	kobject_set_name(&linux_class_root, "class");
198606204f8eSHans Petter Selasky 	linux_class_root.oidp = SYSCTL_ADD_NODE(NULL, SYSCTL_CHILDREN(rootoid),
19878d59ecb2SHans Petter Selasky 	    OID_AUTO, "class", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "class");
198806204f8eSHans Petter Selasky 	kobject_init(&linux_root_device.kobj, &linux_dev_ktype);
198906204f8eSHans Petter Selasky 	kobject_set_name(&linux_root_device.kobj, "device");
199006204f8eSHans Petter Selasky 	linux_root_device.kobj.oidp = SYSCTL_ADD_NODE(NULL,
19918d59ecb2SHans Petter Selasky 	    SYSCTL_CHILDREN(rootoid), OID_AUTO, "device", CTLFLAG_RD, NULL,
19928d59ecb2SHans Petter Selasky 	    "device");
199306204f8eSHans Petter Selasky 	linux_root_device.bsddev = root_bus;
199406204f8eSHans Petter Selasky 	linux_class_misc.name = "misc";
199506204f8eSHans Petter Selasky 	class_register(&linux_class_misc);
19968d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_drivers);
19978d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_devices);
19988d59ecb2SHans Petter Selasky 	spin_lock_init(&pci_lock);
19998d59ecb2SHans Petter Selasky 	mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF);
20008d59ecb2SHans Petter Selasky 	for (i = 0; i < VMMAP_HASH_SIZE; i++)
20018d59ecb2SHans Petter Selasky 		LIST_INIT(&vmmaphead[i]);
20028d59ecb2SHans Petter Selasky }
20038d59ecb2SHans Petter Selasky SYSINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_init, NULL);
20048d59ecb2SHans Petter Selasky 
20058d59ecb2SHans Petter Selasky static void
20068d59ecb2SHans Petter Selasky linux_compat_uninit(void *arg)
20078d59ecb2SHans Petter Selasky {
200806204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_root);
200906204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_root_device.kobj);
201006204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_misc.kobj);
20111ea4c857SHans Petter Selasky 
20121ea4c857SHans Petter Selasky 	rw_destroy(&linux_vma_lock);
20138d59ecb2SHans Petter Selasky }
20148d59ecb2SHans Petter Selasky SYSUNINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_uninit, NULL);
2015f727a767SHans Petter Selasky 
2016f727a767SHans Petter Selasky /*
2017f727a767SHans Petter Selasky  * NOTE: Linux frequently uses "unsigned long" for pointer to integer
2018f727a767SHans Petter Selasky  * conversion and vice versa, where in FreeBSD "uintptr_t" would be
2019f727a767SHans Petter Selasky  * used. Assert these types have the same size, else some parts of the
2020f727a767SHans Petter Selasky  * LinuxKPI may not work like expected:
2021f727a767SHans Petter Selasky  */
2022f727a767SHans Petter Selasky CTASSERT(sizeof(unsigned long) == sizeof(uintptr_t));
2023