ofhandlers.c revision 1.5.6.1 1 1.5.6.1 yamt /* $NetBSD: ofhandlers.c,v 1.5.6.1 2014/05/22 11:43:03 yamt Exp $ */
2 1.1 macallan
3 1.1 macallan /*-
4 1.1 macallan * Copyright (c) 1996 The NetBSD Foundation, Inc.
5 1.1 macallan * All rights reserved.
6 1.1 macallan *
7 1.1 macallan * This code is derived from software contributed to The NetBSD Foundation
8 1.1 macallan * by Jason R. Thorpe.
9 1.1 macallan *
10 1.1 macallan * Redistribution and use in source and binary forms, with or without
11 1.1 macallan * modification, are permitted provided that the following conditions
12 1.1 macallan * are met:
13 1.1 macallan * 1. Redistributions of source code must retain the above copyright
14 1.1 macallan * notice, this list of conditions and the following disclaimer.
15 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 macallan * notice, this list of conditions and the following disclaimer in the
17 1.1 macallan * documentation and/or other materials provided with the distribution.
18 1.1 macallan *
19 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 macallan * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 macallan * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 macallan * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 macallan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 macallan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 macallan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 macallan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 macallan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 macallan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 macallan * POSSIBILITY OF SUCH DAMAGE.
30 1.1 macallan */
31 1.1 macallan
32 1.1 macallan #include <sys/types.h>
33 1.1 macallan #include <sys/ioctl.h>
34 1.1 macallan #include <err.h>
35 1.1 macallan #include <errno.h>
36 1.1 macallan #include <fcntl.h>
37 1.1 macallan #include <stdio.h>
38 1.1 macallan #include <string.h>
39 1.1 macallan #include <unistd.h>
40 1.1 macallan
41 1.1 macallan #include <dev/ofw/openfirmio.h>
42 1.1 macallan
43 1.1 macallan #include "defs.h"
44 1.1 macallan
45 1.1 macallan extern char *path_openfirm;
46 1.1 macallan extern int eval;
47 1.1 macallan extern int verbose;
48 1.1 macallan
49 1.1 macallan static char err_str[BUFSIZE];
50 1.1 macallan
51 1.5.6.1 yamt static void of_notsupp(const struct extabent *, struct ofiocdesc *, char *);
52 1.5.6.1 yamt static void of_uint32h(const struct extabent *, struct ofiocdesc *, char *);
53 1.5.6.1 yamt static void of_uint32d(const struct extabent *, struct ofiocdesc *, char *);
54 1.1 macallan
55 1.1 macallan /*
56 1.1 macallan * There are several known fields that I either don't know how to
57 1.1 macallan * deal with or require special treatment.
58 1.1 macallan */
59 1.5.6.1 yamt static const struct extabent ofextab[] = {
60 1.1 macallan { "security-password", of_notsupp },
61 1.1 macallan { "security-mode", of_notsupp },
62 1.1 macallan { "oem-logo", of_notsupp },
63 1.2 macallan { "oem-banner", of_notsupp },
64 1.2 macallan { "real-base", of_uint32h },
65 1.2 macallan { "real-size", of_uint32h },
66 1.2 macallan { "load-base", of_uint32h },
67 1.2 macallan { "virt-base", of_uint32h },
68 1.2 macallan { "virt-size", of_uint32h },
69 1.2 macallan { "screen-#columns", of_uint32d },
70 1.2 macallan { "screen-#rows", of_uint32d },
71 1.2 macallan { "selftest-#megs", of_uint32d },
72 1.1 macallan { NULL, of_notsupp },
73 1.1 macallan };
74 1.1 macallan
75 1.1 macallan #define BARF(str1, str2) { \
76 1.1 macallan snprintf(err_str, sizeof err_str, "%s: %s", (str1), (str2)); \
77 1.1 macallan ++eval; \
78 1.1 macallan return (err_str); \
79 1.1 macallan };
80 1.1 macallan
81 1.1 macallan void
82 1.5.6.1 yamt of_action(char *keyword, char *arg)
83 1.1 macallan {
84 1.1 macallan char *cp;
85 1.1 macallan
86 1.1 macallan if ((cp = of_handler(keyword, arg)) != NULL)
87 1.1 macallan warnx("%s", cp);
88 1.1 macallan return;
89 1.1 macallan }
90 1.1 macallan
91 1.1 macallan char *
92 1.5.6.1 yamt of_handler(char *keyword, char *arg)
93 1.1 macallan {
94 1.1 macallan struct ofiocdesc ofio;
95 1.5.6.1 yamt const struct extabent *ex;
96 1.1 macallan char ofio_buf[BUFSIZE];
97 1.1 macallan int fd, optnode;
98 1.1 macallan
99 1.1 macallan if ((fd = open(path_openfirm, arg ? O_RDWR : O_RDONLY, 0640)) < 0)
100 1.1 macallan BARF(path_openfirm, strerror(errno));
101 1.1 macallan
102 1.1 macallan /* Check to see if it's a special-case keyword. */
103 1.1 macallan for (ex = ofextab; ex->ex_keyword != NULL; ++ex)
104 1.1 macallan if (strcmp(ex->ex_keyword, keyword) == 0)
105 1.1 macallan break;
106 1.1 macallan
107 1.5 wiz if (ioctl(fd, OFIOCGETOPTNODE, (char *)&optnode) < 0) {
108 1.5 wiz (void)close(fd);
109 1.1 macallan BARF("OFIOCGETOPTNODE", strerror(errno));
110 1.5 wiz }
111 1.1 macallan
112 1.1 macallan memset(&ofio_buf[0], 0, sizeof(ofio_buf));
113 1.1 macallan memset(&ofio, 0, sizeof(ofio));
114 1.1 macallan ofio.of_nodeid = optnode;
115 1.1 macallan ofio.of_name = keyword;
116 1.1 macallan ofio.of_namelen = strlen(ofio.of_name);
117 1.1 macallan
118 1.1 macallan if (arg) {
119 1.1 macallan if (verbose) {
120 1.1 macallan printf("old: ");
121 1.1 macallan
122 1.1 macallan ofio.of_buf = &ofio_buf[0];
123 1.1 macallan ofio.of_buflen = sizeof(ofio_buf);
124 1.5 wiz if (ioctl(fd, OFIOCGET, (char *)&ofio) < 0) {
125 1.5 wiz (void)close(fd);
126 1.1 macallan BARF("OFIOCGET", strerror(errno));
127 1.5 wiz }
128 1.1 macallan
129 1.1 macallan if (ofio.of_buflen <= 0) {
130 1.1 macallan printf("nothing available for %s\n", keyword);
131 1.1 macallan goto out;
132 1.1 macallan }
133 1.1 macallan
134 1.1 macallan if (ex->ex_keyword != NULL)
135 1.1 macallan (*ex->ex_handler)(ex, &ofio, NULL);
136 1.1 macallan else
137 1.1 macallan printf("%s\n", ofio.of_buf);
138 1.1 macallan }
139 1.1 macallan out:
140 1.1 macallan if (ex->ex_keyword != NULL)
141 1.1 macallan (*ex->ex_handler)(ex, &ofio, arg);
142 1.1 macallan else {
143 1.1 macallan ofio.of_buf = arg;
144 1.1 macallan ofio.of_buflen = strlen(arg);
145 1.1 macallan }
146 1.1 macallan
147 1.5 wiz if (ioctl(fd, OFIOCSET, (char *)&ofio) < 0) {
148 1.5 wiz (void)close(fd);
149 1.1 macallan BARF("invalid keyword", keyword);
150 1.5 wiz }
151 1.1 macallan
152 1.1 macallan if (verbose) {
153 1.1 macallan printf("new: ");
154 1.1 macallan if (ex->ex_keyword != NULL)
155 1.1 macallan (*ex->ex_handler)(ex, &ofio, NULL);
156 1.1 macallan else
157 1.1 macallan printf("%s\n", ofio.of_buf);
158 1.1 macallan }
159 1.1 macallan } else {
160 1.1 macallan ofio.of_buf = &ofio_buf[0];
161 1.1 macallan ofio.of_buflen = sizeof(ofio_buf);
162 1.5 wiz if (ioctl(fd, OFIOCGET, (char *)&ofio) < 0) {
163 1.5 wiz (void)close(fd);
164 1.1 macallan BARF("OFIOCGET", strerror(errno));
165 1.5 wiz }
166 1.1 macallan
167 1.1 macallan if (ofio.of_buflen <= 0) {
168 1.1 macallan (void)snprintf(err_str, sizeof err_str,
169 1.1 macallan "nothing available for %s", keyword);
170 1.1 macallan return (err_str);
171 1.1 macallan }
172 1.1 macallan
173 1.1 macallan if (ex->ex_keyword != NULL)
174 1.1 macallan (*ex->ex_handler)(ex, &ofio, NULL);
175 1.1 macallan else
176 1.1 macallan printf("%s=%s\n", keyword, ofio.of_buf);
177 1.1 macallan }
178 1.1 macallan
179 1.1 macallan (void)close(fd);
180 1.1 macallan return (NULL);
181 1.1 macallan }
182 1.1 macallan
183 1.1 macallan /* ARGSUSED */
184 1.1 macallan static void
185 1.5.6.1 yamt of_notsupp(const struct extabent *exent, struct ofiocdesc *ofiop, char *arg)
186 1.1 macallan {
187 1.1 macallan
188 1.1 macallan warnx("property `%s' not yet supported", exent->ex_keyword);
189 1.1 macallan }
190 1.1 macallan
191 1.2 macallan static void
192 1.5.6.1 yamt of_uint32h(const struct extabent *exent, struct ofiocdesc *ofiop, char *arg)
193 1.2 macallan {
194 1.2 macallan
195 1.2 macallan printf("%s=0x%08x\n", exent->ex_keyword, *(uint32_t *)ofiop->of_buf);
196 1.2 macallan }
197 1.2 macallan
198 1.2 macallan static void
199 1.5.6.1 yamt of_uint32d(const struct extabent *exent, struct ofiocdesc *ofiop, char *arg)
200 1.2 macallan {
201 1.2 macallan
202 1.2 macallan printf("%s=%d\n", exent->ex_keyword, *(uint32_t *)ofiop->of_buf);
203 1.2 macallan }
204 1.2 macallan
205 1.1 macallan /*
206 1.1 macallan * XXX: This code is quite ugly. You have been warned.
207 1.1 macallan * (Really! This is the only way I could get it to work!)
208 1.1 macallan */
209 1.1 macallan void
210 1.5.6.1 yamt of_dump(void)
211 1.1 macallan {
212 1.1 macallan struct ofiocdesc ofio1, ofio2;
213 1.5.6.1 yamt const struct extabent *ex;
214 1.1 macallan char buf1[BUFSIZE], buf2[BUFSIZE], buf3[BUFSIZE], buf4[BUFSIZE];
215 1.1 macallan int fd, optnode;
216 1.1 macallan
217 1.1 macallan if ((fd = open(path_openfirm, O_RDONLY, 0640)) < 0)
218 1.1 macallan err(1, "open: %s", path_openfirm);
219 1.1 macallan
220 1.1 macallan if (ioctl(fd, OFIOCGETOPTNODE, (char *)&optnode) < 0)
221 1.1 macallan err(1, "OFIOCGETOPTNODE");
222 1.1 macallan
223 1.1 macallan memset(&ofio1, 0, sizeof(ofio1));
224 1.1 macallan
225 1.1 macallan /* This will grab the first property name from OPIOCNEXTPROP. */
226 1.1 macallan memset(buf1, 0, sizeof(buf1));
227 1.1 macallan memset(buf2, 0, sizeof(buf2));
228 1.1 macallan
229 1.1 macallan ofio1.of_nodeid = ofio2.of_nodeid = optnode;
230 1.1 macallan
231 1.1 macallan ofio1.of_name = buf1;
232 1.1 macallan ofio1.of_buf = buf2;
233 1.1 macallan
234 1.1 macallan ofio2.of_name = buf3;
235 1.1 macallan ofio2.of_buf = buf4;
236 1.1 macallan
237 1.1 macallan /*
238 1.1 macallan * For reference: ofio1 is for obtaining the name. Pass the
239 1.1 macallan * name of the last property read in of_name, and the next one
240 1.1 macallan * will be returned in of_buf. To get the first name, pass
241 1.1 macallan * an empty string. There are no more properties when an
242 1.1 macallan * empty string is returned.
243 1.1 macallan *
244 1.1 macallan * ofio2 is for obtaining the value associated with that name.
245 1.1 macallan * For some crazy reason, it seems as if we need to do all
246 1.1 macallan * of that gratuitious zapping and copying. *sigh*
247 1.1 macallan */
248 1.1 macallan for (;;) {
249 1.1 macallan ofio1.of_namelen = strlen(ofio1.of_name);
250 1.1 macallan ofio1.of_buflen = sizeof(buf2);
251 1.1 macallan
252 1.1 macallan if (ioctl(fd, OFIOCNEXTPROP, (char *)&ofio1) < 0) {
253 1.1 macallan close(fd);
254 1.1 macallan return;
255 1.1 macallan /* err(1, "ioctl: OFIOCNEXTPROP"); */
256 1.1 macallan }
257 1.1 macallan
258 1.1 macallan /*
259 1.1 macallan * The name of the property we wish to get the
260 1.1 macallan * value for has been stored in the value field
261 1.1 macallan * of ofio1. If the length of the name is 0, there
262 1.1 macallan * are no more properties left.
263 1.1 macallan */
264 1.1 macallan strcpy(ofio2.of_name, ofio1.of_buf); /* XXX strcpy is safe */
265 1.1 macallan ofio2.of_namelen = strlen(ofio2.of_name);
266 1.1 macallan
267 1.1 macallan if (ofio2.of_namelen == 0) {
268 1.1 macallan (void)close(fd);
269 1.1 macallan return;
270 1.1 macallan }
271 1.1 macallan
272 1.1 macallan memset(ofio2.of_buf, 0, sizeof(buf4));
273 1.1 macallan ofio2.of_buflen = sizeof(buf4);
274 1.1 macallan
275 1.1 macallan if (ioctl(fd, OFIOCGET, (char *)&ofio2) < 0)
276 1.1 macallan err(1, "ioctl: OFIOCGET");
277 1.1 macallan
278 1.1 macallan for (ex = ofextab; ex->ex_keyword != NULL; ++ex)
279 1.1 macallan if (strcmp(ex->ex_keyword, ofio2.of_name) == 0)
280 1.1 macallan break;
281 1.1 macallan
282 1.1 macallan if (ex->ex_keyword != NULL)
283 1.1 macallan (*ex->ex_handler)(ex, &ofio2, NULL);
284 1.1 macallan else
285 1.1 macallan printf("%s=%s\n", ofio2.of_name, ofio2.of_buf);
286 1.1 macallan
287 1.1 macallan /*
288 1.1 macallan * Place the name of the last read value back into
289 1.1 macallan * ofio1 so that we may obtain the next name.
290 1.1 macallan */
291 1.1 macallan memset(ofio1.of_name, 0, sizeof(buf1));
292 1.1 macallan memset(ofio1.of_buf, 0, sizeof(buf2));
293 1.1 macallan strcpy(ofio1.of_name, ofio2.of_name); /* XXX strcpy is safe */
294 1.1 macallan }
295 1.1 macallan /* NOTREACHED */
296 1.1 macallan }
297