|
@@ -74,17 +74,17 @@ static phandle live_tree_max_phandle(void)
|
|
|
/*
|
|
|
* Adjust a subtree's phandle values by a given delta.
|
|
|
*/
|
|
|
-static void adjust_overlay_phandles(struct device_node *node,
|
|
|
+static void adjust_overlay_phandles(struct device_node *overlay,
|
|
|
int phandle_delta)
|
|
|
{
|
|
|
struct device_node *child;
|
|
|
struct property *prop;
|
|
|
phandle phandle;
|
|
|
|
|
|
- if (node->phandle != 0 && node->phandle != OF_PHANDLE_ILLEGAL)
|
|
|
- node->phandle += phandle_delta;
|
|
|
+ if (overlay->phandle != 0 && overlay->phandle != OF_PHANDLE_ILLEGAL)
|
|
|
+ overlay->phandle += phandle_delta;
|
|
|
|
|
|
- for_each_property_of_node(node, prop) {
|
|
|
+ for_each_property_of_node(overlay, prop) {
|
|
|
|
|
|
if (of_prop_cmp(prop->name, "phandle") &&
|
|
|
of_prop_cmp(prop->name, "linux,phandle"))
|
|
@@ -97,41 +97,40 @@ static void adjust_overlay_phandles(struct device_node *node,
|
|
|
if (phandle == OF_PHANDLE_ILLEGAL)
|
|
|
continue;
|
|
|
|
|
|
- *(uint32_t *)prop->value = cpu_to_be32(node->phandle);
|
|
|
+ *(uint32_t *)prop->value = cpu_to_be32(overlay->phandle);
|
|
|
}
|
|
|
|
|
|
- for_each_child_of_node(node, child)
|
|
|
+ for_each_child_of_node(overlay, child)
|
|
|
adjust_overlay_phandles(child, phandle_delta);
|
|
|
}
|
|
|
|
|
|
-static int update_usages_of_a_phandle_reference(struct device_node *node,
|
|
|
- struct property *rprop, int value)
|
|
|
+static int update_usages_of_a_phandle_reference(struct device_node *overlay,
|
|
|
+ struct property *prop_fixup, phandle phandle)
|
|
|
{
|
|
|
- phandle phandle;
|
|
|
struct device_node *refnode;
|
|
|
- struct property *sprop;
|
|
|
- char *propval, *propcur, *propend, *nodestr, *propstr, *s;
|
|
|
- int offset, propcurlen;
|
|
|
+ struct property *prop;
|
|
|
+ char *value, *cur, *end, *node_path, *prop_name, *s;
|
|
|
+ int offset, len;
|
|
|
int err = 0;
|
|
|
|
|
|
- propval = kmalloc(rprop->length, GFP_KERNEL);
|
|
|
- if (!propval)
|
|
|
+ value = kmalloc(prop_fixup->length, GFP_KERNEL);
|
|
|
+ if (!value)
|
|
|
return -ENOMEM;
|
|
|
- memcpy(propval, rprop->value, rprop->length);
|
|
|
+ memcpy(value, prop_fixup->value, prop_fixup->length);
|
|
|
|
|
|
- propend = propval + rprop->length;
|
|
|
- for (propcur = propval; propcur < propend; propcur += propcurlen + 1) {
|
|
|
- propcurlen = strlen(propcur);
|
|
|
+ end = value + prop_fixup->length;
|
|
|
+ for (cur = value; cur < end; cur += len + 1) {
|
|
|
+ len = strlen(cur);
|
|
|
|
|
|
- nodestr = propcur;
|
|
|
- s = strchr(propcur, ':');
|
|
|
+ node_path = cur;
|
|
|
+ s = strchr(cur, ':');
|
|
|
if (!s) {
|
|
|
err = -EINVAL;
|
|
|
goto err_fail;
|
|
|
}
|
|
|
*s++ = '\0';
|
|
|
|
|
|
- propstr = s;
|
|
|
+ prop_name = s;
|
|
|
s = strchr(s, ':');
|
|
|
if (!s) {
|
|
|
err = -EINVAL;
|
|
@@ -143,27 +142,26 @@ static int update_usages_of_a_phandle_reference(struct device_node *node,
|
|
|
if (err)
|
|
|
goto err_fail;
|
|
|
|
|
|
- refnode = find_node_by_full_name(node, nodestr);
|
|
|
+ refnode = find_node_by_full_name(overlay, node_path);
|
|
|
if (!refnode)
|
|
|
continue;
|
|
|
|
|
|
- for_each_property_of_node(refnode, sprop) {
|
|
|
- if (!of_prop_cmp(sprop->name, propstr))
|
|
|
+ for_each_property_of_node(refnode, prop) {
|
|
|
+ if (!of_prop_cmp(prop->name, prop_name))
|
|
|
break;
|
|
|
}
|
|
|
of_node_put(refnode);
|
|
|
|
|
|
- if (!sprop) {
|
|
|
+ if (!prop) {
|
|
|
err = -ENOENT;
|
|
|
goto err_fail;
|
|
|
}
|
|
|
|
|
|
- phandle = value;
|
|
|
- *(__be32 *)(sprop->value + offset) = cpu_to_be32(phandle);
|
|
|
+ *(__be32 *)(prop->value + offset) = cpu_to_be32(phandle);
|
|
|
}
|
|
|
|
|
|
err_fail:
|
|
|
- kfree(propval);
|
|
|
+ kfree(value);
|
|
|
return err;
|
|
|
}
|
|
|
|
|
@@ -184,61 +182,61 @@ static int node_name_cmp(const struct device_node *dn1,
|
|
|
* Does not take any devtree locks so make sure you call this on a tree
|
|
|
* which is at the detached state.
|
|
|
*/
|
|
|
-static int adjust_local_phandle_references(struct device_node *node,
|
|
|
- struct device_node *target, int phandle_delta)
|
|
|
+static int adjust_local_phandle_references(struct device_node *local_fixups,
|
|
|
+ struct device_node *overlay, int phandle_delta)
|
|
|
{
|
|
|
- struct device_node *child, *childtarget;
|
|
|
- struct property *rprop, *sprop;
|
|
|
+ struct device_node *child, *overlay_child;
|
|
|
+ struct property *prop_fix, *prop;
|
|
|
int err, i, count;
|
|
|
unsigned int off;
|
|
|
phandle phandle;
|
|
|
|
|
|
- if (!node)
|
|
|
+ if (!local_fixups)
|
|
|
return 0;
|
|
|
|
|
|
- for_each_property_of_node(node, rprop) {
|
|
|
+ for_each_property_of_node(local_fixups, prop_fix) {
|
|
|
|
|
|
/* skip properties added automatically */
|
|
|
- if (!of_prop_cmp(rprop->name, "name") ||
|
|
|
- !of_prop_cmp(rprop->name, "phandle") ||
|
|
|
- !of_prop_cmp(rprop->name, "linux,phandle"))
|
|
|
+ if (!of_prop_cmp(prop_fix->name, "name") ||
|
|
|
+ !of_prop_cmp(prop_fix->name, "phandle") ||
|
|
|
+ !of_prop_cmp(prop_fix->name, "linux,phandle"))
|
|
|
continue;
|
|
|
|
|
|
- if ((rprop->length % 4) != 0 || rprop->length == 0)
|
|
|
+ if ((prop_fix->length % 4) != 0 || prop_fix->length == 0)
|
|
|
return -EINVAL;
|
|
|
- count = rprop->length / sizeof(__be32);
|
|
|
+ count = prop_fix->length / sizeof(__be32);
|
|
|
|
|
|
- for_each_property_of_node(target, sprop) {
|
|
|
- if (!of_prop_cmp(sprop->name, rprop->name))
|
|
|
+ for_each_property_of_node(overlay, prop) {
|
|
|
+ if (!of_prop_cmp(prop->name, prop_fix->name))
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
- if (!sprop)
|
|
|
+ if (!prop)
|
|
|
return -EINVAL;
|
|
|
|
|
|
for (i = 0; i < count; i++) {
|
|
|
- off = be32_to_cpu(((__be32 *)rprop->value)[i]);
|
|
|
- if (off >= sprop->length || (off + 4) > sprop->length)
|
|
|
+ off = be32_to_cpu(((__be32 *)prop_fix->value)[i]);
|
|
|
+ if (off >= prop->length || (off + 4) > prop->length)
|
|
|
return -EINVAL;
|
|
|
|
|
|
if (phandle_delta) {
|
|
|
- phandle = be32_to_cpu(*(__be32 *)(sprop->value + off));
|
|
|
+ phandle = be32_to_cpu(*(__be32 *)(prop->value + off));
|
|
|
phandle += phandle_delta;
|
|
|
- *(__be32 *)(sprop->value + off) = cpu_to_be32(phandle);
|
|
|
+ *(__be32 *)(prop->value + off) = cpu_to_be32(phandle);
|
|
|
}
|
|
|
}
|
|
|
}
|
|
|
|
|
|
- for_each_child_of_node(node, child) {
|
|
|
+ for_each_child_of_node(local_fixups, child) {
|
|
|
|
|
|
- for_each_child_of_node(target, childtarget)
|
|
|
- if (!node_name_cmp(child, childtarget))
|
|
|
+ for_each_child_of_node(overlay, overlay_child)
|
|
|
+ if (!node_name_cmp(child, overlay_child))
|
|
|
break;
|
|
|
|
|
|
- if (!childtarget)
|
|
|
+ if (!overlay_child)
|
|
|
return -EINVAL;
|
|
|
|
|
|
- err = adjust_local_phandle_references(child, childtarget,
|
|
|
+ err = adjust_local_phandle_references(child, overlay_child,
|
|
|
phandle_delta);
|
|
|
if (err)
|
|
|
return err;
|
|
@@ -260,78 +258,78 @@ static int adjust_local_phandle_references(struct device_node *node,
|
|
|
* are fit to be inserted or operate upon the live tree.
|
|
|
* Returns 0 on success or a negative error value on error.
|
|
|
*/
|
|
|
-int of_resolve_phandles(struct device_node *resolve)
|
|
|
+int of_resolve_phandles(struct device_node *overlay)
|
|
|
{
|
|
|
- struct device_node *child, *childroot, *refnode;
|
|
|
- struct device_node *root_sym, *resolve_sym, *resolve_fix;
|
|
|
- struct property *rprop;
|
|
|
+ struct device_node *child, *local_fixups, *refnode;
|
|
|
+ struct device_node *tree_symbols, *overlay_symbols, *overlay_fixups;
|
|
|
+ struct property *prop;
|
|
|
const char *refpath;
|
|
|
phandle phandle, phandle_delta;
|
|
|
int err;
|
|
|
|
|
|
- if (!resolve)
|
|
|
- pr_err("%s: null node\n", __func__);
|
|
|
- if (resolve && !of_node_check_flag(resolve, OF_DETACHED))
|
|
|
+ if (!overlay)
|
|
|
+ pr_err("%s: null overlay\n", __func__);
|
|
|
+ if (overlay && !of_node_check_flag(overlay, OF_DETACHED))
|
|
|
pr_err("%s: node %s not detached\n", __func__,
|
|
|
- resolve->full_name);
|
|
|
- if (!resolve || !of_node_check_flag(resolve, OF_DETACHED))
|
|
|
+ overlay->full_name);
|
|
|
+ if (!overlay || !of_node_check_flag(overlay, OF_DETACHED))
|
|
|
return -EINVAL;
|
|
|
|
|
|
phandle_delta = live_tree_max_phandle() + 1;
|
|
|
- adjust_overlay_phandles(resolve, phandle_delta);
|
|
|
+ adjust_overlay_phandles(overlay, phandle_delta);
|
|
|
|
|
|
- childroot = NULL;
|
|
|
- for_each_child_of_node(resolve, childroot)
|
|
|
- if (!of_node_cmp(childroot->name, "__local_fixups__"))
|
|
|
+ local_fixups = NULL;
|
|
|
+ for_each_child_of_node(overlay, local_fixups)
|
|
|
+ if (!of_node_cmp(local_fixups->name, "__local_fixups__"))
|
|
|
break;
|
|
|
|
|
|
- if (childroot != NULL) {
|
|
|
- err = adjust_local_phandle_references(childroot,
|
|
|
- resolve, 0);
|
|
|
+ if (local_fixups != NULL) {
|
|
|
+ err = adjust_local_phandle_references(local_fixups,
|
|
|
+ overlay, 0);
|
|
|
if (err)
|
|
|
return err;
|
|
|
|
|
|
- BUG_ON(adjust_local_phandle_references(childroot,
|
|
|
- resolve, phandle_delta));
|
|
|
+ BUG_ON(adjust_local_phandle_references(local_fixups,
|
|
|
+ overlay, phandle_delta));
|
|
|
}
|
|
|
|
|
|
- root_sym = NULL;
|
|
|
- resolve_sym = NULL;
|
|
|
- resolve_fix = NULL;
|
|
|
+ tree_symbols = NULL;
|
|
|
+ overlay_symbols = NULL;
|
|
|
+ overlay_fixups = NULL;
|
|
|
|
|
|
- root_sym = of_find_node_by_path("/__symbols__");
|
|
|
+ tree_symbols = of_find_node_by_path("/__symbols__");
|
|
|
|
|
|
- for_each_child_of_node(resolve, child) {
|
|
|
+ for_each_child_of_node(overlay, child) {
|
|
|
|
|
|
- if (!resolve_sym && !of_node_cmp(child->name, "__symbols__"))
|
|
|
- resolve_sym = child;
|
|
|
+ if (!overlay_symbols && !of_node_cmp(child->name, "__symbols__"))
|
|
|
+ overlay_symbols = child;
|
|
|
|
|
|
- if (!resolve_fix && !of_node_cmp(child->name, "__fixups__"))
|
|
|
- resolve_fix = child;
|
|
|
+ if (!overlay_fixups && !of_node_cmp(child->name, "__fixups__"))
|
|
|
+ overlay_fixups = child;
|
|
|
|
|
|
- if (resolve_sym && resolve_fix)
|
|
|
+ if (overlay_symbols && overlay_fixups)
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
- if (!resolve_fix) {
|
|
|
+ if (!overlay_fixups) {
|
|
|
err = 0;
|
|
|
goto out;
|
|
|
}
|
|
|
|
|
|
- if (!root_sym) {
|
|
|
+ if (!tree_symbols) {
|
|
|
pr_err("%s: no symbols in root of device tree.\n", __func__);
|
|
|
err = -EINVAL;
|
|
|
goto out;
|
|
|
}
|
|
|
|
|
|
- for_each_property_of_node(resolve_fix, rprop) {
|
|
|
+ for_each_property_of_node(overlay_fixups, prop) {
|
|
|
|
|
|
/* skip properties added automatically */
|
|
|
- if (!of_prop_cmp(rprop->name, "name"))
|
|
|
+ if (!of_prop_cmp(prop->name, "name"))
|
|
|
continue;
|
|
|
|
|
|
- err = of_property_read_string(root_sym,
|
|
|
- rprop->name, &refpath);
|
|
|
+ err = of_property_read_string(tree_symbols,
|
|
|
+ prop->name, &refpath);
|
|
|
if (err)
|
|
|
goto out;
|
|
|
|
|
@@ -344,13 +342,13 @@ int of_resolve_phandles(struct device_node *resolve)
|
|
|
phandle = refnode->phandle;
|
|
|
of_node_put(refnode);
|
|
|
|
|
|
- err = update_usages_of_a_phandle_reference(resolve, rprop, phandle);
|
|
|
+ err = update_usages_of_a_phandle_reference(overlay, prop, phandle);
|
|
|
if (err)
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
out:
|
|
|
- of_node_put(root_sym);
|
|
|
+ of_node_put(tree_symbols);
|
|
|
|
|
|
return err;
|
|
|
}
|