xref: /freebsd/sys/compat/linuxkpi/common/src/linux_compat.c (revision 6dec7efa83cd0316c268618cdaa9a383e78312ac)
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) {
466dac6b88aSMark Johnston 		if (filp->f_shmem != NULL)
467dac6b88aSMark Johnston 			vm_object_deallocate(filp->f_shmem);
468f5a9867bSHans Petter Selasky 		kfree(filp);
469f5a9867bSHans Petter Selasky 	} else {
470f5a9867bSHans Petter Selasky 		/*
471f5a9867bSHans Petter Selasky 		 * The close method of the character device or file
472f5a9867bSHans Petter Selasky 		 * will free the linux_file structure:
473f5a9867bSHans Petter Selasky 		 */
474f5a9867bSHans Petter Selasky 		_fdrop(filp->_file, curthread);
475f5a9867bSHans Petter Selasky 	}
476f5a9867bSHans Petter Selasky }
477f5a9867bSHans Petter Selasky 
4788d59ecb2SHans Petter Selasky static int
47961157228SHans Petter Selasky linux_cdev_pager_fault(vm_object_t vm_obj, vm_ooffset_t offset, int prot,
48061157228SHans Petter Selasky     vm_page_t *mres)
48161157228SHans Petter Selasky {
48261157228SHans Petter Selasky 	struct vm_area_struct *vmap;
48361157228SHans Petter Selasky 
48461157228SHans Petter Selasky 	vmap = linux_cdev_handle_find(vm_obj->handle);
48561157228SHans Petter Selasky 
48661157228SHans Petter Selasky 	MPASS(vmap != NULL);
48761157228SHans Petter Selasky 	MPASS(vmap->vm_private_data == vm_obj->handle);
48861157228SHans Petter Selasky 
48961157228SHans Petter Selasky 	if (likely(vmap->vm_ops != NULL && offset < vmap->vm_len)) {
49061157228SHans Petter Selasky 		vm_paddr_t paddr = IDX_TO_OFF(vmap->vm_pfn) + offset;
49161157228SHans Petter Selasky 		vm_page_t page;
49261157228SHans Petter Selasky 
49361157228SHans Petter Selasky 		if (((*mres)->flags & PG_FICTITIOUS) != 0) {
49461157228SHans Petter Selasky 			/*
49561157228SHans Petter Selasky 			 * If the passed in result page is a fake
49661157228SHans Petter Selasky 			 * page, update it with the new physical
49761157228SHans Petter Selasky 			 * address.
49861157228SHans Petter Selasky 			 */
49961157228SHans Petter Selasky 			page = *mres;
50061157228SHans Petter Selasky 			vm_page_updatefake(page, paddr, vm_obj->memattr);
50161157228SHans Petter Selasky 		} else {
50261157228SHans Petter Selasky 			/*
50361157228SHans Petter Selasky 			 * Replace the passed in "mres" page with our
50461157228SHans Petter Selasky 			 * own fake page and free up the all of the
50561157228SHans Petter Selasky 			 * original pages.
50661157228SHans Petter Selasky 			 */
50761157228SHans Petter Selasky 			VM_OBJECT_WUNLOCK(vm_obj);
50861157228SHans Petter Selasky 			page = vm_page_getfake(paddr, vm_obj->memattr);
50961157228SHans Petter Selasky 			VM_OBJECT_WLOCK(vm_obj);
51061157228SHans Petter Selasky 
51161157228SHans Petter Selasky 			vm_page_replace_checked(page, vm_obj,
51261157228SHans Petter Selasky 			    (*mres)->pindex, *mres);
51361157228SHans Petter Selasky 
51461157228SHans Petter Selasky 			vm_page_lock(*mres);
51561157228SHans Petter Selasky 			vm_page_free(*mres);
51661157228SHans Petter Selasky 			vm_page_unlock(*mres);
51761157228SHans Petter Selasky 			*mres = page;
51861157228SHans Petter Selasky 		}
51961157228SHans Petter Selasky 		page->valid = VM_PAGE_BITS_ALL;
52061157228SHans Petter Selasky 		return (VM_PAGER_OK);
52161157228SHans Petter Selasky 	}
52261157228SHans Petter Selasky 	return (VM_PAGER_FAIL);
52361157228SHans Petter Selasky }
52461157228SHans Petter Selasky 
52561157228SHans Petter Selasky static int
5261ea4c857SHans Petter Selasky linux_cdev_pager_populate(vm_object_t vm_obj, vm_pindex_t pidx, int fault_type,
5271ea4c857SHans Petter Selasky     vm_prot_t max_prot, vm_pindex_t *first, vm_pindex_t *last)
5281ea4c857SHans Petter Selasky {
5291ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
5301ea4c857SHans Petter Selasky 	int err;
5311ea4c857SHans Petter Selasky 
5321ea4c857SHans Petter Selasky 	linux_set_current(curthread);
5331ea4c857SHans Petter Selasky 
5341ea4c857SHans Petter Selasky 	/* get VM area structure */
5351ea4c857SHans Petter Selasky 	vmap = linux_cdev_handle_find(vm_obj->handle);
5361ea4c857SHans Petter Selasky 	MPASS(vmap != NULL);
5371ea4c857SHans Petter Selasky 	MPASS(vmap->vm_private_data == vm_obj->handle);
5381ea4c857SHans Petter Selasky 
53961157228SHans Petter Selasky 	VM_OBJECT_WUNLOCK(vm_obj);
54061157228SHans Petter Selasky 
54161157228SHans Petter Selasky 	down_write(&vmap->vm_mm->mmap_sem);
54261157228SHans Petter Selasky 	if (unlikely(vmap->vm_ops == NULL)) {
54361157228SHans Petter Selasky 		err = VM_FAULT_SIGBUS;
54461157228SHans Petter Selasky 	} else {
54561157228SHans Petter Selasky 		struct vm_fault vmf;
54661157228SHans Petter Selasky 
5471ea4c857SHans Petter Selasky 		/* fill out VM fault structure */
54876fe8c93SHans Petter Selasky 		vmf.virtual_address = (void *)((uintptr_t)pidx << PAGE_SHIFT);
5491ea4c857SHans Petter Selasky 		vmf.flags = (fault_type & VM_PROT_WRITE) ? FAULT_FLAG_WRITE : 0;
5501ea4c857SHans Petter Selasky 		vmf.pgoff = 0;
5511ea4c857SHans Petter Selasky 		vmf.page = NULL;
5521ea4c857SHans Petter Selasky 
5531ea4c857SHans Petter Selasky 		vmap->vm_pfn_count = 0;
5541ea4c857SHans Petter Selasky 		vmap->vm_pfn_pcount = &vmap->vm_pfn_count;
5551ea4c857SHans Petter Selasky 		vmap->vm_obj = vm_obj;
5561ea4c857SHans Petter Selasky 
5571ea4c857SHans Petter Selasky 		err = vmap->vm_ops->fault(vmap, &vmf);
5581ea4c857SHans Petter Selasky 
5591ea4c857SHans Petter Selasky 		while (vmap->vm_pfn_count == 0 && err == VM_FAULT_NOPAGE) {
56002fb845bSMark Johnston 			kern_yield(PRI_USER);
5611ea4c857SHans Petter Selasky 			err = vmap->vm_ops->fault(vmap, &vmf);
5621ea4c857SHans Petter Selasky 		}
5631ea4c857SHans Petter Selasky 	}
5641ea4c857SHans Petter Selasky 
5651ea4c857SHans Petter Selasky 	/* translate return code */
5661ea4c857SHans Petter Selasky 	switch (err) {
5671ea4c857SHans Petter Selasky 	case VM_FAULT_OOM:
5681ea4c857SHans Petter Selasky 		err = VM_PAGER_AGAIN;
5691ea4c857SHans Petter Selasky 		break;
5701ea4c857SHans Petter Selasky 	case VM_FAULT_SIGBUS:
5711ea4c857SHans Petter Selasky 		err = VM_PAGER_BAD;
5721ea4c857SHans Petter Selasky 		break;
5731ea4c857SHans Petter Selasky 	case VM_FAULT_NOPAGE:
5741ea4c857SHans Petter Selasky 		/*
5751ea4c857SHans Petter Selasky 		 * By contract the fault handler will return having
5761ea4c857SHans Petter Selasky 		 * busied all the pages itself. If pidx is already
5771ea4c857SHans Petter Selasky 		 * found in the object, it will simply xbusy the first
5781ea4c857SHans Petter Selasky 		 * page and return with vm_pfn_count set to 1.
5791ea4c857SHans Petter Selasky 		 */
5801ea4c857SHans Petter Selasky 		*first = vmap->vm_pfn_first;
5811ea4c857SHans Petter Selasky 		*last = *first + vmap->vm_pfn_count - 1;
5821ea4c857SHans Petter Selasky 		err = VM_PAGER_OK;
5831ea4c857SHans Petter Selasky 		break;
5841ea4c857SHans Petter Selasky 	default:
5851ea4c857SHans Petter Selasky 		err = VM_PAGER_ERROR;
5861ea4c857SHans Petter Selasky 		break;
5871ea4c857SHans Petter Selasky 	}
5881ea4c857SHans Petter Selasky 	up_write(&vmap->vm_mm->mmap_sem);
5891ea4c857SHans Petter Selasky 	VM_OBJECT_WLOCK(vm_obj);
5901ea4c857SHans Petter Selasky 	return (err);
5911ea4c857SHans Petter Selasky }
5921ea4c857SHans Petter Selasky 
5931ea4c857SHans Petter Selasky static struct rwlock linux_vma_lock;
5941ea4c857SHans Petter Selasky static TAILQ_HEAD(, vm_area_struct) linux_vma_head =
5951ea4c857SHans Petter Selasky     TAILQ_HEAD_INITIALIZER(linux_vma_head);
5961ea4c857SHans Petter Selasky 
597cca15f28SHans Petter Selasky static void
598cca15f28SHans Petter Selasky linux_cdev_handle_free(struct vm_area_struct *vmap)
599cca15f28SHans Petter Selasky {
600d56f1ed8SHans Petter Selasky 	/* Drop reference on vm_file */
601d56f1ed8SHans Petter Selasky 	if (vmap->vm_file != NULL)
602d56f1ed8SHans Petter Selasky 		fput(vmap->vm_file);
603d56f1ed8SHans Petter Selasky 
604cca15f28SHans Petter Selasky 	/* Drop reference on mm_struct */
605cca15f28SHans Petter Selasky 	mmput(vmap->vm_mm);
606cca15f28SHans Petter Selasky 
607cca15f28SHans Petter Selasky 	kfree(vmap);
608cca15f28SHans Petter Selasky }
609cca15f28SHans Petter Selasky 
6101ea4c857SHans Petter Selasky static struct vm_area_struct *
6111ea4c857SHans Petter Selasky linux_cdev_handle_insert(void *handle, struct vm_area_struct *vmap)
6121ea4c857SHans Petter Selasky {
6131ea4c857SHans Petter Selasky 	struct vm_area_struct *ptr;
6141ea4c857SHans Petter Selasky 
6151ea4c857SHans Petter Selasky 	rw_wlock(&linux_vma_lock);
6161ea4c857SHans Petter Selasky 	TAILQ_FOREACH(ptr, &linux_vma_head, vm_entry) {
6171ea4c857SHans Petter Selasky 		if (ptr->vm_private_data == handle) {
6181ea4c857SHans Petter Selasky 			rw_wunlock(&linux_vma_lock);
619cca15f28SHans Petter Selasky 			linux_cdev_handle_free(vmap);
6201ea4c857SHans Petter Selasky 			return (NULL);
6211ea4c857SHans Petter Selasky 		}
6221ea4c857SHans Petter Selasky 	}
6231ea4c857SHans Petter Selasky 	TAILQ_INSERT_TAIL(&linux_vma_head, vmap, vm_entry);
6241ea4c857SHans Petter Selasky 	rw_wunlock(&linux_vma_lock);
6251ea4c857SHans Petter Selasky 	return (vmap);
6261ea4c857SHans Petter Selasky }
6271ea4c857SHans Petter Selasky 
6281ea4c857SHans Petter Selasky static void
6291ea4c857SHans Petter Selasky linux_cdev_handle_remove(struct vm_area_struct *vmap)
6301ea4c857SHans Petter Selasky {
6311ea4c857SHans Petter Selasky 	rw_wlock(&linux_vma_lock);
6321ea4c857SHans Petter Selasky 	TAILQ_REMOVE(&linux_vma_head, vmap, vm_entry);
6331ea4c857SHans Petter Selasky 	rw_wunlock(&linux_vma_lock);
6341ea4c857SHans Petter Selasky }
6351ea4c857SHans Petter Selasky 
6361ea4c857SHans Petter Selasky static struct vm_area_struct *
6371ea4c857SHans Petter Selasky linux_cdev_handle_find(void *handle)
6381ea4c857SHans Petter Selasky {
6391ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
6401ea4c857SHans Petter Selasky 
6411ea4c857SHans Petter Selasky 	rw_rlock(&linux_vma_lock);
6421ea4c857SHans Petter Selasky 	TAILQ_FOREACH(vmap, &linux_vma_head, vm_entry) {
6431ea4c857SHans Petter Selasky 		if (vmap->vm_private_data == handle)
6441ea4c857SHans Petter Selasky 			break;
6451ea4c857SHans Petter Selasky 	}
6461ea4c857SHans Petter Selasky 	rw_runlock(&linux_vma_lock);
6471ea4c857SHans Petter Selasky 	return (vmap);
6481ea4c857SHans Petter Selasky }
6491ea4c857SHans Petter Selasky 
6501ea4c857SHans Petter Selasky static int
6511ea4c857SHans Petter Selasky linux_cdev_pager_ctor(void *handle, vm_ooffset_t size, vm_prot_t prot,
6521ea4c857SHans Petter Selasky 		      vm_ooffset_t foff, struct ucred *cred, u_short *color)
6531ea4c857SHans Petter Selasky {
6541ea4c857SHans Petter Selasky 
655ea67550bSHans Petter Selasky 	MPASS(linux_cdev_handle_find(handle) != NULL);
6561ea4c857SHans Petter Selasky 	*color = 0;
6571ea4c857SHans Petter Selasky 	return (0);
6581ea4c857SHans Petter Selasky }
6591ea4c857SHans Petter Selasky 
6601ea4c857SHans Petter Selasky static void
6611ea4c857SHans Petter Selasky linux_cdev_pager_dtor(void *handle)
6621ea4c857SHans Petter Selasky {
6631ea4c857SHans Petter Selasky 	const struct vm_operations_struct *vm_ops;
6641ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
6651ea4c857SHans Petter Selasky 
6661ea4c857SHans Petter Selasky 	vmap = linux_cdev_handle_find(handle);
6671ea4c857SHans Petter Selasky 	MPASS(vmap != NULL);
6681ea4c857SHans Petter Selasky 
669cca15f28SHans Petter Selasky 	/*
670cca15f28SHans Petter Selasky 	 * Remove handle before calling close operation to prevent
671cca15f28SHans Petter Selasky 	 * other threads from reusing the handle pointer.
672cca15f28SHans Petter Selasky 	 */
673cca15f28SHans Petter Selasky 	linux_cdev_handle_remove(vmap);
674cca15f28SHans Petter Selasky 
6751ea4c857SHans Petter Selasky 	down_write(&vmap->vm_mm->mmap_sem);
6761ea4c857SHans Petter Selasky 	vm_ops = vmap->vm_ops;
6771ea4c857SHans Petter Selasky 	if (likely(vm_ops != NULL))
6781ea4c857SHans Petter Selasky 		vm_ops->close(vmap);
6791ea4c857SHans Petter Selasky 	up_write(&vmap->vm_mm->mmap_sem);
6801ea4c857SHans Petter Selasky 
681cca15f28SHans Petter Selasky 	linux_cdev_handle_free(vmap);
6821ea4c857SHans Petter Selasky }
6831ea4c857SHans Petter Selasky 
68461157228SHans Petter Selasky static struct cdev_pager_ops linux_cdev_pager_ops[2] = {
68561157228SHans Petter Selasky   {
68661157228SHans Petter Selasky 	/* OBJT_MGTDEVICE */
6871ea4c857SHans Petter Selasky 	.cdev_pg_populate	= linux_cdev_pager_populate,
6881ea4c857SHans Petter Selasky 	.cdev_pg_ctor	= linux_cdev_pager_ctor,
6891ea4c857SHans Petter Selasky 	.cdev_pg_dtor	= linux_cdev_pager_dtor
69061157228SHans Petter Selasky   },
69161157228SHans Petter Selasky   {
69261157228SHans Petter Selasky 	/* OBJT_DEVICE */
69361157228SHans Petter Selasky 	.cdev_pg_fault	= linux_cdev_pager_fault,
69461157228SHans Petter Selasky 	.cdev_pg_ctor	= linux_cdev_pager_ctor,
69561157228SHans Petter Selasky 	.cdev_pg_dtor	= linux_cdev_pager_dtor
69661157228SHans Petter Selasky   },
6971ea4c857SHans Petter Selasky };
6981ea4c857SHans Petter Selasky 
6991ea4c857SHans Petter Selasky static int
7008d59ecb2SHans Petter Selasky linux_dev_open(struct cdev *dev, int oflags, int devtype, struct thread *td)
7018d59ecb2SHans Petter Selasky {
7028d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
7038d59ecb2SHans Petter Selasky 	struct linux_file *filp;
7048d59ecb2SHans Petter Selasky 	struct file *file;
7058d59ecb2SHans Petter Selasky 	int error;
7068d59ecb2SHans Petter Selasky 
707464d20bcSHans Petter Selasky 	file = td->td_fpop;
7088d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
7098d59ecb2SHans Petter Selasky 	if (ldev == NULL)
7108d59ecb2SHans Petter Selasky 		return (ENODEV);
711a6b28ee0SHans Petter Selasky 
712a6b28ee0SHans Petter Selasky 	filp = linux_file_alloc();
7138d59ecb2SHans Petter Selasky 	filp->f_dentry = &filp->f_dentry_store;
7148d59ecb2SHans Petter Selasky 	filp->f_op = ldev->ops;
7158d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
7168d59ecb2SHans Petter Selasky 	vhold(file->f_vnode);
7178d59ecb2SHans Petter Selasky 	filp->f_vnode = file->f_vnode;
718f5a9867bSHans Petter Selasky 	filp->_file = file;
719f5a9867bSHans Petter Selasky 
720a6b28ee0SHans Petter Selasky 	linux_set_current(td);
721a6b28ee0SHans Petter Selasky 
7228d59ecb2SHans Petter Selasky 	if (filp->f_op->open) {
7238d59ecb2SHans Petter Selasky 		error = -filp->f_op->open(file->f_vnode, filp);
7248d59ecb2SHans Petter Selasky 		if (error) {
725f5a9867bSHans Petter Selasky 			vdrop(filp->f_vnode);
7268d59ecb2SHans Petter Selasky 			kfree(filp);
727464d20bcSHans Petter Selasky 			goto done;
7288d59ecb2SHans Petter Selasky 		}
7298d59ecb2SHans Petter Selasky 	}
7308d59ecb2SHans Petter Selasky 	error = devfs_set_cdevpriv(filp, linux_file_dtor);
7318d59ecb2SHans Petter Selasky 	if (error) {
7328d59ecb2SHans Petter Selasky 		filp->f_op->release(file->f_vnode, filp);
733f5a9867bSHans Petter Selasky 		vdrop(filp->f_vnode);
7348d59ecb2SHans Petter Selasky 		kfree(filp);
7358d59ecb2SHans Petter Selasky 	}
736464d20bcSHans Petter Selasky done:
737464d20bcSHans Petter Selasky 	return (error);
7388d59ecb2SHans Petter Selasky }
7398d59ecb2SHans Petter Selasky 
7408d59ecb2SHans Petter Selasky static int
7418d59ecb2SHans Petter Selasky linux_dev_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
7428d59ecb2SHans Petter Selasky {
7438d59ecb2SHans Petter Selasky 	struct linux_file *filp;
7448d59ecb2SHans Petter Selasky 	struct file *file;
7458d59ecb2SHans Petter Selasky 	int error;
7468d59ecb2SHans Petter Selasky 
747464d20bcSHans Petter Selasky 	file = td->td_fpop;
7486e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
7498d59ecb2SHans Petter Selasky 		return (0);
7508d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
7518d59ecb2SHans Petter Selasky 		return (error);
7528d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
7538d59ecb2SHans Petter Selasky 	devfs_clear_cdevpriv();
7548d59ecb2SHans Petter Selasky 
7558d59ecb2SHans Petter Selasky 	return (0);
7568d59ecb2SHans Petter Selasky }
7578d59ecb2SHans Petter Selasky 
7583a8bec33SHans Petter Selasky #define	LINUX_IOCTL_MIN_PTR 0x10000UL
7593a8bec33SHans Petter Selasky #define	LINUX_IOCTL_MAX_PTR (LINUX_IOCTL_MIN_PTR + IOCPARM_MAX)
7603a8bec33SHans Petter Selasky 
7613a8bec33SHans Petter Selasky static inline int
7623a8bec33SHans Petter Selasky linux_remap_address(void **uaddr, size_t len)
7633a8bec33SHans Petter Selasky {
7643a8bec33SHans Petter Selasky 	uintptr_t uaddr_val = (uintptr_t)(*uaddr);
7653a8bec33SHans Petter Selasky 
7663a8bec33SHans Petter Selasky 	if (unlikely(uaddr_val >= LINUX_IOCTL_MIN_PTR &&
7673a8bec33SHans Petter Selasky 	    uaddr_val < LINUX_IOCTL_MAX_PTR)) {
7683a8bec33SHans Petter Selasky 		struct task_struct *pts = current;
7693a8bec33SHans Petter Selasky 		if (pts == NULL) {
7703a8bec33SHans Petter Selasky 			*uaddr = NULL;
7713a8bec33SHans Petter Selasky 			return (1);
7723a8bec33SHans Petter Selasky 		}
7733a8bec33SHans Petter Selasky 
7743a8bec33SHans Petter Selasky 		/* compute data offset */
7753a8bec33SHans Petter Selasky 		uaddr_val -= LINUX_IOCTL_MIN_PTR;
7763a8bec33SHans Petter Selasky 
7773a8bec33SHans Petter Selasky 		/* check that length is within bounds */
7783a8bec33SHans Petter Selasky 		if ((len > IOCPARM_MAX) ||
7793a8bec33SHans Petter Selasky 		    (uaddr_val + len) > pts->bsd_ioctl_len) {
7803a8bec33SHans Petter Selasky 			*uaddr = NULL;
7813a8bec33SHans Petter Selasky 			return (1);
7823a8bec33SHans Petter Selasky 		}
7833a8bec33SHans Petter Selasky 
7843a8bec33SHans Petter Selasky 		/* re-add kernel buffer address */
7853a8bec33SHans Petter Selasky 		uaddr_val += (uintptr_t)pts->bsd_ioctl_data;
7863a8bec33SHans Petter Selasky 
7873a8bec33SHans Petter Selasky 		/* update address location */
7883a8bec33SHans Petter Selasky 		*uaddr = (void *)uaddr_val;
7893a8bec33SHans Petter Selasky 		return (1);
7903a8bec33SHans Petter Selasky 	}
7913a8bec33SHans Petter Selasky 	return (0);
7923a8bec33SHans Petter Selasky }
7933a8bec33SHans Petter Selasky 
7943a8bec33SHans Petter Selasky int
7953a8bec33SHans Petter Selasky linux_copyin(const void *uaddr, void *kaddr, size_t len)
7963a8bec33SHans Petter Selasky {
7973a8bec33SHans Petter Selasky 	if (linux_remap_address(__DECONST(void **, &uaddr), len)) {
7983a8bec33SHans Petter Selasky 		if (uaddr == NULL)
7993a8bec33SHans Petter Selasky 			return (-EFAULT);
8003a8bec33SHans Petter Selasky 		memcpy(kaddr, uaddr, len);
8013a8bec33SHans Petter Selasky 		return (0);
8023a8bec33SHans Petter Selasky 	}
8033a8bec33SHans Petter Selasky 	return (-copyin(uaddr, kaddr, len));
8043a8bec33SHans Petter Selasky }
8053a8bec33SHans Petter Selasky 
8063a8bec33SHans Petter Selasky int
8073a8bec33SHans Petter Selasky linux_copyout(const void *kaddr, void *uaddr, size_t len)
8083a8bec33SHans Petter Selasky {
8093a8bec33SHans Petter Selasky 	if (linux_remap_address(&uaddr, len)) {
8103a8bec33SHans Petter Selasky 		if (uaddr == NULL)
8113a8bec33SHans Petter Selasky 			return (-EFAULT);
8123a8bec33SHans Petter Selasky 		memcpy(uaddr, kaddr, len);
8133a8bec33SHans Petter Selasky 		return (0);
8143a8bec33SHans Petter Selasky 	}
8153a8bec33SHans Petter Selasky 	return (-copyout(kaddr, uaddr, len));
8163a8bec33SHans Petter Selasky }
8173a8bec33SHans Petter Selasky 
8180e05589bSHans Petter Selasky size_t
8190e05589bSHans Petter Selasky linux_clear_user(void *_uaddr, size_t _len)
8200e05589bSHans Petter Selasky {
8210e05589bSHans Petter Selasky 	uint8_t *uaddr = _uaddr;
8220e05589bSHans Petter Selasky 	size_t len = _len;
8230e05589bSHans Petter Selasky 
8240e05589bSHans Petter Selasky 	/* make sure uaddr is aligned before going into the fast loop */
8250e05589bSHans Petter Selasky 	while (((uintptr_t)uaddr & 7) != 0 && len > 7) {
8260e05589bSHans Petter Selasky 		if (subyte(uaddr, 0))
8270e05589bSHans Petter Selasky 			return (_len);
8280e05589bSHans Petter Selasky 		uaddr++;
8290e05589bSHans Petter Selasky 		len--;
8300e05589bSHans Petter Selasky 	}
8310e05589bSHans Petter Selasky 
8320e05589bSHans Petter Selasky 	/* zero 8 bytes at a time */
8330e05589bSHans Petter Selasky 	while (len > 7) {
8343803a97fSHans Petter Selasky #ifdef __LP64__
8350e05589bSHans Petter Selasky 		if (suword64(uaddr, 0))
8360e05589bSHans Petter Selasky 			return (_len);
8373803a97fSHans Petter Selasky #else
8383803a97fSHans Petter Selasky 		if (suword32(uaddr, 0))
8393803a97fSHans Petter Selasky 			return (_len);
8403803a97fSHans Petter Selasky 		if (suword32(uaddr + 4, 0))
8413803a97fSHans Petter Selasky 			return (_len);
8423803a97fSHans Petter Selasky #endif
8430e05589bSHans Petter Selasky 		uaddr += 8;
8440e05589bSHans Petter Selasky 		len -= 8;
8450e05589bSHans Petter Selasky 	}
8460e05589bSHans Petter Selasky 
8470e05589bSHans Petter Selasky 	/* zero fill end, if any */
8480e05589bSHans Petter Selasky 	while (len > 0) {
8490e05589bSHans Petter Selasky 		if (subyte(uaddr, 0))
8500e05589bSHans Petter Selasky 			return (_len);
8510e05589bSHans Petter Selasky 		uaddr++;
8520e05589bSHans Petter Selasky 		len--;
8530e05589bSHans Petter Selasky 	}
8540e05589bSHans Petter Selasky 	return (0);
8550e05589bSHans Petter Selasky }
8560e05589bSHans Petter Selasky 
8570e05589bSHans Petter Selasky int
8580e05589bSHans Petter Selasky linux_access_ok(int rw, const void *uaddr, size_t len)
8590e05589bSHans Petter Selasky {
8600e05589bSHans Petter Selasky 	uintptr_t saddr;
8610e05589bSHans Petter Selasky 	uintptr_t eaddr;
8620e05589bSHans Petter Selasky 
8630e05589bSHans Petter Selasky 	/* get start and end address */
8640e05589bSHans Petter Selasky 	saddr = (uintptr_t)uaddr;
8650e05589bSHans Petter Selasky 	eaddr = (uintptr_t)uaddr + len;
8660e05589bSHans Petter Selasky 
8670e05589bSHans Petter Selasky 	/* verify addresses are valid for userspace */
8680e05589bSHans Petter Selasky 	return ((saddr == eaddr) ||
8690e05589bSHans Petter Selasky 	    (eaddr > saddr && eaddr <= VM_MAXUSER_ADDRESS));
8700e05589bSHans Petter Selasky }
8710e05589bSHans Petter Selasky 
8728d59ecb2SHans Petter Selasky static int
8738d59ecb2SHans Petter Selasky linux_dev_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag,
8748d59ecb2SHans Petter Selasky     struct thread *td)
8758d59ecb2SHans Petter Selasky {
8768d59ecb2SHans Petter Selasky 	struct linux_file *filp;
8778d59ecb2SHans Petter Selasky 	struct file *file;
8783a8bec33SHans Petter Selasky 	unsigned size;
8798d59ecb2SHans Petter Selasky 	int error;
8808d59ecb2SHans Petter Selasky 
881464d20bcSHans Petter Selasky 	file = td->td_fpop;
8826e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
8836e3e6544SHans Petter Selasky 		return (ENXIO);
8848d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
8858d59ecb2SHans Petter Selasky 		return (error);
8868d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
8871e3db1deSHans Petter Selasky 
888639af71aSHans Petter Selasky 	/* the LinuxKPI supports blocking and non-blocking I/O */
889639af71aSHans Petter Selasky 	if (cmd == FIONBIO || cmd == FIOASYNC)
890639af71aSHans Petter Selasky 		return (0);
891639af71aSHans Petter Selasky 
8921e3db1deSHans Petter Selasky 	linux_set_current(td);
8933a8bec33SHans Petter Selasky 	size = IOCPARM_LEN(cmd);
8943a8bec33SHans Petter Selasky 	/* refer to logic in sys_ioctl() */
8953a8bec33SHans Petter Selasky 	if (size > 0) {
8968d59ecb2SHans Petter Selasky 		/*
8973a8bec33SHans Petter Selasky 		 * Setup hint for linux_copyin() and linux_copyout().
8983a8bec33SHans Petter Selasky 		 *
8993a8bec33SHans Petter Selasky 		 * Background: Linux code expects a user-space address
9003a8bec33SHans Petter Selasky 		 * while FreeBSD supplies a kernel-space address.
9018d59ecb2SHans Petter Selasky 		 */
9021e3db1deSHans Petter Selasky 		current->bsd_ioctl_data = data;
9031e3db1deSHans Petter Selasky 		current->bsd_ioctl_len = size;
9043a8bec33SHans Petter Selasky 		data = (void *)LINUX_IOCTL_MIN_PTR;
9053a8bec33SHans Petter Selasky 	} else {
9063a8bec33SHans Petter Selasky 		/* fetch user-space pointer */
9078d59ecb2SHans Petter Selasky 		data = *(void **)data;
9083a8bec33SHans Petter Selasky 	}
9098d59ecb2SHans Petter Selasky 	if (filp->f_op->unlocked_ioctl)
9108d59ecb2SHans Petter Selasky 		error = -filp->f_op->unlocked_ioctl(filp, cmd, (u_long)data);
9118d59ecb2SHans Petter Selasky 	else
9128d59ecb2SHans Petter Selasky 		error = ENOTTY;
9131e3db1deSHans Petter Selasky 	if (size > 0) {
9141e3db1deSHans Petter Selasky 		current->bsd_ioctl_data = NULL;
9151e3db1deSHans Petter Selasky 		current->bsd_ioctl_len = 0;
9161e3db1deSHans Petter Selasky 	}
9178d59ecb2SHans Petter Selasky 
91867e984c8SHans Petter Selasky 	if (error == EWOULDBLOCK) {
91967e984c8SHans Petter Selasky 		/* update kqfilter status, if any */
92067e984c8SHans Petter Selasky 		linux_dev_kqfilter_poll(filp,
92167e984c8SHans Petter Selasky 		    LINUX_KQ_FLAG_HAS_READ | LINUX_KQ_FLAG_HAS_WRITE);
92267e984c8SHans Petter Selasky 	} else if (error == ERESTARTSYS)
923328c75d6SHans Petter Selasky 		error = ERESTART;
9248d59ecb2SHans Petter Selasky 	return (error);
9258d59ecb2SHans Petter Selasky }
9268d59ecb2SHans Petter Selasky 
9278d59ecb2SHans Petter Selasky static int
9288d59ecb2SHans Petter Selasky linux_dev_read(struct cdev *dev, struct uio *uio, int ioflag)
9298d59ecb2SHans Petter Selasky {
9308d59ecb2SHans Petter Selasky 	struct linux_file *filp;
931464d20bcSHans Petter Selasky 	struct thread *td;
9328d59ecb2SHans Petter Selasky 	struct file *file;
9338d59ecb2SHans Petter Selasky 	ssize_t bytes;
9348d59ecb2SHans Petter Selasky 	int error;
9358d59ecb2SHans Petter Selasky 
936464d20bcSHans Petter Selasky 	td = curthread;
937464d20bcSHans Petter Selasky 	file = td->td_fpop;
9386e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
9396e3e6544SHans Petter Selasky 		return (ENXIO);
9408d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
9418d59ecb2SHans Petter Selasky 		return (error);
9428d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
943b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
9448d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
945b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
9461e3db1deSHans Petter Selasky 	linux_set_current(td);
9478d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
9488d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
9498d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
9508d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
9518d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
9528d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
9538d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
9548d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
955a6b28ee0SHans Petter Selasky 		} else {
9568d59ecb2SHans Petter Selasky 			error = -bytes;
95767e984c8SHans Petter Selasky 			if (error == ERESTARTSYS)
958328c75d6SHans Petter Selasky 				error = ERESTART;
959a6b28ee0SHans Petter Selasky 		}
9608d59ecb2SHans Petter Selasky 	} else
9618d59ecb2SHans Petter Selasky 		error = ENXIO;
9628d59ecb2SHans Petter Selasky 
96367e984c8SHans Petter Selasky 	/* update kqfilter status, if any */
96467e984c8SHans Petter Selasky 	linux_dev_kqfilter_poll(filp, LINUX_KQ_FLAG_HAS_READ);
96567e984c8SHans Petter Selasky 
9668d59ecb2SHans Petter Selasky 	return (error);
9678d59ecb2SHans Petter Selasky }
9688d59ecb2SHans Petter Selasky 
9698d59ecb2SHans Petter Selasky static int
9708d59ecb2SHans Petter Selasky linux_dev_write(struct cdev *dev, struct uio *uio, int ioflag)
9718d59ecb2SHans Petter Selasky {
9728d59ecb2SHans Petter Selasky 	struct linux_file *filp;
973464d20bcSHans Petter Selasky 	struct thread *td;
9748d59ecb2SHans Petter Selasky 	struct file *file;
9758d59ecb2SHans Petter Selasky 	ssize_t bytes;
9768d59ecb2SHans Petter Selasky 	int error;
9778d59ecb2SHans Petter Selasky 
978464d20bcSHans Petter Selasky 	td = curthread;
979464d20bcSHans Petter Selasky 	file = td->td_fpop;
9806e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
9816e3e6544SHans Petter Selasky 		return (ENXIO);
9828d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
9838d59ecb2SHans Petter Selasky 		return (error);
9848d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
985b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
9868d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
987b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
9881e3db1deSHans Petter Selasky 	linux_set_current(td);
9898d59ecb2SHans Petter Selasky 	if (filp->f_op->write) {
9908d59ecb2SHans Petter Selasky 		bytes = filp->f_op->write(filp, uio->uio_iov->iov_base,
9918d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
9928d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
9938d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
9948d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
9958d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
9968d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
997a6b28ee0SHans Petter Selasky 		} else {
9988d59ecb2SHans Petter Selasky 			error = -bytes;
99967e984c8SHans Petter Selasky 			if (error == ERESTARTSYS)
1000328c75d6SHans Petter Selasky 				error = ERESTART;
1001a6b28ee0SHans Petter Selasky 		}
10028d59ecb2SHans Petter Selasky 	} else
10038d59ecb2SHans Petter Selasky 		error = ENXIO;
10048d59ecb2SHans Petter Selasky 
100567e984c8SHans Petter Selasky 	/* update kqfilter status, if any */
100667e984c8SHans Petter Selasky 	linux_dev_kqfilter_poll(filp, LINUX_KQ_FLAG_HAS_WRITE);
100767e984c8SHans Petter Selasky 
10088d59ecb2SHans Petter Selasky 	return (error);
10098d59ecb2SHans Petter Selasky }
10108d59ecb2SHans Petter Selasky 
10118d59ecb2SHans Petter Selasky static int
10128d59ecb2SHans Petter Selasky linux_dev_poll(struct cdev *dev, int events, struct thread *td)
10138d59ecb2SHans Petter Selasky {
10148d59ecb2SHans Petter Selasky 	struct linux_file *filp;
10158d59ecb2SHans Petter Selasky 	struct file *file;
10168d59ecb2SHans Petter Selasky 	int revents;
10176e3e6544SHans Petter Selasky 
10186e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
10196e3e6544SHans Petter Selasky 		goto error;
10206e3e6544SHans Petter Selasky 	if (devfs_get_cdevpriv((void **)&filp) != 0)
10216e3e6544SHans Petter Selasky 		goto error;
10228d59ecb2SHans Petter Selasky 
1023464d20bcSHans Petter Selasky 	file = td->td_fpop;
10248d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
10251e3db1deSHans Petter Selasky 	linux_set_current(td);
1026*6dec7efaSHans Petter Selasky 	if (filp->f_op->poll != NULL)
10278d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
1028*6dec7efaSHans Petter Selasky 	else
10298d59ecb2SHans Petter Selasky 		revents = 0;
10308d59ecb2SHans Petter Selasky 
10318d59ecb2SHans Petter Selasky 	return (revents);
10326e3e6544SHans Petter Selasky error:
10336e3e6544SHans Petter Selasky 	return (events & (POLLHUP|POLLIN|POLLRDNORM|POLLOUT|POLLWRNORM));
10348d59ecb2SHans Petter Selasky }
10358d59ecb2SHans Petter Selasky 
1036*6dec7efaSHans Petter Selasky /*
1037*6dec7efaSHans Petter Selasky  * This function atomically updates the poll wakeup state and returns
1038*6dec7efaSHans Petter Selasky  * the previous state at the time of update.
1039*6dec7efaSHans Petter Selasky  */
1040*6dec7efaSHans Petter Selasky static uint8_t
1041*6dec7efaSHans Petter Selasky linux_poll_wakeup_state(atomic_t *v, const uint8_t *pstate)
1042*6dec7efaSHans Petter Selasky {
1043*6dec7efaSHans Petter Selasky 	int c, old;
1044*6dec7efaSHans Petter Selasky 
1045*6dec7efaSHans Petter Selasky 	c = v->counter;
1046*6dec7efaSHans Petter Selasky 
1047*6dec7efaSHans Petter Selasky 	while ((old = atomic_cmpxchg(v, c, pstate[c])) != c)
1048*6dec7efaSHans Petter Selasky 		c = old;
1049*6dec7efaSHans Petter Selasky 
1050*6dec7efaSHans Petter Selasky 	return (c);
1051*6dec7efaSHans Petter Selasky }
1052*6dec7efaSHans Petter Selasky 
1053*6dec7efaSHans Petter Selasky 
1054*6dec7efaSHans Petter Selasky static int
1055*6dec7efaSHans Petter Selasky linux_poll_wakeup_callback(wait_queue_t *wq, unsigned int wq_state, int flags, void *key)
1056*6dec7efaSHans Petter Selasky {
1057*6dec7efaSHans Petter Selasky 	static const uint8_t state[LINUX_FWQ_STATE_MAX] = {
1058*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_INIT] = LINUX_FWQ_STATE_INIT, /* NOP */
1059*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_NOT_READY] = LINUX_FWQ_STATE_NOT_READY, /* NOP */
1060*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_QUEUED] = LINUX_FWQ_STATE_READY,
1061*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_READY] = LINUX_FWQ_STATE_READY, /* NOP */
1062*6dec7efaSHans Petter Selasky 	};
1063*6dec7efaSHans Petter Selasky 	struct linux_file *filp = container_of(wq, struct linux_file, f_wait_queue.wq);
1064*6dec7efaSHans Petter Selasky 
1065*6dec7efaSHans Petter Selasky 	switch (linux_poll_wakeup_state(&filp->f_wait_queue.state, state)) {
1066*6dec7efaSHans Petter Selasky 	case LINUX_FWQ_STATE_QUEUED:
1067*6dec7efaSHans Petter Selasky 		linux_poll_wakeup(filp);
1068*6dec7efaSHans Petter Selasky 		return (1);
1069*6dec7efaSHans Petter Selasky 	default:
1070*6dec7efaSHans Petter Selasky 		return (0);
1071*6dec7efaSHans Petter Selasky 	}
1072*6dec7efaSHans Petter Selasky }
1073*6dec7efaSHans Petter Selasky 
1074*6dec7efaSHans Petter Selasky void
1075*6dec7efaSHans Petter Selasky linux_poll_wait(struct linux_file *filp, wait_queue_head_t *wqh, poll_table *p)
1076*6dec7efaSHans Petter Selasky {
1077*6dec7efaSHans Petter Selasky 	static const uint8_t state[LINUX_FWQ_STATE_MAX] = {
1078*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_INIT] = LINUX_FWQ_STATE_NOT_READY,
1079*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_NOT_READY] = LINUX_FWQ_STATE_NOT_READY, /* NOP */
1080*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_QUEUED] = LINUX_FWQ_STATE_QUEUED, /* NOP */
1081*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_READY] = LINUX_FWQ_STATE_QUEUED,
1082*6dec7efaSHans Petter Selasky 	};
1083*6dec7efaSHans Petter Selasky 
1084*6dec7efaSHans Petter Selasky 	selrecord(curthread, &filp->f_selinfo);
1085*6dec7efaSHans Petter Selasky 
1086*6dec7efaSHans Petter Selasky 	switch (linux_poll_wakeup_state(&filp->f_wait_queue.state, state)) {
1087*6dec7efaSHans Petter Selasky 	case LINUX_FWQ_STATE_INIT:
1088*6dec7efaSHans Petter Selasky 		/* NOTE: file handles can only belong to one wait-queue */
1089*6dec7efaSHans Petter Selasky 		filp->f_wait_queue.wqh = wqh;
1090*6dec7efaSHans Petter Selasky 		filp->f_wait_queue.wq.func = &linux_poll_wakeup_callback;
1091*6dec7efaSHans Petter Selasky 		add_wait_queue(wqh, &filp->f_wait_queue.wq);
1092*6dec7efaSHans Petter Selasky 		atomic_set(&filp->f_wait_queue.state, LINUX_FWQ_STATE_QUEUED);
1093*6dec7efaSHans Petter Selasky 		break;
1094*6dec7efaSHans Petter Selasky 	default:
1095*6dec7efaSHans Petter Selasky 		break;
1096*6dec7efaSHans Petter Selasky 	}
1097*6dec7efaSHans Petter Selasky }
1098*6dec7efaSHans Petter Selasky 
1099*6dec7efaSHans Petter Selasky static void
1100*6dec7efaSHans Petter Selasky linux_poll_wait_dequeue(struct linux_file *filp)
1101*6dec7efaSHans Petter Selasky {
1102*6dec7efaSHans Petter Selasky 	static const uint8_t state[LINUX_FWQ_STATE_MAX] = {
1103*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_INIT] = LINUX_FWQ_STATE_INIT,	/* NOP */
1104*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_NOT_READY] = LINUX_FWQ_STATE_INIT,
1105*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_QUEUED] = LINUX_FWQ_STATE_INIT,
1106*6dec7efaSHans Petter Selasky 		[LINUX_FWQ_STATE_READY] = LINUX_FWQ_STATE_INIT,
1107*6dec7efaSHans Petter Selasky 	};
1108*6dec7efaSHans Petter Selasky 
1109*6dec7efaSHans Petter Selasky 	seldrain(&filp->f_selinfo);
1110*6dec7efaSHans Petter Selasky 
1111*6dec7efaSHans Petter Selasky 	switch (linux_poll_wakeup_state(&filp->f_wait_queue.state, state)) {
1112*6dec7efaSHans Petter Selasky 	case LINUX_FWQ_STATE_NOT_READY:
1113*6dec7efaSHans Petter Selasky 	case LINUX_FWQ_STATE_QUEUED:
1114*6dec7efaSHans Petter Selasky 	case LINUX_FWQ_STATE_READY:
1115*6dec7efaSHans Petter Selasky 		remove_wait_queue(filp->f_wait_queue.wqh, &filp->f_wait_queue.wq);
1116*6dec7efaSHans Petter Selasky 		break;
1117*6dec7efaSHans Petter Selasky 	default:
1118*6dec7efaSHans Petter Selasky 		break;
1119*6dec7efaSHans Petter Selasky 	}
1120*6dec7efaSHans Petter Selasky }
1121*6dec7efaSHans Petter Selasky 
1122a6b28ee0SHans Petter Selasky void
1123a6b28ee0SHans Petter Selasky linux_poll_wakeup(struct linux_file *filp)
1124a6b28ee0SHans Petter Selasky {
1125a6b28ee0SHans Petter Selasky 	/* this function should be NULL-safe */
1126a6b28ee0SHans Petter Selasky 	if (filp == NULL)
1127a6b28ee0SHans Petter Selasky 		return;
1128a6b28ee0SHans Petter Selasky 
1129a6b28ee0SHans Petter Selasky 	selwakeup(&filp->f_selinfo);
1130a6b28ee0SHans Petter Selasky 
1131a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
1132a6b28ee0SHans Petter Selasky 	filp->f_kqflags |= LINUX_KQ_FLAG_NEED_READ |
1133a6b28ee0SHans Petter Selasky 	    LINUX_KQ_FLAG_NEED_WRITE;
1134a6b28ee0SHans Petter Selasky 
1135a6b28ee0SHans Petter Selasky 	/* make sure the "knote" gets woken up */
1136a6b28ee0SHans Petter Selasky 	KNOTE_LOCKED(&filp->f_selinfo.si_note, 1);
1137a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
1138a6b28ee0SHans Petter Selasky }
1139a6b28ee0SHans Petter Selasky 
1140a6b28ee0SHans Petter Selasky static void
1141a6b28ee0SHans Petter Selasky linux_dev_kqfilter_detach(struct knote *kn)
1142a6b28ee0SHans Petter Selasky {
1143a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
1144a6b28ee0SHans Petter Selasky 
1145a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
1146a6b28ee0SHans Petter Selasky 	knlist_remove(&filp->f_selinfo.si_note, kn, 1);
1147a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
1148a6b28ee0SHans Petter Selasky }
1149a6b28ee0SHans Petter Selasky 
1150a6b28ee0SHans Petter Selasky static int
1151a6b28ee0SHans Petter Selasky linux_dev_kqfilter_read_event(struct knote *kn, long hint)
1152a6b28ee0SHans Petter Selasky {
1153a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
1154a6b28ee0SHans Petter Selasky 
1155a6b28ee0SHans Petter Selasky 	mtx_assert(&filp->f_kqlock.m, MA_OWNED);
1156a6b28ee0SHans Petter Selasky 
1157a6b28ee0SHans Petter Selasky 	return ((filp->f_kqflags & LINUX_KQ_FLAG_NEED_READ) ? 1 : 0);
1158a6b28ee0SHans Petter Selasky }
1159a6b28ee0SHans Petter Selasky 
1160a6b28ee0SHans Petter Selasky static int
1161a6b28ee0SHans Petter Selasky linux_dev_kqfilter_write_event(struct knote *kn, long hint)
1162a6b28ee0SHans Petter Selasky {
1163a6b28ee0SHans Petter Selasky 	struct linux_file *filp = kn->kn_hook;
1164a6b28ee0SHans Petter Selasky 
1165a6b28ee0SHans Petter Selasky 	mtx_assert(&filp->f_kqlock.m, MA_OWNED);
1166a6b28ee0SHans Petter Selasky 
1167a6b28ee0SHans Petter Selasky 	return ((filp->f_kqflags & LINUX_KQ_FLAG_NEED_WRITE) ? 1 : 0);
1168a6b28ee0SHans Petter Selasky }
1169a6b28ee0SHans Petter Selasky 
1170a6b28ee0SHans Petter Selasky static struct filterops linux_dev_kqfiltops_read = {
1171a6b28ee0SHans Petter Selasky 	.f_isfd = 1,
1172a6b28ee0SHans Petter Selasky 	.f_detach = linux_dev_kqfilter_detach,
1173a6b28ee0SHans Petter Selasky 	.f_event = linux_dev_kqfilter_read_event,
1174a6b28ee0SHans Petter Selasky };
1175a6b28ee0SHans Petter Selasky 
1176a6b28ee0SHans Petter Selasky static struct filterops linux_dev_kqfiltops_write = {
1177a6b28ee0SHans Petter Selasky 	.f_isfd = 1,
1178a6b28ee0SHans Petter Selasky 	.f_detach = linux_dev_kqfilter_detach,
1179a6b28ee0SHans Petter Selasky 	.f_event = linux_dev_kqfilter_write_event,
1180a6b28ee0SHans Petter Selasky };
1181a6b28ee0SHans Petter Selasky 
1182a6b28ee0SHans Petter Selasky static void
118367e984c8SHans Petter Selasky linux_dev_kqfilter_poll(struct linux_file *filp, int kqflags)
1184a6b28ee0SHans Petter Selasky {
1185a6b28ee0SHans Petter Selasky 	int temp;
1186a6b28ee0SHans Petter Selasky 
118767e984c8SHans Petter Selasky 	if (filp->f_kqflags & kqflags) {
1188a6b28ee0SHans Petter Selasky 		/* get the latest polling state */
1189a6b28ee0SHans Petter Selasky 		temp = filp->f_op->poll(filp, NULL);
1190a6b28ee0SHans Petter Selasky 
1191a6b28ee0SHans Petter Selasky 		spin_lock(&filp->f_kqlock);
119267e984c8SHans Petter Selasky 		/* clear kqflags */
119367e984c8SHans Petter Selasky 		filp->f_kqflags &= ~(LINUX_KQ_FLAG_NEED_READ |
119467e984c8SHans Petter Selasky 		    LINUX_KQ_FLAG_NEED_WRITE);
119567e984c8SHans Petter Selasky 		/* update kqflags */
119667e984c8SHans Petter Selasky 		if (temp & (POLLIN | POLLOUT)) {
1197a6b28ee0SHans Petter Selasky 			if (temp & POLLIN)
1198a6b28ee0SHans Petter Selasky 				filp->f_kqflags |= LINUX_KQ_FLAG_NEED_READ;
1199a6b28ee0SHans Petter Selasky 			if (temp & POLLOUT)
1200a6b28ee0SHans Petter Selasky 				filp->f_kqflags |= LINUX_KQ_FLAG_NEED_WRITE;
1201a6b28ee0SHans Petter Selasky 
1202a6b28ee0SHans Petter Selasky 			/* make sure the "knote" gets woken up */
1203a6b28ee0SHans Petter Selasky 			KNOTE_LOCKED(&filp->f_selinfo.si_note, 0);
1204a6b28ee0SHans Petter Selasky 		}
120567e984c8SHans Petter Selasky 		spin_unlock(&filp->f_kqlock);
1206a6b28ee0SHans Petter Selasky 	}
1207a6b28ee0SHans Petter Selasky }
1208a6b28ee0SHans Petter Selasky 
1209a6b28ee0SHans Petter Selasky static int
1210a6b28ee0SHans Petter Selasky linux_dev_kqfilter(struct cdev *dev, struct knote *kn)
1211a6b28ee0SHans Petter Selasky {
1212a6b28ee0SHans Petter Selasky 	struct linux_file *filp;
1213a6b28ee0SHans Petter Selasky 	struct file *file;
1214a6b28ee0SHans Petter Selasky 	struct thread *td;
1215a6b28ee0SHans Petter Selasky 	int error;
1216a6b28ee0SHans Petter Selasky 
1217a6b28ee0SHans Petter Selasky 	td = curthread;
1218a6b28ee0SHans Petter Selasky 	file = td->td_fpop;
1219a6b28ee0SHans Petter Selasky 	if (dev->si_drv1 == NULL)
1220a6b28ee0SHans Petter Selasky 		return (ENXIO);
1221a6b28ee0SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
1222a6b28ee0SHans Petter Selasky 		return (error);
1223a6b28ee0SHans Petter Selasky 	filp->f_flags = file->f_flag;
1224a6b28ee0SHans Petter Selasky 	if (filp->f_op->poll == NULL)
1225a6b28ee0SHans Petter Selasky 		return (EINVAL);
1226a6b28ee0SHans Petter Selasky 
1227a6b28ee0SHans Petter Selasky 	spin_lock(&filp->f_kqlock);
1228a6b28ee0SHans Petter Selasky 	switch (kn->kn_filter) {
1229a6b28ee0SHans Petter Selasky 	case EVFILT_READ:
1230a6b28ee0SHans Petter Selasky 		filp->f_kqflags |= LINUX_KQ_FLAG_HAS_READ;
1231a6b28ee0SHans Petter Selasky 		kn->kn_fop = &linux_dev_kqfiltops_read;
1232a6b28ee0SHans Petter Selasky 		kn->kn_hook = filp;
1233a6b28ee0SHans Petter Selasky 		knlist_add(&filp->f_selinfo.si_note, kn, 1);
1234a6b28ee0SHans Petter Selasky 		break;
1235a6b28ee0SHans Petter Selasky 	case EVFILT_WRITE:
1236a6b28ee0SHans Petter Selasky 		filp->f_kqflags |= LINUX_KQ_FLAG_HAS_WRITE;
1237a6b28ee0SHans Petter Selasky 		kn->kn_fop = &linux_dev_kqfiltops_write;
1238a6b28ee0SHans Petter Selasky 		kn->kn_hook = filp;
1239a6b28ee0SHans Petter Selasky 		knlist_add(&filp->f_selinfo.si_note, kn, 1);
1240a6b28ee0SHans Petter Selasky 		break;
1241a6b28ee0SHans Petter Selasky 	default:
1242a6b28ee0SHans Petter Selasky 		error = EINVAL;
1243a6b28ee0SHans Petter Selasky 		break;
1244a6b28ee0SHans Petter Selasky 	}
1245a6b28ee0SHans Petter Selasky 	spin_unlock(&filp->f_kqlock);
1246a6b28ee0SHans Petter Selasky 
1247a6b28ee0SHans Petter Selasky 	if (error == 0) {
1248a6b28ee0SHans Petter Selasky 		linux_set_current(td);
124967e984c8SHans Petter Selasky 
125067e984c8SHans Petter Selasky 		/* update kqfilter status, if any */
125167e984c8SHans Petter Selasky 		linux_dev_kqfilter_poll(filp,
125267e984c8SHans Petter Selasky 		    LINUX_KQ_FLAG_HAS_READ | LINUX_KQ_FLAG_HAS_WRITE);
1253a6b28ee0SHans Petter Selasky 	}
1254a6b28ee0SHans Petter Selasky 	return (error);
1255a6b28ee0SHans Petter Selasky }
1256a6b28ee0SHans Petter Selasky 
12578d59ecb2SHans Petter Selasky static int
12588d59ecb2SHans Petter Selasky linux_dev_mmap_single(struct cdev *dev, vm_ooffset_t *offset,
12598d59ecb2SHans Petter Selasky     vm_size_t size, struct vm_object **object, int nprot)
12608d59ecb2SHans Petter Selasky {
12611ea4c857SHans Petter Selasky 	struct vm_area_struct *vmap;
1262cca15f28SHans Petter Selasky 	struct mm_struct *mm;
12638d59ecb2SHans Petter Selasky 	struct linux_file *filp;
1264464d20bcSHans Petter Selasky 	struct thread *td;
12658d59ecb2SHans Petter Selasky 	struct file *file;
12661ea4c857SHans Petter Selasky 	vm_memattr_t attr;
12678d59ecb2SHans Petter Selasky 	int error;
12688d59ecb2SHans Petter Selasky 
1269464d20bcSHans Petter Selasky 	td = curthread;
1270464d20bcSHans Petter Selasky 	file = td->td_fpop;
12716e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
12728d59ecb2SHans Petter Selasky 		return (ENODEV);
12738d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
12748d59ecb2SHans Petter Selasky 		return (error);
12758d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
12761ea4c857SHans Petter Selasky 
12771ea4c857SHans Petter Selasky 	if (filp->f_op->mmap == NULL)
12781ea4c857SHans Petter Selasky 		return (ENODEV);
12791ea4c857SHans Petter Selasky 
12801e3db1deSHans Petter Selasky 	linux_set_current(td);
12811ea4c857SHans Petter Selasky 
1282cca15f28SHans Petter Selasky 	/*
1283cca15f28SHans Petter Selasky 	 * The same VM object might be shared by multiple processes
1284cca15f28SHans Petter Selasky 	 * and the mm_struct is usually freed when a process exits.
1285cca15f28SHans Petter Selasky 	 *
1286cca15f28SHans Petter Selasky 	 * The atomic reference below makes sure the mm_struct is
1287cca15f28SHans Petter Selasky 	 * available as long as the vmap is in the linux_vma_head.
1288cca15f28SHans Petter Selasky 	 */
1289cca15f28SHans Petter Selasky 	mm = current->mm;
1290cca15f28SHans Petter Selasky 	if (atomic_inc_not_zero(&mm->mm_users) == 0)
1291cca15f28SHans Petter Selasky 		return (EINVAL);
1292cca15f28SHans Petter Selasky 
12931ea4c857SHans Petter Selasky 	vmap = kzalloc(sizeof(*vmap), GFP_KERNEL);
12941ea4c857SHans Petter Selasky 	vmap->vm_start = 0;
12951ea4c857SHans Petter Selasky 	vmap->vm_end = size;
12961ea4c857SHans Petter Selasky 	vmap->vm_pgoff = *offset / PAGE_SIZE;
12971ea4c857SHans Petter Selasky 	vmap->vm_pfn = 0;
1298ebf85480SHans Petter Selasky 	vmap->vm_flags = vmap->vm_page_prot = (nprot & VM_PROT_ALL);
12991ea4c857SHans Petter Selasky 	vmap->vm_ops = NULL;
1300d56f1ed8SHans Petter Selasky 	vmap->vm_file = get_file(filp);
1301cca15f28SHans Petter Selasky 	vmap->vm_mm = mm;
13021ea4c857SHans Petter Selasky 
13031ea4c857SHans Petter Selasky 	if (unlikely(down_write_killable(&vmap->vm_mm->mmap_sem))) {
13041ea4c857SHans Petter Selasky 		error = EINTR;
13051ea4c857SHans Petter Selasky 	} else {
13061ea4c857SHans Petter Selasky 		error = -filp->f_op->mmap(filp, vmap);
13071ea4c857SHans Petter Selasky 		up_write(&vmap->vm_mm->mmap_sem);
13081ea4c857SHans Petter Selasky 	}
13091ea4c857SHans Petter Selasky 
13101ea4c857SHans Petter Selasky 	if (error != 0) {
1311cca15f28SHans Petter Selasky 		linux_cdev_handle_free(vmap);
13121ea4c857SHans Petter Selasky 		return (error);
13131ea4c857SHans Petter Selasky 	}
13141ea4c857SHans Petter Selasky 
13151ea4c857SHans Petter Selasky 	attr = pgprot2cachemode(vmap->vm_page_prot);
13161ea4c857SHans Petter Selasky 
13171ea4c857SHans Petter Selasky 	if (vmap->vm_ops != NULL) {
13181ea4c857SHans Petter Selasky 		void *vm_private_data;
13191ea4c857SHans Petter Selasky 
1320cde3f930SHans Petter Selasky 		if (vmap->vm_ops->open == NULL ||
13211ea4c857SHans Petter Selasky 		    vmap->vm_ops->close == NULL ||
13221ea4c857SHans Petter Selasky 		    vmap->vm_private_data == NULL) {
1323cca15f28SHans Petter Selasky 			linux_cdev_handle_free(vmap);
13241ea4c857SHans Petter Selasky 			return (EINVAL);
13251ea4c857SHans Petter Selasky 		}
13261ea4c857SHans Petter Selasky 
13271ea4c857SHans Petter Selasky 		vm_private_data = vmap->vm_private_data;
13281ea4c857SHans Petter Selasky 
13291ea4c857SHans Petter Selasky 		vmap = linux_cdev_handle_insert(vm_private_data, vmap);
13301ea4c857SHans Petter Selasky 
133161157228SHans Petter Selasky 		if (vmap->vm_ops->fault == NULL) {
133261157228SHans Petter Selasky 			*object = cdev_pager_allocate(vm_private_data, OBJT_DEVICE,
133361157228SHans Petter Selasky 			    &linux_cdev_pager_ops[1], size, nprot, *offset,
133461157228SHans Petter Selasky 			    curthread->td_ucred);
133561157228SHans Petter Selasky 		} else {
13361ea4c857SHans Petter Selasky 			*object = cdev_pager_allocate(vm_private_data, OBJT_MGTDEVICE,
133761157228SHans Petter Selasky 			    &linux_cdev_pager_ops[0], size, nprot, *offset,
133861157228SHans Petter Selasky 			    curthread->td_ucred);
133961157228SHans Petter Selasky 		}
13401ea4c857SHans Petter Selasky 
13411ea4c857SHans Petter Selasky 		if (*object == NULL) {
13421ea4c857SHans Petter Selasky 			linux_cdev_handle_remove(vmap);
1343cca15f28SHans Petter Selasky 			linux_cdev_handle_free(vmap);
13441ea4c857SHans Petter Selasky 			return (EINVAL);
13451ea4c857SHans Petter Selasky 		}
13461ea4c857SHans Petter Selasky 	} else {
13478d59ecb2SHans Petter Selasky 		struct sglist *sg;
13488d59ecb2SHans Petter Selasky 
13498d59ecb2SHans Petter Selasky 		sg = sglist_alloc(1, M_WAITOK);
135061157228SHans Petter Selasky 		sglist_append_phys(sg,
135161157228SHans Petter Selasky 		    (vm_paddr_t)vmap->vm_pfn << PAGE_SHIFT, vmap->vm_len);
13521ea4c857SHans Petter Selasky 
13531ea4c857SHans Petter Selasky 		*object = vm_pager_allocate(OBJT_SG, sg, vmap->vm_len,
13541ea4c857SHans Petter Selasky 		    nprot, 0, curthread->td_ucred);
13551ea4c857SHans Petter Selasky 
1356cca15f28SHans Petter Selasky 		linux_cdev_handle_free(vmap);
13571ea4c857SHans Petter Selasky 
13588d59ecb2SHans Petter Selasky 		if (*object == NULL) {
13598d59ecb2SHans Petter Selasky 			sglist_free(sg);
13601ea4c857SHans Petter Selasky 			return (EINVAL);
13618d59ecb2SHans Petter Selasky 		}
13621ea4c857SHans Petter Selasky 	}
13631ea4c857SHans Petter Selasky 
13641ea4c857SHans Petter Selasky 	if (attr != VM_MEMATTR_DEFAULT) {
13658d59ecb2SHans Petter Selasky 		VM_OBJECT_WLOCK(*object);
13661ea4c857SHans Petter Selasky 		vm_object_set_memattr(*object, attr);
13678d59ecb2SHans Petter Selasky 		VM_OBJECT_WUNLOCK(*object);
13688d59ecb2SHans Petter Selasky 	}
13691ea4c857SHans Petter Selasky 	*offset = 0;
13701ea4c857SHans Petter Selasky 	return (0);
13718d59ecb2SHans Petter Selasky }
13728d59ecb2SHans Petter Selasky 
13738d59ecb2SHans Petter Selasky struct cdevsw linuxcdevsw = {
13748d59ecb2SHans Petter Selasky 	.d_version = D_VERSION,
13758d59ecb2SHans Petter Selasky 	.d_flags = D_TRACKCLOSE,
13768d59ecb2SHans Petter Selasky 	.d_open = linux_dev_open,
13778d59ecb2SHans Petter Selasky 	.d_close = linux_dev_close,
13788d59ecb2SHans Petter Selasky 	.d_read = linux_dev_read,
13798d59ecb2SHans Petter Selasky 	.d_write = linux_dev_write,
13808d59ecb2SHans Petter Selasky 	.d_ioctl = linux_dev_ioctl,
13818d59ecb2SHans Petter Selasky 	.d_mmap_single = linux_dev_mmap_single,
13828d59ecb2SHans Petter Selasky 	.d_poll = linux_dev_poll,
1383a6b28ee0SHans Petter Selasky 	.d_kqfilter = linux_dev_kqfilter,
138490b30e65SHans Petter Selasky 	.d_name = "lkpidev",
13858d59ecb2SHans Petter Selasky };
13868d59ecb2SHans Petter Selasky 
13878d59ecb2SHans Petter Selasky static int
13888d59ecb2SHans Petter Selasky linux_file_read(struct file *file, struct uio *uio, struct ucred *active_cred,
13898d59ecb2SHans Petter Selasky     int flags, struct thread *td)
13908d59ecb2SHans Petter Selasky {
13918d59ecb2SHans Petter Selasky 	struct linux_file *filp;
13928d59ecb2SHans Petter Selasky 	ssize_t bytes;
13938d59ecb2SHans Petter Selasky 	int error;
13948d59ecb2SHans Petter Selasky 
13958d59ecb2SHans Petter Selasky 	error = 0;
13968d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
13978d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
1398b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
13998d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
1400b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
14011e3db1deSHans Petter Selasky 	linux_set_current(td);
14028d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
14038d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
14048d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
14058d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
14068d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
14078d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
14088d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
14098d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
14108d59ecb2SHans Petter Selasky 		} else
14118d59ecb2SHans Petter Selasky 			error = -bytes;
14128d59ecb2SHans Petter Selasky 	} else
14138d59ecb2SHans Petter Selasky 		error = ENXIO;
14148d59ecb2SHans Petter Selasky 
14158d59ecb2SHans Petter Selasky 	return (error);
14168d59ecb2SHans Petter Selasky }
14178d59ecb2SHans Petter Selasky 
14188d59ecb2SHans Petter Selasky static int
14198d59ecb2SHans Petter Selasky linux_file_poll(struct file *file, int events, struct ucred *active_cred,
14208d59ecb2SHans Petter Selasky     struct thread *td)
14218d59ecb2SHans Petter Selasky {
14228d59ecb2SHans Petter Selasky 	struct linux_file *filp;
14238d59ecb2SHans Petter Selasky 	int revents;
14248d59ecb2SHans Petter Selasky 
14258d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
14268d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
14271e3db1deSHans Petter Selasky 	linux_set_current(td);
14288600ba1aSHans Petter Selasky 	if (filp->f_op->poll != NULL) {
14298600ba1aSHans Petter Selasky 		selrecord(td, &filp->f_selinfo);
14308d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
14318600ba1aSHans Petter Selasky 	} else
14328d59ecb2SHans Petter Selasky 		revents = 0;
14338d59ecb2SHans Petter Selasky 
14340754e66cSHans Petter Selasky 	return (revents);
14358d59ecb2SHans Petter Selasky }
14368d59ecb2SHans Petter Selasky 
14378d59ecb2SHans Petter Selasky static int
14388d59ecb2SHans Petter Selasky linux_file_close(struct file *file, struct thread *td)
14398d59ecb2SHans Petter Selasky {
14408d59ecb2SHans Petter Selasky 	struct linux_file *filp;
14418d59ecb2SHans Petter Selasky 	int error;
14428d59ecb2SHans Petter Selasky 
14438d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
14448d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
14451e3db1deSHans Petter Selasky 	linux_set_current(td);
1446*6dec7efaSHans Petter Selasky 	linux_poll_wait_dequeue(filp);
14478d59ecb2SHans Petter Selasky 	error = -filp->f_op->release(NULL, filp);
14488d59ecb2SHans Petter Selasky 	funsetown(&filp->f_sigio);
14498d59ecb2SHans Petter Selasky 	kfree(filp);
14508d59ecb2SHans Petter Selasky 
14518d59ecb2SHans Petter Selasky 	return (error);
14528d59ecb2SHans Petter Selasky }
14538d59ecb2SHans Petter Selasky 
14548d59ecb2SHans Petter Selasky static int
14558d59ecb2SHans Petter Selasky linux_file_ioctl(struct file *fp, u_long cmd, void *data, struct ucred *cred,
14568d59ecb2SHans Petter Selasky     struct thread *td)
14578d59ecb2SHans Petter Selasky {
14588d59ecb2SHans Petter Selasky 	struct linux_file *filp;
14598d59ecb2SHans Petter Selasky 	int error;
14608d59ecb2SHans Petter Selasky 
14618d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)fp->f_data;
14628d59ecb2SHans Petter Selasky 	filp->f_flags = fp->f_flag;
14638d59ecb2SHans Petter Selasky 	error = 0;
14648d59ecb2SHans Petter Selasky 
14651e3db1deSHans Petter Selasky 	linux_set_current(td);
14668d59ecb2SHans Petter Selasky 	switch (cmd) {
14678d59ecb2SHans Petter Selasky 	case FIONBIO:
14688d59ecb2SHans Petter Selasky 		break;
14698d59ecb2SHans Petter Selasky 	case FIOASYNC:
14708d59ecb2SHans Petter Selasky 		if (filp->f_op->fasync == NULL)
14718d59ecb2SHans Petter Selasky 			break;
14728d59ecb2SHans Petter Selasky 		error = filp->f_op->fasync(0, filp, fp->f_flag & FASYNC);
14738d59ecb2SHans Petter Selasky 		break;
14748d59ecb2SHans Petter Selasky 	case FIOSETOWN:
14758d59ecb2SHans Petter Selasky 		error = fsetown(*(int *)data, &filp->f_sigio);
14768d59ecb2SHans Petter Selasky 		if (error == 0)
14778d59ecb2SHans Petter Selasky 			error = filp->f_op->fasync(0, filp,
14788d59ecb2SHans Petter Selasky 			    fp->f_flag & FASYNC);
14798d59ecb2SHans Petter Selasky 		break;
14808d59ecb2SHans Petter Selasky 	case FIOGETOWN:
14818d59ecb2SHans Petter Selasky 		*(int *)data = fgetown(&filp->f_sigio);
14828d59ecb2SHans Petter Selasky 		break;
14838d59ecb2SHans Petter Selasky 	default:
14848d59ecb2SHans Petter Selasky 		error = ENOTTY;
14858d59ecb2SHans Petter Selasky 		break;
14868d59ecb2SHans Petter Selasky 	}
14878d59ecb2SHans Petter Selasky 	return (error);
14888d59ecb2SHans Petter Selasky }
14898d59ecb2SHans Petter Selasky 
14908d59ecb2SHans Petter Selasky static int
14918d59ecb2SHans Petter Selasky linux_file_stat(struct file *fp, struct stat *sb, struct ucred *active_cred,
14928d59ecb2SHans Petter Selasky     struct thread *td)
14938d59ecb2SHans Petter Selasky {
14948d59ecb2SHans Petter Selasky 
14958d59ecb2SHans Petter Selasky 	return (EOPNOTSUPP);
14968d59ecb2SHans Petter Selasky }
14978d59ecb2SHans Petter Selasky 
14988d59ecb2SHans Petter Selasky static int
14998d59ecb2SHans Petter Selasky linux_file_fill_kinfo(struct file *fp, struct kinfo_file *kif,
15008d59ecb2SHans Petter Selasky     struct filedesc *fdp)
15018d59ecb2SHans Petter Selasky {
15028d59ecb2SHans Petter Selasky 
15038d59ecb2SHans Petter Selasky 	return (0);
15048d59ecb2SHans Petter Selasky }
15058d59ecb2SHans Petter Selasky 
15062b79a966SHans Petter Selasky unsigned int
15072b79a966SHans Petter Selasky linux_iminor(struct inode *inode)
15082b79a966SHans Petter Selasky {
15092b79a966SHans Petter Selasky 	struct linux_cdev *ldev;
15102b79a966SHans Petter Selasky 
15112b79a966SHans Petter Selasky 	if (inode == NULL || inode->v_rdev == NULL ||
15122b79a966SHans Petter Selasky 	    inode->v_rdev->si_devsw != &linuxcdevsw)
15132b79a966SHans Petter Selasky 		return (-1U);
15142b79a966SHans Petter Selasky 	ldev = inode->v_rdev->si_drv1;
15152b79a966SHans Petter Selasky 	if (ldev == NULL)
15162b79a966SHans Petter Selasky 		return (-1U);
15172b79a966SHans Petter Selasky 
15182b79a966SHans Petter Selasky 	return (minor(ldev->dev));
15192b79a966SHans Petter Selasky }
15202b79a966SHans Petter Selasky 
15218d59ecb2SHans Petter Selasky struct fileops linuxfileops = {
15228d59ecb2SHans Petter Selasky 	.fo_read = linux_file_read,
15238d59ecb2SHans Petter Selasky 	.fo_write = invfo_rdwr,
15248d59ecb2SHans Petter Selasky 	.fo_truncate = invfo_truncate,
15258d59ecb2SHans Petter Selasky 	.fo_kqfilter = invfo_kqfilter,
15268d59ecb2SHans Petter Selasky 	.fo_stat = linux_file_stat,
15278d59ecb2SHans Petter Selasky 	.fo_fill_kinfo = linux_file_fill_kinfo,
15288d59ecb2SHans Petter Selasky 	.fo_poll = linux_file_poll,
15298d59ecb2SHans Petter Selasky 	.fo_close = linux_file_close,
15308d59ecb2SHans Petter Selasky 	.fo_ioctl = linux_file_ioctl,
15318d59ecb2SHans Petter Selasky 	.fo_chmod = invfo_chmod,
15328d59ecb2SHans Petter Selasky 	.fo_chown = invfo_chown,
15338d59ecb2SHans Petter Selasky 	.fo_sendfile = invfo_sendfile,
15348d59ecb2SHans Petter Selasky };
15358d59ecb2SHans Petter Selasky 
15368d59ecb2SHans Petter Selasky /*
15378d59ecb2SHans Petter Selasky  * Hash of vmmap addresses.  This is infrequently accessed and does not
15388d59ecb2SHans Petter Selasky  * need to be particularly large.  This is done because we must store the
15398d59ecb2SHans Petter Selasky  * caller's idea of the map size to properly unmap.
15408d59ecb2SHans Petter Selasky  */
15418d59ecb2SHans Petter Selasky struct vmmap {
15428d59ecb2SHans Petter Selasky 	LIST_ENTRY(vmmap)	vm_next;
15438d59ecb2SHans Petter Selasky 	void 			*vm_addr;
15448d59ecb2SHans Petter Selasky 	unsigned long		vm_size;
15458d59ecb2SHans Petter Selasky };
15468d59ecb2SHans Petter Selasky 
15478d59ecb2SHans Petter Selasky struct vmmaphd {
15488d59ecb2SHans Petter Selasky 	struct vmmap *lh_first;
15498d59ecb2SHans Petter Selasky };
15508d59ecb2SHans Petter Selasky #define	VMMAP_HASH_SIZE	64
15518d59ecb2SHans Petter Selasky #define	VMMAP_HASH_MASK	(VMMAP_HASH_SIZE - 1)
15528d59ecb2SHans Petter Selasky #define	VM_HASH(addr)	((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK
15538d59ecb2SHans Petter Selasky static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE];
15548d59ecb2SHans Petter Selasky static struct mtx vmmaplock;
15558d59ecb2SHans Petter Selasky 
15568d59ecb2SHans Petter Selasky static void
15578d59ecb2SHans Petter Selasky vmmap_add(void *addr, unsigned long size)
15588d59ecb2SHans Petter Selasky {
15598d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
15608d59ecb2SHans Petter Selasky 
15618d59ecb2SHans Petter Selasky 	vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL);
15628d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
15638d59ecb2SHans Petter Selasky 	vmmap->vm_size = size;
15648d59ecb2SHans Petter Selasky 	vmmap->vm_addr = addr;
15658d59ecb2SHans Petter Selasky 	LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next);
15668d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
15678d59ecb2SHans Petter Selasky }
15688d59ecb2SHans Petter Selasky 
15698d59ecb2SHans Petter Selasky static struct vmmap *
15708d59ecb2SHans Petter Selasky vmmap_remove(void *addr)
15718d59ecb2SHans Petter Selasky {
15728d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
15738d59ecb2SHans Petter Selasky 
15748d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
15758d59ecb2SHans Petter Selasky 	LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next)
15768d59ecb2SHans Petter Selasky 		if (vmmap->vm_addr == addr)
15778d59ecb2SHans Petter Selasky 			break;
15788d59ecb2SHans Petter Selasky 	if (vmmap)
15798d59ecb2SHans Petter Selasky 		LIST_REMOVE(vmmap, vm_next);
15808d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
15818d59ecb2SHans Petter Selasky 
15828d59ecb2SHans Petter Selasky 	return (vmmap);
15838d59ecb2SHans Petter Selasky }
15848d59ecb2SHans Petter Selasky 
1585864092bcSJustin Hibbits #if defined(__i386__) || defined(__amd64__) || defined(__powerpc__)
15868d59ecb2SHans Petter Selasky void *
15878d59ecb2SHans Petter Selasky _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr)
15888d59ecb2SHans Petter Selasky {
15898d59ecb2SHans Petter Selasky 	void *addr;
15908d59ecb2SHans Petter Selasky 
15918d59ecb2SHans Petter Selasky 	addr = pmap_mapdev_attr(phys_addr, size, attr);
15928d59ecb2SHans Petter Selasky 	if (addr == NULL)
15938d59ecb2SHans Petter Selasky 		return (NULL);
15948d59ecb2SHans Petter Selasky 	vmmap_add(addr, size);
15958d59ecb2SHans Petter Selasky 
15968d59ecb2SHans Petter Selasky 	return (addr);
15978d59ecb2SHans Petter Selasky }
159886845417SHans Petter Selasky #endif
15998d59ecb2SHans Petter Selasky 
16008d59ecb2SHans Petter Selasky void
16018d59ecb2SHans Petter Selasky iounmap(void *addr)
16028d59ecb2SHans Petter Selasky {
16038d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
16048d59ecb2SHans Petter Selasky 
16058d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
16068d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
16078d59ecb2SHans Petter Selasky 		return;
1608864092bcSJustin Hibbits #if defined(__i386__) || defined(__amd64__) || defined(__powerpc__)
16098d59ecb2SHans Petter Selasky 	pmap_unmapdev((vm_offset_t)addr, vmmap->vm_size);
16108d59ecb2SHans Petter Selasky #endif
16118d59ecb2SHans Petter Selasky 	kfree(vmmap);
16128d59ecb2SHans Petter Selasky }
16138d59ecb2SHans Petter Selasky 
16148d59ecb2SHans Petter Selasky 
16158d59ecb2SHans Petter Selasky void *
16168d59ecb2SHans Petter Selasky vmap(struct page **pages, unsigned int count, unsigned long flags, int prot)
16178d59ecb2SHans Petter Selasky {
16188d59ecb2SHans Petter Selasky 	vm_offset_t off;
16198d59ecb2SHans Petter Selasky 	size_t size;
16208d59ecb2SHans Petter Selasky 
16218d59ecb2SHans Petter Selasky 	size = count * PAGE_SIZE;
16228d59ecb2SHans Petter Selasky 	off = kva_alloc(size);
16238d59ecb2SHans Petter Selasky 	if (off == 0)
16248d59ecb2SHans Petter Selasky 		return (NULL);
16258d59ecb2SHans Petter Selasky 	vmmap_add((void *)off, size);
16268d59ecb2SHans Petter Selasky 	pmap_qenter(off, pages, count);
16278d59ecb2SHans Petter Selasky 
16288d59ecb2SHans Petter Selasky 	return ((void *)off);
16298d59ecb2SHans Petter Selasky }
16308d59ecb2SHans Petter Selasky 
16318d59ecb2SHans Petter Selasky void
16328d59ecb2SHans Petter Selasky vunmap(void *addr)
16338d59ecb2SHans Petter Selasky {
16348d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
16358d59ecb2SHans Petter Selasky 
16368d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
16378d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
16388d59ecb2SHans Petter Selasky 		return;
16398d59ecb2SHans Petter Selasky 	pmap_qremove((vm_offset_t)addr, vmmap->vm_size / PAGE_SIZE);
16408d59ecb2SHans Petter Selasky 	kva_free((vm_offset_t)addr, vmmap->vm_size);
16418d59ecb2SHans Petter Selasky 	kfree(vmmap);
16428d59ecb2SHans Petter Selasky }
16438d59ecb2SHans Petter Selasky 
16448d59ecb2SHans Petter Selasky char *
16458d59ecb2SHans Petter Selasky kvasprintf(gfp_t gfp, const char *fmt, va_list ap)
16468d59ecb2SHans Petter Selasky {
16478d59ecb2SHans Petter Selasky 	unsigned int len;
16488d59ecb2SHans Petter Selasky 	char *p;
16498d59ecb2SHans Petter Selasky 	va_list aq;
16508d59ecb2SHans Petter Selasky 
16518d59ecb2SHans Petter Selasky 	va_copy(aq, ap);
16528d59ecb2SHans Petter Selasky 	len = vsnprintf(NULL, 0, fmt, aq);
16538d59ecb2SHans Petter Selasky 	va_end(aq);
16548d59ecb2SHans Petter Selasky 
16558d59ecb2SHans Petter Selasky 	p = kmalloc(len + 1, gfp);
16568d59ecb2SHans Petter Selasky 	if (p != NULL)
16578d59ecb2SHans Petter Selasky 		vsnprintf(p, len + 1, fmt, ap);
16588d59ecb2SHans Petter Selasky 
16598d59ecb2SHans Petter Selasky 	return (p);
16608d59ecb2SHans Petter Selasky }
16618d59ecb2SHans Petter Selasky 
16628d59ecb2SHans Petter Selasky char *
16638d59ecb2SHans Petter Selasky kasprintf(gfp_t gfp, const char *fmt, ...)
16648d59ecb2SHans Petter Selasky {
16658d59ecb2SHans Petter Selasky 	va_list ap;
16668d59ecb2SHans Petter Selasky 	char *p;
16678d59ecb2SHans Petter Selasky 
16688d59ecb2SHans Petter Selasky 	va_start(ap, fmt);
16698d59ecb2SHans Petter Selasky 	p = kvasprintf(gfp, fmt, ap);
16708d59ecb2SHans Petter Selasky 	va_end(ap);
16718d59ecb2SHans Petter Selasky 
16728d59ecb2SHans Petter Selasky 	return (p);
16738d59ecb2SHans Petter Selasky }
16748d59ecb2SHans Petter Selasky 
16758d59ecb2SHans Petter Selasky static void
16768d59ecb2SHans Petter Selasky linux_timer_callback_wrapper(void *context)
16778d59ecb2SHans Petter Selasky {
16788d59ecb2SHans Petter Selasky 	struct timer_list *timer;
16798d59ecb2SHans Petter Selasky 
16805f50a414SHans Petter Selasky 	linux_set_current(curthread);
16815f50a414SHans Petter Selasky 
16828d59ecb2SHans Petter Selasky 	timer = context;
16838d59ecb2SHans Petter Selasky 	timer->function(timer->data);
16848d59ecb2SHans Petter Selasky }
16858d59ecb2SHans Petter Selasky 
16868d59ecb2SHans Petter Selasky void
1687f6800be3SHans Petter Selasky mod_timer(struct timer_list *timer, int expires)
16888d59ecb2SHans Petter Selasky {
16898d59ecb2SHans Petter Selasky 
16908d59ecb2SHans Petter Selasky 	timer->expires = expires;
16918d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
16928d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(expires),
16938d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
16948d59ecb2SHans Petter Selasky }
16958d59ecb2SHans Petter Selasky 
16968d59ecb2SHans Petter Selasky void
16978d59ecb2SHans Petter Selasky add_timer(struct timer_list *timer)
16988d59ecb2SHans Petter Selasky {
16998d59ecb2SHans Petter Selasky 
17008d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
17018d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
17028d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
17038d59ecb2SHans Petter Selasky }
17048d59ecb2SHans Petter Selasky 
1705def277d3SHans Petter Selasky void
1706def277d3SHans Petter Selasky add_timer_on(struct timer_list *timer, int cpu)
1707def277d3SHans Petter Selasky {
1708def277d3SHans Petter Selasky 
1709def277d3SHans Petter Selasky 	callout_reset_on(&timer->timer_callout,
1710def277d3SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
1711def277d3SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer, cpu);
1712def277d3SHans Petter Selasky }
1713def277d3SHans Petter Selasky 
17148d59ecb2SHans Petter Selasky static void
17158d59ecb2SHans Petter Selasky linux_timer_init(void *arg)
17168d59ecb2SHans Petter Selasky {
17178d59ecb2SHans Petter Selasky 
17188d59ecb2SHans Petter Selasky 	/*
17198d59ecb2SHans Petter Selasky 	 * Compute an internal HZ value which can divide 2**32 to
17208d59ecb2SHans Petter Selasky 	 * avoid timer rounding problems when the tick value wraps
17218d59ecb2SHans Petter Selasky 	 * around 2**32:
17228d59ecb2SHans Petter Selasky 	 */
17238d59ecb2SHans Petter Selasky 	linux_timer_hz_mask = 1;
17248d59ecb2SHans Petter Selasky 	while (linux_timer_hz_mask < (unsigned long)hz)
17258d59ecb2SHans Petter Selasky 		linux_timer_hz_mask *= 2;
17268d59ecb2SHans Petter Selasky 	linux_timer_hz_mask--;
17278d59ecb2SHans Petter Selasky }
17288d59ecb2SHans Petter Selasky SYSINIT(linux_timer, SI_SUB_DRIVERS, SI_ORDER_FIRST, linux_timer_init, NULL);
17298d59ecb2SHans Petter Selasky 
17308d59ecb2SHans Petter Selasky void
17318d59ecb2SHans Petter Selasky linux_complete_common(struct completion *c, int all)
17328d59ecb2SHans Petter Selasky {
17338d59ecb2SHans Petter Selasky 	int wakeup_swapper;
17348d59ecb2SHans Petter Selasky 
17358d59ecb2SHans Petter Selasky 	sleepq_lock(c);
17368d59ecb2SHans Petter Selasky 	c->done++;
17378d59ecb2SHans Petter Selasky 	if (all)
17388d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_broadcast(c, SLEEPQ_SLEEP, 0, 0);
17398d59ecb2SHans Petter Selasky 	else
17408d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_signal(c, SLEEPQ_SLEEP, 0, 0);
17418d59ecb2SHans Petter Selasky 	sleepq_release(c);
17428d59ecb2SHans Petter Selasky 	if (wakeup_swapper)
17438d59ecb2SHans Petter Selasky 		kick_proc0();
17448d59ecb2SHans Petter Selasky }
17458d59ecb2SHans Petter Selasky 
17468d59ecb2SHans Petter Selasky /*
17478d59ecb2SHans Petter Selasky  * Indefinite wait for done != 0 with or without signals.
17488d59ecb2SHans Petter Selasky  */
1749f6800be3SHans Petter Selasky int
17508d59ecb2SHans Petter Selasky linux_wait_for_common(struct completion *c, int flags)
17518d59ecb2SHans Petter Selasky {
1752f6800be3SHans Petter Selasky 	int error;
1753b602c283SMark Johnston 
17548eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
175585714218SHans Petter Selasky 		return (0);
17568d59ecb2SHans Petter Selasky 
1757b602c283SMark Johnston 	DROP_GIANT();
1758b602c283SMark Johnston 
17598d59ecb2SHans Petter Selasky 	if (flags != 0)
17608d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
17618d59ecb2SHans Petter Selasky 	else
17628d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
1763b602c283SMark Johnston 	error = 0;
17648d59ecb2SHans Petter Selasky 	for (;;) {
17658d59ecb2SHans Petter Selasky 		sleepq_lock(c);
17668d59ecb2SHans Petter Selasky 		if (c->done)
17678d59ecb2SHans Petter Selasky 			break;
17688d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
17698d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE) {
1770b602c283SMark Johnston 			if (sleepq_wait_sig(c, 0) != 0) {
1771b602c283SMark Johnston 				error = -ERESTARTSYS;
1772b602c283SMark Johnston 				goto intr;
1773b602c283SMark Johnston 			}
17748d59ecb2SHans Petter Selasky 		} else
17758d59ecb2SHans Petter Selasky 			sleepq_wait(c, 0);
17768d59ecb2SHans Petter Selasky 	}
17778d59ecb2SHans Petter Selasky 	c->done--;
17788d59ecb2SHans Petter Selasky 	sleepq_release(c);
17798d59ecb2SHans Petter Selasky 
1780b602c283SMark Johnston intr:
1781b602c283SMark Johnston 	PICKUP_GIANT();
1782b602c283SMark Johnston 
1783b602c283SMark Johnston 	return (error);
17848d59ecb2SHans Petter Selasky }
17858d59ecb2SHans Petter Selasky 
17868d59ecb2SHans Petter Selasky /*
17878d59ecb2SHans Petter Selasky  * Time limited wait for done != 0 with or without signals.
17888d59ecb2SHans Petter Selasky  */
1789f6800be3SHans Petter Selasky int
1790f6800be3SHans Petter Selasky linux_wait_for_timeout_common(struct completion *c, int timeout, int flags)
17918d59ecb2SHans Petter Selasky {
1792f6800be3SHans Petter Selasky 	int end = jiffies + timeout;
1793f6800be3SHans Petter Selasky 	int error;
1794b602c283SMark Johnston 	int ret;
17958d59ecb2SHans Petter Selasky 
17968eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
179785714218SHans Petter Selasky 		return (0);
179885714218SHans Petter Selasky 
1799b602c283SMark Johnston 	DROP_GIANT();
1800b602c283SMark Johnston 
18018d59ecb2SHans Petter Selasky 	if (flags != 0)
18028d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
18038d59ecb2SHans Petter Selasky 	else
18048d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
18058d59ecb2SHans Petter Selasky 
1806b602c283SMark Johnston 	error = 0;
1807b602c283SMark Johnston 	ret = 0;
1808b602c283SMark Johnston 	for (;;) {
18098d59ecb2SHans Petter Selasky 		sleepq_lock(c);
18108d59ecb2SHans Petter Selasky 		if (c->done)
18118d59ecb2SHans Petter Selasky 			break;
18128d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
18138d59ecb2SHans Petter Selasky 		sleepq_set_timeout(c, linux_timer_jiffies_until(end));
18148d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE)
18158d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait_sig(c, 0);
18168d59ecb2SHans Petter Selasky 		else
18178d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait(c, 0);
18188d59ecb2SHans Petter Selasky 		if (ret != 0) {
18198d59ecb2SHans Petter Selasky 			/* check for timeout or signal */
18208d59ecb2SHans Petter Selasky 			if (ret == EWOULDBLOCK)
1821b602c283SMark Johnston 				error = 0;
18228d59ecb2SHans Petter Selasky 			else
1823b602c283SMark Johnston 				error = -ERESTARTSYS;
1824b602c283SMark Johnston 			goto intr;
18258d59ecb2SHans Petter Selasky 		}
18268d59ecb2SHans Petter Selasky 	}
18278d59ecb2SHans Petter Selasky 	c->done--;
18288d59ecb2SHans Petter Selasky 	sleepq_release(c);
18298d59ecb2SHans Petter Selasky 
1830b602c283SMark Johnston intr:
1831b602c283SMark Johnston 	PICKUP_GIANT();
1832b602c283SMark Johnston 
18338d59ecb2SHans Petter Selasky 	/* return how many jiffies are left */
1834b602c283SMark Johnston 	return (ret != 0 ? error : linux_timer_jiffies_until(end));
18358d59ecb2SHans Petter Selasky }
18368d59ecb2SHans Petter Selasky 
18378d59ecb2SHans Petter Selasky int
18388d59ecb2SHans Petter Selasky linux_try_wait_for_completion(struct completion *c)
18398d59ecb2SHans Petter Selasky {
18408d59ecb2SHans Petter Selasky 	int isdone;
18418d59ecb2SHans Petter Selasky 
18428d59ecb2SHans Petter Selasky 	isdone = 1;
18438d59ecb2SHans Petter Selasky 	sleepq_lock(c);
18448d59ecb2SHans Petter Selasky 	if (c->done)
18458d59ecb2SHans Petter Selasky 		c->done--;
18468d59ecb2SHans Petter Selasky 	else
18478d59ecb2SHans Petter Selasky 		isdone = 0;
18488d59ecb2SHans Petter Selasky 	sleepq_release(c);
18498d59ecb2SHans Petter Selasky 	return (isdone);
18508d59ecb2SHans Petter Selasky }
18518d59ecb2SHans Petter Selasky 
18528d59ecb2SHans Petter Selasky int
18538d59ecb2SHans Petter Selasky linux_completion_done(struct completion *c)
18548d59ecb2SHans Petter Selasky {
18558d59ecb2SHans Petter Selasky 	int isdone;
18568d59ecb2SHans Petter Selasky 
18578d59ecb2SHans Petter Selasky 	isdone = 1;
18588d59ecb2SHans Petter Selasky 	sleepq_lock(c);
18598d59ecb2SHans Petter Selasky 	if (c->done == 0)
18608d59ecb2SHans Petter Selasky 		isdone = 0;
18618d59ecb2SHans Petter Selasky 	sleepq_release(c);
18628d59ecb2SHans Petter Selasky 	return (isdone);
18638d59ecb2SHans Petter Selasky }
18648d59ecb2SHans Petter Selasky 
18658d59ecb2SHans Petter Selasky static void
186606204f8eSHans Petter Selasky linux_cdev_release(struct kobject *kobj)
186706204f8eSHans Petter Selasky {
186806204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
186906204f8eSHans Petter Selasky 	struct kobject *parent;
187006204f8eSHans Petter Selasky 
187106204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
187206204f8eSHans Petter Selasky 	parent = kobj->parent;
187306204f8eSHans Petter Selasky 	if (cdev->cdev)
187406204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
187506204f8eSHans Petter Selasky 	kfree(cdev);
187606204f8eSHans Petter Selasky 	kobject_put(parent);
187706204f8eSHans Petter Selasky }
187806204f8eSHans Petter Selasky 
187906204f8eSHans Petter Selasky static void
188006204f8eSHans Petter Selasky linux_cdev_static_release(struct kobject *kobj)
188106204f8eSHans Petter Selasky {
188206204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
188306204f8eSHans Petter Selasky 	struct kobject *parent;
188406204f8eSHans Petter Selasky 
188506204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
188606204f8eSHans Petter Selasky 	parent = kobj->parent;
188706204f8eSHans Petter Selasky 	if (cdev->cdev)
188806204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
188906204f8eSHans Petter Selasky 	kobject_put(parent);
189006204f8eSHans Petter Selasky }
189106204f8eSHans Petter Selasky 
189206204f8eSHans Petter Selasky const struct kobj_type linux_cdev_ktype = {
189306204f8eSHans Petter Selasky 	.release = linux_cdev_release,
189406204f8eSHans Petter Selasky };
189506204f8eSHans Petter Selasky 
189606204f8eSHans Petter Selasky const struct kobj_type linux_cdev_static_ktype = {
189706204f8eSHans Petter Selasky 	.release = linux_cdev_static_release,
189806204f8eSHans Petter Selasky };
189906204f8eSHans Petter Selasky 
190006204f8eSHans Petter Selasky static void
19010c510167SHans Petter Selasky linux_handle_ifnet_link_event(void *arg, struct ifnet *ifp, int linkstate)
19020c510167SHans Petter Selasky {
19030c510167SHans Petter Selasky 	struct notifier_block *nb;
19040c510167SHans Petter Selasky 
19050c510167SHans Petter Selasky 	nb = arg;
19060c510167SHans Petter Selasky 	if (linkstate == LINK_STATE_UP)
19070c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_UP, ifp);
19080c510167SHans Petter Selasky 	else
19090c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_DOWN, ifp);
19100c510167SHans Petter Selasky }
19110c510167SHans Petter Selasky 
19120c510167SHans Petter Selasky static void
19130c510167SHans Petter Selasky linux_handle_ifnet_arrival_event(void *arg, struct ifnet *ifp)
19140c510167SHans Petter Selasky {
19150c510167SHans Petter Selasky 	struct notifier_block *nb;
19160c510167SHans Petter Selasky 
19170c510167SHans Petter Selasky 	nb = arg;
19180c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_REGISTER, ifp);
19190c510167SHans Petter Selasky }
19200c510167SHans Petter Selasky 
19210c510167SHans Petter Selasky static void
19220c510167SHans Petter Selasky linux_handle_ifnet_departure_event(void *arg, struct ifnet *ifp)
19230c510167SHans Petter Selasky {
19240c510167SHans Petter Selasky 	struct notifier_block *nb;
19250c510167SHans Petter Selasky 
19260c510167SHans Petter Selasky 	nb = arg;
19270c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_UNREGISTER, ifp);
19280c510167SHans Petter Selasky }
19290c510167SHans Petter Selasky 
19300c510167SHans Petter Selasky static void
19310c510167SHans Petter Selasky linux_handle_iflladdr_event(void *arg, struct ifnet *ifp)
19320c510167SHans Petter Selasky {
19330c510167SHans Petter Selasky 	struct notifier_block *nb;
19340c510167SHans Petter Selasky 
19350c510167SHans Petter Selasky 	nb = arg;
19360c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEADDR, ifp);
19370c510167SHans Petter Selasky }
19380c510167SHans Petter Selasky 
19390c510167SHans Petter Selasky static void
19400c510167SHans Petter Selasky linux_handle_ifaddr_event(void *arg, struct ifnet *ifp)
19410c510167SHans Petter Selasky {
19420c510167SHans Petter Selasky 	struct notifier_block *nb;
19430c510167SHans Petter Selasky 
19440c510167SHans Petter Selasky 	nb = arg;
19450c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEIFADDR, ifp);
19460c510167SHans Petter Selasky }
19470c510167SHans Petter Selasky 
19480c510167SHans Petter Selasky int
19490c510167SHans Petter Selasky register_netdevice_notifier(struct notifier_block *nb)
19500c510167SHans Petter Selasky {
19510c510167SHans Petter Selasky 
19520c510167SHans Petter Selasky 	nb->tags[NETDEV_UP] = EVENTHANDLER_REGISTER(
19530c510167SHans Petter Selasky 	    ifnet_link_event, linux_handle_ifnet_link_event, nb, 0);
19540c510167SHans Petter Selasky 	nb->tags[NETDEV_REGISTER] = EVENTHANDLER_REGISTER(
19550c510167SHans Petter Selasky 	    ifnet_arrival_event, linux_handle_ifnet_arrival_event, nb, 0);
19560c510167SHans Petter Selasky 	nb->tags[NETDEV_UNREGISTER] = EVENTHANDLER_REGISTER(
19570c510167SHans Petter Selasky 	    ifnet_departure_event, linux_handle_ifnet_departure_event, nb, 0);
19580c510167SHans Petter Selasky 	nb->tags[NETDEV_CHANGEADDR] = EVENTHANDLER_REGISTER(
19590c510167SHans Petter Selasky 	    iflladdr_event, linux_handle_iflladdr_event, nb, 0);
19600c510167SHans Petter Selasky 
19610c510167SHans Petter Selasky 	return (0);
19620c510167SHans Petter Selasky }
19630c510167SHans Petter Selasky 
19640c510167SHans Petter Selasky int
19650c510167SHans Petter Selasky register_inetaddr_notifier(struct notifier_block *nb)
19660c510167SHans Petter Selasky {
19670c510167SHans Petter Selasky 
19680c510167SHans Petter Selasky         nb->tags[NETDEV_CHANGEIFADDR] = EVENTHANDLER_REGISTER(
19690c510167SHans Petter Selasky             ifaddr_event, linux_handle_ifaddr_event, nb, 0);
19700c510167SHans Petter Selasky         return (0);
19710c510167SHans Petter Selasky }
19720c510167SHans Petter Selasky 
19730c510167SHans Petter Selasky int
19740c510167SHans Petter Selasky unregister_netdevice_notifier(struct notifier_block *nb)
19750c510167SHans Petter Selasky {
19760c510167SHans Petter Selasky 
19770c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_link_event,
19780c510167SHans Petter Selasky 	    nb->tags[NETDEV_UP]);
19790c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_arrival_event,
19800c510167SHans Petter Selasky 	    nb->tags[NETDEV_REGISTER]);
19810c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_departure_event,
19820c510167SHans Petter Selasky 	    nb->tags[NETDEV_UNREGISTER]);
19830c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(iflladdr_event,
19840c510167SHans Petter Selasky 	    nb->tags[NETDEV_CHANGEADDR]);
19850c510167SHans Petter Selasky 
19860c510167SHans Petter Selasky 	return (0);
19870c510167SHans Petter Selasky }
19880c510167SHans Petter Selasky 
19890c510167SHans Petter Selasky int
19900c510167SHans Petter Selasky unregister_inetaddr_notifier(struct notifier_block *nb)
19910c510167SHans Petter Selasky {
19920c510167SHans Petter Selasky 
19930c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifaddr_event,
19940c510167SHans Petter Selasky             nb->tags[NETDEV_CHANGEIFADDR]);
19950c510167SHans Petter Selasky 
19960c510167SHans Petter Selasky         return (0);
19970c510167SHans Petter Selasky }
19980c510167SHans Petter Selasky 
1999aad02fb4SHans Petter Selasky struct list_sort_thunk {
2000aad02fb4SHans Petter Selasky 	int (*cmp)(void *, struct list_head *, struct list_head *);
2001aad02fb4SHans Petter Selasky 	void *priv;
2002aad02fb4SHans Petter Selasky };
2003aad02fb4SHans Petter Selasky 
2004aad02fb4SHans Petter Selasky static inline int
2005aad02fb4SHans Petter Selasky linux_le_cmp(void *priv, const void *d1, const void *d2)
2006aad02fb4SHans Petter Selasky {
2007aad02fb4SHans Petter Selasky 	struct list_head *le1, *le2;
2008aad02fb4SHans Petter Selasky 	struct list_sort_thunk *thunk;
2009aad02fb4SHans Petter Selasky 
2010aad02fb4SHans Petter Selasky 	thunk = priv;
2011aad02fb4SHans Petter Selasky 	le1 = *(__DECONST(struct list_head **, d1));
2012aad02fb4SHans Petter Selasky 	le2 = *(__DECONST(struct list_head **, d2));
2013aad02fb4SHans Petter Selasky 	return ((thunk->cmp)(thunk->priv, le1, le2));
2014aad02fb4SHans Petter Selasky }
2015aad02fb4SHans Petter Selasky 
2016aad02fb4SHans Petter Selasky void
2017aad02fb4SHans Petter Selasky list_sort(void *priv, struct list_head *head, int (*cmp)(void *priv,
2018aad02fb4SHans Petter Selasky     struct list_head *a, struct list_head *b))
2019aad02fb4SHans Petter Selasky {
2020aad02fb4SHans Petter Selasky 	struct list_sort_thunk thunk;
2021aad02fb4SHans Petter Selasky 	struct list_head **ar, *le;
2022aad02fb4SHans Petter Selasky 	size_t count, i;
2023aad02fb4SHans Petter Selasky 
2024aad02fb4SHans Petter Selasky 	count = 0;
2025aad02fb4SHans Petter Selasky 	list_for_each(le, head)
2026aad02fb4SHans Petter Selasky 		count++;
2027aad02fb4SHans Petter Selasky 	ar = malloc(sizeof(struct list_head *) * count, M_KMALLOC, M_WAITOK);
2028aad02fb4SHans Petter Selasky 	i = 0;
2029aad02fb4SHans Petter Selasky 	list_for_each(le, head)
2030aad02fb4SHans Petter Selasky 		ar[i++] = le;
2031aad02fb4SHans Petter Selasky 	thunk.cmp = cmp;
2032aad02fb4SHans Petter Selasky 	thunk.priv = priv;
2033aad02fb4SHans Petter Selasky 	qsort_r(ar, count, sizeof(struct list_head *), &thunk, linux_le_cmp);
2034aad02fb4SHans Petter Selasky 	INIT_LIST_HEAD(head);
2035aad02fb4SHans Petter Selasky 	for (i = 0; i < count; i++)
2036aad02fb4SHans Petter Selasky 		list_add_tail(ar[i], head);
2037aad02fb4SHans Petter Selasky 	free(ar, M_KMALLOC);
2038aad02fb4SHans Petter Selasky }
2039aad02fb4SHans Petter Selasky 
20400c510167SHans Petter Selasky void
20410c510167SHans Petter Selasky linux_irq_handler(void *ent)
20420c510167SHans Petter Selasky {
20430c510167SHans Petter Selasky 	struct irq_ent *irqe;
20440c510167SHans Petter Selasky 
20455f50a414SHans Petter Selasky 	linux_set_current(curthread);
20465f50a414SHans Petter Selasky 
20470c510167SHans Petter Selasky 	irqe = ent;
20480c510167SHans Petter Selasky 	irqe->handler(irqe->irq, irqe->arg);
20490c510167SHans Petter Selasky }
20500c510167SHans Petter Selasky 
2051c12488bbSMark Johnston #if defined(__i386__) || defined(__amd64__)
2052c12488bbSMark Johnston int
2053c12488bbSMark Johnston linux_wbinvd_on_all_cpus(void)
2054c12488bbSMark Johnston {
2055c12488bbSMark Johnston 
20566c106233SMark Johnston 	pmap_invalidate_cache();
20576c106233SMark Johnston 	return (0);
2058c12488bbSMark Johnston }
2059c12488bbSMark Johnston #endif
2060c12488bbSMark Johnston 
2061c12488bbSMark Johnston int
2062c12488bbSMark Johnston linux_on_each_cpu(void callback(void *), void *data)
2063c12488bbSMark Johnston {
2064c12488bbSMark Johnston 
2065c12488bbSMark Johnston 	smp_rendezvous(smp_no_rendezvous_barrier, callback,
2066c12488bbSMark Johnston 	    smp_no_rendezvous_barrier, data);
2067c12488bbSMark Johnston 	return (0);
2068c12488bbSMark Johnston }
2069c12488bbSMark Johnston 
2070dff36e69SHans Petter Selasky int
2071dff36e69SHans Petter Selasky linux_in_atomic(void)
2072dff36e69SHans Petter Selasky {
2073dff36e69SHans Petter Selasky 
2074dff36e69SHans Petter Selasky 	return ((curthread->td_pflags & TDP_NOFAULTING) != 0);
2075dff36e69SHans Petter Selasky }
2076dff36e69SHans Petter Selasky 
20771125dbc0SHans Petter Selasky struct linux_cdev *
20781125dbc0SHans Petter Selasky linux_find_cdev(const char *name, unsigned major, unsigned minor)
20791125dbc0SHans Petter Selasky {
20802b79a966SHans Petter Selasky 	dev_t dev = MKDEV(major, minor);
20811125dbc0SHans Petter Selasky 	struct cdev *cdev;
20821125dbc0SHans Petter Selasky 
20831125dbc0SHans Petter Selasky 	dev_lock();
20841125dbc0SHans Petter Selasky 	LIST_FOREACH(cdev, &linuxcdevsw.d_devs, si_list) {
20851125dbc0SHans Petter Selasky 		struct linux_cdev *ldev = cdev->si_drv1;
20862b79a966SHans Petter Selasky 		if (ldev->dev == dev &&
20871125dbc0SHans Petter Selasky 		    strcmp(kobject_name(&ldev->kobj), name) == 0) {
20881125dbc0SHans Petter Selasky 			break;
20891125dbc0SHans Petter Selasky 		}
20901125dbc0SHans Petter Selasky 	}
20911125dbc0SHans Petter Selasky 	dev_unlock();
20921125dbc0SHans Petter Selasky 
20931125dbc0SHans Petter Selasky 	return (cdev != NULL ? cdev->si_drv1 : NULL);
20941125dbc0SHans Petter Selasky }
20951125dbc0SHans Petter Selasky 
20961125dbc0SHans Petter Selasky int
20971125dbc0SHans Petter Selasky __register_chrdev(unsigned int major, unsigned int baseminor,
20981125dbc0SHans Petter Selasky     unsigned int count, const char *name,
20991125dbc0SHans Petter Selasky     const struct file_operations *fops)
21001125dbc0SHans Petter Selasky {
21011125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
21021125dbc0SHans Petter Selasky 	int ret = 0;
21031125dbc0SHans Petter Selasky 	int i;
21041125dbc0SHans Petter Selasky 
21051125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
21061125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
21071125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
21081125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
21091125dbc0SHans Petter Selasky 
21101125dbc0SHans Petter Selasky 		ret = cdev_add(cdev, makedev(major, i), 1);
21111125dbc0SHans Petter Selasky 		if (ret != 0)
21121125dbc0SHans Petter Selasky 			break;
21131125dbc0SHans Petter Selasky 	}
21141125dbc0SHans Petter Selasky 	return (ret);
21151125dbc0SHans Petter Selasky }
21161125dbc0SHans Petter Selasky 
21171125dbc0SHans Petter Selasky int
21181125dbc0SHans Petter Selasky __register_chrdev_p(unsigned int major, unsigned int baseminor,
21191125dbc0SHans Petter Selasky     unsigned int count, const char *name,
21201125dbc0SHans Petter Selasky     const struct file_operations *fops, uid_t uid,
21211125dbc0SHans Petter Selasky     gid_t gid, int mode)
21221125dbc0SHans Petter Selasky {
21231125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
21241125dbc0SHans Petter Selasky 	int ret = 0;
21251125dbc0SHans Petter Selasky 	int i;
21261125dbc0SHans Petter Selasky 
21271125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
21281125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
21291125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
21301125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
21311125dbc0SHans Petter Selasky 
21321125dbc0SHans Petter Selasky 		ret = cdev_add_ext(cdev, makedev(major, i), uid, gid, mode);
21331125dbc0SHans Petter Selasky 		if (ret != 0)
21341125dbc0SHans Petter Selasky 			break;
21351125dbc0SHans Petter Selasky 	}
21361125dbc0SHans Petter Selasky 	return (ret);
21371125dbc0SHans Petter Selasky }
21381125dbc0SHans Petter Selasky 
21391125dbc0SHans Petter Selasky void
21401125dbc0SHans Petter Selasky __unregister_chrdev(unsigned int major, unsigned int baseminor,
21411125dbc0SHans Petter Selasky     unsigned int count, const char *name)
21421125dbc0SHans Petter Selasky {
21431125dbc0SHans Petter Selasky 	struct linux_cdev *cdevp;
21441125dbc0SHans Petter Selasky 	int i;
21451125dbc0SHans Petter Selasky 
21461125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
21471125dbc0SHans Petter Selasky 		cdevp = linux_find_cdev(name, major, i);
21481125dbc0SHans Petter Selasky 		if (cdevp != NULL)
21491125dbc0SHans Petter Selasky 			cdev_del(cdevp);
21501125dbc0SHans Petter Selasky 	}
21511125dbc0SHans Petter Selasky }
21521125dbc0SHans Petter Selasky 
215303219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
215403219fbaSHans Petter Selasky bool linux_cpu_has_clflush;
215503219fbaSHans Petter Selasky #endif
215603219fbaSHans Petter Selasky 
21570c510167SHans Petter Selasky static void
21588d59ecb2SHans Petter Selasky linux_compat_init(void *arg)
21598d59ecb2SHans Petter Selasky {
21608d59ecb2SHans Petter Selasky 	struct sysctl_oid *rootoid;
21618d59ecb2SHans Petter Selasky 	int i;
21628d59ecb2SHans Petter Selasky 
216303219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
216403219fbaSHans Petter Selasky 	linux_cpu_has_clflush = (cpu_feature & CPUID_CLFSH);
216503219fbaSHans Petter Selasky #endif
21661ea4c857SHans Petter Selasky 	rw_init(&linux_vma_lock, "lkpi-vma-lock");
2167e10c4cc0SHans Petter Selasky 
21688d59ecb2SHans Petter Selasky 	rootoid = SYSCTL_ADD_ROOT_NODE(NULL,
21698d59ecb2SHans Petter Selasky 	    OID_AUTO, "sys", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "sys");
217006204f8eSHans Petter Selasky 	kobject_init(&linux_class_root, &linux_class_ktype);
217106204f8eSHans Petter Selasky 	kobject_set_name(&linux_class_root, "class");
217206204f8eSHans Petter Selasky 	linux_class_root.oidp = SYSCTL_ADD_NODE(NULL, SYSCTL_CHILDREN(rootoid),
21738d59ecb2SHans Petter Selasky 	    OID_AUTO, "class", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "class");
217406204f8eSHans Petter Selasky 	kobject_init(&linux_root_device.kobj, &linux_dev_ktype);
217506204f8eSHans Petter Selasky 	kobject_set_name(&linux_root_device.kobj, "device");
217606204f8eSHans Petter Selasky 	linux_root_device.kobj.oidp = SYSCTL_ADD_NODE(NULL,
21778d59ecb2SHans Petter Selasky 	    SYSCTL_CHILDREN(rootoid), OID_AUTO, "device", CTLFLAG_RD, NULL,
21788d59ecb2SHans Petter Selasky 	    "device");
217906204f8eSHans Petter Selasky 	linux_root_device.bsddev = root_bus;
218006204f8eSHans Petter Selasky 	linux_class_misc.name = "misc";
218106204f8eSHans Petter Selasky 	class_register(&linux_class_misc);
21828d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_drivers);
21838d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_devices);
21848d59ecb2SHans Petter Selasky 	spin_lock_init(&pci_lock);
21858d59ecb2SHans Petter Selasky 	mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF);
21868d59ecb2SHans Petter Selasky 	for (i = 0; i < VMMAP_HASH_SIZE; i++)
21878d59ecb2SHans Petter Selasky 		LIST_INIT(&vmmaphead[i]);
21888d59ecb2SHans Petter Selasky }
21898d59ecb2SHans Petter Selasky SYSINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_init, NULL);
21908d59ecb2SHans Petter Selasky 
21918d59ecb2SHans Petter Selasky static void
21928d59ecb2SHans Petter Selasky linux_compat_uninit(void *arg)
21938d59ecb2SHans Petter Selasky {
219406204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_root);
219506204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_root_device.kobj);
219606204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_misc.kobj);
21971ea4c857SHans Petter Selasky 
219847d8a7d4SMark Johnston 	mtx_destroy(&vmmaplock);
219947d8a7d4SMark Johnston 	spin_lock_destroy(&pci_lock);
22001ea4c857SHans Petter Selasky 	rw_destroy(&linux_vma_lock);
22018d59ecb2SHans Petter Selasky }
22028d59ecb2SHans Petter Selasky SYSUNINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_uninit, NULL);
2203f727a767SHans Petter Selasky 
2204f727a767SHans Petter Selasky /*
2205f727a767SHans Petter Selasky  * NOTE: Linux frequently uses "unsigned long" for pointer to integer
2206f727a767SHans Petter Selasky  * conversion and vice versa, where in FreeBSD "uintptr_t" would be
2207f727a767SHans Petter Selasky  * used. Assert these types have the same size, else some parts of the
2208f727a767SHans Petter Selasky  * LinuxKPI may not work like expected:
2209f727a767SHans Petter Selasky  */
2210f727a767SHans Petter Selasky CTASSERT(sizeof(unsigned long) == sizeof(uintptr_t));
2211