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 <netinet/in.h>
  47 #include <linux/if.h>
  48 #include <linux/ethtool.h>
  49 #include <linux/sockios.h>
  50 #include <fcntl.h>
  51
  52 /* DPDK headers don't like -pedantic. */
  53 #ifdef PEDANTIC
  54 #pragma GCC diagnostic ignored "-pedantic"
  55 #endif
  56 #include <rte_atomic.h>
  57 #include <rte_ethdev.h>
  58 #include <rte_mbuf.h>
  59 #include <rte_common.h>
  60 #include <rte_interrupts.h>
  61 #include <rte_alarm.h>
  62 #ifdef PEDANTIC
  63 #pragma GCC diagnostic error "-pedantic"
  64 #endif
  65
  66 #include "mlx5.h"
  67 #include "mlx5_rxtx.h"
  68 #include "mlx5_utils.h"
  69
  70 /**
  71  * Get interface name from private structure.
  72  *
  73  * @param[in] priv
  74  *   Pointer to private structure.
  75  * @param[out] ifname
  76  *   Interface name output buffer.
  77  *
  78  * @return
  79  *   0 on success, -1 on failure and errno is set.
  80  */
  81 int
  82 priv_get_ifname(const struct priv *priv, char (*ifname)[IF_NAMESIZE])
  83 {
  84         DIR *dir;
  85         struct dirent *dent;
  86         unsigned int dev_type = 0;
  87         unsigned int dev_port_prev = ~0u;
  88         char match[IF_NAMESIZE] = "";
  89
  90         {
  91                 MKSTR(path, "%s/device/net", priv->ctx->device->ibdev_path);
  92
  93                 dir = opendir(path);
  94                 if (dir == NULL)
  95                         return -1;
  96         }
  97         while ((dent = readdir(dir)) != NULL) {
  98                 char *name = dent->d_name;
  99                 FILE *file;
 100                 unsigned int dev_port;
 101                 int r;
 102
 103                 if ((name[0] == '.') &&
 104                     ((name[1] == '\0') ||
 105                      ((name[1] == '.') && (name[2] == '\0'))))
 106                         continue;
 107
 108                 MKSTR(path, "%s/device/net/%s/%s",
 109                       priv->ctx->device->ibdev_path, name,
 110                       (dev_type ? "dev_id" : "dev_port"));
 111
 112                 file = fopen(path, "rb");
 113                 if (file == NULL) {
 114                         if (errno != ENOENT)
 115                                 continue;
 116                         /*
 117                          * Switch to dev_id when dev_port does not exist as
 118                          * is the case with Linux kernel versions < 3.15.
 119                          */
 120 try_dev_id:
 121                         match[0] = '\0';
 122                         if (dev_type)
 123                                 break;
 124                         dev_type = 1;
 125                         dev_port_prev = ~0u;
 126                         rewinddir(dir);
 127                         continue;
 128                 }
 129                 r = fscanf(file, (dev_type ? "%x" : "%u"), &dev_port);
 130                 fclose(file);
 131                 if (r != 1)
 132                         continue;
 133                 /*
 134                  * Switch to dev_id when dev_port returns the same value for
 135                  * all ports. May happen when using a MOFED release older than
 136                  * 3.0 with a Linux kernel >= 3.15.
 137                  */
 138                 if (dev_port == dev_port_prev)
 139                         goto try_dev_id;
 140                 dev_port_prev = dev_port;
 141                 if (dev_port == (priv->port - 1u))
 142                         snprintf(match, sizeof(match), "%s", name);
 143         }
 144         closedir(dir);
 145         if (match[0] == '\0')
 146                 return -1;
 147         strncpy(*ifname, match, sizeof(*ifname));
 148         return 0;
 149 }
 150
 151 /**
 152  * Read from sysfs entry.
 153  *
 154  * @param[in] priv
 155  *   Pointer to private structure.
 156  * @param[in] entry
 157  *   Entry name relative to sysfs path.
 158  * @param[out] buf
 159  *   Data output buffer.
 160  * @param size
 161  *   Buffer size.
 162  *
 163  * @return
 164  *   0 on success, -1 on failure and errno is set.
 165  */
 166 static int
 167 priv_sysfs_read(const struct priv *priv, const char *entry,
 168                 char *buf, size_t size)
 169 {
 170         char ifname[IF_NAMESIZE];
 171         FILE *file;
 172         int ret;
 173         int err;
 174
 175         if (priv_get_ifname(priv, &ifname))
 176                 return -1;
 177
 178         MKSTR(path, "%s/device/net/%s/%s", priv->ctx->device->ibdev_path,
 179               ifname, entry);
 180
 181         file = fopen(path, "rb");
 182         if (file == NULL)
 183                 return -1;
 184         ret = fread(buf, 1, size, file);
 185         err = errno;
 186         if (((size_t)ret < size) && (ferror(file)))
 187                 ret = -1;
 188         else
 189                 ret = size;
 190         fclose(file);
 191         errno = err;
 192         return ret;
 193 }
 194
 195 /**
 196  * Write to sysfs entry.
 197  *
 198  * @param[in] priv
 199  *   Pointer to private structure.
 200  * @param[in] entry
 201  *   Entry name relative to sysfs path.
 202  * @param[in] buf
 203  *   Data buffer.
 204  * @param size
 205  *   Buffer size.
 206  *
 207  * @return
 208  *   0 on success, -1 on failure and errno is set.
 209  */
 210 static int
 211 priv_sysfs_write(const struct priv *priv, const char *entry,
 212                  char *buf, size_t size)
 213 {
 214         char ifname[IF_NAMESIZE];
 215         FILE *file;
 216         int ret;
 217         int err;
 218
 219         if (priv_get_ifname(priv, &ifname))
 220                 return -1;
 221
 222         MKSTR(path, "%s/device/net/%s/%s", priv->ctx->device->ibdev_path,
 223               ifname, entry);
 224
 225         file = fopen(path, "wb");
 226         if (file == NULL)
 227                 return -1;
 228         ret = fwrite(buf, 1, size, file);
 229         err = errno;
 230         if (((size_t)ret < size) || (ferror(file)))
 231                 ret = -1;
 232         else
 233                 ret = size;
 234         fclose(file);
 235         errno = err;
 236         return ret;
 237 }
 238
 239 /**
 240  * Get unsigned long sysfs property.
 241  *
 242  * @param priv
 243  *   Pointer to private structure.
 244  * @param[in] name
 245  *   Entry name relative to sysfs path.
 246  * @param[out] value
 247  *   Value output buffer.
 248  *
 249  * @return
 250  *   0 on success, -1 on failure and errno is set.
 251  */
 252 static int
 253 priv_get_sysfs_ulong(struct priv *priv, const char *name, unsigned long *value)
 254 {
 255         int ret;
 256         unsigned long value_ret;
 257         char value_str[32];
 258
 259         ret = priv_sysfs_read(priv, name, value_str, (sizeof(value_str) - 1));
 260         if (ret == -1) {
 261                 DEBUG("cannot read %s value from sysfs: %s",
 262                       name, strerror(errno));
 263                 return -1;
 264         }
 265         value_str[ret] = '\0';
 266         errno = 0;
 267         value_ret = strtoul(value_str, NULL, 0);
 268         if (errno) {
 269                 DEBUG("invalid %s value `%s': %s", name, value_str,
 270                       strerror(errno));
 271                 return -1;
 272         }
 273         *value = value_ret;
 274         return 0;
 275 }
 276
 277 /**
 278  * Set unsigned long sysfs property.
 279  *
 280  * @param priv
 281  *   Pointer to private structure.
 282  * @param[in] name
 283  *   Entry name relative to sysfs path.
 284  * @param value
 285  *   Value to set.
 286  *
 287  * @return
 288  *   0 on success, -1 on failure and errno is set.
 289  */
 290 static int
 291 priv_set_sysfs_ulong(struct priv *priv, const char *name, unsigned long value)
 292 {
 293         int ret;
 294         MKSTR(value_str, "%lu", value);
 295
 296         ret = priv_sysfs_write(priv, name, value_str, (sizeof(value_str) - 1));
 297         if (ret == -1) {
 298                 DEBUG("cannot write %s `%s' (%lu) to sysfs: %s",
 299                       name, value_str, value, strerror(errno));
 300                 return -1;
 301         }
 302         return 0;
 303 }
 304
 305 /**
 306  * Perform ifreq ioctl() on associated Ethernet device.
 307  *
 308  * @param[in] priv
 309  *   Pointer to private structure.
 310  * @param req
 311  *   Request number to pass to ioctl().
 312  * @param[out] ifr
 313  *   Interface request structure output buffer.
 314  *
 315  * @return
 316  *   0 on success, -1 on failure and errno is set.
 317  */
 318 int
 319 priv_ifreq(const struct priv *priv, int req, struct ifreq *ifr)
 320 {
 321         int sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_IP);
 322         int ret = -1;
 323
 324         if (sock == -1)
 325                 return ret;
 326         if (priv_get_ifname(priv, &ifr->ifr_name) == 0)
 327                 ret = ioctl(sock, req, ifr);
 328         close(sock);
 329         return ret;
 330 }
 331
 332 /**
 333  * Get device MTU.
 334  *
 335  * @param priv
 336  *   Pointer to private structure.
 337  * @param[out] mtu
 338  *   MTU value output buffer.
 339  *
 340  * @return
 341  *   0 on success, -1 on failure and errno is set.
 342  */
 343 int
 344 priv_get_mtu(struct priv *priv, uint16_t *mtu)
 345 {
 346         unsigned long ulong_mtu;
 347
 348         if (priv_get_sysfs_ulong(priv, "mtu", &ulong_mtu) == -1)
 349                 return -1;
 350         *mtu = ulong_mtu;
 351         return 0;
 352 }
 353
 354 /**
 355  * Set device MTU.
 356  *
 357  * @param priv
 358  *   Pointer to private structure.
 359  * @param mtu
 360  *   MTU value to set.
 361  *
 362  * @return
 363  *   0 on success, -1 on failure and errno is set.
 364  */
 365 static int
 366 priv_set_mtu(struct priv *priv, uint16_t mtu)
 367 {
 368         return priv_set_sysfs_ulong(priv, "mtu", mtu);
 369 }
 370
 371 /**
 372  * Set device flags.
 373  *
 374  * @param priv
 375  *   Pointer to private structure.
 376  * @param keep
 377  *   Bitmask for flags that must remain untouched.
 378  * @param flags
 379  *   Bitmask for flags to modify.
 380  *
 381  * @return
 382  *   0 on success, -1 on failure and errno is set.
 383  */
 384 int
 385 priv_set_flags(struct priv *priv, unsigned int keep, unsigned int flags)
 386 {
 387         unsigned long tmp;
 388
 389         if (priv_get_sysfs_ulong(priv, "flags", &tmp) == -1)
 390                 return -1;
 391         tmp &= keep;
 392         tmp |= flags;
 393         return priv_set_sysfs_ulong(priv, "flags", tmp);
 394 }
 395
 396 /**
 397  * Ethernet device configuration.
 398  *
 399  * Prepare the driver for a given number of TX and RX queues.
 400  *
 401  * @param dev
 402  *   Pointer to Ethernet device structure.
 403  *
 404  * @return
 405  *   0 on success, errno value on failure.
 406  */
 407 static int
 408 dev_configure(struct rte_eth_dev *dev)
 409 {
 410         struct priv *priv = dev->data->dev_private;
 411         unsigned int rxqs_n = dev->data->nb_rx_queues;
 412         unsigned int txqs_n = dev->data->nb_tx_queues;
 413         unsigned int i;
 414         unsigned int j;
 415         unsigned int reta_idx_n;
 416
 417         priv->rxqs = (void *)dev->data->rx_queues;
 418         priv->txqs = (void *)dev->data->tx_queues;
 419         if (txqs_n != priv->txqs_n) {
 420                 INFO("%p: TX queues number update: %u -> %u",
 421                      (void *)dev, priv->txqs_n, txqs_n);
 422                 priv->txqs_n = txqs_n;
 423         }
 424         if (rxqs_n > priv->ind_table_max_size) {
 425                 ERROR("cannot handle this many RX queues (%u)", rxqs_n);
 426                 return EINVAL;
 427         }
 428         if (rxqs_n == priv->rxqs_n)
 429                 return 0;
 430         INFO("%p: RX queues number update: %u -> %u",
 431              (void *)dev, priv->rxqs_n, rxqs_n);
 432         priv->rxqs_n = rxqs_n;
 433         /* If the requested number of RX queues is not a power of two, use the
 434          * maximum indirection table size for better balancing.
 435          * The result is always rounded to the next power of two. */
 436         reta_idx_n = (1 << log2above((rxqs_n & (rxqs_n - 1)) ?
 437                                      priv->ind_table_max_size :
 438                                      rxqs_n));
 439         if (priv_rss_reta_index_resize(priv, reta_idx_n))
 440                 return ENOMEM;
 441         /* When the number of RX queues is not a power of two, the remaining
 442          * table entries are padded with reused WQs and hashes are not spread
 443          * uniformly. */
 444         for (i = 0, j = 0; (i != reta_idx_n); ++i) {
 445                 (*priv->reta_idx)[i] = j;
 446                 if (++j == rxqs_n)
 447                         j = 0;
 448         }
 449         return 0;
 450 }
 451
 452 /**
 453  * DPDK callback for Ethernet device configuration.
 454  *
 455  * @param dev
 456  *   Pointer to Ethernet device structure.
 457  *
 458  * @return
 459  *   0 on success, negative errno value on failure.
 460  */
 461 int
 462 mlx5_dev_configure(struct rte_eth_dev *dev)
 463 {
 464         struct priv *priv = dev->data->dev_private;
 465         int ret;
 466
 467         priv_lock(priv);
 468         ret = dev_configure(dev);
 469         assert(ret >= 0);
 470         priv_unlock(priv);
 471         return -ret;
 472 }
 473
 474 /**
 475  * DPDK callback to get information about the device.
 476  *
 477  * @param dev
 478  *   Pointer to Ethernet device structure.
 479  * @param[out] info
 480  *   Info structure output buffer.
 481  */
 482 void
 483 mlx5_dev_infos_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *info)
 484 {
 485         struct priv *priv = dev->data->dev_private;
 486         unsigned int max;
 487         char ifname[IF_NAMESIZE];
 488
 489         priv_lock(priv);
 490         /* FIXME: we should ask the device for these values. */
 491         info->min_rx_bufsize = 32;
 492         info->max_rx_pktlen = 65536;
 493         /*
 494          * Since we need one CQ per QP, the limit is the minimum number
 495          * between the two values.
 496          */
 497         max = ((priv->device_attr.max_cq > priv->device_attr.max_qp) ?
 498                priv->device_attr.max_qp : priv->device_attr.max_cq);
 499         /* If max >= 65535 then max = 0, max_rx_queues is uint16_t. */
 500         if (max >= 65535)
 501                 max = 65535;
 502         info->max_rx_queues = max;
 503         info->max_tx_queues = max;
 504         /* Last array entry is reserved for broadcast. */
 505         info->max_mac_addrs = (RTE_DIM(priv->mac) - 1);
 506         info->rx_offload_capa =
 507                 (priv->hw_csum ?
 508                  (DEV_RX_OFFLOAD_IPV4_CKSUM |
 509                   DEV_RX_OFFLOAD_UDP_CKSUM |
 510                   DEV_RX_OFFLOAD_TCP_CKSUM) :
 511                  0);
 512         info->tx_offload_capa =
 513                 (priv->hw_csum ?
 514                  (DEV_TX_OFFLOAD_IPV4_CKSUM |
 515                   DEV_TX_OFFLOAD_UDP_CKSUM |
 516                   DEV_TX_OFFLOAD_TCP_CKSUM) :
 517                  0);
 518         if (priv_get_ifname(priv, &ifname) == 0)
 519                 info->if_index = if_nametoindex(ifname);
 520         /* FIXME: RETA update/query API expects the callee to know the size of
 521          * the indirection table, for this PMD the size varies depending on
 522          * the number of RX queues, it becomes impossible to find the correct
 523          * size if it is not fixed.
 524          * The API should be updated to solve this problem. */
 525         info->reta_size = priv->ind_table_max_size;
 526         priv_unlock(priv);
 527 }
 528
 529 /**
 530  * DPDK callback to retrieve physical link information (unlocked version).
 531  *
 532  * @param dev
 533  *   Pointer to Ethernet device structure.
 534  * @param wait_to_complete
 535  *   Wait for request completion (ignored).
 536  */
 537 static int
 538 mlx5_link_update_unlocked(struct rte_eth_dev *dev, int wait_to_complete)
 539 {
 540         struct priv *priv = dev->data->dev_private;
 541         struct ethtool_cmd edata = {
 542                 .cmd = ETHTOOL_GSET
 543         };
 544         struct ifreq ifr;
 545         struct rte_eth_link dev_link;
 546         int link_speed = 0;
 547
 548         (void)wait_to_complete;
 549         if (priv_ifreq(priv, SIOCGIFFLAGS, &ifr)) {
 550                 WARN("ioctl(SIOCGIFFLAGS) failed: %s", strerror(errno));
 551                 return -1;
 552         }
 553         memset(&dev_link, 0, sizeof(dev_link));
 554         dev_link.link_status = ((ifr.ifr_flags & IFF_UP) &&
 555                                 (ifr.ifr_flags & IFF_RUNNING));
 556         ifr.ifr_data = &edata;
 557         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
 558                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_GSET) failed: %s",
 559                      strerror(errno));
 560                 return -1;
 561         }
 562         link_speed = ethtool_cmd_speed(&edata);
 563         if (link_speed == -1)
 564                 dev_link.link_speed = 0;
 565         else
 566                 dev_link.link_speed = link_speed;
 567         dev_link.link_duplex = ((edata.duplex == DUPLEX_HALF) ?
 568                                 ETH_LINK_HALF_DUPLEX : ETH_LINK_FULL_DUPLEX);
 569         if (memcmp(&dev_link, &dev->data->dev_link, sizeof(dev_link))) {
 570                 /* Link status changed. */
 571                 dev->data->dev_link = dev_link;
 572                 return 0;
 573         }
 574         /* Link status is still the same. */
 575         return -1;
 576 }
 577
 578 /**
 579  * DPDK callback to retrieve physical link information.
 580  *
 581  * @param dev
 582  *   Pointer to Ethernet device structure.
 583  * @param wait_to_complete
 584  *   Wait for request completion (ignored).
 585  */
 586 int
 587 mlx5_link_update(struct rte_eth_dev *dev, int wait_to_complete)
 588 {
 589         struct priv *priv = dev->data->dev_private;
 590         int ret;
 591
 592         priv_lock(priv);
 593         ret = mlx5_link_update_unlocked(dev, wait_to_complete);
 594         priv_unlock(priv);
 595         return ret;
 596 }
 597
 598 /**
 599  * DPDK callback to change the MTU.
 600  *
 601  * Setting the MTU affects hardware MRU (packets larger than the MTU cannot be
 602  * received). Use this as a hint to enable/disable scattered packets support
 603  * and improve performance when not needed.
 604  * Since failure is not an option, reconfiguring queues on the fly is not
 605  * recommended.
 606  *
 607  * @param dev
 608  *   Pointer to Ethernet device structure.
 609  * @param in_mtu
 610  *   New MTU.
 611  *
 612  * @return
 613  *   0 on success, negative errno value on failure.
 614  */
 615 int
 616 mlx5_dev_set_mtu(struct rte_eth_dev *dev, uint16_t mtu)
 617 {
 618         struct priv *priv = dev->data->dev_private;
 619         int ret = 0;
 620         unsigned int i;
 621         uint16_t (*rx_func)(void *, struct rte_mbuf **, uint16_t) =
 622                 mlx5_rx_burst;
 623
 624         priv_lock(priv);
 625         /* Set kernel interface MTU first. */
 626         if (priv_set_mtu(priv, mtu)) {
 627                 ret = errno;
 628                 WARN("cannot set port %u MTU to %u: %s", priv->port, mtu,
 629                      strerror(ret));
 630                 goto out;
 631         } else
 632                 DEBUG("adapter port %u MTU set to %u", priv->port, mtu);
 633         priv->mtu = mtu;
 634         /* Temporarily replace RX handler with a fake one, assuming it has not
 635          * been copied elsewhere. */
 636         dev->rx_pkt_burst = removed_rx_burst;
 637         /* Make sure everyone has left mlx5_rx_burst() and uses
 638          * removed_rx_burst() instead. */
 639         rte_wmb();
 640         usleep(1000);
 641         /* Reconfigure each RX queue. */
 642         for (i = 0; (i != priv->rxqs_n); ++i) {
 643                 struct rxq *rxq = (*priv->rxqs)[i];
 644                 unsigned int max_frame_len;
 645                 int sp;
 646
 647                 if (rxq == NULL)
 648                         continue;
 649                 /* Calculate new maximum frame length according to MTU and
 650                  * toggle scattered support (sp) if necessary. */
 651                 max_frame_len = (priv->mtu + ETHER_HDR_LEN +
 652                                  (ETHER_MAX_VLAN_FRAME_LEN - ETHER_MAX_LEN));
 653                 sp = (max_frame_len > (rxq->mb_len - RTE_PKTMBUF_HEADROOM));
 654                 /* Provide new values to rxq_setup(). */
 655                 dev->data->dev_conf.rxmode.jumbo_frame = sp;
 656                 dev->data->dev_conf.rxmode.max_rx_pkt_len = max_frame_len;
 657                 ret = rxq_rehash(dev, rxq);
 658                 if (ret) {
 659                         /* Force SP RX if that queue requires it and abort. */
 660                         if (rxq->sp)
 661                                 rx_func = mlx5_rx_burst_sp;
 662                         break;
 663                 }
 664                 /* Scattered burst function takes priority. */
 665                 if (rxq->sp)
 666                         rx_func = mlx5_rx_burst_sp;
 667         }
 668         /* Burst functions can now be called again. */
 669         rte_wmb();
 670         dev->rx_pkt_burst = rx_func;
 671 out:
 672         priv_unlock(priv);
 673         assert(ret >= 0);
 674         return -ret;
 675 }
 676
 677 /**
 678  * DPDK callback to get flow control status.
 679  *
 680  * @param dev
 681  *   Pointer to Ethernet device structure.
 682  * @param[out] fc_conf
 683  *   Flow control output buffer.
 684  *
 685  * @return
 686  *   0 on success, negative errno value on failure.
 687  */
 688 int
 689 mlx5_dev_get_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
 690 {
 691         struct priv *priv = dev->data->dev_private;
 692         struct ifreq ifr;
 693         struct ethtool_pauseparam ethpause = {
 694                 .cmd = ETHTOOL_GPAUSEPARAM
 695         };
 696         int ret;
 697
 698         ifr.ifr_data = &ethpause;
 699         priv_lock(priv);
 700         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
 701                 ret = errno;
 702                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_GPAUSEPARAM)"
 703                      " failed: %s",
 704                      strerror(ret));
 705                 goto out;
 706         }
 707
 708         fc_conf->autoneg = ethpause.autoneg;
 709         if (ethpause.rx_pause && ethpause.tx_pause)
 710                 fc_conf->mode = RTE_FC_FULL;
 711         else if (ethpause.rx_pause)
 712                 fc_conf->mode = RTE_FC_RX_PAUSE;
 713         else if (ethpause.tx_pause)
 714                 fc_conf->mode = RTE_FC_TX_PAUSE;
 715         else
 716                 fc_conf->mode = RTE_FC_NONE;
 717         ret = 0;
 718
 719 out:
 720         priv_unlock(priv);
 721         assert(ret >= 0);
 722         return -ret;
 723 }
 724
 725 /**
 726  * DPDK callback to modify flow control parameters.
 727  *
 728  * @param dev
 729  *   Pointer to Ethernet device structure.
 730  * @param[in] fc_conf
 731  *   Flow control parameters.
 732  *
 733  * @return
 734  *   0 on success, negative errno value on failure.
 735  */
 736 int
 737 mlx5_dev_set_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
 738 {
 739         struct priv *priv = dev->data->dev_private;
 740         struct ifreq ifr;
 741         struct ethtool_pauseparam ethpause = {
 742                 .cmd = ETHTOOL_SPAUSEPARAM
 743         };
 744         int ret;
 745
 746         ifr.ifr_data = &ethpause;
 747         ethpause.autoneg = fc_conf->autoneg;
 748         if (((fc_conf->mode & RTE_FC_FULL) == RTE_FC_FULL) ||
 749             (fc_conf->mode & RTE_FC_RX_PAUSE))
 750                 ethpause.rx_pause = 1;
 751         else
 752                 ethpause.rx_pause = 0;
 753
 754         if (((fc_conf->mode & RTE_FC_FULL) == RTE_FC_FULL) ||
 755             (fc_conf->mode & RTE_FC_TX_PAUSE))
 756                 ethpause.tx_pause = 1;
 757         else
 758                 ethpause.tx_pause = 0;
 759
 760         priv_lock(priv);
 761         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
 762                 ret = errno;
 763                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_SPAUSEPARAM)"
 764                      " failed: %s",
 765                      strerror(ret));
 766                 goto out;
 767         }
 768         ret = 0;
 769
 770 out:
 771         priv_unlock(priv);
 772         assert(ret >= 0);
 773         return -ret;
 774 }
 775
 776 /**
 777  * Get PCI information from struct ibv_device.
 778  *
 779  * @param device
 780  *   Pointer to Ethernet device structure.
 781  * @param[out] pci_addr
 782  *   PCI bus address output buffer.
 783  *
 784  * @return
 785  *   0 on success, -1 on failure and errno is set.
 786  */
 787 int
 788 mlx5_ibv_device_to_pci_addr(const struct ibv_device *device,
 789                             struct rte_pci_addr *pci_addr)
 790 {
 791         FILE *file;
 792         char line[32];
 793         MKSTR(path, "%s/device/uevent", device->ibdev_path);
 794
 795         file = fopen(path, "rb");
 796         if (file == NULL)
 797                 return -1;
 798         while (fgets(line, sizeof(line), file) == line) {
 799                 size_t len = strlen(line);
 800                 int ret;
 801
 802                 /* Truncate long lines. */
 803                 if (len == (sizeof(line) - 1))
 804                         while (line[(len - 1)] != '\n') {
 805                                 ret = fgetc(file);
 806                                 if (ret == EOF)
 807                                         break;
 808                                 line[(len - 1)] = ret;
 809                         }
 810                 /* Extract information. */
 811                 if (sscanf(line,
 812                            "PCI_SLOT_NAME="
 813                            "%" SCNx16 ":%" SCNx8 ":%" SCNx8 ".%" SCNx8 "\n",
 814                            &pci_addr->domain,
 815                            &pci_addr->bus,
 816                            &pci_addr->devid,
 817                            &pci_addr->function) == 4) {
 818                         ret = 0;
 819                         break;
 820                 }
 821         }
 822         fclose(file);
 823         return 0;
 824 }
 825
 826 /**
 827  * Link status handler.
 828  *
 829  * @param priv
 830  *   Pointer to private structure.
 831  * @param dev
 832  *   Pointer to the rte_eth_dev structure.
 833  *
 834  * @return
 835  *   Nonzero if the callback process can be called immediately.
 836  */
 837 static int
 838 priv_dev_link_status_handler(struct priv *priv, struct rte_eth_dev *dev)
 839 {
 840         struct ibv_async_event event;
 841         int port_change = 0;
 842         int ret = 0;
 843
 844         /* Read all message and acknowledge them. */
 845         for (;;) {
 846                 if (ibv_get_async_event(priv->ctx, &event))
 847                         break;
 848
 849                 if (event.event_type == IBV_EVENT_PORT_ACTIVE ||
 850                     event.event_type == IBV_EVENT_PORT_ERR)
 851                         port_change = 1;
 852                 else
 853                         DEBUG("event type %d on port %d not handled",
 854                               event.event_type, event.element.port_num);
 855                 ibv_ack_async_event(&event);
 856         }
 857
 858         if (port_change ^ priv->pending_alarm) {
 859                 struct rte_eth_link *link = &dev->data->dev_link;
 860
 861                 priv->pending_alarm = 0;
 862                 mlx5_link_update_unlocked(dev, 0);
 863                 if (((link->link_speed == 0) && link->link_status) ||
 864                     ((link->link_speed != 0) && !link->link_status)) {
 865                         /* Inconsistent status, check again later. */
 866                         priv->pending_alarm = 1;
 867                         rte_eal_alarm_set(MLX5_ALARM_TIMEOUT_US,
 868                                           mlx5_dev_link_status_handler,
 869                                           dev);
 870                 } else
 871                         ret = 1;
 872         }
 873         return ret;
 874 }
 875
 876 /**
 877  * Handle delayed link status event.
 878  *
 879  * @param arg
 880  *   Registered argument.
 881  */
 882 void
 883 mlx5_dev_link_status_handler(void *arg)
 884 {
 885         struct rte_eth_dev *dev = arg;
 886         struct priv *priv = dev->data->dev_private;
 887         int ret;
 888
 889         priv_lock(priv);
 890         assert(priv->pending_alarm == 1);
 891         ret = priv_dev_link_status_handler(priv, dev);
 892         priv_unlock(priv);
 893         if (ret)
 894                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC);
 895 }
 896
 897 /**
 898  * Handle interrupts from the NIC.
 899  *
 900  * @param[in] intr_handle
 901  *   Interrupt handler.
 902  * @param cb_arg
 903  *   Callback argument.
 904  */
 905 void
 906 mlx5_dev_interrupt_handler(struct rte_intr_handle *intr_handle, void *cb_arg)
 907 {
 908         struct rte_eth_dev *dev = cb_arg;
 909         struct priv *priv = dev->data->dev_private;
 910         int ret;
 911
 912         (void)intr_handle;
 913         priv_lock(priv);
 914         ret = priv_dev_link_status_handler(priv, dev);
 915         priv_unlock(priv);
 916         if (ret)
 917                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC);
 918 }
 919
 920 /**
 921  * Uninstall interrupt handler.
 922  *
 923  * @param priv
 924  *   Pointer to private structure.
 925  * @param dev
 926  *   Pointer to the rte_eth_dev structure.
 927  */
 928 void
 929 priv_dev_interrupt_handler_uninstall(struct priv *priv, struct rte_eth_dev *dev)
 930 {
 931         if (!dev->data->dev_conf.intr_conf.lsc)
 932                 return;
 933         rte_intr_callback_unregister(&priv->intr_handle,
 934                                      mlx5_dev_interrupt_handler,
 935                                      dev);
 936         if (priv->pending_alarm)
 937                 rte_eal_alarm_cancel(mlx5_dev_link_status_handler, dev);
 938         priv->pending_alarm = 0;
 939         priv->intr_handle.fd = 0;
 940         priv->intr_handle.type = 0;
 941 }
 942
 943 /**
 944  * Install interrupt handler.
 945  *
 946  * @param priv
 947  *   Pointer to private structure.
 948  * @param dev
 949  *   Pointer to the rte_eth_dev structure.
 950  */
 951 void
 952 priv_dev_interrupt_handler_install(struct priv *priv, struct rte_eth_dev *dev)
 953 {
 954         int rc, flags;
 955
 956         if (!dev->data->dev_conf.intr_conf.lsc)
 957                 return;
 958         assert(priv->ctx->async_fd > 0);
 959         flags = fcntl(priv->ctx->async_fd, F_GETFL);
 960         rc = fcntl(priv->ctx->async_fd, F_SETFL, flags | O_NONBLOCK);
 961         if (rc < 0) {
 962                 INFO("failed to change file descriptor async event queue");
 963                 dev->data->dev_conf.intr_conf.lsc = 0;
 964         } else {
 965                 priv->intr_handle.fd = priv->ctx->async_fd;
 966                 priv->intr_handle.type = RTE_INTR_HANDLE_EXT;
 967                 rte_intr_callback_register(&priv->intr_handle,
 968                                            mlx5_dev_interrupt_handler,
 969                                            dev);
 970         }
 971 }