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", ®, sizeof(reg));
37158158742SRafal Jaworowski if (len <= 0)
37258158742SRafal Jaworowski return (EINVAL);
37358158742SRafal Jaworowski
37458158742SRafal Jaworowski *base = fdt_data_get(®[0], addr_cells);
37558158742SRafal Jaworowski *size = fdt_data_get(®[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 *)®
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