diff options
author | Sascha Hauer <s.hauer@pengutronix.de> | 2013-04-15 14:06:50 +0200 |
---|---|---|
committer | Sascha Hauer <s.hauer@pengutronix.de> | 2013-06-20 08:44:22 +0200 |
commit | 707fb7ada577b4cb6988b9dc820a357959c626a3 (patch) | |
tree | ad6d8b4787aafa8d4d1935049949baa3de4c5d5d /drivers/clk/clk-gate.c | |
parent | c7e41dac4fdb297be6a542389f017d725947649f (diff) | |
download | barebox-707fb7ada577b4cb6988b9dc820a357959c626a3.tar.gz barebox-707fb7ada577b4cb6988b9dc820a357959c626a3.tar.xz |
clk: gate: Add inverted gate support
This adds support for gates which need 0 to enable.
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
Diffstat (limited to 'drivers/clk/clk-gate.c')
-rw-r--r-- | drivers/clk/clk-gate.c | 37 |
1 files changed, 33 insertions, 4 deletions
diff --git a/drivers/clk/clk-gate.c b/drivers/clk/clk-gate.c index a455094b69..f632d8555b 100644 --- a/drivers/clk/clk-gate.c +++ b/drivers/clk/clk-gate.c @@ -25,6 +25,8 @@ struct clk_gate { void __iomem *reg; int shift; const char *parent; +#define CLK_GATE_INVERTED (1 << 0) + unsigned flags; }; static int clk_gate_enable(struct clk *clk) @@ -33,7 +35,12 @@ static int clk_gate_enable(struct clk *clk) u32 val; val = readl(g->reg); - val |= 1 << g->shift; + + if (g->flags & CLK_GATE_INVERTED) + val &= ~(1 << g->shift); + else + val |= 1 << g->shift; + writel(val, g->reg); return 0; @@ -45,7 +52,12 @@ static void clk_gate_disable(struct clk *clk) u32 val; val = readl(g->reg); - val &= ~(1 << g->shift); + + if (g->flags & CLK_GATE_INVERTED) + val |= 1 << g->shift; + else + val &= ~(1 << g->shift); + writel(val, g->reg); } @@ -57,9 +69,9 @@ static int clk_gate_is_enabled(struct clk *clk) val = readl(g->reg); if (val & (1 << g->shift)) - return 1; + return g->flags & CLK_GATE_INVERTED ? 0 : 1; else - return 0; + return g->flags & CLK_GATE_INVERTED ? 1 : 0; } struct clk_ops clk_gate_ops = { @@ -90,3 +102,20 @@ struct clk *clk_gate(const char *name, const char *parent, void __iomem *reg, return &g->clk; } + +struct clk *clk_gate_inverted(const char *name, const char *parent, + void __iomem *reg, u8 shift) +{ + struct clk *clk; + struct clk_gate *g; + + clk = clk_gate(name, parent, reg, shift); + if (IS_ERR(clk)) + return clk; + + g = container_of(clk, struct clk_gate, clk); + + g->flags = CLK_GATE_INVERTED; + + return clk; +} |