xref: /freebsd/sys/dev/ofw/ofw_bus_subr.c (revision 55620f43deef5c0eb5b4b0f675de18b30c8d1c2d)
1 /*-
2  * Copyright (c) 2001 - 2003 by Thomas Moestl <tmm@FreeBSD.org>.
3  * Copyright (c) 2005 Marius Strobl <marius@FreeBSD.org>
4  * All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  * 1. Redistributions of source code must retain the above copyright
10  *    notice, this list of conditions, and the following disclaimer,
11  *    without modification, immediately at the beginning of the file.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in
14  *    the documentation and/or other materials provided with the
15  *    distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
21  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  */
29 
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
32 
33 #include "opt_platform.h"
34 #include <sys/param.h>
35 #include <sys/systm.h>
36 #include <sys/bus.h>
37 #include <sys/errno.h>
38 #include <sys/libkern.h>
39 
40 #include <machine/resource.h>
41 
42 #include <dev/ofw/ofw_bus.h>
43 #include <dev/ofw/ofw_bus_subr.h>
44 #include <dev/ofw/openfirm.h>
45 
46 #include "ofw_bus_if.h"
47 
48 int
49 ofw_bus_gen_setup_devinfo(struct ofw_bus_devinfo *obd, phandle_t node)
50 {
51 
52 	if (obd == NULL)
53 		return (ENOMEM);
54 	/* The 'name' property is considered mandatory. */
55 	if ((OF_getprop_alloc(node, "name", 1, (void **)&obd->obd_name)) == -1)
56 		return (EINVAL);
57 	OF_getprop_alloc(node, "compatible", 1, (void **)&obd->obd_compat);
58 	OF_getprop_alloc(node, "device_type", 1, (void **)&obd->obd_type);
59 	OF_getprop_alloc(node, "model", 1, (void **)&obd->obd_model);
60 	OF_getprop_alloc(node, "status", 1, (void **)&obd->obd_status);
61 	obd->obd_node = node;
62 	return (0);
63 }
64 
65 void
66 ofw_bus_gen_destroy_devinfo(struct ofw_bus_devinfo *obd)
67 {
68 
69 	if (obd == NULL)
70 		return;
71 	if (obd->obd_compat != NULL)
72 		free(obd->obd_compat, M_OFWPROP);
73 	if (obd->obd_model != NULL)
74 		free(obd->obd_model, M_OFWPROP);
75 	if (obd->obd_name != NULL)
76 		free(obd->obd_name, M_OFWPROP);
77 	if (obd->obd_type != NULL)
78 		free(obd->obd_type, M_OFWPROP);
79 	if (obd->obd_status != NULL)
80 		free(obd->obd_status, M_OFWPROP);
81 }
82 
83 int
84 ofw_bus_gen_child_pnpinfo_str(device_t cbdev, device_t child, char *buf,
85     size_t buflen)
86 {
87 
88 	if (ofw_bus_get_name(child) != NULL) {
89 		strlcat(buf, "name=", buflen);
90 		strlcat(buf, ofw_bus_get_name(child), buflen);
91 	}
92 
93 	if (ofw_bus_get_compat(child) != NULL) {
94 		strlcat(buf, " compat=", buflen);
95 		strlcat(buf, ofw_bus_get_compat(child), buflen);
96 	}
97 	return (0);
98 };
99 
100 const char *
101 ofw_bus_gen_get_compat(device_t bus, device_t dev)
102 {
103 	const struct ofw_bus_devinfo *obd;
104 
105 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
106 	if (obd == NULL)
107 		return (NULL);
108 	return (obd->obd_compat);
109 }
110 
111 const char *
112 ofw_bus_gen_get_model(device_t bus, device_t dev)
113 {
114 	const struct ofw_bus_devinfo *obd;
115 
116 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
117 	if (obd == NULL)
118 		return (NULL);
119 	return (obd->obd_model);
120 }
121 
122 const char *
123 ofw_bus_gen_get_name(device_t bus, device_t dev)
124 {
125 	const struct ofw_bus_devinfo *obd;
126 
127 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
128 	if (obd == NULL)
129 		return (NULL);
130 	return (obd->obd_name);
131 }
132 
133 phandle_t
134 ofw_bus_gen_get_node(device_t bus, device_t dev)
135 {
136 	const struct ofw_bus_devinfo *obd;
137 
138 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
139 	if (obd == NULL)
140 		return (0);
141 	return (obd->obd_node);
142 }
143 
144 const char *
145 ofw_bus_gen_get_type(device_t bus, device_t dev)
146 {
147 	const struct ofw_bus_devinfo *obd;
148 
149 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
150 	if (obd == NULL)
151 		return (NULL);
152 	return (obd->obd_type);
153 }
154 
155 const char *
156 ofw_bus_get_status(device_t dev)
157 {
158 	const struct ofw_bus_devinfo *obd;
159 
160 	obd = OFW_BUS_GET_DEVINFO(device_get_parent(dev), dev);
161 	if (obd == NULL)
162 		return (NULL);
163 
164 	return (obd->obd_status);
165 }
166 
167 int
168 ofw_bus_status_okay(device_t dev)
169 {
170 	const char *status;
171 
172 	status = ofw_bus_get_status(dev);
173 	if (status == NULL || strcmp(status, "okay") == 0 ||
174 	    strcmp(status, "ok") == 0)
175 		return (1);
176 
177 	return (0);
178 }
179 
180 static int
181 ofw_bus_node_is_compatible(const char *compat, int len, const char *onecompat)
182 {
183 	int onelen, l, ret;
184 
185 	onelen = strlen(onecompat);
186 
187 	ret = 0;
188 	while (len > 0) {
189 		if (strlen(compat) == onelen &&
190 		    strncasecmp(compat, onecompat, onelen) == 0) {
191 			/* Found it. */
192 			ret = 1;
193 			break;
194 		}
195 
196 		/* Slide to the next sub-string. */
197 		l = strlen(compat) + 1;
198 		compat += l;
199 		len -= l;
200 	}
201 
202 	return (ret);
203 }
204 
205 int
206 ofw_bus_is_compatible(device_t dev, const char *onecompat)
207 {
208 	phandle_t node;
209 	const char *compat;
210 	int len;
211 
212 	if ((compat = ofw_bus_get_compat(dev)) == NULL)
213 		return (0);
214 
215 	if ((node = ofw_bus_get_node(dev)) == -1)
216 		return (0);
217 
218 	/* Get total 'compatible' prop len */
219 	if ((len = OF_getproplen(node, "compatible")) <= 0)
220 		return (0);
221 
222 	return (ofw_bus_node_is_compatible(compat, len, onecompat));
223 }
224 
225 int
226 ofw_bus_is_compatible_strict(device_t dev, const char *compatible)
227 {
228 	const char *compat;
229 	size_t len;
230 
231 	if ((compat = ofw_bus_get_compat(dev)) == NULL)
232 		return (0);
233 
234 	len = strlen(compatible);
235 	if (strlen(compat) == len &&
236 	    strncasecmp(compat, compatible, len) == 0)
237 		return (1);
238 
239 	return (0);
240 }
241 
242 const struct ofw_compat_data *
243 ofw_bus_search_compatible(device_t dev, const struct ofw_compat_data *compat)
244 {
245 
246 	if (compat == NULL)
247 		return NULL;
248 
249 	for (; compat->ocd_str != NULL; ++compat) {
250 		if (ofw_bus_is_compatible(dev, compat->ocd_str))
251 			break;
252 	}
253 
254 	return (compat);
255 }
256 
257 int
258 ofw_bus_has_prop(device_t dev, const char *propname)
259 {
260 	phandle_t node;
261 
262 	if ((node = ofw_bus_get_node(dev)) == -1)
263 		return (0);
264 
265 	return (OF_hasprop(node, propname));
266 }
267 
268 void
269 ofw_bus_setup_iinfo(phandle_t node, struct ofw_bus_iinfo *ii, int intrsz)
270 {
271 	pcell_t addrc;
272 	int msksz;
273 
274 	if (OF_getencprop(node, "#address-cells", &addrc, sizeof(addrc)) == -1)
275 		addrc = 2;
276 	ii->opi_addrc = addrc * sizeof(pcell_t);
277 
278 	ii->opi_imapsz = OF_getencprop_alloc(node, "interrupt-map", 1,
279 	    (void **)&ii->opi_imap);
280 	if (ii->opi_imapsz > 0) {
281 		msksz = OF_getencprop_alloc(node, "interrupt-map-mask", 1,
282 		    (void **)&ii->opi_imapmsk);
283 		/*
284 		 * Failure to get the mask is ignored; a full mask is used
285 		 * then.  We barf on bad mask sizes, however.
286 		 */
287 		if (msksz != -1 && msksz != ii->opi_addrc + intrsz)
288 			panic("ofw_bus_setup_iinfo: bad interrupt-map-mask "
289 			    "property!");
290 	}
291 }
292 
293 int
294 ofw_bus_lookup_imap(phandle_t node, struct ofw_bus_iinfo *ii, void *reg,
295     int regsz, void *pintr, int pintrsz, void *mintr, int mintrsz,
296     phandle_t *iparent)
297 {
298 	uint8_t maskbuf[regsz + pintrsz];
299 	int rv;
300 
301 	if (ii->opi_imapsz <= 0)
302 		return (0);
303 	KASSERT(regsz >= ii->opi_addrc,
304 	    ("ofw_bus_lookup_imap: register size too small: %d < %d",
305 		regsz, ii->opi_addrc));
306 	if (node != -1) {
307 		rv = OF_getencprop(node, "reg", reg, regsz);
308 		if (rv < regsz)
309 			panic("ofw_bus_lookup_imap: cannot get reg property");
310 	}
311 	return (ofw_bus_search_intrmap(pintr, pintrsz, reg, ii->opi_addrc,
312 	    ii->opi_imap, ii->opi_imapsz, ii->opi_imapmsk, maskbuf, mintr,
313 	    mintrsz, iparent));
314 }
315 
316 /*
317  * Map an interrupt using the firmware reg, interrupt-map and
318  * interrupt-map-mask properties.
319  * The interrupt property to be mapped must be of size intrsz, and pointed to
320  * by intr.  The regs property of the node for which the mapping is done must
321  * be passed as regs. This property is an array of register specifications;
322  * the size of the address part of such a specification must be passed as
323  * physsz.  Only the first element of the property is used.
324  * imap and imapsz hold the interrupt mask and it's size.
325  * imapmsk is a pointer to the interrupt-map-mask property, which must have
326  * a size of physsz + intrsz; it may be NULL, in which case a full mask is
327  * assumed.
328  * maskbuf must point to a buffer of length physsz + intrsz.
329  * The interrupt is returned in result, which must point to a buffer of length
330  * rintrsz (which gives the expected size of the mapped interrupt).
331  * Returns number of cells in the interrupt if a mapping was found, 0 otherwise.
332  */
333 int
334 ofw_bus_search_intrmap(void *intr, int intrsz, void *regs, int physsz,
335     void *imap, int imapsz, void *imapmsk, void *maskbuf, void *result,
336     int rintrsz, phandle_t *iparent)
337 {
338 	phandle_t parent;
339 	uint8_t *ref = maskbuf;
340 	uint8_t *uiintr = intr;
341 	uint8_t *uiregs = regs;
342 	uint8_t *uiimapmsk = imapmsk;
343 	uint8_t *mptr;
344 	pcell_t paddrsz;
345 	pcell_t pintrsz;
346 	int i, rsz, tsz;
347 
348 	rsz = -1;
349 	if (imapmsk != NULL) {
350 		for (i = 0; i < physsz; i++)
351 			ref[i] = uiregs[i] & uiimapmsk[i];
352 		for (i = 0; i < intrsz; i++)
353 			ref[physsz + i] = uiintr[i] & uiimapmsk[physsz + i];
354 	} else {
355 		bcopy(regs, ref, physsz);
356 		bcopy(intr, ref + physsz, intrsz);
357 	}
358 
359 	mptr = imap;
360 	i = imapsz;
361 	paddrsz = 0;
362 	while (i > 0) {
363 		bcopy(mptr + physsz + intrsz, &parent, sizeof(parent));
364 #ifndef OFW_IMAP_NO_IPARENT_ADDR_CELLS
365 		/*
366 		 * Find if we need to read the parent address data.
367 		 * CHRP-derived OF bindings, including ePAPR-compliant FDTs,
368 		 * use this as an optional part of the specifier.
369 		 */
370 		if (OF_getencprop(OF_node_from_xref(parent),
371 		    "#address-cells", &paddrsz, sizeof(paddrsz)) == -1)
372 			paddrsz = 0;	/* default */
373 		paddrsz *= sizeof(pcell_t);
374 #endif
375 
376 		if (OF_searchencprop(OF_node_from_xref(parent),
377 		    "#interrupt-cells", &pintrsz, sizeof(pintrsz)) == -1)
378 			pintrsz = 1;	/* default */
379 		pintrsz *= sizeof(pcell_t);
380 
381 		/* Compute the map stride size. */
382 		tsz = physsz + intrsz + sizeof(phandle_t) + paddrsz + pintrsz;
383 		KASSERT(i >= tsz, ("ofw_bus_search_intrmap: truncated map"));
384 
385 		if (bcmp(ref, mptr, physsz + intrsz) == 0) {
386 			bcopy(mptr + physsz + intrsz + sizeof(parent) + paddrsz,
387 			    result, MIN(rintrsz, pintrsz));
388 
389 			if (iparent != NULL)
390 				*iparent = parent;
391 			return (pintrsz/sizeof(pcell_t));
392 		}
393 		mptr += tsz;
394 		i -= tsz;
395 	}
396 	return (0);
397 }
398 
399 int
400 ofw_bus_msimap(phandle_t node, uint16_t pci_rid, phandle_t *msi_parent,
401     uint32_t *msi_rid)
402 {
403 	pcell_t *map, mask, msi_base, rid_base, rid_length;
404 	ssize_t len;
405 	uint32_t masked_rid, rid;
406 	int err, i;
407 
408 	/* TODO: This should be OF_searchprop_alloc if we had it */
409 	len = OF_getencprop_alloc(node, "msi-map", sizeof(*map), (void **)&map);
410 	if (len < 0) {
411 		if (msi_parent != NULL) {
412 			*msi_parent = 0;
413 			OF_getencprop(node, "msi-parent", msi_parent,
414 			    sizeof(*msi_parent));
415 		}
416 		if (msi_rid != NULL)
417 			*msi_rid = pci_rid;
418 		return (0);
419 	}
420 
421 	err = ENOENT;
422 	rid = 0;
423 	mask = 0xffffffff;
424 	OF_getencprop(node, "msi-map-mask", &mask, sizeof(mask));
425 
426 	masked_rid = pci_rid & mask;
427 	for (i = 0; i < len; i += 4) {
428 		rid_base = map[i + 0];
429 		rid_length = map[i + 3];
430 
431 		if (masked_rid < rid_base ||
432 		    masked_rid >= (rid_base + rid_length))
433 			continue;
434 
435 		msi_base = map[i + 2];
436 
437 		if (msi_parent != NULL)
438 			*msi_parent = map[i + 1];
439 		if (msi_rid != NULL)
440 			*msi_rid = masked_rid - rid_base + msi_base;
441 		err = 0;
442 		break;
443 	}
444 
445 	free(map, M_OFWPROP);
446 
447 	return (err);
448 }
449 
450 int
451 ofw_bus_reg_to_rl(device_t dev, phandle_t node, pcell_t acells, pcell_t scells,
452     struct resource_list *rl)
453 {
454 	uint64_t phys, size;
455 	ssize_t i, j, rid, nreg, ret;
456 	uint32_t *reg;
457 	char *name;
458 
459 	/*
460 	 * This may be just redundant when having ofw_bus_devinfo
461 	 * but makes this routine independent of it.
462 	 */
463 	ret = OF_getprop_alloc(node, "name", sizeof(*name), (void **)&name);
464 	if (ret == -1)
465 		name = NULL;
466 
467 	ret = OF_getencprop_alloc(node, "reg", sizeof(*reg), (void **)&reg);
468 	nreg = (ret == -1) ? 0 : ret;
469 
470 	if (nreg % (acells + scells) != 0) {
471 		if (bootverbose)
472 			device_printf(dev, "Malformed reg property on <%s>\n",
473 			    (name == NULL) ? "unknown" : name);
474 		nreg = 0;
475 	}
476 
477 	for (i = 0, rid = 0; i < nreg; i += acells + scells, rid++) {
478 		phys = size = 0;
479 		for (j = 0; j < acells; j++) {
480 			phys <<= 32;
481 			phys |= reg[i + j];
482 		}
483 		for (j = 0; j < scells; j++) {
484 			size <<= 32;
485 			size |= reg[i + acells + j];
486 		}
487 		/* Skip the dummy reg property of glue devices like ssm(4). */
488 		if (size != 0)
489 			resource_list_add(rl, SYS_RES_MEMORY, rid,
490 			    phys, phys + size - 1, size);
491 	}
492 	free(name, M_OFWPROP);
493 	free(reg, M_OFWPROP);
494 
495 	return (0);
496 }
497 
498 /*
499  * Get interrupt parent for given node.
500  * Returns 0 if interrupt parent doesn't exist.
501  */
502 phandle_t
503 ofw_bus_find_iparent(phandle_t node)
504 {
505 	phandle_t iparent;
506 
507 	if (OF_searchencprop(node, "interrupt-parent", &iparent,
508 		    sizeof(iparent)) == -1) {
509 		for (iparent = node; iparent != 0;
510 		    iparent = OF_parent(iparent)) {
511 			if (OF_hasprop(iparent, "interrupt-controller"))
512 				break;
513 		}
514 		iparent = OF_xref_from_node(iparent);
515 	}
516 	return (iparent);
517 }
518 
519 #ifndef INTRNG
520 int
521 ofw_bus_intr_to_rl(device_t dev, phandle_t node,
522     struct resource_list *rl, int *rlen)
523 {
524 	phandle_t iparent;
525 	uint32_t icells, *intr;
526 	int err, i, irqnum, nintr, rid;
527 	boolean_t extended;
528 
529 	nintr = OF_getencprop_alloc(node, "interrupts",  sizeof(*intr),
530 	    (void **)&intr);
531 	if (nintr > 0) {
532 		iparent = ofw_bus_find_iparent(node);
533 		if (iparent == 0) {
534 			device_printf(dev, "No interrupt-parent found, "
535 			    "assuming direct parent\n");
536 			iparent = OF_parent(node);
537 			iparent = OF_xref_from_node(iparent);
538 		}
539 		if (OF_searchencprop(OF_node_from_xref(iparent),
540 		    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
541 			device_printf(dev, "Missing #interrupt-cells "
542 			    "property, assuming <1>\n");
543 			icells = 1;
544 		}
545 		if (icells < 1 || icells > nintr) {
546 			device_printf(dev, "Invalid #interrupt-cells property "
547 			    "value <%d>, assuming <1>\n", icells);
548 			icells = 1;
549 		}
550 		extended = false;
551 	} else {
552 		nintr = OF_getencprop_alloc(node, "interrupts-extended",
553 		    sizeof(*intr), (void **)&intr);
554 		if (nintr <= 0)
555 			return (0);
556 		extended = true;
557 	}
558 	err = 0;
559 	rid = 0;
560 	for (i = 0; i < nintr; i += icells) {
561 		if (extended) {
562 			iparent = intr[i++];
563 			if (OF_searchencprop(OF_node_from_xref(iparent),
564 			    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
565 				device_printf(dev, "Missing #interrupt-cells "
566 				    "property\n");
567 				err = ENOENT;
568 				break;
569 			}
570 			if (icells < 1 || (i + icells) > nintr) {
571 				device_printf(dev, "Invalid #interrupt-cells "
572 				    "property value <%d>\n", icells);
573 				err = ERANGE;
574 				break;
575 			}
576 		}
577 		irqnum = ofw_bus_map_intr(dev, iparent, icells, &intr[i]);
578 		resource_list_add(rl, SYS_RES_IRQ, rid++, irqnum, irqnum, 1);
579 	}
580 	if (rlen != NULL)
581 		*rlen = rid;
582 	free(intr, M_OFWPROP);
583 	return (err);
584 }
585 #endif
586 
587 int
588 ofw_bus_intr_by_rid(device_t dev, phandle_t node, int wanted_rid,
589     phandle_t *producer, int *ncells, pcell_t **cells)
590 {
591 	phandle_t iparent;
592 	uint32_t icells, *intr;
593 	int err, i, nintr, rid;
594 	boolean_t extended;
595 
596 	nintr = OF_getencprop_alloc(node, "interrupts",  sizeof(*intr),
597 	    (void **)&intr);
598 	if (nintr > 0) {
599 		iparent = ofw_bus_find_iparent(node);
600 		if (iparent == 0) {
601 			device_printf(dev, "No interrupt-parent found, "
602 			    "assuming direct parent\n");
603 			iparent = OF_parent(node);
604 			iparent = OF_xref_from_node(iparent);
605 		}
606 		if (OF_searchencprop(OF_node_from_xref(iparent),
607 		    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
608 			device_printf(dev, "Missing #interrupt-cells "
609 			    "property, assuming <1>\n");
610 			icells = 1;
611 		}
612 		if (icells < 1 || icells > nintr) {
613 			device_printf(dev, "Invalid #interrupt-cells property "
614 			    "value <%d>, assuming <1>\n", icells);
615 			icells = 1;
616 		}
617 		extended = false;
618 	} else {
619 		nintr = OF_getencprop_alloc(node, "interrupts-extended",
620 		    sizeof(*intr), (void **)&intr);
621 		if (nintr <= 0)
622 			return (ESRCH);
623 		extended = true;
624 	}
625 	err = ESRCH;
626 	rid = 0;
627 	for (i = 0; i < nintr; i += icells, rid++) {
628 		if (extended) {
629 			iparent = intr[i++];
630 			if (OF_searchencprop(OF_node_from_xref(iparent),
631 			    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
632 				device_printf(dev, "Missing #interrupt-cells "
633 				    "property\n");
634 				err = ENOENT;
635 				break;
636 			}
637 			if (icells < 1 || (i + icells) > nintr) {
638 				device_printf(dev, "Invalid #interrupt-cells "
639 				    "property value <%d>\n", icells);
640 				err = ERANGE;
641 				break;
642 			}
643 		}
644 		if (rid == wanted_rid) {
645 			*cells = malloc(icells * sizeof(**cells), M_OFWPROP,
646 			    M_WAITOK);
647 			*producer = iparent;
648 			*ncells= icells;
649 			memcpy(*cells, intr + i, icells * sizeof(**cells));
650 			err = 0;
651 			break;
652 		}
653 	}
654 	free(intr, M_OFWPROP);
655 	return (err);
656 }
657 
658 phandle_t
659 ofw_bus_find_child(phandle_t start, const char *child_name)
660 {
661 	char *name;
662 	int ret;
663 	phandle_t child;
664 
665 	for (child = OF_child(start); child != 0; child = OF_peer(child)) {
666 		ret = OF_getprop_alloc(child, "name", sizeof(*name), (void **)&name);
667 		if (ret == -1)
668 			continue;
669 		if (strcmp(name, child_name) == 0) {
670 			free(name, M_OFWPROP);
671 			return (child);
672 		}
673 
674 		free(name, M_OFWPROP);
675 	}
676 
677 	return (0);
678 }
679 
680 phandle_t
681 ofw_bus_find_compatible(phandle_t node, const char *onecompat)
682 {
683 	phandle_t child, ret;
684 	void *compat;
685 	int len;
686 
687 	/*
688 	 * Traverse all children of 'start' node, and find first with
689 	 * matching 'compatible' property.
690 	 */
691 	for (child = OF_child(node); child != 0; child = OF_peer(child)) {
692 		len = OF_getprop_alloc(child, "compatible", 1, &compat);
693 		if (len >= 0) {
694 			ret = ofw_bus_node_is_compatible(compat, len,
695 			    onecompat);
696 			free(compat, M_OFWPROP);
697 			if (ret != 0)
698 				return (child);
699 		}
700 
701 		ret = ofw_bus_find_compatible(child, onecompat);
702 		if (ret != 0)
703 			return (ret);
704 	}
705 	return (0);
706 }
707 
708 /**
709  * @brief Return child of bus whose phandle is node
710  *
711  * A direct child of @p will be returned if it its phandle in the
712  * OFW tree is @p node. Otherwise, NULL is returned.
713  *
714  * @param bus		The bus to examine
715  * @param node		The phandle_t to look for.
716  */
717 device_t
718 ofw_bus_find_child_device_by_phandle(device_t bus, phandle_t node)
719 {
720 	device_t *children, retval, child;
721 	int nkid, i;
722 
723 	/*
724 	 * Nothing can match the flag value for no node.
725 	 */
726 	if (node == -1)
727 		return (NULL);
728 
729 	/*
730 	 * Search the children for a match. We microoptimize
731 	 * a bit by not using ofw_bus_get since we already know
732 	 * the parent. We do not recurse.
733 	 */
734 	if (device_get_children(bus, &children, &nkid) != 0)
735 		return (NULL);
736 	retval = NULL;
737 	for (i = 0; i < nkid; i++) {
738 		child = children[i];
739 		if (OFW_BUS_GET_NODE(bus, child) == node) {
740 			retval = child;
741 			break;
742 		}
743 	}
744 	free(children, M_TEMP);
745 
746 	return (retval);
747 }
748 
749 /*
750  * Parse property that contain list of xrefs and values
751  * (like standard "clocks" and "resets" properties)
752  * Input arguments:
753  *  node - consumers device node
754  *  list_name  - name of parsed list - "clocks"
755  *  cells_name - name of size property - "#clock-cells"
756  *  idx - the index of the requested list entry, or, if -1, an indication
757  *        to return the number of entries in the parsed list.
758  * Output arguments:
759  *  producer - handle of producer
760  *  ncells   - number of cells in result or the number of items in the list when
761  *             idx == -1.
762  *  cells    - array of decoded cells
763  */
764 static int
765 ofw_bus_parse_xref_list_internal(phandle_t node, const char *list_name,
766     const char *cells_name, int idx, phandle_t *producer, int *ncells,
767     pcell_t **cells)
768 {
769 	phandle_t pnode;
770 	phandle_t *elems;
771 	uint32_t  pcells;
772 	int rv, i, j, nelems, cnt;
773 
774 	elems = NULL;
775 	nelems = OF_getencprop_alloc(node, list_name,  sizeof(*elems),
776 	    (void **)&elems);
777 	if (nelems <= 0)
778 		return (ENOENT);
779 	rv = (idx == -1) ? 0 : ENOENT;
780 	for (i = 0, cnt = 0; i < nelems; i += pcells, cnt++) {
781 		pnode = elems[i++];
782 		if (OF_getencprop(OF_node_from_xref(pnode),
783 		    cells_name, &pcells, sizeof(pcells)) == -1) {
784 			printf("Missing %s property\n", cells_name);
785 			rv = ENOENT;
786 			break;
787 		}
788 
789 		if ((i + pcells) > nelems) {
790 			printf("Invalid %s property value <%d>\n", cells_name,
791 			    pcells);
792 			rv = ERANGE;
793 			break;
794 		}
795 		if (cnt == idx) {
796 			*cells= malloc(pcells * sizeof(**cells), M_OFWPROP,
797 			    M_WAITOK);
798 			*producer = pnode;
799 			*ncells = pcells;
800 			for (j = 0; j < pcells; j++)
801 				(*cells)[j] = elems[i + j];
802 			rv = 0;
803 			break;
804 		}
805 	}
806 	if (elems != NULL)
807 		free(elems, M_OFWPROP);
808 	if (idx == -1 && rv == 0)
809 		*ncells = cnt;
810 	return (rv);
811 }
812 
813 /*
814  * Parse property that contain list of xrefs and values
815  * (like standard "clocks" and "resets" properties)
816  * Input arguments:
817  *  node - consumers device node
818  *  list_name  - name of parsed list - "clocks"
819  *  cells_name - name of size property - "#clock-cells"
820  *  idx - the index of the requested list entry (>= 0)
821  * Output arguments:
822  *  producer - handle of producer
823  *  ncells   - number of cells in result
824  *  cells    - array of decoded cells
825  */
826 int
827 ofw_bus_parse_xref_list_alloc(phandle_t node, const char *list_name,
828     const char *cells_name, int idx, phandle_t *producer, int *ncells,
829     pcell_t **cells)
830 {
831 
832 	KASSERT(idx >= 0,
833 	    ("ofw_bus_parse_xref_list_alloc: negative index supplied"));
834 
835 	return (ofw_bus_parse_xref_list_internal(node, list_name, cells_name,
836 		    idx, producer, ncells, cells));
837 }
838 
839 /*
840  * Parse property that contain list of xrefs and values
841  * (like standard "clocks" and "resets" properties)
842  * and determine the number of items in the list
843  * Input arguments:
844  *  node - consumers device node
845  *  list_name  - name of parsed list - "clocks"
846  *  cells_name - name of size property - "#clock-cells"
847  * Output arguments:
848  *  count - number of items in list
849  */
850 int
851 ofw_bus_parse_xref_list_get_length(phandle_t node, const char *list_name,
852     const char *cells_name, int *count)
853 {
854 
855 	return (ofw_bus_parse_xref_list_internal(node, list_name, cells_name,
856 		    -1, NULL, count, NULL));
857 }
858 
859 /*
860  * Find index of string in string list property (case sensitive).
861  */
862 int
863 ofw_bus_find_string_index(phandle_t node, const char *list_name,
864     const char *name, int *idx)
865 {
866 	char *elems;
867 	int rv, i, cnt, nelems;
868 
869 	elems = NULL;
870 	nelems = OF_getprop_alloc(node, list_name, 1, (void **)&elems);
871 	if (nelems <= 0)
872 		return (ENOENT);
873 
874 	rv = ENOENT;
875 	for (i = 0, cnt = 0; i < nelems; cnt++) {
876 		if (strcmp(elems + i, name) == 0) {
877 			*idx = cnt;
878 			rv = 0;
879 			break;
880 		}
881 		i += strlen(elems + i) + 1;
882 	}
883 
884 	if (elems != NULL)
885 		free(elems, M_OFWPROP);
886 	return (rv);
887 }
888 
889 /*
890  * Create zero terminated array of strings from string list property.
891  */
892 int
893 ofw_bus_string_list_to_array(phandle_t node, const char *list_name,
894    const char ***out_array)
895 {
896 	char *elems, *tptr;
897 	const char **array;
898 	int i, cnt, nelems, len;
899 
900 	elems = NULL;
901 	nelems = OF_getprop_alloc(node, list_name, 1, (void **)&elems);
902 	if (nelems <= 0)
903 		return (nelems);
904 
905 	/* Count number of strings. */
906 	for (i = 0, cnt = 0; i < nelems; cnt++)
907 		i += strlen(elems + i) + 1;
908 
909 	/* Allocate space for arrays and all strings. */
910 	array = malloc((cnt + 1) * sizeof(char *) + nelems, M_OFWPROP,
911 	    M_WAITOK);
912 
913 	/* Get address of first string. */
914 	tptr = (char *)(array + cnt + 1);
915 
916 	/* Copy strings. */
917 	memcpy(tptr, elems, nelems);
918 	free(elems, M_OFWPROP);
919 
920 	/* Fill string pointers. */
921 	for (i = 0, cnt = 0; i < nelems; cnt++) {
922 		len = strlen(tptr) + 1;
923 		array[cnt] = tptr;
924 		i += len;
925 		tptr += len;
926 	}
927 	array[cnt] = 0;
928 	*out_array = array;
929 
930 	return (cnt);
931 }
932