1 /* SPDX-License-Identifier: BSD-3-Clause 2 * Copyright 2015 6WIND S.A. 3 * Copyright 2015 Mellanox Technologies, Ltd 4 */ 5 6 #include <stddef.h> 7 #include <inttypes.h> 8 #include <unistd.h> 9 #include <stdbool.h> 10 #include <stdint.h> 11 #include <stdio.h> 12 #include <string.h> 13 #include <stdlib.h> 14 #include <errno.h> 15 #include <dirent.h> 16 #include <net/if.h> 17 #include <sys/ioctl.h> 18 #include <sys/socket.h> 19 #include <netinet/in.h> 20 #include <linux/ethtool.h> 21 #include <linux/sockios.h> 22 #include <fcntl.h> 23 #include <stdalign.h> 24 #include <sys/un.h> 25 #include <time.h> 26 27 #include <ethdev_driver.h> 28 #include <rte_bus_pci.h> 29 #include <rte_mbuf.h> 30 #include <rte_common.h> 31 #include <rte_interrupts.h> 32 #include <rte_malloc.h> 33 #include <rte_string_fns.h> 34 #include <rte_rwlock.h> 35 #include <rte_cycles.h> 36 37 #include <mlx5_glue.h> 38 #include <mlx5_devx_cmds.h> 39 #include <mlx5_common.h> 40 #include <mlx5_malloc.h> 41 #include <mlx5_nl.h> 42 43 #include "mlx5.h" 44 #include "mlx5_rxtx.h" 45 #include "mlx5_utils.h" 46 47 /* Supported speed values found in /usr/include/linux/ethtool.h */ 48 #ifndef HAVE_SUPPORTED_40000baseKR4_Full 49 #define SUPPORTED_40000baseKR4_Full (1 << 23) 50 #endif 51 #ifndef HAVE_SUPPORTED_40000baseCR4_Full 52 #define SUPPORTED_40000baseCR4_Full (1 << 24) 53 #endif 54 #ifndef HAVE_SUPPORTED_40000baseSR4_Full 55 #define SUPPORTED_40000baseSR4_Full (1 << 25) 56 #endif 57 #ifndef HAVE_SUPPORTED_40000baseLR4_Full 58 #define SUPPORTED_40000baseLR4_Full (1 << 26) 59 #endif 60 #ifndef HAVE_SUPPORTED_56000baseKR4_Full 61 #define SUPPORTED_56000baseKR4_Full (1 << 27) 62 #endif 63 #ifndef HAVE_SUPPORTED_56000baseCR4_Full 64 #define SUPPORTED_56000baseCR4_Full (1 << 28) 65 #endif 66 #ifndef HAVE_SUPPORTED_56000baseSR4_Full 67 #define SUPPORTED_56000baseSR4_Full (1 << 29) 68 #endif 69 #ifndef HAVE_SUPPORTED_56000baseLR4_Full 70 #define SUPPORTED_56000baseLR4_Full (1 << 30) 71 #endif 72 73 /* Add defines in case the running kernel is not the same as user headers. */ 74 #ifndef ETHTOOL_GLINKSETTINGS 75 struct ethtool_link_settings { 76 uint32_t cmd; 77 uint32_t speed; 78 uint8_t duplex; 79 uint8_t port; 80 uint8_t phy_address; 81 uint8_t autoneg; 82 uint8_t mdio_support; 83 uint8_t eth_to_mdix; 84 uint8_t eth_tp_mdix_ctrl; 85 int8_t link_mode_masks_nwords; 86 uint32_t reserved[8]; 87 uint32_t link_mode_masks[]; 88 }; 89 90 /* The kernel values can be found in /include/uapi/linux/ethtool.h */ 91 #define ETHTOOL_GLINKSETTINGS 0x0000004c 92 #define ETHTOOL_LINK_MODE_1000baseT_Full_BIT 5 93 #define ETHTOOL_LINK_MODE_Autoneg_BIT 6 94 #define ETHTOOL_LINK_MODE_1000baseKX_Full_BIT 17 95 #define ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT 18 96 #define ETHTOOL_LINK_MODE_10000baseKR_Full_BIT 19 97 #define ETHTOOL_LINK_MODE_10000baseR_FEC_BIT 20 98 #define ETHTOOL_LINK_MODE_20000baseMLD2_Full_BIT 21 99 #define ETHTOOL_LINK_MODE_20000baseKR2_Full_BIT 22 100 #define ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT 23 101 #define ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT 24 102 #define ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT 25 103 #define ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT 26 104 #define ETHTOOL_LINK_MODE_56000baseKR4_Full_BIT 27 105 #define ETHTOOL_LINK_MODE_56000baseCR4_Full_BIT 28 106 #define ETHTOOL_LINK_MODE_56000baseSR4_Full_BIT 29 107 #define ETHTOOL_LINK_MODE_56000baseLR4_Full_BIT 30 108 #endif 109 #ifndef HAVE_ETHTOOL_LINK_MODE_25G 110 #define ETHTOOL_LINK_MODE_25000baseCR_Full_BIT 31 111 #define ETHTOOL_LINK_MODE_25000baseKR_Full_BIT 32 112 #define ETHTOOL_LINK_MODE_25000baseSR_Full_BIT 33 113 #endif 114 #ifndef HAVE_ETHTOOL_LINK_MODE_50G 115 #define ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT 34 116 #define ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT 35 117 #endif 118 #ifndef HAVE_ETHTOOL_LINK_MODE_100G 119 #define ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT 36 120 #define ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT 37 121 #define ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT 38 122 #define ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT 39 123 #endif 124 #ifndef HAVE_ETHTOOL_LINK_MODE_200G 125 #define ETHTOOL_LINK_MODE_200000baseKR4_Full_BIT 62 126 #define ETHTOOL_LINK_MODE_200000baseSR4_Full_BIT 63 127 #define ETHTOOL_LINK_MODE_200000baseLR4_ER4_FR4_Full_BIT 0 /* 64 - 64 */ 128 #define ETHTOOL_LINK_MODE_200000baseDR4_Full_BIT 1 /* 65 - 64 */ 129 #define ETHTOOL_LINK_MODE_200000baseCR4_Full_BIT 2 /* 66 - 64 */ 130 #endif 131 132 /* Get interface index from SubFunction device name. */ 133 int 134 mlx5_auxiliary_get_ifindex(const char *sf_name) 135 { 136 char if_name[IF_NAMESIZE] = { 0 }; 137 138 if (mlx5_auxiliary_get_child_name(sf_name, "/net", 139 if_name, sizeof(if_name)) != 0) 140 return -rte_errno; 141 return if_nametoindex(if_name); 142 } 143 144 /** 145 * Get interface name from private structure. 146 * 147 * This is a port representor-aware version of mlx5_get_ifname_sysfs(). 148 * 149 * @param[in] dev 150 * Pointer to Ethernet device. 151 * @param[out] ifname 152 * Interface name output buffer. 153 * 154 * @return 155 * 0 on success, a negative errno value otherwise and rte_errno is set. 156 */ 157 int 158 mlx5_get_ifname(const struct rte_eth_dev *dev, char (*ifname)[MLX5_NAMESIZE]) 159 { 160 struct mlx5_priv *priv = dev->data->dev_private; 161 unsigned int ifindex; 162 163 MLX5_ASSERT(priv); 164 MLX5_ASSERT(priv->sh); 165 if (priv->master && priv->sh->bond.ifindex > 0) { 166 memcpy(ifname, priv->sh->bond.ifname, MLX5_NAMESIZE); 167 return 0; 168 } 169 ifindex = mlx5_ifindex(dev); 170 if (!ifindex) { 171 if (!priv->representor) 172 return mlx5_get_ifname_sysfs(priv->sh->ibdev_path, 173 *ifname); 174 rte_errno = ENXIO; 175 return -rte_errno; 176 } 177 if (if_indextoname(ifindex, &(*ifname)[0])) 178 return 0; 179 rte_errno = errno; 180 return -rte_errno; 181 } 182 183 /** 184 * Perform ifreq ioctl() on associated netdev ifname. 185 * 186 * @param[in] ifname 187 * Pointer to netdev name. 188 * @param req 189 * Request number to pass to ioctl(). 190 * @param[out] ifr 191 * Interface request structure output buffer. 192 * 193 * @return 194 * 0 on success, a negative errno value otherwise and rte_errno is set. 195 */ 196 static int 197 mlx5_ifreq_by_ifname(const char *ifname, int req, struct ifreq *ifr) 198 { 199 int sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_IP); 200 int ret = 0; 201 202 if (sock == -1) { 203 rte_errno = errno; 204 return -rte_errno; 205 } 206 rte_strscpy(ifr->ifr_name, ifname, sizeof(ifr->ifr_name)); 207 ret = ioctl(sock, req, ifr); 208 if (ret == -1) { 209 rte_errno = errno; 210 goto error; 211 } 212 close(sock); 213 return 0; 214 error: 215 close(sock); 216 return -rte_errno; 217 } 218 219 /** 220 * Perform ifreq ioctl() on associated Ethernet device. 221 * 222 * @param[in] dev 223 * Pointer to Ethernet device. 224 * @param req 225 * Request number to pass to ioctl(). 226 * @param[out] ifr 227 * Interface request structure output buffer. 228 * 229 * @return 230 * 0 on success, a negative errno value otherwise and rte_errno is set. 231 */ 232 static int 233 mlx5_ifreq(const struct rte_eth_dev *dev, int req, struct ifreq *ifr) 234 { 235 char ifname[sizeof(ifr->ifr_name)]; 236 int ret; 237 238 ret = mlx5_get_ifname(dev, &ifname); 239 if (ret) 240 return -rte_errno; 241 return mlx5_ifreq_by_ifname(ifname, req, ifr); 242 } 243 244 /** 245 * Get device MTU. 246 * 247 * @param dev 248 * Pointer to Ethernet device. 249 * @param[out] mtu 250 * MTU value output buffer. 251 * 252 * @return 253 * 0 on success, a negative errno value otherwise and rte_errno is set. 254 */ 255 int 256 mlx5_get_mtu(struct rte_eth_dev *dev, uint16_t *mtu) 257 { 258 struct ifreq request; 259 int ret = mlx5_ifreq(dev, SIOCGIFMTU, &request); 260 261 if (ret) 262 return ret; 263 *mtu = request.ifr_mtu; 264 return 0; 265 } 266 267 /** 268 * Set device MTU. 269 * 270 * @param dev 271 * Pointer to Ethernet device. 272 * @param mtu 273 * MTU value to set. 274 * 275 * @return 276 * 0 on success, a negative errno value otherwise and rte_errno is set. 277 */ 278 int 279 mlx5_set_mtu(struct rte_eth_dev *dev, uint16_t mtu) 280 { 281 struct ifreq request = { .ifr_mtu = mtu, }; 282 283 return mlx5_ifreq(dev, SIOCSIFMTU, &request); 284 } 285 286 /** 287 * Set device flags. 288 * 289 * @param dev 290 * Pointer to Ethernet device. 291 * @param keep 292 * Bitmask for flags that must remain untouched. 293 * @param flags 294 * Bitmask for flags to modify. 295 * 296 * @return 297 * 0 on success, a negative errno value otherwise and rte_errno is set. 298 */ 299 static int 300 mlx5_set_flags(struct rte_eth_dev *dev, unsigned int keep, unsigned int flags) 301 { 302 struct ifreq request; 303 int ret = mlx5_ifreq(dev, SIOCGIFFLAGS, &request); 304 305 if (ret) 306 return ret; 307 request.ifr_flags &= keep; 308 request.ifr_flags |= flags & ~keep; 309 return mlx5_ifreq(dev, SIOCSIFFLAGS, &request); 310 } 311 312 /** 313 * Get device current raw clock counter 314 * 315 * @param dev 316 * Pointer to Ethernet device structure. 317 * @param[out] time 318 * Current raw clock counter of the device. 319 * 320 * @return 321 * 0 if the clock has correctly been read 322 * The value of errno in case of error 323 */ 324 int 325 mlx5_read_clock(struct rte_eth_dev *dev, uint64_t *clock) 326 { 327 struct mlx5_priv *priv = dev->data->dev_private; 328 struct ibv_context *ctx = priv->sh->cdev->ctx; 329 struct ibv_values_ex values; 330 int err = 0; 331 332 values.comp_mask = IBV_VALUES_MASK_RAW_CLOCK; 333 err = mlx5_glue->query_rt_values_ex(ctx, &values); 334 if (err != 0) { 335 DRV_LOG(WARNING, "Could not query the clock !"); 336 return err; 337 } 338 *clock = values.raw_clock.tv_nsec; 339 return 0; 340 } 341 342 /** 343 * Retrieve the master device for representor in the same switch domain. 344 * 345 * @param dev 346 * Pointer to representor Ethernet device structure. 347 * 348 * @return 349 * Master device structure on success, NULL otherwise. 350 */ 351 static struct rte_eth_dev * 352 mlx5_find_master_dev(struct rte_eth_dev *dev) 353 { 354 struct mlx5_priv *priv; 355 uint16_t port_id; 356 uint16_t domain_id; 357 358 priv = dev->data->dev_private; 359 domain_id = priv->domain_id; 360 MLX5_ASSERT(priv->representor); 361 MLX5_ETH_FOREACH_DEV(port_id, dev->device) { 362 struct mlx5_priv *opriv = 363 rte_eth_devices[port_id].data->dev_private; 364 if (opriv && 365 opriv->master && 366 opriv->domain_id == domain_id && 367 opriv->sh == priv->sh) 368 return &rte_eth_devices[port_id]; 369 } 370 return NULL; 371 } 372 373 /** 374 * DPDK callback to retrieve physical link information. 375 * 376 * @param dev 377 * Pointer to Ethernet device structure. 378 * @param[out] link 379 * Storage for current link status. 380 * 381 * @return 382 * 0 on success, a negative errno value otherwise and rte_errno is set. 383 */ 384 static int 385 mlx5_link_update_unlocked_gset(struct rte_eth_dev *dev, 386 struct rte_eth_link *link) 387 { 388 struct mlx5_priv *priv = dev->data->dev_private; 389 struct ethtool_cmd edata = { 390 .cmd = ETHTOOL_GSET /* Deprecated since Linux v4.5. */ 391 }; 392 struct ifreq ifr; 393 struct rte_eth_link dev_link; 394 int link_speed = 0; 395 int ret; 396 397 ret = mlx5_ifreq(dev, SIOCGIFFLAGS, &ifr); 398 if (ret) { 399 DRV_LOG(WARNING, "port %u ioctl(SIOCGIFFLAGS) failed: %s", 400 dev->data->port_id, strerror(rte_errno)); 401 return ret; 402 } 403 dev_link = (struct rte_eth_link) { 404 .link_status = ((ifr.ifr_flags & IFF_UP) && 405 (ifr.ifr_flags & IFF_RUNNING)), 406 }; 407 ifr = (struct ifreq) { 408 .ifr_data = (void *)&edata, 409 }; 410 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 411 if (ret) { 412 if (ret == -ENOTSUP && priv->representor) { 413 struct rte_eth_dev *master; 414 415 /* 416 * For representors we can try to inherit link 417 * settings from the master device. Actually 418 * link settings do not make a lot of sense 419 * for representors due to missing physical 420 * link. The old kernel drivers supported 421 * emulated settings query for representors, 422 * the new ones do not, so we have to add 423 * this code for compatibility issues. 424 */ 425 master = mlx5_find_master_dev(dev); 426 if (master) { 427 ifr = (struct ifreq) { 428 .ifr_data = (void *)&edata, 429 }; 430 ret = mlx5_ifreq(master, SIOCETHTOOL, &ifr); 431 } 432 } 433 if (ret) { 434 DRV_LOG(WARNING, 435 "port %u ioctl(SIOCETHTOOL," 436 " ETHTOOL_GSET) failed: %s", 437 dev->data->port_id, strerror(rte_errno)); 438 return ret; 439 } 440 } 441 link_speed = ethtool_cmd_speed(&edata); 442 if (link_speed == -1) 443 dev_link.link_speed = RTE_ETH_SPEED_NUM_UNKNOWN; 444 else 445 dev_link.link_speed = link_speed; 446 priv->link_speed_capa = 0; 447 if (edata.supported & (SUPPORTED_1000baseT_Full | 448 SUPPORTED_1000baseKX_Full)) 449 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_1G; 450 if (edata.supported & SUPPORTED_10000baseKR_Full) 451 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_10G; 452 if (edata.supported & (SUPPORTED_40000baseKR4_Full | 453 SUPPORTED_40000baseCR4_Full | 454 SUPPORTED_40000baseSR4_Full | 455 SUPPORTED_40000baseLR4_Full)) 456 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_40G; 457 dev_link.link_duplex = ((edata.duplex == DUPLEX_HALF) ? 458 RTE_ETH_LINK_HALF_DUPLEX : RTE_ETH_LINK_FULL_DUPLEX); 459 dev_link.link_autoneg = !(dev->data->dev_conf.link_speeds & 460 RTE_ETH_LINK_SPEED_FIXED); 461 *link = dev_link; 462 return 0; 463 } 464 465 /** 466 * Retrieve physical link information (unlocked version using new ioctl). 467 * 468 * @param dev 469 * Pointer to Ethernet device structure. 470 * @param[out] link 471 * Storage for current link status. 472 * 473 * @return 474 * 0 on success, a negative errno value otherwise and rte_errno is set. 475 */ 476 static int 477 mlx5_link_update_unlocked_gs(struct rte_eth_dev *dev, 478 struct rte_eth_link *link) 479 480 { 481 struct mlx5_priv *priv = dev->data->dev_private; 482 struct ethtool_link_settings gcmd = { .cmd = ETHTOOL_GLINKSETTINGS }; 483 struct ifreq ifr; 484 struct rte_eth_link dev_link; 485 struct rte_eth_dev *master = NULL; 486 uint64_t sc; 487 int ret; 488 489 ret = mlx5_ifreq(dev, SIOCGIFFLAGS, &ifr); 490 if (ret) { 491 DRV_LOG(WARNING, "port %u ioctl(SIOCGIFFLAGS) failed: %s", 492 dev->data->port_id, strerror(rte_errno)); 493 return ret; 494 } 495 dev_link = (struct rte_eth_link) { 496 .link_status = ((ifr.ifr_flags & IFF_UP) && 497 (ifr.ifr_flags & IFF_RUNNING)), 498 }; 499 ifr = (struct ifreq) { 500 .ifr_data = (void *)&gcmd, 501 }; 502 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 503 if (ret) { 504 if (ret == -ENOTSUP && priv->representor) { 505 /* 506 * For representors we can try to inherit link 507 * settings from the master device. Actually 508 * link settings do not make a lot of sense 509 * for representors due to missing physical 510 * link. The old kernel drivers supported 511 * emulated settings query for representors, 512 * the new ones do not, so we have to add 513 * this code for compatibility issues. 514 */ 515 master = mlx5_find_master_dev(dev); 516 if (master) { 517 ifr = (struct ifreq) { 518 .ifr_data = (void *)&gcmd, 519 }; 520 ret = mlx5_ifreq(master, SIOCETHTOOL, &ifr); 521 } 522 } 523 if (ret) { 524 DRV_LOG(DEBUG, 525 "port %u ioctl(SIOCETHTOOL," 526 " ETHTOOL_GLINKSETTINGS) failed: %s", 527 dev->data->port_id, strerror(rte_errno)); 528 return ret; 529 } 530 } 531 gcmd.link_mode_masks_nwords = -gcmd.link_mode_masks_nwords; 532 533 alignas(struct ethtool_link_settings) 534 uint8_t data[offsetof(struct ethtool_link_settings, link_mode_masks) + 535 sizeof(uint32_t) * gcmd.link_mode_masks_nwords * 3]; 536 struct ethtool_link_settings *ecmd = (void *)data; 537 538 *ecmd = gcmd; 539 ifr.ifr_data = (void *)ecmd; 540 ret = mlx5_ifreq(master ? master : dev, SIOCETHTOOL, &ifr); 541 if (ret) { 542 DRV_LOG(DEBUG, 543 "port %u ioctl(SIOCETHTOOL," 544 "ETHTOOL_GLINKSETTINGS) failed: %s", 545 dev->data->port_id, strerror(rte_errno)); 546 return ret; 547 } 548 dev_link.link_speed = (ecmd->speed == UINT32_MAX) ? 549 RTE_ETH_SPEED_NUM_UNKNOWN : ecmd->speed; 550 sc = ecmd->link_mode_masks[0] | 551 ((uint64_t)ecmd->link_mode_masks[1] << 32); 552 priv->link_speed_capa = 0; 553 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_1000baseT_Full_BIT) | 554 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_1000baseKX_Full_BIT))) 555 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_1G; 556 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT) | 557 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_10000baseKR_Full_BIT) | 558 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_10000baseR_FEC_BIT))) 559 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_10G; 560 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_20000baseMLD2_Full_BIT) | 561 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_20000baseKR2_Full_BIT))) 562 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_20G; 563 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT) | 564 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT) | 565 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT) | 566 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT))) 567 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_40G; 568 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_56000baseKR4_Full_BIT) | 569 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_56000baseCR4_Full_BIT) | 570 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_56000baseSR4_Full_BIT) | 571 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_56000baseLR4_Full_BIT))) 572 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_56G; 573 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_25000baseCR_Full_BIT) | 574 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_25000baseKR_Full_BIT) | 575 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_25000baseSR_Full_BIT))) 576 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_25G; 577 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT) | 578 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT))) 579 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_50G; 580 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT) | 581 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT) | 582 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT) | 583 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT))) 584 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_100G; 585 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_200000baseKR4_Full_BIT) | 586 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_200000baseSR4_Full_BIT))) 587 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_200G; 588 589 sc = ecmd->link_mode_masks[2] | 590 ((uint64_t)ecmd->link_mode_masks[3] << 32); 591 if (sc & (MLX5_BITSHIFT(ETHTOOL_LINK_MODE_200000baseCR4_Full_BIT) | 592 MLX5_BITSHIFT 593 (ETHTOOL_LINK_MODE_200000baseLR4_ER4_FR4_Full_BIT) | 594 MLX5_BITSHIFT(ETHTOOL_LINK_MODE_200000baseDR4_Full_BIT))) 595 priv->link_speed_capa |= RTE_ETH_LINK_SPEED_200G; 596 dev_link.link_duplex = ((ecmd->duplex == DUPLEX_HALF) ? 597 RTE_ETH_LINK_HALF_DUPLEX : RTE_ETH_LINK_FULL_DUPLEX); 598 dev_link.link_autoneg = !(dev->data->dev_conf.link_speeds & 599 RTE_ETH_LINK_SPEED_FIXED); 600 *link = dev_link; 601 return 0; 602 } 603 604 /** 605 * DPDK callback to retrieve physical link information. 606 * 607 * @param dev 608 * Pointer to Ethernet device structure. 609 * @param wait_to_complete 610 * Wait for request completion. 611 * 612 * @return 613 * 0 if link status was not updated, positive if it was, a negative errno 614 * value otherwise and rte_errno is set. 615 */ 616 int 617 mlx5_link_update(struct rte_eth_dev *dev, int wait_to_complete) 618 { 619 int ret; 620 struct rte_eth_link dev_link; 621 time_t start_time = time(NULL); 622 int retry = MLX5_GET_LINK_STATUS_RETRY_COUNT; 623 624 do { 625 ret = mlx5_link_update_unlocked_gs(dev, &dev_link); 626 if (ret == -ENOTSUP) 627 ret = mlx5_link_update_unlocked_gset(dev, &dev_link); 628 if (ret == 0) 629 break; 630 /* Handle wait to complete situation. */ 631 if ((wait_to_complete || retry) && ret == -EAGAIN) { 632 if (abs((int)difftime(time(NULL), start_time)) < 633 MLX5_LINK_STATUS_TIMEOUT) { 634 usleep(0); 635 continue; 636 } else { 637 rte_errno = EBUSY; 638 return -rte_errno; 639 } 640 } else if (ret < 0) { 641 return ret; 642 } 643 } while (wait_to_complete || retry-- > 0); 644 ret = !!memcmp(&dev->data->dev_link, &dev_link, 645 sizeof(struct rte_eth_link)); 646 dev->data->dev_link = dev_link; 647 return ret; 648 } 649 650 /** 651 * DPDK callback to get flow control status. 652 * 653 * @param dev 654 * Pointer to Ethernet device structure. 655 * @param[out] fc_conf 656 * Flow control output buffer. 657 * 658 * @return 659 * 0 on success, a negative errno value otherwise and rte_errno is set. 660 */ 661 int 662 mlx5_dev_get_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf) 663 { 664 struct ifreq ifr; 665 struct ethtool_pauseparam ethpause = { 666 .cmd = ETHTOOL_GPAUSEPARAM 667 }; 668 int ret; 669 670 ifr.ifr_data = (void *)ðpause; 671 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 672 if (ret) { 673 DRV_LOG(WARNING, 674 "port %u ioctl(SIOCETHTOOL, ETHTOOL_GPAUSEPARAM) failed:" 675 " %s", 676 dev->data->port_id, strerror(rte_errno)); 677 return ret; 678 } 679 fc_conf->autoneg = ethpause.autoneg; 680 if (ethpause.rx_pause && ethpause.tx_pause) 681 fc_conf->mode = RTE_ETH_FC_FULL; 682 else if (ethpause.rx_pause) 683 fc_conf->mode = RTE_ETH_FC_RX_PAUSE; 684 else if (ethpause.tx_pause) 685 fc_conf->mode = RTE_ETH_FC_TX_PAUSE; 686 else 687 fc_conf->mode = RTE_ETH_FC_NONE; 688 return 0; 689 } 690 691 /** 692 * DPDK callback to modify flow control parameters. 693 * 694 * @param dev 695 * Pointer to Ethernet device structure. 696 * @param[in] fc_conf 697 * Flow control parameters. 698 * 699 * @return 700 * 0 on success, a negative errno value otherwise and rte_errno is set. 701 */ 702 int 703 mlx5_dev_set_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf) 704 { 705 struct ifreq ifr; 706 struct ethtool_pauseparam ethpause = { 707 .cmd = ETHTOOL_SPAUSEPARAM 708 }; 709 int ret; 710 711 ifr.ifr_data = (void *)ðpause; 712 ethpause.autoneg = fc_conf->autoneg; 713 if (((fc_conf->mode & RTE_ETH_FC_FULL) == RTE_ETH_FC_FULL) || 714 (fc_conf->mode & RTE_ETH_FC_RX_PAUSE)) 715 ethpause.rx_pause = 1; 716 else 717 ethpause.rx_pause = 0; 718 719 if (((fc_conf->mode & RTE_ETH_FC_FULL) == RTE_ETH_FC_FULL) || 720 (fc_conf->mode & RTE_ETH_FC_TX_PAUSE)) 721 ethpause.tx_pause = 1; 722 else 723 ethpause.tx_pause = 0; 724 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 725 if (ret) { 726 DRV_LOG(WARNING, 727 "port %u ioctl(SIOCETHTOOL, ETHTOOL_SPAUSEPARAM)" 728 " failed: %s", 729 dev->data->port_id, strerror(rte_errno)); 730 return ret; 731 } 732 return 0; 733 } 734 735 /** 736 * Handle asynchronous removal event for entire multiport device. 737 * 738 * @param sh 739 * Infiniband device shared context. 740 */ 741 static void 742 mlx5_dev_interrupt_device_fatal(struct mlx5_dev_ctx_shared *sh) 743 { 744 uint32_t i; 745 746 for (i = 0; i < sh->max_port; ++i) { 747 struct rte_eth_dev *dev; 748 749 if (sh->port[i].ih_port_id >= RTE_MAX_ETHPORTS) { 750 /* 751 * Or not existing port either no 752 * handler installed for this port. 753 */ 754 continue; 755 } 756 dev = &rte_eth_devices[sh->port[i].ih_port_id]; 757 MLX5_ASSERT(dev); 758 if (dev->data->dev_conf.intr_conf.rmv) 759 rte_eth_dev_callback_process 760 (dev, RTE_ETH_EVENT_INTR_RMV, NULL); 761 } 762 } 763 764 static void 765 mlx5_dev_interrupt_nl_cb(struct nlmsghdr *hdr, void *cb_arg) 766 { 767 struct mlx5_dev_ctx_shared *sh = cb_arg; 768 uint32_t i; 769 uint32_t if_index; 770 771 if (mlx5_nl_parse_link_status_update(hdr, &if_index) < 0) 772 return; 773 for (i = 0; i < sh->max_port; i++) { 774 struct mlx5_dev_shared_port *port = &sh->port[i]; 775 struct rte_eth_dev *dev; 776 struct mlx5_priv *priv; 777 778 if (port->nl_ih_port_id >= RTE_MAX_ETHPORTS) 779 continue; 780 dev = &rte_eth_devices[port->nl_ih_port_id]; 781 /* Probing may initiate an LSC before configuration is done. */ 782 if (dev->data->dev_configured && 783 !dev->data->dev_conf.intr_conf.lsc) 784 break; 785 priv = dev->data->dev_private; 786 if (priv->if_index == if_index) { 787 /* Block logical LSC events. */ 788 uint16_t prev_status = dev->data->dev_link.link_status; 789 790 if (mlx5_link_update(dev, 0) < 0) 791 DRV_LOG(ERR, "Failed to update link status: %s", 792 rte_strerror(rte_errno)); 793 else if (prev_status != dev->data->dev_link.link_status) 794 rte_eth_dev_callback_process 795 (dev, RTE_ETH_EVENT_INTR_LSC, NULL); 796 break; 797 } 798 } 799 } 800 801 void 802 mlx5_dev_interrupt_handler_nl(void *arg) 803 { 804 struct mlx5_dev_ctx_shared *sh = arg; 805 int nlsk_fd = rte_intr_fd_get(sh->intr_handle_nl); 806 807 if (nlsk_fd < 0) 808 return; 809 if (mlx5_nl_read_events(nlsk_fd, mlx5_dev_interrupt_nl_cb, sh) < 0) 810 DRV_LOG(ERR, "Failed to process Netlink events: %s", 811 rte_strerror(rte_errno)); 812 } 813 814 /** 815 * Handle shared asynchronous events the NIC (removal event 816 * and link status change). Supports multiport IB device. 817 * 818 * @param cb_arg 819 * Callback argument. 820 */ 821 void 822 mlx5_dev_interrupt_handler(void *cb_arg) 823 { 824 struct mlx5_dev_ctx_shared *sh = cb_arg; 825 struct ibv_async_event event; 826 827 /* Read all message from the IB device and acknowledge them. */ 828 for (;;) { 829 struct rte_eth_dev *dev; 830 uint32_t tmp; 831 832 if (mlx5_glue->get_async_event(sh->cdev->ctx, &event)) 833 break; 834 /* Retrieve and check IB port index. */ 835 tmp = (uint32_t)event.element.port_num; 836 if (!tmp && event.event_type == IBV_EVENT_DEVICE_FATAL) { 837 /* 838 * The DEVICE_FATAL event is called once for 839 * entire device without port specifying. 840 * We should notify all existing ports. 841 */ 842 mlx5_glue->ack_async_event(&event); 843 mlx5_dev_interrupt_device_fatal(sh); 844 continue; 845 } 846 MLX5_ASSERT(tmp && (tmp <= sh->max_port)); 847 if (!tmp) { 848 /* Unsupported device level event. */ 849 mlx5_glue->ack_async_event(&event); 850 DRV_LOG(DEBUG, 851 "unsupported common event (type %d)", 852 event.event_type); 853 continue; 854 } 855 if (tmp > sh->max_port) { 856 /* Invalid IB port index. */ 857 mlx5_glue->ack_async_event(&event); 858 DRV_LOG(DEBUG, 859 "cannot handle an event (type %d)" 860 "due to invalid IB port index (%u)", 861 event.event_type, tmp); 862 continue; 863 } 864 if (sh->port[tmp - 1].ih_port_id >= RTE_MAX_ETHPORTS) { 865 /* No handler installed. */ 866 mlx5_glue->ack_async_event(&event); 867 DRV_LOG(DEBUG, 868 "cannot handle an event (type %d)" 869 "due to no handler installed for port %u", 870 event.event_type, tmp); 871 continue; 872 } 873 /* Retrieve ethernet device descriptor. */ 874 tmp = sh->port[tmp - 1].ih_port_id; 875 dev = &rte_eth_devices[tmp]; 876 MLX5_ASSERT(dev); 877 DRV_LOG(DEBUG, 878 "port %u cannot handle an unknown event (type %d)", 879 dev->data->port_id, event.event_type); 880 mlx5_glue->ack_async_event(&event); 881 } 882 } 883 884 /** 885 * Handle DEVX interrupts from the NIC. 886 * This function is probably called from the DPDK host thread. 887 * 888 * @param cb_arg 889 * Callback argument. 890 */ 891 void 892 mlx5_dev_interrupt_handler_devx(void *cb_arg) 893 { 894 #ifndef HAVE_IBV_DEVX_ASYNC 895 (void)cb_arg; 896 return; 897 #else 898 struct mlx5_dev_ctx_shared *sh = cb_arg; 899 union { 900 struct mlx5dv_devx_async_cmd_hdr cmd_resp; 901 uint8_t buf[MLX5_ST_SZ_BYTES(query_flow_counter_out) + 902 MLX5_ST_SZ_BYTES(traffic_counter) + 903 sizeof(struct mlx5dv_devx_async_cmd_hdr)]; 904 } out; 905 uint8_t *buf = out.buf + sizeof(out.cmd_resp); 906 907 while (!mlx5_glue->devx_get_async_cmd_comp(sh->devx_comp, 908 &out.cmd_resp, 909 sizeof(out.buf))) 910 mlx5_flow_async_pool_query_handle 911 (sh, (uint64_t)out.cmd_resp.wr_id, 912 mlx5_devx_get_out_command_status(buf)); 913 #endif /* HAVE_IBV_DEVX_ASYNC */ 914 } 915 916 /** 917 * DPDK callback to bring the link DOWN. 918 * 919 * @param dev 920 * Pointer to Ethernet device structure. 921 * 922 * @return 923 * 0 on success, a negative errno value otherwise and rte_errno is set. 924 */ 925 int 926 mlx5_set_link_down(struct rte_eth_dev *dev) 927 { 928 return mlx5_set_flags(dev, ~IFF_UP, ~IFF_UP); 929 } 930 931 /** 932 * DPDK callback to bring the link UP. 933 * 934 * @param dev 935 * Pointer to Ethernet device structure. 936 * 937 * @return 938 * 0 on success, a negative errno value otherwise and rte_errno is set. 939 */ 940 int 941 mlx5_set_link_up(struct rte_eth_dev *dev) 942 { 943 return mlx5_set_flags(dev, ~IFF_UP, IFF_UP); 944 } 945 946 /** 947 * Check if mlx5 device was removed. 948 * 949 * @param dev 950 * Pointer to Ethernet device structure. 951 * 952 * @return 953 * 1 when device is removed, otherwise 0. 954 */ 955 int 956 mlx5_is_removed(struct rte_eth_dev *dev) 957 { 958 struct ibv_device_attr device_attr; 959 struct mlx5_priv *priv = dev->data->dev_private; 960 961 if (mlx5_glue->query_device(priv->sh->cdev->ctx, &device_attr) == EIO) 962 return 1; 963 return 0; 964 } 965 966 /** 967 * Analyze gathered port parameters via sysfs to recognize master 968 * and representor devices for E-Switch configuration. 969 * 970 * @param[in] device_dir 971 * flag of presence of "device" directory under port device key. 972 * @param[inout] switch_info 973 * Port information, including port name as a number and port name 974 * type if recognized 975 * 976 * @return 977 * master and representor flags are set in switch_info according to 978 * recognized parameters (if any). 979 */ 980 static void 981 mlx5_sysfs_check_switch_info(bool device_dir, 982 struct mlx5_switch_info *switch_info) 983 { 984 switch (switch_info->name_type) { 985 case MLX5_PHYS_PORT_NAME_TYPE_UNKNOWN: 986 /* 987 * Name is not recognized, assume the master, 988 * check the device directory presence. 989 */ 990 switch_info->master = device_dir; 991 break; 992 case MLX5_PHYS_PORT_NAME_TYPE_NOTSET: 993 /* 994 * Name is not set, this assumes the legacy naming 995 * schema for master, just check if there is 996 * a device directory. 997 */ 998 switch_info->master = device_dir; 999 break; 1000 case MLX5_PHYS_PORT_NAME_TYPE_UPLINK: 1001 /* New uplink naming schema recognized. */ 1002 switch_info->master = 1; 1003 break; 1004 case MLX5_PHYS_PORT_NAME_TYPE_LEGACY: 1005 /* Legacy representors naming schema. */ 1006 switch_info->representor = !device_dir; 1007 break; 1008 case MLX5_PHYS_PORT_NAME_TYPE_PFHPF: 1009 /* Fallthrough */ 1010 case MLX5_PHYS_PORT_NAME_TYPE_PFVF: 1011 /* Fallthrough */ 1012 case MLX5_PHYS_PORT_NAME_TYPE_PFSF: 1013 /* New representors naming schema. */ 1014 switch_info->representor = 1; 1015 break; 1016 default: 1017 switch_info->master = device_dir; 1018 break; 1019 } 1020 } 1021 1022 /** 1023 * Get switch information associated with network interface. 1024 * 1025 * @param ifindex 1026 * Network interface index. 1027 * @param[out] info 1028 * Switch information object, populated in case of success. 1029 * 1030 * @return 1031 * 0 on success, a negative errno value otherwise and rte_errno is set. 1032 */ 1033 int 1034 mlx5_sysfs_switch_info(unsigned int ifindex, struct mlx5_switch_info *info) 1035 { 1036 char ifname[IF_NAMESIZE]; 1037 char port_name[IF_NAMESIZE]; 1038 FILE *file; 1039 struct mlx5_switch_info data = { 1040 .master = 0, 1041 .representor = 0, 1042 .name_type = MLX5_PHYS_PORT_NAME_TYPE_NOTSET, 1043 .port_name = 0, 1044 .switch_id = 0, 1045 }; 1046 DIR *dir; 1047 bool port_switch_id_set = false; 1048 bool device_dir = false; 1049 char c; 1050 1051 if (!if_indextoname(ifindex, ifname)) { 1052 rte_errno = errno; 1053 return -rte_errno; 1054 } 1055 1056 MKSTR(phys_port_name, "/sys/class/net/%s/phys_port_name", 1057 ifname); 1058 MKSTR(phys_switch_id, "/sys/class/net/%s/phys_switch_id", 1059 ifname); 1060 MKSTR(pci_device, "/sys/class/net/%s/device", 1061 ifname); 1062 1063 file = fopen(phys_port_name, "rb"); 1064 if (file != NULL) { 1065 if (fgets(port_name, IF_NAMESIZE, file) != NULL) 1066 mlx5_translate_port_name(port_name, &data); 1067 fclose(file); 1068 } 1069 file = fopen(phys_switch_id, "rb"); 1070 if (file == NULL) { 1071 rte_errno = errno; 1072 return -rte_errno; 1073 } 1074 port_switch_id_set = 1075 fscanf(file, "%" SCNx64 "%c", &data.switch_id, &c) == 2 && 1076 c == '\n'; 1077 fclose(file); 1078 dir = opendir(pci_device); 1079 if (dir != NULL) { 1080 closedir(dir); 1081 device_dir = true; 1082 } 1083 if (port_switch_id_set) { 1084 /* We have some E-Switch configuration. */ 1085 mlx5_sysfs_check_switch_info(device_dir, &data); 1086 } 1087 *info = data; 1088 MLX5_ASSERT(!(data.master && data.representor)); 1089 if (data.master && data.representor) { 1090 DRV_LOG(ERR, "ifindex %u device is recognized as master" 1091 " and as representor", ifindex); 1092 rte_errno = ENODEV; 1093 return -rte_errno; 1094 } 1095 return 0; 1096 } 1097 1098 /** 1099 * Get bond information associated with network interface. 1100 * 1101 * @param pf_ifindex 1102 * Network interface index of bond slave interface 1103 * @param[out] ifindex 1104 * Pointer to bond ifindex. 1105 * @param[out] ifname 1106 * Pointer to bond ifname. 1107 * 1108 * @return 1109 * 0 on success, a negative errno value otherwise and rte_errno is set. 1110 */ 1111 int 1112 mlx5_sysfs_bond_info(unsigned int pf_ifindex, unsigned int *ifindex, 1113 char *ifname) 1114 { 1115 char name[IF_NAMESIZE]; 1116 FILE *file; 1117 unsigned int index; 1118 int ret; 1119 1120 if (!if_indextoname(pf_ifindex, name) || !strlen(name)) { 1121 rte_errno = errno; 1122 return -rte_errno; 1123 } 1124 MKSTR(bond_if, "/sys/class/net/%s/master/ifindex", name); 1125 /* read bond ifindex */ 1126 file = fopen(bond_if, "rb"); 1127 if (file == NULL) { 1128 rte_errno = errno; 1129 return -rte_errno; 1130 } 1131 ret = fscanf(file, "%u", &index); 1132 fclose(file); 1133 if (ret <= 0) { 1134 rte_errno = errno; 1135 return -rte_errno; 1136 } 1137 if (ifindex) 1138 *ifindex = index; 1139 1140 /* read bond device name from symbol link */ 1141 if (ifname) { 1142 if (!if_indextoname(index, ifname)) { 1143 rte_errno = errno; 1144 return -rte_errno; 1145 } 1146 } 1147 return 0; 1148 } 1149 1150 /** 1151 * DPDK callback to retrieve plug-in module EEPROM information (type and size). 1152 * 1153 * @param dev 1154 * Pointer to Ethernet device structure. 1155 * @param[out] modinfo 1156 * Storage for plug-in module EEPROM information. 1157 * 1158 * @return 1159 * 0 on success, a negative errno value otherwise and rte_errno is set. 1160 */ 1161 int 1162 mlx5_get_module_info(struct rte_eth_dev *dev, 1163 struct rte_eth_dev_module_info *modinfo) 1164 { 1165 struct ethtool_modinfo info = { 1166 .cmd = ETHTOOL_GMODULEINFO, 1167 }; 1168 struct ifreq ifr = (struct ifreq) { 1169 .ifr_data = (void *)&info, 1170 }; 1171 int ret = 0; 1172 1173 if (!dev) { 1174 DRV_LOG(WARNING, "missing argument, cannot get module info"); 1175 rte_errno = EINVAL; 1176 return -rte_errno; 1177 } 1178 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1179 if (ret) { 1180 DRV_LOG(WARNING, "port %u ioctl(SIOCETHTOOL) failed: %s", 1181 dev->data->port_id, strerror(rte_errno)); 1182 return ret; 1183 } 1184 modinfo->type = info.type; 1185 modinfo->eeprom_len = info.eeprom_len; 1186 return ret; 1187 } 1188 1189 /** 1190 * DPDK callback to retrieve plug-in module EEPROM data. 1191 * 1192 * @param dev 1193 * Pointer to Ethernet device structure. 1194 * @param[out] info 1195 * Storage for plug-in module EEPROM data. 1196 * 1197 * @return 1198 * 0 on success, a negative errno value otherwise and rte_errno is set. 1199 */ 1200 int mlx5_get_module_eeprom(struct rte_eth_dev *dev, 1201 struct rte_dev_eeprom_info *info) 1202 { 1203 struct ethtool_eeprom *eeprom; 1204 struct ifreq ifr; 1205 int ret = 0; 1206 1207 if (!dev) { 1208 DRV_LOG(WARNING, "missing argument, cannot get module eeprom"); 1209 rte_errno = EINVAL; 1210 return -rte_errno; 1211 } 1212 eeprom = mlx5_malloc(MLX5_MEM_ZERO, 1213 (sizeof(struct ethtool_eeprom) + info->length), 0, 1214 SOCKET_ID_ANY); 1215 if (!eeprom) { 1216 DRV_LOG(WARNING, "port %u cannot allocate memory for " 1217 "eeprom data", dev->data->port_id); 1218 rte_errno = ENOMEM; 1219 return -rte_errno; 1220 } 1221 eeprom->cmd = ETHTOOL_GMODULEEEPROM; 1222 eeprom->offset = info->offset; 1223 eeprom->len = info->length; 1224 ifr = (struct ifreq) { 1225 .ifr_data = (void *)eeprom, 1226 }; 1227 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1228 if (ret) 1229 DRV_LOG(WARNING, "port %u ioctl(SIOCETHTOOL) failed: %s", 1230 dev->data->port_id, strerror(rte_errno)); 1231 else 1232 rte_memcpy(info->data, eeprom->data, info->length); 1233 mlx5_free(eeprom); 1234 return ret; 1235 } 1236 1237 /** 1238 * Read device counters table. 1239 * 1240 * @param dev 1241 * Pointer to Ethernet device. 1242 * @param[in] pf 1243 * PF index in case of bonding device, -1 otherwise 1244 * @param[out] stats 1245 * Counters table output buffer. 1246 * 1247 * @return 1248 * 0 on success and stats is filled, negative errno value otherwise and 1249 * rte_errno is set. 1250 */ 1251 static int 1252 _mlx5_os_read_dev_counters(struct rte_eth_dev *dev, int pf, uint64_t *stats) 1253 { 1254 struct mlx5_priv *priv = dev->data->dev_private; 1255 struct mlx5_xstats_ctrl *xstats_ctrl = &priv->xstats_ctrl; 1256 unsigned int i; 1257 struct ifreq ifr; 1258 unsigned int stats_sz = xstats_ctrl->stats_n * sizeof(uint64_t); 1259 unsigned char et_stat_buf[sizeof(struct ethtool_stats) + stats_sz]; 1260 struct ethtool_stats *et_stats = (struct ethtool_stats *)et_stat_buf; 1261 int ret; 1262 1263 et_stats->cmd = ETHTOOL_GSTATS; 1264 et_stats->n_stats = xstats_ctrl->stats_n; 1265 ifr.ifr_data = (caddr_t)et_stats; 1266 if (pf >= 0) 1267 ret = mlx5_ifreq_by_ifname(priv->sh->bond.ports[pf].ifname, 1268 SIOCETHTOOL, &ifr); 1269 else 1270 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1271 if (ret) { 1272 DRV_LOG(WARNING, 1273 "port %u unable to read statistic values from device", 1274 dev->data->port_id); 1275 return ret; 1276 } 1277 for (i = 0; i != xstats_ctrl->mlx5_stats_n; ++i) { 1278 if (xstats_ctrl->info[i].dev) 1279 continue; 1280 stats[i] += (uint64_t) 1281 et_stats->data[xstats_ctrl->dev_table_idx[i]]; 1282 } 1283 return 0; 1284 } 1285 1286 /** 1287 * Read device counters. 1288 * 1289 * @param dev 1290 * Pointer to Ethernet device. 1291 * @param[out] stats 1292 * Counters table output buffer. 1293 * 1294 * @return 1295 * 0 on success and stats is filled, negative errno value otherwise and 1296 * rte_errno is set. 1297 */ 1298 int 1299 mlx5_os_read_dev_counters(struct rte_eth_dev *dev, uint64_t *stats) 1300 { 1301 struct mlx5_priv *priv = dev->data->dev_private; 1302 struct mlx5_xstats_ctrl *xstats_ctrl = &priv->xstats_ctrl; 1303 int ret = 0, i; 1304 1305 memset(stats, 0, sizeof(*stats) * xstats_ctrl->mlx5_stats_n); 1306 /* Read ifreq counters. */ 1307 if (priv->master && priv->pf_bond >= 0) { 1308 /* Sum xstats from bonding device member ports. */ 1309 for (i = 0; i < priv->sh->bond.n_port; i++) { 1310 ret = _mlx5_os_read_dev_counters(dev, i, stats); 1311 if (ret) 1312 return ret; 1313 } 1314 } else { 1315 ret = _mlx5_os_read_dev_counters(dev, -1, stats); 1316 if (ret) 1317 return ret; 1318 } 1319 /* Read IB counters. */ 1320 for (i = 0; i != xstats_ctrl->mlx5_stats_n; ++i) { 1321 if (!xstats_ctrl->info[i].dev) 1322 continue; 1323 /* return last xstats counter if fail to read. */ 1324 if (mlx5_os_read_dev_stat(priv, xstats_ctrl->info[i].ctr_name, 1325 &stats[i]) == 0) 1326 xstats_ctrl->xstats[i] = stats[i]; 1327 else 1328 stats[i] = xstats_ctrl->xstats[i]; 1329 } 1330 return ret; 1331 } 1332 1333 /** 1334 * Query the number of statistics provided by ETHTOOL. 1335 * 1336 * @param dev 1337 * Pointer to Ethernet device. 1338 * 1339 * @return 1340 * Number of statistics on success, negative errno value otherwise and 1341 * rte_errno is set. 1342 */ 1343 int 1344 mlx5_os_get_stats_n(struct rte_eth_dev *dev) 1345 { 1346 struct mlx5_priv *priv = dev->data->dev_private; 1347 struct ethtool_drvinfo drvinfo; 1348 struct ifreq ifr; 1349 int ret; 1350 1351 drvinfo.cmd = ETHTOOL_GDRVINFO; 1352 ifr.ifr_data = (caddr_t)&drvinfo; 1353 if (priv->master && priv->pf_bond >= 0) 1354 /* Bonding PF. */ 1355 ret = mlx5_ifreq_by_ifname(priv->sh->bond.ports[0].ifname, 1356 SIOCETHTOOL, &ifr); 1357 else 1358 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1359 if (ret) { 1360 DRV_LOG(WARNING, "port %u unable to query number of statistics", 1361 dev->data->port_id); 1362 return ret; 1363 } 1364 return drvinfo.n_stats; 1365 } 1366 1367 static const struct mlx5_counter_ctrl mlx5_counters_init[] = { 1368 { 1369 .dpdk_name = "rx_unicast_bytes", 1370 .ctr_name = "rx_vport_unicast_bytes", 1371 }, 1372 { 1373 .dpdk_name = "rx_multicast_bytes", 1374 .ctr_name = "rx_vport_multicast_bytes", 1375 }, 1376 { 1377 .dpdk_name = "rx_broadcast_bytes", 1378 .ctr_name = "rx_vport_broadcast_bytes", 1379 }, 1380 { 1381 .dpdk_name = "rx_unicast_packets", 1382 .ctr_name = "rx_vport_unicast_packets", 1383 }, 1384 { 1385 .dpdk_name = "rx_multicast_packets", 1386 .ctr_name = "rx_vport_multicast_packets", 1387 }, 1388 { 1389 .dpdk_name = "rx_broadcast_packets", 1390 .ctr_name = "rx_vport_broadcast_packets", 1391 }, 1392 { 1393 .dpdk_name = "tx_unicast_bytes", 1394 .ctr_name = "tx_vport_unicast_bytes", 1395 }, 1396 { 1397 .dpdk_name = "tx_multicast_bytes", 1398 .ctr_name = "tx_vport_multicast_bytes", 1399 }, 1400 { 1401 .dpdk_name = "tx_broadcast_bytes", 1402 .ctr_name = "tx_vport_broadcast_bytes", 1403 }, 1404 { 1405 .dpdk_name = "tx_unicast_packets", 1406 .ctr_name = "tx_vport_unicast_packets", 1407 }, 1408 { 1409 .dpdk_name = "tx_multicast_packets", 1410 .ctr_name = "tx_vport_multicast_packets", 1411 }, 1412 { 1413 .dpdk_name = "tx_broadcast_packets", 1414 .ctr_name = "tx_vport_broadcast_packets", 1415 }, 1416 { 1417 .dpdk_name = "rx_wqe_errors", 1418 .ctr_name = "rx_wqe_err", 1419 }, 1420 { 1421 .dpdk_name = "rx_phy_crc_errors", 1422 .ctr_name = "rx_crc_errors_phy", 1423 }, 1424 { 1425 .dpdk_name = "rx_phy_in_range_len_errors", 1426 .ctr_name = "rx_in_range_len_errors_phy", 1427 }, 1428 { 1429 .dpdk_name = "rx_phy_symbol_errors", 1430 .ctr_name = "rx_symbol_err_phy", 1431 }, 1432 { 1433 .dpdk_name = "tx_phy_errors", 1434 .ctr_name = "tx_errors_phy", 1435 }, 1436 { 1437 .dpdk_name = "rx_out_of_buffer", 1438 .ctr_name = "out_of_buffer", 1439 .dev = 1, 1440 }, 1441 { 1442 .dpdk_name = "tx_phy_packets", 1443 .ctr_name = "tx_packets_phy", 1444 }, 1445 { 1446 .dpdk_name = "rx_phy_packets", 1447 .ctr_name = "rx_packets_phy", 1448 }, 1449 { 1450 .dpdk_name = "tx_phy_discard_packets", 1451 .ctr_name = "tx_discards_phy", 1452 }, 1453 { 1454 .dpdk_name = "rx_phy_discard_packets", 1455 .ctr_name = "rx_discards_phy", 1456 }, 1457 { 1458 .dpdk_name = "rx_prio0_buf_discard_packets", 1459 .ctr_name = "rx_prio0_buf_discard", 1460 }, 1461 { 1462 .dpdk_name = "rx_prio1_buf_discard_packets", 1463 .ctr_name = "rx_prio1_buf_discard", 1464 }, 1465 { 1466 .dpdk_name = "rx_prio2_buf_discard_packets", 1467 .ctr_name = "rx_prio2_buf_discard", 1468 }, 1469 { 1470 .dpdk_name = "rx_prio3_buf_discard_packets", 1471 .ctr_name = "rx_prio3_buf_discard", 1472 }, 1473 { 1474 .dpdk_name = "rx_prio4_buf_discard_packets", 1475 .ctr_name = "rx_prio4_buf_discard", 1476 }, 1477 { 1478 .dpdk_name = "rx_prio5_buf_discard_packets", 1479 .ctr_name = "rx_prio5_buf_discard", 1480 }, 1481 { 1482 .dpdk_name = "rx_prio6_buf_discard_packets", 1483 .ctr_name = "rx_prio6_buf_discard", 1484 }, 1485 { 1486 .dpdk_name = "rx_prio7_buf_discard_packets", 1487 .ctr_name = "rx_prio7_buf_discard", 1488 }, 1489 { 1490 .dpdk_name = "rx_prio0_cong_discard_packets", 1491 .ctr_name = "rx_prio0_cong_discard", 1492 }, 1493 { 1494 .dpdk_name = "rx_prio1_cong_discard_packets", 1495 .ctr_name = "rx_prio1_cong_discard", 1496 }, 1497 { 1498 .dpdk_name = "rx_prio2_cong_discard_packets", 1499 .ctr_name = "rx_prio2_cong_discard", 1500 }, 1501 { 1502 .dpdk_name = "rx_prio3_cong_discard_packets", 1503 .ctr_name = "rx_prio3_cong_discard", 1504 }, 1505 { 1506 .dpdk_name = "rx_prio4_cong_discard_packets", 1507 .ctr_name = "rx_prio4_cong_discard", 1508 }, 1509 { 1510 .dpdk_name = "rx_prio5_cong_discard_packets", 1511 .ctr_name = "rx_prio5_cong_discard", 1512 }, 1513 { 1514 .dpdk_name = "rx_prio6_cong_discard_packets", 1515 .ctr_name = "rx_prio6_cong_discard", 1516 }, 1517 { 1518 .dpdk_name = "rx_prio7_cong_discard_packets", 1519 .ctr_name = "rx_prio7_cong_discard", 1520 }, 1521 { 1522 .dpdk_name = "tx_phy_bytes", 1523 .ctr_name = "tx_bytes_phy", 1524 }, 1525 { 1526 .dpdk_name = "rx_phy_bytes", 1527 .ctr_name = "rx_bytes_phy", 1528 }, 1529 /* Representor only */ 1530 { 1531 .dpdk_name = "rx_vport_packets", 1532 .ctr_name = "vport_rx_packets", 1533 }, 1534 { 1535 .dpdk_name = "rx_vport_bytes", 1536 .ctr_name = "vport_rx_bytes", 1537 }, 1538 { 1539 .dpdk_name = "tx_vport_packets", 1540 .ctr_name = "vport_tx_packets", 1541 }, 1542 { 1543 .dpdk_name = "tx_vport_bytes", 1544 .ctr_name = "vport_tx_bytes", 1545 }, 1546 }; 1547 1548 static const unsigned int xstats_n = RTE_DIM(mlx5_counters_init); 1549 1550 /** 1551 * Init the structures to read device counters. 1552 * 1553 * @param dev 1554 * Pointer to Ethernet device. 1555 */ 1556 void 1557 mlx5_os_stats_init(struct rte_eth_dev *dev) 1558 { 1559 struct mlx5_priv *priv = dev->data->dev_private; 1560 struct mlx5_xstats_ctrl *xstats_ctrl = &priv->xstats_ctrl; 1561 struct mlx5_stats_ctrl *stats_ctrl = &priv->stats_ctrl; 1562 unsigned int i; 1563 unsigned int j; 1564 struct ifreq ifr; 1565 struct ethtool_gstrings *strings = NULL; 1566 unsigned int dev_stats_n; 1567 unsigned int str_sz; 1568 int ret; 1569 1570 /* So that it won't aggregate for each init. */ 1571 xstats_ctrl->mlx5_stats_n = 0; 1572 ret = mlx5_os_get_stats_n(dev); 1573 if (ret < 0) { 1574 DRV_LOG(WARNING, "port %u no extended statistics available", 1575 dev->data->port_id); 1576 return; 1577 } 1578 dev_stats_n = ret; 1579 /* Allocate memory to grab stat names and values. */ 1580 str_sz = dev_stats_n * ETH_GSTRING_LEN; 1581 strings = (struct ethtool_gstrings *) 1582 mlx5_malloc(0, str_sz + sizeof(struct ethtool_gstrings), 0, 1583 SOCKET_ID_ANY); 1584 if (!strings) { 1585 DRV_LOG(WARNING, "port %u unable to allocate memory for xstats", 1586 dev->data->port_id); 1587 return; 1588 } 1589 strings->cmd = ETHTOOL_GSTRINGS; 1590 strings->string_set = ETH_SS_STATS; 1591 strings->len = dev_stats_n; 1592 ifr.ifr_data = (caddr_t)strings; 1593 if (priv->master && priv->pf_bond >= 0) 1594 /* Bonding master. */ 1595 ret = mlx5_ifreq_by_ifname(priv->sh->bond.ports[0].ifname, 1596 SIOCETHTOOL, &ifr); 1597 else 1598 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1599 if (ret) { 1600 DRV_LOG(WARNING, "port %u unable to get statistic names", 1601 dev->data->port_id); 1602 goto free; 1603 } 1604 for (i = 0; i != dev_stats_n; ++i) { 1605 const char *curr_string = (const char *) 1606 &strings->data[i * ETH_GSTRING_LEN]; 1607 1608 for (j = 0; j != xstats_n; ++j) { 1609 if (!strcmp(mlx5_counters_init[j].ctr_name, 1610 curr_string)) { 1611 unsigned int idx = xstats_ctrl->mlx5_stats_n++; 1612 1613 xstats_ctrl->dev_table_idx[idx] = i; 1614 xstats_ctrl->info[idx] = mlx5_counters_init[j]; 1615 break; 1616 } 1617 } 1618 } 1619 /* Add dev counters. */ 1620 MLX5_ASSERT(xstats_ctrl->mlx5_stats_n <= MLX5_MAX_XSTATS); 1621 for (i = 0; i != xstats_n; ++i) { 1622 if (mlx5_counters_init[i].dev) { 1623 unsigned int idx = xstats_ctrl->mlx5_stats_n++; 1624 1625 xstats_ctrl->info[idx] = mlx5_counters_init[i]; 1626 xstats_ctrl->hw_stats[idx] = 0; 1627 } 1628 } 1629 xstats_ctrl->stats_n = dev_stats_n; 1630 /* Copy to base at first time. */ 1631 ret = mlx5_os_read_dev_counters(dev, xstats_ctrl->base); 1632 if (ret) 1633 DRV_LOG(ERR, "port %u cannot read device counters: %s", 1634 dev->data->port_id, strerror(rte_errno)); 1635 mlx5_os_read_dev_stat(priv, "out_of_buffer", &stats_ctrl->imissed_base); 1636 stats_ctrl->imissed = 0; 1637 free: 1638 mlx5_free(strings); 1639 } 1640 1641 /** 1642 * Get MAC address by querying netdevice. 1643 * 1644 * @param[in] dev 1645 * Pointer to Ethernet device. 1646 * @param[out] mac 1647 * MAC address output buffer. 1648 * 1649 * @return 1650 * 0 on success, a negative errno value otherwise and rte_errno is set. 1651 */ 1652 int 1653 mlx5_get_mac(struct rte_eth_dev *dev, uint8_t (*mac)[RTE_ETHER_ADDR_LEN]) 1654 { 1655 struct ifreq request; 1656 int ret; 1657 1658 ret = mlx5_ifreq(dev, SIOCGIFHWADDR, &request); 1659 if (ret) 1660 return ret; 1661 memcpy(mac, request.ifr_hwaddr.sa_data, RTE_ETHER_ADDR_LEN); 1662 return 0; 1663 } 1664 1665 /* 1666 * Query dropless_rq private flag value provided by ETHTOOL. 1667 * 1668 * @param dev 1669 * Pointer to Ethernet device. 1670 * 1671 * @return 1672 * - 0 on success, flag is not set. 1673 * - 1 on success, flag is set. 1674 * - negative errno value otherwise and rte_errno is set. 1675 */ 1676 int mlx5_get_flag_dropless_rq(struct rte_eth_dev *dev) 1677 { 1678 struct { 1679 struct ethtool_sset_info hdr; 1680 uint32_t buf[1]; 1681 } sset_info; 1682 struct ethtool_drvinfo drvinfo; 1683 struct ifreq ifr; 1684 struct ethtool_gstrings *strings = NULL; 1685 struct ethtool_value flags; 1686 const int32_t flag_len = sizeof(flags.data) * CHAR_BIT; 1687 int32_t str_sz; 1688 int32_t len; 1689 int32_t i; 1690 int ret; 1691 1692 sset_info.hdr.cmd = ETHTOOL_GSSET_INFO; 1693 sset_info.hdr.reserved = 0; 1694 sset_info.hdr.sset_mask = 1ULL << ETH_SS_PRIV_FLAGS; 1695 ifr.ifr_data = (caddr_t)&sset_info; 1696 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1697 if (!ret) { 1698 const uint32_t *sset_lengths = sset_info.hdr.data; 1699 1700 len = sset_info.hdr.sset_mask ? sset_lengths[0] : 0; 1701 } else if (ret == -EOPNOTSUPP) { 1702 drvinfo.cmd = ETHTOOL_GDRVINFO; 1703 ifr.ifr_data = (caddr_t)&drvinfo; 1704 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1705 if (ret) { 1706 DRV_LOG(WARNING, "port %u cannot get the driver info", 1707 dev->data->port_id); 1708 goto exit; 1709 } 1710 len = *(uint32_t *)((char *)&drvinfo + 1711 offsetof(struct ethtool_drvinfo, n_priv_flags)); 1712 } else { 1713 DRV_LOG(WARNING, "port %u cannot get the sset info", 1714 dev->data->port_id); 1715 goto exit; 1716 } 1717 if (!len) { 1718 DRV_LOG(WARNING, "port %u does not have private flag", 1719 dev->data->port_id); 1720 rte_errno = EOPNOTSUPP; 1721 ret = -rte_errno; 1722 goto exit; 1723 } else if (len > flag_len) { 1724 DRV_LOG(WARNING, "port %u maximal private flags number is %d", 1725 dev->data->port_id, flag_len); 1726 len = flag_len; 1727 } 1728 str_sz = ETH_GSTRING_LEN * len; 1729 strings = (struct ethtool_gstrings *) 1730 mlx5_malloc(0, str_sz + sizeof(struct ethtool_gstrings), 0, 1731 SOCKET_ID_ANY); 1732 if (!strings) { 1733 DRV_LOG(WARNING, "port %u unable to allocate memory for" 1734 " private flags", dev->data->port_id); 1735 rte_errno = ENOMEM; 1736 ret = -rte_errno; 1737 goto exit; 1738 } 1739 strings->cmd = ETHTOOL_GSTRINGS; 1740 strings->string_set = ETH_SS_PRIV_FLAGS; 1741 strings->len = len; 1742 ifr.ifr_data = (caddr_t)strings; 1743 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1744 if (ret) { 1745 DRV_LOG(WARNING, "port %u unable to get private flags strings", 1746 dev->data->port_id); 1747 goto exit; 1748 } 1749 for (i = 0; i < len; i++) { 1750 strings->data[(i + 1) * ETH_GSTRING_LEN - 1] = 0; 1751 if (!strcmp((const char *)strings->data + i * ETH_GSTRING_LEN, 1752 "dropless_rq")) 1753 break; 1754 } 1755 if (i == len) { 1756 DRV_LOG(WARNING, "port %u does not support dropless_rq", 1757 dev->data->port_id); 1758 rte_errno = EOPNOTSUPP; 1759 ret = -rte_errno; 1760 goto exit; 1761 } 1762 flags.cmd = ETHTOOL_GPFLAGS; 1763 ifr.ifr_data = (caddr_t)&flags; 1764 ret = mlx5_ifreq(dev, SIOCETHTOOL, &ifr); 1765 if (ret) { 1766 DRV_LOG(WARNING, "port %u unable to get private flags status", 1767 dev->data->port_id); 1768 goto exit; 1769 } 1770 ret = !!(flags.data & (1U << i)); 1771 exit: 1772 mlx5_free(strings); 1773 return ret; 1774 } 1775