net/mlx5: add Tx configuration and setup
[dpdk.git] / drivers / net / mlx5 / mlx5_txq.c
index 691ea07..2f3aa5b 100644 (file)
@@ -10,6 +10,7 @@
 #include <stdint.h>
 #include <unistd.h>
 #include <sys/mman.h>
+#include <inttypes.h>
 
 /* Verbs header. */
 /* ISO C doesn't support unnamed structs/unions, disabling -pedantic. */
@@ -46,9 +47,9 @@ txq_alloc_elts(struct mlx5_txq_ctrl *txq_ctrl)
        unsigned int i;
 
        for (i = 0; (i != elts_n); ++i)
-               (*txq_ctrl->txq.elts)[i] = NULL;
+               txq_ctrl->txq.elts[i] = NULL;
        DRV_LOG(DEBUG, "port %u Tx queue %u allocated and configured %u WRs",
-               PORT_ID(txq_ctrl->priv), txq_ctrl->idx, elts_n);
+               PORT_ID(txq_ctrl->priv), txq_ctrl->txq.idx, elts_n);
        txq_ctrl->txq.elts_head = 0;
        txq_ctrl->txq.elts_tail = 0;
        txq_ctrl->txq.elts_comp = 0;
@@ -67,10 +68,10 @@ txq_free_elts(struct mlx5_txq_ctrl *txq_ctrl)
        const uint16_t elts_m = elts_n - 1;
        uint16_t elts_head = txq_ctrl->txq.elts_head;
        uint16_t elts_tail = txq_ctrl->txq.elts_tail;
-       struct rte_mbuf *(*elts)[elts_n] = txq_ctrl->txq.elts;
+       struct rte_mbuf *(*elts)[elts_n] = &txq_ctrl->txq.elts;
 
        DRV_LOG(DEBUG, "port %u Tx queue %u freeing WRs",
-               PORT_ID(txq_ctrl->priv), txq_ctrl->idx);
+               PORT_ID(txq_ctrl->priv), txq_ctrl->txq.idx);
        txq_ctrl->txq.elts_head = 0;
        txq_ctrl->txq.elts_tail = 0;
        txq_ctrl->txq.elts_comp = 0;
@@ -102,7 +103,7 @@ txq_free_elts(struct mlx5_txq_ctrl *txq_ctrl)
 uint64_t
 mlx5_get_tx_port_offloads(struct rte_eth_dev *dev)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        uint64_t offloads = (DEV_TX_OFFLOAD_MULTI_SEGS |
                             DEV_TX_OFFLOAD_VLAN_INSERT);
        struct mlx5_dev_config *config = &priv->config;
@@ -113,16 +114,24 @@ mlx5_get_tx_port_offloads(struct rte_eth_dev *dev)
                             DEV_TX_OFFLOAD_TCP_CKSUM);
        if (config->tso)
                offloads |= DEV_TX_OFFLOAD_TCP_TSO;
+       if (config->swp) {
+               if (config->hw_csum)
+                       offloads |= DEV_TX_OFFLOAD_OUTER_IPV4_CKSUM;
+               if (config->tso)
+                       offloads |= (DEV_TX_OFFLOAD_IP_TNL_TSO |
+                                    DEV_TX_OFFLOAD_UDP_TNL_TSO);
+       }
        if (config->tunnel_en) {
                if (config->hw_csum)
                        offloads |= DEV_TX_OFFLOAD_OUTER_IPV4_CKSUM;
                if (config->tso)
                        offloads |= (DEV_TX_OFFLOAD_VXLAN_TNL_TSO |
                                     DEV_TX_OFFLOAD_GRE_TNL_TSO);
-               if (config->swp)
-                       offloads |= (DEV_TX_OFFLOAD_IP_TNL_TSO |
-                                    DEV_TX_OFFLOAD_UDP_TNL_TSO);
        }
+#ifdef HAVE_IBV_FLOW_DV_SUPPORT
+       if (config->dv_flow_en)
+               offloads |= DEV_TX_OFFLOAD_MATCH_METADATA;
+#endif
        return offloads;
 }
 
@@ -147,7 +156,7 @@ int
 mlx5_tx_queue_setup(struct rte_eth_dev *dev, uint16_t idx, uint16_t desc,
                    unsigned int socket, const struct rte_eth_txconf *conf)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        struct mlx5_txq_data *txq = (*priv->txqs)[idx];
        struct mlx5_txq_ctrl *txq_ctrl =
                container_of(txq, struct mlx5_txq_ctrl, txq);
@@ -205,7 +214,7 @@ mlx5_tx_queue_release(void *dpdk_txq)
 {
        struct mlx5_txq_data *txq = (struct mlx5_txq_data *)dpdk_txq;
        struct mlx5_txq_ctrl *txq_ctrl;
-       struct priv *priv;
+       struct mlx5_priv *priv;
        unsigned int i;
 
        if (txq == NULL)
@@ -216,111 +225,143 @@ mlx5_tx_queue_release(void *dpdk_txq)
                if ((*priv->txqs)[i] == txq) {
                        mlx5_txq_release(ETH_DEV(priv), i);
                        DRV_LOG(DEBUG, "port %u removing Tx queue %u from list",
-                               PORT_ID(priv), txq_ctrl->idx);
+                               PORT_ID(priv), txq->idx);
                        break;
                }
 }
 
+/**
+ * Initialize Tx UAR registers for primary process.
+ *
+ * @param txq_ctrl
+ *   Pointer to Tx queue control structure.
+ */
+static void
+txq_uar_init(struct mlx5_txq_ctrl *txq_ctrl)
+{
+       struct mlx5_priv *priv = txq_ctrl->priv;
+       struct mlx5_proc_priv *ppriv = MLX5_PROC_PRIV(PORT_ID(priv));
+#ifndef RTE_ARCH_64
+       unsigned int lock_idx;
+       const size_t page_size = sysconf(_SC_PAGESIZE);
+#endif
+
+       assert(rte_eal_process_type() == RTE_PROC_PRIMARY);
+       assert(ppriv);
+       ppriv->uar_table[txq_ctrl->txq.idx] = txq_ctrl->bf_reg;
+#ifndef RTE_ARCH_64
+       /* Assign an UAR lock according to UAR page number */
+       lock_idx = (txq_ctrl->uar_mmap_offset / page_size) &
+                  MLX5_UAR_PAGE_NUM_MASK;
+       txq_ctrl->txq.uar_lock = &priv->uar_lock[lock_idx];
+#endif
+}
 
 /**
- * Mmap TX UAR(HW doorbell) pages into reserved UAR address space.
- * Both primary and secondary process do mmap to make UAR address
- * aligned.
+ * Remap UAR register of a Tx queue for secondary process.
  *
- * @param[in] dev
- *   Pointer to Ethernet device.
+ * Remapped address is stored at the table in the process private structure of
+ * the device, indexed by queue index.
+ *
+ * @param txq_ctrl
+ *   Pointer to Tx queue control structure.
  * @param fd
  *   Verbs file descriptor to map UAR pages.
  *
  * @return
  *   0 on success, a negative errno value otherwise and rte_errno is set.
  */
-int
-mlx5_tx_uar_remap(struct rte_eth_dev *dev, int fd)
+static int
+txq_uar_init_secondary(struct mlx5_txq_ctrl *txq_ctrl, int fd)
 {
-       struct priv *priv = dev->data->dev_private;
-       unsigned int i, j;
-       uintptr_t pages[priv->txqs_n];
-       unsigned int pages_n = 0;
-       uintptr_t uar_va;
-       uintptr_t off;
+       struct mlx5_priv *priv = txq_ctrl->priv;
+       struct mlx5_proc_priv *ppriv = MLX5_PROC_PRIV(PORT_ID(priv));
+       struct mlx5_txq_data *txq = &txq_ctrl->txq;
        void *addr;
-       void *ret;
-       struct mlx5_txq_data *txq;
-       struct mlx5_txq_ctrl *txq_ctrl;
-       int already_mapped;
-       size_t page_size = sysconf(_SC_PAGESIZE);
+       uintptr_t uar_va;
+       uintptr_t offset;
+       const size_t page_size = sysconf(_SC_PAGESIZE);
 
-       memset(pages, 0, priv->txqs_n * sizeof(uintptr_t));
+       assert(ppriv);
        /*
-        * As rdma-core, UARs are mapped in size of OS page size.
-        * Use aligned address to avoid duplicate mmap.
-        * Ref to libmlx5 function: mlx5_init_context()
+        * As rdma-core, UARs are mapped in size of OS page
+        * size. Ref to libmlx5 function: mlx5_init_context()
         */
-       for (i = 0; i != priv->txqs_n; ++i) {
-               if (!(*priv->txqs)[i])
-                       continue;
-               txq = (*priv->txqs)[i];
-               txq_ctrl = container_of(txq, struct mlx5_txq_ctrl, txq);
-               assert(txq_ctrl->idx == (uint16_t)i);
-               /* UAR addr form verbs used to find dup and offset in page. */
-               uar_va = (uintptr_t)txq_ctrl->bf_reg_orig;
-               off = uar_va & (page_size - 1); /* offset in page. */
-               uar_va = RTE_ALIGN_FLOOR(uar_va, page_size); /* page addr. */
-               already_mapped = 0;
-               for (j = 0; j != pages_n; ++j) {
-                       if (pages[j] == uar_va) {
-                               already_mapped = 1;
-                               break;
-                       }
-               }
-               /* new address in reserved UAR address space. */
-               addr = RTE_PTR_ADD(priv->uar_base,
-                                  uar_va & (MLX5_UAR_SIZE - 1));
-               if (!already_mapped) {
-                       pages[pages_n++] = uar_va;
-                       /* fixed mmap to specified address in reserved
-                        * address space.
-                        */
-                       ret = mmap(addr, page_size,
-                                  PROT_WRITE, MAP_FIXED | MAP_SHARED, fd,
-                                  txq_ctrl->uar_mmap_offset);
-                       if (ret != addr) {
-                               /* fixed mmap have to return same address */
-                               DRV_LOG(ERR,
-                                       "port %u call to mmap failed on UAR"
-                                       " for txq %u",
-                                       dev->data->port_id, txq_ctrl->idx);
-                               rte_errno = ENXIO;
-                               return -rte_errno;
-                       }
-               }
-               if (rte_eal_process_type() == RTE_PROC_PRIMARY) /* save once */
-                       txq_ctrl->txq.bf_reg = RTE_PTR_ADD((void *)addr, off);
-               else
-                       assert(txq_ctrl->txq.bf_reg ==
-                              RTE_PTR_ADD((void *)addr, off));
+       uar_va = (uintptr_t)txq_ctrl->bf_reg;
+       offset = uar_va & (page_size - 1); /* Offset in page. */
+       addr = mmap(NULL, page_size, PROT_WRITE, MAP_SHARED, fd,
+                       txq_ctrl->uar_mmap_offset);
+       if (addr == MAP_FAILED) {
+               DRV_LOG(ERR,
+                       "port %u mmap failed for BF reg of txq %u",
+                       txq->port_id, txq->idx);
+               rte_errno = ENXIO;
+               return -rte_errno;
        }
+       addr = RTE_PTR_ADD(addr, offset);
+       ppriv->uar_table[txq->idx] = addr;
        return 0;
 }
 
 /**
- * Check if the burst function is using eMPW.
+ * Unmap UAR register of a Tx queue for secondary process.
+ *
+ * @param txq_ctrl
+ *   Pointer to Tx queue control structure.
+ */
+static void
+txq_uar_uninit_secondary(struct mlx5_txq_ctrl *txq_ctrl)
+{
+       struct mlx5_proc_priv *ppriv = MLX5_PROC_PRIV(PORT_ID(txq_ctrl->priv));
+       const size_t page_size = sysconf(_SC_PAGESIZE);
+       void *addr;
+
+       addr = ppriv->uar_table[txq_ctrl->txq.idx];
+       munmap(RTE_PTR_ALIGN_FLOOR(addr, page_size), page_size);
+}
+
+/**
+ * Initialize Tx UAR registers for secondary process.
  *
- * @param tx_pkt_burst
- *   Tx burst function pointer.
+ * @param dev
+ *   Pointer to Ethernet device.
+ * @param fd
+ *   Verbs file descriptor to map UAR pages.
  *
  * @return
- *   1 if the burst function is using eMPW, 0 otherwise.
+ *   0 on success, a negative errno value otherwise and rte_errno is set.
  */
-static int
-is_empw_burst_func(eth_tx_burst_t tx_pkt_burst)
+int
+mlx5_tx_uar_init_secondary(struct rte_eth_dev *dev, int fd)
 {
-       if (tx_pkt_burst == mlx5_tx_burst_raw_vec ||
-           tx_pkt_burst == mlx5_tx_burst_vec ||
-           tx_pkt_burst == mlx5_tx_burst_empw)
-               return 1;
+       struct mlx5_priv *priv = dev->data->dev_private;
+       struct mlx5_txq_data *txq;
+       struct mlx5_txq_ctrl *txq_ctrl;
+       unsigned int i;
+       int ret;
+
+       assert(rte_eal_process_type() == RTE_PROC_SECONDARY);
+       for (i = 0; i != priv->txqs_n; ++i) {
+               if (!(*priv->txqs)[i])
+                       continue;
+               txq = (*priv->txqs)[i];
+               txq_ctrl = container_of(txq, struct mlx5_txq_ctrl, txq);
+               assert(txq->idx == (uint16_t)i);
+               ret = txq_uar_init_secondary(txq_ctrl, fd);
+               if (ret)
+                       goto error;
+       }
        return 0;
+error:
+       /* Rollback. */
+       do {
+               if (!(*priv->txqs)[i])
+                       continue;
+               txq = (*priv->txqs)[i];
+               txq_ctrl = container_of(txq, struct mlx5_txq_ctrl, txq);
+               txq_uar_uninit_secondary(txq_ctrl);
+       } while (i--);
+       return -rte_errno;
 }
 
 /**
@@ -329,7 +370,7 @@ is_empw_burst_func(eth_tx_burst_t tx_pkt_burst)
  * @param dev
  *   Pointer to Ethernet device.
  * @param idx
- *   Queue index in DPDK Rx queue array
+ *   Queue index in DPDK Tx queue array.
  *
  * @return
  *   The Verbs object initialised, NULL otherwise and rte_errno is set.
@@ -337,12 +378,12 @@ is_empw_burst_func(eth_tx_burst_t tx_pkt_burst)
 struct mlx5_txq_ibv *
 mlx5_txq_ibv_new(struct rte_eth_dev *dev, uint16_t idx)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        struct mlx5_txq_data *txq_data = (*priv->txqs)[idx];
        struct mlx5_txq_ctrl *txq_ctrl =
                container_of(txq_data, struct mlx5_txq_ctrl, txq);
        struct mlx5_txq_ibv tmpl;
-       struct mlx5_txq_ibv *txq_ibv;
+       struct mlx5_txq_ibv *txq_ibv = NULL;
        union {
                struct ibv_qp_init_attr_ex init;
                struct ibv_cq_init_attr_ex cq;
@@ -354,7 +395,6 @@ mlx5_txq_ibv_new(struct rte_eth_dev *dev, uint16_t idx)
        struct mlx5dv_cq cq_info;
        struct mlx5dv_obj obj;
        const int desc = 1 << txq_data->elts_n;
-       eth_tx_burst_t tx_pkt_burst = mlx5_select_tx_function(dev);
        int ret = 0;
 
        assert(txq_data);
@@ -371,11 +411,9 @@ mlx5_txq_ibv_new(struct rte_eth_dev *dev, uint16_t idx)
        attr.cq = (struct ibv_cq_init_attr_ex){
                .comp_mask = 0,
        };
-       cqe_n = ((desc / MLX5_TX_COMP_THRESH) - 1) ?
-               ((desc / MLX5_TX_COMP_THRESH) - 1) : 1;
-       if (is_empw_burst_func(tx_pkt_burst))
-               cqe_n += MLX5_TX_COMP_THRESH_INLINE_DIV;
-       tmpl.cq = mlx5_glue->create_cq(priv->ctx, cqe_n, NULL, NULL, 0);
+       cqe_n = desc / MLX5_TX_COMP_THRESH +
+               1 + MLX5_TX_COMP_THRESH_INLINE_DIV;
+       tmpl.cq = mlx5_glue->create_cq(priv->sh->ctx, cqe_n, NULL, NULL, 0);
        if (tmpl.cq == NULL) {
                DRV_LOG(ERR, "port %u Tx queue %u CQ creation failure",
                        dev->data->port_id, idx);
@@ -390,15 +428,15 @@ mlx5_txq_ibv_new(struct rte_eth_dev *dev, uint16_t idx)
                .cap = {
                        /* Max number of outstanding WRs. */
                        .max_send_wr =
-                               ((priv->device_attr.orig_attr.max_qp_wr <
+                               ((priv->sh->device_attr.orig_attr.max_qp_wr <
                                  desc) ?
-                                priv->device_attr.orig_attr.max_qp_wr :
+                                priv->sh->device_attr.orig_attr.max_qp_wr :
                                 desc),
                        /*
                         * Max number of scatter/gather elements in a WR,
                         * must be 1 to prevent libmlx5 from trying to affect
                         * too much memory. TX gather is not impacted by the
-                        * priv->device_attr.max_sge limit and will still work
+                        * device_attr.max_sge limit and will still work
                         * properly.
                         */
                        .max_send_sge = 1,
@@ -409,16 +447,16 @@ mlx5_txq_ibv_new(struct rte_eth_dev *dev, uint16_t idx)
                 * Tx burst.
                 */
                .sq_sig_all = 0,
-               .pd = priv->pd,
+               .pd = priv->sh->pd,
                .comp_mask = IBV_QP_INIT_ATTR_PD,
        };
-       if (txq_data->max_inline)
+       if (txq_data->inlen_send)
                attr.init.cap.max_inline_data = txq_ctrl->max_inline_data;
        if (txq_data->tso_en) {
                attr.init.max_tso_header = txq_ctrl->max_tso_header;
                attr.init.comp_mask |= IBV_QP_INIT_ATTR_MAX_TSO_HEADER;
        }
-       tmpl.qp = mlx5_glue->create_qp_ex(priv->ctx, &attr.init);
+       tmpl.qp = mlx5_glue->create_qp_ex(priv->sh->ctx, &attr.init);
        if (tmpl.qp == NULL) {
                DRV_LOG(ERR, "port %u Tx queue %u QP creation failure",
                        dev->data->port_id, idx);
@@ -428,8 +466,8 @@ mlx5_txq_ibv_new(struct rte_eth_dev *dev, uint16_t idx)
        attr.mod = (struct ibv_qp_attr){
                /* Move the QP to this state. */
                .qp_state = IBV_QPS_INIT,
-               /* Primary port number. */
-               .port_num = priv->port
+               /* IB device port number. */
+               .port_num = (uint8_t)priv->ibv_port,
        };
        ret = mlx5_glue->modify_qp(tmpl.qp, &attr.mod,
                                   (IBV_QP_STATE | IBV_QP_PORT));
@@ -486,26 +524,34 @@ mlx5_txq_ibv_new(struct rte_eth_dev *dev, uint16_t idx)
                goto error;
        }
        txq_data->cqe_n = log2above(cq_info.cqe_cnt);
+       txq_data->cqe_s = 1 << txq_data->cqe_n;
+       txq_data->cqe_m = txq_data->cqe_s - 1;
        txq_data->qp_num_8s = tmpl.qp->qp_num << 8;
        txq_data->wqes = qp.sq.buf;
        txq_data->wqe_n = log2above(qp.sq.wqe_cnt);
+       txq_data->wqe_s = 1 << txq_data->wqe_n;
+       txq_data->wqe_m = txq_data->wqe_s - 1;
+       txq_data->wqes_end = txq_data->wqes + txq_data->wqe_s;
        txq_data->qp_db = &qp.dbrec[MLX5_SND_DBR];
-       txq_ctrl->bf_reg_orig = qp.bf.reg;
        txq_data->cq_db = cq_info.dbrec;
-       txq_data->cqes =
-               (volatile struct mlx5_cqe (*)[])
-               (uintptr_t)cq_info.buf;
+       txq_data->cqes = (volatile struct mlx5_cqe *)cq_info.buf;
        txq_data->cq_ci = 0;
 #ifndef NDEBUG
        txq_data->cq_pi = 0;
 #endif
        txq_data->wqe_ci = 0;
        txq_data->wqe_pi = 0;
+       txq_data->wqe_comp = 0;
+       txq_data->wqe_thres = txq_data->wqe_s / MLX5_TX_COMP_THRESH_INLINE_DIV;
        txq_ibv->qp = tmpl.qp;
        txq_ibv->cq = tmpl.cq;
        rte_atomic32_inc(&txq_ibv->refcnt);
+       txq_ctrl->bf_reg = qp.bf.reg;
+       txq_uar_init(txq_ctrl);
        if (qp.comp_mask & MLX5DV_QP_MASK_UAR_MMAP_OFFSET) {
                txq_ctrl->uar_mmap_offset = qp.uar_mmap_offset;
+               DRV_LOG(DEBUG, "port %u: uar_mmap_offset 0x%"PRIx64,
+                       dev->data->port_id, txq_ctrl->uar_mmap_offset);
        } else {
                DRV_LOG(ERR,
                        "port %u failed to retrieve UAR info, invalid"
@@ -514,8 +560,6 @@ mlx5_txq_ibv_new(struct rte_eth_dev *dev, uint16_t idx)
                rte_errno = EINVAL;
                goto error;
        }
-       DRV_LOG(DEBUG, "port %u Verbs Tx queue %u: refcnt %d",
-               dev->data->port_id, idx, rte_atomic32_read(&txq_ibv->refcnt));
        LIST_INSERT_HEAD(&priv->txqsibv, txq_ibv, next);
        txq_ibv->txq_ctrl = txq_ctrl;
        priv->verbs_alloc_ctx.type = MLX5_VERBS_ALLOC_TYPE_NONE;
@@ -526,6 +570,8 @@ error:
                claim_zero(mlx5_glue->destroy_cq(tmpl.cq));
        if (tmpl.qp)
                claim_zero(mlx5_glue->destroy_qp(tmpl.qp));
+       if (txq_ibv)
+               rte_free(txq_ibv);
        priv->verbs_alloc_ctx.type = MLX5_VERBS_ALLOC_TYPE_NONE;
        rte_errno = ret; /* Restore rte_errno. */
        return NULL;
@@ -537,7 +583,7 @@ error:
  * @param dev
  *   Pointer to Ethernet device.
  * @param idx
- *   Queue index in DPDK Rx queue array
+ *   Queue index in DPDK Tx queue array.
  *
  * @return
  *   The Verbs object if it exists.
@@ -545,7 +591,7 @@ error:
 struct mlx5_txq_ibv *
 mlx5_txq_ibv_get(struct rte_eth_dev *dev, uint16_t idx)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        struct mlx5_txq_ctrl *txq_ctrl;
 
        if (idx >= priv->txqs_n)
@@ -553,12 +599,8 @@ mlx5_txq_ibv_get(struct rte_eth_dev *dev, uint16_t idx)
        if (!(*priv->txqs)[idx])
                return NULL;
        txq_ctrl = container_of((*priv->txqs)[idx], struct mlx5_txq_ctrl, txq);
-       if (txq_ctrl->ibv) {
+       if (txq_ctrl->ibv)
                rte_atomic32_inc(&txq_ctrl->ibv->refcnt);
-               DRV_LOG(DEBUG, "port %u Verbs Tx queue %u: refcnt %d",
-                       dev->data->port_id, txq_ctrl->idx,
-                     rte_atomic32_read(&txq_ctrl->ibv->refcnt));
-       }
        return txq_ctrl->ibv;
 }
 
@@ -575,9 +617,6 @@ int
 mlx5_txq_ibv_release(struct mlx5_txq_ibv *txq_ibv)
 {
        assert(txq_ibv);
-       DRV_LOG(DEBUG, "port %u Verbs Tx queue %u: refcnt %d",
-               PORT_ID(txq_ibv->txq_ctrl->priv),
-               txq_ibv->txq_ctrl->idx, rte_atomic32_read(&txq_ibv->refcnt));
        if (rte_atomic32_dec_and_test(&txq_ibv->refcnt)) {
                claim_zero(mlx5_glue->destroy_qp(txq_ibv->qp));
                claim_zero(mlx5_glue->destroy_cq(txq_ibv->cq));
@@ -588,19 +627,6 @@ mlx5_txq_ibv_release(struct mlx5_txq_ibv *txq_ibv)
        return 1;
 }
 
-/**
- * Return true if a single reference exists on the object.
- *
- * @param txq_ibv
- *   Verbs Tx queue object.
- */
-int
-mlx5_txq_ibv_releasable(struct mlx5_txq_ibv *txq_ibv)
-{
-       assert(txq_ibv);
-       return (rte_atomic32_read(&txq_ibv->refcnt) == 1);
-}
-
 /**
  * Verify the Verbs Tx queue list is empty
  *
@@ -613,18 +639,43 @@ mlx5_txq_ibv_releasable(struct mlx5_txq_ibv *txq_ibv)
 int
 mlx5_txq_ibv_verify(struct rte_eth_dev *dev)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        int ret = 0;
        struct mlx5_txq_ibv *txq_ibv;
 
        LIST_FOREACH(txq_ibv, &priv->txqsibv, next) {
                DRV_LOG(DEBUG, "port %u Verbs Tx queue %u still referenced",
-                       dev->data->port_id, txq_ibv->txq_ctrl->idx);
+                       dev->data->port_id, txq_ibv->txq_ctrl->txq.idx);
                ++ret;
        }
        return ret;
 }
 
+/**
+ * Calculate the total number of WQEBB for Tx queue.
+ *
+ * Simplified version of calc_sq_size() in rdma-core.
+ *
+ * @param txq_ctrl
+ *   Pointer to Tx queue control structure.
+ *
+ * @return
+ *   The number of WQEBB.
+ */
+static int
+txq_calc_wqebb_cnt(struct mlx5_txq_ctrl *txq_ctrl)
+{
+       unsigned int wqe_size;
+       const unsigned int desc = 1 << txq_ctrl->txq.elts_n;
+
+       wqe_size = MLX5_WQE_CSEG_SIZE +
+                  MLX5_WQE_ESEG_SIZE +
+                  MLX5_WSEG_SIZE -
+                  MLX5_ESEG_MIN_INLINE_SIZE +
+                  txq_ctrl->max_inline_data;
+       return rte_align32pow2(wqe_size * desc) / MLX5_WQE_SIZE;
+}
+
 /**
  * Set Tx queue parameters from device configuration.
  *
@@ -634,89 +685,185 @@ mlx5_txq_ibv_verify(struct rte_eth_dev *dev)
 static void
 txq_set_params(struct mlx5_txq_ctrl *txq_ctrl)
 {
-       struct priv *priv = txq_ctrl->priv;
+       struct mlx5_priv *priv = txq_ctrl->priv;
        struct mlx5_dev_config *config = &priv->config;
-       const unsigned int max_tso_inline =
-               ((MLX5_MAX_TSO_HEADER + (RTE_CACHE_LINE_SIZE - 1)) /
-                RTE_CACHE_LINE_SIZE);
-       unsigned int txq_inline;
-       unsigned int txqs_inline;
-       unsigned int inline_max_packet_sz;
-       eth_tx_burst_t tx_pkt_burst =
-               mlx5_select_tx_function(ETH_DEV(priv));
-       int is_empw_func = is_empw_burst_func(tx_pkt_burst);
-       int tso = !!(txq_ctrl->txq.offloads & (DEV_TX_OFFLOAD_TCP_TSO |
-                                              DEV_TX_OFFLOAD_VXLAN_TNL_TSO |
-                                              DEV_TX_OFFLOAD_GRE_TNL_TSO |
-                                              DEV_TX_OFFLOAD_IP_TNL_TSO |
-                                              DEV_TX_OFFLOAD_UDP_TNL_TSO));
-
-       txq_inline = (config->txq_inline == MLX5_ARG_UNSET) ?
-               0 : config->txq_inline;
-       txqs_inline = (config->txqs_inline == MLX5_ARG_UNSET) ?
-               0 : config->txqs_inline;
-       inline_max_packet_sz =
-               (config->inline_max_packet_sz == MLX5_ARG_UNSET) ?
-               0 : config->inline_max_packet_sz;
-       if (is_empw_func) {
-               if (config->txq_inline == MLX5_ARG_UNSET)
-                       txq_inline = MLX5_WQE_SIZE_MAX - MLX5_WQE_SIZE;
-               if (config->txqs_inline == MLX5_ARG_UNSET)
-                       txqs_inline = MLX5_EMPW_MIN_TXQS;
-               if (config->inline_max_packet_sz == MLX5_ARG_UNSET)
-                       inline_max_packet_sz = MLX5_EMPW_MAX_INLINE_LEN;
-               txq_ctrl->txq.mpw_hdr_dseg = config->mpw_hdr_dseg;
-               txq_ctrl->txq.inline_max_packet_sz = inline_max_packet_sz;
-       }
-       if (txq_inline && priv->txqs_n >= txqs_inline) {
-               unsigned int ds_cnt;
-
-               txq_ctrl->txq.max_inline =
-                       ((txq_inline + (RTE_CACHE_LINE_SIZE - 1)) /
-                        RTE_CACHE_LINE_SIZE);
-               if (is_empw_func) {
-                       /* To minimize the size of data set, avoid requesting
-                        * too large WQ.
+       unsigned int inlen_send; /* Inline data for ordinary SEND.*/
+       unsigned int inlen_empw; /* Inline data for enhanced MPW. */
+       unsigned int inlen_mode; /* Minimal required Inline data. */
+       unsigned int txqs_inline; /* Min Tx queues to enable inline. */
+       uint64_t dev_txoff = priv->dev_data->dev_conf.txmode.offloads;
+       bool tso = txq_ctrl->txq.offloads & (DEV_TX_OFFLOAD_TCP_TSO |
+                                           DEV_TX_OFFLOAD_VXLAN_TNL_TSO |
+                                           DEV_TX_OFFLOAD_GRE_TNL_TSO |
+                                           DEV_TX_OFFLOAD_IP_TNL_TSO |
+                                           DEV_TX_OFFLOAD_UDP_TNL_TSO);
+       bool vlan_inline;
+       unsigned int temp;
+
+       if (config->txqs_inline == MLX5_ARG_UNSET)
+               txqs_inline =
+#if defined(RTE_ARCH_ARM64)
+               (priv->sh->pci_dev->id.device_id ==
+                       PCI_DEVICE_ID_MELLANOX_CONNECTX5BF) ?
+                       MLX5_INLINE_MAX_TXQS_BLUEFIELD :
+#endif
+                       MLX5_INLINE_MAX_TXQS;
+       else
+               txqs_inline = (unsigned int)config->txqs_inline;
+       inlen_send = (config->txq_inline_max == MLX5_ARG_UNSET) ?
+                    MLX5_SEND_DEF_INLINE_LEN :
+                    (unsigned int)config->txq_inline_max;
+       inlen_empw = (config->txq_inline_mpw == MLX5_ARG_UNSET) ?
+                    MLX5_EMPW_DEF_INLINE_LEN :
+                    (unsigned int)config->txq_inline_mpw;
+       inlen_mode = (config->txq_inline_min == MLX5_ARG_UNSET) ?
+                    0 : (unsigned int)config->txq_inline_min;
+       if (config->mps != MLX5_MPW_ENHANCED)
+               inlen_empw = 0;
+       /*
+        * If there is requested minimal amount of data to inline
+        * we MUST enable inlining. This is a case for ConnectX-4
+        * which usually requires L2 inlined for correct operating
+        * and ConnectX-4LX which requires L2-L4 inlined to
+        * support E-Switch Flows.
+        */
+       if (inlen_mode) {
+               if (inlen_mode <= MLX5_ESEG_MIN_INLINE_SIZE) {
+                       /*
+                        * Optimize minimal inlining for single
+                        * segment packets to fill one WQEBB
+                        * without gaps.
                         */
-                       txq_ctrl->max_inline_data =
-                               ((RTE_MIN(txq_inline,
-                                         inline_max_packet_sz) +
-                                 (RTE_CACHE_LINE_SIZE - 1)) /
-                                RTE_CACHE_LINE_SIZE) * RTE_CACHE_LINE_SIZE;
+                       temp = MLX5_ESEG_MIN_INLINE_SIZE;
                } else {
-                       txq_ctrl->max_inline_data =
-                               txq_ctrl->txq.max_inline * RTE_CACHE_LINE_SIZE;
+                       temp = inlen_mode - MLX5_ESEG_MIN_INLINE_SIZE;
+                       temp = RTE_ALIGN(temp, MLX5_WSEG_SIZE) +
+                              MLX5_ESEG_MIN_INLINE_SIZE;
+                       temp = RTE_MIN(temp, MLX5_SEND_MAX_INLINE_LEN);
+               }
+               if (temp != inlen_mode) {
+                       DRV_LOG(INFO,
+                               "port %u minimal required inline setting"
+                               " aligned from %u to %u",
+                               PORT_ID(priv), inlen_mode, temp);
+                       inlen_mode = temp;
+               }
+       }
+       /*
+        * If port is configured to support VLAN insertion and device
+        * does not support this feature by HW (for NICs before ConnectX-5
+        * or in case of wqe_vlan_insert flag is not set) we must enable
+        * data inline on all queues because it is supported by single
+        * tx_burst routine.
+        */
+       txq_ctrl->txq.vlan_en = config->hw_vlan_insert;
+       vlan_inline = (dev_txoff & DEV_TX_OFFLOAD_VLAN_INSERT) &&
+                     !config->hw_vlan_insert;
+       if (vlan_inline)
+               inlen_send = RTE_MAX(inlen_send, MLX5_ESEG_MIN_INLINE_SIZE);
+       /*
+        * If there are few Tx queues it is prioritized
+        * to save CPU cycles and disable data inlining at all.
+        */
+       if ((inlen_send && priv->txqs_n >= txqs_inline) || vlan_inline) {
+               /*
+                * The data sent with ordinal MLX5_OPCODE_SEND
+                * may be inlined in Ethernet Segment, align the
+                * length accordingly to fit entire WQEBBs.
+                */
+               temp = (inlen_send / MLX5_WQE_SIZE) * MLX5_WQE_SIZE +
+                       MLX5_ESEG_MIN_INLINE_SIZE + MLX5_WQE_DSEG_SIZE;
+               temp = RTE_MIN(temp, MLX5_WQE_SIZE_MAX +
+                                    MLX5_ESEG_MIN_INLINE_SIZE -
+                                    MLX5_WQE_CSEG_SIZE -
+                                    MLX5_WQE_ESEG_SIZE -
+                                    MLX5_WQE_DSEG_SIZE * 2);
+               temp = RTE_MIN(temp, MLX5_SEND_MAX_INLINE_LEN);
+               temp = RTE_MAX(temp, inlen_mode);
+               if (temp != inlen_send) {
+                       DRV_LOG(INFO,
+                               "port %u ordinary send inline setting"
+                               " aligned from %u to %u",
+                               PORT_ID(priv), inlen_send, temp);
+                       inlen_send = temp;
+               }
+               /*
+                * Not aligned to cache lines, but to WQEs.
+                * First bytes of data (initial alignment)
+                * is going to be copied explicitly at the
+                * beginning of inlining buffer in Ethernet
+                * Segment.
+                */
+               assert(inlen_send >= MLX5_ESEG_MIN_INLINE_SIZE);
+               assert(inlen_send <= MLX5_WQE_SIZE_MAX +
+                                    MLX5_ESEG_MIN_INLINE_SIZE -
+                                    MLX5_WQE_CSEG_SIZE -
+                                    MLX5_WQE_ESEG_SIZE -
+                                    MLX5_WQE_DSEG_SIZE * 2);
+               txq_ctrl->txq.inlen_send = inlen_send;
+               txq_ctrl->txq.inlen_mode = inlen_mode;
+               txq_ctrl->txq.inlen_empw = 0;
+       } else {
+               /*
+                * If minimal inlining is requested we must
+                * enable inlining in general, despite the
+                * number of configured queues.
+                */
+               inlen_send = inlen_mode;
+               if (inlen_mode) {
+                       /*
+                        * Extend space for inline data to allow
+                        * optional alignment of data buffer
+                        * start address, it may improve PCIe
+                        * performance.
+                        */
+                       inlen_send = RTE_MIN(inlen_send + MLX5_WQE_SIZE,
+                                            MLX5_SEND_MAX_INLINE_LEN);
                }
+               txq_ctrl->txq.inlen_send = inlen_send;
+               txq_ctrl->txq.inlen_mode = inlen_mode;
+               txq_ctrl->txq.inlen_empw = 0;
+               inlen_send = 0;
+               inlen_empw = 0;
+       }
+       if (inlen_send && inlen_empw && priv->txqs_n >= txqs_inline) {
                /*
-                * Check if the inline size is too large in a way which
-                * can make the WQE DS to overflow.
-                * Considering in calculation:
-                *      WQE CTRL (1 DS)
-                *      WQE ETH  (1 DS)
-                *      Inline part (N DS)
+                * The data sent with MLX5_OPCODE_ENHANCED_MPSW
+                * may be inlined in Data Segment, align the
+                * length accordingly to fit entire WQEBBs.
                 */
-               ds_cnt = 2 + (txq_ctrl->txq.max_inline / MLX5_WQE_DWORD_SIZE);
-               if (ds_cnt > MLX5_DSEG_MAX) {
-                       unsigned int max_inline = (MLX5_DSEG_MAX - 2) *
-                                                 MLX5_WQE_DWORD_SIZE;
-
-                       max_inline = max_inline - (max_inline %
-                                                  RTE_CACHE_LINE_SIZE);
-                       DRV_LOG(WARNING,
-                               "port %u txq inline is too large (%d) setting"
-                               " it to the maximum possible: %d\n",
-                               PORT_ID(priv), txq_inline, max_inline);
-                       txq_ctrl->txq.max_inline = max_inline /
-                                                  RTE_CACHE_LINE_SIZE;
+               temp = (inlen_empw + MLX5_WQE_SIZE - 1) / MLX5_WQE_SIZE;
+               temp = temp * MLX5_WQE_SIZE +
+                      MLX5_DSEG_MIN_INLINE_SIZE - MLX5_WQE_DSEG_SIZE;
+               temp = RTE_MIN(temp, MLX5_WQE_SIZE_MAX +
+                                    MLX5_DSEG_MIN_INLINE_SIZE -
+                                    MLX5_WQE_CSEG_SIZE -
+                                    MLX5_WQE_ESEG_SIZE -
+                                    MLX5_WQE_DSEG_SIZE);
+               temp = RTE_MIN(temp, MLX5_EMPW_MAX_INLINE_LEN);
+               if (temp != inlen_empw) {
+                       DRV_LOG(INFO,
+                               "port %u enhanced empw inline setting"
+                               " aligned from %u to %u",
+                               PORT_ID(priv), inlen_empw, temp);
+                       inlen_empw = temp;
                }
+               assert(inlen_empw >= MLX5_ESEG_MIN_INLINE_SIZE);
+               assert(inlen_empw <= MLX5_WQE_SIZE_MAX +
+                                    MLX5_DSEG_MIN_INLINE_SIZE -
+                                    MLX5_WQE_CSEG_SIZE -
+                                    MLX5_WQE_ESEG_SIZE -
+                                    MLX5_WQE_DSEG_SIZE);
+               txq_ctrl->txq.inlen_empw = inlen_empw;
        }
+       txq_ctrl->max_inline_data = RTE_MAX(inlen_send, inlen_empw);
        if (tso) {
-               txq_ctrl->max_tso_header = max_tso_inline * RTE_CACHE_LINE_SIZE;
-               txq_ctrl->txq.max_inline = RTE_MAX(txq_ctrl->txq.max_inline,
-                                                  max_tso_inline);
+               txq_ctrl->max_tso_header = MLX5_MAX_TSO_HEADER;
+               txq_ctrl->max_inline_data = RTE_MAX(txq_ctrl->max_inline_data,
+                                                   MLX5_MAX_TSO_HEADER);
                txq_ctrl->txq.tso_en = 1;
        }
-       txq_ctrl->txq.tunnel_en = config->tunnel_en;
+       txq_ctrl->txq.tunnel_en = config->tunnel_en | config->swp;
        txq_ctrl->txq.swp_en = ((DEV_TX_OFFLOAD_IP_TNL_TSO |
                                 DEV_TX_OFFLOAD_UDP_TNL_TSO |
                                 DEV_TX_OFFLOAD_OUTER_IPV4_CKSUM) &
@@ -744,7 +891,7 @@ struct mlx5_txq_ctrl *
 mlx5_txq_new(struct rte_eth_dev *dev, uint16_t idx, uint16_t desc,
             unsigned int socket, const struct rte_eth_txconf *conf)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        struct mlx5_txq_ctrl *tmpl;
 
        tmpl = rte_calloc_socket("TXQ", 1,
@@ -761,25 +908,29 @@ mlx5_txq_new(struct rte_eth_dev *dev, uint16_t idx, uint16_t desc,
                goto error;
        }
        /* Save pointer of global generation number to check memory event. */
-       tmpl->txq.mr_ctrl.dev_gen_ptr = &priv->mr.dev_gen;
+       tmpl->txq.mr_ctrl.dev_gen_ptr = &priv->sh->mr.dev_gen;
        assert(desc > MLX5_TX_COMP_THRESH);
        tmpl->txq.offloads = conf->offloads |
                             dev->data->dev_conf.txmode.offloads;
        tmpl->priv = priv;
        tmpl->socket = socket;
        tmpl->txq.elts_n = log2above(desc);
-       tmpl->idx = idx;
+       tmpl->txq.elts_s = desc;
+       tmpl->txq.elts_m = desc - 1;
+       tmpl->txq.port_id = dev->data->port_id;
+       tmpl->txq.idx = idx;
        txq_set_params(tmpl);
-       DRV_LOG(DEBUG, "port %u priv->device_attr.max_qp_wr is %d",
-               dev->data->port_id, priv->device_attr.orig_attr.max_qp_wr);
-       DRV_LOG(DEBUG, "port %u priv->device_attr.max_sge is %d",
-               dev->data->port_id, priv->device_attr.orig_attr.max_sge);
-       tmpl->txq.elts =
-               (struct rte_mbuf *(*)[1 << tmpl->txq.elts_n])(tmpl + 1);
-       tmpl->txq.stats.idx = idx;
+       if (txq_calc_wqebb_cnt(tmpl) >
+           priv->sh->device_attr.orig_attr.max_qp_wr) {
+               DRV_LOG(ERR,
+                       "port %u Tx WQEBB count (%d) exceeds the limit (%d),"
+                       " try smaller queue size",
+                       dev->data->port_id, txq_calc_wqebb_cnt(tmpl),
+                       priv->sh->device_attr.orig_attr.max_qp_wr);
+               rte_errno = ENOMEM;
+               goto error;
+       }
        rte_atomic32_inc(&tmpl->refcnt);
-       DRV_LOG(DEBUG, "port %u Tx queue %u: refcnt %d", dev->data->port_id,
-               idx, rte_atomic32_read(&tmpl->refcnt));
        LIST_INSERT_HEAD(&priv->txqsctrl, tmpl, next);
        return tmpl;
 error:
@@ -801,7 +952,7 @@ error:
 struct mlx5_txq_ctrl *
 mlx5_txq_get(struct rte_eth_dev *dev, uint16_t idx)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        struct mlx5_txq_ctrl *ctrl = NULL;
 
        if ((*priv->txqs)[idx]) {
@@ -809,9 +960,6 @@ mlx5_txq_get(struct rte_eth_dev *dev, uint16_t idx)
                                    txq);
                mlx5_txq_ibv_get(dev, idx);
                rte_atomic32_inc(&ctrl->refcnt);
-               DRV_LOG(DEBUG, "port %u Tx queue %u refcnt %d",
-                       dev->data->port_id,
-                       ctrl->idx, rte_atomic32_read(&ctrl->refcnt));
        }
        return ctrl;
 }
@@ -830,20 +978,14 @@ mlx5_txq_get(struct rte_eth_dev *dev, uint16_t idx)
 int
 mlx5_txq_release(struct rte_eth_dev *dev, uint16_t idx)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        struct mlx5_txq_ctrl *txq;
-       size_t page_size = sysconf(_SC_PAGESIZE);
 
        if (!(*priv->txqs)[idx])
                return 0;
        txq = container_of((*priv->txqs)[idx], struct mlx5_txq_ctrl, txq);
-       DRV_LOG(DEBUG, "port %u Tx queue %u: refcnt %d", dev->data->port_id,
-               txq->idx, rte_atomic32_read(&txq->refcnt));
        if (txq->ibv && !mlx5_txq_ibv_release(txq->ibv))
                txq->ibv = NULL;
-       if (priv->uar_base)
-               munmap((void *)RTE_ALIGN_FLOOR((uintptr_t)txq->txq.bf_reg,
-                      page_size), page_size);
        if (rte_atomic32_dec_and_test(&txq->refcnt)) {
                txq_free_elts(txq);
                mlx5_mr_btree_free(&txq->txq.mr_ctrl.cache_bh);
@@ -869,7 +1011,7 @@ mlx5_txq_release(struct rte_eth_dev *dev, uint16_t idx)
 int
 mlx5_txq_releasable(struct rte_eth_dev *dev, uint16_t idx)
 {
-       struct priv *priv = dev->data->dev_private;
+       struct mlx5_priv *priv = dev->data->dev_private;
        struct mlx5_txq_ctrl *txq;
 
        if (!(*priv->txqs)[idx])
@@ -890,13 +1032,13 @@ mlx5_txq_releasable(struct rte_eth_dev *dev, uint16_t idx)
 int
 mlx5_txq_verify(struct rte_eth_dev *dev)
 {
-       struct priv *priv = dev->data->dev_private;
-       struct mlx5_txq_ctrl *txq;
+       struct mlx5_priv *priv = dev->data->dev_private;
+       struct mlx5_txq_ctrl *txq_ctrl;
        int ret = 0;
 
-       LIST_FOREACH(txq, &priv->txqsctrl, next) {
+       LIST_FOREACH(txq_ctrl, &priv->txqsctrl, next) {
                DRV_LOG(DEBUG, "port %u Tx queue %u still referenced",
-                       dev->data->port_id, txq->idx);
+                       dev->data->port_id, txq_ctrl->txq.idx);
                ++ret;
        }
        return ret;