sysmo-bts
/
barebox
9
0
Fork 0
Code Releases Activity

clk: gate: unify enable and disable functions handling 

To avoid code duplication and make easier to introduce new flags.

Signed-off-by: Beniamino Galvani <b.galvani@gmail.com>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
Beniamino Galvani 2014-04-27 11:30:39 +02:00 committed by Sascha Hauer
parent 32a2a673c6
commit b80f5d5800
1 changed files with 15 additions and 18 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

33
drivers/clk/clk-gate.c
View File

@ -30,36 +30,33 @@ struct clk_gate {
#define to_clk_gate(_clk) container_of(_clk, struct clk_gate, clk) #define to_clk_gate(_clk) container_of(_clk, struct clk_gate, clk)
static int clk_gate_enable(struct clk *clk) static void clk_gate_endisable(struct clk *clk, int enable)
{ {
struct clk_gate *g = container_of(clk, struct clk_gate, clk); struct clk_gate *gate = container_of(clk, struct clk_gate, clk);
int set = gate->flags & CLK_GATE_INVERTED ? 1 : 0;
u32 val; u32 val;
val = readl(g->reg); set ^= enable;
val = readl(gate->reg);
if (g->flags & CLK_GATE_INVERTED) if (set)
val &= ~(1 << g->shift); val |= BIT(gate->shift);
else else
val |= 1 << g->shift; val &= ~BIT(gate->shift);
writel(val, g->reg); writel(val, gate->reg);
}
static int clk_gate_enable(struct clk *clk)
{
clk_gate_endisable(clk, 1);
return 0; return 0;
} }
static void clk_gate_disable(struct clk *clk) static void clk_gate_disable(struct clk *clk)
{ {
struct clk_gate *g = container_of(clk, struct clk_gate, clk); clk_gate_endisable(clk, 0);
u32 val;
val = readl(g->reg);
if (g->flags & CLK_GATE_INVERTED)
val |= 1 << g->shift;
else
val &= ~(1 << g->shift);
writel(val, g->reg);
} }
static int clk_gate_is_enabled(struct clk *clk) static int clk_gate_is_enabled(struct clk *clk)