Commit 00fa6e5d authored by Tang Yuantian's avatar Tang Yuantian Committed by Mike Turquette

clk: mpc85xx: Update the driver to align to new clock bindings

The clock bindings for Freescale CoreNet platform are updated.
So, the driver needs to be updated accordingly.
The main changes include:
	- Added a new node to present the input system clock
	- Changed PLL and MUX's compatible string
Signed-off-by: default avatarTang Yuantian <Yuantian.Tang@freescale.com>
Acked-by: default avatarScott Wood <scottwood@freescale.com>
Signed-off-by: default avatarMike Turquette <mturquette@linaro.org>
parent 141c71dd
...@@ -27,7 +27,6 @@ struct cmux_clk { ...@@ -27,7 +27,6 @@ struct cmux_clk {
#define CLKSEL_ADJUST BIT(0) #define CLKSEL_ADJUST BIT(0)
#define to_cmux_clk(p) container_of(p, struct cmux_clk, hw) #define to_cmux_clk(p) container_of(p, struct cmux_clk, hw)
static void __iomem *base;
static unsigned int clocks_per_pll; static unsigned int clocks_per_pll;
static int cmux_set_parent(struct clk_hw *hw, u8 idx) static int cmux_set_parent(struct clk_hw *hw, u8 idx)
...@@ -100,7 +99,11 @@ static void __init core_mux_init(struct device_node *np) ...@@ -100,7 +99,11 @@ static void __init core_mux_init(struct device_node *np)
pr_err("%s: could not allocate cmux_clk\n", __func__); pr_err("%s: could not allocate cmux_clk\n", __func__);
goto err_name; goto err_name;
} }
cmux_clk->reg = base + offset; cmux_clk->reg = of_iomap(np, 0);
if (!cmux_clk->reg) {
pr_err("%s: could not map register\n", __func__);
goto err_clk;
}
node = of_find_compatible_node(NULL, NULL, "fsl,p4080-clockgen"); node = of_find_compatible_node(NULL, NULL, "fsl,p4080-clockgen");
if (node && (offset >= 0x80)) if (node && (offset >= 0x80))
...@@ -143,38 +146,39 @@ static void __init core_mux_init(struct device_node *np) ...@@ -143,38 +146,39 @@ static void __init core_mux_init(struct device_node *np)
static void __init core_pll_init(struct device_node *np) static void __init core_pll_init(struct device_node *np)
{ {
u32 offset, mult; u32 mult;
int i, rc, count; int i, rc, count;
const char *clk_name, *parent_name; const char *clk_name, *parent_name;
struct clk_onecell_data *onecell_data; struct clk_onecell_data *onecell_data;
struct clk **subclks; struct clk **subclks;
void __iomem *base;
rc = of_property_read_u32(np, "reg", &offset); base = of_iomap(np, 0);
if (rc) { if (!base) {
pr_err("%s: could not get reg property\n", np->name); pr_err("clk-ppc: iomap error\n");
return; return;
} }
/* get the multiple of PLL */ /* get the multiple of PLL */
mult = ioread32be(base + offset); mult = ioread32be(base);
/* check if this PLL is disabled */ /* check if this PLL is disabled */
if (mult & PLL_KILL) { if (mult & PLL_KILL) {
pr_debug("PLL:%s is disabled\n", np->name); pr_debug("PLL:%s is disabled\n", np->name);
return; goto err_map;
} }
mult = (mult >> 1) & 0x3f; mult = (mult >> 1) & 0x3f;
parent_name = of_clk_get_parent_name(np, 0); parent_name = of_clk_get_parent_name(np, 0);
if (!parent_name) { if (!parent_name) {
pr_err("PLL: %s must have a parent\n", np->name); pr_err("PLL: %s must have a parent\n", np->name);
return; goto err_map;
} }
count = of_property_count_strings(np, "clock-output-names"); count = of_property_count_strings(np, "clock-output-names");
if (count < 0 || count > 4) { if (count < 0 || count > 4) {
pr_err("%s: clock is not supported\n", np->name); pr_err("%s: clock is not supported\n", np->name);
return; goto err_map;
} }
/* output clock number per PLL */ /* output clock number per PLL */
...@@ -183,7 +187,7 @@ static void __init core_pll_init(struct device_node *np) ...@@ -183,7 +187,7 @@ static void __init core_pll_init(struct device_node *np)
subclks = kzalloc(sizeof(struct clk *) * count, GFP_KERNEL); subclks = kzalloc(sizeof(struct clk *) * count, GFP_KERNEL);
if (!subclks) { if (!subclks) {
pr_err("%s: could not allocate subclks\n", __func__); pr_err("%s: could not allocate subclks\n", __func__);
return; goto err_map;
} }
onecell_data = kzalloc(sizeof(struct clk_onecell_data), GFP_KERNEL); onecell_data = kzalloc(sizeof(struct clk_onecell_data), GFP_KERNEL);
...@@ -230,30 +234,52 @@ static void __init core_pll_init(struct device_node *np) ...@@ -230,30 +234,52 @@ static void __init core_pll_init(struct device_node *np)
goto err_cell; goto err_cell;
} }
iounmap(base);
return; return;
err_cell: err_cell:
kfree(onecell_data); kfree(onecell_data);
err_clks: err_clks:
kfree(subclks); kfree(subclks);
err_map:
iounmap(base);
}
static void __init sysclk_init(struct device_node *node)
{
struct clk *clk;
const char *clk_name = node->name;
struct device_node *np = of_get_parent(node);
u32 rate;
if (!np) {
pr_err("ppc-clk: could not get parent node\n");
return;
}
if (of_property_read_u32(np, "clock-frequency", &rate)) {
of_node_put(node);
return;
}
of_property_read_string(np, "clock-output-names", &clk_name);
clk = clk_register_fixed_rate(NULL, clk_name, NULL, CLK_IS_ROOT, rate);
if (!IS_ERR(clk))
of_clk_add_provider(np, of_clk_src_simple_get, clk);
} }
static const struct of_device_id clk_match[] __initconst = { static const struct of_device_id clk_match[] __initconst = {
{ .compatible = "fixed-clock", .data = of_fixed_clk_setup, }, { .compatible = "fsl,qoriq-sysclk-1.0", .data = sysclk_init, },
{ .compatible = "fsl,core-pll-clock", .data = core_pll_init, }, { .compatible = "fsl,qoriq-sysclk-2.0", .data = sysclk_init, },
{ .compatible = "fsl,core-mux-clock", .data = core_mux_init, }, { .compatible = "fsl,qoriq-core-pll-1.0", .data = core_pll_init, },
{ .compatible = "fsl,qoriq-core-pll-2.0", .data = core_pll_init, },
{ .compatible = "fsl,qoriq-core-mux-1.0", .data = core_mux_init, },
{ .compatible = "fsl,qoriq-core-mux-2.0", .data = core_mux_init, },
{} {}
}; };
static int __init ppc_corenet_clk_probe(struct platform_device *pdev) static int __init ppc_corenet_clk_probe(struct platform_device *pdev)
{ {
struct device_node *np;
np = pdev->dev.of_node;
base = of_iomap(np, 0);
if (!base) {
dev_err(&pdev->dev, "iomap error\n");
return -ENOMEM;
}
of_clk_init(clk_match); of_clk_init(clk_match);
return 0; return 0;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment