16365985dSRafal Jaworowski /*- 26365985dSRafal Jaworowski * Copyright (c) 2009-2010 The FreeBSD Foundation 36365985dSRafal Jaworowski * All rights reserved. 46365985dSRafal Jaworowski * 56365985dSRafal Jaworowski * This software was developed by Semihalf under sponsorship from 66365985dSRafal Jaworowski * the FreeBSD Foundation. 76365985dSRafal Jaworowski * 86365985dSRafal Jaworowski * Redistribution and use in source and binary forms, with or without 96365985dSRafal Jaworowski * modification, are permitted provided that the following conditions 106365985dSRafal Jaworowski * are met: 116365985dSRafal Jaworowski * 1. Redistributions of source code must retain the above copyright 126365985dSRafal Jaworowski * notice, this list of conditions and the following disclaimer. 136365985dSRafal Jaworowski * 2. Redistributions in binary form must reproduce the above copyright 146365985dSRafal Jaworowski * notice, this list of conditions and the following disclaimer in the 156365985dSRafal Jaworowski * documentation and/or other materials provided with the distribution. 166365985dSRafal Jaworowski * 176365985dSRafal Jaworowski * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 186365985dSRafal Jaworowski * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 196365985dSRafal Jaworowski * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 206365985dSRafal Jaworowski * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 216365985dSRafal Jaworowski * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 226365985dSRafal Jaworowski * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 236365985dSRafal Jaworowski * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 246365985dSRafal Jaworowski * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 256365985dSRafal Jaworowski * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 266365985dSRafal Jaworowski * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 276365985dSRafal Jaworowski * SUCH DAMAGE. 286365985dSRafal Jaworowski */ 296365985dSRafal Jaworowski 306365985dSRafal Jaworowski #include <sys/cdefs.h> 316365985dSRafal Jaworowski __FBSDID("$FreeBSD$"); 326365985dSRafal Jaworowski 336365985dSRafal Jaworowski #include <sys/param.h> 346365985dSRafal Jaworowski #include <sys/kernel.h> 356365985dSRafal Jaworowski #include <sys/malloc.h> 366365985dSRafal Jaworowski #include <sys/systm.h> 376365985dSRafal Jaworowski 386365985dSRafal Jaworowski #include <contrib/libfdt/libfdt.h> 396365985dSRafal Jaworowski 406365985dSRafal Jaworowski #include <machine/stdarg.h> 416365985dSRafal Jaworowski 426365985dSRafal Jaworowski #include <dev/fdt/fdt_common.h> 436365985dSRafal Jaworowski #include <dev/ofw/ofwvar.h> 446365985dSRafal Jaworowski #include <dev/ofw/openfirm.h> 456365985dSRafal Jaworowski 466365985dSRafal Jaworowski #include "ofw_if.h" 476365985dSRafal Jaworowski 486365985dSRafal Jaworowski #ifdef DEBUG 496365985dSRafal Jaworowski #define debugf(fmt, args...) do { printf("%s(): ", __func__); \ 506365985dSRafal Jaworowski printf(fmt,##args); } while (0) 516365985dSRafal Jaworowski #else 526365985dSRafal Jaworowski #define debugf(fmt, args...) 536365985dSRafal Jaworowski #endif 546365985dSRafal Jaworowski 556365985dSRafal Jaworowski static int ofw_fdt_init(ofw_t, void *); 566365985dSRafal Jaworowski static phandle_t ofw_fdt_peer(ofw_t, phandle_t); 576365985dSRafal Jaworowski static phandle_t ofw_fdt_child(ofw_t, phandle_t); 586365985dSRafal Jaworowski static phandle_t ofw_fdt_parent(ofw_t, phandle_t); 596365985dSRafal Jaworowski static phandle_t ofw_fdt_instance_to_package(ofw_t, ihandle_t); 606365985dSRafal Jaworowski static ssize_t ofw_fdt_getproplen(ofw_t, phandle_t, const char *); 616365985dSRafal Jaworowski static ssize_t ofw_fdt_getprop(ofw_t, phandle_t, const char *, void *, size_t); 626365985dSRafal Jaworowski static int ofw_fdt_nextprop(ofw_t, phandle_t, const char *, char *, size_t); 636365985dSRafal Jaworowski static int ofw_fdt_setprop(ofw_t, phandle_t, const char *, const void *, 646365985dSRafal Jaworowski size_t); 656365985dSRafal Jaworowski static ssize_t ofw_fdt_canon(ofw_t, const char *, char *, size_t); 666365985dSRafal Jaworowski static phandle_t ofw_fdt_finddevice(ofw_t, const char *); 676365985dSRafal Jaworowski static ssize_t ofw_fdt_instance_to_path(ofw_t, ihandle_t, char *, size_t); 686365985dSRafal Jaworowski static ssize_t ofw_fdt_package_to_path(ofw_t, phandle_t, char *, size_t); 69cdb25d82SMarius Strobl static int ofw_fdt_interpret(ofw_t, const char *, int, cell_t *); 706365985dSRafal Jaworowski 716365985dSRafal Jaworowski static ofw_method_t ofw_fdt_methods[] = { 726365985dSRafal Jaworowski OFWMETHOD(ofw_init, ofw_fdt_init), 736365985dSRafal Jaworowski OFWMETHOD(ofw_peer, ofw_fdt_peer), 746365985dSRafal Jaworowski OFWMETHOD(ofw_child, ofw_fdt_child), 756365985dSRafal Jaworowski OFWMETHOD(ofw_parent, ofw_fdt_parent), 766365985dSRafal Jaworowski OFWMETHOD(ofw_instance_to_package, ofw_fdt_instance_to_package), 776365985dSRafal Jaworowski OFWMETHOD(ofw_getproplen, ofw_fdt_getproplen), 786365985dSRafal Jaworowski OFWMETHOD(ofw_getprop, ofw_fdt_getprop), 796365985dSRafal Jaworowski OFWMETHOD(ofw_nextprop, ofw_fdt_nextprop), 806365985dSRafal Jaworowski OFWMETHOD(ofw_setprop, ofw_fdt_setprop), 816365985dSRafal Jaworowski OFWMETHOD(ofw_canon, ofw_fdt_canon), 826365985dSRafal Jaworowski OFWMETHOD(ofw_finddevice, ofw_fdt_finddevice), 836365985dSRafal Jaworowski OFWMETHOD(ofw_instance_to_path, ofw_fdt_instance_to_path), 846365985dSRafal Jaworowski OFWMETHOD(ofw_package_to_path, ofw_fdt_package_to_path), 856365985dSRafal Jaworowski OFWMETHOD(ofw_interpret, ofw_fdt_interpret), 866365985dSRafal Jaworowski { 0, 0 } 876365985dSRafal Jaworowski }; 886365985dSRafal Jaworowski 896365985dSRafal Jaworowski static ofw_def_t ofw_fdt = { 906365985dSRafal Jaworowski OFW_FDT, 916365985dSRafal Jaworowski ofw_fdt_methods, 926365985dSRafal Jaworowski 0 936365985dSRafal Jaworowski }; 946365985dSRafal Jaworowski OFW_DEF(ofw_fdt); 956365985dSRafal Jaworowski 966365985dSRafal Jaworowski static void *fdtp = NULL; 976365985dSRafal Jaworowski 986365985dSRafal Jaworowski static int 996365985dSRafal Jaworowski ofw_fdt_init(ofw_t ofw, void *data) 1006365985dSRafal Jaworowski { 1016365985dSRafal Jaworowski int err; 1026365985dSRafal Jaworowski 1036365985dSRafal Jaworowski /* Check FDT blob integrity */ 1046365985dSRafal Jaworowski if ((err = fdt_check_header(data)) != 0) 1056365985dSRafal Jaworowski return (err); 1066365985dSRafal Jaworowski 1076365985dSRafal Jaworowski fdtp = data; 1086365985dSRafal Jaworowski return (0); 1096365985dSRafal Jaworowski } 1106365985dSRafal Jaworowski 1116365985dSRafal Jaworowski /* 112*af6edc28SJayachandran C. * Device tree functions. 113*af6edc28SJayachandran C. * 114*af6edc28SJayachandran C. * We use the offset from fdtp to the node as the 'phandle' in OF interface. 115*af6edc28SJayachandran C. * 116*af6edc28SJayachandran C. * phandle is a u32 value, therefore we cannot use the pointer to node as 117*af6edc28SJayachandran C. * phandle in 64 bit. We also do not use the usual fdt offset as phandle, 118*af6edc28SJayachandran C. * as it can be 0, and the OF interface has special meaning for phandle 0. 1196365985dSRafal Jaworowski */ 1206365985dSRafal Jaworowski 121*af6edc28SJayachandran C. static phandle_t 122*af6edc28SJayachandran C. fdt_offset_phandle(int offset) 123*af6edc28SJayachandran C. { 124*af6edc28SJayachandran C. if (offset < 0) 125*af6edc28SJayachandran C. return (0); 126*af6edc28SJayachandran C. return ((phandle_t)offset + fdt_off_dt_struct(fdtp)); 127*af6edc28SJayachandran C. } 128*af6edc28SJayachandran C. 1296365985dSRafal Jaworowski static int 1306365985dSRafal Jaworowski fdt_phandle_offset(phandle_t p) 1316365985dSRafal Jaworowski { 132*af6edc28SJayachandran C. int pint = (int)p; 133*af6edc28SJayachandran C. int dtoff = fdt_off_dt_struct(fdtp); 134*af6edc28SJayachandran C. 135*af6edc28SJayachandran C. if (pint < dtoff) 136*af6edc28SJayachandran C. return (-1); 137*af6edc28SJayachandran C. return (pint - dtoff); 138*af6edc28SJayachandran C. } 139*af6edc28SJayachandran C. 140*af6edc28SJayachandran C. static int 141*af6edc28SJayachandran C. fdt_pointer_offset(const void *ptr) 142*af6edc28SJayachandran C. { 143*af6edc28SJayachandran C. uintptr_t dt_struct, p; 1446365985dSRafal Jaworowski int offset; 1456365985dSRafal Jaworowski 146*af6edc28SJayachandran C. p = (uintptr_t)ptr; 147*af6edc28SJayachandran C. dt_struct = (uintptr_t)fdtp + fdt_off_dt_struct(fdtp); 1486365985dSRafal Jaworowski 149*af6edc28SJayachandran C. if ((p < dt_struct) || 150*af6edc28SJayachandran C. p > (dt_struct + fdt_size_dt_struct(fdtp))) 1516365985dSRafal Jaworowski return (-1); 1526365985dSRafal Jaworowski 153*af6edc28SJayachandran C. offset = p - dt_struct; 1546365985dSRafal Jaworowski if (offset < 0) 1556365985dSRafal Jaworowski return (-1); 1566365985dSRafal Jaworowski 1576365985dSRafal Jaworowski return (offset); 1586365985dSRafal Jaworowski } 1596365985dSRafal Jaworowski 1606365985dSRafal Jaworowski /* Return the next sibling of this node or 0. */ 1616365985dSRafal Jaworowski static phandle_t 1626365985dSRafal Jaworowski ofw_fdt_peer(ofw_t ofw, phandle_t node) 1636365985dSRafal Jaworowski { 1646365985dSRafal Jaworowski int depth, offset; 1656365985dSRafal Jaworowski 1666365985dSRafal Jaworowski if (node == 0) { 1676365985dSRafal Jaworowski /* Find root node */ 1686365985dSRafal Jaworowski offset = fdt_path_offset(fdtp, "/"); 1696365985dSRafal Jaworowski 170*af6edc28SJayachandran C. return (fdt_offset_phandle(offset)); 1716365985dSRafal Jaworowski } 1726365985dSRafal Jaworowski 1736365985dSRafal Jaworowski offset = fdt_phandle_offset(node); 1746365985dSRafal Jaworowski if (offset < 0) 1756365985dSRafal Jaworowski return (0); 1766365985dSRafal Jaworowski 1776365985dSRafal Jaworowski for (depth = 1, offset = fdt_next_node(fdtp, offset, &depth); 1786365985dSRafal Jaworowski offset >= 0; 1796365985dSRafal Jaworowski offset = fdt_next_node(fdtp, offset, &depth)) { 1806365985dSRafal Jaworowski if (depth < 0) 1816365985dSRafal Jaworowski return (0); 182*af6edc28SJayachandran C. if (depth == 1) 183*af6edc28SJayachandran C. return (fdt_offset_phandle(offset)); 1846365985dSRafal Jaworowski } 1856365985dSRafal Jaworowski 1866365985dSRafal Jaworowski return (0); 1876365985dSRafal Jaworowski } 1886365985dSRafal Jaworowski 1896365985dSRafal Jaworowski /* Return the first child of this node or 0. */ 1906365985dSRafal Jaworowski static phandle_t 1916365985dSRafal Jaworowski ofw_fdt_child(ofw_t ofw, phandle_t node) 1926365985dSRafal Jaworowski { 1936365985dSRafal Jaworowski int depth, offset; 1946365985dSRafal Jaworowski 1956365985dSRafal Jaworowski offset = fdt_phandle_offset(node); 1966365985dSRafal Jaworowski if (offset < 0) 1976365985dSRafal Jaworowski return (0); 1986365985dSRafal Jaworowski 1996365985dSRafal Jaworowski for (depth = 0, offset = fdt_next_node(fdtp, offset, &depth); 2006365985dSRafal Jaworowski (offset >= 0) && (depth > 0); 2016365985dSRafal Jaworowski offset = fdt_next_node(fdtp, offset, &depth)) { 2026365985dSRafal Jaworowski if (depth < 0) 2036365985dSRafal Jaworowski return (0); 204*af6edc28SJayachandran C. if (depth == 1) 205*af6edc28SJayachandran C. return (fdt_offset_phandle(offset)); 2066365985dSRafal Jaworowski } 2076365985dSRafal Jaworowski 2086365985dSRafal Jaworowski return (0); 2096365985dSRafal Jaworowski } 2106365985dSRafal Jaworowski 2116365985dSRafal Jaworowski /* Return the parent of this node or 0. */ 2126365985dSRafal Jaworowski static phandle_t 2136365985dSRafal Jaworowski ofw_fdt_parent(ofw_t ofw, phandle_t node) 2146365985dSRafal Jaworowski { 2156365985dSRafal Jaworowski int offset, paroffset; 2166365985dSRafal Jaworowski 2176365985dSRafal Jaworowski offset = fdt_phandle_offset(node); 2186365985dSRafal Jaworowski if (offset < 0) 2196365985dSRafal Jaworowski return (0); 2206365985dSRafal Jaworowski 2216365985dSRafal Jaworowski paroffset = fdt_parent_offset(fdtp, offset); 222*af6edc28SJayachandran C. return (fdt_offset_phandle(paroffset)); 2236365985dSRafal Jaworowski } 2246365985dSRafal Jaworowski 2256365985dSRafal Jaworowski /* Return the package handle that corresponds to an instance handle. */ 2266365985dSRafal Jaworowski static phandle_t 2276365985dSRafal Jaworowski ofw_fdt_instance_to_package(ofw_t ofw, ihandle_t instance) 2286365985dSRafal Jaworowski { 2296365985dSRafal Jaworowski int offset; 2306365985dSRafal Jaworowski 2316365985dSRafal Jaworowski /* 2326365985dSRafal Jaworowski * Note: FDT does not have the notion of instances, but we somewhat 2336365985dSRafal Jaworowski * abuse the semantics and let treat as 'instance' the internal 2346365985dSRafal Jaworowski * 'phandle' prop, so that ofw I/F consumers have a uniform way of 2356365985dSRafal Jaworowski * translation between internal representation (which appear in some 2366365985dSRafal Jaworowski * contexts as property values) and effective phandles. 2376365985dSRafal Jaworowski */ 2386365985dSRafal Jaworowski offset = fdt_node_offset_by_phandle(fdtp, instance); 2396365985dSRafal Jaworowski if (offset < 0) 24096fe0b35SRafal Jaworowski return (-1); 2416365985dSRafal Jaworowski 242*af6edc28SJayachandran C. return (fdt_offset_phandle(offset)); 2436365985dSRafal Jaworowski } 2446365985dSRafal Jaworowski 2456365985dSRafal Jaworowski /* Get the length of a property of a package. */ 2466365985dSRafal Jaworowski static ssize_t 2476365985dSRafal Jaworowski ofw_fdt_getproplen(ofw_t ofw, phandle_t package, const char *propname) 2486365985dSRafal Jaworowski { 2496365985dSRafal Jaworowski const struct fdt_property *prop; 2506365985dSRafal Jaworowski int offset, len; 2516365985dSRafal Jaworowski 2526365985dSRafal Jaworowski offset = fdt_phandle_offset(package); 2536365985dSRafal Jaworowski if (offset < 0) 25496fe0b35SRafal Jaworowski return (-1); 2556365985dSRafal Jaworowski 2566365985dSRafal Jaworowski if (strcmp(propname, "name") == 0) { 2576365985dSRafal Jaworowski /* Emulate the 'name' property */ 2586365985dSRafal Jaworowski fdt_get_name(fdtp, offset, &len); 2596365985dSRafal Jaworowski return (len + 1); 2606365985dSRafal Jaworowski } 2616365985dSRafal Jaworowski 26296fe0b35SRafal Jaworowski len = -1; 2636365985dSRafal Jaworowski prop = fdt_get_property(fdtp, offset, propname, &len); 2646365985dSRafal Jaworowski 2656365985dSRafal Jaworowski return (len); 2666365985dSRafal Jaworowski } 2676365985dSRafal Jaworowski 2686365985dSRafal Jaworowski /* Get the value of a property of a package. */ 2696365985dSRafal Jaworowski static ssize_t 2706365985dSRafal Jaworowski ofw_fdt_getprop(ofw_t ofw, phandle_t package, const char *propname, void *buf, 2716365985dSRafal Jaworowski size_t buflen) 2726365985dSRafal Jaworowski { 2736365985dSRafal Jaworowski const void *prop; 2746365985dSRafal Jaworowski const char *name; 2756365985dSRafal Jaworowski int len, offset; 2766365985dSRafal Jaworowski 2776365985dSRafal Jaworowski offset = fdt_phandle_offset(package); 2786365985dSRafal Jaworowski if (offset < 0) 27996fe0b35SRafal Jaworowski return (-1); 2806365985dSRafal Jaworowski 2816365985dSRafal Jaworowski if (strcmp(propname, "name") == 0) { 2826365985dSRafal Jaworowski /* Emulate the 'name' property */ 2836365985dSRafal Jaworowski name = fdt_get_name(fdtp, offset, &len); 2846365985dSRafal Jaworowski strncpy(buf, name, buflen); 2856365985dSRafal Jaworowski if (len + 1 > buflen) 2866365985dSRafal Jaworowski len = buflen; 2876365985dSRafal Jaworowski return (len + 1); 2886365985dSRafal Jaworowski } 2896365985dSRafal Jaworowski 2906365985dSRafal Jaworowski prop = fdt_getprop(fdtp, offset, propname, &len); 2916365985dSRafal Jaworowski if (prop == NULL) 29296fe0b35SRafal Jaworowski return (-1); 2936365985dSRafal Jaworowski 2946365985dSRafal Jaworowski if (len > buflen) 2956365985dSRafal Jaworowski len = buflen; 2966365985dSRafal Jaworowski bcopy(prop, buf, len); 2976365985dSRafal Jaworowski return (len); 2986365985dSRafal Jaworowski } 2996365985dSRafal Jaworowski 3006365985dSRafal Jaworowski static int 3016365985dSRafal Jaworowski fdt_nextprop(int offset, char *buf, size_t size) 3026365985dSRafal Jaworowski { 3036365985dSRafal Jaworowski const struct fdt_property *prop; 3046365985dSRafal Jaworowski const char *name; 3056365985dSRafal Jaworowski uint32_t tag; 3066365985dSRafal Jaworowski int nextoffset, depth; 3076365985dSRafal Jaworowski 3086365985dSRafal Jaworowski depth = 0; 3096365985dSRafal Jaworowski tag = fdt_next_tag(fdtp, offset, &nextoffset); 3106365985dSRafal Jaworowski 3116365985dSRafal Jaworowski /* Find the next prop */ 3126365985dSRafal Jaworowski do { 3136365985dSRafal Jaworowski offset = nextoffset; 3146365985dSRafal Jaworowski tag = fdt_next_tag(fdtp, offset, &nextoffset); 3156365985dSRafal Jaworowski 3166365985dSRafal Jaworowski if (tag == FDT_BEGIN_NODE) 3176365985dSRafal Jaworowski depth++; 3186365985dSRafal Jaworowski else if (tag == FDT_END_NODE) 3196365985dSRafal Jaworowski depth--; 3206365985dSRafal Jaworowski else if ((tag == FDT_PROP) && (depth == 0)) { 3216365985dSRafal Jaworowski prop = 3226365985dSRafal Jaworowski (const struct fdt_property *)fdt_offset_ptr(fdtp, 3236365985dSRafal Jaworowski offset, sizeof(*prop)); 3246365985dSRafal Jaworowski name = fdt_string(fdtp, 3256365985dSRafal Jaworowski fdt32_to_cpu(prop->nameoff)); 3266365985dSRafal Jaworowski strncpy(buf, name, size); 3276365985dSRafal Jaworowski return (strlen(name)); 3286365985dSRafal Jaworowski } else 3296365985dSRafal Jaworowski depth = -1; 3306365985dSRafal Jaworowski } while (depth >= 0); 3316365985dSRafal Jaworowski 33296fe0b35SRafal Jaworowski return (-1); 3336365985dSRafal Jaworowski } 3346365985dSRafal Jaworowski 3356365985dSRafal Jaworowski /* 3366365985dSRafal Jaworowski * Get the next property of a package. Return the actual len of retrieved 3376365985dSRafal Jaworowski * prop name. 3386365985dSRafal Jaworowski */ 3396365985dSRafal Jaworowski static int 3406365985dSRafal Jaworowski ofw_fdt_nextprop(ofw_t ofw, phandle_t package, const char *previous, char *buf, 3416365985dSRafal Jaworowski size_t size) 3426365985dSRafal Jaworowski { 3436365985dSRafal Jaworowski const struct fdt_property *prop; 3446365985dSRafal Jaworowski int offset, rv; 3456365985dSRafal Jaworowski 3466365985dSRafal Jaworowski offset = fdt_phandle_offset(package); 3476365985dSRafal Jaworowski if (offset < 0) 34896fe0b35SRafal Jaworowski return (-1); 3496365985dSRafal Jaworowski 3506365985dSRafal Jaworowski if (previous == NULL) 3516365985dSRafal Jaworowski /* Find the first prop in the node */ 3526365985dSRafal Jaworowski return (fdt_nextprop(offset, buf, size)); 3536365985dSRafal Jaworowski 3546365985dSRafal Jaworowski /* 3556365985dSRafal Jaworowski * Advance to the previous prop 3566365985dSRafal Jaworowski */ 3576365985dSRafal Jaworowski prop = fdt_get_property(fdtp, offset, previous, NULL); 3586365985dSRafal Jaworowski if (prop == NULL) 35996fe0b35SRafal Jaworowski return (-1); 3606365985dSRafal Jaworowski 361*af6edc28SJayachandran C. offset = fdt_pointer_offset(prop); 3626365985dSRafal Jaworowski rv = fdt_nextprop(offset, buf, size); 3636365985dSRafal Jaworowski return (rv); 3646365985dSRafal Jaworowski } 3656365985dSRafal Jaworowski 3666365985dSRafal Jaworowski /* Set the value of a property of a package. */ 3676365985dSRafal Jaworowski static int 3686365985dSRafal Jaworowski ofw_fdt_setprop(ofw_t ofw, phandle_t package, const char *propname, 3696365985dSRafal Jaworowski const void *buf, size_t len) 3706365985dSRafal Jaworowski { 3716365985dSRafal Jaworowski int offset; 3726365985dSRafal Jaworowski 3736365985dSRafal Jaworowski offset = fdt_phandle_offset(package); 3746365985dSRafal Jaworowski if (offset < 0) 3756365985dSRafal Jaworowski return (-1); 3766365985dSRafal Jaworowski 3776365985dSRafal Jaworowski return (fdt_setprop_inplace(fdtp, offset, propname, buf, len)); 3786365985dSRafal Jaworowski } 3796365985dSRafal Jaworowski 3806365985dSRafal Jaworowski /* Convert a device specifier to a fully qualified pathname. */ 3816365985dSRafal Jaworowski static ssize_t 3826365985dSRafal Jaworowski ofw_fdt_canon(ofw_t ofw, const char *device, char *buf, size_t len) 3836365985dSRafal Jaworowski { 3846365985dSRafal Jaworowski 3856365985dSRafal Jaworowski return (-1); 3866365985dSRafal Jaworowski } 3876365985dSRafal Jaworowski 3886365985dSRafal Jaworowski /* Return a package handle for the specified device. */ 3896365985dSRafal Jaworowski static phandle_t 3906365985dSRafal Jaworowski ofw_fdt_finddevice(ofw_t ofw, const char *device) 3916365985dSRafal Jaworowski { 3926365985dSRafal Jaworowski int offset; 3936365985dSRafal Jaworowski 3946365985dSRafal Jaworowski offset = fdt_path_offset(fdtp, device); 395*af6edc28SJayachandran C. return (fdt_offset_phandle(offset)); 3966365985dSRafal Jaworowski } 3976365985dSRafal Jaworowski 3986365985dSRafal Jaworowski /* Return the fully qualified pathname corresponding to an instance. */ 3996365985dSRafal Jaworowski static ssize_t 4006365985dSRafal Jaworowski ofw_fdt_instance_to_path(ofw_t ofw, ihandle_t instance, char *buf, size_t len) 4016365985dSRafal Jaworowski { 4026365985dSRafal Jaworowski 4036365985dSRafal Jaworowski return (-1); 4046365985dSRafal Jaworowski } 4056365985dSRafal Jaworowski 4066365985dSRafal Jaworowski /* Return the fully qualified pathname corresponding to a package. */ 4076365985dSRafal Jaworowski static ssize_t 4086365985dSRafal Jaworowski ofw_fdt_package_to_path(ofw_t ofw, phandle_t package, char *buf, size_t len) 4096365985dSRafal Jaworowski { 4106365985dSRafal Jaworowski 4116365985dSRafal Jaworowski return (-1); 4126365985dSRafal Jaworowski } 4136365985dSRafal Jaworowski 4146365985dSRafal Jaworowski static int 4156365985dSRafal Jaworowski ofw_fdt_fixup(ofw_t ofw) 4166365985dSRafal Jaworowski { 4176365985dSRafal Jaworowski #define FDT_MODEL_LEN 80 4186365985dSRafal Jaworowski char model[FDT_MODEL_LEN]; 4196365985dSRafal Jaworowski phandle_t root; 4206365985dSRafal Jaworowski ssize_t len; 4216365985dSRafal Jaworowski int i; 4226365985dSRafal Jaworowski 4236365985dSRafal Jaworowski if ((root = ofw_fdt_finddevice(ofw, "/")) == 0) 4246365985dSRafal Jaworowski return (ENODEV); 4256365985dSRafal Jaworowski 4266365985dSRafal Jaworowski if ((len = ofw_fdt_getproplen(ofw, root, "model")) <= 0) 4276365985dSRafal Jaworowski return (0); 4286365985dSRafal Jaworowski 4296365985dSRafal Jaworowski bzero(model, FDT_MODEL_LEN); 4306365985dSRafal Jaworowski if (ofw_fdt_getprop(ofw, root, "model", model, FDT_MODEL_LEN) <= 0) 4316365985dSRafal Jaworowski return (0); 4326365985dSRafal Jaworowski 4336365985dSRafal Jaworowski /* 4346365985dSRafal Jaworowski * Search fixup table and call handler if appropriate. 4356365985dSRafal Jaworowski */ 4366365985dSRafal Jaworowski for (i = 0; fdt_fixup_table[i].model != NULL; i++) { 4376365985dSRafal Jaworowski if (strncmp(model, fdt_fixup_table[i].model, 4386365985dSRafal Jaworowski FDT_MODEL_LEN) != 0) 4396365985dSRafal Jaworowski continue; 4406365985dSRafal Jaworowski 4416365985dSRafal Jaworowski if (fdt_fixup_table[i].handler != NULL) 4426365985dSRafal Jaworowski (*fdt_fixup_table[i].handler)(root); 4436365985dSRafal Jaworowski } 4446365985dSRafal Jaworowski 4456365985dSRafal Jaworowski return (0); 4466365985dSRafal Jaworowski } 4476365985dSRafal Jaworowski 4486365985dSRafal Jaworowski static int 449cdb25d82SMarius Strobl ofw_fdt_interpret(ofw_t ofw, const char *cmd, int nret, cell_t *retvals) 4506365985dSRafal Jaworowski { 4516365985dSRafal Jaworowski int rv; 4526365985dSRafal Jaworowski 4536365985dSRafal Jaworowski /* 4546365985dSRafal Jaworowski * Note: FDT does not have the possibility to 'interpret' commands, 4556365985dSRafal Jaworowski * but we abuse the interface a bit to use it for doing non-standard 4566365985dSRafal Jaworowski * operations on the device tree blob. 4576365985dSRafal Jaworowski * 4586365985dSRafal Jaworowski * Currently the only supported 'command' is to trigger performing 4596365985dSRafal Jaworowski * fixups. 4606365985dSRafal Jaworowski */ 4616365985dSRafal Jaworowski if (strncmp("perform-fixup", cmd, 13) != 0) 4626365985dSRafal Jaworowski return (0); 4636365985dSRafal Jaworowski 4646365985dSRafal Jaworowski rv = ofw_fdt_fixup(ofw); 4656365985dSRafal Jaworowski if (nret > 0) 4666365985dSRafal Jaworowski retvals[0] = rv; 4676365985dSRafal Jaworowski 4686365985dSRafal Jaworowski return (rv); 4696365985dSRafal Jaworowski } 470