xref: /freebsd/sys/compat/linuxkpi/common/src/linux_compat.c (revision cde3f930bce271d70eb78d8aeef20aabbbb9ba0e)
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 
405a6b28ee0SHans Petter Selasky static void
406a6b28ee0SHans Petter Selasky linux_kq_lock(void *arg)
407a6b28ee0SHans Petter Selasky {
408a6b28ee0SHans Petter Selasky 	spinlock_t *s = arg;
409a6b28ee0SHans Petter Selasky 
410a6b28ee0SHans Petter Selasky 	spin_lock(s);
411a6b28ee0SHans Petter Selasky }
412a6b28ee0SHans Petter Selasky static void
413a6b28ee0SHans Petter Selasky linux_kq_unlock(void *arg)
414a6b28ee0SHans Petter Selasky {
415a6b28ee0SHans Petter Selasky 	spinlock_t *s = arg;
416a6b28ee0SHans Petter Selasky 
417a6b28ee0SHans Petter Selasky 	spin_unlock(s);
418a6b28ee0SHans Petter Selasky }
419a6b28ee0SHans Petter Selasky 
420a6b28ee0SHans Petter Selasky static void
421a6b28ee0SHans Petter Selasky linux_kq_lock_owned(void *arg)
422a6b28ee0SHans Petter Selasky {
423a6b28ee0SHans Petter Selasky #ifdef INVARIANTS
424a6b28ee0SHans Petter Selasky 	spinlock_t *s = arg;
425a6b28ee0SHans Petter Selasky 
426a6b28ee0SHans Petter Selasky 	mtx_assert(&s->m, MA_OWNED);
427a6b28ee0SHans Petter Selasky #endif
428a6b28ee0SHans Petter Selasky }
429a6b28ee0SHans Petter Selasky 
430a6b28ee0SHans Petter Selasky static void
431a6b28ee0SHans Petter Selasky linux_kq_lock_unowned(void *arg)
432a6b28ee0SHans Petter Selasky {
433a6b28ee0SHans Petter Selasky #ifdef INVARIANTS
434a6b28ee0SHans Petter Selasky 	spinlock_t *s = arg;
435a6b28ee0SHans Petter Selasky 
436a6b28ee0SHans Petter Selasky 	mtx_assert(&s->m, MA_NOTOWNED);
437a6b28ee0SHans Petter Selasky #endif
438a6b28ee0SHans Petter Selasky }
439a6b28ee0SHans Petter Selasky 
440a6b28ee0SHans Petter Selasky static void
44167e984c8SHans Petter Selasky linux_dev_kqfilter_poll(struct linux_file *, int);
442a6b28ee0SHans Petter Selasky 
443a6b28ee0SHans Petter Selasky struct linux_file *
444a6b28ee0SHans Petter Selasky linux_file_alloc(void)
445a6b28ee0SHans Petter Selasky {
446a6b28ee0SHans Petter Selasky 	struct linux_file *filp;
447a6b28ee0SHans Petter Selasky 
448a6b28ee0SHans Petter Selasky 	filp = kzalloc(sizeof(*filp), GFP_KERNEL);
449a6b28ee0SHans Petter Selasky 
450a6b28ee0SHans Petter Selasky 	/* set initial refcount */
451a6b28ee0SHans Petter Selasky 	filp->f_count = 1;
452a6b28ee0SHans Petter Selasky 
453a6b28ee0SHans Petter Selasky 	/* setup fields needed by kqueue support */
454a6b28ee0SHans Petter Selasky 	spin_lock_init(&filp->f_kqlock);
455a6b28ee0SHans Petter Selasky 	knlist_init(&filp->f_selinfo.si_note, &filp->f_kqlock,
456a6b28ee0SHans Petter Selasky 	    linux_kq_lock, linux_kq_unlock,
457a6b28ee0SHans Petter Selasky 	    linux_kq_lock_owned, linux_kq_lock_unowned);
458a6b28ee0SHans Petter Selasky 
459a6b28ee0SHans Petter Selasky 	return (filp);
460a6b28ee0SHans Petter Selasky }
461a6b28ee0SHans 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);
500*cde3f930SHans Petter Selasky 	if (unlikely(vmap->vm_ops == NULL || vmap->vm_ops->fault == 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);
652a6b28ee0SHans Petter Selasky 
653a6b28ee0SHans 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 
661a6b28ee0SHans Petter Selasky 	linux_set_current(td);
662a6b28ee0SHans 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 
829639af71aSHans Petter Selasky 	/* the LinuxKPI supports blocking and non-blocking I/O */
830639af71aSHans Petter Selasky 	if (cmd == FIONBIO || cmd == FIOASYNC)
831639af71aSHans Petter Selasky 		return (0);
832639af71aSHans Petter Selasky 
8331e3db1deSHans Petter Selasky 	linux_set_current(td);
8343a8bec33SHans Petter Selasky 	size = IOCPARM_LEN(cmd);
8353a8bec33SHans Petter Selasky 	/* refer to logic in sys_ioctl() */
8363a8bec33SHans Petter Selasky 	if (size > 0) {
8378d59ecb2SHans Petter Selasky 		/*
8383a8bec33SHans Petter Selasky 		 * Setup hint for linux_copyin() and linux_copyout().
8393a8bec33SHans Petter Selasky 		 *
8403a8bec33SHans Petter Selasky 		 * Background: Linux code expects a user-space address
8413a8bec33SHans Petter Selasky 		 * while FreeBSD supplies a kernel-space address.
8428d59ecb2SHans Petter Selasky 		 */
8431e3db1deSHans Petter Selasky 		current->bsd_ioctl_data = data;
8441e3db1deSHans Petter Selasky 		current->bsd_ioctl_len = size;
8453a8bec33SHans Petter Selasky 		data = (void *)LINUX_IOCTL_MIN_PTR;
8463a8bec33SHans Petter Selasky 	} else {
8473a8bec33SHans Petter Selasky 		/* fetch user-space pointer */
8488d59ecb2SHans Petter Selasky 		data = *(void **)data;
8493a8bec33SHans Petter Selasky 	}
8508d59ecb2SHans Petter Selasky 	if (filp->f_op->unlocked_ioctl)
8518d59ecb2SHans Petter Selasky 		error = -filp->f_op->unlocked_ioctl(filp, cmd, (u_long)data);
8528d59ecb2SHans Petter Selasky 	else
8538d59ecb2SHans Petter Selasky 		error = ENOTTY;
8541e3db1deSHans Petter Selasky 	if (size > 0) {
8551e3db1deSHans Petter Selasky 		current->bsd_ioctl_data = NULL;
8561e3db1deSHans Petter Selasky 		current->bsd_ioctl_len = 0;
8571e3db1deSHans Petter Selasky 	}
8588d59ecb2SHans Petter Selasky 
85967e984c8SHans Petter Selasky 	if (error == EWOULDBLOCK) {
86067e984c8SHans Petter Selasky 		/* update kqfilter status, if any */
86167e984c8SHans Petter Selasky 		linux_dev_kqfilter_poll(filp,
86267e984c8SHans Petter Selasky 		    LINUX_KQ_FLAG_HAS_READ | LINUX_KQ_FLAG_HAS_WRITE);
86367e984c8SHans Petter Selasky 	} else if (error == ERESTARTSYS)
864328c75d6SHans Petter Selasky 		error = ERESTART;
8658d59ecb2SHans Petter Selasky 	return (error);
8668d59ecb2SHans Petter Selasky }
8678d59ecb2SHans Petter Selasky 
8688d59ecb2SHans Petter Selasky static int
8698d59ecb2SHans Petter Selasky linux_dev_read(struct cdev *dev, struct uio *uio, int ioflag)
8708d59ecb2SHans Petter Selasky {
8718d59ecb2SHans Petter Selasky 	struct linux_file *filp;
872464d20bcSHans Petter Selasky 	struct thread *td;
8738d59ecb2SHans Petter Selasky 	struct file *file;
8748d59ecb2SHans Petter Selasky 	ssize_t bytes;
8758d59ecb2SHans Petter Selasky 	int error;
8768d59ecb2SHans Petter Selasky 
877464d20bcSHans Petter Selasky 	td = curthread;
878464d20bcSHans Petter Selasky 	file = td->td_fpop;
8796e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
8806e3e6544SHans Petter Selasky 		return (ENXIO);
8818d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
8828d59ecb2SHans Petter Selasky 		return (error);
8838d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
884b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
8858d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
886b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
8871e3db1deSHans Petter Selasky 	linux_set_current(td);
8888d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
8898d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
8908d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
8918d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
8928d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
8938d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
8948d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
8958d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
896a6b28ee0SHans Petter Selasky 		} else {
8978d59ecb2SHans Petter Selasky 			error = -bytes;
89867e984c8SHans Petter Selasky 			if (error == ERESTARTSYS)
899328c75d6SHans Petter Selasky 				error = ERESTART;
900a6b28ee0SHans Petter Selasky 		}
9018d59ecb2SHans Petter Selasky 	} else
9028d59ecb2SHans Petter Selasky 		error = ENXIO;
9038d59ecb2SHans Petter Selasky 
90467e984c8SHans Petter Selasky 	/* update kqfilter status, if any */
90567e984c8SHans Petter Selasky 	linux_dev_kqfilter_poll(filp, LINUX_KQ_FLAG_HAS_READ);
90667e984c8SHans Petter Selasky 
9078d59ecb2SHans Petter Selasky 	return (error);
9088d59ecb2SHans Petter Selasky }
9098d59ecb2SHans Petter Selasky 
9108d59ecb2SHans Petter Selasky static int
9118d59ecb2SHans Petter Selasky linux_dev_write(struct cdev *dev, struct uio *uio, int ioflag)
9128d59ecb2SHans Petter Selasky {
9138d59ecb2SHans Petter Selasky 	struct linux_file *filp;
914464d20bcSHans Petter Selasky 	struct thread *td;
9158d59ecb2SHans Petter Selasky 	struct file *file;
9168d59ecb2SHans Petter Selasky 	ssize_t bytes;
9178d59ecb2SHans Petter Selasky 	int error;
9188d59ecb2SHans Petter Selasky 
919464d20bcSHans Petter Selasky 	td = curthread;
920464d20bcSHans Petter Selasky 	file = td->td_fpop;
9216e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
9226e3e6544SHans Petter Selasky 		return (ENXIO);
9238d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
9248d59ecb2SHans Petter Selasky 		return (error);
9258d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
926b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
9278d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
928b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
9291e3db1deSHans Petter Selasky 	linux_set_current(td);
9308d59ecb2SHans Petter Selasky 	if (filp->f_op->write) {
9318d59ecb2SHans Petter Selasky 		bytes = filp->f_op->write(filp, uio->uio_iov->iov_base,
9328d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
9338d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
9348d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
9358d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
9368d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
9378d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
938a6b28ee0SHans Petter Selasky 		} else {
9398d59ecb2SHans Petter Selasky 			error = -bytes;
94067e984c8SHans Petter Selasky 			if (error == ERESTARTSYS)
941328c75d6SHans Petter Selasky 				error = ERESTART;
942a6b28ee0SHans Petter Selasky 		}
9438d59ecb2SHans Petter Selasky 	} else
9448d59ecb2SHans Petter Selasky 		error = ENXIO;
9458d59ecb2SHans Petter Selasky 
94667e984c8SHans Petter Selasky 	/* update kqfilter status, if any */
94767e984c8SHans Petter Selasky 	linux_dev_kqfilter_poll(filp, LINUX_KQ_FLAG_HAS_WRITE);
94867e984c8SHans Petter Selasky 
9498d59ecb2SHans Petter Selasky 	return (error);
9508d59ecb2SHans Petter Selasky }
9518d59ecb2SHans Petter Selasky 
9528d59ecb2SHans Petter Selasky static int
9538d59ecb2SHans Petter Selasky linux_dev_poll(struct cdev *dev, int events, struct thread *td)
9548d59ecb2SHans Petter Selasky {
9558d59ecb2SHans Petter Selasky 	struct linux_file *filp;
9568d59ecb2SHans Petter Selasky 	struct file *file;
9578d59ecb2SHans Petter Selasky 	int revents;
9586e3e6544SHans Petter Selasky 
9596e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
9606e3e6544SHans Petter Selasky 		goto error;
9616e3e6544SHans Petter Selasky 	if (devfs_get_cdevpriv((void **)&filp) != 0)
9626e3e6544SHans Petter Selasky 		goto error;
9638d59ecb2SHans Petter Selasky 
964464d20bcSHans Petter Selasky 	file = td->td_fpop;
9658d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
9661e3db1deSHans Petter Selasky 	linux_set_current(td);
9678600ba1aSHans Petter Selasky 	if (filp->f_op->poll != NULL) {
9688600ba1aSHans Petter Selasky 		selrecord(td, &filp->f_selinfo);
9698d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
9708600ba1aSHans Petter Selasky 	} else
9718d59ecb2SHans Petter Selasky 		revents = 0;
9728d59ecb2SHans Petter Selasky 
9738d59ecb2SHans Petter Selasky 	return (revents);
9746e3e6544SHans Petter Selasky error:
9756e3e6544SHans Petter Selasky 	return (events & (POLLHUP|POLLIN|POLLRDNORM|POLLOUT|POLLWRNORM));
9768d59ecb2SHans Petter Selasky }
9778d59ecb2SHans Petter Selasky 
978a6b28ee0SHans Petter Selasky void
979a6b28ee0SHans Petter Selasky linux_poll_wakeup(struct linux_file *filp)
980a6b28ee0SHans Petter Selasky {
981a6b28ee0SHans Petter Selasky 	/* this function should be NULL-safe */
982a6b28ee0SHans Petter Selasky 	if (filp == NULL)
983a6b28ee0SHans Petter Selasky 		return;
984a6b28ee0SHans Petter Selasky 
985a6b28ee0SHans Petter Selasky 	selwakeup(&filp->f_selinfo);
986a6b28ee0SHans Petter Selasky 
987a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
988a6b28ee0SHans Petter Selasky 	filp->f_kqflags |= LINUX_KQ_FLAG_NEED_READ |
989a6b28ee0SHans Petter Selasky 	    LINUX_KQ_FLAG_NEED_WRITE;
990a6b28ee0SHans Petter Selasky 
991a6b28ee0SHans Petter Selasky 	/* make sure the "knote" gets woken up */
992a6b28ee0SHans Petter Selasky 	KNOTE_LOCKED(&filp->f_selinfo.si_note, 1);
993a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
994a6b28ee0SHans Petter Selasky }
995a6b28ee0SHans Petter Selasky 
996a6b28ee0SHans Petter Selasky static void
997a6b28ee0SHans Petter Selasky linux_dev_kqfilter_detach(struct knote *kn)
998a6b28ee0SHans Petter Selasky {
999a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
1000a6b28ee0SHans Petter Selasky 
1001a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
1002a6b28ee0SHans Petter Selasky 	knlist_remove(&filp->f_selinfo.si_note, kn, 1);
1003a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
1004a6b28ee0SHans Petter Selasky }
1005a6b28ee0SHans Petter Selasky 
1006a6b28ee0SHans Petter Selasky static int
1007a6b28ee0SHans Petter Selasky linux_dev_kqfilter_read_event(struct knote *kn, long hint)
1008a6b28ee0SHans Petter Selasky {
1009a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
1010a6b28ee0SHans Petter Selasky 
1011a6b28ee0SHans Petter Selasky 	mtx_assert(&filp->f_kqlock.m, MA_OWNED);
1012a6b28ee0SHans Petter Selasky 
1013a6b28ee0SHans Petter Selasky 	return ((filp->f_kqflags & LINUX_KQ_FLAG_NEED_READ) ? 1 : 0);
1014a6b28ee0SHans Petter Selasky }
1015a6b28ee0SHans Petter Selasky 
1016a6b28ee0SHans Petter Selasky static int
1017a6b28ee0SHans Petter Selasky linux_dev_kqfilter_write_event(struct knote *kn, long hint)
1018a6b28ee0SHans Petter Selasky {
1019a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
1020a6b28ee0SHans Petter Selasky 
1021a6b28ee0SHans Petter Selasky 	mtx_assert(&filp->f_kqlock.m, MA_OWNED);
1022a6b28ee0SHans Petter Selasky 
1023a6b28ee0SHans Petter Selasky 	return ((filp->f_kqflags & LINUX_KQ_FLAG_NEED_WRITE) ? 1 : 0);
1024a6b28ee0SHans Petter Selasky }
1025a6b28ee0SHans Petter Selasky 
1026a6b28ee0SHans Petter Selasky static struct filterops linux_dev_kqfiltops_read = {
1027a6b28ee0SHans Petter Selasky 	.f_isfd = 1,
1028a6b28ee0SHans Petter Selasky 	.f_detach = linux_dev_kqfilter_detach,
1029a6b28ee0SHans Petter Selasky 	.f_event = linux_dev_kqfilter_read_event,
1030a6b28ee0SHans Petter Selasky };
1031a6b28ee0SHans Petter Selasky 
1032a6b28ee0SHans Petter Selasky static struct filterops linux_dev_kqfiltops_write = {
1033a6b28ee0SHans Petter Selasky 	.f_isfd = 1,
1034a6b28ee0SHans Petter Selasky 	.f_detach = linux_dev_kqfilter_detach,
1035a6b28ee0SHans Petter Selasky 	.f_event = linux_dev_kqfilter_write_event,
1036a6b28ee0SHans Petter Selasky };
1037a6b28ee0SHans Petter Selasky 
1038a6b28ee0SHans Petter Selasky static void
103967e984c8SHans Petter Selasky linux_dev_kqfilter_poll(struct linux_file *filp, int kqflags)
1040a6b28ee0SHans Petter Selasky {
1041a6b28ee0SHans Petter Selasky 	int temp;
1042a6b28ee0SHans Petter Selasky 
104367e984c8SHans Petter Selasky 	if (filp->f_kqflags & kqflags) {
1044a6b28ee0SHans Petter Selasky 		/* get the latest polling state */
1045a6b28ee0SHans Petter Selasky 		temp = filp->f_op->poll(filp, NULL);
1046a6b28ee0SHans Petter Selasky 
1047a6b28ee0SHans Petter Selasky 		spin_lock(&filp->f_kqlock);
104867e984c8SHans Petter Selasky 		/* clear kqflags */
104967e984c8SHans Petter Selasky 		filp->f_kqflags &= ~(LINUX_KQ_FLAG_NEED_READ |
105067e984c8SHans Petter Selasky 		    LINUX_KQ_FLAG_NEED_WRITE);
105167e984c8SHans Petter Selasky 		/* update kqflags */
105267e984c8SHans Petter Selasky 		if (temp & (POLLIN | POLLOUT)) {
1053a6b28ee0SHans Petter Selasky 			if (temp & POLLIN)
1054a6b28ee0SHans Petter Selasky 				filp->f_kqflags |= LINUX_KQ_FLAG_NEED_READ;
1055a6b28ee0SHans Petter Selasky 			if (temp & POLLOUT)
1056a6b28ee0SHans Petter Selasky 				filp->f_kqflags |= LINUX_KQ_FLAG_NEED_WRITE;
1057a6b28ee0SHans Petter Selasky 
1058a6b28ee0SHans Petter Selasky 			/* make sure the "knote" gets woken up */
1059a6b28ee0SHans Petter Selasky 			KNOTE_LOCKED(&filp->f_selinfo.si_note, 0);
1060a6b28ee0SHans Petter Selasky 		}
106167e984c8SHans Petter Selasky 		spin_unlock(&filp->f_kqlock);
1062a6b28ee0SHans Petter Selasky 	}
1063a6b28ee0SHans Petter Selasky }
1064a6b28ee0SHans Petter Selasky 
1065a6b28ee0SHans Petter Selasky static int
1066a6b28ee0SHans Petter Selasky linux_dev_kqfilter(struct cdev *dev, struct knote *kn)
1067a6b28ee0SHans Petter Selasky {
1068a6b28ee0SHans Petter Selasky 	struct linux_file *filp;
1069a6b28ee0SHans Petter Selasky 	struct file *file;
1070a6b28ee0SHans Petter Selasky 	struct thread *td;
1071a6b28ee0SHans Petter Selasky 	int error;
1072a6b28ee0SHans Petter Selasky 
1073a6b28ee0SHans Petter Selasky 	td = curthread;
1074a6b28ee0SHans Petter Selasky 	file = td->td_fpop;
1075a6b28ee0SHans Petter Selasky 	if (dev->si_drv1 == NULL)
1076a6b28ee0SHans Petter Selasky 		return (ENXIO);
1077a6b28ee0SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
1078a6b28ee0SHans Petter Selasky 		return (error);
1079a6b28ee0SHans Petter Selasky 	filp->f_flags = file->f_flag;
1080a6b28ee0SHans Petter Selasky 	if (filp->f_op->poll == NULL)
1081a6b28ee0SHans Petter Selasky 		return (EINVAL);
1082a6b28ee0SHans Petter Selasky 
1083a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
1084a6b28ee0SHans Petter Selasky 	switch (kn->kn_filter) {
1085a6b28ee0SHans Petter Selasky 	case EVFILT_READ:
1086a6b28ee0SHans Petter Selasky 		filp->f_kqflags |= LINUX_KQ_FLAG_HAS_READ;
1087a6b28ee0SHans Petter Selasky 		kn->kn_fop = &linux_dev_kqfiltops_read;
1088a6b28ee0SHans Petter Selasky 		kn->kn_hook = filp;
1089a6b28ee0SHans Petter Selasky 		knlist_add(&filp->f_selinfo.si_note, kn, 1);
1090a6b28ee0SHans Petter Selasky 		break;
1091a6b28ee0SHans Petter Selasky 	case EVFILT_WRITE:
1092a6b28ee0SHans Petter Selasky 		filp->f_kqflags |= LINUX_KQ_FLAG_HAS_WRITE;
1093a6b28ee0SHans Petter Selasky 		kn->kn_fop = &linux_dev_kqfiltops_write;
1094a6b28ee0SHans Petter Selasky 		kn->kn_hook = filp;
1095a6b28ee0SHans Petter Selasky 		knlist_add(&filp->f_selinfo.si_note, kn, 1);
1096a6b28ee0SHans Petter Selasky 		break;
1097a6b28ee0SHans Petter Selasky 	default:
1098a6b28ee0SHans Petter Selasky 		error = EINVAL;
1099a6b28ee0SHans Petter Selasky 		break;
1100a6b28ee0SHans Petter Selasky 	}
1101a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
1102a6b28ee0SHans Petter Selasky 
1103a6b28ee0SHans Petter Selasky 	if (error == 0) {
1104a6b28ee0SHans Petter Selasky 		linux_set_current(td);
110567e984c8SHans Petter Selasky 
110667e984c8SHans Petter Selasky 		/* update kqfilter status, if any */
110767e984c8SHans Petter Selasky 		linux_dev_kqfilter_poll(filp,
110867e984c8SHans Petter Selasky 		    LINUX_KQ_FLAG_HAS_READ | LINUX_KQ_FLAG_HAS_WRITE);
1109a6b28ee0SHans Petter Selasky 	}
1110a6b28ee0SHans Petter Selasky 	return (error);
1111a6b28ee0SHans Petter Selasky }
1112a6b28ee0SHans Petter Selasky 
11138d59ecb2SHans Petter Selasky static int
11148d59ecb2SHans Petter Selasky linux_dev_mmap_single(struct cdev *dev, vm_ooffset_t *offset,
11158d59ecb2SHans Petter Selasky     vm_size_t size, struct vm_object **object, int nprot)
11168d59ecb2SHans Petter Selasky {
11171ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
1118cca15f28SHans Petter Selasky 	struct mm_struct *mm;
11198d59ecb2SHans Petter Selasky 	struct linux_file *filp;
1120464d20bcSHans Petter Selasky 	struct thread *td;
11218d59ecb2SHans Petter Selasky 	struct file *file;
11221ea4c857SHans Petter Selasky 	vm_memattr_t attr;
11238d59ecb2SHans Petter Selasky 	int error;
11248d59ecb2SHans Petter Selasky 
1125464d20bcSHans Petter Selasky 	td = curthread;
1126464d20bcSHans Petter Selasky 	file = td->td_fpop;
11276e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
11288d59ecb2SHans Petter Selasky 		return (ENODEV);
11298d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
11308d59ecb2SHans Petter Selasky 		return (error);
11318d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
11321ea4c857SHans Petter Selasky 
11331ea4c857SHans Petter Selasky 	if (filp->f_op->mmap == NULL)
11341ea4c857SHans Petter Selasky 		return (ENODEV);
11351ea4c857SHans Petter Selasky 
11361e3db1deSHans Petter Selasky 	linux_set_current(td);
11371ea4c857SHans Petter Selasky 
1138cca15f28SHans Petter Selasky 	/*
1139cca15f28SHans Petter Selasky 	 * The same VM object might be shared by multiple processes
1140cca15f28SHans Petter Selasky 	 * and the mm_struct is usually freed when a process exits.
1141cca15f28SHans Petter Selasky 	 *
1142cca15f28SHans Petter Selasky 	 * The atomic reference below makes sure the mm_struct is
1143cca15f28SHans Petter Selasky 	 * available as long as the vmap is in the linux_vma_head.
1144cca15f28SHans Petter Selasky 	 */
1145cca15f28SHans Petter Selasky 	mm = current->mm;
1146cca15f28SHans Petter Selasky 	if (atomic_inc_not_zero(&mm->mm_users) == 0)
1147cca15f28SHans Petter Selasky 		return (EINVAL);
1148cca15f28SHans Petter Selasky 
11491ea4c857SHans Petter Selasky 	vmap = kzalloc(sizeof(*vmap), GFP_KERNEL);
11501ea4c857SHans Petter Selasky 	vmap->vm_start = 0;
11511ea4c857SHans Petter Selasky 	vmap->vm_end = size;
11521ea4c857SHans Petter Selasky 	vmap->vm_pgoff = *offset / PAGE_SIZE;
11531ea4c857SHans Petter Selasky 	vmap->vm_pfn = 0;
11541ea4c857SHans Petter Selasky 	vmap->vm_flags = vmap->vm_page_prot = nprot;
11551ea4c857SHans Petter Selasky 	vmap->vm_ops = NULL;
1156d56f1ed8SHans Petter Selasky 	vmap->vm_file = get_file(filp);
1157cca15f28SHans Petter Selasky 	vmap->vm_mm = mm;
11581ea4c857SHans Petter Selasky 
11591ea4c857SHans Petter Selasky 	if (unlikely(down_write_killable(&vmap->vm_mm->mmap_sem))) {
11601ea4c857SHans Petter Selasky 		error = EINTR;
11611ea4c857SHans Petter Selasky 	} else {
11621ea4c857SHans Petter Selasky 		error = -filp->f_op->mmap(filp, vmap);
11631ea4c857SHans Petter Selasky 		up_write(&vmap->vm_mm->mmap_sem);
11641ea4c857SHans Petter Selasky 	}
11651ea4c857SHans Petter Selasky 
11661ea4c857SHans Petter Selasky 	if (error != 0) {
1167cca15f28SHans Petter Selasky 		linux_cdev_handle_free(vmap);
11681ea4c857SHans Petter Selasky 		return (error);
11691ea4c857SHans Petter Selasky 	}
11701ea4c857SHans Petter Selasky 
11711ea4c857SHans Petter Selasky 	attr = pgprot2cachemode(vmap->vm_page_prot);
11721ea4c857SHans Petter Selasky 
11731ea4c857SHans Petter Selasky 	if (vmap->vm_ops != NULL) {
11741ea4c857SHans Petter Selasky 		void *vm_private_data;
11751ea4c857SHans Petter Selasky 
1176*cde3f930SHans Petter Selasky 		if (vmap->vm_ops->open == NULL ||
11771ea4c857SHans Petter Selasky 		    vmap->vm_ops->close == NULL ||
11781ea4c857SHans Petter Selasky 		    vmap->vm_private_data == NULL) {
1179cca15f28SHans Petter Selasky 			linux_cdev_handle_free(vmap);
11801ea4c857SHans Petter Selasky 			return (EINVAL);
11811ea4c857SHans Petter Selasky 		}
11821ea4c857SHans Petter Selasky 
11831ea4c857SHans Petter Selasky 		vm_private_data = vmap->vm_private_data;
11841ea4c857SHans Petter Selasky 
11851ea4c857SHans Petter Selasky 		vmap = linux_cdev_handle_insert(vm_private_data, vmap);
11861ea4c857SHans Petter Selasky 
11871ea4c857SHans Petter Selasky 		*object = cdev_pager_allocate(vm_private_data, OBJT_MGTDEVICE,
11881ea4c857SHans Petter Selasky 		    &linux_cdev_pager_ops, size, nprot, *offset, curthread->td_ucred);
11891ea4c857SHans Petter Selasky 
11901ea4c857SHans Petter Selasky 		if (*object == NULL) {
11911ea4c857SHans Petter Selasky 			linux_cdev_handle_remove(vmap);
1192cca15f28SHans Petter Selasky 			linux_cdev_handle_free(vmap);
11931ea4c857SHans Petter Selasky 			return (EINVAL);
11941ea4c857SHans Petter Selasky 		}
11951ea4c857SHans Petter Selasky 	} else {
11968d59ecb2SHans Petter Selasky 		struct sglist *sg;
11978d59ecb2SHans Petter Selasky 
11988d59ecb2SHans Petter Selasky 		sg = sglist_alloc(1, M_WAITOK);
11991ea4c857SHans Petter Selasky 		sglist_append_phys(sg, (vm_paddr_t)vmap->vm_pfn << PAGE_SHIFT, vmap->vm_len);
12001ea4c857SHans Petter Selasky 
12011ea4c857SHans Petter Selasky 		*object = vm_pager_allocate(OBJT_SG, sg, vmap->vm_len,
12021ea4c857SHans Petter Selasky 		    nprot, 0, curthread->td_ucred);
12031ea4c857SHans Petter Selasky 
1204cca15f28SHans Petter Selasky 		linux_cdev_handle_free(vmap);
12051ea4c857SHans Petter Selasky 
12068d59ecb2SHans Petter Selasky 		if (*object == NULL) {
12078d59ecb2SHans Petter Selasky 			sglist_free(sg);
12081ea4c857SHans Petter Selasky 			return (EINVAL);
12098d59ecb2SHans Petter Selasky 		}
12101ea4c857SHans Petter Selasky 	}
12111ea4c857SHans Petter Selasky 
12121ea4c857SHans Petter Selasky 	if (attr != VM_MEMATTR_DEFAULT) {
12138d59ecb2SHans Petter Selasky 		VM_OBJECT_WLOCK(*object);
12141ea4c857SHans Petter Selasky 		vm_object_set_memattr(*object, attr);
12158d59ecb2SHans Petter Selasky 		VM_OBJECT_WUNLOCK(*object);
12168d59ecb2SHans Petter Selasky 	}
12171ea4c857SHans Petter Selasky 	*offset = 0;
12181ea4c857SHans Petter Selasky 	return (0);
12198d59ecb2SHans Petter Selasky }
12208d59ecb2SHans Petter Selasky 
12218d59ecb2SHans Petter Selasky struct cdevsw linuxcdevsw = {
12228d59ecb2SHans Petter Selasky 	.d_version = D_VERSION,
12238d59ecb2SHans Petter Selasky 	.d_flags = D_TRACKCLOSE,
12248d59ecb2SHans Petter Selasky 	.d_open = linux_dev_open,
12258d59ecb2SHans Petter Selasky 	.d_close = linux_dev_close,
12268d59ecb2SHans Petter Selasky 	.d_read = linux_dev_read,
12278d59ecb2SHans Petter Selasky 	.d_write = linux_dev_write,
12288d59ecb2SHans Petter Selasky 	.d_ioctl = linux_dev_ioctl,
12298d59ecb2SHans Petter Selasky 	.d_mmap_single = linux_dev_mmap_single,
12308d59ecb2SHans Petter Selasky 	.d_poll = linux_dev_poll,
1231a6b28ee0SHans Petter Selasky 	.d_kqfilter = linux_dev_kqfilter,
123290b30e65SHans Petter Selasky 	.d_name = "lkpidev",
12338d59ecb2SHans Petter Selasky };
12348d59ecb2SHans Petter Selasky 
12358d59ecb2SHans Petter Selasky static int
12368d59ecb2SHans Petter Selasky linux_file_read(struct file *file, struct uio *uio, struct ucred *active_cred,
12378d59ecb2SHans Petter Selasky     int flags, struct thread *td)
12388d59ecb2SHans Petter Selasky {
12398d59ecb2SHans Petter Selasky 	struct linux_file *filp;
12408d59ecb2SHans Petter Selasky 	ssize_t bytes;
12418d59ecb2SHans Petter Selasky 	int error;
12428d59ecb2SHans Petter Selasky 
12438d59ecb2SHans Petter Selasky 	error = 0;
12448d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
12458d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
1246b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
12478d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
1248b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
12491e3db1deSHans Petter Selasky 	linux_set_current(td);
12508d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
12518d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
12528d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
12538d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
12548d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
12558d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
12568d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
12578d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
12588d59ecb2SHans Petter Selasky 		} else
12598d59ecb2SHans Petter Selasky 			error = -bytes;
12608d59ecb2SHans Petter Selasky 	} else
12618d59ecb2SHans Petter Selasky 		error = ENXIO;
12628d59ecb2SHans Petter Selasky 
12638d59ecb2SHans Petter Selasky 	return (error);
12648d59ecb2SHans Petter Selasky }
12658d59ecb2SHans Petter Selasky 
12668d59ecb2SHans Petter Selasky static int
12678d59ecb2SHans Petter Selasky linux_file_poll(struct file *file, int events, struct ucred *active_cred,
12688d59ecb2SHans Petter Selasky     struct thread *td)
12698d59ecb2SHans Petter Selasky {
12708d59ecb2SHans Petter Selasky 	struct linux_file *filp;
12718d59ecb2SHans Petter Selasky 	int revents;
12728d59ecb2SHans Petter Selasky 
12738d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
12748d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
12751e3db1deSHans Petter Selasky 	linux_set_current(td);
12768600ba1aSHans Petter Selasky 	if (filp->f_op->poll != NULL) {
12778600ba1aSHans Petter Selasky 		selrecord(td, &filp->f_selinfo);
12788d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
12798600ba1aSHans Petter Selasky 	} else
12808d59ecb2SHans Petter Selasky 		revents = 0;
12818d59ecb2SHans Petter Selasky 
12820754e66cSHans Petter Selasky 	return (revents);
12838d59ecb2SHans Petter Selasky }
12848d59ecb2SHans Petter Selasky 
12858d59ecb2SHans Petter Selasky static int
12868d59ecb2SHans Petter Selasky linux_file_close(struct file *file, 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 *)file->f_data;
12928d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
12931e3db1deSHans Petter Selasky 	linux_set_current(td);
12948d59ecb2SHans Petter Selasky 	error = -filp->f_op->release(NULL, filp);
12958d59ecb2SHans Petter Selasky 	funsetown(&filp->f_sigio);
12968d59ecb2SHans Petter Selasky 	kfree(filp);
12978d59ecb2SHans Petter Selasky 
12988d59ecb2SHans Petter Selasky 	return (error);
12998d59ecb2SHans Petter Selasky }
13008d59ecb2SHans Petter Selasky 
13018d59ecb2SHans Petter Selasky static int
13028d59ecb2SHans Petter Selasky linux_file_ioctl(struct file *fp, u_long cmd, void *data, struct ucred *cred,
13038d59ecb2SHans Petter Selasky     struct thread *td)
13048d59ecb2SHans Petter Selasky {
13058d59ecb2SHans Petter Selasky 	struct linux_file *filp;
13068d59ecb2SHans Petter Selasky 	int error;
13078d59ecb2SHans Petter Selasky 
13088d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)fp->f_data;
13098d59ecb2SHans Petter Selasky 	filp->f_flags = fp->f_flag;
13108d59ecb2SHans Petter Selasky 	error = 0;
13118d59ecb2SHans Petter Selasky 
13121e3db1deSHans Petter Selasky 	linux_set_current(td);
13138d59ecb2SHans Petter Selasky 	switch (cmd) {
13148d59ecb2SHans Petter Selasky 	case FIONBIO:
13158d59ecb2SHans Petter Selasky 		break;
13168d59ecb2SHans Petter Selasky 	case FIOASYNC:
13178d59ecb2SHans Petter Selasky 		if (filp->f_op->fasync == NULL)
13188d59ecb2SHans Petter Selasky 			break;
13198d59ecb2SHans Petter Selasky 		error = filp->f_op->fasync(0, filp, fp->f_flag & FASYNC);
13208d59ecb2SHans Petter Selasky 		break;
13218d59ecb2SHans Petter Selasky 	case FIOSETOWN:
13228d59ecb2SHans Petter Selasky 		error = fsetown(*(int *)data, &filp->f_sigio);
13238d59ecb2SHans Petter Selasky 		if (error == 0)
13248d59ecb2SHans Petter Selasky 			error = filp->f_op->fasync(0, filp,
13258d59ecb2SHans Petter Selasky 			    fp->f_flag & FASYNC);
13268d59ecb2SHans Petter Selasky 		break;
13278d59ecb2SHans Petter Selasky 	case FIOGETOWN:
13288d59ecb2SHans Petter Selasky 		*(int *)data = fgetown(&filp->f_sigio);
13298d59ecb2SHans Petter Selasky 		break;
13308d59ecb2SHans Petter Selasky 	default:
13318d59ecb2SHans Petter Selasky 		error = ENOTTY;
13328d59ecb2SHans Petter Selasky 		break;
13338d59ecb2SHans Petter Selasky 	}
13348d59ecb2SHans Petter Selasky 	return (error);
13358d59ecb2SHans Petter Selasky }
13368d59ecb2SHans Petter Selasky 
13378d59ecb2SHans Petter Selasky static int
13388d59ecb2SHans Petter Selasky linux_file_stat(struct file *fp, struct stat *sb, struct ucred *active_cred,
13398d59ecb2SHans Petter Selasky     struct thread *td)
13408d59ecb2SHans Petter Selasky {
13418d59ecb2SHans Petter Selasky 
13428d59ecb2SHans Petter Selasky 	return (EOPNOTSUPP);
13438d59ecb2SHans Petter Selasky }
13448d59ecb2SHans Petter Selasky 
13458d59ecb2SHans Petter Selasky static int
13468d59ecb2SHans Petter Selasky linux_file_fill_kinfo(struct file *fp, struct kinfo_file *kif,
13478d59ecb2SHans Petter Selasky     struct filedesc *fdp)
13488d59ecb2SHans Petter Selasky {
13498d59ecb2SHans Petter Selasky 
13508d59ecb2SHans Petter Selasky 	return (0);
13518d59ecb2SHans Petter Selasky }
13528d59ecb2SHans Petter Selasky 
13538d59ecb2SHans Petter Selasky struct fileops linuxfileops = {
13548d59ecb2SHans Petter Selasky 	.fo_read = linux_file_read,
13558d59ecb2SHans Petter Selasky 	.fo_write = invfo_rdwr,
13568d59ecb2SHans Petter Selasky 	.fo_truncate = invfo_truncate,
13578d59ecb2SHans Petter Selasky 	.fo_kqfilter = invfo_kqfilter,
13588d59ecb2SHans Petter Selasky 	.fo_stat = linux_file_stat,
13598d59ecb2SHans Petter Selasky 	.fo_fill_kinfo = linux_file_fill_kinfo,
13608d59ecb2SHans Petter Selasky 	.fo_poll = linux_file_poll,
13618d59ecb2SHans Petter Selasky 	.fo_close = linux_file_close,
13628d59ecb2SHans Petter Selasky 	.fo_ioctl = linux_file_ioctl,
13638d59ecb2SHans Petter Selasky 	.fo_chmod = invfo_chmod,
13648d59ecb2SHans Petter Selasky 	.fo_chown = invfo_chown,
13658d59ecb2SHans Petter Selasky 	.fo_sendfile = invfo_sendfile,
13668d59ecb2SHans Petter Selasky };
13678d59ecb2SHans Petter Selasky 
13688d59ecb2SHans Petter Selasky /*
13698d59ecb2SHans Petter Selasky  * Hash of vmmap addresses.  This is infrequently accessed and does not
13708d59ecb2SHans Petter Selasky  * need to be particularly large.  This is done because we must store the
13718d59ecb2SHans Petter Selasky  * caller's idea of the map size to properly unmap.
13728d59ecb2SHans Petter Selasky  */
13738d59ecb2SHans Petter Selasky struct vmmap {
13748d59ecb2SHans Petter Selasky 	LIST_ENTRY(vmmap)	vm_next;
13758d59ecb2SHans Petter Selasky 	void 			*vm_addr;
13768d59ecb2SHans Petter Selasky 	unsigned long		vm_size;
13778d59ecb2SHans Petter Selasky };
13788d59ecb2SHans Petter Selasky 
13798d59ecb2SHans Petter Selasky struct vmmaphd {
13808d59ecb2SHans Petter Selasky 	struct vmmap *lh_first;
13818d59ecb2SHans Petter Selasky };
13828d59ecb2SHans Petter Selasky #define	VMMAP_HASH_SIZE	64
13838d59ecb2SHans Petter Selasky #define	VMMAP_HASH_MASK	(VMMAP_HASH_SIZE - 1)
13848d59ecb2SHans Petter Selasky #define	VM_HASH(addr)	((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK
13858d59ecb2SHans Petter Selasky static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE];
13868d59ecb2SHans Petter Selasky static struct mtx vmmaplock;
13878d59ecb2SHans Petter Selasky 
13888d59ecb2SHans Petter Selasky static void
13898d59ecb2SHans Petter Selasky vmmap_add(void *addr, unsigned long size)
13908d59ecb2SHans Petter Selasky {
13918d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
13928d59ecb2SHans Petter Selasky 
13938d59ecb2SHans Petter Selasky 	vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL);
13948d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
13958d59ecb2SHans Petter Selasky 	vmmap->vm_size = size;
13968d59ecb2SHans Petter Selasky 	vmmap->vm_addr = addr;
13978d59ecb2SHans Petter Selasky 	LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next);
13988d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
13998d59ecb2SHans Petter Selasky }
14008d59ecb2SHans Petter Selasky 
14018d59ecb2SHans Petter Selasky static struct vmmap *
14028d59ecb2SHans Petter Selasky vmmap_remove(void *addr)
14038d59ecb2SHans Petter Selasky {
14048d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
14058d59ecb2SHans Petter Selasky 
14068d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
14078d59ecb2SHans Petter Selasky 	LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next)
14088d59ecb2SHans Petter Selasky 		if (vmmap->vm_addr == addr)
14098d59ecb2SHans Petter Selasky 			break;
14108d59ecb2SHans Petter Selasky 	if (vmmap)
14118d59ecb2SHans Petter Selasky 		LIST_REMOVE(vmmap, vm_next);
14128d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
14138d59ecb2SHans Petter Selasky 
14148d59ecb2SHans Petter Selasky 	return (vmmap);
14158d59ecb2SHans Petter Selasky }
14168d59ecb2SHans Petter Selasky 
1417864092bcSJustin Hibbits #if defined(__i386__) || defined(__amd64__) || defined(__powerpc__)
14188d59ecb2SHans Petter Selasky void *
14198d59ecb2SHans Petter Selasky _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr)
14208d59ecb2SHans Petter Selasky {
14218d59ecb2SHans Petter Selasky 	void *addr;
14228d59ecb2SHans Petter Selasky 
14238d59ecb2SHans Petter Selasky 	addr = pmap_mapdev_attr(phys_addr, size, attr);
14248d59ecb2SHans Petter Selasky 	if (addr == NULL)
14258d59ecb2SHans Petter Selasky 		return (NULL);
14268d59ecb2SHans Petter Selasky 	vmmap_add(addr, size);
14278d59ecb2SHans Petter Selasky 
14288d59ecb2SHans Petter Selasky 	return (addr);
14298d59ecb2SHans Petter Selasky }
143086845417SHans Petter Selasky #endif
14318d59ecb2SHans Petter Selasky 
14328d59ecb2SHans Petter Selasky void
14338d59ecb2SHans Petter Selasky iounmap(void *addr)
14348d59ecb2SHans Petter Selasky {
14358d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
14368d59ecb2SHans Petter Selasky 
14378d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
14388d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
14398d59ecb2SHans Petter Selasky 		return;
1440864092bcSJustin Hibbits #if defined(__i386__) || defined(__amd64__) || defined(__powerpc__)
14418d59ecb2SHans Petter Selasky 	pmap_unmapdev((vm_offset_t)addr, vmmap->vm_size);
14428d59ecb2SHans Petter Selasky #endif
14438d59ecb2SHans Petter Selasky 	kfree(vmmap);
14448d59ecb2SHans Petter Selasky }
14458d59ecb2SHans Petter Selasky 
14468d59ecb2SHans Petter Selasky 
14478d59ecb2SHans Petter Selasky void *
14488d59ecb2SHans Petter Selasky vmap(struct page **pages, unsigned int count, unsigned long flags, int prot)
14498d59ecb2SHans Petter Selasky {
14508d59ecb2SHans Petter Selasky 	vm_offset_t off;
14518d59ecb2SHans Petter Selasky 	size_t size;
14528d59ecb2SHans Petter Selasky 
14538d59ecb2SHans Petter Selasky 	size = count * PAGE_SIZE;
14548d59ecb2SHans Petter Selasky 	off = kva_alloc(size);
14558d59ecb2SHans Petter Selasky 	if (off == 0)
14568d59ecb2SHans Petter Selasky 		return (NULL);
14578d59ecb2SHans Petter Selasky 	vmmap_add((void *)off, size);
14588d59ecb2SHans Petter Selasky 	pmap_qenter(off, pages, count);
14598d59ecb2SHans Petter Selasky 
14608d59ecb2SHans Petter Selasky 	return ((void *)off);
14618d59ecb2SHans Petter Selasky }
14628d59ecb2SHans Petter Selasky 
14638d59ecb2SHans Petter Selasky void
14648d59ecb2SHans Petter Selasky vunmap(void *addr)
14658d59ecb2SHans Petter Selasky {
14668d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
14678d59ecb2SHans Petter Selasky 
14688d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
14698d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
14708d59ecb2SHans Petter Selasky 		return;
14718d59ecb2SHans Petter Selasky 	pmap_qremove((vm_offset_t)addr, vmmap->vm_size / PAGE_SIZE);
14728d59ecb2SHans Petter Selasky 	kva_free((vm_offset_t)addr, vmmap->vm_size);
14738d59ecb2SHans Petter Selasky 	kfree(vmmap);
14748d59ecb2SHans Petter Selasky }
14758d59ecb2SHans Petter Selasky 
14768d59ecb2SHans Petter Selasky char *
14778d59ecb2SHans Petter Selasky kvasprintf(gfp_t gfp, const char *fmt, va_list ap)
14788d59ecb2SHans Petter Selasky {
14798d59ecb2SHans Petter Selasky 	unsigned int len;
14808d59ecb2SHans Petter Selasky 	char *p;
14818d59ecb2SHans Petter Selasky 	va_list aq;
14828d59ecb2SHans Petter Selasky 
14838d59ecb2SHans Petter Selasky 	va_copy(aq, ap);
14848d59ecb2SHans Petter Selasky 	len = vsnprintf(NULL, 0, fmt, aq);
14858d59ecb2SHans Petter Selasky 	va_end(aq);
14868d59ecb2SHans Petter Selasky 
14878d59ecb2SHans Petter Selasky 	p = kmalloc(len + 1, gfp);
14888d59ecb2SHans Petter Selasky 	if (p != NULL)
14898d59ecb2SHans Petter Selasky 		vsnprintf(p, len + 1, fmt, ap);
14908d59ecb2SHans Petter Selasky 
14918d59ecb2SHans Petter Selasky 	return (p);
14928d59ecb2SHans Petter Selasky }
14938d59ecb2SHans Petter Selasky 
14948d59ecb2SHans Petter Selasky char *
14958d59ecb2SHans Petter Selasky kasprintf(gfp_t gfp, const char *fmt, ...)
14968d59ecb2SHans Petter Selasky {
14978d59ecb2SHans Petter Selasky 	va_list ap;
14988d59ecb2SHans Petter Selasky 	char *p;
14998d59ecb2SHans Petter Selasky 
15008d59ecb2SHans Petter Selasky 	va_start(ap, fmt);
15018d59ecb2SHans Petter Selasky 	p = kvasprintf(gfp, fmt, ap);
15028d59ecb2SHans Petter Selasky 	va_end(ap);
15038d59ecb2SHans Petter Selasky 
15048d59ecb2SHans Petter Selasky 	return (p);
15058d59ecb2SHans Petter Selasky }
15068d59ecb2SHans Petter Selasky 
15078d59ecb2SHans Petter Selasky static void
15088d59ecb2SHans Petter Selasky linux_timer_callback_wrapper(void *context)
15098d59ecb2SHans Petter Selasky {
15108d59ecb2SHans Petter Selasky 	struct timer_list *timer;
15118d59ecb2SHans Petter Selasky 
15125f50a414SHans Petter Selasky 	linux_set_current(curthread);
15135f50a414SHans Petter Selasky 
15148d59ecb2SHans Petter Selasky 	timer = context;
15158d59ecb2SHans Petter Selasky 	timer->function(timer->data);
15168d59ecb2SHans Petter Selasky }
15178d59ecb2SHans Petter Selasky 
15188d59ecb2SHans Petter Selasky void
15198d59ecb2SHans Petter Selasky mod_timer(struct timer_list *timer, unsigned long expires)
15208d59ecb2SHans Petter Selasky {
15218d59ecb2SHans Petter Selasky 
15228d59ecb2SHans Petter Selasky 	timer->expires = expires;
15238d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
15248d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(expires),
15258d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
15268d59ecb2SHans Petter Selasky }
15278d59ecb2SHans Petter Selasky 
15288d59ecb2SHans Petter Selasky void
15298d59ecb2SHans Petter Selasky add_timer(struct timer_list *timer)
15308d59ecb2SHans Petter Selasky {
15318d59ecb2SHans Petter Selasky 
15328d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
15338d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
15348d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
15358d59ecb2SHans Petter Selasky }
15368d59ecb2SHans Petter Selasky 
1537def277d3SHans Petter Selasky void
1538def277d3SHans Petter Selasky add_timer_on(struct timer_list *timer, int cpu)
1539def277d3SHans Petter Selasky {
1540def277d3SHans Petter Selasky 
1541def277d3SHans Petter Selasky 	callout_reset_on(&timer->timer_callout,
1542def277d3SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
1543def277d3SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer, cpu);
1544def277d3SHans Petter Selasky }
1545def277d3SHans Petter Selasky 
15468d59ecb2SHans Petter Selasky static void
15478d59ecb2SHans Petter Selasky linux_timer_init(void *arg)
15488d59ecb2SHans Petter Selasky {
15498d59ecb2SHans Petter Selasky 
15508d59ecb2SHans Petter Selasky 	/*
15518d59ecb2SHans Petter Selasky 	 * Compute an internal HZ value which can divide 2**32 to
15528d59ecb2SHans Petter Selasky 	 * avoid timer rounding problems when the tick value wraps
15538d59ecb2SHans Petter Selasky 	 * around 2**32:
15548d59ecb2SHans Petter Selasky 	 */
15558d59ecb2SHans Petter Selasky 	linux_timer_hz_mask = 1;
15568d59ecb2SHans Petter Selasky 	while (linux_timer_hz_mask < (unsigned long)hz)
15578d59ecb2SHans Petter Selasky 		linux_timer_hz_mask *= 2;
15588d59ecb2SHans Petter Selasky 	linux_timer_hz_mask--;
15598d59ecb2SHans Petter Selasky }
15608d59ecb2SHans Petter Selasky SYSINIT(linux_timer, SI_SUB_DRIVERS, SI_ORDER_FIRST, linux_timer_init, NULL);
15618d59ecb2SHans Petter Selasky 
15628d59ecb2SHans Petter Selasky void
15638d59ecb2SHans Petter Selasky linux_complete_common(struct completion *c, int all)
15648d59ecb2SHans Petter Selasky {
15658d59ecb2SHans Petter Selasky 	int wakeup_swapper;
15668d59ecb2SHans Petter Selasky 
15678d59ecb2SHans Petter Selasky 	sleepq_lock(c);
15688d59ecb2SHans Petter Selasky 	c->done++;
15698d59ecb2SHans Petter Selasky 	if (all)
15708d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_broadcast(c, SLEEPQ_SLEEP, 0, 0);
15718d59ecb2SHans Petter Selasky 	else
15728d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_signal(c, SLEEPQ_SLEEP, 0, 0);
15738d59ecb2SHans Petter Selasky 	sleepq_release(c);
15748d59ecb2SHans Petter Selasky 	if (wakeup_swapper)
15758d59ecb2SHans Petter Selasky 		kick_proc0();
15768d59ecb2SHans Petter Selasky }
15778d59ecb2SHans Petter Selasky 
15788d59ecb2SHans Petter Selasky /*
15798d59ecb2SHans Petter Selasky  * Indefinite wait for done != 0 with or without signals.
15808d59ecb2SHans Petter Selasky  */
15818d59ecb2SHans Petter Selasky long
15828d59ecb2SHans Petter Selasky linux_wait_for_common(struct completion *c, int flags)
15838d59ecb2SHans Petter Selasky {
1584b602c283SMark Johnston 	long error;
1585b602c283SMark Johnston 
15868eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
158785714218SHans Petter Selasky 		return (0);
15888d59ecb2SHans Petter Selasky 
1589b602c283SMark Johnston 	DROP_GIANT();
1590b602c283SMark Johnston 
15918d59ecb2SHans Petter Selasky 	if (flags != 0)
15928d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
15938d59ecb2SHans Petter Selasky 	else
15948d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
1595b602c283SMark Johnston 	error = 0;
15968d59ecb2SHans Petter Selasky 	for (;;) {
15978d59ecb2SHans Petter Selasky 		sleepq_lock(c);
15988d59ecb2SHans Petter Selasky 		if (c->done)
15998d59ecb2SHans Petter Selasky 			break;
16008d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
16018d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE) {
1602b602c283SMark Johnston 			if (sleepq_wait_sig(c, 0) != 0) {
1603b602c283SMark Johnston 				error = -ERESTARTSYS;
1604b602c283SMark Johnston 				goto intr;
1605b602c283SMark Johnston 			}
16068d59ecb2SHans Petter Selasky 		} else
16078d59ecb2SHans Petter Selasky 			sleepq_wait(c, 0);
16088d59ecb2SHans Petter Selasky 	}
16098d59ecb2SHans Petter Selasky 	c->done--;
16108d59ecb2SHans Petter Selasky 	sleepq_release(c);
16118d59ecb2SHans Petter Selasky 
1612b602c283SMark Johnston intr:
1613b602c283SMark Johnston 	PICKUP_GIANT();
1614b602c283SMark Johnston 
1615b602c283SMark Johnston 	return (error);
16168d59ecb2SHans Petter Selasky }
16178d59ecb2SHans Petter Selasky 
16188d59ecb2SHans Petter Selasky /*
16198d59ecb2SHans Petter Selasky  * Time limited wait for done != 0 with or without signals.
16208d59ecb2SHans Petter Selasky  */
16218d59ecb2SHans Petter Selasky long
16228d59ecb2SHans Petter Selasky linux_wait_for_timeout_common(struct completion *c, long timeout, int flags)
16238d59ecb2SHans Petter Selasky {
1624b602c283SMark Johnston 	long end = jiffies + timeout, error;
1625b602c283SMark Johnston 	int ret;
16268d59ecb2SHans Petter Selasky 
16278eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
162885714218SHans Petter Selasky 		return (0);
162985714218SHans Petter Selasky 
1630b602c283SMark Johnston 	DROP_GIANT();
1631b602c283SMark Johnston 
16328d59ecb2SHans Petter Selasky 	if (flags != 0)
16338d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
16348d59ecb2SHans Petter Selasky 	else
16358d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
16368d59ecb2SHans Petter Selasky 
1637b602c283SMark Johnston 	error = 0;
1638b602c283SMark Johnston 	ret = 0;
1639b602c283SMark Johnston 	for (;;) {
16408d59ecb2SHans Petter Selasky 		sleepq_lock(c);
16418d59ecb2SHans Petter Selasky 		if (c->done)
16428d59ecb2SHans Petter Selasky 			break;
16438d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
16448d59ecb2SHans Petter Selasky 		sleepq_set_timeout(c, linux_timer_jiffies_until(end));
16458d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE)
16468d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait_sig(c, 0);
16478d59ecb2SHans Petter Selasky 		else
16488d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait(c, 0);
16498d59ecb2SHans Petter Selasky 		if (ret != 0) {
16508d59ecb2SHans Petter Selasky 			/* check for timeout or signal */
16518d59ecb2SHans Petter Selasky 			if (ret == EWOULDBLOCK)
1652b602c283SMark Johnston 				error = 0;
16538d59ecb2SHans Petter Selasky 			else
1654b602c283SMark Johnston 				error = -ERESTARTSYS;
1655b602c283SMark Johnston 			goto intr;
16568d59ecb2SHans Petter Selasky 		}
16578d59ecb2SHans Petter Selasky 	}
16588d59ecb2SHans Petter Selasky 	c->done--;
16598d59ecb2SHans Petter Selasky 	sleepq_release(c);
16608d59ecb2SHans Petter Selasky 
1661b602c283SMark Johnston intr:
1662b602c283SMark Johnston 	PICKUP_GIANT();
1663b602c283SMark Johnston 
16648d59ecb2SHans Petter Selasky 	/* return how many jiffies are left */
1665b602c283SMark Johnston 	return (ret != 0 ? error : linux_timer_jiffies_until(end));
16668d59ecb2SHans Petter Selasky }
16678d59ecb2SHans Petter Selasky 
16688d59ecb2SHans Petter Selasky int
16698d59ecb2SHans Petter Selasky linux_try_wait_for_completion(struct completion *c)
16708d59ecb2SHans Petter Selasky {
16718d59ecb2SHans Petter Selasky 	int isdone;
16728d59ecb2SHans Petter Selasky 
16738d59ecb2SHans Petter Selasky 	isdone = 1;
16748d59ecb2SHans Petter Selasky 	sleepq_lock(c);
16758d59ecb2SHans Petter Selasky 	if (c->done)
16768d59ecb2SHans Petter Selasky 		c->done--;
16778d59ecb2SHans Petter Selasky 	else
16788d59ecb2SHans Petter Selasky 		isdone = 0;
16798d59ecb2SHans Petter Selasky 	sleepq_release(c);
16808d59ecb2SHans Petter Selasky 	return (isdone);
16818d59ecb2SHans Petter Selasky }
16828d59ecb2SHans Petter Selasky 
16838d59ecb2SHans Petter Selasky int
16848d59ecb2SHans Petter Selasky linux_completion_done(struct completion *c)
16858d59ecb2SHans Petter Selasky {
16868d59ecb2SHans Petter Selasky 	int isdone;
16878d59ecb2SHans Petter Selasky 
16888d59ecb2SHans Petter Selasky 	isdone = 1;
16898d59ecb2SHans Petter Selasky 	sleepq_lock(c);
16908d59ecb2SHans Petter Selasky 	if (c->done == 0)
16918d59ecb2SHans Petter Selasky 		isdone = 0;
16928d59ecb2SHans Petter Selasky 	sleepq_release(c);
16938d59ecb2SHans Petter Selasky 	return (isdone);
16948d59ecb2SHans Petter Selasky }
16958d59ecb2SHans Petter Selasky 
16968d59ecb2SHans Petter Selasky static void
169706204f8eSHans Petter Selasky linux_cdev_release(struct kobject *kobj)
169806204f8eSHans Petter Selasky {
169906204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
170006204f8eSHans Petter Selasky 	struct kobject *parent;
170106204f8eSHans Petter Selasky 
170206204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
170306204f8eSHans Petter Selasky 	parent = kobj->parent;
170406204f8eSHans Petter Selasky 	if (cdev->cdev)
170506204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
170606204f8eSHans Petter Selasky 	kfree(cdev);
170706204f8eSHans Petter Selasky 	kobject_put(parent);
170806204f8eSHans Petter Selasky }
170906204f8eSHans Petter Selasky 
171006204f8eSHans Petter Selasky static void
171106204f8eSHans Petter Selasky linux_cdev_static_release(struct kobject *kobj)
171206204f8eSHans Petter Selasky {
171306204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
171406204f8eSHans Petter Selasky 	struct kobject *parent;
171506204f8eSHans Petter Selasky 
171606204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
171706204f8eSHans Petter Selasky 	parent = kobj->parent;
171806204f8eSHans Petter Selasky 	if (cdev->cdev)
171906204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
172006204f8eSHans Petter Selasky 	kobject_put(parent);
172106204f8eSHans Petter Selasky }
172206204f8eSHans Petter Selasky 
172306204f8eSHans Petter Selasky const struct kobj_type linux_cdev_ktype = {
172406204f8eSHans Petter Selasky 	.release = linux_cdev_release,
172506204f8eSHans Petter Selasky };
172606204f8eSHans Petter Selasky 
172706204f8eSHans Petter Selasky const struct kobj_type linux_cdev_static_ktype = {
172806204f8eSHans Petter Selasky 	.release = linux_cdev_static_release,
172906204f8eSHans Petter Selasky };
173006204f8eSHans Petter Selasky 
173106204f8eSHans Petter Selasky static void
17320c510167SHans Petter Selasky linux_handle_ifnet_link_event(void *arg, struct ifnet *ifp, int linkstate)
17330c510167SHans Petter Selasky {
17340c510167SHans Petter Selasky 	struct notifier_block *nb;
17350c510167SHans Petter Selasky 
17360c510167SHans Petter Selasky 	nb = arg;
17370c510167SHans Petter Selasky 	if (linkstate == LINK_STATE_UP)
17380c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_UP, ifp);
17390c510167SHans Petter Selasky 	else
17400c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_DOWN, ifp);
17410c510167SHans Petter Selasky }
17420c510167SHans Petter Selasky 
17430c510167SHans Petter Selasky static void
17440c510167SHans Petter Selasky linux_handle_ifnet_arrival_event(void *arg, struct ifnet *ifp)
17450c510167SHans Petter Selasky {
17460c510167SHans Petter Selasky 	struct notifier_block *nb;
17470c510167SHans Petter Selasky 
17480c510167SHans Petter Selasky 	nb = arg;
17490c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_REGISTER, ifp);
17500c510167SHans Petter Selasky }
17510c510167SHans Petter Selasky 
17520c510167SHans Petter Selasky static void
17530c510167SHans Petter Selasky linux_handle_ifnet_departure_event(void *arg, struct ifnet *ifp)
17540c510167SHans Petter Selasky {
17550c510167SHans Petter Selasky 	struct notifier_block *nb;
17560c510167SHans Petter Selasky 
17570c510167SHans Petter Selasky 	nb = arg;
17580c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_UNREGISTER, ifp);
17590c510167SHans Petter Selasky }
17600c510167SHans Petter Selasky 
17610c510167SHans Petter Selasky static void
17620c510167SHans Petter Selasky linux_handle_iflladdr_event(void *arg, struct ifnet *ifp)
17630c510167SHans Petter Selasky {
17640c510167SHans Petter Selasky 	struct notifier_block *nb;
17650c510167SHans Petter Selasky 
17660c510167SHans Petter Selasky 	nb = arg;
17670c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEADDR, ifp);
17680c510167SHans Petter Selasky }
17690c510167SHans Petter Selasky 
17700c510167SHans Petter Selasky static void
17710c510167SHans Petter Selasky linux_handle_ifaddr_event(void *arg, struct ifnet *ifp)
17720c510167SHans Petter Selasky {
17730c510167SHans Petter Selasky 	struct notifier_block *nb;
17740c510167SHans Petter Selasky 
17750c510167SHans Petter Selasky 	nb = arg;
17760c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEIFADDR, ifp);
17770c510167SHans Petter Selasky }
17780c510167SHans Petter Selasky 
17790c510167SHans Petter Selasky int
17800c510167SHans Petter Selasky register_netdevice_notifier(struct notifier_block *nb)
17810c510167SHans Petter Selasky {
17820c510167SHans Petter Selasky 
17830c510167SHans Petter Selasky 	nb->tags[NETDEV_UP] = EVENTHANDLER_REGISTER(
17840c510167SHans Petter Selasky 	    ifnet_link_event, linux_handle_ifnet_link_event, nb, 0);
17850c510167SHans Petter Selasky 	nb->tags[NETDEV_REGISTER] = EVENTHANDLER_REGISTER(
17860c510167SHans Petter Selasky 	    ifnet_arrival_event, linux_handle_ifnet_arrival_event, nb, 0);
17870c510167SHans Petter Selasky 	nb->tags[NETDEV_UNREGISTER] = EVENTHANDLER_REGISTER(
17880c510167SHans Petter Selasky 	    ifnet_departure_event, linux_handle_ifnet_departure_event, nb, 0);
17890c510167SHans Petter Selasky 	nb->tags[NETDEV_CHANGEADDR] = EVENTHANDLER_REGISTER(
17900c510167SHans Petter Selasky 	    iflladdr_event, linux_handle_iflladdr_event, nb, 0);
17910c510167SHans Petter Selasky 
17920c510167SHans Petter Selasky 	return (0);
17930c510167SHans Petter Selasky }
17940c510167SHans Petter Selasky 
17950c510167SHans Petter Selasky int
17960c510167SHans Petter Selasky register_inetaddr_notifier(struct notifier_block *nb)
17970c510167SHans Petter Selasky {
17980c510167SHans Petter Selasky 
17990c510167SHans Petter Selasky         nb->tags[NETDEV_CHANGEIFADDR] = EVENTHANDLER_REGISTER(
18000c510167SHans Petter Selasky             ifaddr_event, linux_handle_ifaddr_event, nb, 0);
18010c510167SHans Petter Selasky         return (0);
18020c510167SHans Petter Selasky }
18030c510167SHans Petter Selasky 
18040c510167SHans Petter Selasky int
18050c510167SHans Petter Selasky unregister_netdevice_notifier(struct notifier_block *nb)
18060c510167SHans Petter Selasky {
18070c510167SHans Petter Selasky 
18080c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_link_event,
18090c510167SHans Petter Selasky 	    nb->tags[NETDEV_UP]);
18100c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_arrival_event,
18110c510167SHans Petter Selasky 	    nb->tags[NETDEV_REGISTER]);
18120c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_departure_event,
18130c510167SHans Petter Selasky 	    nb->tags[NETDEV_UNREGISTER]);
18140c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(iflladdr_event,
18150c510167SHans Petter Selasky 	    nb->tags[NETDEV_CHANGEADDR]);
18160c510167SHans Petter Selasky 
18170c510167SHans Petter Selasky 	return (0);
18180c510167SHans Petter Selasky }
18190c510167SHans Petter Selasky 
18200c510167SHans Petter Selasky int
18210c510167SHans Petter Selasky unregister_inetaddr_notifier(struct notifier_block *nb)
18220c510167SHans Petter Selasky {
18230c510167SHans Petter Selasky 
18240c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifaddr_event,
18250c510167SHans Petter Selasky             nb->tags[NETDEV_CHANGEIFADDR]);
18260c510167SHans Petter Selasky 
18270c510167SHans Petter Selasky         return (0);
18280c510167SHans Petter Selasky }
18290c510167SHans Petter Selasky 
1830aad02fb4SHans Petter Selasky struct list_sort_thunk {
1831aad02fb4SHans Petter Selasky 	int (*cmp)(void *, struct list_head *, struct list_head *);
1832aad02fb4SHans Petter Selasky 	void *priv;
1833aad02fb4SHans Petter Selasky };
1834aad02fb4SHans Petter Selasky 
1835aad02fb4SHans Petter Selasky static inline int
1836aad02fb4SHans Petter Selasky linux_le_cmp(void *priv, const void *d1, const void *d2)
1837aad02fb4SHans Petter Selasky {
1838aad02fb4SHans Petter Selasky 	struct list_head *le1, *le2;
1839aad02fb4SHans Petter Selasky 	struct list_sort_thunk *thunk;
1840aad02fb4SHans Petter Selasky 
1841aad02fb4SHans Petter Selasky 	thunk = priv;
1842aad02fb4SHans Petter Selasky 	le1 = *(__DECONST(struct list_head **, d1));
1843aad02fb4SHans Petter Selasky 	le2 = *(__DECONST(struct list_head **, d2));
1844aad02fb4SHans Petter Selasky 	return ((thunk->cmp)(thunk->priv, le1, le2));
1845aad02fb4SHans Petter Selasky }
1846aad02fb4SHans Petter Selasky 
1847aad02fb4SHans Petter Selasky void
1848aad02fb4SHans Petter Selasky list_sort(void *priv, struct list_head *head, int (*cmp)(void *priv,
1849aad02fb4SHans Petter Selasky     struct list_head *a, struct list_head *b))
1850aad02fb4SHans Petter Selasky {
1851aad02fb4SHans Petter Selasky 	struct list_sort_thunk thunk;
1852aad02fb4SHans Petter Selasky 	struct list_head **ar, *le;
1853aad02fb4SHans Petter Selasky 	size_t count, i;
1854aad02fb4SHans Petter Selasky 
1855aad02fb4SHans Petter Selasky 	count = 0;
1856aad02fb4SHans Petter Selasky 	list_for_each(le, head)
1857aad02fb4SHans Petter Selasky 		count++;
1858aad02fb4SHans Petter Selasky 	ar = malloc(sizeof(struct list_head *) * count, M_KMALLOC, M_WAITOK);
1859aad02fb4SHans Petter Selasky 	i = 0;
1860aad02fb4SHans Petter Selasky 	list_for_each(le, head)
1861aad02fb4SHans Petter Selasky 		ar[i++] = le;
1862aad02fb4SHans Petter Selasky 	thunk.cmp = cmp;
1863aad02fb4SHans Petter Selasky 	thunk.priv = priv;
1864aad02fb4SHans Petter Selasky 	qsort_r(ar, count, sizeof(struct list_head *), &thunk, linux_le_cmp);
1865aad02fb4SHans Petter Selasky 	INIT_LIST_HEAD(head);
1866aad02fb4SHans Petter Selasky 	for (i = 0; i < count; i++)
1867aad02fb4SHans Petter Selasky 		list_add_tail(ar[i], head);
1868aad02fb4SHans Petter Selasky 	free(ar, M_KMALLOC);
1869aad02fb4SHans Petter Selasky }
1870aad02fb4SHans Petter Selasky 
18710c510167SHans Petter Selasky void
18720c510167SHans Petter Selasky linux_irq_handler(void *ent)
18730c510167SHans Petter Selasky {
18740c510167SHans Petter Selasky 	struct irq_ent *irqe;
18750c510167SHans Petter Selasky 
18765f50a414SHans Petter Selasky 	linux_set_current(curthread);
18775f50a414SHans Petter Selasky 
18780c510167SHans Petter Selasky 	irqe = ent;
18790c510167SHans Petter Selasky 	irqe->handler(irqe->irq, irqe->arg);
18800c510167SHans Petter Selasky }
18810c510167SHans Petter Selasky 
1882c12488bbSMark Johnston #if defined(__i386__) || defined(__amd64__)
1883c12488bbSMark Johnston int
1884c12488bbSMark Johnston linux_wbinvd_on_all_cpus(void)
1885c12488bbSMark Johnston {
1886c12488bbSMark Johnston 
18876c106233SMark Johnston 	pmap_invalidate_cache();
18886c106233SMark Johnston 	return (0);
1889c12488bbSMark Johnston }
1890c12488bbSMark Johnston #endif
1891c12488bbSMark Johnston 
1892c12488bbSMark Johnston int
1893c12488bbSMark Johnston linux_on_each_cpu(void callback(void *), void *data)
1894c12488bbSMark Johnston {
1895c12488bbSMark Johnston 
1896c12488bbSMark Johnston 	smp_rendezvous(smp_no_rendezvous_barrier, callback,
1897c12488bbSMark Johnston 	    smp_no_rendezvous_barrier, data);
1898c12488bbSMark Johnston 	return (0);
1899c12488bbSMark Johnston }
1900c12488bbSMark Johnston 
1901dff36e69SHans Petter Selasky int
1902dff36e69SHans Petter Selasky linux_in_atomic(void)
1903dff36e69SHans Petter Selasky {
1904dff36e69SHans Petter Selasky 
1905dff36e69SHans Petter Selasky 	return ((curthread->td_pflags & TDP_NOFAULTING) != 0);
1906dff36e69SHans Petter Selasky }
1907dff36e69SHans Petter Selasky 
19081125dbc0SHans Petter Selasky struct linux_cdev *
19091125dbc0SHans Petter Selasky linux_find_cdev(const char *name, unsigned major, unsigned minor)
19101125dbc0SHans Petter Selasky {
19111125dbc0SHans Petter Selasky 	int unit = MKDEV(major, minor);
19121125dbc0SHans Petter Selasky 	struct cdev *cdev;
19131125dbc0SHans Petter Selasky 
19141125dbc0SHans Petter Selasky 	dev_lock();
19151125dbc0SHans Petter Selasky 	LIST_FOREACH(cdev, &linuxcdevsw.d_devs, si_list) {
19161125dbc0SHans Petter Selasky 		struct linux_cdev *ldev = cdev->si_drv1;
19171125dbc0SHans Petter Selasky 		if (dev2unit(cdev) == unit &&
19181125dbc0SHans Petter Selasky 		    strcmp(kobject_name(&ldev->kobj), name) == 0) {
19191125dbc0SHans Petter Selasky 			break;
19201125dbc0SHans Petter Selasky 		}
19211125dbc0SHans Petter Selasky 	}
19221125dbc0SHans Petter Selasky 	dev_unlock();
19231125dbc0SHans Petter Selasky 
19241125dbc0SHans Petter Selasky 	return (cdev != NULL ? cdev->si_drv1 : NULL);
19251125dbc0SHans Petter Selasky }
19261125dbc0SHans Petter Selasky 
19271125dbc0SHans Petter Selasky int
19281125dbc0SHans Petter Selasky __register_chrdev(unsigned int major, unsigned int baseminor,
19291125dbc0SHans Petter Selasky     unsigned int count, const char *name,
19301125dbc0SHans Petter Selasky     const struct file_operations *fops)
19311125dbc0SHans Petter Selasky {
19321125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
19331125dbc0SHans Petter Selasky 	int ret = 0;
19341125dbc0SHans Petter Selasky 	int i;
19351125dbc0SHans Petter Selasky 
19361125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
19371125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
19381125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
19391125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
19401125dbc0SHans Petter Selasky 
19411125dbc0SHans Petter Selasky 		ret = cdev_add(cdev, makedev(major, i), 1);
19421125dbc0SHans Petter Selasky 		if (ret != 0)
19431125dbc0SHans Petter Selasky 			break;
19441125dbc0SHans Petter Selasky 	}
19451125dbc0SHans Petter Selasky 	return (ret);
19461125dbc0SHans Petter Selasky }
19471125dbc0SHans Petter Selasky 
19481125dbc0SHans Petter Selasky int
19491125dbc0SHans Petter Selasky __register_chrdev_p(unsigned int major, unsigned int baseminor,
19501125dbc0SHans Petter Selasky     unsigned int count, const char *name,
19511125dbc0SHans Petter Selasky     const struct file_operations *fops, uid_t uid,
19521125dbc0SHans Petter Selasky     gid_t gid, int mode)
19531125dbc0SHans Petter Selasky {
19541125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
19551125dbc0SHans Petter Selasky 	int ret = 0;
19561125dbc0SHans Petter Selasky 	int i;
19571125dbc0SHans Petter Selasky 
19581125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
19591125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
19601125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
19611125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
19621125dbc0SHans Petter Selasky 
19631125dbc0SHans Petter Selasky 		ret = cdev_add_ext(cdev, makedev(major, i), uid, gid, mode);
19641125dbc0SHans Petter Selasky 		if (ret != 0)
19651125dbc0SHans Petter Selasky 			break;
19661125dbc0SHans Petter Selasky 	}
19671125dbc0SHans Petter Selasky 	return (ret);
19681125dbc0SHans Petter Selasky }
19691125dbc0SHans Petter Selasky 
19701125dbc0SHans Petter Selasky void
19711125dbc0SHans Petter Selasky __unregister_chrdev(unsigned int major, unsigned int baseminor,
19721125dbc0SHans Petter Selasky     unsigned int count, const char *name)
19731125dbc0SHans Petter Selasky {
19741125dbc0SHans Petter Selasky 	struct linux_cdev *cdevp;
19751125dbc0SHans Petter Selasky 	int i;
19761125dbc0SHans Petter Selasky 
19771125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
19781125dbc0SHans Petter Selasky 		cdevp = linux_find_cdev(name, major, i);
19791125dbc0SHans Petter Selasky 		if (cdevp != NULL)
19801125dbc0SHans Petter Selasky 			cdev_del(cdevp);
19811125dbc0SHans Petter Selasky 	}
19821125dbc0SHans Petter Selasky }
19831125dbc0SHans Petter Selasky 
198403219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
198503219fbaSHans Petter Selasky bool linux_cpu_has_clflush;
198603219fbaSHans Petter Selasky #endif
198703219fbaSHans Petter Selasky 
19880c510167SHans Petter Selasky static void
19898d59ecb2SHans Petter Selasky linux_compat_init(void *arg)
19908d59ecb2SHans Petter Selasky {
19918d59ecb2SHans Petter Selasky 	struct sysctl_oid *rootoid;
19928d59ecb2SHans Petter Selasky 	int i;
19938d59ecb2SHans Petter Selasky 
199403219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
199503219fbaSHans Petter Selasky 	linux_cpu_has_clflush = (cpu_feature & CPUID_CLFSH);
199603219fbaSHans Petter Selasky #endif
19971ea4c857SHans Petter Selasky 	rw_init(&linux_vma_lock, "lkpi-vma-lock");
1998e10c4cc0SHans Petter Selasky 
19998d59ecb2SHans Petter Selasky 	rootoid = SYSCTL_ADD_ROOT_NODE(NULL,
20008d59ecb2SHans Petter Selasky 	    OID_AUTO, "sys", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "sys");
200106204f8eSHans Petter Selasky 	kobject_init(&linux_class_root, &linux_class_ktype);
200206204f8eSHans Petter Selasky 	kobject_set_name(&linux_class_root, "class");
200306204f8eSHans Petter Selasky 	linux_class_root.oidp = SYSCTL_ADD_NODE(NULL, SYSCTL_CHILDREN(rootoid),
20048d59ecb2SHans Petter Selasky 	    OID_AUTO, "class", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "class");
200506204f8eSHans Petter Selasky 	kobject_init(&linux_root_device.kobj, &linux_dev_ktype);
200606204f8eSHans Petter Selasky 	kobject_set_name(&linux_root_device.kobj, "device");
200706204f8eSHans Petter Selasky 	linux_root_device.kobj.oidp = SYSCTL_ADD_NODE(NULL,
20088d59ecb2SHans Petter Selasky 	    SYSCTL_CHILDREN(rootoid), OID_AUTO, "device", CTLFLAG_RD, NULL,
20098d59ecb2SHans Petter Selasky 	    "device");
201006204f8eSHans Petter Selasky 	linux_root_device.bsddev = root_bus;
201106204f8eSHans Petter Selasky 	linux_class_misc.name = "misc";
201206204f8eSHans Petter Selasky 	class_register(&linux_class_misc);
20138d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_drivers);
20148d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_devices);
20158d59ecb2SHans Petter Selasky 	spin_lock_init(&pci_lock);
20168d59ecb2SHans Petter Selasky 	mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF);
20178d59ecb2SHans Petter Selasky 	for (i = 0; i < VMMAP_HASH_SIZE; i++)
20188d59ecb2SHans Petter Selasky 		LIST_INIT(&vmmaphead[i]);
20198d59ecb2SHans Petter Selasky }
20208d59ecb2SHans Petter Selasky SYSINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_init, NULL);
20218d59ecb2SHans Petter Selasky 
20228d59ecb2SHans Petter Selasky static void
20238d59ecb2SHans Petter Selasky linux_compat_uninit(void *arg)
20248d59ecb2SHans Petter Selasky {
202506204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_root);
202606204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_root_device.kobj);
202706204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_misc.kobj);
20281ea4c857SHans Petter Selasky 
20291ea4c857SHans Petter Selasky 	rw_destroy(&linux_vma_lock);
20308d59ecb2SHans Petter Selasky }
20318d59ecb2SHans Petter Selasky SYSUNINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_uninit, NULL);
2032f727a767SHans Petter Selasky 
2033f727a767SHans Petter Selasky /*
2034f727a767SHans Petter Selasky  * NOTE: Linux frequently uses "unsigned long" for pointer to integer
2035f727a767SHans Petter Selasky  * conversion and vice versa, where in FreeBSD "uintptr_t" would be
2036f727a767SHans Petter Selasky  * used. Assert these types have the same size, else some parts of the
2037f727a767SHans Petter Selasky  * LinuxKPI may not work like expected:
2038f727a767SHans Petter Selasky  */
2039f727a767SHans Petter Selasky CTASSERT(sizeof(unsigned long) == sizeof(uintptr_t));
2040