xref: /freebsd/sys/dev/ofw/ofw_bus_subr.c (revision acc1a9ef8333c798c210fa94be6af4d5fe2dd794)
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_reg_to_rl(device_t dev, phandle_t node, pcell_t acells, pcell_t scells,
401     struct resource_list *rl)
402 {
403 	uint64_t phys, size;
404 	ssize_t i, j, rid, nreg, ret;
405 	uint32_t *reg;
406 	char *name;
407 
408 	/*
409 	 * This may be just redundant when having ofw_bus_devinfo
410 	 * but makes this routine independent of it.
411 	 */
412 	ret = OF_getprop_alloc(node, "name", sizeof(*name), (void **)&name);
413 	if (ret == -1)
414 		name = NULL;
415 
416 	ret = OF_getencprop_alloc(node, "reg", sizeof(*reg), (void **)&reg);
417 	nreg = (ret == -1) ? 0 : ret;
418 
419 	if (nreg % (acells + scells) != 0) {
420 		if (bootverbose)
421 			device_printf(dev, "Malformed reg property on <%s>\n",
422 			    (name == NULL) ? "unknown" : name);
423 		nreg = 0;
424 	}
425 
426 	for (i = 0, rid = 0; i < nreg; i += acells + scells, rid++) {
427 		phys = size = 0;
428 		for (j = 0; j < acells; j++) {
429 			phys <<= 32;
430 			phys |= reg[i + j];
431 		}
432 		for (j = 0; j < scells; j++) {
433 			size <<= 32;
434 			size |= reg[i + acells + j];
435 		}
436 		/* Skip the dummy reg property of glue devices like ssm(4). */
437 		if (size != 0)
438 			resource_list_add(rl, SYS_RES_MEMORY, rid,
439 			    phys, phys + size - 1, size);
440 	}
441 	free(name, M_OFWPROP);
442 	free(reg, M_OFWPROP);
443 
444 	return (0);
445 }
446 
447 /*
448  * Get interrupt parent for given node.
449  * Returns 0 if interrupt parent doesn't exist.
450  */
451 phandle_t
452 ofw_bus_find_iparent(phandle_t node)
453 {
454 	phandle_t iparent;
455 
456 	if (OF_searchencprop(node, "interrupt-parent", &iparent,
457 		    sizeof(iparent)) == -1) {
458 		for (iparent = node; iparent != 0;
459 		    iparent = OF_parent(iparent)) {
460 			if (OF_hasprop(iparent, "interrupt-controller"))
461 				break;
462 		}
463 		iparent = OF_xref_from_node(iparent);
464 	}
465 	return (iparent);
466 }
467 
468 int
469 ofw_bus_intr_to_rl(device_t dev, phandle_t node,
470     struct resource_list *rl, int *rlen)
471 {
472 	phandle_t iparent;
473 	uint32_t icells, *intr;
474 	int err, i, irqnum, nintr, rid;
475 	boolean_t extended;
476 
477 	nintr = OF_getencprop_alloc(node, "interrupts",  sizeof(*intr),
478 	    (void **)&intr);
479 	if (nintr > 0) {
480 		iparent = ofw_bus_find_iparent(node);
481 		if (iparent == 0) {
482 			device_printf(dev, "No interrupt-parent found, "
483 			    "assuming direct parent\n");
484 			iparent = OF_parent(node);
485 			iparent = OF_xref_from_node(iparent);
486 		}
487 		if (OF_searchencprop(OF_node_from_xref(iparent),
488 		    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
489 			device_printf(dev, "Missing #interrupt-cells "
490 			    "property, assuming <1>\n");
491 			icells = 1;
492 		}
493 		if (icells < 1 || icells > nintr) {
494 			device_printf(dev, "Invalid #interrupt-cells property "
495 			    "value <%d>, assuming <1>\n", icells);
496 			icells = 1;
497 		}
498 		extended = false;
499 	} else {
500 		nintr = OF_getencprop_alloc(node, "interrupts-extended",
501 		    sizeof(*intr), (void **)&intr);
502 		if (nintr <= 0)
503 			return (0);
504 		extended = true;
505 	}
506 	err = 0;
507 	rid = 0;
508 	for (i = 0; i < nintr; i += icells) {
509 		if (extended) {
510 			iparent = intr[i++];
511 			if (OF_searchencprop(OF_node_from_xref(iparent),
512 			    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
513 				device_printf(dev, "Missing #interrupt-cells "
514 				    "property\n");
515 				err = ENOENT;
516 				break;
517 			}
518 			if (icells < 1 || (i + icells) > nintr) {
519 				device_printf(dev, "Invalid #interrupt-cells "
520 				    "property value <%d>\n", icells);
521 				err = ERANGE;
522 				break;
523 			}
524 		}
525 		irqnum = ofw_bus_map_intr(dev, iparent, icells, &intr[i]);
526 		resource_list_add(rl, SYS_RES_IRQ, rid++, irqnum, irqnum, 1);
527 	}
528 	if (rlen != NULL)
529 		*rlen = rid;
530 	free(intr, M_OFWPROP);
531 	return (err);
532 }
533 
534 phandle_t
535 ofw_bus_find_child(phandle_t start, const char *child_name)
536 {
537 	char *name;
538 	int ret;
539 	phandle_t child;
540 
541 	for (child = OF_child(start); child != 0; child = OF_peer(child)) {
542 		ret = OF_getprop_alloc(child, "name", sizeof(*name), (void **)&name);
543 		if (ret == -1)
544 			continue;
545 		if (strcmp(name, child_name) == 0) {
546 			free(name, M_OFWPROP);
547 			return (child);
548 		}
549 
550 		free(name, M_OFWPROP);
551 	}
552 
553 	return (0);
554 }
555 
556 phandle_t
557 ofw_bus_find_compatible(phandle_t node, const char *onecompat)
558 {
559 	phandle_t child, ret;
560 	void *compat;
561 	int len;
562 
563 	/*
564 	 * Traverse all children of 'start' node, and find first with
565 	 * matching 'compatible' property.
566 	 */
567 	for (child = OF_child(node); child != 0; child = OF_peer(child)) {
568 		len = OF_getprop_alloc(child, "compatible", 1, &compat);
569 		if (len >= 0) {
570 			ret = ofw_bus_node_is_compatible(compat, len,
571 			    onecompat);
572 			free(compat, M_OFWPROP);
573 			if (ret != 0)
574 				return (child);
575 		}
576 
577 		ret = ofw_bus_find_compatible(child, onecompat);
578 		if (ret != 0)
579 			return (ret);
580 	}
581 	return (0);
582 }
583 
584 /**
585  * @brief Return child of bus whose phandle is node
586  *
587  * A direct child of @p will be returned if it its phandle in the
588  * OFW tree is @p node. Otherwise, NULL is returned.
589  *
590  * @param bus		The bus to examine
591  * @param node		The phandle_t to look for.
592  */
593 device_t
594 ofw_bus_find_child_device_by_phandle(device_t bus, phandle_t node)
595 {
596 	device_t *children, retval, child;
597 	int nkid, i;
598 
599 	/*
600 	 * Nothing can match the flag value for no node.
601 	 */
602 	if (node == -1)
603 		return (NULL);
604 
605 	/*
606 	 * Search the children for a match. We microoptimize
607 	 * a bit by not using ofw_bus_get since we already know
608 	 * the parent. We do not recurse.
609 	 */
610 	if (device_get_children(bus, &children, &nkid) != 0)
611 		return (NULL);
612 	retval = NULL;
613 	for (i = 0; i < nkid; i++) {
614 		child = children[i];
615 		if (OFW_BUS_GET_NODE(bus, child) == node) {
616 			retval = child;
617 			break;
618 		}
619 	}
620 	free(children, M_TEMP);
621 
622 	return (retval);
623 }
624 
625 /*
626  * Parse property that contain list of xrefs and values
627  * (like standard "clocks" and "resets" properties)
628  * Input arguments:
629  *  node - consumers device node
630  *  list_name  - name of parsed list - "clocks"
631  *  cells_name - name of size property - "#clock-cells"
632  *  idx - the index of the requested list entry, or, if -1, an indication
633  *        to return the number of entries in the parsed list.
634  * Output arguments:
635  *  producer - handle of producer
636  *  ncells   - number of cells in result or the number of items in the list when
637  *             idx == -1.
638  *  cells    - array of decoded cells
639  */
640 static int
641 ofw_bus_parse_xref_list_internal(phandle_t node, const char *list_name,
642     const char *cells_name, int idx, phandle_t *producer, int *ncells,
643     pcell_t **cells)
644 {
645 	phandle_t pnode;
646 	phandle_t *elems;
647 	uint32_t  pcells;
648 	int rv, i, j, nelems, cnt;
649 
650 	elems = NULL;
651 	nelems = OF_getencprop_alloc(node, list_name,  sizeof(*elems),
652 	    (void **)&elems);
653 	if (nelems <= 0)
654 		return (ENOENT);
655 	rv = (idx == -1) ? 0 : ENOENT;
656 	for (i = 0, cnt = 0; i < nelems; i += pcells, cnt++) {
657 		pnode = elems[i++];
658 		if (OF_getencprop(OF_node_from_xref(pnode),
659 		    cells_name, &pcells, sizeof(pcells)) == -1) {
660 			printf("Missing %s property\n", cells_name);
661 			rv = ENOENT;
662 			break;
663 		}
664 
665 		if ((i + pcells) > nelems) {
666 			printf("Invalid %s property value <%d>\n", cells_name,
667 			    pcells);
668 			rv = ERANGE;
669 			break;
670 		}
671 		if (cnt == idx) {
672 			*cells= malloc(pcells * sizeof(**cells), M_OFWPROP,
673 			    M_WAITOK);
674 			*producer = pnode;
675 			*ncells = pcells;
676 			for (j = 0; j < pcells; j++)
677 				(*cells)[j] = elems[i + j];
678 			rv = 0;
679 			break;
680 		}
681 	}
682 	if (elems != NULL)
683 		free(elems, M_OFWPROP);
684 	if (idx == -1 && rv == 0)
685 		*ncells = cnt;
686 	return (rv);
687 }
688 
689 /*
690  * Parse property that contain list of xrefs and values
691  * (like standard "clocks" and "resets" properties)
692  * Input arguments:
693  *  node - consumers device node
694  *  list_name  - name of parsed list - "clocks"
695  *  cells_name - name of size property - "#clock-cells"
696  *  idx - the index of the requested list entry (>= 0)
697  * Output arguments:
698  *  producer - handle of producer
699  *  ncells   - number of cells in result
700  *  cells    - array of decoded cells
701  */
702 int
703 ofw_bus_parse_xref_list_alloc(phandle_t node, const char *list_name,
704     const char *cells_name, int idx, phandle_t *producer, int *ncells,
705     pcell_t **cells)
706 {
707 
708 	KASSERT(idx >= 0,
709 	    ("ofw_bus_parse_xref_list_alloc: negative index supplied"));
710 
711 	return (ofw_bus_parse_xref_list_internal(node, list_name, cells_name,
712 		    idx, producer, ncells, cells));
713 }
714 
715 /*
716  * Parse property that contain list of xrefs and values
717  * (like standard "clocks" and "resets" properties)
718  * and determine the number of items in the list
719  * Input arguments:
720  *  node - consumers device node
721  *  list_name  - name of parsed list - "clocks"
722  *  cells_name - name of size property - "#clock-cells"
723  * Output arguments:
724  *  count - number of items in list
725  */
726 int
727 ofw_bus_parse_xref_list_get_length(phandle_t node, const char *list_name,
728     const char *cells_name, int *count)
729 {
730 
731 	return (ofw_bus_parse_xref_list_internal(node, list_name, cells_name,
732 		    -1, NULL, count, NULL));
733 }
734 
735 /*
736  * Find index of string in string list property (case sensitive).
737  */
738 int
739 ofw_bus_find_string_index(phandle_t node, const char *list_name,
740     const char *name, int *idx)
741 {
742 	char *elems;
743 	int rv, i, cnt, nelems;
744 
745 	elems = NULL;
746 	nelems = OF_getprop_alloc(node, list_name, 1, (void **)&elems);
747 	if (nelems <= 0)
748 		return (ENOENT);
749 
750 	rv = ENOENT;
751 	for (i = 0, cnt = 0; i < nelems; cnt++) {
752 		if (strcmp(elems + i, name) == 0) {
753 			*idx = cnt;
754 			rv = 0;
755 			break;
756 		}
757 		i += strlen(elems + i) + 1;
758 	}
759 
760 	if (elems != NULL)
761 		free(elems, M_OFWPROP);
762 	return (rv);
763 }
764 
765 /*
766  * Create zero terminated array of strings from string list property.
767  */
768 int
769 ofw_bus_string_list_to_array(phandle_t node, const char *list_name,
770    const char ***out_array)
771 {
772 	char *elems, *tptr;
773 	const char **array;
774 	int i, cnt, nelems, len;
775 
776 	elems = NULL;
777 	nelems = OF_getprop_alloc(node, list_name, 1, (void **)&elems);
778 	if (nelems <= 0)
779 		return (nelems);
780 
781 	/* Count number of strings. */
782 	for (i = 0, cnt = 0; i < nelems; cnt++)
783 		i += strlen(elems + i) + 1;
784 
785 	/* Allocate space for arrays and all strings. */
786 	array = malloc((cnt + 1) * sizeof(char *) + nelems, M_OFWPROP,
787 	    M_WAITOK);
788 
789 	/* Get address of first string. */
790 	tptr = (char *)(array + cnt + 1);
791 
792 	/* Copy strings. */
793 	memcpy(tptr, elems, nelems);
794 	free(elems, M_OFWPROP);
795 
796 	/* Fill string pointers. */
797 	for (i = 0, cnt = 0; i < nelems; cnt++) {
798 		len = strlen(tptr) + 1;
799 		array[cnt] = tptr;
800 		i += len;
801 		tptr += len;
802 	}
803 	array[cnt] = 0;
804 	*out_array = array;
805 
806 	return (cnt);
807 }
808