net: add rte prefix to ether structures
[dpdk.git] / drivers / net / failsafe / failsafe_ops.c
index 7a67e16..c900ecc 100644 (file)
@@ -1,6 +1,6 @@
 /* SPDX-License-Identifier: BSD-3-Clause
  * Copyright 2017 6WIND S.A.
- * Copyright 2017 Mellanox.
+ * Copyright 2017 Mellanox Technologies, Ltd
  */
 
 #include <stdbool.h>
@@ -13,6 +13,7 @@
 #include <rte_malloc.h>
 #include <rte_flow.h>
 #include <rte_cycles.h>
+#include <rte_ethdev.h>
 
 #include "failsafe_private.h"
 
@@ -56,7 +57,6 @@ static struct rte_eth_dev_info default_infos = {
                DEV_RX_OFFLOAD_VLAN_FILTER |
                DEV_RX_OFFLOAD_VLAN_EXTEND |
                DEV_RX_OFFLOAD_JUMBO_FRAME |
-               DEV_RX_OFFLOAD_CRC_STRIP |
                DEV_RX_OFFLOAD_SCATTER |
                DEV_RX_OFFLOAD_TIMESTAMP |
                DEV_RX_OFFLOAD_SECURITY,
@@ -73,42 +73,40 @@ static struct rte_eth_dev_info default_infos = {
                DEV_RX_OFFLOAD_VLAN_FILTER |
                DEV_RX_OFFLOAD_VLAN_EXTEND |
                DEV_RX_OFFLOAD_JUMBO_FRAME |
-               DEV_RX_OFFLOAD_CRC_STRIP |
                DEV_RX_OFFLOAD_SCATTER |
                DEV_RX_OFFLOAD_TIMESTAMP |
                DEV_RX_OFFLOAD_SECURITY,
        .tx_offload_capa =
                DEV_TX_OFFLOAD_MULTI_SEGS |
+               DEV_TX_OFFLOAD_MBUF_FAST_FREE |
                DEV_TX_OFFLOAD_IPV4_CKSUM |
                DEV_TX_OFFLOAD_UDP_CKSUM |
-               DEV_TX_OFFLOAD_TCP_CKSUM,
-       .flow_type_rss_offloads = 0x0,
+               DEV_TX_OFFLOAD_TCP_CKSUM |
+               DEV_TX_OFFLOAD_TCP_TSO,
+       .flow_type_rss_offloads =
+                       ETH_RSS_IP |
+                       ETH_RSS_UDP |
+                       ETH_RSS_TCP,
+       .dev_capa =
+               RTE_ETH_DEV_CAPA_RUNTIME_RX_QUEUE_SETUP |
+               RTE_ETH_DEV_CAPA_RUNTIME_TX_QUEUE_SETUP,
 };
 
 static int
 fs_dev_configure(struct rte_eth_dev *dev)
 {
        struct sub_device *sdev;
-       uint64_t supp_tx_offloads;
-       uint64_t tx_offloads;
        uint8_t i;
        int ret;
 
-       supp_tx_offloads = PRIV(dev)->infos.tx_offload_capa;
-       tx_offloads = dev->data->dev_conf.txmode.offloads;
-       if ((tx_offloads & supp_tx_offloads) != tx_offloads) {
-               rte_errno = ENOTSUP;
-               ERROR("Some Tx offloads are not supported, "
-                     "requested 0x%" PRIx64 " supported 0x%" PRIx64,
-                     tx_offloads, supp_tx_offloads);
-               return -rte_errno;
-       }
+       fs_lock(dev, 0);
        FOREACH_SUBDEV(sdev, i, dev) {
                int rmv_interrupt = 0;
                int lsc_interrupt = 0;
                int lsc_enabled;
 
-               if (sdev->state != DEV_PROBED)
+               if (sdev->state != DEV_PROBED &&
+                   !(PRIV(dev)->alarm_lock == 0 && sdev->state == DEV_ACTIVE))
                        continue;
 
                rmv_interrupt = ETH(sdev)->data->dev_flags &
@@ -131,7 +129,6 @@ fs_dev_configure(struct rte_eth_dev *dev)
                        dev->data->dev_conf.intr_conf.lsc = 0;
                }
                DEBUG("Configuring sub-device %d", i);
-               sdev->remove = 0;
                ret = rte_eth_dev_configure(PORT_ID(sdev),
                                        dev->data->nb_rx_queues,
                                        dev->data->nb_tx_queues,
@@ -140,9 +137,10 @@ fs_dev_configure(struct rte_eth_dev *dev)
                        if (!fs_err(sdev, ret))
                                continue;
                        ERROR("Could not configure sub_device %d", i);
+                       fs_unlock(dev, 0);
                        return ret;
                }
-               if (rmv_interrupt) {
+               if (rmv_interrupt && sdev->rmv_callback == 0) {
                        ret = rte_eth_dev_callback_register(PORT_ID(sdev),
                                        RTE_ETH_EVENT_INTR_RMV,
                                        failsafe_eth_rmv_event_callback,
@@ -150,9 +148,11 @@ fs_dev_configure(struct rte_eth_dev *dev)
                        if (ret)
                                WARN("Failed to register RMV callback for sub_device %d",
                                     SUB_ID(sdev));
+                       else
+                               sdev->rmv_callback = 1;
                }
                dev->data->dev_conf.intr_conf.rmv = 0;
-               if (lsc_interrupt) {
+               if (lsc_interrupt && sdev->lsc_callback == 0) {
                        ret = rte_eth_dev_callback_register(PORT_ID(sdev),
                                                RTE_ETH_EVENT_INTR_LSC,
                                                failsafe_eth_lsc_event_callback,
@@ -160,15 +160,39 @@ fs_dev_configure(struct rte_eth_dev *dev)
                        if (ret)
                                WARN("Failed to register LSC callback for sub_device %d",
                                     SUB_ID(sdev));
+                       else
+                               sdev->lsc_callback = 1;
                }
                dev->data->dev_conf.intr_conf.lsc = lsc_enabled;
                sdev->state = DEV_ACTIVE;
        }
        if (PRIV(dev)->state < DEV_ACTIVE)
                PRIV(dev)->state = DEV_ACTIVE;
+       fs_unlock(dev, 0);
        return 0;
 }
 
+static void
+fs_set_queues_state_start(struct rte_eth_dev *dev)
+{
+       struct rxq *rxq;
+       struct txq *txq;
+       uint16_t i;
+
+       for (i = 0; i < dev->data->nb_rx_queues; i++) {
+               rxq = dev->data->rx_queues[i];
+               if (rxq != NULL && !rxq->info.conf.rx_deferred_start)
+                       dev->data->rx_queue_state[i] =
+                                               RTE_ETH_QUEUE_STATE_STARTED;
+       }
+       for (i = 0; i < dev->data->nb_tx_queues; i++) {
+               txq = dev->data->tx_queues[i];
+               if (txq != NULL && !txq->info.conf.tx_deferred_start)
+                       dev->data->tx_queue_state[i] =
+                                               RTE_ETH_QUEUE_STATE_STARTED;
+       }
+}
+
 static int
 fs_dev_start(struct rte_eth_dev *dev)
 {
@@ -176,9 +200,12 @@ fs_dev_start(struct rte_eth_dev *dev)
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
        ret = failsafe_rx_intr_install(dev);
-       if (ret)
+       if (ret) {
+               fs_unlock(dev, 0);
                return ret;
+       }
        FOREACH_SUBDEV(sdev, i, dev) {
                if (sdev->state != DEV_ACTIVE)
                        continue;
@@ -187,6 +214,7 @@ fs_dev_start(struct rte_eth_dev *dev)
                if (ret) {
                        if (!fs_err(sdev, ret))
                                continue;
+                       fs_unlock(dev, 0);
                        return ret;
                }
                ret = failsafe_rx_intr_install_subdevice(sdev);
@@ -194,22 +222,42 @@ fs_dev_start(struct rte_eth_dev *dev)
                        if (!fs_err(sdev, ret))
                                continue;
                        rte_eth_dev_stop(PORT_ID(sdev));
+                       fs_unlock(dev, 0);
                        return ret;
                }
                sdev->state = DEV_STARTED;
        }
-       if (PRIV(dev)->state < DEV_STARTED)
+       if (PRIV(dev)->state < DEV_STARTED) {
                PRIV(dev)->state = DEV_STARTED;
+               fs_set_queues_state_start(dev);
+       }
        fs_switch_dev(dev, NULL);
+       fs_unlock(dev, 0);
        return 0;
 }
 
+static void
+fs_set_queues_state_stop(struct rte_eth_dev *dev)
+{
+       uint16_t i;
+
+       for (i = 0; i < dev->data->nb_rx_queues; i++)
+               if (dev->data->rx_queues[i] != NULL)
+                       dev->data->rx_queue_state[i] =
+                                               RTE_ETH_QUEUE_STATE_STOPPED;
+       for (i = 0; i < dev->data->nb_tx_queues; i++)
+               if (dev->data->tx_queues[i] != NULL)
+                       dev->data->tx_queue_state[i] =
+                                               RTE_ETH_QUEUE_STATE_STOPPED;
+}
+
 static void
 fs_dev_stop(struct rte_eth_dev *dev)
 {
        struct sub_device *sdev;
        uint8_t i;
 
+       fs_lock(dev, 0);
        PRIV(dev)->state = DEV_STARTED - 1;
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_STARTED) {
                rte_eth_dev_stop(PORT_ID(sdev));
@@ -217,6 +265,8 @@ fs_dev_stop(struct rte_eth_dev *dev)
                sdev->state = DEV_STARTED - 1;
        }
        failsafe_rx_intr_uninstall(dev);
+       fs_set_queues_state_stop(dev);
+       fs_unlock(dev, 0);
 }
 
 static int
@@ -226,15 +276,18 @@ fs_dev_set_link_up(struct rte_eth_dev *dev)
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                DEBUG("Calling rte_eth_dev_set_link_up on sub_device %d", i);
                ret = rte_eth_dev_set_link_up(PORT_ID(sdev));
                if ((ret = fs_err(sdev, ret))) {
                        ERROR("Operation rte_eth_dev_set_link_up failed for sub_device %d"
                              " with error %d", i, ret);
+                       fs_unlock(dev, 0);
                        return ret;
                }
        }
+       fs_unlock(dev, 0);
        return 0;
 }
 
@@ -245,15 +298,18 @@ fs_dev_set_link_down(struct rte_eth_dev *dev)
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                DEBUG("Calling rte_eth_dev_set_link_down on sub_device %d", i);
                ret = rte_eth_dev_set_link_down(PORT_ID(sdev));
                if ((ret = fs_err(sdev, ret))) {
                        ERROR("Operation rte_eth_dev_set_link_down failed for sub_device %d"
                              " with error %d", i, ret);
+                       fs_unlock(dev, 0);
                        return ret;
                }
        }
+       fs_unlock(dev, 0);
        return 0;
 }
 
@@ -264,35 +320,125 @@ fs_dev_close(struct rte_eth_dev *dev)
        struct sub_device *sdev;
        uint8_t i;
 
+       fs_lock(dev, 0);
        failsafe_hotplug_alarm_cancel(dev);
        if (PRIV(dev)->state == DEV_STARTED)
                dev->dev_ops->dev_stop(dev);
        PRIV(dev)->state = DEV_ACTIVE - 1;
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                DEBUG("Closing sub_device %d", i);
+               failsafe_eth_dev_unregister_callbacks(sdev);
                rte_eth_dev_close(PORT_ID(sdev));
                sdev->state = DEV_ACTIVE - 1;
        }
        fs_dev_free_queues(dev);
+       fs_unlock(dev, 0);
 }
 
-static bool
-fs_rxq_offloads_valid(struct rte_eth_dev *dev, uint64_t offloads)
+static int
+fs_rx_queue_stop(struct rte_eth_dev *dev, uint16_t rx_queue_id)
 {
-       uint64_t port_offloads;
-       uint64_t queue_supp_offloads;
-       uint64_t port_supp_offloads;
+       struct sub_device *sdev;
+       uint8_t i;
+       int ret;
+       int err = 0;
+       bool failure = true;
+
+       fs_lock(dev, 0);
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               uint16_t port_id = ETH(sdev)->data->port_id;
 
-       port_offloads = dev->data->dev_conf.rxmode.offloads;
-       queue_supp_offloads = PRIV(dev)->infos.rx_queue_offload_capa;
-       port_supp_offloads = PRIV(dev)->infos.rx_offload_capa;
-       if ((offloads & (queue_supp_offloads | port_supp_offloads)) !=
-            offloads)
-               return false;
-       /* Verify we have no conflict with port offloads */
-       if ((port_offloads ^ offloads) & port_supp_offloads)
-               return false;
-       return true;
+               ret = rte_eth_dev_rx_queue_stop(port_id, rx_queue_id);
+               ret = fs_err(sdev, ret);
+               if (ret) {
+                       ERROR("Rx queue stop failed for subdevice %d", i);
+                       err = ret;
+               } else {
+                       failure = false;
+               }
+       }
+       dev->data->rx_queue_state[rx_queue_id] = RTE_ETH_QUEUE_STATE_STOPPED;
+       fs_unlock(dev, 0);
+       /* Return 0 in case of at least one successful queue stop */
+       return (failure) ? err : 0;
+}
+
+static int
+fs_rx_queue_start(struct rte_eth_dev *dev, uint16_t rx_queue_id)
+{
+       struct sub_device *sdev;
+       uint8_t i;
+       int ret;
+
+       fs_lock(dev, 0);
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               uint16_t port_id = ETH(sdev)->data->port_id;
+
+               ret = rte_eth_dev_rx_queue_start(port_id, rx_queue_id);
+               ret = fs_err(sdev, ret);
+               if (ret) {
+                       ERROR("Rx queue start failed for subdevice %d", i);
+                       fs_rx_queue_stop(dev, rx_queue_id);
+                       fs_unlock(dev, 0);
+                       return ret;
+               }
+       }
+       dev->data->rx_queue_state[rx_queue_id] = RTE_ETH_QUEUE_STATE_STARTED;
+       fs_unlock(dev, 0);
+       return 0;
+}
+
+static int
+fs_tx_queue_stop(struct rte_eth_dev *dev, uint16_t tx_queue_id)
+{
+       struct sub_device *sdev;
+       uint8_t i;
+       int ret;
+       int err = 0;
+       bool failure = true;
+
+       fs_lock(dev, 0);
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               uint16_t port_id = ETH(sdev)->data->port_id;
+
+               ret = rte_eth_dev_tx_queue_stop(port_id, tx_queue_id);
+               ret = fs_err(sdev, ret);
+               if (ret) {
+                       ERROR("Tx queue stop failed for subdevice %d", i);
+                       err = ret;
+               } else {
+                       failure = false;
+               }
+       }
+       dev->data->tx_queue_state[tx_queue_id] = RTE_ETH_QUEUE_STATE_STOPPED;
+       fs_unlock(dev, 0);
+       /* Return 0 in case of at least one successful queue stop */
+       return (failure) ? err : 0;
+}
+
+static int
+fs_tx_queue_start(struct rte_eth_dev *dev, uint16_t tx_queue_id)
+{
+       struct sub_device *sdev;
+       uint8_t i;
+       int ret;
+
+       fs_lock(dev, 0);
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               uint16_t port_id = ETH(sdev)->data->port_id;
+
+               ret = rte_eth_dev_tx_queue_start(port_id, tx_queue_id);
+               ret = fs_err(sdev, ret);
+               if (ret) {
+                       ERROR("Tx queue start failed for subdevice %d", i);
+                       fs_tx_queue_stop(dev, tx_queue_id);
+                       fs_unlock(dev, 0);
+                       return ret;
+               }
+       }
+       dev->data->tx_queue_state[tx_queue_id] = RTE_ETH_QUEUE_STATE_STARTED;
+       fs_unlock(dev, 0);
+       return 0;
 }
 
 static void
@@ -306,14 +452,20 @@ fs_rx_queue_release(void *queue)
        if (queue == NULL)
                return;
        rxq = queue;
+       dev = &rte_eth_devices[rxq->priv->data->port_id];
+       fs_lock(dev, 0);
        if (rxq->event_fd > 0)
                close(rxq->event_fd);
-       dev = rxq->priv->dev;
-       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE)
-               SUBOPS(sdev, rx_queue_release)
-                       (ETH(sdev)->data->rx_queues[rxq->qid]);
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               if (ETH(sdev)->data->rx_queues != NULL &&
+                   ETH(sdev)->data->rx_queues[rxq->qid] != NULL) {
+                       SUBOPS(sdev, rx_queue_release)
+                               (ETH(sdev)->data->rx_queues[rxq->qid]);
+               }
+       }
        dev->data->rx_queues[rxq->qid] = NULL;
        rte_free(rxq);
+       fs_unlock(dev, 0);
 }
 
 static int
@@ -339,29 +491,30 @@ fs_rx_queue_setup(struct rte_eth_dev *dev,
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
+       if (rx_conf->rx_deferred_start) {
+               FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_PROBED) {
+                       if (SUBOPS(sdev, rx_queue_start) == NULL) {
+                               ERROR("Rx queue deferred start is not "
+                                       "supported for subdevice %d", i);
+                               fs_unlock(dev, 0);
+                               return -EINVAL;
+                       }
+               }
+       }
        rxq = dev->data->rx_queues[rx_queue_id];
        if (rxq != NULL) {
                fs_rx_queue_release(rxq);
                dev->data->rx_queues[rx_queue_id] = NULL;
        }
-       /* Verify application offloads are valid for our port and queue. */
-       if (fs_rxq_offloads_valid(dev, rx_conf->offloads) == false) {
-               rte_errno = ENOTSUP;
-               ERROR("Rx queue offloads 0x%" PRIx64
-                     " don't match port offloads 0x%" PRIx64
-                     " or supported offloads 0x%" PRIx64,
-                     rx_conf->offloads,
-                     dev->data->dev_conf.rxmode.offloads,
-                     PRIV(dev)->infos.rx_offload_capa |
-                     PRIV(dev)->infos.rx_queue_offload_capa);
-               return -rte_errno;
-       }
        rxq = rte_zmalloc(NULL,
                          sizeof(*rxq) +
                          sizeof(rte_atomic64_t) * PRIV(dev)->subs_tail,
                          RTE_CACHE_LINE_SIZE);
-       if (rxq == NULL)
+       if (rxq == NULL) {
+               fs_unlock(dev, 0);
                return -ENOMEM;
+       }
        FOREACH_SUBDEV(sdev, i, dev)
                rte_atomic64_init(&rxq->refcnt[i]);
        rxq->qid = rx_queue_id;
@@ -372,8 +525,10 @@ fs_rx_queue_setup(struct rte_eth_dev *dev,
        rxq->priv = PRIV(dev);
        rxq->sdev = PRIV(dev)->subs;
        ret = rte_intr_efd_enable(&intr_handle, 1);
-       if (ret < 0)
+       if (ret < 0) {
+               fs_unlock(dev, 0);
                return ret;
+       }
        rxq->event_fd = intr_handle.efds[0];
        dev->data->rx_queues[rx_queue_id] = rxq;
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
@@ -386,9 +541,11 @@ fs_rx_queue_setup(struct rte_eth_dev *dev,
                        goto free_rxq;
                }
        }
+       fs_unlock(dev, 0);
        return 0;
 free_rxq:
        fs_rx_queue_release(rxq);
+       fs_unlock(dev, 0);
        return ret;
 }
 
@@ -401,20 +558,21 @@ fs_rx_intr_enable(struct rte_eth_dev *dev, uint16_t idx)
        int ret;
        int rc = 0;
 
+       fs_lock(dev, 0);
        if (idx >= dev->data->nb_rx_queues) {
-               rte_errno = EINVAL;
-               return -rte_errno;
+               rc = -EINVAL;
+               goto unlock;
        }
        rxq = dev->data->rx_queues[idx];
        if (rxq == NULL || rxq->event_fd <= 0) {
-               rte_errno = EINVAL;
-               return -rte_errno;
+               rc = -EINVAL;
+               goto unlock;
        }
        /* Fail if proxy service is nor running. */
        if (PRIV(dev)->rxp.sstate != SS_RUNNING) {
                ERROR("failsafe interrupt services are not running");
-               rte_errno = EAGAIN;
-               return -rte_errno;
+               rc = -EAGAIN;
+               goto unlock;
        }
        rxq->enable_events = 1;
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
@@ -423,6 +581,8 @@ fs_rx_intr_enable(struct rte_eth_dev *dev, uint16_t idx)
                if (ret)
                        rc = ret;
        }
+unlock:
+       fs_unlock(dev, 0);
        if (rc)
                rte_errno = -rc;
        return rc;
@@ -438,14 +598,15 @@ fs_rx_intr_disable(struct rte_eth_dev *dev, uint16_t idx)
        int rc = 0;
        int ret;
 
+       fs_lock(dev, 0);
        if (idx >= dev->data->nb_rx_queues) {
-               rte_errno = EINVAL;
-               return -rte_errno;
+               rc = -EINVAL;
+               goto unlock;
        }
        rxq = dev->data->rx_queues[idx];
        if (rxq == NULL || rxq->event_fd <= 0) {
-               rte_errno = EINVAL;
-               return -rte_errno;
+               rc = -EINVAL;
+               goto unlock;
        }
        rxq->enable_events = 0;
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
@@ -457,30 +618,13 @@ fs_rx_intr_disable(struct rte_eth_dev *dev, uint16_t idx)
        /* Clear pending events */
        while (read(rxq->event_fd, &u64, sizeof(uint64_t)) >  0)
                ;
+unlock:
+       fs_unlock(dev, 0);
        if (rc)
                rte_errno = -rc;
        return rc;
 }
 
-static bool
-fs_txq_offloads_valid(struct rte_eth_dev *dev, uint64_t offloads)
-{
-       uint64_t port_offloads;
-       uint64_t queue_supp_offloads;
-       uint64_t port_supp_offloads;
-
-       port_offloads = dev->data->dev_conf.txmode.offloads;
-       queue_supp_offloads = PRIV(dev)->infos.tx_queue_offload_capa;
-       port_supp_offloads = PRIV(dev)->infos.tx_offload_capa;
-       if ((offloads & (queue_supp_offloads | port_supp_offloads)) !=
-            offloads)
-               return false;
-       /* Verify we have no conflict with port offloads */
-       if ((port_offloads ^ offloads) & port_supp_offloads)
-               return false;
-       return true;
-}
-
 static void
 fs_tx_queue_release(void *queue)
 {
@@ -492,12 +636,18 @@ fs_tx_queue_release(void *queue)
        if (queue == NULL)
                return;
        txq = queue;
-       dev = txq->priv->dev;
-       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE)
-               SUBOPS(sdev, tx_queue_release)
-                       (ETH(sdev)->data->tx_queues[txq->qid]);
+       dev = &rte_eth_devices[txq->priv->data->port_id];
+       fs_lock(dev, 0);
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               if (ETH(sdev)->data->tx_queues != NULL &&
+                   ETH(sdev)->data->tx_queues[txq->qid] != NULL) {
+                       SUBOPS(sdev, tx_queue_release)
+                               (ETH(sdev)->data->tx_queues[txq->qid]);
+               }
+       }
        dev->data->tx_queues[txq->qid] = NULL;
        rte_free(txq);
+       fs_unlock(dev, 0);
 }
 
 static int
@@ -512,34 +662,30 @@ fs_tx_queue_setup(struct rte_eth_dev *dev,
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
+       if (tx_conf->tx_deferred_start) {
+               FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_PROBED) {
+                       if (SUBOPS(sdev, tx_queue_start) == NULL) {
+                               ERROR("Tx queue deferred start is not "
+                                       "supported for subdevice %d", i);
+                               fs_unlock(dev, 0);
+                               return -EINVAL;
+                       }
+               }
+       }
        txq = dev->data->tx_queues[tx_queue_id];
        if (txq != NULL) {
                fs_tx_queue_release(txq);
                dev->data->tx_queues[tx_queue_id] = NULL;
        }
-       /*
-        * Don't verify queue offloads for applications which
-        * use the old API.
-        */
-       if (tx_conf != NULL &&
-           (tx_conf->txq_flags & ETH_TXQ_FLAGS_IGNORE) &&
-           fs_txq_offloads_valid(dev, tx_conf->offloads) == false) {
-               rte_errno = ENOTSUP;
-               ERROR("Tx queue offloads 0x%" PRIx64
-                     " don't match port offloads 0x%" PRIx64
-                     " or supported offloads 0x%" PRIx64,
-                     tx_conf->offloads,
-                     dev->data->dev_conf.txmode.offloads,
-                     PRIV(dev)->infos.tx_offload_capa |
-                     PRIV(dev)->infos.tx_queue_offload_capa);
-               return -rte_errno;
-       }
        txq = rte_zmalloc("ethdev TX queue",
                          sizeof(*txq) +
                          sizeof(rte_atomic64_t) * PRIV(dev)->subs_tail,
                          RTE_CACHE_LINE_SIZE);
-       if (txq == NULL)
+       if (txq == NULL) {
+               fs_unlock(dev, 0);
                return -ENOMEM;
+       }
        FOREACH_SUBDEV(sdev, i, dev)
                rte_atomic64_init(&txq->refcnt[i]);
        txq->qid = tx_queue_id;
@@ -558,9 +704,11 @@ fs_tx_queue_setup(struct rte_eth_dev *dev,
                        goto free_txq;
                }
        }
+       fs_unlock(dev, 0);
        return 0;
 free_txq:
        fs_tx_queue_release(txq);
+       fs_unlock(dev, 0);
        return ret;
 }
 
@@ -587,8 +735,10 @@ fs_promiscuous_enable(struct rte_eth_dev *dev)
        struct sub_device *sdev;
        uint8_t i;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE)
                rte_eth_promiscuous_enable(PORT_ID(sdev));
+       fs_unlock(dev, 0);
 }
 
 static void
@@ -597,8 +747,10 @@ fs_promiscuous_disable(struct rte_eth_dev *dev)
        struct sub_device *sdev;
        uint8_t i;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE)
                rte_eth_promiscuous_disable(PORT_ID(sdev));
+       fs_unlock(dev, 0);
 }
 
 static void
@@ -607,8 +759,10 @@ fs_allmulticast_enable(struct rte_eth_dev *dev)
        struct sub_device *sdev;
        uint8_t i;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE)
                rte_eth_allmulticast_enable(PORT_ID(sdev));
+       fs_unlock(dev, 0);
 }
 
 static void
@@ -617,8 +771,10 @@ fs_allmulticast_disable(struct rte_eth_dev *dev)
        struct sub_device *sdev;
        uint8_t i;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE)
                rte_eth_allmulticast_disable(PORT_ID(sdev));
+       fs_unlock(dev, 0);
 }
 
 static int
@@ -629,6 +785,7 @@ fs_link_update(struct rte_eth_dev *dev,
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                DEBUG("Calling link_update on sub_device %d", i);
                ret = (SUBOPS(sdev, link_update))(ETH(sdev), wait_to_complete);
@@ -636,6 +793,7 @@ fs_link_update(struct rte_eth_dev *dev,
                    rte_eth_dev_is_removed(PORT_ID(sdev)) == 0) {
                        ERROR("Link update failed for sub_device %d with error %d",
                              i, ret);
+                       fs_unlock(dev, 0);
                        return ret;
                }
        }
@@ -647,9 +805,11 @@ fs_link_update(struct rte_eth_dev *dev,
                l2 = &ETH(TX_SUBDEV(dev))->data->dev_link;
                if (memcmp(l1, l2, sizeof(*l1))) {
                        *l1 = *l2;
+                       fs_unlock(dev, 0);
                        return 0;
                }
        }
+       fs_unlock(dev, 0);
        return -1;
 }
 
@@ -662,6 +822,7 @@ fs_stats_get(struct rte_eth_dev *dev,
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
        rte_memcpy(stats, &PRIV(dev)->stats_accumulator, sizeof(*stats));
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                struct rte_eth_stats *snapshot = &sdev->stats_snapshot.stats;
@@ -677,12 +838,14 @@ fs_stats_get(struct rte_eth_dev *dev,
                        ERROR("Operation rte_eth_stats_get failed for sub_device %d with error %d",
                                  i, ret);
                        *timestamp = 0;
+                       fs_unlock(dev, 0);
                        return ret;
                }
                *timestamp = rte_rdtsc();
 inc:
                failsafe_stats_increment(stats, snapshot);
        }
+       fs_unlock(dev, 0);
        return 0;
 }
 
@@ -692,11 +855,13 @@ fs_stats_reset(struct rte_eth_dev *dev)
        struct sub_device *sdev;
        uint8_t i;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                rte_eth_stats_reset(PORT_ID(sdev));
                memset(&sdev->stats_snapshot, 0, sizeof(struct rte_eth_stats));
        }
        memset(&PRIV(dev)->stats_accumulator, 0, sizeof(struct rte_eth_stats));
+       fs_unlock(dev, 0);
 }
 
 /**
@@ -726,6 +891,8 @@ fs_stats_reset(struct rte_eth_dev *dev)
  *      all sub_devices and the default capabilities.
  *      Uses a logical AND of TX capabilities among
  *      the active probed sub_device and the default capabilities.
+ *      Uses a logical AND of device capabilities among
+ *      all sub_devices and the default capabilities.
  *
  */
 static void
@@ -743,26 +910,33 @@ fs_dev_infos_get(struct rte_eth_dev *dev,
        } else {
                uint64_t rx_offload_capa;
                uint64_t rxq_offload_capa;
+               uint64_t rss_hf_offload_capa;
+               uint64_t dev_capa;
 
                rx_offload_capa = default_infos.rx_offload_capa;
                rxq_offload_capa = default_infos.rx_queue_offload_capa;
+               rss_hf_offload_capa = default_infos.flow_type_rss_offloads;
+               dev_capa = default_infos.dev_capa;
                FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_PROBED) {
                        rte_eth_dev_info_get(PORT_ID(sdev),
                                        &PRIV(dev)->infos);
                        rx_offload_capa &= PRIV(dev)->infos.rx_offload_capa;
                        rxq_offload_capa &=
                                        PRIV(dev)->infos.rx_queue_offload_capa;
+                       rss_hf_offload_capa &=
+                                       PRIV(dev)->infos.flow_type_rss_offloads;
+                       dev_capa &= PRIV(dev)->infos.dev_capa;
                }
                sdev = TX_SUBDEV(dev);
                rte_eth_dev_info_get(PORT_ID(sdev), &PRIV(dev)->infos);
                PRIV(dev)->infos.rx_offload_capa = rx_offload_capa;
                PRIV(dev)->infos.rx_queue_offload_capa = rxq_offload_capa;
+               PRIV(dev)->infos.flow_type_rss_offloads = rss_hf_offload_capa;
+               PRIV(dev)->infos.dev_capa = dev_capa;
                PRIV(dev)->infos.tx_offload_capa &=
                                        default_infos.tx_offload_capa;
                PRIV(dev)->infos.tx_queue_offload_capa &=
                                        default_infos.tx_queue_offload_capa;
-               PRIV(dev)->infos.flow_type_rss_offloads &=
-                                       default_infos.flow_type_rss_offloads;
        }
        rte_memcpy(infos, &PRIV(dev)->infos, sizeof(*infos));
 }
@@ -772,14 +946,20 @@ fs_dev_supported_ptypes_get(struct rte_eth_dev *dev)
 {
        struct sub_device *sdev;
        struct rte_eth_dev *edev;
+       const uint32_t *ret;
 
+       fs_lock(dev, 0);
        sdev = TX_SUBDEV(dev);
-       if (sdev == NULL)
-               return NULL;
+       if (sdev == NULL) {
+               ret = NULL;
+               goto unlock;
+       }
        edev = ETH(sdev);
        /* ENOTSUP: counts as no supported ptypes */
-       if (SUBOPS(sdev, dev_supported_ptypes_get) == NULL)
-               return NULL;
+       if (SUBOPS(sdev, dev_supported_ptypes_get) == NULL) {
+               ret = NULL;
+               goto unlock;
+       }
        /*
         * The API does not permit to do a clean AND of all ptypes,
         * It is also incomplete by design and we do not really care
@@ -787,7 +967,10 @@ fs_dev_supported_ptypes_get(struct rte_eth_dev *dev)
         * We just return the ptypes of the device of highest
         * priority, usually the PREFERRED device.
         */
-       return SUBOPS(sdev, dev_supported_ptypes_get)(edev);
+       ret = SUBOPS(sdev, dev_supported_ptypes_get)(edev);
+unlock:
+       fs_unlock(dev, 0);
+       return ret;
 }
 
 static int
@@ -797,15 +980,18 @@ fs_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                DEBUG("Calling rte_eth_dev_set_mtu on sub_device %d", i);
                ret = rte_eth_dev_set_mtu(PORT_ID(sdev), mtu);
                if ((ret = fs_err(sdev, ret))) {
                        ERROR("Operation rte_eth_dev_set_mtu failed for sub_device %d with error %d",
                              i, ret);
+                       fs_unlock(dev, 0);
                        return ret;
                }
        }
+       fs_unlock(dev, 0);
        return 0;
 }
 
@@ -816,15 +1002,18 @@ fs_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                DEBUG("Calling rte_eth_dev_vlan_filter on sub_device %d", i);
                ret = rte_eth_dev_vlan_filter(PORT_ID(sdev), vlan_id, on);
                if ((ret = fs_err(sdev, ret))) {
                        ERROR("Operation rte_eth_dev_vlan_filter failed for sub_device %d"
                              " with error %d", i, ret);
+                       fs_unlock(dev, 0);
                        return ret;
                }
        }
+       fs_unlock(dev, 0);
        return 0;
 }
 
@@ -833,13 +1022,22 @@ fs_flow_ctrl_get(struct rte_eth_dev *dev,
                struct rte_eth_fc_conf *fc_conf)
 {
        struct sub_device *sdev;
+       int ret;
 
+       fs_lock(dev, 0);
        sdev = TX_SUBDEV(dev);
-       if (sdev == NULL)
-               return 0;
-       if (SUBOPS(sdev, flow_ctrl_get) == NULL)
-               return -ENOTSUP;
-       return SUBOPS(sdev, flow_ctrl_get)(ETH(sdev), fc_conf);
+       if (sdev == NULL) {
+               ret = 0;
+               goto unlock;
+       }
+       if (SUBOPS(sdev, flow_ctrl_get) == NULL) {
+               ret = -ENOTSUP;
+               goto unlock;
+       }
+       ret = SUBOPS(sdev, flow_ctrl_get)(ETH(sdev), fc_conf);
+unlock:
+       fs_unlock(dev, 0);
+       return ret;
 }
 
 static int
@@ -850,15 +1048,18 @@ fs_flow_ctrl_set(struct rte_eth_dev *dev,
        uint8_t i;
        int ret;
 
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                DEBUG("Calling rte_eth_dev_flow_ctrl_set on sub_device %d", i);
                ret = rte_eth_dev_flow_ctrl_set(PORT_ID(sdev), fc_conf);
                if ((ret = fs_err(sdev, ret))) {
                        ERROR("Operation rte_eth_dev_flow_ctrl_set failed for sub_device %d"
                              " with error %d", i, ret);
+                       fs_unlock(dev, 0);
                        return ret;
                }
        }
+       fs_unlock(dev, 0);
        return 0;
 }
 
@@ -868,6 +1069,7 @@ fs_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index)
        struct sub_device *sdev;
        uint8_t i;
 
+       fs_lock(dev, 0);
        /* No check: already done within the rte_eth_dev_mac_addr_remove
         * call for the fail-safe device.
         */
@@ -875,11 +1077,12 @@ fs_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index)
                rte_eth_dev_mac_addr_remove(PORT_ID(sdev),
                                &dev->data->mac_addrs[index]);
        PRIV(dev)->mac_addr_pool[index] = 0;
+       fs_unlock(dev, 0);
 }
 
 static int
 fs_mac_addr_add(struct rte_eth_dev *dev,
-               struct ether_addr *mac_addr,
+               struct rte_ether_addr *mac_addr,
                uint32_t index,
                uint32_t vmdq)
 {
@@ -888,11 +1091,13 @@ fs_mac_addr_add(struct rte_eth_dev *dev,
        uint8_t i;
 
        RTE_ASSERT(index < FAILSAFE_MAX_ETHADDR);
+       fs_lock(dev, 0);
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
                ret = rte_eth_dev_mac_addr_add(PORT_ID(sdev), mac_addr, vmdq);
                if ((ret = fs_err(sdev, ret))) {
                        ERROR("Operation rte_eth_dev_mac_addr_add failed for sub_device %"
                              PRIu8 " with error %d", i, ret);
+                       fs_unlock(dev, 0);
                        return ret;
                }
        }
@@ -901,46 +1106,121 @@ fs_mac_addr_add(struct rte_eth_dev *dev,
                PRIV(dev)->nb_mac_addr = index;
        }
        PRIV(dev)->mac_addr_pool[index] = vmdq;
+       fs_unlock(dev, 0);
        return 0;
 }
 
-static void
-fs_mac_addr_set(struct rte_eth_dev *dev, struct ether_addr *mac_addr)
+static int
+fs_mac_addr_set(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr)
 {
        struct sub_device *sdev;
        uint8_t i;
+       int ret;
 
-       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE)
-               rte_eth_dev_default_mac_addr_set(PORT_ID(sdev), mac_addr);
+       fs_lock(dev, 0);
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               ret = rte_eth_dev_default_mac_addr_set(PORT_ID(sdev), mac_addr);
+               ret = fs_err(sdev, ret);
+               if (ret) {
+                       ERROR("Operation rte_eth_dev_mac_addr_set failed for sub_device %d with error %d",
+                               i, ret);
+                       fs_unlock(dev, 0);
+                       return ret;
+               }
+       }
+       fs_unlock(dev, 0);
+
+       return 0;
 }
 
 static int
-fs_filter_ctrl(struct rte_eth_dev *dev,
-               enum rte_filter_type type,
-               enum rte_filter_op op,
-               void *arg)
+fs_set_mc_addr_list(struct rte_eth_dev *dev,
+                   struct rte_ether_addr *mc_addr_set, uint32_t nb_mc_addr)
 {
        struct sub_device *sdev;
        uint8_t i;
        int ret;
+       void *mcast_addrs;
 
-       if (type == RTE_ETH_FILTER_GENERIC &&
-           op == RTE_ETH_FILTER_GET) {
-               *(const void **)arg = &fs_flow_ops;
-               return 0;
+       fs_lock(dev, 0);
+
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               ret = rte_eth_dev_set_mc_addr_list(PORT_ID(sdev),
+                                                  mc_addr_set, nb_mc_addr);
+               if (ret != 0) {
+                       ERROR("Operation rte_eth_dev_set_mc_addr_list failed for sub_device %d with error %d",
+                             i, ret);
+                       goto rollback;
+               }
+       }
+
+       mcast_addrs = rte_realloc(PRIV(dev)->mcast_addrs,
+               nb_mc_addr * sizeof(PRIV(dev)->mcast_addrs[0]), 0);
+       if (mcast_addrs == NULL && nb_mc_addr > 0) {
+               ret = -ENOMEM;
+               goto rollback;
        }
+       rte_memcpy(mcast_addrs, mc_addr_set,
+                  nb_mc_addr * sizeof(PRIV(dev)->mcast_addrs[0]));
+       PRIV(dev)->nb_mcast_addr = nb_mc_addr;
+       PRIV(dev)->mcast_addrs = mcast_addrs;
+
+       fs_unlock(dev, 0);
+       return 0;
+
+rollback:
        FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
-               DEBUG("Calling rte_eth_dev_filter_ctrl on sub_device %d", i);
-               ret = rte_eth_dev_filter_ctrl(PORT_ID(sdev), type, op, arg);
-               if ((ret = fs_err(sdev, ret))) {
-                       ERROR("Operation rte_eth_dev_filter_ctrl failed for sub_device %d"
-                             " with error %d", i, ret);
+               int rc = rte_eth_dev_set_mc_addr_list(PORT_ID(sdev),
+                       PRIV(dev)->mcast_addrs, PRIV(dev)->nb_mcast_addr);
+               if (rc != 0) {
+                       ERROR("Multicast MAC address list rollback for sub_device %d failed with error %d",
+                             i, rc);
+               }
+       }
+
+       fs_unlock(dev, 0);
+       return ret;
+}
+
+static int
+fs_rss_hash_update(struct rte_eth_dev *dev,
+                       struct rte_eth_rss_conf *rss_conf)
+{
+       struct sub_device *sdev;
+       uint8_t i;
+       int ret;
+
+       fs_lock(dev, 0);
+       FOREACH_SUBDEV_STATE(sdev, i, dev, DEV_ACTIVE) {
+               ret = rte_eth_dev_rss_hash_update(PORT_ID(sdev), rss_conf);
+               ret = fs_err(sdev, ret);
+               if (ret) {
+                       ERROR("Operation rte_eth_dev_rss_hash_update"
+                               " failed for sub_device %d with error %d",
+                               i, ret);
+                       fs_unlock(dev, 0);
                        return ret;
                }
        }
+       fs_unlock(dev, 0);
+
        return 0;
 }
 
+static int
+fs_filter_ctrl(struct rte_eth_dev *dev __rte_unused,
+               enum rte_filter_type type,
+               enum rte_filter_op op,
+               void *arg)
+{
+       if (type == RTE_ETH_FILTER_GENERIC &&
+           op == RTE_ETH_FILTER_GET) {
+               *(const void **)arg = &fs_flow_ops;
+               return 0;
+       }
+       return -ENOTSUP;
+}
+
 const struct eth_dev_ops failsafe_ops = {
        .dev_configure = fs_dev_configure,
        .dev_start = fs_dev_start,
@@ -959,6 +1239,10 @@ const struct eth_dev_ops failsafe_ops = {
        .dev_supported_ptypes_get = fs_dev_supported_ptypes_get,
        .mtu_set = fs_mtu_set,
        .vlan_filter_set = fs_vlan_filter_set,
+       .rx_queue_start = fs_rx_queue_start,
+       .rx_queue_stop = fs_rx_queue_stop,
+       .tx_queue_start = fs_tx_queue_start,
+       .tx_queue_stop = fs_tx_queue_stop,
        .rx_queue_setup = fs_rx_queue_setup,
        .tx_queue_setup = fs_tx_queue_setup,
        .rx_queue_release = fs_rx_queue_release,
@@ -970,5 +1254,7 @@ const struct eth_dev_ops failsafe_ops = {
        .mac_addr_remove = fs_mac_addr_remove,
        .mac_addr_add = fs_mac_addr_add,
        .mac_addr_set = fs_mac_addr_set,
+       .set_mc_addr_list = fs_set_mc_addr_list,
+       .rss_hash_update = fs_rss_hash_update,
        .filter_ctrl = fs_filter_ctrl,
 };