clk: imx: disable the pfd when set pfdv2 clock rate

It is possible that a PFD is enabled in HW but not in SW. That
means the enable count & prepare count of the PFD clock is '0',
so the 'CLK_SET_RATE' flag can do nothing when the rate is changed
while the PFD is hw enabled. In order to safely change the pfd
rate, we can disable the PFD directly if it is hw enabled but not
used by SW end user.

Signed-off-by: Jacky Bai <ping.bai@nxp.com>
Reviewed-by: Abel Vesa <abel.vesa@nxp.com>
Link: https://lore.kernel.org/r/20210914065208.3582128-7-ping.bai@nxp.com
Signed-off-by: Abel Vesa <abel.vesa@nxp.com>

diff --git a/drivers/clk/imx/clk-pfdv2.c b/drivers/clk/imx/clk-pfdv2.c
index 6b744c84278ea0e8eb7c0d3a211a86c0b14ec803..9cba8352198839dbd051a50fab6fa552bced9e43 100644 (file)
--- a/drivers/clk/imx/clk-pfdv2.c
+++ b/drivers/clk/imx/clk-pfdv2.c
@@ -161,8 +161,17 @@ static int clk_pfdv2_set_rate(struct clk_hw *hw, unsigned long rate,
        if (!rate)
                return -EINVAL;
 
-       /* PFD can NOT change rate without gating */
-       WARN_ON(clk_pfdv2_is_enabled(hw));
+       /*
+        * PFD can NOT change rate without gating.
+        * as the PFDs may enabled in HW by default but no
+        * consumer used it, the enable count is '0', so the
+        * 'SET_RATE_GATE' can NOT help on blocking the set_rate
+        * ops especially for 'assigned-clock-xxx'. In order
+        * to simplify the case, just disable the PFD if it is
+        * enabled in HW but not in SW.
+        */
+       if (clk_pfdv2_is_enabled(hw))
+               clk_pfdv2_disable(hw);
 
        tmp = tmp * 18 + rate / 2;
        do_div(tmp, rate);