drivers/net/ethernet/qlogic/qede/qede_ethtool.c

   1 /* QLogic qede NIC Driver
   2 * Copyright (c) 2015 QLogic Corporation
   3 *
   4 * This software is available under the terms of the GNU General Public License
   5 * (GPL) Version 2, available from the file COPYING in the main directory of
   6 * this source tree.
   7 */
   8
   9 #include <linux/version.h>
  10 #include <linux/types.h>
  11 #include <linux/netdevice.h>
  12 #include <linux/ethtool.h>
  13 #include <linux/string.h>
  14 #include <linux/pci.h>
  15 #include <linux/capability.h>
  16 #include "qede.h"
  17
  18 #define QEDE_STAT_OFFSET(stat_name) (offsetof(struct qede_stats, stat_name))
  19 #define QEDE_STAT_STRING(stat_name) (#stat_name)
  20 #define _QEDE_STAT(stat_name, pf_only) \
  21          {QEDE_STAT_OFFSET(stat_name), QEDE_STAT_STRING(stat_name), pf_only}
  22 #define QEDE_PF_STAT(stat_name)         _QEDE_STAT(stat_name, true)
  23 #define QEDE_STAT(stat_name)            _QEDE_STAT(stat_name, false)
  24
  25 #define QEDE_RQSTAT_OFFSET(stat_name) \
  26          (offsetof(struct qede_rx_queue, stat_name))
  27 #define QEDE_RQSTAT_STRING(stat_name) (#stat_name)
  28 #define QEDE_RQSTAT(stat_name) \
  29          {QEDE_RQSTAT_OFFSET(stat_name), QEDE_RQSTAT_STRING(stat_name)}
  30 static const struct {
  31         u64 offset;
  32         char string[ETH_GSTRING_LEN];
  33 } qede_rqstats_arr[] = {
  34         QEDE_RQSTAT(rx_hw_errors),
  35         QEDE_RQSTAT(rx_alloc_errors),
  36 };
  37
  38 #define QEDE_NUM_RQSTATS ARRAY_SIZE(qede_rqstats_arr)
  39 #define QEDE_RQSTATS_DATA(dev, sindex, rqindex) \
  40         (*((u64 *)(((char *)(dev->fp_array[(rqindex)].rxq)) +\
  41                     qede_rqstats_arr[(sindex)].offset)))
  42 static const struct {
  43         u64 offset;
  44         char string[ETH_GSTRING_LEN];
  45         bool pf_only;
  46 } qede_stats_arr[] = {
  47         QEDE_STAT(rx_ucast_bytes),
  48         QEDE_STAT(rx_mcast_bytes),
  49         QEDE_STAT(rx_bcast_bytes),
  50         QEDE_STAT(rx_ucast_pkts),
  51         QEDE_STAT(rx_mcast_pkts),
  52         QEDE_STAT(rx_bcast_pkts),
  53
  54         QEDE_STAT(tx_ucast_bytes),
  55         QEDE_STAT(tx_mcast_bytes),
  56         QEDE_STAT(tx_bcast_bytes),
  57         QEDE_STAT(tx_ucast_pkts),
  58         QEDE_STAT(tx_mcast_pkts),
  59         QEDE_STAT(tx_bcast_pkts),
  60
  61         QEDE_PF_STAT(rx_64_byte_packets),
  62         QEDE_PF_STAT(rx_127_byte_packets),
  63         QEDE_PF_STAT(rx_255_byte_packets),
  64         QEDE_PF_STAT(rx_511_byte_packets),
  65         QEDE_PF_STAT(rx_1023_byte_packets),
  66         QEDE_PF_STAT(rx_1518_byte_packets),
  67         QEDE_PF_STAT(rx_1522_byte_packets),
  68         QEDE_PF_STAT(rx_2047_byte_packets),
  69         QEDE_PF_STAT(rx_4095_byte_packets),
  70         QEDE_PF_STAT(rx_9216_byte_packets),
  71         QEDE_PF_STAT(rx_16383_byte_packets),
  72         QEDE_PF_STAT(tx_64_byte_packets),
  73         QEDE_PF_STAT(tx_65_to_127_byte_packets),
  74         QEDE_PF_STAT(tx_128_to_255_byte_packets),
  75         QEDE_PF_STAT(tx_256_to_511_byte_packets),
  76         QEDE_PF_STAT(tx_512_to_1023_byte_packets),
  77         QEDE_PF_STAT(tx_1024_to_1518_byte_packets),
  78         QEDE_PF_STAT(tx_1519_to_2047_byte_packets),
  79         QEDE_PF_STAT(tx_2048_to_4095_byte_packets),
  80         QEDE_PF_STAT(tx_4096_to_9216_byte_packets),
  81         QEDE_PF_STAT(tx_9217_to_16383_byte_packets),
  82
  83         QEDE_PF_STAT(rx_mac_crtl_frames),
  84         QEDE_PF_STAT(tx_mac_ctrl_frames),
  85         QEDE_PF_STAT(rx_pause_frames),
  86         QEDE_PF_STAT(tx_pause_frames),
  87         QEDE_PF_STAT(rx_pfc_frames),
  88         QEDE_PF_STAT(tx_pfc_frames),
  89
  90         QEDE_PF_STAT(rx_crc_errors),
  91         QEDE_PF_STAT(rx_align_errors),
  92         QEDE_PF_STAT(rx_carrier_errors),
  93         QEDE_PF_STAT(rx_oversize_packets),
  94         QEDE_PF_STAT(rx_jabbers),
  95         QEDE_PF_STAT(rx_undersize_packets),
  96         QEDE_PF_STAT(rx_fragments),
  97         QEDE_PF_STAT(tx_lpi_entry_count),
  98         QEDE_PF_STAT(tx_total_collisions),
  99         QEDE_PF_STAT(brb_truncates),
 100         QEDE_PF_STAT(brb_discards),
 101         QEDE_STAT(no_buff_discards),
 102         QEDE_PF_STAT(mftag_filter_discards),
 103         QEDE_PF_STAT(mac_filter_discards),
 104         QEDE_STAT(tx_err_drop_pkts),
 105
 106         QEDE_STAT(coalesced_pkts),
 107         QEDE_STAT(coalesced_events),
 108         QEDE_STAT(coalesced_aborts_num),
 109         QEDE_STAT(non_coalesced_pkts),
 110         QEDE_STAT(coalesced_bytes),
 111 };
 112
 113 #define QEDE_STATS_DATA(dev, index) \
 114         (*((u64 *)(((char *)(dev)) + offsetof(struct qede_dev, stats) \
 115                         + qede_stats_arr[(index)].offset)))
 116
 117 #define QEDE_NUM_STATS  ARRAY_SIZE(qede_stats_arr)
 118
 119 static void qede_get_strings_stats(struct qede_dev *edev, u8 *buf)
 120 {
 121         int i, j, k;
 122
 123         for (i = 0, j = 0; i < QEDE_NUM_STATS; i++) {
 124                 strcpy(buf + j * ETH_GSTRING_LEN,
 125                        qede_stats_arr[i].string);
 126                 j++;
 127         }
 128
 129         for (k = 0; k < QEDE_NUM_RQSTATS; k++, j++)
 130                 strcpy(buf + j * ETH_GSTRING_LEN,
 131                        qede_rqstats_arr[k].string);
 132 }
 133
 134 static void qede_get_strings(struct net_device *dev, u32 stringset, u8 *buf)
 135 {
 136         struct qede_dev *edev = netdev_priv(dev);
 137
 138         switch (stringset) {
 139         case ETH_SS_STATS:
 140                 qede_get_strings_stats(edev, buf);
 141                 break;
 142         default:
 143                 DP_VERBOSE(edev, QED_MSG_DEBUG,
 144                            "Unsupported stringset 0x%08x\n", stringset);
 145         }
 146 }
 147
 148 static void qede_get_ethtool_stats(struct net_device *dev,
 149                                    struct ethtool_stats *stats, u64 *buf)
 150 {
 151         struct qede_dev *edev = netdev_priv(dev);
 152         int sidx, cnt = 0;
 153         int qid;
 154
 155         qede_fill_by_demand_stats(edev);
 156
 157         mutex_lock(&edev->qede_lock);
 158
 159         for (sidx = 0; sidx < QEDE_NUM_STATS; sidx++)
 160                 buf[cnt++] = QEDE_STATS_DATA(edev, sidx);
 161
 162         for (sidx = 0; sidx < QEDE_NUM_RQSTATS; sidx++) {
 163                 buf[cnt] = 0;
 164                 for (qid = 0; qid < edev->num_rss; qid++)
 165                         buf[cnt] += QEDE_RQSTATS_DATA(edev, sidx, qid);
 166                 cnt++;
 167         }
 168
 169         mutex_unlock(&edev->qede_lock);
 170 }
 171
 172 static int qede_get_sset_count(struct net_device *dev, int stringset)
 173 {
 174         struct qede_dev *edev = netdev_priv(dev);
 175         int num_stats = QEDE_NUM_STATS;
 176
 177         switch (stringset) {
 178         case ETH_SS_STATS:
 179                 return num_stats + QEDE_NUM_RQSTATS;
 180
 181         default:
 182                 DP_VERBOSE(edev, QED_MSG_DEBUG,
 183                            "Unsupported stringset 0x%08x\n", stringset);
 184                 return -EINVAL;
 185         }
 186 }
 187
 188 static int qede_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
 189 {
 190         struct qede_dev *edev = netdev_priv(dev);
 191         struct qed_link_output current_link;
 192
 193         memset(&current_link, 0, sizeof(current_link));
 194         edev->ops->common->get_link(edev->cdev, &current_link);
 195
 196         cmd->supported = current_link.supported_caps;
 197         cmd->advertising = current_link.advertised_caps;
 198         if ((edev->state == QEDE_STATE_OPEN) && (current_link.link_up)) {
 199                 ethtool_cmd_speed_set(cmd, current_link.speed);
 200                 cmd->duplex = current_link.duplex;
 201         } else {
 202                 cmd->duplex = DUPLEX_UNKNOWN;
 203                 ethtool_cmd_speed_set(cmd, SPEED_UNKNOWN);
 204         }
 205         cmd->port = current_link.port;
 206         cmd->autoneg = (current_link.autoneg) ? AUTONEG_ENABLE :
 207                                                 AUTONEG_DISABLE;
 208         cmd->lp_advertising = current_link.lp_caps;
 209
 210         return 0;
 211 }
 212
 213 static int qede_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
 214 {
 215         struct qede_dev *edev = netdev_priv(dev);
 216         struct qed_link_output current_link;
 217         struct qed_link_params params;
 218         u32 speed;
 219
 220         if (edev->dev_info.common.is_mf) {
 221                 DP_INFO(edev,
 222                         "Link parameters can not be changed in MF mode\n");
 223                 return -EOPNOTSUPP;
 224         }
 225
 226         memset(&current_link, 0, sizeof(current_link));
 227         memset(&params, 0, sizeof(params));
 228         edev->ops->common->get_link(edev->cdev, &current_link);
 229
 230         speed = ethtool_cmd_speed(cmd);
 231         params.override_flags |= QED_LINK_OVERRIDE_SPEED_ADV_SPEEDS;
 232         params.override_flags |= QED_LINK_OVERRIDE_SPEED_AUTONEG;
 233         if (cmd->autoneg == AUTONEG_ENABLE) {
 234                 params.autoneg = true;
 235                 params.forced_speed = 0;
 236                 params.adv_speeds = cmd->advertising;
 237         } else { /* forced speed */
 238                 params.override_flags |= QED_LINK_OVERRIDE_SPEED_FORCED_SPEED;
 239                 params.autoneg = false;
 240                 params.forced_speed = speed;
 241                 switch (speed) {
 242                 case SPEED_10000:
 243                         if (!(current_link.supported_caps &
 244                             SUPPORTED_10000baseKR_Full)) {
 245                                 DP_INFO(edev, "10G speed not supported\n");
 246                                 return -EINVAL;
 247                         }
 248                         params.adv_speeds = SUPPORTED_10000baseKR_Full;
 249                         break;
 250                 case SPEED_40000:
 251                         if (!(current_link.supported_caps &
 252                             SUPPORTED_40000baseLR4_Full)) {
 253                                 DP_INFO(edev, "40G speed not supported\n");
 254                                 return -EINVAL;
 255                         }
 256                         params.adv_speeds = SUPPORTED_40000baseLR4_Full;
 257                         break;
 258                 default:
 259                         DP_INFO(edev, "Unsupported speed %u\n", speed);
 260                         return -EINVAL;
 261                 }
 262         }
 263
 264         params.link_up = true;
 265         edev->ops->common->set_link(edev->cdev, &params);
 266
 267         return 0;
 268 }
 269
 270 static void qede_get_drvinfo(struct net_device *ndev,
 271                              struct ethtool_drvinfo *info)
 272 {
 273         char mfw[ETHTOOL_FWVERS_LEN], storm[ETHTOOL_FWVERS_LEN];
 274         struct qede_dev *edev = netdev_priv(ndev);
 275
 276         strlcpy(info->driver, "qede", sizeof(info->driver));
 277         strlcpy(info->version, DRV_MODULE_VERSION, sizeof(info->version));
 278
 279         snprintf(storm, ETHTOOL_FWVERS_LEN, "%d.%d.%d.%d",
 280                  edev->dev_info.common.fw_major,
 281                  edev->dev_info.common.fw_minor,
 282                  edev->dev_info.common.fw_rev,
 283                  edev->dev_info.common.fw_eng);
 284
 285         snprintf(mfw, ETHTOOL_FWVERS_LEN, "%d.%d.%d.%d",
 286                  (edev->dev_info.common.mfw_rev >> 24) & 0xFF,
 287                  (edev->dev_info.common.mfw_rev >> 16) & 0xFF,
 288                  (edev->dev_info.common.mfw_rev >> 8) & 0xFF,
 289                  edev->dev_info.common.mfw_rev & 0xFF);
 290
 291         if ((strlen(storm) + strlen(mfw) + strlen("mfw storm  ")) <
 292             sizeof(info->fw_version)) {
 293                 snprintf(info->fw_version, sizeof(info->fw_version),
 294                          "mfw %s storm %s", mfw, storm);
 295         } else {
 296                 snprintf(info->fw_version, sizeof(info->fw_version),
 297                          "%s %s", mfw, storm);
 298         }
 299
 300         strlcpy(info->bus_info, pci_name(edev->pdev), sizeof(info->bus_info));
 301 }
 302
 303 static u32 qede_get_msglevel(struct net_device *ndev)
 304 {
 305         struct qede_dev *edev = netdev_priv(ndev);
 306
 307         return ((u32)edev->dp_level << QED_LOG_LEVEL_SHIFT) |
 308                edev->dp_module;
 309 }
 310
 311 static void qede_set_msglevel(struct net_device *ndev, u32 level)
 312 {
 313         struct qede_dev *edev = netdev_priv(ndev);
 314         u32 dp_module = 0;
 315         u8 dp_level = 0;
 316
 317         qede_config_debug(level, &dp_module, &dp_level);
 318
 319         edev->dp_level = dp_level;
 320         edev->dp_module = dp_module;
 321         edev->ops->common->update_msglvl(edev->cdev,
 322                                          dp_module, dp_level);
 323 }
 324
 325 static u32 qede_get_link(struct net_device *dev)
 326 {
 327         struct qede_dev *edev = netdev_priv(dev);
 328         struct qed_link_output current_link;
 329
 330         memset(&current_link, 0, sizeof(current_link));
 331         edev->ops->common->get_link(edev->cdev, &current_link);
 332
 333         return current_link.link_up;
 334 }
 335
 336 static void qede_update_mtu(struct qede_dev *edev, union qede_reload_args *args)
 337 {
 338         edev->ndev->mtu = args->mtu;
 339 }
 340
 341 /* Netdevice NDOs */
 342 #define ETH_MAX_JUMBO_PACKET_SIZE       9600
 343 #define ETH_MIN_PACKET_SIZE             60
 344 int qede_change_mtu(struct net_device *ndev, int new_mtu)
 345 {
 346         struct qede_dev *edev = netdev_priv(ndev);
 347         union qede_reload_args args;
 348
 349         if ((new_mtu > ETH_MAX_JUMBO_PACKET_SIZE) ||
 350             ((new_mtu + ETH_HLEN) < ETH_MIN_PACKET_SIZE)) {
 351                 DP_ERR(edev, "Can't support requested MTU size\n");
 352                 return -EINVAL;
 353         }
 354
 355         DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 356                    "Configuring MTU size of %d\n", new_mtu);
 357
 358         /* Set the mtu field and re-start the interface if needed*/
 359         args.mtu = new_mtu;
 360
 361         if (netif_running(edev->ndev))
 362                 qede_reload(edev, &qede_update_mtu, &args);
 363
 364         qede_update_mtu(edev, &args);
 365
 366         return 0;
 367 }
 368
 369 static const struct ethtool_ops qede_ethtool_ops = {
 370         .get_settings = qede_get_settings,
 371         .set_settings = qede_set_settings,
 372         .get_drvinfo = qede_get_drvinfo,
 373         .get_msglevel = qede_get_msglevel,
 374         .set_msglevel = qede_set_msglevel,
 375         .get_link = qede_get_link,
 376         .get_strings = qede_get_strings,
 377         .get_ethtool_stats = qede_get_ethtool_stats,
 378         .get_sset_count = qede_get_sset_count,
 379
 380 };
 381
 382 void qede_set_ethtool_ops(struct net_device *dev)
 383 {
 384         dev->ethtool_ops = &qede_ethtool_ops;
 385 }