From 153c34b34790d89076fc03f3b8798a60c140754b Mon Sep 17 00:00:00 2001 From: Teresa Remmet Date: Thu, 25 Feb 2016 08:36:47 +0100 Subject: [PATCH] common: oftree: Add function to register set status fixup Added a function to register a fixup to enable or disable device tree nodes. Signed-off-by: Teresa Remmet Signed-off-by: Sascha Hauer --- common/oftree.c | 36 ++++++++++++++++++++++++++++++++++++ include/of.h | 1 + 2 files changed, 37 insertions(+) diff --git a/common/oftree.c b/common/oftree.c index d408f14e6..e98b90873 100644 --- a/common/oftree.c +++ b/common/oftree.c @@ -139,6 +139,42 @@ static int of_register_bootargs_fixup(void) } late_initcall(of_register_bootargs_fixup); +struct of_fixup_status_data { + const char *path; + bool status; +}; + +static int of_fixup_status(struct device_node *root, void *context) +{ + const struct of_fixup_status_data *data = context; + struct device_node *node; + + node = of_find_node_by_path_or_alias(root, data->path); + if (!node) + return -ENODEV; + + if (data->status) + return of_device_enable(node); + else + return of_device_disable(node); +} + +/** + * of_register_set_status_fixup - register fix up to set status of nodes + * Register a fixup to enable or disable a node in the devicet tree by + * passing the path or alias. + */ +int of_register_set_status_fixup(const char *path, bool status) +{ + struct of_fixup_status_data *data; + + data = xzalloc(sizeof(*data)); + data->path = path; + data->status = status; + + return of_register_fixup(of_fixup_status, (void *)data); +} + struct of_fixup { int (*fixup)(struct device_node *, void *); void *context; diff --git a/include/of.h b/include/of.h index 75cc3c11c..8c8f57a7c 100644 --- a/include/of.h +++ b/include/of.h @@ -249,6 +249,7 @@ int of_find_path(struct device_node *node, const char *propname, char **outpath, int of_find_path_by_node(struct device_node *node, char **outpath, unsigned flags); int of_register_fixup(int (*fixup)(struct device_node *, void *), void *context); int of_unregister_fixup(int (*fixup)(struct device_node *, void *), void *context); +int of_register_set_status_fixup(const char *node, bool status); struct device_node *of_find_node_by_alias(struct device_node *root, const char *alias); struct device_node *of_find_node_by_path_or_alias(struct device_node *root,