[PATCH V4] clk: imx: Fix reparenting of UARTs not associated with stdout
Ahmad Fatoum
a.fatoum at pengutronix.de
Sat Mar 13 15:16:56 GMT 2021
Hi,
On 13.03.21 13:28, Adam Ford wrote:
> Most if not all i.MX SoC's call a function which enables all UARTS.
> This is a problem for users who need to re-parent the clock source,
> because any attempt to change the parent results in an busy error
> due to the fact that the clocks have been enabled already.
>
> clk: failed to reparent uart1 to sys_pll1_80m: -16
>
> Instead of pre-initializing all UARTS, scan the device tree to see
> which UART clocks are associated to stdout, and only enable those
> UART clocks if it's needed early. This will move initialization of
> the remaining clocks until after the parenting of the clocks.
>
> When the clocks are shutdown, this mechanism will also disable any
> clocks that were pre-initialized.
>
> Fixes: 9461f7b33d11c ("clk: fix CLK_SET_RATE_GATE with clock rate protection")
> Suggested-by: Aisheng Dong <aisheng.dong at nxp.com>
> Signed-off-by: Adam Ford <aford173 at gmail.com>
> Reviewed-by: Abel Vesa <abel.vesa at nxp.com>
> Tested-by: Ahmad Fatoum <a.fatoum at pengutronix.de>
>
> ---
> V4: Check if of_stdout is available before using it.
> Re-align #ifdef to remove repeated code.
> V3: Return a method more closely related to upstream kernel but
> instead of passing an array of UART's, each SoC passes the max
> number of UART clocks is has. The imx clock driver will create
> an array to enable on startup, and disable later.
> V2: Attempt to port driver from vendor kernel.
> ---
> drivers/clk/imx/clk-imx25.c | 12 +---------
> drivers/clk/imx/clk-imx27.c | 13 +----------
> drivers/clk/imx/clk-imx35.c | 10 +--------
> drivers/clk/imx/clk-imx5.c | 30 +++----------------------
> drivers/clk/imx/clk-imx6q.c | 16 +-------------
> drivers/clk/imx/clk-imx6sl.c | 16 +-------------
> drivers/clk/imx/clk-imx6sll.c | 24 +-------------------
> drivers/clk/imx/clk-imx6sx.c | 16 +-------------
> drivers/clk/imx/clk-imx7d.c | 22 +------------------
> drivers/clk/imx/clk-imx7ulp.c | 31 ++------------------------
> drivers/clk/imx/clk-imx8mm.c | 18 ++-------------
> drivers/clk/imx/clk-imx8mn.c | 18 ++-------------
> drivers/clk/imx/clk-imx8mp.c | 17 +--------------
> drivers/clk/imx/clk-imx8mq.c | 18 ++-------------
> drivers/clk/imx/clk.c | 41 +++++++++++++++++++++++++++--------
> drivers/clk/imx/clk.h | 4 ++--
> 16 files changed, 54 insertions(+), 252 deletions(-)
>
> diff --git a/drivers/clk/imx/clk-imx25.c b/drivers/clk/imx/clk-imx25.c
> index a66cabfbf94f..66192fe0a898 100644
> --- a/drivers/clk/imx/clk-imx25.c
> +++ b/drivers/clk/imx/clk-imx25.c
> @@ -73,16 +73,6 @@ enum mx25_clks {
>
> static struct clk *clk[clk_max];
>
> -static struct clk ** const uart_clks[] __initconst = {
> - &clk[uart_ipg_per],
> - &clk[uart1_ipg],
> - &clk[uart2_ipg],
> - &clk[uart3_ipg],
> - &clk[uart4_ipg],
> - &clk[uart5_ipg],
> - NULL
> -};
> -
> static int __init __mx25_clocks_init(void __iomem *ccm_base)
> {
> BUG_ON(!ccm_base);
> @@ -228,7 +218,7 @@ static int __init __mx25_clocks_init(void __iomem *ccm_base)
> */
> clk_set_parent(clk[cko_sel], clk[ipg]);
>
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(6);
>
> return 0;
> }
> diff --git a/drivers/clk/imx/clk-imx27.c b/drivers/clk/imx/clk-imx27.c
> index 5585ded8b8c6..56a5fc402b10 100644
> --- a/drivers/clk/imx/clk-imx27.c
> +++ b/drivers/clk/imx/clk-imx27.c
> @@ -49,17 +49,6 @@ static const char *ssi_sel_clks[] = { "spll_gate", "mpll", };
> static struct clk *clk[IMX27_CLK_MAX];
> static struct clk_onecell_data clk_data;
>
> -static struct clk ** const uart_clks[] __initconst = {
> - &clk[IMX27_CLK_PER1_GATE],
> - &clk[IMX27_CLK_UART1_IPG_GATE],
> - &clk[IMX27_CLK_UART2_IPG_GATE],
> - &clk[IMX27_CLK_UART3_IPG_GATE],
> - &clk[IMX27_CLK_UART4_IPG_GATE],
> - &clk[IMX27_CLK_UART5_IPG_GATE],
> - &clk[IMX27_CLK_UART6_IPG_GATE],
> - NULL
> -};
> -
> static void __init _mx27_clocks_init(unsigned long fref)
> {
> BUG_ON(!ccm);
> @@ -176,7 +165,7 @@ static void __init _mx27_clocks_init(unsigned long fref)
>
> clk_prepare_enable(clk[IMX27_CLK_EMI_AHB_GATE]);
>
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(7);
>
> imx_print_silicon_rev("i.MX27", mx27_revision());
> }
> diff --git a/drivers/clk/imx/clk-imx35.c b/drivers/clk/imx/clk-imx35.c
> index c1df03665c09..0fe5ac210156 100644
> --- a/drivers/clk/imx/clk-imx35.c
> +++ b/drivers/clk/imx/clk-imx35.c
> @@ -82,14 +82,6 @@ enum mx35_clks {
>
> static struct clk *clk[clk_max];
>
> -static struct clk ** const uart_clks[] __initconst = {
> - &clk[ipg],
> - &clk[uart1_gate],
> - &clk[uart2_gate],
> - &clk[uart3_gate],
> - NULL
> -};
> -
> static void __init _mx35_clocks_init(void)
> {
> void __iomem *base;
> @@ -243,7 +235,7 @@ static void __init _mx35_clocks_init(void)
> */
> clk_prepare_enable(clk[scc_gate]);
>
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(4);
>
> imx_print_silicon_rev("i.MX35", mx35_revision());
> }
> diff --git a/drivers/clk/imx/clk-imx5.c b/drivers/clk/imx/clk-imx5.c
> index 01e079b81026..e4493846454d 100644
> --- a/drivers/clk/imx/clk-imx5.c
> +++ b/drivers/clk/imx/clk-imx5.c
> @@ -128,30 +128,6 @@ static const char *ieee1588_sels[] = { "pll3_sw", "pll4_sw", "dummy" /* usbphy2_
> static struct clk *clk[IMX5_CLK_END];
> static struct clk_onecell_data clk_data;
>
> -static struct clk ** const uart_clks_mx51[] __initconst = {
> - &clk[IMX5_CLK_UART1_IPG_GATE],
> - &clk[IMX5_CLK_UART1_PER_GATE],
> - &clk[IMX5_CLK_UART2_IPG_GATE],
> - &clk[IMX5_CLK_UART2_PER_GATE],
> - &clk[IMX5_CLK_UART3_IPG_GATE],
> - &clk[IMX5_CLK_UART3_PER_GATE],
> - NULL
> -};
> -
> -static struct clk ** const uart_clks_mx50_mx53[] __initconst = {
> - &clk[IMX5_CLK_UART1_IPG_GATE],
> - &clk[IMX5_CLK_UART1_PER_GATE],
> - &clk[IMX5_CLK_UART2_IPG_GATE],
> - &clk[IMX5_CLK_UART2_PER_GATE],
> - &clk[IMX5_CLK_UART3_IPG_GATE],
> - &clk[IMX5_CLK_UART3_PER_GATE],
> - &clk[IMX5_CLK_UART4_IPG_GATE],
> - &clk[IMX5_CLK_UART4_PER_GATE],
> - &clk[IMX5_CLK_UART5_IPG_GATE],
> - &clk[IMX5_CLK_UART5_PER_GATE],
> - NULL
> -};
> -
> static void __init mx5_clocks_common_init(void __iomem *ccm_base)
> {
> clk[IMX5_CLK_DUMMY] = imx_clk_fixed("dummy", 0);
> @@ -382,7 +358,7 @@ static void __init mx50_clocks_init(struct device_node *np)
> r = clk_round_rate(clk[IMX5_CLK_USBOH3_PER_GATE], 54000000);
> clk_set_rate(clk[IMX5_CLK_USBOH3_PER_GATE], r);
>
> - imx_register_uart_clocks(uart_clks_mx50_mx53);
> + imx_register_uart_clocks(5);
> }
> CLK_OF_DECLARE(imx50_ccm, "fsl,imx50-ccm", mx50_clocks_init);
>
> @@ -488,7 +464,7 @@ static void __init mx51_clocks_init(struct device_node *np)
> val |= 1 << 23;
> writel(val, MXC_CCM_CLPCR);
>
> - imx_register_uart_clocks(uart_clks_mx51);
> + imx_register_uart_clocks(3);
> }
> CLK_OF_DECLARE(imx51_ccm, "fsl,imx51-ccm", mx51_clocks_init);
>
> @@ -633,6 +609,6 @@ static void __init mx53_clocks_init(struct device_node *np)
> r = clk_round_rate(clk[IMX5_CLK_USBOH3_PER_GATE], 54000000);
> clk_set_rate(clk[IMX5_CLK_USBOH3_PER_GATE], r);
>
> - imx_register_uart_clocks(uart_clks_mx50_mx53);
> + imx_register_uart_clocks(5);
> }
> CLK_OF_DECLARE(imx53_ccm, "fsl,imx53-ccm", mx53_clocks_init);
> diff --git a/drivers/clk/imx/clk-imx6q.c b/drivers/clk/imx/clk-imx6q.c
> index 521d6136d22c..496900de0b0b 100644
> --- a/drivers/clk/imx/clk-imx6q.c
> +++ b/drivers/clk/imx/clk-imx6q.c
> @@ -140,13 +140,6 @@ static inline int clk_on_imx6dl(void)
> return of_machine_is_compatible("fsl,imx6dl");
> }
>
> -static const int uart_clk_ids[] __initconst = {
> - IMX6QDL_CLK_UART_IPG,
> - IMX6QDL_CLK_UART_SERIAL,
> -};
> -
> -static struct clk **uart_clks[ARRAY_SIZE(uart_clk_ids) + 1] __initdata;
> -
> static int ldb_di_sel_by_clock_id(int clock_id)
> {
> switch (clock_id) {
> @@ -440,7 +433,6 @@ static void __init imx6q_clocks_init(struct device_node *ccm_node)
> struct device_node *np;
> void __iomem *anatop_base, *base;
> int ret;
> - int i;
>
> clk_hw_data = kzalloc(struct_size(clk_hw_data, hws,
> IMX6QDL_CLK_END), GFP_KERNEL);
> @@ -982,12 +974,6 @@ static void __init imx6q_clocks_init(struct device_node *ccm_node)
> hws[IMX6QDL_CLK_PLL3_USB_OTG]->clk);
> }
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_clks[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(1);
> }
> CLK_OF_DECLARE(imx6q, "fsl,imx6q-ccm", imx6q_clocks_init);
> diff --git a/drivers/clk/imx/clk-imx6sl.c b/drivers/clk/imx/clk-imx6sl.c
> index 29eab05c9068..277365970320 100644
> --- a/drivers/clk/imx/clk-imx6sl.c
> +++ b/drivers/clk/imx/clk-imx6sl.c
> @@ -179,19 +179,11 @@ void imx6sl_set_wait_clk(bool enter)
> imx6sl_enable_pll_arm(false);
> }
>
> -static const int uart_clk_ids[] __initconst = {
> - IMX6SL_CLK_UART,
> - IMX6SL_CLK_UART_SERIAL,
> -};
> -
> -static struct clk **uart_clks[ARRAY_SIZE(uart_clk_ids) + 1] __initdata;
> -
> static void __init imx6sl_clocks_init(struct device_node *ccm_node)
> {
> struct device_node *np;
> void __iomem *base;
> int ret;
> - int i;
>
> clk_hw_data = kzalloc(struct_size(clk_hw_data, hws,
> IMX6SL_CLK_END), GFP_KERNEL);
> @@ -448,12 +440,6 @@ static void __init imx6sl_clocks_init(struct device_node *ccm_node)
> clk_set_parent(hws[IMX6SL_CLK_LCDIF_AXI_SEL]->clk,
> hws[IMX6SL_CLK_PLL2_PFD2]->clk);
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_clks[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(2);
> }
> CLK_OF_DECLARE(imx6sl, "fsl,imx6sl-ccm", imx6sl_clocks_init);
> diff --git a/drivers/clk/imx/clk-imx6sll.c b/drivers/clk/imx/clk-imx6sll.c
> index 8e8288bda4d0..31d777f30039 100644
> --- a/drivers/clk/imx/clk-imx6sll.c
> +++ b/drivers/clk/imx/clk-imx6sll.c
> @@ -76,26 +76,10 @@ static u32 share_count_ssi1;
> static u32 share_count_ssi2;
> static u32 share_count_ssi3;
>
> -static const int uart_clk_ids[] __initconst = {
> - IMX6SLL_CLK_UART1_IPG,
> - IMX6SLL_CLK_UART1_SERIAL,
> - IMX6SLL_CLK_UART2_IPG,
> - IMX6SLL_CLK_UART2_SERIAL,
> - IMX6SLL_CLK_UART3_IPG,
> - IMX6SLL_CLK_UART3_SERIAL,
> - IMX6SLL_CLK_UART4_IPG,
> - IMX6SLL_CLK_UART4_SERIAL,
> - IMX6SLL_CLK_UART5_IPG,
> - IMX6SLL_CLK_UART5_SERIAL,
> -};
> -
> -static struct clk **uart_clks[ARRAY_SIZE(uart_clk_ids) + 1] __initdata;
> -
> static void __init imx6sll_clocks_init(struct device_node *ccm_node)
> {
> struct device_node *np;
> void __iomem *base;
> - int i;
>
> clk_hw_data = kzalloc(struct_size(clk_hw_data, hws,
> IMX6SLL_CLK_END), GFP_KERNEL);
> @@ -356,13 +340,7 @@ static void __init imx6sll_clocks_init(struct device_node *ccm_node)
>
> of_clk_add_hw_provider(np, of_clk_hw_onecell_get, clk_hw_data);
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_clks[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(5);
>
> /* Lower the AHB clock rate before changing the clock source. */
> clk_set_rate(hws[IMX6SLL_CLK_AHB]->clk, 99000000);
> diff --git a/drivers/clk/imx/clk-imx6sx.c b/drivers/clk/imx/clk-imx6sx.c
> index 20dcce526d07..fc1bd23d4583 100644
> --- a/drivers/clk/imx/clk-imx6sx.c
> +++ b/drivers/clk/imx/clk-imx6sx.c
> @@ -117,18 +117,10 @@ static u32 share_count_ssi3;
> static u32 share_count_sai1;
> static u32 share_count_sai2;
>
> -static const int uart_clk_ids[] __initconst = {
> - IMX6SX_CLK_UART_IPG,
> - IMX6SX_CLK_UART_SERIAL,
> -};
> -
> -static struct clk **uart_clks[ARRAY_SIZE(uart_clk_ids) + 1] __initdata;
> -
> static void __init imx6sx_clocks_init(struct device_node *ccm_node)
> {
> struct device_node *np;
> void __iomem *base;
> - int i;
>
> clk_hw_data = kzalloc(struct_size(clk_hw_data, hws,
> IMX6SX_CLK_CLK_END), GFP_KERNEL);
> @@ -556,12 +548,6 @@ static void __init imx6sx_clocks_init(struct device_node *ccm_node)
> clk_set_parent(hws[IMX6SX_CLK_QSPI1_SEL]->clk, hws[IMX6SX_CLK_PLL2_BUS]->clk);
> clk_set_parent(hws[IMX6SX_CLK_QSPI2_SEL]->clk, hws[IMX6SX_CLK_PLL2_BUS]->clk);
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_clks[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(2);
> }
> CLK_OF_DECLARE(imx6sx, "fsl,imx6sx-ccm", imx6sx_clocks_init);
> diff --git a/drivers/clk/imx/clk-imx7d.c b/drivers/clk/imx/clk-imx7d.c
> index 22d24a6a05e7..c4e0f1c07192 100644
> --- a/drivers/clk/imx/clk-imx7d.c
> +++ b/drivers/clk/imx/clk-imx7d.c
> @@ -377,23 +377,10 @@ static const char *pll_video_bypass_sel[] = { "pll_video_main", "pll_video_main_
> static struct clk_hw **hws;
> static struct clk_hw_onecell_data *clk_hw_data;
>
> -static const int uart_clk_ids[] __initconst = {
> - IMX7D_UART1_ROOT_CLK,
> - IMX7D_UART2_ROOT_CLK,
> - IMX7D_UART3_ROOT_CLK,
> - IMX7D_UART4_ROOT_CLK,
> - IMX7D_UART5_ROOT_CLK,
> - IMX7D_UART6_ROOT_CLK,
> - IMX7D_UART7_ROOT_CLK,
> -};
> -
> -static struct clk **uart_clks[ARRAY_SIZE(uart_clk_ids) + 1] __initdata;
> -
> static void __init imx7d_clocks_init(struct device_node *ccm_node)
> {
> struct device_node *np;
> void __iomem *base;
> - int i;
>
> clk_hw_data = kzalloc(struct_size(clk_hw_data, hws,
> IMX7D_CLK_END), GFP_KERNEL);
> @@ -897,14 +884,7 @@ static void __init imx7d_clocks_init(struct device_node *ccm_node)
> hws[IMX7D_USB1_MAIN_480M_CLK] = imx_clk_hw_fixed_factor("pll_usb1_main_clk", "osc", 20, 1);
> hws[IMX7D_USB_MAIN_480M_CLK] = imx_clk_hw_fixed_factor("pll_usb_main_clk", "osc", 20, 1);
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_clks[i] = &hws[index]->clk;
> - }
> -
> -
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(7);
>
> }
> CLK_OF_DECLARE(imx7d, "fsl,imx7d-ccm", imx7d_clocks_init);
> diff --git a/drivers/clk/imx/clk-imx7ulp.c b/drivers/clk/imx/clk-imx7ulp.c
> index 634c0b6636b0..779e09105da7 100644
> --- a/drivers/clk/imx/clk-imx7ulp.c
> +++ b/drivers/clk/imx/clk-imx7ulp.c
> @@ -43,19 +43,6 @@ static const struct clk_div_table ulp_div_table[] = {
> { /* sentinel */ },
> };
>
> -static const int pcc2_uart_clk_ids[] __initconst = {
> - IMX7ULP_CLK_LPUART4,
> - IMX7ULP_CLK_LPUART5,
> -};
> -
> -static const int pcc3_uart_clk_ids[] __initconst = {
> - IMX7ULP_CLK_LPUART6,
> - IMX7ULP_CLK_LPUART7,
> -};
> -
> -static struct clk **pcc2_uart_clks[ARRAY_SIZE(pcc2_uart_clk_ids) + 1] __initdata;
> -static struct clk **pcc3_uart_clks[ARRAY_SIZE(pcc3_uart_clk_ids) + 1] __initdata;
> -
> static void __init imx7ulp_clk_scg1_init(struct device_node *np)
> {
> struct clk_hw_onecell_data *clk_data;
> @@ -150,7 +137,6 @@ static void __init imx7ulp_clk_pcc2_init(struct device_node *np)
> struct clk_hw_onecell_data *clk_data;
> struct clk_hw **hws;
> void __iomem *base;
> - int i;
>
> clk_data = kzalloc(struct_size(clk_data, hws, IMX7ULP_CLK_PCC2_END),
> GFP_KERNEL);
> @@ -190,13 +176,7 @@ static void __init imx7ulp_clk_pcc2_init(struct device_node *np)
>
> of_clk_add_hw_provider(np, of_clk_hw_onecell_get, clk_data);
>
> - for (i = 0; i < ARRAY_SIZE(pcc2_uart_clk_ids); i++) {
> - int index = pcc2_uart_clk_ids[i];
> -
> - pcc2_uart_clks[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(pcc2_uart_clks);
> + imx_register_uart_clocks(2);
> }
> CLK_OF_DECLARE(imx7ulp_clk_pcc2, "fsl,imx7ulp-pcc2", imx7ulp_clk_pcc2_init);
>
> @@ -205,7 +185,6 @@ static void __init imx7ulp_clk_pcc3_init(struct device_node *np)
> struct clk_hw_onecell_data *clk_data;
> struct clk_hw **hws;
> void __iomem *base;
> - int i;
>
> clk_data = kzalloc(struct_size(clk_data, hws, IMX7ULP_CLK_PCC3_END),
> GFP_KERNEL);
> @@ -244,13 +223,7 @@ static void __init imx7ulp_clk_pcc3_init(struct device_node *np)
>
> of_clk_add_hw_provider(np, of_clk_hw_onecell_get, clk_data);
>
> - for (i = 0; i < ARRAY_SIZE(pcc3_uart_clk_ids); i++) {
> - int index = pcc3_uart_clk_ids[i];
> -
> - pcc3_uart_clks[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(pcc3_uart_clks);
> + imx_register_uart_clocks(7);
> }
> CLK_OF_DECLARE(imx7ulp_clk_pcc3, "fsl,imx7ulp-pcc3", imx7ulp_clk_pcc3_init);
>
> diff --git a/drivers/clk/imx/clk-imx8mm.c b/drivers/clk/imx/clk-imx8mm.c
> index 6a01eec36dd0..f1919fafb124 100644
> --- a/drivers/clk/imx/clk-imx8mm.c
> +++ b/drivers/clk/imx/clk-imx8mm.c
> @@ -296,20 +296,12 @@ static const char * const clkout_sels[] = {"audio_pll1_out", "audio_pll2_out", "
> static struct clk_hw_onecell_data *clk_hw_data;
> static struct clk_hw **hws;
>
> -static const int uart_clk_ids[] = {
> - IMX8MM_CLK_UART1_ROOT,
> - IMX8MM_CLK_UART2_ROOT,
> - IMX8MM_CLK_UART3_ROOT,
> - IMX8MM_CLK_UART4_ROOT,
> -};
> -static struct clk **uart_hws[ARRAY_SIZE(uart_clk_ids) + 1];
> -
> static int imx8mm_clocks_probe(struct platform_device *pdev)
> {
> struct device *dev = &pdev->dev;
> struct device_node *np = dev->of_node;
> void __iomem *base;
> - int ret, i;
> + int ret;
>
> clk_hw_data = kzalloc(struct_size(clk_hw_data, hws,
> IMX8MM_CLK_END), GFP_KERNEL);
> @@ -634,13 +626,7 @@ static int imx8mm_clocks_probe(struct platform_device *pdev)
> goto unregister_hws;
> }
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_hws[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(uart_hws);
> + imx_register_uart_clocks(4);
>
> return 0;
>
> diff --git a/drivers/clk/imx/clk-imx8mn.c b/drivers/clk/imx/clk-imx8mn.c
> index 324c5fd0aa04..88f6630cd472 100644
> --- a/drivers/clk/imx/clk-imx8mn.c
> +++ b/drivers/clk/imx/clk-imx8mn.c
> @@ -289,20 +289,12 @@ static const char * const clkout_sels[] = {"audio_pll1_out", "audio_pll2_out", "
> static struct clk_hw_onecell_data *clk_hw_data;
> static struct clk_hw **hws;
>
> -static const int uart_clk_ids[] = {
> - IMX8MN_CLK_UART1_ROOT,
> - IMX8MN_CLK_UART2_ROOT,
> - IMX8MN_CLK_UART3_ROOT,
> - IMX8MN_CLK_UART4_ROOT,
> -};
> -static struct clk **uart_hws[ARRAY_SIZE(uart_clk_ids) + 1];
> -
> static int imx8mn_clocks_probe(struct platform_device *pdev)
> {
> struct device *dev = &pdev->dev;
> struct device_node *np = dev->of_node;
> void __iomem *base;
> - int ret, i;
> + int ret;
>
> clk_hw_data = kzalloc(struct_size(clk_hw_data, hws,
> IMX8MN_CLK_END), GFP_KERNEL);
> @@ -585,13 +577,7 @@ static int imx8mn_clocks_probe(struct platform_device *pdev)
> goto unregister_hws;
> }
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_hws[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(uart_hws);
> + imx_register_uart_clocks(4);
>
> return 0;
>
> diff --git a/drivers/clk/imx/clk-imx8mp.c b/drivers/clk/imx/clk-imx8mp.c
> index 2f4e1d674e1c..3e6557e7d559 100644
> --- a/drivers/clk/imx/clk-imx8mp.c
> +++ b/drivers/clk/imx/clk-imx8mp.c
> @@ -414,20 +414,11 @@ static const char * const imx8mp_dram_core_sels[] = {"dram_pll_out", "dram_alt_r
> static struct clk_hw **hws;
> static struct clk_hw_onecell_data *clk_hw_data;
>
> -static const int uart_clk_ids[] = {
> - IMX8MP_CLK_UART1_ROOT,
> - IMX8MP_CLK_UART2_ROOT,
> - IMX8MP_CLK_UART3_ROOT,
> - IMX8MP_CLK_UART4_ROOT,
> -};
> -static struct clk **uart_clks[ARRAY_SIZE(uart_clk_ids) + 1];
> -
> static int imx8mp_clocks_probe(struct platform_device *pdev)
> {
> struct device *dev = &pdev->dev;
> struct device_node *np;
> void __iomem *anatop_base, *ccm_base;
> - int i;
>
> np = of_find_compatible_node(NULL, NULL, "fsl,imx8mp-anatop");
> anatop_base = of_iomap(np, 0);
> @@ -737,13 +728,7 @@ static int imx8mp_clocks_probe(struct platform_device *pdev)
>
> of_clk_add_hw_provider(np, of_clk_hw_onecell_get, clk_hw_data);
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_clks[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(uart_clks);
> + imx_register_uart_clocks(4);
>
> return 0;
> }
> diff --git a/drivers/clk/imx/clk-imx8mq.c b/drivers/clk/imx/clk-imx8mq.c
> index 4dd4ae9d022b..3e1a10d3f55c 100644
> --- a/drivers/clk/imx/clk-imx8mq.c
> +++ b/drivers/clk/imx/clk-imx8mq.c
> @@ -281,20 +281,12 @@ static const char * const pllout_monitor_sels[] = {"osc_25m", "osc_27m", "dummy"
> static struct clk_hw_onecell_data *clk_hw_data;
> static struct clk_hw **hws;
>
> -static const int uart_clk_ids[] = {
> - IMX8MQ_CLK_UART1_ROOT,
> - IMX8MQ_CLK_UART2_ROOT,
> - IMX8MQ_CLK_UART3_ROOT,
> - IMX8MQ_CLK_UART4_ROOT,
> -};
> -static struct clk **uart_hws[ARRAY_SIZE(uart_clk_ids) + 1];
> -
> static int imx8mq_clocks_probe(struct platform_device *pdev)
> {
> struct device *dev = &pdev->dev;
> struct device_node *np = dev->of_node;
> void __iomem *base;
> - int err, i;
> + int err;
>
> clk_hw_data = kzalloc(struct_size(clk_hw_data, hws,
> IMX8MQ_CLK_END), GFP_KERNEL);
> @@ -629,13 +621,7 @@ static int imx8mq_clocks_probe(struct platform_device *pdev)
> goto unregister_hws;
> }
>
> - for (i = 0; i < ARRAY_SIZE(uart_clk_ids); i++) {
> - int index = uart_clk_ids[i];
> -
> - uart_hws[i] = &hws[index]->clk;
> - }
> -
> - imx_register_uart_clocks(uart_hws);
> + imx_register_uart_clocks(4);
>
> return 0;
>
> diff --git a/drivers/clk/imx/clk.c b/drivers/clk/imx/clk.c
> index 47882c51cb85..35e41b9a4e34 100644
> --- a/drivers/clk/imx/clk.c
> +++ b/drivers/clk/imx/clk.c
> @@ -147,8 +147,10 @@ void imx_cscmr1_fixup(u32 *val)
> }
>
> #ifndef MODULE
> -static int imx_keep_uart_clocks;
> -static struct clk ** const *imx_uart_clocks;
> +
> +static bool imx_keep_uart_clocks;
> +static int imx_enabled_uart_clocks;
> +static struct clk **imx_uart_clocks;
>
> static int __init imx_keep_uart_clocks_param(char *str)
> {
> @@ -161,24 +163,45 @@ __setup_param("earlycon", imx_keep_uart_earlycon,
> __setup_param("earlyprintk", imx_keep_uart_earlyprintk,
> imx_keep_uart_clocks_param, 0);
>
> -void imx_register_uart_clocks(struct clk ** const clks[])
> +void imx_register_uart_clocks(unsigned int clk_count)
> {
> + imx_enabled_uart_clocks = 0;
> +
> +/* i.MX boards use device trees now. For build tests without CONFIG_OF, do nothing */
> +#ifdef CONFIG_OF
> if (imx_keep_uart_clocks) {
> int i;
>
> - imx_uart_clocks = clks;
> - for (i = 0; imx_uart_clocks[i]; i++)
> - clk_prepare_enable(*imx_uart_clocks[i]);
> + imx_uart_clocks = kcalloc(clk_count, sizeof(struct clk *), GFP_KERNEL);
> +
> + if (!of_stdout)
> + return;
Memory leak. Just do if (imx_keep_uart_clocks && of_stdout)
> +
> + for (i = 0; i < clk_count; i++) {
> + imx_uart_clocks[imx_enabled_uart_clocks] = of_clk_get(of_stdout, i);
> +
> + /* Stop if there are no more of_stdout references */
> + if (IS_ERR(imx_uart_clocks[imx_enabled_uart_clocks]))
> + return;
> +
> + /* Only enable the clock if it's not NULL */
> + if (imx_uart_clocks[imx_enabled_uart_clocks])
> + clk_prepare_enable(imx_uart_clocks[imx_enabled_uart_clocks++]);
> + }
> }
> +#endif
> }
>
> static int __init imx_clk_disable_uart(void)
> {
> - if (imx_keep_uart_clocks && imx_uart_clocks) {
> + if (imx_keep_uart_clocks && imx_enabled_uart_clocks) {
> int i;
>
> - for (i = 0; imx_uart_clocks[i]; i++)
> - clk_disable_unprepare(*imx_uart_clocks[i]);
> + for (i = 0; i < imx_enabled_uart_clocks; i++) {
> + clk_disable_unprepare(imx_uart_clocks[i]);
> + clk_put(imx_uart_clocks[i]);
> + };
> + kfree(imx_uart_clocks);
> }
>
> return 0;
> diff --git a/drivers/clk/imx/clk.h b/drivers/clk/imx/clk.h
> index 4f04c8287286..7571603bee23 100644
> --- a/drivers/clk/imx/clk.h
> +++ b/drivers/clk/imx/clk.h
> @@ -11,9 +11,9 @@ extern spinlock_t imx_ccm_lock;
> void imx_check_clocks(struct clk *clks[], unsigned int count);
> void imx_check_clk_hws(struct clk_hw *clks[], unsigned int count);
> #ifndef MODULE
> -void imx_register_uart_clocks(struct clk ** const clks[]);
> +void imx_register_uart_clocks(unsigned int clk_count);
> #else
> -static inline void imx_register_uart_clocks(struct clk ** const clks[])
> +static inline void imx_register_uart_clocks(unsigned int clk_count)
> {
> }
> #endif
>
--
Pengutronix e.K. | |
Steuerwalder Str. 21 | http://www.pengutronix.de/ |
31137 Hildesheim, Germany | Phone: +49-5121-206917-0 |
Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
More information about the linux-arm-kernel
mailing list