xref: /freebsd/sys/contrib/libfdt/fdt_overlay.c (revision 1a4529b5e5cd270938c89a6c329894c2abcdd1f7)
1*1a4529b5SKyle Evans /*
2*1a4529b5SKyle Evans  * libfdt - Flat Device Tree manipulation
3*1a4529b5SKyle Evans  * Copyright (C) 2016 Free Electrons
4*1a4529b5SKyle Evans  * Copyright (C) 2016 NextThing Co.
5*1a4529b5SKyle Evans  *
6*1a4529b5SKyle Evans  * libfdt is dual licensed: you can use it either under the terms of
7*1a4529b5SKyle Evans  * the GPL, or the BSD license, at your option.
8*1a4529b5SKyle Evans  *
9*1a4529b5SKyle Evans  *  a) This library is free software; you can redistribute it and/or
10*1a4529b5SKyle Evans  *     modify it under the terms of the GNU General Public License as
11*1a4529b5SKyle Evans  *     published by the Free Software Foundation; either version 2 of the
12*1a4529b5SKyle Evans  *     License, or (at your option) any later version.
13*1a4529b5SKyle Evans  *
14*1a4529b5SKyle Evans  *     This library is distributed in the hope that it will be useful,
15*1a4529b5SKyle Evans  *     but WITHOUT ANY WARRANTY; without even the implied warranty of
16*1a4529b5SKyle Evans  *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17*1a4529b5SKyle Evans  *     GNU General Public License for more details.
18*1a4529b5SKyle Evans  *
19*1a4529b5SKyle Evans  *     You should have received a copy of the GNU General Public
20*1a4529b5SKyle Evans  *     License along with this library; if not, write to the Free
21*1a4529b5SKyle Evans  *     Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
22*1a4529b5SKyle Evans  *     MA 02110-1301 USA
23*1a4529b5SKyle Evans  *
24*1a4529b5SKyle Evans  * Alternatively,
25*1a4529b5SKyle Evans  *
26*1a4529b5SKyle Evans  *  b) Redistribution and use in source and binary forms, with or
27*1a4529b5SKyle Evans  *     without modification, are permitted provided that the following
28*1a4529b5SKyle Evans  *     conditions are met:
29*1a4529b5SKyle Evans  *
30*1a4529b5SKyle Evans  *     1. Redistributions of source code must retain the above
31*1a4529b5SKyle Evans  *        copyright notice, this list of conditions and the following
32*1a4529b5SKyle Evans  *        disclaimer.
33*1a4529b5SKyle Evans  *     2. Redistributions in binary form must reproduce the above
34*1a4529b5SKyle Evans  *        copyright notice, this list of conditions and the following
35*1a4529b5SKyle Evans  *        disclaimer in the documentation and/or other materials
36*1a4529b5SKyle Evans  *        provided with the distribution.
37*1a4529b5SKyle Evans  *
38*1a4529b5SKyle Evans  *     THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
39*1a4529b5SKyle Evans  *     CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
40*1a4529b5SKyle Evans  *     INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
41*1a4529b5SKyle Evans  *     MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
42*1a4529b5SKyle Evans  *     DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
43*1a4529b5SKyle Evans  *     CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
44*1a4529b5SKyle Evans  *     SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
45*1a4529b5SKyle Evans  *     NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
46*1a4529b5SKyle Evans  *     LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
47*1a4529b5SKyle Evans  *     HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
48*1a4529b5SKyle Evans  *     CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
49*1a4529b5SKyle Evans  *     OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
50*1a4529b5SKyle Evans  *     EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
51*1a4529b5SKyle Evans  */
526780e684SKyle Evans #include "libfdt_env.h"
536780e684SKyle Evans 
546780e684SKyle Evans #include <fdt.h>
556780e684SKyle Evans #include <libfdt.h>
566780e684SKyle Evans 
576780e684SKyle Evans #include "libfdt_internal.h"
586780e684SKyle Evans 
596780e684SKyle Evans /**
606780e684SKyle Evans  * overlay_get_target_phandle - retrieves the target phandle of a fragment
616780e684SKyle Evans  * @fdto: pointer to the device tree overlay blob
626780e684SKyle Evans  * @fragment: node offset of the fragment in the overlay
636780e684SKyle Evans  *
646780e684SKyle Evans  * overlay_get_target_phandle() retrieves the target phandle of an
656780e684SKyle Evans  * overlay fragment when that fragment uses a phandle (target
666780e684SKyle Evans  * property) instead of a path (target-path property).
676780e684SKyle Evans  *
686780e684SKyle Evans  * returns:
696780e684SKyle Evans  *      the phandle pointed by the target property
706780e684SKyle Evans  *      0, if the phandle was not found
716780e684SKyle Evans  *	-1, if the phandle was malformed
726780e684SKyle Evans  */
overlay_get_target_phandle(const void * fdto,int fragment)736780e684SKyle Evans static uint32_t overlay_get_target_phandle(const void *fdto, int fragment)
746780e684SKyle Evans {
756780e684SKyle Evans 	const fdt32_t *val;
766780e684SKyle Evans 	int len;
776780e684SKyle Evans 
786780e684SKyle Evans 	val = fdt_getprop(fdto, fragment, "target", &len);
796780e684SKyle Evans 	if (!val)
806780e684SKyle Evans 		return 0;
816780e684SKyle Evans 
826780e684SKyle Evans 	if ((len != sizeof(*val)) || (fdt32_to_cpu(*val) == (uint32_t)-1))
836780e684SKyle Evans 		return (uint32_t)-1;
846780e684SKyle Evans 
856780e684SKyle Evans 	return fdt32_to_cpu(*val);
866780e684SKyle Evans }
876780e684SKyle Evans 
886780e684SKyle Evans /**
896780e684SKyle Evans  * overlay_get_target - retrieves the offset of a fragment's target
906780e684SKyle Evans  * @fdt: Base device tree blob
916780e684SKyle Evans  * @fdto: Device tree overlay blob
926780e684SKyle Evans  * @fragment: node offset of the fragment in the overlay
936780e684SKyle Evans  * @pathp: pointer which receives the path of the target (or NULL)
946780e684SKyle Evans  *
956780e684SKyle Evans  * overlay_get_target() retrieves the target offset in the base
966780e684SKyle Evans  * device tree of a fragment, no matter how the actual targetting is
976780e684SKyle Evans  * done (through a phandle or a path)
986780e684SKyle Evans  *
996780e684SKyle Evans  * returns:
1006780e684SKyle Evans  *      the targetted node offset in the base device tree
1016780e684SKyle Evans  *      Negative error code on error
1026780e684SKyle Evans  */
overlay_get_target(const void * fdt,const void * fdto,int fragment,char const ** pathp)1036780e684SKyle Evans static int overlay_get_target(const void *fdt, const void *fdto,
1046780e684SKyle Evans 			      int fragment, char const **pathp)
1056780e684SKyle Evans {
1066780e684SKyle Evans 	uint32_t phandle;
1076780e684SKyle Evans 	const char *path = NULL;
1086780e684SKyle Evans 	int path_len = 0, ret;
1096780e684SKyle Evans 
1106780e684SKyle Evans 	/* Try first to do a phandle based lookup */
1116780e684SKyle Evans 	phandle = overlay_get_target_phandle(fdto, fragment);
1126780e684SKyle Evans 	if (phandle == (uint32_t)-1)
1136780e684SKyle Evans 		return -FDT_ERR_BADPHANDLE;
1146780e684SKyle Evans 
1156780e684SKyle Evans 	/* no phandle, try path */
1166780e684SKyle Evans 	if (!phandle) {
1176780e684SKyle Evans 		/* And then a path based lookup */
1186780e684SKyle Evans 		path = fdt_getprop(fdto, fragment, "target-path", &path_len);
1196780e684SKyle Evans 		if (path)
1206780e684SKyle Evans 			ret = fdt_path_offset(fdt, path);
1216780e684SKyle Evans 		else
1226780e684SKyle Evans 			ret = path_len;
1236780e684SKyle Evans 	} else
1246780e684SKyle Evans 		ret = fdt_node_offset_by_phandle(fdt, phandle);
1256780e684SKyle Evans 
1266780e684SKyle Evans 	/*
1276780e684SKyle Evans 	* If we haven't found either a target or a
1286780e684SKyle Evans 	* target-path property in a node that contains a
1296780e684SKyle Evans 	* __overlay__ subnode (we wouldn't be called
1306780e684SKyle Evans 	* otherwise), consider it a improperly written
1316780e684SKyle Evans 	* overlay
1326780e684SKyle Evans 	*/
1336780e684SKyle Evans 	if (ret < 0 && path_len == -FDT_ERR_NOTFOUND)
1346780e684SKyle Evans 		ret = -FDT_ERR_BADOVERLAY;
1356780e684SKyle Evans 
1366780e684SKyle Evans 	/* return on error */
1376780e684SKyle Evans 	if (ret < 0)
1386780e684SKyle Evans 		return ret;
1396780e684SKyle Evans 
1406780e684SKyle Evans 	/* return pointer to path (if available) */
1416780e684SKyle Evans 	if (pathp)
1426780e684SKyle Evans 		*pathp = path ? path : NULL;
1436780e684SKyle Evans 
1446780e684SKyle Evans 	return ret;
1456780e684SKyle Evans }
1466780e684SKyle Evans 
1476780e684SKyle Evans /**
1486780e684SKyle Evans  * overlay_phandle_add_offset - Increases a phandle by an offset
1496780e684SKyle Evans  * @fdt: Base device tree blob
1506780e684SKyle Evans  * @node: Device tree overlay blob
1516780e684SKyle Evans  * @name: Name of the property to modify (phandle or linux,phandle)
1526780e684SKyle Evans  * @delta: offset to apply
1536780e684SKyle Evans  *
1546780e684SKyle Evans  * overlay_phandle_add_offset() increments a node phandle by a given
1556780e684SKyle Evans  * offset.
1566780e684SKyle Evans  *
1576780e684SKyle Evans  * returns:
1586780e684SKyle Evans  *      0 on success.
1596780e684SKyle Evans  *      Negative error code on error
1606780e684SKyle Evans  */
overlay_phandle_add_offset(void * fdt,int node,const char * name,uint32_t delta)1616780e684SKyle Evans static int overlay_phandle_add_offset(void *fdt, int node,
1626780e684SKyle Evans 				      const char *name, uint32_t delta)
1636780e684SKyle Evans {
1646780e684SKyle Evans 	const fdt32_t *val;
1656780e684SKyle Evans 	uint32_t adj_val;
1666780e684SKyle Evans 	int len;
1676780e684SKyle Evans 
1686780e684SKyle Evans 	val = fdt_getprop(fdt, node, name, &len);
1696780e684SKyle Evans 	if (!val)
1706780e684SKyle Evans 		return len;
1716780e684SKyle Evans 
1726780e684SKyle Evans 	if (len != sizeof(*val))
1736780e684SKyle Evans 		return -FDT_ERR_BADPHANDLE;
1746780e684SKyle Evans 
1756780e684SKyle Evans 	adj_val = fdt32_to_cpu(*val);
1766780e684SKyle Evans 	if ((adj_val + delta) < adj_val)
1776780e684SKyle Evans 		return -FDT_ERR_NOPHANDLES;
1786780e684SKyle Evans 
1796780e684SKyle Evans 	adj_val += delta;
1806780e684SKyle Evans 	if (adj_val == (uint32_t)-1)
1816780e684SKyle Evans 		return -FDT_ERR_NOPHANDLES;
1826780e684SKyle Evans 
1836780e684SKyle Evans 	return fdt_setprop_inplace_u32(fdt, node, name, adj_val);
1846780e684SKyle Evans }
1856780e684SKyle Evans 
1866780e684SKyle Evans /**
1876780e684SKyle Evans  * overlay_adjust_node_phandles - Offsets the phandles of a node
1886780e684SKyle Evans  * @fdto: Device tree overlay blob
1896780e684SKyle Evans  * @node: Offset of the node we want to adjust
1906780e684SKyle Evans  * @delta: Offset to shift the phandles of
1916780e684SKyle Evans  *
1926780e684SKyle Evans  * overlay_adjust_node_phandles() adds a constant to all the phandles
1936780e684SKyle Evans  * of a given node. This is mainly use as part of the overlay
1946780e684SKyle Evans  * application process, when we want to update all the overlay
1956780e684SKyle Evans  * phandles to not conflict with the overlays of the base device tree.
1966780e684SKyle Evans  *
1976780e684SKyle Evans  * returns:
1986780e684SKyle Evans  *      0 on success
1996780e684SKyle Evans  *      Negative error code on failure
2006780e684SKyle Evans  */
overlay_adjust_node_phandles(void * fdto,int node,uint32_t delta)2016780e684SKyle Evans static int overlay_adjust_node_phandles(void *fdto, int node,
2026780e684SKyle Evans 					uint32_t delta)
2036780e684SKyle Evans {
2046780e684SKyle Evans 	int child;
2056780e684SKyle Evans 	int ret;
2066780e684SKyle Evans 
2076780e684SKyle Evans 	ret = overlay_phandle_add_offset(fdto, node, "phandle", delta);
2086780e684SKyle Evans 	if (ret && ret != -FDT_ERR_NOTFOUND)
2096780e684SKyle Evans 		return ret;
2106780e684SKyle Evans 
2116780e684SKyle Evans 	ret = overlay_phandle_add_offset(fdto, node, "linux,phandle", delta);
2126780e684SKyle Evans 	if (ret && ret != -FDT_ERR_NOTFOUND)
2136780e684SKyle Evans 		return ret;
2146780e684SKyle Evans 
2156780e684SKyle Evans 	fdt_for_each_subnode(child, fdto, node) {
2166780e684SKyle Evans 		ret = overlay_adjust_node_phandles(fdto, child, delta);
2176780e684SKyle Evans 		if (ret)
2186780e684SKyle Evans 			return ret;
2196780e684SKyle Evans 	}
2206780e684SKyle Evans 
2216780e684SKyle Evans 	return 0;
2226780e684SKyle Evans }
2236780e684SKyle Evans 
2246780e684SKyle Evans /**
2256780e684SKyle Evans  * overlay_adjust_local_phandles - Adjust the phandles of a whole overlay
2266780e684SKyle Evans  * @fdto: Device tree overlay blob
2276780e684SKyle Evans  * @delta: Offset to shift the phandles of
2286780e684SKyle Evans  *
2296780e684SKyle Evans  * overlay_adjust_local_phandles() adds a constant to all the
2306780e684SKyle Evans  * phandles of an overlay. This is mainly use as part of the overlay
2316780e684SKyle Evans  * application process, when we want to update all the overlay
2326780e684SKyle Evans  * phandles to not conflict with the overlays of the base device tree.
2336780e684SKyle Evans  *
2346780e684SKyle Evans  * returns:
2356780e684SKyle Evans  *      0 on success
2366780e684SKyle Evans  *      Negative error code on failure
2376780e684SKyle Evans  */
overlay_adjust_local_phandles(void * fdto,uint32_t delta)2386780e684SKyle Evans static int overlay_adjust_local_phandles(void *fdto, uint32_t delta)
2396780e684SKyle Evans {
2406780e684SKyle Evans 	/*
2416780e684SKyle Evans 	 * Start adjusting the phandles from the overlay root
2426780e684SKyle Evans 	 */
2436780e684SKyle Evans 	return overlay_adjust_node_phandles(fdto, 0, delta);
2446780e684SKyle Evans }
2456780e684SKyle Evans 
2466780e684SKyle Evans /**
2476780e684SKyle Evans  * overlay_update_local_node_references - Adjust the overlay references
2486780e684SKyle Evans  * @fdto: Device tree overlay blob
2496780e684SKyle Evans  * @tree_node: Node offset of the node to operate on
2506780e684SKyle Evans  * @fixup_node: Node offset of the matching local fixups node
2516780e684SKyle Evans  * @delta: Offset to shift the phandles of
2526780e684SKyle Evans  *
2536780e684SKyle Evans  * overlay_update_local_nodes_references() update the phandles
2546780e684SKyle Evans  * pointing to a node within the device tree overlay by adding a
2556780e684SKyle Evans  * constant delta.
2566780e684SKyle Evans  *
2576780e684SKyle Evans  * This is mainly used as part of a device tree application process,
2586780e684SKyle Evans  * where you want the device tree overlays phandles to not conflict
2596780e684SKyle Evans  * with the ones from the base device tree before merging them.
2606780e684SKyle Evans  *
2616780e684SKyle Evans  * returns:
2626780e684SKyle Evans  *      0 on success
2636780e684SKyle Evans  *      Negative error code on failure
2646780e684SKyle Evans  */
overlay_update_local_node_references(void * fdto,int tree_node,int fixup_node,uint32_t delta)2656780e684SKyle Evans static int overlay_update_local_node_references(void *fdto,
2666780e684SKyle Evans 						int tree_node,
2676780e684SKyle Evans 						int fixup_node,
2686780e684SKyle Evans 						uint32_t delta)
2696780e684SKyle Evans {
2706780e684SKyle Evans 	int fixup_prop;
2716780e684SKyle Evans 	int fixup_child;
2726780e684SKyle Evans 	int ret;
2736780e684SKyle Evans 
2746780e684SKyle Evans 	fdt_for_each_property_offset(fixup_prop, fdto, fixup_node) {
2756780e684SKyle Evans 		const fdt32_t *fixup_val;
2766780e684SKyle Evans 		const char *tree_val;
2776780e684SKyle Evans 		const char *name;
2786780e684SKyle Evans 		int fixup_len;
2796780e684SKyle Evans 		int tree_len;
2806780e684SKyle Evans 		int i;
2816780e684SKyle Evans 
2826780e684SKyle Evans 		fixup_val = fdt_getprop_by_offset(fdto, fixup_prop,
2836780e684SKyle Evans 						  &name, &fixup_len);
2846780e684SKyle Evans 		if (!fixup_val)
2856780e684SKyle Evans 			return fixup_len;
2866780e684SKyle Evans 
2876780e684SKyle Evans 		if (fixup_len % sizeof(uint32_t))
2886780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
2896780e684SKyle Evans 
2906780e684SKyle Evans 		tree_val = fdt_getprop(fdto, tree_node, name, &tree_len);
2916780e684SKyle Evans 		if (!tree_val) {
2926780e684SKyle Evans 			if (tree_len == -FDT_ERR_NOTFOUND)
2936780e684SKyle Evans 				return -FDT_ERR_BADOVERLAY;
2946780e684SKyle Evans 
2956780e684SKyle Evans 			return tree_len;
2966780e684SKyle Evans 		}
2976780e684SKyle Evans 
2986780e684SKyle Evans 		for (i = 0; i < (fixup_len / sizeof(uint32_t)); i++) {
2996780e684SKyle Evans 			fdt32_t adj_val;
3006780e684SKyle Evans 			uint32_t poffset;
3016780e684SKyle Evans 
3026780e684SKyle Evans 			poffset = fdt32_to_cpu(fixup_val[i]);
3036780e684SKyle Evans 
3046780e684SKyle Evans 			/*
3056780e684SKyle Evans 			 * phandles to fixup can be unaligned.
3066780e684SKyle Evans 			 *
3076780e684SKyle Evans 			 * Use a memcpy for the architectures that do
3086780e684SKyle Evans 			 * not support unaligned accesses.
3096780e684SKyle Evans 			 */
3106780e684SKyle Evans 			memcpy(&adj_val, tree_val + poffset, sizeof(adj_val));
3116780e684SKyle Evans 
3126780e684SKyle Evans 			adj_val = cpu_to_fdt32(fdt32_to_cpu(adj_val) + delta);
3136780e684SKyle Evans 
3146780e684SKyle Evans 			ret = fdt_setprop_inplace_namelen_partial(fdto,
3156780e684SKyle Evans 								  tree_node,
3166780e684SKyle Evans 								  name,
3176780e684SKyle Evans 								  strlen(name),
3186780e684SKyle Evans 								  poffset,
3196780e684SKyle Evans 								  &adj_val,
3206780e684SKyle Evans 								  sizeof(adj_val));
3216780e684SKyle Evans 			if (ret == -FDT_ERR_NOSPACE)
3226780e684SKyle Evans 				return -FDT_ERR_BADOVERLAY;
3236780e684SKyle Evans 
3246780e684SKyle Evans 			if (ret)
3256780e684SKyle Evans 				return ret;
3266780e684SKyle Evans 		}
3276780e684SKyle Evans 	}
3286780e684SKyle Evans 
3296780e684SKyle Evans 	fdt_for_each_subnode(fixup_child, fdto, fixup_node) {
3306780e684SKyle Evans 		const char *fixup_child_name = fdt_get_name(fdto, fixup_child,
3316780e684SKyle Evans 							    NULL);
3326780e684SKyle Evans 		int tree_child;
3336780e684SKyle Evans 
3346780e684SKyle Evans 		tree_child = fdt_subnode_offset(fdto, tree_node,
3356780e684SKyle Evans 						fixup_child_name);
3366780e684SKyle Evans 		if (tree_child == -FDT_ERR_NOTFOUND)
3376780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
3386780e684SKyle Evans 		if (tree_child < 0)
3396780e684SKyle Evans 			return tree_child;
3406780e684SKyle Evans 
3416780e684SKyle Evans 		ret = overlay_update_local_node_references(fdto,
3426780e684SKyle Evans 							   tree_child,
3436780e684SKyle Evans 							   fixup_child,
3446780e684SKyle Evans 							   delta);
3456780e684SKyle Evans 		if (ret)
3466780e684SKyle Evans 			return ret;
3476780e684SKyle Evans 	}
3486780e684SKyle Evans 
3496780e684SKyle Evans 	return 0;
3506780e684SKyle Evans }
3516780e684SKyle Evans 
3526780e684SKyle Evans /**
3536780e684SKyle Evans  * overlay_update_local_references - Adjust the overlay references
3546780e684SKyle Evans  * @fdto: Device tree overlay blob
3556780e684SKyle Evans  * @delta: Offset to shift the phandles of
3566780e684SKyle Evans  *
3576780e684SKyle Evans  * overlay_update_local_references() update all the phandles pointing
3586780e684SKyle Evans  * to a node within the device tree overlay by adding a constant
3596780e684SKyle Evans  * delta to not conflict with the base overlay.
3606780e684SKyle Evans  *
3616780e684SKyle Evans  * This is mainly used as part of a device tree application process,
3626780e684SKyle Evans  * where you want the device tree overlays phandles to not conflict
3636780e684SKyle Evans  * with the ones from the base device tree before merging them.
3646780e684SKyle Evans  *
3656780e684SKyle Evans  * returns:
3666780e684SKyle Evans  *      0 on success
3676780e684SKyle Evans  *      Negative error code on failure
3686780e684SKyle Evans  */
overlay_update_local_references(void * fdto,uint32_t delta)3696780e684SKyle Evans static int overlay_update_local_references(void *fdto, uint32_t delta)
3706780e684SKyle Evans {
3716780e684SKyle Evans 	int fixups;
3726780e684SKyle Evans 
3736780e684SKyle Evans 	fixups = fdt_path_offset(fdto, "/__local_fixups__");
3746780e684SKyle Evans 	if (fixups < 0) {
3756780e684SKyle Evans 		/* There's no local phandles to adjust, bail out */
3766780e684SKyle Evans 		if (fixups == -FDT_ERR_NOTFOUND)
3776780e684SKyle Evans 			return 0;
3786780e684SKyle Evans 
3796780e684SKyle Evans 		return fixups;
3806780e684SKyle Evans 	}
3816780e684SKyle Evans 
3826780e684SKyle Evans 	/*
3836780e684SKyle Evans 	 * Update our local references from the root of the tree
3846780e684SKyle Evans 	 */
3856780e684SKyle Evans 	return overlay_update_local_node_references(fdto, 0, fixups,
3866780e684SKyle Evans 						    delta);
3876780e684SKyle Evans }
3886780e684SKyle Evans 
3896780e684SKyle Evans /**
3906780e684SKyle Evans  * overlay_fixup_one_phandle - Set an overlay phandle to the base one
3916780e684SKyle Evans  * @fdt: Base Device Tree blob
3926780e684SKyle Evans  * @fdto: Device tree overlay blob
3936780e684SKyle Evans  * @symbols_off: Node offset of the symbols node in the base device tree
3946780e684SKyle Evans  * @path: Path to a node holding a phandle in the overlay
3956780e684SKyle Evans  * @path_len: number of path characters to consider
3966780e684SKyle Evans  * @name: Name of the property holding the phandle reference in the overlay
3976780e684SKyle Evans  * @name_len: number of name characters to consider
3986780e684SKyle Evans  * @poffset: Offset within the overlay property where the phandle is stored
3996780e684SKyle Evans  * @label: Label of the node referenced by the phandle
4006780e684SKyle Evans  *
4016780e684SKyle Evans  * overlay_fixup_one_phandle() resolves an overlay phandle pointing to
4026780e684SKyle Evans  * a node in the base device tree.
4036780e684SKyle Evans  *
4046780e684SKyle Evans  * This is part of the device tree overlay application process, when
4056780e684SKyle Evans  * you want all the phandles in the overlay to point to the actual
4066780e684SKyle Evans  * base dt nodes.
4076780e684SKyle Evans  *
4086780e684SKyle Evans  * returns:
4096780e684SKyle Evans  *      0 on success
4106780e684SKyle Evans  *      Negative error code on failure
4116780e684SKyle Evans  */
overlay_fixup_one_phandle(void * fdt,void * fdto,int symbols_off,const char * path,uint32_t path_len,const char * name,uint32_t name_len,int poffset,const char * label)4126780e684SKyle Evans static int overlay_fixup_one_phandle(void *fdt, void *fdto,
4136780e684SKyle Evans 				     int symbols_off,
4146780e684SKyle Evans 				     const char *path, uint32_t path_len,
4156780e684SKyle Evans 				     const char *name, uint32_t name_len,
4166780e684SKyle Evans 				     int poffset, const char *label)
4176780e684SKyle Evans {
4186780e684SKyle Evans 	const char *symbol_path;
4196780e684SKyle Evans 	uint32_t phandle;
4206780e684SKyle Evans 	fdt32_t phandle_prop;
4216780e684SKyle Evans 	int symbol_off, fixup_off;
4226780e684SKyle Evans 	int prop_len;
4236780e684SKyle Evans 
4246780e684SKyle Evans 	if (symbols_off < 0)
4256780e684SKyle Evans 		return symbols_off;
4266780e684SKyle Evans 
4276780e684SKyle Evans 	symbol_path = fdt_getprop(fdt, symbols_off, label,
4286780e684SKyle Evans 				  &prop_len);
4296780e684SKyle Evans 	if (!symbol_path)
4306780e684SKyle Evans 		return prop_len;
4316780e684SKyle Evans 
4326780e684SKyle Evans 	symbol_off = fdt_path_offset(fdt, symbol_path);
4336780e684SKyle Evans 	if (symbol_off < 0)
4346780e684SKyle Evans 		return symbol_off;
4356780e684SKyle Evans 
4366780e684SKyle Evans 	phandle = fdt_get_phandle(fdt, symbol_off);
4376780e684SKyle Evans 	if (!phandle)
4386780e684SKyle Evans 		return -FDT_ERR_NOTFOUND;
4396780e684SKyle Evans 
4406780e684SKyle Evans 	fixup_off = fdt_path_offset_namelen(fdto, path, path_len);
4416780e684SKyle Evans 	if (fixup_off == -FDT_ERR_NOTFOUND)
4426780e684SKyle Evans 		return -FDT_ERR_BADOVERLAY;
4436780e684SKyle Evans 	if (fixup_off < 0)
4446780e684SKyle Evans 		return fixup_off;
4456780e684SKyle Evans 
4466780e684SKyle Evans 	phandle_prop = cpu_to_fdt32(phandle);
4476780e684SKyle Evans 	return fdt_setprop_inplace_namelen_partial(fdto, fixup_off,
4486780e684SKyle Evans 						   name, name_len, poffset,
4496780e684SKyle Evans 						   &phandle_prop,
4506780e684SKyle Evans 						   sizeof(phandle_prop));
4516780e684SKyle Evans };
4526780e684SKyle Evans 
4536780e684SKyle Evans /**
4546780e684SKyle Evans  * overlay_fixup_phandle - Set an overlay phandle to the base one
4556780e684SKyle Evans  * @fdt: Base Device Tree blob
4566780e684SKyle Evans  * @fdto: Device tree overlay blob
4576780e684SKyle Evans  * @symbols_off: Node offset of the symbols node in the base device tree
4586780e684SKyle Evans  * @property: Property offset in the overlay holding the list of fixups
4596780e684SKyle Evans  *
4606780e684SKyle Evans  * overlay_fixup_phandle() resolves all the overlay phandles pointed
4616780e684SKyle Evans  * to in a __fixups__ property, and updates them to match the phandles
4626780e684SKyle Evans  * in use in the base device tree.
4636780e684SKyle Evans  *
4646780e684SKyle Evans  * This is part of the device tree overlay application process, when
4656780e684SKyle Evans  * you want all the phandles in the overlay to point to the actual
4666780e684SKyle Evans  * base dt nodes.
4676780e684SKyle Evans  *
4686780e684SKyle Evans  * returns:
4696780e684SKyle Evans  *      0 on success
4706780e684SKyle Evans  *      Negative error code on failure
4716780e684SKyle Evans  */
overlay_fixup_phandle(void * fdt,void * fdto,int symbols_off,int property)4726780e684SKyle Evans static int overlay_fixup_phandle(void *fdt, void *fdto, int symbols_off,
4736780e684SKyle Evans 				 int property)
4746780e684SKyle Evans {
4756780e684SKyle Evans 	const char *value;
4766780e684SKyle Evans 	const char *label;
4776780e684SKyle Evans 	int len;
4786780e684SKyle Evans 
4796780e684SKyle Evans 	value = fdt_getprop_by_offset(fdto, property,
4806780e684SKyle Evans 				      &label, &len);
4816780e684SKyle Evans 	if (!value) {
4826780e684SKyle Evans 		if (len == -FDT_ERR_NOTFOUND)
4836780e684SKyle Evans 			return -FDT_ERR_INTERNAL;
4846780e684SKyle Evans 
4856780e684SKyle Evans 		return len;
4866780e684SKyle Evans 	}
4876780e684SKyle Evans 
4886780e684SKyle Evans 	do {
4896780e684SKyle Evans 		const char *path, *name, *fixup_end;
4906780e684SKyle Evans 		const char *fixup_str = value;
4916780e684SKyle Evans 		uint32_t path_len, name_len;
4926780e684SKyle Evans 		uint32_t fixup_len;
4936780e684SKyle Evans 		char *sep, *endptr;
4946780e684SKyle Evans 		int poffset, ret;
4956780e684SKyle Evans 
4966780e684SKyle Evans 		fixup_end = memchr(value, '\0', len);
4976780e684SKyle Evans 		if (!fixup_end)
4986780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
4996780e684SKyle Evans 		fixup_len = fixup_end - fixup_str;
5006780e684SKyle Evans 
5016780e684SKyle Evans 		len -= fixup_len + 1;
5026780e684SKyle Evans 		value += fixup_len + 1;
5036780e684SKyle Evans 
5046780e684SKyle Evans 		path = fixup_str;
5056780e684SKyle Evans 		sep = memchr(fixup_str, ':', fixup_len);
5066780e684SKyle Evans 		if (!sep || *sep != ':')
5076780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
5086780e684SKyle Evans 
5096780e684SKyle Evans 		path_len = sep - path;
5106780e684SKyle Evans 		if (path_len == (fixup_len - 1))
5116780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
5126780e684SKyle Evans 
5136780e684SKyle Evans 		fixup_len -= path_len + 1;
5146780e684SKyle Evans 		name = sep + 1;
5156780e684SKyle Evans 		sep = memchr(name, ':', fixup_len);
5166780e684SKyle Evans 		if (!sep || *sep != ':')
5176780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
5186780e684SKyle Evans 
5196780e684SKyle Evans 		name_len = sep - name;
5206780e684SKyle Evans 		if (!name_len)
5216780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
5226780e684SKyle Evans 
5236780e684SKyle Evans 		poffset = strtoul(sep + 1, &endptr, 10);
5246780e684SKyle Evans 		if ((*endptr != '\0') || (endptr <= (sep + 1)))
5256780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
5266780e684SKyle Evans 
5276780e684SKyle Evans 		ret = overlay_fixup_one_phandle(fdt, fdto, symbols_off,
5286780e684SKyle Evans 						path, path_len, name, name_len,
5296780e684SKyle Evans 						poffset, label);
5306780e684SKyle Evans 		if (ret)
5316780e684SKyle Evans 			return ret;
5326780e684SKyle Evans 	} while (len > 0);
5336780e684SKyle Evans 
5346780e684SKyle Evans 	return 0;
5356780e684SKyle Evans }
5366780e684SKyle Evans 
5376780e684SKyle Evans /**
5386780e684SKyle Evans  * overlay_fixup_phandles - Resolve the overlay phandles to the base
5396780e684SKyle Evans  *                          device tree
5406780e684SKyle Evans  * @fdt: Base Device Tree blob
5416780e684SKyle Evans  * @fdto: Device tree overlay blob
5426780e684SKyle Evans  *
5436780e684SKyle Evans  * overlay_fixup_phandles() resolves all the overlay phandles pointing
5446780e684SKyle Evans  * to nodes in the base device tree.
5456780e684SKyle Evans  *
5466780e684SKyle Evans  * This is one of the steps of the device tree overlay application
5476780e684SKyle Evans  * process, when you want all the phandles in the overlay to point to
5486780e684SKyle Evans  * the actual base dt nodes.
5496780e684SKyle Evans  *
5506780e684SKyle Evans  * returns:
5516780e684SKyle Evans  *      0 on success
5526780e684SKyle Evans  *      Negative error code on failure
5536780e684SKyle Evans  */
overlay_fixup_phandles(void * fdt,void * fdto)5546780e684SKyle Evans static int overlay_fixup_phandles(void *fdt, void *fdto)
5556780e684SKyle Evans {
5566780e684SKyle Evans 	int fixups_off, symbols_off;
5576780e684SKyle Evans 	int property;
5586780e684SKyle Evans 
5596780e684SKyle Evans 	/* We can have overlays without any fixups */
5606780e684SKyle Evans 	fixups_off = fdt_path_offset(fdto, "/__fixups__");
5616780e684SKyle Evans 	if (fixups_off == -FDT_ERR_NOTFOUND)
5626780e684SKyle Evans 		return 0; /* nothing to do */
5636780e684SKyle Evans 	if (fixups_off < 0)
5646780e684SKyle Evans 		return fixups_off;
5656780e684SKyle Evans 
5666780e684SKyle Evans 	/* And base DTs without symbols */
5676780e684SKyle Evans 	symbols_off = fdt_path_offset(fdt, "/__symbols__");
5686780e684SKyle Evans 	if ((symbols_off < 0 && (symbols_off != -FDT_ERR_NOTFOUND)))
5696780e684SKyle Evans 		return symbols_off;
5706780e684SKyle Evans 
5716780e684SKyle Evans 	fdt_for_each_property_offset(property, fdto, fixups_off) {
5726780e684SKyle Evans 		int ret;
5736780e684SKyle Evans 
5746780e684SKyle Evans 		ret = overlay_fixup_phandle(fdt, fdto, symbols_off, property);
5756780e684SKyle Evans 		if (ret)
5766780e684SKyle Evans 			return ret;
5776780e684SKyle Evans 	}
5786780e684SKyle Evans 
5796780e684SKyle Evans 	return 0;
5806780e684SKyle Evans }
5816780e684SKyle Evans 
5826780e684SKyle Evans /**
5836780e684SKyle Evans  * overlay_apply_node - Merges a node into the base device tree
5846780e684SKyle Evans  * @fdt: Base Device Tree blob
5856780e684SKyle Evans  * @target: Node offset in the base device tree to apply the fragment to
5866780e684SKyle Evans  * @fdto: Device tree overlay blob
5876780e684SKyle Evans  * @node: Node offset in the overlay holding the changes to merge
5886780e684SKyle Evans  *
5896780e684SKyle Evans  * overlay_apply_node() merges a node into a target base device tree
5906780e684SKyle Evans  * node pointed.
5916780e684SKyle Evans  *
5926780e684SKyle Evans  * This is part of the final step in the device tree overlay
5936780e684SKyle Evans  * application process, when all the phandles have been adjusted and
5946780e684SKyle Evans  * resolved and you just have to merge overlay into the base device
5956780e684SKyle Evans  * tree.
5966780e684SKyle Evans  *
5976780e684SKyle Evans  * returns:
5986780e684SKyle Evans  *      0 on success
5996780e684SKyle Evans  *      Negative error code on failure
6006780e684SKyle Evans  */
overlay_apply_node(void * fdt,int target,void * fdto,int node)6016780e684SKyle Evans static int overlay_apply_node(void *fdt, int target,
6026780e684SKyle Evans 			      void *fdto, int node)
6036780e684SKyle Evans {
6046780e684SKyle Evans 	int property;
6056780e684SKyle Evans 	int subnode;
6066780e684SKyle Evans 
6076780e684SKyle Evans 	fdt_for_each_property_offset(property, fdto, node) {
6086780e684SKyle Evans 		const char *name;
6096780e684SKyle Evans 		const void *prop;
6106780e684SKyle Evans 		int prop_len;
6116780e684SKyle Evans 		int ret;
6126780e684SKyle Evans 
6136780e684SKyle Evans 		prop = fdt_getprop_by_offset(fdto, property, &name,
6146780e684SKyle Evans 					     &prop_len);
6156780e684SKyle Evans 		if (prop_len == -FDT_ERR_NOTFOUND)
6166780e684SKyle Evans 			return -FDT_ERR_INTERNAL;
6176780e684SKyle Evans 		if (prop_len < 0)
6186780e684SKyle Evans 			return prop_len;
6196780e684SKyle Evans 
6206780e684SKyle Evans 		ret = fdt_setprop(fdt, target, name, prop, prop_len);
6216780e684SKyle Evans 		if (ret)
6226780e684SKyle Evans 			return ret;
6236780e684SKyle Evans 	}
6246780e684SKyle Evans 
6256780e684SKyle Evans 	fdt_for_each_subnode(subnode, fdto, node) {
6266780e684SKyle Evans 		const char *name = fdt_get_name(fdto, subnode, NULL);
6276780e684SKyle Evans 		int nnode;
6286780e684SKyle Evans 		int ret;
6296780e684SKyle Evans 
6306780e684SKyle Evans 		nnode = fdt_add_subnode(fdt, target, name);
6316780e684SKyle Evans 		if (nnode == -FDT_ERR_EXISTS) {
6326780e684SKyle Evans 			nnode = fdt_subnode_offset(fdt, target, name);
6336780e684SKyle Evans 			if (nnode == -FDT_ERR_NOTFOUND)
6346780e684SKyle Evans 				return -FDT_ERR_INTERNAL;
6356780e684SKyle Evans 		}
6366780e684SKyle Evans 
6376780e684SKyle Evans 		if (nnode < 0)
6386780e684SKyle Evans 			return nnode;
6396780e684SKyle Evans 
6406780e684SKyle Evans 		ret = overlay_apply_node(fdt, nnode, fdto, subnode);
6416780e684SKyle Evans 		if (ret)
6426780e684SKyle Evans 			return ret;
6436780e684SKyle Evans 	}
6446780e684SKyle Evans 
6456780e684SKyle Evans 	return 0;
6466780e684SKyle Evans }
6476780e684SKyle Evans 
6486780e684SKyle Evans /**
6496780e684SKyle Evans  * overlay_merge - Merge an overlay into its base device tree
6506780e684SKyle Evans  * @fdt: Base Device Tree blob
6516780e684SKyle Evans  * @fdto: Device tree overlay blob
6526780e684SKyle Evans  *
6536780e684SKyle Evans  * overlay_merge() merges an overlay into its base device tree.
6546780e684SKyle Evans  *
6556780e684SKyle Evans  * This is the next to last step in the device tree overlay application
6566780e684SKyle Evans  * process, when all the phandles have been adjusted and resolved and
6576780e684SKyle Evans  * you just have to merge overlay into the base device tree.
6586780e684SKyle Evans  *
6596780e684SKyle Evans  * returns:
6606780e684SKyle Evans  *      0 on success
6616780e684SKyle Evans  *      Negative error code on failure
6626780e684SKyle Evans  */
overlay_merge(void * fdt,void * fdto)6636780e684SKyle Evans static int overlay_merge(void *fdt, void *fdto)
6646780e684SKyle Evans {
6656780e684SKyle Evans 	int fragment;
6666780e684SKyle Evans 
6676780e684SKyle Evans 	fdt_for_each_subnode(fragment, fdto, 0) {
6686780e684SKyle Evans 		int overlay;
6696780e684SKyle Evans 		int target;
6706780e684SKyle Evans 		int ret;
6716780e684SKyle Evans 
6726780e684SKyle Evans 		/*
6736780e684SKyle Evans 		 * Each fragments will have an __overlay__ node. If
6746780e684SKyle Evans 		 * they don't, it's not supposed to be merged
6756780e684SKyle Evans 		 */
6766780e684SKyle Evans 		overlay = fdt_subnode_offset(fdto, fragment, "__overlay__");
6776780e684SKyle Evans 		if (overlay == -FDT_ERR_NOTFOUND)
6786780e684SKyle Evans 			continue;
6796780e684SKyle Evans 
6806780e684SKyle Evans 		if (overlay < 0)
6816780e684SKyle Evans 			return overlay;
6826780e684SKyle Evans 
6836780e684SKyle Evans 		target = overlay_get_target(fdt, fdto, fragment, NULL);
6846780e684SKyle Evans 		if (target < 0)
6856780e684SKyle Evans 			return target;
6866780e684SKyle Evans 
6876780e684SKyle Evans 		ret = overlay_apply_node(fdt, target, fdto, overlay);
6886780e684SKyle Evans 		if (ret)
6896780e684SKyle Evans 			return ret;
6906780e684SKyle Evans 	}
6916780e684SKyle Evans 
6926780e684SKyle Evans 	return 0;
6936780e684SKyle Evans }
6946780e684SKyle Evans 
get_path_len(const void * fdt,int nodeoffset)6956780e684SKyle Evans static int get_path_len(const void *fdt, int nodeoffset)
6966780e684SKyle Evans {
6976780e684SKyle Evans 	int len = 0, namelen;
6986780e684SKyle Evans 	const char *name;
6996780e684SKyle Evans 
7006780e684SKyle Evans 	FDT_CHECK_HEADER(fdt);
7016780e684SKyle Evans 
7026780e684SKyle Evans 	for (;;) {
7036780e684SKyle Evans 		name = fdt_get_name(fdt, nodeoffset, &namelen);
7046780e684SKyle Evans 		if (!name)
7056780e684SKyle Evans 			return namelen;
7066780e684SKyle Evans 
7076780e684SKyle Evans 		/* root? we're done */
7086780e684SKyle Evans 		if (namelen == 0)
7096780e684SKyle Evans 			break;
7106780e684SKyle Evans 
7116780e684SKyle Evans 		nodeoffset = fdt_parent_offset(fdt, nodeoffset);
7126780e684SKyle Evans 		if (nodeoffset < 0)
7136780e684SKyle Evans 			return nodeoffset;
7146780e684SKyle Evans 		len += namelen + 1;
7156780e684SKyle Evans 	}
7166780e684SKyle Evans 
7176780e684SKyle Evans 	/* in case of root pretend it's "/" */
7186780e684SKyle Evans 	if (len == 0)
7196780e684SKyle Evans 		len++;
7206780e684SKyle Evans 	return len;
7216780e684SKyle Evans }
7226780e684SKyle Evans 
7236780e684SKyle Evans /**
7246780e684SKyle Evans  * overlay_symbol_update - Update the symbols of base tree after a merge
7256780e684SKyle Evans  * @fdt: Base Device Tree blob
7266780e684SKyle Evans  * @fdto: Device tree overlay blob
7276780e684SKyle Evans  *
7286780e684SKyle Evans  * overlay_symbol_update() updates the symbols of the base tree with the
7296780e684SKyle Evans  * symbols of the applied overlay
7306780e684SKyle Evans  *
7316780e684SKyle Evans  * This is the last step in the device tree overlay application
7326780e684SKyle Evans  * process, allowing the reference of overlay symbols by subsequent
7336780e684SKyle Evans  * overlay operations.
7346780e684SKyle Evans  *
7356780e684SKyle Evans  * returns:
7366780e684SKyle Evans  *      0 on success
7376780e684SKyle Evans  *      Negative error code on failure
7386780e684SKyle Evans  */
overlay_symbol_update(void * fdt,void * fdto)7396780e684SKyle Evans static int overlay_symbol_update(void *fdt, void *fdto)
7406780e684SKyle Evans {
7416780e684SKyle Evans 	int root_sym, ov_sym, prop, path_len, fragment, target;
7426780e684SKyle Evans 	int len, frag_name_len, ret, rel_path_len;
7436780e684SKyle Evans 	const char *s, *e;
7446780e684SKyle Evans 	const char *path;
7456780e684SKyle Evans 	const char *name;
7466780e684SKyle Evans 	const char *frag_name;
7476780e684SKyle Evans 	const char *rel_path;
7486780e684SKyle Evans 	const char *target_path;
7496780e684SKyle Evans 	char *buf;
7506780e684SKyle Evans 	void *p;
7516780e684SKyle Evans 
7526780e684SKyle Evans 	ov_sym = fdt_subnode_offset(fdto, 0, "__symbols__");
7536780e684SKyle Evans 
7546780e684SKyle Evans 	/* if no overlay symbols exist no problem */
7556780e684SKyle Evans 	if (ov_sym < 0)
7566780e684SKyle Evans 		return 0;
7576780e684SKyle Evans 
7586780e684SKyle Evans 	root_sym = fdt_subnode_offset(fdt, 0, "__symbols__");
7596780e684SKyle Evans 
7606780e684SKyle Evans 	/* it no root symbols exist we should create them */
7616780e684SKyle Evans 	if (root_sym == -FDT_ERR_NOTFOUND)
7626780e684SKyle Evans 		root_sym = fdt_add_subnode(fdt, 0, "__symbols__");
7636780e684SKyle Evans 
7646780e684SKyle Evans 	/* any error is fatal now */
7656780e684SKyle Evans 	if (root_sym < 0)
7666780e684SKyle Evans 		return root_sym;
7676780e684SKyle Evans 
7686780e684SKyle Evans 	/* iterate over each overlay symbol */
7696780e684SKyle Evans 	fdt_for_each_property_offset(prop, fdto, ov_sym) {
7706780e684SKyle Evans 		path = fdt_getprop_by_offset(fdto, prop, &name, &path_len);
7716780e684SKyle Evans 		if (!path)
7726780e684SKyle Evans 			return path_len;
7736780e684SKyle Evans 
7746780e684SKyle Evans 		/* verify it's a string property (terminated by a single \0) */
7756780e684SKyle Evans 		if (path_len < 1 || memchr(path, '\0', path_len) != &path[path_len - 1])
7766780e684SKyle Evans 			return -FDT_ERR_BADVALUE;
7776780e684SKyle Evans 
7786780e684SKyle Evans 		/* keep end marker to avoid strlen() */
7796780e684SKyle Evans 		e = path + path_len;
7806780e684SKyle Evans 
7816780e684SKyle Evans 		/* format: /<fragment-name>/__overlay__/<relative-subnode-path> */
7826780e684SKyle Evans 
7836780e684SKyle Evans 		if (*path != '/')
7846780e684SKyle Evans 			return -FDT_ERR_BADVALUE;
7856780e684SKyle Evans 
7866780e684SKyle Evans 		/* get fragment name first */
7876780e684SKyle Evans 		s = strchr(path + 1, '/');
7886780e684SKyle Evans 		if (!s)
7896780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
7906780e684SKyle Evans 
7916780e684SKyle Evans 		frag_name = path + 1;
7926780e684SKyle Evans 		frag_name_len = s - path - 1;
7936780e684SKyle Evans 
7946780e684SKyle Evans 		/* verify format; safe since "s" lies in \0 terminated prop */
7956780e684SKyle Evans 		len = sizeof("/__overlay__/") - 1;
7966780e684SKyle Evans 		if ((e - s) < len || memcmp(s, "/__overlay__/", len))
7976780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
7986780e684SKyle Evans 
7996780e684SKyle Evans 		rel_path = s + len;
8006780e684SKyle Evans 		rel_path_len = e - rel_path;
8016780e684SKyle Evans 
8026780e684SKyle Evans 		/* find the fragment index in which the symbol lies */
8036780e684SKyle Evans 		ret = fdt_subnode_offset_namelen(fdto, 0, frag_name,
8046780e684SKyle Evans 					       frag_name_len);
8056780e684SKyle Evans 		/* not found? */
8066780e684SKyle Evans 		if (ret < 0)
8076780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
8086780e684SKyle Evans 		fragment = ret;
8096780e684SKyle Evans 
8106780e684SKyle Evans 		/* an __overlay__ subnode must exist */
8116780e684SKyle Evans 		ret = fdt_subnode_offset(fdto, fragment, "__overlay__");
8126780e684SKyle Evans 		if (ret < 0)
8136780e684SKyle Evans 			return -FDT_ERR_BADOVERLAY;
8146780e684SKyle Evans 
8156780e684SKyle Evans 		/* get the target of the fragment */
8166780e684SKyle Evans 		ret = overlay_get_target(fdt, fdto, fragment, &target_path);
8176780e684SKyle Evans 		if (ret < 0)
8186780e684SKyle Evans 			return ret;
8196780e684SKyle Evans 		target = ret;
8206780e684SKyle Evans 
8216780e684SKyle Evans 		/* if we have a target path use */
8226780e684SKyle Evans 		if (!target_path) {
8236780e684SKyle Evans 			ret = get_path_len(fdt, target);
8246780e684SKyle Evans 			if (ret < 0)
8256780e684SKyle Evans 				return ret;
8266780e684SKyle Evans 			len = ret;
8276780e684SKyle Evans 		} else {
8286780e684SKyle Evans 			len = strlen(target_path);
8296780e684SKyle Evans 		}
8306780e684SKyle Evans 
8316780e684SKyle Evans 		ret = fdt_setprop_placeholder(fdt, root_sym, name,
8326780e684SKyle Evans 				len + (len > 1) + rel_path_len + 1, &p);
8336780e684SKyle Evans 		if (ret < 0)
8346780e684SKyle Evans 			return ret;
8356780e684SKyle Evans 
8366780e684SKyle Evans 		if (!target_path) {
8376780e684SKyle Evans 			/* again in case setprop_placeholder changed it */
8386780e684SKyle Evans 			ret = overlay_get_target(fdt, fdto, fragment, &target_path);
8396780e684SKyle Evans 			if (ret < 0)
8406780e684SKyle Evans 				return ret;
8416780e684SKyle Evans 			target = ret;
8426780e684SKyle Evans 		}
8436780e684SKyle Evans 
8446780e684SKyle Evans 		buf = p;
8456780e684SKyle Evans 		if (len > 1) { /* target is not root */
8466780e684SKyle Evans 			if (!target_path) {
8476780e684SKyle Evans 				ret = fdt_get_path(fdt, target, buf, len + 1);
8486780e684SKyle Evans 				if (ret < 0)
8496780e684SKyle Evans 					return ret;
8506780e684SKyle Evans 			} else
8516780e684SKyle Evans 				memcpy(buf, target_path, len + 1);
8526780e684SKyle Evans 
8536780e684SKyle Evans 		} else
8546780e684SKyle Evans 			len--;
8556780e684SKyle Evans 
8566780e684SKyle Evans 		buf[len] = '/';
8576780e684SKyle Evans 		memcpy(buf + len + 1, rel_path, rel_path_len);
8586780e684SKyle Evans 		buf[len + 1 + rel_path_len] = '\0';
8596780e684SKyle Evans 	}
8606780e684SKyle Evans 
8616780e684SKyle Evans 	return 0;
8626780e684SKyle Evans }
8636780e684SKyle Evans 
fdt_overlay_apply(void * fdt,void * fdto)8646780e684SKyle Evans int fdt_overlay_apply(void *fdt, void *fdto)
8656780e684SKyle Evans {
8666780e684SKyle Evans 	uint32_t delta = fdt_get_max_phandle(fdt);
8676780e684SKyle Evans 	int ret;
8686780e684SKyle Evans 
8696780e684SKyle Evans 	FDT_CHECK_HEADER(fdt);
8706780e684SKyle Evans 	FDT_CHECK_HEADER(fdto);
8716780e684SKyle Evans 
8726780e684SKyle Evans 	ret = overlay_adjust_local_phandles(fdto, delta);
8736780e684SKyle Evans 	if (ret)
8746780e684SKyle Evans 		goto err;
8756780e684SKyle Evans 
8766780e684SKyle Evans 	ret = overlay_update_local_references(fdto, delta);
8776780e684SKyle Evans 	if (ret)
8786780e684SKyle Evans 		goto err;
8796780e684SKyle Evans 
8806780e684SKyle Evans 	ret = overlay_fixup_phandles(fdt, fdto);
8816780e684SKyle Evans 	if (ret)
8826780e684SKyle Evans 		goto err;
8836780e684SKyle Evans 
8846780e684SKyle Evans 	ret = overlay_merge(fdt, fdto);
8856780e684SKyle Evans 	if (ret)
8866780e684SKyle Evans 		goto err;
8876780e684SKyle Evans 
8886780e684SKyle Evans 	ret = overlay_symbol_update(fdt, fdto);
8896780e684SKyle Evans 	if (ret)
8906780e684SKyle Evans 		goto err;
8916780e684SKyle Evans 
8926780e684SKyle Evans 	/*
8936780e684SKyle Evans 	 * The overlay has been damaged, erase its magic.
8946780e684SKyle Evans 	 */
8956780e684SKyle Evans 	fdt_set_magic(fdto, ~0);
8966780e684SKyle Evans 
8976780e684SKyle Evans 	return 0;
8986780e684SKyle Evans 
8996780e684SKyle Evans err:
9006780e684SKyle Evans 	/*
9016780e684SKyle Evans 	 * The overlay might have been damaged, erase its magic.
9026780e684SKyle Evans 	 */
9036780e684SKyle Evans 	fdt_set_magic(fdto, ~0);
9046780e684SKyle Evans 
9056780e684SKyle Evans 	/*
9066780e684SKyle Evans 	 * The base device tree might have been damaged, erase its
9076780e684SKyle Evans 	 * magic.
9086780e684SKyle Evans 	 */
9096780e684SKyle Evans 	fdt_set_magic(fdt, ~0);
9106780e684SKyle Evans 
9116780e684SKyle Evans 	return ret;
9126780e684SKyle Evans }
913