Blame SOURCES/0006-net-virtio-implement-Rx-path-for-packed-queues.patch

b91920
From a1168f29a051eba2344407d72267b5d5f648d80c Mon Sep 17 00:00:00 2001
b91920
From: Jens Freimann <jfreimann@redhat.com>
b91920
Date: Mon, 17 Dec 2018 22:31:35 +0100
b91920
Subject: [PATCH 06/18] net/virtio: implement Rx path for packed queues
b91920
b91920
[ upstream commit a76290c8f1cf9c4774c23592921302a04a90bded ]
b91920
b91920
Implement the receive part.
b91920
b91920
Signed-off-by: Jens Freimann <jfreimann@redhat.com>
b91920
Signed-off-by: Tiwei Bie <tiwei.bie@intel.com>
b91920
Reviewed-by: Maxime Coquelin <maxime.coquelin@redhat.com>
b91920
(cherry picked from commit a76290c8f1cf9c4774c23592921302a04a90bded)
b91920
Signed-off-by: Jens Freimann <jfreimann@redhat.com>
b91920
---
b91920
 drivers/net/virtio/virtio_ethdev.c |  56 +++--
b91920
 drivers/net/virtio/virtio_ethdev.h |   5 +
b91920
 drivers/net/virtio/virtio_rxtx.c   | 375 ++++++++++++++++++++++++++++-
b91920
 drivers/net/virtio/virtqueue.c     |  43 +++-
b91920
 4 files changed, 457 insertions(+), 22 deletions(-)
b91920
b91920
diff --git a/drivers/net/virtio/virtio_ethdev.c b/drivers/net/virtio/virtio_ethdev.c
b91920
index 6023d6f2c..4ef1da393 100644
b91920
--- a/drivers/net/virtio/virtio_ethdev.c
b91920
+++ b/drivers/net/virtio/virtio_ethdev.c
b91920
@@ -1363,24 +1363,40 @@ set_rxtx_funcs(struct rte_eth_dev *eth_dev)
b91920
 		}
b91920
 	}
b91920
 
b91920
-	if (hw->use_simple_rx) {
b91920
-		PMD_INIT_LOG(INFO, "virtio: using simple Rx path on port %u",
b91920
-			eth_dev->data->port_id);
b91920
-		eth_dev->rx_pkt_burst = virtio_recv_pkts_vec;
b91920
-	} else if (hw->use_inorder_rx) {
b91920
-		PMD_INIT_LOG(INFO,
b91920
-			"virtio: using inorder mergeable buffer Rx path on port %u",
b91920
-			eth_dev->data->port_id);
b91920
-		eth_dev->rx_pkt_burst = &virtio_recv_mergeable_pkts_inorder;
b91920
-	} else if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
b91920
-		PMD_INIT_LOG(INFO,
b91920
-			"virtio: using mergeable buffer Rx path on port %u",
b91920
-			eth_dev->data->port_id);
b91920
-		eth_dev->rx_pkt_burst = &virtio_recv_mergeable_pkts;
b91920
+	if (vtpci_packed_queue(hw)) {
b91920
+		if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
b91920
+			PMD_INIT_LOG(INFO,
b91920
+				"virtio: using packed ring mergeable buffer Rx path on port %u",
b91920
+				eth_dev->data->port_id);
b91920
+			eth_dev->rx_pkt_burst =
b91920
+				&virtio_recv_mergeable_pkts_packed;
b91920
+		} else {
b91920
+			PMD_INIT_LOG(INFO,
b91920
+				"virtio: using packed ring standard Rx path on port %u",
b91920
+				eth_dev->data->port_id);
b91920
+			eth_dev->rx_pkt_burst = &virtio_recv_pkts_packed;
b91920
+		}
b91920
 	} else {
b91920
-		PMD_INIT_LOG(INFO, "virtio: using standard Rx path on port %u",
b91920
-			eth_dev->data->port_id);
b91920
-		eth_dev->rx_pkt_burst = &virtio_recv_pkts;
b91920
+		if (hw->use_simple_rx) {
b91920
+			PMD_INIT_LOG(INFO, "virtio: using simple Rx path on port %u",
b91920
+				eth_dev->data->port_id);
b91920
+			eth_dev->rx_pkt_burst = virtio_recv_pkts_vec;
b91920
+		} else if (hw->use_inorder_rx) {
b91920
+			PMD_INIT_LOG(INFO,
b91920
+				"virtio: using inorder mergeable buffer Rx path on port %u",
b91920
+				eth_dev->data->port_id);
b91920
+			eth_dev->rx_pkt_burst =
b91920
+				&virtio_recv_mergeable_pkts_inorder;
b91920
+		} else if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
b91920
+			PMD_INIT_LOG(INFO,
b91920
+				"virtio: using mergeable buffer Rx path on port %u",
b91920
+				eth_dev->data->port_id);
b91920
+			eth_dev->rx_pkt_burst = &virtio_recv_mergeable_pkts;
b91920
+		} else {
b91920
+			PMD_INIT_LOG(INFO, "virtio: using standard Rx path on port %u",
b91920
+				eth_dev->data->port_id);
b91920
+			eth_dev->rx_pkt_burst = &virtio_recv_pkts;
b91920
+		}
b91920
 	}
b91920
 
b91920
 }
b91920
@@ -1944,6 +1960,12 @@ virtio_dev_configure(struct rte_eth_dev *dev)
b91920
 		}
b91920
 	}
b91920
 
b91920
+	if (vtpci_packed_queue(hw)) {
b91920
+		hw->use_simple_rx = 0;
b91920
+		hw->use_inorder_rx = 0;
b91920
+		hw->use_inorder_tx = 0;
b91920
+	}
b91920
+
b91920
 #if defined RTE_ARCH_ARM64 || defined RTE_ARCH_ARM
b91920
 	if (!rte_cpu_get_flag_enabled(RTE_CPUFLAG_NEON)) {
b91920
 		hw->use_simple_rx = 0;
b91920
diff --git a/drivers/net/virtio/virtio_ethdev.h b/drivers/net/virtio/virtio_ethdev.h
b91920
index 05d355180..88b8c42a3 100644
b91920
--- a/drivers/net/virtio/virtio_ethdev.h
b91920
+++ b/drivers/net/virtio/virtio_ethdev.h
b91920
@@ -73,10 +73,15 @@ int virtio_dev_tx_queue_setup_finish(struct rte_eth_dev *dev,
b91920
 
b91920
 uint16_t virtio_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
b91920
 		uint16_t nb_pkts);
b91920
+uint16_t virtio_recv_pkts_packed(void *rx_queue, struct rte_mbuf **rx_pkts,
b91920
+		uint16_t nb_pkts);
b91920
 
b91920
 uint16_t virtio_recv_mergeable_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
b91920
 		uint16_t nb_pkts);
b91920
 
b91920
+uint16_t virtio_recv_mergeable_pkts_packed(void *rx_queue,
b91920
+		struct rte_mbuf **rx_pkts, uint16_t nb_pkts);
b91920
+
b91920
 uint16_t virtio_recv_mergeable_pkts_inorder(void *rx_queue,
b91920
 		struct rte_mbuf **rx_pkts, uint16_t nb_pkts);
b91920
 
b91920
diff --git a/drivers/net/virtio/virtio_rxtx.c b/drivers/net/virtio/virtio_rxtx.c
b91920
index ab74917a8..0bcf3b08a 100644
b91920
--- a/drivers/net/virtio/virtio_rxtx.c
b91920
+++ b/drivers/net/virtio/virtio_rxtx.c
b91920
@@ -31,6 +31,7 @@
b91920
 #include "virtqueue.h"
b91920
 #include "virtio_rxtx.h"
b91920
 #include "virtio_rxtx_simple.h"
b91920
+#include "virtio_ring.h"
b91920
 
b91920
 #ifdef RTE_LIBRTE_VIRTIO_DEBUG_DUMP
b91920
 #define VIRTIO_DUMP_PACKET(m, len) rte_pktmbuf_dump(stdout, m, len)
b91920
@@ -105,6 +106,47 @@ vq_ring_free_id_packed(struct virtqueue *vq, uint16_t id)
b91920
 	dxp->next = VQ_RING_DESC_CHAIN_END;
b91920
 }
b91920
 
b91920
+static uint16_t
b91920
+virtqueue_dequeue_burst_rx_packed(struct virtqueue *vq,
b91920
+				  struct rte_mbuf **rx_pkts,
b91920
+				  uint32_t *len,
b91920
+				  uint16_t num)
b91920
+{
b91920
+	struct rte_mbuf *cookie;
b91920
+	uint16_t used_idx;
b91920
+	uint16_t id;
b91920
+	struct vring_packed_desc *desc;
b91920
+	uint16_t i;
b91920
+
b91920
+	desc = vq->ring_packed.desc_packed;
b91920
+
b91920
+	for (i = 0; i < num; i++) {
b91920
+		used_idx = vq->vq_used_cons_idx;
b91920
+		if (!desc_is_used(&desc[used_idx], vq))
b91920
+			return i;
b91920
+		len[i] = desc[used_idx].len;
b91920
+		id = desc[used_idx].id;
b91920
+		cookie = (struct rte_mbuf *)vq->vq_descx[id].cookie;
b91920
+		if (unlikely(cookie == NULL)) {
b91920
+			PMD_DRV_LOG(ERR, "vring descriptor with no mbuf cookie at %u",
b91920
+				vq->vq_used_cons_idx);
b91920
+			break;
b91920
+		}
b91920
+		rte_prefetch0(cookie);
b91920
+		rte_packet_prefetch(rte_pktmbuf_mtod(cookie, void *));
b91920
+		rx_pkts[i] = cookie;
b91920
+
b91920
+		vq->vq_free_cnt++;
b91920
+		vq->vq_used_cons_idx++;
b91920
+		if (vq->vq_used_cons_idx >= vq->vq_nentries) {
b91920
+			vq->vq_used_cons_idx -= vq->vq_nentries;
b91920
+			vq->used_wrap_counter ^= 1;
b91920
+		}
b91920
+	}
b91920
+
b91920
+	return i;
b91920
+}
b91920
+
b91920
 static uint16_t
b91920
 virtqueue_dequeue_burst_rx(struct virtqueue *vq, struct rte_mbuf **rx_pkts,
b91920
 			   uint32_t *len, uint16_t num)
b91920
@@ -350,6 +392,51 @@ virtqueue_enqueue_recv_refill(struct virtqueue *vq, struct rte_mbuf *cookie)
b91920
 	return 0;
b91920
 }
b91920
 
b91920
+static inline int
b91920
+virtqueue_enqueue_recv_refill_packed(struct virtqueue *vq,
b91920
+				     struct rte_mbuf **cookie, uint16_t num)
b91920
+{
b91920
+	struct vring_packed_desc *start_dp = vq->ring_packed.desc_packed;
b91920
+	uint16_t flags = VRING_DESC_F_WRITE | vq->avail_used_flags;
b91920
+	struct virtio_hw *hw = vq->hw;
b91920
+	struct vq_desc_extra *dxp;
b91920
+	uint16_t idx;
b91920
+	int i;
b91920
+
b91920
+	if (unlikely(vq->vq_free_cnt == 0))
b91920
+		return -ENOSPC;
b91920
+	if (unlikely(vq->vq_free_cnt < num))
b91920
+		return -EMSGSIZE;
b91920
+
b91920
+	for (i = 0; i < num; i++) {
b91920
+		idx = vq->vq_avail_idx;
b91920
+		dxp = &vq->vq_descx[idx];
b91920
+		dxp->cookie = (void *)cookie[i];
b91920
+		dxp->ndescs = 1;
b91920
+
b91920
+		start_dp[idx].addr = VIRTIO_MBUF_ADDR(cookie[i], vq) +
b91920
+				RTE_PKTMBUF_HEADROOM - hw->vtnet_hdr_size;
b91920
+		start_dp[idx].len = cookie[i]->buf_len - RTE_PKTMBUF_HEADROOM
b91920
+					+ hw->vtnet_hdr_size;
b91920
+
b91920
+		vq->vq_desc_head_idx = dxp->next;
b91920
+		if (vq->vq_desc_head_idx == VQ_RING_DESC_CHAIN_END)
b91920
+			vq->vq_desc_tail_idx = vq->vq_desc_head_idx;
b91920
+		rte_smp_wmb();
b91920
+		start_dp[idx].flags = flags;
b91920
+		if (++vq->vq_avail_idx >= vq->vq_nentries) {
b91920
+			vq->vq_avail_idx -= vq->vq_nentries;
b91920
+			vq->avail_wrap_counter ^= 1;
b91920
+			vq->avail_used_flags =
b91920
+				VRING_DESC_F_AVAIL(vq->avail_wrap_counter) |
b91920
+				VRING_DESC_F_USED(!vq->avail_wrap_counter);
b91920
+			flags = VRING_DESC_F_WRITE | vq->avail_used_flags;
b91920
+		}
b91920
+	}
b91920
+	vq->vq_free_cnt = (uint16_t)(vq->vq_free_cnt - num);
b91920
+	return 0;
b91920
+}
b91920
+
b91920
 /* When doing TSO, the IP length is not included in the pseudo header
b91920
  * checksum of the packet given to the PMD, but for virtio it is
b91920
  * expected.
b91920
@@ -801,7 +888,11 @@ virtio_dev_rx_queue_setup_finish(struct rte_eth_dev *dev, uint16_t queue_idx)
b91920
 				break;
b91920
 
b91920
 			/* Enqueue allocated buffers */
b91920
-			error = virtqueue_enqueue_recv_refill(vq, m);
b91920
+			if (vtpci_packed_queue(vq->hw))
b91920
+				error = virtqueue_enqueue_recv_refill_packed(vq,
b91920
+						&m, 1);
b91920
+			else
b91920
+				error = virtqueue_enqueue_recv_refill(vq, m);
b91920
 			if (error) {
b91920
 				rte_pktmbuf_free(m);
b91920
 				break;
b91920
@@ -809,7 +900,8 @@ virtio_dev_rx_queue_setup_finish(struct rte_eth_dev *dev, uint16_t queue_idx)
b91920
 			nbufs++;
b91920
 		}
b91920
 
b91920
-		vq_update_avail_idx(vq);
b91920
+		if (!vtpci_packed_queue(vq->hw))
b91920
+			vq_update_avail_idx(vq);
b91920
 	}
b91920
 
b91920
 	PMD_INIT_LOG(DEBUG, "Allocated %d bufs", nbufs);
b91920
@@ -896,7 +988,10 @@ virtio_discard_rxbuf(struct virtqueue *vq, struct rte_mbuf *m)
b91920
 	 * Requeue the discarded mbuf. This should always be
b91920
 	 * successful since it was just dequeued.
b91920
 	 */
b91920
-	error = virtqueue_enqueue_recv_refill(vq, m);
b91920
+	if (vtpci_packed_queue(vq->hw))
b91920
+		error = virtqueue_enqueue_recv_refill_packed(vq, &m, 1);
b91920
+	else
b91920
+		error = virtqueue_enqueue_recv_refill(vq, m);
b91920
 
b91920
 	if (unlikely(error)) {
b91920
 		RTE_LOG(ERR, PMD, "cannot requeue discarded mbuf");
b91920
@@ -1135,6 +1230,104 @@ virtio_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts, uint16_t nb_pkts)
b91920
 	return nb_rx;
b91920
 }
b91920
 
b91920
+uint16_t
b91920
+virtio_recv_pkts_packed(void *rx_queue, struct rte_mbuf **rx_pkts,
b91920
+			uint16_t nb_pkts)
b91920
+{
b91920
+	struct virtnet_rx *rxvq = rx_queue;
b91920
+	struct virtqueue *vq = rxvq->vq;
b91920
+	struct virtio_hw *hw = vq->hw;
b91920
+	struct rte_mbuf *rxm, *new_mbuf;
b91920
+	uint16_t num, nb_rx;
b91920
+	uint32_t len[VIRTIO_MBUF_BURST_SZ];
b91920
+	struct rte_mbuf *rcv_pkts[VIRTIO_MBUF_BURST_SZ];
b91920
+	int error;
b91920
+	uint32_t i, nb_enqueued;
b91920
+	uint32_t hdr_size;
b91920
+	struct virtio_net_hdr *hdr;
b91920
+
b91920
+	nb_rx = 0;
b91920
+	if (unlikely(hw->started == 0))
b91920
+		return nb_rx;
b91920
+
b91920
+	num = RTE_MIN(VIRTIO_MBUF_BURST_SZ, nb_pkts);
b91920
+	if (likely(num > DESC_PER_CACHELINE))
b91920
+		num = num - ((vq->vq_used_cons_idx + num) % DESC_PER_CACHELINE);
b91920
+
b91920
+	num = virtqueue_dequeue_burst_rx_packed(vq, rcv_pkts, len, num);
b91920
+	PMD_RX_LOG(DEBUG, "dequeue:%d", num);
b91920
+
b91920
+	nb_enqueued = 0;
b91920
+	hdr_size = hw->vtnet_hdr_size;
b91920
+
b91920
+	for (i = 0; i < num; i++) {
b91920
+		rxm = rcv_pkts[i];
b91920
+
b91920
+		PMD_RX_LOG(DEBUG, "packet len:%d", len[i]);
b91920
+
b91920
+		if (unlikely(len[i] < hdr_size + ETHER_HDR_LEN)) {
b91920
+			PMD_RX_LOG(ERR, "Packet drop");
b91920
+			nb_enqueued++;
b91920
+			virtio_discard_rxbuf(vq, rxm);
b91920
+			rxvq->stats.errors++;
b91920
+			continue;
b91920
+		}
b91920
+
b91920
+		rxm->port = rxvq->port_id;
b91920
+		rxm->data_off = RTE_PKTMBUF_HEADROOM;
b91920
+		rxm->ol_flags = 0;
b91920
+		rxm->vlan_tci = 0;
b91920
+
b91920
+		rxm->pkt_len = (uint32_t)(len[i] - hdr_size);
b91920
+		rxm->data_len = (uint16_t)(len[i] - hdr_size);
b91920
+
b91920
+		hdr = (struct virtio_net_hdr *)((char *)rxm->buf_addr +
b91920
+			RTE_PKTMBUF_HEADROOM - hdr_size);
b91920
+
b91920
+		if (hw->vlan_strip)
b91920
+			rte_vlan_strip(rxm);
b91920
+
b91920
+		if (hw->has_rx_offload && virtio_rx_offload(rxm, hdr) < 0) {
b91920
+			virtio_discard_rxbuf(vq, rxm);
b91920
+			rxvq->stats.errors++;
b91920
+			continue;
b91920
+		}
b91920
+
b91920
+		virtio_rx_stats_updated(rxvq, rxm);
b91920
+
b91920
+		rx_pkts[nb_rx++] = rxm;
b91920
+	}
b91920
+
b91920
+	rxvq->stats.packets += nb_rx;
b91920
+
b91920
+	/* Allocate new mbuf for the used descriptor */
b91920
+	while (likely(!virtqueue_full(vq))) {
b91920
+		new_mbuf = rte_mbuf_raw_alloc(rxvq->mpool);
b91920
+		if (unlikely(new_mbuf == NULL)) {
b91920
+			struct rte_eth_dev *dev =
b91920
+				&rte_eth_devices[rxvq->port_id];
b91920
+			dev->data->rx_mbuf_alloc_failed++;
b91920
+			break;
b91920
+		}
b91920
+		error = virtqueue_enqueue_recv_refill_packed(vq, &new_mbuf, 1);
b91920
+		if (unlikely(error)) {
b91920
+			rte_pktmbuf_free(new_mbuf);
b91920
+			break;
b91920
+		}
b91920
+		nb_enqueued++;
b91920
+	}
b91920
+
b91920
+	if (likely(nb_enqueued)) {
b91920
+		if (unlikely(virtqueue_kick_prepare_packed(vq))) {
b91920
+			virtqueue_notify(vq);
b91920
+			PMD_RX_LOG(DEBUG, "Notified");
b91920
+		}
b91920
+	}
b91920
+
b91920
+	return nb_rx;
b91920
+}
b91920
+
b91920
+
b91920
 uint16_t
b91920
 virtio_recv_mergeable_pkts_inorder(void *rx_queue,
b91920
 			struct rte_mbuf **rx_pkts,
b91920
@@ -1493,6 +1686,182 @@ virtio_recv_mergeable_pkts(void *rx_queue,
b91920
 	return nb_rx;
b91920
 }
b91920
 
b91920
+uint16_t
b91920
+virtio_recv_mergeable_pkts_packed(void *rx_queue,
b91920
+			struct rte_mbuf **rx_pkts,
b91920
+			uint16_t nb_pkts)
b91920
+{
b91920
+	struct virtnet_rx *rxvq = rx_queue;
b91920
+	struct virtqueue *vq = rxvq->vq;
b91920
+	struct virtio_hw *hw = vq->hw;
b91920
+	struct rte_mbuf *rxm;
b91920
+	struct rte_mbuf *prev = NULL;
b91920
+	uint16_t num, nb_rx = 0;
b91920
+	uint32_t len[VIRTIO_MBUF_BURST_SZ];
b91920
+	struct rte_mbuf *rcv_pkts[VIRTIO_MBUF_BURST_SZ];
b91920
+	uint32_t nb_enqueued = 0;
b91920
+	uint32_t seg_num = 0;
b91920
+	uint32_t seg_res = 0;
b91920
+	uint32_t hdr_size = hw->vtnet_hdr_size;
b91920
+	int32_t i;
b91920
+	int error;
b91920
+
b91920
+	if (unlikely(hw->started == 0))
b91920
+		return nb_rx;
b91920
+
b91920
+
b91920
+	num = nb_pkts;
b91920
+	if (unlikely(num > VIRTIO_MBUF_BURST_SZ))
b91920
+		num = VIRTIO_MBUF_BURST_SZ;
b91920
+	if (likely(num > DESC_PER_CACHELINE))
b91920
+		num = num - ((vq->vq_used_cons_idx + num) % DESC_PER_CACHELINE);
b91920
+
b91920
+	num = virtqueue_dequeue_burst_rx_packed(vq, rcv_pkts, len, num);
b91920
+
b91920
+	for (i = 0; i < num; i++) {
b91920
+		struct virtio_net_hdr_mrg_rxbuf *header;
b91920
+
b91920
+		PMD_RX_LOG(DEBUG, "dequeue:%d", num);
b91920
+		PMD_RX_LOG(DEBUG, "packet len:%d", len[i]);
b91920
+
b91920
+		rxm = rcv_pkts[i];
b91920
+
b91920
+		if (unlikely(len[i] < hdr_size + ETHER_HDR_LEN)) {
b91920
+			PMD_RX_LOG(ERR, "Packet drop");
b91920
+			nb_enqueued++;
b91920
+			virtio_discard_rxbuf(vq, rxm);
b91920
+			rxvq->stats.errors++;
b91920
+			continue;
b91920
+		}
b91920
+
b91920
+		header = (struct virtio_net_hdr_mrg_rxbuf *)((char *)
b91920
+			  rxm->buf_addr + RTE_PKTMBUF_HEADROOM - hdr_size);
b91920
+		seg_num = header->num_buffers;
b91920
+
b91920
+		if (seg_num == 0)
b91920
+			seg_num = 1;
b91920
+
b91920
+		rxm->data_off = RTE_PKTMBUF_HEADROOM;
b91920
+		rxm->nb_segs = seg_num;
b91920
+		rxm->ol_flags = 0;
b91920
+		rxm->vlan_tci = 0;
b91920
+		rxm->pkt_len = (uint32_t)(len[i] - hdr_size);
b91920
+		rxm->data_len = (uint16_t)(len[i] - hdr_size);
b91920
+
b91920
+		rxm->port = rxvq->port_id;
b91920
+		rx_pkts[nb_rx] = rxm;
b91920
+		prev = rxm;
b91920
+
b91920
+		if (hw->has_rx_offload &&
b91920
+				virtio_rx_offload(rxm, &header->hdr) < 0) {
b91920
+			virtio_discard_rxbuf(vq, rxm);
b91920
+			rxvq->stats.errors++;
b91920
+			continue;
b91920
+		}
b91920
+
b91920
+		if (hw->vlan_strip)
b91920
+			rte_vlan_strip(rx_pkts[nb_rx]);
b91920
+
b91920
+		seg_res = seg_num - 1;
b91920
+
b91920
+		/* Merge remaining segments */
b91920
+		while (seg_res != 0 && i < (num - 1)) {
b91920
+			i++;
b91920
+
b91920
+			rxm = rcv_pkts[i];
b91920
+			rxm->data_off = RTE_PKTMBUF_HEADROOM - hdr_size;
b91920
+			rxm->pkt_len = (uint32_t)(len[i]);
b91920
+			rxm->data_len = (uint16_t)(len[i]);
b91920
+
b91920
+			rx_pkts[nb_rx]->pkt_len += (uint32_t)(len[i]);
b91920
+			rx_pkts[nb_rx]->data_len += (uint16_t)(len[i]);
b91920
+
b91920
+			if (prev)
b91920
+				prev->next = rxm;
b91920
+
b91920
+			prev = rxm;
b91920
+			seg_res -= 1;
b91920
+		}
b91920
+
b91920
+		if (!seg_res) {
b91920
+			virtio_rx_stats_updated(rxvq, rx_pkts[nb_rx]);
b91920
+			nb_rx++;
b91920
+		}
b91920
+	}
b91920
+
b91920
+	/* Last packet still need merge segments */
b91920
+	while (seg_res != 0) {
b91920
+		uint16_t rcv_cnt = RTE_MIN((uint16_t)seg_res,
b91920
+					VIRTIO_MBUF_BURST_SZ);
b91920
+		if (likely(vq->vq_free_cnt >= rcv_cnt)) {
b91920
+			num = virtqueue_dequeue_burst_rx_packed(vq, rcv_pkts,
b91920
+					len, rcv_cnt);
b91920
+			uint16_t extra_idx = 0;
b91920
+
b91920
+			rcv_cnt = num;
b91920
+
b91920
+			while (extra_idx < rcv_cnt) {
b91920
+				rxm = rcv_pkts[extra_idx];
b91920
+
b91920
+				rxm->data_off =
b91920
+					RTE_PKTMBUF_HEADROOM - hdr_size;
b91920
+				rxm->pkt_len = (uint32_t)(len[extra_idx]);
b91920
+				rxm->data_len = (uint16_t)(len[extra_idx]);
b91920
+
b91920
+				prev->next = rxm;
b91920
+				prev = rxm;
b91920
+				rx_pkts[nb_rx]->pkt_len += len[extra_idx];
b91920
+				rx_pkts[nb_rx]->data_len += len[extra_idx];
b91920
+				extra_idx += 1;
b91920
+			}
b91920
+			seg_res -= rcv_cnt;
b91920
+			if (!seg_res) {
b91920
+				virtio_rx_stats_updated(rxvq, rx_pkts[nb_rx]);
b91920
+				nb_rx++;
b91920
+			}
b91920
+		} else {
b91920
+			PMD_RX_LOG(ERR,
b91920
+					"No enough segments for packet.");
b91920
+			if (prev)
b91920
+				virtio_discard_rxbuf(vq, prev);
b91920
+			rxvq->stats.errors++;
b91920
+			break;
b91920
+		}
b91920
+	}
b91920
+
b91920
+	rxvq->stats.packets += nb_rx;
b91920
+
b91920
+	/* Allocate new mbuf for the used descriptor */
b91920
+	if (likely(!virtqueue_full(vq))) {
b91920
+		/* free_cnt may include mrg descs */
b91920
+		uint16_t free_cnt = vq->vq_free_cnt;
b91920
+		struct rte_mbuf *new_pkts[free_cnt];
b91920
+
b91920
+		if (!rte_pktmbuf_alloc_bulk(rxvq->mpool, new_pkts, free_cnt)) {
b91920
+			error = virtqueue_enqueue_recv_refill_packed(vq,
b91920
+					new_pkts, free_cnt);
b91920
+			if (unlikely(error)) {
b91920
+				for (i = 0; i < free_cnt; i++)
b91920
+					rte_pktmbuf_free(new_pkts[i]);
b91920
+			}
b91920
+			nb_enqueued += free_cnt;
b91920
+		} else {
b91920
+			struct rte_eth_dev *dev =
b91920
+				&rte_eth_devices[rxvq->port_id];
b91920
+			dev->data->rx_mbuf_alloc_failed += free_cnt;
b91920
+		}
b91920
+	}
b91920
+
b91920
+	if (likely(nb_enqueued)) {
b91920
+		if (unlikely(virtqueue_kick_prepare_packed(vq))) {
b91920
+			virtqueue_notify(vq);
b91920
+			PMD_RX_LOG(DEBUG, "Notified");
b91920
+		}
b91920
+	}
b91920
+
b91920
+	return nb_rx;
b91920
+}
b91920
+
b91920
 uint16_t
b91920
 virtio_xmit_pkts_packed(void *tx_queue, struct rte_mbuf **tx_pkts,
b91920
 			uint16_t nb_pkts)
b91920
diff --git a/drivers/net/virtio/virtqueue.c b/drivers/net/virtio/virtqueue.c
b91920
index 56a77cc71..5b03f7a27 100644
b91920
--- a/drivers/net/virtio/virtqueue.c
b91920
+++ b/drivers/net/virtio/virtqueue.c
b91920
@@ -54,9 +54,36 @@ virtqueue_detach_unused(struct virtqueue *vq)
b91920
 	return NULL;
b91920
 }
b91920
 
b91920
+/* Flush used descs */
b91920
+static void
b91920
+virtqueue_rxvq_flush_packed(struct virtqueue *vq)
b91920
+{
b91920
+	struct vq_desc_extra *dxp;
b91920
+	uint16_t i;
b91920
+
b91920
+	struct vring_packed_desc *descs = vq->ring_packed.desc_packed;
b91920
+	int cnt = 0;
b91920
+
b91920
+	i = vq->vq_used_cons_idx;
b91920
+	while (desc_is_used(&descs[i], vq) && cnt++ < vq->vq_nentries) {
b91920
+		dxp = &vq->vq_descx[descs[i].id];
b91920
+		if (dxp->cookie != NULL) {
b91920
+			rte_pktmbuf_free(dxp->cookie);
b91920
+			dxp->cookie = NULL;
b91920
+		}
b91920
+		vq->vq_free_cnt++;
b91920
+		vq->vq_used_cons_idx++;
b91920
+		if (vq->vq_used_cons_idx >= vq->vq_nentries) {
b91920
+			vq->vq_used_cons_idx -= vq->vq_nentries;
b91920
+			vq->used_wrap_counter ^= 1;
b91920
+		}
b91920
+		i = vq->vq_used_cons_idx;
b91920
+	}
b91920
+}
b91920
+
b91920
 /* Flush the elements in the used ring. */
b91920
-void
b91920
-virtqueue_rxvq_flush(struct virtqueue *vq)
b91920
+static void
b91920
+virtqueue_rxvq_flush_split(struct virtqueue *vq)
b91920
 {
b91920
 	struct virtnet_rx *rxq = &vq->rxq;
b91920
 	struct virtio_hw *hw = vq->hw;
b91920
@@ -102,3 +129,15 @@ virtqueue_rxvq_flush(struct virtqueue *vq)
b91920
 		}
b91920
 	}
b91920
 }
b91920
+
b91920
+/* Flush the elements in the used ring. */
b91920
+void
b91920
+virtqueue_rxvq_flush(struct virtqueue *vq)
b91920
+{
b91920
+	struct virtio_hw *hw = vq->hw;
b91920
+
b91920
+	if (vtpci_packed_queue(hw))
b91920
+		virtqueue_rxvq_flush_packed(vq);
b91920
+	else
b91920
+		virtqueue_rxvq_flush_split(vq);
b91920
+}
b91920
-- 
b91920
2.21.0
b91920