generic: ar8216: use phydev instead of pdev everywhere
[openwrt/staging/blogic.git] / target / linux / generic / files / drivers / net / phy / ar8216.c
index f7fbf4e498e745a18656438b53e9d9558dbbbeb1..7fbc531242d82ca97e7575b48f7eed8794fa6011 100644 (file)
@@ -794,18 +794,18 @@ ar8316_hw_init(struct ar8216_priv *priv)
                if (priv->port4_phy) {
                        /* value taken from Ubiquiti RouterStation Pro */
                        newval = 0x81461bea;
-                       printk(KERN_INFO "ar8316: Using port 4 as PHY\n");
+                       pr_info("ar8316: Using port 4 as PHY\n");
                } else {
                        newval = 0x01261be2;
-                       printk(KERN_INFO "ar8316: Using port 4 as switch port\n");
+                       pr_info("ar8316: Using port 4 as switch port\n");
                }
        } else if (priv->phy->interface == PHY_INTERFACE_MODE_GMII) {
                /* value taken from AVM Fritz!Box 7390 sources */
                newval = 0x010e5b71;
        } else {
                /* no known value for phy interface */
-               printk(KERN_ERR "ar8316: unsupported mii mode: %d.\n",
-                       priv->phy->interface);
+               pr_err("ar8316: unsupported mii mode: %d.\n",
+                      priv->phy->interface);
                return -EINVAL;
        }
 
@@ -1689,9 +1689,8 @@ ar8216_id_chip(struct ar8216_priv *priv)
                priv->chip = &ar8327_chip;
                break;
        default:
-               printk(KERN_DEBUG
-                       "ar8216: Unknown Atheros device [ver=%d, rev=%d]\n",
-                       priv->chip_ver, priv->chip_rev);
+               pr_err("ar8216: Unknown Atheros device [ver=%d, rev=%d]\n",
+                      priv->chip_ver, priv->chip_rev);
 
                return -ENODEV;
        }
@@ -1756,13 +1755,12 @@ ar8xxx_mib_start(struct ar8216_priv *priv)
 }
 
 static void
-ar8xxx_mib_cleanup(struct ar8216_priv *priv)
+ar8xxx_mib_stop(struct ar8216_priv *priv)
 {
        if (!ar8xxx_has_mib_counters(priv))
                return;
 
        cancel_delayed_work(&priv->mib_work);
-       kfree(priv->mib_stats);
 }
 
 static struct ar8216_priv *
@@ -1781,6 +1779,13 @@ ar8xxx_create(void)
        return priv;
 }
 
+static void
+ar8xxx_free(struct ar8216_priv *priv)
+{
+       kfree(priv->mib_stats);
+       kfree(priv);
+}
+
 static struct ar8216_priv *
 ar8xxx_create_mii(struct mii_bus *bus)
 {
@@ -1797,51 +1802,85 @@ ar8xxx_create_mii(struct mii_bus *bus)
 }
 
 static int
-ar8216_config_init(struct phy_device *pdev)
+ar8xxx_probe_switch(struct ar8216_priv *priv)
+{
+       struct switch_dev *swdev;
+       int ret;
+
+       ret = ar8216_id_chip(priv);
+       if (ret)
+               return ret;
+
+       swdev = &priv->dev;
+       swdev->cpu_port = AR8216_PORT_CPU;
+       swdev->ops = &ar8216_sw_ops;
+
+       if (chip_is_ar8316(priv)) {
+               swdev->name = "Atheros AR8316";
+               swdev->vlans = AR8X16_MAX_VLANS;
+               swdev->ports = AR8216_NUM_PORTS;
+       } else if (chip_is_ar8236(priv)) {
+               swdev->name = "Atheros AR8236";
+               swdev->vlans = AR8216_NUM_VLANS;
+               swdev->ports = AR8216_NUM_PORTS;
+       } else if (chip_is_ar8327(priv)) {
+               swdev->name = "Atheros AR8327";
+               swdev->vlans = AR8X16_MAX_VLANS;
+               swdev->ports = AR8327_NUM_PORTS;
+       } else {
+               swdev->name = "Atheros AR8216";
+               swdev->vlans = AR8216_NUM_VLANS;
+               swdev->ports = AR8216_NUM_PORTS;
+       }
+
+       ret = ar8xxx_mib_init(priv);
+       if (ret)
+               return ret;
+
+       return 0;
+}
+
+static int
+ar8216_config_init(struct phy_device *phydev)
 {
-       struct ar8216_priv *priv = pdev->priv;
-       struct net_device *dev = pdev->attached_dev;
+       struct ar8216_priv *priv = phydev->priv;
+       struct net_device *dev = phydev->attached_dev;
        struct switch_dev *swdev;
        int ret;
 
        if (!priv) {
-               priv = ar8xxx_create_mii(pdev->bus);
+               priv = ar8xxx_create_mii(phydev->bus);
                if (priv == NULL)
                        return -ENOMEM;
 
-               ret = ar8216_id_chip(priv);
+               ret = ar8xxx_probe_switch(priv);
                if (ret)
                        goto err_free_priv;
        }
 
-       priv->phy = pdev;
+       priv->phy = phydev;
 
-       if (ar8xxx_has_gige(priv))
-               pdev->supported = SUPPORTED_1000baseT_Full;
-       else
-               pdev->supported = SUPPORTED_100baseT_Full;
-       pdev->advertising = pdev->supported;
-
-       if (pdev->addr != 0) {
+       if (phydev->addr != 0) {
                if (chip_is_ar8316(priv)) {
                        /* check if we're attaching to the switch twice */
-                       pdev = pdev->bus->phy_map[0];
-                       if (!pdev) {
-                               kfree(priv);
+                       phydev = phydev->bus->phy_map[0];
+                       if (!phydev) {
+                               ar8xxx_free(priv);
                                return 0;
                        }
 
                        /* switch device has not been initialized, reuse priv */
-                       if (!pdev->priv) {
+                       if (!phydev->priv) {
                                priv->port4_phy = true;
-                               pdev->priv = priv;
+                               priv->dev.ports = (AR8216_NUM_PORTS - 1);
+                               phydev->priv = priv;
                                return 0;
                        }
 
-                       kfree(priv);
+                       ar8xxx_free(priv);
 
                        /* switch device has been initialized, reinit */
-                       priv = pdev->priv;
+                       priv = phydev->priv;
                        priv->dev.ports = (AR8216_NUM_PORTS - 1);
                        priv->initialized = false;
                        priv->port4_phy = true;
@@ -1849,48 +1888,19 @@ ar8216_config_init(struct phy_device *pdev)
                        return 0;
                }
 
-               kfree(priv);
+               ar8xxx_free(priv);
                return 0;
        }
 
-       pdev->priv = priv;
+       phydev->priv = priv;
 
        swdev = &priv->dev;
-       swdev->cpu_port = AR8216_PORT_CPU;
-       swdev->ops = &ar8216_sw_ops;
-       swdev->ports = AR8216_NUM_PORTS;
-
-       if (chip_is_ar8316(priv)) {
-               swdev->name = "Atheros AR8316";
-               swdev->vlans = AR8X16_MAX_VLANS;
-
-               if (priv->port4_phy) {
-                       /* port 5 connected to the other mac, therefore unusable */
-                       swdev->ports = (AR8216_NUM_PORTS - 1);
-               }
-       } else if (chip_is_ar8236(priv)) {
-               swdev->name = "Atheros AR8236";
-               swdev->vlans = AR8216_NUM_VLANS;
-               swdev->ports = AR8216_NUM_PORTS;
-       } else if (chip_is_ar8327(priv)) {
-               swdev->name = "Atheros AR8327";
-               swdev->vlans = AR8X16_MAX_VLANS;
-               swdev->ports = AR8327_NUM_PORTS;
-       } else {
-               swdev->name = "Atheros AR8216";
-               swdev->vlans = AR8216_NUM_VLANS;
-       }
-
-       ret = ar8xxx_mib_init(priv);
+       ret = register_switch(swdev, phydev->attached_dev);
        if (ret)
                goto err_free_priv;
 
-       ret = register_switch(swdev, pdev->attached_dev);
-       if (ret)
-               goto err_cleanup_mib;
-
-       printk(KERN_INFO "%s: %s switch driver attached.\n",
-               pdev->attached_dev->name, swdev->name);
+       pr_info("%s: %s switch driver attached.\n",
+               phydev->attached_dev->name, swdev->name);
 
        priv->init = true;
 
@@ -1918,11 +1928,9 @@ ar8216_config_init(struct phy_device *pdev)
 
 err_unregister_switch:
        unregister_switch(&priv->dev);
-err_cleanup_mib:
-       ar8xxx_mib_cleanup(priv);
 err_free_priv:
-       kfree(priv);
-       pdev->priv = NULL;
+       ar8xxx_free(priv);
+       phydev->priv = NULL;
        return ret;
 }
 
@@ -2016,34 +2024,54 @@ ar8xxx_is_possible(struct mii_bus *bus)
 }
 
 static int
-ar8216_probe(struct phy_device *pdev)
+ar8216_probe(struct phy_device *phydev)
 {
        struct ar8216_priv *priv;
        int ret;
 
        /* skip PHYs at unused adresses */
-       if (pdev->addr != 0 && pdev->addr != 4)
+       if (phydev->addr != 0 && phydev->addr != 4)
                return -ENODEV;
 
-       if (!ar8xxx_is_possible(pdev->bus))
+       if (!ar8xxx_is_possible(phydev->bus))
                return -ENODEV;
 
-       priv = ar8xxx_create_mii(pdev->bus);
+       priv = ar8xxx_create_mii(phydev->bus);
        if (priv == NULL)
                return -ENOMEM;
 
-       priv->phy = pdev;
+       priv->phy = phydev;
 
-       ret = ar8216_id_chip(priv);
-       kfree(priv);
+       ret = ar8xxx_probe_switch(priv);
+       if (ret)
+               goto out;
+
+       if (phydev->addr == 0) {
+               if (ar8xxx_has_gige(priv)) {
+                       phydev->supported = SUPPORTED_1000baseT_Full;
+                       phydev->advertising = ADVERTISED_1000baseT_Full;
+               } else {
+                       phydev->supported = SUPPORTED_100baseT_Full;
+                       phydev->advertising = ADVERTISED_100baseT_Full;
+               }
+       } else {
+               if (ar8xxx_has_gige(priv)) {
+                       phydev->supported |= SUPPORTED_1000baseT_Full;
+                       phydev->advertising |= ADVERTISED_1000baseT_Full;
+               }
+       }
 
+       ret = 0;
+
+out:
+       ar8xxx_free(priv);
        return ret;
 }
 
 static void
-ar8216_detach(struct phy_device *pdev)
+ar8216_detach(struct phy_device *phydev)
 {
-       struct net_device *dev = pdev->attached_dev;
+       struct net_device *dev = phydev->attached_dev;
 
        if (!dev)
                return;
@@ -2055,20 +2083,20 @@ ar8216_detach(struct phy_device *pdev)
 }
 
 static void
-ar8216_remove(struct phy_device *pdev)
+ar8216_remove(struct phy_device *phydev)
 {
-       struct ar8216_priv *priv = pdev->priv;
+       struct ar8216_priv *priv = phydev->priv;
 
        if (!priv)
                return;
 
-       pdev->priv = NULL;
+       phydev->priv = NULL;
 
-       if (pdev->addr == 0)
+       if (phydev->addr == 0)
                unregister_switch(&priv->dev);
 
-       ar8xxx_mib_cleanup(priv);
-       kfree(priv);
+       ar8xxx_mib_stop(priv);
+       ar8xxx_free(priv);
 }
 
 static struct phy_driver ar8216_driver = {