[PATCH V4] clk: imx: Fix reparenting of UARTs not associated with stdout
Adam Ford
aford173 at gmail.com
Wed Mar 24 17:06:25 GMT 2021
On Mon, Mar 22, 2021 at 4:42 PM Abel Vesa <abel.vesa at nxp.com> wrote:
>
> On 21-03-13 06:28:17, 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;
> > +
> > + 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]);
> > + };
>
> Also removed the semicolon here and squashed into your change.
Thanks for doing that. Sorry to make you have to do that.
adam
>
> > + 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
> > --
> > 2.25.1
> >
More information about the linux-arm-kernel
mailing list