Commit a513b72c authored by Emil Medve's avatar Emil Medve Committed by Michael Turquette
Browse files

clk: qoriq: Add support for the platform PLL 



Change-Id: Iac11ed95f274485a86d2c11f32a3dc502bcd020f
Signed-off-by: default avatarEmil Medve <Emilian.Medve@Freescale.com>
Acked-by: default avatarTang Yuantian <Yuantian.Tang@freescale.com>
Signed-off-by: default avatarMichael Turquette <mturquette@linaro.org>
parent 8f0ab1e1

drivers/clk/clk-qoriq.c

+83 −0
Original line number Diff line number Diff line
@@ -271,9 +271,92 @@ static void __init sysclk_init(struct device_node *node) 
	if (!IS_ERR(clk))

		of_clk_add_provider(np, of_clk_src_simple_get, clk);

}



static void __init pltfrm_pll_init(struct device_node *np)

{

	void __iomem *base;

	uint32_t mult;

	const char *parent_name, *clk_name;

	int i, _errno;

	struct clk_onecell_data *cod;



	base = of_iomap(np, 0);

	if (!base) {

		pr_err("%s(): %s: of_iomap() failed\n", __func__, np->name);

		return;

	}



	/* Get the multiple of PLL */

	mult = ioread32be(base);



	iounmap(base);



	/* Check if this PLL is disabled */

	if (mult & PLL_KILL) {

		pr_debug("%s(): %s: Disabled\n", __func__, np->name);

		return;

	}

	mult = (mult & GENMASK(6, 1)) >> 1;



	parent_name = of_clk_get_parent_name(np, 0);

	if (!parent_name) {

		pr_err("%s(): %s: of_clk_get_parent_name() failed\n",

		       __func__, np->name);

		return;

	}



	i = of_property_count_strings(np, "clock-output-names");

	if (i < 0) {

		pr_err("%s(): %s: of_property_count_strings(clock-output-names) = %d\n",

		       __func__, np->name, i);

		return;

	}



	cod = kmalloc(sizeof(*cod) + i * sizeof(struct clk *), GFP_KERNEL);

	if (!cod)

		return;

	cod->clks = (struct clk **)(cod + 1);

	cod->clk_num = i;



	for (i = 0; i < cod->clk_num; i++) {

		_errno = of_property_read_string_index(np, "clock-output-names",

						       i, &clk_name);

		if (_errno < 0) {

			pr_err("%s(): %s: of_property_read_string_index(clock-output-names) = %d\n",

			       __func__, np->name, _errno);

			goto return_clk_unregister;

		}



		cod->clks[i] = clk_register_fixed_factor(NULL, clk_name,

					       parent_name, 0, mult, 1 + i);

		if (IS_ERR(cod->clks[i])) {

			pr_err("%s(): %s: clk_register_fixed_factor(%s) = %ld\n",

			       __func__, np->name,

			       clk_name, PTR_ERR(cod->clks[i]));

			goto return_clk_unregister;

		}

	}



	_errno = of_clk_add_provider(np, of_clk_src_onecell_get, cod);

	if (_errno < 0) {

		pr_err("%s(): %s: of_clk_add_provider() = %d\n",

		       __func__, np->name, _errno);

		goto return_clk_unregister;

	}



	return;



return_clk_unregister:

	while (--i >= 0)

		clk_unregister(cod->clks[i]);

	kfree(cod);

}



CLK_OF_DECLARE(qoriq_sysclk_1, "fsl,qoriq-sysclk-1.0", sysclk_init);

CLK_OF_DECLARE(qoriq_sysclk_2, "fsl,qoriq-sysclk-2.0", sysclk_init);

CLK_OF_DECLARE(qoriq_core_pll_1, "fsl,qoriq-core-pll-1.0", core_pll_init);

CLK_OF_DECLARE(qoriq_core_pll_2, "fsl,qoriq-core-pll-2.0", core_pll_init);

CLK_OF_DECLARE(qoriq_core_mux_1, "fsl,qoriq-core-mux-1.0", core_mux_init);

CLK_OF_DECLARE(qoriq_core_mux_2, "fsl,qoriq-core-mux-2.0", core_mux_init);

CLK_OF_DECLARE(qoriq_pltfrm_pll_1, "fsl,qoriq-platform-pll-1.0", pltfrm_pll_init);

CLK_OF_DECLARE(qoriq_pltfrm_pll_2, "fsl,qoriq-platform-pll-2.0", pltfrm_pll_init);