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->tx_offload_capa =
  71                 DEV_TX_OFFLOAD_IPV4_CKSUM |
  72                 DEV_TX_OFFLOAD_UDP_CKSUM |
  73                 DEV_TX_OFFLOAD_TCP_CKSUM;
  74
  75         dev_info->default_txconf.txq_flags = ETH_TXQ_FLAGS_NOVLANOFFL |
  76                                              ETH_TXQ_FLAGS_NOXSUMSCTP;
  77
  78         dev_info->rx_desc_lim.nb_max = EFX_RXQ_MAXNDESCS;
  79         dev_info->rx_desc_lim.nb_min = EFX_RXQ_MINNDESCS;
  80         /* The RXQ hardware requires that the descriptor count is a power
  81          * of 2, but rx_desc_lim cannot properly describe that constraint.
  82          */
  83         dev_info->rx_desc_lim.nb_align = EFX_RXQ_MINNDESCS;
  84
  85         dev_info->tx_desc_lim.nb_max = sa->txq_max_entries;
  86         dev_info->tx_desc_lim.nb_min = EFX_TXQ_MINNDESCS;
  87         /*
  88          * The TXQ hardware requires that the descriptor count is a power
  89          * of 2, but tx_desc_lim cannot properly describe that constraint
  90          */
  91         dev_info->tx_desc_lim.nb_align = EFX_TXQ_MINNDESCS;
  92 }
  93
  94 static int
  95 sfc_dev_configure(struct rte_eth_dev *dev)
  96 {
  97         struct rte_eth_dev_data *dev_data = dev->data;
  98         struct sfc_adapter *sa = dev_data->dev_private;
  99         int rc;
 100
 101         sfc_log_init(sa, "entry n_rxq=%u n_txq=%u",
 102                      dev_data->nb_rx_queues, dev_data->nb_tx_queues);
 103
 104         sfc_adapter_lock(sa);
 105         switch (sa->state) {
 106         case SFC_ADAPTER_CONFIGURED:
 107                 sfc_close(sa);
 108                 SFC_ASSERT(sa->state == SFC_ADAPTER_INITIALIZED);
 109                 /* FALLTHROUGH */
 110         case SFC_ADAPTER_INITIALIZED:
 111                 rc = sfc_configure(sa);
 112                 break;
 113         default:
 114                 sfc_err(sa, "unexpected adapter state %u to configure",
 115                         sa->state);
 116                 rc = EINVAL;
 117                 break;
 118         }
 119         sfc_adapter_unlock(sa);
 120
 121         sfc_log_init(sa, "done %d", rc);
 122         SFC_ASSERT(rc >= 0);
 123         return -rc;
 124 }
 125
 126 static int
 127 sfc_dev_start(struct rte_eth_dev *dev)
 128 {
 129         struct sfc_adapter *sa = dev->data->dev_private;
 130         int rc;
 131
 132         sfc_log_init(sa, "entry");
 133
 134         sfc_adapter_lock(sa);
 135         rc = sfc_start(sa);
 136         sfc_adapter_unlock(sa);
 137
 138         sfc_log_init(sa, "done %d", rc);
 139         SFC_ASSERT(rc >= 0);
 140         return -rc;
 141 }
 142
 143 static int
 144 sfc_dev_link_update(struct rte_eth_dev *dev, int wait_to_complete)
 145 {
 146         struct sfc_adapter *sa = dev->data->dev_private;
 147         struct rte_eth_link *dev_link = &dev->data->dev_link;
 148         struct rte_eth_link old_link;
 149         struct rte_eth_link current_link;
 150
 151         sfc_log_init(sa, "entry");
 152
 153         if (sa->state != SFC_ADAPTER_STARTED)
 154                 return 0;
 155
 156 retry:
 157         EFX_STATIC_ASSERT(sizeof(*dev_link) == sizeof(rte_atomic64_t));
 158         *(int64_t *)&old_link = rte_atomic64_read((rte_atomic64_t *)dev_link);
 159
 160         if (wait_to_complete) {
 161                 efx_link_mode_t link_mode;
 162
 163                 efx_port_poll(sa->nic, &link_mode);
 164                 sfc_port_link_mode_to_info(link_mode, &current_link);
 165
 166                 if (!rte_atomic64_cmpset((volatile uint64_t *)dev_link,
 167                                          *(uint64_t *)&old_link,
 168                                          *(uint64_t *)&current_link))
 169                         goto retry;
 170         } else {
 171                 sfc_ev_mgmt_qpoll(sa);
 172                 *(int64_t *)&current_link =
 173                         rte_atomic64_read((rte_atomic64_t *)dev_link);
 174         }
 175
 176         if (old_link.link_status != current_link.link_status)
 177                 sfc_info(sa, "Link status is %s",
 178                          current_link.link_status ? "UP" : "DOWN");
 179
 180         return old_link.link_status == current_link.link_status ? 0 : -1;
 181 }
 182
 183 static void
 184 sfc_dev_stop(struct rte_eth_dev *dev)
 185 {
 186         struct sfc_adapter *sa = dev->data->dev_private;
 187
 188         sfc_log_init(sa, "entry");
 189
 190         sfc_adapter_lock(sa);
 191         sfc_stop(sa);
 192         sfc_adapter_unlock(sa);
 193
 194         sfc_log_init(sa, "done");
 195 }
 196
 197 static int
 198 sfc_dev_set_link_up(struct rte_eth_dev *dev)
 199 {
 200         struct sfc_adapter *sa = dev->data->dev_private;
 201         int rc;
 202
 203         sfc_log_init(sa, "entry");
 204
 205         sfc_adapter_lock(sa);
 206         rc = sfc_start(sa);
 207         sfc_adapter_unlock(sa);
 208
 209         SFC_ASSERT(rc >= 0);
 210         return -rc;
 211 }
 212
 213 static int
 214 sfc_dev_set_link_down(struct rte_eth_dev *dev)
 215 {
 216         struct sfc_adapter *sa = dev->data->dev_private;
 217
 218         sfc_log_init(sa, "entry");
 219
 220         sfc_adapter_lock(sa);
 221         sfc_stop(sa);
 222         sfc_adapter_unlock(sa);
 223
 224         return 0;
 225 }
 226
 227 static void
 228 sfc_dev_close(struct rte_eth_dev *dev)
 229 {
 230         struct sfc_adapter *sa = dev->data->dev_private;
 231
 232         sfc_log_init(sa, "entry");
 233
 234         sfc_adapter_lock(sa);
 235         switch (sa->state) {
 236         case SFC_ADAPTER_STARTED:
 237                 sfc_stop(sa);
 238                 SFC_ASSERT(sa->state == SFC_ADAPTER_CONFIGURED);
 239                 /* FALLTHROUGH */
 240         case SFC_ADAPTER_CONFIGURED:
 241                 sfc_close(sa);
 242                 SFC_ASSERT(sa->state == SFC_ADAPTER_INITIALIZED);
 243                 /* FALLTHROUGH */
 244         case SFC_ADAPTER_INITIALIZED:
 245                 break;
 246         default:
 247                 sfc_err(sa, "unexpected adapter state %u on close", sa->state);
 248                 break;
 249         }
 250         sfc_adapter_unlock(sa);
 251
 252         sfc_log_init(sa, "done");
 253 }
 254
 255 static int
 256 sfc_rx_queue_setup(struct rte_eth_dev *dev, uint16_t rx_queue_id,
 257                    uint16_t nb_rx_desc, unsigned int socket_id,
 258                    const struct rte_eth_rxconf *rx_conf,
 259                    struct rte_mempool *mb_pool)
 260 {
 261         struct sfc_adapter *sa = dev->data->dev_private;
 262         int rc;
 263
 264         sfc_log_init(sa, "RxQ=%u nb_rx_desc=%u socket_id=%u",
 265                      rx_queue_id, nb_rx_desc, socket_id);
 266
 267         sfc_adapter_lock(sa);
 268
 269         rc = sfc_rx_qinit(sa, rx_queue_id, nb_rx_desc, socket_id,
 270                           rx_conf, mb_pool);
 271         if (rc != 0)
 272                 goto fail_rx_qinit;
 273
 274         dev->data->rx_queues[rx_queue_id] = sa->rxq_info[rx_queue_id].rxq;
 275
 276         sfc_adapter_unlock(sa);
 277
 278         return 0;
 279
 280 fail_rx_qinit:
 281         sfc_adapter_unlock(sa);
 282         SFC_ASSERT(rc > 0);
 283         return -rc;
 284 }
 285
 286 static void
 287 sfc_rx_queue_release(void *queue)
 288 {
 289         struct sfc_rxq *rxq = queue;
 290         struct sfc_adapter *sa;
 291         unsigned int sw_index;
 292
 293         if (rxq == NULL)
 294                 return;
 295
 296         sa = rxq->evq->sa;
 297         sfc_adapter_lock(sa);
 298
 299         sw_index = sfc_rxq_sw_index(rxq);
 300
 301         sfc_log_init(sa, "RxQ=%u", sw_index);
 302
 303         sa->eth_dev->data->rx_queues[sw_index] = NULL;
 304
 305         sfc_rx_qfini(sa, sw_index);
 306
 307         sfc_adapter_unlock(sa);
 308 }
 309
 310 static int
 311 sfc_tx_queue_setup(struct rte_eth_dev *dev, uint16_t tx_queue_id,
 312                    uint16_t nb_tx_desc, unsigned int socket_id,
 313                    const struct rte_eth_txconf *tx_conf)
 314 {
 315         struct sfc_adapter *sa = dev->data->dev_private;
 316         int rc;
 317
 318         sfc_log_init(sa, "TxQ = %u, nb_tx_desc = %u, socket_id = %u",
 319                      tx_queue_id, nb_tx_desc, socket_id);
 320
 321         sfc_adapter_lock(sa);
 322
 323         rc = sfc_tx_qinit(sa, tx_queue_id, nb_tx_desc, socket_id, tx_conf);
 324         if (rc != 0)
 325                 goto fail_tx_qinit;
 326
 327         dev->data->tx_queues[tx_queue_id] = sa->txq_info[tx_queue_id].txq;
 328
 329         sfc_adapter_unlock(sa);
 330         return 0;
 331
 332 fail_tx_qinit:
 333         sfc_adapter_unlock(sa);
 334         SFC_ASSERT(rc > 0);
 335         return -rc;
 336 }
 337
 338 static void
 339 sfc_tx_queue_release(void *queue)
 340 {
 341         struct sfc_txq *txq = queue;
 342         unsigned int sw_index;
 343         struct sfc_adapter *sa;
 344
 345         if (txq == NULL)
 346                 return;
 347
 348         sw_index = sfc_txq_sw_index(txq);
 349
 350         SFC_ASSERT(txq->evq != NULL);
 351         sa = txq->evq->sa;
 352
 353         sfc_log_init(sa, "TxQ = %u", sw_index);
 354
 355         sfc_adapter_lock(sa);
 356
 357         SFC_ASSERT(sw_index < sa->eth_dev->data->nb_tx_queues);
 358         sa->eth_dev->data->tx_queues[sw_index] = NULL;
 359
 360         sfc_tx_qfini(sa, sw_index);
 361
 362         sfc_adapter_unlock(sa);
 363 }
 364
 365 static void
 366 sfc_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
 367 {
 368         struct sfc_adapter *sa = dev->data->dev_private;
 369         struct sfc_port *port = &sa->port;
 370         uint64_t *mac_stats;
 371
 372         rte_spinlock_lock(&port->mac_stats_lock);
 373
 374         if (sfc_port_update_mac_stats(sa) != 0)
 375                 goto unlock;
 376
 377         mac_stats = port->mac_stats_buf;
 378
 379         if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask,
 380                                    EFX_MAC_VADAPTER_RX_UNICAST_PACKETS)) {
 381                 stats->ipackets =
 382                         mac_stats[EFX_MAC_VADAPTER_RX_UNICAST_PACKETS] +
 383                         mac_stats[EFX_MAC_VADAPTER_RX_MULTICAST_PACKETS] +
 384                         mac_stats[EFX_MAC_VADAPTER_RX_BROADCAST_PACKETS];
 385                 stats->opackets =
 386                         mac_stats[EFX_MAC_VADAPTER_TX_UNICAST_PACKETS] +
 387                         mac_stats[EFX_MAC_VADAPTER_TX_MULTICAST_PACKETS] +
 388                         mac_stats[EFX_MAC_VADAPTER_TX_BROADCAST_PACKETS];
 389                 stats->ibytes =
 390                         mac_stats[EFX_MAC_VADAPTER_RX_UNICAST_BYTES] +
 391                         mac_stats[EFX_MAC_VADAPTER_RX_MULTICAST_BYTES] +
 392                         mac_stats[EFX_MAC_VADAPTER_RX_BROADCAST_BYTES];
 393                 stats->obytes =
 394                         mac_stats[EFX_MAC_VADAPTER_TX_UNICAST_BYTES] +
 395                         mac_stats[EFX_MAC_VADAPTER_TX_MULTICAST_BYTES] +
 396                         mac_stats[EFX_MAC_VADAPTER_TX_BROADCAST_BYTES];
 397                 stats->imissed = mac_stats[EFX_MAC_VADAPTER_RX_OVERFLOW];
 398                 stats->ierrors = mac_stats[EFX_MAC_VADAPTER_RX_BAD_PACKETS];
 399                 stats->oerrors = mac_stats[EFX_MAC_VADAPTER_TX_BAD_PACKETS];
 400         } else {
 401                 stats->ipackets = mac_stats[EFX_MAC_RX_PKTS];
 402                 stats->opackets = mac_stats[EFX_MAC_TX_PKTS];
 403                 stats->ibytes = mac_stats[EFX_MAC_RX_OCTETS];
 404                 stats->obytes = mac_stats[EFX_MAC_TX_OCTETS];
 405                 /*
 406                  * Take into account stats which are whenever supported
 407                  * on EF10. If some stat is not supported by current
 408                  * firmware variant or HW revision, it is guaranteed
 409                  * to be zero in mac_stats.
 410                  */
 411                 stats->imissed =
 412                         mac_stats[EFX_MAC_RX_NODESC_DROP_CNT] +
 413                         mac_stats[EFX_MAC_PM_TRUNC_BB_OVERFLOW] +
 414                         mac_stats[EFX_MAC_PM_DISCARD_BB_OVERFLOW] +
 415                         mac_stats[EFX_MAC_PM_TRUNC_VFIFO_FULL] +
 416                         mac_stats[EFX_MAC_PM_DISCARD_VFIFO_FULL] +
 417                         mac_stats[EFX_MAC_PM_TRUNC_QBB] +
 418                         mac_stats[EFX_MAC_PM_DISCARD_QBB] +
 419                         mac_stats[EFX_MAC_PM_DISCARD_MAPPING] +
 420                         mac_stats[EFX_MAC_RXDP_Q_DISABLED_PKTS] +
 421                         mac_stats[EFX_MAC_RXDP_DI_DROPPED_PKTS];
 422                 stats->ierrors =
 423                         mac_stats[EFX_MAC_RX_FCS_ERRORS] +
 424                         mac_stats[EFX_MAC_RX_ALIGN_ERRORS] +
 425                         mac_stats[EFX_MAC_RX_JABBER_PKTS];
 426                 /* no oerrors counters supported on EF10 */
 427         }
 428
 429 unlock:
 430         rte_spinlock_unlock(&port->mac_stats_lock);
 431 }
 432
 433 static int
 434 sfc_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
 435                unsigned int xstats_count)
 436 {
 437         struct sfc_adapter *sa = dev->data->dev_private;
 438         struct sfc_port *port = &sa->port;
 439         uint64_t *mac_stats;
 440         int rc;
 441         unsigned int i;
 442         int nstats = 0;
 443
 444         rte_spinlock_lock(&port->mac_stats_lock);
 445
 446         rc = sfc_port_update_mac_stats(sa);
 447         if (rc != 0) {
 448                 SFC_ASSERT(rc > 0);
 449                 nstats = -rc;
 450                 goto unlock;
 451         }
 452
 453         mac_stats = port->mac_stats_buf;
 454
 455         for (i = 0; i < EFX_MAC_NSTATS; ++i) {
 456                 if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask, i)) {
 457                         if (xstats != NULL && nstats < (int)xstats_count) {
 458                                 xstats[nstats].id = nstats;
 459                                 xstats[nstats].value = mac_stats[i];
 460                         }
 461                         nstats++;
 462                 }
 463         }
 464
 465 unlock:
 466         rte_spinlock_unlock(&port->mac_stats_lock);
 467
 468         return nstats;
 469 }
 470
 471 static int
 472 sfc_xstats_get_names(struct rte_eth_dev *dev,
 473                      struct rte_eth_xstat_name *xstats_names,
 474                      unsigned int xstats_count)
 475 {
 476         struct sfc_adapter *sa = dev->data->dev_private;
 477         struct sfc_port *port = &sa->port;
 478         unsigned int i;
 479         unsigned int nstats = 0;
 480
 481         for (i = 0; i < EFX_MAC_NSTATS; ++i) {
 482                 if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask, i)) {
 483                         if (xstats_names != NULL && nstats < xstats_count)
 484                                 strncpy(xstats_names[nstats].name,
 485                                         efx_mac_stat_name(sa->nic, i),
 486                                         sizeof(xstats_names[0].name));
 487                         nstats++;
 488                 }
 489         }
 490
 491         return nstats;
 492 }
 493
 494 static int
 495 sfc_flow_ctrl_get(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
 496 {
 497         struct sfc_adapter *sa = dev->data->dev_private;
 498         unsigned int wanted_fc, link_fc;
 499
 500         memset(fc_conf, 0, sizeof(*fc_conf));
 501
 502         sfc_adapter_lock(sa);
 503
 504         if (sa->state == SFC_ADAPTER_STARTED)
 505                 efx_mac_fcntl_get(sa->nic, &wanted_fc, &link_fc);
 506         else
 507                 link_fc = sa->port.flow_ctrl;
 508
 509         switch (link_fc) {
 510         case 0:
 511                 fc_conf->mode = RTE_FC_NONE;
 512                 break;
 513         case EFX_FCNTL_RESPOND:
 514                 fc_conf->mode = RTE_FC_RX_PAUSE;
 515                 break;
 516         case EFX_FCNTL_GENERATE:
 517                 fc_conf->mode = RTE_FC_TX_PAUSE;
 518                 break;
 519         case (EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE):
 520                 fc_conf->mode = RTE_FC_FULL;
 521                 break;
 522         default:
 523                 sfc_err(sa, "%s: unexpected flow control value %#x",
 524                         __func__, link_fc);
 525         }
 526
 527         fc_conf->autoneg = sa->port.flow_ctrl_autoneg;
 528
 529         sfc_adapter_unlock(sa);
 530
 531         return 0;
 532 }
 533
 534 static int
 535 sfc_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
 536 {
 537         struct sfc_adapter *sa = dev->data->dev_private;
 538         struct sfc_port *port = &sa->port;
 539         unsigned int fcntl;
 540         int rc;
 541
 542         if (fc_conf->high_water != 0 || fc_conf->low_water != 0 ||
 543             fc_conf->pause_time != 0 || fc_conf->send_xon != 0 ||
 544             fc_conf->mac_ctrl_frame_fwd != 0) {
 545                 sfc_err(sa, "unsupported flow control settings specified");
 546                 rc = EINVAL;
 547                 goto fail_inval;
 548         }
 549
 550         switch (fc_conf->mode) {
 551         case RTE_FC_NONE:
 552                 fcntl = 0;
 553                 break;
 554         case RTE_FC_RX_PAUSE:
 555                 fcntl = EFX_FCNTL_RESPOND;
 556                 break;
 557         case RTE_FC_TX_PAUSE:
 558                 fcntl = EFX_FCNTL_GENERATE;
 559                 break;
 560         case RTE_FC_FULL:
 561                 fcntl = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
 562                 break;
 563         default:
 564                 rc = EINVAL;
 565                 goto fail_inval;
 566         }
 567
 568         sfc_adapter_lock(sa);
 569
 570         if (sa->state == SFC_ADAPTER_STARTED) {
 571                 rc = efx_mac_fcntl_set(sa->nic, fcntl, fc_conf->autoneg);
 572                 if (rc != 0)
 573                         goto fail_mac_fcntl_set;
 574         }
 575
 576         port->flow_ctrl = fcntl;
 577         port->flow_ctrl_autoneg = fc_conf->autoneg;
 578
 579         sfc_adapter_unlock(sa);
 580
 581         return 0;
 582
 583 fail_mac_fcntl_set:
 584         sfc_adapter_unlock(sa);
 585 fail_inval:
 586         SFC_ASSERT(rc > 0);
 587         return -rc;
 588 }
 589
 590 static int
 591 sfc_dev_set_mtu(struct rte_eth_dev *dev, uint16_t mtu)
 592 {
 593         struct sfc_adapter *sa = dev->data->dev_private;
 594         size_t pdu = EFX_MAC_PDU(mtu);
 595         size_t old_pdu;
 596         int rc;
 597
 598         sfc_log_init(sa, "mtu=%u", mtu);
 599
 600         rc = EINVAL;
 601         if (pdu < EFX_MAC_PDU_MIN) {
 602                 sfc_err(sa, "too small MTU %u (PDU size %u less than min %u)",
 603                         (unsigned int)mtu, (unsigned int)pdu,
 604                         EFX_MAC_PDU_MIN);
 605                 goto fail_inval;
 606         }
 607         if (pdu > EFX_MAC_PDU_MAX) {
 608                 sfc_err(sa, "too big MTU %u (PDU size %u greater than max %u)",
 609                         (unsigned int)mtu, (unsigned int)pdu,
 610                         EFX_MAC_PDU_MAX);
 611                 goto fail_inval;
 612         }
 613
 614         sfc_adapter_lock(sa);
 615
 616         if (pdu != sa->port.pdu) {
 617                 if (sa->state == SFC_ADAPTER_STARTED) {
 618                         sfc_stop(sa);
 619
 620                         old_pdu = sa->port.pdu;
 621                         sa->port.pdu = pdu;
 622                         rc = sfc_start(sa);
 623                         if (rc != 0)
 624                                 goto fail_start;
 625                 } else {
 626                         sa->port.pdu = pdu;
 627                 }
 628         }
 629
 630         /*
 631          * The driver does not use it, but other PMDs update jumbo_frame
 632          * flag and max_rx_pkt_len when MTU is set.
 633          */
 634         dev->data->dev_conf.rxmode.jumbo_frame = (mtu > ETHER_MAX_LEN);
 635         dev->data->dev_conf.rxmode.max_rx_pkt_len = sa->port.pdu;
 636
 637         sfc_adapter_unlock(sa);
 638
 639         sfc_log_init(sa, "done");
 640         return 0;
 641
 642 fail_start:
 643         sa->port.pdu = old_pdu;
 644         if (sfc_start(sa) != 0)
 645                 sfc_err(sa, "cannot start with neither new (%u) nor old (%u) "
 646                         "PDU max size - port is stopped",
 647                         (unsigned int)pdu, (unsigned int)old_pdu);
 648         sfc_adapter_unlock(sa);
 649
 650 fail_inval:
 651         sfc_log_init(sa, "failed %d", rc);
 652         SFC_ASSERT(rc > 0);
 653         return -rc;
 654 }
 655
 656 static const struct eth_dev_ops sfc_eth_dev_ops = {
 657         .dev_configure                  = sfc_dev_configure,
 658         .dev_start                      = sfc_dev_start,
 659         .dev_stop                       = sfc_dev_stop,
 660         .dev_set_link_up                = sfc_dev_set_link_up,
 661         .dev_set_link_down              = sfc_dev_set_link_down,
 662         .dev_close                      = sfc_dev_close,
 663         .link_update                    = sfc_dev_link_update,
 664         .stats_get                      = sfc_stats_get,
 665         .xstats_get                     = sfc_xstats_get,
 666         .xstats_get_names               = sfc_xstats_get_names,
 667         .dev_infos_get                  = sfc_dev_infos_get,
 668         .mtu_set                        = sfc_dev_set_mtu,
 669         .rx_queue_setup                 = sfc_rx_queue_setup,
 670         .rx_queue_release               = sfc_rx_queue_release,
 671         .tx_queue_setup                 = sfc_tx_queue_setup,
 672         .tx_queue_release               = sfc_tx_queue_release,
 673         .flow_ctrl_get                  = sfc_flow_ctrl_get,
 674         .flow_ctrl_set                  = sfc_flow_ctrl_set,
 675 };
 676
 677 static int
 678 sfc_eth_dev_init(struct rte_eth_dev *dev)
 679 {
 680         struct sfc_adapter *sa = dev->data->dev_private;
 681         struct rte_pci_device *pci_dev = SFC_DEV_TO_PCI(dev);
 682         int rc;
 683         const efx_nic_cfg_t *encp;
 684         const struct ether_addr *from;
 685
 686         /* Required for logging */
 687         sa->eth_dev = dev;
 688
 689         /* Copy PCI device info to the dev->data */
 690         rte_eth_copy_pci_info(dev, pci_dev);
 691
 692         rc = sfc_kvargs_parse(sa);
 693         if (rc != 0)
 694                 goto fail_kvargs_parse;
 695
 696         rc = sfc_kvargs_process(sa, SFC_KVARG_DEBUG_INIT,
 697                                 sfc_kvarg_bool_handler, &sa->debug_init);
 698         if (rc != 0)
 699                 goto fail_kvarg_debug_init;
 700
 701         sfc_log_init(sa, "entry");
 702
 703         dev->data->mac_addrs = rte_zmalloc("sfc", ETHER_ADDR_LEN, 0);
 704         if (dev->data->mac_addrs == NULL) {
 705                 rc = ENOMEM;
 706                 goto fail_mac_addrs;
 707         }
 708
 709         sfc_adapter_lock_init(sa);
 710         sfc_adapter_lock(sa);
 711
 712         sfc_log_init(sa, "attaching");
 713         rc = sfc_attach(sa);
 714         if (rc != 0)
 715                 goto fail_attach;
 716
 717         encp = efx_nic_cfg_get(sa->nic);
 718
 719         /*
 720          * The arguments are really reverse order in comparison to
 721          * Linux kernel. Copy from NIC config to Ethernet device data.
 722          */
 723         from = (const struct ether_addr *)(encp->enc_mac_addr);
 724         ether_addr_copy(from, &dev->data->mac_addrs[0]);
 725
 726         dev->dev_ops = &sfc_eth_dev_ops;
 727         dev->rx_pkt_burst = &sfc_recv_pkts;
 728         dev->tx_pkt_burst = &sfc_xmit_pkts;
 729
 730         sfc_adapter_unlock(sa);
 731
 732         sfc_log_init(sa, "done");
 733         return 0;
 734
 735 fail_attach:
 736         sfc_adapter_unlock(sa);
 737         sfc_adapter_lock_fini(sa);
 738         rte_free(dev->data->mac_addrs);
 739         dev->data->mac_addrs = NULL;
 740
 741 fail_mac_addrs:
 742 fail_kvarg_debug_init:
 743         sfc_kvargs_cleanup(sa);
 744
 745 fail_kvargs_parse:
 746         sfc_log_init(sa, "failed %d", rc);
 747         SFC_ASSERT(rc > 0);
 748         return -rc;
 749 }
 750
 751 static int
 752 sfc_eth_dev_uninit(struct rte_eth_dev *dev)
 753 {
 754         struct sfc_adapter *sa = dev->data->dev_private;
 755
 756         sfc_log_init(sa, "entry");
 757
 758         sfc_adapter_lock(sa);
 759
 760         sfc_detach(sa);
 761
 762         rte_free(dev->data->mac_addrs);
 763         dev->data->mac_addrs = NULL;
 764
 765         dev->dev_ops = NULL;
 766         dev->rx_pkt_burst = NULL;
 767         dev->tx_pkt_burst = NULL;
 768
 769         sfc_kvargs_cleanup(sa);
 770
 771         sfc_adapter_unlock(sa);
 772         sfc_adapter_lock_fini(sa);
 773
 774         sfc_log_init(sa, "done");
 775
 776         /* Required for logging, so cleanup last */
 777         sa->eth_dev = NULL;
 778         return 0;
 779 }
 780
 781 static const struct rte_pci_id pci_id_sfc_efx_map[] = {
 782         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_FARMINGDALE) },
 783         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_GREENPORT) },
 784         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_MEDFORD) },
 785         { .vendor_id = 0 /* sentinel */ }
 786 };
 787
 788 static struct eth_driver sfc_efx_pmd = {
 789         .pci_drv = {
 790                 .id_table = pci_id_sfc_efx_map,
 791                 .drv_flags =
 792                         RTE_PCI_DRV_INTR_LSC |
 793                         RTE_PCI_DRV_NEED_MAPPING,
 794                 .probe = rte_eth_dev_pci_probe,
 795                 .remove = rte_eth_dev_pci_remove,
 796         },
 797         .eth_dev_init = sfc_eth_dev_init,
 798         .eth_dev_uninit = sfc_eth_dev_uninit,
 799         .dev_private_size = sizeof(struct sfc_adapter),
 800 };
 801
 802 RTE_PMD_REGISTER_PCI(net_sfc_efx, sfc_efx_pmd.pci_drv);
 803 RTE_PMD_REGISTER_PCI_TABLE(net_sfc_efx, pci_id_sfc_efx_map);
 804 RTE_PMD_REGISTER_PARAM_STRING(net_sfc_efx,
 805         SFC_KVARG_PERF_PROFILE "=" SFC_KVARG_VALUES_PERF_PROFILE " "
 806         SFC_KVARG_MCDI_LOGGING "=" SFC_KVARG_VALUES_BOOL " "
 807         SFC_KVARG_DEBUG_INIT "=" SFC_KVARG_VALUES_BOOL);