drivers/net/failsafe/failsafe_ops.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright 2017 6WIND S.A.
   3  * Copyright 2017 Mellanox Technologies, Ltd
   4  */
   5
   6 #include <stdbool.h>
   7 #include <stdint.h>
   8 #include <unistd.h>
   9
  10 #include <rte_debug.h>
  11 #include <rte_atomic.h>
  12 #include <rte_ethdev_driver.h>
  13 #include <rte_malloc.h>
  14 #include <rte_flow.h>
  15 #include <rte_cycles.h>
  16 #include <rte_ethdev.h>
  17 #include <rte_string_fns.h>
  18
  19 #include "failsafe_private.h"
  20
  21 static int
  22 fs_dev_configure(struct rte_eth_dev *dev)
  23 {
  24         struct sub_device *sdev;
  25         uint8_t i;
  26         int ret;
  27
  28         fs_lock(dev, 0);
  29         FOREACH_SUBDEV(sdev, i, dev) {
  30                 int rmv_interrupt = 0;
  31                 int lsc_interrupt = 0;
  32                 int lsc_enabled;
  33
  34                 if (sdev->state != DEV_PROBED &&
  35                     !(PRIV(dev)->alarm_lock == 0 && sdev->state == DEV_ACTIVE))
  36                         continue;
  37
  38                 rmv_interrupt = ETH(sdev)->data->dev_flags &
  39                                 RTE_ETH_DEV_INTR_RMV;
  40                 if (rmv_interrupt) {
  41                         DEBUG("Enabling RMV interrupts for sub_device %d", i);
  42                         dev->data->dev_conf.intr_conf.rmv = 1;
  43                 } else {
  44                         DEBUG("sub_device %d does not support RMV event", i);
  45                 }
  46                 lsc_enabled = dev->data->dev_conf.intr_conf.lsc;
  47                 lsc_interrupt = lsc_enabled &&
  48                                 (ETH(sdev)->data->dev_flags &
  49                                  RTE_ETH_DEV_INTR_LSC);
  50                 if (lsc_interrupt) {
  51                         DEBUG("Enabling LSC interrupts for sub_device %d", i);
  52                         dev->data->dev_conf.intr_conf.lsc = 1;
  53                 } else if (lsc_enabled && !lsc_interrupt) {
  54                         DEBUG("Disabling LSC interrupts for sub_device %d", i);
  55                         dev->data->dev_conf.intr_conf.lsc = 0;
  56                 }
  57                 DEBUG("Configuring sub-device %d", i);
  58                 ret = rte_eth_dev_configure(PORT_ID(sdev),
  59                                         dev->data->nb_rx_queues,
  60                                         dev->data->nb_tx_queues,
  61                                         &dev->data->dev_conf);
  62                 if (ret) {
  63                         if (!fs_err(sdev, ret))
  64                                 continue;
  65                         ERROR("Could not configure sub_device %d", i);
  66                         fs_unlock(dev, 0);
  67                         return ret;
  68                 }
  69                 if (rmv_interrupt && sdev->rmv_callback == 0) {
  70                         ret = rte_eth_dev_callback_register(PORT_ID(sdev),
  71                                         RTE_ETH_EVENT_INTR_RMV,
  72                                         failsafe_eth_rmv_event_callback,
  73                                         sdev);
  74                         if (ret)
  75                                 WARN("Failed to register RMV callback for sub_device %d",
  76                                      SUB_ID(sdev));
  77                         else
  78                                 sdev->rmv_callback = 1;
  79                 }
  80                 dev->data->dev_conf.intr_conf.rmv = 0;
  81                 if (lsc_interrupt && sdev->lsc_callback == 0) {
  82                         ret = rte_eth_dev_callback_register(PORT_ID(sdev),
  83                                                 RTE_ETH_EVENT_INTR_LSC,
  84                                                 failsafe_eth_lsc_event_callback,
  85                                                 dev);
  86                         if (ret)
  87                                 WARN("Failed to register LSC callback for sub_device %d",
  88                                      SUB_ID(sdev));
  89                         else
  90                                 sdev->lsc_callback = 1;
  91                 }
  92                 dev->data->dev_conf.intr_conf.lsc = lsc_enabled;
  93                 sdev->state = DEV_ACTIVE;
  94         }
  95         if (PRIV(dev)->state < DEV_ACTIVE)
  96                 PRIV(dev)->state = DEV_ACTIVE;
  97         fs_unlock(dev, 0);
  98         return 0;
  99 }
 100
 101 static void
 102 fs_set_queues_state_start(struct rte_eth_dev *dev)
 103 {
 104         struct rxq *rxq;
 105         struct txq *txq;
 106         uint16_t i;
 107
 108         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 109                 rxq = dev->data->rx_queues[i];
 110                 if (rxq != NULL && !rxq->info.conf.rx_deferred_start)
 111                         dev->data->rx_queue_state[i] =
 112                                                 RTE_ETH_QUEUE_STATE_STARTED;
 113         }
 114         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 115                 txq = dev->data->tx_queues[i];
 116                 if (txq != NULL && !txq->info.conf.tx_deferred_start)
 117                         dev->data->tx_queue_state[i] =
 118                                                 RTE_ETH_QUEUE_STATE_STARTED;
 119         }
 120 }
 121
 122 static int
 123 fs_dev_start(struct rte_eth_dev *dev)
 124 {
 125         struct sub_device *sdev;
 126         uint8_t i;
 127         int ret;
 128
 129         fs_lock(dev, 0);
 130         ret = failsafe_rx_intr_install(dev);
 131         if (ret) {
 132                 fs_unlock(dev, 0);
 133                 return ret;
 134         }
 135         FOREACH_SUBDEV(sdev, i, dev) {
 136                 if (sdev->state != DEV_ACTIVE)
 137                         continue;
 138                 DEBUG("Starting sub_device %d", i);
 139                 ret = rte_eth_dev_start(PORT_ID(sdev));
 140                 if (ret) {
 141                         if (!fs_err(sdev, ret))
 142                                 continue;
 143                         fs_unlock(dev, 0);
 144                         return ret;
 145                 }
 146                 ret = failsafe_rx_intr_install_subdevice(sdev);
 147                 if (ret) {
 148                         if (!fs_err(sdev, ret))
 149                                 continue;
 150                         rte_eth_dev_stop(PORT_ID(sdev));
 151                         fs_unlock(dev, 0);
 152                         return ret;
 153                 }
 154                 sdev->state = DEV_STARTED;
 155         }
 156         if (PRIV(dev)->state < DEV_STARTED) {
 157                 PRIV(dev)->state = DEV_STARTED;
 158                 fs_set_queues_state_start(dev);
 159         }
 160         fs_switch_dev(dev, NULL);
 161         fs_unlock(dev, 0);
 162         return 0;
 163 }
 164
 165 static void
 166 fs_set_queues_state_stop(struct rte_eth_dev *dev)
 167 {
 168         uint16_t i;
 169
 170         for (i = 0; i < dev->data->nb_rx_queues; i++)
 171                 if (dev->data->rx_queues[i] != NULL)
 172                         dev->data->rx_queue_state[i] =
 173                                                 RTE_ETH_QUEUE_STATE_STOPPED;
 174         for (i = 0; i < dev->data->nb_tx_queues; i++)
 175                 if (dev->data->tx_queues[i] != NULL)
 176                         dev->data->tx_queue_state[i] =
 177                                                 RTE_ETH_QUEUE_STATE_STOPPED;
 178 }
 179
 180 static void
 181 fs_dev_stop(struct rte_eth_dev *dev)
 182 {
 183         struct sub_device *sdev;
 184         uint8_t i;
 185
 186         fs_lock(dev, 0);
 187         PRIV(dev)->state = DEV_STARTED - 1;
 188         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_STARTED) {
 189                 rte_eth_dev_stop(PORT_ID(sdev));
 190                 failsafe_rx_intr_uninstall_subdevice(sdev);
 191                 sdev->state = DEV_STARTED - 1;
 192         }
 193         failsafe_rx_intr_uninstall(dev);
 194         fs_set_queues_state_stop(dev);
 195         fs_unlock(dev, 0);
 196 }
 197
 198 static int
 199 fs_dev_set_link_up(struct rte_eth_dev *dev)
 200 {
 201         struct sub_device *sdev;
 202         uint8_t i;
 203         int ret;
 204
 205         fs_lock(dev, 0);
 206         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 207                 DEBUG("Calling rte_eth_dev_set_link_up on sub_device %d", i);
 208                 ret = rte_eth_dev_set_link_up(PORT_ID(sdev));
 209                 if ((ret = fs_err(sdev, ret))) {
 210                         ERROR("Operation rte_eth_dev_set_link_up failed for sub_device %d"
 211                               " with error %d", i, ret);
 212                         fs_unlock(dev, 0);
 213                         return ret;
 214                 }
 215         }
 216         fs_unlock(dev, 0);
 217         return 0;
 218 }
 219
 220 static int
 221 fs_dev_set_link_down(struct rte_eth_dev *dev)
 222 {
 223         struct sub_device *sdev;
 224         uint8_t i;
 225         int ret;
 226
 227         fs_lock(dev, 0);
 228         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 229                 DEBUG("Calling rte_eth_dev_set_link_down on sub_device %d", i);
 230                 ret = rte_eth_dev_set_link_down(PORT_ID(sdev));
 231                 if ((ret = fs_err(sdev, ret))) {
 232                         ERROR("Operation rte_eth_dev_set_link_down failed for sub_device %d"
 233                               " with error %d", i, ret);
 234                         fs_unlock(dev, 0);
 235                         return ret;
 236                 }
 237         }
 238         fs_unlock(dev, 0);
 239         return 0;
 240 }
 241
 242 static void fs_dev_free_queues(struct rte_eth_dev *dev);
 243 static void
 244 fs_dev_close(struct rte_eth_dev *dev)
 245 {
 246         struct sub_device *sdev;
 247         uint8_t i;
 248
 249         fs_lock(dev, 0);
 250         failsafe_hotplug_alarm_cancel(dev);
 251         if (PRIV(dev)->state == DEV_STARTED)
 252                 dev->dev_ops->dev_stop(dev);
 253         PRIV(dev)->state = DEV_ACTIVE - 1;
 254         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 255                 DEBUG("Closing sub_device %d", i);
 256                 failsafe_eth_dev_unregister_callbacks(sdev);
 257                 rte_eth_dev_close(PORT_ID(sdev));
 258                 sdev->state = DEV_ACTIVE - 1;
 259         }
 260         fs_dev_free_queues(dev);
 261         fs_unlock(dev, 0);
 262 }
 263
 264 static int
 265 fs_rx_queue_stop(struct rte_eth_dev *dev, uint16_t rx_queue_id)
 266 {
 267         struct sub_device *sdev;
 268         uint8_t i;
 269         int ret;
 270         int err = 0;
 271         bool failure = true;
 272
 273         fs_lock(dev, 0);
 274         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 275                 uint16_t port_id = ETH(sdev)->data->port_id;
 276
 277                 ret = rte_eth_dev_rx_queue_stop(port_id, rx_queue_id);
 278                 ret = fs_err(sdev, ret);
 279                 if (ret) {
 280                         ERROR("Rx queue stop failed for subdevice %d", i);
 281                         err = ret;
 282                 } else {
 283                         failure = false;
 284                 }
 285         }
 286         dev->data->rx_queue_state[rx_queue_id] = RTE_ETH_QUEUE_STATE_STOPPED;
 287         fs_unlock(dev, 0);
 288         /* Return 0 in case of at least one successful queue stop */
 289         return (failure) ? err : 0;
 290 }
 291
 292 static int
 293 fs_rx_queue_start(struct rte_eth_dev *dev, uint16_t rx_queue_id)
 294 {
 295         struct sub_device *sdev;
 296         uint8_t i;
 297         int ret;
 298
 299         fs_lock(dev, 0);
 300         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 301                 uint16_t port_id = ETH(sdev)->data->port_id;
 302
 303                 ret = rte_eth_dev_rx_queue_start(port_id, rx_queue_id);
 304                 ret = fs_err(sdev, ret);
 305                 if (ret) {
 306                         ERROR("Rx queue start failed for subdevice %d", i);
 307                         fs_rx_queue_stop(dev, rx_queue_id);
 308                         fs_unlock(dev, 0);
 309                         return ret;
 310                 }
 311         }
 312         dev->data->rx_queue_state[rx_queue_id] = RTE_ETH_QUEUE_STATE_STARTED;
 313         fs_unlock(dev, 0);
 314         return 0;
 315 }
 316
 317 static int
 318 fs_tx_queue_stop(struct rte_eth_dev *dev, uint16_t tx_queue_id)
 319 {
 320         struct sub_device *sdev;
 321         uint8_t i;
 322         int ret;
 323         int err = 0;
 324         bool failure = true;
 325
 326         fs_lock(dev, 0);
 327         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 328                 uint16_t port_id = ETH(sdev)->data->port_id;
 329
 330                 ret = rte_eth_dev_tx_queue_stop(port_id, tx_queue_id);
 331                 ret = fs_err(sdev, ret);
 332                 if (ret) {
 333                         ERROR("Tx queue stop failed for subdevice %d", i);
 334                         err = ret;
 335                 } else {
 336                         failure = false;
 337                 }
 338         }
 339         dev->data->tx_queue_state[tx_queue_id] = RTE_ETH_QUEUE_STATE_STOPPED;
 340         fs_unlock(dev, 0);
 341         /* Return 0 in case of at least one successful queue stop */
 342         return (failure) ? err : 0;
 343 }
 344
 345 static int
 346 fs_tx_queue_start(struct rte_eth_dev *dev, uint16_t tx_queue_id)
 347 {
 348         struct sub_device *sdev;
 349         uint8_t i;
 350         int ret;
 351
 352         fs_lock(dev, 0);
 353         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 354                 uint16_t port_id = ETH(sdev)->data->port_id;
 355
 356                 ret = rte_eth_dev_tx_queue_start(port_id, tx_queue_id);
 357                 ret = fs_err(sdev, ret);
 358                 if (ret) {
 359                         ERROR("Tx queue start failed for subdevice %d", i);
 360                         fs_tx_queue_stop(dev, tx_queue_id);
 361                         fs_unlock(dev, 0);
 362                         return ret;
 363                 }
 364         }
 365         dev->data->tx_queue_state[tx_queue_id] = RTE_ETH_QUEUE_STATE_STARTED;
 366         fs_unlock(dev, 0);
 367         return 0;
 368 }
 369
 370 static void
 371 fs_rx_queue_release(void *queue)
 372 {
 373         struct rte_eth_dev *dev;
 374         struct sub_device *sdev;
 375         uint8_t i;
 376         struct rxq *rxq;
 377
 378         if (queue == NULL)
 379                 return;
 380         rxq = queue;
 381         dev = &rte_eth_devices[rxq->priv->data->port_id];
 382         fs_lock(dev, 0);
 383         if (rxq->event_fd >= 0)
 384                 close(rxq->event_fd);
 385         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 386                 if (ETH(sdev)->data->rx_queues != NULL &&
 387                     ETH(sdev)->data->rx_queues[rxq->qid] != NULL) {
 388                         SUBOPS(sdev, rx_queue_release)
 389                                 (ETH(sdev)->data->rx_queues[rxq->qid]);
 390                 }
 391         }
 392         dev->data->rx_queues[rxq->qid] = NULL;
 393         rte_free(rxq);
 394         fs_unlock(dev, 0);
 395 }
 396
 397 static int
 398 fs_rx_queue_setup(struct rte_eth_dev *dev,
 399                 uint16_t rx_queue_id,
 400                 uint16_t nb_rx_desc,
 401                 unsigned int socket_id,
 402                 const struct rte_eth_rxconf *rx_conf,
 403                 struct rte_mempool *mb_pool)
 404 {
 405         /*
 406          * FIXME: Add a proper interface in rte_eal_interrupts for
 407          * allocating eventfd as an interrupt vector.
 408          * For the time being, fake as if we are using MSIX interrupts,
 409          * this will cause rte_intr_efd_enable to allocate an eventfd for us.
 410          */
 411         struct rte_intr_handle intr_handle = {
 412                 .type = RTE_INTR_HANDLE_VFIO_MSIX,
 413                 .efds = { -1, },
 414         };
 415         struct sub_device *sdev;
 416         struct rxq *rxq;
 417         uint8_t i;
 418         int ret;
 419
 420         fs_lock(dev, 0);
 421         if (rx_conf->rx_deferred_start) {
 422                 FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_PROBED) {
 423                         if (SUBOPS(sdev, rx_queue_start) == NULL) {
 424                                 ERROR("Rx queue deferred start is not "
 425                                         "supported for subdevice %d", i);
 426                                 fs_unlock(dev, 0);
 427                                 return -EINVAL;
 428                         }
 429                 }
 430         }
 431         rxq = dev->data->rx_queues[rx_queue_id];
 432         if (rxq != NULL) {
 433                 fs_rx_queue_release(rxq);
 434                 dev->data->rx_queues[rx_queue_id] = NULL;
 435         }
 436         rxq = rte_zmalloc(NULL,
 437                           sizeof(*rxq) +
 438                           sizeof(rte_atomic64_t) * PRIV(dev)->subs_tail,
 439                           RTE_CACHE_LINE_SIZE);
 440         if (rxq == NULL) {
 441                 fs_unlock(dev, 0);
 442                 return -ENOMEM;
 443         }
 444         FOREACH_SUBDEV(sdev, i, dev)
 445                 rte_atomic64_init(&rxq->refcnt[i]);
 446         rxq->qid = rx_queue_id;
 447         rxq->socket_id = socket_id;
 448         rxq->info.mp = mb_pool;
 449         rxq->info.conf = *rx_conf;
 450         rxq->info.nb_desc = nb_rx_desc;
 451         rxq->priv = PRIV(dev);
 452         rxq->sdev = PRIV(dev)->subs;
 453         ret = rte_intr_efd_enable(&intr_handle, 1);
 454         if (ret < 0) {
 455                 fs_unlock(dev, 0);
 456                 return ret;
 457         }
 458         rxq->event_fd = intr_handle.efds[0];
 459         dev->data->rx_queues[rx_queue_id] = rxq;
 460         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 461                 ret = rte_eth_rx_queue_setup(PORT_ID(sdev),
 462                                 rx_queue_id,
 463                                 nb_rx_desc, socket_id,
 464                                 rx_conf, mb_pool);
 465                 if ((ret = fs_err(sdev, ret))) {
 466                         ERROR("RX queue setup failed for sub_device %d", i);
 467                         goto free_rxq;
 468                 }
 469         }
 470         fs_unlock(dev, 0);
 471         return 0;
 472 free_rxq:
 473         fs_rx_queue_release(rxq);
 474         fs_unlock(dev, 0);
 475         return ret;
 476 }
 477
 478 static int
 479 fs_rx_intr_enable(struct rte_eth_dev *dev, uint16_t idx)
 480 {
 481         struct rxq *rxq;
 482         struct sub_device *sdev;
 483         uint8_t i;
 484         int ret;
 485         int rc = 0;
 486
 487         fs_lock(dev, 0);
 488         if (idx >= dev->data->nb_rx_queues) {
 489                 rc = -EINVAL;
 490                 goto unlock;
 491         }
 492         rxq = dev->data->rx_queues[idx];
 493         if (rxq == NULL || rxq->event_fd <= 0) {
 494                 rc = -EINVAL;
 495                 goto unlock;
 496         }
 497         /* Fail if proxy service is nor running. */
 498         if (PRIV(dev)->rxp.sstate != SS_RUNNING) {
 499                 ERROR("failsafe interrupt services are not running");
 500                 rc = -EAGAIN;
 501                 goto unlock;
 502         }
 503         rxq->enable_events = 1;
 504         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 505                 ret = rte_eth_dev_rx_intr_enable(PORT_ID(sdev), idx);
 506                 ret = fs_err(sdev, ret);
 507                 if (ret)
 508                         rc = ret;
 509         }
 510 unlock:
 511         fs_unlock(dev, 0);
 512         if (rc)
 513                 rte_errno = -rc;
 514         return rc;
 515 }
 516
 517 static int
 518 fs_rx_intr_disable(struct rte_eth_dev *dev, uint16_t idx)
 519 {
 520         struct rxq *rxq;
 521         struct sub_device *sdev;
 522         uint64_t u64;
 523         uint8_t i;
 524         int rc = 0;
 525         int ret;
 526
 527         fs_lock(dev, 0);
 528         if (idx >= dev->data->nb_rx_queues) {
 529                 rc = -EINVAL;
 530                 goto unlock;
 531         }
 532         rxq = dev->data->rx_queues[idx];
 533         if (rxq == NULL || rxq->event_fd <= 0) {
 534                 rc = -EINVAL;
 535                 goto unlock;
 536         }
 537         rxq->enable_events = 0;
 538         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 539                 ret = rte_eth_dev_rx_intr_disable(PORT_ID(sdev), idx);
 540                 ret = fs_err(sdev, ret);
 541                 if (ret)
 542                         rc = ret;
 543         }
 544         /* Clear pending events */
 545         while (read(rxq->event_fd, &u64, sizeof(uint64_t)) >  0)
 546                 ;
 547 unlock:
 548         fs_unlock(dev, 0);
 549         if (rc)
 550                 rte_errno = -rc;
 551         return rc;
 552 }
 553
 554 static void
 555 fs_tx_queue_release(void *queue)
 556 {
 557         struct rte_eth_dev *dev;
 558         struct sub_device *sdev;
 559         uint8_t i;
 560         struct txq *txq;
 561
 562         if (queue == NULL)
 563                 return;
 564         txq = queue;
 565         dev = &rte_eth_devices[txq->priv->data->port_id];
 566         fs_lock(dev, 0);
 567         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 568                 if (ETH(sdev)->data->tx_queues != NULL &&
 569                     ETH(sdev)->data->tx_queues[txq->qid] != NULL) {
 570                         SUBOPS(sdev, tx_queue_release)
 571                                 (ETH(sdev)->data->tx_queues[txq->qid]);
 572                 }
 573         }
 574         dev->data->tx_queues[txq->qid] = NULL;
 575         rte_free(txq);
 576         fs_unlock(dev, 0);
 577 }
 578
 579 static int
 580 fs_tx_queue_setup(struct rte_eth_dev *dev,
 581                 uint16_t tx_queue_id,
 582                 uint16_t nb_tx_desc,
 583                 unsigned int socket_id,
 584                 const struct rte_eth_txconf *tx_conf)
 585 {
 586         struct sub_device *sdev;
 587         struct txq *txq;
 588         uint8_t i;
 589         int ret;
 590
 591         fs_lock(dev, 0);
 592         if (tx_conf->tx_deferred_start) {
 593                 FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_PROBED) {
 594                         if (SUBOPS(sdev, tx_queue_start) == NULL) {
 595                                 ERROR("Tx queue deferred start is not "
 596                                         "supported for subdevice %d", i);
 597                                 fs_unlock(dev, 0);
 598                                 return -EINVAL;
 599                         }
 600                 }
 601         }
 602         txq = dev->data->tx_queues[tx_queue_id];
 603         if (txq != NULL) {
 604                 fs_tx_queue_release(txq);
 605                 dev->data->tx_queues[tx_queue_id] = NULL;
 606         }
 607         txq = rte_zmalloc("ethdev TX queue",
 608                           sizeof(*txq) +
 609                           sizeof(rte_atomic64_t) * PRIV(dev)->subs_tail,
 610                           RTE_CACHE_LINE_SIZE);
 611         if (txq == NULL) {
 612                 fs_unlock(dev, 0);
 613                 return -ENOMEM;
 614         }
 615         FOREACH_SUBDEV(sdev, i, dev)
 616                 rte_atomic64_init(&txq->refcnt[i]);
 617         txq->qid = tx_queue_id;
 618         txq->socket_id = socket_id;
 619         txq->info.conf = *tx_conf;
 620         txq->info.nb_desc = nb_tx_desc;
 621         txq->priv = PRIV(dev);
 622         dev->data->tx_queues[tx_queue_id] = txq;
 623         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 624                 ret = rte_eth_tx_queue_setup(PORT_ID(sdev),
 625                                 tx_queue_id,
 626                                 nb_tx_desc, socket_id,
 627                                 tx_conf);
 628                 if ((ret = fs_err(sdev, ret))) {
 629                         ERROR("TX queue setup failed for sub_device %d", i);
 630                         goto free_txq;
 631                 }
 632         }
 633         fs_unlock(dev, 0);
 634         return 0;
 635 free_txq:
 636         fs_tx_queue_release(txq);
 637         fs_unlock(dev, 0);
 638         return ret;
 639 }
 640
 641 static void
 642 fs_dev_free_queues(struct rte_eth_dev *dev)
 643 {
 644         uint16_t i;
 645
 646         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 647                 fs_rx_queue_release(dev->data->rx_queues[i]);
 648                 dev->data->rx_queues[i] = NULL;
 649         }
 650         dev->data->nb_rx_queues = 0;
 651         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 652                 fs_tx_queue_release(dev->data->tx_queues[i]);
 653                 dev->data->tx_queues[i] = NULL;
 654         }
 655         dev->data->nb_tx_queues = 0;
 656 }
 657
 658 static int
 659 fs_promiscuous_enable(struct rte_eth_dev *dev)
 660 {
 661         struct sub_device *sdev;
 662         uint8_t i;
 663         int ret = 0;
 664
 665         fs_lock(dev, 0);
 666         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 667                 ret = rte_eth_promiscuous_enable(PORT_ID(sdev));
 668                 ret = fs_err(sdev, ret);
 669                 if (ret != 0) {
 670                         ERROR("Promiscuous mode enable failed for subdevice %d",
 671                                 PORT_ID(sdev));
 672                         break;
 673                 }
 674         }
 675         if (ret != 0) {
 676                 /* Rollback in the case of failure */
 677                 FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 678                         ret = rte_eth_promiscuous_disable(PORT_ID(sdev));
 679                         ret = fs_err(sdev, ret);
 680                         if (ret != 0)
 681                                 ERROR("Promiscuous mode disable during rollback failed for subdevice %d",
 682                                         PORT_ID(sdev));
 683                 }
 684         }
 685         fs_unlock(dev, 0);
 686
 687         return ret;
 688 }
 689
 690 static int
 691 fs_promiscuous_disable(struct rte_eth_dev *dev)
 692 {
 693         struct sub_device *sdev;
 694         uint8_t i;
 695         int ret = 0;
 696
 697         fs_lock(dev, 0);
 698         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 699                 ret = rte_eth_promiscuous_disable(PORT_ID(sdev));
 700                 ret = fs_err(sdev, ret);
 701                 if (ret != 0) {
 702                         ERROR("Promiscuous mode disable failed for subdevice %d",
 703                                 PORT_ID(sdev));
 704                         break;
 705                 }
 706         }
 707         if (ret != 0) {
 708                 /* Rollback in the case of failure */
 709                 FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 710                         ret = rte_eth_promiscuous_enable(PORT_ID(sdev));
 711                         ret = fs_err(sdev, ret);
 712                         if (ret != 0)
 713                                 ERROR("Promiscuous mode enable during rollback failed for subdevice %d",
 714                                         PORT_ID(sdev));
 715                 }
 716         }
 717         fs_unlock(dev, 0);
 718
 719         return ret;
 720 }
 721
 722 static int
 723 fs_allmulticast_enable(struct rte_eth_dev *dev)
 724 {
 725         struct sub_device *sdev;
 726         uint8_t i;
 727         int ret = 0;
 728
 729         fs_lock(dev, 0);
 730         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 731                 ret = rte_eth_allmulticast_enable(PORT_ID(sdev));
 732                 ret = fs_err(sdev, ret);
 733                 if (ret != 0) {
 734                         ERROR("All-multicast mode enable failed for subdevice %d",
 735                                 PORT_ID(sdev));
 736                         break;
 737                 }
 738         }
 739         if (ret != 0) {
 740                 /* Rollback in the case of failure */
 741                 FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 742                         ret = rte_eth_allmulticast_disable(PORT_ID(sdev));
 743                         ret = fs_err(sdev, ret);
 744                         if (ret != 0)
 745                                 ERROR("All-multicast mode disable during rollback failed for subdevice %d",
 746                                         PORT_ID(sdev));
 747                 }
 748         }
 749         fs_unlock(dev, 0);
 750
 751         return ret;
 752 }
 753
 754 static int
 755 fs_allmulticast_disable(struct rte_eth_dev *dev)
 756 {
 757         struct sub_device *sdev;
 758         uint8_t i;
 759         int ret = 0;
 760
 761         fs_lock(dev, 0);
 762         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 763                 ret = rte_eth_allmulticast_disable(PORT_ID(sdev));
 764                 ret = fs_err(sdev, ret);
 765                 if (ret != 0) {
 766                         ERROR("All-multicast mode disable failed for subdevice %d",
 767                                 PORT_ID(sdev));
 768                         break;
 769                 }
 770         }
 771         if (ret != 0) {
 772                 /* Rollback in the case of failure */
 773                 FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 774                         ret = rte_eth_allmulticast_enable(PORT_ID(sdev));
 775                         ret = fs_err(sdev, ret);
 776                         if (ret != 0)
 777                                 ERROR("All-multicast mode enable during rollback failed for subdevice %d",
 778                                         PORT_ID(sdev));
 779                 }
 780         }
 781         fs_unlock(dev, 0);
 782
 783         return ret;
 784 }
 785
 786 static int
 787 fs_link_update(struct rte_eth_dev *dev,
 788                 int wait_to_complete)
 789 {
 790         struct sub_device *sdev;
 791         uint8_t i;
 792         int ret;
 793
 794         fs_lock(dev, 0);
 795         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 796                 DEBUG("Calling link_update on sub_device %d", i);
 797                 ret = (SUBOPS(sdev, link_update))(ETH(sdev), wait_to_complete);
 798                 if (ret && ret != -1 && sdev->remove == 0 &&
 799                     rte_eth_dev_is_removed(PORT_ID(sdev)) == 0) {
 800                         ERROR("Link update failed for sub_device %d with error %d",
 801                               i, ret);
 802                         fs_unlock(dev, 0);
 803                         return ret;
 804                 }
 805         }
 806         if (TX_SUBDEV(dev)) {
 807                 struct rte_eth_link *l1;
 808                 struct rte_eth_link *l2;
 809
 810                 l1 = &dev->data->dev_link;
 811                 l2 = &ETH(TX_SUBDEV(dev))->data->dev_link;
 812                 if (memcmp(l1, l2, sizeof(*l1))) {
 813                         *l1 = *l2;
 814                         fs_unlock(dev, 0);
 815                         return 0;
 816                 }
 817         }
 818         fs_unlock(dev, 0);
 819         return -1;
 820 }
 821
 822 static int
 823 fs_stats_get(struct rte_eth_dev *dev,
 824              struct rte_eth_stats *stats)
 825 {
 826         struct rte_eth_stats backup;
 827         struct sub_device *sdev;
 828         uint8_t i;
 829         int ret;
 830
 831         fs_lock(dev, 0);
 832         rte_memcpy(stats, &PRIV(dev)->stats_accumulator, sizeof(*stats));
 833         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 834                 struct rte_eth_stats *snapshot = &sdev->stats_snapshot.stats;
 835                 uint64_t *timestamp = &sdev->stats_snapshot.timestamp;
 836
 837                 rte_memcpy(&backup, snapshot, sizeof(backup));
 838                 ret = rte_eth_stats_get(PORT_ID(sdev), snapshot);
 839                 if (ret) {
 840                         if (!fs_err(sdev, ret)) {
 841                                 rte_memcpy(snapshot, &backup, sizeof(backup));
 842                                 goto inc;
 843                         }
 844                         ERROR("Operation rte_eth_stats_get failed for sub_device %d with error %d",
 845                                   i, ret);
 846                         *timestamp = 0;
 847                         fs_unlock(dev, 0);
 848                         return ret;
 849                 }
 850                 *timestamp = rte_rdtsc();
 851 inc:
 852                 failsafe_stats_increment(stats, snapshot);
 853         }
 854         fs_unlock(dev, 0);
 855         return 0;
 856 }
 857
 858 static int
 859 fs_stats_reset(struct rte_eth_dev *dev)
 860 {
 861         struct sub_device *sdev;
 862         uint8_t i;
 863         int ret;
 864
 865         fs_lock(dev, 0);
 866         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 867                 ret = rte_eth_stats_reset(PORT_ID(sdev));
 868                 if (ret) {
 869                         if (!fs_err(sdev, ret))
 870                                 continue;
 871
 872                         ERROR("Operation rte_eth_stats_reset failed for sub_device %d with error %d",
 873                               i, ret);
 874                         fs_unlock(dev, 0);
 875                         return ret;
 876                 }
 877                 memset(&sdev->stats_snapshot, 0, sizeof(struct rte_eth_stats));
 878         }
 879         memset(&PRIV(dev)->stats_accumulator, 0, sizeof(struct rte_eth_stats));
 880         fs_unlock(dev, 0);
 881
 882         return 0;
 883 }
 884
 885 static int
 886 __fs_xstats_count(struct rte_eth_dev *dev)
 887 {
 888         struct sub_device *sdev;
 889         int count = 0;
 890         uint8_t i;
 891         int ret;
 892
 893         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 894                 ret = rte_eth_xstats_get_names(PORT_ID(sdev), NULL, 0);
 895                 if (ret < 0)
 896                         return ret;
 897                 count += ret;
 898         }
 899
 900         return count;
 901 }
 902
 903 static int
 904 __fs_xstats_get_names(struct rte_eth_dev *dev,
 905                     struct rte_eth_xstat_name *xstats_names,
 906                     unsigned int limit)
 907 {
 908         struct sub_device *sdev;
 909         unsigned int count = 0;
 910         uint8_t i;
 911
 912         /* Caller only cares about count */
 913         if (!xstats_names)
 914                 return  __fs_xstats_count(dev);
 915
 916         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 917                 struct rte_eth_xstat_name *sub_names = xstats_names + count;
 918                 int j, r;
 919
 920                 if (count >= limit)
 921                         break;
 922
 923                 r = rte_eth_xstats_get_names(PORT_ID(sdev),
 924                                              sub_names, limit - count);
 925                 if (r < 0)
 926                         return r;
 927
 928                 /* add subN_ prefix to names */
 929                 for (j = 0; j < r; j++) {
 930                         char *xname = sub_names[j].name;
 931                         char tmp[RTE_ETH_XSTATS_NAME_SIZE];
 932
 933                         if ((xname[0] == 't' || xname[0] == 'r') &&
 934                             xname[1] == 'x' && xname[2] == '_')
 935                                 snprintf(tmp, sizeof(tmp), "%.3ssub%u_%s",
 936                                          xname, i, xname + 3);
 937                         else
 938                                 snprintf(tmp, sizeof(tmp), "sub%u_%s",
 939                                          i, xname);
 940
 941                         strlcpy(xname, tmp, RTE_ETH_XSTATS_NAME_SIZE);
 942                 }
 943                 count += r;
 944         }
 945         return count;
 946 }
 947
 948 static int
 949 fs_xstats_get_names(struct rte_eth_dev *dev,
 950                     struct rte_eth_xstat_name *xstats_names,
 951                     unsigned int limit)
 952 {
 953         int ret;
 954
 955         fs_lock(dev, 0);
 956         ret = __fs_xstats_get_names(dev, xstats_names, limit);
 957         fs_unlock(dev, 0);
 958         return ret;
 959 }
 960
 961 static int
 962 __fs_xstats_get(struct rte_eth_dev *dev,
 963               struct rte_eth_xstat *xstats,
 964               unsigned int n)
 965 {
 966         unsigned int count = 0;
 967         struct sub_device *sdev;
 968         uint8_t i;
 969         int j, ret;
 970
 971         ret = __fs_xstats_count(dev);
 972         /*
 973          * if error
 974          * or caller did not give enough space
 975          * or just querying
 976          */
 977         if (ret < 0 || ret > (int)n || xstats == NULL)
 978                 return ret;
 979
 980         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
 981                 ret = rte_eth_xstats_get(PORT_ID(sdev), xstats, n);
 982                 if (ret < 0)
 983                         return ret;
 984
 985                 if (ret > (int)n)
 986                         return n + count;
 987
 988                 /* add offset to id's from sub-device */
 989                 for (j = 0; j < ret; j++)
 990                         xstats[j].id += count;
 991
 992                 xstats += ret;
 993                 n -= ret;
 994                 count += ret;
 995         }
 996
 997         return count;
 998 }
 999
1000 static int
1001 fs_xstats_get(struct rte_eth_dev *dev,
1002               struct rte_eth_xstat *xstats,
1003               unsigned int n)
1004 {
1005         int ret;
1006
1007         fs_lock(dev, 0);
1008         ret = __fs_xstats_get(dev, xstats, n);
1009         fs_unlock(dev, 0);
1010
1011         return ret;
1012 }
1013
1014
1015 static int
1016 fs_xstats_reset(struct rte_eth_dev *dev)
1017 {
1018         struct sub_device *sdev;
1019         uint8_t i;
1020         int r = 0;
1021
1022         fs_lock(dev, 0);
1023         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1024                 r = rte_eth_xstats_reset(PORT_ID(sdev));
1025                 if (r < 0)
1026                         break;
1027         }
1028         fs_unlock(dev, 0);
1029
1030         return r;
1031 }
1032
1033 static void
1034 fs_dev_merge_desc_lim(struct rte_eth_desc_lim *to,
1035                       const struct rte_eth_desc_lim *from)
1036 {
1037         to->nb_max = RTE_MIN(to->nb_max, from->nb_max);
1038         to->nb_min = RTE_MAX(to->nb_min, from->nb_min);
1039         to->nb_align = RTE_MAX(to->nb_align, from->nb_align);
1040
1041         to->nb_seg_max = RTE_MIN(to->nb_seg_max, from->nb_seg_max);
1042         to->nb_mtu_seg_max = RTE_MIN(to->nb_mtu_seg_max, from->nb_mtu_seg_max);
1043 }
1044
1045 /*
1046  * Merge the information from sub-devices.
1047  *
1048  * The reported values must be the common subset of all sub devices
1049  */
1050 static void
1051 fs_dev_merge_info(struct rte_eth_dev_info *info,
1052                   const struct rte_eth_dev_info *sinfo)
1053 {
1054         info->max_rx_pktlen = RTE_MIN(info->max_rx_pktlen, sinfo->max_rx_pktlen);
1055         info->max_rx_queues = RTE_MIN(info->max_rx_queues, sinfo->max_rx_queues);
1056         info->max_tx_queues = RTE_MIN(info->max_tx_queues, sinfo->max_tx_queues);
1057         info->max_mac_addrs = RTE_MIN(info->max_mac_addrs, sinfo->max_mac_addrs);
1058         info->max_hash_mac_addrs = RTE_MIN(info->max_hash_mac_addrs,
1059                                         sinfo->max_hash_mac_addrs);
1060         info->max_vmdq_pools = RTE_MIN(info->max_vmdq_pools, sinfo->max_vmdq_pools);
1061         info->max_vfs = RTE_MIN(info->max_vfs, sinfo->max_vfs);
1062
1063         fs_dev_merge_desc_lim(&info->rx_desc_lim, &sinfo->rx_desc_lim);
1064         fs_dev_merge_desc_lim(&info->tx_desc_lim, &sinfo->tx_desc_lim);
1065
1066         info->rx_offload_capa &= sinfo->rx_offload_capa;
1067         info->tx_offload_capa &= sinfo->tx_offload_capa;
1068         info->rx_queue_offload_capa &= sinfo->rx_queue_offload_capa;
1069         info->tx_queue_offload_capa &= sinfo->tx_queue_offload_capa;
1070         info->flow_type_rss_offloads &= sinfo->flow_type_rss_offloads;
1071
1072         /*
1073          * RETA size is a GCD of RETA sizes indicated by sub-devices.
1074          * Each of these sizes is a power of 2, so use the lower one.
1075          */
1076         info->reta_size = RTE_MIN(info->reta_size, sinfo->reta_size);
1077
1078         info->hash_key_size = RTE_MIN(info->hash_key_size,
1079                                       sinfo->hash_key_size);
1080 }
1081
1082 /**
1083  * Fail-safe dev_infos_get rules:
1084  *
1085  * No sub_device:
1086  *   Numerables:
1087  *      Use the maximum possible values for any field, so as not
1088  *      to impede any further configuration effort.
1089  *   Capabilities:
1090  *      Limits capabilities to those that are understood by the
1091  *      fail-safe PMD. This understanding stems from the fail-safe
1092  *      being capable of verifying that the related capability is
1093  *      expressed within the device configuration (struct rte_eth_conf).
1094  *
1095  * At least one probed sub_device:
1096  *   Numerables:
1097  *      Uses values from the active probed sub_device
1098  *      The rationale here is that if any sub_device is less capable
1099  *      (for example concerning the number of queues) than the active
1100  *      sub_device, then its subsequent configuration will fail.
1101  *      It is impossible to foresee this failure when the failing sub_device
1102  *      is supposed to be plugged-in later on, so the configuration process
1103  *      is the single point of failure and error reporting.
1104  *   Capabilities:
1105  *      Uses a logical AND of RX capabilities among
1106  *      all sub_devices and the default capabilities.
1107  *      Uses a logical AND of TX capabilities among
1108  *      the active probed sub_device and the default capabilities.
1109  *      Uses a logical AND of device capabilities among
1110  *      all sub_devices and the default capabilities.
1111  *
1112  */
1113 static int
1114 fs_dev_infos_get(struct rte_eth_dev *dev,
1115                   struct rte_eth_dev_info *infos)
1116 {
1117         struct sub_device *sdev;
1118         uint8_t i;
1119         int ret;
1120
1121         /* Use maximum upper bounds by default */
1122         infos->max_rx_pktlen = UINT32_MAX;
1123         infos->max_rx_queues = RTE_MAX_QUEUES_PER_PORT;
1124         infos->max_tx_queues = RTE_MAX_QUEUES_PER_PORT;
1125         infos->max_mac_addrs = FAILSAFE_MAX_ETHADDR;
1126         infos->max_hash_mac_addrs = UINT32_MAX;
1127         infos->max_vfs = UINT16_MAX;
1128         infos->max_vmdq_pools = UINT16_MAX;
1129         infos->reta_size = UINT16_MAX;
1130         infos->hash_key_size = UINT8_MAX;
1131
1132         /*
1133          * Set of capabilities that can be verified upon
1134          * configuring a sub-device.
1135          */
1136         infos->rx_offload_capa =
1137                 DEV_RX_OFFLOAD_VLAN_STRIP |
1138                 DEV_RX_OFFLOAD_IPV4_CKSUM |
1139                 DEV_RX_OFFLOAD_UDP_CKSUM |
1140                 DEV_RX_OFFLOAD_TCP_CKSUM |
1141                 DEV_RX_OFFLOAD_TCP_LRO |
1142                 DEV_RX_OFFLOAD_QINQ_STRIP |
1143                 DEV_RX_OFFLOAD_OUTER_IPV4_CKSUM |
1144                 DEV_RX_OFFLOAD_MACSEC_STRIP |
1145                 DEV_RX_OFFLOAD_HEADER_SPLIT |
1146                 DEV_RX_OFFLOAD_VLAN_FILTER |
1147                 DEV_RX_OFFLOAD_VLAN_EXTEND |
1148                 DEV_RX_OFFLOAD_JUMBO_FRAME |
1149                 DEV_RX_OFFLOAD_SCATTER |
1150                 DEV_RX_OFFLOAD_TIMESTAMP |
1151                 DEV_RX_OFFLOAD_SECURITY;
1152
1153         infos->rx_queue_offload_capa =
1154                 DEV_RX_OFFLOAD_VLAN_STRIP |
1155                 DEV_RX_OFFLOAD_IPV4_CKSUM |
1156                 DEV_RX_OFFLOAD_UDP_CKSUM |
1157                 DEV_RX_OFFLOAD_TCP_CKSUM |
1158                 DEV_RX_OFFLOAD_TCP_LRO |
1159                 DEV_RX_OFFLOAD_QINQ_STRIP |
1160                 DEV_RX_OFFLOAD_OUTER_IPV4_CKSUM |
1161                 DEV_RX_OFFLOAD_MACSEC_STRIP |
1162                 DEV_RX_OFFLOAD_HEADER_SPLIT |
1163                 DEV_RX_OFFLOAD_VLAN_FILTER |
1164                 DEV_RX_OFFLOAD_VLAN_EXTEND |
1165                 DEV_RX_OFFLOAD_JUMBO_FRAME |
1166                 DEV_RX_OFFLOAD_SCATTER |
1167                 DEV_RX_OFFLOAD_TIMESTAMP |
1168                 DEV_RX_OFFLOAD_SECURITY;
1169
1170         infos->tx_offload_capa =
1171                 DEV_TX_OFFLOAD_MULTI_SEGS |
1172                 DEV_TX_OFFLOAD_MBUF_FAST_FREE |
1173                 DEV_TX_OFFLOAD_IPV4_CKSUM |
1174                 DEV_TX_OFFLOAD_UDP_CKSUM |
1175                 DEV_TX_OFFLOAD_TCP_CKSUM |
1176                 DEV_TX_OFFLOAD_TCP_TSO;
1177
1178         infos->flow_type_rss_offloads =
1179                 ETH_RSS_IP |
1180                 ETH_RSS_UDP |
1181                 ETH_RSS_TCP;
1182         infos->dev_capa =
1183                 RTE_ETH_DEV_CAPA_RUNTIME_RX_QUEUE_SETUP |
1184                 RTE_ETH_DEV_CAPA_RUNTIME_TX_QUEUE_SETUP;
1185
1186         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_PROBED) {
1187                 struct rte_eth_dev_info sub_info;
1188
1189                 ret = rte_eth_dev_info_get(PORT_ID(sdev), &sub_info);
1190                 ret = fs_err(sdev, ret);
1191                 if (ret != 0)
1192                         return ret;
1193
1194                 fs_dev_merge_info(infos, &sub_info);
1195         }
1196
1197         return 0;
1198 }
1199
1200 static const uint32_t *
1201 fs_dev_supported_ptypes_get(struct rte_eth_dev *dev)
1202 {
1203         struct sub_device *sdev;
1204         struct rte_eth_dev *edev;
1205         const uint32_t *ret;
1206
1207         fs_lock(dev, 0);
1208         sdev = TX_SUBDEV(dev);
1209         if (sdev == NULL) {
1210                 ret = NULL;
1211                 goto unlock;
1212         }
1213         edev = ETH(sdev);
1214         /* ENOTSUP: counts as no supported ptypes */
1215         if (SUBOPS(sdev, dev_supported_ptypes_get) == NULL) {
1216                 ret = NULL;
1217                 goto unlock;
1218         }
1219         /*
1220          * The API does not permit to do a clean AND of all ptypes,
1221          * It is also incomplete by design and we do not really care
1222          * to have a best possible value in this context.
1223          * We just return the ptypes of the device of highest
1224          * priority, usually the PREFERRED device.
1225          */
1226         ret = SUBOPS(sdev, dev_supported_ptypes_get)(edev);
1227 unlock:
1228         fs_unlock(dev, 0);
1229         return ret;
1230 }
1231
1232 static int
1233 fs_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
1234 {
1235         struct sub_device *sdev;
1236         uint8_t i;
1237         int ret;
1238
1239         fs_lock(dev, 0);
1240         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1241                 DEBUG("Calling rte_eth_dev_set_mtu on sub_device %d", i);
1242                 ret = rte_eth_dev_set_mtu(PORT_ID(sdev), mtu);
1243                 if ((ret = fs_err(sdev, ret))) {
1244                         ERROR("Operation rte_eth_dev_set_mtu failed for sub_device %d with error %d",
1245                               i, ret);
1246                         fs_unlock(dev, 0);
1247                         return ret;
1248                 }
1249         }
1250         fs_unlock(dev, 0);
1251         return 0;
1252 }
1253
1254 static int
1255 fs_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
1256 {
1257         struct sub_device *sdev;
1258         uint8_t i;
1259         int ret;
1260
1261         fs_lock(dev, 0);
1262         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1263                 DEBUG("Calling rte_eth_dev_vlan_filter on sub_device %d", i);
1264                 ret = rte_eth_dev_vlan_filter(PORT_ID(sdev), vlan_id, on);
1265                 if ((ret = fs_err(sdev, ret))) {
1266                         ERROR("Operation rte_eth_dev_vlan_filter failed for sub_device %d"
1267                               " with error %d", i, ret);
1268                         fs_unlock(dev, 0);
1269                         return ret;
1270                 }
1271         }
1272         fs_unlock(dev, 0);
1273         return 0;
1274 }
1275
1276 static int
1277 fs_flow_ctrl_get(struct rte_eth_dev *dev,
1278                 struct rte_eth_fc_conf *fc_conf)
1279 {
1280         struct sub_device *sdev;
1281         int ret;
1282
1283         fs_lock(dev, 0);
1284         sdev = TX_SUBDEV(dev);
1285         if (sdev == NULL) {
1286                 ret = 0;
1287                 goto unlock;
1288         }
1289         if (SUBOPS(sdev, flow_ctrl_get) == NULL) {
1290                 ret = -ENOTSUP;
1291                 goto unlock;
1292         }
1293         ret = SUBOPS(sdev, flow_ctrl_get)(ETH(sdev), fc_conf);
1294 unlock:
1295         fs_unlock(dev, 0);
1296         return ret;
1297 }
1298
1299 static int
1300 fs_flow_ctrl_set(struct rte_eth_dev *dev,
1301                 struct rte_eth_fc_conf *fc_conf)
1302 {
1303         struct sub_device *sdev;
1304         uint8_t i;
1305         int ret;
1306
1307         fs_lock(dev, 0);
1308         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1309                 DEBUG("Calling rte_eth_dev_flow_ctrl_set on sub_device %d", i);
1310                 ret = rte_eth_dev_flow_ctrl_set(PORT_ID(sdev), fc_conf);
1311                 if ((ret = fs_err(sdev, ret))) {
1312                         ERROR("Operation rte_eth_dev_flow_ctrl_set failed for sub_device %d"
1313                               " with error %d", i, ret);
1314                         fs_unlock(dev, 0);
1315                         return ret;
1316                 }
1317         }
1318         fs_unlock(dev, 0);
1319         return 0;
1320 }
1321
1322 static void
1323 fs_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index)
1324 {
1325         struct sub_device *sdev;
1326         uint8_t i;
1327
1328         fs_lock(dev, 0);
1329         /* No check: already done within the rte_eth_dev_mac_addr_remove
1330          * call for the fail-safe device.
1331          */
1332         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE)
1333                 rte_eth_dev_mac_addr_remove(PORT_ID(sdev),
1334                                 &dev->data->mac_addrs[index]);
1335         PRIV(dev)->mac_addr_pool[index] = 0;
1336         fs_unlock(dev, 0);
1337 }
1338
1339 static int
1340 fs_mac_addr_add(struct rte_eth_dev *dev,
1341                 struct rte_ether_addr *mac_addr,
1342                 uint32_t index,
1343                 uint32_t vmdq)
1344 {
1345         struct sub_device *sdev;
1346         int ret;
1347         uint8_t i;
1348
1349         RTE_ASSERT(index < FAILSAFE_MAX_ETHADDR);
1350         fs_lock(dev, 0);
1351         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1352                 ret = rte_eth_dev_mac_addr_add(PORT_ID(sdev), mac_addr, vmdq);
1353                 if ((ret = fs_err(sdev, ret))) {
1354                         ERROR("Operation rte_eth_dev_mac_addr_add failed for sub_device %"
1355                               PRIu8 " with error %d", i, ret);
1356                         fs_unlock(dev, 0);
1357                         return ret;
1358                 }
1359         }
1360         if (index >= PRIV(dev)->nb_mac_addr) {
1361                 DEBUG("Growing mac_addrs array");
1362                 PRIV(dev)->nb_mac_addr = index;
1363         }
1364         PRIV(dev)->mac_addr_pool[index] = vmdq;
1365         fs_unlock(dev, 0);
1366         return 0;
1367 }
1368
1369 static int
1370 fs_mac_addr_set(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr)
1371 {
1372         struct sub_device *sdev;
1373         uint8_t i;
1374         int ret;
1375
1376         fs_lock(dev, 0);
1377         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1378                 ret = rte_eth_dev_default_mac_addr_set(PORT_ID(sdev), mac_addr);
1379                 ret = fs_err(sdev, ret);
1380                 if (ret) {
1381                         ERROR("Operation rte_eth_dev_mac_addr_set failed for sub_device %d with error %d",
1382                                 i, ret);
1383                         fs_unlock(dev, 0);
1384                         return ret;
1385                 }
1386         }
1387         fs_unlock(dev, 0);
1388
1389         return 0;
1390 }
1391
1392 static int
1393 fs_set_mc_addr_list(struct rte_eth_dev *dev,
1394                     struct rte_ether_addr *mc_addr_set, uint32_t nb_mc_addr)
1395 {
1396         struct sub_device *sdev;
1397         uint8_t i;
1398         int ret;
1399         void *mcast_addrs;
1400
1401         fs_lock(dev, 0);
1402
1403         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1404                 ret = rte_eth_dev_set_mc_addr_list(PORT_ID(sdev),
1405                                                    mc_addr_set, nb_mc_addr);
1406                 if (ret != 0) {
1407                         ERROR("Operation rte_eth_dev_set_mc_addr_list failed for sub_device %d with error %d",
1408                               i, ret);
1409                         goto rollback;
1410                 }
1411         }
1412
1413         mcast_addrs = rte_realloc(PRIV(dev)->mcast_addrs,
1414                 nb_mc_addr * sizeof(PRIV(dev)->mcast_addrs[0]), 0);
1415         if (mcast_addrs == NULL && nb_mc_addr > 0) {
1416                 ret = -ENOMEM;
1417                 goto rollback;
1418         }
1419         rte_memcpy(mcast_addrs, mc_addr_set,
1420                    nb_mc_addr * sizeof(PRIV(dev)->mcast_addrs[0]));
1421         PRIV(dev)->nb_mcast_addr = nb_mc_addr;
1422         PRIV(dev)->mcast_addrs = mcast_addrs;
1423
1424         fs_unlock(dev, 0);
1425         return 0;
1426
1427 rollback:
1428         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1429                 int rc = rte_eth_dev_set_mc_addr_list(PORT_ID(sdev),
1430                         PRIV(dev)->mcast_addrs, PRIV(dev)->nb_mcast_addr);
1431                 if (rc != 0) {
1432                         ERROR("Multicast MAC address list rollback for sub_device %d failed with error %d",
1433                               i, rc);
1434                 }
1435         }
1436
1437         fs_unlock(dev, 0);
1438         return ret;
1439 }
1440
1441 static int
1442 fs_rss_hash_update(struct rte_eth_dev *dev,
1443                         struct rte_eth_rss_conf *rss_conf)
1444 {
1445         struct sub_device *sdev;
1446         uint8_t i;
1447         int ret;
1448
1449         fs_lock(dev, 0);
1450         FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
1451                 ret = rte_eth_dev_rss_hash_update(PORT_ID(sdev), rss_conf);
1452                 ret = fs_err(sdev, ret);
1453                 if (ret) {
1454                         ERROR("Operation rte_eth_dev_rss_hash_update"
1455                                 " failed for sub_device %d with error %d",
1456                                 i, ret);
1457                         fs_unlock(dev, 0);
1458                         return ret;
1459                 }
1460         }
1461         fs_unlock(dev, 0);
1462
1463         return 0;
1464 }
1465
1466 static int
1467 fs_filter_ctrl(struct rte_eth_dev *dev __rte_unused,
1468                 enum rte_filter_type type,
1469                 enum rte_filter_op op,
1470                 void *arg)
1471 {
1472         if (type == RTE_ETH_FILTER_GENERIC &&
1473             op == RTE_ETH_FILTER_GET) {
1474                 *(const void **)arg = &fs_flow_ops;
1475                 return 0;
1476         }
1477         return -ENOTSUP;
1478 }
1479
1480 const struct eth_dev_ops failsafe_ops = {
1481         .dev_configure = fs_dev_configure,
1482         .dev_start = fs_dev_start,
1483         .dev_stop = fs_dev_stop,
1484         .dev_set_link_down = fs_dev_set_link_down,
1485         .dev_set_link_up = fs_dev_set_link_up,
1486         .dev_close = fs_dev_close,
1487         .promiscuous_enable = fs_promiscuous_enable,
1488         .promiscuous_disable = fs_promiscuous_disable,
1489         .allmulticast_enable = fs_allmulticast_enable,
1490         .allmulticast_disable = fs_allmulticast_disable,
1491         .link_update = fs_link_update,
1492         .stats_get = fs_stats_get,
1493         .stats_reset = fs_stats_reset,
1494         .xstats_get = fs_xstats_get,
1495         .xstats_get_names = fs_xstats_get_names,
1496         .xstats_reset = fs_xstats_reset,
1497         .dev_infos_get = fs_dev_infos_get,
1498         .dev_supported_ptypes_get = fs_dev_supported_ptypes_get,
1499         .mtu_set = fs_mtu_set,
1500         .vlan_filter_set = fs_vlan_filter_set,
1501         .rx_queue_start = fs_rx_queue_start,
1502         .rx_queue_stop = fs_rx_queue_stop,
1503         .tx_queue_start = fs_tx_queue_start,
1504         .tx_queue_stop = fs_tx_queue_stop,
1505         .rx_queue_setup = fs_rx_queue_setup,
1506         .tx_queue_setup = fs_tx_queue_setup,
1507         .rx_queue_release = fs_rx_queue_release,
1508         .tx_queue_release = fs_tx_queue_release,
1509         .rx_queue_intr_enable = fs_rx_intr_enable,
1510         .rx_queue_intr_disable = fs_rx_intr_disable,
1511         .flow_ctrl_get = fs_flow_ctrl_get,
1512         .flow_ctrl_set = fs_flow_ctrl_set,
1513         .mac_addr_remove = fs_mac_addr_remove,
1514         .mac_addr_add = fs_mac_addr_add,
1515         .mac_addr_set = fs_mac_addr_set,
1516         .set_mc_addr_list = fs_set_mc_addr_list,
1517         .rss_hash_update = fs_rss_hash_update,
1518         .filter_ctrl = fs_filter_ctrl,
1519 };