ath79: ag71xx: add ethtool statistics support

Add statistics to ethtool. The statistics can be useful to
debug network issues.

The code is backported from mainline ag71xx.c driver.

Signed-off-by: Leon Leijssen <leon.git@leijssen.info>

diff --git a/target/linux/ath79/files/drivers/net/ethernet/atheros/ag71xx/ag71xx_ethtool.c b/target/linux/ath79/files/drivers/net/ethernet/atheros/ag71xx/ag71xx_ethtool.c
index 2cd7b1be8388dd871e109eedd7a797fb1457f352..104b9320b9de37bcd9813e9f138b7ce55c536afd 100644 (file)
--- a/target/linux/ath79/files/drivers/net/ethernet/atheros/ag71xx/ag71xx_ethtool.c
+++ b/target/linux/ath79/files/drivers/net/ethernet/atheros/ag71xx/ag71xx_ethtool.c
@@ -13,6 +13,59 @@
 
 #include "ag71xx.h"
 
+struct ag71xx_statistic {
+       unsigned short offset;
+       u32 mask;
+       const char name[ETH_GSTRING_LEN];
+};
+
+static const struct ag71xx_statistic ag71xx_statistics[] = {
+       { 0x0080, GENMASK(17, 0), "Tx/Rx 64 Byte", },
+       { 0x0084, GENMASK(17, 0), "Tx/Rx 65-127 Byte", },
+       { 0x0088, GENMASK(17, 0), "Tx/Rx 128-255 Byte", },
+       { 0x008C, GENMASK(17, 0), "Tx/Rx 256-511 Byte", },
+       { 0x0090, GENMASK(17, 0), "Tx/Rx 512-1023 Byte", },
+       { 0x0094, GENMASK(17, 0), "Tx/Rx 1024-1518 Byte", },
+       { 0x0098, GENMASK(17, 0), "Tx/Rx 1519-1522 Byte VLAN", },
+       { 0x009C, GENMASK(23, 0), "Rx Byte", },
+       { 0x00A0, GENMASK(17, 0), "Rx Packet", },
+       { 0x00A4, GENMASK(11, 0), "Rx FCS Error", },
+       { 0x00A8, GENMASK(17, 0), "Rx Multicast Packet", },
+       { 0x00AC, GENMASK(21, 0), "Rx Broadcast Packet", },
+       { 0x00B0, GENMASK(17, 0), "Rx Control Frame Packet", },
+       { 0x00B4, GENMASK(11, 0), "Rx Pause Frame Packet", },
+       { 0x00B8, GENMASK(11, 0), "Rx Unknown OPCode Packet", },
+       { 0x00BC, GENMASK(11, 0), "Rx Alignment Error", },
+       { 0x00C0, GENMASK(15, 0), "Rx Frame Length Error", },
+       { 0x00C4, GENMASK(11, 0), "Rx Code Error", },
+       { 0x00C8, GENMASK(11, 0), "Rx Carrier Sense Error", },
+       { 0x00CC, GENMASK(11, 0), "Rx Undersize Packet", },
+       { 0x00D0, GENMASK(11, 0), "Rx Oversize Packet", },
+       { 0x00D4, GENMASK(11, 0), "Rx Fragments", },
+       { 0x00D8, GENMASK(11, 0), "Rx Jabber", },
+       { 0x00DC, GENMASK(11, 0), "Rx Dropped Packet", },
+       { 0x00E0, GENMASK(23, 0), "Tx Byte", },
+       { 0x00E4, GENMASK(17, 0), "Tx Packet", },
+       { 0x00E8, GENMASK(17, 0), "Tx Multicast Packet", },
+       { 0x00EC, GENMASK(17, 0), "Tx Broadcast Packet", },
+       { 0x00F0, GENMASK(11, 0), "Tx Pause Control Frame", },
+       { 0x00F4, GENMASK(11, 0), "Tx Deferral Packet", },
+       { 0x00F8, GENMASK(11, 0), "Tx Excessive Deferral Packet", },
+       { 0x00FC, GENMASK(11, 0), "Tx Single Collision Packet", },
+       { 0x0100, GENMASK(11, 0), "Tx Multiple Collision", },
+       { 0x0104, GENMASK(11, 0), "Tx Late Collision Packet", },
+       { 0x0108, GENMASK(11, 0), "Tx Excessive Collision Packet", },
+       { 0x010C, GENMASK(12, 0), "Tx Total Collision", },
+       { 0x0110, GENMASK(11, 0), "Tx Pause Frames Honored", },
+       { 0x0114, GENMASK(11, 0), "Tx Drop Frame", },
+       { 0x0118, GENMASK(11, 0), "Tx Jabber Frame", },
+       { 0x011C, GENMASK(11, 0), "Tx FCS Error", },
+       { 0x0120, GENMASK(11, 0), "Tx Control Frame", },
+       { 0x0124, GENMASK(11, 0), "Tx Oversize Frame", },
+       { 0x0128, GENMASK(11, 0), "Tx Undersize Frame", },
+       { 0x012C, GENMASK(11, 0), "Tx Fragment", },
+};
+
 static u32 ag71xx_ethtool_get_msglevel(struct net_device *dev)
 {
        struct ag71xx *ag = netdev_priv(dev);
@@ -95,6 +148,36 @@ static int ag71xx_ethtool_nway_reset(struct net_device *dev)
        return genphy_restart_aneg(phydev);
 }
 
+static void ag71xx_ethtool_get_strings(struct net_device *netdev, u32 sset,
+                                      u8 *data)
+{
+       if (sset == ETH_SS_STATS) {
+               int i;
+
+               for (i = 0; i < ARRAY_SIZE(ag71xx_statistics); i++)
+                       memcpy(data + i * ETH_GSTRING_LEN,
+                              ag71xx_statistics[i].name, ETH_GSTRING_LEN);
+       }
+}
+
+static void ag71xx_ethtool_get_stats(struct net_device *ndev,
+                                    struct ethtool_stats *stats, u64 *data)
+{
+       struct ag71xx *ag = netdev_priv(ndev);
+       int i;
+
+       for (i = 0; i < ARRAY_SIZE(ag71xx_statistics); i++)
+               *data++ = ag71xx_rr(ag, ag71xx_statistics[i].offset)
+                               & ag71xx_statistics[i].mask;
+}
+
+static int ag71xx_ethtool_get_sset_count(struct net_device *ndev, int sset)
+{
+       if (sset == ETH_SS_STATS)
+               return ARRAY_SIZE(ag71xx_statistics);
+       return -EOPNOTSUPP;
+}
+
 struct ethtool_ops ag71xx_ethtool_ops = {
        .get_msglevel   = ag71xx_ethtool_get_msglevel,
        .set_msglevel   = ag71xx_ethtool_set_msglevel,
@@ -105,4 +188,7 @@ struct ethtool_ops ag71xx_ethtool_ops = {
        .get_link       = ethtool_op_get_link,
        .get_ts_info    = ethtool_op_get_ts_info,
        .nway_reset     = ag71xx_ethtool_nway_reset,
+       .get_strings            = ag71xx_ethtool_get_strings,
+       .get_ethtool_stats      = ag71xx_ethtool_get_stats,
+       .get_sset_count         = ag71xx_ethtool_get_sset_count,
 };