xref: /freebsd/sys/dev/ofw/ofw_bus_subr.c (revision 685dc743)
1bba6f0a9SMarius Strobl /*-
24d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro F. Giffuni  *
494b4a038SNathan Whitehorn  * Copyright (c) 2001 - 2003 by Thomas Moestl <tmm@FreeBSD.org>.
5bba6f0a9SMarius Strobl  * Copyright (c) 2005 Marius Strobl <marius@FreeBSD.org>
6bba6f0a9SMarius Strobl  * All rights reserved.
7bba6f0a9SMarius Strobl  *
8bba6f0a9SMarius Strobl  * Redistribution and use in source and binary forms, with or without
9bba6f0a9SMarius Strobl  * modification, are permitted provided that the following conditions
10bba6f0a9SMarius Strobl  * are met:
11bba6f0a9SMarius Strobl  * 1. Redistributions of source code must retain the above copyright
12bba6f0a9SMarius Strobl  *    notice, this list of conditions, and the following disclaimer,
13bba6f0a9SMarius Strobl  *    without modification, immediately at the beginning of the file.
14bba6f0a9SMarius Strobl  * 2. Redistributions in binary form must reproduce the above copyright
15bba6f0a9SMarius Strobl  *    notice, this list of conditions and the following disclaimer in
16bba6f0a9SMarius Strobl  *    the documentation and/or other materials provided with the
17bba6f0a9SMarius Strobl  *    distribution.
18bba6f0a9SMarius Strobl  *
19bba6f0a9SMarius Strobl  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20bba6f0a9SMarius Strobl  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21bba6f0a9SMarius Strobl  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22bba6f0a9SMarius Strobl  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
23bba6f0a9SMarius Strobl  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24bba6f0a9SMarius Strobl  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25bba6f0a9SMarius Strobl  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26bba6f0a9SMarius Strobl  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27bba6f0a9SMarius Strobl  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28bba6f0a9SMarius Strobl  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29bba6f0a9SMarius Strobl  * SUCH DAMAGE.
30bba6f0a9SMarius Strobl  */
31bba6f0a9SMarius Strobl 
32bba6f0a9SMarius Strobl #include <sys/cdefs.h>
338297758aSRafal Jaworowski #include "opt_platform.h"
34bba6f0a9SMarius Strobl #include <sys/param.h>
35bba6f0a9SMarius Strobl #include <sys/systm.h>
36bba6f0a9SMarius Strobl #include <sys/bus.h>
37bba6f0a9SMarius Strobl #include <sys/errno.h>
3894b4a038SNathan Whitehorn #include <sys/libkern.h>
39c90902d3SWarner Losh #include <sys/sbuf.h>
40bba6f0a9SMarius Strobl 
41c47d4cdeSIan Lepore #include <machine/resource.h>
42c47d4cdeSIan Lepore 
4394b4a038SNathan Whitehorn #include <dev/ofw/ofw_bus.h>
44bba6f0a9SMarius Strobl #include <dev/ofw/ofw_bus_subr.h>
45bba6f0a9SMarius Strobl #include <dev/ofw/openfirm.h>
46bba6f0a9SMarius Strobl 
47bba6f0a9SMarius Strobl #include "ofw_bus_if.h"
48bba6f0a9SMarius Strobl 
4924f4202dSJustin Hibbits #define	OFW_COMPAT_LEN	255
50e5e94d2dSWojciech Macek #define	OFW_STATUS_LEN	16
5124f4202dSJustin Hibbits 
52bba6f0a9SMarius Strobl int
ofw_bus_gen_setup_devinfo(struct ofw_bus_devinfo * obd,phandle_t node)53bba6f0a9SMarius Strobl ofw_bus_gen_setup_devinfo(struct ofw_bus_devinfo *obd, phandle_t node)
54bba6f0a9SMarius Strobl {
55bba6f0a9SMarius Strobl 
56bba6f0a9SMarius Strobl 	if (obd == NULL)
57bba6f0a9SMarius Strobl 		return (ENOMEM);
58bba6f0a9SMarius Strobl 	/* The 'name' property is considered mandatory. */
59217d17bcSOleksandr Tymoshenko 	if ((OF_getprop_alloc(node, "name", (void **)&obd->obd_name)) == -1)
60bba6f0a9SMarius Strobl 		return (EINVAL);
61217d17bcSOleksandr Tymoshenko 	OF_getprop_alloc(node, "compatible", (void **)&obd->obd_compat);
62217d17bcSOleksandr Tymoshenko 	OF_getprop_alloc(node, "device_type", (void **)&obd->obd_type);
63217d17bcSOleksandr Tymoshenko 	OF_getprop_alloc(node, "model", (void **)&obd->obd_model);
64217d17bcSOleksandr Tymoshenko 	OF_getprop_alloc(node, "status", (void **)&obd->obd_status);
65bba6f0a9SMarius Strobl 	obd->obd_node = node;
66bba6f0a9SMarius Strobl 	return (0);
67bba6f0a9SMarius Strobl }
68bba6f0a9SMarius Strobl 
69bba6f0a9SMarius Strobl void
ofw_bus_gen_destroy_devinfo(struct ofw_bus_devinfo * obd)70bba6f0a9SMarius Strobl ofw_bus_gen_destroy_devinfo(struct ofw_bus_devinfo *obd)
71bba6f0a9SMarius Strobl {
72bba6f0a9SMarius Strobl 
73bba6f0a9SMarius Strobl 	if (obd == NULL)
74bba6f0a9SMarius Strobl 		return;
75bba6f0a9SMarius Strobl 	if (obd->obd_compat != NULL)
76bba6f0a9SMarius Strobl 		free(obd->obd_compat, M_OFWPROP);
77bba6f0a9SMarius Strobl 	if (obd->obd_model != NULL)
78bba6f0a9SMarius Strobl 		free(obd->obd_model, M_OFWPROP);
79bba6f0a9SMarius Strobl 	if (obd->obd_name != NULL)
80bba6f0a9SMarius Strobl 		free(obd->obd_name, M_OFWPROP);
81bba6f0a9SMarius Strobl 	if (obd->obd_type != NULL)
82bba6f0a9SMarius Strobl 		free(obd->obd_type, M_OFWPROP);
83e4be5a16SNathan Whitehorn 	if (obd->obd_status != NULL)
84e4be5a16SNathan Whitehorn 		free(obd->obd_status, M_OFWPROP);
85bba6f0a9SMarius Strobl }
86bba6f0a9SMarius Strobl 
8794b4a038SNathan Whitehorn int
ofw_bus_gen_child_pnpinfo(device_t cbdev,device_t child,struct sbuf * sb)88c90902d3SWarner Losh ofw_bus_gen_child_pnpinfo(device_t cbdev, device_t child, struct sbuf *sb)
8994b4a038SNathan Whitehorn {
90481d6b54SMarius Strobl 
9125f0326aSEmmanuel Vadot 	if (!ofw_bus_status_okay(child))
9225f0326aSEmmanuel Vadot 		return (0);
9325f0326aSEmmanuel Vadot 
9494b4a038SNathan Whitehorn 	if (ofw_bus_get_name(child) != NULL) {
95c90902d3SWarner Losh 		sbuf_printf(sb, "name=%s ", ofw_bus_get_name(child));
9694b4a038SNathan Whitehorn 	}
9794b4a038SNathan Whitehorn 
9894b4a038SNathan Whitehorn 	if (ofw_bus_get_compat(child) != NULL) {
99c90902d3SWarner Losh 		sbuf_printf(sb, "compat=%s ", ofw_bus_get_compat(child));
10094b4a038SNathan Whitehorn 	}
10125f0326aSEmmanuel Vadot 
10294b4a038SNathan Whitehorn 	return (0);
10394b4a038SNathan Whitehorn };
104bba6f0a9SMarius Strobl 
1057b5d62bbSTakanori Watanabe int
ofw_bus_gen_get_device_path(device_t cbdev,device_t child,const char * locator,struct sbuf * sb)1067b5d62bbSTakanori Watanabe ofw_bus_gen_get_device_path(device_t cbdev, device_t child, const char *locator,
1077b5d62bbSTakanori Watanabe 			   struct sbuf *sb)
1087b5d62bbSTakanori Watanabe {
1097b5d62bbSTakanori Watanabe 	int rv;
1107b5d62bbSTakanori Watanabe 
1117b5d62bbSTakanori Watanabe 	if ( strcmp(locator, BUS_LOCATOR_OFW) == 0){
1127b5d62bbSTakanori Watanabe 		rv = bus_generic_get_device_path(cbdev, child, locator, sb);
1137b5d62bbSTakanori Watanabe 		if (rv == 0){
1147b5d62bbSTakanori Watanabe 			sbuf_printf(sb, "/%s",  ofw_bus_get_name(child));
1157b5d62bbSTakanori Watanabe 		}
1167b5d62bbSTakanori Watanabe 		return (rv);
1177b5d62bbSTakanori Watanabe 	}
1187b5d62bbSTakanori Watanabe 	return (bus_generic_get_device_path(cbdev, child, locator, sb));
1197b5d62bbSTakanori Watanabe };
1207b5d62bbSTakanori Watanabe 
121bba6f0a9SMarius Strobl const char *
ofw_bus_gen_get_compat(device_t bus,device_t dev)122bba6f0a9SMarius Strobl ofw_bus_gen_get_compat(device_t bus, device_t dev)
123bba6f0a9SMarius Strobl {
124bba6f0a9SMarius Strobl 	const struct ofw_bus_devinfo *obd;
125bba6f0a9SMarius Strobl 
126bba6f0a9SMarius Strobl 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
127bba6f0a9SMarius Strobl 	if (obd == NULL)
128bba6f0a9SMarius Strobl 		return (NULL);
129bba6f0a9SMarius Strobl 	return (obd->obd_compat);
130bba6f0a9SMarius Strobl }
131bba6f0a9SMarius Strobl 
132bba6f0a9SMarius Strobl const char *
ofw_bus_gen_get_model(device_t bus,device_t dev)133bba6f0a9SMarius Strobl ofw_bus_gen_get_model(device_t bus, device_t dev)
134bba6f0a9SMarius Strobl {
135bba6f0a9SMarius Strobl 	const struct ofw_bus_devinfo *obd;
136bba6f0a9SMarius Strobl 
137bba6f0a9SMarius Strobl 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
138bba6f0a9SMarius Strobl 	if (obd == NULL)
139bba6f0a9SMarius Strobl 		return (NULL);
140bba6f0a9SMarius Strobl 	return (obd->obd_model);
141bba6f0a9SMarius Strobl }
142bba6f0a9SMarius Strobl 
143bba6f0a9SMarius Strobl const char *
ofw_bus_gen_get_name(device_t bus,device_t dev)144bba6f0a9SMarius Strobl ofw_bus_gen_get_name(device_t bus, device_t dev)
145bba6f0a9SMarius Strobl {
146bba6f0a9SMarius Strobl 	const struct ofw_bus_devinfo *obd;
147bba6f0a9SMarius Strobl 
148bba6f0a9SMarius Strobl 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
149bba6f0a9SMarius Strobl 	if (obd == NULL)
150bba6f0a9SMarius Strobl 		return (NULL);
151bba6f0a9SMarius Strobl 	return (obd->obd_name);
152bba6f0a9SMarius Strobl }
153bba6f0a9SMarius Strobl 
154bba6f0a9SMarius Strobl phandle_t
ofw_bus_gen_get_node(device_t bus,device_t dev)155bba6f0a9SMarius Strobl ofw_bus_gen_get_node(device_t bus, device_t dev)
156bba6f0a9SMarius Strobl {
157bba6f0a9SMarius Strobl 	const struct ofw_bus_devinfo *obd;
158bba6f0a9SMarius Strobl 
159bba6f0a9SMarius Strobl 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
160bba6f0a9SMarius Strobl 	if (obd == NULL)
1613eae4e10SMichal Meloun 		return ((phandle_t)-1);
162bba6f0a9SMarius Strobl 	return (obd->obd_node);
163bba6f0a9SMarius Strobl }
164bba6f0a9SMarius Strobl 
165bba6f0a9SMarius Strobl const char *
ofw_bus_gen_get_type(device_t bus,device_t dev)166bba6f0a9SMarius Strobl ofw_bus_gen_get_type(device_t bus, device_t dev)
167bba6f0a9SMarius Strobl {
168bba6f0a9SMarius Strobl 	const struct ofw_bus_devinfo *obd;
169bba6f0a9SMarius Strobl 
170bba6f0a9SMarius Strobl 	obd = OFW_BUS_GET_DEVINFO(bus, dev);
171bba6f0a9SMarius Strobl 	if (obd == NULL)
172bba6f0a9SMarius Strobl 		return (NULL);
173bba6f0a9SMarius Strobl 	return (obd->obd_type);
174bba6f0a9SMarius Strobl }
17594b4a038SNathan Whitehorn 
176e4be5a16SNathan Whitehorn const char *
ofw_bus_get_status(device_t dev)177e4be5a16SNathan Whitehorn ofw_bus_get_status(device_t dev)
178e4be5a16SNathan Whitehorn {
179e4be5a16SNathan Whitehorn 	const struct ofw_bus_devinfo *obd;
180e4be5a16SNathan Whitehorn 
181e4be5a16SNathan Whitehorn 	obd = OFW_BUS_GET_DEVINFO(device_get_parent(dev), dev);
182e4be5a16SNathan Whitehorn 	if (obd == NULL)
183e4be5a16SNathan Whitehorn 		return (NULL);
184e4be5a16SNathan Whitehorn 
185e4be5a16SNathan Whitehorn 	return (obd->obd_status);
186e4be5a16SNathan Whitehorn }
187e4be5a16SNathan Whitehorn 
188e4be5a16SNathan Whitehorn int
ofw_bus_status_okay(device_t dev)189e4be5a16SNathan Whitehorn ofw_bus_status_okay(device_t dev)
190e4be5a16SNathan Whitehorn {
191e4be5a16SNathan Whitehorn 	const char *status;
192e4be5a16SNathan Whitehorn 
193e4be5a16SNathan Whitehorn 	status = ofw_bus_get_status(dev);
194f3856d8fSAndrew Turner 	if (status == NULL || strcmp(status, "okay") == 0 ||
195f3856d8fSAndrew Turner 	    strcmp(status, "ok") == 0)
196e4be5a16SNathan Whitehorn 		return (1);
197e4be5a16SNathan Whitehorn 
198e4be5a16SNathan Whitehorn 	return (0);
199e4be5a16SNathan Whitehorn }
200e4be5a16SNathan Whitehorn 
201e5e94d2dSWojciech Macek int
ofw_bus_node_status_okay(phandle_t node)202e5e94d2dSWojciech Macek ofw_bus_node_status_okay(phandle_t node)
203e5e94d2dSWojciech Macek {
204e5e94d2dSWojciech Macek 	char status[OFW_STATUS_LEN];
205e5e94d2dSWojciech Macek 	int len;
206e5e94d2dSWojciech Macek 
207e5e94d2dSWojciech Macek 	len = OF_getproplen(node, "status");
208e5e94d2dSWojciech Macek 	if (len <= 0)
209e5e94d2dSWojciech Macek 		return (1);
210e5e94d2dSWojciech Macek 
211e5e94d2dSWojciech Macek 	OF_getprop(node, "status", status, OFW_STATUS_LEN);
212e5e94d2dSWojciech Macek 	if ((len == 5 && (bcmp(status, "okay", len) == 0)) ||
213e5e94d2dSWojciech Macek 	    (len == 3 && (bcmp(status, "ok", len))))
214e5e94d2dSWojciech Macek 		return (1);
215e5e94d2dSWojciech Macek 
216e5e94d2dSWojciech Macek 	return (0);
217e5e94d2dSWojciech Macek }
218e5e94d2dSWojciech Macek 
21972a638c7SAndrew Turner static int
ofw_bus_node_is_compatible_int(const char * compat,int len,const char * onecompat)22024f4202dSJustin Hibbits ofw_bus_node_is_compatible_int(const char *compat, int len,
22124f4202dSJustin Hibbits     const char *onecompat)
22272a638c7SAndrew Turner {
22372a638c7SAndrew Turner 	int onelen, l, ret;
22472a638c7SAndrew Turner 
22572a638c7SAndrew Turner 	onelen = strlen(onecompat);
22672a638c7SAndrew Turner 
22772a638c7SAndrew Turner 	ret = 0;
22872a638c7SAndrew Turner 	while (len > 0) {
22972a638c7SAndrew Turner 		if (strlen(compat) == onelen &&
23072a638c7SAndrew Turner 		    strncasecmp(compat, onecompat, onelen) == 0) {
23172a638c7SAndrew Turner 			/* Found it. */
23272a638c7SAndrew Turner 			ret = 1;
23372a638c7SAndrew Turner 			break;
23472a638c7SAndrew Turner 		}
23572a638c7SAndrew Turner 
23672a638c7SAndrew Turner 		/* Slide to the next sub-string. */
23772a638c7SAndrew Turner 		l = strlen(compat) + 1;
23872a638c7SAndrew Turner 		compat += l;
23972a638c7SAndrew Turner 		len -= l;
24072a638c7SAndrew Turner 	}
24172a638c7SAndrew Turner 
24272a638c7SAndrew Turner 	return (ret);
24372a638c7SAndrew Turner }
24472a638c7SAndrew Turner 
2458297758aSRafal Jaworowski int
ofw_bus_node_is_compatible(phandle_t node,const char * compatstr)24624f4202dSJustin Hibbits ofw_bus_node_is_compatible(phandle_t node, const char *compatstr)
24724f4202dSJustin Hibbits {
24824f4202dSJustin Hibbits 	char compat[OFW_COMPAT_LEN];
24924f4202dSJustin Hibbits 	int len, rv;
25024f4202dSJustin Hibbits 
25124f4202dSJustin Hibbits 	if ((len = OF_getproplen(node, "compatible")) <= 0)
25224f4202dSJustin Hibbits 		return (0);
25324f4202dSJustin Hibbits 
25424f4202dSJustin Hibbits 	bzero(compat, OFW_COMPAT_LEN);
25524f4202dSJustin Hibbits 
25624f4202dSJustin Hibbits 	if (OF_getprop(node, "compatible", compat, OFW_COMPAT_LEN) < 0)
25724f4202dSJustin Hibbits 		return (0);
25824f4202dSJustin Hibbits 
25924f4202dSJustin Hibbits 	rv = ofw_bus_node_is_compatible_int(compat, len, compatstr);
26024f4202dSJustin Hibbits 
26124f4202dSJustin Hibbits 	return (rv);
26224f4202dSJustin Hibbits }
26324f4202dSJustin Hibbits 
26424f4202dSJustin Hibbits int
ofw_bus_is_compatible(device_t dev,const char * onecompat)2658297758aSRafal Jaworowski ofw_bus_is_compatible(device_t dev, const char *onecompat)
2668297758aSRafal Jaworowski {
2678297758aSRafal Jaworowski 	phandle_t node;
2688297758aSRafal Jaworowski 	const char *compat;
26972a638c7SAndrew Turner 	int len;
2708297758aSRafal Jaworowski 
2718297758aSRafal Jaworowski 	if ((compat = ofw_bus_get_compat(dev)) == NULL)
2728297758aSRafal Jaworowski 		return (0);
2738297758aSRafal Jaworowski 
2740d8d9edaSNathan Whitehorn 	if ((node = ofw_bus_get_node(dev)) == -1)
2758297758aSRafal Jaworowski 		return (0);
2768297758aSRafal Jaworowski 
2778297758aSRafal Jaworowski 	/* Get total 'compatible' prop len */
2788297758aSRafal Jaworowski 	if ((len = OF_getproplen(node, "compatible")) <= 0)
2798297758aSRafal Jaworowski 		return (0);
2808297758aSRafal Jaworowski 
28124f4202dSJustin Hibbits 	return (ofw_bus_node_is_compatible_int(compat, len, onecompat));
2828297758aSRafal Jaworowski }
2838297758aSRafal Jaworowski 
2848297758aSRafal Jaworowski int
ofw_bus_is_compatible_strict(device_t dev,const char * compatible)2858297758aSRafal Jaworowski ofw_bus_is_compatible_strict(device_t dev, const char *compatible)
2868297758aSRafal Jaworowski {
2878297758aSRafal Jaworowski 	const char *compat;
28826ca4965SHiroki Sato 	size_t len;
2898297758aSRafal Jaworowski 
2908297758aSRafal Jaworowski 	if ((compat = ofw_bus_get_compat(dev)) == NULL)
2918297758aSRafal Jaworowski 		return (0);
2928297758aSRafal Jaworowski 
29326ca4965SHiroki Sato 	len = strlen(compatible);
29426ca4965SHiroki Sato 	if (strlen(compat) == len &&
29526ca4965SHiroki Sato 	    strncasecmp(compat, compatible, len) == 0)
2968297758aSRafal Jaworowski 		return (1);
2978297758aSRafal Jaworowski 
2988297758aSRafal Jaworowski 	return (0);
2998297758aSRafal Jaworowski }
3008297758aSRafal Jaworowski 
301498fa7c1SIan Lepore const struct ofw_compat_data *
ofw_bus_search_compatible(device_t dev,const struct ofw_compat_data * compat)302498fa7c1SIan Lepore ofw_bus_search_compatible(device_t dev, const struct ofw_compat_data *compat)
303498fa7c1SIan Lepore {
304498fa7c1SIan Lepore 
305498fa7c1SIan Lepore 	if (compat == NULL)
306498fa7c1SIan Lepore 		return NULL;
307498fa7c1SIan Lepore 
308498fa7c1SIan Lepore 	for (; compat->ocd_str != NULL; ++compat) {
309498fa7c1SIan Lepore 		if (ofw_bus_is_compatible(dev, compat->ocd_str))
310498fa7c1SIan Lepore 			break;
311498fa7c1SIan Lepore 	}
312498fa7c1SIan Lepore 
313498fa7c1SIan Lepore 	return (compat);
314498fa7c1SIan Lepore }
315498fa7c1SIan Lepore 
31626ca4965SHiroki Sato int
ofw_bus_has_prop(device_t dev,const char * propname)31726ca4965SHiroki Sato ofw_bus_has_prop(device_t dev, const char *propname)
31826ca4965SHiroki Sato {
31926ca4965SHiroki Sato 	phandle_t node;
32026ca4965SHiroki Sato 
32126ca4965SHiroki Sato 	if ((node = ofw_bus_get_node(dev)) == -1)
32226ca4965SHiroki Sato 		return (0);
32326ca4965SHiroki Sato 
32426ca4965SHiroki Sato 	return (OF_hasprop(node, propname));
32526ca4965SHiroki Sato }
32626ca4965SHiroki Sato 
32794b4a038SNathan Whitehorn void
ofw_bus_setup_iinfo(phandle_t node,struct ofw_bus_iinfo * ii,int intrsz)32894b4a038SNathan Whitehorn ofw_bus_setup_iinfo(phandle_t node, struct ofw_bus_iinfo *ii, int intrsz)
32994b4a038SNathan Whitehorn {
33094b4a038SNathan Whitehorn 	pcell_t addrc;
33194b4a038SNathan Whitehorn 	int msksz;
33294b4a038SNathan Whitehorn 
333d3a0a0f3SNathan Whitehorn 	if (OF_getencprop(node, "#address-cells", &addrc, sizeof(addrc)) == -1)
33494b4a038SNathan Whitehorn 		addrc = 2;
33594b4a038SNathan Whitehorn 	ii->opi_addrc = addrc * sizeof(pcell_t);
33694b4a038SNathan Whitehorn 
337f7604b1bSOleksandr Tymoshenko 	ii->opi_imapsz = OF_getencprop_alloc(node, "interrupt-map",
33894b4a038SNathan Whitehorn 	    (void **)&ii->opi_imap);
33994b4a038SNathan Whitehorn 	if (ii->opi_imapsz > 0) {
340f7604b1bSOleksandr Tymoshenko 		msksz = OF_getencprop_alloc(node, "interrupt-map-mask",
34194b4a038SNathan Whitehorn 		    (void **)&ii->opi_imapmsk);
34294b4a038SNathan Whitehorn 		/*
343481d6b54SMarius Strobl 		 * Failure to get the mask is ignored; a full mask is used
344481d6b54SMarius Strobl 		 * then.  We barf on bad mask sizes, however.
34594b4a038SNathan Whitehorn 		 */
346481d6b54SMarius Strobl 		if (msksz != -1 && msksz != ii->opi_addrc + intrsz)
34794b4a038SNathan Whitehorn 			panic("ofw_bus_setup_iinfo: bad interrupt-map-mask "
34894b4a038SNathan Whitehorn 			    "property!");
34994b4a038SNathan Whitehorn 	}
35094b4a038SNathan Whitehorn }
35194b4a038SNathan Whitehorn 
35294b4a038SNathan Whitehorn int
ofw_bus_lookup_imap(phandle_t node,struct ofw_bus_iinfo * ii,void * reg,int regsz,void * pintr,int pintrsz,void * mintr,int mintrsz,phandle_t * iparent)35394b4a038SNathan Whitehorn ofw_bus_lookup_imap(phandle_t node, struct ofw_bus_iinfo *ii, void *reg,
35494b4a038SNathan Whitehorn     int regsz, void *pintr, int pintrsz, void *mintr, int mintrsz,
35595e3bfe8SNathan Whitehorn     phandle_t *iparent)
35694b4a038SNathan Whitehorn {
35795e3bfe8SNathan Whitehorn 	uint8_t maskbuf[regsz + pintrsz];
35894b4a038SNathan Whitehorn 	int rv;
35994b4a038SNathan Whitehorn 
36094b4a038SNathan Whitehorn 	if (ii->opi_imapsz <= 0)
36194b4a038SNathan Whitehorn 		return (0);
36294b4a038SNathan Whitehorn 	KASSERT(regsz >= ii->opi_addrc,
36394b4a038SNathan Whitehorn 	    ("ofw_bus_lookup_imap: register size too small: %d < %d",
36494b4a038SNathan Whitehorn 		regsz, ii->opi_addrc));
3656064b6acSNathan Whitehorn 	if (node != -1) {
366d3a0a0f3SNathan Whitehorn 		rv = OF_getencprop(node, "reg", reg, regsz);
36794b4a038SNathan Whitehorn 		if (rv < regsz)
3686064b6acSNathan Whitehorn 			panic("ofw_bus_lookup_imap: cannot get reg property");
3696064b6acSNathan Whitehorn 	}
37094b4a038SNathan Whitehorn 	return (ofw_bus_search_intrmap(pintr, pintrsz, reg, ii->opi_addrc,
37194b4a038SNathan Whitehorn 	    ii->opi_imap, ii->opi_imapsz, ii->opi_imapmsk, maskbuf, mintr,
372eaef5f0aSNathan Whitehorn 	    mintrsz, iparent));
37394b4a038SNathan Whitehorn }
37494b4a038SNathan Whitehorn 
37594b4a038SNathan Whitehorn /*
37694b4a038SNathan Whitehorn  * Map an interrupt using the firmware reg, interrupt-map and
37794b4a038SNathan Whitehorn  * interrupt-map-mask properties.
37894b4a038SNathan Whitehorn  * The interrupt property to be mapped must be of size intrsz, and pointed to
37994b4a038SNathan Whitehorn  * by intr.  The regs property of the node for which the mapping is done must
38094b4a038SNathan Whitehorn  * be passed as regs. This property is an array of register specifications;
38194b4a038SNathan Whitehorn  * the size of the address part of such a specification must be passed as
38294b4a038SNathan Whitehorn  * physsz.  Only the first element of the property is used.
38394b4a038SNathan Whitehorn  * imap and imapsz hold the interrupt mask and it's size.
38494b4a038SNathan Whitehorn  * imapmsk is a pointer to the interrupt-map-mask property, which must have
38594b4a038SNathan Whitehorn  * a size of physsz + intrsz; it may be NULL, in which case a full mask is
38694b4a038SNathan Whitehorn  * assumed.
38794b4a038SNathan Whitehorn  * maskbuf must point to a buffer of length physsz + intrsz.
38894b4a038SNathan Whitehorn  * The interrupt is returned in result, which must point to a buffer of length
38994b4a038SNathan Whitehorn  * rintrsz (which gives the expected size of the mapped interrupt).
390cb6d9d6cSNathan Whitehorn  * Returns number of cells in the interrupt if a mapping was found, 0 otherwise.
39194b4a038SNathan Whitehorn  */
39294b4a038SNathan Whitehorn int
ofw_bus_search_intrmap(void * intr,int intrsz,void * regs,int physsz,void * imap,int imapsz,void * imapmsk,void * maskbuf,void * result,int rintrsz,phandle_t * iparent)39394b4a038SNathan Whitehorn ofw_bus_search_intrmap(void *intr, int intrsz, void *regs, int physsz,
39494b4a038SNathan Whitehorn     void *imap, int imapsz, void *imapmsk, void *maskbuf, void *result,
395eaef5f0aSNathan Whitehorn     int rintrsz, phandle_t *iparent)
39694b4a038SNathan Whitehorn {
39794b4a038SNathan Whitehorn 	phandle_t parent;
398481d6b54SMarius Strobl 	uint8_t *ref = maskbuf;
399481d6b54SMarius Strobl 	uint8_t *uiintr = intr;
400481d6b54SMarius Strobl 	uint8_t *uiregs = regs;
401481d6b54SMarius Strobl 	uint8_t *uiimapmsk = imapmsk;
402481d6b54SMarius Strobl 	uint8_t *mptr;
403122493cfSAndrew Turner 	pcell_t paddrsz;
40494b4a038SNathan Whitehorn 	pcell_t pintrsz;
405151ba793SAlexander Kabaev 	int i, tsz;
40694b4a038SNathan Whitehorn 
40794b4a038SNathan Whitehorn 	if (imapmsk != NULL) {
40894b4a038SNathan Whitehorn 		for (i = 0; i < physsz; i++)
40994b4a038SNathan Whitehorn 			ref[i] = uiregs[i] & uiimapmsk[i];
41094b4a038SNathan Whitehorn 		for (i = 0; i < intrsz; i++)
41194b4a038SNathan Whitehorn 			ref[physsz + i] = uiintr[i] & uiimapmsk[physsz + i];
41294b4a038SNathan Whitehorn 	} else {
41394b4a038SNathan Whitehorn 		bcopy(regs, ref, physsz);
41494b4a038SNathan Whitehorn 		bcopy(intr, ref + physsz, intrsz);
41594b4a038SNathan Whitehorn 	}
41694b4a038SNathan Whitehorn 
41794b4a038SNathan Whitehorn 	mptr = imap;
41894b4a038SNathan Whitehorn 	i = imapsz;
419122493cfSAndrew Turner 	paddrsz = 0;
42094b4a038SNathan Whitehorn 	while (i > 0) {
42194b4a038SNathan Whitehorn 		bcopy(mptr + physsz + intrsz, &parent, sizeof(parent));
4229f4a7eaeSNathan Whitehorn #ifndef OFW_IMAP_NO_IPARENT_ADDR_CELLS
423122493cfSAndrew Turner 		/*
4249f4a7eaeSNathan Whitehorn 		 * Find if we need to read the parent address data.
4259f4a7eaeSNathan Whitehorn 		 * CHRP-derived OF bindings, including ePAPR-compliant FDTs,
4269f4a7eaeSNathan Whitehorn 		 * use this as an optional part of the specifier.
427122493cfSAndrew Turner 		 */
428122493cfSAndrew Turner 		if (OF_getencprop(OF_node_from_xref(parent),
429122493cfSAndrew Turner 		    "#address-cells", &paddrsz, sizeof(paddrsz)) == -1)
430122493cfSAndrew Turner 			paddrsz = 0;	/* default */
431122493cfSAndrew Turner 		paddrsz *= sizeof(pcell_t);
432122493cfSAndrew Turner #endif
433122493cfSAndrew Turner 
434752ba930SIan Lepore 		if (OF_searchencprop(OF_node_from_xref(parent),
435d3a0a0f3SNathan Whitehorn 		    "#interrupt-cells", &pintrsz, sizeof(pintrsz)) == -1)
43694b4a038SNathan Whitehorn 			pintrsz = 1;	/* default */
43794b4a038SNathan Whitehorn 		pintrsz *= sizeof(pcell_t);
438acb97117SNathan Whitehorn 
439481d6b54SMarius Strobl 		/* Compute the map stride size. */
440122493cfSAndrew Turner 		tsz = physsz + intrsz + sizeof(phandle_t) + paddrsz + pintrsz;
441acb97117SNathan Whitehorn 		KASSERT(i >= tsz, ("ofw_bus_search_intrmap: truncated map"));
44294b4a038SNathan Whitehorn 
44394b4a038SNathan Whitehorn 		if (bcmp(ref, mptr, physsz + intrsz) == 0) {
444122493cfSAndrew Turner 			bcopy(mptr + physsz + intrsz + sizeof(parent) + paddrsz,
445cb6d9d6cSNathan Whitehorn 			    result, MIN(rintrsz, pintrsz));
446eaef5f0aSNathan Whitehorn 
447eaef5f0aSNathan Whitehorn 			if (iparent != NULL)
448eaef5f0aSNathan Whitehorn 				*iparent = parent;
449cb6d9d6cSNathan Whitehorn 			return (pintrsz/sizeof(pcell_t));
45094b4a038SNathan Whitehorn 		}
45194b4a038SNathan Whitehorn 		mptr += tsz;
45294b4a038SNathan Whitehorn 		i -= tsz;
45394b4a038SNathan Whitehorn 	}
45494b4a038SNathan Whitehorn 	return (0);
45594b4a038SNathan Whitehorn }
4566064b6acSNathan Whitehorn 
457c47d4cdeSIan Lepore int
ofw_bus_msimap(phandle_t node,uint16_t pci_rid,phandle_t * msi_parent,uint32_t * msi_rid)4581e43b18cSAndrew Turner ofw_bus_msimap(phandle_t node, uint16_t pci_rid, phandle_t *msi_parent,
4591e43b18cSAndrew Turner     uint32_t *msi_rid)
4601e43b18cSAndrew Turner {
4611e43b18cSAndrew Turner 	pcell_t *map, mask, msi_base, rid_base, rid_length;
4621e43b18cSAndrew Turner 	ssize_t len;
463151ba793SAlexander Kabaev 	uint32_t masked_rid;
4641e43b18cSAndrew Turner 	int err, i;
4651e43b18cSAndrew Turner 
4661e43b18cSAndrew Turner 	/* TODO: This should be OF_searchprop_alloc if we had it */
467f7604b1bSOleksandr Tymoshenko 	len = OF_getencprop_alloc_multi(node, "msi-map", sizeof(*map),
468f7604b1bSOleksandr Tymoshenko 	    (void **)&map);
4691e43b18cSAndrew Turner 	if (len < 0) {
4701e43b18cSAndrew Turner 		if (msi_parent != NULL) {
4711e43b18cSAndrew Turner 			*msi_parent = 0;
4721e43b18cSAndrew Turner 			OF_getencprop(node, "msi-parent", msi_parent,
4731e43b18cSAndrew Turner 			    sizeof(*msi_parent));
4741e43b18cSAndrew Turner 		}
4751e43b18cSAndrew Turner 		if (msi_rid != NULL)
4761e43b18cSAndrew Turner 			*msi_rid = pci_rid;
4771e43b18cSAndrew Turner 		return (0);
4781e43b18cSAndrew Turner 	}
4791e43b18cSAndrew Turner 
4801e43b18cSAndrew Turner 	err = ENOENT;
4811e43b18cSAndrew Turner 	mask = 0xffffffff;
4821e43b18cSAndrew Turner 	OF_getencprop(node, "msi-map-mask", &mask, sizeof(mask));
4831e43b18cSAndrew Turner 
4841e43b18cSAndrew Turner 	masked_rid = pci_rid & mask;
4851e43b18cSAndrew Turner 	for (i = 0; i < len; i += 4) {
4861e43b18cSAndrew Turner 		rid_base = map[i + 0];
4871e43b18cSAndrew Turner 		rid_length = map[i + 3];
4881e43b18cSAndrew Turner 
4891e43b18cSAndrew Turner 		if (masked_rid < rid_base ||
4901e43b18cSAndrew Turner 		    masked_rid >= (rid_base + rid_length))
4911e43b18cSAndrew Turner 			continue;
4921e43b18cSAndrew Turner 
4931e43b18cSAndrew Turner 		msi_base = map[i + 2];
4941e43b18cSAndrew Turner 
4951e43b18cSAndrew Turner 		if (msi_parent != NULL)
4961e43b18cSAndrew Turner 			*msi_parent = map[i + 1];
4971e43b18cSAndrew Turner 		if (msi_rid != NULL)
4981e43b18cSAndrew Turner 			*msi_rid = masked_rid - rid_base + msi_base;
4991e43b18cSAndrew Turner 		err = 0;
5001e43b18cSAndrew Turner 		break;
5011e43b18cSAndrew Turner 	}
5021e43b18cSAndrew Turner 
5031e43b18cSAndrew Turner 	free(map, M_OFWPROP);
5041e43b18cSAndrew Turner 
5051e43b18cSAndrew Turner 	return (err);
5061e43b18cSAndrew Turner }
5071e43b18cSAndrew Turner 
5080b6bacc7SRuslan Bukin int
ofw_bus_iommu_map(phandle_t node,uint16_t pci_rid,phandle_t * iommu_parent,uint32_t * iommu_rid)5090b6bacc7SRuslan Bukin ofw_bus_iommu_map(phandle_t node, uint16_t pci_rid, phandle_t *iommu_parent,
5100b6bacc7SRuslan Bukin     uint32_t *iommu_rid)
5110b6bacc7SRuslan Bukin {
5120c0bfa0fSRuslan Bukin 	pcell_t *map, mask, iommu_base, rid_base, rid_length;
5130b6bacc7SRuslan Bukin 	ssize_t len;
5140c0bfa0fSRuslan Bukin 	uint32_t masked_rid;
5150b6bacc7SRuslan Bukin 	int err, i;
5160b6bacc7SRuslan Bukin 
5170c0bfa0fSRuslan Bukin 	len = OF_getencprop_alloc_multi(node, "iommu-map", sizeof(*map),
5180c0bfa0fSRuslan Bukin 	    (void **)&map);
5190b6bacc7SRuslan Bukin 	if (len <= 0)
5200b6bacc7SRuslan Bukin 		return (ENOENT);
5210b6bacc7SRuslan Bukin 
5220b6bacc7SRuslan Bukin 	err = ENOENT;
5230b6bacc7SRuslan Bukin 	mask = 0xffffffff;
5240b6bacc7SRuslan Bukin 	OF_getencprop(node, "iommu-map-mask", &mask, sizeof(mask));
5250b6bacc7SRuslan Bukin 
5260b6bacc7SRuslan Bukin 	masked_rid = pci_rid & mask;
5270b6bacc7SRuslan Bukin 	for (i = 0; i < len; i += 4) {
5280b6bacc7SRuslan Bukin 		rid_base = map[i + 0];
5290b6bacc7SRuslan Bukin 		rid_length = map[i + 3];
5300b6bacc7SRuslan Bukin 
5310b6bacc7SRuslan Bukin 		if (masked_rid < rid_base ||
5320b6bacc7SRuslan Bukin 		    masked_rid >= (rid_base + rid_length))
5330b6bacc7SRuslan Bukin 			continue;
5340b6bacc7SRuslan Bukin 
5350b6bacc7SRuslan Bukin 		iommu_base = map[i + 2];
5360b6bacc7SRuslan Bukin 
5370b6bacc7SRuslan Bukin 		if (iommu_parent != NULL)
5380b6bacc7SRuslan Bukin 			*iommu_parent = map[i + 1];
5390b6bacc7SRuslan Bukin 		if (iommu_rid != NULL)
5400b6bacc7SRuslan Bukin 			*iommu_rid = masked_rid - rid_base + iommu_base;
5410b6bacc7SRuslan Bukin 		err = 0;
5420b6bacc7SRuslan Bukin 		break;
5430b6bacc7SRuslan Bukin 	}
5440b6bacc7SRuslan Bukin 
5450c0bfa0fSRuslan Bukin 	free(map, M_OFWPROP);
5460c0bfa0fSRuslan Bukin 
5470b6bacc7SRuslan Bukin 	return (err);
5480b6bacc7SRuslan Bukin }
5490b6bacc7SRuslan Bukin 
550d310c9e0SMarcin Wojtas static int
ofw_bus_reg_to_rl_helper(device_t dev,phandle_t node,pcell_t acells,pcell_t scells,struct resource_list * rl,const char * reg_source)551d310c9e0SMarcin Wojtas ofw_bus_reg_to_rl_helper(device_t dev, phandle_t node, pcell_t acells, pcell_t scells,
552d310c9e0SMarcin Wojtas     struct resource_list *rl, const char *reg_source)
5534b3d9160SZbigniew Bodek {
5544b3d9160SZbigniew Bodek 	uint64_t phys, size;
5554b3d9160SZbigniew Bodek 	ssize_t i, j, rid, nreg, ret;
5564b3d9160SZbigniew Bodek 	uint32_t *reg;
5574b3d9160SZbigniew Bodek 	char *name;
5584b3d9160SZbigniew Bodek 
5594b3d9160SZbigniew Bodek 	/*
5604b3d9160SZbigniew Bodek 	 * This may be just redundant when having ofw_bus_devinfo
5614b3d9160SZbigniew Bodek 	 * but makes this routine independent of it.
5624b3d9160SZbigniew Bodek 	 */
563217d17bcSOleksandr Tymoshenko 	ret = OF_getprop_alloc(node, "name", (void **)&name);
5644b3d9160SZbigniew Bodek 	if (ret == -1)
5654b3d9160SZbigniew Bodek 		name = NULL;
5664b3d9160SZbigniew Bodek 
567f7604b1bSOleksandr Tymoshenko 	ret = OF_getencprop_alloc_multi(node, reg_source, sizeof(*reg),
568f7604b1bSOleksandr Tymoshenko 	    (void **)&reg);
5694b3d9160SZbigniew Bodek 	nreg = (ret == -1) ? 0 : ret;
5704b3d9160SZbigniew Bodek 
5714b3d9160SZbigniew Bodek 	if (nreg % (acells + scells) != 0) {
5724b3d9160SZbigniew Bodek 		if (bootverbose)
5734b3d9160SZbigniew Bodek 			device_printf(dev, "Malformed reg property on <%s>\n",
5744b3d9160SZbigniew Bodek 			    (name == NULL) ? "unknown" : name);
5754b3d9160SZbigniew Bodek 		nreg = 0;
5764b3d9160SZbigniew Bodek 	}
5774b3d9160SZbigniew Bodek 
5784b3d9160SZbigniew Bodek 	for (i = 0, rid = 0; i < nreg; i += acells + scells, rid++) {
5794b3d9160SZbigniew Bodek 		phys = size = 0;
5804b3d9160SZbigniew Bodek 		for (j = 0; j < acells; j++) {
5814b3d9160SZbigniew Bodek 			phys <<= 32;
5824b3d9160SZbigniew Bodek 			phys |= reg[i + j];
5834b3d9160SZbigniew Bodek 		}
5844b3d9160SZbigniew Bodek 		for (j = 0; j < scells; j++) {
5854b3d9160SZbigniew Bodek 			size <<= 32;
5864b3d9160SZbigniew Bodek 			size |= reg[i + acells + j];
5874b3d9160SZbigniew Bodek 		}
5884b3d9160SZbigniew Bodek 		/* Skip the dummy reg property of glue devices like ssm(4). */
5894b3d9160SZbigniew Bodek 		if (size != 0)
5904b3d9160SZbigniew Bodek 			resource_list_add(rl, SYS_RES_MEMORY, rid,
5914b3d9160SZbigniew Bodek 			    phys, phys + size - 1, size);
5924b3d9160SZbigniew Bodek 	}
5934b3d9160SZbigniew Bodek 	free(name, M_OFWPROP);
5944b3d9160SZbigniew Bodek 	free(reg, M_OFWPROP);
5954b3d9160SZbigniew Bodek 
5964b3d9160SZbigniew Bodek 	return (0);
5974b3d9160SZbigniew Bodek }
5984b3d9160SZbigniew Bodek 
599d310c9e0SMarcin Wojtas int
ofw_bus_reg_to_rl(device_t dev,phandle_t node,pcell_t acells,pcell_t scells,struct resource_list * rl)600d310c9e0SMarcin Wojtas ofw_bus_reg_to_rl(device_t dev, phandle_t node, pcell_t acells, pcell_t scells,
601d310c9e0SMarcin Wojtas     struct resource_list *rl)
602d310c9e0SMarcin Wojtas {
603d310c9e0SMarcin Wojtas 
604d310c9e0SMarcin Wojtas 	return (ofw_bus_reg_to_rl_helper(dev, node, acells, scells, rl, "reg"));
605d310c9e0SMarcin Wojtas }
606d310c9e0SMarcin Wojtas 
607d310c9e0SMarcin Wojtas int
ofw_bus_assigned_addresses_to_rl(device_t dev,phandle_t node,pcell_t acells,pcell_t scells,struct resource_list * rl)608d310c9e0SMarcin Wojtas ofw_bus_assigned_addresses_to_rl(device_t dev, phandle_t node, pcell_t acells,
609d310c9e0SMarcin Wojtas     pcell_t scells, struct resource_list *rl)
610d310c9e0SMarcin Wojtas {
611d310c9e0SMarcin Wojtas 
612d310c9e0SMarcin Wojtas 	return (ofw_bus_reg_to_rl_helper(dev, node, acells, scells,
613d310c9e0SMarcin Wojtas 	    rl, "assigned-addresses"));
614d310c9e0SMarcin Wojtas }
615d310c9e0SMarcin Wojtas 
616821a61efSMichal Meloun /*
617821a61efSMichal Meloun  * Get interrupt parent for given node.
618821a61efSMichal Meloun  * Returns 0 if interrupt parent doesn't exist.
619821a61efSMichal Meloun  */
620821a61efSMichal Meloun phandle_t
ofw_bus_find_iparent(phandle_t node)621821a61efSMichal Meloun ofw_bus_find_iparent(phandle_t node)
622821a61efSMichal Meloun {
623821a61efSMichal Meloun 	phandle_t iparent;
624821a61efSMichal Meloun 
625821a61efSMichal Meloun 	if (OF_searchencprop(node, "interrupt-parent", &iparent,
626821a61efSMichal Meloun 		    sizeof(iparent)) == -1) {
627821a61efSMichal Meloun 		for (iparent = node; iparent != 0;
628821a61efSMichal Meloun 		    iparent = OF_parent(iparent)) {
629821a61efSMichal Meloun 			if (OF_hasprop(iparent, "interrupt-controller"))
630821a61efSMichal Meloun 				break;
631821a61efSMichal Meloun 		}
632821a61efSMichal Meloun 		iparent = OF_xref_from_node(iparent);
633821a61efSMichal Meloun 	}
634821a61efSMichal Meloun 	return (iparent);
635821a61efSMichal Meloun }
636821a61efSMichal Meloun 
6374b3d9160SZbigniew Bodek int
ofw_bus_intr_to_rl(device_t dev,phandle_t node,struct resource_list * rl,int * rlen)638a8c5ea04SRuslan Bukin ofw_bus_intr_to_rl(device_t dev, phandle_t node,
639a8c5ea04SRuslan Bukin     struct resource_list *rl, int *rlen)
640c47d4cdeSIan Lepore {
641c47d4cdeSIan Lepore 	phandle_t iparent;
642c47d4cdeSIan Lepore 	uint32_t icells, *intr;
643c47d4cdeSIan Lepore 	int err, i, irqnum, nintr, rid;
644c47d4cdeSIan Lepore 	boolean_t extended;
645c47d4cdeSIan Lepore 
646f7604b1bSOleksandr Tymoshenko 	nintr = OF_getencprop_alloc_multi(node, "interrupts",  sizeof(*intr),
647c47d4cdeSIan Lepore 	    (void **)&intr);
648c47d4cdeSIan Lepore 	if (nintr > 0) {
649821a61efSMichal Meloun 		iparent = ofw_bus_find_iparent(node);
65008b96b9fSNathan Whitehorn 		if (iparent == 0) {
651c47d4cdeSIan Lepore 			device_printf(dev, "No interrupt-parent found, "
652c47d4cdeSIan Lepore 			    "assuming direct parent\n");
653c47d4cdeSIan Lepore 			iparent = OF_parent(node);
65408b96b9fSNathan Whitehorn 			iparent = OF_xref_from_node(iparent);
65508b96b9fSNathan Whitehorn 		}
656c47d4cdeSIan Lepore 		if (OF_searchencprop(OF_node_from_xref(iparent),
657c47d4cdeSIan Lepore 		    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
658c47d4cdeSIan Lepore 			device_printf(dev, "Missing #interrupt-cells "
659c47d4cdeSIan Lepore 			    "property, assuming <1>\n");
660c47d4cdeSIan Lepore 			icells = 1;
661c47d4cdeSIan Lepore 		}
662c47d4cdeSIan Lepore 		if (icells < 1 || icells > nintr) {
663c47d4cdeSIan Lepore 			device_printf(dev, "Invalid #interrupt-cells property "
664c47d4cdeSIan Lepore 			    "value <%d>, assuming <1>\n", icells);
665c47d4cdeSIan Lepore 			icells = 1;
666c47d4cdeSIan Lepore 		}
667c47d4cdeSIan Lepore 		extended = false;
668c47d4cdeSIan Lepore 	} else {
669f7604b1bSOleksandr Tymoshenko 		nintr = OF_getencprop_alloc_multi(node, "interrupts-extended",
670c47d4cdeSIan Lepore 		    sizeof(*intr), (void **)&intr);
671c47d4cdeSIan Lepore 		if (nintr <= 0)
672c47d4cdeSIan Lepore 			return (0);
673c47d4cdeSIan Lepore 		extended = true;
674c47d4cdeSIan Lepore 	}
675c47d4cdeSIan Lepore 	err = 0;
676c47d4cdeSIan Lepore 	rid = 0;
677c47d4cdeSIan Lepore 	for (i = 0; i < nintr; i += icells) {
678c47d4cdeSIan Lepore 		if (extended) {
679c47d4cdeSIan Lepore 			iparent = intr[i++];
680c47d4cdeSIan Lepore 			if (OF_searchencprop(OF_node_from_xref(iparent),
681c47d4cdeSIan Lepore 			    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
682c47d4cdeSIan Lepore 				device_printf(dev, "Missing #interrupt-cells "
683c47d4cdeSIan Lepore 				    "property\n");
684c47d4cdeSIan Lepore 				err = ENOENT;
685c47d4cdeSIan Lepore 				break;
686c47d4cdeSIan Lepore 			}
687c47d4cdeSIan Lepore 			if (icells < 1 || (i + icells) > nintr) {
688c47d4cdeSIan Lepore 				device_printf(dev, "Invalid #interrupt-cells "
689c47d4cdeSIan Lepore 				    "property value <%d>\n", icells);
690c47d4cdeSIan Lepore 				err = ERANGE;
691c47d4cdeSIan Lepore 				break;
692c47d4cdeSIan Lepore 			}
693c47d4cdeSIan Lepore 		}
694c47d4cdeSIan Lepore 		irqnum = ofw_bus_map_intr(dev, iparent, icells, &intr[i]);
695c47d4cdeSIan Lepore 		resource_list_add(rl, SYS_RES_IRQ, rid++, irqnum, irqnum, 1);
696c47d4cdeSIan Lepore 	}
697a8c5ea04SRuslan Bukin 	if (rlen != NULL)
698a8c5ea04SRuslan Bukin 		*rlen = rid;
699c47d4cdeSIan Lepore 	free(intr, M_OFWPROP);
700c47d4cdeSIan Lepore 	return (err);
701c47d4cdeSIan Lepore }
702ad5244ecSSvatopluk Kraus 
703ad5244ecSSvatopluk Kraus int
ofw_bus_intr_by_rid(device_t dev,phandle_t node,int wanted_rid,phandle_t * producer,int * ncells,pcell_t ** cells)704ad5244ecSSvatopluk Kraus ofw_bus_intr_by_rid(device_t dev, phandle_t node, int wanted_rid,
705ad5244ecSSvatopluk Kraus     phandle_t *producer, int *ncells, pcell_t **cells)
706ad5244ecSSvatopluk Kraus {
707ad5244ecSSvatopluk Kraus 	phandle_t iparent;
708ad5244ecSSvatopluk Kraus 	uint32_t icells, *intr;
709ad5244ecSSvatopluk Kraus 	int err, i, nintr, rid;
710ad5244ecSSvatopluk Kraus 	boolean_t extended;
711ad5244ecSSvatopluk Kraus 
712f7604b1bSOleksandr Tymoshenko 	nintr = OF_getencprop_alloc_multi(node, "interrupts",  sizeof(*intr),
713ad5244ecSSvatopluk Kraus 	    (void **)&intr);
714ad5244ecSSvatopluk Kraus 	if (nintr > 0) {
715ad5244ecSSvatopluk Kraus 		iparent = ofw_bus_find_iparent(node);
716ad5244ecSSvatopluk Kraus 		if (iparent == 0) {
717ad5244ecSSvatopluk Kraus 			device_printf(dev, "No interrupt-parent found, "
718ad5244ecSSvatopluk Kraus 			    "assuming direct parent\n");
719ad5244ecSSvatopluk Kraus 			iparent = OF_parent(node);
720ad5244ecSSvatopluk Kraus 			iparent = OF_xref_from_node(iparent);
721ad5244ecSSvatopluk Kraus 		}
722ad5244ecSSvatopluk Kraus 		if (OF_searchencprop(OF_node_from_xref(iparent),
723ad5244ecSSvatopluk Kraus 		    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
724ad5244ecSSvatopluk Kraus 			device_printf(dev, "Missing #interrupt-cells "
725ad5244ecSSvatopluk Kraus 			    "property, assuming <1>\n");
726ad5244ecSSvatopluk Kraus 			icells = 1;
727ad5244ecSSvatopluk Kraus 		}
728ad5244ecSSvatopluk Kraus 		if (icells < 1 || icells > nintr) {
729ad5244ecSSvatopluk Kraus 			device_printf(dev, "Invalid #interrupt-cells property "
730ad5244ecSSvatopluk Kraus 			    "value <%d>, assuming <1>\n", icells);
731ad5244ecSSvatopluk Kraus 			icells = 1;
732ad5244ecSSvatopluk Kraus 		}
733ad5244ecSSvatopluk Kraus 		extended = false;
734ad5244ecSSvatopluk Kraus 	} else {
735f7604b1bSOleksandr Tymoshenko 		nintr = OF_getencprop_alloc_multi(node, "interrupts-extended",
736ad5244ecSSvatopluk Kraus 		    sizeof(*intr), (void **)&intr);
737ad5244ecSSvatopluk Kraus 		if (nintr <= 0)
738ad5244ecSSvatopluk Kraus 			return (ESRCH);
739ad5244ecSSvatopluk Kraus 		extended = true;
740ad5244ecSSvatopluk Kraus 	}
741ad5244ecSSvatopluk Kraus 	err = ESRCH;
742ad5244ecSSvatopluk Kraus 	rid = 0;
743ad5244ecSSvatopluk Kraus 	for (i = 0; i < nintr; i += icells, rid++) {
744ad5244ecSSvatopluk Kraus 		if (extended) {
745ad5244ecSSvatopluk Kraus 			iparent = intr[i++];
746ad5244ecSSvatopluk Kraus 			if (OF_searchencprop(OF_node_from_xref(iparent),
747ad5244ecSSvatopluk Kraus 			    "#interrupt-cells", &icells, sizeof(icells)) == -1) {
748ad5244ecSSvatopluk Kraus 				device_printf(dev, "Missing #interrupt-cells "
749ad5244ecSSvatopluk Kraus 				    "property\n");
750ad5244ecSSvatopluk Kraus 				err = ENOENT;
751ad5244ecSSvatopluk Kraus 				break;
752ad5244ecSSvatopluk Kraus 			}
753ad5244ecSSvatopluk Kraus 			if (icells < 1 || (i + icells) > nintr) {
754ad5244ecSSvatopluk Kraus 				device_printf(dev, "Invalid #interrupt-cells "
755ad5244ecSSvatopluk Kraus 				    "property value <%d>\n", icells);
756ad5244ecSSvatopluk Kraus 				err = ERANGE;
757ad5244ecSSvatopluk Kraus 				break;
758ad5244ecSSvatopluk Kraus 			}
759ad5244ecSSvatopluk Kraus 		}
760ad5244ecSSvatopluk Kraus 		if (rid == wanted_rid) {
761ad5244ecSSvatopluk Kraus 			*cells = malloc(icells * sizeof(**cells), M_OFWPROP,
762ad5244ecSSvatopluk Kraus 			    M_WAITOK);
763ad5244ecSSvatopluk Kraus 			*producer = iparent;
764ad5244ecSSvatopluk Kraus 			*ncells= icells;
765ad5244ecSSvatopluk Kraus 			memcpy(*cells, intr + i, icells * sizeof(**cells));
766ad5244ecSSvatopluk Kraus 			err = 0;
767ad5244ecSSvatopluk Kraus 			break;
768ad5244ecSSvatopluk Kraus 		}
769ad5244ecSSvatopluk Kraus 	}
770ad5244ecSSvatopluk Kraus 	free(intr, M_OFWPROP);
771ad5244ecSSvatopluk Kraus 	return (err);
772ad5244ecSSvatopluk Kraus }
77308b96b9fSNathan Whitehorn 
77472a638c7SAndrew Turner phandle_t
ofw_bus_find_child(phandle_t start,const char * child_name)77537c1967cSOleksandr Tymoshenko ofw_bus_find_child(phandle_t start, const char *child_name)
77637c1967cSOleksandr Tymoshenko {
77737c1967cSOleksandr Tymoshenko 	char *name;
77837c1967cSOleksandr Tymoshenko 	int ret;
77937c1967cSOleksandr Tymoshenko 	phandle_t child;
78037c1967cSOleksandr Tymoshenko 
78137c1967cSOleksandr Tymoshenko 	for (child = OF_child(start); child != 0; child = OF_peer(child)) {
782217d17bcSOleksandr Tymoshenko 		ret = OF_getprop_alloc(child, "name", (void **)&name);
78337c1967cSOleksandr Tymoshenko 		if (ret == -1)
78437c1967cSOleksandr Tymoshenko 			continue;
78537c1967cSOleksandr Tymoshenko 		if (strcmp(name, child_name) == 0) {
78637c1967cSOleksandr Tymoshenko 			free(name, M_OFWPROP);
78737c1967cSOleksandr Tymoshenko 			return (child);
78837c1967cSOleksandr Tymoshenko 		}
78937c1967cSOleksandr Tymoshenko 
79037c1967cSOleksandr Tymoshenko 		free(name, M_OFWPROP);
79137c1967cSOleksandr Tymoshenko 	}
79237c1967cSOleksandr Tymoshenko 
79337c1967cSOleksandr Tymoshenko 	return (0);
79437c1967cSOleksandr Tymoshenko }
79537c1967cSOleksandr Tymoshenko 
79637c1967cSOleksandr Tymoshenko phandle_t
ofw_bus_find_compatible(phandle_t node,const char * onecompat)79772a638c7SAndrew Turner ofw_bus_find_compatible(phandle_t node, const char *onecompat)
79872a638c7SAndrew Turner {
79972a638c7SAndrew Turner 	phandle_t child, ret;
80072a638c7SAndrew Turner 
80172a638c7SAndrew Turner 	/*
80272a638c7SAndrew Turner 	 * Traverse all children of 'start' node, and find first with
80372a638c7SAndrew Turner 	 * matching 'compatible' property.
80472a638c7SAndrew Turner 	 */
80572a638c7SAndrew Turner 	for (child = OF_child(node); child != 0; child = OF_peer(child)) {
806edf3dd3bSMarcin Wojtas 		if (ofw_bus_node_is_compatible(child, onecompat) != 0)
80772a638c7SAndrew Turner 			return (child);
80872a638c7SAndrew Turner 
80972a638c7SAndrew Turner 		ret = ofw_bus_find_compatible(child, onecompat);
81072a638c7SAndrew Turner 		if (ret != 0)
81172a638c7SAndrew Turner 			return (ret);
81272a638c7SAndrew Turner 	}
81372a638c7SAndrew Turner 	return (0);
81472a638c7SAndrew Turner }
815bb39ff4cSWarner Losh 
816bb39ff4cSWarner Losh /**
817bb39ff4cSWarner Losh  * @brief Return child of bus whose phandle is node
818bb39ff4cSWarner Losh  *
819bb39ff4cSWarner Losh  * A direct child of @p will be returned if it its phandle in the
820bb39ff4cSWarner Losh  * OFW tree is @p node. Otherwise, NULL is returned.
821bb39ff4cSWarner Losh  *
822bb39ff4cSWarner Losh  * @param bus		The bus to examine
823bb39ff4cSWarner Losh  * @param node		The phandle_t to look for.
824bb39ff4cSWarner Losh  */
825bb39ff4cSWarner Losh device_t
ofw_bus_find_child_device_by_phandle(device_t bus,phandle_t node)826bb39ff4cSWarner Losh ofw_bus_find_child_device_by_phandle(device_t bus, phandle_t node)
827bb39ff4cSWarner Losh {
828bb39ff4cSWarner Losh 	device_t *children, retval, child;
829bb39ff4cSWarner Losh 	int nkid, i;
830bb39ff4cSWarner Losh 
831bb39ff4cSWarner Losh 	/*
832bb39ff4cSWarner Losh 	 * Nothing can match the flag value for no node.
833bb39ff4cSWarner Losh 	 */
834bb39ff4cSWarner Losh 	if (node == -1)
835bb39ff4cSWarner Losh 		return (NULL);
836bb39ff4cSWarner Losh 
837bb39ff4cSWarner Losh 	/*
838bb39ff4cSWarner Losh 	 * Search the children for a match. We microoptimize
839bb39ff4cSWarner Losh 	 * a bit by not using ofw_bus_get since we already know
840bb39ff4cSWarner Losh 	 * the parent. We do not recurse.
841bb39ff4cSWarner Losh 	 */
842bb39ff4cSWarner Losh 	if (device_get_children(bus, &children, &nkid) != 0)
843bb39ff4cSWarner Losh 		return (NULL);
844bb39ff4cSWarner Losh 	retval = NULL;
845bb39ff4cSWarner Losh 	for (i = 0; i < nkid; i++) {
846bb39ff4cSWarner Losh 		child = children[i];
847bb39ff4cSWarner Losh 		if (OFW_BUS_GET_NODE(bus, child) == node) {
848bb39ff4cSWarner Losh 			retval = child;
849bb39ff4cSWarner Losh 			break;
850bb39ff4cSWarner Losh 		}
851bb39ff4cSWarner Losh 	}
852bb39ff4cSWarner Losh 	free(children, M_TEMP);
853bb39ff4cSWarner Losh 
854bb39ff4cSWarner Losh 	return (retval);
855bb39ff4cSWarner Losh }
8560b757c47SMichal Meloun 
8570b757c47SMichal Meloun /*
8580b757c47SMichal Meloun  * Parse property that contain list of xrefs and values
8590b757c47SMichal Meloun  * (like standard "clocks" and "resets" properties)
8600b757c47SMichal Meloun  * Input arguments:
8610b757c47SMichal Meloun  *  node - consumers device node
8620b757c47SMichal Meloun  *  list_name  - name of parsed list - "clocks"
8630b757c47SMichal Meloun  *  cells_name - name of size property - "#clock-cells"
86491ef8da0SAdrian Chadd  *  idx - the index of the requested list entry, or, if -1, an indication
86591ef8da0SAdrian Chadd  *        to return the number of entries in the parsed list.
8660b757c47SMichal Meloun  * Output arguments:
8670b757c47SMichal Meloun  *  producer - handle of producer
86891ef8da0SAdrian Chadd  *  ncells   - number of cells in result or the number of items in the list when
86991ef8da0SAdrian Chadd  *             idx == -1.
8700b757c47SMichal Meloun  *  cells    - array of decoded cells
8710b757c47SMichal Meloun  */
87291ef8da0SAdrian Chadd static int
ofw_bus_parse_xref_list_internal(phandle_t node,const char * list_name,const char * cells_name,int idx,phandle_t * producer,int * ncells,pcell_t ** cells)87391ef8da0SAdrian Chadd ofw_bus_parse_xref_list_internal(phandle_t node, const char *list_name,
8740b757c47SMichal Meloun     const char *cells_name, int idx, phandle_t *producer, int *ncells,
8750b757c47SMichal Meloun     pcell_t **cells)
8760b757c47SMichal Meloun {
8770b757c47SMichal Meloun 	phandle_t pnode;
8780b757c47SMichal Meloun 	phandle_t *elems;
8790b757c47SMichal Meloun 	uint32_t  pcells;
8800b757c47SMichal Meloun 	int rv, i, j, nelems, cnt;
8810b757c47SMichal Meloun 
8820b757c47SMichal Meloun 	elems = NULL;
883f7604b1bSOleksandr Tymoshenko 	nelems = OF_getencprop_alloc_multi(node, list_name,  sizeof(*elems),
8840b757c47SMichal Meloun 	    (void **)&elems);
8850b757c47SMichal Meloun 	if (nelems <= 0)
8860b757c47SMichal Meloun 		return (ENOENT);
88791ef8da0SAdrian Chadd 	rv = (idx == -1) ? 0 : ENOENT;
8880b757c47SMichal Meloun 	for (i = 0, cnt = 0; i < nelems; i += pcells, cnt++) {
8890b757c47SMichal Meloun 		pnode = elems[i++];
8900b757c47SMichal Meloun 		if (OF_getencprop(OF_node_from_xref(pnode),
8910b757c47SMichal Meloun 		    cells_name, &pcells, sizeof(pcells)) == -1) {
8920b757c47SMichal Meloun 			printf("Missing %s property\n", cells_name);
8930b757c47SMichal Meloun 			rv = ENOENT;
8940b757c47SMichal Meloun 			break;
8950b757c47SMichal Meloun 		}
8960b757c47SMichal Meloun 
8970b757c47SMichal Meloun 		if ((i + pcells) > nelems) {
8980b757c47SMichal Meloun 			printf("Invalid %s property value <%d>\n", cells_name,
8990b757c47SMichal Meloun 			    pcells);
9000b757c47SMichal Meloun 			rv = ERANGE;
9010b757c47SMichal Meloun 			break;
9020b757c47SMichal Meloun 		}
9030b757c47SMichal Meloun 		if (cnt == idx) {
9040b757c47SMichal Meloun 			*cells= malloc(pcells * sizeof(**cells), M_OFWPROP,
9050b757c47SMichal Meloun 			    M_WAITOK);
9060b757c47SMichal Meloun 			*producer = pnode;
9070b757c47SMichal Meloun 			*ncells = pcells;
9080b757c47SMichal Meloun 			for (j = 0; j < pcells; j++)
9090b757c47SMichal Meloun 				(*cells)[j] = elems[i + j];
9100b757c47SMichal Meloun 			rv = 0;
9110b757c47SMichal Meloun 			break;
9120b757c47SMichal Meloun 		}
9130b757c47SMichal Meloun 	}
9140b757c47SMichal Meloun 	if (elems != NULL)
9150b757c47SMichal Meloun 		free(elems, M_OFWPROP);
91691ef8da0SAdrian Chadd 	if (idx == -1 && rv == 0)
91791ef8da0SAdrian Chadd 		*ncells = cnt;
9180b757c47SMichal Meloun 	return (rv);
9190b757c47SMichal Meloun }
9200b757c47SMichal Meloun 
9210b757c47SMichal Meloun /*
92291ef8da0SAdrian Chadd  * Parse property that contain list of xrefs and values
92391ef8da0SAdrian Chadd  * (like standard "clocks" and "resets" properties)
92491ef8da0SAdrian Chadd  * Input arguments:
92591ef8da0SAdrian Chadd  *  node - consumers device node
92691ef8da0SAdrian Chadd  *  list_name  - name of parsed list - "clocks"
92791ef8da0SAdrian Chadd  *  cells_name - name of size property - "#clock-cells"
92891ef8da0SAdrian Chadd  *  idx - the index of the requested list entry (>= 0)
92991ef8da0SAdrian Chadd  * Output arguments:
93091ef8da0SAdrian Chadd  *  producer - handle of producer
93191ef8da0SAdrian Chadd  *  ncells   - number of cells in result
93291ef8da0SAdrian Chadd  *  cells    - array of decoded cells
93391ef8da0SAdrian Chadd  */
93491ef8da0SAdrian Chadd int
ofw_bus_parse_xref_list_alloc(phandle_t node,const char * list_name,const char * cells_name,int idx,phandle_t * producer,int * ncells,pcell_t ** cells)93591ef8da0SAdrian Chadd ofw_bus_parse_xref_list_alloc(phandle_t node, const char *list_name,
93691ef8da0SAdrian Chadd     const char *cells_name, int idx, phandle_t *producer, int *ncells,
93791ef8da0SAdrian Chadd     pcell_t **cells)
93891ef8da0SAdrian Chadd {
93991ef8da0SAdrian Chadd 
94091ef8da0SAdrian Chadd 	KASSERT(idx >= 0,
94191ef8da0SAdrian Chadd 	    ("ofw_bus_parse_xref_list_alloc: negative index supplied"));
94291ef8da0SAdrian Chadd 
94391ef8da0SAdrian Chadd 	return (ofw_bus_parse_xref_list_internal(node, list_name, cells_name,
94491ef8da0SAdrian Chadd 		    idx, producer, ncells, cells));
94591ef8da0SAdrian Chadd }
94691ef8da0SAdrian Chadd 
94791ef8da0SAdrian Chadd /*
94891ef8da0SAdrian Chadd  * Parse property that contain list of xrefs and values
94991ef8da0SAdrian Chadd  * (like standard "clocks" and "resets" properties)
95091ef8da0SAdrian Chadd  * and determine the number of items in the list
95191ef8da0SAdrian Chadd  * Input arguments:
95291ef8da0SAdrian Chadd  *  node - consumers device node
95391ef8da0SAdrian Chadd  *  list_name  - name of parsed list - "clocks"
95491ef8da0SAdrian Chadd  *  cells_name - name of size property - "#clock-cells"
95591ef8da0SAdrian Chadd  * Output arguments:
95691ef8da0SAdrian Chadd  *  count - number of items in list
95791ef8da0SAdrian Chadd  */
95891ef8da0SAdrian Chadd int
ofw_bus_parse_xref_list_get_length(phandle_t node,const char * list_name,const char * cells_name,int * count)95991ef8da0SAdrian Chadd ofw_bus_parse_xref_list_get_length(phandle_t node, const char *list_name,
96091ef8da0SAdrian Chadd     const char *cells_name, int *count)
96191ef8da0SAdrian Chadd {
96291ef8da0SAdrian Chadd 
96391ef8da0SAdrian Chadd 	return (ofw_bus_parse_xref_list_internal(node, list_name, cells_name,
96491ef8da0SAdrian Chadd 		    -1, NULL, count, NULL));
96591ef8da0SAdrian Chadd }
96691ef8da0SAdrian Chadd 
96791ef8da0SAdrian Chadd /*
9680b757c47SMichal Meloun  * Find index of string in string list property (case sensitive).
9690b757c47SMichal Meloun  */
9700b757c47SMichal Meloun int
ofw_bus_find_string_index(phandle_t node,const char * list_name,const char * name,int * idx)9710b757c47SMichal Meloun ofw_bus_find_string_index(phandle_t node, const char *list_name,
9720b757c47SMichal Meloun     const char *name, int *idx)
9730b757c47SMichal Meloun {
9740b757c47SMichal Meloun 	char *elems;
9750b757c47SMichal Meloun 	int rv, i, cnt, nelems;
9760b757c47SMichal Meloun 
9770b757c47SMichal Meloun 	elems = NULL;
978217d17bcSOleksandr Tymoshenko 	nelems = OF_getprop_alloc(node, list_name, (void **)&elems);
9790b757c47SMichal Meloun 	if (nelems <= 0)
9800b757c47SMichal Meloun 		return (ENOENT);
9810b757c47SMichal Meloun 
9820b757c47SMichal Meloun 	rv = ENOENT;
9830b757c47SMichal Meloun 	for (i = 0, cnt = 0; i < nelems; cnt++) {
9840b757c47SMichal Meloun 		if (strcmp(elems + i, name) == 0) {
9850b757c47SMichal Meloun 			*idx = cnt;
9860b757c47SMichal Meloun 			rv = 0;
9870b757c47SMichal Meloun 			break;
9880b757c47SMichal Meloun 		}
9890b757c47SMichal Meloun 		i += strlen(elems + i) + 1;
9900b757c47SMichal Meloun 	}
9910b757c47SMichal Meloun 
9920b757c47SMichal Meloun 	if (elems != NULL)
9930b757c47SMichal Meloun 		free(elems, M_OFWPROP);
9940b757c47SMichal Meloun 	return (rv);
9950b757c47SMichal Meloun }
9960b757c47SMichal Meloun 
9970b757c47SMichal Meloun /*
9980b757c47SMichal Meloun  * Create zero terminated array of strings from string list property.
9990b757c47SMichal Meloun  */
10000b757c47SMichal Meloun int
ofw_bus_string_list_to_array(phandle_t node,const char * list_name,const char *** out_array)10010b757c47SMichal Meloun ofw_bus_string_list_to_array(phandle_t node, const char *list_name,
1002086a6314SMichal Meloun    const char ***out_array)
10030b757c47SMichal Meloun {
10040b757c47SMichal Meloun 	char *elems, *tptr;
1005086a6314SMichal Meloun 	const char **array;
10060b757c47SMichal Meloun 	int i, cnt, nelems, len;
10070b757c47SMichal Meloun 
10080b757c47SMichal Meloun 	elems = NULL;
1009217d17bcSOleksandr Tymoshenko 	nelems = OF_getprop_alloc(node, list_name, (void **)&elems);
10100b757c47SMichal Meloun 	if (nelems <= 0)
10110b757c47SMichal Meloun 		return (nelems);
10120b757c47SMichal Meloun 
10130b757c47SMichal Meloun 	/* Count number of strings. */
10140b757c47SMichal Meloun 	for (i = 0, cnt = 0; i < nelems; cnt++)
10150b757c47SMichal Meloun 		i += strlen(elems + i) + 1;
10160b757c47SMichal Meloun 
10170b757c47SMichal Meloun 	/* Allocate space for arrays and all strings. */
1018086a6314SMichal Meloun 	array = malloc((cnt + 1) * sizeof(char *) + nelems, M_OFWPROP,
10190b757c47SMichal Meloun 	    M_WAITOK);
10200b757c47SMichal Meloun 
10210b757c47SMichal Meloun 	/* Get address of first string. */
1022086a6314SMichal Meloun 	tptr = (char *)(array + cnt + 1);
10230b757c47SMichal Meloun 
10240b757c47SMichal Meloun 	/* Copy strings. */
10250b757c47SMichal Meloun 	memcpy(tptr, elems, nelems);
10260b757c47SMichal Meloun 	free(elems, M_OFWPROP);
10270b757c47SMichal Meloun 
10280b757c47SMichal Meloun 	/* Fill string pointers. */
10290b757c47SMichal Meloun 	for (i = 0, cnt = 0; i < nelems; cnt++) {
1030086a6314SMichal Meloun 		len = strlen(tptr) + 1;
1031086a6314SMichal Meloun 		array[cnt] = tptr;
10320b757c47SMichal Meloun 		i += len;
10330b757c47SMichal Meloun 		tptr += len;
10340b757c47SMichal Meloun 	}
10354d24901aSPedro F. Giffuni 	array[cnt] = NULL;
1036086a6314SMichal Meloun 	*out_array = array;
10370b757c47SMichal Meloun 
10380b757c47SMichal Meloun 	return (cnt);
10390b757c47SMichal Meloun }
1040