1 /*- 2 * Copyright (c) 2015 Oleksandr Tymoshenko <gonzo@freebsd.org> 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 1. Redistributions of source code must retain the above copyright 8 * notice, this list of conditions and the following disclaimer. 9 * 2. Redistributions in binary form must reproduce the above copyright 10 * notice, this list of conditions and the following disclaimer in the 11 * documentation and/or other materials provided with the distribution. 12 * 13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 17 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23 * SUCH DAMAGE. 24 */ 25 #include <sys/cdefs.h> 26 __FBSDID("$FreeBSD$"); 27 28 #include <sys/param.h> 29 #include <sys/systm.h> 30 #include <sys/kernel.h> 31 #include <sys/malloc.h> 32 #include <sys/module.h> 33 #include <sys/ioccom.h> 34 #include <sys/conf.h> 35 #include <sys/proc.h> 36 37 #include <arm/broadcom/bcm2835/bcm2835_mbox_prop.h> 38 39 MALLOC_DECLARE(M_VCIO); 40 MALLOC_DEFINE(M_VCIO, "vcio", "VCIO temporary buffers"); 41 42 static struct cdev *sdev; 43 static d_ioctl_t vcio_ioctl; 44 45 static struct cdevsw vcio_devsw = { 46 /* version */ .d_version = D_VERSION, 47 /* ioctl */ .d_ioctl = vcio_ioctl, 48 }; 49 50 #define VCIO_IOC_MAGIC 100 51 #define IOCTL_MBOX_PROPERTY _IOWR(VCIO_IOC_MAGIC, 0, char *) 52 53 int 54 vcio_ioctl(struct cdev *dev, u_long cmd, caddr_t arg, int mode, 55 struct thread *td) 56 { 57 int error; 58 void *ptr; 59 uint32_t size; 60 uint8_t *property; 61 62 error = 0; 63 switch(cmd) { 64 case IOCTL_MBOX_PROPERTY: 65 memcpy (&ptr, arg, sizeof(ptr)); 66 error = copyin(ptr, &size, sizeof(size)); 67 68 if (error != 0) 69 break; 70 property = malloc(size, M_VCIO, M_WAITOK); 71 72 error = copyin(ptr, property, size); 73 if (error) { 74 free(property, M_VCIO); 75 break; 76 } 77 78 error = bcm2835_mbox_property(property, size); 79 if (error) { 80 free(property, M_VCIO); 81 break; 82 } 83 84 error = copyout(property, ptr, size); 85 free(property, M_VCIO); 86 87 break; 88 default: 89 error = EINVAL; 90 break; 91 } 92 return (error); 93 } 94 95 static int 96 vcio_load(module_t mod, int cmd, void *arg) 97 { 98 int err = 0; 99 100 switch (cmd) { 101 case MOD_LOAD: 102 sdev = make_dev(&vcio_devsw, 0, UID_ROOT, GID_WHEEL, 0600, "vcio"); 103 break; 104 105 case MOD_UNLOAD: 106 destroy_dev(sdev); 107 break; 108 109 default: 110 err = EOPNOTSUPP; 111 break; 112 } 113 114 return(err); 115 } 116 117 DEV_MODULE(vcio, vcio_load, NULL); 118 MODULE_DEPEND(vcio, mbox, 1, 1, 1); 119