X-Git-Url: https://git.rohieb.name/openwrt.git/blobdiff_plain/58618dfb3db93ac481c3b33b114df4588bc60962..19b6acd0905aef3f8718e694c0264ef5ddcf6403:/target/linux/generic-2.6/files/drivers/net/phy/ar8216.c

diff --git a/target/linux/generic-2.6/files/drivers/net/phy/ar8216.c b/target/linux/generic-2.6/files/drivers/net/phy/ar8216.c
index 394e50d47..4ae61da23 100644
--- a/target/linux/generic-2.6/files/drivers/net/phy/ar8216.c
+++ b/target/linux/generic-2.6/files/drivers/net/phy/ar8216.c
@@ -33,6 +33,7 @@
 
 /* size of the vlan table */
 #define AR8X16_MAX_VLANS	128
+#define AR8X16_PROBE_RETRIES	10
 
 struct ar8216_priv {
 	struct switch_dev dev;
@@ -119,18 +120,35 @@ ar8216_id_chip(struct ar8216_priv *priv)
 {
 	u32 val;
 	u16 id;
+	int i;
+
 	val = ar8216_mii_read(priv, AR8216_REG_CTRL);
+	if (val == ~0)
+		return UNKNOWN;
+
 	id = val & (AR8216_CTRL_REVISION | AR8216_CTRL_VERSION);
+	for (i = 0; i < AR8X16_PROBE_RETRIES; i++) {
+		u16 t;
+
+		val = ar8216_mii_read(priv, AR8216_REG_CTRL);
+		if (val == ~0)
+			return UNKNOWN;
+
+		t = val & (AR8216_CTRL_REVISION | AR8216_CTRL_VERSION);
+		if (t != id)
+			return UNKNOWN;
+	}
+
 	switch (id) {
 	case 0x0101:
 		return AR8216;
 	case 0x1001:
 		return AR8316;
 	default:
-		printk(KERN_ERR
+		printk(KERN_DEBUG
 			"ar8216: Unknown Atheros device [ver=%d, rev=%d, phy_id=%04x%04x]\n",
-			(int)(val >> AR8216_CTRL_VERSION_S),
-			(int)(val & AR8216_CTRL_REVISION),
+			(int)(id >> AR8216_CTRL_VERSION_S),
+			(int)(id & AR8216_CTRL_REVISION),
 			priv->phy->bus->read(priv->phy->bus, priv->phy->addr, 2),
 			priv->phy->bus->read(priv->phy->bus, priv->phy->addr, 3));
 
@@ -279,7 +297,7 @@ recv:
 error:
 	/* no vlan? eat the packet! */
 	dev_kfree_skb_any(skb);
-	return 0;
+	return NET_RX_DROP;
 }
 
 static int
@@ -628,8 +646,10 @@ ar8216_config_init(struct phy_device *pdev)
 
 	priv->chip = ar8216_id_chip(priv);
 
-	printk(KERN_INFO "%s: AR%d PHY driver attached.\n",
-		pdev->attached_dev->name, priv->chip);
+	if (pdev->addr == 0)
+		printk(KERN_INFO "%s: AR%d switch driver attached.\n",
+			pdev->attached_dev->name, priv->chip);
+
 
 	if (pdev->addr != 0) {
 		if (priv->chip == AR8316) {
@@ -736,11 +756,13 @@ static int
 ar8216_probe(struct phy_device *pdev)
 {
 	struct ar8216_priv priv;
+	u16 chip;
 
 	priv.phy = pdev;
-	if (ar8216_id_chip(&priv) == UNKNOWN) {
+	chip = ar8216_id_chip(&priv);
+	if (chip == UNKNOWN)
 		return -ENODEV;
-	}
+
 	return 0;
 }