drivers/net/ethernet/aquantia/atlantic/aq_ethtool.c

   1 /*
   2  * aQuantia Corporation Network Driver
   3  * Copyright (C) 2014-2017 aQuantia Corporation. All rights reserved
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms and conditions of the GNU General Public License,
   7  * version 2, as published by the Free Software Foundation.
   8  */
   9
  10 /* File aq_ethtool.c: Definition of ethertool related functions. */
  11
  12 #include "aq_ethtool.h"
  13 #include "aq_nic.h"
  14
  15 static void aq_ethtool_get_regs(struct net_device *ndev,
  16                                 struct ethtool_regs *regs, void *p)
  17 {
  18         struct aq_nic_s *aq_nic = netdev_priv(ndev);
  19         u32 regs_count = aq_nic_get_regs_count(aq_nic);
  20
  21         memset(p, 0, regs_count * sizeof(u32));
  22         aq_nic_get_regs(aq_nic, regs, p);
  23 }
  24
  25 static int aq_ethtool_get_regs_len(struct net_device *ndev)
  26 {
  27         struct aq_nic_s *aq_nic = netdev_priv(ndev);
  28         u32 regs_count = aq_nic_get_regs_count(aq_nic);
  29
  30         return regs_count * sizeof(u32);
  31 }
  32
  33 static u32 aq_ethtool_get_link(struct net_device *ndev)
  34 {
  35         return ethtool_op_get_link(ndev);
  36 }
  37
  38 static int aq_ethtool_get_link_ksettings(struct net_device *ndev,
  39                                          struct ethtool_link_ksettings *cmd)
  40 {
  41         struct aq_nic_s *aq_nic = netdev_priv(ndev);
  42
  43         aq_nic_get_link_ksettings(aq_nic, cmd);
  44         cmd->base.speed = netif_carrier_ok(ndev) ?
  45                                 aq_nic_get_link_speed(aq_nic) : 0U;
  46
  47         return 0;
  48 }
  49
  50 static int
  51 aq_ethtool_set_link_ksettings(struct net_device *ndev,
  52                               const struct ethtool_link_ksettings *cmd)
  53 {
  54         struct aq_nic_s *aq_nic = netdev_priv(ndev);
  55
  56         return aq_nic_set_link_ksettings(aq_nic, cmd);
  57 }
  58
  59 static const char aq_ethtool_stat_names[][ETH_GSTRING_LEN] = {
  60         "InPackets",
  61         "InUCast",
  62         "InMCast",
  63         "InBCast",
  64         "InErrors",
  65         "OutPackets",
  66         "OutUCast",
  67         "OutMCast",
  68         "OutBCast",
  69         "InUCastOctets",
  70         "OutUCastOctets",
  71         "InMCastOctets",
  72         "OutMCastOctets",
  73         "InBCastOctets",
  74         "OutBCastOctets",
  75         "InOctets",
  76         "OutOctets",
  77         "InPacketsDma",
  78         "OutPacketsDma",
  79         "InOctetsDma",
  80         "OutOctetsDma",
  81         "InDroppedDma",
  82 };
  83
  84 static const char aq_ethtool_queue_stat_names[][ETH_GSTRING_LEN] = {
  85         "Queue[%d] InPackets",
  86         "Queue[%d] OutPackets",
  87         "Queue[%d] Restarts",
  88         "Queue[%d] InJumboPackets",
  89         "Queue[%d] InLroPackets",
  90         "Queue[%d] InErrors",
  91 };
  92
  93 static void aq_ethtool_stats(struct net_device *ndev,
  94                              struct ethtool_stats *stats, u64 *data)
  95 {
  96         struct aq_nic_s *aq_nic = netdev_priv(ndev);
  97         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
  98
  99         memset(data, 0, (ARRAY_SIZE(aq_ethtool_stat_names) +
 100                                 ARRAY_SIZE(aq_ethtool_queue_stat_names) *
 101                                 cfg->vecs) * sizeof(u64));
 102         aq_nic_get_stats(aq_nic, data);
 103 }
 104
 105 static void aq_ethtool_get_drvinfo(struct net_device *ndev,
 106                                    struct ethtool_drvinfo *drvinfo)
 107 {
 108         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 109         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
 110         struct pci_dev *pdev = to_pci_dev(ndev->dev.parent);
 111         u32 firmware_version = aq_nic_get_fw_version(aq_nic);
 112         u32 regs_count = aq_nic_get_regs_count(aq_nic);
 113
 114         strlcat(drvinfo->driver, AQ_CFG_DRV_NAME, sizeof(drvinfo->driver));
 115         strlcat(drvinfo->version, AQ_CFG_DRV_VERSION, sizeof(drvinfo->version));
 116
 117         snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version),
 118                  "%u.%u.%u", firmware_version >> 24,
 119                  (firmware_version >> 16) & 0xFFU, firmware_version & 0xFFFFU);
 120
 121         strlcpy(drvinfo->bus_info, pdev ? pci_name(pdev) : "",
 122                 sizeof(drvinfo->bus_info));
 123         drvinfo->n_stats = ARRAY_SIZE(aq_ethtool_stat_names) +
 124                 cfg->vecs * ARRAY_SIZE(aq_ethtool_queue_stat_names);
 125         drvinfo->testinfo_len = 0;
 126         drvinfo->regdump_len = regs_count;
 127         drvinfo->eedump_len = 0;
 128 }
 129
 130 static void aq_ethtool_get_strings(struct net_device *ndev,
 131                                    u32 stringset, u8 *data)
 132 {
 133         int i, si;
 134         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 135         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
 136         u8 *p = data;
 137
 138         if (stringset == ETH_SS_STATS) {
 139                 memcpy(p, *aq_ethtool_stat_names,
 140                        sizeof(aq_ethtool_stat_names));
 141                 p = p + sizeof(aq_ethtool_stat_names);
 142                 for (i = 0; i < cfg->vecs; i++) {
 143                         for (si = 0;
 144                                 si < ARRAY_SIZE(aq_ethtool_queue_stat_names);
 145                                 si++) {
 146                                 snprintf(p, ETH_GSTRING_LEN,
 147                                          aq_ethtool_queue_stat_names[si], i);
 148                                 p += ETH_GSTRING_LEN;
 149                         }
 150                 }
 151         }
 152 }
 153
 154 static int aq_ethtool_get_sset_count(struct net_device *ndev, int stringset)
 155 {
 156         int ret = 0;
 157         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 158         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
 159
 160         switch (stringset) {
 161         case ETH_SS_STATS:
 162                 ret = ARRAY_SIZE(aq_ethtool_stat_names) +
 163                         cfg->vecs * ARRAY_SIZE(aq_ethtool_queue_stat_names);
 164                 break;
 165         default:
 166                 ret = -EOPNOTSUPP;
 167         }
 168         return ret;
 169 }
 170
 171 static u32 aq_ethtool_get_rss_indir_size(struct net_device *ndev)
 172 {
 173         return AQ_CFG_RSS_INDIRECTION_TABLE_MAX;
 174 }
 175
 176 static u32 aq_ethtool_get_rss_key_size(struct net_device *ndev)
 177 {
 178         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 179         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
 180
 181         return sizeof(cfg->aq_rss.hash_secret_key);
 182 }
 183
 184 static int aq_ethtool_get_rss(struct net_device *ndev, u32 *indir, u8 *key,
 185                               u8 *hfunc)
 186 {
 187         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 188         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
 189         unsigned int i = 0U;
 190
 191         if (hfunc)
 192                 *hfunc = ETH_RSS_HASH_TOP; /* Toeplitz */
 193         if (indir) {
 194                 for (i = 0; i < AQ_CFG_RSS_INDIRECTION_TABLE_MAX; i++)
 195                         indir[i] = cfg->aq_rss.indirection_table[i];
 196         }
 197         if (key)
 198                 memcpy(key, cfg->aq_rss.hash_secret_key,
 199                        sizeof(cfg->aq_rss.hash_secret_key));
 200         return 0;
 201 }
 202
 203 static int aq_ethtool_get_rxnfc(struct net_device *ndev,
 204                                 struct ethtool_rxnfc *cmd,
 205                                 u32 *rule_locs)
 206 {
 207         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 208         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
 209         int err = 0;
 210
 211         switch (cmd->cmd) {
 212         case ETHTOOL_GRXRINGS:
 213                 cmd->data = cfg->vecs;
 214                 break;
 215
 216         default:
 217                 err = -EOPNOTSUPP;
 218                 break;
 219         }
 220
 221         return err;
 222 }
 223
 224 static int aq_ethtool_get_coalesce(struct net_device *ndev,
 225                                    struct ethtool_coalesce *coal)
 226 {
 227         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 228         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
 229
 230         if (cfg->itr == AQ_CFG_INTERRUPT_MODERATION_ON ||
 231             cfg->itr == AQ_CFG_INTERRUPT_MODERATION_AUTO) {
 232                 coal->rx_coalesce_usecs = cfg->rx_itr;
 233                 coal->tx_coalesce_usecs = cfg->tx_itr;
 234                 coal->rx_max_coalesced_frames = 0;
 235                 coal->tx_max_coalesced_frames = 0;
 236         } else {
 237                 coal->rx_coalesce_usecs = 0;
 238                 coal->tx_coalesce_usecs = 0;
 239                 coal->rx_max_coalesced_frames = 1;
 240                 coal->tx_max_coalesced_frames = 1;
 241         }
 242         return 0;
 243 }
 244
 245 static int aq_ethtool_set_coalesce(struct net_device *ndev,
 246                                    struct ethtool_coalesce *coal)
 247 {
 248         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 249         struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
 250
 251         /* This is not yet supported
 252          */
 253         if (coal->use_adaptive_rx_coalesce || coal->use_adaptive_tx_coalesce)
 254                 return -EOPNOTSUPP;
 255
 256         /* Atlantic only supports timing based coalescing
 257          */
 258         if (coal->rx_max_coalesced_frames > 1 ||
 259             coal->rx_coalesce_usecs_irq ||
 260             coal->rx_max_coalesced_frames_irq)
 261                 return -EOPNOTSUPP;
 262
 263         if (coal->tx_max_coalesced_frames > 1 ||
 264             coal->tx_coalesce_usecs_irq ||
 265             coal->tx_max_coalesced_frames_irq)
 266                 return -EOPNOTSUPP;
 267
 268         /* We do not support frame counting. Check this
 269          */
 270         if (!(coal->rx_max_coalesced_frames == !coal->rx_coalesce_usecs))
 271                 return -EOPNOTSUPP;
 272         if (!(coal->tx_max_coalesced_frames == !coal->tx_coalesce_usecs))
 273                 return -EOPNOTSUPP;
 274
 275         if (coal->rx_coalesce_usecs > AQ_CFG_INTERRUPT_MODERATION_USEC_MAX ||
 276             coal->tx_coalesce_usecs > AQ_CFG_INTERRUPT_MODERATION_USEC_MAX)
 277                 return -EINVAL;
 278
 279         cfg->itr = AQ_CFG_INTERRUPT_MODERATION_ON;
 280
 281         cfg->rx_itr = coal->rx_coalesce_usecs;
 282         cfg->tx_itr = coal->tx_coalesce_usecs;
 283
 284         return aq_nic_update_interrupt_moderation_settings(aq_nic);
 285 }
 286
 287 const struct ethtool_ops aq_ethtool_ops = {
 288         .get_link            = aq_ethtool_get_link,
 289         .get_regs_len        = aq_ethtool_get_regs_len,
 290         .get_regs            = aq_ethtool_get_regs,
 291         .get_drvinfo         = aq_ethtool_get_drvinfo,
 292         .get_strings         = aq_ethtool_get_strings,
 293         .get_rxfh_indir_size = aq_ethtool_get_rss_indir_size,
 294         .get_rxfh_key_size   = aq_ethtool_get_rss_key_size,
 295         .get_rxfh            = aq_ethtool_get_rss,
 296         .get_rxnfc           = aq_ethtool_get_rxnfc,
 297         .get_sset_count      = aq_ethtool_get_sset_count,
 298         .get_ethtool_stats   = aq_ethtool_stats,
 299         .get_link_ksettings  = aq_ethtool_get_link_ksettings,
 300         .set_link_ksettings  = aq_ethtool_set_link_ksettings,
 301         .get_coalesce        = aq_ethtool_get_coalesce,
 302         .set_coalesce        = aq_ethtool_set_coalesce,
 303 };