net: phy: report link partner features through ethtool

The PHY library already reads the MII_STAT1000 and MII_LPA registers in
genphy_read_status(), so extend it to also populate the PHY device link
partner advertised features such that we can feed this back into ethtool
when asked for it in phy_ethtool_gset().

Signed-off-by: Florian Fainelli <f.fainelli@gmail.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

2 files changed, 7 insertions, 0 deletions

diff --git a/drivers/net/phy/phy.c b/drivers/net/phy/phy.c
index 36c6994436b7..05cb8fe742f9 100644
--- a/drivers/net/phy/phy.c
+++ b/drivers/net/phy/phy.c
@@ -289,6 +289,7 @@ int phy_ethtool_gset(struct phy_device *phydev, struct ethtool_cmd *cmd)
         cmd->supported = phydev->supported;
 
         cmd->advertising = phydev->advertising;
+        cmd->lp_advertising = phydev->lp_advertising;
 
         ethtool_cmd_speed_set(cmd, phydev->speed);
         cmd->duplex = phydev->duplex;
diff --git a/drivers/net/phy/phy_device.c b/drivers/net/phy/phy_device.c
index d6447b3f7409..6db36595eac9 100644
--- a/drivers/net/phy/phy_device.c
+++ b/drivers/net/phy/phy_device.c
@@ -839,6 +839,8 @@ int genphy_read_status(struct phy_device *phydev)
         if (err)
                 return err;
 
+        phydev->lp_advertising = 0;
+
         if (AUTONEG_ENABLE == phydev->autoneg) {
                 if (phydev->supported & (SUPPORTED_1000baseT_Half
                                         | SUPPORTED_1000baseT_Full)) {
@@ -852,6 +854,8 @@ int genphy_read_status(struct phy_device *phydev)
                         if (adv < 0)
                                 return adv;
 
+                        phydev->lp_advertising =
+                                mii_stat1000_to_ethtool_lpa_t(lpagb);
                         lpagb &= adv << 2;
                 }
 
@@ -860,6 +864,8 @@ int genphy_read_status(struct phy_device *phydev)
                 if (lpa < 0)
                         return lpa;
 
+                phydev->lp_advertising |= mii_lpa_to_ethtool_lpa_t(lpa);
+
                 adv = phy_read(phydev, MII_ADVERTISE);
 
                 if (adv < 0)