bcm2835_vcio.c revision 290382 
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: head/sys/arm/broadcom/bcm2835/bcm2835_vcio.c 290382 2015-11-05 04:16:03Z gonzo $");
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
39MALLOC_DECLARE(M_VCIO);
40MALLOC_DEFINE(M_VCIO, "vcio", "VCIO temporary buffers");
41
42static struct cdev *sdev;
43static d_ioctl_t vcio_ioctl;
44
45static 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
53int
54vcio_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	if (property == NULL) {
72		error = ENOMEM;
73		break;
74	}
75
76	error = copyin(ptr, property, size);
77	if (error) {
78		free(property, M_VCIO);
79		break;
80	}
81
82	error = bcm2835_mbox_property(property, size);
83	if (error) {
84		free(property, M_VCIO);
85		break;
86	}
87
88	error = copyout(property, ptr, size);
89	free(property, M_VCIO);
90
91	break;
92    default:
93	error = EINVAL;
94	break;
95    }
96    return (error);
97}
98
99static int
100vcio_load(module_t mod, int cmd, void *arg)
101{
102    int  err = 0;
103
104    switch (cmd) {
105    case MOD_LOAD:
106	sdev = make_dev(&vcio_devsw, 0, UID_ROOT, GID_WHEEL, 0600, "vcio");
107	break;
108
109    case MOD_UNLOAD:
110	destroy_dev(sdev);
111	break;
112
113    default:
114	err = EOPNOTSUPP;
115	break;
116    }
117
118    return(err);
119}
120
121DEV_MODULE(vcio, vcio_load, NULL);
122MODULE_DEPEND(vcio, mbox, 1, 1, 1);
123