drivers/net/mlx5/mlx5_ethdev.c

   1 /*-
   2  *   BSD LICENSE
   3  *
   4  *   Copyright 2015 6WIND S.A.
   5  *   Copyright 2015 Mellanox.
   6  *
   7  *   Redistribution and use in source and binary forms, with or without
   8  *   modification, are permitted provided that the following conditions
   9  *   are met:
  10  *
  11  *     * Redistributions of source code must retain the above copyright
  12  *       notice, this list of conditions and the following disclaimer.
  13  *     * Redistributions in binary form must reproduce the above copyright
  14  *       notice, this list of conditions and the following disclaimer in
  15  *       the documentation and/or other materials provided with the
  16  *       distribution.
  17  *     * Neither the name of 6WIND S.A. nor the names of its
  18  *       contributors may be used to endorse or promote products derived
  19  *       from this software without specific prior written permission.
  20  *
  21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32  */
  33
  34 #include <stddef.h>
  35 #include <assert.h>
  36 #include <unistd.h>
  37 #include <stdint.h>
  38 #include <stdio.h>
  39 #include <string.h>
  40 #include <stdlib.h>
  41 #include <errno.h>
  42 #include <dirent.h>
  43 #include <net/if.h>
  44 #include <sys/ioctl.h>
  45 #include <sys/socket.h>
  46 #include <sys/utsname.h>
  47 #include <netinet/in.h>
  48 #include <linux/ethtool.h>
  49 #include <linux/sockios.h>
  50 #include <linux/version.h>
  51 #include <fcntl.h>
  52
  53 /* DPDK headers don't like -pedantic. */
  54 #ifdef PEDANTIC
  55 #pragma GCC diagnostic ignored "-Wpedantic"
  56 #endif
  57 #include <rte_atomic.h>
  58 #include <rte_ethdev.h>
  59 #include <rte_mbuf.h>
  60 #include <rte_common.h>
  61 #include <rte_interrupts.h>
  62 #include <rte_alarm.h>
  63 #include <rte_malloc.h>
  64 #ifdef PEDANTIC
  65 #pragma GCC diagnostic error "-Wpedantic"
  66 #endif
  67
  68 #include "mlx5.h"
  69 #include "mlx5_rxtx.h"
  70 #include "mlx5_utils.h"
  71
  72 /* Add defines in case the running kernel is not the same as user headers. */
  73 #ifndef ETHTOOL_GLINKSETTINGS
  74 struct ethtool_link_settings {
  75         uint32_t cmd;
  76         uint32_t speed;
  77         uint8_t duplex;
  78         uint8_t port;
  79         uint8_t phy_address;
  80         uint8_t autoneg;
  81         uint8_t mdio_support;
  82         uint8_t eth_to_mdix;
  83         uint8_t eth_tp_mdix_ctrl;
  84         int8_t link_mode_masks_nwords;
  85         uint32_t reserved[8];
  86         uint32_t link_mode_masks[];
  87 };
  88
  89 #define ETHTOOL_GLINKSETTINGS 0x0000004c
  90 #define ETHTOOL_LINK_MODE_1000baseT_Full_BIT 5
  91 #define ETHTOOL_LINK_MODE_Autoneg_BIT 6
  92 #define ETHTOOL_LINK_MODE_1000baseKX_Full_BIT 17
  93 #define ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT 18
  94 #define ETHTOOL_LINK_MODE_10000baseKR_Full_BIT 19
  95 #define ETHTOOL_LINK_MODE_10000baseR_FEC_BIT 20
  96 #define ETHTOOL_LINK_MODE_20000baseMLD2_Full_BIT 21
  97 #define ETHTOOL_LINK_MODE_20000baseKR2_Full_BIT 22
  98 #define ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT 23
  99 #define ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT 24
 100 #define ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT 25
 101 #define ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT 26
 102 #define ETHTOOL_LINK_MODE_56000baseKR4_Full_BIT 27
 103 #define ETHTOOL_LINK_MODE_56000baseCR4_Full_BIT 28
 104 #define ETHTOOL_LINK_MODE_56000baseSR4_Full_BIT 29
 105 #define ETHTOOL_LINK_MODE_56000baseLR4_Full_BIT 30
 106 #endif
 107 #ifndef HAVE_ETHTOOL_LINK_MODE_25G
 108 #define ETHTOOL_LINK_MODE_25000baseCR_Full_BIT 31
 109 #define ETHTOOL_LINK_MODE_25000baseKR_Full_BIT 32
 110 #define ETHTOOL_LINK_MODE_25000baseSR_Full_BIT 33
 111 #endif
 112 #ifndef HAVE_ETHTOOL_LINK_MODE_50G
 113 #define ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT 34
 114 #define ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT 35
 115 #endif
 116 #ifndef HAVE_ETHTOOL_LINK_MODE_100G
 117 #define ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT 36
 118 #define ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT 37
 119 #define ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT 38
 120 #define ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT 39
 121 #endif
 122
 123 /**
 124  * Return private structure associated with an Ethernet device.
 125  *
 126  * @param dev
 127  *   Pointer to Ethernet device structure.
 128  *
 129  * @return
 130  *   Pointer to private structure.
 131  */
 132 struct priv *
 133 mlx5_get_priv(struct rte_eth_dev *dev)
 134 {
 135         struct mlx5_secondary_data *sd;
 136
 137         if (!mlx5_is_secondary())
 138                 return dev->data->dev_private;
 139         sd = &mlx5_secondary_data[dev->data->port_id];
 140         return sd->data.dev_private;
 141 }
 142
 143 /**
 144  * Check if running as a secondary process.
 145  *
 146  * @return
 147  *   Nonzero if running as a secondary process.
 148  */
 149 inline int
 150 mlx5_is_secondary(void)
 151 {
 152         return rte_eal_process_type() != RTE_PROC_PRIMARY;
 153 }
 154
 155 /**
 156  * Get interface name from private structure.
 157  *
 158  * @param[in] priv
 159  *   Pointer to private structure.
 160  * @param[out] ifname
 161  *   Interface name output buffer.
 162  *
 163  * @return
 164  *   0 on success, -1 on failure and errno is set.
 165  */
 166 int
 167 priv_get_ifname(const struct priv *priv, char (*ifname)[IF_NAMESIZE])
 168 {
 169         DIR *dir;
 170         struct dirent *dent;
 171         unsigned int dev_type = 0;
 172         unsigned int dev_port_prev = ~0u;
 173         char match[IF_NAMESIZE] = "";
 174
 175         {
 176                 MKSTR(path, "%s/device/net", priv->ctx->device->ibdev_path);
 177
 178                 dir = opendir(path);
 179                 if (dir == NULL)
 180                         return -1;
 181         }
 182         while ((dent = readdir(dir)) != NULL) {
 183                 char *name = dent->d_name;
 184                 FILE *file;
 185                 unsigned int dev_port;
 186                 int r;
 187
 188                 if ((name[0] == '.') &&
 189                     ((name[1] == '\0') ||
 190                      ((name[1] == '.') && (name[2] == '\0'))))
 191                         continue;
 192
 193                 MKSTR(path, "%s/device/net/%s/%s",
 194                       priv->ctx->device->ibdev_path, name,
 195                       (dev_type ? "dev_id" : "dev_port"));
 196
 197                 file = fopen(path, "rb");
 198                 if (file == NULL) {
 199                         if (errno != ENOENT)
 200                                 continue;
 201                         /*
 202                          * Switch to dev_id when dev_port does not exist as
 203                          * is the case with Linux kernel versions < 3.15.
 204                          */
 205 try_dev_id:
 206                         match[0] = '\0';
 207                         if (dev_type)
 208                                 break;
 209                         dev_type = 1;
 210                         dev_port_prev = ~0u;
 211                         rewinddir(dir);
 212                         continue;
 213                 }
 214                 r = fscanf(file, (dev_type ? "%x" : "%u"), &dev_port);
 215                 fclose(file);
 216                 if (r != 1)
 217                         continue;
 218                 /*
 219                  * Switch to dev_id when dev_port returns the same value for
 220                  * all ports. May happen when using a MOFED release older than
 221                  * 3.0 with a Linux kernel >= 3.15.
 222                  */
 223                 if (dev_port == dev_port_prev)
 224                         goto try_dev_id;
 225                 dev_port_prev = dev_port;
 226                 if (dev_port == (priv->port - 1u))
 227                         snprintf(match, sizeof(match), "%s", name);
 228         }
 229         closedir(dir);
 230         if (match[0] == '\0')
 231                 return -1;
 232         strncpy(*ifname, match, sizeof(*ifname));
 233         return 0;
 234 }
 235
 236 /**
 237  * Check if the counter is located on ib counters file.
 238  *
 239  * @param[in] cntr
 240  *   Counter name.
 241  *
 242  * @return
 243  *   1 if counter is located on ib counters file , 0 otherwise.
 244  */
 245 int
 246 priv_is_ib_cntr(const char *cntr)
 247 {
 248         if (!strcmp(cntr, "out_of_buffer"))
 249                 return 1;
 250         return 0;
 251 }
 252
 253 /**
 254  * Read from sysfs entry.
 255  *
 256  * @param[in] priv
 257  *   Pointer to private structure.
 258  * @param[in] entry
 259  *   Entry name relative to sysfs path.
 260  * @param[out] buf
 261  *   Data output buffer.
 262  * @param size
 263  *   Buffer size.
 264  *
 265  * @return
 266  *   0 on success, -1 on failure and errno is set.
 267  */
 268 static int
 269 priv_sysfs_read(const struct priv *priv, const char *entry,
 270                 char *buf, size_t size)
 271 {
 272         char ifname[IF_NAMESIZE];
 273         FILE *file;
 274         int ret;
 275         int err;
 276
 277         if (priv_get_ifname(priv, &ifname))
 278                 return -1;
 279
 280         if (priv_is_ib_cntr(entry)) {
 281                 MKSTR(path, "%s/ports/1/hw_counters/%s",
 282                       priv->ctx->device->ibdev_path, entry);
 283                 file = fopen(path, "rb");
 284         } else {
 285                 MKSTR(path, "%s/device/net/%s/%s",
 286                       priv->ctx->device->ibdev_path, ifname, entry);
 287                 file = fopen(path, "rb");
 288         }
 289         if (file == NULL)
 290                 return -1;
 291         ret = fread(buf, 1, size, file);
 292         err = errno;
 293         if (((size_t)ret < size) && (ferror(file)))
 294                 ret = -1;
 295         else
 296                 ret = size;
 297         fclose(file);
 298         errno = err;
 299         return ret;
 300 }
 301
 302 /**
 303  * Write to sysfs entry.
 304  *
 305  * @param[in] priv
 306  *   Pointer to private structure.
 307  * @param[in] entry
 308  *   Entry name relative to sysfs path.
 309  * @param[in] buf
 310  *   Data buffer.
 311  * @param size
 312  *   Buffer size.
 313  *
 314  * @return
 315  *   0 on success, -1 on failure and errno is set.
 316  */
 317 static int
 318 priv_sysfs_write(const struct priv *priv, const char *entry,
 319                  char *buf, size_t size)
 320 {
 321         char ifname[IF_NAMESIZE];
 322         FILE *file;
 323         int ret;
 324         int err;
 325
 326         if (priv_get_ifname(priv, &ifname))
 327                 return -1;
 328
 329         MKSTR(path, "%s/device/net/%s/%s", priv->ctx->device->ibdev_path,
 330               ifname, entry);
 331
 332         file = fopen(path, "wb");
 333         if (file == NULL)
 334                 return -1;
 335         ret = fwrite(buf, 1, size, file);
 336         err = errno;
 337         if (((size_t)ret < size) || (ferror(file)))
 338                 ret = -1;
 339         else
 340                 ret = size;
 341         fclose(file);
 342         errno = err;
 343         return ret;
 344 }
 345
 346 /**
 347  * Get unsigned long sysfs property.
 348  *
 349  * @param priv
 350  *   Pointer to private structure.
 351  * @param[in] name
 352  *   Entry name relative to sysfs path.
 353  * @param[out] value
 354  *   Value output buffer.
 355  *
 356  * @return
 357  *   0 on success, -1 on failure and errno is set.
 358  */
 359 static int
 360 priv_get_sysfs_ulong(struct priv *priv, const char *name, unsigned long *value)
 361 {
 362         int ret;
 363         unsigned long value_ret;
 364         char value_str[32];
 365
 366         ret = priv_sysfs_read(priv, name, value_str, (sizeof(value_str) - 1));
 367         if (ret == -1) {
 368                 DEBUG("cannot read %s value from sysfs: %s",
 369                       name, strerror(errno));
 370                 return -1;
 371         }
 372         value_str[ret] = '\0';
 373         errno = 0;
 374         value_ret = strtoul(value_str, NULL, 0);
 375         if (errno) {
 376                 DEBUG("invalid %s value `%s': %s", name, value_str,
 377                       strerror(errno));
 378                 return -1;
 379         }
 380         *value = value_ret;
 381         return 0;
 382 }
 383
 384 /**
 385  * Set unsigned long sysfs property.
 386  *
 387  * @param priv
 388  *   Pointer to private structure.
 389  * @param[in] name
 390  *   Entry name relative to sysfs path.
 391  * @param value
 392  *   Value to set.
 393  *
 394  * @return
 395  *   0 on success, -1 on failure and errno is set.
 396  */
 397 static int
 398 priv_set_sysfs_ulong(struct priv *priv, const char *name, unsigned long value)
 399 {
 400         int ret;
 401         MKSTR(value_str, "%lu", value);
 402
 403         ret = priv_sysfs_write(priv, name, value_str, (sizeof(value_str) - 1));
 404         if (ret == -1) {
 405                 DEBUG("cannot write %s `%s' (%lu) to sysfs: %s",
 406                       name, value_str, value, strerror(errno));
 407                 return -1;
 408         }
 409         return 0;
 410 }
 411
 412 /**
 413  * Perform ifreq ioctl() on associated Ethernet device.
 414  *
 415  * @param[in] priv
 416  *   Pointer to private structure.
 417  * @param req
 418  *   Request number to pass to ioctl().
 419  * @param[out] ifr
 420  *   Interface request structure output buffer.
 421  *
 422  * @return
 423  *   0 on success, -1 on failure and errno is set.
 424  */
 425 int
 426 priv_ifreq(const struct priv *priv, int req, struct ifreq *ifr)
 427 {
 428         int sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_IP);
 429         int ret = -1;
 430
 431         if (sock == -1)
 432                 return ret;
 433         if (priv_get_ifname(priv, &ifr->ifr_name) == 0)
 434                 ret = ioctl(sock, req, ifr);
 435         close(sock);
 436         return ret;
 437 }
 438
 439 /**
 440  * Return the number of active VFs for the current device.
 441  *
 442  * @param[in] priv
 443  *   Pointer to private structure.
 444  * @param[out] num_vfs
 445  *   Number of active VFs.
 446  *
 447  * @return
 448  *   0 on success, -1 on failure and errno is set.
 449  */
 450 int
 451 priv_get_num_vfs(struct priv *priv, uint16_t *num_vfs)
 452 {
 453         /* The sysfs entry name depends on the operating system. */
 454         const char **name = (const char *[]){
 455                 "device/sriov_numvfs",
 456                 "device/mlx5_num_vfs",
 457                 NULL,
 458         };
 459         int ret;
 460
 461         do {
 462                 unsigned long ulong_num_vfs;
 463
 464                 ret = priv_get_sysfs_ulong(priv, *name, &ulong_num_vfs);
 465                 if (!ret)
 466                         *num_vfs = ulong_num_vfs;
 467         } while (*(++name) && ret);
 468         return ret;
 469 }
 470
 471 /**
 472  * Get device MTU.
 473  *
 474  * @param priv
 475  *   Pointer to private structure.
 476  * @param[out] mtu
 477  *   MTU value output buffer.
 478  *
 479  * @return
 480  *   0 on success, -1 on failure and errno is set.
 481  */
 482 int
 483 priv_get_mtu(struct priv *priv, uint16_t *mtu)
 484 {
 485         unsigned long ulong_mtu;
 486
 487         if (priv_get_sysfs_ulong(priv, "mtu", &ulong_mtu) == -1)
 488                 return -1;
 489         *mtu = ulong_mtu;
 490         return 0;
 491 }
 492
 493 /**
 494  * Read device counter from sysfs.
 495  *
 496  * @param priv
 497  *   Pointer to private structure.
 498  * @param name
 499  *   Counter name.
 500  * @param[out] cntr
 501  *   Counter output buffer.
 502  *
 503  * @return
 504  *   0 on success, -1 on failure and errno is set.
 505  */
 506 int
 507 priv_get_cntr_sysfs(struct priv *priv, const char *name, uint64_t *cntr)
 508 {
 509         unsigned long ulong_ctr;
 510
 511         if (priv_get_sysfs_ulong(priv, name, &ulong_ctr) == -1)
 512                 return -1;
 513         *cntr = ulong_ctr;
 514         return 0;
 515 }
 516
 517 /**
 518  * Set device MTU.
 519  *
 520  * @param priv
 521  *   Pointer to private structure.
 522  * @param mtu
 523  *   MTU value to set.
 524  *
 525  * @return
 526  *   0 on success, -1 on failure and errno is set.
 527  */
 528 static int
 529 priv_set_mtu(struct priv *priv, uint16_t mtu)
 530 {
 531         uint16_t new_mtu;
 532
 533         if (priv_set_sysfs_ulong(priv, "mtu", mtu) ||
 534             priv_get_mtu(priv, &new_mtu))
 535                 return -1;
 536         if (new_mtu == mtu)
 537                 return 0;
 538         errno = EINVAL;
 539         return -1;
 540 }
 541
 542 /**
 543  * Set device flags.
 544  *
 545  * @param priv
 546  *   Pointer to private structure.
 547  * @param keep
 548  *   Bitmask for flags that must remain untouched.
 549  * @param flags
 550  *   Bitmask for flags to modify.
 551  *
 552  * @return
 553  *   0 on success, -1 on failure and errno is set.
 554  */
 555 int
 556 priv_set_flags(struct priv *priv, unsigned int keep, unsigned int flags)
 557 {
 558         unsigned long tmp;
 559
 560         if (priv_get_sysfs_ulong(priv, "flags", &tmp) == -1)
 561                 return -1;
 562         tmp &= keep;
 563         tmp |= (flags & (~keep));
 564         return priv_set_sysfs_ulong(priv, "flags", tmp);
 565 }
 566
 567 /**
 568  * Ethernet device configuration.
 569  *
 570  * Prepare the driver for a given number of TX and RX queues.
 571  *
 572  * @param dev
 573  *   Pointer to Ethernet device structure.
 574  *
 575  * @return
 576  *   0 on success, errno value on failure.
 577  */
 578 static int
 579 dev_configure(struct rte_eth_dev *dev)
 580 {
 581         struct priv *priv = dev->data->dev_private;
 582         unsigned int rxqs_n = dev->data->nb_rx_queues;
 583         unsigned int txqs_n = dev->data->nb_tx_queues;
 584         unsigned int i;
 585         unsigned int j;
 586         unsigned int reta_idx_n;
 587
 588         priv->rss_hf = dev->data->dev_conf.rx_adv_conf.rss_conf.rss_hf;
 589         priv->rxqs = (void *)dev->data->rx_queues;
 590         priv->txqs = (void *)dev->data->tx_queues;
 591         if (txqs_n != priv->txqs_n) {
 592                 INFO("%p: TX queues number update: %u -> %u",
 593                      (void *)dev, priv->txqs_n, txqs_n);
 594                 priv->txqs_n = txqs_n;
 595         }
 596         if (rxqs_n > priv->ind_table_max_size) {
 597                 ERROR("cannot handle this many RX queues (%u)", rxqs_n);
 598                 return EINVAL;
 599         }
 600         if (rxqs_n == priv->rxqs_n)
 601                 return 0;
 602         INFO("%p: RX queues number update: %u -> %u",
 603              (void *)dev, priv->rxqs_n, rxqs_n);
 604         priv->rxqs_n = rxqs_n;
 605         /* If the requested number of RX queues is not a power of two, use the
 606          * maximum indirection table size for better balancing.
 607          * The result is always rounded to the next power of two. */
 608         reta_idx_n = (1 << log2above((rxqs_n & (rxqs_n - 1)) ?
 609                                      priv->ind_table_max_size :
 610                                      rxqs_n));
 611         if (priv_rss_reta_index_resize(priv, reta_idx_n))
 612                 return ENOMEM;
 613         /* When the number of RX queues is not a power of two, the remaining
 614          * table entries are padded with reused WQs and hashes are not spread
 615          * uniformly. */
 616         for (i = 0, j = 0; (i != reta_idx_n); ++i) {
 617                 (*priv->reta_idx)[i] = j;
 618                 if (++j == rxqs_n)
 619                         j = 0;
 620         }
 621         return 0;
 622 }
 623
 624 /**
 625  * DPDK callback for Ethernet device configuration.
 626  *
 627  * @param dev
 628  *   Pointer to Ethernet device structure.
 629  *
 630  * @return
 631  *   0 on success, negative errno value on failure.
 632  */
 633 int
 634 mlx5_dev_configure(struct rte_eth_dev *dev)
 635 {
 636         struct priv *priv = dev->data->dev_private;
 637         int ret;
 638
 639         if (mlx5_is_secondary())
 640                 return -E_RTE_SECONDARY;
 641
 642         priv_lock(priv);
 643         ret = dev_configure(dev);
 644         assert(ret >= 0);
 645         priv_unlock(priv);
 646         return -ret;
 647 }
 648
 649 /**
 650  * DPDK callback to get information about the device.
 651  *
 652  * @param dev
 653  *   Pointer to Ethernet device structure.
 654  * @param[out] info
 655  *   Info structure output buffer.
 656  */
 657 void
 658 mlx5_dev_infos_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *info)
 659 {
 660         struct priv *priv = mlx5_get_priv(dev);
 661         unsigned int max;
 662         char ifname[IF_NAMESIZE];
 663
 664         info->pci_dev = RTE_ETH_DEV_TO_PCI(dev);
 665
 666         priv_lock(priv);
 667         /* FIXME: we should ask the device for these values. */
 668         info->min_rx_bufsize = 32;
 669         info->max_rx_pktlen = 65536;
 670         /*
 671          * Since we need one CQ per QP, the limit is the minimum number
 672          * between the two values.
 673          */
 674         max = ((priv->device_attr.max_cq > priv->device_attr.max_qp) ?
 675                priv->device_attr.max_qp : priv->device_attr.max_cq);
 676         /* If max >= 65535 then max = 0, max_rx_queues is uint16_t. */
 677         if (max >= 65535)
 678                 max = 65535;
 679         info->max_rx_queues = max;
 680         info->max_tx_queues = max;
 681         info->max_mac_addrs = RTE_DIM(priv->mac);
 682         info->rx_offload_capa =
 683                 (priv->hw_csum ?
 684                  (DEV_RX_OFFLOAD_IPV4_CKSUM |
 685                   DEV_RX_OFFLOAD_UDP_CKSUM |
 686                   DEV_RX_OFFLOAD_TCP_CKSUM) :
 687                  0) |
 688                 (priv->hw_vlan_strip ? DEV_RX_OFFLOAD_VLAN_STRIP : 0);
 689         if (!priv->mps)
 690                 info->tx_offload_capa = DEV_TX_OFFLOAD_VLAN_INSERT;
 691         if (priv->hw_csum)
 692                 info->tx_offload_capa |=
 693                         (DEV_TX_OFFLOAD_IPV4_CKSUM |
 694                          DEV_TX_OFFLOAD_UDP_CKSUM |
 695                          DEV_TX_OFFLOAD_TCP_CKSUM);
 696         if (priv->tso)
 697                 info->tx_offload_capa |= DEV_TX_OFFLOAD_TCP_TSO;
 698         if (priv->tunnel_en)
 699                 info->tx_offload_capa |= (DEV_TX_OFFLOAD_OUTER_IPV4_CKSUM |
 700                                           DEV_TX_OFFLOAD_VXLAN_TNL_TSO |
 701                                           DEV_TX_OFFLOAD_GRE_TNL_TSO);
 702         if (priv_get_ifname(priv, &ifname) == 0)
 703                 info->if_index = if_nametoindex(ifname);
 704         info->reta_size = priv->reta_idx_n ?
 705                 priv->reta_idx_n : priv->ind_table_max_size;
 706         info->hash_key_size = ((*priv->rss_conf) ?
 707                                (*priv->rss_conf)[0]->rss_key_len :
 708                                0);
 709         info->speed_capa = priv->link_speed_capa;
 710         priv_unlock(priv);
 711 }
 712
 713 const uint32_t *
 714 mlx5_dev_supported_ptypes_get(struct rte_eth_dev *dev)
 715 {
 716         static const uint32_t ptypes[] = {
 717                 /* refers to rxq_cq_to_pkt_type() */
 718                 RTE_PTYPE_L3_IPV4_EXT_UNKNOWN,
 719                 RTE_PTYPE_L3_IPV6_EXT_UNKNOWN,
 720                 RTE_PTYPE_INNER_L3_IPV4_EXT_UNKNOWN,
 721                 RTE_PTYPE_INNER_L3_IPV6_EXT_UNKNOWN,
 722                 RTE_PTYPE_UNKNOWN
 723
 724         };
 725
 726         if (dev->rx_pkt_burst == mlx5_rx_burst)
 727                 return ptypes;
 728         return NULL;
 729 }
 730
 731 /**
 732  * DPDK callback to retrieve physical link information.
 733  *
 734  * @param dev
 735  *   Pointer to Ethernet device structure.
 736  * @param wait_to_complete
 737  *   Wait for request completion (ignored).
 738  */
 739 static int
 740 mlx5_link_update_unlocked_gset(struct rte_eth_dev *dev, int wait_to_complete)
 741 {
 742         struct priv *priv = mlx5_get_priv(dev);
 743         struct ethtool_cmd edata = {
 744                 .cmd = ETHTOOL_GSET /* Deprecated since Linux v4.5. */
 745         };
 746         struct ifreq ifr;
 747         struct rte_eth_link dev_link;
 748         int link_speed = 0;
 749
 750         /* priv_lock() is not taken to allow concurrent calls. */
 751
 752         (void)wait_to_complete;
 753         if (priv_ifreq(priv, SIOCGIFFLAGS, &ifr)) {
 754                 WARN("ioctl(SIOCGIFFLAGS) failed: %s", strerror(errno));
 755                 return -1;
 756         }
 757         memset(&dev_link, 0, sizeof(dev_link));
 758         dev_link.link_status = ((ifr.ifr_flags & IFF_UP) &&
 759                                 (ifr.ifr_flags & IFF_RUNNING));
 760         ifr.ifr_data = (void *)&edata;
 761         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
 762                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_GSET) failed: %s",
 763                      strerror(errno));
 764                 return -1;
 765         }
 766         link_speed = ethtool_cmd_speed(&edata);
 767         if (link_speed == -1)
 768                 dev_link.link_speed = 0;
 769         else
 770                 dev_link.link_speed = link_speed;
 771         priv->link_speed_capa = 0;
 772         if (edata.supported & SUPPORTED_Autoneg)
 773                 priv->link_speed_capa |= ETH_LINK_SPEED_AUTONEG;
 774         if (edata.supported & (SUPPORTED_1000baseT_Full |
 775                                SUPPORTED_1000baseKX_Full))
 776                 priv->link_speed_capa |= ETH_LINK_SPEED_1G;
 777         if (edata.supported & SUPPORTED_10000baseKR_Full)
 778                 priv->link_speed_capa |= ETH_LINK_SPEED_10G;
 779         if (edata.supported & (SUPPORTED_40000baseKR4_Full |
 780                                SUPPORTED_40000baseCR4_Full |
 781                                SUPPORTED_40000baseSR4_Full |
 782                                SUPPORTED_40000baseLR4_Full))
 783                 priv->link_speed_capa |= ETH_LINK_SPEED_40G;
 784         dev_link.link_duplex = ((edata.duplex == DUPLEX_HALF) ?
 785                                 ETH_LINK_HALF_DUPLEX : ETH_LINK_FULL_DUPLEX);
 786         dev_link.link_autoneg = !(dev->data->dev_conf.link_speeds &
 787                         ETH_LINK_SPEED_FIXED);
 788         if (memcmp(&dev_link, &dev->data->dev_link, sizeof(dev_link))) {
 789                 /* Link status changed. */
 790                 dev->data->dev_link = dev_link;
 791                 return 0;
 792         }
 793         /* Link status is still the same. */
 794         return -1;
 795 }
 796
 797 /**
 798  * Retrieve physical link information (unlocked version using new ioctl).
 799  *
 800  * @param dev
 801  *   Pointer to Ethernet device structure.
 802  * @param wait_to_complete
 803  *   Wait for request completion (ignored).
 804  */
 805 static int
 806 mlx5_link_update_unlocked_gs(struct rte_eth_dev *dev, int wait_to_complete)
 807 {
 808         struct priv *priv = mlx5_get_priv(dev);
 809         struct ethtool_link_settings edata = {
 810                 .cmd = ETHTOOL_GLINKSETTINGS,
 811         };
 812         struct ifreq ifr;
 813         struct rte_eth_link dev_link;
 814         uint64_t sc;
 815
 816         (void)wait_to_complete;
 817         if (priv_ifreq(priv, SIOCGIFFLAGS, &ifr)) {
 818                 WARN("ioctl(SIOCGIFFLAGS) failed: %s", strerror(errno));
 819                 return -1;
 820         }
 821         memset(&dev_link, 0, sizeof(dev_link));
 822         dev_link.link_status = ((ifr.ifr_flags & IFF_UP) &&
 823                                 (ifr.ifr_flags & IFF_RUNNING));
 824         ifr.ifr_data = (void *)&edata;
 825         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
 826                 DEBUG("ioctl(SIOCETHTOOL, ETHTOOL_GLINKSETTINGS) failed: %s",
 827                       strerror(errno));
 828                 return -1;
 829         }
 830         dev_link.link_speed = edata.speed;
 831         sc = edata.link_mode_masks[0] |
 832                 ((uint64_t)edata.link_mode_masks[1] << 32);
 833         priv->link_speed_capa = 0;
 834         if (sc & ETHTOOL_LINK_MODE_Autoneg_BIT)
 835                 priv->link_speed_capa |= ETH_LINK_SPEED_AUTONEG;
 836         if (sc & (ETHTOOL_LINK_MODE_1000baseT_Full_BIT |
 837                   ETHTOOL_LINK_MODE_1000baseKX_Full_BIT))
 838                 priv->link_speed_capa |= ETH_LINK_SPEED_1G;
 839         if (sc & (ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT |
 840                   ETHTOOL_LINK_MODE_10000baseKR_Full_BIT |
 841                   ETHTOOL_LINK_MODE_10000baseR_FEC_BIT))
 842                 priv->link_speed_capa |= ETH_LINK_SPEED_10G;
 843         if (sc & (ETHTOOL_LINK_MODE_20000baseMLD2_Full_BIT |
 844                   ETHTOOL_LINK_MODE_20000baseKR2_Full_BIT))
 845                 priv->link_speed_capa |= ETH_LINK_SPEED_20G;
 846         if (sc & (ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT |
 847                   ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT |
 848                   ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT |
 849                   ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT))
 850                 priv->link_speed_capa |= ETH_LINK_SPEED_40G;
 851         if (sc & (ETHTOOL_LINK_MODE_56000baseKR4_Full_BIT |
 852                   ETHTOOL_LINK_MODE_56000baseCR4_Full_BIT |
 853                   ETHTOOL_LINK_MODE_56000baseSR4_Full_BIT |
 854                   ETHTOOL_LINK_MODE_56000baseLR4_Full_BIT))
 855                 priv->link_speed_capa |= ETH_LINK_SPEED_56G;
 856         if (sc & (ETHTOOL_LINK_MODE_25000baseCR_Full_BIT |
 857                   ETHTOOL_LINK_MODE_25000baseKR_Full_BIT |
 858                   ETHTOOL_LINK_MODE_25000baseSR_Full_BIT))
 859                 priv->link_speed_capa |= ETH_LINK_SPEED_25G;
 860         if (sc & (ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT |
 861                   ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT))
 862                 priv->link_speed_capa |= ETH_LINK_SPEED_50G;
 863         if (sc & (ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT |
 864                   ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT |
 865                   ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT |
 866                   ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT))
 867                 priv->link_speed_capa |= ETH_LINK_SPEED_100G;
 868         dev_link.link_duplex = ((edata.duplex == DUPLEX_HALF) ?
 869                                 ETH_LINK_HALF_DUPLEX : ETH_LINK_FULL_DUPLEX);
 870         dev_link.link_autoneg = !(dev->data->dev_conf.link_speeds &
 871                                   ETH_LINK_SPEED_FIXED);
 872         if (memcmp(&dev_link, &dev->data->dev_link, sizeof(dev_link))) {
 873                 /* Link status changed. */
 874                 dev->data->dev_link = dev_link;
 875                 return 0;
 876         }
 877         /* Link status is still the same. */
 878         return -1;
 879 }
 880
 881 /**
 882  * DPDK callback to retrieve physical link information.
 883  *
 884  * @param dev
 885  *   Pointer to Ethernet device structure.
 886  * @param wait_to_complete
 887  *   Wait for request completion (ignored).
 888  */
 889 int
 890 mlx5_link_update(struct rte_eth_dev *dev, int wait_to_complete)
 891 {
 892         struct utsname utsname;
 893         int ver[3];
 894
 895         if (uname(&utsname) == -1 ||
 896             sscanf(utsname.release, "%d.%d.%d",
 897                    &ver[0], &ver[1], &ver[2]) != 3 ||
 898             KERNEL_VERSION(ver[0], ver[1], ver[2]) < KERNEL_VERSION(4, 9, 0))
 899                 return mlx5_link_update_unlocked_gset(dev, wait_to_complete);
 900         return mlx5_link_update_unlocked_gs(dev, wait_to_complete);
 901 }
 902
 903 /**
 904  * DPDK callback to change the MTU.
 905  *
 906  * Setting the MTU affects hardware MRU (packets larger than the MTU cannot be
 907  * received). Use this as a hint to enable/disable scattered packets support
 908  * and improve performance when not needed.
 909  * Since failure is not an option, reconfiguring queues on the fly is not
 910  * recommended.
 911  *
 912  * @param dev
 913  *   Pointer to Ethernet device structure.
 914  * @param in_mtu
 915  *   New MTU.
 916  *
 917  * @return
 918  *   0 on success, negative errno value on failure.
 919  */
 920 int
 921 mlx5_dev_set_mtu(struct rte_eth_dev *dev, uint16_t mtu)
 922 {
 923         struct priv *priv = dev->data->dev_private;
 924         int ret = 0;
 925         unsigned int i;
 926         unsigned int max_frame_len;
 927         int rehash;
 928         int restart = priv->started;
 929
 930         if (mlx5_is_secondary())
 931                 return -E_RTE_SECONDARY;
 932
 933         priv_lock(priv);
 934         /* Set kernel interface MTU first. */
 935         if (priv_set_mtu(priv, mtu)) {
 936                 ret = errno;
 937                 WARN("cannot set port %u MTU to %u: %s", priv->port, mtu,
 938                      strerror(ret));
 939                 goto out;
 940         } else
 941                 DEBUG("adapter port %u MTU set to %u", priv->port, mtu);
 942         /* Temporarily replace RX handler with a fake one, assuming it has not
 943          * been copied elsewhere. */
 944         dev->rx_pkt_burst = removed_rx_burst;
 945         /* Make sure everyone has left dev->rx_pkt_burst() and uses
 946          * removed_rx_burst() instead. */
 947         rte_wmb();
 948         usleep(1000);
 949         /* MTU does not include header and CRC. */
 950         max_frame_len = ETHER_HDR_LEN + mtu + ETHER_CRC_LEN;
 951         /* Check if at least one queue is going to need a SGE update. */
 952         for (i = 0; i != priv->rxqs_n; ++i) {
 953                 struct rxq *rxq = (*priv->rxqs)[i];
 954                 unsigned int mb_len;
 955                 unsigned int size = RTE_PKTMBUF_HEADROOM + max_frame_len;
 956                 unsigned int sges_n;
 957
 958                 if (rxq == NULL)
 959                         continue;
 960                 mb_len = rte_pktmbuf_data_room_size(rxq->mp);
 961                 assert(mb_len >= RTE_PKTMBUF_HEADROOM);
 962                 /*
 963                  * Determine the number of SGEs needed for a full packet
 964                  * and round it to the next power of two.
 965                  */
 966                 sges_n = log2above((size / mb_len) + !!(size % mb_len));
 967                 if (sges_n != rxq->sges_n)
 968                         break;
 969         }
 970         /*
 971          * If all queues have the right number of SGEs, a simple rehash
 972          * of their buffers is enough, otherwise SGE information can only
 973          * be updated in a queue by recreating it. All resources that depend
 974          * on queues (flows, indirection tables) must be recreated as well in
 975          * that case.
 976          */
 977         rehash = (i == priv->rxqs_n);
 978         if (!rehash) {
 979                 /* Clean up everything as with mlx5_dev_stop(). */
 980                 priv_special_flow_disable_all(priv);
 981                 priv_mac_addrs_disable(priv);
 982                 priv_destroy_hash_rxqs(priv);
 983                 priv_fdir_disable(priv);
 984                 priv_dev_interrupt_handler_uninstall(priv, dev);
 985         }
 986 recover:
 987         /* Reconfigure each RX queue. */
 988         for (i = 0; (i != priv->rxqs_n); ++i) {
 989                 struct rxq *rxq = (*priv->rxqs)[i];
 990                 struct rxq_ctrl *rxq_ctrl =
 991                         container_of(rxq, struct rxq_ctrl, rxq);
 992                 unsigned int mb_len;
 993                 unsigned int tmp;
 994
 995                 if (rxq == NULL)
 996                         continue;
 997                 mb_len = rte_pktmbuf_data_room_size(rxq->mp);
 998                 assert(mb_len >= RTE_PKTMBUF_HEADROOM);
 999                 /* Provide new values to rxq_setup(). */
1000                 dev->data->dev_conf.rxmode.jumbo_frame =
1001                         (max_frame_len > ETHER_MAX_LEN);
1002                 dev->data->dev_conf.rxmode.max_rx_pkt_len = max_frame_len;
1003                 if (rehash)
1004                         ret = rxq_rehash(dev, rxq_ctrl);
1005                 else
1006                         ret = rxq_ctrl_setup(dev, rxq_ctrl, 1 << rxq->elts_n,
1007                                              rxq_ctrl->socket, NULL, rxq->mp);
1008                 if (!ret)
1009                         continue;
1010                 /* Attempt to roll back in case of error. */
1011                 tmp = (mb_len << rxq->sges_n) - RTE_PKTMBUF_HEADROOM;
1012                 if (max_frame_len != tmp) {
1013                         max_frame_len = tmp;
1014                         goto recover;
1015                 }
1016                 /* Double fault, disable RX. */
1017                 break;
1018         }
1019         /* Mimic mlx5_dev_start(). */
1020         if (ret) {
1021                 ERROR("unable to reconfigure RX queues, RX disabled");
1022         } else if (restart &&
1023                    !rehash &&
1024                    !priv_create_hash_rxqs(priv) &&
1025                    !priv_rehash_flows(priv)) {
1026                 if (dev->data->dev_conf.fdir_conf.mode == RTE_FDIR_MODE_NONE)
1027                         priv_fdir_enable(priv);
1028                 priv_dev_interrupt_handler_install(priv, dev);
1029         }
1030         priv->mtu = mtu;
1031         /* Burst functions can now be called again. */
1032         rte_wmb();
1033         /*
1034          * Use a safe RX burst function in case of error, otherwise select RX
1035          * burst function again.
1036          */
1037         if (!ret)
1038                 priv_select_rx_function(priv);
1039 out:
1040         priv_unlock(priv);
1041         assert(ret >= 0);
1042         return -ret;
1043 }
1044
1045 /**
1046  * DPDK callback to get flow control status.
1047  *
1048  * @param dev
1049  *   Pointer to Ethernet device structure.
1050  * @param[out] fc_conf
1051  *   Flow control output buffer.
1052  *
1053  * @return
1054  *   0 on success, negative errno value on failure.
1055  */
1056 int
1057 mlx5_dev_get_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
1058 {
1059         struct priv *priv = dev->data->dev_private;
1060         struct ifreq ifr;
1061         struct ethtool_pauseparam ethpause = {
1062                 .cmd = ETHTOOL_GPAUSEPARAM
1063         };
1064         int ret;
1065
1066         if (mlx5_is_secondary())
1067                 return -E_RTE_SECONDARY;
1068
1069         ifr.ifr_data = (void *)&ethpause;
1070         priv_lock(priv);
1071         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
1072                 ret = errno;
1073                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_GPAUSEPARAM)"
1074                      " failed: %s",
1075                      strerror(ret));
1076                 goto out;
1077         }
1078
1079         fc_conf->autoneg = ethpause.autoneg;
1080         if (ethpause.rx_pause && ethpause.tx_pause)
1081                 fc_conf->mode = RTE_FC_FULL;
1082         else if (ethpause.rx_pause)
1083                 fc_conf->mode = RTE_FC_RX_PAUSE;
1084         else if (ethpause.tx_pause)
1085                 fc_conf->mode = RTE_FC_TX_PAUSE;
1086         else
1087                 fc_conf->mode = RTE_FC_NONE;
1088         ret = 0;
1089
1090 out:
1091         priv_unlock(priv);
1092         assert(ret >= 0);
1093         return -ret;
1094 }
1095
1096 /**
1097  * DPDK callback to modify flow control parameters.
1098  *
1099  * @param dev
1100  *   Pointer to Ethernet device structure.
1101  * @param[in] fc_conf
1102  *   Flow control parameters.
1103  *
1104  * @return
1105  *   0 on success, negative errno value on failure.
1106  */
1107 int
1108 mlx5_dev_set_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
1109 {
1110         struct priv *priv = dev->data->dev_private;
1111         struct ifreq ifr;
1112         struct ethtool_pauseparam ethpause = {
1113                 .cmd = ETHTOOL_SPAUSEPARAM
1114         };
1115         int ret;
1116
1117         if (mlx5_is_secondary())
1118                 return -E_RTE_SECONDARY;
1119
1120         ifr.ifr_data = (void *)&ethpause;
1121         ethpause.autoneg = fc_conf->autoneg;
1122         if (((fc_conf->mode & RTE_FC_FULL) == RTE_FC_FULL) ||
1123             (fc_conf->mode & RTE_FC_RX_PAUSE))
1124                 ethpause.rx_pause = 1;
1125         else
1126                 ethpause.rx_pause = 0;
1127
1128         if (((fc_conf->mode & RTE_FC_FULL) == RTE_FC_FULL) ||
1129             (fc_conf->mode & RTE_FC_TX_PAUSE))
1130                 ethpause.tx_pause = 1;
1131         else
1132                 ethpause.tx_pause = 0;
1133
1134         priv_lock(priv);
1135         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
1136                 ret = errno;
1137                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_SPAUSEPARAM)"
1138                      " failed: %s",
1139                      strerror(ret));
1140                 goto out;
1141         }
1142         ret = 0;
1143
1144 out:
1145         priv_unlock(priv);
1146         assert(ret >= 0);
1147         return -ret;
1148 }
1149
1150 /**
1151  * Get PCI information from struct ibv_device.
1152  *
1153  * @param device
1154  *   Pointer to Ethernet device structure.
1155  * @param[out] pci_addr
1156  *   PCI bus address output buffer.
1157  *
1158  * @return
1159  *   0 on success, -1 on failure and errno is set.
1160  */
1161 int
1162 mlx5_ibv_device_to_pci_addr(const struct ibv_device *device,
1163                             struct rte_pci_addr *pci_addr)
1164 {
1165         FILE *file;
1166         char line[32];
1167         MKSTR(path, "%s/device/uevent", device->ibdev_path);
1168
1169         file = fopen(path, "rb");
1170         if (file == NULL)
1171                 return -1;
1172         while (fgets(line, sizeof(line), file) == line) {
1173                 size_t len = strlen(line);
1174                 int ret;
1175
1176                 /* Truncate long lines. */
1177                 if (len == (sizeof(line) - 1))
1178                         while (line[(len - 1)] != '\n') {
1179                                 ret = fgetc(file);
1180                                 if (ret == EOF)
1181                                         break;
1182                                 line[(len - 1)] = ret;
1183                         }
1184                 /* Extract information. */
1185                 if (sscanf(line,
1186                            "PCI_SLOT_NAME="
1187                            "%" SCNx32 ":%" SCNx8 ":%" SCNx8 ".%" SCNx8 "\n",
1188                            &pci_addr->domain,
1189                            &pci_addr->bus,
1190                            &pci_addr->devid,
1191                            &pci_addr->function) == 4) {
1192                         ret = 0;
1193                         break;
1194                 }
1195         }
1196         fclose(file);
1197         return 0;
1198 }
1199
1200 /**
1201  * Link status handler.
1202  *
1203  * @param priv
1204  *   Pointer to private structure.
1205  * @param dev
1206  *   Pointer to the rte_eth_dev structure.
1207  *
1208  * @return
1209  *   Nonzero if the callback process can be called immediately.
1210  */
1211 static int
1212 priv_dev_link_status_handler(struct priv *priv, struct rte_eth_dev *dev)
1213 {
1214         struct ibv_async_event event;
1215         struct rte_eth_link *link = &dev->data->dev_link;
1216         int ret = 0;
1217
1218         /* Read all message and acknowledge them. */
1219         for (;;) {
1220                 if (ibv_get_async_event(priv->ctx, &event))
1221                         break;
1222
1223                 if (event.event_type != IBV_EVENT_PORT_ACTIVE &&
1224                     event.event_type != IBV_EVENT_PORT_ERR)
1225                         DEBUG("event type %d on port %d not handled",
1226                               event.event_type, event.element.port_num);
1227                 ibv_ack_async_event(&event);
1228         }
1229         mlx5_link_update(dev, 0);
1230         if (((link->link_speed == 0) && link->link_status) ||
1231             ((link->link_speed != 0) && !link->link_status)) {
1232                 if (!priv->pending_alarm) {
1233                         /* Inconsistent status, check again later. */
1234                         priv->pending_alarm = 1;
1235                         rte_eal_alarm_set(MLX5_ALARM_TIMEOUT_US,
1236                                           mlx5_dev_link_status_handler,
1237                                           dev);
1238                 }
1239         } else {
1240                 ret = 1;
1241         }
1242         return ret;
1243 }
1244
1245 /**
1246  * Handle delayed link status event.
1247  *
1248  * @param arg
1249  *   Registered argument.
1250  */
1251 void
1252 mlx5_dev_link_status_handler(void *arg)
1253 {
1254         struct rte_eth_dev *dev = arg;
1255         struct priv *priv = dev->data->dev_private;
1256         int ret;
1257
1258         priv_lock(priv);
1259         assert(priv->pending_alarm == 1);
1260         priv->pending_alarm = 0;
1261         ret = priv_dev_link_status_handler(priv, dev);
1262         priv_unlock(priv);
1263         if (ret)
1264                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC, NULL,
1265                                               NULL);
1266 }
1267
1268 /**
1269  * Handle interrupts from the NIC.
1270  *
1271  * @param[in] intr_handle
1272  *   Interrupt handler.
1273  * @param cb_arg
1274  *   Callback argument.
1275  */
1276 void
1277 mlx5_dev_interrupt_handler(void *cb_arg)
1278 {
1279         struct rte_eth_dev *dev = cb_arg;
1280         struct priv *priv = dev->data->dev_private;
1281         int ret;
1282
1283         priv_lock(priv);
1284         ret = priv_dev_link_status_handler(priv, dev);
1285         priv_unlock(priv);
1286         if (ret)
1287                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC, NULL,
1288                                               NULL);
1289 }
1290
1291 /**
1292  * Uninstall interrupt handler.
1293  *
1294  * @param priv
1295  *   Pointer to private structure.
1296  * @param dev
1297  *   Pointer to the rte_eth_dev structure.
1298  */
1299 void
1300 priv_dev_interrupt_handler_uninstall(struct priv *priv, struct rte_eth_dev *dev)
1301 {
1302         if (!dev->data->dev_conf.intr_conf.lsc)
1303                 return;
1304         rte_intr_callback_unregister(&priv->intr_handle,
1305                                      mlx5_dev_interrupt_handler,
1306                                      dev);
1307         if (priv->pending_alarm)
1308                 rte_eal_alarm_cancel(mlx5_dev_link_status_handler, dev);
1309         priv->pending_alarm = 0;
1310         priv->intr_handle.fd = 0;
1311         priv->intr_handle.type = RTE_INTR_HANDLE_UNKNOWN;
1312 }
1313
1314 /**
1315  * Install interrupt handler.
1316  *
1317  * @param priv
1318  *   Pointer to private structure.
1319  * @param dev
1320  *   Pointer to the rte_eth_dev structure.
1321  */
1322 void
1323 priv_dev_interrupt_handler_install(struct priv *priv, struct rte_eth_dev *dev)
1324 {
1325         int rc, flags;
1326
1327         if (!dev->data->dev_conf.intr_conf.lsc)
1328                 return;
1329         assert(priv->ctx->async_fd > 0);
1330         flags = fcntl(priv->ctx->async_fd, F_GETFL);
1331         rc = fcntl(priv->ctx->async_fd, F_SETFL, flags | O_NONBLOCK);
1332         if (rc < 0) {
1333                 INFO("failed to change file descriptor async event queue");
1334                 dev->data->dev_conf.intr_conf.lsc = 0;
1335         } else {
1336                 priv->intr_handle.fd = priv->ctx->async_fd;
1337                 priv->intr_handle.type = RTE_INTR_HANDLE_EXT;
1338                 rte_intr_callback_register(&priv->intr_handle,
1339                                            mlx5_dev_interrupt_handler,
1340                                            dev);
1341         }
1342 }
1343
1344 /**
1345  * Change the link state (UP / DOWN).
1346  *
1347  * @param priv
1348  *   Pointer to Ethernet device structure.
1349  * @param up
1350  *   Nonzero for link up, otherwise link down.
1351  *
1352  * @return
1353  *   0 on success, errno value on failure.
1354  */
1355 static int
1356 priv_set_link(struct priv *priv, int up)
1357 {
1358         struct rte_eth_dev *dev = priv->dev;
1359         int err;
1360
1361         if (up) {
1362                 err = priv_set_flags(priv, ~IFF_UP, IFF_UP);
1363                 if (err)
1364                         return err;
1365                 priv_select_tx_function(priv);
1366                 priv_select_rx_function(priv);
1367         } else {
1368                 err = priv_set_flags(priv, ~IFF_UP, ~IFF_UP);
1369                 if (err)
1370                         return err;
1371                 dev->rx_pkt_burst = removed_rx_burst;
1372                 dev->tx_pkt_burst = removed_tx_burst;
1373         }
1374         return 0;
1375 }
1376
1377 /**
1378  * DPDK callback to bring the link DOWN.
1379  *
1380  * @param dev
1381  *   Pointer to Ethernet device structure.
1382  *
1383  * @return
1384  *   0 on success, errno value on failure.
1385  */
1386 int
1387 mlx5_set_link_down(struct rte_eth_dev *dev)
1388 {
1389         struct priv *priv = dev->data->dev_private;
1390         int err;
1391
1392         priv_lock(priv);
1393         err = priv_set_link(priv, 0);
1394         priv_unlock(priv);
1395         return err;
1396 }
1397
1398 /**
1399  * DPDK callback to bring the link UP.
1400  *
1401  * @param dev
1402  *   Pointer to Ethernet device structure.
1403  *
1404  * @return
1405  *   0 on success, errno value on failure.
1406  */
1407 int
1408 mlx5_set_link_up(struct rte_eth_dev *dev)
1409 {
1410         struct priv *priv = dev->data->dev_private;
1411         int err;
1412
1413         priv_lock(priv);
1414         err = priv_set_link(priv, 1);
1415         priv_unlock(priv);
1416         return err;
1417 }
1418
1419 /**
1420  * Configure secondary process queues from a private data pointer (primary
1421  * or secondary) and update burst callbacks. Can take place only once.
1422  *
1423  * All queues must have been previously created by the primary process to
1424  * avoid undefined behavior.
1425  *
1426  * @param priv
1427  *   Private data pointer from either primary or secondary process.
1428  *
1429  * @return
1430  *   Private data pointer from secondary process, NULL in case of error.
1431  */
1432 struct priv *
1433 mlx5_secondary_data_setup(struct priv *priv)
1434 {
1435         unsigned int port_id = 0;
1436         struct mlx5_secondary_data *sd;
1437         void **tx_queues;
1438         void **rx_queues;
1439         unsigned int nb_tx_queues;
1440         unsigned int nb_rx_queues;
1441         unsigned int i;
1442
1443         /* priv must be valid at this point. */
1444         assert(priv != NULL);
1445         /* priv->dev must also be valid but may point to local memory from
1446          * another process, possibly with the same address and must not
1447          * be dereferenced yet. */
1448         assert(priv->dev != NULL);
1449         /* Determine port ID by finding out where priv comes from. */
1450         while (1) {
1451                 sd = &mlx5_secondary_data[port_id];
1452                 rte_spinlock_lock(&sd->lock);
1453                 /* Primary process? */
1454                 if (sd->primary_priv == priv)
1455                         break;
1456                 /* Secondary process? */
1457                 if (sd->data.dev_private == priv)
1458                         break;
1459                 rte_spinlock_unlock(&sd->lock);
1460                 if (++port_id == RTE_DIM(mlx5_secondary_data))
1461                         port_id = 0;
1462         }
1463         /* Switch to secondary private structure. If private data has already
1464          * been updated by another thread, there is nothing else to do. */
1465         priv = sd->data.dev_private;
1466         if (priv->dev->data == &sd->data)
1467                 goto end;
1468         /* Sanity checks. Secondary private structure is supposed to point
1469          * to local eth_dev, itself still pointing to the shared device data
1470          * structure allocated by the primary process. */
1471         assert(sd->shared_dev_data != &sd->data);
1472         assert(sd->data.nb_tx_queues == 0);
1473         assert(sd->data.tx_queues == NULL);
1474         assert(sd->data.nb_rx_queues == 0);
1475         assert(sd->data.rx_queues == NULL);
1476         assert(priv != sd->primary_priv);
1477         assert(priv->dev->data == sd->shared_dev_data);
1478         assert(priv->txqs_n == 0);
1479         assert(priv->txqs == NULL);
1480         assert(priv->rxqs_n == 0);
1481         assert(priv->rxqs == NULL);
1482         nb_tx_queues = sd->shared_dev_data->nb_tx_queues;
1483         nb_rx_queues = sd->shared_dev_data->nb_rx_queues;
1484         /* Allocate local storage for queues. */
1485         tx_queues = rte_zmalloc("secondary ethdev->tx_queues",
1486                                 sizeof(sd->data.tx_queues[0]) * nb_tx_queues,
1487                                 RTE_CACHE_LINE_SIZE);
1488         rx_queues = rte_zmalloc("secondary ethdev->rx_queues",
1489                                 sizeof(sd->data.rx_queues[0]) * nb_rx_queues,
1490                                 RTE_CACHE_LINE_SIZE);
1491         if (tx_queues == NULL || rx_queues == NULL)
1492                 goto error;
1493         /* Lock to prevent control operations during setup. */
1494         priv_lock(priv);
1495         /* TX queues. */
1496         for (i = 0; i != nb_tx_queues; ++i) {
1497                 struct txq *primary_txq = (*sd->primary_priv->txqs)[i];
1498                 struct txq_ctrl *primary_txq_ctrl;
1499                 struct txq_ctrl *txq_ctrl;
1500
1501                 if (primary_txq == NULL)
1502                         continue;
1503                 primary_txq_ctrl = container_of(primary_txq,
1504                                                 struct txq_ctrl, txq);
1505                 txq_ctrl = rte_calloc_socket("TXQ", 1, sizeof(*txq_ctrl) +
1506                                              (1 << primary_txq->elts_n) *
1507                                              sizeof(struct rte_mbuf *), 0,
1508                                              primary_txq_ctrl->socket);
1509                 if (txq_ctrl != NULL) {
1510                         if (txq_ctrl_setup(priv->dev,
1511                                            txq_ctrl,
1512                                            1 << primary_txq->elts_n,
1513                                            primary_txq_ctrl->socket,
1514                                            NULL) == 0) {
1515                                 txq_ctrl->txq.stats.idx =
1516                                         primary_txq->stats.idx;
1517                                 tx_queues[i] = &txq_ctrl->txq;
1518                                 continue;
1519                         }
1520                         rte_free(txq_ctrl);
1521                 }
1522                 while (i) {
1523                         txq_ctrl = tx_queues[--i];
1524                         txq_cleanup(txq_ctrl);
1525                         rte_free(txq_ctrl);
1526                 }
1527                 goto error;
1528         }
1529         /* RX queues. */
1530         for (i = 0; i != nb_rx_queues; ++i) {
1531                 struct rxq_ctrl *primary_rxq =
1532                         container_of((*sd->primary_priv->rxqs)[i],
1533                                      struct rxq_ctrl, rxq);
1534
1535                 if (primary_rxq == NULL)
1536                         continue;
1537                 /* Not supported yet. */
1538                 rx_queues[i] = NULL;
1539         }
1540         /* Update everything. */
1541         priv->txqs = (void *)tx_queues;
1542         priv->txqs_n = nb_tx_queues;
1543         priv->rxqs = (void *)rx_queues;
1544         priv->rxqs_n = nb_rx_queues;
1545         sd->data.rx_queues = rx_queues;
1546         sd->data.tx_queues = tx_queues;
1547         sd->data.nb_rx_queues = nb_rx_queues;
1548         sd->data.nb_tx_queues = nb_tx_queues;
1549         sd->data.dev_link = sd->shared_dev_data->dev_link;
1550         sd->data.mtu = sd->shared_dev_data->mtu;
1551         memcpy(sd->data.rx_queue_state, sd->shared_dev_data->rx_queue_state,
1552                sizeof(sd->data.rx_queue_state));
1553         memcpy(sd->data.tx_queue_state, sd->shared_dev_data->tx_queue_state,
1554                sizeof(sd->data.tx_queue_state));
1555         sd->data.dev_flags = sd->shared_dev_data->dev_flags;
1556         /* Use local data from now on. */
1557         rte_mb();
1558         priv->dev->data = &sd->data;
1559         rte_mb();
1560         priv_select_tx_function(priv);
1561         priv_select_rx_function(priv);
1562         priv_unlock(priv);
1563 end:
1564         /* More sanity checks. */
1565         assert(priv->dev->data == &sd->data);
1566         rte_spinlock_unlock(&sd->lock);
1567         return priv;
1568 error:
1569         priv_unlock(priv);
1570         rte_free(tx_queues);
1571         rte_free(rx_queues);
1572         rte_spinlock_unlock(&sd->lock);
1573         return NULL;
1574 }
1575
1576 /**
1577  * Configure the TX function to use.
1578  *
1579  * @param priv
1580  *   Pointer to private structure.
1581  */
1582 void
1583 priv_select_tx_function(struct priv *priv)
1584 {
1585         priv->dev->tx_pkt_burst = mlx5_tx_burst;
1586         /* Select appropriate TX function. */
1587         if (priv->mps == MLX5_MPW_ENHANCED) {
1588                 priv->dev->tx_pkt_burst =
1589                         mlx5_tx_burst_empw;
1590                 DEBUG("selected Enhanced MPW TX function");
1591         } else if (priv->mps && priv->txq_inline) {
1592                 priv->dev->tx_pkt_burst = mlx5_tx_burst_mpw_inline;
1593                 DEBUG("selected MPW inline TX function");
1594         } else if (priv->mps) {
1595                 priv->dev->tx_pkt_burst = mlx5_tx_burst_mpw;
1596                 DEBUG("selected MPW TX function");
1597         }
1598 }
1599
1600 /**
1601  * Configure the RX function to use.
1602  *
1603  * @param priv
1604  *   Pointer to private structure.
1605  */
1606 void
1607 priv_select_rx_function(struct priv *priv)
1608 {
1609         priv->dev->rx_pkt_burst = mlx5_rx_burst;
1610 }