2 * Copyright (c) 2010 Isilon Systems, Inc.
3 * Copyright (c) 2010 iX Systems, Inc.
4 * Copyright (c) 2010 Panasas, Inc.
5 * Copyright (c) 2013, 2014 Mellanox Technologies, Ltd.
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
11 * 1. Redistributions of source code must retain the above copyright
12 * notice unmodified, this list of conditions, and the following
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 #include <sys/param.h>
31 #include <sys/systm.h>
32 #include <sys/malloc.h>
33 #include <sys/kernel.h>
34 #include <sys/sysctl.h>
36 #include <sys/mutex.h>
38 #include <sys/fcntl.h>
40 #include <sys/filio.h>
41 #include <sys/rwlock.h>
46 #include <machine/stdarg.h>
47 #include <machine/pmap.h>
49 #include <linux/kobject.h>
50 #include <linux/device.h>
51 #include <linux/slab.h>
52 #include <linux/module.h>
53 #include <linux/cdev.h>
54 #include <linux/file.h>
55 #include <linux/sysfs.h>
58 #include <linux/vmalloc.h>
60 #include <vm/vm_pager.h>
62 MALLOC_DEFINE(M_KMALLOC, "linux", "Linux kmalloc compat");
64 #include <linux/rbtree.h>
65 /* Undo Linux compat changes. */
69 #define RB_ROOT(head) (head)->rbh_root
71 /* From sys/queue.h */
72 #define LIST_HEAD(name, type) \
74 struct type *lh_first; /* first element */ \
77 struct kobject class_root;
78 struct device linux_rootdev;
79 struct class miscclass;
80 struct list_head pci_drivers;
81 struct list_head pci_devices;
85 panic_cmp(struct rb_node *one, struct rb_node *two)
90 RB_GENERATE(linux_root, rb_node, __entry, panic_cmp);
93 kobject_set_name(struct kobject *kobj, const char *fmt, ...)
99 error = kobject_set_name_vargs(kobj, fmt, args);
106 kobject_add_complete(struct kobject *kobj, struct kobject *parent)
111 kobj->parent = kobject_get(parent);
112 error = sysfs_create_dir(kobj);
113 if (error == 0 && kobj->ktype && kobj->ktype->default_attrs) {
114 struct attribute **attr;
117 for (attr = t->default_attrs; *attr != NULL; attr++) {
118 error = sysfs_create_file(kobj, *attr);
123 sysfs_remove_dir(kobj);
130 kobject_add(struct kobject *kobj, struct kobject *parent, const char *fmt, ...)
136 error = kobject_set_name_vargs(kobj, fmt, args);
141 return kobject_add_complete(kobj, parent);
145 kobject_release(struct kref *kref)
147 struct kobject *kobj;
150 kobj = container_of(kref, struct kobject, kref);
151 sysfs_remove_dir(kobj);
153 kobject_put(kobj->parent);
156 if (kobj->ktype && kobj->ktype->release)
157 kobj->ktype->release(kobj);
162 kobject_kfree(struct kobject *kobj)
168 kobject_kfree_name(struct kobject *kobj)
175 struct kobj_type kfree_type = { .release = kobject_kfree };
178 device_create(struct class *class, struct device *parent, dev_t devt,
179 void *drvdata, const char *fmt, ...)
184 dev = kzalloc(sizeof(*dev), M_WAITOK);
185 dev->parent = parent;
188 dev->driver_data = drvdata;
190 kobject_set_name_vargs(&dev->kobj, fmt, args);
192 device_register(dev);
198 kobject_init_and_add(struct kobject *kobj, struct kobj_type *ktype,
199 struct kobject *parent, const char *fmt, ...)
204 kobject_init(kobj, ktype);
206 kobj->parent = parent;
210 error = kobject_set_name_vargs(kobj, fmt, args);
214 return kobject_add_complete(kobj, parent);
218 linux_file_dtor(void *cdp)
220 struct linux_file *filp;
223 filp->f_op->release(filp->f_vnode, filp);
224 vdrop(filp->f_vnode);
229 linux_dev_open(struct cdev *dev, int oflags, int devtype, struct thread *td)
231 struct linux_cdev *ldev;
232 struct linux_file *filp;
236 file = curthread->td_fpop;
240 filp = kzalloc(sizeof(*filp), GFP_KERNEL);
241 filp->f_dentry = &filp->f_dentry_store;
242 filp->f_op = ldev->ops;
243 filp->f_flags = file->f_flag;
244 vhold(file->f_vnode);
245 filp->f_vnode = file->f_vnode;
246 if (filp->f_op->open) {
247 error = -filp->f_op->open(file->f_vnode, filp);
253 error = devfs_set_cdevpriv(filp, linux_file_dtor);
255 filp->f_op->release(file->f_vnode, filp);
264 linux_dev_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
266 struct linux_cdev *ldev;
267 struct linux_file *filp;
271 file = curthread->td_fpop;
275 if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
277 filp->f_flags = file->f_flag;
278 devfs_clear_cdevpriv();
285 linux_dev_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag,
288 struct linux_cdev *ldev;
289 struct linux_file *filp;
293 file = curthread->td_fpop;
297 if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
299 filp->f_flags = file->f_flag;
301 * Linux does not have a generic ioctl copyin/copyout layer. All
302 * linux ioctls must be converted to void ioctls which pass a
303 * pointer to the address of the data. We want the actual user
304 * address so we dereference here.
306 data = *(void **)data;
307 if (filp->f_op->unlocked_ioctl)
308 error = -filp->f_op->unlocked_ioctl(filp, cmd, (u_long)data);
316 linux_dev_read(struct cdev *dev, struct uio *uio, int ioflag)
318 struct linux_cdev *ldev;
319 struct linux_file *filp;
324 file = curthread->td_fpop;
328 if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
330 filp->f_flags = file->f_flag;
331 if (uio->uio_iovcnt != 1)
332 panic("linux_dev_read: uio %p iovcnt %d",
333 uio, uio->uio_iovcnt);
334 if (filp->f_op->read) {
335 bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
336 uio->uio_iov->iov_len, &uio->uio_offset);
338 uio->uio_iov->iov_base += bytes;
339 uio->uio_iov->iov_len -= bytes;
340 uio->uio_resid -= bytes;
350 linux_dev_write(struct cdev *dev, struct uio *uio, int ioflag)
352 struct linux_cdev *ldev;
353 struct linux_file *filp;
358 file = curthread->td_fpop;
362 if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
364 filp->f_flags = file->f_flag;
365 if (uio->uio_iovcnt != 1)
366 panic("linux_dev_write: uio %p iovcnt %d",
367 uio, uio->uio_iovcnt);
368 if (filp->f_op->write) {
369 bytes = filp->f_op->write(filp, uio->uio_iov->iov_base,
370 uio->uio_iov->iov_len, &uio->uio_offset);
372 uio->uio_iov->iov_base += bytes;
373 uio->uio_iov->iov_len -= bytes;
374 uio->uio_resid -= bytes;
384 linux_dev_poll(struct cdev *dev, int events, struct thread *td)
386 struct linux_cdev *ldev;
387 struct linux_file *filp;
392 file = curthread->td_fpop;
396 if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
398 filp->f_flags = file->f_flag;
399 if (filp->f_op->poll)
400 revents = filp->f_op->poll(filp, NULL) & events;
408 linux_dev_mmap(struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr,
409 int nprot, vm_memattr_t *memattr)
412 /* XXX memattr not honored. */
418 linux_dev_mmap_single(struct cdev *dev, vm_ooffset_t *offset,
419 vm_size_t size, struct vm_object **object, int nprot)
421 struct linux_cdev *ldev;
422 struct linux_file *filp;
424 struct vm_area_struct vma;
429 file = curthread->td_fpop;
433 if (size != PAGE_SIZE)
435 if ((error = devfs_get_cdevpriv((void **)&filp)) != 0)
437 filp->f_flags = file->f_flag;
439 vma.vm_end = PAGE_SIZE;
440 vma.vm_pgoff = *offset / PAGE_SIZE;
442 vma.vm_page_prot = 0;
443 if (filp->f_op->mmap) {
444 error = -filp->f_op->mmap(filp, &vma);
446 paddr = (vm_paddr_t)vma.vm_pfn << PAGE_SHIFT;
448 m = PHYS_TO_VM_PAGE(paddr);
449 *object = vm_pager_allocate(OBJT_DEVICE, dev,
450 PAGE_SIZE, nprot, *offset, curthread->td_ucred);
453 if (vma.vm_page_prot != VM_MEMATTR_DEFAULT)
454 pmap_page_set_memattr(m, vma.vm_page_prot);
462 struct cdevsw linuxcdevsw = {
463 .d_version = D_VERSION,
464 .d_flags = D_TRACKCLOSE,
465 .d_open = linux_dev_open,
466 .d_close = linux_dev_close,
467 .d_read = linux_dev_read,
468 .d_write = linux_dev_write,
469 .d_ioctl = linux_dev_ioctl,
470 .d_mmap_single = linux_dev_mmap_single,
471 .d_mmap = linux_dev_mmap,
472 .d_poll = linux_dev_poll,
476 linux_file_read(struct file *file, struct uio *uio, struct ucred *active_cred,
477 int flags, struct thread *td)
479 struct linux_file *filp;
484 filp = (struct linux_file *)file->f_data;
485 filp->f_flags = file->f_flag;
486 if (uio->uio_iovcnt != 1)
487 panic("linux_file_read: uio %p iovcnt %d",
488 uio, uio->uio_iovcnt);
489 if (filp->f_op->read) {
490 bytes = filp->f_op->read(filp, uio->uio_iov->iov_base,
491 uio->uio_iov->iov_len, &uio->uio_offset);
493 uio->uio_iov->iov_base += bytes;
494 uio->uio_iov->iov_len -= bytes;
495 uio->uio_resid -= bytes;
505 linux_file_poll(struct file *file, int events, struct ucred *active_cred,
508 struct linux_file *filp;
511 filp = (struct linux_file *)file->f_data;
512 filp->f_flags = file->f_flag;
513 if (filp->f_op->poll)
514 revents = filp->f_op->poll(filp, NULL) & events;
522 linux_file_close(struct file *file, struct thread *td)
524 struct linux_file *filp;
527 filp = (struct linux_file *)file->f_data;
528 filp->f_flags = file->f_flag;
529 error = -filp->f_op->release(NULL, filp);
530 funsetown(&filp->f_sigio);
537 linux_file_ioctl(struct file *fp, u_long cmd, void *data, struct ucred *cred,
540 struct linux_file *filp;
543 filp = (struct linux_file *)fp->f_data;
544 filp->f_flags = fp->f_flag;
551 if (filp->f_op->fasync == NULL)
553 error = filp->f_op->fasync(0, filp, fp->f_flag & FASYNC);
556 error = fsetown(*(int *)data, &filp->f_sigio);
558 error = filp->f_op->fasync(0, filp,
559 fp->f_flag & FASYNC);
562 *(int *)data = fgetown(&filp->f_sigio);
571 struct fileops linuxfileops = {
572 .fo_read = linux_file_read,
573 .fo_poll = linux_file_poll,
574 .fo_close = linux_file_close,
575 .fo_ioctl = linux_file_ioctl,
576 .fo_chmod = invfo_chmod,
577 .fo_chown = invfo_chown,
578 .fo_sendfile = invfo_sendfile,
582 * Hash of vmmap addresses. This is infrequently accessed and does not
583 * need to be particularly large. This is done because we must store the
584 * caller's idea of the map size to properly unmap.
587 LIST_ENTRY(vmmap) vm_next;
589 unsigned long vm_size;
592 LIST_HEAD(vmmaphd, vmmap);
593 #define VMMAP_HASH_SIZE 64
594 #define VMMAP_HASH_MASK (VMMAP_HASH_SIZE - 1)
595 #define VM_HASH(addr) ((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK
596 static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE];
597 static struct mtx vmmaplock;
600 vmmap_add(void *addr, unsigned long size)
604 vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL);
605 mtx_lock(&vmmaplock);
606 vmmap->vm_size = size;
607 vmmap->vm_addr = addr;
608 LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next);
609 mtx_unlock(&vmmaplock);
612 static struct vmmap *
613 vmmap_remove(void *addr)
617 mtx_lock(&vmmaplock);
618 LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next)
619 if (vmmap->vm_addr == addr)
622 LIST_REMOVE(vmmap, vm_next);
623 mtx_unlock(&vmmaplock);
629 _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr)
633 addr = pmap_mapdev_attr(phys_addr, size, attr);
636 vmmap_add(addr, size);
646 vmmap = vmmap_remove(addr);
649 pmap_unmapdev((vm_offset_t)addr, vmmap->vm_size);
655 vmap(struct page **pages, unsigned int count, unsigned long flags, int prot)
660 size = count * PAGE_SIZE;
661 off = kva_alloc(size);
664 vmmap_add((void *)off, size);
665 pmap_qenter(off, pages, count);
667 return ((void *)off);
675 vmmap = vmmap_remove(addr);
678 pmap_qremove((vm_offset_t)addr, vmmap->vm_size / PAGE_SIZE);
679 kva_free((vm_offset_t)addr, vmmap->vm_size);
684 linux_compat_init(void)
686 struct sysctl_oid *rootoid;
689 rootoid = SYSCTL_ADD_NODE(NULL, SYSCTL_STATIC_CHILDREN(),
690 OID_AUTO, "sys", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "sys");
691 kobject_init(&class_root, &class_ktype);
692 kobject_set_name(&class_root, "class");
693 class_root.oidp = SYSCTL_ADD_NODE(NULL, SYSCTL_CHILDREN(rootoid),
694 OID_AUTO, "class", CTLFLAG_RD|CTLFLAG_MPSAFE, NULL, "class");
695 kobject_init(&linux_rootdev.kobj, &dev_ktype);
696 kobject_set_name(&linux_rootdev.kobj, "device");
697 linux_rootdev.kobj.oidp = SYSCTL_ADD_NODE(NULL,
698 SYSCTL_CHILDREN(rootoid), OID_AUTO, "device", CTLFLAG_RD, NULL,
700 linux_rootdev.bsddev = root_bus;
701 miscclass.name = "misc";
702 class_register(&miscclass);
703 INIT_LIST_HEAD(&pci_drivers);
704 INIT_LIST_HEAD(&pci_devices);
705 spin_lock_init(&pci_lock);
706 mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF);
707 for (i = 0; i < VMMAP_HASH_SIZE; i++)
708 LIST_INIT(&vmmaphead[i]);
711 SYSINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_init, NULL);
714 linux_compat_uninit(void)
716 kobject_kfree_name(&class_root);
717 kobject_kfree_name(&linux_rootdev.kobj);
718 kobject_kfree_name(&miscclass.kobj);
720 SYSUNINIT(linux_compat, SI_SUB_DRIVERS, SI_ORDER_SECOND, linux_compat_uninit, NULL);