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