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 548d59ecb2SHans Petter Selasky #include <linux/kobject.h> 558d59ecb2SHans Petter Selasky #include <linux/device.h> 568d59ecb2SHans Petter Selasky #include <linux/slab.h> 578d59ecb2SHans Petter Selasky #include <linux/module.h> 588d59ecb2SHans Petter Selasky #include <linux/cdev.h> 598d59ecb2SHans Petter Selasky #include <linux/file.h> 608d59ecb2SHans Petter Selasky #include <linux/sysfs.h> 618d59ecb2SHans Petter Selasky #include <linux/mm.h> 628d59ecb2SHans Petter Selasky #include <linux/io.h> 638d59ecb2SHans Petter Selasky #include <linux/vmalloc.h> 648d59ecb2SHans Petter Selasky #include <linux/netdevice.h> 658d59ecb2SHans Petter Selasky #include <linux/timer.h> 6655d445d3SHans Petter Selasky #include <linux/workqueue.h> 67e10c4cc0SHans Petter Selasky #include <linux/rcupdate.h> 680c510167SHans Petter Selasky #include <linux/interrupt.h> 698d59ecb2SHans Petter Selasky 708d59ecb2SHans Petter Selasky #include <vm/vm_pager.h> 718d59ecb2SHans Petter Selasky 728d59ecb2SHans Petter Selasky MALLOC_DEFINE(M_KMALLOC, "linux", "Linux kmalloc compat"); 738d59ecb2SHans Petter Selasky 748d59ecb2SHans Petter Selasky #include <linux/rbtree.h> 758d59ecb2SHans Petter Selasky /* Undo Linux compat changes. */ 768d59ecb2SHans Petter Selasky #undef RB_ROOT 778d59ecb2SHans Petter Selasky #undef file 788d59ecb2SHans Petter Selasky #undef cdev 798d59ecb2SHans Petter Selasky #define RB_ROOT(head) (head)->rbh_root 808d59ecb2SHans Petter Selasky 8106204f8eSHans Petter Selasky struct kobject linux_class_root; 8206204f8eSHans Petter Selasky struct device linux_root_device; 8306204f8eSHans Petter Selasky struct class linux_class_misc; 848d59ecb2SHans Petter Selasky struct list_head pci_drivers; 858d59ecb2SHans Petter Selasky struct list_head pci_devices; 868d59ecb2SHans Petter Selasky struct net init_net; 878d59ecb2SHans Petter Selasky spinlock_t pci_lock; 88e10c4cc0SHans Petter Selasky struct sx linux_global_rcu_lock; 898d59ecb2SHans Petter Selasky 908d59ecb2SHans Petter Selasky unsigned long linux_timer_hz_mask; 918d59ecb2SHans Petter Selasky 928d59ecb2SHans Petter Selasky int 938d59ecb2SHans Petter Selasky panic_cmp(struct rb_node *one, struct rb_node *two) 948d59ecb2SHans Petter Selasky { 958d59ecb2SHans Petter Selasky panic("no cmp"); 968d59ecb2SHans Petter Selasky } 978d59ecb2SHans Petter Selasky 988d59ecb2SHans Petter Selasky RB_GENERATE(linux_root, rb_node, __entry, panic_cmp); 998d59ecb2SHans Petter Selasky 10026019405SHans Petter Selasky int 10126019405SHans Petter Selasky kobject_set_name_vargs(struct kobject *kobj, const char *fmt, va_list args) 10226019405SHans Petter Selasky { 10326019405SHans Petter Selasky va_list tmp_va; 10426019405SHans Petter Selasky int len; 10526019405SHans Petter Selasky char *old; 10626019405SHans Petter Selasky char *name; 10726019405SHans Petter Selasky char dummy; 10826019405SHans Petter Selasky 10926019405SHans Petter Selasky old = kobj->name; 11026019405SHans Petter Selasky 11126019405SHans Petter Selasky if (old && fmt == NULL) 11226019405SHans Petter Selasky return (0); 11326019405SHans Petter Selasky 11426019405SHans Petter Selasky /* compute length of string */ 11526019405SHans Petter Selasky va_copy(tmp_va, args); 11626019405SHans Petter Selasky len = vsnprintf(&dummy, 0, fmt, tmp_va); 11726019405SHans Petter Selasky va_end(tmp_va); 11826019405SHans Petter Selasky 11926019405SHans Petter Selasky /* account for zero termination */ 12026019405SHans Petter Selasky len++; 12126019405SHans Petter Selasky 12226019405SHans Petter Selasky /* check for error */ 12326019405SHans Petter Selasky if (len < 1) 12426019405SHans Petter Selasky return (-EINVAL); 12526019405SHans Petter Selasky 12626019405SHans Petter Selasky /* allocate memory for string */ 12726019405SHans Petter Selasky name = kzalloc(len, GFP_KERNEL); 12826019405SHans Petter Selasky if (name == NULL) 12926019405SHans Petter Selasky return (-ENOMEM); 13026019405SHans Petter Selasky vsnprintf(name, len, fmt, args); 13126019405SHans Petter Selasky kobj->name = name; 13226019405SHans Petter Selasky 13326019405SHans Petter Selasky /* free old string */ 13426019405SHans Petter Selasky kfree(old); 13526019405SHans Petter Selasky 13626019405SHans Petter Selasky /* filter new string */ 13726019405SHans Petter Selasky for (; *name != '\0'; name++) 13826019405SHans Petter Selasky if (*name == '/') 13926019405SHans Petter Selasky *name = '!'; 14026019405SHans Petter Selasky return (0); 14126019405SHans Petter Selasky } 14226019405SHans Petter Selasky 1438d59ecb2SHans Petter Selasky int 1448d59ecb2SHans Petter Selasky kobject_set_name(struct kobject *kobj, const char *fmt, ...) 1458d59ecb2SHans Petter Selasky { 1468d59ecb2SHans Petter Selasky va_list args; 1478d59ecb2SHans Petter Selasky int error; 1488d59ecb2SHans Petter Selasky 1498d59ecb2SHans Petter Selasky va_start(args, fmt); 1508d59ecb2SHans Petter Selasky error = kobject_set_name_vargs(kobj, fmt, args); 1518d59ecb2SHans Petter Selasky va_end(args); 1528d59ecb2SHans Petter Selasky 1538d59ecb2SHans Petter Selasky return (error); 1548d59ecb2SHans Petter Selasky } 1558d59ecb2SHans Petter Selasky 15606204f8eSHans Petter Selasky static int 1578d59ecb2SHans Petter Selasky kobject_add_complete(struct kobject *kobj, struct kobject *parent) 1588d59ecb2SHans Petter Selasky { 15906204f8eSHans Petter Selasky const struct kobj_type *t; 1608d59ecb2SHans Petter Selasky int error; 1618d59ecb2SHans Petter Selasky 162337cb9f0SHans Petter Selasky kobj->parent = parent; 1638d59ecb2SHans Petter Selasky error = sysfs_create_dir(kobj); 1648d59ecb2SHans Petter Selasky if (error == 0 && kobj->ktype && kobj->ktype->default_attrs) { 1658d59ecb2SHans Petter Selasky struct attribute **attr; 1668d59ecb2SHans Petter Selasky t = kobj->ktype; 1678d59ecb2SHans Petter Selasky 1688d59ecb2SHans Petter Selasky for (attr = t->default_attrs; *attr != NULL; attr++) { 1698d59ecb2SHans Petter Selasky error = sysfs_create_file(kobj, *attr); 1708d59ecb2SHans Petter Selasky if (error) 1718d59ecb2SHans Petter Selasky break; 1728d59ecb2SHans Petter Selasky } 1738d59ecb2SHans Petter Selasky if (error) 1748d59ecb2SHans Petter Selasky sysfs_remove_dir(kobj); 1758d59ecb2SHans Petter Selasky 1768d59ecb2SHans Petter Selasky } 1778d59ecb2SHans Petter Selasky return (error); 1788d59ecb2SHans Petter Selasky } 1798d59ecb2SHans Petter Selasky 1808d59ecb2SHans Petter Selasky int 1818d59ecb2SHans Petter Selasky kobject_add(struct kobject *kobj, struct kobject *parent, const char *fmt, ...) 1828d59ecb2SHans Petter Selasky { 1838d59ecb2SHans Petter Selasky va_list args; 1848d59ecb2SHans Petter Selasky int error; 1858d59ecb2SHans Petter Selasky 1868d59ecb2SHans Petter Selasky va_start(args, fmt); 1878d59ecb2SHans Petter Selasky error = kobject_set_name_vargs(kobj, fmt, args); 1888d59ecb2SHans Petter Selasky va_end(args); 1898d59ecb2SHans Petter Selasky if (error) 1908d59ecb2SHans Petter Selasky return (error); 1918d59ecb2SHans Petter Selasky 1928d59ecb2SHans Petter Selasky return kobject_add_complete(kobj, parent); 1938d59ecb2SHans Petter Selasky } 1948d59ecb2SHans Petter Selasky 1958d59ecb2SHans Petter Selasky void 19606204f8eSHans Petter Selasky linux_kobject_release(struct kref *kref) 1978d59ecb2SHans Petter Selasky { 1988d59ecb2SHans Petter Selasky struct kobject *kobj; 1998d59ecb2SHans Petter Selasky char *name; 2008d59ecb2SHans Petter Selasky 2018d59ecb2SHans Petter Selasky kobj = container_of(kref, struct kobject, kref); 2028d59ecb2SHans Petter Selasky sysfs_remove_dir(kobj); 2038d59ecb2SHans Petter Selasky name = kobj->name; 2048d59ecb2SHans Petter Selasky if (kobj->ktype && kobj->ktype->release) 2058d59ecb2SHans Petter Selasky kobj->ktype->release(kobj); 2068d59ecb2SHans Petter Selasky kfree(name); 2078d59ecb2SHans Petter Selasky } 2088d59ecb2SHans Petter Selasky 2098d59ecb2SHans Petter Selasky static void 21006204f8eSHans Petter Selasky linux_kobject_kfree(struct kobject *kobj) 2118d59ecb2SHans Petter Selasky { 2128d59ecb2SHans Petter Selasky kfree(kobj); 2138d59ecb2SHans Petter Selasky } 2148d59ecb2SHans Petter Selasky 2158d59ecb2SHans Petter Selasky static void 21606204f8eSHans Petter Selasky linux_kobject_kfree_name(struct kobject *kobj) 2178d59ecb2SHans Petter Selasky { 2188d59ecb2SHans Petter Selasky if (kobj) { 2198d59ecb2SHans Petter Selasky kfree(kobj->name); 2208d59ecb2SHans Petter Selasky } 2218d59ecb2SHans Petter Selasky } 2228d59ecb2SHans Petter Selasky 22306204f8eSHans Petter Selasky const struct kobj_type linux_kfree_type = { 22406204f8eSHans Petter Selasky .release = linux_kobject_kfree 22506204f8eSHans Petter Selasky }; 2268d59ecb2SHans Petter Selasky 2278d59ecb2SHans Petter Selasky static void 22806204f8eSHans Petter Selasky linux_device_release(struct device *dev) 2298d59ecb2SHans Petter Selasky { 23006204f8eSHans Petter Selasky pr_debug("linux_device_release: %s\n", dev_name(dev)); 2318d59ecb2SHans Petter Selasky kfree(dev); 2328d59ecb2SHans Petter Selasky } 2338d59ecb2SHans Petter Selasky 23406204f8eSHans Petter Selasky static ssize_t 23506204f8eSHans Petter Selasky linux_class_show(struct kobject *kobj, struct attribute *attr, char *buf) 23606204f8eSHans Petter Selasky { 23706204f8eSHans Petter Selasky struct class_attribute *dattr; 23806204f8eSHans Petter Selasky ssize_t error; 23906204f8eSHans Petter Selasky 24006204f8eSHans Petter Selasky dattr = container_of(attr, struct class_attribute, attr); 24106204f8eSHans Petter Selasky error = -EIO; 24206204f8eSHans Petter Selasky if (dattr->show) 24306204f8eSHans Petter Selasky error = dattr->show(container_of(kobj, struct class, kobj), 24406204f8eSHans Petter Selasky dattr, buf); 24506204f8eSHans Petter Selasky return (error); 24606204f8eSHans Petter Selasky } 24706204f8eSHans Petter Selasky 24806204f8eSHans Petter Selasky static ssize_t 24906204f8eSHans Petter Selasky linux_class_store(struct kobject *kobj, struct attribute *attr, const char *buf, 25006204f8eSHans Petter Selasky size_t count) 25106204f8eSHans Petter Selasky { 25206204f8eSHans Petter Selasky struct class_attribute *dattr; 25306204f8eSHans Petter Selasky ssize_t error; 25406204f8eSHans Petter Selasky 25506204f8eSHans Petter Selasky dattr = container_of(attr, struct class_attribute, attr); 25606204f8eSHans Petter Selasky error = -EIO; 25706204f8eSHans Petter Selasky if (dattr->store) 25806204f8eSHans Petter Selasky error = dattr->store(container_of(kobj, struct class, kobj), 25906204f8eSHans Petter Selasky dattr, buf, count); 26006204f8eSHans Petter Selasky return (error); 26106204f8eSHans Petter Selasky } 26206204f8eSHans Petter Selasky 26306204f8eSHans Petter Selasky static void 26406204f8eSHans Petter Selasky linux_class_release(struct kobject *kobj) 26506204f8eSHans Petter Selasky { 26606204f8eSHans Petter Selasky struct class *class; 26706204f8eSHans Petter Selasky 26806204f8eSHans Petter Selasky class = container_of(kobj, struct class, kobj); 26906204f8eSHans Petter Selasky if (class->class_release) 27006204f8eSHans Petter Selasky class->class_release(class); 27106204f8eSHans Petter Selasky } 27206204f8eSHans Petter Selasky 27306204f8eSHans Petter Selasky static const struct sysfs_ops linux_class_sysfs = { 27406204f8eSHans Petter Selasky .show = linux_class_show, 27506204f8eSHans Petter Selasky .store = linux_class_store, 27606204f8eSHans Petter Selasky }; 27706204f8eSHans Petter Selasky 27806204f8eSHans Petter Selasky const struct kobj_type linux_class_ktype = { 27906204f8eSHans Petter Selasky .release = linux_class_release, 28006204f8eSHans Petter Selasky .sysfs_ops = &linux_class_sysfs 28106204f8eSHans Petter Selasky }; 28206204f8eSHans Petter Selasky 28306204f8eSHans Petter Selasky static void 28406204f8eSHans Petter Selasky linux_dev_release(struct kobject *kobj) 28506204f8eSHans Petter Selasky { 28606204f8eSHans Petter Selasky struct device *dev; 28706204f8eSHans Petter Selasky 28806204f8eSHans Petter Selasky dev = container_of(kobj, struct device, kobj); 28906204f8eSHans Petter Selasky /* This is the precedence defined by linux. */ 29006204f8eSHans Petter Selasky if (dev->release) 29106204f8eSHans Petter Selasky dev->release(dev); 29206204f8eSHans Petter Selasky else if (dev->class && dev->class->dev_release) 29306204f8eSHans Petter Selasky dev->class->dev_release(dev); 29406204f8eSHans Petter Selasky } 29506204f8eSHans Petter Selasky 29606204f8eSHans Petter Selasky static ssize_t 29706204f8eSHans Petter Selasky linux_dev_show(struct kobject *kobj, struct attribute *attr, char *buf) 29806204f8eSHans Petter Selasky { 29906204f8eSHans Petter Selasky struct device_attribute *dattr; 30006204f8eSHans Petter Selasky ssize_t error; 30106204f8eSHans Petter Selasky 30206204f8eSHans Petter Selasky dattr = container_of(attr, struct device_attribute, attr); 30306204f8eSHans Petter Selasky error = -EIO; 30406204f8eSHans Petter Selasky if (dattr->show) 30506204f8eSHans Petter Selasky error = dattr->show(container_of(kobj, struct device, kobj), 30606204f8eSHans Petter Selasky dattr, buf); 30706204f8eSHans Petter Selasky return (error); 30806204f8eSHans Petter Selasky } 30906204f8eSHans Petter Selasky 31006204f8eSHans Petter Selasky static ssize_t 31106204f8eSHans Petter Selasky linux_dev_store(struct kobject *kobj, struct attribute *attr, const char *buf, 31206204f8eSHans Petter Selasky size_t count) 31306204f8eSHans Petter Selasky { 31406204f8eSHans Petter Selasky struct device_attribute *dattr; 31506204f8eSHans Petter Selasky ssize_t error; 31606204f8eSHans Petter Selasky 31706204f8eSHans Petter Selasky dattr = container_of(attr, struct device_attribute, attr); 31806204f8eSHans Petter Selasky error = -EIO; 31906204f8eSHans Petter Selasky if (dattr->store) 32006204f8eSHans Petter Selasky error = dattr->store(container_of(kobj, struct device, kobj), 32106204f8eSHans Petter Selasky dattr, buf, count); 32206204f8eSHans Petter Selasky return (error); 32306204f8eSHans Petter Selasky } 32406204f8eSHans Petter Selasky 32506204f8eSHans Petter Selasky static const struct sysfs_ops linux_dev_sysfs = { 32606204f8eSHans Petter Selasky .show = linux_dev_show, 32706204f8eSHans Petter Selasky .store = linux_dev_store, 32806204f8eSHans Petter Selasky }; 32906204f8eSHans Petter Selasky 33006204f8eSHans Petter Selasky const struct kobj_type linux_dev_ktype = { 33106204f8eSHans Petter Selasky .release = linux_dev_release, 33206204f8eSHans Petter Selasky .sysfs_ops = &linux_dev_sysfs 33306204f8eSHans Petter Selasky }; 33406204f8eSHans Petter Selasky 3358d59ecb2SHans Petter Selasky struct device * 3368d59ecb2SHans Petter Selasky device_create(struct class *class, struct device *parent, dev_t devt, 3378d59ecb2SHans Petter Selasky void *drvdata, const char *fmt, ...) 3388d59ecb2SHans Petter Selasky { 3398d59ecb2SHans Petter Selasky struct device *dev; 3408d59ecb2SHans Petter Selasky va_list args; 3418d59ecb2SHans Petter Selasky 3428d59ecb2SHans Petter Selasky dev = kzalloc(sizeof(*dev), M_WAITOK); 3438d59ecb2SHans Petter Selasky dev->parent = parent; 3448d59ecb2SHans Petter Selasky dev->class = class; 3458d59ecb2SHans Petter Selasky dev->devt = devt; 3468d59ecb2SHans Petter Selasky dev->driver_data = drvdata; 34706204f8eSHans Petter Selasky dev->release = linux_device_release; 3488d59ecb2SHans Petter Selasky va_start(args, fmt); 3498d59ecb2SHans Petter Selasky kobject_set_name_vargs(&dev->kobj, fmt, args); 3508d59ecb2SHans Petter Selasky va_end(args); 3518d59ecb2SHans Petter Selasky device_register(dev); 3528d59ecb2SHans Petter Selasky 3538d59ecb2SHans Petter Selasky return (dev); 3548d59ecb2SHans Petter Selasky } 3558d59ecb2SHans Petter Selasky 3568d59ecb2SHans Petter Selasky int 35706204f8eSHans Petter Selasky kobject_init_and_add(struct kobject *kobj, const struct kobj_type *ktype, 3588d59ecb2SHans Petter Selasky struct kobject *parent, const char *fmt, ...) 3598d59ecb2SHans Petter Selasky { 3608d59ecb2SHans Petter Selasky va_list args; 3618d59ecb2SHans Petter Selasky int error; 3628d59ecb2SHans Petter Selasky 3638d59ecb2SHans Petter Selasky kobject_init(kobj, ktype); 3648d59ecb2SHans Petter Selasky kobj->ktype = ktype; 3658d59ecb2SHans Petter Selasky kobj->parent = parent; 3668d59ecb2SHans Petter Selasky kobj->name = NULL; 3678d59ecb2SHans Petter Selasky 3688d59ecb2SHans Petter Selasky va_start(args, fmt); 3698d59ecb2SHans Petter Selasky error = kobject_set_name_vargs(kobj, fmt, args); 3708d59ecb2SHans Petter Selasky va_end(args); 3718d59ecb2SHans Petter Selasky if (error) 3728d59ecb2SHans Petter Selasky return (error); 3738d59ecb2SHans Petter Selasky return kobject_add_complete(kobj, parent); 3748d59ecb2SHans Petter Selasky } 3758d59ecb2SHans Petter Selasky 3768d59ecb2SHans Petter Selasky static void 377*464d20bcSHans Petter Selasky linux_set_current(struct thread *td, struct task_struct *t) 378*464d20bcSHans Petter Selasky { 379*464d20bcSHans Petter Selasky memset(t, 0, sizeof(*t)); 380*464d20bcSHans Petter Selasky task_struct_fill(td, t); 381*464d20bcSHans Petter Selasky task_struct_set(td, t); 382*464d20bcSHans Petter Selasky } 383*464d20bcSHans Petter Selasky 384*464d20bcSHans Petter Selasky static void 385*464d20bcSHans Petter Selasky linux_clear_current(struct thread *td) 386*464d20bcSHans Petter Selasky { 387*464d20bcSHans Petter Selasky task_struct_set(td, NULL); 388*464d20bcSHans Petter Selasky } 389*464d20bcSHans Petter Selasky 390*464d20bcSHans Petter Selasky static void 3918d59ecb2SHans Petter Selasky linux_file_dtor(void *cdp) 3928d59ecb2SHans Petter Selasky { 3938d59ecb2SHans Petter Selasky struct linux_file *filp; 394*464d20bcSHans Petter Selasky struct task_struct t; 395*464d20bcSHans Petter Selasky struct thread *td; 3968d59ecb2SHans Petter Selasky 397*464d20bcSHans Petter Selasky td = curthread; 3988d59ecb2SHans Petter Selasky filp = cdp; 399*464d20bcSHans Petter Selasky linux_set_current(td, &t); 4008d59ecb2SHans Petter Selasky filp->f_op->release(filp->f_vnode, filp); 401*464d20bcSHans Petter Selasky linux_clear_current(td); 4028d59ecb2SHans Petter Selasky vdrop(filp->f_vnode); 4038d59ecb2SHans Petter Selasky kfree(filp); 4048d59ecb2SHans Petter Selasky } 4058d59ecb2SHans Petter Selasky 4068d59ecb2SHans Petter Selasky static int 4078d59ecb2SHans Petter Selasky linux_dev_open(struct cdev *dev, int oflags, int devtype, struct thread *td) 4088d59ecb2SHans Petter Selasky { 4098d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 4108d59ecb2SHans Petter Selasky struct linux_file *filp; 411*464d20bcSHans Petter Selasky struct task_struct t; 4128d59ecb2SHans Petter Selasky struct file *file; 4138d59ecb2SHans Petter Selasky int error; 4148d59ecb2SHans Petter Selasky 415*464d20bcSHans Petter Selasky file = td->td_fpop; 4168d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 4178d59ecb2SHans Petter Selasky if (ldev == NULL) 4188d59ecb2SHans Petter Selasky return (ENODEV); 4198d59ecb2SHans Petter Selasky filp = kzalloc(sizeof(*filp), GFP_KERNEL); 4208d59ecb2SHans Petter Selasky filp->f_dentry = &filp->f_dentry_store; 4218d59ecb2SHans Petter Selasky filp->f_op = ldev->ops; 4228d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 4238d59ecb2SHans Petter Selasky vhold(file->f_vnode); 4248d59ecb2SHans Petter Selasky filp->f_vnode = file->f_vnode; 425*464d20bcSHans Petter Selasky linux_set_current(td, &t); 4268d59ecb2SHans Petter Selasky if (filp->f_op->open) { 4278d59ecb2SHans Petter Selasky error = -filp->f_op->open(file->f_vnode, filp); 4288d59ecb2SHans Petter Selasky if (error) { 4298d59ecb2SHans Petter Selasky kfree(filp); 430*464d20bcSHans Petter Selasky goto done; 4318d59ecb2SHans Petter Selasky } 4328d59ecb2SHans Petter Selasky } 4338d59ecb2SHans Petter Selasky error = devfs_set_cdevpriv(filp, linux_file_dtor); 4348d59ecb2SHans Petter Selasky if (error) { 4358d59ecb2SHans Petter Selasky filp->f_op->release(file->f_vnode, filp); 4368d59ecb2SHans Petter Selasky kfree(filp); 4378d59ecb2SHans Petter Selasky } 438*464d20bcSHans Petter Selasky done: 439*464d20bcSHans Petter Selasky linux_clear_current(td); 440*464d20bcSHans Petter Selasky return (error); 4418d59ecb2SHans Petter Selasky } 4428d59ecb2SHans Petter Selasky 4438d59ecb2SHans Petter Selasky static int 4448d59ecb2SHans Petter Selasky linux_dev_close(struct cdev *dev, int fflag, int devtype, struct thread *td) 4458d59ecb2SHans Petter Selasky { 4468d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 4478d59ecb2SHans Petter Selasky struct linux_file *filp; 4488d59ecb2SHans Petter Selasky struct file *file; 4498d59ecb2SHans Petter Selasky int error; 4508d59ecb2SHans Petter Selasky 451*464d20bcSHans Petter Selasky file = td->td_fpop; 4528d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 4538d59ecb2SHans Petter Selasky if (ldev == NULL) 4548d59ecb2SHans Petter Selasky return (0); 4558d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 4568d59ecb2SHans Petter Selasky return (error); 4578d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 4588d59ecb2SHans Petter Selasky devfs_clear_cdevpriv(); 4598d59ecb2SHans Petter Selasky 4608d59ecb2SHans Petter Selasky 4618d59ecb2SHans Petter Selasky return (0); 4628d59ecb2SHans Petter Selasky } 4638d59ecb2SHans Petter Selasky 4648d59ecb2SHans Petter Selasky static int 4658d59ecb2SHans Petter Selasky linux_dev_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag, 4668d59ecb2SHans Petter Selasky struct thread *td) 4678d59ecb2SHans Petter Selasky { 4688d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 4698d59ecb2SHans Petter Selasky struct linux_file *filp; 470*464d20bcSHans Petter Selasky struct task_struct t; 4718d59ecb2SHans Petter Selasky struct file *file; 4728d59ecb2SHans Petter Selasky int error; 4738d59ecb2SHans Petter Selasky 474*464d20bcSHans Petter Selasky file = td->td_fpop; 4758d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 4768d59ecb2SHans Petter Selasky if (ldev == NULL) 4778d59ecb2SHans Petter Selasky return (0); 4788d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 4798d59ecb2SHans Petter Selasky return (error); 4808d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 481*464d20bcSHans Petter Selasky linux_set_current(td, &t); 4828d59ecb2SHans Petter Selasky /* 4838d59ecb2SHans Petter Selasky * Linux does not have a generic ioctl copyin/copyout layer. All 4848d59ecb2SHans Petter Selasky * linux ioctls must be converted to void ioctls which pass a 4858d59ecb2SHans Petter Selasky * pointer to the address of the data. We want the actual user 4868d59ecb2SHans Petter Selasky * address so we dereference here. 4878d59ecb2SHans Petter Selasky */ 4888d59ecb2SHans Petter Selasky data = *(void **)data; 4898d59ecb2SHans Petter Selasky if (filp->f_op->unlocked_ioctl) 4908d59ecb2SHans Petter Selasky error = -filp->f_op->unlocked_ioctl(filp, cmd, (u_long)data); 4918d59ecb2SHans Petter Selasky else 4928d59ecb2SHans Petter Selasky error = ENOTTY; 493*464d20bcSHans Petter Selasky linux_clear_current(td); 4948d59ecb2SHans Petter Selasky 4958d59ecb2SHans Petter Selasky return (error); 4968d59ecb2SHans Petter Selasky } 4978d59ecb2SHans Petter Selasky 4988d59ecb2SHans Petter Selasky static int 4998d59ecb2SHans Petter Selasky linux_dev_read(struct cdev *dev, struct uio *uio, int ioflag) 5008d59ecb2SHans Petter Selasky { 5018d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 5028d59ecb2SHans Petter Selasky struct linux_file *filp; 503*464d20bcSHans Petter Selasky struct task_struct t; 504*464d20bcSHans Petter Selasky struct thread *td; 5058d59ecb2SHans Petter Selasky struct file *file; 5068d59ecb2SHans Petter Selasky ssize_t bytes; 5078d59ecb2SHans Petter Selasky int error; 5088d59ecb2SHans Petter Selasky 509*464d20bcSHans Petter Selasky td = curthread; 510*464d20bcSHans Petter Selasky file = td->td_fpop; 5118d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 5128d59ecb2SHans Petter Selasky if (ldev == NULL) 5138d59ecb2SHans Petter Selasky return (0); 5148d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 5158d59ecb2SHans Petter Selasky return (error); 5168d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 517b3c89b5aSHans Petter Selasky /* XXX no support for I/O vectors currently */ 5188d59ecb2SHans Petter Selasky if (uio->uio_iovcnt != 1) 519b3c89b5aSHans Petter Selasky return (EOPNOTSUPP); 520*464d20bcSHans Petter Selasky linux_set_current(td, &t); 5218d59ecb2SHans Petter Selasky if (filp->f_op->read) { 5228d59ecb2SHans Petter Selasky bytes = filp->f_op->read(filp, uio->uio_iov->iov_base, 5238d59ecb2SHans Petter Selasky uio->uio_iov->iov_len, &uio->uio_offset); 5248d59ecb2SHans Petter Selasky if (bytes >= 0) { 5258d59ecb2SHans Petter Selasky uio->uio_iov->iov_base = 5268d59ecb2SHans Petter Selasky ((uint8_t *)uio->uio_iov->iov_base) + bytes; 5278d59ecb2SHans Petter Selasky uio->uio_iov->iov_len -= bytes; 5288d59ecb2SHans Petter Selasky uio->uio_resid -= bytes; 5298d59ecb2SHans Petter Selasky } else 5308d59ecb2SHans Petter Selasky error = -bytes; 5318d59ecb2SHans Petter Selasky } else 5328d59ecb2SHans Petter Selasky error = ENXIO; 533*464d20bcSHans Petter Selasky linux_clear_current(td); 5348d59ecb2SHans Petter Selasky 5358d59ecb2SHans Petter Selasky return (error); 5368d59ecb2SHans Petter Selasky } 5378d59ecb2SHans Petter Selasky 5388d59ecb2SHans Petter Selasky static int 5398d59ecb2SHans Petter Selasky linux_dev_write(struct cdev *dev, struct uio *uio, int ioflag) 5408d59ecb2SHans Petter Selasky { 5418d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 5428d59ecb2SHans Petter Selasky struct linux_file *filp; 543*464d20bcSHans Petter Selasky struct task_struct t; 544*464d20bcSHans Petter Selasky struct thread *td; 5458d59ecb2SHans Petter Selasky struct file *file; 5468d59ecb2SHans Petter Selasky ssize_t bytes; 5478d59ecb2SHans Petter Selasky int error; 5488d59ecb2SHans Petter Selasky 549*464d20bcSHans Petter Selasky td = curthread; 550*464d20bcSHans Petter Selasky file = td->td_fpop; 5518d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 5528d59ecb2SHans Petter Selasky if (ldev == NULL) 5538d59ecb2SHans Petter Selasky return (0); 5548d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 5558d59ecb2SHans Petter Selasky return (error); 5568d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 557b3c89b5aSHans Petter Selasky /* XXX no support for I/O vectors currently */ 5588d59ecb2SHans Petter Selasky if (uio->uio_iovcnt != 1) 559b3c89b5aSHans Petter Selasky return (EOPNOTSUPP); 560*464d20bcSHans Petter Selasky linux_set_current(td, &t); 5618d59ecb2SHans Petter Selasky if (filp->f_op->write) { 5628d59ecb2SHans Petter Selasky bytes = filp->f_op->write(filp, uio->uio_iov->iov_base, 5638d59ecb2SHans Petter Selasky uio->uio_iov->iov_len, &uio->uio_offset); 5648d59ecb2SHans Petter Selasky if (bytes >= 0) { 5658d59ecb2SHans Petter Selasky uio->uio_iov->iov_base = 5668d59ecb2SHans Petter Selasky ((uint8_t *)uio->uio_iov->iov_base) + bytes; 5678d59ecb2SHans Petter Selasky uio->uio_iov->iov_len -= bytes; 5688d59ecb2SHans Petter Selasky uio->uio_resid -= bytes; 5698d59ecb2SHans Petter Selasky } else 5708d59ecb2SHans Petter Selasky error = -bytes; 5718d59ecb2SHans Petter Selasky } else 5728d59ecb2SHans Petter Selasky error = ENXIO; 573*464d20bcSHans Petter Selasky linux_clear_current(td); 5748d59ecb2SHans Petter Selasky 5758d59ecb2SHans Petter Selasky return (error); 5768d59ecb2SHans Petter Selasky } 5778d59ecb2SHans Petter Selasky 5788d59ecb2SHans Petter Selasky static int 5798d59ecb2SHans Petter Selasky linux_dev_poll(struct cdev *dev, int events, struct thread *td) 5808d59ecb2SHans Petter Selasky { 5818d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 5828d59ecb2SHans Petter Selasky struct linux_file *filp; 583*464d20bcSHans Petter Selasky struct task_struct t; 5848d59ecb2SHans Petter Selasky struct file *file; 5858d59ecb2SHans Petter Selasky int revents; 5868d59ecb2SHans Petter Selasky int error; 5878d59ecb2SHans Petter Selasky 588*464d20bcSHans Petter Selasky file = td->td_fpop; 5898d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 5908d59ecb2SHans Petter Selasky if (ldev == NULL) 5918d59ecb2SHans Petter Selasky return (0); 5928d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 5938d59ecb2SHans Petter Selasky return (error); 5948d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 595*464d20bcSHans Petter Selasky linux_set_current(td, &t); 5968d59ecb2SHans Petter Selasky if (filp->f_op->poll) 5978d59ecb2SHans Petter Selasky revents = filp->f_op->poll(filp, NULL) & events; 5988d59ecb2SHans Petter Selasky else 5998d59ecb2SHans Petter Selasky revents = 0; 600*464d20bcSHans Petter Selasky linux_clear_current(td); 6018d59ecb2SHans Petter Selasky 6028d59ecb2SHans Petter Selasky return (revents); 6038d59ecb2SHans Petter Selasky } 6048d59ecb2SHans Petter Selasky 6058d59ecb2SHans Petter Selasky static int 6068d59ecb2SHans Petter Selasky linux_dev_mmap_single(struct cdev *dev, vm_ooffset_t *offset, 6078d59ecb2SHans Petter Selasky vm_size_t size, struct vm_object **object, int nprot) 6088d59ecb2SHans Petter Selasky { 6098d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 6108d59ecb2SHans Petter Selasky struct linux_file *filp; 611*464d20bcSHans Petter Selasky struct thread *td; 612*464d20bcSHans Petter Selasky struct task_struct t; 6138d59ecb2SHans Petter Selasky struct file *file; 6148d59ecb2SHans Petter Selasky struct vm_area_struct vma; 6158d59ecb2SHans Petter Selasky int error; 6168d59ecb2SHans Petter Selasky 617*464d20bcSHans Petter Selasky td = curthread; 618*464d20bcSHans Petter Selasky file = td->td_fpop; 6198d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 6208d59ecb2SHans Petter Selasky if (ldev == NULL) 6218d59ecb2SHans Petter Selasky return (ENODEV); 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; 625*464d20bcSHans Petter Selasky linux_set_current(td, &t); 6268d59ecb2SHans Petter Selasky vma.vm_start = 0; 6278d59ecb2SHans Petter Selasky vma.vm_end = size; 6288d59ecb2SHans Petter Selasky vma.vm_pgoff = *offset / PAGE_SIZE; 6298d59ecb2SHans Petter Selasky vma.vm_pfn = 0; 630e23cd1b9SJohn Baldwin vma.vm_page_prot = VM_MEMATTR_DEFAULT; 6318d59ecb2SHans Petter Selasky if (filp->f_op->mmap) { 6328d59ecb2SHans Petter Selasky error = -filp->f_op->mmap(filp, &vma); 6338d59ecb2SHans Petter Selasky if (error == 0) { 6348d59ecb2SHans Petter Selasky struct sglist *sg; 6358d59ecb2SHans Petter Selasky 6368d59ecb2SHans Petter Selasky sg = sglist_alloc(1, M_WAITOK); 6378d59ecb2SHans Petter Selasky sglist_append_phys(sg, 6388d59ecb2SHans Petter Selasky (vm_paddr_t)vma.vm_pfn << PAGE_SHIFT, vma.vm_len); 6398d59ecb2SHans Petter Selasky *object = vm_pager_allocate(OBJT_SG, sg, vma.vm_len, 640*464d20bcSHans Petter Selasky nprot, 0, td->td_ucred); 6418d59ecb2SHans Petter Selasky if (*object == NULL) { 6428d59ecb2SHans Petter Selasky sglist_free(sg); 643*464d20bcSHans Petter Selasky error = EINVAL; 644*464d20bcSHans Petter Selasky goto done; 6458d59ecb2SHans Petter Selasky } 6468d59ecb2SHans Petter Selasky *offset = 0; 6478d59ecb2SHans Petter Selasky if (vma.vm_page_prot != VM_MEMATTR_DEFAULT) { 6488d59ecb2SHans Petter Selasky VM_OBJECT_WLOCK(*object); 6498d59ecb2SHans Petter Selasky vm_object_set_memattr(*object, 6508d59ecb2SHans Petter Selasky vma.vm_page_prot); 6518d59ecb2SHans Petter Selasky VM_OBJECT_WUNLOCK(*object); 6528d59ecb2SHans Petter Selasky } 6538d59ecb2SHans Petter Selasky } 6548d59ecb2SHans Petter Selasky } else 6558d59ecb2SHans Petter Selasky error = ENODEV; 656*464d20bcSHans Petter Selasky done: 657*464d20bcSHans Petter Selasky linux_clear_current(td); 6588d59ecb2SHans Petter Selasky return (error); 6598d59ecb2SHans Petter Selasky } 6608d59ecb2SHans Petter Selasky 6618d59ecb2SHans Petter Selasky struct cdevsw linuxcdevsw = { 6628d59ecb2SHans Petter Selasky .d_version = D_VERSION, 6638d59ecb2SHans Petter Selasky .d_flags = D_TRACKCLOSE, 6648d59ecb2SHans Petter Selasky .d_open = linux_dev_open, 6658d59ecb2SHans Petter Selasky .d_close = linux_dev_close, 6668d59ecb2SHans Petter Selasky .d_read = linux_dev_read, 6678d59ecb2SHans Petter Selasky .d_write = linux_dev_write, 6688d59ecb2SHans Petter Selasky .d_ioctl = linux_dev_ioctl, 6698d59ecb2SHans Petter Selasky .d_mmap_single = linux_dev_mmap_single, 6708d59ecb2SHans Petter Selasky .d_poll = linux_dev_poll, 6718d59ecb2SHans Petter Selasky }; 6728d59ecb2SHans Petter Selasky 6738d59ecb2SHans Petter Selasky static int 6748d59ecb2SHans Petter Selasky linux_file_read(struct file *file, struct uio *uio, struct ucred *active_cred, 6758d59ecb2SHans Petter Selasky int flags, struct thread *td) 6768d59ecb2SHans Petter Selasky { 6778d59ecb2SHans Petter Selasky struct linux_file *filp; 678*464d20bcSHans Petter Selasky struct task_struct t; 6798d59ecb2SHans Petter Selasky ssize_t bytes; 6808d59ecb2SHans Petter Selasky int error; 6818d59ecb2SHans Petter Selasky 6828d59ecb2SHans Petter Selasky error = 0; 6838d59ecb2SHans Petter Selasky filp = (struct linux_file *)file->f_data; 6848d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 685b3c89b5aSHans Petter Selasky /* XXX no support for I/O vectors currently */ 6868d59ecb2SHans Petter Selasky if (uio->uio_iovcnt != 1) 687b3c89b5aSHans Petter Selasky return (EOPNOTSUPP); 688*464d20bcSHans Petter Selasky linux_set_current(td, &t); 6898d59ecb2SHans Petter Selasky if (filp->f_op->read) { 6908d59ecb2SHans Petter Selasky bytes = filp->f_op->read(filp, uio->uio_iov->iov_base, 6918d59ecb2SHans Petter Selasky uio->uio_iov->iov_len, &uio->uio_offset); 6928d59ecb2SHans Petter Selasky if (bytes >= 0) { 6938d59ecb2SHans Petter Selasky uio->uio_iov->iov_base = 6948d59ecb2SHans Petter Selasky ((uint8_t *)uio->uio_iov->iov_base) + bytes; 6958d59ecb2SHans Petter Selasky uio->uio_iov->iov_len -= bytes; 6968d59ecb2SHans Petter Selasky uio->uio_resid -= bytes; 6978d59ecb2SHans Petter Selasky } else 6988d59ecb2SHans Petter Selasky error = -bytes; 6998d59ecb2SHans Petter Selasky } else 7008d59ecb2SHans Petter Selasky error = ENXIO; 701*464d20bcSHans Petter Selasky linux_clear_current(td); 7028d59ecb2SHans Petter Selasky 7038d59ecb2SHans Petter Selasky return (error); 7048d59ecb2SHans Petter Selasky } 7058d59ecb2SHans Petter Selasky 7068d59ecb2SHans Petter Selasky static int 7078d59ecb2SHans Petter Selasky linux_file_poll(struct file *file, int events, struct ucred *active_cred, 7088d59ecb2SHans Petter Selasky struct thread *td) 7098d59ecb2SHans Petter Selasky { 7108d59ecb2SHans Petter Selasky struct linux_file *filp; 711*464d20bcSHans Petter Selasky struct task_struct t; 7128d59ecb2SHans Petter Selasky int revents; 7138d59ecb2SHans Petter Selasky 7148d59ecb2SHans Petter Selasky filp = (struct linux_file *)file->f_data; 7158d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 716*464d20bcSHans Petter Selasky linux_set_current(td, &t); 7178d59ecb2SHans Petter Selasky if (filp->f_op->poll) 7188d59ecb2SHans Petter Selasky revents = filp->f_op->poll(filp, NULL) & events; 7198d59ecb2SHans Petter Selasky else 7208d59ecb2SHans Petter Selasky revents = 0; 721*464d20bcSHans Petter Selasky linux_clear_current(td); 7228d59ecb2SHans Petter Selasky 7230754e66cSHans Petter Selasky return (revents); 7248d59ecb2SHans Petter Selasky } 7258d59ecb2SHans Petter Selasky 7268d59ecb2SHans Petter Selasky static int 7278d59ecb2SHans Petter Selasky linux_file_close(struct file *file, struct thread *td) 7288d59ecb2SHans Petter Selasky { 7298d59ecb2SHans Petter Selasky struct linux_file *filp; 730*464d20bcSHans Petter Selasky struct task_struct t; 7318d59ecb2SHans Petter Selasky int error; 7328d59ecb2SHans Petter Selasky 7338d59ecb2SHans Petter Selasky filp = (struct linux_file *)file->f_data; 7348d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 735*464d20bcSHans Petter Selasky linux_set_current(td, &t); 7368d59ecb2SHans Petter Selasky error = -filp->f_op->release(NULL, filp); 737*464d20bcSHans Petter Selasky linux_clear_current(td); 7388d59ecb2SHans Petter Selasky funsetown(&filp->f_sigio); 7398d59ecb2SHans Petter Selasky kfree(filp); 7408d59ecb2SHans Petter Selasky 7418d59ecb2SHans Petter Selasky return (error); 7428d59ecb2SHans Petter Selasky } 7438d59ecb2SHans Petter Selasky 7448d59ecb2SHans Petter Selasky static int 7458d59ecb2SHans Petter Selasky linux_file_ioctl(struct file *fp, u_long cmd, void *data, struct ucred *cred, 7468d59ecb2SHans Petter Selasky struct thread *td) 7478d59ecb2SHans Petter Selasky { 7488d59ecb2SHans Petter Selasky struct linux_file *filp; 749*464d20bcSHans Petter Selasky struct task_struct t; 7508d59ecb2SHans Petter Selasky int error; 7518d59ecb2SHans Petter Selasky 7528d59ecb2SHans Petter Selasky filp = (struct linux_file *)fp->f_data; 7538d59ecb2SHans Petter Selasky filp->f_flags = fp->f_flag; 7548d59ecb2SHans Petter Selasky error = 0; 7558d59ecb2SHans Petter Selasky 756*464d20bcSHans Petter Selasky linux_set_current(td, &t); 7578d59ecb2SHans Petter Selasky switch (cmd) { 7588d59ecb2SHans Petter Selasky case FIONBIO: 7598d59ecb2SHans Petter Selasky break; 7608d59ecb2SHans Petter Selasky case FIOASYNC: 7618d59ecb2SHans Petter Selasky if (filp->f_op->fasync == NULL) 7628d59ecb2SHans Petter Selasky break; 7638d59ecb2SHans Petter Selasky error = filp->f_op->fasync(0, filp, fp->f_flag & FASYNC); 7648d59ecb2SHans Petter Selasky break; 7658d59ecb2SHans Petter Selasky case FIOSETOWN: 7668d59ecb2SHans Petter Selasky error = fsetown(*(int *)data, &filp->f_sigio); 7678d59ecb2SHans Petter Selasky if (error == 0) 7688d59ecb2SHans Petter Selasky error = filp->f_op->fasync(0, filp, 7698d59ecb2SHans Petter Selasky fp->f_flag & FASYNC); 7708d59ecb2SHans Petter Selasky break; 7718d59ecb2SHans Petter Selasky case FIOGETOWN: 7728d59ecb2SHans Petter Selasky *(int *)data = fgetown(&filp->f_sigio); 7738d59ecb2SHans Petter Selasky break; 7748d59ecb2SHans Petter Selasky default: 7758d59ecb2SHans Petter Selasky error = ENOTTY; 7768d59ecb2SHans Petter Selasky break; 7778d59ecb2SHans Petter Selasky } 778*464d20bcSHans Petter Selasky linux_clear_current(td); 7798d59ecb2SHans Petter Selasky return (error); 7808d59ecb2SHans Petter Selasky } 7818d59ecb2SHans Petter Selasky 7828d59ecb2SHans Petter Selasky static int 7838d59ecb2SHans Petter Selasky linux_file_stat(struct file *fp, struct stat *sb, struct ucred *active_cred, 7848d59ecb2SHans Petter Selasky struct thread *td) 7858d59ecb2SHans Petter Selasky { 7868d59ecb2SHans Petter Selasky 7878d59ecb2SHans Petter Selasky return (EOPNOTSUPP); 7888d59ecb2SHans Petter Selasky } 7898d59ecb2SHans Petter Selasky 7908d59ecb2SHans Petter Selasky static int 7918d59ecb2SHans Petter Selasky linux_file_fill_kinfo(struct file *fp, struct kinfo_file *kif, 7928d59ecb2SHans Petter Selasky struct filedesc *fdp) 7938d59ecb2SHans Petter Selasky { 7948d59ecb2SHans Petter Selasky 7958d59ecb2SHans Petter Selasky return (0); 7968d59ecb2SHans Petter Selasky } 7978d59ecb2SHans Petter Selasky 7988d59ecb2SHans Petter Selasky struct fileops linuxfileops = { 7998d59ecb2SHans Petter Selasky .fo_read = linux_file_read, 8008d59ecb2SHans Petter Selasky .fo_write = invfo_rdwr, 8018d59ecb2SHans Petter Selasky .fo_truncate = invfo_truncate, 8028d59ecb2SHans Petter Selasky .fo_kqfilter = invfo_kqfilter, 8038d59ecb2SHans Petter Selasky .fo_stat = linux_file_stat, 8048d59ecb2SHans Petter Selasky .fo_fill_kinfo = linux_file_fill_kinfo, 8058d59ecb2SHans Petter Selasky .fo_poll = linux_file_poll, 8068d59ecb2SHans Petter Selasky .fo_close = linux_file_close, 8078d59ecb2SHans Petter Selasky .fo_ioctl = linux_file_ioctl, 8088d59ecb2SHans Petter Selasky .fo_chmod = invfo_chmod, 8098d59ecb2SHans Petter Selasky .fo_chown = invfo_chown, 8108d59ecb2SHans Petter Selasky .fo_sendfile = invfo_sendfile, 8118d59ecb2SHans Petter Selasky }; 8128d59ecb2SHans Petter Selasky 8138d59ecb2SHans Petter Selasky /* 8148d59ecb2SHans Petter Selasky * Hash of vmmap addresses. This is infrequently accessed and does not 8158d59ecb2SHans Petter Selasky * need to be particularly large. This is done because we must store the 8168d59ecb2SHans Petter Selasky * caller's idea of the map size to properly unmap. 8178d59ecb2SHans Petter Selasky */ 8188d59ecb2SHans Petter Selasky struct vmmap { 8198d59ecb2SHans Petter Selasky LIST_ENTRY(vmmap) vm_next; 8208d59ecb2SHans Petter Selasky void *vm_addr; 8218d59ecb2SHans Petter Selasky unsigned long vm_size; 8228d59ecb2SHans Petter Selasky }; 8238d59ecb2SHans Petter Selasky 8248d59ecb2SHans Petter Selasky struct vmmaphd { 8258d59ecb2SHans Petter Selasky struct vmmap *lh_first; 8268d59ecb2SHans Petter Selasky }; 8278d59ecb2SHans Petter Selasky #define VMMAP_HASH_SIZE 64 8288d59ecb2SHans Petter Selasky #define VMMAP_HASH_MASK (VMMAP_HASH_SIZE - 1) 8298d59ecb2SHans Petter Selasky #define VM_HASH(addr) ((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK 8308d59ecb2SHans Petter Selasky static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE]; 8318d59ecb2SHans Petter Selasky static struct mtx vmmaplock; 8328d59ecb2SHans Petter Selasky 8338d59ecb2SHans Petter Selasky static void 8348d59ecb2SHans Petter Selasky vmmap_add(void *addr, unsigned long size) 8358d59ecb2SHans Petter Selasky { 8368d59ecb2SHans Petter Selasky struct vmmap *vmmap; 8378d59ecb2SHans Petter Selasky 8388d59ecb2SHans Petter Selasky vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL); 8398d59ecb2SHans Petter Selasky mtx_lock(&vmmaplock); 8408d59ecb2SHans Petter Selasky vmmap->vm_size = size; 8418d59ecb2SHans Petter Selasky vmmap->vm_addr = addr; 8428d59ecb2SHans Petter Selasky LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next); 8438d59ecb2SHans Petter Selasky mtx_unlock(&vmmaplock); 8448d59ecb2SHans Petter Selasky } 8458d59ecb2SHans Petter Selasky 8468d59ecb2SHans Petter Selasky static struct vmmap * 8478d59ecb2SHans Petter Selasky vmmap_remove(void *addr) 8488d59ecb2SHans Petter Selasky { 8498d59ecb2SHans Petter Selasky struct vmmap *vmmap; 8508d59ecb2SHans Petter Selasky 8518d59ecb2SHans Petter Selasky mtx_lock(&vmmaplock); 8528d59ecb2SHans Petter Selasky LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next) 8538d59ecb2SHans Petter Selasky if (vmmap->vm_addr == addr) 8548d59ecb2SHans Petter Selasky break; 8558d59ecb2SHans Petter Selasky if (vmmap) 8568d59ecb2SHans Petter Selasky LIST_REMOVE(vmmap, vm_next); 8578d59ecb2SHans Petter Selasky mtx_unlock(&vmmaplock); 8588d59ecb2SHans Petter Selasky 8598d59ecb2SHans Petter Selasky return (vmmap); 8608d59ecb2SHans Petter Selasky } 8618d59ecb2SHans Petter Selasky 86286845417SHans Petter Selasky #if defined(__i386__) || defined(__amd64__) 8638d59ecb2SHans Petter Selasky void * 8648d59ecb2SHans Petter Selasky _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr) 8658d59ecb2SHans Petter Selasky { 8668d59ecb2SHans Petter Selasky void *addr; 8678d59ecb2SHans Petter Selasky 8688d59ecb2SHans Petter Selasky addr = pmap_mapdev_attr(phys_addr, size, attr); 8698d59ecb2SHans Petter Selasky if (addr == NULL) 8708d59ecb2SHans Petter Selasky return (NULL); 8718d59ecb2SHans Petter Selasky vmmap_add(addr, size); 8728d59ecb2SHans Petter Selasky 8738d59ecb2SHans Petter Selasky return (addr); 8748d59ecb2SHans Petter Selasky } 87586845417SHans Petter Selasky #endif 8768d59ecb2SHans Petter Selasky 8778d59ecb2SHans Petter Selasky void 8788d59ecb2SHans Petter Selasky iounmap(void *addr) 8798d59ecb2SHans Petter Selasky { 8808d59ecb2SHans Petter Selasky struct vmmap *vmmap; 8818d59ecb2SHans Petter Selasky 8828d59ecb2SHans Petter Selasky vmmap = vmmap_remove(addr); 8838d59ecb2SHans Petter Selasky if (vmmap == NULL) 8848d59ecb2SHans Petter Selasky return; 8858d59ecb2SHans Petter Selasky #if defined(__i386__) || defined(__amd64__) 8868d59ecb2SHans Petter Selasky pmap_unmapdev((vm_offset_t)addr, vmmap->vm_size); 8878d59ecb2SHans Petter Selasky #endif 8888d59ecb2SHans Petter Selasky kfree(vmmap); 8898d59ecb2SHans Petter Selasky } 8908d59ecb2SHans Petter Selasky 8918d59ecb2SHans Petter Selasky 8928d59ecb2SHans Petter Selasky void * 8938d59ecb2SHans Petter Selasky vmap(struct page **pages, unsigned int count, unsigned long flags, int prot) 8948d59ecb2SHans Petter Selasky { 8958d59ecb2SHans Petter Selasky vm_offset_t off; 8968d59ecb2SHans Petter Selasky size_t size; 8978d59ecb2SHans Petter Selasky 8988d59ecb2SHans Petter Selasky size = count * PAGE_SIZE; 8998d59ecb2SHans Petter Selasky off = kva_alloc(size); 9008d59ecb2SHans Petter Selasky if (off == 0) 9018d59ecb2SHans Petter Selasky return (NULL); 9028d59ecb2SHans Petter Selasky vmmap_add((void *)off, size); 9038d59ecb2SHans Petter Selasky pmap_qenter(off, pages, count); 9048d59ecb2SHans Petter Selasky 9058d59ecb2SHans Petter Selasky return ((void *)off); 9068d59ecb2SHans Petter Selasky } 9078d59ecb2SHans Petter Selasky 9088d59ecb2SHans Petter Selasky void 9098d59ecb2SHans Petter Selasky vunmap(void *addr) 9108d59ecb2SHans Petter Selasky { 9118d59ecb2SHans Petter Selasky struct vmmap *vmmap; 9128d59ecb2SHans Petter Selasky 9138d59ecb2SHans Petter Selasky vmmap = vmmap_remove(addr); 9148d59ecb2SHans Petter Selasky if (vmmap == NULL) 9158d59ecb2SHans Petter Selasky return; 9168d59ecb2SHans Petter Selasky pmap_qremove((vm_offset_t)addr, vmmap->vm_size / PAGE_SIZE); 9178d59ecb2SHans Petter Selasky kva_free((vm_offset_t)addr, vmmap->vm_size); 9188d59ecb2SHans Petter Selasky kfree(vmmap); 9198d59ecb2SHans Petter Selasky } 9208d59ecb2SHans Petter Selasky 9218d59ecb2SHans Petter Selasky char * 9228d59ecb2SHans Petter Selasky kvasprintf(gfp_t gfp, const char *fmt, va_list ap) 9238d59ecb2SHans Petter Selasky { 9248d59ecb2SHans Petter Selasky unsigned int len; 9258d59ecb2SHans Petter Selasky char *p; 9268d59ecb2SHans Petter Selasky va_list aq; 9278d59ecb2SHans Petter Selasky 9288d59ecb2SHans Petter Selasky va_copy(aq, ap); 9298d59ecb2SHans Petter Selasky len = vsnprintf(NULL, 0, fmt, aq); 9308d59ecb2SHans Petter Selasky va_end(aq); 9318d59ecb2SHans Petter Selasky 9328d59ecb2SHans Petter Selasky p = kmalloc(len + 1, gfp); 9338d59ecb2SHans Petter Selasky if (p != NULL) 9348d59ecb2SHans Petter Selasky vsnprintf(p, len + 1, fmt, ap); 9358d59ecb2SHans Petter Selasky 9368d59ecb2SHans Petter Selasky return (p); 9378d59ecb2SHans Petter Selasky } 9388d59ecb2SHans Petter Selasky 9398d59ecb2SHans Petter Selasky char * 9408d59ecb2SHans Petter Selasky kasprintf(gfp_t gfp, const char *fmt, ...) 9418d59ecb2SHans Petter Selasky { 9428d59ecb2SHans Petter Selasky va_list ap; 9438d59ecb2SHans Petter Selasky char *p; 9448d59ecb2SHans Petter Selasky 9458d59ecb2SHans Petter Selasky va_start(ap, fmt); 9468d59ecb2SHans Petter Selasky p = kvasprintf(gfp, fmt, ap); 9478d59ecb2SHans Petter Selasky va_end(ap); 9488d59ecb2SHans Petter Selasky 9498d59ecb2SHans Petter Selasky return (p); 9508d59ecb2SHans Petter Selasky } 9518d59ecb2SHans Petter Selasky 9528d59ecb2SHans Petter Selasky static void 9538d59ecb2SHans Petter Selasky linux_timer_callback_wrapper(void *context) 9548d59ecb2SHans Petter Selasky { 9558d59ecb2SHans Petter Selasky struct timer_list *timer; 9568d59ecb2SHans Petter Selasky 9578d59ecb2SHans Petter Selasky timer = context; 9588d59ecb2SHans Petter Selasky timer->function(timer->data); 9598d59ecb2SHans Petter Selasky } 9608d59ecb2SHans Petter Selasky 9618d59ecb2SHans Petter Selasky void 9628d59ecb2SHans Petter Selasky mod_timer(struct timer_list *timer, unsigned long expires) 9638d59ecb2SHans Petter Selasky { 9648d59ecb2SHans Petter Selasky 9658d59ecb2SHans Petter Selasky timer->expires = expires; 9668d59ecb2SHans Petter Selasky callout_reset(&timer->timer_callout, 9678d59ecb2SHans Petter Selasky linux_timer_jiffies_until(expires), 9688d59ecb2SHans Petter Selasky &linux_timer_callback_wrapper, timer); 9698d59ecb2SHans Petter Selasky } 9708d59ecb2SHans Petter Selasky 9718d59ecb2SHans Petter Selasky void 9728d59ecb2SHans Petter Selasky add_timer(struct timer_list *timer) 9738d59ecb2SHans Petter Selasky { 9748d59ecb2SHans Petter Selasky 9758d59ecb2SHans Petter Selasky callout_reset(&timer->timer_callout, 9768d59ecb2SHans Petter Selasky linux_timer_jiffies_until(timer->expires), 9778d59ecb2SHans Petter Selasky &linux_timer_callback_wrapper, timer); 9788d59ecb2SHans Petter Selasky } 9798d59ecb2SHans Petter Selasky 9808d59ecb2SHans Petter Selasky static void 9818d59ecb2SHans Petter Selasky linux_timer_init(void *arg) 9828d59ecb2SHans Petter Selasky { 9838d59ecb2SHans Petter Selasky 9848d59ecb2SHans Petter Selasky /* 9858d59ecb2SHans Petter Selasky * Compute an internal HZ value which can divide 2**32 to 9868d59ecb2SHans Petter Selasky * avoid timer rounding problems when the tick value wraps 9878d59ecb2SHans Petter Selasky * around 2**32: 9888d59ecb2SHans Petter Selasky */ 9898d59ecb2SHans Petter Selasky linux_timer_hz_mask = 1; 9908d59ecb2SHans Petter Selasky while (linux_timer_hz_mask < (unsigned long)hz) 9918d59ecb2SHans Petter Selasky linux_timer_hz_mask *= 2; 9928d59ecb2SHans Petter Selasky linux_timer_hz_mask--; 9938d59ecb2SHans Petter Selasky } 9948d59ecb2SHans Petter Selasky SYSINIT(linux_timer, SI_SUB_DRIVERS, SI_ORDER_FIRST, linux_timer_init, NULL); 9958d59ecb2SHans Petter Selasky 9968d59ecb2SHans Petter Selasky void 9978d59ecb2SHans Petter Selasky linux_complete_common(struct completion *c, int all) 9988d59ecb2SHans Petter Selasky { 9998d59ecb2SHans Petter Selasky int wakeup_swapper; 10008d59ecb2SHans Petter Selasky 10018d59ecb2SHans Petter Selasky sleepq_lock(c); 10028d59ecb2SHans Petter Selasky c->done++; 10038d59ecb2SHans Petter Selasky if (all) 10048d59ecb2SHans Petter Selasky wakeup_swapper = sleepq_broadcast(c, SLEEPQ_SLEEP, 0, 0); 10058d59ecb2SHans Petter Selasky else 10068d59ecb2SHans Petter Selasky wakeup_swapper = sleepq_signal(c, SLEEPQ_SLEEP, 0, 0); 10078d59ecb2SHans Petter Selasky sleepq_release(c); 10088d59ecb2SHans Petter Selasky if (wakeup_swapper) 10098d59ecb2SHans Petter Selasky kick_proc0(); 10108d59ecb2SHans Petter Selasky } 10118d59ecb2SHans Petter Selasky 10128d59ecb2SHans Petter Selasky /* 10138d59ecb2SHans Petter Selasky * Indefinite wait for done != 0 with or without signals. 10148d59ecb2SHans Petter Selasky */ 10158d59ecb2SHans Petter Selasky long 10168d59ecb2SHans Petter Selasky linux_wait_for_common(struct completion *c, int flags) 10178d59ecb2SHans Petter Selasky { 10188d59ecb2SHans Petter Selasky 10198d59ecb2SHans Petter Selasky if (flags != 0) 10208d59ecb2SHans Petter Selasky flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP; 10218d59ecb2SHans Petter Selasky else 10228d59ecb2SHans Petter Selasky flags = SLEEPQ_SLEEP; 10238d59ecb2SHans Petter Selasky for (;;) { 10248d59ecb2SHans Petter Selasky sleepq_lock(c); 10258d59ecb2SHans Petter Selasky if (c->done) 10268d59ecb2SHans Petter Selasky break; 10278d59ecb2SHans Petter Selasky sleepq_add(c, NULL, "completion", flags, 0); 10288d59ecb2SHans Petter Selasky if (flags & SLEEPQ_INTERRUPTIBLE) { 10298d59ecb2SHans Petter Selasky if (sleepq_wait_sig(c, 0) != 0) 10308d59ecb2SHans Petter Selasky return (-ERESTARTSYS); 10318d59ecb2SHans Petter Selasky } else 10328d59ecb2SHans Petter Selasky sleepq_wait(c, 0); 10338d59ecb2SHans Petter Selasky } 10348d59ecb2SHans Petter Selasky c->done--; 10358d59ecb2SHans Petter Selasky sleepq_release(c); 10368d59ecb2SHans Petter Selasky 10378d59ecb2SHans Petter Selasky return (0); 10388d59ecb2SHans Petter Selasky } 10398d59ecb2SHans Petter Selasky 10408d59ecb2SHans Petter Selasky /* 10418d59ecb2SHans Petter Selasky * Time limited wait for done != 0 with or without signals. 10428d59ecb2SHans Petter Selasky */ 10438d59ecb2SHans Petter Selasky long 10448d59ecb2SHans Petter Selasky linux_wait_for_timeout_common(struct completion *c, long timeout, int flags) 10458d59ecb2SHans Petter Selasky { 10468d59ecb2SHans Petter Selasky long end = jiffies + timeout; 10478d59ecb2SHans Petter Selasky 10488d59ecb2SHans Petter Selasky if (flags != 0) 10498d59ecb2SHans Petter Selasky flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP; 10508d59ecb2SHans Petter Selasky else 10518d59ecb2SHans Petter Selasky flags = SLEEPQ_SLEEP; 10528d59ecb2SHans Petter Selasky for (;;) { 10538d59ecb2SHans Petter Selasky int ret; 10548d59ecb2SHans Petter Selasky 10558d59ecb2SHans Petter Selasky sleepq_lock(c); 10568d59ecb2SHans Petter Selasky if (c->done) 10578d59ecb2SHans Petter Selasky break; 10588d59ecb2SHans Petter Selasky sleepq_add(c, NULL, "completion", flags, 0); 10598d59ecb2SHans Petter Selasky sleepq_set_timeout(c, linux_timer_jiffies_until(end)); 10608d59ecb2SHans Petter Selasky if (flags & SLEEPQ_INTERRUPTIBLE) 10618d59ecb2SHans Petter Selasky ret = sleepq_timedwait_sig(c, 0); 10628d59ecb2SHans Petter Selasky else 10638d59ecb2SHans Petter Selasky ret = sleepq_timedwait(c, 0); 10648d59ecb2SHans Petter Selasky if (ret != 0) { 10658d59ecb2SHans Petter Selasky /* check for timeout or signal */ 10668d59ecb2SHans Petter Selasky if (ret == EWOULDBLOCK) 10678d59ecb2SHans Petter Selasky return (0); 10688d59ecb2SHans Petter Selasky else 10698d59ecb2SHans Petter Selasky return (-ERESTARTSYS); 10708d59ecb2SHans Petter Selasky } 10718d59ecb2SHans Petter Selasky } 10728d59ecb2SHans Petter Selasky c->done--; 10738d59ecb2SHans Petter Selasky sleepq_release(c); 10748d59ecb2SHans Petter Selasky 10758d59ecb2SHans Petter Selasky /* return how many jiffies are left */ 10768d59ecb2SHans Petter Selasky return (linux_timer_jiffies_until(end)); 10778d59ecb2SHans Petter Selasky } 10788d59ecb2SHans Petter Selasky 10798d59ecb2SHans Petter Selasky int 10808d59ecb2SHans Petter Selasky linux_try_wait_for_completion(struct completion *c) 10818d59ecb2SHans Petter Selasky { 10828d59ecb2SHans Petter Selasky int isdone; 10838d59ecb2SHans Petter Selasky 10848d59ecb2SHans Petter Selasky isdone = 1; 10858d59ecb2SHans Petter Selasky sleepq_lock(c); 10868d59ecb2SHans Petter Selasky if (c->done) 10878d59ecb2SHans Petter Selasky c->done--; 10888d59ecb2SHans Petter Selasky else 10898d59ecb2SHans Petter Selasky isdone = 0; 10908d59ecb2SHans Petter Selasky sleepq_release(c); 10918d59ecb2SHans Petter Selasky return (isdone); 10928d59ecb2SHans Petter Selasky } 10938d59ecb2SHans Petter Selasky 10948d59ecb2SHans Petter Selasky int 10958d59ecb2SHans Petter Selasky linux_completion_done(struct completion *c) 10968d59ecb2SHans Petter Selasky { 10978d59ecb2SHans Petter Selasky int isdone; 10988d59ecb2SHans Petter Selasky 10998d59ecb2SHans Petter Selasky isdone = 1; 11008d59ecb2SHans Petter Selasky sleepq_lock(c); 11018d59ecb2SHans Petter Selasky if (c->done == 0) 11028d59ecb2SHans Petter Selasky isdone = 0; 11038d59ecb2SHans Petter Selasky sleepq_release(c); 11048d59ecb2SHans Petter Selasky return (isdone); 11058d59ecb2SHans Petter Selasky } 11068d59ecb2SHans Petter Selasky 110755d445d3SHans Petter Selasky void 110855d445d3SHans Petter Selasky linux_delayed_work_fn(void *arg) 110955d445d3SHans Petter Selasky { 111055d445d3SHans Petter Selasky struct delayed_work *work; 111155d445d3SHans Petter Selasky 111255d445d3SHans Petter Selasky work = arg; 111355d445d3SHans Petter Selasky taskqueue_enqueue(work->work.taskqueue, &work->work.work_task); 111455d445d3SHans Petter Selasky } 111555d445d3SHans Petter Selasky 111655d445d3SHans Petter Selasky void 111755d445d3SHans Petter Selasky linux_work_fn(void *context, int pending) 111855d445d3SHans Petter Selasky { 111955d445d3SHans Petter Selasky struct work_struct *work; 112055d445d3SHans Petter Selasky 112155d445d3SHans Petter Selasky work = context; 112255d445d3SHans Petter Selasky work->fn(work); 112355d445d3SHans Petter Selasky } 112455d445d3SHans Petter Selasky 112555d445d3SHans Petter Selasky void 112655d445d3SHans Petter Selasky linux_flush_fn(void *context, int pending) 112755d445d3SHans Petter Selasky { 112855d445d3SHans Petter Selasky } 112955d445d3SHans Petter Selasky 113055d445d3SHans Petter Selasky struct workqueue_struct * 113155d445d3SHans Petter Selasky linux_create_workqueue_common(const char *name, int cpus) 113255d445d3SHans Petter Selasky { 113355d445d3SHans Petter Selasky struct workqueue_struct *wq; 113455d445d3SHans Petter Selasky 113555d445d3SHans Petter Selasky wq = kmalloc(sizeof(*wq), M_WAITOK); 113655d445d3SHans Petter Selasky wq->taskqueue = taskqueue_create(name, M_WAITOK, 113755d445d3SHans Petter Selasky taskqueue_thread_enqueue, &wq->taskqueue); 1138c4e58b4eSHans Petter Selasky atomic_set(&wq->draining, 0); 113955d445d3SHans Petter Selasky taskqueue_start_threads(&wq->taskqueue, cpus, PWAIT, "%s", name); 114055d445d3SHans Petter Selasky 114155d445d3SHans Petter Selasky return (wq); 114255d445d3SHans Petter Selasky } 114355d445d3SHans Petter Selasky 114455d445d3SHans Petter Selasky void 114555d445d3SHans Petter Selasky destroy_workqueue(struct workqueue_struct *wq) 114655d445d3SHans Petter Selasky { 114755d445d3SHans Petter Selasky taskqueue_free(wq->taskqueue); 114855d445d3SHans Petter Selasky kfree(wq); 114955d445d3SHans Petter Selasky } 115055d445d3SHans Petter Selasky 11518d59ecb2SHans Petter Selasky static void 115206204f8eSHans Petter Selasky linux_cdev_release(struct kobject *kobj) 115306204f8eSHans Petter Selasky { 115406204f8eSHans Petter Selasky struct linux_cdev *cdev; 115506204f8eSHans Petter Selasky struct kobject *parent; 115606204f8eSHans Petter Selasky 115706204f8eSHans Petter Selasky cdev = container_of(kobj, struct linux_cdev, kobj); 115806204f8eSHans Petter Selasky parent = kobj->parent; 115906204f8eSHans Petter Selasky if (cdev->cdev) 116006204f8eSHans Petter Selasky destroy_dev(cdev->cdev); 116106204f8eSHans Petter Selasky kfree(cdev); 116206204f8eSHans Petter Selasky kobject_put(parent); 116306204f8eSHans Petter Selasky } 116406204f8eSHans Petter Selasky 116506204f8eSHans Petter Selasky static void 116606204f8eSHans Petter Selasky linux_cdev_static_release(struct kobject *kobj) 116706204f8eSHans Petter Selasky { 116806204f8eSHans Petter Selasky struct linux_cdev *cdev; 116906204f8eSHans Petter Selasky struct kobject *parent; 117006204f8eSHans Petter Selasky 117106204f8eSHans Petter Selasky cdev = container_of(kobj, struct linux_cdev, kobj); 117206204f8eSHans Petter Selasky parent = kobj->parent; 117306204f8eSHans Petter Selasky if (cdev->cdev) 117406204f8eSHans Petter Selasky destroy_dev(cdev->cdev); 117506204f8eSHans Petter Selasky kobject_put(parent); 117606204f8eSHans Petter Selasky } 117706204f8eSHans Petter Selasky 117806204f8eSHans Petter Selasky const struct kobj_type linux_cdev_ktype = { 117906204f8eSHans Petter Selasky .release = linux_cdev_release, 118006204f8eSHans Petter Selasky }; 118106204f8eSHans Petter Selasky 118206204f8eSHans Petter Selasky const struct kobj_type linux_cdev_static_ktype = { 118306204f8eSHans Petter Selasky .release = linux_cdev_static_release, 118406204f8eSHans Petter Selasky }; 118506204f8eSHans Petter Selasky 118606204f8eSHans Petter Selasky static void 11870c510167SHans Petter Selasky linux_handle_ifnet_link_event(void *arg, struct ifnet *ifp, int linkstate) 11880c510167SHans Petter Selasky { 11890c510167SHans Petter Selasky struct notifier_block *nb; 11900c510167SHans Petter Selasky 11910c510167SHans Petter Selasky nb = arg; 11920c510167SHans Petter Selasky if (linkstate == LINK_STATE_UP) 11930c510167SHans Petter Selasky nb->notifier_call(nb, NETDEV_UP, ifp); 11940c510167SHans Petter Selasky else 11950c510167SHans Petter Selasky nb->notifier_call(nb, NETDEV_DOWN, ifp); 11960c510167SHans Petter Selasky } 11970c510167SHans Petter Selasky 11980c510167SHans Petter Selasky static void 11990c510167SHans Petter Selasky linux_handle_ifnet_arrival_event(void *arg, struct ifnet *ifp) 12000c510167SHans Petter Selasky { 12010c510167SHans Petter Selasky struct notifier_block *nb; 12020c510167SHans Petter Selasky 12030c510167SHans Petter Selasky nb = arg; 12040c510167SHans Petter Selasky nb->notifier_call(nb, NETDEV_REGISTER, ifp); 12050c510167SHans Petter Selasky } 12060c510167SHans Petter Selasky 12070c510167SHans Petter Selasky static void 12080c510167SHans Petter Selasky linux_handle_ifnet_departure_event(void *arg, struct ifnet *ifp) 12090c510167SHans Petter Selasky { 12100c510167SHans Petter Selasky struct notifier_block *nb; 12110c510167SHans Petter Selasky 12120c510167SHans Petter Selasky nb = arg; 12130c510167SHans Petter Selasky nb->notifier_call(nb, NETDEV_UNREGISTER, ifp); 12140c510167SHans Petter Selasky } 12150c510167SHans Petter Selasky 12160c510167SHans Petter Selasky static void 12170c510167SHans Petter Selasky linux_handle_iflladdr_event(void *arg, struct ifnet *ifp) 12180c510167SHans Petter Selasky { 12190c510167SHans Petter Selasky struct notifier_block *nb; 12200c510167SHans Petter Selasky 12210c510167SHans Petter Selasky nb = arg; 12220c510167SHans Petter Selasky nb->notifier_call(nb, NETDEV_CHANGEADDR, ifp); 12230c510167SHans Petter Selasky } 12240c510167SHans Petter Selasky 12250c510167SHans Petter Selasky static void 12260c510167SHans Petter Selasky linux_handle_ifaddr_event(void *arg, struct ifnet *ifp) 12270c510167SHans Petter Selasky { 12280c510167SHans Petter Selasky struct notifier_block *nb; 12290c510167SHans Petter Selasky 12300c510167SHans Petter Selasky nb = arg; 12310c510167SHans Petter Selasky nb->notifier_call(nb, NETDEV_CHANGEIFADDR, ifp); 12320c510167SHans Petter Selasky } 12330c510167SHans Petter Selasky 12340c510167SHans Petter Selasky int 12350c510167SHans Petter Selasky register_netdevice_notifier(struct notifier_block *nb) 12360c510167SHans Petter Selasky { 12370c510167SHans Petter Selasky 12380c510167SHans Petter Selasky nb->tags[NETDEV_UP] = EVENTHANDLER_REGISTER( 12390c510167SHans Petter Selasky ifnet_link_event, linux_handle_ifnet_link_event, nb, 0); 12400c510167SHans Petter Selasky nb->tags[NETDEV_REGISTER] = EVENTHANDLER_REGISTER( 12410c510167SHans Petter Selasky ifnet_arrival_event, linux_handle_ifnet_arrival_event, nb, 0); 12420c510167SHans Petter Selasky nb->tags[NETDEV_UNREGISTER] = EVENTHANDLER_REGISTER( 12430c510167SHans Petter Selasky ifnet_departure_event, linux_handle_ifnet_departure_event, nb, 0); 12440c510167SHans Petter Selasky nb->tags[NETDEV_CHANGEADDR] = EVENTHANDLER_REGISTER( 12450c510167SHans Petter Selasky iflladdr_event, linux_handle_iflladdr_event, nb, 0); 12460c510167SHans Petter Selasky 12470c510167SHans Petter Selasky return (0); 12480c510167SHans Petter Selasky } 12490c510167SHans Petter Selasky 12500c510167SHans Petter Selasky int 12510c510167SHans Petter Selasky register_inetaddr_notifier(struct notifier_block *nb) 12520c510167SHans Petter Selasky { 12530c510167SHans Petter Selasky 12540c510167SHans Petter Selasky nb->tags[NETDEV_CHANGEIFADDR] = EVENTHANDLER_REGISTER( 12550c510167SHans Petter Selasky ifaddr_event, linux_handle_ifaddr_event, nb, 0); 12560c510167SHans Petter Selasky return (0); 12570c510167SHans Petter Selasky } 12580c510167SHans Petter Selasky 12590c510167SHans Petter Selasky int 12600c510167SHans Petter Selasky unregister_netdevice_notifier(struct notifier_block *nb) 12610c510167SHans Petter Selasky { 12620c510167SHans Petter Selasky 12630c510167SHans Petter Selasky EVENTHANDLER_DEREGISTER(ifnet_link_event, 12640c510167SHans Petter Selasky nb->tags[NETDEV_UP]); 12650c510167SHans Petter Selasky EVENTHANDLER_DEREGISTER(ifnet_arrival_event, 12660c510167SHans Petter Selasky nb->tags[NETDEV_REGISTER]); 12670c510167SHans Petter Selasky EVENTHANDLER_DEREGISTER(ifnet_departure_event, 12680c510167SHans Petter Selasky nb->tags[NETDEV_UNREGISTER]); 12690c510167SHans Petter Selasky EVENTHANDLER_DEREGISTER(iflladdr_event, 12700c510167SHans Petter Selasky nb->tags[NETDEV_CHANGEADDR]); 12710c510167SHans Petter Selasky 12720c510167SHans Petter Selasky return (0); 12730c510167SHans Petter Selasky } 12740c510167SHans Petter Selasky 12750c510167SHans Petter Selasky int 12760c510167SHans Petter Selasky unregister_inetaddr_notifier(struct notifier_block *nb) 12770c510167SHans Petter Selasky { 12780c510167SHans Petter Selasky 12790c510167SHans Petter Selasky EVENTHANDLER_DEREGISTER(ifaddr_event, 12800c510167SHans Petter Selasky nb->tags[NETDEV_CHANGEIFADDR]); 12810c510167SHans Petter Selasky 12820c510167SHans Petter Selasky return (0); 12830c510167SHans Petter Selasky } 12840c510167SHans Petter Selasky 12850c510167SHans Petter Selasky void 12860c510167SHans Petter Selasky linux_irq_handler(void *ent) 12870c510167SHans Petter Selasky { 12880c510167SHans Petter Selasky struct irq_ent *irqe; 12890c510167SHans Petter Selasky 12900c510167SHans Petter Selasky irqe = ent; 12910c510167SHans Petter Selasky irqe->handler(irqe->irq, irqe->arg); 12920c510167SHans Petter Selasky } 12930c510167SHans Petter Selasky 12940c510167SHans Petter Selasky static void 12958d59ecb2SHans Petter Selasky linux_compat_init(void *arg) 12968d59ecb2SHans Petter Selasky { 12978d59ecb2SHans Petter Selasky struct sysctl_oid *rootoid; 12988d59ecb2SHans Petter Selasky int i; 12998d59ecb2SHans Petter Selasky 1300e10c4cc0SHans Petter Selasky sx_init(&linux_global_rcu_lock, "LinuxGlobalRCU"); 1301e10c4cc0SHans Petter Selasky 13028d59ecb2SHans Petter Selasky rootoid = SYSCTL_ADD_ROOT_NODE(NULL, 13038d59ecb2SHans Petter Selasky OID_AUTO, "sys", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "sys"); 130406204f8eSHans Petter Selasky kobject_init(&linux_class_root, &linux_class_ktype); 130506204f8eSHans Petter Selasky kobject_set_name(&linux_class_root, "class"); 130606204f8eSHans Petter Selasky linux_class_root.oidp = SYSCTL_ADD_NODE(NULL, SYSCTL_CHILDREN(rootoid), 13078d59ecb2SHans Petter Selasky OID_AUTO, "class", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "class"); 130806204f8eSHans Petter Selasky kobject_init(&linux_root_device.kobj, &linux_dev_ktype); 130906204f8eSHans Petter Selasky kobject_set_name(&linux_root_device.kobj, "device"); 131006204f8eSHans Petter Selasky linux_root_device.kobj.oidp = SYSCTL_ADD_NODE(NULL, 13118d59ecb2SHans Petter Selasky SYSCTL_CHILDREN(rootoid), OID_AUTO, "device", CTLFLAG_RD, NULL, 13128d59ecb2SHans Petter Selasky "device"); 131306204f8eSHans Petter Selasky linux_root_device.bsddev = root_bus; 131406204f8eSHans Petter Selasky linux_class_misc.name = "misc"; 131506204f8eSHans Petter Selasky class_register(&linux_class_misc); 13168d59ecb2SHans Petter Selasky INIT_LIST_HEAD(&pci_drivers); 13178d59ecb2SHans Petter Selasky INIT_LIST_HEAD(&pci_devices); 13188d59ecb2SHans Petter Selasky spin_lock_init(&pci_lock); 13198d59ecb2SHans Petter Selasky mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF); 13208d59ecb2SHans Petter Selasky for (i = 0; i < VMMAP_HASH_SIZE; i++) 13218d59ecb2SHans Petter Selasky LIST_INIT(&vmmaphead[i]); 13228d59ecb2SHans Petter Selasky } 13238d59ecb2SHans Petter Selasky SYSINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_init, NULL); 13248d59ecb2SHans Petter Selasky 13258d59ecb2SHans Petter Selasky static void 13268d59ecb2SHans Petter Selasky linux_compat_uninit(void *arg) 13278d59ecb2SHans Petter Selasky { 132806204f8eSHans Petter Selasky linux_kobject_kfree_name(&linux_class_root); 132906204f8eSHans Petter Selasky linux_kobject_kfree_name(&linux_root_device.kobj); 133006204f8eSHans Petter Selasky linux_kobject_kfree_name(&linux_class_misc.kobj); 1331e10c4cc0SHans Petter Selasky 1332e10c4cc0SHans Petter Selasky synchronize_rcu(); 1333e10c4cc0SHans Petter Selasky sx_destroy(&linux_global_rcu_lock); 13348d59ecb2SHans Petter Selasky } 13358d59ecb2SHans Petter Selasky SYSUNINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_uninit, NULL); 1336f727a767SHans Petter Selasky 1337f727a767SHans Petter Selasky /* 1338f727a767SHans Petter Selasky * NOTE: Linux frequently uses "unsigned long" for pointer to integer 1339f727a767SHans Petter Selasky * conversion and vice versa, where in FreeBSD "uintptr_t" would be 1340f727a767SHans Petter Selasky * used. Assert these types have the same size, else some parts of the 1341f727a767SHans Petter Selasky * LinuxKPI may not work like expected: 1342f727a767SHans Petter Selasky */ 1343f727a767SHans Petter Selasky CTASSERT(sizeof(unsigned long) == sizeof(uintptr_t)); 1344