projects / openwrt.git / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
generic: ar8216: use usleep_range in ar8216_mii_{read,write}
[openwrt.git] / target / linux / generic / files / drivers / net / phy / ar8216.c
diff --git a/target/linux/generic/files/drivers/net/phy/ar8216.c b/target/linux/generic/files/drivers/net/phy/ar8216.c
index 8e84e9d..ffa561b 100644 (file)
--- a/target/linux/generic/files/drivers/net/phy/ar8216.c
+++ b/target/linux/generic/files/drivers/net/phy/ar8216.c
@@ -29,6 +29,7 @@
 #include <linux/phy.h>
 #include <linux/netdevice.h>
 #include <linux/etherdevice.h>
 #include <linux/phy.h>
 #include <linux/netdevice.h>
 #include <linux/etherdevice.h>
+#include <linux/lockdep.h>
 #include "ar8216.h"
 
 /* size of the vlan table */
 #include "ar8216.h"
 
 /* size of the vlan table */
@@ -86,7 +87,7 @@ ar8216_mii_read(struct ar8216_priv *priv, int reg)
        mutex_lock(&bus->mdio_lock);
 
        bus->write(bus, 0x18, 0, page);
        mutex_lock(&bus->mdio_lock);
 
        bus->write(bus, 0x18, 0, page);
-       msleep(1); /* wait for the page switch to propagate */
+       usleep_range(1000, 2000); /* wait for the page switch to propagate */
        lo = bus->read(bus, 0x10 | r2, r1);
        hi = bus->read(bus, 0x10 | r2, r1 + 1);
 
        lo = bus->read(bus, 0x10 | r2, r1);
        hi = bus->read(bus, 0x10 | r2, r1 + 1);
 
@@ -110,18 +111,32 @@ ar8216_mii_write(struct ar8216_priv *priv, int reg, u32 val)
        mutex_lock(&bus->mdio_lock);
 
        bus->write(bus, 0x18, 0, r3);
        mutex_lock(&bus->mdio_lock);
 
        bus->write(bus, 0x18, 0, r3);
-       msleep(1); /* wait for the page switch to propagate */
+       usleep_range(1000, 2000); /* wait for the page switch to propagate */
        bus->write(bus, 0x10 | r2, r1 + 1, hi);
        bus->write(bus, 0x10 | r2, r1, lo);
 
        mutex_unlock(&bus->mdio_lock);
 }
 
        bus->write(bus, 0x10 | r2, r1 + 1, hi);
        bus->write(bus, 0x10 | r2, r1, lo);
 
        mutex_unlock(&bus->mdio_lock);
 }
 
+static void
+ar8216_phy_dbg_write(struct ar8216_priv *priv, int phy_addr,
+                    u16 dbg_addr, u16 dbg_data)
+{
+       struct mii_bus *bus = priv->phy->bus;
+
+       mutex_lock(&bus->mdio_lock);
+       bus->write(bus, phy_addr, MII_ATH_DBG_ADDR, dbg_addr);
+       bus->write(bus, phy_addr, MII_ATH_DBG_DATA, dbg_data);
+       mutex_unlock(&bus->mdio_lock);
+}
+
 static u32
 ar8216_rmw(struct ar8216_priv *priv, int reg, u32 mask, u32 val)
 {
        u32 v;
 
 static u32
 ar8216_rmw(struct ar8216_priv *priv, int reg, u32 mask, u32 val)
 {
        u32 v;
 
+       lockdep_assert_held(&priv->reg_mutex);
+
        v = priv->read(priv, reg);
        v &= ~mask;
        v |= val;
        v = priv->read(priv, reg);
        v &= ~mask;
        v |= val;
@@ -137,9 +152,11 @@ ar8216_id_chip(struct ar8216_priv *priv)
        u16 id;
        int i;
 
        u16 id;
        int i;
 
+       priv->chip = UNKNOWN;
+
        val = ar8216_mii_read(priv, AR8216_REG_CTRL);
        if (val == ~0)
        val = ar8216_mii_read(priv, AR8216_REG_CTRL);
        if (val == ~0)
-               return UNKNOWN;
+               return -ENODEV;
 
        id = val & (AR8216_CTRL_REVISION | AR8216_CTRL_VERSION);
        for (i = 0; i < AR8X16_PROBE_RETRIES; i++) {
 
        id = val & (AR8216_CTRL_REVISION | AR8216_CTRL_VERSION);
        for (i = 0; i < AR8X16_PROBE_RETRIES; i++) {
@@ -147,21 +164,24 @@ ar8216_id_chip(struct ar8216_priv *priv)
 
                val = ar8216_mii_read(priv, AR8216_REG_CTRL);
                if (val == ~0)
 
                val = ar8216_mii_read(priv, AR8216_REG_CTRL);
                if (val == ~0)
-                       return UNKNOWN;
+                       return -ENODEV;
 
                t = val & (AR8216_CTRL_REVISION | AR8216_CTRL_VERSION);
                if (t != id)
 
                t = val & (AR8216_CTRL_REVISION | AR8216_CTRL_VERSION);
                if (t != id)
-                       return UNKNOWN;
+                       return -ENODEV;
        }
 
        switch (id) {
        case 0x0101:
        }
 
        switch (id) {
        case 0x0101:
-               return AR8216;
+               priv->chip = AR8216;
+               break;
        case 0x0301:
        case 0x0301:
-               return AR8236;
+               priv->chip = AR8236;
+               break;
        case 0x1000:
        case 0x1001:
        case 0x1000:
        case 0x1001:
-               return AR8316;
+               priv->chip = AR8316;
+               break;
        default:
                printk(KERN_DEBUG
                        "ar8216: Unknown Atheros device [ver=%d, rev=%d, phy_id=%04x%04x]\n",
        default:
                printk(KERN_DEBUG
                        "ar8216: Unknown Atheros device [ver=%d, rev=%d, phy_id=%04x%04x]\n",
@@ -170,8 +190,10 @@ ar8216_id_chip(struct ar8216_priv *priv)
                        mdiobus_read(priv->phy->bus, priv->phy->addr, 2),
                        mdiobus_read(priv->phy->bus, priv->phy->addr, 3));
 
                        mdiobus_read(priv->phy->bus, priv->phy->addr, 2),
                        mdiobus_read(priv->phy->bus, priv->phy->addr, 3));
 
-               return UNKNOWN;
+               return -ENODEV;
        }
        }
+
+       return 0;
 }
 
 static void
 }
 
 static void
@@ -219,7 +241,7 @@ ar8216_read_port_link(struct ar8216_priv *priv, int port,
 
 static int
 ar8216_set_vlan(struct switch_dev *dev, const struct switch_attr *attr,
 
 static int
 ar8216_set_vlan(struct switch_dev *dev, const struct switch_attr *attr,
-                struct switch_val *val)
+               struct switch_val *val)
 {
        struct ar8216_priv *priv = to_ar8216(dev);
        priv->vlan = !!val->value.i;
 {
        struct ar8216_priv *priv = to_ar8216(dev);
        priv->vlan = !!val->value.i;
@@ -228,7 +250,7 @@ ar8216_set_vlan(struct switch_dev *dev, const struct switch_attr *attr,
 
 static int
 ar8216_get_vlan(struct switch_dev *dev, const struct switch_attr *attr,
 
 static int
 ar8216_get_vlan(struct switch_dev *dev, const struct switch_attr *attr,
-                struct switch_val *val)
+               struct switch_val *val)
 {
        struct ar8216_priv *priv = to_ar8216(dev);
        val->value.i = priv->vlan;
 {
        struct ar8216_priv *priv = to_ar8216(dev);
        val->value.i = priv->vlan;
@@ -260,7 +282,7 @@ ar8216_get_pvid(struct switch_dev *dev, int port, int *vlan)
 
 static int
 ar8216_set_vid(struct switch_dev *dev, const struct switch_attr *attr,
 
 static int
 ar8216_set_vid(struct switch_dev *dev, const struct switch_attr *attr,
-                struct switch_val *val)
+              struct switch_val *val)
 {
        struct ar8216_priv *priv = to_ar8216(dev);
        priv->vlan_id[val->port_vlan] = val->value.i;
 {
        struct ar8216_priv *priv = to_ar8216(dev);
        priv->vlan_id[val->port_vlan] = val->value.i;
@@ -269,7 +291,7 @@ ar8216_set_vid(struct switch_dev *dev, const struct switch_attr *attr,
 
 static int
 ar8216_get_vid(struct switch_dev *dev, const struct switch_attr *attr,
 
 static int
 ar8216_get_vid(struct switch_dev *dev, const struct switch_attr *attr,
-                struct switch_val *val)
+              struct switch_val *val)
 {
        struct ar8216_priv *priv = to_ar8216(dev);
        val->value.i = priv->vlan_id[val->port_vlan];
 {
        struct ar8216_priv *priv = to_ar8216(dev);
        val->value.i = priv->vlan_id[val->port_vlan];
@@ -292,8 +314,8 @@ ar8216_mangle_tx(struct sk_buff *skb, struct net_device *dev)
        struct ar8216_priv *priv = dev->phy_ptr;
        unsigned char *buf;
 
        struct ar8216_priv *priv = dev->phy_ptr;
        unsigned char *buf;
 
-    if (unlikely(!priv))
-        goto error;
+       if (unlikely(!priv))
+               goto error;
 
        if (!priv->vlan)
                goto send;
 
        if (!priv->vlan)
                goto send;
@@ -444,9 +466,9 @@ ar8216_set_ports(struct switch_dev *dev, struct switch_val *val)
        for (i = 0; i < val->len; i++) {
                struct switch_port *p = &val->value.ports[i];
 
        for (i = 0; i < val->len; i++) {
                struct switch_port *p = &val->value.ports[i];
 
-               if (p->flags & (1 << SWITCH_PORT_FLAG_TAGGED))
+               if (p->flags & (1 << SWITCH_PORT_FLAG_TAGGED)) {
                        priv->vlan_tagged |= (1 << p->id);
                        priv->vlan_tagged |= (1 << p->id);
-               else {
+               } else {
                        priv->vlan_tagged &= ~(1 << p->id);
                        priv->pvid[p->id] = val->port_vlan;
 
                        priv->vlan_tagged &= ~(1 << p->id);
                        priv->pvid[p->id] = val->port_vlan;
 
@@ -599,11 +621,10 @@ ar8216_hw_apply(struct switch_dev *dev)
                int egress, ingress;
                int pvid;
 
                int egress, ingress;
                int pvid;
 
-               if (priv->vlan) {
+               if (priv->vlan)
                        pvid = priv->vlan_id[priv->pvid[i]];
                        pvid = priv->vlan_id[priv->pvid[i]];
-               } else {
+               else
                        pvid = i;
                        pvid = i;
-               }
 
                if (priv->vlan) {
                        if (priv->vlan_tagged & (1 << i))
 
                if (priv->vlan) {
                        if (priv->vlan_tagged & (1 << i))
@@ -613,11 +634,11 @@ ar8216_hw_apply(struct switch_dev *dev)
                } else {
                        egress = AR8216_OUT_KEEP;
                }
                } else {
                        egress = AR8216_OUT_KEEP;
                }
-               if (priv->vlan) {
+
+               if (priv->vlan)
                        ingress = AR8216_IN_SECURE;
                        ingress = AR8216_IN_SECURE;
-               } else {
+               else
                        ingress = AR8216_IN_PORT_ONLY;
                        ingress = AR8216_IN_PORT_ONLY;
-               }
 
                if (priv->chip == AR8236)
                        ar8236_setup_port(priv, i, egress, ingress, portmask[i],
 
                if (priv->chip == AR8236)
                        ar8236_setup_port(priv, i, egress, ingress, portmask[i],
@@ -631,12 +652,23 @@ ar8216_hw_apply(struct switch_dev *dev)
 }
 
 static int
 }
 
 static int
-ar8236_hw_init(struct ar8216_priv *priv) {
-       static int initialized;
+ar8216_hw_init(struct ar8216_priv *priv)
+{
+       /* XXX: undocumented magic from atheros, required! */
+       priv->write(priv, 0x38, 0xc000050e);
+
+       ar8216_rmw(priv, AR8216_REG_GLOBAL_CTRL,
+                  AR8216_GCTRL_MTU, 1518 + 8 + 2);
+       return 0;
+}
+
+static int
+ar8236_hw_init(struct ar8216_priv *priv)
+{
        int i;
        struct mii_bus *bus;
 
        int i;
        struct mii_bus *bus;
 
-       if (initialized)
+       if (priv->initialized)
                return 0;
 
        /* Initialize the PHYs */
                return 0;
 
        /* Initialize the PHYs */
@@ -649,12 +681,17 @@ ar8236_hw_init(struct ar8216_priv *priv) {
        }
        msleep(1000);
 
        }
        msleep(1000);
 
-       initialized = true;
+       /* enable jumbo frames */
+       ar8216_rmw(priv, AR8216_REG_GLOBAL_CTRL,
+                  AR8316_GCTRL_MTU, 9018 + 8 + 2);
+
+       priv->initialized = true;
        return 0;
 }
 
 static int
        return 0;
 }
 
 static int
-ar8316_hw_init(struct ar8216_priv *priv) {
+ar8316_hw_init(struct ar8216_priv *priv)
+{
        int i;
        u32 val, newval;
        struct mii_bus *bus;
        int i;
        u32 val, newval;
        struct mii_bus *bus;
@@ -694,14 +731,11 @@ ar8316_hw_init(struct ar8216_priv *priv) {
                if ((i == 4) && priv->port4_phy &&
                    priv->phy->interface == PHY_INTERFACE_MODE_RGMII) {
                        /* work around for phy4 rgmii mode */
                if ((i == 4) && priv->port4_phy &&
                    priv->phy->interface == PHY_INTERFACE_MODE_RGMII) {
                        /* work around for phy4 rgmii mode */
-                       mdiobus_write(bus, i, MII_ATH_DBG_ADDR, 0x12);
-                       mdiobus_write(bus, i, MII_ATH_DBG_DATA, 0x480c);
+                       ar8216_phy_dbg_write(priv, i, 0x12, 0x480c);
                        /* rx delay */
                        /* rx delay */
-                       mdiobus_write(bus, i, MII_ATH_DBG_ADDR, 0x0);
-                       mdiobus_write(bus, i, MII_ATH_DBG_DATA, 0x824e);
+                       ar8216_phy_dbg_write(priv, i, 0x0, 0x824e);
                        /* tx delay */
                        /* tx delay */
-                       mdiobus_write(bus, i, MII_ATH_DBG_ADDR, 0x5);
-                       mdiobus_write(bus, i, MII_ATH_DBG_DATA, 0x3d47);
+                       ar8216_phy_dbg_write(priv, i, 0x5, 0x3d47);
                        msleep(1000);
                }
 
                        msleep(1000);
                }
 
@@ -713,6 +747,13 @@ ar8316_hw_init(struct ar8216_priv *priv) {
                msleep(1000);
        }
 
                msleep(1000);
        }
 
+       /* enable jumbo frames */
+       ar8216_rmw(priv, AR8216_REG_GLOBAL_CTRL,
+                  AR8316_GCTRL_MTU, 9018 + 8 + 2);
+
+       /* enable cpu port to receive multicast and broadcast frames */
+       priv->write(priv, AR8216_REG_FLOOD_MASK, 0x003f003f);
+
 out:
        priv->initialized = true;
        return 0;
 out:
        priv->initialized = true;
        return 0;
@@ -753,31 +794,14 @@ ar8216_reset_switch(struct switch_dev *dev)
        mutex_lock(&priv->reg_mutex);
        memset(&priv->vlan, 0, sizeof(struct ar8216_priv) -
                offsetof(struct ar8216_priv, vlan));
        mutex_lock(&priv->reg_mutex);
        memset(&priv->vlan, 0, sizeof(struct ar8216_priv) -
                offsetof(struct ar8216_priv, vlan));
-       for (i = 0; i < AR8X16_MAX_VLANS; i++) {
+
+       for (i = 0; i < AR8X16_MAX_VLANS; i++)
                priv->vlan_id[i] = i;
                priv->vlan_id[i] = i;
-       }
 
        /* Configure all ports */
        for (i = 0; i < AR8216_NUM_PORTS; i++)
                ar8216_init_port(priv, i);
 
 
        /* Configure all ports */
        for (i = 0; i < AR8216_NUM_PORTS; i++)
                ar8216_init_port(priv, i);
 
-       /* XXX: undocumented magic from atheros, required! */
-       priv->write(priv, 0x38, 0xc000050e);
-
-       if (priv->chip == AR8216) {
-               ar8216_rmw(priv, AR8216_REG_GLOBAL_CTRL,
-                       AR8216_GCTRL_MTU, 1518 + 8 + 2);
-       } else if (priv->chip == AR8316 ||
-                  priv->chip == AR8236) {
-               /* enable jumbo frames */
-               ar8216_rmw(priv, AR8216_REG_GLOBAL_CTRL,
-                       AR8316_GCTRL_MTU, 9018 + 8 + 2);
-       }
-
-       if (priv->chip == AR8316) {
-               /* enable cpu port to receive multicast and broadcast frames */
-               priv->write(priv, AR8216_REG_FLOOD_MASK, 0x003f003f);
-       }
        mutex_unlock(&priv->reg_mutex);
        return ar8216_hw_apply(dev);
 }
        mutex_unlock(&priv->reg_mutex);
        return ar8216_hw_apply(dev);
 }
@@ -821,7 +845,9 @@ ar8216_config_init(struct phy_device *pdev)
 
        priv->phy = pdev;
 
 
        priv->phy = pdev;
 
-       priv->chip = ar8216_id_chip(priv);
+       ret = ar8216_id_chip(priv);
+       if (ret)
+               goto err_free_priv;
 
        if (pdev->addr != 0) {
                if (priv->chip == AR8316) {
 
        if (pdev->addr != 0) {
                if (priv->chip == AR8316) {
@@ -899,7 +925,9 @@ ar8216_config_init(struct phy_device *pdev)
        priv->init = true;
 
        ret = 0;
        priv->init = true;
 
        ret = 0;
-       if (priv->chip == AR8236)
+       if (priv->chip == AR8216)
+               ret = ar8216_hw_init(priv);
+       else if (priv->chip == AR8236)
                ret = ar8236_hw_init(priv);
        else if (priv->chip == AR8316)
                ret = ar8316_hw_init(priv);
                ret = ar8236_hw_init(priv);
        else if (priv->chip == AR8316)
                ret = ar8316_hw_init(priv);
@@ -939,9 +967,9 @@ ar8216_read_status(struct phy_device *phydev)
        struct ar8216_priv *priv = phydev->priv;
        struct switch_port_link link;
        int ret;
        struct ar8216_priv *priv = phydev->priv;
        struct switch_port_link link;
        int ret;
-       if (phydev->addr != 0) {
+
+       if (phydev->addr != 0)
                return genphy_read_status(phydev);
                return genphy_read_status(phydev);
-       }
 
        ar8216_read_port_link(priv, phydev->addr, &link);
        phydev->link = !!link.link;
 
        ar8216_read_port_link(priv, phydev->addr, &link);
        phydev->link = !!link.link;
@@ -950,13 +978,13 @@ ar8216_read_status(struct phy_device *phydev)
 
        switch (link.speed) {
        case SWITCH_PORT_SPEED_10:
 
        switch (link.speed) {
        case SWITCH_PORT_SPEED_10:
-               phydev->speed = SPEED_10;
+               phydev->speed = SPEED_10;
                break;
        case SWITCH_PORT_SPEED_100:
                break;
        case SWITCH_PORT_SPEED_100:
-               phydev->speed = SPEED_100;
+               phydev->speed = SPEED_100;
                break;
        case SWITCH_PORT_SPEED_1000:
                break;
        case SWITCH_PORT_SPEED_1000:
-               phydev->speed = SPEED_1000;
+               phydev->speed = SPEED_1000;
                break;
        default:
                phydev->speed = 0;
                break;
        default:
                phydev->speed = 0;
@@ -990,14 +1018,9 @@ static int
 ar8216_probe(struct phy_device *pdev)
 {
        struct ar8216_priv priv;
 ar8216_probe(struct phy_device *pdev)
 {
        struct ar8216_priv priv;
-       u16 chip;
 
        priv.phy = pdev;
 
        priv.phy = pdev;
-       chip = ar8216_id_chip(&priv);
-       if (chip == UNKNOWN)
-               return -ENODEV;
-
-       return 0;
+       return ar8216_id_chip(&priv);
 }
 
 static void
 }
 
 static void
Personal OpenWRT clone
This page took 0.04694 seconds and 4 git commands to generate.