Add a new callback: get_ethtool_phy_stats() which allows network device
drivers not making use of the PHY library to return PHY statistics.
Update ethtool_get_phy_stats(), __ethtool_get_sset_count() and
__ethtool_get_strings() accordingly to interogate the network device
about ETH_SS_PHY_STATS.

Signed-off-by: Florian Fainelli <f.faine...@gmail.com>
---
 include/linux/ethtool.h |  5 +++++
 net/core/ethtool.c      | 39 +++++++++++++++++++++------------------
 2 files changed, 26 insertions(+), 18 deletions(-)

diff --git a/include/linux/ethtool.h b/include/linux/ethtool.h
index ebe41811ed34..9b19556f0156 100644
--- a/include/linux/ethtool.h
+++ b/include/linux/ethtool.h
@@ -310,6 +310,9 @@ bool ethtool_convert_link_mode_to_legacy_u32(u32 
*legacy_u32,
  *     fields should be ignored (use %__ETHTOOL_LINK_MODE_MASK_NBITS
  *     instead of the latter), any change to them will be overwritten
  *     by kernel. Returns a negative error code or zero.
+ * @get_ethtool_phy_stats: Return extended statistics about the PHY device.
+ *     This is only useful if the device maintains PHY statistics and
+ *     cannot use the standard PHY library helpers.
  *
  * All operations are optional (i.e. the function pointer may be set
  * to %NULL) and callers must take this into account.  Callers must
@@ -405,5 +408,7 @@ struct ethtool_ops {
                                      struct ethtool_fecparam *);
        int     (*set_fecparam)(struct net_device *,
                                      struct ethtool_fecparam *);
+       void    (*get_ethtool_phy_stats)(struct net_device *,
+                                        struct ethtool_stats *, u64 *);
 };
 #endif /* _LINUX_ETHTOOL_H */
diff --git a/net/core/ethtool.c b/net/core/ethtool.c
index f0d42e093c4a..4b8992ccf904 100644
--- a/net/core/ethtool.c
+++ b/net/core/ethtool.c
@@ -226,12 +226,9 @@ static int __ethtool_get_sset_count(struct net_device 
*dev, int sset)
        if (sset == ETH_SS_PHY_TUNABLES)
                return ARRAY_SIZE(phy_tunable_strings);
 
-       if (sset == ETH_SS_PHY_STATS) {
-               if (dev->phydev)
-                       return phy_ethtool_get_sset_count(dev->phydev);
-               else
-                       return -EOPNOTSUPP;
-       }
+       if (sset == ETH_SS_PHY_STATS && dev->phydev &&
+           !ops->get_ethtool_phy_stats)
+               return phy_ethtool_get_sset_count(dev->phydev);
 
        if (ops->get_sset_count && ops->get_strings)
                return ops->get_sset_count(dev, sset);
@@ -254,12 +251,10 @@ static void __ethtool_get_strings(struct net_device *dev,
                memcpy(data, tunable_strings, sizeof(tunable_strings));
        else if (stringset == ETH_SS_PHY_TUNABLES)
                memcpy(data, phy_tunable_strings, sizeof(phy_tunable_strings));
-       else if (stringset == ETH_SS_PHY_STATS) {
-               if (dev->phydev)
-                       phy_ethtool_get_strings(dev->phydev, data);
-               else
-                       return;
-       } else
+       else if (stringset == ETH_SS_PHY_STATS && dev->phydev &&
+                !ops->get_ethtool_phy_stats)
+               phy_ethtool_get_strings(dev->phydev, data);
+       else
                /* ops->get_strings is valid because checked earlier */
                ops->get_strings(dev, stringset, data);
 }
@@ -1971,15 +1966,19 @@ static int ethtool_get_stats(struct net_device *dev, 
void __user *useraddr)
 
 static int ethtool_get_phy_stats(struct net_device *dev, void __user *useraddr)
 {
-       struct ethtool_stats stats;
+       const struct ethtool_ops *ops = dev->ethtool_ops;
        struct phy_device *phydev = dev->phydev;
+       struct ethtool_stats stats;
        u64 *data;
        int ret, n_stats;
 
-       if (!phydev)
+       if (!phydev && (!ops->get_ethtool_phy_stats || !ops->get_sset_count))
                return -EOPNOTSUPP;
 
-       n_stats = phy_ethtool_get_sset_count(dev->phydev);
+       if (dev->phydev && !ops->get_ethtool_phy_stats)
+               n_stats = phy_ethtool_get_sset_count(dev->phydev);
+       else
+               n_stats = ops->get_sset_count(dev, ETH_SS_PHY_STATS);
        if (n_stats < 0)
                return n_stats;
        if (n_stats > S32_MAX / sizeof(u64))
@@ -1994,9 +1993,13 @@ static int ethtool_get_phy_stats(struct net_device *dev, 
void __user *useraddr)
        if (n_stats && !data)
                return -ENOMEM;
 
-       ret = phy_ethtool_get_stats(dev->phydev, &stats, data);
-       if (ret < 0)
-               return ret;
+       if (dev->phydev && !ops->get_ethtool_phy_stats) {
+               ret = phy_ethtool_get_stats(dev->phydev, &stats, data);
+               if (ret < 0)
+                       return ret;
+       } else {
+               ops->get_ethtool_phy_stats(dev, &stats, data);
+       }
 
        ret = -EFAULT;
        if (copy_to_user(useraddr, &stats, sizeof(stats)))
-- 
2.7.4

Reply via email to