[PATCH v3 1/4] clk: bcm2835: More flexible IO register remapping
From: Phil Elwell
Date: Wed Jun 14 2017 - 12:30:15 EST
The BCM2835 AUX block contains two registers - AUXIRQ and AUXENB.
The addition of an irqchip driver using AUXIRQ is hampered by
the current DT node reserving both registers with a compatible string
claimed by this bcm2835-aux-clk driver.
Ease the transition to separate DT nodes by detecting and handling
the case where this driver's MEM resource has been reduced to include
only the AUXENB register. Otherwise, use devm_ioremap to remap the
region without reserving it.
Signed-off-by: Phil Elwell <phil@xxxxxxxxxxxxxxx>
---
drivers/clk/bcm/clk-bcm2835-aux.c | 27 +++++++++++++++++++++++----
1 file changed, 23 insertions(+), 4 deletions(-)
diff --git a/drivers/clk/bcm/clk-bcm2835-aux.c b/drivers/clk/bcm/clk-bcm2835-aux.c
index bd750cf..7b99395 100644
--- a/drivers/clk/bcm/clk-bcm2835-aux.c
+++ b/drivers/clk/bcm/clk-bcm2835-aux.c
@@ -37,9 +37,29 @@ static int bcm2835_aux_clk_probe(struct platform_device *pdev)
parent = __clk_get_name(parent_clk);
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- reg = devm_ioremap_resource(dev, res);
- if (IS_ERR(reg))
- return PTR_ERR(reg);
+
+ /*
+ * If the MEM resource is only 4 bytes long it covers just the
+ * AUXENB register, otherwise it is the entire AUX block.
+ *
+ * If remapping the entire block, use devm_ioremap rather than
+ * devm_ioremap_resource to avoid requesting the mem_region.
+ *
+ * N.B. This if/else can be replaced with the if body once the
+ * new DT bindings are in use.
+ */
+ if (resource_size(res) == 4) {
+ reg = devm_ioremap_resource(dev, res);
+ if (IS_ERR(reg))
+ return PTR_ERR(reg);
+ gate = reg;
+ } else {
+ reg = devm_ioremap(dev, res->start, resource_size(res));
+ if (IS_ERR(reg))
+ return PTR_ERR(reg);
+ gate = reg + BCM2835_AUXENB;
+ }
+
onecell = devm_kmalloc(dev, sizeof(*onecell) + sizeof(*onecell->hws) *
BCM2835_AUX_CLOCK_COUNT, GFP_KERNEL);
@@ -47,7 +67,6 @@ static int bcm2835_aux_clk_probe(struct platform_device *pdev)
return -ENOMEM;
onecell->num = BCM2835_AUX_CLOCK_COUNT;
- gate = reg + BCM2835_AUXENB;
onecell->hws[BCM2835_AUX_CLOCK_UART] =
clk_hw_register_gate(dev, "aux_uart", parent, 0, gate, 0, 0, NULL);
--
1.9.1