xref: /freebsd/sys/compat/linuxkpi/common/src/linux_compat.c (revision 6e3e654490c36939c6fbcebfa2c8512fe8120d5f)
18d59ecb2SHans Petter Selasky /*-
28d59ecb2SHans Petter Selasky  * Copyright (c) 2010 Isilon Systems, Inc.
38d59ecb2SHans Petter Selasky  * Copyright (c) 2010 iX Systems, Inc.
48d59ecb2SHans Petter Selasky  * Copyright (c) 2010 Panasas, Inc.
5e10c4cc0SHans Petter Selasky  * Copyright (c) 2013-2016 Mellanox Technologies, Ltd.
68d59ecb2SHans Petter Selasky  * All rights reserved.
78d59ecb2SHans Petter Selasky  *
88d59ecb2SHans Petter Selasky  * Redistribution and use in source and binary forms, with or without
98d59ecb2SHans Petter Selasky  * modification, are permitted provided that the following conditions
108d59ecb2SHans Petter Selasky  * are met:
118d59ecb2SHans Petter Selasky  * 1. Redistributions of source code must retain the above copyright
128d59ecb2SHans Petter Selasky  *    notice unmodified, this list of conditions, and the following
138d59ecb2SHans Petter Selasky  *    disclaimer.
148d59ecb2SHans Petter Selasky  * 2. Redistributions in binary form must reproduce the above copyright
158d59ecb2SHans Petter Selasky  *    notice, this list of conditions and the following disclaimer in the
168d59ecb2SHans Petter Selasky  *    documentation and/or other materials provided with the distribution.
178d59ecb2SHans Petter Selasky  *
188d59ecb2SHans Petter Selasky  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
198d59ecb2SHans Petter Selasky  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
208d59ecb2SHans Petter Selasky  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
218d59ecb2SHans Petter Selasky  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
228d59ecb2SHans Petter Selasky  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
238d59ecb2SHans Petter Selasky  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
248d59ecb2SHans Petter Selasky  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
258d59ecb2SHans Petter Selasky  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
268d59ecb2SHans Petter Selasky  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
278d59ecb2SHans Petter Selasky  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
288d59ecb2SHans Petter Selasky  */
298d59ecb2SHans Petter Selasky 
308d59ecb2SHans Petter Selasky #include <sys/cdefs.h>
318d59ecb2SHans Petter Selasky __FBSDID("$FreeBSD$");
328d59ecb2SHans Petter Selasky 
338d59ecb2SHans Petter Selasky #include <sys/param.h>
348d59ecb2SHans Petter Selasky #include <sys/systm.h>
358d59ecb2SHans Petter Selasky #include <sys/malloc.h>
368d59ecb2SHans Petter Selasky #include <sys/kernel.h>
378d59ecb2SHans Petter Selasky #include <sys/sysctl.h>
388d59ecb2SHans Petter Selasky #include <sys/proc.h>
398d59ecb2SHans Petter Selasky #include <sys/sglist.h>
408d59ecb2SHans Petter Selasky #include <sys/sleepqueue.h>
418d59ecb2SHans Petter Selasky #include <sys/lock.h>
428d59ecb2SHans Petter Selasky #include <sys/mutex.h>
438d59ecb2SHans Petter Selasky #include <sys/bus.h>
448d59ecb2SHans Petter Selasky #include <sys/fcntl.h>
458d59ecb2SHans Petter Selasky #include <sys/file.h>
468d59ecb2SHans Petter Selasky #include <sys/filio.h>
478d59ecb2SHans Petter Selasky #include <sys/rwlock.h>
488d59ecb2SHans Petter Selasky 
498d59ecb2SHans Petter Selasky #include <vm/vm.h>
508d59ecb2SHans Petter Selasky #include <vm/pmap.h>
518d59ecb2SHans Petter Selasky 
528d59ecb2SHans Petter Selasky #include <machine/stdarg.h>
538d59ecb2SHans Petter Selasky 
5403219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
5503219fbaSHans Petter Selasky #include <machine/md_var.h>
5603219fbaSHans Petter Selasky #endif
5703219fbaSHans Petter Selasky 
588d59ecb2SHans Petter Selasky #include <linux/kobject.h>
598d59ecb2SHans Petter Selasky #include <linux/device.h>
608d59ecb2SHans Petter Selasky #include <linux/slab.h>
618d59ecb2SHans Petter Selasky #include <linux/module.h>
621d9b99e5SHans Petter Selasky #include <linux/moduleparam.h>
638d59ecb2SHans Petter Selasky #include <linux/cdev.h>
648d59ecb2SHans Petter Selasky #include <linux/file.h>
658d59ecb2SHans Petter Selasky #include <linux/sysfs.h>
668d59ecb2SHans Petter Selasky #include <linux/mm.h>
678d59ecb2SHans Petter Selasky #include <linux/io.h>
688d59ecb2SHans Petter Selasky #include <linux/vmalloc.h>
698d59ecb2SHans Petter Selasky #include <linux/netdevice.h>
708d59ecb2SHans Petter Selasky #include <linux/timer.h>
710c510167SHans Petter Selasky #include <linux/interrupt.h>
723a8bec33SHans Petter Selasky #include <linux/uaccess.h>
7303219fbaSHans Petter Selasky #include <linux/kernel.h>
74aad02fb4SHans Petter Selasky #include <linux/list.h>
753ce12630SHans Petter Selasky #include <linux/compat.h>
76*6e3e6544SHans Petter Selasky #include <linux/poll.h>
778d59ecb2SHans Petter Selasky 
788d59ecb2SHans Petter Selasky #include <vm/vm_pager.h>
798d59ecb2SHans Petter Selasky 
801d9b99e5SHans Petter Selasky SYSCTL_NODE(_compat, OID_AUTO, linuxkpi, CTLFLAG_RW, 0, "LinuxKPI parameters");
811d9b99e5SHans Petter Selasky 
828d59ecb2SHans Petter Selasky MALLOC_DEFINE(M_KMALLOC, "linux", "Linux kmalloc compat");
838d59ecb2SHans Petter Selasky 
848d59ecb2SHans Petter Selasky #include <linux/rbtree.h>
858d59ecb2SHans Petter Selasky /* Undo Linux compat changes. */
868d59ecb2SHans Petter Selasky #undef RB_ROOT
878d59ecb2SHans Petter Selasky #undef file
888d59ecb2SHans Petter Selasky #undef cdev
898d59ecb2SHans Petter Selasky #define	RB_ROOT(head)	(head)->rbh_root
908d59ecb2SHans Petter Selasky 
9106204f8eSHans Petter Selasky struct kobject linux_class_root;
9206204f8eSHans Petter Selasky struct device linux_root_device;
9306204f8eSHans Petter Selasky struct class linux_class_misc;
948d59ecb2SHans Petter Selasky struct list_head pci_drivers;
958d59ecb2SHans Petter Selasky struct list_head pci_devices;
968d59ecb2SHans Petter Selasky spinlock_t pci_lock;
978d59ecb2SHans Petter Selasky 
988d59ecb2SHans Petter Selasky unsigned long linux_timer_hz_mask;
998d59ecb2SHans Petter Selasky 
1008d59ecb2SHans Petter Selasky int
1018d59ecb2SHans Petter Selasky panic_cmp(struct rb_node *one, struct rb_node *two)
1028d59ecb2SHans Petter Selasky {
1038d59ecb2SHans Petter Selasky 	panic("no cmp");
1048d59ecb2SHans Petter Selasky }
1058d59ecb2SHans Petter Selasky 
1068d59ecb2SHans Petter Selasky RB_GENERATE(linux_root, rb_node, __entry, panic_cmp);
1078d59ecb2SHans Petter Selasky 
10826019405SHans Petter Selasky int
10926019405SHans Petter Selasky kobject_set_name_vargs(struct kobject *kobj, const char *fmt, va_list args)
11026019405SHans Petter Selasky {
11126019405SHans Petter Selasky 	va_list tmp_va;
11226019405SHans Petter Selasky 	int len;
11326019405SHans Petter Selasky 	char *old;
11426019405SHans Petter Selasky 	char *name;
11526019405SHans Petter Selasky 	char dummy;
11626019405SHans Petter Selasky 
11726019405SHans Petter Selasky 	old = kobj->name;
11826019405SHans Petter Selasky 
11926019405SHans Petter Selasky 	if (old && fmt == NULL)
12026019405SHans Petter Selasky 		return (0);
12126019405SHans Petter Selasky 
12226019405SHans Petter Selasky 	/* compute length of string */
12326019405SHans Petter Selasky 	va_copy(tmp_va, args);
12426019405SHans Petter Selasky 	len = vsnprintf(&dummy, 0, fmt, tmp_va);
12526019405SHans Petter Selasky 	va_end(tmp_va);
12626019405SHans Petter Selasky 
12726019405SHans Petter Selasky 	/* account for zero termination */
12826019405SHans Petter Selasky 	len++;
12926019405SHans Petter Selasky 
13026019405SHans Petter Selasky 	/* check for error */
13126019405SHans Petter Selasky 	if (len < 1)
13226019405SHans Petter Selasky 		return (-EINVAL);
13326019405SHans Petter Selasky 
13426019405SHans Petter Selasky 	/* allocate memory for string */
13526019405SHans Petter Selasky 	name = kzalloc(len, GFP_KERNEL);
13626019405SHans Petter Selasky 	if (name == NULL)
13726019405SHans Petter Selasky 		return (-ENOMEM);
13826019405SHans Petter Selasky 	vsnprintf(name, len, fmt, args);
13926019405SHans Petter Selasky 	kobj->name = name;
14026019405SHans Petter Selasky 
14126019405SHans Petter Selasky 	/* free old string */
14226019405SHans Petter Selasky 	kfree(old);
14326019405SHans Petter Selasky 
14426019405SHans Petter Selasky 	/* filter new string */
14526019405SHans Petter Selasky 	for (; *name != '\0'; name++)
14626019405SHans Petter Selasky 		if (*name == '/')
14726019405SHans Petter Selasky 			*name = '!';
14826019405SHans Petter Selasky 	return (0);
14926019405SHans Petter Selasky }
15026019405SHans Petter Selasky 
1518d59ecb2SHans Petter Selasky int
1528d59ecb2SHans Petter Selasky kobject_set_name(struct kobject *kobj, const char *fmt, ...)
1538d59ecb2SHans Petter Selasky {
1548d59ecb2SHans Petter Selasky 	va_list args;
1558d59ecb2SHans Petter Selasky 	int error;
1568d59ecb2SHans Petter Selasky 
1578d59ecb2SHans Petter Selasky 	va_start(args, fmt);
1588d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
1598d59ecb2SHans Petter Selasky 	va_end(args);
1608d59ecb2SHans Petter Selasky 
1618d59ecb2SHans Petter Selasky 	return (error);
1628d59ecb2SHans Petter Selasky }
1638d59ecb2SHans Petter Selasky 
16406204f8eSHans Petter Selasky static int
1658d59ecb2SHans Petter Selasky kobject_add_complete(struct kobject *kobj, struct kobject *parent)
1668d59ecb2SHans Petter Selasky {
16706204f8eSHans Petter Selasky 	const struct kobj_type *t;
1688d59ecb2SHans Petter Selasky 	int error;
1698d59ecb2SHans Petter Selasky 
170337cb9f0SHans Petter Selasky 	kobj->parent = parent;
1718d59ecb2SHans Petter Selasky 	error = sysfs_create_dir(kobj);
1728d59ecb2SHans Petter Selasky 	if (error == 0 && kobj->ktype && kobj->ktype->default_attrs) {
1738d59ecb2SHans Petter Selasky 		struct attribute **attr;
1748d59ecb2SHans Petter Selasky 		t = kobj->ktype;
1758d59ecb2SHans Petter Selasky 
1768d59ecb2SHans Petter Selasky 		for (attr = t->default_attrs; *attr != NULL; attr++) {
1778d59ecb2SHans Petter Selasky 			error = sysfs_create_file(kobj, *attr);
1788d59ecb2SHans Petter Selasky 			if (error)
1798d59ecb2SHans Petter Selasky 				break;
1808d59ecb2SHans Petter Selasky 		}
1818d59ecb2SHans Petter Selasky 		if (error)
1828d59ecb2SHans Petter Selasky 			sysfs_remove_dir(kobj);
1838d59ecb2SHans Petter Selasky 
1848d59ecb2SHans Petter Selasky 	}
1858d59ecb2SHans Petter Selasky 	return (error);
1868d59ecb2SHans Petter Selasky }
1878d59ecb2SHans Petter Selasky 
1888d59ecb2SHans Petter Selasky int
1898d59ecb2SHans Petter Selasky kobject_add(struct kobject *kobj, struct kobject *parent, const char *fmt, ...)
1908d59ecb2SHans Petter Selasky {
1918d59ecb2SHans Petter Selasky 	va_list args;
1928d59ecb2SHans Petter Selasky 	int error;
1938d59ecb2SHans Petter Selasky 
1948d59ecb2SHans Petter Selasky 	va_start(args, fmt);
1958d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
1968d59ecb2SHans Petter Selasky 	va_end(args);
1978d59ecb2SHans Petter Selasky 	if (error)
1988d59ecb2SHans Petter Selasky 		return (error);
1998d59ecb2SHans Petter Selasky 
2008d59ecb2SHans Petter Selasky 	return kobject_add_complete(kobj, parent);
2018d59ecb2SHans Petter Selasky }
2028d59ecb2SHans Petter Selasky 
2038d59ecb2SHans Petter Selasky void
20406204f8eSHans Petter Selasky linux_kobject_release(struct kref *kref)
2058d59ecb2SHans Petter Selasky {
2068d59ecb2SHans Petter Selasky 	struct kobject *kobj;
2078d59ecb2SHans Petter Selasky 	char *name;
2088d59ecb2SHans Petter Selasky 
2098d59ecb2SHans Petter Selasky 	kobj = container_of(kref, struct kobject, kref);
2108d59ecb2SHans Petter Selasky 	sysfs_remove_dir(kobj);
2118d59ecb2SHans Petter Selasky 	name = kobj->name;
2128d59ecb2SHans Petter Selasky 	if (kobj->ktype && kobj->ktype->release)
2138d59ecb2SHans Petter Selasky 		kobj->ktype->release(kobj);
2148d59ecb2SHans Petter Selasky 	kfree(name);
2158d59ecb2SHans Petter Selasky }
2168d59ecb2SHans Petter Selasky 
2178d59ecb2SHans Petter Selasky static void
21806204f8eSHans Petter Selasky linux_kobject_kfree(struct kobject *kobj)
2198d59ecb2SHans Petter Selasky {
2208d59ecb2SHans Petter Selasky 	kfree(kobj);
2218d59ecb2SHans Petter Selasky }
2228d59ecb2SHans Petter Selasky 
2238d59ecb2SHans Petter Selasky static void
22406204f8eSHans Petter Selasky linux_kobject_kfree_name(struct kobject *kobj)
2258d59ecb2SHans Petter Selasky {
2268d59ecb2SHans Petter Selasky 	if (kobj) {
2278d59ecb2SHans Petter Selasky 		kfree(kobj->name);
2288d59ecb2SHans Petter Selasky 	}
2298d59ecb2SHans Petter Selasky }
2308d59ecb2SHans Petter Selasky 
23106204f8eSHans Petter Selasky const struct kobj_type linux_kfree_type = {
23206204f8eSHans Petter Selasky 	.release = linux_kobject_kfree
23306204f8eSHans Petter Selasky };
2348d59ecb2SHans Petter Selasky 
2358d59ecb2SHans Petter Selasky static void
23606204f8eSHans Petter Selasky linux_device_release(struct device *dev)
2378d59ecb2SHans Petter Selasky {
23806204f8eSHans Petter Selasky 	pr_debug("linux_device_release: %s\n", dev_name(dev));
2398d59ecb2SHans Petter Selasky 	kfree(dev);
2408d59ecb2SHans Petter Selasky }
2418d59ecb2SHans Petter Selasky 
24206204f8eSHans Petter Selasky static ssize_t
24306204f8eSHans Petter Selasky linux_class_show(struct kobject *kobj, struct attribute *attr, char *buf)
24406204f8eSHans Petter Selasky {
24506204f8eSHans Petter Selasky 	struct class_attribute *dattr;
24606204f8eSHans Petter Selasky 	ssize_t error;
24706204f8eSHans Petter Selasky 
24806204f8eSHans Petter Selasky 	dattr = container_of(attr, struct class_attribute, attr);
24906204f8eSHans Petter Selasky 	error = -EIO;
25006204f8eSHans Petter Selasky 	if (dattr->show)
25106204f8eSHans Petter Selasky 		error = dattr->show(container_of(kobj, struct class, kobj),
25206204f8eSHans Petter Selasky 		    dattr, buf);
25306204f8eSHans Petter Selasky 	return (error);
25406204f8eSHans Petter Selasky }
25506204f8eSHans Petter Selasky 
25606204f8eSHans Petter Selasky static ssize_t
25706204f8eSHans Petter Selasky linux_class_store(struct kobject *kobj, struct attribute *attr, const char *buf,
25806204f8eSHans Petter Selasky     size_t count)
25906204f8eSHans Petter Selasky {
26006204f8eSHans Petter Selasky 	struct class_attribute *dattr;
26106204f8eSHans Petter Selasky 	ssize_t error;
26206204f8eSHans Petter Selasky 
26306204f8eSHans Petter Selasky 	dattr = container_of(attr, struct class_attribute, attr);
26406204f8eSHans Petter Selasky 	error = -EIO;
26506204f8eSHans Petter Selasky 	if (dattr->store)
26606204f8eSHans Petter Selasky 		error = dattr->store(container_of(kobj, struct class, kobj),
26706204f8eSHans Petter Selasky 		    dattr, buf, count);
26806204f8eSHans Petter Selasky 	return (error);
26906204f8eSHans Petter Selasky }
27006204f8eSHans Petter Selasky 
27106204f8eSHans Petter Selasky static void
27206204f8eSHans Petter Selasky linux_class_release(struct kobject *kobj)
27306204f8eSHans Petter Selasky {
27406204f8eSHans Petter Selasky 	struct class *class;
27506204f8eSHans Petter Selasky 
27606204f8eSHans Petter Selasky 	class = container_of(kobj, struct class, kobj);
27706204f8eSHans Petter Selasky 	if (class->class_release)
27806204f8eSHans Petter Selasky 		class->class_release(class);
27906204f8eSHans Petter Selasky }
28006204f8eSHans Petter Selasky 
28106204f8eSHans Petter Selasky static const struct sysfs_ops linux_class_sysfs = {
28206204f8eSHans Petter Selasky 	.show  = linux_class_show,
28306204f8eSHans Petter Selasky 	.store = linux_class_store,
28406204f8eSHans Petter Selasky };
28506204f8eSHans Petter Selasky 
28606204f8eSHans Petter Selasky const struct kobj_type linux_class_ktype = {
28706204f8eSHans Petter Selasky 	.release = linux_class_release,
28806204f8eSHans Petter Selasky 	.sysfs_ops = &linux_class_sysfs
28906204f8eSHans Petter Selasky };
29006204f8eSHans Petter Selasky 
29106204f8eSHans Petter Selasky static void
29206204f8eSHans Petter Selasky linux_dev_release(struct kobject *kobj)
29306204f8eSHans Petter Selasky {
29406204f8eSHans Petter Selasky 	struct device *dev;
29506204f8eSHans Petter Selasky 
29606204f8eSHans Petter Selasky 	dev = container_of(kobj, struct device, kobj);
29706204f8eSHans Petter Selasky 	/* This is the precedence defined by linux. */
29806204f8eSHans Petter Selasky 	if (dev->release)
29906204f8eSHans Petter Selasky 		dev->release(dev);
30006204f8eSHans Petter Selasky 	else if (dev->class && dev->class->dev_release)
30106204f8eSHans Petter Selasky 		dev->class->dev_release(dev);
30206204f8eSHans Petter Selasky }
30306204f8eSHans Petter Selasky 
30406204f8eSHans Petter Selasky static ssize_t
30506204f8eSHans Petter Selasky linux_dev_show(struct kobject *kobj, struct attribute *attr, char *buf)
30606204f8eSHans Petter Selasky {
30706204f8eSHans Petter Selasky 	struct device_attribute *dattr;
30806204f8eSHans Petter Selasky 	ssize_t error;
30906204f8eSHans Petter Selasky 
31006204f8eSHans Petter Selasky 	dattr = container_of(attr, struct device_attribute, attr);
31106204f8eSHans Petter Selasky 	error = -EIO;
31206204f8eSHans Petter Selasky 	if (dattr->show)
31306204f8eSHans Petter Selasky 		error = dattr->show(container_of(kobj, struct device, kobj),
31406204f8eSHans Petter Selasky 		    dattr, buf);
31506204f8eSHans Petter Selasky 	return (error);
31606204f8eSHans Petter Selasky }
31706204f8eSHans Petter Selasky 
31806204f8eSHans Petter Selasky static ssize_t
31906204f8eSHans Petter Selasky linux_dev_store(struct kobject *kobj, struct attribute *attr, const char *buf,
32006204f8eSHans Petter Selasky     size_t count)
32106204f8eSHans Petter Selasky {
32206204f8eSHans Petter Selasky 	struct device_attribute *dattr;
32306204f8eSHans Petter Selasky 	ssize_t error;
32406204f8eSHans Petter Selasky 
32506204f8eSHans Petter Selasky 	dattr = container_of(attr, struct device_attribute, attr);
32606204f8eSHans Petter Selasky 	error = -EIO;
32706204f8eSHans Petter Selasky 	if (dattr->store)
32806204f8eSHans Petter Selasky 		error = dattr->store(container_of(kobj, struct device, kobj),
32906204f8eSHans Petter Selasky 		    dattr, buf, count);
33006204f8eSHans Petter Selasky 	return (error);
33106204f8eSHans Petter Selasky }
33206204f8eSHans Petter Selasky 
33306204f8eSHans Petter Selasky static const struct sysfs_ops linux_dev_sysfs = {
33406204f8eSHans Petter Selasky 	.show  = linux_dev_show,
33506204f8eSHans Petter Selasky 	.store = linux_dev_store,
33606204f8eSHans Petter Selasky };
33706204f8eSHans Petter Selasky 
33806204f8eSHans Petter Selasky const struct kobj_type linux_dev_ktype = {
33906204f8eSHans Petter Selasky 	.release = linux_dev_release,
34006204f8eSHans Petter Selasky 	.sysfs_ops = &linux_dev_sysfs
34106204f8eSHans Petter Selasky };
34206204f8eSHans Petter Selasky 
3438d59ecb2SHans Petter Selasky struct device *
3448d59ecb2SHans Petter Selasky device_create(struct class *class, struct device *parent, dev_t devt,
3458d59ecb2SHans Petter Selasky     void *drvdata, const char *fmt, ...)
3468d59ecb2SHans Petter Selasky {
3478d59ecb2SHans Petter Selasky 	struct device *dev;
3488d59ecb2SHans Petter Selasky 	va_list args;
3498d59ecb2SHans Petter Selasky 
3508d59ecb2SHans Petter Selasky 	dev = kzalloc(sizeof(*dev), M_WAITOK);
3518d59ecb2SHans Petter Selasky 	dev->parent = parent;
3528d59ecb2SHans Petter Selasky 	dev->class = class;
3538d59ecb2SHans Petter Selasky 	dev->devt = devt;
3548d59ecb2SHans Petter Selasky 	dev->driver_data = drvdata;
35506204f8eSHans Petter Selasky 	dev->release = linux_device_release;
3568d59ecb2SHans Petter Selasky 	va_start(args, fmt);
3578d59ecb2SHans Petter Selasky 	kobject_set_name_vargs(&dev->kobj, fmt, args);
3588d59ecb2SHans Petter Selasky 	va_end(args);
3598d59ecb2SHans Petter Selasky 	device_register(dev);
3608d59ecb2SHans Petter Selasky 
3618d59ecb2SHans Petter Selasky 	return (dev);
3628d59ecb2SHans Petter Selasky }
3638d59ecb2SHans Petter Selasky 
3648d59ecb2SHans Petter Selasky int
36506204f8eSHans Petter Selasky kobject_init_and_add(struct kobject *kobj, const struct kobj_type *ktype,
3668d59ecb2SHans Petter Selasky     struct kobject *parent, const char *fmt, ...)
3678d59ecb2SHans Petter Selasky {
3688d59ecb2SHans Petter Selasky 	va_list args;
3698d59ecb2SHans Petter Selasky 	int error;
3708d59ecb2SHans Petter Selasky 
3718d59ecb2SHans Petter Selasky 	kobject_init(kobj, ktype);
3728d59ecb2SHans Petter Selasky 	kobj->ktype = ktype;
3738d59ecb2SHans Petter Selasky 	kobj->parent = parent;
3748d59ecb2SHans Petter Selasky 	kobj->name = NULL;
3758d59ecb2SHans Petter Selasky 
3768d59ecb2SHans Petter Selasky 	va_start(args, fmt);
3778d59ecb2SHans Petter Selasky 	error = kobject_set_name_vargs(kobj, fmt, args);
3788d59ecb2SHans Petter Selasky 	va_end(args);
3798d59ecb2SHans Petter Selasky 	if (error)
3808d59ecb2SHans Petter Selasky 		return (error);
3818d59ecb2SHans Petter Selasky 	return kobject_add_complete(kobj, parent);
3828d59ecb2SHans Petter Selasky }
3838d59ecb2SHans Petter Selasky 
384464d20bcSHans Petter Selasky static void
3858d59ecb2SHans Petter Selasky linux_file_dtor(void *cdp)
3868d59ecb2SHans Petter Selasky {
3878d59ecb2SHans Petter Selasky 	struct linux_file *filp;
3888d59ecb2SHans Petter Selasky 
3891e3db1deSHans Petter Selasky 	linux_set_current(curthread);
3908d59ecb2SHans Petter Selasky 	filp = cdp;
3918d59ecb2SHans Petter Selasky 	filp->f_op->release(filp->f_vnode, filp);
3928d59ecb2SHans Petter Selasky 	vdrop(filp->f_vnode);
3938d59ecb2SHans Petter Selasky 	kfree(filp);
3948d59ecb2SHans Petter Selasky }
3958d59ecb2SHans Petter Selasky 
3968d59ecb2SHans Petter Selasky static int
3978d59ecb2SHans Petter Selasky linux_dev_open(struct cdev *dev, int oflags, int devtype, struct thread *td)
3988d59ecb2SHans Petter Selasky {
3998d59ecb2SHans Petter Selasky 	struct linux_cdev *ldev;
4008d59ecb2SHans Petter Selasky 	struct linux_file *filp;
4018d59ecb2SHans Petter Selasky 	struct file *file;
4028d59ecb2SHans Petter Selasky 	int error;
4038d59ecb2SHans Petter Selasky 
404464d20bcSHans Petter Selasky 	file = td->td_fpop;
4058d59ecb2SHans Petter Selasky 	ldev = dev->si_drv1;
4068d59ecb2SHans Petter Selasky 	if (ldev == NULL)
4078d59ecb2SHans Petter Selasky 		return (ENODEV);
4088d59ecb2SHans Petter Selasky 	filp = kzalloc(sizeof(*filp), GFP_KERNEL);
4098d59ecb2SHans Petter Selasky 	filp->f_dentry = &filp->f_dentry_store;
4108d59ecb2SHans Petter Selasky 	filp->f_op = ldev->ops;
4118d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
4128d59ecb2SHans Petter Selasky 	vhold(file->f_vnode);
4138d59ecb2SHans Petter Selasky 	filp->f_vnode = file->f_vnode;
4141e3db1deSHans Petter Selasky 	linux_set_current(td);
4158d59ecb2SHans Petter Selasky 	if (filp->f_op->open) {
4168d59ecb2SHans Petter Selasky 		error = -filp->f_op->open(file->f_vnode, filp);
4178d59ecb2SHans Petter Selasky 		if (error) {
4188d59ecb2SHans Petter Selasky 			kfree(filp);
419464d20bcSHans Petter Selasky 			goto done;
4208d59ecb2SHans Petter Selasky 		}
4218d59ecb2SHans Petter Selasky 	}
4228d59ecb2SHans Petter Selasky 	error = devfs_set_cdevpriv(filp, linux_file_dtor);
4238d59ecb2SHans Petter Selasky 	if (error) {
4248d59ecb2SHans Petter Selasky 		filp->f_op->release(file->f_vnode, filp);
4258d59ecb2SHans Petter Selasky 		kfree(filp);
4268d59ecb2SHans Petter Selasky 	}
427464d20bcSHans Petter Selasky done:
428464d20bcSHans Petter Selasky 	return (error);
4298d59ecb2SHans Petter Selasky }
4308d59ecb2SHans Petter Selasky 
4318d59ecb2SHans Petter Selasky static int
4328d59ecb2SHans Petter Selasky linux_dev_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
4338d59ecb2SHans Petter Selasky {
4348d59ecb2SHans Petter Selasky 	struct linux_file *filp;
4358d59ecb2SHans Petter Selasky 	struct file *file;
4368d59ecb2SHans Petter Selasky 	int error;
4378d59ecb2SHans Petter Selasky 
438464d20bcSHans Petter Selasky 	file = td->td_fpop;
439*6e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
4408d59ecb2SHans Petter Selasky 		return (0);
4418d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
4428d59ecb2SHans Petter Selasky 		return (error);
4438d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
4448d59ecb2SHans Petter Selasky         devfs_clear_cdevpriv();
4458d59ecb2SHans Petter Selasky 
4468d59ecb2SHans Petter Selasky 
4478d59ecb2SHans Petter Selasky 	return (0);
4488d59ecb2SHans Petter Selasky }
4498d59ecb2SHans Petter Selasky 
4503a8bec33SHans Petter Selasky #define	LINUX_IOCTL_MIN_PTR 0x10000UL
4513a8bec33SHans Petter Selasky #define	LINUX_IOCTL_MAX_PTR (LINUX_IOCTL_MIN_PTR + IOCPARM_MAX)
4523a8bec33SHans Petter Selasky 
4533a8bec33SHans Petter Selasky static inline int
4543a8bec33SHans Petter Selasky linux_remap_address(void **uaddr, size_t len)
4553a8bec33SHans Petter Selasky {
4563a8bec33SHans Petter Selasky 	uintptr_t uaddr_val = (uintptr_t)(*uaddr);
4573a8bec33SHans Petter Selasky 
4583a8bec33SHans Petter Selasky 	if (unlikely(uaddr_val >= LINUX_IOCTL_MIN_PTR &&
4593a8bec33SHans Petter Selasky 	    uaddr_val < LINUX_IOCTL_MAX_PTR)) {
4603a8bec33SHans Petter Selasky 		struct task_struct *pts = current;
4613a8bec33SHans Petter Selasky 		if (pts == NULL) {
4623a8bec33SHans Petter Selasky 			*uaddr = NULL;
4633a8bec33SHans Petter Selasky 			return (1);
4643a8bec33SHans Petter Selasky 		}
4653a8bec33SHans Petter Selasky 
4663a8bec33SHans Petter Selasky 		/* compute data offset */
4673a8bec33SHans Petter Selasky 		uaddr_val -= LINUX_IOCTL_MIN_PTR;
4683a8bec33SHans Petter Selasky 
4693a8bec33SHans Petter Selasky 		/* check that length is within bounds */
4703a8bec33SHans Petter Selasky 		if ((len > IOCPARM_MAX) ||
4713a8bec33SHans Petter Selasky 		    (uaddr_val + len) > pts->bsd_ioctl_len) {
4723a8bec33SHans Petter Selasky 			*uaddr = NULL;
4733a8bec33SHans Petter Selasky 			return (1);
4743a8bec33SHans Petter Selasky 		}
4753a8bec33SHans Petter Selasky 
4763a8bec33SHans Petter Selasky 		/* re-add kernel buffer address */
4773a8bec33SHans Petter Selasky 		uaddr_val += (uintptr_t)pts->bsd_ioctl_data;
4783a8bec33SHans Petter Selasky 
4793a8bec33SHans Petter Selasky 		/* update address location */
4803a8bec33SHans Petter Selasky 		*uaddr = (void *)uaddr_val;
4813a8bec33SHans Petter Selasky 		return (1);
4823a8bec33SHans Petter Selasky 	}
4833a8bec33SHans Petter Selasky 	return (0);
4843a8bec33SHans Petter Selasky }
4853a8bec33SHans Petter Selasky 
4863a8bec33SHans Petter Selasky int
4873a8bec33SHans Petter Selasky linux_copyin(const void *uaddr, void *kaddr, size_t len)
4883a8bec33SHans Petter Selasky {
4893a8bec33SHans Petter Selasky 	if (linux_remap_address(__DECONST(void **, &uaddr), len)) {
4903a8bec33SHans Petter Selasky 		if (uaddr == NULL)
4913a8bec33SHans Petter Selasky 			return (-EFAULT);
4923a8bec33SHans Petter Selasky 		memcpy(kaddr, uaddr, len);
4933a8bec33SHans Petter Selasky 		return (0);
4943a8bec33SHans Petter Selasky 	}
4953a8bec33SHans Petter Selasky 	return (-copyin(uaddr, kaddr, len));
4963a8bec33SHans Petter Selasky }
4973a8bec33SHans Petter Selasky 
4983a8bec33SHans Petter Selasky int
4993a8bec33SHans Petter Selasky linux_copyout(const void *kaddr, void *uaddr, size_t len)
5003a8bec33SHans Petter Selasky {
5013a8bec33SHans Petter Selasky 	if (linux_remap_address(&uaddr, len)) {
5023a8bec33SHans Petter Selasky 		if (uaddr == NULL)
5033a8bec33SHans Petter Selasky 			return (-EFAULT);
5043a8bec33SHans Petter Selasky 		memcpy(uaddr, kaddr, len);
5053a8bec33SHans Petter Selasky 		return (0);
5063a8bec33SHans Petter Selasky 	}
5073a8bec33SHans Petter Selasky 	return (-copyout(kaddr, uaddr, len));
5083a8bec33SHans Petter Selasky }
5093a8bec33SHans Petter Selasky 
5100e05589bSHans Petter Selasky size_t
5110e05589bSHans Petter Selasky linux_clear_user(void *_uaddr, size_t _len)
5120e05589bSHans Petter Selasky {
5130e05589bSHans Petter Selasky 	uint8_t *uaddr = _uaddr;
5140e05589bSHans Petter Selasky 	size_t len = _len;
5150e05589bSHans Petter Selasky 
5160e05589bSHans Petter Selasky 	/* make sure uaddr is aligned before going into the fast loop */
5170e05589bSHans Petter Selasky 	while (((uintptr_t)uaddr & 7) != 0 && len > 7) {
5180e05589bSHans Petter Selasky 		if (subyte(uaddr, 0))
5190e05589bSHans Petter Selasky 			return (_len);
5200e05589bSHans Petter Selasky 		uaddr++;
5210e05589bSHans Petter Selasky 		len--;
5220e05589bSHans Petter Selasky 	}
5230e05589bSHans Petter Selasky 
5240e05589bSHans Petter Selasky 	/* zero 8 bytes at a time */
5250e05589bSHans Petter Selasky 	while (len > 7) {
5263803a97fSHans Petter Selasky #ifdef __LP64__
5270e05589bSHans Petter Selasky 		if (suword64(uaddr, 0))
5280e05589bSHans Petter Selasky 			return (_len);
5293803a97fSHans Petter Selasky #else
5303803a97fSHans Petter Selasky 		if (suword32(uaddr, 0))
5313803a97fSHans Petter Selasky 			return (_len);
5323803a97fSHans Petter Selasky 		if (suword32(uaddr + 4, 0))
5333803a97fSHans Petter Selasky 			return (_len);
5343803a97fSHans Petter Selasky #endif
5350e05589bSHans Petter Selasky 		uaddr += 8;
5360e05589bSHans Petter Selasky 		len -= 8;
5370e05589bSHans Petter Selasky 	}
5380e05589bSHans Petter Selasky 
5390e05589bSHans Petter Selasky 	/* zero fill end, if any */
5400e05589bSHans Petter Selasky 	while (len > 0) {
5410e05589bSHans Petter Selasky 		if (subyte(uaddr, 0))
5420e05589bSHans Petter Selasky 			return (_len);
5430e05589bSHans Petter Selasky 		uaddr++;
5440e05589bSHans Petter Selasky 		len--;
5450e05589bSHans Petter Selasky 	}
5460e05589bSHans Petter Selasky 	return (0);
5470e05589bSHans Petter Selasky }
5480e05589bSHans Petter Selasky 
5490e05589bSHans Petter Selasky int
5500e05589bSHans Petter Selasky linux_access_ok(int rw, const void *uaddr, size_t len)
5510e05589bSHans Petter Selasky {
5520e05589bSHans Petter Selasky 	uintptr_t saddr;
5530e05589bSHans Petter Selasky 	uintptr_t eaddr;
5540e05589bSHans Petter Selasky 
5550e05589bSHans Petter Selasky 	/* get start and end address */
5560e05589bSHans Petter Selasky 	saddr = (uintptr_t)uaddr;
5570e05589bSHans Petter Selasky 	eaddr = (uintptr_t)uaddr + len;
5580e05589bSHans Petter Selasky 
5590e05589bSHans Petter Selasky 	/* verify addresses are valid for userspace */
5600e05589bSHans Petter Selasky 	return ((saddr == eaddr) ||
5610e05589bSHans Petter Selasky 	    (eaddr > saddr && eaddr <= VM_MAXUSER_ADDRESS));
5620e05589bSHans Petter Selasky }
5630e05589bSHans Petter Selasky 
5648d59ecb2SHans Petter Selasky static int
5658d59ecb2SHans Petter Selasky linux_dev_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag,
5668d59ecb2SHans Petter Selasky     struct thread *td)
5678d59ecb2SHans Petter Selasky {
5688d59ecb2SHans Petter Selasky 	struct linux_file *filp;
5698d59ecb2SHans Petter Selasky 	struct file *file;
5703a8bec33SHans Petter Selasky 	unsigned size;
5718d59ecb2SHans Petter Selasky 	int error;
5728d59ecb2SHans Petter Selasky 
573464d20bcSHans Petter Selasky 	file = td->td_fpop;
574*6e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
575*6e3e6544SHans Petter Selasky 		return (ENXIO);
5768d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
5778d59ecb2SHans Petter Selasky 		return (error);
5788d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
5791e3db1deSHans Petter Selasky 
5801e3db1deSHans Petter Selasky 	linux_set_current(td);
5813a8bec33SHans Petter Selasky 	size = IOCPARM_LEN(cmd);
5823a8bec33SHans Petter Selasky 	/* refer to logic in sys_ioctl() */
5833a8bec33SHans Petter Selasky 	if (size > 0) {
5848d59ecb2SHans Petter Selasky 		/*
5853a8bec33SHans Petter Selasky 		 * Setup hint for linux_copyin() and linux_copyout().
5863a8bec33SHans Petter Selasky 		 *
5873a8bec33SHans Petter Selasky 		 * Background: Linux code expects a user-space address
5883a8bec33SHans Petter Selasky 		 * while FreeBSD supplies a kernel-space address.
5898d59ecb2SHans Petter Selasky 		 */
5901e3db1deSHans Petter Selasky 		current->bsd_ioctl_data = data;
5911e3db1deSHans Petter Selasky 		current->bsd_ioctl_len = size;
5923a8bec33SHans Petter Selasky 		data = (void *)LINUX_IOCTL_MIN_PTR;
5933a8bec33SHans Petter Selasky 	} else {
5943a8bec33SHans Petter Selasky 		/* fetch user-space pointer */
5958d59ecb2SHans Petter Selasky 		data = *(void **)data;
5963a8bec33SHans Petter Selasky 	}
5978d59ecb2SHans Petter Selasky 	if (filp->f_op->unlocked_ioctl)
5988d59ecb2SHans Petter Selasky 		error = -filp->f_op->unlocked_ioctl(filp, cmd, (u_long)data);
5998d59ecb2SHans Petter Selasky 	else
6008d59ecb2SHans Petter Selasky 		error = ENOTTY;
6011e3db1deSHans Petter Selasky 	if (size > 0) {
6021e3db1deSHans Petter Selasky 		current->bsd_ioctl_data = NULL;
6031e3db1deSHans Petter Selasky 		current->bsd_ioctl_len = 0;
6041e3db1deSHans Petter Selasky 	}
6058d59ecb2SHans Petter Selasky 
6068d59ecb2SHans Petter Selasky 	return (error);
6078d59ecb2SHans Petter Selasky }
6088d59ecb2SHans Petter Selasky 
6098d59ecb2SHans Petter Selasky static int
6108d59ecb2SHans Petter Selasky linux_dev_read(struct cdev *dev, struct uio *uio, int ioflag)
6118d59ecb2SHans Petter Selasky {
6128d59ecb2SHans Petter Selasky 	struct linux_file *filp;
613464d20bcSHans Petter Selasky 	struct thread *td;
6148d59ecb2SHans Petter Selasky 	struct file *file;
6158d59ecb2SHans Petter Selasky 	ssize_t bytes;
6168d59ecb2SHans Petter Selasky 	int error;
6178d59ecb2SHans Petter Selasky 
618464d20bcSHans Petter Selasky 	td = curthread;
619464d20bcSHans Petter Selasky 	file = td->td_fpop;
620*6e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
621*6e3e6544SHans Petter Selasky 		return (ENXIO);
6228d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
6238d59ecb2SHans Petter Selasky 		return (error);
6248d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
625b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
6268d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
627b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
6281e3db1deSHans Petter Selasky 	linux_set_current(td);
6298d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
6308d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
6318d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
6328d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
6338d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
6348d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
6358d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
6368d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
6378d59ecb2SHans Petter Selasky 		} else
6388d59ecb2SHans Petter Selasky 			error = -bytes;
6398d59ecb2SHans Petter Selasky 	} else
6408d59ecb2SHans Petter Selasky 		error = ENXIO;
6418d59ecb2SHans Petter Selasky 
6428d59ecb2SHans Petter Selasky 	return (error);
6438d59ecb2SHans Petter Selasky }
6448d59ecb2SHans Petter Selasky 
6458d59ecb2SHans Petter Selasky static int
6468d59ecb2SHans Petter Selasky linux_dev_write(struct cdev *dev, struct uio *uio, int ioflag)
6478d59ecb2SHans Petter Selasky {
6488d59ecb2SHans Petter Selasky 	struct linux_file *filp;
649464d20bcSHans Petter Selasky 	struct thread *td;
6508d59ecb2SHans Petter Selasky 	struct file *file;
6518d59ecb2SHans Petter Selasky 	ssize_t bytes;
6528d59ecb2SHans Petter Selasky 	int error;
6538d59ecb2SHans Petter Selasky 
654464d20bcSHans Petter Selasky 	td = curthread;
655464d20bcSHans Petter Selasky 	file = td->td_fpop;
656*6e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
657*6e3e6544SHans Petter Selasky 		return (ENXIO);
6588d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
6598d59ecb2SHans Petter Selasky 		return (error);
6608d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
661b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
6628d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
663b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
6641e3db1deSHans Petter Selasky 	linux_set_current(td);
6658d59ecb2SHans Petter Selasky 	if (filp->f_op->write) {
6668d59ecb2SHans Petter Selasky 		bytes = filp->f_op->write(filp, uio->uio_iov->iov_base,
6678d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
6688d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
6698d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
6708d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
6718d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
6728d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
6738d59ecb2SHans Petter Selasky 		} else
6748d59ecb2SHans Petter Selasky 			error = -bytes;
6758d59ecb2SHans Petter Selasky 	} else
6768d59ecb2SHans Petter Selasky 		error = ENXIO;
6778d59ecb2SHans Petter Selasky 
6788d59ecb2SHans Petter Selasky 	return (error);
6798d59ecb2SHans Petter Selasky }
6808d59ecb2SHans Petter Selasky 
6818d59ecb2SHans Petter Selasky static int
6828d59ecb2SHans Petter Selasky linux_dev_poll(struct cdev *dev, int events, struct thread *td)
6838d59ecb2SHans Petter Selasky {
6848d59ecb2SHans Petter Selasky 	struct linux_file *filp;
6858d59ecb2SHans Petter Selasky 	struct file *file;
6868d59ecb2SHans Petter Selasky 	int revents;
687*6e3e6544SHans Petter Selasky 
688*6e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
689*6e3e6544SHans Petter Selasky 		goto error;
690*6e3e6544SHans Petter Selasky 	if (devfs_get_cdevpriv((void **)&filp) != 0)
691*6e3e6544SHans Petter Selasky 		goto error;
6928d59ecb2SHans Petter Selasky 
693464d20bcSHans Petter Selasky 	file = td->td_fpop;
6948d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
6951e3db1deSHans Petter Selasky 	linux_set_current(td);
6968d59ecb2SHans Petter Selasky 	if (filp->f_op->poll)
6978d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
6988d59ecb2SHans Petter Selasky 	else
6998d59ecb2SHans Petter Selasky 		revents = 0;
7008d59ecb2SHans Petter Selasky 
7018d59ecb2SHans Petter Selasky 	return (revents);
702*6e3e6544SHans Petter Selasky error:
703*6e3e6544SHans Petter Selasky 	return (events & (POLLHUP|POLLIN|POLLRDNORM|POLLOUT|POLLWRNORM));
7048d59ecb2SHans Petter Selasky }
7058d59ecb2SHans Petter Selasky 
7068d59ecb2SHans Petter Selasky static int
7078d59ecb2SHans Petter Selasky linux_dev_mmap_single(struct cdev *dev, vm_ooffset_t *offset,
7088d59ecb2SHans Petter Selasky     vm_size_t size, struct vm_object **object, int nprot)
7098d59ecb2SHans Petter Selasky {
7108d59ecb2SHans Petter Selasky 	struct linux_file *filp;
711464d20bcSHans Petter Selasky 	struct thread *td;
7128d59ecb2SHans Petter Selasky 	struct file *file;
7138d59ecb2SHans Petter Selasky 	struct vm_area_struct vma;
7148d59ecb2SHans Petter Selasky 	int error;
7158d59ecb2SHans Petter Selasky 
716464d20bcSHans Petter Selasky 	td = curthread;
717464d20bcSHans Petter Selasky 	file = td->td_fpop;
718*6e3e6544SHans Petter Selasky 	if (dev->si_drv1 == NULL)
7198d59ecb2SHans Petter Selasky 		return (ENODEV);
7208d59ecb2SHans Petter Selasky 	if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
7218d59ecb2SHans Petter Selasky 		return (error);
7228d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
7231e3db1deSHans Petter Selasky 	linux_set_current(td);
7248d59ecb2SHans Petter Selasky 	vma.vm_start = 0;
7258d59ecb2SHans Petter Selasky 	vma.vm_end = size;
7268d59ecb2SHans Petter Selasky 	vma.vm_pgoff = *offset / PAGE_SIZE;
7278d59ecb2SHans Petter Selasky 	vma.vm_pfn = 0;
728e23cd1b9SJohn Baldwin 	vma.vm_page_prot = VM_MEMATTR_DEFAULT;
7298d59ecb2SHans Petter Selasky 	if (filp->f_op->mmap) {
7308d59ecb2SHans Petter Selasky 		error = -filp->f_op->mmap(filp, &vma);
7318d59ecb2SHans Petter Selasky 		if (error == 0) {
7328d59ecb2SHans Petter Selasky 			struct sglist *sg;
7338d59ecb2SHans Petter Selasky 
7348d59ecb2SHans Petter Selasky 			sg = sglist_alloc(1, M_WAITOK);
7358d59ecb2SHans Petter Selasky 			sglist_append_phys(sg,
7368d59ecb2SHans Petter Selasky 			    (vm_paddr_t)vma.vm_pfn << PAGE_SHIFT, vma.vm_len);
7378d59ecb2SHans Petter Selasky 			*object = vm_pager_allocate(OBJT_SG, sg, vma.vm_len,
738464d20bcSHans Petter Selasky 			    nprot, 0, td->td_ucred);
7398d59ecb2SHans Petter Selasky 		        if (*object == NULL) {
7408d59ecb2SHans Petter Selasky 				sglist_free(sg);
741464d20bcSHans Petter Selasky 				error = EINVAL;
742464d20bcSHans Petter Selasky 				goto done;
7438d59ecb2SHans Petter Selasky 			}
7448d59ecb2SHans Petter Selasky 			*offset = 0;
7458d59ecb2SHans Petter Selasky 			if (vma.vm_page_prot != VM_MEMATTR_DEFAULT) {
7468d59ecb2SHans Petter Selasky 				VM_OBJECT_WLOCK(*object);
7478d59ecb2SHans Petter Selasky 				vm_object_set_memattr(*object,
7488d59ecb2SHans Petter Selasky 				    vma.vm_page_prot);
7498d59ecb2SHans Petter Selasky 				VM_OBJECT_WUNLOCK(*object);
7508d59ecb2SHans Petter Selasky 			}
7518d59ecb2SHans Petter Selasky 		}
7528d59ecb2SHans Petter Selasky 	} else
7538d59ecb2SHans Petter Selasky 		error = ENODEV;
754464d20bcSHans Petter Selasky done:
7558d59ecb2SHans Petter Selasky 	return (error);
7568d59ecb2SHans Petter Selasky }
7578d59ecb2SHans Petter Selasky 
7588d59ecb2SHans Petter Selasky struct cdevsw linuxcdevsw = {
7598d59ecb2SHans Petter Selasky 	.d_version = D_VERSION,
7608d59ecb2SHans Petter Selasky 	.d_flags = D_TRACKCLOSE,
7618d59ecb2SHans Petter Selasky 	.d_open = linux_dev_open,
7628d59ecb2SHans Petter Selasky 	.d_close = linux_dev_close,
7638d59ecb2SHans Petter Selasky 	.d_read = linux_dev_read,
7648d59ecb2SHans Petter Selasky 	.d_write = linux_dev_write,
7658d59ecb2SHans Petter Selasky 	.d_ioctl = linux_dev_ioctl,
7668d59ecb2SHans Petter Selasky 	.d_mmap_single = linux_dev_mmap_single,
7678d59ecb2SHans Petter Selasky 	.d_poll = linux_dev_poll,
7688d59ecb2SHans Petter Selasky };
7698d59ecb2SHans Petter Selasky 
7708d59ecb2SHans Petter Selasky static int
7718d59ecb2SHans Petter Selasky linux_file_read(struct file *file, struct uio *uio, struct ucred *active_cred,
7728d59ecb2SHans Petter Selasky     int flags, struct thread *td)
7738d59ecb2SHans Petter Selasky {
7748d59ecb2SHans Petter Selasky 	struct linux_file *filp;
7758d59ecb2SHans Petter Selasky 	ssize_t bytes;
7768d59ecb2SHans Petter Selasky 	int error;
7778d59ecb2SHans Petter Selasky 
7788d59ecb2SHans Petter Selasky 	error = 0;
7798d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
7808d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
781b3c89b5aSHans Petter Selasky 	/* XXX no support for I/O vectors currently */
7828d59ecb2SHans Petter Selasky 	if (uio->uio_iovcnt != 1)
783b3c89b5aSHans Petter Selasky 		return (EOPNOTSUPP);
7841e3db1deSHans Petter Selasky 	linux_set_current(td);
7858d59ecb2SHans Petter Selasky 	if (filp->f_op->read) {
7868d59ecb2SHans Petter Selasky 		bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
7878d59ecb2SHans Petter Selasky 		    uio->uio_iov->iov_len, &uio->uio_offset);
7888d59ecb2SHans Petter Selasky 		if (bytes >= 0) {
7898d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_base =
7908d59ecb2SHans Petter Selasky 			    ((uint8_t *)uio->uio_iov->iov_base) + bytes;
7918d59ecb2SHans Petter Selasky 			uio->uio_iov->iov_len -= bytes;
7928d59ecb2SHans Petter Selasky 			uio->uio_resid -= bytes;
7938d59ecb2SHans Petter Selasky 		} else
7948d59ecb2SHans Petter Selasky 			error = -bytes;
7958d59ecb2SHans Petter Selasky 	} else
7968d59ecb2SHans Petter Selasky 		error = ENXIO;
7978d59ecb2SHans Petter Selasky 
7988d59ecb2SHans Petter Selasky 	return (error);
7998d59ecb2SHans Petter Selasky }
8008d59ecb2SHans Petter Selasky 
8018d59ecb2SHans Petter Selasky static int
8028d59ecb2SHans Petter Selasky linux_file_poll(struct file *file, int events, struct ucred *active_cred,
8038d59ecb2SHans Petter Selasky     struct thread *td)
8048d59ecb2SHans Petter Selasky {
8058d59ecb2SHans Petter Selasky 	struct linux_file *filp;
8068d59ecb2SHans Petter Selasky 	int revents;
8078d59ecb2SHans Petter Selasky 
8088d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
8098d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
8101e3db1deSHans Petter Selasky 	linux_set_current(td);
8118d59ecb2SHans Petter Selasky 	if (filp->f_op->poll)
8128d59ecb2SHans Petter Selasky 		revents = filp->f_op->poll(filp, NULL) & events;
8138d59ecb2SHans Petter Selasky 	else
8148d59ecb2SHans Petter Selasky 		revents = 0;
8158d59ecb2SHans Petter Selasky 
8160754e66cSHans Petter Selasky 	return (revents);
8178d59ecb2SHans Petter Selasky }
8188d59ecb2SHans Petter Selasky 
8198d59ecb2SHans Petter Selasky static int
8208d59ecb2SHans Petter Selasky linux_file_close(struct file *file, struct thread *td)
8218d59ecb2SHans Petter Selasky {
8228d59ecb2SHans Petter Selasky 	struct linux_file *filp;
8238d59ecb2SHans Petter Selasky 	int error;
8248d59ecb2SHans Petter Selasky 
8258d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)file->f_data;
8268d59ecb2SHans Petter Selasky 	filp->f_flags = file->f_flag;
8271e3db1deSHans Petter Selasky 	linux_set_current(td);
8288d59ecb2SHans Petter Selasky 	error = -filp->f_op->release(NULL, filp);
8298d59ecb2SHans Petter Selasky 	funsetown(&filp->f_sigio);
8308d59ecb2SHans Petter Selasky 	kfree(filp);
8318d59ecb2SHans Petter Selasky 
8328d59ecb2SHans Petter Selasky 	return (error);
8338d59ecb2SHans Petter Selasky }
8348d59ecb2SHans Petter Selasky 
8358d59ecb2SHans Petter Selasky static int
8368d59ecb2SHans Petter Selasky linux_file_ioctl(struct file *fp, u_long cmd, void *data, struct ucred *cred,
8378d59ecb2SHans Petter Selasky     struct thread *td)
8388d59ecb2SHans Petter Selasky {
8398d59ecb2SHans Petter Selasky 	struct linux_file *filp;
8408d59ecb2SHans Petter Selasky 	int error;
8418d59ecb2SHans Petter Selasky 
8428d59ecb2SHans Petter Selasky 	filp = (struct linux_file *)fp->f_data;
8438d59ecb2SHans Petter Selasky 	filp->f_flags = fp->f_flag;
8448d59ecb2SHans Petter Selasky 	error = 0;
8458d59ecb2SHans Petter Selasky 
8461e3db1deSHans Petter Selasky 	linux_set_current(td);
8478d59ecb2SHans Petter Selasky 	switch (cmd) {
8488d59ecb2SHans Petter Selasky 	case FIONBIO:
8498d59ecb2SHans Petter Selasky 		break;
8508d59ecb2SHans Petter Selasky 	case FIOASYNC:
8518d59ecb2SHans Petter Selasky 		if (filp->f_op->fasync == NULL)
8528d59ecb2SHans Petter Selasky 			break;
8538d59ecb2SHans Petter Selasky 		error = filp->f_op->fasync(0, filp, fp->f_flag & FASYNC);
8548d59ecb2SHans Petter Selasky 		break;
8558d59ecb2SHans Petter Selasky 	case FIOSETOWN:
8568d59ecb2SHans Petter Selasky 		error = fsetown(*(int *)data, &filp->f_sigio);
8578d59ecb2SHans Petter Selasky 		if (error == 0)
8588d59ecb2SHans Petter Selasky 			error = filp->f_op->fasync(0, filp,
8598d59ecb2SHans Petter Selasky 			    fp->f_flag & FASYNC);
8608d59ecb2SHans Petter Selasky 		break;
8618d59ecb2SHans Petter Selasky 	case FIOGETOWN:
8628d59ecb2SHans Petter Selasky 		*(int *)data = fgetown(&filp->f_sigio);
8638d59ecb2SHans Petter Selasky 		break;
8648d59ecb2SHans Petter Selasky 	default:
8658d59ecb2SHans Petter Selasky 		error = ENOTTY;
8668d59ecb2SHans Petter Selasky 		break;
8678d59ecb2SHans Petter Selasky 	}
8688d59ecb2SHans Petter Selasky 	return (error);
8698d59ecb2SHans Petter Selasky }
8708d59ecb2SHans Petter Selasky 
8718d59ecb2SHans Petter Selasky static int
8728d59ecb2SHans Petter Selasky linux_file_stat(struct file *fp, struct stat *sb, struct ucred *active_cred,
8738d59ecb2SHans Petter Selasky     struct thread *td)
8748d59ecb2SHans Petter Selasky {
8758d59ecb2SHans Petter Selasky 
8768d59ecb2SHans Petter Selasky 	return (EOPNOTSUPP);
8778d59ecb2SHans Petter Selasky }
8788d59ecb2SHans Petter Selasky 
8798d59ecb2SHans Petter Selasky static int
8808d59ecb2SHans Petter Selasky linux_file_fill_kinfo(struct file *fp, struct kinfo_file *kif,
8818d59ecb2SHans Petter Selasky     struct filedesc *fdp)
8828d59ecb2SHans Petter Selasky {
8838d59ecb2SHans Petter Selasky 
8848d59ecb2SHans Petter Selasky 	return (0);
8858d59ecb2SHans Petter Selasky }
8868d59ecb2SHans Petter Selasky 
8878d59ecb2SHans Petter Selasky struct fileops linuxfileops = {
8888d59ecb2SHans Petter Selasky 	.fo_read = linux_file_read,
8898d59ecb2SHans Petter Selasky 	.fo_write = invfo_rdwr,
8908d59ecb2SHans Petter Selasky 	.fo_truncate = invfo_truncate,
8918d59ecb2SHans Petter Selasky 	.fo_kqfilter = invfo_kqfilter,
8928d59ecb2SHans Petter Selasky 	.fo_stat = linux_file_stat,
8938d59ecb2SHans Petter Selasky 	.fo_fill_kinfo = linux_file_fill_kinfo,
8948d59ecb2SHans Petter Selasky 	.fo_poll = linux_file_poll,
8958d59ecb2SHans Petter Selasky 	.fo_close = linux_file_close,
8968d59ecb2SHans Petter Selasky 	.fo_ioctl = linux_file_ioctl,
8978d59ecb2SHans Petter Selasky 	.fo_chmod = invfo_chmod,
8988d59ecb2SHans Petter Selasky 	.fo_chown = invfo_chown,
8998d59ecb2SHans Petter Selasky 	.fo_sendfile = invfo_sendfile,
9008d59ecb2SHans Petter Selasky };
9018d59ecb2SHans Petter Selasky 
9028d59ecb2SHans Petter Selasky /*
9038d59ecb2SHans Petter Selasky  * Hash of vmmap addresses.  This is infrequently accessed and does not
9048d59ecb2SHans Petter Selasky  * need to be particularly large.  This is done because we must store the
9058d59ecb2SHans Petter Selasky  * caller's idea of the map size to properly unmap.
9068d59ecb2SHans Petter Selasky  */
9078d59ecb2SHans Petter Selasky struct vmmap {
9088d59ecb2SHans Petter Selasky 	LIST_ENTRY(vmmap)	vm_next;
9098d59ecb2SHans Petter Selasky 	void 			*vm_addr;
9108d59ecb2SHans Petter Selasky 	unsigned long		vm_size;
9118d59ecb2SHans Petter Selasky };
9128d59ecb2SHans Petter Selasky 
9138d59ecb2SHans Petter Selasky struct vmmaphd {
9148d59ecb2SHans Petter Selasky 	struct vmmap *lh_first;
9158d59ecb2SHans Petter Selasky };
9168d59ecb2SHans Petter Selasky #define	VMMAP_HASH_SIZE	64
9178d59ecb2SHans Petter Selasky #define	VMMAP_HASH_MASK	(VMMAP_HASH_SIZE - 1)
9188d59ecb2SHans Petter Selasky #define	VM_HASH(addr)	((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK
9198d59ecb2SHans Petter Selasky static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE];
9208d59ecb2SHans Petter Selasky static struct mtx vmmaplock;
9218d59ecb2SHans Petter Selasky 
9228d59ecb2SHans Petter Selasky static void
9238d59ecb2SHans Petter Selasky vmmap_add(void *addr, unsigned long size)
9248d59ecb2SHans Petter Selasky {
9258d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
9268d59ecb2SHans Petter Selasky 
9278d59ecb2SHans Petter Selasky 	vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL);
9288d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
9298d59ecb2SHans Petter Selasky 	vmmap->vm_size = size;
9308d59ecb2SHans Petter Selasky 	vmmap->vm_addr = addr;
9318d59ecb2SHans Petter Selasky 	LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next);
9328d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
9338d59ecb2SHans Petter Selasky }
9348d59ecb2SHans Petter Selasky 
9358d59ecb2SHans Petter Selasky static struct vmmap *
9368d59ecb2SHans Petter Selasky vmmap_remove(void *addr)
9378d59ecb2SHans Petter Selasky {
9388d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
9398d59ecb2SHans Petter Selasky 
9408d59ecb2SHans Petter Selasky 	mtx_lock(&vmmaplock);
9418d59ecb2SHans Petter Selasky 	LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next)
9428d59ecb2SHans Petter Selasky 		if (vmmap->vm_addr == addr)
9438d59ecb2SHans Petter Selasky 			break;
9448d59ecb2SHans Petter Selasky 	if (vmmap)
9458d59ecb2SHans Petter Selasky 		LIST_REMOVE(vmmap, vm_next);
9468d59ecb2SHans Petter Selasky 	mtx_unlock(&vmmaplock);
9478d59ecb2SHans Petter Selasky 
9488d59ecb2SHans Petter Selasky 	return (vmmap);
9498d59ecb2SHans Petter Selasky }
9508d59ecb2SHans Petter Selasky 
95186845417SHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
9528d59ecb2SHans Petter Selasky void *
9538d59ecb2SHans Petter Selasky _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr)
9548d59ecb2SHans Petter Selasky {
9558d59ecb2SHans Petter Selasky 	void *addr;
9568d59ecb2SHans Petter Selasky 
9578d59ecb2SHans Petter Selasky 	addr = pmap_mapdev_attr(phys_addr, size, attr);
9588d59ecb2SHans Petter Selasky 	if (addr == NULL)
9598d59ecb2SHans Petter Selasky 		return (NULL);
9608d59ecb2SHans Petter Selasky 	vmmap_add(addr, size);
9618d59ecb2SHans Petter Selasky 
9628d59ecb2SHans Petter Selasky 	return (addr);
9638d59ecb2SHans Petter Selasky }
96486845417SHans Petter Selasky #endif
9658d59ecb2SHans Petter Selasky 
9668d59ecb2SHans Petter Selasky void
9678d59ecb2SHans Petter Selasky iounmap(void *addr)
9688d59ecb2SHans Petter Selasky {
9698d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
9708d59ecb2SHans Petter Selasky 
9718d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
9728d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
9738d59ecb2SHans Petter Selasky 		return;
9748d59ecb2SHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
9758d59ecb2SHans Petter Selasky 	pmap_unmapdev((vm_offset_t)addr, vmmap->vm_size);
9768d59ecb2SHans Petter Selasky #endif
9778d59ecb2SHans Petter Selasky 	kfree(vmmap);
9788d59ecb2SHans Petter Selasky }
9798d59ecb2SHans Petter Selasky 
9808d59ecb2SHans Petter Selasky 
9818d59ecb2SHans Petter Selasky void *
9828d59ecb2SHans Petter Selasky vmap(struct page **pages, unsigned int count, unsigned long flags, int prot)
9838d59ecb2SHans Petter Selasky {
9848d59ecb2SHans Petter Selasky 	vm_offset_t off;
9858d59ecb2SHans Petter Selasky 	size_t size;
9868d59ecb2SHans Petter Selasky 
9878d59ecb2SHans Petter Selasky 	size = count * PAGE_SIZE;
9888d59ecb2SHans Petter Selasky 	off = kva_alloc(size);
9898d59ecb2SHans Petter Selasky 	if (off == 0)
9908d59ecb2SHans Petter Selasky 		return (NULL);
9918d59ecb2SHans Petter Selasky 	vmmap_add((void *)off, size);
9928d59ecb2SHans Petter Selasky 	pmap_qenter(off, pages, count);
9938d59ecb2SHans Petter Selasky 
9948d59ecb2SHans Petter Selasky 	return ((void *)off);
9958d59ecb2SHans Petter Selasky }
9968d59ecb2SHans Petter Selasky 
9978d59ecb2SHans Petter Selasky void
9988d59ecb2SHans Petter Selasky vunmap(void *addr)
9998d59ecb2SHans Petter Selasky {
10008d59ecb2SHans Petter Selasky 	struct vmmap *vmmap;
10018d59ecb2SHans Petter Selasky 
10028d59ecb2SHans Petter Selasky 	vmmap = vmmap_remove(addr);
10038d59ecb2SHans Petter Selasky 	if (vmmap == NULL)
10048d59ecb2SHans Petter Selasky 		return;
10058d59ecb2SHans Petter Selasky 	pmap_qremove((vm_offset_t)addr, vmmap->vm_size / PAGE_SIZE);
10068d59ecb2SHans Petter Selasky 	kva_free((vm_offset_t)addr, vmmap->vm_size);
10078d59ecb2SHans Petter Selasky 	kfree(vmmap);
10088d59ecb2SHans Petter Selasky }
10098d59ecb2SHans Petter Selasky 
10108d59ecb2SHans Petter Selasky char *
10118d59ecb2SHans Petter Selasky kvasprintf(gfp_t gfp, const char *fmt, va_list ap)
10128d59ecb2SHans Petter Selasky {
10138d59ecb2SHans Petter Selasky 	unsigned int len;
10148d59ecb2SHans Petter Selasky 	char *p;
10158d59ecb2SHans Petter Selasky 	va_list aq;
10168d59ecb2SHans Petter Selasky 
10178d59ecb2SHans Petter Selasky 	va_copy(aq, ap);
10188d59ecb2SHans Petter Selasky 	len = vsnprintf(NULL, 0, fmt, aq);
10198d59ecb2SHans Petter Selasky 	va_end(aq);
10208d59ecb2SHans Petter Selasky 
10218d59ecb2SHans Petter Selasky 	p = kmalloc(len + 1, gfp);
10228d59ecb2SHans Petter Selasky 	if (p != NULL)
10238d59ecb2SHans Petter Selasky 		vsnprintf(p, len + 1, fmt, ap);
10248d59ecb2SHans Petter Selasky 
10258d59ecb2SHans Petter Selasky 	return (p);
10268d59ecb2SHans Petter Selasky }
10278d59ecb2SHans Petter Selasky 
10288d59ecb2SHans Petter Selasky char *
10298d59ecb2SHans Petter Selasky kasprintf(gfp_t gfp, const char *fmt, ...)
10308d59ecb2SHans Petter Selasky {
10318d59ecb2SHans Petter Selasky 	va_list ap;
10328d59ecb2SHans Petter Selasky 	char *p;
10338d59ecb2SHans Petter Selasky 
10348d59ecb2SHans Petter Selasky 	va_start(ap, fmt);
10358d59ecb2SHans Petter Selasky 	p = kvasprintf(gfp, fmt, ap);
10368d59ecb2SHans Petter Selasky 	va_end(ap);
10378d59ecb2SHans Petter Selasky 
10388d59ecb2SHans Petter Selasky 	return (p);
10398d59ecb2SHans Petter Selasky }
10408d59ecb2SHans Petter Selasky 
10418d59ecb2SHans Petter Selasky static void
10428d59ecb2SHans Petter Selasky linux_timer_callback_wrapper(void *context)
10438d59ecb2SHans Petter Selasky {
10448d59ecb2SHans Petter Selasky 	struct timer_list *timer;
10458d59ecb2SHans Petter Selasky 
10465f50a414SHans Petter Selasky 	linux_set_current(curthread);
10475f50a414SHans Petter Selasky 
10488d59ecb2SHans Petter Selasky 	timer = context;
10498d59ecb2SHans Petter Selasky 	timer->function(timer->data);
10508d59ecb2SHans Petter Selasky }
10518d59ecb2SHans Petter Selasky 
10528d59ecb2SHans Petter Selasky void
10538d59ecb2SHans Petter Selasky mod_timer(struct timer_list *timer, unsigned long expires)
10548d59ecb2SHans Petter Selasky {
10558d59ecb2SHans Petter Selasky 
10568d59ecb2SHans Petter Selasky 	timer->expires = expires;
10578d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
10588d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(expires),
10598d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
10608d59ecb2SHans Petter Selasky }
10618d59ecb2SHans Petter Selasky 
10628d59ecb2SHans Petter Selasky void
10638d59ecb2SHans Petter Selasky add_timer(struct timer_list *timer)
10648d59ecb2SHans Petter Selasky {
10658d59ecb2SHans Petter Selasky 
10668d59ecb2SHans Petter Selasky 	callout_reset(&timer->timer_callout,
10678d59ecb2SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
10688d59ecb2SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer);
10698d59ecb2SHans Petter Selasky }
10708d59ecb2SHans Petter Selasky 
1071def277d3SHans Petter Selasky void
1072def277d3SHans Petter Selasky add_timer_on(struct timer_list *timer, int cpu)
1073def277d3SHans Petter Selasky {
1074def277d3SHans Petter Selasky 
1075def277d3SHans Petter Selasky 	callout_reset_on(&timer->timer_callout,
1076def277d3SHans Petter Selasky 	    linux_timer_jiffies_until(timer->expires),
1077def277d3SHans Petter Selasky 	    &linux_timer_callback_wrapper, timer, cpu);
1078def277d3SHans Petter Selasky }
1079def277d3SHans Petter Selasky 
10808d59ecb2SHans Petter Selasky static void
10818d59ecb2SHans Petter Selasky linux_timer_init(void *arg)
10828d59ecb2SHans Petter Selasky {
10838d59ecb2SHans Petter Selasky 
10848d59ecb2SHans Petter Selasky 	/*
10858d59ecb2SHans Petter Selasky 	 * Compute an internal HZ value which can divide 2**32 to
10868d59ecb2SHans Petter Selasky 	 * avoid timer rounding problems when the tick value wraps
10878d59ecb2SHans Petter Selasky 	 * around 2**32:
10888d59ecb2SHans Petter Selasky 	 */
10898d59ecb2SHans Petter Selasky 	linux_timer_hz_mask = 1;
10908d59ecb2SHans Petter Selasky 	while (linux_timer_hz_mask < (unsigned long)hz)
10918d59ecb2SHans Petter Selasky 		linux_timer_hz_mask *= 2;
10928d59ecb2SHans Petter Selasky 	linux_timer_hz_mask--;
10938d59ecb2SHans Petter Selasky }
10948d59ecb2SHans Petter Selasky SYSINIT(linux_timer, SI_SUB_DRIVERS, SI_ORDER_FIRST, linux_timer_init, NULL);
10958d59ecb2SHans Petter Selasky 
10968d59ecb2SHans Petter Selasky void
10978d59ecb2SHans Petter Selasky linux_complete_common(struct completion *c, int all)
10988d59ecb2SHans Petter Selasky {
10998d59ecb2SHans Petter Selasky 	int wakeup_swapper;
11008d59ecb2SHans Petter Selasky 
11018d59ecb2SHans Petter Selasky 	sleepq_lock(c);
11028d59ecb2SHans Petter Selasky 	c->done++;
11038d59ecb2SHans Petter Selasky 	if (all)
11048d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_broadcast(c, SLEEPQ_SLEEP, 0, 0);
11058d59ecb2SHans Petter Selasky 	else
11068d59ecb2SHans Petter Selasky 		wakeup_swapper = sleepq_signal(c, SLEEPQ_SLEEP, 0, 0);
11078d59ecb2SHans Petter Selasky 	sleepq_release(c);
11088d59ecb2SHans Petter Selasky 	if (wakeup_swapper)
11098d59ecb2SHans Petter Selasky 		kick_proc0();
11108d59ecb2SHans Petter Selasky }
11118d59ecb2SHans Petter Selasky 
11128d59ecb2SHans Petter Selasky /*
11138d59ecb2SHans Petter Selasky  * Indefinite wait for done != 0 with or without signals.
11148d59ecb2SHans Petter Selasky  */
11158d59ecb2SHans Petter Selasky long
11168d59ecb2SHans Petter Selasky linux_wait_for_common(struct completion *c, int flags)
11178d59ecb2SHans Petter Selasky {
11188eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
111985714218SHans Petter Selasky 		return (0);
11208d59ecb2SHans Petter Selasky 
11218d59ecb2SHans Petter Selasky 	if (flags != 0)
11228d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
11238d59ecb2SHans Petter Selasky 	else
11248d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
11258d59ecb2SHans Petter Selasky 	for (;;) {
11268d59ecb2SHans Petter Selasky 		sleepq_lock(c);
11278d59ecb2SHans Petter Selasky 		if (c->done)
11288d59ecb2SHans Petter Selasky 			break;
11298d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
11308d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE) {
11318d59ecb2SHans Petter Selasky 			if (sleepq_wait_sig(c, 0) != 0)
11328d59ecb2SHans Petter Selasky 				return (-ERESTARTSYS);
11338d59ecb2SHans Petter Selasky 		} else
11348d59ecb2SHans Petter Selasky 			sleepq_wait(c, 0);
11358d59ecb2SHans Petter Selasky 	}
11368d59ecb2SHans Petter Selasky 	c->done--;
11378d59ecb2SHans Petter Selasky 	sleepq_release(c);
11388d59ecb2SHans Petter Selasky 
11398d59ecb2SHans Petter Selasky 	return (0);
11408d59ecb2SHans Petter Selasky }
11418d59ecb2SHans Petter Selasky 
11428d59ecb2SHans Petter Selasky /*
11438d59ecb2SHans Petter Selasky  * Time limited wait for done != 0 with or without signals.
11448d59ecb2SHans Petter Selasky  */
11458d59ecb2SHans Petter Selasky long
11468d59ecb2SHans Petter Selasky linux_wait_for_timeout_common(struct completion *c, long timeout, int flags)
11478d59ecb2SHans Petter Selasky {
11488d59ecb2SHans Petter Selasky 	long end = jiffies + timeout;
11498d59ecb2SHans Petter Selasky 
11508eeb3e17SHans Petter Selasky 	if (SCHEDULER_STOPPED())
115185714218SHans Petter Selasky 		return (0);
115285714218SHans Petter Selasky 
11538d59ecb2SHans Petter Selasky 	if (flags != 0)
11548d59ecb2SHans Petter Selasky 		flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP;
11558d59ecb2SHans Petter Selasky 	else
11568d59ecb2SHans Petter Selasky 		flags = SLEEPQ_SLEEP;
11578d59ecb2SHans Petter Selasky 	for (;;) {
11588d59ecb2SHans Petter Selasky 		int ret;
11598d59ecb2SHans Petter Selasky 
11608d59ecb2SHans Petter Selasky 		sleepq_lock(c);
11618d59ecb2SHans Petter Selasky 		if (c->done)
11628d59ecb2SHans Petter Selasky 			break;
11638d59ecb2SHans Petter Selasky 		sleepq_add(c, NULL, "completion", flags, 0);
11648d59ecb2SHans Petter Selasky 		sleepq_set_timeout(c, linux_timer_jiffies_until(end));
11658d59ecb2SHans Petter Selasky 		if (flags & SLEEPQ_INTERRUPTIBLE)
11668d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait_sig(c, 0);
11678d59ecb2SHans Petter Selasky 		else
11688d59ecb2SHans Petter Selasky 			ret = sleepq_timedwait(c, 0);
11698d59ecb2SHans Petter Selasky 		if (ret != 0) {
11708d59ecb2SHans Petter Selasky 			/* check for timeout or signal */
11718d59ecb2SHans Petter Selasky 			if (ret == EWOULDBLOCK)
11728d59ecb2SHans Petter Selasky 				return (0);
11738d59ecb2SHans Petter Selasky 			else
11748d59ecb2SHans Petter Selasky 				return (-ERESTARTSYS);
11758d59ecb2SHans Petter Selasky 		}
11768d59ecb2SHans Petter Selasky 	}
11778d59ecb2SHans Petter Selasky 	c->done--;
11788d59ecb2SHans Petter Selasky 	sleepq_release(c);
11798d59ecb2SHans Petter Selasky 
11808d59ecb2SHans Petter Selasky 	/* return how many jiffies are left */
11818d59ecb2SHans Petter Selasky 	return (linux_timer_jiffies_until(end));
11828d59ecb2SHans Petter Selasky }
11838d59ecb2SHans Petter Selasky 
11848d59ecb2SHans Petter Selasky int
11858d59ecb2SHans Petter Selasky linux_try_wait_for_completion(struct completion *c)
11868d59ecb2SHans Petter Selasky {
11878d59ecb2SHans Petter Selasky 	int isdone;
11888d59ecb2SHans Petter Selasky 
11898d59ecb2SHans Petter Selasky 	isdone = 1;
11908d59ecb2SHans Petter Selasky 	sleepq_lock(c);
11918d59ecb2SHans Petter Selasky 	if (c->done)
11928d59ecb2SHans Petter Selasky 		c->done--;
11938d59ecb2SHans Petter Selasky 	else
11948d59ecb2SHans Petter Selasky 		isdone = 0;
11958d59ecb2SHans Petter Selasky 	sleepq_release(c);
11968d59ecb2SHans Petter Selasky 	return (isdone);
11978d59ecb2SHans Petter Selasky }
11988d59ecb2SHans Petter Selasky 
11998d59ecb2SHans Petter Selasky int
12008d59ecb2SHans Petter Selasky linux_completion_done(struct completion *c)
12018d59ecb2SHans Petter Selasky {
12028d59ecb2SHans Petter Selasky 	int isdone;
12038d59ecb2SHans Petter Selasky 
12048d59ecb2SHans Petter Selasky 	isdone = 1;
12058d59ecb2SHans Petter Selasky 	sleepq_lock(c);
12068d59ecb2SHans Petter Selasky 	if (c->done == 0)
12078d59ecb2SHans Petter Selasky 		isdone = 0;
12088d59ecb2SHans Petter Selasky 	sleepq_release(c);
12098d59ecb2SHans Petter Selasky 	return (isdone);
12108d59ecb2SHans Petter Selasky }
12118d59ecb2SHans Petter Selasky 
12128d59ecb2SHans Petter Selasky static void
121306204f8eSHans Petter Selasky linux_cdev_release(struct kobject *kobj)
121406204f8eSHans Petter Selasky {
121506204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
121606204f8eSHans Petter Selasky 	struct kobject *parent;
121706204f8eSHans Petter Selasky 
121806204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
121906204f8eSHans Petter Selasky 	parent = kobj->parent;
122006204f8eSHans Petter Selasky 	if (cdev->cdev)
122106204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
122206204f8eSHans Petter Selasky 	kfree(cdev);
122306204f8eSHans Petter Selasky 	kobject_put(parent);
122406204f8eSHans Petter Selasky }
122506204f8eSHans Petter Selasky 
122606204f8eSHans Petter Selasky static void
122706204f8eSHans Petter Selasky linux_cdev_static_release(struct kobject *kobj)
122806204f8eSHans Petter Selasky {
122906204f8eSHans Petter Selasky 	struct linux_cdev *cdev;
123006204f8eSHans Petter Selasky 	struct kobject *parent;
123106204f8eSHans Petter Selasky 
123206204f8eSHans Petter Selasky 	cdev = container_of(kobj, struct linux_cdev, kobj);
123306204f8eSHans Petter Selasky 	parent = kobj->parent;
123406204f8eSHans Petter Selasky 	if (cdev->cdev)
123506204f8eSHans Petter Selasky 		destroy_dev(cdev->cdev);
123606204f8eSHans Petter Selasky 	kobject_put(parent);
123706204f8eSHans Petter Selasky }
123806204f8eSHans Petter Selasky 
123906204f8eSHans Petter Selasky const struct kobj_type linux_cdev_ktype = {
124006204f8eSHans Petter Selasky 	.release = linux_cdev_release,
124106204f8eSHans Petter Selasky };
124206204f8eSHans Petter Selasky 
124306204f8eSHans Petter Selasky const struct kobj_type linux_cdev_static_ktype = {
124406204f8eSHans Petter Selasky 	.release = linux_cdev_static_release,
124506204f8eSHans Petter Selasky };
124606204f8eSHans Petter Selasky 
124706204f8eSHans Petter Selasky static void
12480c510167SHans Petter Selasky linux_handle_ifnet_link_event(void *arg, struct ifnet *ifp, int linkstate)
12490c510167SHans Petter Selasky {
12500c510167SHans Petter Selasky 	struct notifier_block *nb;
12510c510167SHans Petter Selasky 
12520c510167SHans Petter Selasky 	nb = arg;
12530c510167SHans Petter Selasky 	if (linkstate == LINK_STATE_UP)
12540c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_UP, ifp);
12550c510167SHans Petter Selasky 	else
12560c510167SHans Petter Selasky 		nb->notifier_call(nb, NETDEV_DOWN, ifp);
12570c510167SHans Petter Selasky }
12580c510167SHans Petter Selasky 
12590c510167SHans Petter Selasky static void
12600c510167SHans Petter Selasky linux_handle_ifnet_arrival_event(void *arg, struct ifnet *ifp)
12610c510167SHans Petter Selasky {
12620c510167SHans Petter Selasky 	struct notifier_block *nb;
12630c510167SHans Petter Selasky 
12640c510167SHans Petter Selasky 	nb = arg;
12650c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_REGISTER, ifp);
12660c510167SHans Petter Selasky }
12670c510167SHans Petter Selasky 
12680c510167SHans Petter Selasky static void
12690c510167SHans Petter Selasky linux_handle_ifnet_departure_event(void *arg, struct ifnet *ifp)
12700c510167SHans Petter Selasky {
12710c510167SHans Petter Selasky 	struct notifier_block *nb;
12720c510167SHans Petter Selasky 
12730c510167SHans Petter Selasky 	nb = arg;
12740c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_UNREGISTER, ifp);
12750c510167SHans Petter Selasky }
12760c510167SHans Petter Selasky 
12770c510167SHans Petter Selasky static void
12780c510167SHans Petter Selasky linux_handle_iflladdr_event(void *arg, struct ifnet *ifp)
12790c510167SHans Petter Selasky {
12800c510167SHans Petter Selasky 	struct notifier_block *nb;
12810c510167SHans Petter Selasky 
12820c510167SHans Petter Selasky 	nb = arg;
12830c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEADDR, ifp);
12840c510167SHans Petter Selasky }
12850c510167SHans Petter Selasky 
12860c510167SHans Petter Selasky static void
12870c510167SHans Petter Selasky linux_handle_ifaddr_event(void *arg, struct ifnet *ifp)
12880c510167SHans Petter Selasky {
12890c510167SHans Petter Selasky 	struct notifier_block *nb;
12900c510167SHans Petter Selasky 
12910c510167SHans Petter Selasky 	nb = arg;
12920c510167SHans Petter Selasky 	nb->notifier_call(nb, NETDEV_CHANGEIFADDR, ifp);
12930c510167SHans Petter Selasky }
12940c510167SHans Petter Selasky 
12950c510167SHans Petter Selasky int
12960c510167SHans Petter Selasky register_netdevice_notifier(struct notifier_block *nb)
12970c510167SHans Petter Selasky {
12980c510167SHans Petter Selasky 
12990c510167SHans Petter Selasky 	nb->tags[NETDEV_UP] = EVENTHANDLER_REGISTER(
13000c510167SHans Petter Selasky 	    ifnet_link_event, linux_handle_ifnet_link_event, nb, 0);
13010c510167SHans Petter Selasky 	nb->tags[NETDEV_REGISTER] = EVENTHANDLER_REGISTER(
13020c510167SHans Petter Selasky 	    ifnet_arrival_event, linux_handle_ifnet_arrival_event, nb, 0);
13030c510167SHans Petter Selasky 	nb->tags[NETDEV_UNREGISTER] = EVENTHANDLER_REGISTER(
13040c510167SHans Petter Selasky 	    ifnet_departure_event, linux_handle_ifnet_departure_event, nb, 0);
13050c510167SHans Petter Selasky 	nb->tags[NETDEV_CHANGEADDR] = EVENTHANDLER_REGISTER(
13060c510167SHans Petter Selasky 	    iflladdr_event, linux_handle_iflladdr_event, nb, 0);
13070c510167SHans Petter Selasky 
13080c510167SHans Petter Selasky 	return (0);
13090c510167SHans Petter Selasky }
13100c510167SHans Petter Selasky 
13110c510167SHans Petter Selasky int
13120c510167SHans Petter Selasky register_inetaddr_notifier(struct notifier_block *nb)
13130c510167SHans Petter Selasky {
13140c510167SHans Petter Selasky 
13150c510167SHans Petter Selasky         nb->tags[NETDEV_CHANGEIFADDR] = EVENTHANDLER_REGISTER(
13160c510167SHans Petter Selasky             ifaddr_event, linux_handle_ifaddr_event, nb, 0);
13170c510167SHans Petter Selasky         return (0);
13180c510167SHans Petter Selasky }
13190c510167SHans Petter Selasky 
13200c510167SHans Petter Selasky int
13210c510167SHans Petter Selasky unregister_netdevice_notifier(struct notifier_block *nb)
13220c510167SHans Petter Selasky {
13230c510167SHans Petter Selasky 
13240c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_link_event,
13250c510167SHans Petter Selasky 	    nb->tags[NETDEV_UP]);
13260c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_arrival_event,
13270c510167SHans Petter Selasky 	    nb->tags[NETDEV_REGISTER]);
13280c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifnet_departure_event,
13290c510167SHans Petter Selasky 	    nb->tags[NETDEV_UNREGISTER]);
13300c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(iflladdr_event,
13310c510167SHans Petter Selasky 	    nb->tags[NETDEV_CHANGEADDR]);
13320c510167SHans Petter Selasky 
13330c510167SHans Petter Selasky 	return (0);
13340c510167SHans Petter Selasky }
13350c510167SHans Petter Selasky 
13360c510167SHans Petter Selasky int
13370c510167SHans Petter Selasky unregister_inetaddr_notifier(struct notifier_block *nb)
13380c510167SHans Petter Selasky {
13390c510167SHans Petter Selasky 
13400c510167SHans Petter Selasky         EVENTHANDLER_DEREGISTER(ifaddr_event,
13410c510167SHans Petter Selasky             nb->tags[NETDEV_CHANGEIFADDR]);
13420c510167SHans Petter Selasky 
13430c510167SHans Petter Selasky         return (0);
13440c510167SHans Petter Selasky }
13450c510167SHans Petter Selasky 
1346aad02fb4SHans Petter Selasky struct list_sort_thunk {
1347aad02fb4SHans Petter Selasky 	int (*cmp)(void *, struct list_head *, struct list_head *);
1348aad02fb4SHans Petter Selasky 	void *priv;
1349aad02fb4SHans Petter Selasky };
1350aad02fb4SHans Petter Selasky 
1351aad02fb4SHans Petter Selasky static inline int
1352aad02fb4SHans Petter Selasky linux_le_cmp(void *priv, const void *d1, const void *d2)
1353aad02fb4SHans Petter Selasky {
1354aad02fb4SHans Petter Selasky 	struct list_head *le1, *le2;
1355aad02fb4SHans Petter Selasky 	struct list_sort_thunk *thunk;
1356aad02fb4SHans Petter Selasky 
1357aad02fb4SHans Petter Selasky 	thunk = priv;
1358aad02fb4SHans Petter Selasky 	le1 = *(__DECONST(struct list_head **, d1));
1359aad02fb4SHans Petter Selasky 	le2 = *(__DECONST(struct list_head **, d2));
1360aad02fb4SHans Petter Selasky 	return ((thunk->cmp)(thunk->priv, le1, le2));
1361aad02fb4SHans Petter Selasky }
1362aad02fb4SHans Petter Selasky 
1363aad02fb4SHans Petter Selasky void
1364aad02fb4SHans Petter Selasky list_sort(void *priv, struct list_head *head, int (*cmp)(void *priv,
1365aad02fb4SHans Petter Selasky     struct list_head *a, struct list_head *b))
1366aad02fb4SHans Petter Selasky {
1367aad02fb4SHans Petter Selasky 	struct list_sort_thunk thunk;
1368aad02fb4SHans Petter Selasky 	struct list_head **ar, *le;
1369aad02fb4SHans Petter Selasky 	size_t count, i;
1370aad02fb4SHans Petter Selasky 
1371aad02fb4SHans Petter Selasky 	count = 0;
1372aad02fb4SHans Petter Selasky 	list_for_each(le, head)
1373aad02fb4SHans Petter Selasky 		count++;
1374aad02fb4SHans Petter Selasky 	ar = malloc(sizeof(struct list_head *) * count, M_KMALLOC, M_WAITOK);
1375aad02fb4SHans Petter Selasky 	i = 0;
1376aad02fb4SHans Petter Selasky 	list_for_each(le, head)
1377aad02fb4SHans Petter Selasky 		ar[i++] = le;
1378aad02fb4SHans Petter Selasky 	thunk.cmp = cmp;
1379aad02fb4SHans Petter Selasky 	thunk.priv = priv;
1380aad02fb4SHans Petter Selasky 	qsort_r(ar, count, sizeof(struct list_head *), &thunk, linux_le_cmp);
1381aad02fb4SHans Petter Selasky 	INIT_LIST_HEAD(head);
1382aad02fb4SHans Petter Selasky 	for (i = 0; i < count; i++)
1383aad02fb4SHans Petter Selasky 		list_add_tail(ar[i], head);
1384aad02fb4SHans Petter Selasky 	free(ar, M_KMALLOC);
1385aad02fb4SHans Petter Selasky }
1386aad02fb4SHans Petter Selasky 
13870c510167SHans Petter Selasky void
13880c510167SHans Petter Selasky linux_irq_handler(void *ent)
13890c510167SHans Petter Selasky {
13900c510167SHans Petter Selasky 	struct irq_ent *irqe;
13910c510167SHans Petter Selasky 
13925f50a414SHans Petter Selasky 	linux_set_current(curthread);
13935f50a414SHans Petter Selasky 
13940c510167SHans Petter Selasky 	irqe = ent;
13950c510167SHans Petter Selasky 	irqe->handler(irqe->irq, irqe->arg);
13960c510167SHans Petter Selasky }
13970c510167SHans Petter Selasky 
13981125dbc0SHans Petter Selasky struct linux_cdev *
13991125dbc0SHans Petter Selasky linux_find_cdev(const char *name, unsigned major, unsigned minor)
14001125dbc0SHans Petter Selasky {
14011125dbc0SHans Petter Selasky 	int unit = MKDEV(major, minor);
14021125dbc0SHans Petter Selasky 	struct cdev *cdev;
14031125dbc0SHans Petter Selasky 
14041125dbc0SHans Petter Selasky 	dev_lock();
14051125dbc0SHans Petter Selasky 	LIST_FOREACH(cdev, &linuxcdevsw.d_devs, si_list) {
14061125dbc0SHans Petter Selasky 		struct linux_cdev *ldev = cdev->si_drv1;
14071125dbc0SHans Petter Selasky 		if (dev2unit(cdev) == unit &&
14081125dbc0SHans Petter Selasky 		    strcmp(kobject_name(&ldev->kobj), name) == 0) {
14091125dbc0SHans Petter Selasky 			break;
14101125dbc0SHans Petter Selasky 		}
14111125dbc0SHans Petter Selasky 	}
14121125dbc0SHans Petter Selasky 	dev_unlock();
14131125dbc0SHans Petter Selasky 
14141125dbc0SHans Petter Selasky 	return (cdev != NULL ? cdev->si_drv1 : NULL);
14151125dbc0SHans Petter Selasky }
14161125dbc0SHans Petter Selasky 
14171125dbc0SHans Petter Selasky int
14181125dbc0SHans Petter Selasky __register_chrdev(unsigned int major, unsigned int baseminor,
14191125dbc0SHans Petter Selasky     unsigned int count, const char *name,
14201125dbc0SHans Petter Selasky     const struct file_operations *fops)
14211125dbc0SHans Petter Selasky {
14221125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
14231125dbc0SHans Petter Selasky 	int ret = 0;
14241125dbc0SHans Petter Selasky 	int i;
14251125dbc0SHans Petter Selasky 
14261125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
14271125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
14281125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
14291125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
14301125dbc0SHans Petter Selasky 
14311125dbc0SHans Petter Selasky 		ret = cdev_add(cdev, makedev(major, i), 1);
14321125dbc0SHans Petter Selasky 		if (ret != 0)
14331125dbc0SHans Petter Selasky 			break;
14341125dbc0SHans Petter Selasky 	}
14351125dbc0SHans Petter Selasky 	return (ret);
14361125dbc0SHans Petter Selasky }
14371125dbc0SHans Petter Selasky 
14381125dbc0SHans Petter Selasky int
14391125dbc0SHans Petter Selasky __register_chrdev_p(unsigned int major, unsigned int baseminor,
14401125dbc0SHans Petter Selasky     unsigned int count, const char *name,
14411125dbc0SHans Petter Selasky     const struct file_operations *fops, uid_t uid,
14421125dbc0SHans Petter Selasky     gid_t gid, int mode)
14431125dbc0SHans Petter Selasky {
14441125dbc0SHans Petter Selasky 	struct linux_cdev *cdev;
14451125dbc0SHans Petter Selasky 	int ret = 0;
14461125dbc0SHans Petter Selasky 	int i;
14471125dbc0SHans Petter Selasky 
14481125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
14491125dbc0SHans Petter Selasky 		cdev = cdev_alloc();
14501125dbc0SHans Petter Selasky 		cdev_init(cdev, fops);
14511125dbc0SHans Petter Selasky 		kobject_set_name(&cdev->kobj, name);
14521125dbc0SHans Petter Selasky 
14531125dbc0SHans Petter Selasky 		ret = cdev_add_ext(cdev, makedev(major, i), uid, gid, mode);
14541125dbc0SHans Petter Selasky 		if (ret != 0)
14551125dbc0SHans Petter Selasky 			break;
14561125dbc0SHans Petter Selasky 	}
14571125dbc0SHans Petter Selasky 	return (ret);
14581125dbc0SHans Petter Selasky }
14591125dbc0SHans Petter Selasky 
14601125dbc0SHans Petter Selasky void
14611125dbc0SHans Petter Selasky __unregister_chrdev(unsigned int major, unsigned int baseminor,
14621125dbc0SHans Petter Selasky     unsigned int count, const char *name)
14631125dbc0SHans Petter Selasky {
14641125dbc0SHans Petter Selasky 	struct linux_cdev *cdevp;
14651125dbc0SHans Petter Selasky 	int i;
14661125dbc0SHans Petter Selasky 
14671125dbc0SHans Petter Selasky 	for (i = baseminor; i < baseminor + count; i++) {
14681125dbc0SHans Petter Selasky 		cdevp = linux_find_cdev(name, major, i);
14691125dbc0SHans Petter Selasky 		if (cdevp != NULL)
14701125dbc0SHans Petter Selasky 			cdev_del(cdevp);
14711125dbc0SHans Petter Selasky 	}
14721125dbc0SHans Petter Selasky }
14731125dbc0SHans Petter Selasky 
147403219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
147503219fbaSHans Petter Selasky bool linux_cpu_has_clflush;
147603219fbaSHans Petter Selasky #endif
147703219fbaSHans Petter Selasky 
14780c510167SHans Petter Selasky static void
14798d59ecb2SHans Petter Selasky linux_compat_init(void *arg)
14808d59ecb2SHans Petter Selasky {
14818d59ecb2SHans Petter Selasky 	struct sysctl_oid *rootoid;
14828d59ecb2SHans Petter Selasky 	int i;
14838d59ecb2SHans Petter Selasky 
148403219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
148503219fbaSHans Petter Selasky 	linux_cpu_has_clflush = (cpu_feature & CPUID_CLFSH);
148603219fbaSHans Petter Selasky #endif
1487e10c4cc0SHans Petter Selasky 
14888d59ecb2SHans Petter Selasky 	rootoid = SYSCTL_ADD_ROOT_NODE(NULL,
14898d59ecb2SHans Petter Selasky 	    OID_AUTO, "sys", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "sys");
149006204f8eSHans Petter Selasky 	kobject_init(&linux_class_root, &linux_class_ktype);
149106204f8eSHans Petter Selasky 	kobject_set_name(&linux_class_root, "class");
149206204f8eSHans Petter Selasky 	linux_class_root.oidp = SYSCTL_ADD_NODE(NULL, SYSCTL_CHILDREN(rootoid),
14938d59ecb2SHans Petter Selasky 	    OID_AUTO, "class", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "class");
149406204f8eSHans Petter Selasky 	kobject_init(&linux_root_device.kobj, &linux_dev_ktype);
149506204f8eSHans Petter Selasky 	kobject_set_name(&linux_root_device.kobj, "device");
149606204f8eSHans Petter Selasky 	linux_root_device.kobj.oidp = SYSCTL_ADD_NODE(NULL,
14978d59ecb2SHans Petter Selasky 	    SYSCTL_CHILDREN(rootoid), OID_AUTO, "device", CTLFLAG_RD, NULL,
14988d59ecb2SHans Petter Selasky 	    "device");
149906204f8eSHans Petter Selasky 	linux_root_device.bsddev = root_bus;
150006204f8eSHans Petter Selasky 	linux_class_misc.name = "misc";
150106204f8eSHans Petter Selasky 	class_register(&linux_class_misc);
15028d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_drivers);
15038d59ecb2SHans Petter Selasky 	INIT_LIST_HEAD(&pci_devices);
15048d59ecb2SHans Petter Selasky 	spin_lock_init(&pci_lock);
15058d59ecb2SHans Petter Selasky 	mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF);
15068d59ecb2SHans Petter Selasky 	for (i = 0; i < VMMAP_HASH_SIZE; i++)
15078d59ecb2SHans Petter Selasky 		LIST_INIT(&vmmaphead[i]);
15088d59ecb2SHans Petter Selasky }
15098d59ecb2SHans Petter Selasky SYSINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_init, NULL);
15108d59ecb2SHans Petter Selasky 
15118d59ecb2SHans Petter Selasky static void
15128d59ecb2SHans Petter Selasky linux_compat_uninit(void *arg)
15138d59ecb2SHans Petter Selasky {
151406204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_root);
151506204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_root_device.kobj);
151606204f8eSHans Petter Selasky 	linux_kobject_kfree_name(&linux_class_misc.kobj);
15178d59ecb2SHans Petter Selasky }
15188d59ecb2SHans Petter Selasky SYSUNINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_uninit, NULL);
1519f727a767SHans Petter Selasky 
1520f727a767SHans Petter Selasky /*
1521f727a767SHans Petter Selasky  * NOTE: Linux frequently uses "unsigned long" for pointer to integer
1522f727a767SHans Petter Selasky  * conversion and vice versa, where in FreeBSD "uintptr_t" would be
1523f727a767SHans Petter Selasky  * used. Assert these types have the same size, else some parts of the
1524f727a767SHans Petter Selasky  * LinuxKPI may not work like expected:
1525f727a767SHans Petter Selasky  */
1526f727a767SHans Petter Selasky CTASSERT(sizeof(unsigned long) == sizeof(uintptr_t));
1527