smsc75xx: add explicit test that device is READY
authorSteve Glendinning <steve.glendinning@shawell.net>
Fri, 28 Sep 2012 00:57:51 +0000 (00:57 +0000)
committerDavid S. Miller <davem@davemloft.net>
Fri, 28 Sep 2012 22:35:47 +0000 (18:35 -0400)
This patch adds an explicit test that the READY bit is set on
the device when attempting to initialize it.

If this bit is clear then the device hasn't succesfully started
all its clocks, and this patch helps make the resulting logged
error more helpful.

Signed-off-by: Steve Glendinning <steve.glendinning@shawell.net>
Signed-off-by: David S. Miller <davem@davemloft.net>
drivers/net/usb/smsc75xx.c

index 376143e8a1aaf6f78ee44fb76888922064c46dd1..1f45f7b2fe639750e72b77ebe591933bc0e2637e 100644 (file)
@@ -756,6 +756,26 @@ static int smsc75xx_set_features(struct net_device *netdev,
        return 0;
 }
 
+static int smsc75xx_wait_ready(struct usbnet *dev)
+{
+       int timeout = 0;
+
+       do {
+               u32 buf;
+               int ret = smsc75xx_read_reg(dev, PMT_CTL, &buf);
+               check_warn_return(ret, "Failed to read PMT_CTL: %d", ret);
+
+               if (buf & PMT_CTL_DEV_RDY)
+                       return 0;
+
+               msleep(10);
+               timeout++;
+       } while (timeout < 100);
+
+       netdev_warn(dev->net, "timeout waiting for device ready");
+       return -EIO;
+}
+
 static int smsc75xx_reset(struct usbnet *dev)
 {
        struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
@@ -764,6 +784,9 @@ static int smsc75xx_reset(struct usbnet *dev)
 
        netif_dbg(dev, ifup, dev->net, "entering smsc75xx_reset");
 
+       ret = smsc75xx_wait_ready(dev);
+       check_warn_return(ret, "device not ready in smsc75xx_reset");
+
        ret = smsc75xx_read_reg(dev, HW_CFG, &buf);
        check_warn_return(ret, "Failed to read HW_CFG: %d", ret);