drivers/net/sfc/sfc_ethdev.c

   1 /*-
   2  * Copyright (c) 2016 Solarflare Communications Inc.
   3  * All rights reserved.
   4  *
   5  * This software was jointly developed between OKTET Labs (under contract
   6  * for Solarflare) and Solarflare Communications, Inc.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions are met:
  10  *
  11  * 1. Redistributions of source code must retain the above copyright notice,
  12  *    this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright notice,
  14  *    this list of conditions and the following disclaimer in the documentation
  15  *    and/or other materials provided with the distribution.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  18  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  19  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  20  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  21  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  22  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  23  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  24  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  25  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  26  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
  27  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28  */
  29
  30 #include <rte_dev.h>
  31 #include <rte_ethdev.h>
  32 #include <rte_pci.h>
  33
  34 #include "efx.h"
  35
  36 #include "sfc.h"
  37 #include "sfc_debug.h"
  38 #include "sfc_log.h"
  39 #include "sfc_kvargs.h"
  40 #include "sfc_ev.h"
  41 #include "sfc_rx.h"
  42 #include "sfc_tx.h"
  43
  44
  45 static void
  46 sfc_dev_infos_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info)
  47 {
  48         struct sfc_adapter *sa = dev->data->dev_private;
  49
  50         sfc_log_init(sa, "entry");
  51
  52         dev_info->pci_dev = RTE_DEV_TO_PCI(dev->device);
  53         dev_info->max_rx_pktlen = EFX_MAC_PDU_MAX;
  54
  55         /* Autonegotiation may be disabled */
  56         dev_info->speed_capa = ETH_LINK_SPEED_FIXED;
  57         if (sa->port.phy_adv_cap_mask & EFX_PHY_CAP_1000FDX)
  58                 dev_info->speed_capa |= ETH_LINK_SPEED_1G;
  59         if (sa->port.phy_adv_cap_mask & EFX_PHY_CAP_10000FDX)
  60                 dev_info->speed_capa |= ETH_LINK_SPEED_10G;
  61         if (sa->port.phy_adv_cap_mask & EFX_PHY_CAP_40000FDX)
  62                 dev_info->speed_capa |= ETH_LINK_SPEED_40G;
  63
  64         dev_info->max_rx_queues = sa->rxq_max;
  65         dev_info->max_tx_queues = sa->txq_max;
  66
  67         /* By default packets are dropped if no descriptors are available */
  68         dev_info->default_rxconf.rx_drop_en = 1;
  69
  70         dev_info->rx_offload_capa =
  71                 DEV_RX_OFFLOAD_IPV4_CKSUM |
  72                 DEV_RX_OFFLOAD_UDP_CKSUM |
  73                 DEV_RX_OFFLOAD_TCP_CKSUM;
  74
  75         dev_info->tx_offload_capa =
  76                 DEV_TX_OFFLOAD_IPV4_CKSUM |
  77                 DEV_TX_OFFLOAD_UDP_CKSUM |
  78                 DEV_TX_OFFLOAD_TCP_CKSUM;
  79
  80         dev_info->default_txconf.txq_flags = ETH_TXQ_FLAGS_NOVLANOFFL |
  81                                              ETH_TXQ_FLAGS_NOXSUMSCTP;
  82
  83         dev_info->rx_desc_lim.nb_max = EFX_RXQ_MAXNDESCS;
  84         dev_info->rx_desc_lim.nb_min = EFX_RXQ_MINNDESCS;
  85         /* The RXQ hardware requires that the descriptor count is a power
  86          * of 2, but rx_desc_lim cannot properly describe that constraint.
  87          */
  88         dev_info->rx_desc_lim.nb_align = EFX_RXQ_MINNDESCS;
  89
  90         dev_info->tx_desc_lim.nb_max = sa->txq_max_entries;
  91         dev_info->tx_desc_lim.nb_min = EFX_TXQ_MINNDESCS;
  92         /*
  93          * The TXQ hardware requires that the descriptor count is a power
  94          * of 2, but tx_desc_lim cannot properly describe that constraint
  95          */
  96         dev_info->tx_desc_lim.nb_align = EFX_TXQ_MINNDESCS;
  97 }
  98
  99 static int
 100 sfc_dev_configure(struct rte_eth_dev *dev)
 101 {
 102         struct rte_eth_dev_data *dev_data = dev->data;
 103         struct sfc_adapter *sa = dev_data->dev_private;
 104         int rc;
 105
 106         sfc_log_init(sa, "entry n_rxq=%u n_txq=%u",
 107                      dev_data->nb_rx_queues, dev_data->nb_tx_queues);
 108
 109         sfc_adapter_lock(sa);
 110         switch (sa->state) {
 111         case SFC_ADAPTER_CONFIGURED:
 112                 sfc_close(sa);
 113                 SFC_ASSERT(sa->state == SFC_ADAPTER_INITIALIZED);
 114                 /* FALLTHROUGH */
 115         case SFC_ADAPTER_INITIALIZED:
 116                 rc = sfc_configure(sa);
 117                 break;
 118         default:
 119                 sfc_err(sa, "unexpected adapter state %u to configure",
 120                         sa->state);
 121                 rc = EINVAL;
 122                 break;
 123         }
 124         sfc_adapter_unlock(sa);
 125
 126         sfc_log_init(sa, "done %d", rc);
 127         SFC_ASSERT(rc >= 0);
 128         return -rc;
 129 }
 130
 131 static int
 132 sfc_dev_start(struct rte_eth_dev *dev)
 133 {
 134         struct sfc_adapter *sa = dev->data->dev_private;
 135         int rc;
 136
 137         sfc_log_init(sa, "entry");
 138
 139         sfc_adapter_lock(sa);
 140         rc = sfc_start(sa);
 141         sfc_adapter_unlock(sa);
 142
 143         sfc_log_init(sa, "done %d", rc);
 144         SFC_ASSERT(rc >= 0);
 145         return -rc;
 146 }
 147
 148 static int
 149 sfc_dev_link_update(struct rte_eth_dev *dev, int wait_to_complete)
 150 {
 151         struct sfc_adapter *sa = dev->data->dev_private;
 152         struct rte_eth_link *dev_link = &dev->data->dev_link;
 153         struct rte_eth_link old_link;
 154         struct rte_eth_link current_link;
 155
 156         sfc_log_init(sa, "entry");
 157
 158         if (sa->state != SFC_ADAPTER_STARTED)
 159                 return 0;
 160
 161 retry:
 162         EFX_STATIC_ASSERT(sizeof(*dev_link) == sizeof(rte_atomic64_t));
 163         *(int64_t *)&old_link = rte_atomic64_read((rte_atomic64_t *)dev_link);
 164
 165         if (wait_to_complete) {
 166                 efx_link_mode_t link_mode;
 167
 168                 efx_port_poll(sa->nic, &link_mode);
 169                 sfc_port_link_mode_to_info(link_mode, &current_link);
 170
 171                 if (!rte_atomic64_cmpset((volatile uint64_t *)dev_link,
 172                                          *(uint64_t *)&old_link,
 173                                          *(uint64_t *)&current_link))
 174                         goto retry;
 175         } else {
 176                 sfc_ev_mgmt_qpoll(sa);
 177                 *(int64_t *)&current_link =
 178                         rte_atomic64_read((rte_atomic64_t *)dev_link);
 179         }
 180
 181         if (old_link.link_status != current_link.link_status)
 182                 sfc_info(sa, "Link status is %s",
 183                          current_link.link_status ? "UP" : "DOWN");
 184
 185         return old_link.link_status == current_link.link_status ? 0 : -1;
 186 }
 187
 188 static void
 189 sfc_dev_stop(struct rte_eth_dev *dev)
 190 {
 191         struct sfc_adapter *sa = dev->data->dev_private;
 192
 193         sfc_log_init(sa, "entry");
 194
 195         sfc_adapter_lock(sa);
 196         sfc_stop(sa);
 197         sfc_adapter_unlock(sa);
 198
 199         sfc_log_init(sa, "done");
 200 }
 201
 202 static int
 203 sfc_dev_set_link_up(struct rte_eth_dev *dev)
 204 {
 205         struct sfc_adapter *sa = dev->data->dev_private;
 206         int rc;
 207
 208         sfc_log_init(sa, "entry");
 209
 210         sfc_adapter_lock(sa);
 211         rc = sfc_start(sa);
 212         sfc_adapter_unlock(sa);
 213
 214         SFC_ASSERT(rc >= 0);
 215         return -rc;
 216 }
 217
 218 static int
 219 sfc_dev_set_link_down(struct rte_eth_dev *dev)
 220 {
 221         struct sfc_adapter *sa = dev->data->dev_private;
 222
 223         sfc_log_init(sa, "entry");
 224
 225         sfc_adapter_lock(sa);
 226         sfc_stop(sa);
 227         sfc_adapter_unlock(sa);
 228
 229         return 0;
 230 }
 231
 232 static void
 233 sfc_dev_close(struct rte_eth_dev *dev)
 234 {
 235         struct sfc_adapter *sa = dev->data->dev_private;
 236
 237         sfc_log_init(sa, "entry");
 238
 239         sfc_adapter_lock(sa);
 240         switch (sa->state) {
 241         case SFC_ADAPTER_STARTED:
 242                 sfc_stop(sa);
 243                 SFC_ASSERT(sa->state == SFC_ADAPTER_CONFIGURED);
 244                 /* FALLTHROUGH */
 245         case SFC_ADAPTER_CONFIGURED:
 246                 sfc_close(sa);
 247                 SFC_ASSERT(sa->state == SFC_ADAPTER_INITIALIZED);
 248                 /* FALLTHROUGH */
 249         case SFC_ADAPTER_INITIALIZED:
 250                 break;
 251         default:
 252                 sfc_err(sa, "unexpected adapter state %u on close", sa->state);
 253                 break;
 254         }
 255         sfc_adapter_unlock(sa);
 256
 257         sfc_log_init(sa, "done");
 258 }
 259
 260 static void
 261 sfc_dev_filter_set(struct rte_eth_dev *dev, enum sfc_dev_filter_mode mode,
 262                    boolean_t enabled)
 263 {
 264         struct sfc_port *port;
 265         boolean_t *toggle;
 266         struct sfc_adapter *sa = dev->data->dev_private;
 267         boolean_t allmulti = (mode == SFC_DEV_FILTER_MODE_ALLMULTI);
 268         const char *desc = (allmulti) ? "all-multi" : "promiscuous";
 269
 270         sfc_adapter_lock(sa);
 271
 272         port = &sa->port;
 273         toggle = (allmulti) ? (&port->allmulti) : (&port->promisc);
 274
 275         if (*toggle != enabled) {
 276                 *toggle = enabled;
 277
 278                 if ((sa->state == SFC_ADAPTER_STARTED) &&
 279                     (sfc_set_rx_mode(sa) != 0)) {
 280                         *toggle = !(enabled);
 281                         sfc_warn(sa, "Failed to %s %s mode",
 282                                  ((enabled) ? "enable" : "disable"), desc);
 283                 }
 284         }
 285
 286         sfc_adapter_unlock(sa);
 287 }
 288
 289 static void
 290 sfc_dev_promisc_enable(struct rte_eth_dev *dev)
 291 {
 292         sfc_dev_filter_set(dev, SFC_DEV_FILTER_MODE_PROMISC, B_TRUE);
 293 }
 294
 295 static void
 296 sfc_dev_promisc_disable(struct rte_eth_dev *dev)
 297 {
 298         sfc_dev_filter_set(dev, SFC_DEV_FILTER_MODE_PROMISC, B_FALSE);
 299 }
 300
 301 static void
 302 sfc_dev_allmulti_enable(struct rte_eth_dev *dev)
 303 {
 304         sfc_dev_filter_set(dev, SFC_DEV_FILTER_MODE_ALLMULTI, B_TRUE);
 305 }
 306
 307 static void
 308 sfc_dev_allmulti_disable(struct rte_eth_dev *dev)
 309 {
 310         sfc_dev_filter_set(dev, SFC_DEV_FILTER_MODE_ALLMULTI, B_FALSE);
 311 }
 312
 313 static int
 314 sfc_rx_queue_setup(struct rte_eth_dev *dev, uint16_t rx_queue_id,
 315                    uint16_t nb_rx_desc, unsigned int socket_id,
 316                    const struct rte_eth_rxconf *rx_conf,
 317                    struct rte_mempool *mb_pool)
 318 {
 319         struct sfc_adapter *sa = dev->data->dev_private;
 320         int rc;
 321
 322         sfc_log_init(sa, "RxQ=%u nb_rx_desc=%u socket_id=%u",
 323                      rx_queue_id, nb_rx_desc, socket_id);
 324
 325         sfc_adapter_lock(sa);
 326
 327         rc = sfc_rx_qinit(sa, rx_queue_id, nb_rx_desc, socket_id,
 328                           rx_conf, mb_pool);
 329         if (rc != 0)
 330                 goto fail_rx_qinit;
 331
 332         dev->data->rx_queues[rx_queue_id] = sa->rxq_info[rx_queue_id].rxq;
 333
 334         sfc_adapter_unlock(sa);
 335
 336         return 0;
 337
 338 fail_rx_qinit:
 339         sfc_adapter_unlock(sa);
 340         SFC_ASSERT(rc > 0);
 341         return -rc;
 342 }
 343
 344 static void
 345 sfc_rx_queue_release(void *queue)
 346 {
 347         struct sfc_rxq *rxq = queue;
 348         struct sfc_adapter *sa;
 349         unsigned int sw_index;
 350
 351         if (rxq == NULL)
 352                 return;
 353
 354         sa = rxq->evq->sa;
 355         sfc_adapter_lock(sa);
 356
 357         sw_index = sfc_rxq_sw_index(rxq);
 358
 359         sfc_log_init(sa, "RxQ=%u", sw_index);
 360
 361         sa->eth_dev->data->rx_queues[sw_index] = NULL;
 362
 363         sfc_rx_qfini(sa, sw_index);
 364
 365         sfc_adapter_unlock(sa);
 366 }
 367
 368 static int
 369 sfc_tx_queue_setup(struct rte_eth_dev *dev, uint16_t tx_queue_id,
 370                    uint16_t nb_tx_desc, unsigned int socket_id,
 371                    const struct rte_eth_txconf *tx_conf)
 372 {
 373         struct sfc_adapter *sa = dev->data->dev_private;
 374         int rc;
 375
 376         sfc_log_init(sa, "TxQ = %u, nb_tx_desc = %u, socket_id = %u",
 377                      tx_queue_id, nb_tx_desc, socket_id);
 378
 379         sfc_adapter_lock(sa);
 380
 381         rc = sfc_tx_qinit(sa, tx_queue_id, nb_tx_desc, socket_id, tx_conf);
 382         if (rc != 0)
 383                 goto fail_tx_qinit;
 384
 385         dev->data->tx_queues[tx_queue_id] = sa->txq_info[tx_queue_id].txq;
 386
 387         sfc_adapter_unlock(sa);
 388         return 0;
 389
 390 fail_tx_qinit:
 391         sfc_adapter_unlock(sa);
 392         SFC_ASSERT(rc > 0);
 393         return -rc;
 394 }
 395
 396 static void
 397 sfc_tx_queue_release(void *queue)
 398 {
 399         struct sfc_txq *txq = queue;
 400         unsigned int sw_index;
 401         struct sfc_adapter *sa;
 402
 403         if (txq == NULL)
 404                 return;
 405
 406         sw_index = sfc_txq_sw_index(txq);
 407
 408         SFC_ASSERT(txq->evq != NULL);
 409         sa = txq->evq->sa;
 410
 411         sfc_log_init(sa, "TxQ = %u", sw_index);
 412
 413         sfc_adapter_lock(sa);
 414
 415         SFC_ASSERT(sw_index < sa->eth_dev->data->nb_tx_queues);
 416         sa->eth_dev->data->tx_queues[sw_index] = NULL;
 417
 418         sfc_tx_qfini(sa, sw_index);
 419
 420         sfc_adapter_unlock(sa);
 421 }
 422
 423 static void
 424 sfc_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
 425 {
 426         struct sfc_adapter *sa = dev->data->dev_private;
 427         struct sfc_port *port = &sa->port;
 428         uint64_t *mac_stats;
 429
 430         rte_spinlock_lock(&port->mac_stats_lock);
 431
 432         if (sfc_port_update_mac_stats(sa) != 0)
 433                 goto unlock;
 434
 435         mac_stats = port->mac_stats_buf;
 436
 437         if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask,
 438                                    EFX_MAC_VADAPTER_RX_UNICAST_PACKETS)) {
 439                 stats->ipackets =
 440                         mac_stats[EFX_MAC_VADAPTER_RX_UNICAST_PACKETS] +
 441                         mac_stats[EFX_MAC_VADAPTER_RX_MULTICAST_PACKETS] +
 442                         mac_stats[EFX_MAC_VADAPTER_RX_BROADCAST_PACKETS];
 443                 stats->opackets =
 444                         mac_stats[EFX_MAC_VADAPTER_TX_UNICAST_PACKETS] +
 445                         mac_stats[EFX_MAC_VADAPTER_TX_MULTICAST_PACKETS] +
 446                         mac_stats[EFX_MAC_VADAPTER_TX_BROADCAST_PACKETS];
 447                 stats->ibytes =
 448                         mac_stats[EFX_MAC_VADAPTER_RX_UNICAST_BYTES] +
 449                         mac_stats[EFX_MAC_VADAPTER_RX_MULTICAST_BYTES] +
 450                         mac_stats[EFX_MAC_VADAPTER_RX_BROADCAST_BYTES];
 451                 stats->obytes =
 452                         mac_stats[EFX_MAC_VADAPTER_TX_UNICAST_BYTES] +
 453                         mac_stats[EFX_MAC_VADAPTER_TX_MULTICAST_BYTES] +
 454                         mac_stats[EFX_MAC_VADAPTER_TX_BROADCAST_BYTES];
 455                 stats->imissed = mac_stats[EFX_MAC_VADAPTER_RX_OVERFLOW];
 456                 stats->ierrors = mac_stats[EFX_MAC_VADAPTER_RX_BAD_PACKETS];
 457                 stats->oerrors = mac_stats[EFX_MAC_VADAPTER_TX_BAD_PACKETS];
 458         } else {
 459                 stats->ipackets = mac_stats[EFX_MAC_RX_PKTS];
 460                 stats->opackets = mac_stats[EFX_MAC_TX_PKTS];
 461                 stats->ibytes = mac_stats[EFX_MAC_RX_OCTETS];
 462                 stats->obytes = mac_stats[EFX_MAC_TX_OCTETS];
 463                 /*
 464                  * Take into account stats which are whenever supported
 465                  * on EF10. If some stat is not supported by current
 466                  * firmware variant or HW revision, it is guaranteed
 467                  * to be zero in mac_stats.
 468                  */
 469                 stats->imissed =
 470                         mac_stats[EFX_MAC_RX_NODESC_DROP_CNT] +
 471                         mac_stats[EFX_MAC_PM_TRUNC_BB_OVERFLOW] +
 472                         mac_stats[EFX_MAC_PM_DISCARD_BB_OVERFLOW] +
 473                         mac_stats[EFX_MAC_PM_TRUNC_VFIFO_FULL] +
 474                         mac_stats[EFX_MAC_PM_DISCARD_VFIFO_FULL] +
 475                         mac_stats[EFX_MAC_PM_TRUNC_QBB] +
 476                         mac_stats[EFX_MAC_PM_DISCARD_QBB] +
 477                         mac_stats[EFX_MAC_PM_DISCARD_MAPPING] +
 478                         mac_stats[EFX_MAC_RXDP_Q_DISABLED_PKTS] +
 479                         mac_stats[EFX_MAC_RXDP_DI_DROPPED_PKTS];
 480                 stats->ierrors =
 481                         mac_stats[EFX_MAC_RX_FCS_ERRORS] +
 482                         mac_stats[EFX_MAC_RX_ALIGN_ERRORS] +
 483                         mac_stats[EFX_MAC_RX_JABBER_PKTS];
 484                 /* no oerrors counters supported on EF10 */
 485         }
 486
 487 unlock:
 488         rte_spinlock_unlock(&port->mac_stats_lock);
 489 }
 490
 491 static int
 492 sfc_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
 493                unsigned int xstats_count)
 494 {
 495         struct sfc_adapter *sa = dev->data->dev_private;
 496         struct sfc_port *port = &sa->port;
 497         uint64_t *mac_stats;
 498         int rc;
 499         unsigned int i;
 500         int nstats = 0;
 501
 502         rte_spinlock_lock(&port->mac_stats_lock);
 503
 504         rc = sfc_port_update_mac_stats(sa);
 505         if (rc != 0) {
 506                 SFC_ASSERT(rc > 0);
 507                 nstats = -rc;
 508                 goto unlock;
 509         }
 510
 511         mac_stats = port->mac_stats_buf;
 512
 513         for (i = 0; i < EFX_MAC_NSTATS; ++i) {
 514                 if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask, i)) {
 515                         if (xstats != NULL && nstats < (int)xstats_count) {
 516                                 xstats[nstats].id = nstats;
 517                                 xstats[nstats].value = mac_stats[i];
 518                         }
 519                         nstats++;
 520                 }
 521         }
 522
 523 unlock:
 524         rte_spinlock_unlock(&port->mac_stats_lock);
 525
 526         return nstats;
 527 }
 528
 529 static int
 530 sfc_xstats_get_names(struct rte_eth_dev *dev,
 531                      struct rte_eth_xstat_name *xstats_names,
 532                      unsigned int xstats_count)
 533 {
 534         struct sfc_adapter *sa = dev->data->dev_private;
 535         struct sfc_port *port = &sa->port;
 536         unsigned int i;
 537         unsigned int nstats = 0;
 538
 539         for (i = 0; i < EFX_MAC_NSTATS; ++i) {
 540                 if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask, i)) {
 541                         if (xstats_names != NULL && nstats < xstats_count)
 542                                 strncpy(xstats_names[nstats].name,
 543                                         efx_mac_stat_name(sa->nic, i),
 544                                         sizeof(xstats_names[0].name));
 545                         nstats++;
 546                 }
 547         }
 548
 549         return nstats;
 550 }
 551
 552 static int
 553 sfc_flow_ctrl_get(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
 554 {
 555         struct sfc_adapter *sa = dev->data->dev_private;
 556         unsigned int wanted_fc, link_fc;
 557
 558         memset(fc_conf, 0, sizeof(*fc_conf));
 559
 560         sfc_adapter_lock(sa);
 561
 562         if (sa->state == SFC_ADAPTER_STARTED)
 563                 efx_mac_fcntl_get(sa->nic, &wanted_fc, &link_fc);
 564         else
 565                 link_fc = sa->port.flow_ctrl;
 566
 567         switch (link_fc) {
 568         case 0:
 569                 fc_conf->mode = RTE_FC_NONE;
 570                 break;
 571         case EFX_FCNTL_RESPOND:
 572                 fc_conf->mode = RTE_FC_RX_PAUSE;
 573                 break;
 574         case EFX_FCNTL_GENERATE:
 575                 fc_conf->mode = RTE_FC_TX_PAUSE;
 576                 break;
 577         case (EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE):
 578                 fc_conf->mode = RTE_FC_FULL;
 579                 break;
 580         default:
 581                 sfc_err(sa, "%s: unexpected flow control value %#x",
 582                         __func__, link_fc);
 583         }
 584
 585         fc_conf->autoneg = sa->port.flow_ctrl_autoneg;
 586
 587         sfc_adapter_unlock(sa);
 588
 589         return 0;
 590 }
 591
 592 static int
 593 sfc_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
 594 {
 595         struct sfc_adapter *sa = dev->data->dev_private;
 596         struct sfc_port *port = &sa->port;
 597         unsigned int fcntl;
 598         int rc;
 599
 600         if (fc_conf->high_water != 0 || fc_conf->low_water != 0 ||
 601             fc_conf->pause_time != 0 || fc_conf->send_xon != 0 ||
 602             fc_conf->mac_ctrl_frame_fwd != 0) {
 603                 sfc_err(sa, "unsupported flow control settings specified");
 604                 rc = EINVAL;
 605                 goto fail_inval;
 606         }
 607
 608         switch (fc_conf->mode) {
 609         case RTE_FC_NONE:
 610                 fcntl = 0;
 611                 break;
 612         case RTE_FC_RX_PAUSE:
 613                 fcntl = EFX_FCNTL_RESPOND;
 614                 break;
 615         case RTE_FC_TX_PAUSE:
 616                 fcntl = EFX_FCNTL_GENERATE;
 617                 break;
 618         case RTE_FC_FULL:
 619                 fcntl = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
 620                 break;
 621         default:
 622                 rc = EINVAL;
 623                 goto fail_inval;
 624         }
 625
 626         sfc_adapter_lock(sa);
 627
 628         if (sa->state == SFC_ADAPTER_STARTED) {
 629                 rc = efx_mac_fcntl_set(sa->nic, fcntl, fc_conf->autoneg);
 630                 if (rc != 0)
 631                         goto fail_mac_fcntl_set;
 632         }
 633
 634         port->flow_ctrl = fcntl;
 635         port->flow_ctrl_autoneg = fc_conf->autoneg;
 636
 637         sfc_adapter_unlock(sa);
 638
 639         return 0;
 640
 641 fail_mac_fcntl_set:
 642         sfc_adapter_unlock(sa);
 643 fail_inval:
 644         SFC_ASSERT(rc > 0);
 645         return -rc;
 646 }
 647
 648 static int
 649 sfc_dev_set_mtu(struct rte_eth_dev *dev, uint16_t mtu)
 650 {
 651         struct sfc_adapter *sa = dev->data->dev_private;
 652         size_t pdu = EFX_MAC_PDU(mtu);
 653         size_t old_pdu;
 654         int rc;
 655
 656         sfc_log_init(sa, "mtu=%u", mtu);
 657
 658         rc = EINVAL;
 659         if (pdu < EFX_MAC_PDU_MIN) {
 660                 sfc_err(sa, "too small MTU %u (PDU size %u less than min %u)",
 661                         (unsigned int)mtu, (unsigned int)pdu,
 662                         EFX_MAC_PDU_MIN);
 663                 goto fail_inval;
 664         }
 665         if (pdu > EFX_MAC_PDU_MAX) {
 666                 sfc_err(sa, "too big MTU %u (PDU size %u greater than max %u)",
 667                         (unsigned int)mtu, (unsigned int)pdu,
 668                         EFX_MAC_PDU_MAX);
 669                 goto fail_inval;
 670         }
 671
 672         sfc_adapter_lock(sa);
 673
 674         if (pdu != sa->port.pdu) {
 675                 if (sa->state == SFC_ADAPTER_STARTED) {
 676                         sfc_stop(sa);
 677
 678                         old_pdu = sa->port.pdu;
 679                         sa->port.pdu = pdu;
 680                         rc = sfc_start(sa);
 681                         if (rc != 0)
 682                                 goto fail_start;
 683                 } else {
 684                         sa->port.pdu = pdu;
 685                 }
 686         }
 687
 688         /*
 689          * The driver does not use it, but other PMDs update jumbo_frame
 690          * flag and max_rx_pkt_len when MTU is set.
 691          */
 692         dev->data->dev_conf.rxmode.jumbo_frame = (mtu > ETHER_MAX_LEN);
 693         dev->data->dev_conf.rxmode.max_rx_pkt_len = sa->port.pdu;
 694
 695         sfc_adapter_unlock(sa);
 696
 697         sfc_log_init(sa, "done");
 698         return 0;
 699
 700 fail_start:
 701         sa->port.pdu = old_pdu;
 702         if (sfc_start(sa) != 0)
 703                 sfc_err(sa, "cannot start with neither new (%u) nor old (%u) "
 704                         "PDU max size - port is stopped",
 705                         (unsigned int)pdu, (unsigned int)old_pdu);
 706         sfc_adapter_unlock(sa);
 707
 708 fail_inval:
 709         sfc_log_init(sa, "failed %d", rc);
 710         SFC_ASSERT(rc > 0);
 711         return -rc;
 712 }
 713 static void
 714 sfc_mac_addr_set(struct rte_eth_dev *dev, struct ether_addr *mac_addr)
 715 {
 716         struct sfc_adapter *sa = dev->data->dev_private;
 717         const efx_nic_cfg_t *encp = efx_nic_cfg_get(sa->nic);
 718         int rc;
 719
 720         sfc_adapter_lock(sa);
 721
 722         if (sa->state != SFC_ADAPTER_STARTED) {
 723                 sfc_info(sa, "the port is not started");
 724                 sfc_info(sa, "the new MAC address will be set on port start");
 725
 726                 goto unlock;
 727         }
 728
 729         if (encp->enc_allow_set_mac_with_installed_filters) {
 730                 rc = efx_mac_addr_set(sa->nic, mac_addr->addr_bytes);
 731                 if (rc != 0) {
 732                         sfc_err(sa, "cannot set MAC address (rc = %u)", rc);
 733                         goto unlock;
 734                 }
 735
 736                 /*
 737                  * Changing the MAC address by means of MCDI request
 738                  * has no effect on received traffic, therefore
 739                  * we also need to update unicast filters
 740                  */
 741                 rc = sfc_set_rx_mode(sa);
 742                 if (rc != 0)
 743                         sfc_err(sa, "cannot set filter (rc = %u)", rc);
 744         } else {
 745                 sfc_warn(sa, "cannot set MAC address with filters installed");
 746                 sfc_warn(sa, "adapter will be restarted to pick the new MAC");
 747                 sfc_warn(sa, "(some traffic may be dropped)");
 748
 749                 /*
 750                  * Since setting MAC address with filters installed is not
 751                  * allowed on the adapter, one needs to simply restart adapter
 752                  * so that the new MAC address will be taken from an outer
 753                  * storage and set flawlessly by means of sfc_start() call
 754                  */
 755                 sfc_stop(sa);
 756                 rc = sfc_start(sa);
 757                 if (rc != 0)
 758                         sfc_err(sa, "cannot restart adapter (rc = %u)", rc);
 759         }
 760
 761 unlock:
 762         sfc_adapter_unlock(sa);
 763 }
 764
 765
 766 static int
 767 sfc_set_mc_addr_list(struct rte_eth_dev *dev, struct ether_addr *mc_addr_set,
 768                      uint32_t nb_mc_addr)
 769 {
 770         struct sfc_adapter *sa = dev->data->dev_private;
 771         uint8_t *mc_addrs_p;
 772         uint8_t *mc_addrs;
 773         int rc;
 774         unsigned int i;
 775
 776         if (nb_mc_addr > EFX_MAC_MULTICAST_LIST_MAX) {
 777                 sfc_err(sa, "too many multicast addresses: %u > %u",
 778                          nb_mc_addr, EFX_MAC_MULTICAST_LIST_MAX);
 779                 return -EINVAL;
 780         }
 781
 782         mc_addrs_p = rte_calloc("mc-addrs", nb_mc_addr, EFX_MAC_ADDR_LEN, 0);
 783         if (mc_addrs_p == NULL)
 784                 return -ENOMEM;
 785
 786         mc_addrs = mc_addrs_p;
 787
 788         for (i = 0; i < nb_mc_addr; ++i) {
 789                 (void)rte_memcpy(mc_addrs, mc_addr_set[i].addr_bytes,
 790                                  EFX_MAC_ADDR_LEN);
 791                 mc_addrs += EFX_MAC_ADDR_LEN;
 792         }
 793
 794         rc = efx_mac_multicast_list_set(sa->nic, mc_addrs_p, nb_mc_addr);
 795
 796         rte_free(mc_addrs_p);
 797
 798         if (rc != 0)
 799                 sfc_err(sa, "cannot set multicast address list (rc = %u)", rc);
 800
 801         SFC_ASSERT(rc > 0);
 802         return -rc;
 803 }
 804
 805 static const struct eth_dev_ops sfc_eth_dev_ops = {
 806         .dev_configure                  = sfc_dev_configure,
 807         .dev_start                      = sfc_dev_start,
 808         .dev_stop                       = sfc_dev_stop,
 809         .dev_set_link_up                = sfc_dev_set_link_up,
 810         .dev_set_link_down              = sfc_dev_set_link_down,
 811         .dev_close                      = sfc_dev_close,
 812         .promiscuous_enable             = sfc_dev_promisc_enable,
 813         .promiscuous_disable            = sfc_dev_promisc_disable,
 814         .allmulticast_enable            = sfc_dev_allmulti_enable,
 815         .allmulticast_disable           = sfc_dev_allmulti_disable,
 816         .link_update                    = sfc_dev_link_update,
 817         .stats_get                      = sfc_stats_get,
 818         .xstats_get                     = sfc_xstats_get,
 819         .xstats_get_names               = sfc_xstats_get_names,
 820         .dev_infos_get                  = sfc_dev_infos_get,
 821         .mtu_set                        = sfc_dev_set_mtu,
 822         .rx_queue_setup                 = sfc_rx_queue_setup,
 823         .rx_queue_release               = sfc_rx_queue_release,
 824         .tx_queue_setup                 = sfc_tx_queue_setup,
 825         .tx_queue_release               = sfc_tx_queue_release,
 826         .flow_ctrl_get                  = sfc_flow_ctrl_get,
 827         .flow_ctrl_set                  = sfc_flow_ctrl_set,
 828         .mac_addr_set                   = sfc_mac_addr_set,
 829         .set_mc_addr_list               = sfc_set_mc_addr_list,
 830 };
 831
 832 static int
 833 sfc_eth_dev_init(struct rte_eth_dev *dev)
 834 {
 835         struct sfc_adapter *sa = dev->data->dev_private;
 836         struct rte_pci_device *pci_dev = SFC_DEV_TO_PCI(dev);
 837         int rc;
 838         const efx_nic_cfg_t *encp;
 839         const struct ether_addr *from;
 840
 841         /* Required for logging */
 842         sa->eth_dev = dev;
 843
 844         /* Copy PCI device info to the dev->data */
 845         rte_eth_copy_pci_info(dev, pci_dev);
 846
 847         rc = sfc_kvargs_parse(sa);
 848         if (rc != 0)
 849                 goto fail_kvargs_parse;
 850
 851         rc = sfc_kvargs_process(sa, SFC_KVARG_DEBUG_INIT,
 852                                 sfc_kvarg_bool_handler, &sa->debug_init);
 853         if (rc != 0)
 854                 goto fail_kvarg_debug_init;
 855
 856         sfc_log_init(sa, "entry");
 857
 858         dev->data->mac_addrs = rte_zmalloc("sfc", ETHER_ADDR_LEN, 0);
 859         if (dev->data->mac_addrs == NULL) {
 860                 rc = ENOMEM;
 861                 goto fail_mac_addrs;
 862         }
 863
 864         sfc_adapter_lock_init(sa);
 865         sfc_adapter_lock(sa);
 866
 867         sfc_log_init(sa, "attaching");
 868         rc = sfc_attach(sa);
 869         if (rc != 0)
 870                 goto fail_attach;
 871
 872         encp = efx_nic_cfg_get(sa->nic);
 873
 874         /*
 875          * The arguments are really reverse order in comparison to
 876          * Linux kernel. Copy from NIC config to Ethernet device data.
 877          */
 878         from = (const struct ether_addr *)(encp->enc_mac_addr);
 879         ether_addr_copy(from, &dev->data->mac_addrs[0]);
 880
 881         dev->dev_ops = &sfc_eth_dev_ops;
 882         dev->rx_pkt_burst = &sfc_recv_pkts;
 883         dev->tx_pkt_burst = &sfc_xmit_pkts;
 884
 885         sfc_adapter_unlock(sa);
 886
 887         sfc_log_init(sa, "done");
 888         return 0;
 889
 890 fail_attach:
 891         sfc_adapter_unlock(sa);
 892         sfc_adapter_lock_fini(sa);
 893         rte_free(dev->data->mac_addrs);
 894         dev->data->mac_addrs = NULL;
 895
 896 fail_mac_addrs:
 897 fail_kvarg_debug_init:
 898         sfc_kvargs_cleanup(sa);
 899
 900 fail_kvargs_parse:
 901         sfc_log_init(sa, "failed %d", rc);
 902         SFC_ASSERT(rc > 0);
 903         return -rc;
 904 }
 905
 906 static int
 907 sfc_eth_dev_uninit(struct rte_eth_dev *dev)
 908 {
 909         struct sfc_adapter *sa = dev->data->dev_private;
 910
 911         sfc_log_init(sa, "entry");
 912
 913         sfc_adapter_lock(sa);
 914
 915         sfc_detach(sa);
 916
 917         rte_free(dev->data->mac_addrs);
 918         dev->data->mac_addrs = NULL;
 919
 920         dev->dev_ops = NULL;
 921         dev->rx_pkt_burst = NULL;
 922         dev->tx_pkt_burst = NULL;
 923
 924         sfc_kvargs_cleanup(sa);
 925
 926         sfc_adapter_unlock(sa);
 927         sfc_adapter_lock_fini(sa);
 928
 929         sfc_log_init(sa, "done");
 930
 931         /* Required for logging, so cleanup last */
 932         sa->eth_dev = NULL;
 933         return 0;
 934 }
 935
 936 static const struct rte_pci_id pci_id_sfc_efx_map[] = {
 937         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_FARMINGDALE) },
 938         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_GREENPORT) },
 939         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_MEDFORD) },
 940         { .vendor_id = 0 /* sentinel */ }
 941 };
 942
 943 static struct eth_driver sfc_efx_pmd = {
 944         .pci_drv = {
 945                 .id_table = pci_id_sfc_efx_map,
 946                 .drv_flags =
 947                         RTE_PCI_DRV_INTR_LSC |
 948                         RTE_PCI_DRV_NEED_MAPPING,
 949                 .probe = rte_eth_dev_pci_probe,
 950                 .remove = rte_eth_dev_pci_remove,
 951         },
 952         .eth_dev_init = sfc_eth_dev_init,
 953         .eth_dev_uninit = sfc_eth_dev_uninit,
 954         .dev_private_size = sizeof(struct sfc_adapter),
 955 };
 956
 957 RTE_PMD_REGISTER_PCI(net_sfc_efx, sfc_efx_pmd.pci_drv);
 958 RTE_PMD_REGISTER_PCI_TABLE(net_sfc_efx, pci_id_sfc_efx_map);
 959 RTE_PMD_REGISTER_PARAM_STRING(net_sfc_efx,
 960         SFC_KVARG_PERF_PROFILE "=" SFC_KVARG_VALUES_PERF_PROFILE " "
 961         SFC_KVARG_MCDI_LOGGING "=" SFC_KVARG_VALUES_BOOL " "
 962         SFC_KVARG_DEBUG_INIT "=" SFC_KVARG_VALUES_BOOL);