Use readl_poll_timeout_atomic() to simplify code

Signed-off-by: Chunfeng Yun <[email protected]>
---
 drivers/phy/broadcom/phy-bcm-sr-usb.c | 19 ++++++++-----------
 1 file changed, 8 insertions(+), 11 deletions(-)

diff --git a/drivers/phy/broadcom/phy-bcm-sr-usb.c 
b/drivers/phy/broadcom/phy-bcm-sr-usb.c
index 77c025a..c3e99ad 100644
--- a/drivers/phy/broadcom/phy-bcm-sr-usb.c
+++ b/drivers/phy/broadcom/phy-bcm-sr-usb.c
@@ -5,6 +5,7 @@
 
 #include <linux/delay.h>
 #include <linux/io.h>
+#include <linux/iopoll.h>
 #include <linux/module.h>
 #include <linux/of.h>
 #include <linux/phy/phy.h>
@@ -109,19 +110,15 @@ static inline void bcm_usb_reg32_setbits(void __iomem 
*addr, uint32_t set)
 
 static int bcm_usb_pll_lock_check(void __iomem *addr, u32 bit)
 {
-       int retry;
-       u32 rd_data;
+       u32 data;
+       int ret;
 
-       retry = PLL_LOCK_RETRY_COUNT;
-       do {
-               rd_data = readl(addr);
-               if (rd_data & bit)
-                       return 0;
-               udelay(1);
-       } while (--retry > 0);
+       ret = readl_poll_timeout_atomic(addr, data, (data & bit), 1,
+                                       PLL_LOCK_RETRY_COUNT);
+       if (ret)
+               pr_err("%s: FAIL\n", __func__);
 
-       pr_err("%s: FAIL\n", __func__);
-       return -ETIMEDOUT;
+       return ret;
 }
 
 static int bcm_usb_ss_phy_init(struct bcm_usb_phy_cfg *phy_cfg)
-- 
1.9.1

Reply via email to