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 = ndev->phydev;
  61
  62         if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII) {
  63                 if (phydev == NULL)
  64                         return -ENODEV;
  65
  66                 return phy_ethtool_gset(phydev, cmd);
  67         } else if (pdata->phy_mode == PHY_INTERFACE_MODE_SGMII) {
  68                 if (pdata->mdio_driver) {
  69                         if (!phydev)
  70                                 return -ENODEV;
  71
  72                         return phy_ethtool_gset(phydev, cmd);
  73                 }
  74
  75                 cmd->supported = SUPPORTED_1000baseT_Full | SUPPORTED_Autoneg |
  76                                  SUPPORTED_MII;
  77                 cmd->advertising = cmd->supported;
  78                 ethtool_cmd_speed_set(cmd, SPEED_1000);
  79                 cmd->duplex = DUPLEX_FULL;
  80                 cmd->port = PORT_MII;
  81                 cmd->transceiver = XCVR_INTERNAL;
  82                 cmd->autoneg = AUTONEG_ENABLE;
  83         } else {
  84                 cmd->supported = SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE;
  85                 cmd->advertising = cmd->supported;
  86                 ethtool_cmd_speed_set(cmd, SPEED_10000);
  87                 cmd->duplex = DUPLEX_FULL;
  88                 cmd->port = PORT_FIBRE;
  89                 cmd->transceiver = XCVR_INTERNAL;
  90                 cmd->autoneg = AUTONEG_DISABLE;
  91         }
  92
  93         return 0;
  94 }
  95
  96 static int xgene_set_settings(struct net_device *ndev, struct ethtool_cmd *cmd)
  97 {
  98         struct xgene_enet_pdata *pdata = netdev_priv(ndev);
  99         struct phy_device *phydev = ndev->phydev;
 100
 101         if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII) {
 102                 if (!phydev)
 103                         return -ENODEV;
 104
 105                 return phy_ethtool_sset(phydev, cmd);
 106         }
 107
 108         if (pdata->phy_mode == PHY_INTERFACE_MODE_SGMII) {
 109                 if (pdata->mdio_driver) {
 110                         if (!phydev)
 111                                 return -ENODEV;
 112
 113                         return phy_ethtool_sset(phydev, cmd);
 114                 }
 115         }
 116
 117         return -EINVAL;
 118 }
 119
 120 static void xgene_get_strings(struct net_device *ndev, u32 stringset, u8 *data)
 121 {
 122         int i;
 123         u8 *p = data;
 124
 125         if (stringset != ETH_SS_STATS)
 126                 return;
 127
 128         for (i = 0; i < XGENE_STATS_LEN; i++) {
 129                 memcpy(p, gstrings_stats[i].name, ETH_GSTRING_LEN);
 130                 p += ETH_GSTRING_LEN;
 131         }
 132 }
 133
 134 static int xgene_get_sset_count(struct net_device *ndev, int sset)
 135 {
 136         if (sset != ETH_SS_STATS)
 137                 return -EINVAL;
 138
 139         return XGENE_STATS_LEN;
 140 }
 141
 142 static void xgene_get_ethtool_stats(struct net_device *ndev,
 143                                     struct ethtool_stats *dummy,
 144                                     u64 *data)
 145 {
 146         void *pdata = netdev_priv(ndev);
 147         int i;
 148
 149         for (i = 0; i < XGENE_STATS_LEN; i++)
 150                 *data++ = *(u64 *)(pdata + gstrings_stats[i].offset);
 151 }
 152
 153 static const struct ethtool_ops xgene_ethtool_ops = {
 154         .get_drvinfo = xgene_get_drvinfo,
 155         .get_settings = xgene_get_settings,
 156         .set_settings = xgene_set_settings,
 157         .get_link = ethtool_op_get_link,
 158         .get_strings = xgene_get_strings,
 159         .get_sset_count = xgene_get_sset_count,
 160         .get_ethtool_stats = xgene_get_ethtool_stats
 161 };
 162
 163 void xgene_enet_set_ethtool_ops(struct net_device *ndev)
 164 {
 165         ndev->ethtool_ops = &xgene_ethtool_ops;
 166 }