diff options
author | Ahmad Fatoum <a.fatoum@pengutronix.de> | 2020-02-18 15:23:04 +0100 |
---|---|---|
committer | Sascha Hauer <s.hauer@pengutronix.de> | 2020-02-19 09:03:31 +0100 |
commit | b36b7b7271926f7ac37d95c389e5e8d712675142 (patch) | |
tree | b9ea60c18b687d71b802719c83e09bf889c598bb /drivers | |
parent | 54bf3146e571f30cc90f44ad05d5947d9622fb73 (diff) | |
download | barebox-b36b7b7271926f7ac37d95c389e5e8d712675142.tar.gz barebox-b36b7b7271926f7ac37d95c389e5e8d712675142.tar.xz |
mfd: syscon: clock peripheral if specified in device tree
Linux supports a clocks property in syscon nodes to indicate that access
should only occur with the clock active.
Attach the clock to the regmap if found.
Signed-off-by: Ahmad Fatoum <a.fatoum@pengutronix.de>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
Diffstat (limited to 'drivers')
-rw-r--r-- | drivers/mfd/syscon.c | 20 |
1 files changed, 18 insertions, 2 deletions
diff --git a/drivers/mfd/syscon.c b/drivers/mfd/syscon.c index adc263c6e6..f1e6559d71 100644 --- a/drivers/mfd/syscon.c +++ b/drivers/mfd/syscon.c @@ -19,6 +19,7 @@ #include <xfuncs.h> #include <of_address.h> #include <linux/err.h> +#include <linux/clk.h> #include <mfd/syscon.h> @@ -37,7 +38,7 @@ static const struct regmap_config syscon_regmap_config = { .reg_stride = 4, }; -static struct syscon *of_syscon_register(struct device_node *np) +static struct syscon *of_syscon_register(struct device_node *np, bool check_clk) { int ret; struct syscon *syscon; @@ -60,6 +61,21 @@ static struct syscon *of_syscon_register(struct device_node *np) syscon->regmap = of_regmap_init_mmio_clk(np, NULL, syscon->base, &syscon_regmap_config); + + if (check_clk) { + struct clk *clk = of_clk_get(np, 0); + if (IS_ERR(clk)) { + ret = PTR_ERR(clk); + /* clock is optional */ + if (ret != -ENOENT) + goto err_map; + } else { + ret = regmap_mmio_attach_clk(syscon->regmap, clk); + if (ret) + goto err_map; + } + } + return syscon; err_map: @@ -78,7 +94,7 @@ static struct syscon *node_to_syscon(struct device_node *np) } if (!syscon) - syscon = of_syscon_register(np); + syscon = of_syscon_register(np, true); if (IS_ERR(syscon)) return ERR_CAST(syscon); |