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: releng/11.0/sys/dev/ofw/ofw_bus_subr.c 301453 2016-06-05 16:20:12Z skra $");
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
48int
49ofw_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
65void
66ofw_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
83int
84ofw_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
100const char *
101ofw_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
111const char *
112ofw_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
122const char *
123ofw_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
133phandle_t
134ofw_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
144const char *
145ofw_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
155const char *
156ofw_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
167int
168ofw_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
180static int
181ofw_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
205int
206ofw_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
225int
226ofw_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
242const struct ofw_compat_data *
243ofw_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
257int
258ofw_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
268void
269ofw_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
293int
294ofw_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 */
333int
334ofw_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
399int
400ofw_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
450int
451ofw_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 */
502phandle_t
503ofw_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
520int
521ofw_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
587int
588ofw_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
658phandle_t
659ofw_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
680phandle_t
681ofw_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 */
717device_t
718ofw_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 */
764static int
765ofw_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 */
826int
827ofw_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 */
850int
851ofw_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 */
862int
863ofw_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 */
892int
893ofw_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