Deleted Added
sdiff udiff text old ( 190522 ) new ( 194138 )
full compact
openfirm.c (190522) openfirm.c (194138)
1/* $NetBSD: Locore.c,v 1.7 2000/08/20 07:04:59 tsubai Exp $ */
2
3/*-
4 * Copyright (C) 1995, 1996 Wolfgang Solfrank.
5 * Copyright (C) 1995, 1996 TooLs GmbH.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without

--- 42 unchanged lines hidden (view full) ---

51 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
52 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
53 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
54 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
55 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
56 */
57
58#include <sys/cdefs.h>
1/* $NetBSD: Locore.c,v 1.7 2000/08/20 07:04:59 tsubai Exp $ */
2
3/*-
4 * Copyright (C) 1995, 1996 Wolfgang Solfrank.
5 * Copyright (C) 1995, 1996 TooLs GmbH.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without

--- 42 unchanged lines hidden (view full) ---

51 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
52 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
53 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
54 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
55 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
56 */
57
58#include <sys/cdefs.h>
59__FBSDID("$FreeBSD: head/sys/dev/ofw/openfirm.c 190522 2009-03-29 15:10:49Z marius $");
59__FBSDID("$FreeBSD: head/sys/dev/ofw/openfirm.c 194138 2009-06-14 00:05:38Z marius $");
60
61#include <sys/param.h>
62#include <sys/kernel.h>
63#include <sys/malloc.h>
64#include <sys/systm.h>
65
66#include <machine/stdarg.h>
67
60
61#include <sys/param.h>
62#include <sys/kernel.h>
63#include <sys/malloc.h>
64#include <sys/systm.h>
65
66#include <machine/stdarg.h>
67
68#include <dev/ofw/openfirm.h>
69#include <dev/ofw/ofwvar.h>
68#include <dev/ofw/ofwvar.h>
69#include <dev/ofw/openfirm.h>
70
71#include "ofw_if.h"
72
73MALLOC_DEFINE(M_OFWPROP, "openfirm", "Open Firmware properties");
74
75static ihandle_t stdout;
76
77static ofw_def_t *ofw_def_impl;

--- 5 unchanged lines hidden (view full) ---

83 * OFW install routines. Highest priority wins, equal priority also
84 * overrides allowing last-set to win.
85 */
86SET_DECLARE(ofw_set, ofw_def_t);
87
88boolean_t
89OF_install(char *name, int prio)
90{
70
71#include "ofw_if.h"
72
73MALLOC_DEFINE(M_OFWPROP, "openfirm", "Open Firmware properties");
74
75static ihandle_t stdout;
76
77static ofw_def_t *ofw_def_impl;

--- 5 unchanged lines hidden (view full) ---

83 * OFW install routines. Highest priority wins, equal priority also
84 * overrides allowing last-set to win.
85 */
86SET_DECLARE(ofw_set, ofw_def_t);
87
88boolean_t
89OF_install(char *name, int prio)
90{
91 ofw_def_t **ofwpp, *ofwp;
91 ofw_def_t *ofwp, **ofwpp;
92 static int curr_prio = 0;
93
94 /*
92 static int curr_prio = 0;
93
94 /*
95 * Try and locate the OFW kobj corresponding to the name
96 */
95 * Try and locate the OFW kobj corresponding to the name.
96 */
97 SET_FOREACH(ofwpp, ofw_set) {
98 ofwp = *ofwpp;
99
100 if (ofwp->name &&
101 !strcmp(ofwp->name, name) &&
102 prio >= curr_prio) {
103 curr_prio = prio;
104 ofw_def_impl = ofwp;
105 return (TRUE);
106 }
107 }
108
109 return (FALSE);
110}
111
97 SET_FOREACH(ofwpp, ofw_set) {
98 ofwp = *ofwpp;
99
100 if (ofwp->name &&
101 !strcmp(ofwp->name, name) &&
102 prio >= curr_prio) {
103 curr_prio = prio;
104 ofw_def_impl = ofwp;
105 return (TRUE);
106 }
107 }
108
109 return (FALSE);
110}
111
112/* Initialiser */
113
112/* Initializer */
114void
115OF_init(void *cookie)
116{
117 phandle_t chosen;
118
119 ofw_obj = &ofw_kernel_obj;
120 /*
121 * Take care of compiling the selected class, and
113void
114OF_init(void *cookie)
115{
116 phandle_t chosen;
117
118 ofw_obj = &ofw_kernel_obj;
119 /*
120 * Take care of compiling the selected class, and
122 * then statically initialize the OFW object
121 * then statically initialize the OFW object.
123 */
124 kobj_class_compile_static(ofw_def_impl, &ofw_kernel_kops);
125 kobj_init((kobj_t)ofw_obj, ofw_def_impl);
126
127 OFW_INIT(ofw_obj, cookie);
128
129 if ((chosen = OF_finddevice("/chosen")) == -1)
130 OF_exit();

--- 16 unchanged lines hidden (view full) ---

147/*
148 * Generic functions
149 */
150
151/* Test to see if a service exists. */
152int
153OF_test(const char *name)
154{
122 */
123 kobj_class_compile_static(ofw_def_impl, &ofw_kernel_kops);
124 kobj_init((kobj_t)ofw_obj, ofw_def_impl);
125
126 OFW_INIT(ofw_obj, cookie);
127
128 if ((chosen = OF_finddevice("/chosen")) == -1)
129 OF_exit();

--- 16 unchanged lines hidden (view full) ---

146/*
147 * Generic functions
148 */
149
150/* Test to see if a service exists. */
151int
152OF_test(const char *name)
153{
154
155 return (OFW_TEST(ofw_obj, name));
156}
157
158int
159OF_interpret(const char *cmd, int nreturns, ...)
160{
161 va_list ap;
162 unsigned long slots[16];

--- 15 unchanged lines hidden (view full) ---

178/*
179 * Device tree functions
180 */
181
182/* Return the next sibling of this node or 0. */
183phandle_t
184OF_peer(phandle_t node)
185{
155 return (OFW_TEST(ofw_obj, name));
156}
157
158int
159OF_interpret(const char *cmd, int nreturns, ...)
160{
161 va_list ap;
162 unsigned long slots[16];

--- 15 unchanged lines hidden (view full) ---

178/*
179 * Device tree functions
180 */
181
182/* Return the next sibling of this node or 0. */
183phandle_t
184OF_peer(phandle_t node)
185{
186
186 return (OFW_PEER(ofw_obj, node));
187}
188
189/* Return the first child of this node or 0. */
190phandle_t
191OF_child(phandle_t node)
192{
187 return (OFW_PEER(ofw_obj, node));
188}
189
190/* Return the first child of this node or 0. */
191phandle_t
192OF_child(phandle_t node)
193{
194
193 return (OFW_CHILD(ofw_obj, node));
194}
195
196/* Return the parent of this node or 0. */
197phandle_t
198OF_parent(phandle_t node)
199{
195 return (OFW_CHILD(ofw_obj, node));
196}
197
198/* Return the parent of this node or 0. */
199phandle_t
200OF_parent(phandle_t node)
201{
202
200 return (OFW_PARENT(ofw_obj, node));
201}
202
203/* Return the package handle that corresponds to an instance handle. */
204phandle_t
205OF_instance_to_package(ihandle_t instance)
206{
203 return (OFW_PARENT(ofw_obj, node));
204}
205
206/* Return the package handle that corresponds to an instance handle. */
207phandle_t
208OF_instance_to_package(ihandle_t instance)
209{
210
207 return (OFW_INSTANCE_TO_PACKAGE(ofw_obj, instance));
208}
209
210/* Get the length of a property of a package. */
211ssize_t
212OF_getproplen(phandle_t package, const char *propname)
213{
211 return (OFW_INSTANCE_TO_PACKAGE(ofw_obj, instance));
212}
213
214/* Get the length of a property of a package. */
215ssize_t
216OF_getproplen(phandle_t package, const char *propname)
217{
218
214 return (OFW_GETPROPLEN(ofw_obj, package, propname));
215}
216
217/* Get the value of a property of a package. */
218ssize_t
219OF_getprop(phandle_t package, const char *propname, void *buf, size_t buflen)
220{
219 return (OFW_GETPROPLEN(ofw_obj, package, propname));
220}
221
222/* Get the value of a property of a package. */
223ssize_t
224OF_getprop(phandle_t package, const char *propname, void *buf, size_t buflen)
225{
226
221 return (OFW_GETPROP(ofw_obj, package, propname, buf, buflen));
222}
223
224/*
225 * Resursively search the node and its parent for the given property, working
226 * downward from the node to the device tree root. Returns the value of the
227 * first match.
228 */
229ssize_t
227 return (OFW_GETPROP(ofw_obj, package, propname, buf, buflen));
228}
229
230/*
231 * Resursively search the node and its parent for the given property, working
232 * downward from the node to the device tree root. Returns the value of the
233 * first match.
234 */
235ssize_t
230OF_searchprop(phandle_t node, char *propname, void *buf, size_t len)
236OF_searchprop(phandle_t node, const char *propname, void *buf, size_t len)
231{
232 ssize_t rv;
233
237{
238 ssize_t rv;
239
234 for (; node != 0; node = OF_parent(node)) {
240 for (; node != 0; node = OF_parent(node))
235 if ((rv = OF_getprop(node, propname, buf, len)) != -1)
236 return (rv);
241 if ((rv = OF_getprop(node, propname, buf, len)) != -1)
242 return (rv);
237 }
238 return (-1);
239}
240
241/*
242 * Store the value of a property of a package into newly allocated memory
243 return (-1);
244}
245
246/*
247 * Store the value of a property of a package into newly allocated memory
243 * (using the M_OFWPROP malloc pool and M_WAITOK). elsz is the size of a
248 * (using the M_OFWPROP malloc pool and M_WAITOK). elsz is the size of a
244 * single element, the number of elements is return in number.
245 */
246ssize_t
247OF_getprop_alloc(phandle_t package, const char *propname, int elsz, void **buf)
248{
249 int len;
250
251 *buf = NULL;

--- 9 unchanged lines hidden (view full) ---

261 }
262 return (len / elsz);
263}
264
265/* Get the next property of a package. */
266int
267OF_nextprop(phandle_t package, const char *previous, char *buf, size_t size)
268{
249 * single element, the number of elements is return in number.
250 */
251ssize_t
252OF_getprop_alloc(phandle_t package, const char *propname, int elsz, void **buf)
253{
254 int len;
255
256 *buf = NULL;

--- 9 unchanged lines hidden (view full) ---

266 }
267 return (len / elsz);
268}
269
270/* Get the next property of a package. */
271int
272OF_nextprop(phandle_t package, const char *previous, char *buf, size_t size)
273{
274
269 return (OFW_NEXTPROP(ofw_obj, package, previous, buf, size));
270}
271
272/* Set the value of a property of a package. */
273int
274OF_setprop(phandle_t package, const char *propname, const void *buf, size_t len)
275{
275 return (OFW_NEXTPROP(ofw_obj, package, previous, buf, size));
276}
277
278/* Set the value of a property of a package. */
279int
280OF_setprop(phandle_t package, const char *propname, const void *buf, size_t len)
281{
282
276 return (OFW_SETPROP(ofw_obj, package, propname, buf,len));
277}
278
279/* Convert a device specifier to a fully qualified pathname. */
280ssize_t
281OF_canon(const char *device, char *buf, size_t len)
282{
283 return (OFW_SETPROP(ofw_obj, package, propname, buf,len));
284}
285
286/* Convert a device specifier to a fully qualified pathname. */
287ssize_t
288OF_canon(const char *device, char *buf, size_t len)
289{
290
283 return (OFW_CANON(ofw_obj, device, buf, len));
284}
285
286/* Return a package handle for the specified device. */
287phandle_t
288OF_finddevice(const char *device)
289{
291 return (OFW_CANON(ofw_obj, device, buf, len));
292}
293
294/* Return a package handle for the specified device. */
295phandle_t
296OF_finddevice(const char *device)
297{
298
290 return (OFW_FINDDEVICE(ofw_obj, device));
291}
292
293/* Return the fully qualified pathname corresponding to an instance. */
294ssize_t
295OF_instance_to_path(ihandle_t instance, char *buf, size_t len)
296{
299 return (OFW_FINDDEVICE(ofw_obj, device));
300}
301
302/* Return the fully qualified pathname corresponding to an instance. */
303ssize_t
304OF_instance_to_path(ihandle_t instance, char *buf, size_t len)
305{
306
297 return (OFW_INSTANCE_TO_PATH(ofw_obj, instance, buf, len));
298}
299
300/* Return the fully qualified pathname corresponding to a package. */
301ssize_t
302OF_package_to_path(phandle_t package, char *buf, size_t len)
303{
307 return (OFW_INSTANCE_TO_PATH(ofw_obj, instance, buf, len));
308}
309
310/* Return the fully qualified pathname corresponding to a package. */
311ssize_t
312OF_package_to_path(phandle_t package, char *buf, size_t len)
313{
314
304 return (OFW_PACKAGE_TO_PATH(ofw_obj, package, buf, len));
305}
306
307/* Call the method in the scope of a given instance. */
308int
309OF_call_method(const char *method, ihandle_t instance, int nargs, int nreturns,
310 ...)
311{

--- 4 unchanged lines hidden (view full) ---

316 if (nargs > 6)
317 return (-1);
318 va_start(ap, nreturns);
319 for (n = 0; n < nargs; n++)
320 args_n_results[n] = va_arg(ap, unsigned long);
321
322 status = OFW_CALL_METHOD(ofw_obj, instance, method, nargs, nreturns,
323 args_n_results);
315 return (OFW_PACKAGE_TO_PATH(ofw_obj, package, buf, len));
316}
317
318/* Call the method in the scope of a given instance. */
319int
320OF_call_method(const char *method, ihandle_t instance, int nargs, int nreturns,
321 ...)
322{

--- 4 unchanged lines hidden (view full) ---

327 if (nargs > 6)
328 return (-1);
329 va_start(ap, nreturns);
330 for (n = 0; n < nargs; n++)
331 args_n_results[n] = va_arg(ap, unsigned long);
332
333 status = OFW_CALL_METHOD(ofw_obj, instance, method, nargs, nreturns,
334 args_n_results);
324
325 if (status != 0)
326 return (status);
327
328 for (; n < nargs + nreturns; n++)
329 *va_arg(ap, unsigned long *) = args_n_results[n];
330 va_end(ap);
331 return (0);
332}
333
334/*
335 * Device I/O functions
336 */
337
338/* Open an instance for a device. */
339ihandle_t
340OF_open(const char *device)
341{
335 if (status != 0)
336 return (status);
337
338 for (; n < nargs + nreturns; n++)
339 *va_arg(ap, unsigned long *) = args_n_results[n];
340 va_end(ap);
341 return (0);
342}
343
344/*
345 * Device I/O functions
346 */
347
348/* Open an instance for a device. */
349ihandle_t
350OF_open(const char *device)
351{
352
342 return (OFW_OPEN(ofw_obj, device));
343}
344
345/* Close an instance. */
346void
347OF_close(ihandle_t instance)
348{
353 return (OFW_OPEN(ofw_obj, device));
354}
355
356/* Close an instance. */
357void
358OF_close(ihandle_t instance)
359{
360
349 OFW_CLOSE(ofw_obj, instance);
350}
351
352/* Read from an instance. */
353ssize_t
354OF_read(ihandle_t instance, void *addr, size_t len)
355{
361 OFW_CLOSE(ofw_obj, instance);
362}
363
364/* Read from an instance. */
365ssize_t
366OF_read(ihandle_t instance, void *addr, size_t len)
367{
368
356 return (OFW_READ(ofw_obj, instance, addr, len));
357}
358
359/* Write to an instance. */
360ssize_t
361OF_write(ihandle_t instance, const void *addr, size_t len)
362{
369 return (OFW_READ(ofw_obj, instance, addr, len));
370}
371
372/* Write to an instance. */
373ssize_t
374OF_write(ihandle_t instance, const void *addr, size_t len)
375{
376
363 return (OFW_WRITE(ofw_obj, instance, addr, len));
364}
365
366/* Seek to a position. */
367int
368OF_seek(ihandle_t instance, uint64_t pos)
369{
377 return (OFW_WRITE(ofw_obj, instance, addr, len));
378}
379
380/* Seek to a position. */
381int
382OF_seek(ihandle_t instance, uint64_t pos)
383{
384
370 return (OFW_SEEK(ofw_obj, instance, pos));
371}
372
373/*
374 * Memory functions
375 */
376
377/* Claim an area of memory. */
378void *
379OF_claim(void *virt, size_t size, u_int align)
380{
385 return (OFW_SEEK(ofw_obj, instance, pos));
386}
387
388/*
389 * Memory functions
390 */
391
392/* Claim an area of memory. */
393void *
394OF_claim(void *virt, size_t size, u_int align)
395{
396
381 return (OFW_CLAIM(ofw_obj, virt, size, align));
382}
383
384/* Release an area of memory. */
385void
386OF_release(void *virt, size_t size)
387{
397 return (OFW_CLAIM(ofw_obj, virt, size, align));
398}
399
400/* Release an area of memory. */
401void
402OF_release(void *virt, size_t size)
403{
404
388 OFW_RELEASE(ofw_obj, virt, size);
389}
390
391/*
392 * Control transfer functions
393 */
394
395/* Suspend and drop back to the Open Firmware interface. */
396void
397OF_enter()
398{
405 OFW_RELEASE(ofw_obj, virt, size);
406}
407
408/*
409 * Control transfer functions
410 */
411
412/* Suspend and drop back to the Open Firmware interface. */
413void
414OF_enter()
415{
416
399 OFW_ENTER(ofw_obj);
400}
401
402/* Shut down and drop back to the Open Firmware interface. */
403void
404OF_exit()
405{
417 OFW_ENTER(ofw_obj);
418}
419
420/* Shut down and drop back to the Open Firmware interface. */
421void
422OF_exit()
423{
424
406 /* Should not return */
407 OFW_EXIT(ofw_obj);
408
409 for (;;) /* just in case */
410 ;
411}
425 /* Should not return */
426 OFW_EXIT(ofw_obj);
427
428 for (;;) /* just in case */
429 ;
430}
412