drivers/net/ethernet/amazon/ena/ena_ethtool.c

   1 /*
   2  * Copyright 2015 Amazon.com, Inc. or its affiliates.
   3  *
   4  * This software is available to you under a choice of one of two
   5  * licenses.  You may choose to be licensed under the terms of the GNU
   6  * General Public License (GPL) Version 2, available from the file
   7  * COPYING in the main directory of this source tree, or the
   8  * BSD license below:
   9  *
  10  *     Redistribution and use in source and binary forms, with or
  11  *     without modification, are permitted provided that the following
  12  *     conditions are met:
  13  *
  14  *      - Redistributions of source code must retain the above
  15  *        copyright notice, this list of conditions and the following
  16  *        disclaimer.
  17  *
  18  *      - Redistributions in binary form must reproduce the above
  19  *        copyright notice, this list of conditions and the following
  20  *        disclaimer in the documentation and/or other materials
  21  *        provided with the distribution.
  22  *
  23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30  * SOFTWARE.
  31  */
  32
  33 #include <linux/pci.h>
  34
  35 #include "ena_netdev.h"
  36
  37 struct ena_stats {
  38         char name[ETH_GSTRING_LEN];
  39         int stat_offset;
  40 };
  41
  42 #define ENA_STAT_ENA_COM_ENTRY(stat) { \
  43         .name = #stat, \
  44         .stat_offset = offsetof(struct ena_com_stats_admin, stat) \
  45 }
  46
  47 #define ENA_STAT_ENTRY(stat, stat_type) { \
  48         .name = #stat, \
  49         .stat_offset = offsetof(struct ena_stats_##stat_type, stat) \
  50 }
  51
  52 #define ENA_STAT_RX_ENTRY(stat) \
  53         ENA_STAT_ENTRY(stat, rx)
  54
  55 #define ENA_STAT_TX_ENTRY(stat) \
  56         ENA_STAT_ENTRY(stat, tx)
  57
  58 #define ENA_STAT_GLOBAL_ENTRY(stat) \
  59         ENA_STAT_ENTRY(stat, dev)
  60
  61 static const struct ena_stats ena_stats_global_strings[] = {
  62         ENA_STAT_GLOBAL_ENTRY(tx_timeout),
  63         ENA_STAT_GLOBAL_ENTRY(suspend),
  64         ENA_STAT_GLOBAL_ENTRY(resume),
  65         ENA_STAT_GLOBAL_ENTRY(wd_expired),
  66         ENA_STAT_GLOBAL_ENTRY(interface_up),
  67         ENA_STAT_GLOBAL_ENTRY(interface_down),
  68         ENA_STAT_GLOBAL_ENTRY(admin_q_pause),
  69 };
  70
  71 static const struct ena_stats ena_stats_tx_strings[] = {
  72         ENA_STAT_TX_ENTRY(cnt),
  73         ENA_STAT_TX_ENTRY(bytes),
  74         ENA_STAT_TX_ENTRY(queue_stop),
  75         ENA_STAT_TX_ENTRY(queue_wakeup),
  76         ENA_STAT_TX_ENTRY(dma_mapping_err),
  77         ENA_STAT_TX_ENTRY(linearize),
  78         ENA_STAT_TX_ENTRY(linearize_failed),
  79         ENA_STAT_TX_ENTRY(napi_comp),
  80         ENA_STAT_TX_ENTRY(tx_poll),
  81         ENA_STAT_TX_ENTRY(doorbells),
  82         ENA_STAT_TX_ENTRY(prepare_ctx_err),
  83         ENA_STAT_TX_ENTRY(bad_req_id),
  84         ENA_STAT_TX_ENTRY(llq_buffer_copy),
  85         ENA_STAT_TX_ENTRY(missed_tx),
  86 };
  87
  88 static const struct ena_stats ena_stats_rx_strings[] = {
  89         ENA_STAT_RX_ENTRY(cnt),
  90         ENA_STAT_RX_ENTRY(bytes),
  91         ENA_STAT_RX_ENTRY(rx_copybreak_pkt),
  92         ENA_STAT_RX_ENTRY(csum_good),
  93         ENA_STAT_RX_ENTRY(refil_partial),
  94         ENA_STAT_RX_ENTRY(bad_csum),
  95         ENA_STAT_RX_ENTRY(page_alloc_fail),
  96         ENA_STAT_RX_ENTRY(skb_alloc_fail),
  97         ENA_STAT_RX_ENTRY(dma_mapping_err),
  98         ENA_STAT_RX_ENTRY(bad_desc_num),
  99         ENA_STAT_RX_ENTRY(bad_req_id),
 100         ENA_STAT_RX_ENTRY(empty_rx_ring),
 101         ENA_STAT_RX_ENTRY(csum_unchecked),
 102 };
 103
 104 static const struct ena_stats ena_stats_ena_com_strings[] = {
 105         ENA_STAT_ENA_COM_ENTRY(aborted_cmd),
 106         ENA_STAT_ENA_COM_ENTRY(submitted_cmd),
 107         ENA_STAT_ENA_COM_ENTRY(completed_cmd),
 108         ENA_STAT_ENA_COM_ENTRY(out_of_space),
 109         ENA_STAT_ENA_COM_ENTRY(no_completion),
 110 };
 111
 112 #define ENA_STATS_ARRAY_GLOBAL  ARRAY_SIZE(ena_stats_global_strings)
 113 #define ENA_STATS_ARRAY_TX      ARRAY_SIZE(ena_stats_tx_strings)
 114 #define ENA_STATS_ARRAY_RX      ARRAY_SIZE(ena_stats_rx_strings)
 115 #define ENA_STATS_ARRAY_ENA_COM ARRAY_SIZE(ena_stats_ena_com_strings)
 116
 117 static void ena_safe_update_stat(u64 *src, u64 *dst,
 118                                  struct u64_stats_sync *syncp)
 119 {
 120         unsigned int start;
 121
 122         do {
 123                 start = u64_stats_fetch_begin_irq(syncp);
 124                 *(dst) = *src;
 125         } while (u64_stats_fetch_retry_irq(syncp, start));
 126 }
 127
 128 static void ena_queue_stats(struct ena_adapter *adapter, u64 **data)
 129 {
 130         const struct ena_stats *ena_stats;
 131         struct ena_ring *ring;
 132
 133         u64 *ptr;
 134         int i, j;
 135
 136         for (i = 0; i < adapter->num_io_queues; i++) {
 137                 /* Tx stats */
 138                 ring = &adapter->tx_ring[i];
 139
 140                 for (j = 0; j < ENA_STATS_ARRAY_TX; j++) {
 141                         ena_stats = &ena_stats_tx_strings[j];
 142
 143                         ptr = (u64 *)((uintptr_t)&ring->tx_stats +
 144                                 (uintptr_t)ena_stats->stat_offset);
 145
 146                         ena_safe_update_stat(ptr, (*data)++, &ring->syncp);
 147                 }
 148
 149                 /* Rx stats */
 150                 ring = &adapter->rx_ring[i];
 151
 152                 for (j = 0; j < ENA_STATS_ARRAY_RX; j++) {
 153                         ena_stats = &ena_stats_rx_strings[j];
 154
 155                         ptr = (u64 *)((uintptr_t)&ring->rx_stats +
 156                                 (uintptr_t)ena_stats->stat_offset);
 157
 158                         ena_safe_update_stat(ptr, (*data)++, &ring->syncp);
 159                 }
 160         }
 161 }
 162
 163 static void ena_dev_admin_queue_stats(struct ena_adapter *adapter, u64 **data)
 164 {
 165         const struct ena_stats *ena_stats;
 166         u32 *ptr;
 167         int i;
 168
 169         for (i = 0; i < ENA_STATS_ARRAY_ENA_COM; i++) {
 170                 ena_stats = &ena_stats_ena_com_strings[i];
 171
 172                 ptr = (u32 *)((uintptr_t)&adapter->ena_dev->admin_queue.stats +
 173                         (uintptr_t)ena_stats->stat_offset);
 174
 175                 *(*data)++ = *ptr;
 176         }
 177 }
 178
 179 static void ena_get_ethtool_stats(struct net_device *netdev,
 180                                   struct ethtool_stats *stats,
 181                                   u64 *data)
 182 {
 183         struct ena_adapter *adapter = netdev_priv(netdev);
 184         const struct ena_stats *ena_stats;
 185         u64 *ptr;
 186         int i;
 187
 188         for (i = 0; i < ENA_STATS_ARRAY_GLOBAL; i++) {
 189                 ena_stats = &ena_stats_global_strings[i];
 190
 191                 ptr = (u64 *)((uintptr_t)&adapter->dev_stats +
 192                         (uintptr_t)ena_stats->stat_offset);
 193
 194                 ena_safe_update_stat(ptr, data++, &adapter->syncp);
 195         }
 196
 197         ena_queue_stats(adapter, &data);
 198         ena_dev_admin_queue_stats(adapter, &data);
 199 }
 200
 201 int ena_get_sset_count(struct net_device *netdev, int sset)
 202 {
 203         struct ena_adapter *adapter = netdev_priv(netdev);
 204
 205         if (sset != ETH_SS_STATS)
 206                 return -EOPNOTSUPP;
 207
 208         return  adapter->num_io_queues * (ENA_STATS_ARRAY_TX + ENA_STATS_ARRAY_RX)
 209                 + ENA_STATS_ARRAY_GLOBAL + ENA_STATS_ARRAY_ENA_COM;
 210 }
 211
 212 static void ena_queue_strings(struct ena_adapter *adapter, u8 **data)
 213 {
 214         const struct ena_stats *ena_stats;
 215         int i, j;
 216
 217         for (i = 0; i < adapter->num_io_queues; i++) {
 218                 /* Tx stats */
 219                 for (j = 0; j < ENA_STATS_ARRAY_TX; j++) {
 220                         ena_stats = &ena_stats_tx_strings[j];
 221
 222                         snprintf(*data, ETH_GSTRING_LEN,
 223                                  "queue_%u_tx_%s", i, ena_stats->name);
 224                          (*data) += ETH_GSTRING_LEN;
 225                 }
 226                 /* Rx stats */
 227                 for (j = 0; j < ENA_STATS_ARRAY_RX; j++) {
 228                         ena_stats = &ena_stats_rx_strings[j];
 229
 230                         snprintf(*data, ETH_GSTRING_LEN,
 231                                  "queue_%u_rx_%s", i, ena_stats->name);
 232                         (*data) += ETH_GSTRING_LEN;
 233                 }
 234         }
 235 }
 236
 237 static void ena_com_dev_strings(u8 **data)
 238 {
 239         const struct ena_stats *ena_stats;
 240         int i;
 241
 242         for (i = 0; i < ENA_STATS_ARRAY_ENA_COM; i++) {
 243                 ena_stats = &ena_stats_ena_com_strings[i];
 244
 245                 snprintf(*data, ETH_GSTRING_LEN,
 246                          "ena_admin_q_%s", ena_stats->name);
 247                 (*data) += ETH_GSTRING_LEN;
 248         }
 249 }
 250
 251 static void ena_get_strings(struct net_device *netdev, u32 sset, u8 *data)
 252 {
 253         struct ena_adapter *adapter = netdev_priv(netdev);
 254         const struct ena_stats *ena_stats;
 255         int i;
 256
 257         if (sset != ETH_SS_STATS)
 258                 return;
 259
 260         for (i = 0; i < ENA_STATS_ARRAY_GLOBAL; i++) {
 261                 ena_stats = &ena_stats_global_strings[i];
 262
 263                 memcpy(data, ena_stats->name, ETH_GSTRING_LEN);
 264                 data += ETH_GSTRING_LEN;
 265         }
 266
 267         ena_queue_strings(adapter, &data);
 268         ena_com_dev_strings(&data);
 269 }
 270
 271 static int ena_get_link_ksettings(struct net_device *netdev,
 272                                   struct ethtool_link_ksettings *link_ksettings)
 273 {
 274         struct ena_adapter *adapter = netdev_priv(netdev);
 275         struct ena_com_dev *ena_dev = adapter->ena_dev;
 276         struct ena_admin_get_feature_link_desc *link;
 277         struct ena_admin_get_feat_resp feat_resp;
 278         int rc;
 279
 280         rc = ena_com_get_link_params(ena_dev, &feat_resp);
 281         if (rc)
 282                 return rc;
 283
 284         link = &feat_resp.u.link;
 285         link_ksettings->base.speed = link->speed;
 286
 287         if (link->flags & ENA_ADMIN_GET_FEATURE_LINK_DESC_AUTONEG_MASK) {
 288                 ethtool_link_ksettings_add_link_mode(link_ksettings,
 289                                                      supported, Autoneg);
 290                 ethtool_link_ksettings_add_link_mode(link_ksettings,
 291                                                      supported, Autoneg);
 292         }
 293
 294         link_ksettings->base.autoneg =
 295                 (link->flags & ENA_ADMIN_GET_FEATURE_LINK_DESC_AUTONEG_MASK) ?
 296                 AUTONEG_ENABLE : AUTONEG_DISABLE;
 297
 298         link_ksettings->base.duplex = DUPLEX_FULL;
 299
 300         return 0;
 301 }
 302
 303 static int ena_get_coalesce(struct net_device *net_dev,
 304                             struct ethtool_coalesce *coalesce)
 305 {
 306         struct ena_adapter *adapter = netdev_priv(net_dev);
 307         struct ena_com_dev *ena_dev = adapter->ena_dev;
 308
 309         if (!ena_com_interrupt_moderation_supported(ena_dev)) {
 310                 /* the devie doesn't support interrupt moderation */
 311                 return -EOPNOTSUPP;
 312         }
 313
 314         coalesce->tx_coalesce_usecs =
 315                 ena_com_get_nonadaptive_moderation_interval_tx(ena_dev) *
 316                         ena_dev->intr_delay_resolution;
 317
 318         if (!ena_com_get_adaptive_moderation_enabled(ena_dev))
 319                 coalesce->rx_coalesce_usecs =
 320                         ena_com_get_nonadaptive_moderation_interval_rx(ena_dev)
 321                         * ena_dev->intr_delay_resolution;
 322
 323         coalesce->use_adaptive_rx_coalesce =
 324                 ena_com_get_adaptive_moderation_enabled(ena_dev);
 325
 326         return 0;
 327 }
 328
 329 static void ena_update_tx_rings_intr_moderation(struct ena_adapter *adapter)
 330 {
 331         unsigned int val;
 332         int i;
 333
 334         val = ena_com_get_nonadaptive_moderation_interval_tx(adapter->ena_dev);
 335
 336         for (i = 0; i < adapter->num_io_queues; i++)
 337                 adapter->tx_ring[i].smoothed_interval = val;
 338 }
 339
 340 static void ena_update_rx_rings_intr_moderation(struct ena_adapter *adapter)
 341 {
 342         unsigned int val;
 343         int i;
 344
 345         val = ena_com_get_nonadaptive_moderation_interval_rx(adapter->ena_dev);
 346
 347         for (i = 0; i < adapter->num_io_queues; i++)
 348                 adapter->rx_ring[i].smoothed_interval = val;
 349 }
 350
 351 static int ena_set_coalesce(struct net_device *net_dev,
 352                             struct ethtool_coalesce *coalesce)
 353 {
 354         struct ena_adapter *adapter = netdev_priv(net_dev);
 355         struct ena_com_dev *ena_dev = adapter->ena_dev;
 356         int rc;
 357
 358         if (!ena_com_interrupt_moderation_supported(ena_dev)) {
 359                 /* the devie doesn't support interrupt moderation */
 360                 return -EOPNOTSUPP;
 361         }
 362
 363         rc = ena_com_update_nonadaptive_moderation_interval_tx(ena_dev,
 364                                                                coalesce->tx_coalesce_usecs);
 365         if (rc)
 366                 return rc;
 367
 368         ena_update_tx_rings_intr_moderation(adapter);
 369
 370         if (coalesce->use_adaptive_rx_coalesce) {
 371                 if (!ena_com_get_adaptive_moderation_enabled(ena_dev))
 372                         ena_com_enable_adaptive_moderation(ena_dev);
 373                 return 0;
 374         }
 375
 376         rc = ena_com_update_nonadaptive_moderation_interval_rx(ena_dev,
 377                                                                coalesce->rx_coalesce_usecs);
 378         if (rc)
 379                 return rc;
 380
 381         ena_update_rx_rings_intr_moderation(adapter);
 382
 383         if (!coalesce->use_adaptive_rx_coalesce) {
 384                 if (ena_com_get_adaptive_moderation_enabled(ena_dev))
 385                         ena_com_disable_adaptive_moderation(ena_dev);
 386         }
 387
 388         return 0;
 389 }
 390
 391 static u32 ena_get_msglevel(struct net_device *netdev)
 392 {
 393         struct ena_adapter *adapter = netdev_priv(netdev);
 394
 395         return adapter->msg_enable;
 396 }
 397
 398 static void ena_set_msglevel(struct net_device *netdev, u32 value)
 399 {
 400         struct ena_adapter *adapter = netdev_priv(netdev);
 401
 402         adapter->msg_enable = value;
 403 }
 404
 405 static void ena_get_drvinfo(struct net_device *dev,
 406                             struct ethtool_drvinfo *info)
 407 {
 408         struct ena_adapter *adapter = netdev_priv(dev);
 409
 410         strlcpy(info->driver, DRV_MODULE_NAME, sizeof(info->driver));
 411         strlcpy(info->version, DRV_MODULE_VERSION, sizeof(info->version));
 412         strlcpy(info->bus_info, pci_name(adapter->pdev),
 413                 sizeof(info->bus_info));
 414 }
 415
 416 static void ena_get_ringparam(struct net_device *netdev,
 417                               struct ethtool_ringparam *ring)
 418 {
 419         struct ena_adapter *adapter = netdev_priv(netdev);
 420
 421         ring->tx_max_pending = adapter->max_tx_ring_size;
 422         ring->rx_max_pending = adapter->max_rx_ring_size;
 423         ring->tx_pending = adapter->tx_ring[0].ring_size;
 424         ring->rx_pending = adapter->rx_ring[0].ring_size;
 425 }
 426
 427 static int ena_set_ringparam(struct net_device *netdev,
 428                              struct ethtool_ringparam *ring)
 429 {
 430         struct ena_adapter *adapter = netdev_priv(netdev);
 431         u32 new_tx_size, new_rx_size;
 432
 433         new_tx_size = ring->tx_pending < ENA_MIN_RING_SIZE ?
 434                         ENA_MIN_RING_SIZE : ring->tx_pending;
 435         new_tx_size = rounddown_pow_of_two(new_tx_size);
 436
 437         new_rx_size = ring->rx_pending < ENA_MIN_RING_SIZE ?
 438                         ENA_MIN_RING_SIZE : ring->rx_pending;
 439         new_rx_size = rounddown_pow_of_two(new_rx_size);
 440
 441         if (new_tx_size == adapter->requested_tx_ring_size &&
 442             new_rx_size == adapter->requested_rx_ring_size)
 443                 return 0;
 444
 445         return ena_update_queue_sizes(adapter, new_tx_size, new_rx_size);
 446 }
 447
 448 static u32 ena_flow_hash_to_flow_type(u16 hash_fields)
 449 {
 450         u32 data = 0;
 451
 452         if (hash_fields & ENA_ADMIN_RSS_L2_DA)
 453                 data |= RXH_L2DA;
 454
 455         if (hash_fields & ENA_ADMIN_RSS_L3_DA)
 456                 data |= RXH_IP_DST;
 457
 458         if (hash_fields & ENA_ADMIN_RSS_L3_SA)
 459                 data |= RXH_IP_SRC;
 460
 461         if (hash_fields & ENA_ADMIN_RSS_L4_DP)
 462                 data |= RXH_L4_B_2_3;
 463
 464         if (hash_fields & ENA_ADMIN_RSS_L4_SP)
 465                 data |= RXH_L4_B_0_1;
 466
 467         return data;
 468 }
 469
 470 static u16 ena_flow_data_to_flow_hash(u32 hash_fields)
 471 {
 472         u16 data = 0;
 473
 474         if (hash_fields & RXH_L2DA)
 475                 data |= ENA_ADMIN_RSS_L2_DA;
 476
 477         if (hash_fields & RXH_IP_DST)
 478                 data |= ENA_ADMIN_RSS_L3_DA;
 479
 480         if (hash_fields & RXH_IP_SRC)
 481                 data |= ENA_ADMIN_RSS_L3_SA;
 482
 483         if (hash_fields & RXH_L4_B_2_3)
 484                 data |= ENA_ADMIN_RSS_L4_DP;
 485
 486         if (hash_fields & RXH_L4_B_0_1)
 487                 data |= ENA_ADMIN_RSS_L4_SP;
 488
 489         return data;
 490 }
 491
 492 static int ena_get_rss_hash(struct ena_com_dev *ena_dev,
 493                             struct ethtool_rxnfc *cmd)
 494 {
 495         enum ena_admin_flow_hash_proto proto;
 496         u16 hash_fields;
 497         int rc;
 498
 499         cmd->data = 0;
 500
 501         switch (cmd->flow_type) {
 502         case TCP_V4_FLOW:
 503                 proto = ENA_ADMIN_RSS_TCP4;
 504                 break;
 505         case UDP_V4_FLOW:
 506                 proto = ENA_ADMIN_RSS_UDP4;
 507                 break;
 508         case TCP_V6_FLOW:
 509                 proto = ENA_ADMIN_RSS_TCP6;
 510                 break;
 511         case UDP_V6_FLOW:
 512                 proto = ENA_ADMIN_RSS_UDP6;
 513                 break;
 514         case IPV4_FLOW:
 515                 proto = ENA_ADMIN_RSS_IP4;
 516                 break;
 517         case IPV6_FLOW:
 518                 proto = ENA_ADMIN_RSS_IP6;
 519                 break;
 520         case ETHER_FLOW:
 521                 proto = ENA_ADMIN_RSS_NOT_IP;
 522                 break;
 523         case AH_V4_FLOW:
 524         case ESP_V4_FLOW:
 525         case AH_V6_FLOW:
 526         case ESP_V6_FLOW:
 527         case SCTP_V4_FLOW:
 528         case AH_ESP_V4_FLOW:
 529                 return -EOPNOTSUPP;
 530         default:
 531                 return -EINVAL;
 532         }
 533
 534         rc = ena_com_get_hash_ctrl(ena_dev, proto, &hash_fields);
 535         if (rc)
 536                 return rc;
 537
 538         cmd->data = ena_flow_hash_to_flow_type(hash_fields);
 539
 540         return 0;
 541 }
 542
 543 static int ena_set_rss_hash(struct ena_com_dev *ena_dev,
 544                             struct ethtool_rxnfc *cmd)
 545 {
 546         enum ena_admin_flow_hash_proto proto;
 547         u16 hash_fields;
 548
 549         switch (cmd->flow_type) {
 550         case TCP_V4_FLOW:
 551                 proto = ENA_ADMIN_RSS_TCP4;
 552                 break;
 553         case UDP_V4_FLOW:
 554                 proto = ENA_ADMIN_RSS_UDP4;
 555                 break;
 556         case TCP_V6_FLOW:
 557                 proto = ENA_ADMIN_RSS_TCP6;
 558                 break;
 559         case UDP_V6_FLOW:
 560                 proto = ENA_ADMIN_RSS_UDP6;
 561                 break;
 562         case IPV4_FLOW:
 563                 proto = ENA_ADMIN_RSS_IP4;
 564                 break;
 565         case IPV6_FLOW:
 566                 proto = ENA_ADMIN_RSS_IP6;
 567                 break;
 568         case ETHER_FLOW:
 569                 proto = ENA_ADMIN_RSS_NOT_IP;
 570                 break;
 571         case AH_V4_FLOW:
 572         case ESP_V4_FLOW:
 573         case AH_V6_FLOW:
 574         case ESP_V6_FLOW:
 575         case SCTP_V4_FLOW:
 576         case AH_ESP_V4_FLOW:
 577                 return -EOPNOTSUPP;
 578         default:
 579                 return -EINVAL;
 580         }
 581
 582         hash_fields = ena_flow_data_to_flow_hash(cmd->data);
 583
 584         return ena_com_fill_hash_ctrl(ena_dev, proto, hash_fields);
 585 }
 586
 587 static int ena_set_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *info)
 588 {
 589         struct ena_adapter *adapter = netdev_priv(netdev);
 590         int rc = 0;
 591
 592         switch (info->cmd) {
 593         case ETHTOOL_SRXFH:
 594                 rc = ena_set_rss_hash(adapter->ena_dev, info);
 595                 break;
 596         case ETHTOOL_SRXCLSRLDEL:
 597         case ETHTOOL_SRXCLSRLINS:
 598         default:
 599                 netif_err(adapter, drv, netdev,
 600                           "Command parameter %d is not supported\n", info->cmd);
 601                 rc = -EOPNOTSUPP;
 602         }
 603
 604         return rc;
 605 }
 606
 607 static int ena_get_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *info,
 608                          u32 *rules)
 609 {
 610         struct ena_adapter *adapter = netdev_priv(netdev);
 611         int rc = 0;
 612
 613         switch (info->cmd) {
 614         case ETHTOOL_GRXRINGS:
 615                 info->data = adapter->num_io_queues;
 616                 rc = 0;
 617                 break;
 618         case ETHTOOL_GRXFH:
 619                 rc = ena_get_rss_hash(adapter->ena_dev, info);
 620                 break;
 621         case ETHTOOL_GRXCLSRLCNT:
 622         case ETHTOOL_GRXCLSRULE:
 623         case ETHTOOL_GRXCLSRLALL:
 624         default:
 625                 netif_err(adapter, drv, netdev,
 626                           "Command parameter %d is not supported\n", info->cmd);
 627                 rc = -EOPNOTSUPP;
 628         }
 629
 630         return rc;
 631 }
 632
 633 static u32 ena_get_rxfh_indir_size(struct net_device *netdev)
 634 {
 635         return ENA_RX_RSS_TABLE_SIZE;
 636 }
 637
 638 static u32 ena_get_rxfh_key_size(struct net_device *netdev)
 639 {
 640         return ENA_HASH_KEY_SIZE;
 641 }
 642
 643 static int ena_get_rxfh(struct net_device *netdev, u32 *indir, u8 *key,
 644                         u8 *hfunc)
 645 {
 646         struct ena_adapter *adapter = netdev_priv(netdev);
 647         enum ena_admin_hash_functions ena_func;
 648         u8 func;
 649         int rc;
 650
 651         rc = ena_com_indirect_table_get(adapter->ena_dev, indir);
 652         if (rc)
 653                 return rc;
 654
 655         rc = ena_com_get_hash_function(adapter->ena_dev, &ena_func, key);
 656         if (rc)
 657                 return rc;
 658
 659         switch (ena_func) {
 660         case ENA_ADMIN_TOEPLITZ:
 661                 func = ETH_RSS_HASH_TOP;
 662                 break;
 663         case ENA_ADMIN_CRC32:
 664                 func = ETH_RSS_HASH_XOR;
 665                 break;
 666         default:
 667                 netif_err(adapter, drv, netdev,
 668                           "Command parameter is not supported\n");
 669                 return -EOPNOTSUPP;
 670         }
 671
 672         if (hfunc)
 673                 *hfunc = func;
 674
 675         return rc;
 676 }
 677
 678 static int ena_set_rxfh(struct net_device *netdev, const u32 *indir,
 679                         const u8 *key, const u8 hfunc)
 680 {
 681         struct ena_adapter *adapter = netdev_priv(netdev);
 682         struct ena_com_dev *ena_dev = adapter->ena_dev;
 683         enum ena_admin_hash_functions func;
 684         int rc, i;
 685
 686         if (indir) {
 687                 for (i = 0; i < ENA_RX_RSS_TABLE_SIZE; i++) {
 688                         rc = ena_com_indirect_table_fill_entry(ena_dev,
 689                                                                i,
 690                                                                ENA_IO_RXQ_IDX(indir[i]));
 691                         if (unlikely(rc)) {
 692                                 netif_err(adapter, drv, netdev,
 693                                           "Cannot fill indirect table (index is too large)\n");
 694                                 return rc;
 695                         }
 696                 }
 697
 698                 rc = ena_com_indirect_table_set(ena_dev);
 699                 if (rc) {
 700                         netif_err(adapter, drv, netdev,
 701                                   "Cannot set indirect table\n");
 702                         return rc == -EPERM ? -EOPNOTSUPP : rc;
 703                 }
 704         }
 705
 706         switch (hfunc) {
 707         case ETH_RSS_HASH_TOP:
 708                 func = ENA_ADMIN_TOEPLITZ;
 709                 break;
 710         case ETH_RSS_HASH_XOR:
 711                 func = ENA_ADMIN_CRC32;
 712                 break;
 713         default:
 714                 netif_err(adapter, drv, netdev, "Unsupported hfunc %d\n",
 715                           hfunc);
 716                 return -EOPNOTSUPP;
 717         }
 718
 719         if (key) {
 720                 rc = ena_com_fill_hash_function(ena_dev, func, key,
 721                                                 ENA_HASH_KEY_SIZE,
 722                                                 0xFFFFFFFF);
 723                 if (unlikely(rc)) {
 724                         netif_err(adapter, drv, netdev, "Cannot fill key\n");
 725                         return rc == -EPERM ? -EOPNOTSUPP : rc;
 726                 }
 727         }
 728
 729         return 0;
 730 }
 731
 732 static void ena_get_channels(struct net_device *netdev,
 733                              struct ethtool_channels *channels)
 734 {
 735         struct ena_adapter *adapter = netdev_priv(netdev);
 736
 737         channels->max_combined = adapter->max_num_io_queues;
 738         channels->combined_count = adapter->num_io_queues;
 739 }
 740
 741 static int ena_set_channels(struct net_device *netdev,
 742                             struct ethtool_channels *channels)
 743 {
 744         struct ena_adapter *adapter = netdev_priv(netdev);
 745         u32 count = channels->combined_count;
 746         /* The check for max value is already done in ethtool */
 747         if (count < ENA_MIN_NUM_IO_QUEUES)
 748                 return -EINVAL;
 749
 750         return ena_update_queue_count(adapter, count);
 751 }
 752
 753 static int ena_get_tunable(struct net_device *netdev,
 754                            const struct ethtool_tunable *tuna, void *data)
 755 {
 756         struct ena_adapter *adapter = netdev_priv(netdev);
 757         int ret = 0;
 758
 759         switch (tuna->id) {
 760         case ETHTOOL_RX_COPYBREAK:
 761                 *(u32 *)data = adapter->rx_copybreak;
 762                 break;
 763         default:
 764                 ret = -EINVAL;
 765                 break;
 766         }
 767
 768         return ret;
 769 }
 770
 771 static int ena_set_tunable(struct net_device *netdev,
 772                            const struct ethtool_tunable *tuna,
 773                            const void *data)
 774 {
 775         struct ena_adapter *adapter = netdev_priv(netdev);
 776         int ret = 0;
 777         u32 len;
 778
 779         switch (tuna->id) {
 780         case ETHTOOL_RX_COPYBREAK:
 781                 len = *(u32 *)data;
 782                 if (len > adapter->netdev->mtu) {
 783                         ret = -EINVAL;
 784                         break;
 785                 }
 786                 adapter->rx_copybreak = len;
 787                 break;
 788         default:
 789                 ret = -EINVAL;
 790                 break;
 791         }
 792
 793         return ret;
 794 }
 795
 796 static const struct ethtool_ops ena_ethtool_ops = {
 797         .get_link_ksettings     = ena_get_link_ksettings,
 798         .get_drvinfo            = ena_get_drvinfo,
 799         .get_msglevel           = ena_get_msglevel,
 800         .set_msglevel           = ena_set_msglevel,
 801         .get_link               = ethtool_op_get_link,
 802         .get_coalesce           = ena_get_coalesce,
 803         .set_coalesce           = ena_set_coalesce,
 804         .get_ringparam          = ena_get_ringparam,
 805         .set_ringparam          = ena_set_ringparam,
 806         .get_sset_count         = ena_get_sset_count,
 807         .get_strings            = ena_get_strings,
 808         .get_ethtool_stats      = ena_get_ethtool_stats,
 809         .get_rxnfc              = ena_get_rxnfc,
 810         .set_rxnfc              = ena_set_rxnfc,
 811         .get_rxfh_indir_size    = ena_get_rxfh_indir_size,
 812         .get_rxfh_key_size      = ena_get_rxfh_key_size,
 813         .get_rxfh               = ena_get_rxfh,
 814         .set_rxfh               = ena_set_rxfh,
 815         .get_channels           = ena_get_channels,
 816         .set_channels           = ena_set_channels,
 817         .get_tunable            = ena_get_tunable,
 818         .set_tunable            = ena_set_tunable,
 819 };
 820
 821 void ena_set_ethtool_ops(struct net_device *netdev)
 822 {
 823         netdev->ethtool_ops = &ena_ethtool_ops;
 824 }
 825
 826 static void ena_dump_stats_ex(struct ena_adapter *adapter, u8 *buf)
 827 {
 828         struct net_device *netdev = adapter->netdev;
 829         u8 *strings_buf;
 830         u64 *data_buf;
 831         int strings_num;
 832         int i, rc;
 833
 834         strings_num = ena_get_sset_count(netdev, ETH_SS_STATS);
 835         if (strings_num <= 0) {
 836                 netif_err(adapter, drv, netdev, "Can't get stats num\n");
 837                 return;
 838         }
 839
 840         strings_buf = devm_kcalloc(&adapter->pdev->dev,
 841                                    ETH_GSTRING_LEN, strings_num,
 842                                    GFP_ATOMIC);
 843         if (!strings_buf) {
 844                 netif_err(adapter, drv, netdev,
 845                           "failed to alloc strings_buf\n");
 846                 return;
 847         }
 848
 849         data_buf = devm_kcalloc(&adapter->pdev->dev,
 850                                 strings_num, sizeof(u64),
 851                                 GFP_ATOMIC);
 852         if (!data_buf) {
 853                 netif_err(adapter, drv, netdev,
 854                           "failed to allocate data buf\n");
 855                 devm_kfree(&adapter->pdev->dev, strings_buf);
 856                 return;
 857         }
 858
 859         ena_get_strings(netdev, ETH_SS_STATS, strings_buf);
 860         ena_get_ethtool_stats(netdev, NULL, data_buf);
 861
 862         /* If there is a buffer, dump stats, otherwise print them to dmesg */
 863         if (buf)
 864                 for (i = 0; i < strings_num; i++) {
 865                         rc = snprintf(buf, ETH_GSTRING_LEN + sizeof(u64),
 866                                       "%s %llu\n",
 867                                       strings_buf + i * ETH_GSTRING_LEN,
 868                                       data_buf[i]);
 869                         buf += rc;
 870                 }
 871         else
 872                 for (i = 0; i < strings_num; i++)
 873                         netif_err(adapter, drv, netdev, "%s: %llu\n",
 874                                   strings_buf + i * ETH_GSTRING_LEN,
 875                                   data_buf[i]);
 876
 877         devm_kfree(&adapter->pdev->dev, strings_buf);
 878         devm_kfree(&adapter->pdev->dev, data_buf);
 879 }
 880
 881 void ena_dump_stats_to_buf(struct ena_adapter *adapter, u8 *buf)
 882 {
 883         if (!buf)
 884                 return;
 885
 886         ena_dump_stats_ex(adapter, buf);
 887 }
 888
 889 void ena_dump_stats_to_dmesg(struct ena_adapter *adapter)
 890 {
 891         ena_dump_stats_ex(adapter, NULL);
 892 }