#include <linux/clk.h>
 #include <linux/err.h>
 #include <linux/io.h>
+#include <linux/iopoll.h>
 #include <linux/pm_runtime.h>
 #include <linux/davinci_emac.h>
 #include <linux/of.h>
 static inline int wait_for_idle(struct davinci_mdio_data *data)
 {
        struct davinci_mdio_regs __iomem *regs = data->regs;
-       unsigned long timeout = jiffies + msecs_to_jiffies(MDIO_TIMEOUT);
+       u32 val, ret;
 
-       while (time_after(timeout, jiffies)) {
-               if (__raw_readl(®s->control) & CONTROL_IDLE)
-                       return 0;
-       }
-       dev_err(data->dev, "timed out waiting for idle\n");
-       return -ETIMEDOUT;
+       ret = readl_poll_timeout(®s->control, val, val & CONTROL_IDLE,
+                                0, MDIO_TIMEOUT * 1000);
+       if (ret)
+               dev_err(data->dev, "timed out waiting for idle\n");
+
+       return ret;
 }
 
 static int davinci_mdio_read(struct mii_bus *bus, int phy_id, int phy_reg)