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. 586845417SHans Petter Selasky * Copyright (c) 2013-2015 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 #include <machine/pmap.h> 548d59ecb2SHans Petter Selasky 558d59ecb2SHans Petter Selasky #include <linux/kobject.h> 568d59ecb2SHans Petter Selasky #include <linux/device.h> 578d59ecb2SHans Petter Selasky #include <linux/slab.h> 588d59ecb2SHans Petter Selasky #include <linux/module.h> 598d59ecb2SHans Petter Selasky #include <linux/cdev.h> 608d59ecb2SHans Petter Selasky #include <linux/file.h> 618d59ecb2SHans Petter Selasky #include <linux/sysfs.h> 628d59ecb2SHans Petter Selasky #include <linux/mm.h> 638d59ecb2SHans Petter Selasky #include <linux/io.h> 648d59ecb2SHans Petter Selasky #include <linux/vmalloc.h> 658d59ecb2SHans Petter Selasky #include <linux/netdevice.h> 668d59ecb2SHans Petter Selasky #include <linux/timer.h> 678d59ecb2SHans Petter Selasky 688d59ecb2SHans Petter Selasky #include <vm/vm_pager.h> 698d59ecb2SHans Petter Selasky 708d59ecb2SHans Petter Selasky MALLOC_DEFINE(M_KMALLOC, "linux", "Linux kmalloc compat"); 718d59ecb2SHans Petter Selasky 728d59ecb2SHans Petter Selasky #include <linux/rbtree.h> 738d59ecb2SHans Petter Selasky /* Undo Linux compat changes. */ 748d59ecb2SHans Petter Selasky #undef RB_ROOT 758d59ecb2SHans Petter Selasky #undef file 768d59ecb2SHans Petter Selasky #undef cdev 778d59ecb2SHans Petter Selasky #define RB_ROOT(head) (head)->rbh_root 788d59ecb2SHans Petter Selasky 798d59ecb2SHans Petter Selasky struct kobject class_root; 808d59ecb2SHans Petter Selasky struct device linux_rootdev; 818d59ecb2SHans Petter Selasky struct class miscclass; 828d59ecb2SHans Petter Selasky struct list_head pci_drivers; 838d59ecb2SHans Petter Selasky struct list_head pci_devices; 848d59ecb2SHans Petter Selasky struct net init_net; 858d59ecb2SHans Petter Selasky spinlock_t pci_lock; 868d59ecb2SHans Petter Selasky 878d59ecb2SHans Petter Selasky unsigned long linux_timer_hz_mask; 888d59ecb2SHans Petter Selasky 898d59ecb2SHans Petter Selasky int 908d59ecb2SHans Petter Selasky panic_cmp(struct rb_node *one, struct rb_node *two) 918d59ecb2SHans Petter Selasky { 928d59ecb2SHans Petter Selasky panic("no cmp"); 938d59ecb2SHans Petter Selasky } 948d59ecb2SHans Petter Selasky 958d59ecb2SHans Petter Selasky RB_GENERATE(linux_root, rb_node, __entry, panic_cmp); 968d59ecb2SHans Petter Selasky 978d59ecb2SHans Petter Selasky int 988d59ecb2SHans Petter Selasky kobject_set_name(struct kobject *kobj, const char *fmt, ...) 998d59ecb2SHans Petter Selasky { 1008d59ecb2SHans Petter Selasky va_list args; 1018d59ecb2SHans Petter Selasky int error; 1028d59ecb2SHans Petter Selasky 1038d59ecb2SHans Petter Selasky va_start(args, fmt); 1048d59ecb2SHans Petter Selasky error = kobject_set_name_vargs(kobj, fmt, args); 1058d59ecb2SHans Petter Selasky va_end(args); 1068d59ecb2SHans Petter Selasky 1078d59ecb2SHans Petter Selasky return (error); 1088d59ecb2SHans Petter Selasky } 1098d59ecb2SHans Petter Selasky 1108d59ecb2SHans Petter Selasky static inline int 1118d59ecb2SHans Petter Selasky kobject_add_complete(struct kobject *kobj, struct kobject *parent) 1128d59ecb2SHans Petter Selasky { 1138d59ecb2SHans Petter Selasky struct kobj_type *t; 1148d59ecb2SHans Petter Selasky int error; 1158d59ecb2SHans Petter Selasky 1168d59ecb2SHans Petter Selasky kobj->parent = kobject_get(parent); 1178d59ecb2SHans Petter Selasky error = sysfs_create_dir(kobj); 1188d59ecb2SHans Petter Selasky if (error == 0 && kobj->ktype && kobj->ktype->default_attrs) { 1198d59ecb2SHans Petter Selasky struct attribute **attr; 1208d59ecb2SHans Petter Selasky t = kobj->ktype; 1218d59ecb2SHans Petter Selasky 1228d59ecb2SHans Petter Selasky for (attr = t->default_attrs; *attr != NULL; attr++) { 1238d59ecb2SHans Petter Selasky error = sysfs_create_file(kobj, *attr); 1248d59ecb2SHans Petter Selasky if (error) 1258d59ecb2SHans Petter Selasky break; 1268d59ecb2SHans Petter Selasky } 1278d59ecb2SHans Petter Selasky if (error) 1288d59ecb2SHans Petter Selasky sysfs_remove_dir(kobj); 1298d59ecb2SHans Petter Selasky 1308d59ecb2SHans Petter Selasky } 1318d59ecb2SHans Petter Selasky return (error); 1328d59ecb2SHans Petter Selasky } 1338d59ecb2SHans Petter Selasky 1348d59ecb2SHans Petter Selasky int 1358d59ecb2SHans Petter Selasky kobject_add(struct kobject *kobj, struct kobject *parent, const char *fmt, ...) 1368d59ecb2SHans Petter Selasky { 1378d59ecb2SHans Petter Selasky va_list args; 1388d59ecb2SHans Petter Selasky int error; 1398d59ecb2SHans Petter Selasky 1408d59ecb2SHans Petter Selasky va_start(args, fmt); 1418d59ecb2SHans Petter Selasky error = kobject_set_name_vargs(kobj, fmt, args); 1428d59ecb2SHans Petter Selasky va_end(args); 1438d59ecb2SHans Petter Selasky if (error) 1448d59ecb2SHans Petter Selasky return (error); 1458d59ecb2SHans Petter Selasky 1468d59ecb2SHans Petter Selasky return kobject_add_complete(kobj, parent); 1478d59ecb2SHans Petter Selasky } 1488d59ecb2SHans Petter Selasky 1498d59ecb2SHans Petter Selasky void 1508d59ecb2SHans Petter Selasky kobject_release(struct kref *kref) 1518d59ecb2SHans Petter Selasky { 1528d59ecb2SHans Petter Selasky struct kobject *kobj; 1538d59ecb2SHans Petter Selasky char *name; 1548d59ecb2SHans Petter Selasky 1558d59ecb2SHans Petter Selasky kobj = container_of(kref, struct kobject, kref); 1568d59ecb2SHans Petter Selasky sysfs_remove_dir(kobj); 1578d59ecb2SHans Petter Selasky if (kobj->parent) 1588d59ecb2SHans Petter Selasky kobject_put(kobj->parent); 1598d59ecb2SHans Petter Selasky kobj->parent = NULL; 1608d59ecb2SHans Petter Selasky name = kobj->name; 1618d59ecb2SHans Petter Selasky if (kobj->ktype && kobj->ktype->release) 1628d59ecb2SHans Petter Selasky kobj->ktype->release(kobj); 1638d59ecb2SHans Petter Selasky kfree(name); 1648d59ecb2SHans Petter Selasky } 1658d59ecb2SHans Petter Selasky 1668d59ecb2SHans Petter Selasky static void 1678d59ecb2SHans Petter Selasky kobject_kfree(struct kobject *kobj) 1688d59ecb2SHans Petter Selasky { 1698d59ecb2SHans Petter Selasky kfree(kobj); 1708d59ecb2SHans Petter Selasky } 1718d59ecb2SHans Petter Selasky 1728d59ecb2SHans Petter Selasky static void 1738d59ecb2SHans Petter Selasky kobject_kfree_name(struct kobject *kobj) 1748d59ecb2SHans Petter Selasky { 1758d59ecb2SHans Petter Selasky if (kobj) { 1768d59ecb2SHans Petter Selasky kfree(kobj->name); 1778d59ecb2SHans Petter Selasky } 1788d59ecb2SHans Petter Selasky } 1798d59ecb2SHans Petter Selasky 1808d59ecb2SHans Petter Selasky struct kobj_type kfree_type = { .release = kobject_kfree }; 1818d59ecb2SHans Petter Selasky 1828d59ecb2SHans Petter Selasky static void 1838d59ecb2SHans Petter Selasky dev_release(struct device *dev) 1848d59ecb2SHans Petter Selasky { 1858d59ecb2SHans Petter Selasky pr_debug("dev_release: %s\n", dev_name(dev)); 1868d59ecb2SHans Petter Selasky kfree(dev); 1878d59ecb2SHans Petter Selasky } 1888d59ecb2SHans Petter Selasky 1898d59ecb2SHans Petter Selasky struct device * 1908d59ecb2SHans Petter Selasky device_create(struct class *class, struct device *parent, dev_t devt, 1918d59ecb2SHans Petter Selasky void *drvdata, const char *fmt, ...) 1928d59ecb2SHans Petter Selasky { 1938d59ecb2SHans Petter Selasky struct device *dev; 1948d59ecb2SHans Petter Selasky va_list args; 1958d59ecb2SHans Petter Selasky 1968d59ecb2SHans Petter Selasky dev = kzalloc(sizeof(*dev), M_WAITOK); 1978d59ecb2SHans Petter Selasky dev->parent = parent; 1988d59ecb2SHans Petter Selasky dev->class = class; 1998d59ecb2SHans Petter Selasky dev->devt = devt; 2008d59ecb2SHans Petter Selasky dev->driver_data = drvdata; 2018d59ecb2SHans Petter Selasky dev->release = dev_release; 2028d59ecb2SHans Petter Selasky va_start(args, fmt); 2038d59ecb2SHans Petter Selasky kobject_set_name_vargs(&dev->kobj, fmt, args); 2048d59ecb2SHans Petter Selasky va_end(args); 2058d59ecb2SHans Petter Selasky device_register(dev); 2068d59ecb2SHans Petter Selasky 2078d59ecb2SHans Petter Selasky return (dev); 2088d59ecb2SHans Petter Selasky } 2098d59ecb2SHans Petter Selasky 2108d59ecb2SHans Petter Selasky int 2118d59ecb2SHans Petter Selasky kobject_init_and_add(struct kobject *kobj, struct kobj_type *ktype, 2128d59ecb2SHans Petter Selasky struct kobject *parent, const char *fmt, ...) 2138d59ecb2SHans Petter Selasky { 2148d59ecb2SHans Petter Selasky va_list args; 2158d59ecb2SHans Petter Selasky int error; 2168d59ecb2SHans Petter Selasky 2178d59ecb2SHans Petter Selasky kobject_init(kobj, ktype); 2188d59ecb2SHans Petter Selasky kobj->ktype = ktype; 2198d59ecb2SHans Petter Selasky kobj->parent = parent; 2208d59ecb2SHans Petter Selasky kobj->name = NULL; 2218d59ecb2SHans Petter Selasky 2228d59ecb2SHans Petter Selasky va_start(args, fmt); 2238d59ecb2SHans Petter Selasky error = kobject_set_name_vargs(kobj, fmt, args); 2248d59ecb2SHans Petter Selasky va_end(args); 2258d59ecb2SHans Petter Selasky if (error) 2268d59ecb2SHans Petter Selasky return (error); 2278d59ecb2SHans Petter Selasky return kobject_add_complete(kobj, parent); 2288d59ecb2SHans Petter Selasky } 2298d59ecb2SHans Petter Selasky 2308d59ecb2SHans Petter Selasky static void 2318d59ecb2SHans Petter Selasky linux_file_dtor(void *cdp) 2328d59ecb2SHans Petter Selasky { 2338d59ecb2SHans Petter Selasky struct linux_file *filp; 2348d59ecb2SHans Petter Selasky 2358d59ecb2SHans Petter Selasky filp = cdp; 2368d59ecb2SHans Petter Selasky filp->f_op->release(filp->f_vnode, filp); 2378d59ecb2SHans Petter Selasky vdrop(filp->f_vnode); 2388d59ecb2SHans Petter Selasky kfree(filp); 2398d59ecb2SHans Petter Selasky } 2408d59ecb2SHans Petter Selasky 2418d59ecb2SHans Petter Selasky static int 2428d59ecb2SHans Petter Selasky linux_dev_open(struct cdev *dev, int oflags, int devtype, struct thread *td) 2438d59ecb2SHans Petter Selasky { 2448d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 2458d59ecb2SHans Petter Selasky struct linux_file *filp; 2468d59ecb2SHans Petter Selasky struct file *file; 2478d59ecb2SHans Petter Selasky int error; 2488d59ecb2SHans Petter Selasky 2498d59ecb2SHans Petter Selasky file = curthread->td_fpop; 2508d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 2518d59ecb2SHans Petter Selasky if (ldev == NULL) 2528d59ecb2SHans Petter Selasky return (ENODEV); 2538d59ecb2SHans Petter Selasky filp = kzalloc(sizeof(*filp), GFP_KERNEL); 2548d59ecb2SHans Petter Selasky filp->f_dentry = &filp->f_dentry_store; 2558d59ecb2SHans Petter Selasky filp->f_op = ldev->ops; 2568d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 2578d59ecb2SHans Petter Selasky vhold(file->f_vnode); 2588d59ecb2SHans Petter Selasky filp->f_vnode = file->f_vnode; 2598d59ecb2SHans Petter Selasky if (filp->f_op->open) { 2608d59ecb2SHans Petter Selasky error = -filp->f_op->open(file->f_vnode, filp); 2618d59ecb2SHans Petter Selasky if (error) { 2628d59ecb2SHans Petter Selasky kfree(filp); 2638d59ecb2SHans Petter Selasky return (error); 2648d59ecb2SHans Petter Selasky } 2658d59ecb2SHans Petter Selasky } 2668d59ecb2SHans Petter Selasky error = devfs_set_cdevpriv(filp, linux_file_dtor); 2678d59ecb2SHans Petter Selasky if (error) { 2688d59ecb2SHans Petter Selasky filp->f_op->release(file->f_vnode, filp); 2698d59ecb2SHans Petter Selasky kfree(filp); 2708d59ecb2SHans Petter Selasky return (error); 2718d59ecb2SHans Petter Selasky } 2728d59ecb2SHans Petter Selasky 2738d59ecb2SHans Petter Selasky return 0; 2748d59ecb2SHans Petter Selasky } 2758d59ecb2SHans Petter Selasky 2768d59ecb2SHans Petter Selasky static int 2778d59ecb2SHans Petter Selasky linux_dev_close(struct cdev *dev, int fflag, int devtype, struct thread *td) 2788d59ecb2SHans Petter Selasky { 2798d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 2808d59ecb2SHans Petter Selasky struct linux_file *filp; 2818d59ecb2SHans Petter Selasky struct file *file; 2828d59ecb2SHans Petter Selasky int error; 2838d59ecb2SHans Petter Selasky 2848d59ecb2SHans Petter Selasky file = curthread->td_fpop; 2858d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 2868d59ecb2SHans Petter Selasky if (ldev == NULL) 2878d59ecb2SHans Petter Selasky return (0); 2888d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 2898d59ecb2SHans Petter Selasky return (error); 2908d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 2918d59ecb2SHans Petter Selasky devfs_clear_cdevpriv(); 2928d59ecb2SHans Petter Selasky 2938d59ecb2SHans Petter Selasky 2948d59ecb2SHans Petter Selasky return (0); 2958d59ecb2SHans Petter Selasky } 2968d59ecb2SHans Petter Selasky 2978d59ecb2SHans Petter Selasky static int 2988d59ecb2SHans Petter Selasky linux_dev_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag, 2998d59ecb2SHans Petter Selasky struct thread *td) 3008d59ecb2SHans Petter Selasky { 3018d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 3028d59ecb2SHans Petter Selasky struct linux_file *filp; 3038d59ecb2SHans Petter Selasky struct file *file; 3048d59ecb2SHans Petter Selasky int error; 3058d59ecb2SHans Petter Selasky 3068d59ecb2SHans Petter Selasky file = curthread->td_fpop; 3078d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 3088d59ecb2SHans Petter Selasky if (ldev == NULL) 3098d59ecb2SHans Petter Selasky return (0); 3108d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 3118d59ecb2SHans Petter Selasky return (error); 3128d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 3138d59ecb2SHans Petter Selasky /* 3148d59ecb2SHans Petter Selasky * Linux does not have a generic ioctl copyin/copyout layer. All 3158d59ecb2SHans Petter Selasky * linux ioctls must be converted to void ioctls which pass a 3168d59ecb2SHans Petter Selasky * pointer to the address of the data. We want the actual user 3178d59ecb2SHans Petter Selasky * address so we dereference here. 3188d59ecb2SHans Petter Selasky */ 3198d59ecb2SHans Petter Selasky data = *(void **)data; 3208d59ecb2SHans Petter Selasky if (filp->f_op->unlocked_ioctl) 3218d59ecb2SHans Petter Selasky error = -filp->f_op->unlocked_ioctl(filp, cmd, (u_long)data); 3228d59ecb2SHans Petter Selasky else 3238d59ecb2SHans Petter Selasky error = ENOTTY; 3248d59ecb2SHans Petter Selasky 3258d59ecb2SHans Petter Selasky return (error); 3268d59ecb2SHans Petter Selasky } 3278d59ecb2SHans Petter Selasky 3288d59ecb2SHans Petter Selasky static int 3298d59ecb2SHans Petter Selasky linux_dev_read(struct cdev *dev, struct uio *uio, int ioflag) 3308d59ecb2SHans Petter Selasky { 3318d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 3328d59ecb2SHans Petter Selasky struct linux_file *filp; 3338d59ecb2SHans Petter Selasky struct file *file; 3348d59ecb2SHans Petter Selasky ssize_t bytes; 3358d59ecb2SHans Petter Selasky int error; 3368d59ecb2SHans Petter Selasky 3378d59ecb2SHans Petter Selasky file = curthread->td_fpop; 3388d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 3398d59ecb2SHans Petter Selasky if (ldev == NULL) 3408d59ecb2SHans Petter Selasky return (0); 3418d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 3428d59ecb2SHans Petter Selasky return (error); 3438d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 3448d59ecb2SHans Petter Selasky if (uio->uio_iovcnt != 1) 3458d59ecb2SHans Petter Selasky panic("linux_dev_read: uio %p iovcnt %d", 3468d59ecb2SHans Petter Selasky uio, uio->uio_iovcnt); 3478d59ecb2SHans Petter Selasky if (filp->f_op->read) { 3488d59ecb2SHans Petter Selasky bytes = filp->f_op->read(filp, uio->uio_iov->iov_base, 3498d59ecb2SHans Petter Selasky uio->uio_iov->iov_len, &uio->uio_offset); 3508d59ecb2SHans Petter Selasky if (bytes >= 0) { 3518d59ecb2SHans Petter Selasky uio->uio_iov->iov_base = 3528d59ecb2SHans Petter Selasky ((uint8_t *)uio->uio_iov->iov_base) + bytes; 3538d59ecb2SHans Petter Selasky uio->uio_iov->iov_len -= bytes; 3548d59ecb2SHans Petter Selasky uio->uio_resid -= bytes; 3558d59ecb2SHans Petter Selasky } else 3568d59ecb2SHans Petter Selasky error = -bytes; 3578d59ecb2SHans Petter Selasky } else 3588d59ecb2SHans Petter Selasky error = ENXIO; 3598d59ecb2SHans Petter Selasky 3608d59ecb2SHans Petter Selasky return (error); 3618d59ecb2SHans Petter Selasky } 3628d59ecb2SHans Petter Selasky 3638d59ecb2SHans Petter Selasky static int 3648d59ecb2SHans Petter Selasky linux_dev_write(struct cdev *dev, struct uio *uio, int ioflag) 3658d59ecb2SHans Petter Selasky { 3668d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 3678d59ecb2SHans Petter Selasky struct linux_file *filp; 3688d59ecb2SHans Petter Selasky struct file *file; 3698d59ecb2SHans Petter Selasky ssize_t bytes; 3708d59ecb2SHans Petter Selasky int error; 3718d59ecb2SHans Petter Selasky 3728d59ecb2SHans Petter Selasky file = curthread->td_fpop; 3738d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 3748d59ecb2SHans Petter Selasky if (ldev == NULL) 3758d59ecb2SHans Petter Selasky return (0); 3768d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 3778d59ecb2SHans Petter Selasky return (error); 3788d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 3798d59ecb2SHans Petter Selasky if (uio->uio_iovcnt != 1) 3808d59ecb2SHans Petter Selasky panic("linux_dev_write: uio %p iovcnt %d", 3818d59ecb2SHans Petter Selasky uio, uio->uio_iovcnt); 3828d59ecb2SHans Petter Selasky if (filp->f_op->write) { 3838d59ecb2SHans Petter Selasky bytes = filp->f_op->write(filp, uio->uio_iov->iov_base, 3848d59ecb2SHans Petter Selasky uio->uio_iov->iov_len, &uio->uio_offset); 3858d59ecb2SHans Petter Selasky if (bytes >= 0) { 3868d59ecb2SHans Petter Selasky uio->uio_iov->iov_base = 3878d59ecb2SHans Petter Selasky ((uint8_t *)uio->uio_iov->iov_base) + bytes; 3888d59ecb2SHans Petter Selasky uio->uio_iov->iov_len -= bytes; 3898d59ecb2SHans Petter Selasky uio->uio_resid -= bytes; 3908d59ecb2SHans Petter Selasky } else 3918d59ecb2SHans Petter Selasky error = -bytes; 3928d59ecb2SHans Petter Selasky } else 3938d59ecb2SHans Petter Selasky error = ENXIO; 3948d59ecb2SHans Petter Selasky 3958d59ecb2SHans Petter Selasky return (error); 3968d59ecb2SHans Petter Selasky } 3978d59ecb2SHans Petter Selasky 3988d59ecb2SHans Petter Selasky static int 3998d59ecb2SHans Petter Selasky linux_dev_poll(struct cdev *dev, int events, struct thread *td) 4008d59ecb2SHans Petter Selasky { 4018d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 4028d59ecb2SHans Petter Selasky struct linux_file *filp; 4038d59ecb2SHans Petter Selasky struct file *file; 4048d59ecb2SHans Petter Selasky int revents; 4058d59ecb2SHans Petter Selasky int error; 4068d59ecb2SHans Petter Selasky 4078d59ecb2SHans Petter Selasky file = curthread->td_fpop; 4088d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 4098d59ecb2SHans Petter Selasky if (ldev == NULL) 4108d59ecb2SHans Petter Selasky return (0); 4118d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 4128d59ecb2SHans Petter Selasky return (error); 4138d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 4148d59ecb2SHans Petter Selasky if (filp->f_op->poll) 4158d59ecb2SHans Petter Selasky revents = filp->f_op->poll(filp, NULL) & events; 4168d59ecb2SHans Petter Selasky else 4178d59ecb2SHans Petter Selasky revents = 0; 4188d59ecb2SHans Petter Selasky 4198d59ecb2SHans Petter Selasky return (revents); 4208d59ecb2SHans Petter Selasky } 4218d59ecb2SHans Petter Selasky 4228d59ecb2SHans Petter Selasky static int 4238d59ecb2SHans Petter Selasky linux_dev_mmap_single(struct cdev *dev, vm_ooffset_t *offset, 4248d59ecb2SHans Petter Selasky vm_size_t size, struct vm_object **object, int nprot) 4258d59ecb2SHans Petter Selasky { 4268d59ecb2SHans Petter Selasky struct linux_cdev *ldev; 4278d59ecb2SHans Petter Selasky struct linux_file *filp; 4288d59ecb2SHans Petter Selasky struct file *file; 4298d59ecb2SHans Petter Selasky struct vm_area_struct vma; 4308d59ecb2SHans Petter Selasky int error; 4318d59ecb2SHans Petter Selasky 4328d59ecb2SHans Petter Selasky file = curthread->td_fpop; 4338d59ecb2SHans Petter Selasky ldev = dev->si_drv1; 4348d59ecb2SHans Petter Selasky if (ldev == NULL) 4358d59ecb2SHans Petter Selasky return (ENODEV); 4368d59ecb2SHans Petter Selasky if ((error = devfs_get_cdevpriv((void **)&filp)) != 0) 4378d59ecb2SHans Petter Selasky return (error); 4388d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 4398d59ecb2SHans Petter Selasky vma.vm_start = 0; 4408d59ecb2SHans Petter Selasky vma.vm_end = size; 4418d59ecb2SHans Petter Selasky vma.vm_pgoff = *offset / PAGE_SIZE; 4428d59ecb2SHans Petter Selasky vma.vm_pfn = 0; 4438d59ecb2SHans Petter Selasky vma.vm_page_prot = 0; 4448d59ecb2SHans Petter Selasky if (filp->f_op->mmap) { 4458d59ecb2SHans Petter Selasky error = -filp->f_op->mmap(filp, &vma); 4468d59ecb2SHans Petter Selasky if (error == 0) { 4478d59ecb2SHans Petter Selasky struct sglist *sg; 4488d59ecb2SHans Petter Selasky 4498d59ecb2SHans Petter Selasky sg = sglist_alloc(1, M_WAITOK); 4508d59ecb2SHans Petter Selasky sglist_append_phys(sg, 4518d59ecb2SHans Petter Selasky (vm_paddr_t)vma.vm_pfn << PAGE_SHIFT, vma.vm_len); 4528d59ecb2SHans Petter Selasky *object = vm_pager_allocate(OBJT_SG, sg, vma.vm_len, 4538d59ecb2SHans Petter Selasky nprot, 0, curthread->td_ucred); 4548d59ecb2SHans Petter Selasky if (*object == NULL) { 4558d59ecb2SHans Petter Selasky sglist_free(sg); 4568d59ecb2SHans Petter Selasky return (EINVAL); 4578d59ecb2SHans Petter Selasky } 4588d59ecb2SHans Petter Selasky *offset = 0; 4598d59ecb2SHans Petter Selasky if (vma.vm_page_prot != VM_MEMATTR_DEFAULT) { 4608d59ecb2SHans Petter Selasky VM_OBJECT_WLOCK(*object); 4618d59ecb2SHans Petter Selasky vm_object_set_memattr(*object, 4628d59ecb2SHans Petter Selasky vma.vm_page_prot); 4638d59ecb2SHans Petter Selasky VM_OBJECT_WUNLOCK(*object); 4648d59ecb2SHans Petter Selasky } 4658d59ecb2SHans Petter Selasky } 4668d59ecb2SHans Petter Selasky } else 4678d59ecb2SHans Petter Selasky error = ENODEV; 4688d59ecb2SHans Petter Selasky 4698d59ecb2SHans Petter Selasky return (error); 4708d59ecb2SHans Petter Selasky } 4718d59ecb2SHans Petter Selasky 4728d59ecb2SHans Petter Selasky struct cdevsw linuxcdevsw = { 4738d59ecb2SHans Petter Selasky .d_version = D_VERSION, 4748d59ecb2SHans Petter Selasky .d_flags = D_TRACKCLOSE, 4758d59ecb2SHans Petter Selasky .d_open = linux_dev_open, 4768d59ecb2SHans Petter Selasky .d_close = linux_dev_close, 4778d59ecb2SHans Petter Selasky .d_read = linux_dev_read, 4788d59ecb2SHans Petter Selasky .d_write = linux_dev_write, 4798d59ecb2SHans Petter Selasky .d_ioctl = linux_dev_ioctl, 4808d59ecb2SHans Petter Selasky .d_mmap_single = linux_dev_mmap_single, 4818d59ecb2SHans Petter Selasky .d_poll = linux_dev_poll, 4828d59ecb2SHans Petter Selasky }; 4838d59ecb2SHans Petter Selasky 4848d59ecb2SHans Petter Selasky static int 4858d59ecb2SHans Petter Selasky linux_file_read(struct file *file, struct uio *uio, struct ucred *active_cred, 4868d59ecb2SHans Petter Selasky int flags, struct thread *td) 4878d59ecb2SHans Petter Selasky { 4888d59ecb2SHans Petter Selasky struct linux_file *filp; 4898d59ecb2SHans Petter Selasky ssize_t bytes; 4908d59ecb2SHans Petter Selasky int error; 4918d59ecb2SHans Petter Selasky 4928d59ecb2SHans Petter Selasky error = 0; 4938d59ecb2SHans Petter Selasky filp = (struct linux_file *)file->f_data; 4948d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 4958d59ecb2SHans Petter Selasky if (uio->uio_iovcnt != 1) 4968d59ecb2SHans Petter Selasky panic("linux_file_read: uio %p iovcnt %d", 4978d59ecb2SHans Petter Selasky uio, uio->uio_iovcnt); 4988d59ecb2SHans Petter Selasky if (filp->f_op->read) { 4998d59ecb2SHans Petter Selasky bytes = filp->f_op->read(filp, uio->uio_iov->iov_base, 5008d59ecb2SHans Petter Selasky uio->uio_iov->iov_len, &uio->uio_offset); 5018d59ecb2SHans Petter Selasky if (bytes >= 0) { 5028d59ecb2SHans Petter Selasky uio->uio_iov->iov_base = 5038d59ecb2SHans Petter Selasky ((uint8_t *)uio->uio_iov->iov_base) + bytes; 5048d59ecb2SHans Petter Selasky uio->uio_iov->iov_len -= bytes; 5058d59ecb2SHans Petter Selasky uio->uio_resid -= bytes; 5068d59ecb2SHans Petter Selasky } else 5078d59ecb2SHans Petter Selasky error = -bytes; 5088d59ecb2SHans Petter Selasky } else 5098d59ecb2SHans Petter Selasky error = ENXIO; 5108d59ecb2SHans Petter Selasky 5118d59ecb2SHans Petter Selasky return (error); 5128d59ecb2SHans Petter Selasky } 5138d59ecb2SHans Petter Selasky 5148d59ecb2SHans Petter Selasky static int 5158d59ecb2SHans Petter Selasky linux_file_poll(struct file *file, int events, struct ucred *active_cred, 5168d59ecb2SHans Petter Selasky struct thread *td) 5178d59ecb2SHans Petter Selasky { 5188d59ecb2SHans Petter Selasky struct linux_file *filp; 5198d59ecb2SHans Petter Selasky int revents; 5208d59ecb2SHans Petter Selasky 5218d59ecb2SHans Petter Selasky filp = (struct linux_file *)file->f_data; 5228d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 5238d59ecb2SHans Petter Selasky if (filp->f_op->poll) 5248d59ecb2SHans Petter Selasky revents = filp->f_op->poll(filp, NULL) & events; 5258d59ecb2SHans Petter Selasky else 5268d59ecb2SHans Petter Selasky revents = 0; 5278d59ecb2SHans Petter Selasky 5288d59ecb2SHans Petter Selasky return (0); 5298d59ecb2SHans Petter Selasky } 5308d59ecb2SHans Petter Selasky 5318d59ecb2SHans Petter Selasky static int 5328d59ecb2SHans Petter Selasky linux_file_close(struct file *file, struct thread *td) 5338d59ecb2SHans Petter Selasky { 5348d59ecb2SHans Petter Selasky struct linux_file *filp; 5358d59ecb2SHans Petter Selasky int error; 5368d59ecb2SHans Petter Selasky 5378d59ecb2SHans Petter Selasky filp = (struct linux_file *)file->f_data; 5388d59ecb2SHans Petter Selasky filp->f_flags = file->f_flag; 5398d59ecb2SHans Petter Selasky error = -filp->f_op->release(NULL, filp); 5408d59ecb2SHans Petter Selasky funsetown(&filp->f_sigio); 5418d59ecb2SHans Petter Selasky kfree(filp); 5428d59ecb2SHans Petter Selasky 5438d59ecb2SHans Petter Selasky return (error); 5448d59ecb2SHans Petter Selasky } 5458d59ecb2SHans Petter Selasky 5468d59ecb2SHans Petter Selasky static int 5478d59ecb2SHans Petter Selasky linux_file_ioctl(struct file *fp, u_long cmd, void *data, struct ucred *cred, 5488d59ecb2SHans Petter Selasky struct thread *td) 5498d59ecb2SHans Petter Selasky { 5508d59ecb2SHans Petter Selasky struct linux_file *filp; 5518d59ecb2SHans Petter Selasky int error; 5528d59ecb2SHans Petter Selasky 5538d59ecb2SHans Petter Selasky filp = (struct linux_file *)fp->f_data; 5548d59ecb2SHans Petter Selasky filp->f_flags = fp->f_flag; 5558d59ecb2SHans Petter Selasky error = 0; 5568d59ecb2SHans Petter Selasky 5578d59ecb2SHans Petter Selasky switch (cmd) { 5588d59ecb2SHans Petter Selasky case FIONBIO: 5598d59ecb2SHans Petter Selasky break; 5608d59ecb2SHans Petter Selasky case FIOASYNC: 5618d59ecb2SHans Petter Selasky if (filp->f_op->fasync == NULL) 5628d59ecb2SHans Petter Selasky break; 5638d59ecb2SHans Petter Selasky error = filp->f_op->fasync(0, filp, fp->f_flag & FASYNC); 5648d59ecb2SHans Petter Selasky break; 5658d59ecb2SHans Petter Selasky case FIOSETOWN: 5668d59ecb2SHans Petter Selasky error = fsetown(*(int *)data, &filp->f_sigio); 5678d59ecb2SHans Petter Selasky if (error == 0) 5688d59ecb2SHans Petter Selasky error = filp->f_op->fasync(0, filp, 5698d59ecb2SHans Petter Selasky fp->f_flag & FASYNC); 5708d59ecb2SHans Petter Selasky break; 5718d59ecb2SHans Petter Selasky case FIOGETOWN: 5728d59ecb2SHans Petter Selasky *(int *)data = fgetown(&filp->f_sigio); 5738d59ecb2SHans Petter Selasky break; 5748d59ecb2SHans Petter Selasky default: 5758d59ecb2SHans Petter Selasky error = ENOTTY; 5768d59ecb2SHans Petter Selasky break; 5778d59ecb2SHans Petter Selasky } 5788d59ecb2SHans Petter Selasky return (error); 5798d59ecb2SHans Petter Selasky } 5808d59ecb2SHans Petter Selasky 5818d59ecb2SHans Petter Selasky static int 5828d59ecb2SHans Petter Selasky linux_file_stat(struct file *fp, struct stat *sb, struct ucred *active_cred, 5838d59ecb2SHans Petter Selasky struct thread *td) 5848d59ecb2SHans Petter Selasky { 5858d59ecb2SHans Petter Selasky 5868d59ecb2SHans Petter Selasky return (EOPNOTSUPP); 5878d59ecb2SHans Petter Selasky } 5888d59ecb2SHans Petter Selasky 5898d59ecb2SHans Petter Selasky static int 5908d59ecb2SHans Petter Selasky linux_file_fill_kinfo(struct file *fp, struct kinfo_file *kif, 5918d59ecb2SHans Petter Selasky struct filedesc *fdp) 5928d59ecb2SHans Petter Selasky { 5938d59ecb2SHans Petter Selasky 5948d59ecb2SHans Petter Selasky return (0); 5958d59ecb2SHans Petter Selasky } 5968d59ecb2SHans Petter Selasky 5978d59ecb2SHans Petter Selasky struct fileops linuxfileops = { 5988d59ecb2SHans Petter Selasky .fo_read = linux_file_read, 5998d59ecb2SHans Petter Selasky .fo_write = invfo_rdwr, 6008d59ecb2SHans Petter Selasky .fo_truncate = invfo_truncate, 6018d59ecb2SHans Petter Selasky .fo_kqfilter = invfo_kqfilter, 6028d59ecb2SHans Petter Selasky .fo_stat = linux_file_stat, 6038d59ecb2SHans Petter Selasky .fo_fill_kinfo = linux_file_fill_kinfo, 6048d59ecb2SHans Petter Selasky .fo_poll = linux_file_poll, 6058d59ecb2SHans Petter Selasky .fo_close = linux_file_close, 6068d59ecb2SHans Petter Selasky .fo_ioctl = linux_file_ioctl, 6078d59ecb2SHans Petter Selasky .fo_chmod = invfo_chmod, 6088d59ecb2SHans Petter Selasky .fo_chown = invfo_chown, 6098d59ecb2SHans Petter Selasky .fo_sendfile = invfo_sendfile, 6108d59ecb2SHans Petter Selasky }; 6118d59ecb2SHans Petter Selasky 6128d59ecb2SHans Petter Selasky /* 6138d59ecb2SHans Petter Selasky * Hash of vmmap addresses. This is infrequently accessed and does not 6148d59ecb2SHans Petter Selasky * need to be particularly large. This is done because we must store the 6158d59ecb2SHans Petter Selasky * caller's idea of the map size to properly unmap. 6168d59ecb2SHans Petter Selasky */ 6178d59ecb2SHans Petter Selasky struct vmmap { 6188d59ecb2SHans Petter Selasky LIST_ENTRY(vmmap) vm_next; 6198d59ecb2SHans Petter Selasky void *vm_addr; 6208d59ecb2SHans Petter Selasky unsigned long vm_size; 6218d59ecb2SHans Petter Selasky }; 6228d59ecb2SHans Petter Selasky 6238d59ecb2SHans Petter Selasky struct vmmaphd { 6248d59ecb2SHans Petter Selasky struct vmmap *lh_first; 6258d59ecb2SHans Petter Selasky }; 6268d59ecb2SHans Petter Selasky #define VMMAP_HASH_SIZE 64 6278d59ecb2SHans Petter Selasky #define VMMAP_HASH_MASK (VMMAP_HASH_SIZE - 1) 6288d59ecb2SHans Petter Selasky #define VM_HASH(addr) ((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK 6298d59ecb2SHans Petter Selasky static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE]; 6308d59ecb2SHans Petter Selasky static struct mtx vmmaplock; 6318d59ecb2SHans Petter Selasky 6328d59ecb2SHans Petter Selasky static void 6338d59ecb2SHans Petter Selasky vmmap_add(void *addr, unsigned long size) 6348d59ecb2SHans Petter Selasky { 6358d59ecb2SHans Petter Selasky struct vmmap *vmmap; 6368d59ecb2SHans Petter Selasky 6378d59ecb2SHans Petter Selasky vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL); 6388d59ecb2SHans Petter Selasky mtx_lock(&vmmaplock); 6398d59ecb2SHans Petter Selasky vmmap->vm_size = size; 6408d59ecb2SHans Petter Selasky vmmap->vm_addr = addr; 6418d59ecb2SHans Petter Selasky LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next); 6428d59ecb2SHans Petter Selasky mtx_unlock(&vmmaplock); 6438d59ecb2SHans Petter Selasky } 6448d59ecb2SHans Petter Selasky 6458d59ecb2SHans Petter Selasky static struct vmmap * 6468d59ecb2SHans Petter Selasky vmmap_remove(void *addr) 6478d59ecb2SHans Petter Selasky { 6488d59ecb2SHans Petter Selasky struct vmmap *vmmap; 6498d59ecb2SHans Petter Selasky 6508d59ecb2SHans Petter Selasky mtx_lock(&vmmaplock); 6518d59ecb2SHans Petter Selasky LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next) 6528d59ecb2SHans Petter Selasky if (vmmap->vm_addr == addr) 6538d59ecb2SHans Petter Selasky break; 6548d59ecb2SHans Petter Selasky if (vmmap) 6558d59ecb2SHans Petter Selasky LIST_REMOVE(vmmap, vm_next); 6568d59ecb2SHans Petter Selasky mtx_unlock(&vmmaplock); 6578d59ecb2SHans Petter Selasky 6588d59ecb2SHans Petter Selasky return (vmmap); 6598d59ecb2SHans Petter Selasky } 6608d59ecb2SHans Petter Selasky 66186845417SHans Petter Selasky #if defined(__i386__) || defined(__amd64__) 6628d59ecb2SHans Petter Selasky void * 6638d59ecb2SHans Petter Selasky _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr) 6648d59ecb2SHans Petter Selasky { 6658d59ecb2SHans Petter Selasky void *addr; 6668d59ecb2SHans Petter Selasky 6678d59ecb2SHans Petter Selasky addr = pmap_mapdev_attr(phys_addr, size, attr); 6688d59ecb2SHans Petter Selasky if (addr == NULL) 6698d59ecb2SHans Petter Selasky return (NULL); 6708d59ecb2SHans Petter Selasky vmmap_add(addr, size); 6718d59ecb2SHans Petter Selasky 6728d59ecb2SHans Petter Selasky return (addr); 6738d59ecb2SHans Petter Selasky } 67486845417SHans Petter Selasky #endif 6758d59ecb2SHans Petter Selasky 6768d59ecb2SHans Petter Selasky void 6778d59ecb2SHans Petter Selasky iounmap(void *addr) 6788d59ecb2SHans Petter Selasky { 6798d59ecb2SHans Petter Selasky struct vmmap *vmmap; 6808d59ecb2SHans Petter Selasky 6818d59ecb2SHans Petter Selasky vmmap = vmmap_remove(addr); 6828d59ecb2SHans Petter Selasky if (vmmap == NULL) 6838d59ecb2SHans Petter Selasky return; 6848d59ecb2SHans Petter Selasky #if defined(__i386__) || defined(__amd64__) 6858d59ecb2SHans Petter Selasky pmap_unmapdev((vm_offset_t)addr, vmmap->vm_size); 6868d59ecb2SHans Petter Selasky #endif 6878d59ecb2SHans Petter Selasky kfree(vmmap); 6888d59ecb2SHans Petter Selasky } 6898d59ecb2SHans Petter Selasky 6908d59ecb2SHans Petter Selasky 6918d59ecb2SHans Petter Selasky void * 6928d59ecb2SHans Petter Selasky vmap(struct page **pages, unsigned int count, unsigned long flags, int prot) 6938d59ecb2SHans Petter Selasky { 6948d59ecb2SHans Petter Selasky vm_offset_t off; 6958d59ecb2SHans Petter Selasky size_t size; 6968d59ecb2SHans Petter Selasky 6978d59ecb2SHans Petter Selasky size = count * PAGE_SIZE; 6988d59ecb2SHans Petter Selasky off = kva_alloc(size); 6998d59ecb2SHans Petter Selasky if (off == 0) 7008d59ecb2SHans Petter Selasky return (NULL); 7018d59ecb2SHans Petter Selasky vmmap_add((void *)off, size); 7028d59ecb2SHans Petter Selasky pmap_qenter(off, pages, count); 7038d59ecb2SHans Petter Selasky 7048d59ecb2SHans Petter Selasky return ((void *)off); 7058d59ecb2SHans Petter Selasky } 7068d59ecb2SHans Petter Selasky 7078d59ecb2SHans Petter Selasky void 7088d59ecb2SHans Petter Selasky vunmap(void *addr) 7098d59ecb2SHans Petter Selasky { 7108d59ecb2SHans Petter Selasky struct vmmap *vmmap; 7118d59ecb2SHans Petter Selasky 7128d59ecb2SHans Petter Selasky vmmap = vmmap_remove(addr); 7138d59ecb2SHans Petter Selasky if (vmmap == NULL) 7148d59ecb2SHans Petter Selasky return; 7158d59ecb2SHans Petter Selasky pmap_qremove((vm_offset_t)addr, vmmap->vm_size / PAGE_SIZE); 7168d59ecb2SHans Petter Selasky kva_free((vm_offset_t)addr, vmmap->vm_size); 7178d59ecb2SHans Petter Selasky kfree(vmmap); 7188d59ecb2SHans Petter Selasky } 7198d59ecb2SHans Petter Selasky 7208d59ecb2SHans Petter Selasky char * 7218d59ecb2SHans Petter Selasky kvasprintf(gfp_t gfp, const char *fmt, va_list ap) 7228d59ecb2SHans Petter Selasky { 7238d59ecb2SHans Petter Selasky unsigned int len; 7248d59ecb2SHans Petter Selasky char *p; 7258d59ecb2SHans Petter Selasky va_list aq; 7268d59ecb2SHans Petter Selasky 7278d59ecb2SHans Petter Selasky va_copy(aq, ap); 7288d59ecb2SHans Petter Selasky len = vsnprintf(NULL, 0, fmt, aq); 7298d59ecb2SHans Petter Selasky va_end(aq); 7308d59ecb2SHans Petter Selasky 7318d59ecb2SHans Petter Selasky p = kmalloc(len + 1, gfp); 7328d59ecb2SHans Petter Selasky if (p != NULL) 7338d59ecb2SHans Petter Selasky vsnprintf(p, len + 1, fmt, ap); 7348d59ecb2SHans Petter Selasky 7358d59ecb2SHans Petter Selasky return (p); 7368d59ecb2SHans Petter Selasky } 7378d59ecb2SHans Petter Selasky 7388d59ecb2SHans Petter Selasky char * 7398d59ecb2SHans Petter Selasky kasprintf(gfp_t gfp, const char *fmt, ...) 7408d59ecb2SHans Petter Selasky { 7418d59ecb2SHans Petter Selasky va_list ap; 7428d59ecb2SHans Petter Selasky char *p; 7438d59ecb2SHans Petter Selasky 7448d59ecb2SHans Petter Selasky va_start(ap, fmt); 7458d59ecb2SHans Petter Selasky p = kvasprintf(gfp, fmt, ap); 7468d59ecb2SHans Petter Selasky va_end(ap); 7478d59ecb2SHans Petter Selasky 7488d59ecb2SHans Petter Selasky return (p); 7498d59ecb2SHans Petter Selasky } 7508d59ecb2SHans Petter Selasky 7518d59ecb2SHans Petter Selasky static int 7528d59ecb2SHans Petter Selasky linux_timer_jiffies_until(unsigned long expires) 7538d59ecb2SHans Petter Selasky { 7548d59ecb2SHans Petter Selasky int delta = expires - jiffies; 7558d59ecb2SHans Petter Selasky /* guard against already expired values */ 7568d59ecb2SHans Petter Selasky if (delta < 1) 7578d59ecb2SHans Petter Selasky delta = 1; 7588d59ecb2SHans Petter Selasky return (delta); 7598d59ecb2SHans Petter Selasky } 7608d59ecb2SHans Petter Selasky 7618d59ecb2SHans Petter Selasky static void 7628d59ecb2SHans Petter Selasky linux_timer_callback_wrapper(void *context) 7638d59ecb2SHans Petter Selasky { 7648d59ecb2SHans Petter Selasky struct timer_list *timer; 7658d59ecb2SHans Petter Selasky 7668d59ecb2SHans Petter Selasky timer = context; 7678d59ecb2SHans Petter Selasky timer->function(timer->data); 7688d59ecb2SHans Petter Selasky } 7698d59ecb2SHans Petter Selasky 7708d59ecb2SHans Petter Selasky void 7718d59ecb2SHans Petter Selasky mod_timer(struct timer_list *timer, unsigned long expires) 7728d59ecb2SHans Petter Selasky { 7738d59ecb2SHans Petter Selasky 7748d59ecb2SHans Petter Selasky timer->expires = expires; 7758d59ecb2SHans Petter Selasky callout_reset(&timer->timer_callout, 7768d59ecb2SHans Petter Selasky linux_timer_jiffies_until(expires), 7778d59ecb2SHans Petter Selasky &linux_timer_callback_wrapper, timer); 7788d59ecb2SHans Petter Selasky } 7798d59ecb2SHans Petter Selasky 7808d59ecb2SHans Petter Selasky void 7818d59ecb2SHans Petter Selasky add_timer(struct timer_list *timer) 7828d59ecb2SHans Petter Selasky { 7838d59ecb2SHans Petter Selasky 7848d59ecb2SHans Petter Selasky callout_reset(&timer->timer_callout, 7858d59ecb2SHans Petter Selasky linux_timer_jiffies_until(timer->expires), 7868d59ecb2SHans Petter Selasky &linux_timer_callback_wrapper, timer); 7878d59ecb2SHans Petter Selasky } 7888d59ecb2SHans Petter Selasky 7898d59ecb2SHans Petter Selasky static void 7908d59ecb2SHans Petter Selasky linux_timer_init(void *arg) 7918d59ecb2SHans Petter Selasky { 7928d59ecb2SHans Petter Selasky 7938d59ecb2SHans Petter Selasky /* 7948d59ecb2SHans Petter Selasky * Compute an internal HZ value which can divide 2**32 to 7958d59ecb2SHans Petter Selasky * avoid timer rounding problems when the tick value wraps 7968d59ecb2SHans Petter Selasky * around 2**32: 7978d59ecb2SHans Petter Selasky */ 7988d59ecb2SHans Petter Selasky linux_timer_hz_mask = 1; 7998d59ecb2SHans Petter Selasky while (linux_timer_hz_mask < (unsigned long)hz) 8008d59ecb2SHans Petter Selasky linux_timer_hz_mask *= 2; 8018d59ecb2SHans Petter Selasky linux_timer_hz_mask--; 8028d59ecb2SHans Petter Selasky } 8038d59ecb2SHans Petter Selasky SYSINIT(linux_timer, SI_SUB_DRIVERS, SI_ORDER_FIRST, linux_timer_init, NULL); 8048d59ecb2SHans Petter Selasky 8058d59ecb2SHans Petter Selasky void 8068d59ecb2SHans Petter Selasky linux_complete_common(struct completion *c, int all) 8078d59ecb2SHans Petter Selasky { 8088d59ecb2SHans Petter Selasky int wakeup_swapper; 8098d59ecb2SHans Petter Selasky 8108d59ecb2SHans Petter Selasky sleepq_lock(c); 8118d59ecb2SHans Petter Selasky c->done++; 8128d59ecb2SHans Petter Selasky if (all) 8138d59ecb2SHans Petter Selasky wakeup_swapper = sleepq_broadcast(c, SLEEPQ_SLEEP, 0, 0); 8148d59ecb2SHans Petter Selasky else 8158d59ecb2SHans Petter Selasky wakeup_swapper = sleepq_signal(c, SLEEPQ_SLEEP, 0, 0); 8168d59ecb2SHans Petter Selasky sleepq_release(c); 8178d59ecb2SHans Petter Selasky if (wakeup_swapper) 8188d59ecb2SHans Petter Selasky kick_proc0(); 8198d59ecb2SHans Petter Selasky } 8208d59ecb2SHans Petter Selasky 8218d59ecb2SHans Petter Selasky /* 8228d59ecb2SHans Petter Selasky * Indefinite wait for done != 0 with or without signals. 8238d59ecb2SHans Petter Selasky */ 8248d59ecb2SHans Petter Selasky long 8258d59ecb2SHans Petter Selasky linux_wait_for_common(struct completion *c, int flags) 8268d59ecb2SHans Petter Selasky { 8278d59ecb2SHans Petter Selasky 8288d59ecb2SHans Petter Selasky if (flags != 0) 8298d59ecb2SHans Petter Selasky flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP; 8308d59ecb2SHans Petter Selasky else 8318d59ecb2SHans Petter Selasky flags = SLEEPQ_SLEEP; 8328d59ecb2SHans Petter Selasky for (;;) { 8338d59ecb2SHans Petter Selasky sleepq_lock(c); 8348d59ecb2SHans Petter Selasky if (c->done) 8358d59ecb2SHans Petter Selasky break; 8368d59ecb2SHans Petter Selasky sleepq_add(c, NULL, "completion", flags, 0); 8378d59ecb2SHans Petter Selasky if (flags & SLEEPQ_INTERRUPTIBLE) { 8388d59ecb2SHans Petter Selasky if (sleepq_wait_sig(c, 0) != 0) 8398d59ecb2SHans Petter Selasky return (-ERESTARTSYS); 8408d59ecb2SHans Petter Selasky } else 8418d59ecb2SHans Petter Selasky sleepq_wait(c, 0); 8428d59ecb2SHans Petter Selasky } 8438d59ecb2SHans Petter Selasky c->done--; 8448d59ecb2SHans Petter Selasky sleepq_release(c); 8458d59ecb2SHans Petter Selasky 8468d59ecb2SHans Petter Selasky return (0); 8478d59ecb2SHans Petter Selasky } 8488d59ecb2SHans Petter Selasky 8498d59ecb2SHans Petter Selasky /* 8508d59ecb2SHans Petter Selasky * Time limited wait for done != 0 with or without signals. 8518d59ecb2SHans Petter Selasky */ 8528d59ecb2SHans Petter Selasky long 8538d59ecb2SHans Petter Selasky linux_wait_for_timeout_common(struct completion *c, long timeout, int flags) 8548d59ecb2SHans Petter Selasky { 8558d59ecb2SHans Petter Selasky long end = jiffies + timeout; 8568d59ecb2SHans Petter Selasky 8578d59ecb2SHans Petter Selasky if (flags != 0) 8588d59ecb2SHans Petter Selasky flags = SLEEPQ_INTERRUPTIBLE | SLEEPQ_SLEEP; 8598d59ecb2SHans Petter Selasky else 8608d59ecb2SHans Petter Selasky flags = SLEEPQ_SLEEP; 8618d59ecb2SHans Petter Selasky for (;;) { 8628d59ecb2SHans Petter Selasky int ret; 8638d59ecb2SHans Petter Selasky 8648d59ecb2SHans Petter Selasky sleepq_lock(c); 8658d59ecb2SHans Petter Selasky if (c->done) 8668d59ecb2SHans Petter Selasky break; 8678d59ecb2SHans Petter Selasky sleepq_add(c, NULL, "completion", flags, 0); 8688d59ecb2SHans Petter Selasky sleepq_set_timeout(c, linux_timer_jiffies_until(end)); 8698d59ecb2SHans Petter Selasky if (flags & SLEEPQ_INTERRUPTIBLE) 8708d59ecb2SHans Petter Selasky ret = sleepq_timedwait_sig(c, 0); 8718d59ecb2SHans Petter Selasky else 8728d59ecb2SHans Petter Selasky ret = sleepq_timedwait(c, 0); 8738d59ecb2SHans Petter Selasky if (ret != 0) { 8748d59ecb2SHans Petter Selasky /* check for timeout or signal */ 8758d59ecb2SHans Petter Selasky if (ret == EWOULDBLOCK) 8768d59ecb2SHans Petter Selasky return (0); 8778d59ecb2SHans Petter Selasky else 8788d59ecb2SHans Petter Selasky return (-ERESTARTSYS); 8798d59ecb2SHans Petter Selasky } 8808d59ecb2SHans Petter Selasky } 8818d59ecb2SHans Petter Selasky c->done--; 8828d59ecb2SHans Petter Selasky sleepq_release(c); 8838d59ecb2SHans Petter Selasky 8848d59ecb2SHans Petter Selasky /* return how many jiffies are left */ 8858d59ecb2SHans Petter Selasky return (linux_timer_jiffies_until(end)); 8868d59ecb2SHans Petter Selasky } 8878d59ecb2SHans Petter Selasky 8888d59ecb2SHans Petter Selasky int 8898d59ecb2SHans Petter Selasky linux_try_wait_for_completion(struct completion *c) 8908d59ecb2SHans Petter Selasky { 8918d59ecb2SHans Petter Selasky int isdone; 8928d59ecb2SHans Petter Selasky 8938d59ecb2SHans Petter Selasky isdone = 1; 8948d59ecb2SHans Petter Selasky sleepq_lock(c); 8958d59ecb2SHans Petter Selasky if (c->done) 8968d59ecb2SHans Petter Selasky c->done--; 8978d59ecb2SHans Petter Selasky else 8988d59ecb2SHans Petter Selasky isdone = 0; 8998d59ecb2SHans Petter Selasky sleepq_release(c); 9008d59ecb2SHans Petter Selasky return (isdone); 9018d59ecb2SHans Petter Selasky } 9028d59ecb2SHans Petter Selasky 9038d59ecb2SHans Petter Selasky int 9048d59ecb2SHans Petter Selasky linux_completion_done(struct completion *c) 9058d59ecb2SHans Petter Selasky { 9068d59ecb2SHans Petter Selasky int isdone; 9078d59ecb2SHans Petter Selasky 9088d59ecb2SHans Petter Selasky isdone = 1; 9098d59ecb2SHans Petter Selasky sleepq_lock(c); 9108d59ecb2SHans Petter Selasky if (c->done == 0) 9118d59ecb2SHans Petter Selasky isdone = 0; 9128d59ecb2SHans Petter Selasky sleepq_release(c); 9138d59ecb2SHans Petter Selasky return (isdone); 9148d59ecb2SHans Petter Selasky } 9158d59ecb2SHans Petter Selasky 9168d59ecb2SHans Petter Selasky static void 9178d59ecb2SHans Petter Selasky linux_compat_init(void *arg) 9188d59ecb2SHans Petter Selasky { 9198d59ecb2SHans Petter Selasky struct sysctl_oid *rootoid; 9208d59ecb2SHans Petter Selasky int i; 9218d59ecb2SHans Petter Selasky 9228d59ecb2SHans Petter Selasky rootoid = SYSCTL_ADD_ROOT_NODE(NULL, 9238d59ecb2SHans Petter Selasky OID_AUTO, "sys", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "sys"); 9248d59ecb2SHans Petter Selasky kobject_init(&class_root, &class_ktype); 9258d59ecb2SHans Petter Selasky kobject_set_name(&class_root, "class"); 9268d59ecb2SHans Petter Selasky class_root.oidp = SYSCTL_ADD_NODE(NULL, SYSCTL_CHILDREN(rootoid), 9278d59ecb2SHans Petter Selasky OID_AUTO, "class", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "class"); 9288d59ecb2SHans Petter Selasky kobject_init(&linux_rootdev.kobj, &dev_ktype); 9298d59ecb2SHans Petter Selasky kobject_set_name(&linux_rootdev.kobj, "device"); 9308d59ecb2SHans Petter Selasky linux_rootdev.kobj.oidp = SYSCTL_ADD_NODE(NULL, 9318d59ecb2SHans Petter Selasky SYSCTL_CHILDREN(rootoid), OID_AUTO, "device", CTLFLAG_RD, NULL, 9328d59ecb2SHans Petter Selasky "device"); 9338d59ecb2SHans Petter Selasky linux_rootdev.bsddev = root_bus; 9348d59ecb2SHans Petter Selasky miscclass.name = "misc"; 9358d59ecb2SHans Petter Selasky class_register(&miscclass); 9368d59ecb2SHans Petter Selasky INIT_LIST_HEAD(&pci_drivers); 9378d59ecb2SHans Petter Selasky INIT_LIST_HEAD(&pci_devices); 9388d59ecb2SHans Petter Selasky spin_lock_init(&pci_lock); 9398d59ecb2SHans Petter Selasky mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF); 9408d59ecb2SHans Petter Selasky for (i = 0; i < VMMAP_HASH_SIZE; i++) 9418d59ecb2SHans Petter Selasky LIST_INIT(&vmmaphead[i]); 9428d59ecb2SHans Petter Selasky } 9438d59ecb2SHans Petter Selasky SYSINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_init, NULL); 9448d59ecb2SHans Petter Selasky 9458d59ecb2SHans Petter Selasky static void 9468d59ecb2SHans Petter Selasky linux_compat_uninit(void *arg) 9478d59ecb2SHans Petter Selasky { 9488d59ecb2SHans Petter Selasky kobject_kfree_name(&class_root); 9498d59ecb2SHans Petter Selasky kobject_kfree_name(&linux_rootdev.kobj); 9508d59ecb2SHans Petter Selasky kobject_kfree_name(&miscclass.kobj); 9518d59ecb2SHans Petter Selasky } 9528d59ecb2SHans Petter Selasky SYSUNINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_uninit, NULL); 953*f727a767SHans Petter Selasky 954*f727a767SHans Petter Selasky /* 955*f727a767SHans Petter Selasky * NOTE: Linux frequently uses "unsigned long" for pointer to integer 956*f727a767SHans Petter Selasky * conversion and vice versa, where in FreeBSD "uintptr_t" would be 957*f727a767SHans Petter Selasky * used. Assert these types have the same size, else some parts of the 958*f727a767SHans Petter Selasky * LinuxKPI may not work like expected: 959*f727a767SHans Petter Selasky */ 960*f727a767SHans Petter Selasky CTASSERT(sizeof(unsigned long) == sizeof(uintptr_t)); 961