xref: /freebsd/sys/dev/ofw/ofw_fdt.c (revision af6edc28545a98e5d9b817a87a9d1f5e30d05fc4)
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