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