clock: redefine variable clocks_per_pll as a struct member
redefine variable clocks_per_pll as a struct member If there are multiple PLL clock nodes, this variable will get overwritten. Redefining it as a struct member can avoid that. Signed-off-by: Tang Yuantian <Yuantian.Tang@freescale.com> Signed-off-by: Michael Turquette <mturquette@linaro.org>
This commit is contained in:
parent
1114428312
commit
57bfd7ee6f
1 changed files with 15 additions and 7 deletions
|
@ -19,6 +19,7 @@
|
|||
struct cmux_clk {
|
||||
struct clk_hw hw;
|
||||
void __iomem *reg;
|
||||
unsigned int clk_per_pll;
|
||||
u32 flags;
|
||||
};
|
||||
|
||||
|
@ -27,14 +28,12 @@ struct cmux_clk {
|
|||
#define CLKSEL_ADJUST BIT(0)
|
||||
#define to_cmux_clk(p) container_of(p, struct cmux_clk, hw)
|
||||
|
||||
static unsigned int clocks_per_pll;
|
||||
|
||||
static int cmux_set_parent(struct clk_hw *hw, u8 idx)
|
||||
{
|
||||
struct cmux_clk *clk = to_cmux_clk(hw);
|
||||
u32 clksel;
|
||||
|
||||
clksel = ((idx / clocks_per_pll) << 2) + idx % clocks_per_pll;
|
||||
clksel = ((idx / clk->clk_per_pll) << 2) + idx % clk->clk_per_pll;
|
||||
if (clk->flags & CLKSEL_ADJUST)
|
||||
clksel += 8;
|
||||
clksel = (clksel & 0xf) << CLKSEL_SHIFT;
|
||||
|
@ -52,7 +51,7 @@ static u8 cmux_get_parent(struct clk_hw *hw)
|
|||
clksel = (clksel >> CLKSEL_SHIFT) & 0xf;
|
||||
if (clk->flags & CLKSEL_ADJUST)
|
||||
clksel -= 8;
|
||||
clksel = (clksel >> 2) * clocks_per_pll + clksel % 4;
|
||||
clksel = (clksel >> 2) * clk->clk_per_pll + clksel % 4;
|
||||
|
||||
return clksel;
|
||||
}
|
||||
|
@ -72,6 +71,7 @@ static void __init core_mux_init(struct device_node *np)
|
|||
u32 offset;
|
||||
const char *clk_name;
|
||||
const char **parent_names;
|
||||
struct of_phandle_args clkspec;
|
||||
|
||||
rc = of_property_read_u32(np, "reg", &offset);
|
||||
if (rc) {
|
||||
|
@ -105,6 +105,17 @@ static void __init core_mux_init(struct device_node *np)
|
|||
goto err_clk;
|
||||
}
|
||||
|
||||
rc = of_parse_phandle_with_args(np, "clocks", "#clock-cells", 0,
|
||||
&clkspec);
|
||||
if (rc) {
|
||||
pr_err("%s: parse clock node error\n", __func__);
|
||||
goto err_clk;
|
||||
}
|
||||
|
||||
cmux_clk->clk_per_pll = of_property_count_strings(clkspec.np,
|
||||
"clock-output-names");
|
||||
of_node_put(clkspec.np);
|
||||
|
||||
node = of_find_compatible_node(NULL, NULL, "fsl,p4080-clockgen");
|
||||
if (node && (offset >= 0x80))
|
||||
cmux_clk->flags = CLKSEL_ADJUST;
|
||||
|
@ -181,9 +192,6 @@ static void __init core_pll_init(struct device_node *np)
|
|||
goto err_map;
|
||||
}
|
||||
|
||||
/* output clock number per PLL */
|
||||
clocks_per_pll = count;
|
||||
|
||||
subclks = kzalloc(sizeof(struct clk *) * count, GFP_KERNEL);
|
||||
if (!subclks) {
|
||||
pr_err("%s: could not allocate subclks\n", __func__);
|
||||
|
|
Loading…
Reference in a new issue