clk: imx: clk-pllv3: Use readl_relaxed_poll_timeout() for PLL lock wait
Use readl_relaxed_poll_timeout() for PLL lock wait which can simplify the code a lot. Signed-off-by: Anson Huang <Anson.Huang@nxp.com> Reviewed-by: Abel Vesa <abel.vesa@nxp.com> Reviewed-by: Stephen Boyd <sboyd@kernel.org> Signed-off-by: Shawn Guo <shawnguo@kernel.org>
This commit is contained in:
@@ -7,6 +7,7 @@
|
|||||||
#include <linux/clk-provider.h>
|
#include <linux/clk-provider.h>
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
#include <linux/io.h>
|
#include <linux/io.h>
|
||||||
|
#include <linux/iopoll.h>
|
||||||
#include <linux/slab.h>
|
#include <linux/slab.h>
|
||||||
#include <linux/jiffies.h>
|
#include <linux/jiffies.h>
|
||||||
#include <linux/err.h>
|
#include <linux/err.h>
|
||||||
@@ -25,6 +26,8 @@
|
|||||||
#define IMX7_ENET_PLL_POWER (0x1 << 5)
|
#define IMX7_ENET_PLL_POWER (0x1 << 5)
|
||||||
#define IMX7_DDR_PLL_POWER (0x1 << 20)
|
#define IMX7_DDR_PLL_POWER (0x1 << 20)
|
||||||
|
|
||||||
|
#define PLL_LOCK_TIMEOUT 10000
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* struct clk_pllv3 - IMX PLL clock version 3
|
* struct clk_pllv3 - IMX PLL clock version 3
|
||||||
* @clk_hw: clock source
|
* @clk_hw: clock source
|
||||||
@@ -53,23 +56,14 @@ struct clk_pllv3 {
|
|||||||
|
|
||||||
static int clk_pllv3_wait_lock(struct clk_pllv3 *pll)
|
static int clk_pllv3_wait_lock(struct clk_pllv3 *pll)
|
||||||
{
|
{
|
||||||
unsigned long timeout = jiffies + msecs_to_jiffies(10);
|
|
||||||
u32 val = readl_relaxed(pll->base) & pll->power_bit;
|
u32 val = readl_relaxed(pll->base) & pll->power_bit;
|
||||||
|
|
||||||
/* No need to wait for lock when pll is not powered up */
|
/* No need to wait for lock when pll is not powered up */
|
||||||
if ((pll->powerup_set && !val) || (!pll->powerup_set && val))
|
if ((pll->powerup_set && !val) || (!pll->powerup_set && val))
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
/* Wait for PLL to lock */
|
return readl_relaxed_poll_timeout(pll->base, val, val & BM_PLL_LOCK,
|
||||||
do {
|
500, PLL_LOCK_TIMEOUT);
|
||||||
if (readl_relaxed(pll->base) & BM_PLL_LOCK)
|
|
||||||
break;
|
|
||||||
if (time_after(jiffies, timeout))
|
|
||||||
break;
|
|
||||||
usleep_range(50, 500);
|
|
||||||
} while (1);
|
|
||||||
|
|
||||||
return readl_relaxed(pll->base) & BM_PLL_LOCK ? 0 : -ETIMEDOUT;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int clk_pllv3_prepare(struct clk_hw *hw)
|
static int clk_pllv3_prepare(struct clk_hw *hw)
|
||||||
|
Reference in New Issue
Block a user