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