iopoll: Add dealy to read poll
authorJagan Teki <jagan@amarulasolutions.com>
Sat, 2 May 2020 07:15:02 +0000 (12:45 +0530)
committerJagan Teki <jagan@amarulasolutions.com>
Sun, 10 May 2020 20:00:49 +0000 (01:30 +0530)
Some drivers and other bsp code not only poll the
register with timeout but also required to delay
on each transaction.

This patch add that requirement by adding sleep_us
variable so-that read_poll_timeout now support
delay as well.

This change is referenced from Linux from below commit:
commit <5f5323a14cad19323060a8cbf9d96f2280a462dd> ("iopoll:
introduce read_poll_timeout macro")

Signed-off-by: Jagan Teki <jagan@amarulasolutions.com>
include/linux/iopoll.h

index 51966d83da92c2296297346fdb952170b73da878..76d2f951c1573070978dd6fe664dee940fa6e047 100644 (file)
@@ -6,6 +6,7 @@
 #ifndef _LINUX_IOPOLL_H
 #define _LINUX_IOPOLL_H
 
+#include <linux/delay.h>
 #include <linux/errno.h>
 #include <linux/io.h>
 #include <time.h>
@@ -16,6 +17,7 @@
  * @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
  *
  * Returns 0 on success and -ETIMEDOUT upon a timeout. In either
@@ -24,7 +26,7 @@
  * 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, timeout_us)     \
+#define read_poll_timeout(op, addr, val, cond, sleep_us, timeout_us)   \
 ({ \
        unsigned long timeout = timer_get_us() + timeout_us; \
        for (;;) { \
                        (val) = op(addr); \
                        break; \
                } \
+               if (sleep_us) \
+                       udelay(sleep_us); \
        } \
        (cond) ? 0 : -ETIMEDOUT; \
 })
 
 #define readx_poll_timeout(op, addr, val, cond, timeout_us) \
-       read_poll_timeout(op, addr, val, cond, timeout_us)
+       read_poll_timeout(op, addr, val, cond, false, timeout_us)
 
 #define readb_poll_timeout(addr, val, cond, timeout_us) \
        readx_poll_timeout(readb, addr, val, cond, timeout_us)