xref: /freebsd-src/sys/dev/fdt/fdt_common.c (revision fdafd315ad0d0f28a11b9fb4476a9ab059c62b92)
158158742SRafal Jaworowski /*-
2*4d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro F. Giffuni  *
4d455cc04SAndrew Turner  * Copyright (c) 2009-2014 The FreeBSD Foundation
558158742SRafal Jaworowski  *
6d455cc04SAndrew Turner  * This software was developed by Andrew Turner under sponsorship from
7d455cc04SAndrew Turner  * the FreeBSD Foundation.
858158742SRafal Jaworowski  * This software was developed by Semihalf under sponsorship from
958158742SRafal Jaworowski  * the FreeBSD Foundation.
1058158742SRafal Jaworowski  *
1158158742SRafal Jaworowski  * Redistribution and use in source and binary forms, with or without
1258158742SRafal Jaworowski  * modification, are permitted provided that the following conditions
1358158742SRafal Jaworowski  * are met:
1458158742SRafal Jaworowski  * 1. Redistributions of source code must retain the above copyright
1558158742SRafal Jaworowski  *    notice, this list of conditions and the following disclaimer.
1658158742SRafal Jaworowski  * 2. Redistributions in binary form must reproduce the above copyright
1758158742SRafal Jaworowski  *    notice, this list of conditions and the following disclaimer in the
1858158742SRafal Jaworowski  *    documentation and/or other materials provided with the distribution.
1958158742SRafal Jaworowski  *
2058158742SRafal Jaworowski  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
2158158742SRafal Jaworowski  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2258158742SRafal Jaworowski  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2358158742SRafal Jaworowski  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2458158742SRafal Jaworowski  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2558158742SRafal Jaworowski  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2658158742SRafal Jaworowski  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2758158742SRafal Jaworowski  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2858158742SRafal Jaworowski  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2958158742SRafal Jaworowski  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
3058158742SRafal Jaworowski  * SUCH DAMAGE.
3158158742SRafal Jaworowski  */
3258158742SRafal Jaworowski 
3358158742SRafal Jaworowski #include <sys/param.h>
3458158742SRafal Jaworowski #include <sys/systm.h>
3558158742SRafal Jaworowski #include <sys/kernel.h>
3658158742SRafal Jaworowski #include <sys/module.h>
3758158742SRafal Jaworowski #include <sys/bus.h>
388bb93637SOleksandr Tymoshenko #include <sys/limits.h>
39a183d81dSStephen J. Kiernan #include <sys/sysctl.h>
4058158742SRafal Jaworowski 
4158158742SRafal Jaworowski #include <machine/resource.h>
4258158742SRafal Jaworowski 
4358158742SRafal Jaworowski #include <dev/fdt/fdt_common.h>
4458158742SRafal Jaworowski #include <dev/ofw/ofw_bus.h>
4558158742SRafal Jaworowski #include <dev/ofw/ofw_bus_subr.h>
4658158742SRafal Jaworowski #include <dev/ofw/openfirm.h>
4758158742SRafal Jaworowski 
4858158742SRafal Jaworowski #include "ofw_bus_if.h"
4958158742SRafal Jaworowski 
5058158742SRafal Jaworowski #ifdef DEBUG
5158158742SRafal Jaworowski #define debugf(fmt, args...) do { printf("%s(): ", __func__);	\
5258158742SRafal Jaworowski     printf(fmt,##args); } while (0)
5358158742SRafal Jaworowski #else
5458158742SRafal Jaworowski #define debugf(fmt, args...)
5558158742SRafal Jaworowski #endif
5658158742SRafal Jaworowski 
5758158742SRafal Jaworowski #define FDT_COMPAT_LEN	255
5858158742SRafal Jaworowski 
5958158742SRafal Jaworowski #define FDT_REG_CELLS	4
60bfd084c8SMarcin Wojtas #define FDT_RANGES_SIZE 48
6158158742SRafal Jaworowski 
627029da5cSPawel Biernacki SYSCTL_NODE(_hw, OID_AUTO, fdt, CTLFLAG_RD | CTLFLAG_MPSAFE, 0,
637029da5cSPawel Biernacki     "Flattened Device Tree");
64a183d81dSStephen J. Kiernan 
6558158742SRafal Jaworowski vm_paddr_t fdt_immr_pa;
6658158742SRafal Jaworowski vm_offset_t fdt_immr_va;
6758158742SRafal Jaworowski vm_offset_t fdt_immr_size;
6858158742SRafal Jaworowski 
691f40dbc8SBrooks Davis struct fdt_ic_list fdt_ic_list_head = SLIST_HEAD_INITIALIZER(fdt_ic_list_head);
701f40dbc8SBrooks Davis 
71d455cc04SAndrew Turner static int
fdt_get_range_by_busaddr(phandle_t node,u_long addr,u_long * base,u_long * size)72d455cc04SAndrew Turner fdt_get_range_by_busaddr(phandle_t node, u_long addr, u_long *base,
73d455cc04SAndrew Turner     u_long *size)
74d455cc04SAndrew Turner {
75d455cc04SAndrew Turner 	pcell_t ranges[32], *rangesptr;
76d455cc04SAndrew Turner 	pcell_t addr_cells, size_cells, par_addr_cells;
77d455cc04SAndrew Turner 	u_long bus_addr, par_bus_addr, pbase, psize;
78d455cc04SAndrew Turner 	int err, i, len, tuple_size, tuples;
79d455cc04SAndrew Turner 
8030ef1a05SAndrew Turner 	if (node == 0) {
8130ef1a05SAndrew Turner 		*base = 0;
8230ef1a05SAndrew Turner 		*size = ULONG_MAX;
8330ef1a05SAndrew Turner 		return (0);
8430ef1a05SAndrew Turner 	}
8530ef1a05SAndrew Turner 
86d455cc04SAndrew Turner 	if ((fdt_addrsize_cells(node, &addr_cells, &size_cells)) != 0)
87d455cc04SAndrew Turner 		return (ENXIO);
88d455cc04SAndrew Turner 	/*
89d455cc04SAndrew Turner 	 * Process 'ranges' property.
90d455cc04SAndrew Turner 	 */
91d455cc04SAndrew Turner 	par_addr_cells = fdt_parent_addr_cells(node);
92d455cc04SAndrew Turner 	if (par_addr_cells > 2) {
93d455cc04SAndrew Turner 		return (ERANGE);
94d455cc04SAndrew Turner 	}
95d455cc04SAndrew Turner 
96d455cc04SAndrew Turner 	len = OF_getproplen(node, "ranges");
97d455cc04SAndrew Turner 	if (len < 0)
98d455cc04SAndrew Turner 		return (-1);
99d455cc04SAndrew Turner 	if (len > sizeof(ranges))
100d455cc04SAndrew Turner 		return (ENOMEM);
101d455cc04SAndrew Turner 	if (len == 0) {
10230ef1a05SAndrew Turner 		return (fdt_get_range_by_busaddr(OF_parent(node), addr,
10330ef1a05SAndrew Turner 		    base, size));
104d455cc04SAndrew Turner 	}
105d455cc04SAndrew Turner 
106d455cc04SAndrew Turner 	if (OF_getprop(node, "ranges", ranges, sizeof(ranges)) <= 0)
107d455cc04SAndrew Turner 		return (EINVAL);
108d455cc04SAndrew Turner 
109d455cc04SAndrew Turner 	tuple_size = addr_cells + par_addr_cells + size_cells;
110d455cc04SAndrew Turner 	tuples = len / (tuple_size * sizeof(cell_t));
111d455cc04SAndrew Turner 
112ba2ea14aSRuslan Bukin 	if (par_addr_cells > 2 || addr_cells > 2 || size_cells > 2)
113d455cc04SAndrew Turner 		return (ERANGE);
114ba2ea14aSRuslan Bukin 
115d455cc04SAndrew Turner 	*base = 0;
116d455cc04SAndrew Turner 	*size = 0;
117d455cc04SAndrew Turner 
118d455cc04SAndrew Turner 	for (i = 0; i < tuples; i++) {
119d455cc04SAndrew Turner 		rangesptr = &ranges[i * tuple_size];
120d455cc04SAndrew Turner 
121d455cc04SAndrew Turner 		bus_addr = fdt_data_get((void *)rangesptr, addr_cells);
122d455cc04SAndrew Turner 		if (bus_addr != addr)
123d455cc04SAndrew Turner 			continue;
124d455cc04SAndrew Turner 		rangesptr += addr_cells;
125d455cc04SAndrew Turner 
126d455cc04SAndrew Turner 		par_bus_addr = fdt_data_get((void *)rangesptr, par_addr_cells);
127d455cc04SAndrew Turner 		rangesptr += par_addr_cells;
128d455cc04SAndrew Turner 
129d455cc04SAndrew Turner 		err = fdt_get_range_by_busaddr(OF_parent(node), par_bus_addr,
130d455cc04SAndrew Turner 		    &pbase, &psize);
131d455cc04SAndrew Turner 		if (err > 0)
132d455cc04SAndrew Turner 			return (err);
133d455cc04SAndrew Turner 		if (err == 0)
134d455cc04SAndrew Turner 			*base = pbase;
135d455cc04SAndrew Turner 		else
136d455cc04SAndrew Turner 			*base = par_bus_addr;
137d455cc04SAndrew Turner 
138d455cc04SAndrew Turner 		*size = fdt_data_get((void *)rangesptr, size_cells);
139d455cc04SAndrew Turner 
140d455cc04SAndrew Turner 		return (0);
141d455cc04SAndrew Turner 	}
142d455cc04SAndrew Turner 
143d455cc04SAndrew Turner 	return (EINVAL);
144d455cc04SAndrew Turner }
145d455cc04SAndrew Turner 
14658158742SRafal Jaworowski int
fdt_get_range(phandle_t node,int range_id,u_long * base,u_long * size)1478bb93637SOleksandr Tymoshenko fdt_get_range(phandle_t node, int range_id, u_long *base, u_long *size)
14858158742SRafal Jaworowski {
149bfd084c8SMarcin Wojtas 	pcell_t ranges[FDT_RANGES_SIZE], *rangesptr;
15058158742SRafal Jaworowski 	pcell_t addr_cells, size_cells, par_addr_cells;
151d455cc04SAndrew Turner 	u_long par_bus_addr, pbase, psize;
152151ba793SAlexander Kabaev 	int err, len;
15358158742SRafal Jaworowski 
15458158742SRafal Jaworowski 	if ((fdt_addrsize_cells(node, &addr_cells, &size_cells)) != 0)
15558158742SRafal Jaworowski 		return (ENXIO);
15658158742SRafal Jaworowski 	/*
15758158742SRafal Jaworowski 	 * Process 'ranges' property.
15858158742SRafal Jaworowski 	 */
15958158742SRafal Jaworowski 	par_addr_cells = fdt_parent_addr_cells(node);
16058158742SRafal Jaworowski 	if (par_addr_cells > 2)
16158158742SRafal Jaworowski 		return (ERANGE);
16258158742SRafal Jaworowski 
16358158742SRafal Jaworowski 	len = OF_getproplen(node, "ranges");
16458158742SRafal Jaworowski 	if (len > sizeof(ranges))
16558158742SRafal Jaworowski 		return (ENOMEM);
1668bb93637SOleksandr Tymoshenko 	if (len == 0) {
1678bb93637SOleksandr Tymoshenko 		*base = 0;
1688bb93637SOleksandr Tymoshenko 		*size = ULONG_MAX;
1698bb93637SOleksandr Tymoshenko 		return (0);
1708bb93637SOleksandr Tymoshenko 	}
1718bb93637SOleksandr Tymoshenko 
1728bb93637SOleksandr Tymoshenko 	if (!(range_id < len))
1738bb93637SOleksandr Tymoshenko 		return (ERANGE);
17458158742SRafal Jaworowski 
17558158742SRafal Jaworowski 	if (OF_getprop(node, "ranges", ranges, sizeof(ranges)) <= 0)
17658158742SRafal Jaworowski 		return (EINVAL);
17758158742SRafal Jaworowski 
178ba2ea14aSRuslan Bukin 	if (par_addr_cells > 2 || addr_cells > 2 || size_cells > 2)
17958158742SRafal Jaworowski 		return (ERANGE);
180ba2ea14aSRuslan Bukin 
1818bb93637SOleksandr Tymoshenko 	*base = 0;
1828bb93637SOleksandr Tymoshenko 	*size = 0;
1838bb93637SOleksandr Tymoshenko 	rangesptr = &ranges[range_id];
18458158742SRafal Jaworowski 
1858bb93637SOleksandr Tymoshenko 	*base = fdt_data_get((void *)rangesptr, addr_cells);
18658158742SRafal Jaworowski 	rangesptr += addr_cells;
187d455cc04SAndrew Turner 
188d455cc04SAndrew Turner 	par_bus_addr = fdt_data_get((void *)rangesptr, par_addr_cells);
18958158742SRafal Jaworowski 	rangesptr += par_addr_cells;
190d455cc04SAndrew Turner 
191d455cc04SAndrew Turner 	err = fdt_get_range_by_busaddr(OF_parent(node), par_bus_addr,
192d455cc04SAndrew Turner 	   &pbase, &psize);
193d455cc04SAndrew Turner 	if (err == 0)
194d455cc04SAndrew Turner 		*base += pbase;
195d455cc04SAndrew Turner 	else
196d455cc04SAndrew Turner 		*base += par_bus_addr;
197d455cc04SAndrew Turner 
1988bb93637SOleksandr Tymoshenko 	*size = fdt_data_get((void *)rangesptr, size_cells);
1998bb93637SOleksandr Tymoshenko 	return (0);
2008bb93637SOleksandr Tymoshenko }
20158158742SRafal Jaworowski 
2028bb93637SOleksandr Tymoshenko int
fdt_immr_addr(vm_offset_t immr_va)2039f56e37dSAndrew Turner fdt_immr_addr(vm_offset_t immr_va)
2049f56e37dSAndrew Turner {
2059f56e37dSAndrew Turner 	phandle_t node;
2069f56e37dSAndrew Turner 	u_long base, size;
2079f56e37dSAndrew Turner 	int r;
2089f56e37dSAndrew Turner 
2099f56e37dSAndrew Turner 	/*
2109f56e37dSAndrew Turner 	 * Try to access the SOC node directly i.e. through /aliases/.
2119f56e37dSAndrew Turner 	 */
2129f56e37dSAndrew Turner 	if ((node = OF_finddevice("soc")) != -1)
2139d9889b5SAndrew Turner 		if (ofw_bus_node_is_compatible(node, "simple-bus"))
2149f56e37dSAndrew Turner 			goto moveon;
2159f56e37dSAndrew Turner 	/*
2169f56e37dSAndrew Turner 	 * Find the node the long way.
2179f56e37dSAndrew Turner 	 */
2189f56e37dSAndrew Turner 	if ((node = OF_finddevice("/")) == -1)
2199f56e37dSAndrew Turner 		return (ENXIO);
2209f56e37dSAndrew Turner 
2219f56e37dSAndrew Turner 	if ((node = fdt_find_compatible(node, "simple-bus", 0)) == 0)
2229f56e37dSAndrew Turner 		return (ENXIO);
2239f56e37dSAndrew Turner 
2249f56e37dSAndrew Turner moveon:
2259f56e37dSAndrew Turner 	if ((r = fdt_get_range(node, 0, &base, &size)) == 0) {
2269f56e37dSAndrew Turner 		fdt_immr_pa = base;
2279f56e37dSAndrew Turner 		fdt_immr_va = immr_va;
2289f56e37dSAndrew Turner 		fdt_immr_size = size;
2299f56e37dSAndrew Turner 	}
2309f56e37dSAndrew Turner 
2319f56e37dSAndrew Turner 	return (r);
2329f56e37dSAndrew Turner }
2339f56e37dSAndrew Turner 
2349f56e37dSAndrew Turner int
fdt_is_compatible_strict(phandle_t node,const char * compatible)23558158742SRafal Jaworowski fdt_is_compatible_strict(phandle_t node, const char *compatible)
23658158742SRafal Jaworowski {
23758158742SRafal Jaworowski 	char compat[FDT_COMPAT_LEN];
23858158742SRafal Jaworowski 
23958158742SRafal Jaworowski 	if (OF_getproplen(node, "compatible") <= 0)
24058158742SRafal Jaworowski 		return (0);
24158158742SRafal Jaworowski 
24258158742SRafal Jaworowski 	if (OF_getprop(node, "compatible", compat, FDT_COMPAT_LEN) < 0)
24358158742SRafal Jaworowski 		return (0);
24458158742SRafal Jaworowski 
24558158742SRafal Jaworowski 	if (strncasecmp(compat, compatible, FDT_COMPAT_LEN) == 0)
24658158742SRafal Jaworowski 		/* This fits. */
24758158742SRafal Jaworowski 		return (1);
24858158742SRafal Jaworowski 
24958158742SRafal Jaworowski 	return (0);
25058158742SRafal Jaworowski }
25158158742SRafal Jaworowski 
25258158742SRafal Jaworowski phandle_t
fdt_find_compatible(phandle_t start,const char * compat,int strict)25358158742SRafal Jaworowski fdt_find_compatible(phandle_t start, const char *compat, int strict)
25458158742SRafal Jaworowski {
25558158742SRafal Jaworowski 	phandle_t child;
25658158742SRafal Jaworowski 
25758158742SRafal Jaworowski 	/*
25858158742SRafal Jaworowski 	 * Traverse all children of 'start' node, and find first with
25958158742SRafal Jaworowski 	 * matching 'compatible' property.
26058158742SRafal Jaworowski 	 */
26158158742SRafal Jaworowski 	for (child = OF_child(start); child != 0; child = OF_peer(child))
2629d9889b5SAndrew Turner 		if (ofw_bus_node_is_compatible(child, compat)) {
26358158742SRafal Jaworowski 			if (strict)
26458158742SRafal Jaworowski 				if (!fdt_is_compatible_strict(child, compat))
26558158742SRafal Jaworowski 					continue;
26658158742SRafal Jaworowski 			return (child);
26758158742SRafal Jaworowski 		}
26858158742SRafal Jaworowski 	return (0);
26958158742SRafal Jaworowski }
27058158742SRafal Jaworowski 
271731ff010SIan Lepore phandle_t
fdt_depth_search_compatible(phandle_t start,const char * compat,int strict)272731ff010SIan Lepore fdt_depth_search_compatible(phandle_t start, const char *compat, int strict)
273731ff010SIan Lepore {
274731ff010SIan Lepore 	phandle_t child, node;
275731ff010SIan Lepore 
276731ff010SIan Lepore 	/*
277731ff010SIan Lepore 	 * Depth-search all descendants of 'start' node, and find first with
278731ff010SIan Lepore 	 * matching 'compatible' property.
279731ff010SIan Lepore 	 */
280731ff010SIan Lepore 	for (node = OF_child(start); node != 0; node = OF_peer(node)) {
2819d9889b5SAndrew Turner 		if (ofw_bus_node_is_compatible(node, compat) &&
282731ff010SIan Lepore 		    (strict == 0 || fdt_is_compatible_strict(node, compat))) {
283731ff010SIan Lepore 			return (node);
284731ff010SIan Lepore 		}
285a41679c9SIan Lepore 		child = fdt_depth_search_compatible(node, compat, strict);
286731ff010SIan Lepore 		if (child != 0)
287731ff010SIan Lepore 			return (child);
288731ff010SIan Lepore 	}
289731ff010SIan Lepore 	return (0);
290731ff010SIan Lepore }
291731ff010SIan Lepore 
29258158742SRafal Jaworowski int
fdt_parent_addr_cells(phandle_t node)29358158742SRafal Jaworowski fdt_parent_addr_cells(phandle_t node)
29458158742SRafal Jaworowski {
29558158742SRafal Jaworowski 	pcell_t addr_cells;
29658158742SRafal Jaworowski 
29758158742SRafal Jaworowski 	/* Find out #address-cells of the superior bus. */
29858158742SRafal Jaworowski 	if (OF_searchprop(OF_parent(node), "#address-cells", &addr_cells,
29958158742SRafal Jaworowski 	    sizeof(addr_cells)) <= 0)
300d455cc04SAndrew Turner 		return (2);
30158158742SRafal Jaworowski 
30258158742SRafal Jaworowski 	return ((int)fdt32_to_cpu(addr_cells));
30358158742SRafal Jaworowski }
30458158742SRafal Jaworowski 
30558158742SRafal Jaworowski u_long
fdt_data_get(void * data,int cells)30658158742SRafal Jaworowski fdt_data_get(void *data, int cells)
30758158742SRafal Jaworowski {
30858158742SRafal Jaworowski 
30958158742SRafal Jaworowski 	if (cells == 1)
31058158742SRafal Jaworowski 		return (fdt32_to_cpu(*((uint32_t *)data)));
31158158742SRafal Jaworowski 
31258158742SRafal Jaworowski 	return (fdt64_to_cpu(*((uint64_t *)data)));
31358158742SRafal Jaworowski }
31458158742SRafal Jaworowski 
31558158742SRafal Jaworowski int
fdt_addrsize_cells(phandle_t node,int * addr_cells,int * size_cells)31658158742SRafal Jaworowski fdt_addrsize_cells(phandle_t node, int *addr_cells, int *size_cells)
31758158742SRafal Jaworowski {
31858158742SRafal Jaworowski 	pcell_t cell;
31958158742SRafal Jaworowski 	int cell_size;
32058158742SRafal Jaworowski 
32158158742SRafal Jaworowski 	/*
32258158742SRafal Jaworowski 	 * Retrieve #{address,size}-cells.
32358158742SRafal Jaworowski 	 */
32458158742SRafal Jaworowski 	cell_size = sizeof(cell);
325c6c4276bSAndrew Turner 	if (OF_getencprop(node, "#address-cells", &cell, cell_size) < cell_size)
326948dad6aSLuiz Otavio O Souza 		cell = 2;
327c6c4276bSAndrew Turner 	*addr_cells = (int)cell;
32858158742SRafal Jaworowski 
329c6c4276bSAndrew Turner 	if (OF_getencprop(node, "#size-cells", &cell, cell_size) < cell_size)
33058158742SRafal Jaworowski 		cell = 1;
331c6c4276bSAndrew Turner 	*size_cells = (int)cell;
33258158742SRafal Jaworowski 
33358158742SRafal Jaworowski 	if (*addr_cells > 3 || *size_cells > 2)
33458158742SRafal Jaworowski 		return (ERANGE);
33558158742SRafal Jaworowski 	return (0);
33658158742SRafal Jaworowski }
33758158742SRafal Jaworowski 
33858158742SRafal Jaworowski int
fdt_data_to_res(pcell_t * data,int addr_cells,int size_cells,u_long * start,u_long * count)33958158742SRafal Jaworowski fdt_data_to_res(pcell_t *data, int addr_cells, int size_cells, u_long *start,
34058158742SRafal Jaworowski     u_long *count)
34158158742SRafal Jaworowski {
34258158742SRafal Jaworowski 
34358158742SRafal Jaworowski 	/* Address portion. */
344ba2ea14aSRuslan Bukin 	if (addr_cells > 2)
34558158742SRafal Jaworowski 		return (ERANGE);
34658158742SRafal Jaworowski 
34758158742SRafal Jaworowski 	*start = fdt_data_get((void *)data, addr_cells);
34858158742SRafal Jaworowski 	data += addr_cells;
34958158742SRafal Jaworowski 
35058158742SRafal Jaworowski 	/* Size portion. */
351ba2ea14aSRuslan Bukin 	if (size_cells > 2)
35258158742SRafal Jaworowski 		return (ERANGE);
35358158742SRafal Jaworowski 
35458158742SRafal Jaworowski 	*count = fdt_data_get((void *)data, size_cells);
35558158742SRafal Jaworowski 	return (0);
35658158742SRafal Jaworowski }
35758158742SRafal Jaworowski 
35858158742SRafal Jaworowski int
fdt_regsize(phandle_t node,u_long * base,u_long * size)35958158742SRafal Jaworowski fdt_regsize(phandle_t node, u_long *base, u_long *size)
36058158742SRafal Jaworowski {
36158158742SRafal Jaworowski 	pcell_t reg[4];
36258158742SRafal Jaworowski 	int addr_cells, len, size_cells;
36358158742SRafal Jaworowski 
36458158742SRafal Jaworowski 	if (fdt_addrsize_cells(OF_parent(node), &addr_cells, &size_cells))
36558158742SRafal Jaworowski 		return (ENXIO);
36658158742SRafal Jaworowski 
36758158742SRafal Jaworowski 	if ((sizeof(pcell_t) * (addr_cells + size_cells)) > sizeof(reg))
36858158742SRafal Jaworowski 		return (ENOMEM);
36958158742SRafal Jaworowski 
37058158742SRafal Jaworowski 	len = OF_getprop(node, "reg", &reg, sizeof(reg));
37158158742SRafal Jaworowski 	if (len <= 0)
37258158742SRafal Jaworowski 		return (EINVAL);
37358158742SRafal Jaworowski 
37458158742SRafal Jaworowski 	*base = fdt_data_get(&reg[0], addr_cells);
37558158742SRafal Jaworowski 	*size = fdt_data_get(&reg[addr_cells], size_cells);
37658158742SRafal Jaworowski 	return (0);
37758158742SRafal Jaworowski }
37858158742SRafal Jaworowski 
37958158742SRafal Jaworowski int
fdt_get_phyaddr(phandle_t node,device_t dev,int * phy_addr,void ** phy_sc)380aa15e881SRafal Jaworowski fdt_get_phyaddr(phandle_t node, device_t dev, int *phy_addr, void **phy_sc)
38158158742SRafal Jaworowski {
38258158742SRafal Jaworowski 	phandle_t phy_node;
38358158742SRafal Jaworowski 	pcell_t phy_handle, phy_reg;
384aa15e881SRafal Jaworowski 	uint32_t i;
385aa15e881SRafal Jaworowski 	device_t parent, child;
38658158742SRafal Jaworowski 
387755c9591SNathan Whitehorn 	if (OF_getencprop(node, "phy-handle", (void *)&phy_handle,
38858158742SRafal Jaworowski 	    sizeof(phy_handle)) <= 0)
38958158742SRafal Jaworowski 		return (ENXIO);
39058158742SRafal Jaworowski 
391752ba930SIan Lepore 	phy_node = OF_node_from_xref(phy_handle);
39258158742SRafal Jaworowski 
393c6c4276bSAndrew Turner 	if (OF_getencprop(phy_node, "reg", (void *)&phy_reg,
39458158742SRafal Jaworowski 	    sizeof(phy_reg)) <= 0)
39558158742SRafal Jaworowski 		return (ENXIO);
39658158742SRafal Jaworowski 
397c6c4276bSAndrew Turner 	*phy_addr = phy_reg;
398aa15e881SRafal Jaworowski 
3995eb26411SEd Maste 	if (phy_sc == NULL)
4005eb26411SEd Maste 		return (0);
4015eb26411SEd Maste 
402aa15e881SRafal Jaworowski 	/*
403aa15e881SRafal Jaworowski 	 * Search for softc used to communicate with phy.
404aa15e881SRafal Jaworowski 	 */
405aa15e881SRafal Jaworowski 
406aa15e881SRafal Jaworowski 	/*
407aa15e881SRafal Jaworowski 	 * Step 1: Search for ancestor of the phy-node with a "phy-handle"
408aa15e881SRafal Jaworowski 	 * property set.
409aa15e881SRafal Jaworowski 	 */
410aa15e881SRafal Jaworowski 	phy_node = OF_parent(phy_node);
411aa15e881SRafal Jaworowski 	while (phy_node != 0) {
412aa15e881SRafal Jaworowski 		if (OF_getprop(phy_node, "phy-handle", (void *)&phy_handle,
413aa15e881SRafal Jaworowski 		    sizeof(phy_handle)) > 0)
414aa15e881SRafal Jaworowski 			break;
415aa15e881SRafal Jaworowski 		phy_node = OF_parent(phy_node);
416aa15e881SRafal Jaworowski 	}
417aa15e881SRafal Jaworowski 	if (phy_node == 0)
418aa15e881SRafal Jaworowski 		return (ENXIO);
419aa15e881SRafal Jaworowski 
420aa15e881SRafal Jaworowski 	/*
421aa15e881SRafal Jaworowski 	 * Step 2: For each device with the same parent and name as ours
422aa15e881SRafal Jaworowski 	 * compare its node with the one found in step 1, ancestor of phy
423aa15e881SRafal Jaworowski 	 * node (stored in phy_node).
424aa15e881SRafal Jaworowski 	 */
425aa15e881SRafal Jaworowski 	parent = device_get_parent(dev);
426aa15e881SRafal Jaworowski 	i = 0;
427aa15e881SRafal Jaworowski 	child = device_find_child(parent, device_get_name(dev), i);
428aa15e881SRafal Jaworowski 	while (child != NULL) {
429aa15e881SRafal Jaworowski 		if (ofw_bus_get_node(child) == phy_node)
430aa15e881SRafal Jaworowski 			break;
431aa15e881SRafal Jaworowski 		i++;
432aa15e881SRafal Jaworowski 		child = device_find_child(parent, device_get_name(dev), i);
433aa15e881SRafal Jaworowski 	}
434aa15e881SRafal Jaworowski 	if (child == NULL)
435aa15e881SRafal Jaworowski 		return (ENXIO);
436aa15e881SRafal Jaworowski 
437aa15e881SRafal Jaworowski 	/*
438aa15e881SRafal Jaworowski 	 * Use softc of the device found.
439aa15e881SRafal Jaworowski 	 */
440aa15e881SRafal Jaworowski 	*phy_sc = (void *)device_get_softc(child);
441aa15e881SRafal Jaworowski 
44258158742SRafal Jaworowski 	return (0);
44358158742SRafal Jaworowski }
44458158742SRafal Jaworowski 
44558158742SRafal Jaworowski int
fdt_get_reserved_regions(struct mem_region * mr,int * mrcnt)4461d1ffd9eSOleksandr Tymoshenko fdt_get_reserved_regions(struct mem_region *mr, int *mrcnt)
4471d1ffd9eSOleksandr Tymoshenko {
4481d1ffd9eSOleksandr Tymoshenko 	pcell_t reserve[FDT_REG_CELLS * FDT_MEM_REGIONS];
4491d1ffd9eSOleksandr Tymoshenko 	pcell_t *reservep;
4501d1ffd9eSOleksandr Tymoshenko 	phandle_t memory, root;
4511d1ffd9eSOleksandr Tymoshenko 	int addr_cells, size_cells;
452151ba793SAlexander Kabaev 	int i, res_len, rv, tuple_size, tuples;
4531d1ffd9eSOleksandr Tymoshenko 
4541d1ffd9eSOleksandr Tymoshenko 	root = OF_finddevice("/");
4551d1ffd9eSOleksandr Tymoshenko 	memory = OF_finddevice("/memory");
4561d1ffd9eSOleksandr Tymoshenko 	if (memory == -1) {
4571d1ffd9eSOleksandr Tymoshenko 		rv = ENXIO;
4581d1ffd9eSOleksandr Tymoshenko 		goto out;
4591d1ffd9eSOleksandr Tymoshenko 	}
4601d1ffd9eSOleksandr Tymoshenko 
4611d1ffd9eSOleksandr Tymoshenko 	if ((rv = fdt_addrsize_cells(OF_parent(memory), &addr_cells,
4621d1ffd9eSOleksandr Tymoshenko 	    &size_cells)) != 0)
4631d1ffd9eSOleksandr Tymoshenko 		goto out;
4641d1ffd9eSOleksandr Tymoshenko 
4651d1ffd9eSOleksandr Tymoshenko 	if (addr_cells > 2) {
4661d1ffd9eSOleksandr Tymoshenko 		rv = ERANGE;
4671d1ffd9eSOleksandr Tymoshenko 		goto out;
4681d1ffd9eSOleksandr Tymoshenko 	}
4691d1ffd9eSOleksandr Tymoshenko 
4701d1ffd9eSOleksandr Tymoshenko 	tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
4711d1ffd9eSOleksandr Tymoshenko 
4721d1ffd9eSOleksandr Tymoshenko 	res_len = OF_getproplen(root, "memreserve");
4731d1ffd9eSOleksandr Tymoshenko 	if (res_len <= 0 || res_len > sizeof(reserve)) {
4741d1ffd9eSOleksandr Tymoshenko 		rv = ERANGE;
4751d1ffd9eSOleksandr Tymoshenko 		goto out;
4761d1ffd9eSOleksandr Tymoshenko 	}
4771d1ffd9eSOleksandr Tymoshenko 
4781d1ffd9eSOleksandr Tymoshenko 	if (OF_getprop(root, "memreserve", reserve, res_len) <= 0) {
4791d1ffd9eSOleksandr Tymoshenko 		rv = ENXIO;
4801d1ffd9eSOleksandr Tymoshenko 		goto out;
4811d1ffd9eSOleksandr Tymoshenko 	}
4821d1ffd9eSOleksandr Tymoshenko 
4831d1ffd9eSOleksandr Tymoshenko 	tuples = res_len / tuple_size;
4841d1ffd9eSOleksandr Tymoshenko 	reservep = (pcell_t *)&reserve;
4851d1ffd9eSOleksandr Tymoshenko 	for (i = 0; i < tuples; i++) {
4861d1ffd9eSOleksandr Tymoshenko 
4871d1ffd9eSOleksandr Tymoshenko 		rv = fdt_data_to_res(reservep, addr_cells, size_cells,
4881d1ffd9eSOleksandr Tymoshenko 			(u_long *)&mr[i].mr_start, (u_long *)&mr[i].mr_size);
4891d1ffd9eSOleksandr Tymoshenko 
4901d1ffd9eSOleksandr Tymoshenko 		if (rv != 0)
4911d1ffd9eSOleksandr Tymoshenko 			goto out;
4921d1ffd9eSOleksandr Tymoshenko 
4931d1ffd9eSOleksandr Tymoshenko 		reservep += addr_cells + size_cells;
4941d1ffd9eSOleksandr Tymoshenko 	}
4951d1ffd9eSOleksandr Tymoshenko 
4961d1ffd9eSOleksandr Tymoshenko 	*mrcnt = i;
4971d1ffd9eSOleksandr Tymoshenko 	rv = 0;
4981d1ffd9eSOleksandr Tymoshenko out:
4991d1ffd9eSOleksandr Tymoshenko 	return (rv);
5001d1ffd9eSOleksandr Tymoshenko }
5011d1ffd9eSOleksandr Tymoshenko 
5021d1ffd9eSOleksandr Tymoshenko int
fdt_get_reserved_mem(struct mem_region * reserved,int * mreserved)5031442afc1SAndrew Turner fdt_get_reserved_mem(struct mem_region *reserved, int *mreserved)
5041442afc1SAndrew Turner {
5051442afc1SAndrew Turner 	pcell_t reg[FDT_REG_CELLS];
5061442afc1SAndrew Turner 	phandle_t child, root;
5071442afc1SAndrew Turner 	int addr_cells, size_cells;
5081442afc1SAndrew Turner 	int i, rv;
5091442afc1SAndrew Turner 
5101442afc1SAndrew Turner 	root = OF_finddevice("/reserved-memory");
5111442afc1SAndrew Turner 	if (root == -1) {
5121442afc1SAndrew Turner 		return (ENXIO);
5131442afc1SAndrew Turner 	}
5141442afc1SAndrew Turner 
5151442afc1SAndrew Turner 	if ((rv = fdt_addrsize_cells(root, &addr_cells, &size_cells)) != 0)
5161442afc1SAndrew Turner 		return (rv);
5171442afc1SAndrew Turner 
5181442afc1SAndrew Turner 	if (addr_cells + size_cells > FDT_REG_CELLS)
5191442afc1SAndrew Turner 		panic("Too many address and size cells %d %d", addr_cells,
5201442afc1SAndrew Turner 		    size_cells);
5211442afc1SAndrew Turner 
5221442afc1SAndrew Turner 	i = 0;
5231442afc1SAndrew Turner 	for (child = OF_child(root); child != 0; child = OF_peer(child)) {
5241442afc1SAndrew Turner 		if (!OF_hasprop(child, "no-map"))
5251442afc1SAndrew Turner 			continue;
5261442afc1SAndrew Turner 
5271442afc1SAndrew Turner 		rv = OF_getprop(child, "reg", reg, sizeof(reg));
5281442afc1SAndrew Turner 		if (rv <= 0)
5291442afc1SAndrew Turner 			/* XXX: Does a no-map of a dynamic range make sense? */
5301442afc1SAndrew Turner 			continue;
5311442afc1SAndrew Turner 
5321442afc1SAndrew Turner 		fdt_data_to_res(reg, addr_cells, size_cells,
5331442afc1SAndrew Turner 		    (u_long *)&reserved[i].mr_start,
5341442afc1SAndrew Turner 		    (u_long *)&reserved[i].mr_size);
5351442afc1SAndrew Turner 		i++;
5361442afc1SAndrew Turner 	}
5371442afc1SAndrew Turner 
5381442afc1SAndrew Turner 	*mreserved = i;
5391442afc1SAndrew Turner 
5401442afc1SAndrew Turner 	return (0);
5411442afc1SAndrew Turner }
5421442afc1SAndrew Turner 
5431442afc1SAndrew Turner int
fdt_get_mem_regions(struct mem_region * mr,int * mrcnt,uint64_t * memsize)5449636600cSAndrew Turner fdt_get_mem_regions(struct mem_region *mr, int *mrcnt, uint64_t *memsize)
54558158742SRafal Jaworowski {
54658158742SRafal Jaworowski 	pcell_t reg[FDT_REG_CELLS * FDT_MEM_REGIONS];
54758158742SRafal Jaworowski 	pcell_t *regp;
54858158742SRafal Jaworowski 	phandle_t memory;
5499636600cSAndrew Turner 	uint64_t memory_size;
55058158742SRafal Jaworowski 	int addr_cells, size_cells;
551151ba793SAlexander Kabaev 	int i, reg_len, rv, tuple_size, tuples;
55258158742SRafal Jaworowski 
55358158742SRafal Jaworowski 	memory = OF_finddevice("/memory");
55407042befSJayachandran C. 	if (memory == -1) {
55558158742SRafal Jaworowski 		rv = ENXIO;
55658158742SRafal Jaworowski 		goto out;
55758158742SRafal Jaworowski 	}
55858158742SRafal Jaworowski 
55958158742SRafal Jaworowski 	if ((rv = fdt_addrsize_cells(OF_parent(memory), &addr_cells,
56058158742SRafal Jaworowski 	    &size_cells)) != 0)
56158158742SRafal Jaworowski 		goto out;
56258158742SRafal Jaworowski 
56358158742SRafal Jaworowski 	if (addr_cells > 2) {
56458158742SRafal Jaworowski 		rv = ERANGE;
56558158742SRafal Jaworowski 		goto out;
56658158742SRafal Jaworowski 	}
56758158742SRafal Jaworowski 
56858158742SRafal Jaworowski 	tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
56958158742SRafal Jaworowski 	reg_len = OF_getproplen(memory, "reg");
57058158742SRafal Jaworowski 	if (reg_len <= 0 || reg_len > sizeof(reg)) {
57158158742SRafal Jaworowski 		rv = ERANGE;
57258158742SRafal Jaworowski 		goto out;
57358158742SRafal Jaworowski 	}
57458158742SRafal Jaworowski 
57558158742SRafal Jaworowski 	if (OF_getprop(memory, "reg", reg, reg_len) <= 0) {
57658158742SRafal Jaworowski 		rv = ENXIO;
57758158742SRafal Jaworowski 		goto out;
57858158742SRafal Jaworowski 	}
57958158742SRafal Jaworowski 
58058158742SRafal Jaworowski 	memory_size = 0;
58158158742SRafal Jaworowski 	tuples = reg_len / tuple_size;
58258158742SRafal Jaworowski 	regp = (pcell_t *)&reg;
58358158742SRafal Jaworowski 	for (i = 0; i < tuples; i++) {
58458158742SRafal Jaworowski 
58558158742SRafal Jaworowski 		rv = fdt_data_to_res(regp, addr_cells, size_cells,
58658158742SRafal Jaworowski 			(u_long *)&mr[i].mr_start, (u_long *)&mr[i].mr_size);
58758158742SRafal Jaworowski 
58858158742SRafal Jaworowski 		if (rv != 0)
58958158742SRafal Jaworowski 			goto out;
59058158742SRafal Jaworowski 
59158158742SRafal Jaworowski 		regp += addr_cells + size_cells;
59258158742SRafal Jaworowski 		memory_size += mr[i].mr_size;
59358158742SRafal Jaworowski 	}
59458158742SRafal Jaworowski 
59558158742SRafal Jaworowski 	if (memory_size == 0) {
59658158742SRafal Jaworowski 		rv = ERANGE;
59758158742SRafal Jaworowski 		goto out;
59858158742SRafal Jaworowski 	}
59958158742SRafal Jaworowski 
60058158742SRafal Jaworowski 	*mrcnt = i;
601a4376069SAndrew Turner 	if (memsize != NULL)
60258158742SRafal Jaworowski 		*memsize = memory_size;
60358158742SRafal Jaworowski 	rv = 0;
60458158742SRafal Jaworowski out:
60558158742SRafal Jaworowski 	return (rv);
60658158742SRafal Jaworowski }
6072c990564SGrzegorz Bernacki 
6082c990564SGrzegorz Bernacki int
fdt_get_chosen_bootargs(char * bootargs,size_t max_size)609e64c3743SMichal Meloun fdt_get_chosen_bootargs(char *bootargs, size_t max_size)
610e64c3743SMichal Meloun {
611e64c3743SMichal Meloun 	phandle_t chosen;
612e64c3743SMichal Meloun 
613e64c3743SMichal Meloun 	chosen = OF_finddevice("/chosen");
614e64c3743SMichal Meloun 	if (chosen == -1)
615e64c3743SMichal Meloun 		return (ENXIO);
616e64c3743SMichal Meloun 	if (OF_getprop(chosen, "bootargs", bootargs, max_size) == -1)
617e64c3743SMichal Meloun 		return (ENXIO);
618e64c3743SMichal Meloun 	return (0);
619e64c3743SMichal Meloun }
620