1 /*-
2 * Copyright (c) 2003 Jake Burkholder.
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 *
26 */
27
28 #include <sys/cdefs.h>
29 __FBSDID("$FreeBSD: src/sys/dev/ofw/openpromio.c,v 1.6 2004/08/16 15:45:26 marius Exp $");
30
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/conf.h>
34 #include <sys/errno.h>
35 #include <sys/fcntl.h>
36 #include <sys/ioccom.h>
37 #include <sys/kernel.h>
38 #include <sys/malloc.h>
39 #include <sys/module.h>
40
41 #include <dev/ofw/openfirm.h>
42 #include <dev/ofw/openpromio.h>
43
44 /*
45 * This provides a Solaris compatible character device interface to
46 * Open Firmware. It exists entirely for compatibility with software
47 * like X11, and only the features that are actually needed for that
48 * are implemented. The interface sucks too much to actually use,
49 * new code should use the /dev/openfirm device.
50 */
51
52 static d_open_t openprom_open;
53 static d_close_t openprom_close;
54 static d_ioctl_t openprom_ioctl;
55
56 static int openprom_modevent(module_t mode, int type, void *data);
57 static int openprom_node_valid(phandle_t node);
58 static int openprom_node_search(phandle_t root, phandle_t node);
59
60 static struct cdevsw openprom_cdevsw = {
61 .d_version = D_VERSION,
62 .d_flags = D_NEEDGIANT,
63 .d_open = openprom_open,
64 .d_close = openprom_close,
65 .d_ioctl = openprom_ioctl,
66 .d_name = "openprom",
67 };
68
69 static int openprom_is_open;
70 static struct cdev *openprom_dev;
71 static phandle_t openprom_node;
72
73 static int
74 openprom_open(struct cdev *dev, int oflags, int devtype, struct thread *td)
75 {
76
77 if (openprom_is_open != 0)
78 return (EBUSY);
79 openprom_is_open = 1;
80 return (0);
81 }
82
83 static int
84 openprom_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
85 {
86
87 openprom_is_open = 0;
88 return (0);
89 }
90
91 static int
92 openprom_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int flags,
93 struct thread *td)
94 {
95 struct openpromio *oprom;
96 phandle_t node;
97 uint32_t len;
98 size_t done;
99 int proplen;
100 char *prop;
101 char *buf;
102 int error;
103
104 error = 0;
105 oprom = *(void **)data;
106 switch (cmd) {
107 case OPROMCHILD:
108 case OPROMNEXT:
109 error = copyin(&oprom->oprom_size, &len, sizeof(len));
110 if (error != 0)
111 break;
112 if (len != sizeof(node)) {
113 error = EINVAL;
114 break;
115 }
116 error = copyin(&oprom->oprom_array, &node, sizeof(node));
117 if (error != 0)
118 break;
119 error = openprom_node_valid(node);
120 if (error != 0)
121 break;
122 switch (cmd) {
123 case OPROMCHILD:
124 node = OF_child(node);
125 break;
126 case OPROMNEXT:
127 node = OF_peer(node);
128 break;
129 }
130 error = copyout(&node, &oprom->oprom_array, sizeof(node));
131 if (error != 0)
132 break;
133 openprom_node = node;
134 break;
135 case OPROMGETPROP:
136 case OPROMNXTPROP:
137 error = copyin(&oprom->oprom_size, &len, sizeof(len));
138 if (error != 0)
139 break;
140 if (len > OPROMMAXPARAM) {
141 error = EINVAL;
142 break;
143 }
144 prop = malloc(len, M_TEMP, M_WAITOK | M_ZERO);
145 error = copyinstr(&oprom->oprom_array, prop, len, &done);
146 if (error != 0)
147 break;
148 buf = malloc(OPROMMAXPARAM, M_TEMP, M_WAITOK | M_ZERO);
149 node = openprom_node;
150 switch (cmd) {
151 case OPROMGETPROP:
152 proplen = OF_getproplen(node, prop);
153 if (proplen > OPROMMAXPARAM) {
154 error = EINVAL;
155 break;
156 }
157 error = OF_getprop(node, prop, buf, proplen);
158 break;
159 case OPROMNXTPROP:
160 error = OF_nextprop(node, prop, buf);
161 proplen = strlen(buf);
162 break;
163 }
164 if (error != -1) {
165 error = copyout(&proplen, &oprom->oprom_size,
166 sizeof(proplen));
167 if (error == 0)
168 error = copyout(buf, &oprom->oprom_array,
169 proplen + 1);
170 } else
171 error = EINVAL;
172 free(prop, M_TEMP);
173 free(buf, M_TEMP);
174 break;
175 default:
176 error = ENOIOCTL;
177 break;
178 }
179 return (error);
180 }
181
182 static int
183 openprom_node_valid(phandle_t node)
184 {
185
186 if (node == 0)
187 return (0);
188 return (openprom_node_search(OF_peer(0), node));
189 }
190
191 static int
192 openprom_node_search(phandle_t root, phandle_t node)
193 {
194 phandle_t child;
195
196 if (root == node)
197 return (0);
198 for (child = OF_child(root); child != 0 && child != -1;
199 child = OF_peer(child))
200 if (openprom_node_search(child, node) == 0)
201 return (0);
202 return (EINVAL);
203 }
204
205 static int
206 openprom_modevent(module_t mode, int type, void *data)
207 {
208
209 switch (type) {
210 case MOD_LOAD:
211 openprom_dev = make_dev(&openprom_cdevsw, 0, UID_ROOT,
212 GID_WHEEL, 0600, "openprom");
213 return (0);
214 case MOD_UNLOAD:
215 destroy_dev(openprom_dev);
216 return (0);
217 default:
218 return (EOPNOTSUPP);
219 }
220 }
221
222 DEV_MODULE(openprom, openprom_modevent, NULL);
Cache object: f7193642dd423ca0704d590efd7af527
|