iopoll: Extend read_poll_timeout macro to support variable parameters
authorAriel D'Alessandro <ariel.dalessandro@collabora.com>
Tue, 12 Apr 2022 13:31:35 +0000 (10:31 -0300)
committerStefano Babic <sbabic@denx.de>
Tue, 12 Apr 2022 17:10:44 +0000 (19:10 +0200)
This macro currently supports only one parameter. Based on Linux iopoll,
let's extend read_poll_timeout common API to allow multiple variable
parameters.

Signed-off-by: Ariel D'Alessandro <ariel.dalessandro@collabora.com>
arch/arm/mach-socfpga/reset_manager_s10.c
drivers/mmc/rockchip_sdhci.c
include/linux/iopoll.h

index d2337bd..f47fec1 100644 (file)
@@ -80,9 +80,9 @@ void socfpga_bridges_reset(int enable)
                             ~0);
 
                /* Poll until all idleack to 0 */
-               read_poll_timeout(readl, socfpga_get_sysmgr_addr() +
-                                 SYSMGR_SOC64_NOC_IDLEACK, reg, !reg, 1000,
-                                 300000);
+               read_poll_timeout(readl, reg, !reg, 1000, 300000,
+                                 socfpga_get_sysmgr_addr() +
+                                 SYSMGR_SOC64_NOC_IDLEACK);
        } else {
                /* set idle request to all bridges */
                writel(~0,
@@ -93,18 +93,20 @@ void socfpga_bridges_reset(int enable)
                writel(1, socfpga_get_sysmgr_addr() + SYSMGR_SOC64_NOC_TIMEOUT);
 
                /* Poll until all idleack to 1 */
-               read_poll_timeout(readl, socfpga_get_sysmgr_addr() +
-                                 SYSMGR_SOC64_NOC_IDLEACK, reg,
+               read_poll_timeout(readl, reg,
                                  reg == (SYSMGR_NOC_H2F_MSK |
                                          SYSMGR_NOC_LWH2F_MSK),
-                                 1000, 300000);
+                                 1000, 300000,
+                                 socfpga_get_sysmgr_addr() +
+                                 SYSMGR_SOC64_NOC_IDLEACK);
 
                /* Poll until all idlestatus to 1 */
-               read_poll_timeout(readl, socfpga_get_sysmgr_addr() +
-                                 SYSMGR_SOC64_NOC_IDLESTATUS, reg,
+               read_poll_timeout(readl, reg,
                                  reg == (SYSMGR_NOC_H2F_MSK |
                                          SYSMGR_NOC_LWH2F_MSK),
-                                 1000, 300000);
+                                 1000, 300000,
+                                 socfpga_get_sysmgr_addr() +
+                                 SYSMGR_SOC64_NOC_IDLESTATUS);
 
                /* Reset all bridges (except NOR DDR scheduler & F2S) */
                setbits_le32(socfpga_get_rstmgr_addr() + RSTMGR_SOC64_BRGMODRST,
index f3f9d83..1fdc841 100644 (file)
@@ -202,8 +202,8 @@ static void rk3399_emmc_phy_power_on(struct rockchip_emmc_phy *phy, u32 clock)
        /* REN Enable on STRB Line for HS400 */
        writel(RK_CLRSETBITS(0, 1 << 9), &phy->emmcphy_con[2]);
 
-       read_poll_timeout(readl, &phy->emmcphy_status, dllrdy,
-                         PHYCTRL_DLL_LOCK_WO_TMOUT(dllrdy), 1, 5000);
+       read_poll_timeout(readl, dllrdy, PHYCTRL_DLL_LOCK_WO_TMOUT(dllrdy), 1,
+                         5000, &phy->emmcphy_status);
 }
 
 static void rk3399_emmc_phy_power_off(struct rockchip_emmc_phy *phy)
@@ -328,8 +328,9 @@ static int rk3568_sdhci_emmc_set_clock(struct sdhci_host *host, unsigned int clo
                        DWCMSHC_EMMC_DLL_START;
                sdhci_writel(host, extra, DWCMSHC_EMMC_DLL_CTRL);
 
-               ret = read_poll_timeout(readl, host->ioaddr + DWCMSHC_EMMC_DLL_STATUS0,
-                                       val, DLL_LOCK_WO_TMOUT(val), 1, 500);
+               ret = read_poll_timeout(readl, val, DLL_LOCK_WO_TMOUT(val), 1,
+                                       500,
+                                       host->ioaddr + DWCMSHC_EMMC_DLL_STATUS0);
                if (ret)
                        return ret;
 
index 30cdea0..0ee2bdd 100644 (file)
 /**
  * read_poll_timeout - Periodically poll an address until a condition is met or a timeout occurs
  * @op: accessor function (takes @addr as its only argument)
- * @addr: Address to poll
  * @val: Variable to read the value into
  * @cond: Break condition (usually involving @val)
  * @sleep_us: Maximum time to sleep in us
  * @timeout_us: Timeout in us, 0 means never timeout
+ * @args: arguments for @op poll
  *
  * Returns 0 on success and -ETIMEDOUT upon a timeout. In either
  * case, the last read value at @addr is stored in @val.
  * When available, you'll probably want to use one of the specialized
  * macros defined below rather than this macro directly.
  */
-#define read_poll_timeout(op, addr, val, cond, sleep_us, timeout_us)   \
+#define read_poll_timeout(op, val, cond, sleep_us, timeout_us, args...)        \
 ({ \
        unsigned long timeout = timer_get_us() + timeout_us; \
        for (;;) { \
-               (val) = op(addr); \
+               (val) = op(args); \
                if (cond) \
                        break; \
                if (timeout_us && time_after(timer_get_us(), timeout)) { \
-                       (val) = op(addr); \
+                       (val) = op(args); \
                        break; \
                } \
                if (sleep_us) \
 })
 
 #define readx_poll_sleep_timeout(op, addr, val, cond, sleep_us, timeout_us) \
-       read_poll_timeout(op, addr, val, cond, sleep_us, timeout_us)
+       read_poll_timeout(op, val, cond, sleep_us, timeout_us, addr)
 
 #define readl_poll_sleep_timeout(addr, val, cond, sleep_us, timeout_us) \
        readx_poll_sleep_timeout(readl, addr, val, cond, sleep_us, timeout_us)
 
 #define readx_poll_timeout(op, addr, val, cond, timeout_us) \
-       read_poll_timeout(op, addr, val, cond, false, timeout_us)
+       read_poll_timeout(op, val, cond, false, timeout_us, addr)
 
 #define readb_poll_timeout(addr, val, cond, timeout_us) \
        readx_poll_timeout(readb, addr, val, cond, timeout_us)