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/etherdevice.h>
  13 #include <linux/ethtool.h>
  14 #include <linux/string.h>
  15 #include <linux/pci.h>
  16 #include <linux/capability.h>
  17 #include "qede.h"
  18
  19 #define QEDE_STAT_OFFSET(stat_name) (offsetof(struct qede_stats, stat_name))
  20 #define QEDE_STAT_STRING(stat_name) (#stat_name)
  21 #define _QEDE_STAT(stat_name, pf_only) \
  22          {QEDE_STAT_OFFSET(stat_name), QEDE_STAT_STRING(stat_name), pf_only}
  23 #define QEDE_PF_STAT(stat_name)         _QEDE_STAT(stat_name, true)
  24 #define QEDE_STAT(stat_name)            _QEDE_STAT(stat_name, false)
  25
  26 #define QEDE_RQSTAT_OFFSET(stat_name) \
  27          (offsetof(struct qede_rx_queue, stat_name))
  28 #define QEDE_RQSTAT_STRING(stat_name) (#stat_name)
  29 #define QEDE_RQSTAT(stat_name) \
  30          {QEDE_RQSTAT_OFFSET(stat_name), QEDE_RQSTAT_STRING(stat_name)}
  31
  32 #define QEDE_SELFTEST_POLL_COUNT 100
  33
  34 static const struct {
  35         u64 offset;
  36         char string[ETH_GSTRING_LEN];
  37 } qede_rqstats_arr[] = {
  38         QEDE_RQSTAT(rcv_pkts),
  39         QEDE_RQSTAT(rx_hw_errors),
  40         QEDE_RQSTAT(rx_alloc_errors),
  41         QEDE_RQSTAT(rx_ip_frags),
  42 };
  43
  44 #define QEDE_NUM_RQSTATS ARRAY_SIZE(qede_rqstats_arr)
  45 #define QEDE_RQSTATS_DATA(dev, sindex, rqindex) \
  46         (*((u64 *)(((char *)(dev->fp_array[(rqindex)].rxq)) +\
  47                     qede_rqstats_arr[(sindex)].offset)))
  48 #define QEDE_TQSTAT_OFFSET(stat_name) \
  49         (offsetof(struct qede_tx_queue, stat_name))
  50 #define QEDE_TQSTAT_STRING(stat_name) (#stat_name)
  51 #define QEDE_TQSTAT(stat_name) \
  52         {QEDE_TQSTAT_OFFSET(stat_name), QEDE_TQSTAT_STRING(stat_name)}
  53 #define QEDE_NUM_TQSTATS ARRAY_SIZE(qede_tqstats_arr)
  54 static const struct {
  55         u64 offset;
  56         char string[ETH_GSTRING_LEN];
  57 } qede_tqstats_arr[] = {
  58         QEDE_TQSTAT(xmit_pkts),
  59         QEDE_TQSTAT(stopped_cnt),
  60 };
  61
  62 #define QEDE_TQSTATS_DATA(dev, sindex, tssid, tcid) \
  63         (*((u64 *)(((void *)(&dev->fp_array[tssid].txqs[tcid])) +\
  64                    qede_tqstats_arr[(sindex)].offset)))
  65
  66 static const struct {
  67         u64 offset;
  68         char string[ETH_GSTRING_LEN];
  69         bool pf_only;
  70 } qede_stats_arr[] = {
  71         QEDE_STAT(rx_ucast_bytes),
  72         QEDE_STAT(rx_mcast_bytes),
  73         QEDE_STAT(rx_bcast_bytes),
  74         QEDE_STAT(rx_ucast_pkts),
  75         QEDE_STAT(rx_mcast_pkts),
  76         QEDE_STAT(rx_bcast_pkts),
  77
  78         QEDE_STAT(tx_ucast_bytes),
  79         QEDE_STAT(tx_mcast_bytes),
  80         QEDE_STAT(tx_bcast_bytes),
  81         QEDE_STAT(tx_ucast_pkts),
  82         QEDE_STAT(tx_mcast_pkts),
  83         QEDE_STAT(tx_bcast_pkts),
  84
  85         QEDE_PF_STAT(rx_64_byte_packets),
  86         QEDE_PF_STAT(rx_65_to_127_byte_packets),
  87         QEDE_PF_STAT(rx_128_to_255_byte_packets),
  88         QEDE_PF_STAT(rx_256_to_511_byte_packets),
  89         QEDE_PF_STAT(rx_512_to_1023_byte_packets),
  90         QEDE_PF_STAT(rx_1024_to_1518_byte_packets),
  91         QEDE_PF_STAT(rx_1519_to_1522_byte_packets),
  92         QEDE_PF_STAT(rx_1519_to_2047_byte_packets),
  93         QEDE_PF_STAT(rx_2048_to_4095_byte_packets),
  94         QEDE_PF_STAT(rx_4096_to_9216_byte_packets),
  95         QEDE_PF_STAT(rx_9217_to_16383_byte_packets),
  96         QEDE_PF_STAT(tx_64_byte_packets),
  97         QEDE_PF_STAT(tx_65_to_127_byte_packets),
  98         QEDE_PF_STAT(tx_128_to_255_byte_packets),
  99         QEDE_PF_STAT(tx_256_to_511_byte_packets),
 100         QEDE_PF_STAT(tx_512_to_1023_byte_packets),
 101         QEDE_PF_STAT(tx_1024_to_1518_byte_packets),
 102         QEDE_PF_STAT(tx_1519_to_2047_byte_packets),
 103         QEDE_PF_STAT(tx_2048_to_4095_byte_packets),
 104         QEDE_PF_STAT(tx_4096_to_9216_byte_packets),
 105         QEDE_PF_STAT(tx_9217_to_16383_byte_packets),
 106
 107         QEDE_PF_STAT(rx_mac_crtl_frames),
 108         QEDE_PF_STAT(tx_mac_ctrl_frames),
 109         QEDE_PF_STAT(rx_pause_frames),
 110         QEDE_PF_STAT(tx_pause_frames),
 111         QEDE_PF_STAT(rx_pfc_frames),
 112         QEDE_PF_STAT(tx_pfc_frames),
 113
 114         QEDE_PF_STAT(rx_crc_errors),
 115         QEDE_PF_STAT(rx_align_errors),
 116         QEDE_PF_STAT(rx_carrier_errors),
 117         QEDE_PF_STAT(rx_oversize_packets),
 118         QEDE_PF_STAT(rx_jabbers),
 119         QEDE_PF_STAT(rx_undersize_packets),
 120         QEDE_PF_STAT(rx_fragments),
 121         QEDE_PF_STAT(tx_lpi_entry_count),
 122         QEDE_PF_STAT(tx_total_collisions),
 123         QEDE_PF_STAT(brb_truncates),
 124         QEDE_PF_STAT(brb_discards),
 125         QEDE_STAT(no_buff_discards),
 126         QEDE_PF_STAT(mftag_filter_discards),
 127         QEDE_PF_STAT(mac_filter_discards),
 128         QEDE_STAT(tx_err_drop_pkts),
 129         QEDE_STAT(ttl0_discard),
 130         QEDE_STAT(packet_too_big_discard),
 131
 132         QEDE_STAT(coalesced_pkts),
 133         QEDE_STAT(coalesced_events),
 134         QEDE_STAT(coalesced_aborts_num),
 135         QEDE_STAT(non_coalesced_pkts),
 136         QEDE_STAT(coalesced_bytes),
 137 };
 138
 139 #define QEDE_STATS_DATA(dev, index) \
 140         (*((u64 *)(((char *)(dev)) + offsetof(struct qede_dev, stats) \
 141                         + qede_stats_arr[(index)].offset)))
 142
 143 #define QEDE_NUM_STATS  ARRAY_SIZE(qede_stats_arr)
 144
 145 enum {
 146         QEDE_PRI_FLAG_CMT,
 147         QEDE_PRI_FLAG_LEN,
 148 };
 149
 150 static const char qede_private_arr[QEDE_PRI_FLAG_LEN][ETH_GSTRING_LEN] = {
 151         "Coupled-Function",
 152 };
 153
 154 enum qede_ethtool_tests {
 155         QEDE_ETHTOOL_INT_LOOPBACK,
 156         QEDE_ETHTOOL_INTERRUPT_TEST,
 157         QEDE_ETHTOOL_MEMORY_TEST,
 158         QEDE_ETHTOOL_REGISTER_TEST,
 159         QEDE_ETHTOOL_CLOCK_TEST,
 160         QEDE_ETHTOOL_TEST_MAX
 161 };
 162
 163 static const char qede_tests_str_arr[QEDE_ETHTOOL_TEST_MAX][ETH_GSTRING_LEN] = {
 164         "Internal loopback (offline)",
 165         "Interrupt (online)\t",
 166         "Memory (online)\t\t",
 167         "Register (online)\t",
 168         "Clock (online)\t\t",
 169 };
 170
 171 static void qede_get_strings_stats(struct qede_dev *edev, u8 *buf)
 172 {
 173         int i, j, k;
 174
 175         for (i = 0, k = 0; i < QEDE_QUEUE_CNT(edev); i++) {
 176                 int tc;
 177
 178                 for (j = 0; j < QEDE_NUM_RQSTATS; j++)
 179                         sprintf(buf + (k + j) * ETH_GSTRING_LEN,
 180                                 "%d:   %s", i, qede_rqstats_arr[j].string);
 181                 k += QEDE_NUM_RQSTATS;
 182                 for (tc = 0; tc < edev->num_tc; tc++) {
 183                         for (j = 0; j < QEDE_NUM_TQSTATS; j++)
 184                                 sprintf(buf + (k + j) * ETH_GSTRING_LEN,
 185                                         "%d.%d: %s", i, tc,
 186                                         qede_tqstats_arr[j].string);
 187                         k += QEDE_NUM_TQSTATS;
 188                 }
 189         }
 190
 191         for (i = 0, j = 0; i < QEDE_NUM_STATS; i++) {
 192                 if (IS_VF(edev) && qede_stats_arr[i].pf_only)
 193                         continue;
 194                 strcpy(buf + (k + j) * ETH_GSTRING_LEN,
 195                        qede_stats_arr[i].string);
 196                 j++;
 197         }
 198 }
 199
 200 static void qede_get_strings(struct net_device *dev, u32 stringset, u8 *buf)
 201 {
 202         struct qede_dev *edev = netdev_priv(dev);
 203
 204         switch (stringset) {
 205         case ETH_SS_STATS:
 206                 qede_get_strings_stats(edev, buf);
 207                 break;
 208         case ETH_SS_PRIV_FLAGS:
 209                 memcpy(buf, qede_private_arr,
 210                        ETH_GSTRING_LEN * QEDE_PRI_FLAG_LEN);
 211                 break;
 212         case ETH_SS_TEST:
 213                 memcpy(buf, qede_tests_str_arr,
 214                        ETH_GSTRING_LEN * QEDE_ETHTOOL_TEST_MAX);
 215                 break;
 216         default:
 217                 DP_VERBOSE(edev, QED_MSG_DEBUG,
 218                            "Unsupported stringset 0x%08x\n", stringset);
 219         }
 220 }
 221
 222 static void qede_get_ethtool_stats(struct net_device *dev,
 223                                    struct ethtool_stats *stats, u64 *buf)
 224 {
 225         struct qede_dev *edev = netdev_priv(dev);
 226         int sidx, cnt = 0;
 227         int qid;
 228
 229         qede_fill_by_demand_stats(edev);
 230
 231         mutex_lock(&edev->qede_lock);
 232
 233         for (qid = 0; qid < QEDE_QUEUE_CNT(edev); qid++) {
 234                 int tc;
 235
 236                 if (edev->fp_array[qid].type & QEDE_FASTPATH_RX) {
 237                         for (sidx = 0; sidx < QEDE_NUM_RQSTATS; sidx++)
 238                                 buf[cnt++] = QEDE_RQSTATS_DATA(edev, sidx, qid);
 239                 }
 240
 241                 if (edev->fp_array[qid].type & QEDE_FASTPATH_TX) {
 242                         for (tc = 0; tc < edev->num_tc; tc++) {
 243                                 for (sidx = 0; sidx < QEDE_NUM_TQSTATS; sidx++)
 244                                         buf[cnt++] = QEDE_TQSTATS_DATA(edev,
 245                                                                        sidx,
 246                                                                        qid, tc);
 247                         }
 248                 }
 249         }
 250
 251         for (sidx = 0; sidx < QEDE_NUM_STATS; sidx++) {
 252                 if (IS_VF(edev) && qede_stats_arr[sidx].pf_only)
 253                         continue;
 254                 buf[cnt++] = QEDE_STATS_DATA(edev, sidx);
 255         }
 256
 257         mutex_unlock(&edev->qede_lock);
 258 }
 259
 260 static int qede_get_sset_count(struct net_device *dev, int stringset)
 261 {
 262         struct qede_dev *edev = netdev_priv(dev);
 263         int num_stats = QEDE_NUM_STATS;
 264
 265         switch (stringset) {
 266         case ETH_SS_STATS:
 267                 if (IS_VF(edev)) {
 268                         int i;
 269
 270                         for (i = 0; i < QEDE_NUM_STATS; i++)
 271                                 if (qede_stats_arr[i].pf_only)
 272                                         num_stats--;
 273                 }
 274                 return num_stats + QEDE_RSS_COUNT(edev) * QEDE_NUM_RQSTATS +
 275                        QEDE_TSS_COUNT(edev) * QEDE_NUM_TQSTATS * edev->num_tc;
 276         case ETH_SS_PRIV_FLAGS:
 277                 return QEDE_PRI_FLAG_LEN;
 278         case ETH_SS_TEST:
 279                 if (!IS_VF(edev))
 280                         return QEDE_ETHTOOL_TEST_MAX;
 281                 else
 282                         return 0;
 283         default:
 284                 DP_VERBOSE(edev, QED_MSG_DEBUG,
 285                            "Unsupported stringset 0x%08x\n", stringset);
 286                 return -EINVAL;
 287         }
 288 }
 289
 290 static u32 qede_get_priv_flags(struct net_device *dev)
 291 {
 292         struct qede_dev *edev = netdev_priv(dev);
 293
 294         return (!!(edev->dev_info.common.num_hwfns > 1)) << QEDE_PRI_FLAG_CMT;
 295 }
 296
 297 struct qede_link_mode_mapping {
 298         u32 qed_link_mode;
 299         u32 ethtool_link_mode;
 300 };
 301
 302 static const struct qede_link_mode_mapping qed_lm_map[] = {
 303         {QED_LM_FIBRE_BIT, ETHTOOL_LINK_MODE_FIBRE_BIT},
 304         {QED_LM_Autoneg_BIT, ETHTOOL_LINK_MODE_Autoneg_BIT},
 305         {QED_LM_Asym_Pause_BIT, ETHTOOL_LINK_MODE_Asym_Pause_BIT},
 306         {QED_LM_Pause_BIT, ETHTOOL_LINK_MODE_Pause_BIT},
 307         {QED_LM_1000baseT_Half_BIT, ETHTOOL_LINK_MODE_1000baseT_Half_BIT},
 308         {QED_LM_1000baseT_Full_BIT, ETHTOOL_LINK_MODE_1000baseT_Full_BIT},
 309         {QED_LM_10000baseKR_Full_BIT, ETHTOOL_LINK_MODE_10000baseKR_Full_BIT},
 310         {QED_LM_25000baseKR_Full_BIT, ETHTOOL_LINK_MODE_25000baseKR_Full_BIT},
 311         {QED_LM_40000baseLR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT},
 312         {QED_LM_50000baseKR2_Full_BIT, ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT},
 313         {QED_LM_100000baseKR4_Full_BIT,
 314          ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT},
 315 };
 316
 317 #define QEDE_DRV_TO_ETHTOOL_CAPS(caps, lk_ksettings, name)      \
 318 {                                                               \
 319         int i;                                                  \
 320                                                                 \
 321         for (i = 0; i < QED_LM_COUNT; i++) {                    \
 322                 if ((caps) & (qed_lm_map[i].qed_link_mode))     \
 323                         __set_bit(qed_lm_map[i].ethtool_link_mode,\
 324                                   lk_ksettings->link_modes.name); \
 325         }                                                       \
 326 }
 327
 328 #define QEDE_ETHTOOL_TO_DRV_CAPS(caps, lk_ksettings, name)      \
 329 {                                                               \
 330         int i;                                                  \
 331                                                                 \
 332         for (i = 0; i < QED_LM_COUNT; i++) {                    \
 333                 if (test_bit(qed_lm_map[i].ethtool_link_mode,   \
 334                              lk_ksettings->link_modes.name))    \
 335                         caps |= qed_lm_map[i].qed_link_mode;    \
 336         }                                                       \
 337 }
 338
 339 static int qede_get_link_ksettings(struct net_device *dev,
 340                                    struct ethtool_link_ksettings *cmd)
 341 {
 342         struct ethtool_link_settings *base = &cmd->base;
 343         struct qede_dev *edev = netdev_priv(dev);
 344         struct qed_link_output current_link;
 345
 346         memset(&current_link, 0, sizeof(current_link));
 347         edev->ops->common->get_link(edev->cdev, &current_link);
 348
 349         ethtool_link_ksettings_zero_link_mode(cmd, supported);
 350         QEDE_DRV_TO_ETHTOOL_CAPS(current_link.supported_caps, cmd, supported)
 351
 352         ethtool_link_ksettings_zero_link_mode(cmd, advertising);
 353         QEDE_DRV_TO_ETHTOOL_CAPS(current_link.advertised_caps, cmd, advertising)
 354
 355         ethtool_link_ksettings_zero_link_mode(cmd, lp_advertising);
 356         QEDE_DRV_TO_ETHTOOL_CAPS(current_link.lp_caps, cmd, lp_advertising)
 357
 358         if ((edev->state == QEDE_STATE_OPEN) && (current_link.link_up)) {
 359                 base->speed = current_link.speed;
 360                 base->duplex = current_link.duplex;
 361         } else {
 362                 base->speed = SPEED_UNKNOWN;
 363                 base->duplex = DUPLEX_UNKNOWN;
 364         }
 365         base->port = current_link.port;
 366         base->autoneg = (current_link.autoneg) ? AUTONEG_ENABLE :
 367                         AUTONEG_DISABLE;
 368
 369         return 0;
 370 }
 371
 372 static int qede_set_link_ksettings(struct net_device *dev,
 373                                    const struct ethtool_link_ksettings *cmd)
 374 {
 375         const struct ethtool_link_settings *base = &cmd->base;
 376         struct qede_dev *edev = netdev_priv(dev);
 377         struct qed_link_output current_link;
 378         struct qed_link_params params;
 379
 380         if (!edev->ops || !edev->ops->common->can_link_change(edev->cdev)) {
 381                 DP_INFO(edev, "Link settings are not allowed to be changed\n");
 382                 return -EOPNOTSUPP;
 383         }
 384         memset(&current_link, 0, sizeof(current_link));
 385         memset(&params, 0, sizeof(params));
 386         edev->ops->common->get_link(edev->cdev, &current_link);
 387
 388         params.override_flags |= QED_LINK_OVERRIDE_SPEED_ADV_SPEEDS;
 389         params.override_flags |= QED_LINK_OVERRIDE_SPEED_AUTONEG;
 390         if (base->autoneg == AUTONEG_ENABLE) {
 391                 params.autoneg = true;
 392                 params.forced_speed = 0;
 393                 QEDE_ETHTOOL_TO_DRV_CAPS(params.adv_speeds, cmd, advertising)
 394         } else {                /* forced speed */
 395                 params.override_flags |= QED_LINK_OVERRIDE_SPEED_FORCED_SPEED;
 396                 params.autoneg = false;
 397                 params.forced_speed = base->speed;
 398                 switch (base->speed) {
 399                 case SPEED_10000:
 400                         if (!(current_link.supported_caps &
 401                               QED_LM_10000baseKR_Full_BIT)) {
 402                                 DP_INFO(edev, "10G speed not supported\n");
 403                                 return -EINVAL;
 404                         }
 405                         params.adv_speeds = QED_LM_10000baseKR_Full_BIT;
 406                         break;
 407                 case SPEED_25000:
 408                         if (!(current_link.supported_caps &
 409                               QED_LM_25000baseKR_Full_BIT)) {
 410                                 DP_INFO(edev, "25G speed not supported\n");
 411                                 return -EINVAL;
 412                         }
 413                         params.adv_speeds = QED_LM_25000baseKR_Full_BIT;
 414                         break;
 415                 case SPEED_40000:
 416                         if (!(current_link.supported_caps &
 417                               QED_LM_40000baseLR4_Full_BIT)) {
 418                                 DP_INFO(edev, "40G speed not supported\n");
 419                                 return -EINVAL;
 420                         }
 421                         params.adv_speeds = QED_LM_40000baseLR4_Full_BIT;
 422                         break;
 423                 case SPEED_50000:
 424                         if (!(current_link.supported_caps &
 425                               QED_LM_50000baseKR2_Full_BIT)) {
 426                                 DP_INFO(edev, "50G speed not supported\n");
 427                                 return -EINVAL;
 428                         }
 429                         params.adv_speeds = QED_LM_50000baseKR2_Full_BIT;
 430                         break;
 431                 case SPEED_100000:
 432                         if (!(current_link.supported_caps &
 433                               QED_LM_100000baseKR4_Full_BIT)) {
 434                                 DP_INFO(edev, "100G speed not supported\n");
 435                                 return -EINVAL;
 436                         }
 437                         params.adv_speeds = QED_LM_100000baseKR4_Full_BIT;
 438                         break;
 439                 default:
 440                         DP_INFO(edev, "Unsupported speed %u\n", base->speed);
 441                         return -EINVAL;
 442                 }
 443         }
 444
 445         params.link_up = true;
 446         edev->ops->common->set_link(edev->cdev, &params);
 447
 448         return 0;
 449 }
 450
 451 static void qede_get_drvinfo(struct net_device *ndev,
 452                              struct ethtool_drvinfo *info)
 453 {
 454         char mfw[ETHTOOL_FWVERS_LEN], storm[ETHTOOL_FWVERS_LEN];
 455         struct qede_dev *edev = netdev_priv(ndev);
 456
 457         strlcpy(info->driver, "qede", sizeof(info->driver));
 458         strlcpy(info->version, DRV_MODULE_VERSION, sizeof(info->version));
 459
 460         snprintf(storm, ETHTOOL_FWVERS_LEN, "%d.%d.%d.%d",
 461                  edev->dev_info.common.fw_major,
 462                  edev->dev_info.common.fw_minor,
 463                  edev->dev_info.common.fw_rev,
 464                  edev->dev_info.common.fw_eng);
 465
 466         snprintf(mfw, ETHTOOL_FWVERS_LEN, "%d.%d.%d.%d",
 467                  (edev->dev_info.common.mfw_rev >> 24) & 0xFF,
 468                  (edev->dev_info.common.mfw_rev >> 16) & 0xFF,
 469                  (edev->dev_info.common.mfw_rev >> 8) & 0xFF,
 470                  edev->dev_info.common.mfw_rev & 0xFF);
 471
 472         if ((strlen(storm) + strlen(mfw) + strlen("mfw storm  ")) <
 473             sizeof(info->fw_version)) {
 474                 snprintf(info->fw_version, sizeof(info->fw_version),
 475                          "mfw %s storm %s", mfw, storm);
 476         } else {
 477                 snprintf(info->fw_version, sizeof(info->fw_version),
 478                          "%s %s", mfw, storm);
 479         }
 480
 481         strlcpy(info->bus_info, pci_name(edev->pdev), sizeof(info->bus_info));
 482 }
 483
 484 static u32 qede_get_msglevel(struct net_device *ndev)
 485 {
 486         struct qede_dev *edev = netdev_priv(ndev);
 487
 488         return ((u32)edev->dp_level << QED_LOG_LEVEL_SHIFT) | edev->dp_module;
 489 }
 490
 491 static void qede_set_msglevel(struct net_device *ndev, u32 level)
 492 {
 493         struct qede_dev *edev = netdev_priv(ndev);
 494         u32 dp_module = 0;
 495         u8 dp_level = 0;
 496
 497         qede_config_debug(level, &dp_module, &dp_level);
 498
 499         edev->dp_level = dp_level;
 500         edev->dp_module = dp_module;
 501         edev->ops->common->update_msglvl(edev->cdev,
 502                                          dp_module, dp_level);
 503 }
 504
 505 static int qede_nway_reset(struct net_device *dev)
 506 {
 507         struct qede_dev *edev = netdev_priv(dev);
 508         struct qed_link_output current_link;
 509         struct qed_link_params link_params;
 510
 511         if (!edev->ops || !edev->ops->common->can_link_change(edev->cdev)) {
 512                 DP_INFO(edev, "Link settings are not allowed to be changed\n");
 513                 return -EOPNOTSUPP;
 514         }
 515
 516         if (!netif_running(dev))
 517                 return 0;
 518
 519         memset(&current_link, 0, sizeof(current_link));
 520         edev->ops->common->get_link(edev->cdev, &current_link);
 521         if (!current_link.link_up)
 522                 return 0;
 523
 524         /* Toggle the link */
 525         memset(&link_params, 0, sizeof(link_params));
 526         link_params.link_up = false;
 527         edev->ops->common->set_link(edev->cdev, &link_params);
 528         link_params.link_up = true;
 529         edev->ops->common->set_link(edev->cdev, &link_params);
 530
 531         return 0;
 532 }
 533
 534 static u32 qede_get_link(struct net_device *dev)
 535 {
 536         struct qede_dev *edev = netdev_priv(dev);
 537         struct qed_link_output current_link;
 538
 539         memset(&current_link, 0, sizeof(current_link));
 540         edev->ops->common->get_link(edev->cdev, &current_link);
 541
 542         return current_link.link_up;
 543 }
 544
 545 static int qede_get_coalesce(struct net_device *dev,
 546                              struct ethtool_coalesce *coal)
 547 {
 548         struct qede_dev *edev = netdev_priv(dev);
 549         u16 rxc, txc;
 550
 551         memset(coal, 0, sizeof(struct ethtool_coalesce));
 552         edev->ops->common->get_coalesce(edev->cdev, &rxc, &txc);
 553
 554         coal->rx_coalesce_usecs = rxc;
 555         coal->tx_coalesce_usecs = txc;
 556
 557         return 0;
 558 }
 559
 560 static int qede_set_coalesce(struct net_device *dev,
 561                              struct ethtool_coalesce *coal)
 562 {
 563         struct qede_dev *edev = netdev_priv(dev);
 564         int i, rc = 0;
 565         u16 rxc, txc;
 566         u8 sb_id;
 567
 568         if (!netif_running(dev)) {
 569                 DP_INFO(edev, "Interface is down\n");
 570                 return -EINVAL;
 571         }
 572
 573         if (coal->rx_coalesce_usecs > QED_COALESCE_MAX ||
 574             coal->tx_coalesce_usecs > QED_COALESCE_MAX) {
 575                 DP_INFO(edev,
 576                         "Can't support requested %s coalesce value [max supported value %d]\n",
 577                         coal->rx_coalesce_usecs > QED_COALESCE_MAX ? "rx"
 578                                                                    : "tx",
 579                         QED_COALESCE_MAX);
 580                 return -EINVAL;
 581         }
 582
 583         rxc = (u16)coal->rx_coalesce_usecs;
 584         txc = (u16)coal->tx_coalesce_usecs;
 585         for_each_queue(i) {
 586                 sb_id = edev->fp_array[i].sb_info->igu_sb_id;
 587                 rc = edev->ops->common->set_coalesce(edev->cdev, rxc, txc,
 588                                                      (u8)i, sb_id);
 589                 if (rc) {
 590                         DP_INFO(edev, "Set coalesce error, rc = %d\n", rc);
 591                         return rc;
 592                 }
 593         }
 594
 595         return rc;
 596 }
 597
 598 static void qede_get_ringparam(struct net_device *dev,
 599                                struct ethtool_ringparam *ering)
 600 {
 601         struct qede_dev *edev = netdev_priv(dev);
 602
 603         ering->rx_max_pending = NUM_RX_BDS_MAX;
 604         ering->rx_pending = edev->q_num_rx_buffers;
 605         ering->tx_max_pending = NUM_TX_BDS_MAX;
 606         ering->tx_pending = edev->q_num_tx_buffers;
 607 }
 608
 609 static int qede_set_ringparam(struct net_device *dev,
 610                               struct ethtool_ringparam *ering)
 611 {
 612         struct qede_dev *edev = netdev_priv(dev);
 613
 614         DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 615                    "Set ring params command parameters: rx_pending = %d, tx_pending = %d\n",
 616                    ering->rx_pending, ering->tx_pending);
 617
 618         /* Validate legality of configuration */
 619         if (ering->rx_pending > NUM_RX_BDS_MAX ||
 620             ering->rx_pending < NUM_RX_BDS_MIN ||
 621             ering->tx_pending > NUM_TX_BDS_MAX ||
 622             ering->tx_pending < NUM_TX_BDS_MIN) {
 623                 DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 624                            "Can only support Rx Buffer size [0%08x,...,0x%08x] and Tx Buffer size [0x%08x,...,0x%08x]\n",
 625                            NUM_RX_BDS_MIN, NUM_RX_BDS_MAX,
 626                            NUM_TX_BDS_MIN, NUM_TX_BDS_MAX);
 627                 return -EINVAL;
 628         }
 629
 630         /* Change ring size and re-load */
 631         edev->q_num_rx_buffers = ering->rx_pending;
 632         edev->q_num_tx_buffers = ering->tx_pending;
 633
 634         if (netif_running(edev->ndev))
 635                 qede_reload(edev, NULL, NULL);
 636
 637         return 0;
 638 }
 639
 640 static void qede_get_pauseparam(struct net_device *dev,
 641                                 struct ethtool_pauseparam *epause)
 642 {
 643         struct qede_dev *edev = netdev_priv(dev);
 644         struct qed_link_output current_link;
 645
 646         memset(&current_link, 0, sizeof(current_link));
 647         edev->ops->common->get_link(edev->cdev, &current_link);
 648
 649         if (current_link.pause_config & QED_LINK_PAUSE_AUTONEG_ENABLE)
 650                 epause->autoneg = true;
 651         if (current_link.pause_config & QED_LINK_PAUSE_RX_ENABLE)
 652                 epause->rx_pause = true;
 653         if (current_link.pause_config & QED_LINK_PAUSE_TX_ENABLE)
 654                 epause->tx_pause = true;
 655
 656         DP_VERBOSE(edev, QED_MSG_DEBUG,
 657                    "ethtool_pauseparam: cmd %d  autoneg %d  rx_pause %d  tx_pause %d\n",
 658                    epause->cmd, epause->autoneg, epause->rx_pause,
 659                    epause->tx_pause);
 660 }
 661
 662 static int qede_set_pauseparam(struct net_device *dev,
 663                                struct ethtool_pauseparam *epause)
 664 {
 665         struct qede_dev *edev = netdev_priv(dev);
 666         struct qed_link_params params;
 667         struct qed_link_output current_link;
 668
 669         if (!edev->ops || !edev->ops->common->can_link_change(edev->cdev)) {
 670                 DP_INFO(edev,
 671                         "Pause settings are not allowed to be changed\n");
 672                 return -EOPNOTSUPP;
 673         }
 674
 675         memset(&current_link, 0, sizeof(current_link));
 676         edev->ops->common->get_link(edev->cdev, &current_link);
 677
 678         memset(&params, 0, sizeof(params));
 679         params.override_flags |= QED_LINK_OVERRIDE_PAUSE_CONFIG;
 680         if (epause->autoneg) {
 681                 if (!(current_link.supported_caps & QED_LM_Autoneg_BIT)) {
 682                         DP_INFO(edev, "autoneg not supported\n");
 683                         return -EINVAL;
 684                 }
 685                 params.pause_config |= QED_LINK_PAUSE_AUTONEG_ENABLE;
 686         }
 687         if (epause->rx_pause)
 688                 params.pause_config |= QED_LINK_PAUSE_RX_ENABLE;
 689         if (epause->tx_pause)
 690                 params.pause_config |= QED_LINK_PAUSE_TX_ENABLE;
 691
 692         params.link_up = true;
 693         edev->ops->common->set_link(edev->cdev, &params);
 694
 695         return 0;
 696 }
 697
 698 static void qede_get_regs(struct net_device *ndev,
 699                           struct ethtool_regs *regs, void *buffer)
 700 {
 701         struct qede_dev *edev = netdev_priv(ndev);
 702
 703         regs->version = 0;
 704         memset(buffer, 0, regs->len);
 705
 706         if (edev->ops && edev->ops->common)
 707                 edev->ops->common->dbg_all_data(edev->cdev, buffer);
 708 }
 709
 710 static int qede_get_regs_len(struct net_device *ndev)
 711 {
 712         struct qede_dev *edev = netdev_priv(ndev);
 713
 714         if (edev->ops && edev->ops->common)
 715                 return edev->ops->common->dbg_all_data_size(edev->cdev);
 716         else
 717                 return -EINVAL;
 718 }
 719
 720 static void qede_update_mtu(struct qede_dev *edev, union qede_reload_args *args)
 721 {
 722         edev->ndev->mtu = args->mtu;
 723 }
 724
 725 /* Netdevice NDOs */
 726 #define ETH_MAX_JUMBO_PACKET_SIZE       9600
 727 #define ETH_MIN_PACKET_SIZE             60
 728 int qede_change_mtu(struct net_device *ndev, int new_mtu)
 729 {
 730         struct qede_dev *edev = netdev_priv(ndev);
 731         union qede_reload_args args;
 732
 733         if ((new_mtu > ETH_MAX_JUMBO_PACKET_SIZE) ||
 734             ((new_mtu + ETH_HLEN) < ETH_MIN_PACKET_SIZE)) {
 735                 DP_ERR(edev, "Can't support requested MTU size\n");
 736                 return -EINVAL;
 737         }
 738
 739         DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 740                    "Configuring MTU size of %d\n", new_mtu);
 741
 742         /* Set the mtu field and re-start the interface if needed*/
 743         args.mtu = new_mtu;
 744
 745         if (netif_running(edev->ndev))
 746                 qede_reload(edev, &qede_update_mtu, &args);
 747
 748         qede_update_mtu(edev, &args);
 749
 750         return 0;
 751 }
 752
 753 static void qede_get_channels(struct net_device *dev,
 754                               struct ethtool_channels *channels)
 755 {
 756         struct qede_dev *edev = netdev_priv(dev);
 757
 758         channels->max_combined = QEDE_MAX_RSS_CNT(edev);
 759         channels->max_rx = QEDE_MAX_RSS_CNT(edev);
 760         channels->max_tx = QEDE_MAX_RSS_CNT(edev);
 761         channels->combined_count = QEDE_QUEUE_CNT(edev) - edev->fp_num_tx -
 762                                         edev->fp_num_rx;
 763         channels->tx_count = edev->fp_num_tx;
 764         channels->rx_count = edev->fp_num_rx;
 765 }
 766
 767 static int qede_set_channels(struct net_device *dev,
 768                              struct ethtool_channels *channels)
 769 {
 770         struct qede_dev *edev = netdev_priv(dev);
 771         u32 count;
 772
 773         DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 774                    "set-channels command parameters: rx = %d, tx = %d, other = %d, combined = %d\n",
 775                    channels->rx_count, channels->tx_count,
 776                    channels->other_count, channels->combined_count);
 777
 778         count = channels->rx_count + channels->tx_count +
 779                         channels->combined_count;
 780
 781         /* We don't support `other' channels */
 782         if (channels->other_count) {
 783                 DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 784                            "command parameters not supported\n");
 785                 return -EINVAL;
 786         }
 787
 788         if (!(channels->combined_count || (channels->rx_count &&
 789                                            channels->tx_count))) {
 790                 DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 791                            "need to request at least one transmit and one receive channel\n");
 792                 return -EINVAL;
 793         }
 794
 795         if (count > QEDE_MAX_RSS_CNT(edev)) {
 796                 DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 797                            "requested channels = %d max supported channels = %d\n",
 798                            count, QEDE_MAX_RSS_CNT(edev));
 799                 return -EINVAL;
 800         }
 801
 802         /* Check if there was a change in the active parameters */
 803         if ((count == QEDE_QUEUE_CNT(edev)) &&
 804             (channels->tx_count == edev->fp_num_tx) &&
 805             (channels->rx_count == edev->fp_num_rx)) {
 806                 DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 807                            "No change in active parameters\n");
 808                 return 0;
 809         }
 810
 811         /* We need the number of queues to be divisible between the hwfns */
 812         if ((count % edev->dev_info.common.num_hwfns) ||
 813             (channels->tx_count % edev->dev_info.common.num_hwfns) ||
 814             (channels->rx_count % edev->dev_info.common.num_hwfns)) {
 815                 DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 816                            "Number of channels must be divisible by %04x\n",
 817                            edev->dev_info.common.num_hwfns);
 818                 return -EINVAL;
 819         }
 820
 821         /* Set number of queues and reload if necessary */
 822         edev->req_queues = count;
 823         edev->req_num_tx = channels->tx_count;
 824         edev->req_num_rx = channels->rx_count;
 825         if (netif_running(dev))
 826                 qede_reload(edev, NULL, NULL);
 827
 828         return 0;
 829 }
 830
 831 static int qede_set_phys_id(struct net_device *dev,
 832                             enum ethtool_phys_id_state state)
 833 {
 834         struct qede_dev *edev = netdev_priv(dev);
 835         u8 led_state = 0;
 836
 837         switch (state) {
 838         case ETHTOOL_ID_ACTIVE:
 839                 return 1;       /* cycle on/off once per second */
 840
 841         case ETHTOOL_ID_ON:
 842                 led_state = QED_LED_MODE_ON;
 843                 break;
 844
 845         case ETHTOOL_ID_OFF:
 846                 led_state = QED_LED_MODE_OFF;
 847                 break;
 848
 849         case ETHTOOL_ID_INACTIVE:
 850                 led_state = QED_LED_MODE_RESTORE;
 851                 break;
 852         }
 853
 854         edev->ops->common->set_led(edev->cdev, led_state);
 855
 856         return 0;
 857 }
 858
 859 static int qede_get_rss_flags(struct qede_dev *edev, struct ethtool_rxnfc *info)
 860 {
 861         info->data = RXH_IP_SRC | RXH_IP_DST;
 862
 863         switch (info->flow_type) {
 864         case TCP_V4_FLOW:
 865         case TCP_V6_FLOW:
 866                 info->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 867                 break;
 868         case UDP_V4_FLOW:
 869                 if (edev->rss_params.rss_caps & QED_RSS_IPV4_UDP)
 870                         info->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 871                 break;
 872         case UDP_V6_FLOW:
 873                 if (edev->rss_params.rss_caps & QED_RSS_IPV6_UDP)
 874                         info->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 875                 break;
 876         case IPV4_FLOW:
 877         case IPV6_FLOW:
 878                 break;
 879         default:
 880                 info->data = 0;
 881                 break;
 882         }
 883
 884         return 0;
 885 }
 886
 887 static int qede_get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *info,
 888                           u32 *rules __always_unused)
 889 {
 890         struct qede_dev *edev = netdev_priv(dev);
 891
 892         switch (info->cmd) {
 893         case ETHTOOL_GRXRINGS:
 894                 info->data = QEDE_RSS_COUNT(edev);
 895                 return 0;
 896         case ETHTOOL_GRXFH:
 897                 return qede_get_rss_flags(edev, info);
 898         default:
 899                 DP_ERR(edev, "Command parameters not supported\n");
 900                 return -EOPNOTSUPP;
 901         }
 902 }
 903
 904 static int qede_set_rss_flags(struct qede_dev *edev, struct ethtool_rxnfc *info)
 905 {
 906         struct qed_update_vport_params vport_update_params;
 907         u8 set_caps = 0, clr_caps = 0;
 908
 909         DP_VERBOSE(edev, QED_MSG_DEBUG,
 910                    "Set rss flags command parameters: flow type = %d, data = %llu\n",
 911                    info->flow_type, info->data);
 912
 913         switch (info->flow_type) {
 914         case TCP_V4_FLOW:
 915         case TCP_V6_FLOW:
 916                 /* For TCP only 4-tuple hash is supported */
 917                 if (info->data ^ (RXH_IP_SRC | RXH_IP_DST |
 918                                   RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
 919                         DP_INFO(edev, "Command parameters not supported\n");
 920                         return -EINVAL;
 921                 }
 922                 return 0;
 923         case UDP_V4_FLOW:
 924                 /* For UDP either 2-tuple hash or 4-tuple hash is supported */
 925                 if (info->data == (RXH_IP_SRC | RXH_IP_DST |
 926                                    RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
 927                         set_caps = QED_RSS_IPV4_UDP;
 928                         DP_VERBOSE(edev, QED_MSG_DEBUG,
 929                                    "UDP 4-tuple enabled\n");
 930                 } else if (info->data == (RXH_IP_SRC | RXH_IP_DST)) {
 931                         clr_caps = QED_RSS_IPV4_UDP;
 932                         DP_VERBOSE(edev, QED_MSG_DEBUG,
 933                                    "UDP 4-tuple disabled\n");
 934                 } else {
 935                         return -EINVAL;
 936                 }
 937                 break;
 938         case UDP_V6_FLOW:
 939                 /* For UDP either 2-tuple hash or 4-tuple hash is supported */
 940                 if (info->data == (RXH_IP_SRC | RXH_IP_DST |
 941                                    RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
 942                         set_caps = QED_RSS_IPV6_UDP;
 943                         DP_VERBOSE(edev, QED_MSG_DEBUG,
 944                                    "UDP 4-tuple enabled\n");
 945                 } else if (info->data == (RXH_IP_SRC | RXH_IP_DST)) {
 946                         clr_caps = QED_RSS_IPV6_UDP;
 947                         DP_VERBOSE(edev, QED_MSG_DEBUG,
 948                                    "UDP 4-tuple disabled\n");
 949                 } else {
 950                         return -EINVAL;
 951                 }
 952                 break;
 953         case IPV4_FLOW:
 954         case IPV6_FLOW:
 955                 /* For IP only 2-tuple hash is supported */
 956                 if (info->data ^ (RXH_IP_SRC | RXH_IP_DST)) {
 957                         DP_INFO(edev, "Command parameters not supported\n");
 958                         return -EINVAL;
 959                 }
 960                 return 0;
 961         case SCTP_V4_FLOW:
 962         case AH_ESP_V4_FLOW:
 963         case AH_V4_FLOW:
 964         case ESP_V4_FLOW:
 965         case SCTP_V6_FLOW:
 966         case AH_ESP_V6_FLOW:
 967         case AH_V6_FLOW:
 968         case ESP_V6_FLOW:
 969         case IP_USER_FLOW:
 970         case ETHER_FLOW:
 971                 /* RSS is not supported for these protocols */
 972                 if (info->data) {
 973                         DP_INFO(edev, "Command parameters not supported\n");
 974                         return -EINVAL;
 975                 }
 976                 return 0;
 977         default:
 978                 return -EINVAL;
 979         }
 980
 981         /* No action is needed if there is no change in the rss capability */
 982         if (edev->rss_params.rss_caps == ((edev->rss_params.rss_caps &
 983                                            ~clr_caps) | set_caps))
 984                 return 0;
 985
 986         /* Update internal configuration */
 987         edev->rss_params.rss_caps = (edev->rss_params.rss_caps & ~clr_caps) |
 988                                     set_caps;
 989         edev->rss_params_inited |= QEDE_RSS_CAPS_INITED;
 990
 991         /* Re-configure if possible */
 992         if (netif_running(edev->ndev)) {
 993                 memset(&vport_update_params, 0, sizeof(vport_update_params));
 994                 vport_update_params.update_rss_flg = 1;
 995                 vport_update_params.vport_id = 0;
 996                 memcpy(&vport_update_params.rss_params, &edev->rss_params,
 997                        sizeof(vport_update_params.rss_params));
 998                 return edev->ops->vport_update(edev->cdev,
 999                                                &vport_update_params);
1000         }
1001
1002         return 0;
1003 }
1004
1005 static int qede_set_rxnfc(struct net_device *dev, struct ethtool_rxnfc *info)
1006 {
1007         struct qede_dev *edev = netdev_priv(dev);
1008
1009         switch (info->cmd) {
1010         case ETHTOOL_SRXFH:
1011                 return qede_set_rss_flags(edev, info);
1012         default:
1013                 DP_INFO(edev, "Command parameters not supported\n");
1014                 return -EOPNOTSUPP;
1015         }
1016 }
1017
1018 static u32 qede_get_rxfh_indir_size(struct net_device *dev)
1019 {
1020         return QED_RSS_IND_TABLE_SIZE;
1021 }
1022
1023 static u32 qede_get_rxfh_key_size(struct net_device *dev)
1024 {
1025         struct qede_dev *edev = netdev_priv(dev);
1026
1027         return sizeof(edev->rss_params.rss_key);
1028 }
1029
1030 static int qede_get_rxfh(struct net_device *dev, u32 *indir, u8 *key, u8 *hfunc)
1031 {
1032         struct qede_dev *edev = netdev_priv(dev);
1033         int i;
1034
1035         if (hfunc)
1036                 *hfunc = ETH_RSS_HASH_TOP;
1037
1038         if (!indir)
1039                 return 0;
1040
1041         for (i = 0; i < QED_RSS_IND_TABLE_SIZE; i++)
1042                 indir[i] = edev->rss_params.rss_ind_table[i];
1043
1044         if (key)
1045                 memcpy(key, edev->rss_params.rss_key,
1046                        qede_get_rxfh_key_size(dev));
1047
1048         return 0;
1049 }
1050
1051 static int qede_set_rxfh(struct net_device *dev, const u32 *indir,
1052                          const u8 *key, const u8 hfunc)
1053 {
1054         struct qed_update_vport_params vport_update_params;
1055         struct qede_dev *edev = netdev_priv(dev);
1056         int i;
1057
1058         if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP)
1059                 return -EOPNOTSUPP;
1060
1061         if (!indir && !key)
1062                 return 0;
1063
1064         if (indir) {
1065                 for (i = 0; i < QED_RSS_IND_TABLE_SIZE; i++)
1066                         edev->rss_params.rss_ind_table[i] = indir[i];
1067                 edev->rss_params_inited |= QEDE_RSS_INDIR_INITED;
1068         }
1069
1070         if (key) {
1071                 memcpy(&edev->rss_params.rss_key, key,
1072                        qede_get_rxfh_key_size(dev));
1073                 edev->rss_params_inited |= QEDE_RSS_KEY_INITED;
1074         }
1075
1076         if (netif_running(edev->ndev)) {
1077                 memset(&vport_update_params, 0, sizeof(vport_update_params));
1078                 vport_update_params.update_rss_flg = 1;
1079                 vport_update_params.vport_id = 0;
1080                 memcpy(&vport_update_params.rss_params, &edev->rss_params,
1081                        sizeof(vport_update_params.rss_params));
1082                 return edev->ops->vport_update(edev->cdev,
1083                                                &vport_update_params);
1084         }
1085
1086         return 0;
1087 }
1088
1089 /* This function enables the interrupt generation and the NAPI on the device */
1090 static void qede_netif_start(struct qede_dev *edev)
1091 {
1092         int i;
1093
1094         if (!netif_running(edev->ndev))
1095                 return;
1096
1097         for_each_queue(i) {
1098                 /* Update and reenable interrupts */
1099                 qed_sb_ack(edev->fp_array[i].sb_info, IGU_INT_ENABLE, 1);
1100                 napi_enable(&edev->fp_array[i].napi);
1101         }
1102 }
1103
1104 /* This function disables the NAPI and the interrupt generation on the device */
1105 static void qede_netif_stop(struct qede_dev *edev)
1106 {
1107         int i;
1108
1109         for_each_queue(i) {
1110                 napi_disable(&edev->fp_array[i].napi);
1111                 /* Disable interrupts */
1112                 qed_sb_ack(edev->fp_array[i].sb_info, IGU_INT_DISABLE, 0);
1113         }
1114 }
1115
1116 static int qede_selftest_transmit_traffic(struct qede_dev *edev,
1117                                           struct sk_buff *skb)
1118 {
1119         struct qede_tx_queue *txq = NULL;
1120         struct eth_tx_1st_bd *first_bd;
1121         dma_addr_t mapping;
1122         int i, idx, val;
1123
1124         for_each_queue(i) {
1125                 if (edev->fp_array[i].type & QEDE_FASTPATH_TX) {
1126                         txq = edev->fp_array[i].txqs;
1127                         break;
1128                 }
1129         }
1130
1131         if (!txq) {
1132                 DP_NOTICE(edev, "Tx path is not available\n");
1133                 return -1;
1134         }
1135
1136         /* Fill the entry in the SW ring and the BDs in the FW ring */
1137         idx = txq->sw_tx_prod & NUM_TX_BDS_MAX;
1138         txq->sw_tx_ring[idx].skb = skb;
1139         first_bd = qed_chain_produce(&txq->tx_pbl);
1140         memset(first_bd, 0, sizeof(*first_bd));
1141         val = 1 << ETH_TX_1ST_BD_FLAGS_START_BD_SHIFT;
1142         first_bd->data.bd_flags.bitfields = val;
1143         val = skb->len & ETH_TX_DATA_1ST_BD_PKT_LEN_MASK;
1144         first_bd->data.bitfields |= (val << ETH_TX_DATA_1ST_BD_PKT_LEN_SHIFT);
1145
1146         /* Map skb linear data for DMA and set in the first BD */
1147         mapping = dma_map_single(&edev->pdev->dev, skb->data,
1148                                  skb_headlen(skb), DMA_TO_DEVICE);
1149         if (unlikely(dma_mapping_error(&edev->pdev->dev, mapping))) {
1150                 DP_NOTICE(edev, "SKB mapping failed\n");
1151                 return -ENOMEM;
1152         }
1153         BD_SET_UNMAP_ADDR_LEN(first_bd, mapping, skb_headlen(skb));
1154
1155         /* update the first BD with the actual num BDs */
1156         first_bd->data.nbds = 1;
1157         txq->sw_tx_prod++;
1158         /* 'next page' entries are counted in the producer value */
1159         val = cpu_to_le16(qed_chain_get_prod_idx(&txq->tx_pbl));
1160         txq->tx_db.data.bd_prod = val;
1161
1162         /* wmb makes sure that the BDs data is updated before updating the
1163          * producer, otherwise FW may read old data from the BDs.
1164          */
1165         wmb();
1166         barrier();
1167         writel(txq->tx_db.raw, txq->doorbell_addr);
1168
1169         /* mmiowb is needed to synchronize doorbell writes from more than one
1170          * processor. It guarantees that the write arrives to the device before
1171          * the queue lock is released and another start_xmit is called (possibly
1172          * on another CPU). Without this barrier, the next doorbell can bypass
1173          * this doorbell. This is applicable to IA64/Altix systems.
1174          */
1175         mmiowb();
1176
1177         for (i = 0; i < QEDE_SELFTEST_POLL_COUNT; i++) {
1178                 if (qede_txq_has_work(txq))
1179                         break;
1180                 usleep_range(100, 200);
1181         }
1182
1183         if (!qede_txq_has_work(txq)) {
1184                 DP_NOTICE(edev, "Tx completion didn't happen\n");
1185                 return -1;
1186         }
1187
1188         first_bd = (struct eth_tx_1st_bd *)qed_chain_consume(&txq->tx_pbl);
1189         dma_unmap_page(&edev->pdev->dev, BD_UNMAP_ADDR(first_bd),
1190                        BD_UNMAP_LEN(first_bd), DMA_TO_DEVICE);
1191         txq->sw_tx_cons++;
1192         txq->sw_tx_ring[idx].skb = NULL;
1193
1194         return 0;
1195 }
1196
1197 static int qede_selftest_receive_traffic(struct qede_dev *edev)
1198 {
1199         u16 hw_comp_cons, sw_comp_cons, sw_rx_index, len;
1200         struct eth_fast_path_rx_reg_cqe *fp_cqe;
1201         struct qede_rx_queue *rxq = NULL;
1202         struct sw_rx_data *sw_rx_data;
1203         union eth_rx_cqe *cqe;
1204         u8 *data_ptr;
1205         int i;
1206
1207         for_each_queue(i) {
1208                 if (edev->fp_array[i].type & QEDE_FASTPATH_RX) {
1209                         rxq = edev->fp_array[i].rxq;
1210                         break;
1211                 }
1212         }
1213
1214         if (!rxq) {
1215                 DP_NOTICE(edev, "Rx path is not available\n");
1216                 return -1;
1217         }
1218
1219         /* The packet is expected to receive on rx-queue 0 even though RSS is
1220          * enabled. This is because the queue 0 is configured as the default
1221          * queue and that the loopback traffic is not IP.
1222          */
1223         for (i = 0; i < QEDE_SELFTEST_POLL_COUNT; i++) {
1224                 if (qede_has_rx_work(rxq))
1225                         break;
1226                 usleep_range(100, 200);
1227         }
1228
1229         if (!qede_has_rx_work(rxq)) {
1230                 DP_NOTICE(edev, "Failed to receive the traffic\n");
1231                 return -1;
1232         }
1233
1234         hw_comp_cons = le16_to_cpu(*rxq->hw_cons_ptr);
1235         sw_comp_cons = qed_chain_get_cons_idx(&rxq->rx_comp_ring);
1236
1237         /* Memory barrier to prevent the CPU from doing speculative reads of CQE
1238          * / BD before reading hw_comp_cons. If the CQE is read before it is
1239          * written by FW, then FW writes CQE and SB, and then the CPU reads the
1240          * hw_comp_cons, it will use an old CQE.
1241          */
1242         rmb();
1243
1244         /* Get the CQE from the completion ring */
1245         cqe = (union eth_rx_cqe *)qed_chain_consume(&rxq->rx_comp_ring);
1246
1247         /* Get the data from the SW ring */
1248         sw_rx_index = rxq->sw_rx_cons & NUM_RX_BDS_MAX;
1249         sw_rx_data = &rxq->sw_rx_ring[sw_rx_index];
1250         fp_cqe = &cqe->fast_path_regular;
1251         len =  le16_to_cpu(fp_cqe->len_on_first_bd);
1252         data_ptr = (u8 *)(page_address(sw_rx_data->data) +
1253                      fp_cqe->placement_offset + sw_rx_data->page_offset);
1254         for (i = ETH_HLEN; i < len; i++)
1255                 if (data_ptr[i] != (unsigned char)(i & 0xff)) {
1256                         DP_NOTICE(edev, "Loopback test failed\n");
1257                         qede_recycle_rx_bd_ring(rxq, edev, 1);
1258                         return -1;
1259                 }
1260
1261         qede_recycle_rx_bd_ring(rxq, edev, 1);
1262
1263         return 0;
1264 }
1265
1266 static int qede_selftest_run_loopback(struct qede_dev *edev, u32 loopback_mode)
1267 {
1268         struct qed_link_params link_params;
1269         struct sk_buff *skb = NULL;
1270         int rc = 0, i;
1271         u32 pkt_size;
1272         u8 *packet;
1273
1274         if (!netif_running(edev->ndev)) {
1275                 DP_NOTICE(edev, "Interface is down\n");
1276                 return -EINVAL;
1277         }
1278
1279         qede_netif_stop(edev);
1280
1281         /* Bring up the link in Loopback mode */
1282         memset(&link_params, 0, sizeof(link_params));
1283         link_params.link_up = true;
1284         link_params.override_flags = QED_LINK_OVERRIDE_LOOPBACK_MODE;
1285         link_params.loopback_mode = loopback_mode;
1286         edev->ops->common->set_link(edev->cdev, &link_params);
1287
1288         /* Wait for loopback configuration to apply */
1289         msleep_interruptible(500);
1290
1291         /* prepare the loopback packet */
1292         pkt_size = edev->ndev->mtu + ETH_HLEN;
1293
1294         skb = netdev_alloc_skb(edev->ndev, pkt_size);
1295         if (!skb) {
1296                 DP_INFO(edev, "Can't allocate skb\n");
1297                 rc = -ENOMEM;
1298                 goto test_loopback_exit;
1299         }
1300         packet = skb_put(skb, pkt_size);
1301         ether_addr_copy(packet, edev->ndev->dev_addr);
1302         ether_addr_copy(packet + ETH_ALEN, edev->ndev->dev_addr);
1303         memset(packet + (2 * ETH_ALEN), 0x77, (ETH_HLEN - (2 * ETH_ALEN)));
1304         for (i = ETH_HLEN; i < pkt_size; i++)
1305                 packet[i] = (unsigned char)(i & 0xff);
1306
1307         rc = qede_selftest_transmit_traffic(edev, skb);
1308         if (rc)
1309                 goto test_loopback_exit;
1310
1311         rc = qede_selftest_receive_traffic(edev);
1312         if (rc)
1313                 goto test_loopback_exit;
1314
1315         DP_VERBOSE(edev, NETIF_MSG_RX_STATUS, "Loopback test successful\n");
1316
1317 test_loopback_exit:
1318         dev_kfree_skb(skb);
1319
1320         /* Bring up the link in Normal mode */
1321         memset(&link_params, 0, sizeof(link_params));
1322         link_params.link_up = true;
1323         link_params.override_flags = QED_LINK_OVERRIDE_LOOPBACK_MODE;
1324         link_params.loopback_mode = QED_LINK_LOOPBACK_NONE;
1325         edev->ops->common->set_link(edev->cdev, &link_params);
1326
1327         /* Wait for loopback configuration to apply */
1328         msleep_interruptible(500);
1329
1330         qede_netif_start(edev);
1331
1332         return rc;
1333 }
1334
1335 static void qede_self_test(struct net_device *dev,
1336                            struct ethtool_test *etest, u64 *buf)
1337 {
1338         struct qede_dev *edev = netdev_priv(dev);
1339
1340         DP_VERBOSE(edev, QED_MSG_DEBUG,
1341                    "Self-test command parameters: offline = %d, external_lb = %d\n",
1342                    (etest->flags & ETH_TEST_FL_OFFLINE),
1343                    (etest->flags & ETH_TEST_FL_EXTERNAL_LB) >> 2);
1344
1345         memset(buf, 0, sizeof(u64) * QEDE_ETHTOOL_TEST_MAX);
1346
1347         if (etest->flags & ETH_TEST_FL_OFFLINE) {
1348                 if (qede_selftest_run_loopback(edev,
1349                                                QED_LINK_LOOPBACK_INT_PHY)) {
1350                         buf[QEDE_ETHTOOL_INT_LOOPBACK] = 1;
1351                         etest->flags |= ETH_TEST_FL_FAILED;
1352                 }
1353         }
1354
1355         if (edev->ops->common->selftest->selftest_interrupt(edev->cdev)) {
1356                 buf[QEDE_ETHTOOL_INTERRUPT_TEST] = 1;
1357                 etest->flags |= ETH_TEST_FL_FAILED;
1358         }
1359
1360         if (edev->ops->common->selftest->selftest_memory(edev->cdev)) {
1361                 buf[QEDE_ETHTOOL_MEMORY_TEST] = 1;
1362                 etest->flags |= ETH_TEST_FL_FAILED;
1363         }
1364
1365         if (edev->ops->common->selftest->selftest_register(edev->cdev)) {
1366                 buf[QEDE_ETHTOOL_REGISTER_TEST] = 1;
1367                 etest->flags |= ETH_TEST_FL_FAILED;
1368         }
1369
1370         if (edev->ops->common->selftest->selftest_clock(edev->cdev)) {
1371                 buf[QEDE_ETHTOOL_CLOCK_TEST] = 1;
1372                 etest->flags |= ETH_TEST_FL_FAILED;
1373         }
1374 }
1375
1376 static int qede_set_tunable(struct net_device *dev,
1377                             const struct ethtool_tunable *tuna,
1378                             const void *data)
1379 {
1380         struct qede_dev *edev = netdev_priv(dev);
1381         u32 val;
1382
1383         switch (tuna->id) {
1384         case ETHTOOL_RX_COPYBREAK:
1385                 val = *(u32 *)data;
1386                 if (val < QEDE_MIN_PKT_LEN || val > QEDE_RX_HDR_SIZE) {
1387                         DP_VERBOSE(edev, QED_MSG_DEBUG,
1388                                    "Invalid rx copy break value, range is [%u, %u]",
1389                                    QEDE_MIN_PKT_LEN, QEDE_RX_HDR_SIZE);
1390                         return -EINVAL;
1391                 }
1392
1393                 edev->rx_copybreak = *(u32 *)data;
1394                 break;
1395         default:
1396                 return -EOPNOTSUPP;
1397         }
1398
1399         return 0;
1400 }
1401
1402 static int qede_get_tunable(struct net_device *dev,
1403                             const struct ethtool_tunable *tuna, void *data)
1404 {
1405         struct qede_dev *edev = netdev_priv(dev);
1406
1407         switch (tuna->id) {
1408         case ETHTOOL_RX_COPYBREAK:
1409                 *(u32 *)data = edev->rx_copybreak;
1410                 break;
1411         default:
1412                 return -EOPNOTSUPP;
1413         }
1414
1415         return 0;
1416 }
1417
1418 static const struct ethtool_ops qede_ethtool_ops = {
1419         .get_link_ksettings = qede_get_link_ksettings,
1420         .set_link_ksettings = qede_set_link_ksettings,
1421         .get_drvinfo = qede_get_drvinfo,
1422         .get_regs_len = qede_get_regs_len,
1423         .get_regs = qede_get_regs,
1424         .get_msglevel = qede_get_msglevel,
1425         .set_msglevel = qede_set_msglevel,
1426         .nway_reset = qede_nway_reset,
1427         .get_link = qede_get_link,
1428         .get_coalesce = qede_get_coalesce,
1429         .set_coalesce = qede_set_coalesce,
1430         .get_ringparam = qede_get_ringparam,
1431         .set_ringparam = qede_set_ringparam,
1432         .get_pauseparam = qede_get_pauseparam,
1433         .set_pauseparam = qede_set_pauseparam,
1434         .get_strings = qede_get_strings,
1435         .set_phys_id = qede_set_phys_id,
1436         .get_ethtool_stats = qede_get_ethtool_stats,
1437         .get_priv_flags = qede_get_priv_flags,
1438         .get_sset_count = qede_get_sset_count,
1439         .get_rxnfc = qede_get_rxnfc,
1440         .set_rxnfc = qede_set_rxnfc,
1441         .get_rxfh_indir_size = qede_get_rxfh_indir_size,
1442         .get_rxfh_key_size = qede_get_rxfh_key_size,
1443         .get_rxfh = qede_get_rxfh,
1444         .set_rxfh = qede_set_rxfh,
1445         .get_channels = qede_get_channels,
1446         .set_channels = qede_set_channels,
1447         .self_test = qede_self_test,
1448         .get_tunable = qede_get_tunable,
1449         .set_tunable = qede_set_tunable,
1450 };
1451
1452 static const struct ethtool_ops qede_vf_ethtool_ops = {
1453         .get_link_ksettings = qede_get_link_ksettings,
1454         .get_drvinfo = qede_get_drvinfo,
1455         .get_msglevel = qede_get_msglevel,
1456         .set_msglevel = qede_set_msglevel,
1457         .get_link = qede_get_link,
1458         .get_ringparam = qede_get_ringparam,
1459         .set_ringparam = qede_set_ringparam,
1460         .get_strings = qede_get_strings,
1461         .get_ethtool_stats = qede_get_ethtool_stats,
1462         .get_priv_flags = qede_get_priv_flags,
1463         .get_sset_count = qede_get_sset_count,
1464         .get_rxnfc = qede_get_rxnfc,
1465         .set_rxnfc = qede_set_rxnfc,
1466         .get_rxfh_indir_size = qede_get_rxfh_indir_size,
1467         .get_rxfh_key_size = qede_get_rxfh_key_size,
1468         .get_rxfh = qede_get_rxfh,
1469         .set_rxfh = qede_set_rxfh,
1470         .get_channels = qede_get_channels,
1471         .set_channels = qede_set_channels,
1472         .get_tunable = qede_get_tunable,
1473         .set_tunable = qede_set_tunable,
1474 };
1475
1476 void qede_set_ethtool_ops(struct net_device *dev)
1477 {
1478         struct qede_dev *edev = netdev_priv(dev);
1479
1480         if (IS_VF(edev))
1481                 dev->ethtool_ops = &qede_vf_ethtool_ops;
1482         else
1483                 dev->ethtool_ops = &qede_ethtool_ops;
1484 }