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