net: ti: icssg-prueth: Add Standard network staticstics

Implement .ndo_get_stats64 to dump standard network interface
statistics for ICSSG ethernet driver.

Signed-off-by: MD Danish Anwar <danishanwar@ti.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/ti/icssg/icssg_prueth.c b/drivers/net/ethernet/ti/icssg/icssg_prueth.c
index d0bb4db11b309222aca88a7c258bd286f9c506d3..e641b6ce941587d45f2f5a97a5ba1d9c442aa0c6 100644 (file)
--- a/drivers/net/ethernet/ti/icssg/icssg_prueth.c
+++ b/drivers/net/ethernet/ti/icssg/icssg_prueth.c
@@ -1240,6 +1240,27 @@ static int emac_ndo_ioctl(struct net_device *ndev, struct ifreq *ifr, int cmd)
        return phy_do_ioctl(ndev, ifr, cmd);
 }
 
+static void emac_ndo_get_stats64(struct net_device *ndev,
+                                struct rtnl_link_stats64 *stats)
+{
+       struct prueth_emac *emac = netdev_priv(ndev);
+
+       emac_update_hardware_stats(emac);
+
+       stats->rx_packets     = emac_get_stat_by_name(emac, "rx_packets");
+       stats->rx_bytes       = emac_get_stat_by_name(emac, "rx_bytes");
+       stats->tx_packets     = emac_get_stat_by_name(emac, "tx_packets");
+       stats->tx_bytes       = emac_get_stat_by_name(emac, "tx_bytes");
+       stats->rx_crc_errors  = emac_get_stat_by_name(emac, "rx_crc_errors");
+       stats->rx_over_errors = emac_get_stat_by_name(emac, "rx_over_errors");
+       stats->multicast      = emac_get_stat_by_name(emac, "rx_multicast_frames");
+
+       stats->rx_errors  = ndev->stats.rx_errors;
+       stats->rx_dropped = ndev->stats.rx_dropped;
+       stats->tx_errors  = ndev->stats.tx_errors;
+       stats->tx_dropped = ndev->stats.tx_dropped;
+}
+
 static const struct net_device_ops emac_netdev_ops = {
        .ndo_open = emac_ndo_open,
        .ndo_stop = emac_ndo_stop,
@@ -1249,6 +1270,7 @@ static const struct net_device_ops emac_netdev_ops = {
        .ndo_tx_timeout = emac_ndo_tx_timeout,
        .ndo_set_rx_mode = emac_ndo_set_rx_mode,
        .ndo_eth_ioctl = emac_ndo_ioctl,
+       .ndo_get_stats64 = emac_ndo_get_stats64,
 };
 
 /* get emac_port corresponding to eth_node name */

diff --git a/drivers/net/ethernet/ti/icssg/icssg_prueth.h b/drivers/net/ethernet/ti/icssg/icssg_prueth.h
index f13de0d2e90b5ff3e740440645f215bc4978eb7c..e58cd8db7ba00262673a178bec8ab375c07449f1 100644 (file)
--- a/drivers/net/ethernet/ti/icssg/icssg_prueth.h
+++ b/drivers/net/ethernet/ti/icssg/icssg_prueth.h
@@ -51,6 +51,7 @@
 
 /* Number of ICSSG related stats */
 #define ICSSG_NUM_STATS 60
+#define ICSSG_NUM_STANDARD_STATS 31
 
 /* Firmware status codes */
 #define ICSS_HS_FW_READY 0x55555555
@@ -254,4 +255,5 @@ u32 icssg_queue_level(struct prueth *prueth, int queue);
 
 void emac_stats_work_handler(struct work_struct *work);
 void emac_update_hardware_stats(struct prueth_emac *emac);
+int emac_get_stat_by_name(struct prueth_emac *emac, char *stat_name);
 #endif /* __NET_TI_ICSSG_PRUETH_H */

diff --git a/drivers/net/ethernet/ti/icssg/icssg_stats.c b/drivers/net/ethernet/ti/icssg/icssg_stats.c
index 25deb368a3f03eab0f4eeb02095895314cb9a2df..bb0b33927e3b8253619b031ecf11d843d80fe293 100644 (file)
--- a/drivers/net/ethernet/ti/icssg/icssg_stats.c
+++ b/drivers/net/ethernet/ti/icssg/icssg_stats.c
@@ -42,3 +42,16 @@ void emac_stats_work_handler(struct work_struct *work)
        queue_delayed_work(system_long_wq, &emac->stats_work,
                           msecs_to_jiffies((STATS_TIME_LIMIT_1G_MS * 1000) / emac->speed));
 }
+
+int emac_get_stat_by_name(struct prueth_emac *emac, char *stat_name)
+{
+       int i;
+
+       for (i = 0; i < ARRAY_SIZE(icssg_all_stats); i++) {
+               if (!strcmp(icssg_all_stats[i].name, stat_name))
+                       return emac->stats[icssg_all_stats[i].offset / sizeof(u32)];
+       }
+
+       netdev_err(emac->ndev, "Invalid stats %s\n", stat_name);
+       return -EINVAL;
+}