[PATCH net-next 4/5] net: phy: add helper to convert negotiation result to phy settings

[Russell King]

Add a helper to convert the result of the autonegotiation advertisment
into the PHYs speed and duplex settings.  If the result is full duplex,
also extract the pause mode settings from the link partner advertisment.

Signed-off-by: Russell King <rmk+ker...@armlinux.org.uk>
---
 drivers/net/phy/phy-core.c | 43 +++++++++++++++++++++++++++++++++++++++++++
 include/linux/phy.h        |  2 ++
 2 files changed, 45 insertions(+)

diff --git a/drivers/net/phy/phy-core.c b/drivers/net/phy/phy-core.c
index 9c08850eed16..3d67f182b844 100644
--- a/drivers/net/phy/phy-core.c
+++ b/drivers/net/phy/phy-core.c
@@ -189,6 +189,49 @@ size_t phy_speeds(unsigned int *speeds, size_t size,
        return count;
 }
 
+/**
+ * phy_resolve_aneg_linkmode - resolve the advertisments into phy settings
+ * @phydev: The phy_device struct
+ *
+ * Resolve our and the link partner advertisments into their corresponding
+ * speed and duplex. If full duplex was negotiated, extract the pause mode
+ * from the link partner mask.
+ */
+void phy_resolve_aneg_linkmode(struct phy_device *phydev)
+{
+       u32 common = phydev->lp_advertising & phydev->advertising;
+
+       if (common & ADVERTISED_10000baseT_Full) {
+               phydev->speed = SPEED_10000;
+               phydev->duplex = DUPLEX_FULL;
+       } else if (common & ADVERTISED_1000baseT_Full) {
+               phydev->speed = SPEED_1000;
+               phydev->duplex = DUPLEX_FULL;
+       } else if (common & ADVERTISED_1000baseT_Half) {
+               phydev->speed = SPEED_1000;
+               phydev->duplex = DUPLEX_HALF;
+       } else if (common & ADVERTISED_100baseT_Full) {
+               phydev->speed = SPEED_100;
+               phydev->duplex = DUPLEX_FULL;
+       } else if (common & ADVERTISED_100baseT_Half) {
+               phydev->speed = SPEED_100;
+               phydev->duplex = DUPLEX_HALF;
+       } else if (common & ADVERTISED_10baseT_Full) {
+               phydev->speed = SPEED_10;
+               phydev->duplex = DUPLEX_FULL;
+       } else if (common & ADVERTISED_10baseT_Half) {
+               phydev->speed = SPEED_10;
+               phydev->duplex = DUPLEX_HALF;
+       }
+
+       if (phydev->duplex == DUPLEX_FULL) {
+               phydev->pause = !!(phydev->lp_advertising & ADVERTISED_Pause);
+               phydev->asym_pause = !!(phydev->lp_advertising &
+                                       ADVERTISED_Asym_Pause);
+       }
+}
+EXPORT_SYMBOL_GPL(phy_resolve_aneg_linkmode);
+
 static void mmd_phy_indirect(struct mii_bus *bus, int phy_addr, int devad,
                             u16 regnum)
 {
diff --git a/include/linux/phy.h b/include/linux/phy.h
index bb89a60716c2..0db52b272fd7 100644
--- a/include/linux/phy.h
+++ b/include/linux/phy.h
@@ -693,6 +693,8 @@ phy_lookup_setting(int speed, int duplex, const unsigned 
long *mask,
 size_t phy_speeds(unsigned int *speeds, size_t size,
                  unsigned long *mask, size_t maxbit);
 
+void phy_resolve_aneg_linkmode(struct phy_device *phydev);
+
 /**
  * phy_read_mmd - Convenience function for reading a register
  * from an MMD on a given PHY.
-- 
2.7.4