drivers/net/ethernet/apm/xgene/xgene_enet_ethtool.c

   1 /* Applied Micro X-Gene SoC Ethernet Driver
   2  *
   3  * Copyright (c) 2014, Applied Micro Circuits Corporation
   4  * Authors: Iyappan Subramanian <isubramanian@apm.com>
   5  *
   6  * This program is free software; you can redistribute  it and/or modify it
   7  * under  the terms of  the GNU General  Public License as published by the
   8  * Free Software Foundation;  either version 2 of the  License, or (at your
   9  * option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include <linux/ethtool.h>
  21 #include "xgene_enet_main.h"
  22
  23 struct xgene_gstrings_stats {
  24         char name[ETH_GSTRING_LEN];
  25         int offset;
  26 };
  27
  28 #define XGENE_STAT(m) { #m, offsetof(struct xgene_enet_pdata, stats.m) }
  29
  30 static const struct xgene_gstrings_stats gstrings_stats[] = {
  31         XGENE_STAT(rx_packets),
  32         XGENE_STAT(tx_packets),
  33         XGENE_STAT(rx_bytes),
  34         XGENE_STAT(tx_bytes),
  35         XGENE_STAT(rx_errors),
  36         XGENE_STAT(tx_errors),
  37         XGENE_STAT(rx_length_errors),
  38         XGENE_STAT(rx_crc_errors),
  39         XGENE_STAT(rx_frame_errors),
  40         XGENE_STAT(rx_fifo_errors)
  41 };
  42
  43 #define XGENE_STATS_LEN         ARRAY_SIZE(gstrings_stats)
  44
  45 static void xgene_get_drvinfo(struct net_device *ndev,
  46                               struct ethtool_drvinfo *info)
  47 {
  48         struct xgene_enet_pdata *pdata = netdev_priv(ndev);
  49         struct platform_device *pdev = pdata->pdev;
  50
  51         strcpy(info->driver, "xgene_enet");
  52         strcpy(info->version, XGENE_DRV_VERSION);
  53         snprintf(info->fw_version, ETHTOOL_FWVERS_LEN, "N/A");
  54         sprintf(info->bus_info, "%s", pdev->name);
  55 }
  56
  57 static int xgene_get_settings(struct net_device *ndev, struct ethtool_cmd *cmd)
  58 {
  59         struct xgene_enet_pdata *pdata = netdev_priv(ndev);
  60         struct phy_device *phydev = pdata->phy_dev;
  61
  62         if (phydev == NULL)
  63                 return -ENODEV;
  64
  65         return phy_ethtool_gset(phydev, cmd);
  66 }
  67
  68 static int xgene_set_settings(struct net_device *ndev, struct ethtool_cmd *cmd)
  69 {
  70         struct xgene_enet_pdata *pdata = netdev_priv(ndev);
  71         struct phy_device *phydev = pdata->phy_dev;
  72
  73         if (phydev == NULL)
  74                 return -ENODEV;
  75
  76         return phy_ethtool_sset(phydev, cmd);
  77 }
  78
  79 static void xgene_get_strings(struct net_device *ndev, u32 stringset, u8 *data)
  80 {
  81         int i;
  82         u8 *p = data;
  83
  84         if (stringset != ETH_SS_STATS)
  85                 return;
  86
  87         for (i = 0; i < XGENE_STATS_LEN; i++) {
  88                 memcpy(p, gstrings_stats[i].name, ETH_GSTRING_LEN);
  89                 p += ETH_GSTRING_LEN;
  90         }
  91 }
  92
  93 static int xgene_get_sset_count(struct net_device *ndev, int sset)
  94 {
  95         if (sset != ETH_SS_STATS)
  96                 return -EINVAL;
  97
  98         return XGENE_STATS_LEN;
  99 }
 100
 101 static void xgene_get_ethtool_stats(struct net_device *ndev,
 102                                     struct ethtool_stats *dummy,
 103                                     u64 *data)
 104 {
 105         void *pdata = netdev_priv(ndev);
 106         int i;
 107
 108         for (i = 0; i < XGENE_STATS_LEN; i++)
 109                 *data++ = *(u64 *)(pdata + gstrings_stats[i].offset);
 110 }
 111
 112 static const struct ethtool_ops xgene_ethtool_ops = {
 113         .get_drvinfo = xgene_get_drvinfo,
 114         .get_settings = xgene_get_settings,
 115         .set_settings = xgene_set_settings,
 116         .get_link = ethtool_op_get_link,
 117         .get_strings = xgene_get_strings,
 118         .get_sset_count = xgene_get_sset_count,
 119         .get_ethtool_stats = xgene_get_ethtool_stats
 120 };
 121
 122 void xgene_enet_set_ethtool_ops(struct net_device *ndev)
 123 {
 124         ndev->ethtool_ops = &xgene_ethtool_ops;
 125 }