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", ®, sizeof(reg)); 47358158742SRafal Jaworowski if (len <= 0) 47458158742SRafal Jaworowski return (EINVAL); 47558158742SRafal Jaworowski 47658158742SRafal Jaworowski *base = fdt_data_get(®[0], addr_cells); 47758158742SRafal Jaworowski *size = fdt_data_get(®[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 **)®); 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 *)® 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