Merge branch 'wip-2.6.34' into old-private-masterarchived-private-master

1 files changed, 89 insertions, 79 deletions

diff --git a/drivers/net/sfc/mdio_10g.c b/drivers/net/sfc/mdio_10g.c
index 6c33459f9ea9..0548fcbbdcd0 100644
--- a/drivers/net/sfc/mdio_10g.c
+++ b/drivers/net/sfc/mdio_10g.c
@@ -1,6 +1,6 @@
 /****************************************************************************
  * Driver for Solarflare Solarstorm network controllers and boards
- * Copyright 2006-2008 Solarflare Communications Inc.
+ * Copyright 2006-2009 Solarflare Communications Inc.
  *
  * This program is free software; you can redistribute it and/or modify it
  * under the terms of the GNU General Public License version 2 as published
@@ -14,8 +14,8 @@
 #include <linux/delay.h>
 #include "net_driver.h"
 #include "mdio_10g.h"
-#include "boards.h"
 #include "workarounds.h"
+#include "nic.h"
 
 unsigned efx_mdio_id_oui(u32 id)
 {
@@ -174,7 +174,7 @@ bool efx_mdio_links_ok(struct efx_nic *efx, unsigned int mmd_mask)
          * of mmd's */
         if (LOOPBACK_INTERNAL(efx))
                 return true;
-        else if (efx->loopback_mode == LOOPBACK_NETWORK)
+        else if (LOOPBACK_MASK(efx) & LOOPBACKS_WS)
                 return false;
         else if (efx_phy_mode_disabled(efx->phy_mode))
                 return false;
@@ -211,7 +211,7 @@ void efx_mdio_phy_reconfigure(struct efx_nic *efx)
                           efx->loopback_mode == LOOPBACK_PCS);
         efx_mdio_set_flag(efx, MDIO_MMD_PHYXS,
                           MDIO_CTRL1, MDIO_PHYXS_CTRL1_LOOPBACK,
-                          efx->loopback_mode == LOOPBACK_NETWORK);
+                          efx->loopback_mode == LOOPBACK_PHYXS_WS);
 }
 
 static void efx_mdio_set_mmd_lpower(struct efx_nic *efx,
@@ -249,8 +249,6 @@ void efx_mdio_set_mmds_lpower(struct efx_nic *efx,
 int efx_mdio_set_settings(struct efx_nic *efx, struct ethtool_cmd *ecmd)
 {
         struct ethtool_cmd prev;
-        u32 required;
-        int reg;
 
         efx->phy_op->get_settings(efx, &prev);
 
@@ -266,86 +264,98 @@ int efx_mdio_set_settings(struct efx_nic *efx, struct ethtool_cmd *ecmd)
                 return -EINVAL;
 
         /* Check that PHY supports these settings */
-        if (ecmd->autoneg) {
-                required = SUPPORTED_Autoneg;
-        } else if (ecmd->duplex) {
-                switch (ecmd->speed) {
-                case SPEED_10:  required = SUPPORTED_10baseT_Full;  break;
-                case SPEED_100: required = SUPPORTED_100baseT_Full; break;
-                default:        return -EINVAL;
-                }
-        } else {
-                switch (ecmd->speed) {
-                case SPEED_10:  required = SUPPORTED_10baseT_Half;  break;
-                case SPEED_100: required = SUPPORTED_100baseT_Half; break;
-                default:        return -EINVAL;
-                }
-        }
-        required |= ecmd->advertising;
-        if (required & ~prev.supported)
+        if (!ecmd->autoneg ||
+            (ecmd->advertising | SUPPORTED_Autoneg) & ~prev.supported)
                 return -EINVAL;
 
-        if (ecmd->autoneg) {
-                bool xnp = (ecmd->advertising & ADVERTISED_10000baseT_Full
-                            || EFX_WORKAROUND_13204(efx));
-
-                /* Set up the base page */
-                reg = ADVERTISE_CSMA;
-                if (ecmd->advertising & ADVERTISED_10baseT_Half)
-                        reg |= ADVERTISE_10HALF;
-                if (ecmd->advertising & ADVERTISED_10baseT_Full)
-                        reg |= ADVERTISE_10FULL;
-                if (ecmd->advertising & ADVERTISED_100baseT_Half)
-                        reg |= ADVERTISE_100HALF;
-                if (ecmd->advertising & ADVERTISED_100baseT_Full)
-                        reg |= ADVERTISE_100FULL;
-                if (xnp)
-                        reg |= ADVERTISE_RESV;
-                else if (ecmd->advertising & (ADVERTISED_1000baseT_Half |
-                                              ADVERTISED_1000baseT_Full))
-                        reg |= ADVERTISE_NPAGE;
-                reg |= mii_advertise_flowctrl(efx->wanted_fc);
-                efx_mdio_write(efx, MDIO_MMD_AN, MDIO_AN_ADVERTISE, reg);
-
-                /* Set up the (extended) next page if necessary */
-                if (efx->phy_op->set_npage_adv)
-                        efx->phy_op->set_npage_adv(efx, ecmd->advertising);
-
-                /* Enable and restart AN */
-                reg = efx_mdio_read(efx, MDIO_MMD_AN, MDIO_CTRL1);
-                reg |= MDIO_AN_CTRL1_ENABLE;
-                if (!(EFX_WORKAROUND_15195(efx) &&
-                      LOOPBACK_MASK(efx) & efx->phy_op->loopbacks))
-                        reg |= MDIO_AN_CTRL1_RESTART;
-                if (xnp)
-                        reg |= MDIO_AN_CTRL1_XNP;
-                else
-                        reg &= ~MDIO_AN_CTRL1_XNP;
-                efx_mdio_write(efx, MDIO_MMD_AN, MDIO_CTRL1, reg);
-        } else {
-                /* Disable AN */
-                efx_mdio_set_flag(efx, MDIO_MMD_AN, MDIO_CTRL1,
-                                  MDIO_AN_CTRL1_ENABLE, false);
-
-                /* Set the basic control bits */
-                reg = efx_mdio_read(efx, MDIO_MMD_PMAPMD, MDIO_CTRL1);
-                reg &= ~(MDIO_CTRL1_SPEEDSEL | MDIO_CTRL1_FULLDPLX);
-                if (ecmd->speed == SPEED_100)
-                        reg |= MDIO_PMA_CTRL1_SPEED100;
-                if (ecmd->duplex)
-                        reg |= MDIO_CTRL1_FULLDPLX;
-                efx_mdio_write(efx, MDIO_MMD_PMAPMD, MDIO_CTRL1, reg);
-        }
-
+        efx_link_set_advertising(efx, ecmd->advertising | ADVERTISED_Autoneg);
+        efx_mdio_an_reconfigure(efx);
         return 0;
 }
 
+/**
+ * efx_mdio_an_reconfigure - Push advertising flags and restart autonegotiation
+ * @efx:                Efx NIC
+ */
+void efx_mdio_an_reconfigure(struct efx_nic *efx)
+{
+        bool xnp = (efx->link_advertising & ADVERTISED_10000baseT_Full
+                    || EFX_WORKAROUND_13204(efx));
+        int reg;
+
+        WARN_ON(!(efx->mdio.mmds & MDIO_DEVS_AN));
+
+        /* Set up the base page */
+        reg = ADVERTISE_CSMA;
+        if (efx->link_advertising & ADVERTISED_10baseT_Half)
+                reg |= ADVERTISE_10HALF;
+        if (efx->link_advertising & ADVERTISED_10baseT_Full)
+                reg |= ADVERTISE_10FULL;
+        if (efx->link_advertising & ADVERTISED_100baseT_Half)
+                reg |= ADVERTISE_100HALF;
+        if (efx->link_advertising & ADVERTISED_100baseT_Full)
+                reg |= ADVERTISE_100FULL;
+        if (xnp)
+                reg |= ADVERTISE_RESV;
+        else if (efx->link_advertising & (ADVERTISED_1000baseT_Half |
+                                          ADVERTISED_1000baseT_Full))
+                reg |= ADVERTISE_NPAGE;
+        if (efx->link_advertising & ADVERTISED_Pause)
+                reg |= ADVERTISE_PAUSE_CAP;
+        if (efx->link_advertising & ADVERTISED_Asym_Pause)
+                reg |= ADVERTISE_PAUSE_ASYM;
+        efx_mdio_write(efx, MDIO_MMD_AN, MDIO_AN_ADVERTISE, reg);
+
+        /* Set up the (extended) next page if necessary */
+        if (efx->phy_op->set_npage_adv)
+                efx->phy_op->set_npage_adv(efx, efx->link_advertising);
+
+        /* Enable and restart AN */
+        reg = efx_mdio_read(efx, MDIO_MMD_AN, MDIO_CTRL1);
+        reg |= MDIO_AN_CTRL1_ENABLE;
+        if (!(EFX_WORKAROUND_15195(efx) && LOOPBACK_EXTERNAL(efx)))
+                reg |= MDIO_AN_CTRL1_RESTART;
+        if (xnp)
+                reg |= MDIO_AN_CTRL1_XNP;
+        else
+                reg &= ~MDIO_AN_CTRL1_XNP;
+        efx_mdio_write(efx, MDIO_MMD_AN, MDIO_CTRL1, reg);
+}
+
 enum efx_fc_type efx_mdio_get_pause(struct efx_nic *efx)
 {
-        int lpa;
+        BUILD_BUG_ON(EFX_FC_AUTO & (EFX_FC_RX | EFX_FC_TX));
 
-        if (!(efx->phy_op->mmds & MDIO_DEVS_AN))
+        if (!(efx->wanted_fc & EFX_FC_AUTO))
                 return efx->wanted_fc;
-        lpa = efx_mdio_read(efx, MDIO_MMD_AN, MDIO_AN_LPA);
-        return efx_fc_resolve(efx->wanted_fc, lpa);
+
+        WARN_ON(!(efx->mdio.mmds & MDIO_DEVS_AN));
+
+        return mii_resolve_flowctrl_fdx(
+                mii_advertise_flowctrl(efx->wanted_fc),
+                efx_mdio_read(efx, MDIO_MMD_AN, MDIO_AN_LPA));
+}
+
+int efx_mdio_test_alive(struct efx_nic *efx)
+{
+        int rc;
+        int devad = __ffs(efx->mdio.mmds);
+        u16 physid1, physid2;
+
+        mutex_lock(&efx->mac_lock);
+
+        physid1 = efx_mdio_read(efx, devad, MDIO_DEVID1);
+        physid2 = efx_mdio_read(efx, devad, MDIO_DEVID2);
+
+        if ((physid1 == 0x0000) || (physid1 == 0xffff) ||
+            (physid2 == 0x0000) || (physid2 == 0xffff)) {
+                EFX_ERR(efx, "no MDIO PHY present with ID %d\n",
+                        efx->mdio.prtad);
+                rc = -EINVAL;
+        } else {
+                rc = efx_mdio_check_mmds(efx, efx->mdio.mmds, 0);
+        }
+
+        mutex_unlock(&efx->mac_lock);
+        return rc;
 }