xref: /freebsd/sys/dev/fdt/fdt_common.c (revision 718cf2ccb9956613756ab15d7a0e28f2c8e91cab)
158158742SRafal Jaworowski /*-
2*718cf2ccSPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3*718cf2ccSPedro F. Giffuni  *
4d455cc04SAndrew Turner  * Copyright (c) 2009-2014 The FreeBSD Foundation
558158742SRafal Jaworowski  * All rights reserved.
658158742SRafal Jaworowski  *
7d455cc04SAndrew Turner  * This software was developed by Andrew Turner under sponsorship from
8d455cc04SAndrew Turner  * the FreeBSD Foundation.
958158742SRafal Jaworowski  * This software was developed by Semihalf under sponsorship from
1058158742SRafal Jaworowski  * the FreeBSD Foundation.
1158158742SRafal Jaworowski  *
1258158742SRafal Jaworowski  * Redistribution and use in source and binary forms, with or without
1358158742SRafal Jaworowski  * modification, are permitted provided that the following conditions
1458158742SRafal Jaworowski  * are met:
1558158742SRafal Jaworowski  * 1. Redistributions of source code must retain the above copyright
1658158742SRafal Jaworowski  *    notice, this list of conditions and the following disclaimer.
1758158742SRafal Jaworowski  * 2. Redistributions in binary form must reproduce the above copyright
1858158742SRafal Jaworowski  *    notice, this list of conditions and the following disclaimer in the
1958158742SRafal Jaworowski  *    documentation and/or other materials provided with the distribution.
2058158742SRafal Jaworowski  *
2158158742SRafal Jaworowski  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
2258158742SRafal Jaworowski  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2358158742SRafal Jaworowski  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2458158742SRafal Jaworowski  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2558158742SRafal Jaworowski  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2658158742SRafal Jaworowski  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2758158742SRafal Jaworowski  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2858158742SRafal Jaworowski  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2958158742SRafal Jaworowski  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
3058158742SRafal Jaworowski  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
3158158742SRafal Jaworowski  * SUCH DAMAGE.
3258158742SRafal Jaworowski  */
3358158742SRafal Jaworowski 
3458158742SRafal Jaworowski #include <sys/cdefs.h>
3558158742SRafal Jaworowski __FBSDID("$FreeBSD$");
3658158742SRafal Jaworowski 
3758158742SRafal Jaworowski #include <sys/param.h>
3858158742SRafal Jaworowski #include <sys/systm.h>
3958158742SRafal Jaworowski #include <sys/kernel.h>
4058158742SRafal Jaworowski #include <sys/module.h>
4158158742SRafal Jaworowski #include <sys/bus.h>
428bb93637SOleksandr Tymoshenko #include <sys/limits.h>
43a183d81dSStephen J. Kiernan #include <sys/sysctl.h>
4458158742SRafal Jaworowski 
4558158742SRafal Jaworowski #include <machine/resource.h>
4658158742SRafal Jaworowski 
4758158742SRafal Jaworowski #include <dev/fdt/fdt_common.h>
4858158742SRafal Jaworowski #include <dev/ofw/ofw_bus.h>
4958158742SRafal Jaworowski #include <dev/ofw/ofw_bus_subr.h>
5058158742SRafal Jaworowski #include <dev/ofw/openfirm.h>
5158158742SRafal Jaworowski 
5258158742SRafal Jaworowski #include "ofw_bus_if.h"
5358158742SRafal Jaworowski 
5458158742SRafal Jaworowski #ifdef DEBUG
5558158742SRafal Jaworowski #define debugf(fmt, args...) do { printf("%s(): ", __func__);	\
5658158742SRafal Jaworowski     printf(fmt,##args); } while (0)
5758158742SRafal Jaworowski #else
5858158742SRafal Jaworowski #define debugf(fmt, args...)
5958158742SRafal Jaworowski #endif
6058158742SRafal Jaworowski 
6158158742SRafal Jaworowski #define FDT_COMPAT_LEN	255
6258158742SRafal Jaworowski #define FDT_TYPE_LEN	64
6358158742SRafal Jaworowski 
6458158742SRafal Jaworowski #define FDT_REG_CELLS	4
65bfd084c8SMarcin Wojtas #define FDT_RANGES_SIZE 48
6658158742SRafal Jaworowski 
67a183d81dSStephen J. Kiernan SYSCTL_NODE(_hw, OID_AUTO, fdt, CTLFLAG_RD, 0, "Flattened Device Tree");
68a183d81dSStephen J. Kiernan 
6958158742SRafal Jaworowski vm_paddr_t fdt_immr_pa;
7058158742SRafal Jaworowski vm_offset_t fdt_immr_va;
7158158742SRafal Jaworowski vm_offset_t fdt_immr_size;
7258158742SRafal Jaworowski 
731f40dbc8SBrooks Davis struct fdt_ic_list fdt_ic_list_head = SLIST_HEAD_INITIALIZER(fdt_ic_list_head);
741f40dbc8SBrooks Davis 
75f74776edSAndrew Turner static int fdt_is_compatible(phandle_t, const char *);
76f74776edSAndrew Turner 
77d455cc04SAndrew Turner static int
78d455cc04SAndrew Turner fdt_get_range_by_busaddr(phandle_t node, u_long addr, u_long *base,
79d455cc04SAndrew Turner     u_long *size)
80d455cc04SAndrew Turner {
81d455cc04SAndrew Turner 	pcell_t ranges[32], *rangesptr;
82d455cc04SAndrew Turner 	pcell_t addr_cells, size_cells, par_addr_cells;
83d455cc04SAndrew Turner 	u_long bus_addr, par_bus_addr, pbase, psize;
84d455cc04SAndrew Turner 	int err, i, len, tuple_size, tuples;
85d455cc04SAndrew Turner 
8630ef1a05SAndrew Turner 	if (node == 0) {
8730ef1a05SAndrew Turner 		*base = 0;
8830ef1a05SAndrew Turner 		*size = ULONG_MAX;
8930ef1a05SAndrew Turner 		return (0);
9030ef1a05SAndrew Turner 	}
9130ef1a05SAndrew Turner 
92d455cc04SAndrew Turner 	if ((fdt_addrsize_cells(node, &addr_cells, &size_cells)) != 0)
93d455cc04SAndrew Turner 		return (ENXIO);
94d455cc04SAndrew Turner 	/*
95d455cc04SAndrew Turner 	 * Process 'ranges' property.
96d455cc04SAndrew Turner 	 */
97d455cc04SAndrew Turner 	par_addr_cells = fdt_parent_addr_cells(node);
98d455cc04SAndrew Turner 	if (par_addr_cells > 2) {
99d455cc04SAndrew Turner 		return (ERANGE);
100d455cc04SAndrew Turner 	}
101d455cc04SAndrew Turner 
102d455cc04SAndrew Turner 	len = OF_getproplen(node, "ranges");
103d455cc04SAndrew Turner 	if (len < 0)
104d455cc04SAndrew Turner 		return (-1);
105d455cc04SAndrew Turner 	if (len > sizeof(ranges))
106d455cc04SAndrew Turner 		return (ENOMEM);
107d455cc04SAndrew Turner 	if (len == 0) {
10830ef1a05SAndrew Turner 		return (fdt_get_range_by_busaddr(OF_parent(node), addr,
10930ef1a05SAndrew Turner 		    base, size));
110d455cc04SAndrew Turner 	}
111d455cc04SAndrew Turner 
112d455cc04SAndrew Turner 	if (OF_getprop(node, "ranges", ranges, sizeof(ranges)) <= 0)
113d455cc04SAndrew Turner 		return (EINVAL);
114d455cc04SAndrew Turner 
115d455cc04SAndrew Turner 	tuple_size = addr_cells + par_addr_cells + size_cells;
116d455cc04SAndrew Turner 	tuples = len / (tuple_size * sizeof(cell_t));
117d455cc04SAndrew Turner 
118ba2ea14aSRuslan Bukin 	if (par_addr_cells > 2 || addr_cells > 2 || size_cells > 2)
119d455cc04SAndrew Turner 		return (ERANGE);
120ba2ea14aSRuslan Bukin 
121d455cc04SAndrew Turner 	*base = 0;
122d455cc04SAndrew Turner 	*size = 0;
123d455cc04SAndrew Turner 
124d455cc04SAndrew Turner 	for (i = 0; i < tuples; i++) {
125d455cc04SAndrew Turner 		rangesptr = &ranges[i * tuple_size];
126d455cc04SAndrew Turner 
127d455cc04SAndrew Turner 		bus_addr = fdt_data_get((void *)rangesptr, addr_cells);
128d455cc04SAndrew Turner 		if (bus_addr != addr)
129d455cc04SAndrew Turner 			continue;
130d455cc04SAndrew Turner 		rangesptr += addr_cells;
131d455cc04SAndrew Turner 
132d455cc04SAndrew Turner 		par_bus_addr = fdt_data_get((void *)rangesptr, par_addr_cells);
133d455cc04SAndrew Turner 		rangesptr += par_addr_cells;
134d455cc04SAndrew Turner 
135d455cc04SAndrew Turner 		err = fdt_get_range_by_busaddr(OF_parent(node), par_bus_addr,
136d455cc04SAndrew Turner 		    &pbase, &psize);
137d455cc04SAndrew Turner 		if (err > 0)
138d455cc04SAndrew Turner 			return (err);
139d455cc04SAndrew Turner 		if (err == 0)
140d455cc04SAndrew Turner 			*base = pbase;
141d455cc04SAndrew Turner 		else
142d455cc04SAndrew Turner 			*base = par_bus_addr;
143d455cc04SAndrew Turner 
144d455cc04SAndrew Turner 		*size = fdt_data_get((void *)rangesptr, size_cells);
145d455cc04SAndrew Turner 
146d455cc04SAndrew Turner 		return (0);
147d455cc04SAndrew Turner 	}
148d455cc04SAndrew Turner 
149d455cc04SAndrew Turner 	return (EINVAL);
150d455cc04SAndrew Turner }
151d455cc04SAndrew Turner 
15258158742SRafal Jaworowski int
1538bb93637SOleksandr Tymoshenko fdt_get_range(phandle_t node, int range_id, u_long *base, u_long *size)
15458158742SRafal Jaworowski {
155bfd084c8SMarcin Wojtas 	pcell_t ranges[FDT_RANGES_SIZE], *rangesptr;
15658158742SRafal Jaworowski 	pcell_t addr_cells, size_cells, par_addr_cells;
157d455cc04SAndrew Turner 	u_long par_bus_addr, pbase, psize;
158d455cc04SAndrew Turner 	int err, len, tuple_size, tuples;
15958158742SRafal Jaworowski 
16058158742SRafal Jaworowski 	if ((fdt_addrsize_cells(node, &addr_cells, &size_cells)) != 0)
16158158742SRafal Jaworowski 		return (ENXIO);
16258158742SRafal Jaworowski 	/*
16358158742SRafal Jaworowski 	 * Process 'ranges' property.
16458158742SRafal Jaworowski 	 */
16558158742SRafal Jaworowski 	par_addr_cells = fdt_parent_addr_cells(node);
16658158742SRafal Jaworowski 	if (par_addr_cells > 2)
16758158742SRafal Jaworowski 		return (ERANGE);
16858158742SRafal Jaworowski 
16958158742SRafal Jaworowski 	len = OF_getproplen(node, "ranges");
17058158742SRafal Jaworowski 	if (len > sizeof(ranges))
17158158742SRafal Jaworowski 		return (ENOMEM);
1728bb93637SOleksandr Tymoshenko 	if (len == 0) {
1738bb93637SOleksandr Tymoshenko 		*base = 0;
1748bb93637SOleksandr Tymoshenko 		*size = ULONG_MAX;
1758bb93637SOleksandr Tymoshenko 		return (0);
1768bb93637SOleksandr Tymoshenko 	}
1778bb93637SOleksandr Tymoshenko 
1788bb93637SOleksandr Tymoshenko 	if (!(range_id < len))
1798bb93637SOleksandr Tymoshenko 		return (ERANGE);
18058158742SRafal Jaworowski 
18158158742SRafal Jaworowski 	if (OF_getprop(node, "ranges", ranges, sizeof(ranges)) <= 0)
18258158742SRafal Jaworowski 		return (EINVAL);
18358158742SRafal Jaworowski 
18458158742SRafal Jaworowski 	tuple_size = sizeof(pcell_t) * (addr_cells + par_addr_cells +
18558158742SRafal Jaworowski 	    size_cells);
18658158742SRafal Jaworowski 	tuples = len / tuple_size;
18758158742SRafal Jaworowski 
188ba2ea14aSRuslan Bukin 	if (par_addr_cells > 2 || addr_cells > 2 || size_cells > 2)
18958158742SRafal Jaworowski 		return (ERANGE);
190ba2ea14aSRuslan Bukin 
1918bb93637SOleksandr Tymoshenko 	*base = 0;
1928bb93637SOleksandr Tymoshenko 	*size = 0;
1938bb93637SOleksandr Tymoshenko 	rangesptr = &ranges[range_id];
19458158742SRafal Jaworowski 
1958bb93637SOleksandr Tymoshenko 	*base = fdt_data_get((void *)rangesptr, addr_cells);
19658158742SRafal Jaworowski 	rangesptr += addr_cells;
197d455cc04SAndrew Turner 
198d455cc04SAndrew Turner 	par_bus_addr = fdt_data_get((void *)rangesptr, par_addr_cells);
19958158742SRafal Jaworowski 	rangesptr += par_addr_cells;
200d455cc04SAndrew Turner 
201d455cc04SAndrew Turner 	err = fdt_get_range_by_busaddr(OF_parent(node), par_bus_addr,
202d455cc04SAndrew Turner 	   &pbase, &psize);
203d455cc04SAndrew Turner 	if (err == 0)
204d455cc04SAndrew Turner 		*base += pbase;
205d455cc04SAndrew Turner 	else
206d455cc04SAndrew Turner 		*base += par_bus_addr;
207d455cc04SAndrew Turner 
2088bb93637SOleksandr Tymoshenko 	*size = fdt_data_get((void *)rangesptr, size_cells);
2098bb93637SOleksandr Tymoshenko 	return (0);
2108bb93637SOleksandr Tymoshenko }
21158158742SRafal Jaworowski 
2128bb93637SOleksandr Tymoshenko int
2138bb93637SOleksandr Tymoshenko fdt_immr_addr(vm_offset_t immr_va)
2148bb93637SOleksandr Tymoshenko {
2158bb93637SOleksandr Tymoshenko 	phandle_t node;
2168bb93637SOleksandr Tymoshenko 	u_long base, size;
2178bb93637SOleksandr Tymoshenko 	int r;
2188bb93637SOleksandr Tymoshenko 
2198bb93637SOleksandr Tymoshenko 	/*
2208bb93637SOleksandr Tymoshenko 	 * Try to access the SOC node directly i.e. through /aliases/.
2218bb93637SOleksandr Tymoshenko 	 */
2228bb93637SOleksandr Tymoshenko 	if ((node = OF_finddevice("soc")) != 0)
223b2ea73e3SZbigniew Bodek 		if (fdt_is_compatible(node, "simple-bus"))
2248bb93637SOleksandr Tymoshenko 			goto moveon;
2258bb93637SOleksandr Tymoshenko 	/*
2268bb93637SOleksandr Tymoshenko 	 * Find the node the long way.
2278bb93637SOleksandr Tymoshenko 	 */
2288bb93637SOleksandr Tymoshenko 	if ((node = OF_finddevice("/")) == 0)
2298bb93637SOleksandr Tymoshenko 		return (ENXIO);
2308bb93637SOleksandr Tymoshenko 
231b2ea73e3SZbigniew Bodek 	if ((node = fdt_find_compatible(node, "simple-bus", 0)) == 0)
2328bb93637SOleksandr Tymoshenko 		return (ENXIO);
2338bb93637SOleksandr Tymoshenko 
2348bb93637SOleksandr Tymoshenko moveon:
2358bb93637SOleksandr Tymoshenko 	if ((r = fdt_get_range(node, 0, &base, &size)) == 0) {
23658158742SRafal Jaworowski 		fdt_immr_pa = base;
2374f124b97SRafal Jaworowski 		fdt_immr_va = immr_va;
23858158742SRafal Jaworowski 		fdt_immr_size = size;
2398bb93637SOleksandr Tymoshenko 	}
24058158742SRafal Jaworowski 
2418bb93637SOleksandr Tymoshenko 	return (r);
24258158742SRafal Jaworowski }
24358158742SRafal Jaworowski 
24458158742SRafal Jaworowski /*
24558158742SRafal Jaworowski  * This routine is an early-usage version of the ofw_bus_is_compatible() when
24658158742SRafal Jaworowski  * the ofw_bus I/F is not available (like early console routines and similar).
24758158742SRafal Jaworowski  * Note the buffer has to be on the stack since malloc() is usually not
24858158742SRafal Jaworowski  * available in such cases either.
24958158742SRafal Jaworowski  */
250f74776edSAndrew Turner static int
25158158742SRafal Jaworowski fdt_is_compatible(phandle_t node, const char *compatstr)
25258158742SRafal Jaworowski {
25358158742SRafal Jaworowski 	char buf[FDT_COMPAT_LEN];
25458158742SRafal Jaworowski 	char *compat;
25558158742SRafal Jaworowski 	int len, onelen, l, rv;
25658158742SRafal Jaworowski 
25758158742SRafal Jaworowski 	if ((len = OF_getproplen(node, "compatible")) <= 0)
25858158742SRafal Jaworowski 		return (0);
25958158742SRafal Jaworowski 
26058158742SRafal Jaworowski 	compat = (char *)&buf;
26158158742SRafal Jaworowski 	bzero(compat, FDT_COMPAT_LEN);
26258158742SRafal Jaworowski 
26358158742SRafal Jaworowski 	if (OF_getprop(node, "compatible", compat, FDT_COMPAT_LEN) < 0)
26458158742SRafal Jaworowski 		return (0);
26558158742SRafal Jaworowski 
26658158742SRafal Jaworowski 	onelen = strlen(compatstr);
26758158742SRafal Jaworowski 	rv = 0;
26858158742SRafal Jaworowski 	while (len > 0) {
26958158742SRafal Jaworowski 		if (strncasecmp(compat, compatstr, onelen) == 0) {
27058158742SRafal Jaworowski 			/* Found it. */
27158158742SRafal Jaworowski 			rv = 1;
27258158742SRafal Jaworowski 			break;
27358158742SRafal Jaworowski 		}
27458158742SRafal Jaworowski 		/* Slide to the next sub-string. */
27558158742SRafal Jaworowski 		l = strlen(compat) + 1;
27658158742SRafal Jaworowski 		compat += l;
27758158742SRafal Jaworowski 		len -= l;
27858158742SRafal Jaworowski 	}
27958158742SRafal Jaworowski 
28058158742SRafal Jaworowski 	return (rv);
28158158742SRafal Jaworowski }
28258158742SRafal Jaworowski 
28358158742SRafal Jaworowski int
28458158742SRafal Jaworowski fdt_is_compatible_strict(phandle_t node, const char *compatible)
28558158742SRafal Jaworowski {
28658158742SRafal Jaworowski 	char compat[FDT_COMPAT_LEN];
28758158742SRafal Jaworowski 
28858158742SRafal Jaworowski 	if (OF_getproplen(node, "compatible") <= 0)
28958158742SRafal Jaworowski 		return (0);
29058158742SRafal Jaworowski 
29158158742SRafal Jaworowski 	if (OF_getprop(node, "compatible", compat, FDT_COMPAT_LEN) < 0)
29258158742SRafal Jaworowski 		return (0);
29358158742SRafal Jaworowski 
29458158742SRafal Jaworowski 	if (strncasecmp(compat, compatible, FDT_COMPAT_LEN) == 0)
29558158742SRafal Jaworowski 		/* This fits. */
29658158742SRafal Jaworowski 		return (1);
29758158742SRafal Jaworowski 
29858158742SRafal Jaworowski 	return (0);
29958158742SRafal Jaworowski }
30058158742SRafal Jaworowski 
30158158742SRafal Jaworowski phandle_t
30258158742SRafal Jaworowski fdt_find_compatible(phandle_t start, const char *compat, int strict)
30358158742SRafal Jaworowski {
30458158742SRafal Jaworowski 	phandle_t child;
30558158742SRafal Jaworowski 
30658158742SRafal Jaworowski 	/*
30758158742SRafal Jaworowski 	 * Traverse all children of 'start' node, and find first with
30858158742SRafal Jaworowski 	 * matching 'compatible' property.
30958158742SRafal Jaworowski 	 */
31058158742SRafal Jaworowski 	for (child = OF_child(start); child != 0; child = OF_peer(child))
31158158742SRafal Jaworowski 		if (fdt_is_compatible(child, compat)) {
31258158742SRafal Jaworowski 			if (strict)
31358158742SRafal Jaworowski 				if (!fdt_is_compatible_strict(child, compat))
31458158742SRafal Jaworowski 					continue;
31558158742SRafal Jaworowski 			return (child);
31658158742SRafal Jaworowski 		}
31758158742SRafal Jaworowski 	return (0);
31858158742SRafal Jaworowski }
31958158742SRafal Jaworowski 
320731ff010SIan Lepore phandle_t
321731ff010SIan Lepore fdt_depth_search_compatible(phandle_t start, const char *compat, int strict)
322731ff010SIan Lepore {
323731ff010SIan Lepore 	phandle_t child, node;
324731ff010SIan Lepore 
325731ff010SIan Lepore 	/*
326731ff010SIan Lepore 	 * Depth-search all descendants of 'start' node, and find first with
327731ff010SIan Lepore 	 * matching 'compatible' property.
328731ff010SIan Lepore 	 */
329731ff010SIan Lepore 	for (node = OF_child(start); node != 0; node = OF_peer(node)) {
330731ff010SIan Lepore 		if (fdt_is_compatible(node, compat) &&
331731ff010SIan Lepore 		    (strict == 0 || fdt_is_compatible_strict(node, compat))) {
332731ff010SIan Lepore 			return (node);
333731ff010SIan Lepore 		}
334a41679c9SIan Lepore 		child = fdt_depth_search_compatible(node, compat, strict);
335731ff010SIan Lepore 		if (child != 0)
336731ff010SIan Lepore 			return (child);
337731ff010SIan Lepore 	}
338731ff010SIan Lepore 	return (0);
339731ff010SIan Lepore }
340731ff010SIan Lepore 
34158158742SRafal Jaworowski int
34258158742SRafal Jaworowski fdt_is_enabled(phandle_t node)
34358158742SRafal Jaworowski {
34458158742SRafal Jaworowski 	char *stat;
34558158742SRafal Jaworowski 	int ena, len;
34658158742SRafal Jaworowski 
34758158742SRafal Jaworowski 	len = OF_getprop_alloc(node, "status", sizeof(char),
34858158742SRafal Jaworowski 	    (void **)&stat);
34958158742SRafal Jaworowski 
35058158742SRafal Jaworowski 	if (len <= 0)
35158158742SRafal Jaworowski 		/* It is OK if no 'status' property. */
35258158742SRafal Jaworowski 		return (1);
35358158742SRafal Jaworowski 
35458158742SRafal Jaworowski 	/* Anything other than 'okay' means disabled. */
35558158742SRafal Jaworowski 	ena = 0;
35658158742SRafal Jaworowski 	if (strncmp((char *)stat, "okay", len) == 0)
35758158742SRafal Jaworowski 		ena = 1;
35858158742SRafal Jaworowski 
359bc90a48cSOleksandr Tymoshenko 	OF_prop_free(stat);
36058158742SRafal Jaworowski 	return (ena);
36158158742SRafal Jaworowski }
36258158742SRafal Jaworowski 
36358158742SRafal Jaworowski int
36458158742SRafal Jaworowski fdt_is_type(phandle_t node, const char *typestr)
36558158742SRafal Jaworowski {
36658158742SRafal Jaworowski 	char type[FDT_TYPE_LEN];
36758158742SRafal Jaworowski 
36858158742SRafal Jaworowski 	if (OF_getproplen(node, "device_type") <= 0)
36958158742SRafal Jaworowski 		return (0);
37058158742SRafal Jaworowski 
37158158742SRafal Jaworowski 	if (OF_getprop(node, "device_type", type, FDT_TYPE_LEN) < 0)
37258158742SRafal Jaworowski 		return (0);
37358158742SRafal Jaworowski 
37458158742SRafal Jaworowski 	if (strncasecmp(type, typestr, FDT_TYPE_LEN) == 0)
37558158742SRafal Jaworowski 		/* This fits. */
37658158742SRafal Jaworowski 		return (1);
37758158742SRafal Jaworowski 
37858158742SRafal Jaworowski 	return (0);
37958158742SRafal Jaworowski }
38058158742SRafal Jaworowski 
38158158742SRafal Jaworowski int
38258158742SRafal Jaworowski fdt_parent_addr_cells(phandle_t node)
38358158742SRafal Jaworowski {
38458158742SRafal Jaworowski 	pcell_t addr_cells;
38558158742SRafal Jaworowski 
38658158742SRafal Jaworowski 	/* Find out #address-cells of the superior bus. */
38758158742SRafal Jaworowski 	if (OF_searchprop(OF_parent(node), "#address-cells", &addr_cells,
38858158742SRafal Jaworowski 	    sizeof(addr_cells)) <= 0)
389d455cc04SAndrew Turner 		return (2);
39058158742SRafal Jaworowski 
39158158742SRafal Jaworowski 	return ((int)fdt32_to_cpu(addr_cells));
39258158742SRafal Jaworowski }
39358158742SRafal Jaworowski 
39458158742SRafal Jaworowski int
39558158742SRafal Jaworowski fdt_pm_is_enabled(phandle_t node)
39658158742SRafal Jaworowski {
39758158742SRafal Jaworowski 	int ret;
39858158742SRafal Jaworowski 
39958158742SRafal Jaworowski 	ret = 1;
40058158742SRafal Jaworowski 
40158158742SRafal Jaworowski #if defined(SOC_MV_KIRKWOOD) || defined(SOC_MV_DISCOVERY)
40258158742SRafal Jaworowski 	ret = fdt_pm(node);
40358158742SRafal Jaworowski #endif
40458158742SRafal Jaworowski 	return (ret);
40558158742SRafal Jaworowski }
40658158742SRafal Jaworowski 
40758158742SRafal Jaworowski u_long
40858158742SRafal Jaworowski fdt_data_get(void *data, int cells)
40958158742SRafal Jaworowski {
41058158742SRafal Jaworowski 
41158158742SRafal Jaworowski 	if (cells == 1)
41258158742SRafal Jaworowski 		return (fdt32_to_cpu(*((uint32_t *)data)));
41358158742SRafal Jaworowski 
41458158742SRafal Jaworowski 	return (fdt64_to_cpu(*((uint64_t *)data)));
41558158742SRafal Jaworowski }
41658158742SRafal Jaworowski 
41758158742SRafal Jaworowski int
41858158742SRafal Jaworowski fdt_addrsize_cells(phandle_t node, int *addr_cells, int *size_cells)
41958158742SRafal Jaworowski {
42058158742SRafal Jaworowski 	pcell_t cell;
42158158742SRafal Jaworowski 	int cell_size;
42258158742SRafal Jaworowski 
42358158742SRafal Jaworowski 	/*
42458158742SRafal Jaworowski 	 * Retrieve #{address,size}-cells.
42558158742SRafal Jaworowski 	 */
42658158742SRafal Jaworowski 	cell_size = sizeof(cell);
427c6c4276bSAndrew Turner 	if (OF_getencprop(node, "#address-cells", &cell, cell_size) < cell_size)
428948dad6aSLuiz Otavio O Souza 		cell = 2;
429c6c4276bSAndrew Turner 	*addr_cells = (int)cell;
43058158742SRafal Jaworowski 
431c6c4276bSAndrew Turner 	if (OF_getencprop(node, "#size-cells", &cell, cell_size) < cell_size)
43258158742SRafal Jaworowski 		cell = 1;
433c6c4276bSAndrew Turner 	*size_cells = (int)cell;
43458158742SRafal Jaworowski 
43558158742SRafal Jaworowski 	if (*addr_cells > 3 || *size_cells > 2)
43658158742SRafal Jaworowski 		return (ERANGE);
43758158742SRafal Jaworowski 	return (0);
43858158742SRafal Jaworowski }
43958158742SRafal Jaworowski 
44058158742SRafal Jaworowski int
44158158742SRafal Jaworowski fdt_data_to_res(pcell_t *data, int addr_cells, int size_cells, u_long *start,
44258158742SRafal Jaworowski     u_long *count)
44358158742SRafal Jaworowski {
44458158742SRafal Jaworowski 
44558158742SRafal Jaworowski 	/* Address portion. */
446ba2ea14aSRuslan Bukin 	if (addr_cells > 2)
44758158742SRafal Jaworowski 		return (ERANGE);
44858158742SRafal Jaworowski 
44958158742SRafal Jaworowski 	*start = fdt_data_get((void *)data, addr_cells);
45058158742SRafal Jaworowski 	data += addr_cells;
45158158742SRafal Jaworowski 
45258158742SRafal Jaworowski 	/* Size portion. */
453ba2ea14aSRuslan Bukin 	if (size_cells > 2)
45458158742SRafal Jaworowski 		return (ERANGE);
45558158742SRafal Jaworowski 
45658158742SRafal Jaworowski 	*count = fdt_data_get((void *)data, size_cells);
45758158742SRafal Jaworowski 	return (0);
45858158742SRafal Jaworowski }
45958158742SRafal Jaworowski 
46058158742SRafal Jaworowski int
46158158742SRafal Jaworowski fdt_regsize(phandle_t node, u_long *base, u_long *size)
46258158742SRafal Jaworowski {
46358158742SRafal Jaworowski 	pcell_t reg[4];
46458158742SRafal Jaworowski 	int addr_cells, len, size_cells;
46558158742SRafal Jaworowski 
46658158742SRafal Jaworowski 	if (fdt_addrsize_cells(OF_parent(node), &addr_cells, &size_cells))
46758158742SRafal Jaworowski 		return (ENXIO);
46858158742SRafal Jaworowski 
46958158742SRafal Jaworowski 	if ((sizeof(pcell_t) * (addr_cells + size_cells)) > sizeof(reg))
47058158742SRafal Jaworowski 		return (ENOMEM);
47158158742SRafal Jaworowski 
47258158742SRafal Jaworowski 	len = OF_getprop(node, "reg", &reg, sizeof(reg));
47358158742SRafal Jaworowski 	if (len <= 0)
47458158742SRafal Jaworowski 		return (EINVAL);
47558158742SRafal Jaworowski 
47658158742SRafal Jaworowski 	*base = fdt_data_get(&reg[0], addr_cells);
47758158742SRafal Jaworowski 	*size = fdt_data_get(&reg[addr_cells], size_cells);
47858158742SRafal Jaworowski 	return (0);
47958158742SRafal Jaworowski }
48058158742SRafal Jaworowski 
48158158742SRafal Jaworowski int
4828bb93637SOleksandr Tymoshenko fdt_reg_to_rl(phandle_t node, struct resource_list *rl)
48358158742SRafal Jaworowski {
4845ac9d989SAleksandr Rybalko 	u_long end, count, start;
48558158742SRafal Jaworowski 	pcell_t *reg, *regptr;
48658158742SRafal Jaworowski 	pcell_t addr_cells, size_cells;
48758158742SRafal Jaworowski 	int tuple_size, tuples;
48858158742SRafal Jaworowski 	int i, rv;
4898bb93637SOleksandr Tymoshenko 	long busaddr, bussize;
49058158742SRafal Jaworowski 
49158158742SRafal Jaworowski 	if (fdt_addrsize_cells(OF_parent(node), &addr_cells, &size_cells) != 0)
49258158742SRafal Jaworowski 		return (ENXIO);
4932f0da24bSGrzegorz Bernacki 	if (fdt_get_range(OF_parent(node), 0, &busaddr, &bussize)) {
4942f0da24bSGrzegorz Bernacki 		busaddr = 0;
4952f0da24bSGrzegorz Bernacki 		bussize = 0;
4962f0da24bSGrzegorz Bernacki 	}
49758158742SRafal Jaworowski 
49858158742SRafal Jaworowski 	tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
49958158742SRafal Jaworowski 	tuples = OF_getprop_alloc(node, "reg", tuple_size, (void **)&reg);
50058158742SRafal Jaworowski 	debugf("addr_cells = %d, size_cells = %d\n", addr_cells, size_cells);
50158158742SRafal Jaworowski 	debugf("tuples = %d, tuple size = %d\n", tuples, tuple_size);
50258158742SRafal Jaworowski 	if (tuples <= 0)
50358158742SRafal Jaworowski 		/* No 'reg' property in this node. */
50458158742SRafal Jaworowski 		return (0);
50558158742SRafal Jaworowski 
50658158742SRafal Jaworowski 	regptr = reg;
50758158742SRafal Jaworowski 	for (i = 0; i < tuples; i++) {
50858158742SRafal Jaworowski 
5095ac9d989SAleksandr Rybalko 		rv = fdt_data_to_res(reg, addr_cells, size_cells, &start,
5105ac9d989SAleksandr Rybalko 		    &count);
51158158742SRafal Jaworowski 		if (rv != 0) {
51258158742SRafal Jaworowski 			resource_list_free(rl);
51358158742SRafal Jaworowski 			goto out;
51458158742SRafal Jaworowski 		}
51558158742SRafal Jaworowski 		reg += addr_cells + size_cells;
51658158742SRafal Jaworowski 
51758158742SRafal Jaworowski 		/* Calculate address range relative to base. */
5188bb93637SOleksandr Tymoshenko 		start += busaddr;
5194117c1dbSAleksandr Rybalko 		end = start + count - 1;
52058158742SRafal Jaworowski 
5214117c1dbSAleksandr Rybalko 		debugf("reg addr start = %lx, end = %lx, count = %lx\n", start,
52258158742SRafal Jaworowski 		    end, count);
52358158742SRafal Jaworowski 
5244117c1dbSAleksandr Rybalko 		resource_list_add(rl, SYS_RES_MEMORY, i, start, end,
52558158742SRafal Jaworowski 		    count);
52658158742SRafal Jaworowski 	}
52758158742SRafal Jaworowski 	rv = 0;
52858158742SRafal Jaworowski 
52958158742SRafal Jaworowski out:
530bc90a48cSOleksandr Tymoshenko 	OF_prop_free(regptr);
53158158742SRafal Jaworowski 	return (rv);
53258158742SRafal Jaworowski }
53358158742SRafal Jaworowski 
53458158742SRafal Jaworowski int
535aa15e881SRafal Jaworowski fdt_get_phyaddr(phandle_t node, device_t dev, int *phy_addr, void **phy_sc)
53658158742SRafal Jaworowski {
53758158742SRafal Jaworowski 	phandle_t phy_node;
53858158742SRafal Jaworowski 	pcell_t phy_handle, phy_reg;
539aa15e881SRafal Jaworowski 	uint32_t i;
540aa15e881SRafal Jaworowski 	device_t parent, child;
54158158742SRafal Jaworowski 
542755c9591SNathan Whitehorn 	if (OF_getencprop(node, "phy-handle", (void *)&phy_handle,
54358158742SRafal Jaworowski 	    sizeof(phy_handle)) <= 0)
54458158742SRafal Jaworowski 		return (ENXIO);
54558158742SRafal Jaworowski 
546752ba930SIan Lepore 	phy_node = OF_node_from_xref(phy_handle);
54758158742SRafal Jaworowski 
548c6c4276bSAndrew Turner 	if (OF_getencprop(phy_node, "reg", (void *)&phy_reg,
54958158742SRafal Jaworowski 	    sizeof(phy_reg)) <= 0)
55058158742SRafal Jaworowski 		return (ENXIO);
55158158742SRafal Jaworowski 
552c6c4276bSAndrew Turner 	*phy_addr = phy_reg;
553aa15e881SRafal Jaworowski 
554aa15e881SRafal Jaworowski 	/*
555aa15e881SRafal Jaworowski 	 * Search for softc used to communicate with phy.
556aa15e881SRafal Jaworowski 	 */
557aa15e881SRafal Jaworowski 
558aa15e881SRafal Jaworowski 	/*
559aa15e881SRafal Jaworowski 	 * Step 1: Search for ancestor of the phy-node with a "phy-handle"
560aa15e881SRafal Jaworowski 	 * property set.
561aa15e881SRafal Jaworowski 	 */
562aa15e881SRafal Jaworowski 	phy_node = OF_parent(phy_node);
563aa15e881SRafal Jaworowski 	while (phy_node != 0) {
564aa15e881SRafal Jaworowski 		if (OF_getprop(phy_node, "phy-handle", (void *)&phy_handle,
565aa15e881SRafal Jaworowski 		    sizeof(phy_handle)) > 0)
566aa15e881SRafal Jaworowski 			break;
567aa15e881SRafal Jaworowski 		phy_node = OF_parent(phy_node);
568aa15e881SRafal Jaworowski 	}
569aa15e881SRafal Jaworowski 	if (phy_node == 0)
570aa15e881SRafal Jaworowski 		return (ENXIO);
571aa15e881SRafal Jaworowski 
572aa15e881SRafal Jaworowski 	/*
573aa15e881SRafal Jaworowski 	 * Step 2: For each device with the same parent and name as ours
574aa15e881SRafal Jaworowski 	 * compare its node with the one found in step 1, ancestor of phy
575aa15e881SRafal Jaworowski 	 * node (stored in phy_node).
576aa15e881SRafal Jaworowski 	 */
577aa15e881SRafal Jaworowski 	parent = device_get_parent(dev);
578aa15e881SRafal Jaworowski 	i = 0;
579aa15e881SRafal Jaworowski 	child = device_find_child(parent, device_get_name(dev), i);
580aa15e881SRafal Jaworowski 	while (child != NULL) {
581aa15e881SRafal Jaworowski 		if (ofw_bus_get_node(child) == phy_node)
582aa15e881SRafal Jaworowski 			break;
583aa15e881SRafal Jaworowski 		i++;
584aa15e881SRafal Jaworowski 		child = device_find_child(parent, device_get_name(dev), i);
585aa15e881SRafal Jaworowski 	}
586aa15e881SRafal Jaworowski 	if (child == NULL)
587aa15e881SRafal Jaworowski 		return (ENXIO);
588aa15e881SRafal Jaworowski 
589aa15e881SRafal Jaworowski 	/*
590aa15e881SRafal Jaworowski 	 * Use softc of the device found.
591aa15e881SRafal Jaworowski 	 */
592aa15e881SRafal Jaworowski 	*phy_sc = (void *)device_get_softc(child);
593aa15e881SRafal Jaworowski 
59458158742SRafal Jaworowski 	return (0);
59558158742SRafal Jaworowski }
59658158742SRafal Jaworowski 
59758158742SRafal Jaworowski int
5981d1ffd9eSOleksandr Tymoshenko fdt_get_reserved_regions(struct mem_region *mr, int *mrcnt)
5991d1ffd9eSOleksandr Tymoshenko {
6001d1ffd9eSOleksandr Tymoshenko 	pcell_t reserve[FDT_REG_CELLS * FDT_MEM_REGIONS];
6011d1ffd9eSOleksandr Tymoshenko 	pcell_t *reservep;
6021d1ffd9eSOleksandr Tymoshenko 	phandle_t memory, root;
6031d1ffd9eSOleksandr Tymoshenko 	uint32_t memory_size;
6041d1ffd9eSOleksandr Tymoshenko 	int addr_cells, size_cells;
6051d1ffd9eSOleksandr Tymoshenko 	int i, max_size, res_len, rv, tuple_size, tuples;
6061d1ffd9eSOleksandr Tymoshenko 
6071d1ffd9eSOleksandr Tymoshenko 	max_size = sizeof(reserve);
6081d1ffd9eSOleksandr Tymoshenko 	root = OF_finddevice("/");
6091d1ffd9eSOleksandr Tymoshenko 	memory = OF_finddevice("/memory");
6101d1ffd9eSOleksandr Tymoshenko 	if (memory == -1) {
6111d1ffd9eSOleksandr Tymoshenko 		rv = ENXIO;
6121d1ffd9eSOleksandr Tymoshenko 		goto out;
6131d1ffd9eSOleksandr Tymoshenko 	}
6141d1ffd9eSOleksandr Tymoshenko 
6151d1ffd9eSOleksandr Tymoshenko 	if ((rv = fdt_addrsize_cells(OF_parent(memory), &addr_cells,
6161d1ffd9eSOleksandr Tymoshenko 	    &size_cells)) != 0)
6171d1ffd9eSOleksandr Tymoshenko 		goto out;
6181d1ffd9eSOleksandr Tymoshenko 
6191d1ffd9eSOleksandr Tymoshenko 	if (addr_cells > 2) {
6201d1ffd9eSOleksandr Tymoshenko 		rv = ERANGE;
6211d1ffd9eSOleksandr Tymoshenko 		goto out;
6221d1ffd9eSOleksandr Tymoshenko 	}
6231d1ffd9eSOleksandr Tymoshenko 
6241d1ffd9eSOleksandr Tymoshenko 	tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
6251d1ffd9eSOleksandr Tymoshenko 
6261d1ffd9eSOleksandr Tymoshenko 	res_len = OF_getproplen(root, "memreserve");
6271d1ffd9eSOleksandr Tymoshenko 	if (res_len <= 0 || res_len > sizeof(reserve)) {
6281d1ffd9eSOleksandr Tymoshenko 		rv = ERANGE;
6291d1ffd9eSOleksandr Tymoshenko 		goto out;
6301d1ffd9eSOleksandr Tymoshenko 	}
6311d1ffd9eSOleksandr Tymoshenko 
6321d1ffd9eSOleksandr Tymoshenko 	if (OF_getprop(root, "memreserve", reserve, res_len) <= 0) {
6331d1ffd9eSOleksandr Tymoshenko 		rv = ENXIO;
6341d1ffd9eSOleksandr Tymoshenko 		goto out;
6351d1ffd9eSOleksandr Tymoshenko 	}
6361d1ffd9eSOleksandr Tymoshenko 
6371d1ffd9eSOleksandr Tymoshenko 	memory_size = 0;
6381d1ffd9eSOleksandr Tymoshenko 	tuples = res_len / tuple_size;
6391d1ffd9eSOleksandr Tymoshenko 	reservep = (pcell_t *)&reserve;
6401d1ffd9eSOleksandr Tymoshenko 	for (i = 0; i < tuples; i++) {
6411d1ffd9eSOleksandr Tymoshenko 
6421d1ffd9eSOleksandr Tymoshenko 		rv = fdt_data_to_res(reservep, addr_cells, size_cells,
6431d1ffd9eSOleksandr Tymoshenko 			(u_long *)&mr[i].mr_start, (u_long *)&mr[i].mr_size);
6441d1ffd9eSOleksandr Tymoshenko 
6451d1ffd9eSOleksandr Tymoshenko 		if (rv != 0)
6461d1ffd9eSOleksandr Tymoshenko 			goto out;
6471d1ffd9eSOleksandr Tymoshenko 
6481d1ffd9eSOleksandr Tymoshenko 		reservep += addr_cells + size_cells;
6491d1ffd9eSOleksandr Tymoshenko 	}
6501d1ffd9eSOleksandr Tymoshenko 
6511d1ffd9eSOleksandr Tymoshenko 	*mrcnt = i;
6521d1ffd9eSOleksandr Tymoshenko 	rv = 0;
6531d1ffd9eSOleksandr Tymoshenko out:
6541d1ffd9eSOleksandr Tymoshenko 	return (rv);
6551d1ffd9eSOleksandr Tymoshenko }
6561d1ffd9eSOleksandr Tymoshenko 
6571d1ffd9eSOleksandr Tymoshenko int
6589636600cSAndrew Turner fdt_get_mem_regions(struct mem_region *mr, int *mrcnt, uint64_t *memsize)
65958158742SRafal Jaworowski {
66058158742SRafal Jaworowski 	pcell_t reg[FDT_REG_CELLS * FDT_MEM_REGIONS];
66158158742SRafal Jaworowski 	pcell_t *regp;
66258158742SRafal Jaworowski 	phandle_t memory;
6639636600cSAndrew Turner 	uint64_t memory_size;
66458158742SRafal Jaworowski 	int addr_cells, size_cells;
66558158742SRafal Jaworowski 	int i, max_size, reg_len, rv, tuple_size, tuples;
66658158742SRafal Jaworowski 
66758158742SRafal Jaworowski 	max_size = sizeof(reg);
66858158742SRafal Jaworowski 	memory = OF_finddevice("/memory");
66907042befSJayachandran C. 	if (memory == -1) {
67058158742SRafal Jaworowski 		rv = ENXIO;
67158158742SRafal Jaworowski 		goto out;
67258158742SRafal Jaworowski 	}
67358158742SRafal Jaworowski 
67458158742SRafal Jaworowski 	if ((rv = fdt_addrsize_cells(OF_parent(memory), &addr_cells,
67558158742SRafal Jaworowski 	    &size_cells)) != 0)
67658158742SRafal Jaworowski 		goto out;
67758158742SRafal Jaworowski 
67858158742SRafal Jaworowski 	if (addr_cells > 2) {
67958158742SRafal Jaworowski 		rv = ERANGE;
68058158742SRafal Jaworowski 		goto out;
68158158742SRafal Jaworowski 	}
68258158742SRafal Jaworowski 
68358158742SRafal Jaworowski 	tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
68458158742SRafal Jaworowski 	reg_len = OF_getproplen(memory, "reg");
68558158742SRafal Jaworowski 	if (reg_len <= 0 || reg_len > sizeof(reg)) {
68658158742SRafal Jaworowski 		rv = ERANGE;
68758158742SRafal Jaworowski 		goto out;
68858158742SRafal Jaworowski 	}
68958158742SRafal Jaworowski 
69058158742SRafal Jaworowski 	if (OF_getprop(memory, "reg", reg, reg_len) <= 0) {
69158158742SRafal Jaworowski 		rv = ENXIO;
69258158742SRafal Jaworowski 		goto out;
69358158742SRafal Jaworowski 	}
69458158742SRafal Jaworowski 
69558158742SRafal Jaworowski 	memory_size = 0;
69658158742SRafal Jaworowski 	tuples = reg_len / tuple_size;
69758158742SRafal Jaworowski 	regp = (pcell_t *)&reg;
69858158742SRafal Jaworowski 	for (i = 0; i < tuples; i++) {
69958158742SRafal Jaworowski 
70058158742SRafal Jaworowski 		rv = fdt_data_to_res(regp, addr_cells, size_cells,
70158158742SRafal Jaworowski 			(u_long *)&mr[i].mr_start, (u_long *)&mr[i].mr_size);
70258158742SRafal Jaworowski 
70358158742SRafal Jaworowski 		if (rv != 0)
70458158742SRafal Jaworowski 			goto out;
70558158742SRafal Jaworowski 
70658158742SRafal Jaworowski 		regp += addr_cells + size_cells;
70758158742SRafal Jaworowski 		memory_size += mr[i].mr_size;
70858158742SRafal Jaworowski 	}
70958158742SRafal Jaworowski 
71058158742SRafal Jaworowski 	if (memory_size == 0) {
71158158742SRafal Jaworowski 		rv = ERANGE;
71258158742SRafal Jaworowski 		goto out;
71358158742SRafal Jaworowski 	}
71458158742SRafal Jaworowski 
71558158742SRafal Jaworowski 	*mrcnt = i;
716a4376069SAndrew Turner 	if (memsize != NULL)
71758158742SRafal Jaworowski 		*memsize = memory_size;
71858158742SRafal Jaworowski 	rv = 0;
71958158742SRafal Jaworowski out:
72058158742SRafal Jaworowski 	return (rv);
72158158742SRafal Jaworowski }
7222c990564SGrzegorz Bernacki 
7232c990564SGrzegorz Bernacki int
7242c990564SGrzegorz Bernacki fdt_get_unit(device_t dev)
7252c990564SGrzegorz Bernacki {
7262c990564SGrzegorz Bernacki 	const char * name;
7272c990564SGrzegorz Bernacki 
7282c990564SGrzegorz Bernacki 	name = ofw_bus_get_name(dev);
7292c990564SGrzegorz Bernacki 	name = strchr(name, '@') + 1;
7302c990564SGrzegorz Bernacki 
7312c990564SGrzegorz Bernacki 	return (strtol(name,NULL,0));
7322c990564SGrzegorz Bernacki }
733e64c3743SMichal Meloun 
734e64c3743SMichal Meloun int
735e64c3743SMichal Meloun fdt_get_chosen_bootargs(char *bootargs, size_t max_size)
736e64c3743SMichal Meloun {
737e64c3743SMichal Meloun 	phandle_t chosen;
738e64c3743SMichal Meloun 
739e64c3743SMichal Meloun 	chosen = OF_finddevice("/chosen");
740e64c3743SMichal Meloun 	if (chosen == -1)
741e64c3743SMichal Meloun 		return (ENXIO);
742e64c3743SMichal Meloun 	if (OF_getprop(chosen, "bootargs", bootargs, max_size) == -1)
743e64c3743SMichal Meloun 		return (ENXIO);
744e64c3743SMichal Meloun 	return (0);
745e64c3743SMichal Meloun }
746