xref: /dpdk/drivers/net/virtio/virtio_ethdev.c (revision 25553d44)
15566a3e3SBruce Richardson /* SPDX-License-Identifier: BSD-3-Clause
25566a3e3SBruce Richardson  * Copyright(c) 2010-2016 Intel Corporation
36c3169a3SBruce Richardson  */
46c3169a3SBruce Richardson 
56c3169a3SBruce Richardson #include <stdint.h>
66c3169a3SBruce Richardson #include <string.h>
76c3169a3SBruce Richardson #include <stdio.h>
86c3169a3SBruce Richardson #include <errno.h>
96c3169a3SBruce Richardson #include <unistd.h>
106c3169a3SBruce Richardson 
11ffc905f3SFerruh Yigit #include <rte_ethdev_driver.h>
12fdf91e0fSJan Blunck #include <rte_ethdev_pci.h>
136c3169a3SBruce Richardson #include <rte_memcpy.h>
146c3169a3SBruce Richardson #include <rte_string_fns.h>
156c3169a3SBruce Richardson #include <rte_memzone.h>
166c3169a3SBruce Richardson #include <rte_malloc.h>
176c3169a3SBruce Richardson #include <rte_branch_prediction.h>
186c3169a3SBruce Richardson #include <rte_pci.h>
19c752998bSGaetan Rivet #include <rte_bus_pci.h>
206c3169a3SBruce Richardson #include <rte_ether.h>
217365504fSXiao Wang #include <rte_ip.h>
227365504fSXiao Wang #include <rte_arp.h>
236c3169a3SBruce Richardson #include <rte_common.h>
24abf4c84bSBernard Iremonger #include <rte_errno.h>
254819eae8SOlivier Matz #include <rte_cpuflags.h>
266c3169a3SBruce Richardson 
276c3169a3SBruce Richardson #include <rte_memory.h>
286c3169a3SBruce Richardson #include <rte_eal.h>
296c3169a3SBruce Richardson #include <rte_dev.h>
301978a9dcSXiao Wang #include <rte_cycles.h>
316c3169a3SBruce Richardson 
326c3169a3SBruce Richardson #include "virtio_ethdev.h"
336c3169a3SBruce Richardson #include "virtio_pci.h"
346c3169a3SBruce Richardson #include "virtio_logs.h"
356c3169a3SBruce Richardson #include "virtqueue.h"
36cab04612SHuawei Xie #include "virtio_rxtx.h"
376c3169a3SBruce Richardson 
38abf4c84bSBernard Iremonger static int eth_virtio_dev_uninit(struct rte_eth_dev *eth_dev);
396c3169a3SBruce Richardson static int  virtio_dev_configure(struct rte_eth_dev *dev);
406c3169a3SBruce Richardson static int  virtio_dev_start(struct rte_eth_dev *dev);
416c3169a3SBruce Richardson static void virtio_dev_stop(struct rte_eth_dev *dev);
426c3169a3SBruce Richardson static void virtio_dev_promiscuous_enable(struct rte_eth_dev *dev);
436c3169a3SBruce Richardson static void virtio_dev_promiscuous_disable(struct rte_eth_dev *dev);
446c3169a3SBruce Richardson static void virtio_dev_allmulticast_enable(struct rte_eth_dev *dev);
456c3169a3SBruce Richardson static void virtio_dev_allmulticast_disable(struct rte_eth_dev *dev);
466c3169a3SBruce Richardson static void virtio_dev_info_get(struct rte_eth_dev *dev,
476c3169a3SBruce Richardson 				struct rte_eth_dev_info *dev_info);
486c3169a3SBruce Richardson static int virtio_dev_link_update(struct rte_eth_dev *dev,
49dd2c630aSFerruh Yigit 	int wait_to_complete);
50289ba0c0SDavid Harton static int virtio_dev_vlan_offload_set(struct rte_eth_dev *dev, int mask);
516c3169a3SBruce Richardson 
526c3169a3SBruce Richardson static void virtio_set_hwaddr(struct virtio_hw *hw);
536c3169a3SBruce Richardson static void virtio_get_hwaddr(struct virtio_hw *hw);
546c3169a3SBruce Richardson 
55d5b0924bSMatan Azrad static int virtio_dev_stats_get(struct rte_eth_dev *dev,
5676d4c652SHarry van Haaren 				 struct rte_eth_stats *stats);
5776d4c652SHarry van Haaren static int virtio_dev_xstats_get(struct rte_eth_dev *dev,
58e2aae1c1SRemy Horton 				 struct rte_eth_xstat *xstats, unsigned n);
59baf91c39SRemy Horton static int virtio_dev_xstats_get_names(struct rte_eth_dev *dev,
60baf91c39SRemy Horton 				       struct rte_eth_xstat_name *xstats_names,
61baf91c39SRemy Horton 				       unsigned limit);
626c3169a3SBruce Richardson static void virtio_dev_stats_reset(struct rte_eth_dev *dev);
636c3169a3SBruce Richardson static void virtio_dev_free_mbufs(struct rte_eth_dev *dev);
646c3169a3SBruce Richardson static int virtio_vlan_filter_set(struct rte_eth_dev *dev,
656c3169a3SBruce Richardson 				uint16_t vlan_id, int on);
666d01e580SWei Dai static int virtio_mac_addr_add(struct rte_eth_dev *dev,
676c3169a3SBruce Richardson 				struct ether_addr *mac_addr,
68dd2c630aSFerruh Yigit 				uint32_t index, uint32_t vmdq);
696c3169a3SBruce Richardson static void virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index);
706c3169a3SBruce Richardson static void virtio_mac_addr_set(struct rte_eth_dev *dev,
716c3169a3SBruce Richardson 				struct ether_addr *mac_addr);
726c3169a3SBruce Richardson 
73fe19d49cSZhiyong Yang static int virtio_intr_enable(struct rte_eth_dev *dev);
74fe19d49cSZhiyong Yang static int virtio_intr_disable(struct rte_eth_dev *dev);
75fe19d49cSZhiyong Yang 
766c3169a3SBruce Richardson static int virtio_dev_queue_stats_mapping_set(
77dd2c630aSFerruh Yigit 	struct rte_eth_dev *eth_dev,
78dd2c630aSFerruh Yigit 	uint16_t queue_id,
79dd2c630aSFerruh Yigit 	uint8_t stat_idx,
80dd2c630aSFerruh Yigit 	uint8_t is_rx);
816c3169a3SBruce Richardson 
8200628188SStephen Hemminger int virtio_logtype_init;
8300628188SStephen Hemminger int virtio_logtype_driver;
8400628188SStephen Hemminger 
857365504fSXiao Wang static void virtio_notify_peers(struct rte_eth_dev *dev);
867365504fSXiao Wang static void virtio_ack_link_announce(struct rte_eth_dev *dev);
877365504fSXiao Wang 
886c3169a3SBruce Richardson /*
896c3169a3SBruce Richardson  * The set of PCI devices this driver supports
906c3169a3SBruce Richardson  */
916c3169a3SBruce Richardson static const struct rte_pci_id pci_id_virtio_map[] = {
924c790365SJason Wang 	{ RTE_PCI_DEVICE(VIRTIO_PCI_VENDORID, VIRTIO_PCI_LEGACY_DEVICEID_NET) },
934c790365SJason Wang 	{ RTE_PCI_DEVICE(VIRTIO_PCI_VENDORID, VIRTIO_PCI_MODERN_DEVICEID_NET) },
946c3169a3SBruce Richardson 	{ .vendor_id = 0, /* sentinel */ },
956c3169a3SBruce Richardson };
966c3169a3SBruce Richardson 
9776d4c652SHarry van Haaren struct rte_virtio_xstats_name_off {
9876d4c652SHarry van Haaren 	char name[RTE_ETH_XSTATS_NAME_SIZE];
9976d4c652SHarry van Haaren 	unsigned offset;
10076d4c652SHarry van Haaren };
10176d4c652SHarry van Haaren 
10276d4c652SHarry van Haaren /* [rt]x_qX_ is prepended to the name string here */
10301ad44fdSHuawei Xie static const struct rte_virtio_xstats_name_off rte_virtio_rxq_stat_strings[] = {
10401ad44fdSHuawei Xie 	{"good_packets",           offsetof(struct virtnet_rx, stats.packets)},
10501ad44fdSHuawei Xie 	{"good_bytes",             offsetof(struct virtnet_rx, stats.bytes)},
10601ad44fdSHuawei Xie 	{"errors",                 offsetof(struct virtnet_rx, stats.errors)},
10701ad44fdSHuawei Xie 	{"multicast_packets",      offsetof(struct virtnet_rx, stats.multicast)},
10801ad44fdSHuawei Xie 	{"broadcast_packets",      offsetof(struct virtnet_rx, stats.broadcast)},
10901ad44fdSHuawei Xie 	{"undersize_packets",      offsetof(struct virtnet_rx, stats.size_bins[0])},
11001ad44fdSHuawei Xie 	{"size_64_packets",        offsetof(struct virtnet_rx, stats.size_bins[1])},
11101ad44fdSHuawei Xie 	{"size_65_127_packets",    offsetof(struct virtnet_rx, stats.size_bins[2])},
11201ad44fdSHuawei Xie 	{"size_128_255_packets",   offsetof(struct virtnet_rx, stats.size_bins[3])},
11301ad44fdSHuawei Xie 	{"size_256_511_packets",   offsetof(struct virtnet_rx, stats.size_bins[4])},
11401ad44fdSHuawei Xie 	{"size_512_1023_packets",  offsetof(struct virtnet_rx, stats.size_bins[5])},
11581f7234bSZhiyong Yang 	{"size_1024_1518_packets", offsetof(struct virtnet_rx, stats.size_bins[6])},
11681f7234bSZhiyong Yang 	{"size_1519_max_packets",  offsetof(struct virtnet_rx, stats.size_bins[7])},
11776d4c652SHarry van Haaren };
11876d4c652SHarry van Haaren 
11901ad44fdSHuawei Xie /* [rt]x_qX_ is prepended to the name string here */
12001ad44fdSHuawei Xie static const struct rte_virtio_xstats_name_off rte_virtio_txq_stat_strings[] = {
12101ad44fdSHuawei Xie 	{"good_packets",           offsetof(struct virtnet_tx, stats.packets)},
12201ad44fdSHuawei Xie 	{"good_bytes",             offsetof(struct virtnet_tx, stats.bytes)},
12301ad44fdSHuawei Xie 	{"errors",                 offsetof(struct virtnet_tx, stats.errors)},
12401ad44fdSHuawei Xie 	{"multicast_packets",      offsetof(struct virtnet_tx, stats.multicast)},
12501ad44fdSHuawei Xie 	{"broadcast_packets",      offsetof(struct virtnet_tx, stats.broadcast)},
12601ad44fdSHuawei Xie 	{"undersize_packets",      offsetof(struct virtnet_tx, stats.size_bins[0])},
12701ad44fdSHuawei Xie 	{"size_64_packets",        offsetof(struct virtnet_tx, stats.size_bins[1])},
12801ad44fdSHuawei Xie 	{"size_65_127_packets",    offsetof(struct virtnet_tx, stats.size_bins[2])},
12901ad44fdSHuawei Xie 	{"size_128_255_packets",   offsetof(struct virtnet_tx, stats.size_bins[3])},
13001ad44fdSHuawei Xie 	{"size_256_511_packets",   offsetof(struct virtnet_tx, stats.size_bins[4])},
13101ad44fdSHuawei Xie 	{"size_512_1023_packets",  offsetof(struct virtnet_tx, stats.size_bins[5])},
13281f7234bSZhiyong Yang 	{"size_1024_1518_packets", offsetof(struct virtnet_tx, stats.size_bins[6])},
13381f7234bSZhiyong Yang 	{"size_1519_max_packets",  offsetof(struct virtnet_tx, stats.size_bins[7])},
13401ad44fdSHuawei Xie };
13501ad44fdSHuawei Xie 
13601ad44fdSHuawei Xie #define VIRTIO_NB_RXQ_XSTATS (sizeof(rte_virtio_rxq_stat_strings) / \
13701ad44fdSHuawei Xie 			    sizeof(rte_virtio_rxq_stat_strings[0]))
13801ad44fdSHuawei Xie #define VIRTIO_NB_TXQ_XSTATS (sizeof(rte_virtio_txq_stat_strings) / \
13901ad44fdSHuawei Xie 			    sizeof(rte_virtio_txq_stat_strings[0]))
14076d4c652SHarry van Haaren 
141553f4593SYuanhan Liu struct virtio_hw_internal virtio_hw_internal[RTE_MAX_ETHPORTS];
142553f4593SYuanhan Liu 
1436c3169a3SBruce Richardson static int
14401ad44fdSHuawei Xie virtio_send_command(struct virtnet_ctl *cvq, struct virtio_pmd_ctrl *ctrl,
1456c3169a3SBruce Richardson 		int *dlen, int pkt_num)
1466c3169a3SBruce Richardson {
1479e71668bSDamjan Marion 	uint32_t head, i;
1486c3169a3SBruce Richardson 	int k, sum = 0;
1496c3169a3SBruce Richardson 	virtio_net_ctrl_ack status = ~0;
150da4f2e4bSZhiyong Yang 	struct virtio_pmd_ctrl *result;
15101ad44fdSHuawei Xie 	struct virtqueue *vq;
1526c3169a3SBruce Richardson 
1536c3169a3SBruce Richardson 	ctrl->status = status;
1546c3169a3SBruce Richardson 
1553bd60a27SJianfeng Tan 	if (!cvq || !cvq->vq) {
1560bb159adSHuawei Xie 		PMD_INIT_LOG(ERR, "Control queue is not supported.");
1576c3169a3SBruce Richardson 		return -1;
1586c3169a3SBruce Richardson 	}
159a2ffb87bSXiao Wang 
160a2ffb87bSXiao Wang 	rte_spinlock_lock(&cvq->lock);
16101ad44fdSHuawei Xie 	vq = cvq->vq;
1629e71668bSDamjan Marion 	head = vq->vq_desc_head_idx;
1636c3169a3SBruce Richardson 
1646c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG, "vq->vq_desc_head_idx = %d, status = %d, "
1656c3169a3SBruce Richardson 		"vq->hw->cvq = %p vq = %p",
1666c3169a3SBruce Richardson 		vq->vq_desc_head_idx, status, vq->hw->cvq, vq);
1676c3169a3SBruce Richardson 
168a2ffb87bSXiao Wang 	if (vq->vq_free_cnt < pkt_num + 2 || pkt_num < 1) {
169a2ffb87bSXiao Wang 		rte_spinlock_unlock(&cvq->lock);
1706c3169a3SBruce Richardson 		return -1;
171a2ffb87bSXiao Wang 	}
1726c3169a3SBruce Richardson 
17301ad44fdSHuawei Xie 	memcpy(cvq->virtio_net_hdr_mz->addr, ctrl,
1746c3169a3SBruce Richardson 		sizeof(struct virtio_pmd_ctrl));
1756c3169a3SBruce Richardson 
1766c3169a3SBruce Richardson 	/*
1776c3169a3SBruce Richardson 	 * Format is enforced in qemu code:
1786c3169a3SBruce Richardson 	 * One TX packet for header;
1796c3169a3SBruce Richardson 	 * At least one TX packet per argument;
1806c3169a3SBruce Richardson 	 * One RX packet for ACK.
1816c3169a3SBruce Richardson 	 */
1826c3169a3SBruce Richardson 	vq->vq_ring.desc[head].flags = VRING_DESC_F_NEXT;
183f24f8f9fSJianfeng Tan 	vq->vq_ring.desc[head].addr = cvq->virtio_net_hdr_mem;
1846c3169a3SBruce Richardson 	vq->vq_ring.desc[head].len = sizeof(struct virtio_net_ctrl_hdr);
1856c3169a3SBruce Richardson 	vq->vq_free_cnt--;
1866c3169a3SBruce Richardson 	i = vq->vq_ring.desc[head].next;
1876c3169a3SBruce Richardson 
1886c3169a3SBruce Richardson 	for (k = 0; k < pkt_num; k++) {
1896c3169a3SBruce Richardson 		vq->vq_ring.desc[i].flags = VRING_DESC_F_NEXT;
190f24f8f9fSJianfeng Tan 		vq->vq_ring.desc[i].addr = cvq->virtio_net_hdr_mem
1916c3169a3SBruce Richardson 			+ sizeof(struct virtio_net_ctrl_hdr)
1926c3169a3SBruce Richardson 			+ sizeof(ctrl->status) + sizeof(uint8_t)*sum;
1936c3169a3SBruce Richardson 		vq->vq_ring.desc[i].len = dlen[k];
1946c3169a3SBruce Richardson 		sum += dlen[k];
1956c3169a3SBruce Richardson 		vq->vq_free_cnt--;
1966c3169a3SBruce Richardson 		i = vq->vq_ring.desc[i].next;
1976c3169a3SBruce Richardson 	}
1986c3169a3SBruce Richardson 
1996c3169a3SBruce Richardson 	vq->vq_ring.desc[i].flags = VRING_DESC_F_WRITE;
200f24f8f9fSJianfeng Tan 	vq->vq_ring.desc[i].addr = cvq->virtio_net_hdr_mem
2016c3169a3SBruce Richardson 			+ sizeof(struct virtio_net_ctrl_hdr);
2026c3169a3SBruce Richardson 	vq->vq_ring.desc[i].len = sizeof(ctrl->status);
2036c3169a3SBruce Richardson 	vq->vq_free_cnt--;
2046c3169a3SBruce Richardson 
2056c3169a3SBruce Richardson 	vq->vq_desc_head_idx = vq->vq_ring.desc[i].next;
2066c3169a3SBruce Richardson 
2076c3169a3SBruce Richardson 	vq_update_avail_ring(vq, head);
2086c3169a3SBruce Richardson 	vq_update_avail_idx(vq);
2096c3169a3SBruce Richardson 
2106c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG, "vq->vq_queue_index = %d", vq->vq_queue_index);
2116c3169a3SBruce Richardson 
2126c3169a3SBruce Richardson 	virtqueue_notify(vq);
2136c3169a3SBruce Richardson 
2146c3169a3SBruce Richardson 	rte_rmb();
215b81026f1SHuawei Xie 	while (VIRTQUEUE_NUSED(vq) == 0) {
2166c3169a3SBruce Richardson 		rte_rmb();
2176c3169a3SBruce Richardson 		usleep(100);
2186c3169a3SBruce Richardson 	}
2196c3169a3SBruce Richardson 
220b81026f1SHuawei Xie 	while (VIRTQUEUE_NUSED(vq)) {
2216c3169a3SBruce Richardson 		uint32_t idx, desc_idx, used_idx;
2226c3169a3SBruce Richardson 		struct vring_used_elem *uep;
2236c3169a3SBruce Richardson 
2246c3169a3SBruce Richardson 		used_idx = (uint32_t)(vq->vq_used_cons_idx
2256c3169a3SBruce Richardson 				& (vq->vq_nentries - 1));
2266c3169a3SBruce Richardson 		uep = &vq->vq_ring.used->ring[used_idx];
2276c3169a3SBruce Richardson 		idx = (uint32_t) uep->id;
2286c3169a3SBruce Richardson 		desc_idx = idx;
2296c3169a3SBruce Richardson 
2306c3169a3SBruce Richardson 		while (vq->vq_ring.desc[desc_idx].flags & VRING_DESC_F_NEXT) {
2316c3169a3SBruce Richardson 			desc_idx = vq->vq_ring.desc[desc_idx].next;
2326c3169a3SBruce Richardson 			vq->vq_free_cnt++;
2336c3169a3SBruce Richardson 		}
2346c3169a3SBruce Richardson 
2356c3169a3SBruce Richardson 		vq->vq_ring.desc[desc_idx].next = vq->vq_desc_head_idx;
2366c3169a3SBruce Richardson 		vq->vq_desc_head_idx = idx;
2376c3169a3SBruce Richardson 
2386c3169a3SBruce Richardson 		vq->vq_used_cons_idx++;
2396c3169a3SBruce Richardson 		vq->vq_free_cnt++;
2406c3169a3SBruce Richardson 	}
2416c3169a3SBruce Richardson 
2426c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG, "vq->vq_free_cnt=%d\nvq->vq_desc_head_idx=%d",
2436c3169a3SBruce Richardson 			vq->vq_free_cnt, vq->vq_desc_head_idx);
2446c3169a3SBruce Richardson 
245da4f2e4bSZhiyong Yang 	result = cvq->virtio_net_hdr_mz->addr;
2466c3169a3SBruce Richardson 
247a2ffb87bSXiao Wang 	rte_spinlock_unlock(&cvq->lock);
248da4f2e4bSZhiyong Yang 	return result->status;
2496c3169a3SBruce Richardson }
2506c3169a3SBruce Richardson 
2516c3169a3SBruce Richardson static int
2526c3169a3SBruce Richardson virtio_set_multiple_queues(struct rte_eth_dev *dev, uint16_t nb_queues)
2536c3169a3SBruce Richardson {
2546c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
2556c3169a3SBruce Richardson 	struct virtio_pmd_ctrl ctrl;
2566c3169a3SBruce Richardson 	int dlen[1];
2576c3169a3SBruce Richardson 	int ret;
2586c3169a3SBruce Richardson 
2596c3169a3SBruce Richardson 	ctrl.hdr.class = VIRTIO_NET_CTRL_MQ;
2606c3169a3SBruce Richardson 	ctrl.hdr.cmd = VIRTIO_NET_CTRL_MQ_VQ_PAIRS_SET;
2616c3169a3SBruce Richardson 	memcpy(ctrl.data, &nb_queues, sizeof(uint16_t));
2626c3169a3SBruce Richardson 
2636c3169a3SBruce Richardson 	dlen[0] = sizeof(uint16_t);
2646c3169a3SBruce Richardson 
2656c3169a3SBruce Richardson 	ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
2666c3169a3SBruce Richardson 	if (ret) {
2676c3169a3SBruce Richardson 		PMD_INIT_LOG(ERR, "Multiqueue configured but send command "
2686c3169a3SBruce Richardson 			  "failed, this is too late now...");
2696c3169a3SBruce Richardson 		return -EINVAL;
2706c3169a3SBruce Richardson 	}
2716c3169a3SBruce Richardson 
2726c3169a3SBruce Richardson 	return 0;
2736c3169a3SBruce Richardson }
2746c3169a3SBruce Richardson 
27569c80d4eSYuanhan Liu static void
27669c80d4eSYuanhan Liu virtio_dev_queue_release(void *queue __rte_unused)
2772963d99aSJianfeng Tan {
27869c80d4eSYuanhan Liu 	/* do nothing */
2795382b188SBernard Iremonger }
2805382b188SBernard Iremonger 
28169c80d4eSYuanhan Liu static uint16_t
28269c80d4eSYuanhan Liu virtio_get_nr_vq(struct virtio_hw *hw)
28369c80d4eSYuanhan Liu {
28469c80d4eSYuanhan Liu 	uint16_t nr_vq = hw->max_queue_pairs * 2;
28569c80d4eSYuanhan Liu 
28669c80d4eSYuanhan Liu 	if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ))
28769c80d4eSYuanhan Liu 		nr_vq += 1;
28869c80d4eSYuanhan Liu 
28969c80d4eSYuanhan Liu 	return nr_vq;
29069c80d4eSYuanhan Liu }
29169c80d4eSYuanhan Liu 
292f4d1ad15SYuanhan Liu static void
293f4d1ad15SYuanhan Liu virtio_init_vring(struct virtqueue *vq)
294f4d1ad15SYuanhan Liu {
295f4d1ad15SYuanhan Liu 	int size = vq->vq_nentries;
296f4d1ad15SYuanhan Liu 	struct vring *vr = &vq->vq_ring;
297f4d1ad15SYuanhan Liu 	uint8_t *ring_mem = vq->vq_ring_virt_mem;
298f4d1ad15SYuanhan Liu 
299f4d1ad15SYuanhan Liu 	PMD_INIT_FUNC_TRACE();
300f4d1ad15SYuanhan Liu 
301f4d1ad15SYuanhan Liu 	/*
302f4d1ad15SYuanhan Liu 	 * Reinitialise since virtio port might have been stopped and restarted
303f4d1ad15SYuanhan Liu 	 */
304f4d1ad15SYuanhan Liu 	memset(ring_mem, 0, vq->vq_ring_size);
305f4d1ad15SYuanhan Liu 	vring_init(vr, size, ring_mem, VIRTIO_PCI_VRING_ALIGN);
306f4d1ad15SYuanhan Liu 	vq->vq_used_cons_idx = 0;
307f4d1ad15SYuanhan Liu 	vq->vq_desc_head_idx = 0;
308f4d1ad15SYuanhan Liu 	vq->vq_avail_idx = 0;
309f4d1ad15SYuanhan Liu 	vq->vq_desc_tail_idx = (uint16_t)(vq->vq_nentries - 1);
310f4d1ad15SYuanhan Liu 	vq->vq_free_cnt = vq->vq_nentries;
311f4d1ad15SYuanhan Liu 	memset(vq->vq_descx, 0, sizeof(struct vq_desc_extra) * vq->vq_nentries);
312f4d1ad15SYuanhan Liu 
313f4d1ad15SYuanhan Liu 	vring_desc_init(vr->desc, size);
314f4d1ad15SYuanhan Liu 
315f4d1ad15SYuanhan Liu 	/*
316f4d1ad15SYuanhan Liu 	 * Disable device(host) interrupting guest
317f4d1ad15SYuanhan Liu 	 */
318f4d1ad15SYuanhan Liu 	virtqueue_disable_intr(vq);
319f4d1ad15SYuanhan Liu }
320f4d1ad15SYuanhan Liu 
32169c80d4eSYuanhan Liu static int
32269c80d4eSYuanhan Liu virtio_init_queue(struct rte_eth_dev *dev, uint16_t vtpci_queue_idx)
3236c3169a3SBruce Richardson {
3246c3169a3SBruce Richardson 	char vq_name[VIRTQUEUE_MAX_NAME_SZ];
32501ad44fdSHuawei Xie 	char vq_hdr_name[VIRTQUEUE_MAX_NAME_SZ];
32601ad44fdSHuawei Xie 	const struct rte_memzone *mz = NULL, *hdr_mz = NULL;
3271e7bd238SStephen Hemminger 	unsigned int vq_size, size;
3286c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
329f24f8f9fSJianfeng Tan 	struct virtnet_rx *rxvq = NULL;
330f24f8f9fSJianfeng Tan 	struct virtnet_tx *txvq = NULL;
331f24f8f9fSJianfeng Tan 	struct virtnet_ctl *cvq = NULL;
33201ad44fdSHuawei Xie 	struct virtqueue *vq;
333905a2469SYuanhan Liu 	size_t sz_hdr_mz = 0;
33401ad44fdSHuawei Xie 	void *sw_ring = NULL;
33569c80d4eSYuanhan Liu 	int queue_type = virtio_get_queue_type(hw, vtpci_queue_idx);
33601ad44fdSHuawei Xie 	int ret;
3376c3169a3SBruce Richardson 
338d5bbeefcSYuanhan Liu 	PMD_INIT_LOG(DEBUG, "setting up queue: %u", vtpci_queue_idx);
3396c3169a3SBruce Richardson 
3406c3169a3SBruce Richardson 	/*
3416c3169a3SBruce Richardson 	 * Read the virtqueue size from the Queue Size field
3426c3169a3SBruce Richardson 	 * Always power of 2 and if 0 virtqueue does not exist
3436c3169a3SBruce Richardson 	 */
344553f4593SYuanhan Liu 	vq_size = VTPCI_OPS(hw)->get_queue_num(hw, vtpci_queue_idx);
34569c80d4eSYuanhan Liu 	PMD_INIT_LOG(DEBUG, "vq_size: %u", vq_size);
3466c3169a3SBruce Richardson 	if (vq_size == 0) {
3470bb159adSHuawei Xie 		PMD_INIT_LOG(ERR, "virtqueue does not exist");
3486c3169a3SBruce Richardson 		return -EINVAL;
349d78deadaSStephen Hemminger 	}
350d78deadaSStephen Hemminger 
351d78deadaSStephen Hemminger 	if (!rte_is_power_of_2(vq_size)) {
3520bb159adSHuawei Xie 		PMD_INIT_LOG(ERR, "virtqueue size is not powerof 2");
3536c3169a3SBruce Richardson 		return -EINVAL;
354d78deadaSStephen Hemminger 	}
355d78deadaSStephen Hemminger 
35673d017ddSYuanhan Liu 	snprintf(vq_name, sizeof(vq_name), "port%d_vq%d",
35773d017ddSYuanhan Liu 		 dev->data->port_id, vtpci_queue_idx);
35801ad44fdSHuawei Xie 
359905a2469SYuanhan Liu 	size = RTE_ALIGN_CEIL(sizeof(*vq) +
3606c3169a3SBruce Richardson 				vq_size * sizeof(struct vq_desc_extra),
3616c3169a3SBruce Richardson 				RTE_CACHE_LINE_SIZE);
362905a2469SYuanhan Liu 	if (queue_type == VTNET_TQ) {
36301ad44fdSHuawei Xie 		/*
36401ad44fdSHuawei Xie 		 * For each xmit packet, allocate a virtio_net_hdr
36501ad44fdSHuawei Xie 		 * and indirect ring elements
36601ad44fdSHuawei Xie 		 */
36701ad44fdSHuawei Xie 		sz_hdr_mz = vq_size * sizeof(struct virtio_tx_region);
36801ad44fdSHuawei Xie 	} else if (queue_type == VTNET_CQ) {
36901ad44fdSHuawei Xie 		/* Allocate a page for control vq command, data and status */
37001ad44fdSHuawei Xie 		sz_hdr_mz = PAGE_SIZE;
37101ad44fdSHuawei Xie 	}
3724166bbf6SJianfeng Tan 
37369c80d4eSYuanhan Liu 	vq = rte_zmalloc_socket(vq_name, size, RTE_CACHE_LINE_SIZE,
37469c80d4eSYuanhan Liu 				SOCKET_ID_ANY);
37501ad44fdSHuawei Xie 	if (vq == NULL) {
37601ad44fdSHuawei Xie 		PMD_INIT_LOG(ERR, "can not allocate vq");
377cab04612SHuawei Xie 		return -ENOMEM;
378cab04612SHuawei Xie 	}
37969c80d4eSYuanhan Liu 	hw->vqs[vtpci_queue_idx] = vq;
38069c80d4eSYuanhan Liu 
3816c3169a3SBruce Richardson 	vq->hw = hw;
3826c3169a3SBruce Richardson 	vq->vq_queue_index = vtpci_queue_idx;
3836c3169a3SBruce Richardson 	vq->vq_nentries = vq_size;
3846c3169a3SBruce Richardson 
3856c3169a3SBruce Richardson 	/*
3866c3169a3SBruce Richardson 	 * Reserve a memzone for vring elements
3876c3169a3SBruce Richardson 	 */
3886c3169a3SBruce Richardson 	size = vring_size(vq_size, VIRTIO_PCI_VRING_ALIGN);
3896c3169a3SBruce Richardson 	vq->vq_ring_size = RTE_ALIGN_CEIL(size, VIRTIO_PCI_VRING_ALIGN);
39001ad44fdSHuawei Xie 	PMD_INIT_LOG(DEBUG, "vring_size: %d, rounded_vring_size: %d",
39101ad44fdSHuawei Xie 		     size, vq->vq_ring_size);
3926c3169a3SBruce Richardson 
39369c80d4eSYuanhan Liu 	mz = rte_memzone_reserve_aligned(vq_name, vq->vq_ring_size,
394*25553d44SAnatoly Burakov 			SOCKET_ID_ANY, RTE_MEMZONE_IOVA_CONTIG,
395*25553d44SAnatoly Burakov 			VIRTIO_PCI_VRING_ALIGN);
3966c3169a3SBruce Richardson 	if (mz == NULL) {
397abf4c84bSBernard Iremonger 		if (rte_errno == EEXIST)
398abf4c84bSBernard Iremonger 			mz = rte_memzone_lookup(vq_name);
399abf4c84bSBernard Iremonger 		if (mz == NULL) {
40001ad44fdSHuawei Xie 			ret = -ENOMEM;
40101ad44fdSHuawei Xie 			goto fail_q_alloc;
4026c3169a3SBruce Richardson 		}
403abf4c84bSBernard Iremonger 	}
4046c3169a3SBruce Richardson 
4055bdd24e4STiwei Bie 	memset(mz->addr, 0, mz->len);
40601ad44fdSHuawei Xie 
407f17ca787SThomas Monjalon 	vq->vq_ring_mem = mz->iova;
4086c3169a3SBruce Richardson 	vq->vq_ring_virt_mem = mz->addr;
40901ad44fdSHuawei Xie 	PMD_INIT_LOG(DEBUG, "vq->vq_ring_mem:      0x%" PRIx64,
410f17ca787SThomas Monjalon 		     (uint64_t)mz->iova);
41101ad44fdSHuawei Xie 	PMD_INIT_LOG(DEBUG, "vq->vq_ring_virt_mem: 0x%" PRIx64,
41201ad44fdSHuawei Xie 		     (uint64_t)(uintptr_t)mz->addr);
4136c3169a3SBruce Richardson 
414f4d1ad15SYuanhan Liu 	virtio_init_vring(vq);
415f4d1ad15SYuanhan Liu 
41601ad44fdSHuawei Xie 	if (sz_hdr_mz) {
41773d017ddSYuanhan Liu 		snprintf(vq_hdr_name, sizeof(vq_hdr_name), "port%d_vq%d_hdr",
41873d017ddSYuanhan Liu 			 dev->data->port_id, vtpci_queue_idx);
41901ad44fdSHuawei Xie 		hdr_mz = rte_memzone_reserve_aligned(vq_hdr_name, sz_hdr_mz,
420*25553d44SAnatoly Burakov 				SOCKET_ID_ANY, RTE_MEMZONE_IOVA_CONTIG,
4216dc5de3aSStephen Hemminger 				RTE_CACHE_LINE_SIZE);
4226dc5de3aSStephen Hemminger 		if (hdr_mz == NULL) {
423abf4c84bSBernard Iremonger 			if (rte_errno == EEXIST)
42401ad44fdSHuawei Xie 				hdr_mz = rte_memzone_lookup(vq_hdr_name);
4256dc5de3aSStephen Hemminger 			if (hdr_mz == NULL) {
42601ad44fdSHuawei Xie 				ret = -ENOMEM;
42701ad44fdSHuawei Xie 				goto fail_q_alloc;
4286c3169a3SBruce Richardson 			}
429abf4c84bSBernard Iremonger 		}
43001ad44fdSHuawei Xie 	}
43101ad44fdSHuawei Xie 
43201ad44fdSHuawei Xie 	if (queue_type == VTNET_RQ) {
43301ad44fdSHuawei Xie 		size_t sz_sw = (RTE_PMD_VIRTIO_RX_MAX_BURST + vq_size) *
43401ad44fdSHuawei Xie 			       sizeof(vq->sw_ring[0]);
43501ad44fdSHuawei Xie 
43601ad44fdSHuawei Xie 		sw_ring = rte_zmalloc_socket("sw_ring", sz_sw,
43769c80d4eSYuanhan Liu 				RTE_CACHE_LINE_SIZE, SOCKET_ID_ANY);
43801ad44fdSHuawei Xie 		if (!sw_ring) {
43901ad44fdSHuawei Xie 			PMD_INIT_LOG(ERR, "can not allocate RX soft ring");
44001ad44fdSHuawei Xie 			ret = -ENOMEM;
44101ad44fdSHuawei Xie 			goto fail_q_alloc;
44201ad44fdSHuawei Xie 		}
44301ad44fdSHuawei Xie 
44401ad44fdSHuawei Xie 		vq->sw_ring = sw_ring;
445905a2469SYuanhan Liu 		rxvq = &vq->rxq;
44601ad44fdSHuawei Xie 		rxvq->vq = vq;
44701ad44fdSHuawei Xie 		rxvq->port_id = dev->data->port_id;
44801ad44fdSHuawei Xie 		rxvq->mz = mz;
44901ad44fdSHuawei Xie 	} else if (queue_type == VTNET_TQ) {
450905a2469SYuanhan Liu 		txvq = &vq->txq;
45101ad44fdSHuawei Xie 		txvq->vq = vq;
45201ad44fdSHuawei Xie 		txvq->port_id = dev->data->port_id;
45301ad44fdSHuawei Xie 		txvq->mz = mz;
45401ad44fdSHuawei Xie 		txvq->virtio_net_hdr_mz = hdr_mz;
455f17ca787SThomas Monjalon 		txvq->virtio_net_hdr_mem = hdr_mz->iova;
456f24f8f9fSJianfeng Tan 	} else if (queue_type == VTNET_CQ) {
457905a2469SYuanhan Liu 		cvq = &vq->cq;
458f24f8f9fSJianfeng Tan 		cvq->vq = vq;
459f24f8f9fSJianfeng Tan 		cvq->mz = mz;
460f24f8f9fSJianfeng Tan 		cvq->virtio_net_hdr_mz = hdr_mz;
461f17ca787SThomas Monjalon 		cvq->virtio_net_hdr_mem = hdr_mz->iova;
462f24f8f9fSJianfeng Tan 		memset(cvq->virtio_net_hdr_mz->addr, 0, PAGE_SIZE);
46369c80d4eSYuanhan Liu 
46469c80d4eSYuanhan Liu 		hw->cvq = cvq;
465f24f8f9fSJianfeng Tan 	}
466f24f8f9fSJianfeng Tan 
4676a7c0dfcSJan Blunck 	/* For virtio_user case (that is when hw->dev is NULL), we use
468f24f8f9fSJianfeng Tan 	 * virtual address. And we need properly set _offset_, please see
46925f80d10SOlivier Matz 	 * VIRTIO_MBUF_DATA_DMA_ADDR in virtqueue.h for more information.
470f24f8f9fSJianfeng Tan 	 */
4719470427cSYuanhan Liu 	if (!hw->virtio_user_dev)
472455da545SSantosh Shukla 		vq->offset = offsetof(struct rte_mbuf, buf_iova);
473f24f8f9fSJianfeng Tan 	else {
474f24f8f9fSJianfeng Tan 		vq->vq_ring_mem = (uintptr_t)mz->addr;
475f24f8f9fSJianfeng Tan 		vq->offset = offsetof(struct rte_mbuf, buf_addr);
476f24f8f9fSJianfeng Tan 		if (queue_type == VTNET_TQ)
477f24f8f9fSJianfeng Tan 			txvq->virtio_net_hdr_mem = (uintptr_t)hdr_mz->addr;
478f24f8f9fSJianfeng Tan 		else if (queue_type == VTNET_CQ)
479f24f8f9fSJianfeng Tan 			cvq->virtio_net_hdr_mem = (uintptr_t)hdr_mz->addr;
480f24f8f9fSJianfeng Tan 	}
481f24f8f9fSJianfeng Tan 
482f24f8f9fSJianfeng Tan 	if (queue_type == VTNET_TQ) {
483f24f8f9fSJianfeng Tan 		struct virtio_tx_region *txr;
484f24f8f9fSJianfeng Tan 		unsigned int i;
485f24f8f9fSJianfeng Tan 
4866dc5de3aSStephen Hemminger 		txr = hdr_mz->addr;
4876dc5de3aSStephen Hemminger 		memset(txr, 0, vq_size * sizeof(*txr));
4886dc5de3aSStephen Hemminger 		for (i = 0; i < vq_size; i++) {
4896dc5de3aSStephen Hemminger 			struct vring_desc *start_dp = txr[i].tx_indir;
4906dc5de3aSStephen Hemminger 
4916dc5de3aSStephen Hemminger 			vring_desc_init(start_dp, RTE_DIM(txr[i].tx_indir));
4926dc5de3aSStephen Hemminger 
4936dc5de3aSStephen Hemminger 			/* first indirect descriptor is always the tx header */
49401ad44fdSHuawei Xie 			start_dp->addr = txvq->virtio_net_hdr_mem
4956dc5de3aSStephen Hemminger 				+ i * sizeof(*txr)
4966dc5de3aSStephen Hemminger 				+ offsetof(struct virtio_tx_region, tx_hdr);
4976dc5de3aSStephen Hemminger 
49801ad44fdSHuawei Xie 			start_dp->len = hw->vtnet_hdr_size;
4996dc5de3aSStephen Hemminger 			start_dp->flags = VRING_DESC_F_NEXT;
5006dc5de3aSStephen Hemminger 		}
5016c3169a3SBruce Richardson 	}
5026c3169a3SBruce Richardson 
503553f4593SYuanhan Liu 	if (VTPCI_OPS(hw)->setup_queue(hw, vq) < 0) {
504595454c5SJianfeng Tan 		PMD_INIT_LOG(ERR, "setup_queue failed");
505595454c5SJianfeng Tan 		return -EINVAL;
506595454c5SJianfeng Tan 	}
507595454c5SJianfeng Tan 
5086c3169a3SBruce Richardson 	return 0;
50901ad44fdSHuawei Xie 
51001ad44fdSHuawei Xie fail_q_alloc:
51101ad44fdSHuawei Xie 	rte_free(sw_ring);
51201ad44fdSHuawei Xie 	rte_memzone_free(hdr_mz);
51301ad44fdSHuawei Xie 	rte_memzone_free(mz);
51401ad44fdSHuawei Xie 	rte_free(vq);
51501ad44fdSHuawei Xie 
51601ad44fdSHuawei Xie 	return ret;
5176c3169a3SBruce Richardson }
5186c3169a3SBruce Richardson 
51969c80d4eSYuanhan Liu static void
52069c80d4eSYuanhan Liu virtio_free_queues(struct virtio_hw *hw)
5216c3169a3SBruce Richardson {
52269c80d4eSYuanhan Liu 	uint16_t nr_vq = virtio_get_nr_vq(hw);
52369c80d4eSYuanhan Liu 	struct virtqueue *vq;
52469c80d4eSYuanhan Liu 	int queue_type;
52569c80d4eSYuanhan Liu 	uint16_t i;
5266c3169a3SBruce Richardson 
5270e78cfddSHuanle Han 	if (hw->vqs == NULL)
5280e78cfddSHuanle Han 		return;
5290e78cfddSHuanle Han 
53069c80d4eSYuanhan Liu 	for (i = 0; i < nr_vq; i++) {
53169c80d4eSYuanhan Liu 		vq = hw->vqs[i];
53269c80d4eSYuanhan Liu 		if (!vq)
53369c80d4eSYuanhan Liu 			continue;
53469c80d4eSYuanhan Liu 
53569c80d4eSYuanhan Liu 		queue_type = virtio_get_queue_type(hw, i);
53669c80d4eSYuanhan Liu 		if (queue_type == VTNET_RQ) {
53769c80d4eSYuanhan Liu 			rte_free(vq->sw_ring);
53869c80d4eSYuanhan Liu 			rte_memzone_free(vq->rxq.mz);
53969c80d4eSYuanhan Liu 		} else if (queue_type == VTNET_TQ) {
54069c80d4eSYuanhan Liu 			rte_memzone_free(vq->txq.mz);
54169c80d4eSYuanhan Liu 			rte_memzone_free(vq->txq.virtio_net_hdr_mz);
54269c80d4eSYuanhan Liu 		} else {
54369c80d4eSYuanhan Liu 			rte_memzone_free(vq->cq.mz);
54469c80d4eSYuanhan Liu 			rte_memzone_free(vq->cq.virtio_net_hdr_mz);
54569c80d4eSYuanhan Liu 		}
54669c80d4eSYuanhan Liu 
54769c80d4eSYuanhan Liu 		rte_free(vq);
5480e78cfddSHuanle Han 		hw->vqs[i] = NULL;
54969c80d4eSYuanhan Liu 	}
55069c80d4eSYuanhan Liu 
55169c80d4eSYuanhan Liu 	rte_free(hw->vqs);
5520e78cfddSHuanle Han 	hw->vqs = NULL;
55369c80d4eSYuanhan Liu }
55469c80d4eSYuanhan Liu 
55569c80d4eSYuanhan Liu static int
55669c80d4eSYuanhan Liu virtio_alloc_queues(struct rte_eth_dev *dev)
55769c80d4eSYuanhan Liu {
55869c80d4eSYuanhan Liu 	struct virtio_hw *hw = dev->data->dev_private;
55969c80d4eSYuanhan Liu 	uint16_t nr_vq = virtio_get_nr_vq(hw);
56069c80d4eSYuanhan Liu 	uint16_t i;
56169c80d4eSYuanhan Liu 	int ret;
56269c80d4eSYuanhan Liu 
56369c80d4eSYuanhan Liu 	hw->vqs = rte_zmalloc(NULL, sizeof(struct virtqueue *) * nr_vq, 0);
56469c80d4eSYuanhan Liu 	if (!hw->vqs) {
56569c80d4eSYuanhan Liu 		PMD_INIT_LOG(ERR, "failed to allocate vqs");
56669c80d4eSYuanhan Liu 		return -ENOMEM;
56769c80d4eSYuanhan Liu 	}
56869c80d4eSYuanhan Liu 
56969c80d4eSYuanhan Liu 	for (i = 0; i < nr_vq; i++) {
57069c80d4eSYuanhan Liu 		ret = virtio_init_queue(dev, i);
5716c3169a3SBruce Richardson 		if (ret < 0) {
57269c80d4eSYuanhan Liu 			virtio_free_queues(hw);
5736c3169a3SBruce Richardson 			return ret;
5746c3169a3SBruce Richardson 		}
5756c3169a3SBruce Richardson 	}
5766c3169a3SBruce Richardson 
57769c80d4eSYuanhan Liu 	return 0;
578941d64b5SBernard Iremonger }
579941d64b5SBernard Iremonger 
5809ebdeefeSJianfeng Tan static void virtio_queues_unbind_intr(struct rte_eth_dev *dev);
5819ebdeefeSJianfeng Tan 
582941d64b5SBernard Iremonger static void
5836c3169a3SBruce Richardson virtio_dev_close(struct rte_eth_dev *dev)
5846c3169a3SBruce Richardson {
5856c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
5869ebdeefeSJianfeng Tan 	struct rte_intr_conf *intr_conf = &dev->data->dev_conf.intr_conf;
5876c3169a3SBruce Richardson 
5886c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG, "virtio_dev_close");
5896c3169a3SBruce Richardson 
5906c3169a3SBruce Richardson 	/* reset the NIC */
59162a785a6SJianfeng Tan 	if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)
592981e61f5SJianfeng Tan 		VTPCI_OPS(hw)->set_config_irq(hw, VIRTIO_MSI_NO_VECTOR);
5939ebdeefeSJianfeng Tan 	if (intr_conf->rxq)
5949ebdeefeSJianfeng Tan 		virtio_queues_unbind_intr(dev);
5959ebdeefeSJianfeng Tan 
5969ebdeefeSJianfeng Tan 	if (intr_conf->lsc || intr_conf->rxq) {
597fe19d49cSZhiyong Yang 		virtio_intr_disable(dev);
5989ebdeefeSJianfeng Tan 		rte_intr_efd_disable(dev->intr_handle);
5999ebdeefeSJianfeng Tan 		rte_free(dev->intr_handle->intr_vec);
6009ebdeefeSJianfeng Tan 		dev->intr_handle->intr_vec = NULL;
6019ebdeefeSJianfeng Tan 	}
6029ebdeefeSJianfeng Tan 
6036c3169a3SBruce Richardson 	vtpci_reset(hw);
6046c3169a3SBruce Richardson 	virtio_dev_free_mbufs(dev);
60569c80d4eSYuanhan Liu 	virtio_free_queues(hw);
6066c3169a3SBruce Richardson }
6076c3169a3SBruce Richardson 
6086c3169a3SBruce Richardson static void
6096c3169a3SBruce Richardson virtio_dev_promiscuous_enable(struct rte_eth_dev *dev)
6106c3169a3SBruce Richardson {
6116c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
6126c3169a3SBruce Richardson 	struct virtio_pmd_ctrl ctrl;
6136c3169a3SBruce Richardson 	int dlen[1];
6146c3169a3SBruce Richardson 	int ret;
6156c3169a3SBruce Richardson 
616e9e414a4SStephen Hemminger 	if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) {
617f2462150SFerruh Yigit 		PMD_INIT_LOG(INFO, "host does not support rx control");
618e9e414a4SStephen Hemminger 		return;
619e9e414a4SStephen Hemminger 	}
620e9e414a4SStephen Hemminger 
6216c3169a3SBruce Richardson 	ctrl.hdr.class = VIRTIO_NET_CTRL_RX;
6226c3169a3SBruce Richardson 	ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC;
6236c3169a3SBruce Richardson 	ctrl.data[0] = 1;
6246c3169a3SBruce Richardson 	dlen[0] = 1;
6256c3169a3SBruce Richardson 
6266c3169a3SBruce Richardson 	ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
6276c3169a3SBruce Richardson 	if (ret)
6286c3169a3SBruce Richardson 		PMD_INIT_LOG(ERR, "Failed to enable promisc");
6296c3169a3SBruce Richardson }
6306c3169a3SBruce Richardson 
6316c3169a3SBruce Richardson static void
6326c3169a3SBruce Richardson virtio_dev_promiscuous_disable(struct rte_eth_dev *dev)
6336c3169a3SBruce Richardson {
6346c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
6356c3169a3SBruce Richardson 	struct virtio_pmd_ctrl ctrl;
6366c3169a3SBruce Richardson 	int dlen[1];
6376c3169a3SBruce Richardson 	int ret;
6386c3169a3SBruce Richardson 
639e9e414a4SStephen Hemminger 	if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) {
640f2462150SFerruh Yigit 		PMD_INIT_LOG(INFO, "host does not support rx control");
641e9e414a4SStephen Hemminger 		return;
642e9e414a4SStephen Hemminger 	}
643e9e414a4SStephen Hemminger 
6446c3169a3SBruce Richardson 	ctrl.hdr.class = VIRTIO_NET_CTRL_RX;
6456c3169a3SBruce Richardson 	ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC;
6466c3169a3SBruce Richardson 	ctrl.data[0] = 0;
6476c3169a3SBruce Richardson 	dlen[0] = 1;
6486c3169a3SBruce Richardson 
6496c3169a3SBruce Richardson 	ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
6506c3169a3SBruce Richardson 	if (ret)
6516c3169a3SBruce Richardson 		PMD_INIT_LOG(ERR, "Failed to disable promisc");
6526c3169a3SBruce Richardson }
6536c3169a3SBruce Richardson 
6546c3169a3SBruce Richardson static void
6556c3169a3SBruce Richardson virtio_dev_allmulticast_enable(struct rte_eth_dev *dev)
6566c3169a3SBruce Richardson {
6576c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
6586c3169a3SBruce Richardson 	struct virtio_pmd_ctrl ctrl;
6596c3169a3SBruce Richardson 	int dlen[1];
6606c3169a3SBruce Richardson 	int ret;
6616c3169a3SBruce Richardson 
662e9e414a4SStephen Hemminger 	if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) {
663f2462150SFerruh Yigit 		PMD_INIT_LOG(INFO, "host does not support rx control");
664e9e414a4SStephen Hemminger 		return;
665e9e414a4SStephen Hemminger 	}
666e9e414a4SStephen Hemminger 
6676c3169a3SBruce Richardson 	ctrl.hdr.class = VIRTIO_NET_CTRL_RX;
6686c3169a3SBruce Richardson 	ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI;
6696c3169a3SBruce Richardson 	ctrl.data[0] = 1;
6706c3169a3SBruce Richardson 	dlen[0] = 1;
6716c3169a3SBruce Richardson 
6726c3169a3SBruce Richardson 	ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
6736c3169a3SBruce Richardson 	if (ret)
6746c3169a3SBruce Richardson 		PMD_INIT_LOG(ERR, "Failed to enable allmulticast");
6756c3169a3SBruce Richardson }
6766c3169a3SBruce Richardson 
6776c3169a3SBruce Richardson static void
6786c3169a3SBruce Richardson virtio_dev_allmulticast_disable(struct rte_eth_dev *dev)
6796c3169a3SBruce Richardson {
6806c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
6816c3169a3SBruce Richardson 	struct virtio_pmd_ctrl ctrl;
6826c3169a3SBruce Richardson 	int dlen[1];
6836c3169a3SBruce Richardson 	int ret;
6846c3169a3SBruce Richardson 
685e9e414a4SStephen Hemminger 	if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) {
686f2462150SFerruh Yigit 		PMD_INIT_LOG(INFO, "host does not support rx control");
687e9e414a4SStephen Hemminger 		return;
688e9e414a4SStephen Hemminger 	}
689e9e414a4SStephen Hemminger 
6906c3169a3SBruce Richardson 	ctrl.hdr.class = VIRTIO_NET_CTRL_RX;
6916c3169a3SBruce Richardson 	ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI;
6926c3169a3SBruce Richardson 	ctrl.data[0] = 0;
6936c3169a3SBruce Richardson 	dlen[0] = 1;
6946c3169a3SBruce Richardson 
6956c3169a3SBruce Richardson 	ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
6966c3169a3SBruce Richardson 	if (ret)
6976c3169a3SBruce Richardson 		PMD_INIT_LOG(ERR, "Failed to disable allmulticast");
6986c3169a3SBruce Richardson }
6996c3169a3SBruce Richardson 
7004ec2424aSSouvik Dey #define VLAN_TAG_LEN           4    /* 802.3ac tag (not DMA'd) */
7014ec2424aSSouvik Dey static int
7024ec2424aSSouvik Dey virtio_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
7034ec2424aSSouvik Dey {
7044ec2424aSSouvik Dey 	struct virtio_hw *hw = dev->data->dev_private;
7054ec2424aSSouvik Dey 	uint32_t ether_hdr_len = ETHER_HDR_LEN + VLAN_TAG_LEN +
7064ec2424aSSouvik Dey 				 hw->vtnet_hdr_size;
7074ec2424aSSouvik Dey 	uint32_t frame_size = mtu + ether_hdr_len;
70849d26d9eSMaxime Coquelin 	uint32_t max_frame_size = hw->max_mtu + ether_hdr_len;
7094ec2424aSSouvik Dey 
71049d26d9eSMaxime Coquelin 	max_frame_size = RTE_MIN(max_frame_size, VIRTIO_MAX_RX_PKTLEN);
71149d26d9eSMaxime Coquelin 
71249d26d9eSMaxime Coquelin 	if (mtu < ETHER_MIN_MTU || frame_size > max_frame_size) {
713f2462150SFerruh Yigit 		PMD_INIT_LOG(ERR, "MTU should be between %d and %d",
71449d26d9eSMaxime Coquelin 			ETHER_MIN_MTU, max_frame_size - ether_hdr_len);
7154ec2424aSSouvik Dey 		return -EINVAL;
7164ec2424aSSouvik Dey 	}
7174ec2424aSSouvik Dey 	return 0;
7184ec2424aSSouvik Dey }
7194ec2424aSSouvik Dey 
720c056be23SJianfeng Tan static int
721c056be23SJianfeng Tan virtio_dev_rx_queue_intr_enable(struct rte_eth_dev *dev, uint16_t queue_id)
722c056be23SJianfeng Tan {
723c056be23SJianfeng Tan 	struct virtnet_rx *rxvq = dev->data->rx_queues[queue_id];
724c056be23SJianfeng Tan 	struct virtqueue *vq = rxvq->vq;
725c056be23SJianfeng Tan 
726c056be23SJianfeng Tan 	virtqueue_enable_intr(vq);
727c056be23SJianfeng Tan 	return 0;
728c056be23SJianfeng Tan }
729c056be23SJianfeng Tan 
730c056be23SJianfeng Tan static int
731c056be23SJianfeng Tan virtio_dev_rx_queue_intr_disable(struct rte_eth_dev *dev, uint16_t queue_id)
732c056be23SJianfeng Tan {
733c056be23SJianfeng Tan 	struct virtnet_rx *rxvq = dev->data->rx_queues[queue_id];
734c056be23SJianfeng Tan 	struct virtqueue *vq = rxvq->vq;
735c056be23SJianfeng Tan 
736c056be23SJianfeng Tan 	virtqueue_disable_intr(vq);
737c056be23SJianfeng Tan 	return 0;
738c056be23SJianfeng Tan }
739c056be23SJianfeng Tan 
7406c3169a3SBruce Richardson /*
7416c3169a3SBruce Richardson  * dev_ops for virtio, bare necessities for basic operation
7426c3169a3SBruce Richardson  */
7436c3169a3SBruce Richardson static const struct eth_dev_ops virtio_eth_dev_ops = {
7446c3169a3SBruce Richardson 	.dev_configure           = virtio_dev_configure,
7456c3169a3SBruce Richardson 	.dev_start               = virtio_dev_start,
7466c3169a3SBruce Richardson 	.dev_stop                = virtio_dev_stop,
7476c3169a3SBruce Richardson 	.dev_close               = virtio_dev_close,
7486c3169a3SBruce Richardson 	.promiscuous_enable      = virtio_dev_promiscuous_enable,
7496c3169a3SBruce Richardson 	.promiscuous_disable     = virtio_dev_promiscuous_disable,
7506c3169a3SBruce Richardson 	.allmulticast_enable     = virtio_dev_allmulticast_enable,
7516c3169a3SBruce Richardson 	.allmulticast_disable    = virtio_dev_allmulticast_disable,
7524ec2424aSSouvik Dey 	.mtu_set                 = virtio_mtu_set,
7536c3169a3SBruce Richardson 	.dev_infos_get           = virtio_dev_info_get,
7546c3169a3SBruce Richardson 	.stats_get               = virtio_dev_stats_get,
75576d4c652SHarry van Haaren 	.xstats_get              = virtio_dev_xstats_get,
756baf91c39SRemy Horton 	.xstats_get_names        = virtio_dev_xstats_get_names,
7576c3169a3SBruce Richardson 	.stats_reset             = virtio_dev_stats_reset,
75876d4c652SHarry van Haaren 	.xstats_reset            = virtio_dev_stats_reset,
7596c3169a3SBruce Richardson 	.link_update             = virtio_dev_link_update,
760289ba0c0SDavid Harton 	.vlan_offload_set        = virtio_dev_vlan_offload_set,
7616c3169a3SBruce Richardson 	.rx_queue_setup          = virtio_dev_rx_queue_setup,
762c056be23SJianfeng Tan 	.rx_queue_intr_enable    = virtio_dev_rx_queue_intr_enable,
763c056be23SJianfeng Tan 	.rx_queue_intr_disable   = virtio_dev_rx_queue_intr_disable,
76469c80d4eSYuanhan Liu 	.rx_queue_release        = virtio_dev_queue_release,
765b0caba1aSJianfeng Tan 	.rx_descriptor_done      = virtio_dev_rx_queue_done,
7666c3169a3SBruce Richardson 	.tx_queue_setup          = virtio_dev_tx_queue_setup,
76769c80d4eSYuanhan Liu 	.tx_queue_release        = virtio_dev_queue_release,
7686c3169a3SBruce Richardson 	/* collect stats per queue */
7696c3169a3SBruce Richardson 	.queue_stats_mapping_set = virtio_dev_queue_stats_mapping_set,
7706c3169a3SBruce Richardson 	.vlan_filter_set         = virtio_vlan_filter_set,
7716c3169a3SBruce Richardson 	.mac_addr_add            = virtio_mac_addr_add,
7726c3169a3SBruce Richardson 	.mac_addr_remove         = virtio_mac_addr_remove,
7736c3169a3SBruce Richardson 	.mac_addr_set            = virtio_mac_addr_set,
7746c3169a3SBruce Richardson };
7756c3169a3SBruce Richardson 
7766c3169a3SBruce Richardson static void
77776d4c652SHarry van Haaren virtio_update_stats(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
7786c3169a3SBruce Richardson {
7796c3169a3SBruce Richardson 	unsigned i;
7806c3169a3SBruce Richardson 
7816c3169a3SBruce Richardson 	for (i = 0; i < dev->data->nb_tx_queues; i++) {
78201ad44fdSHuawei Xie 		const struct virtnet_tx *txvq = dev->data->tx_queues[i];
7836c3169a3SBruce Richardson 		if (txvq == NULL)
7846c3169a3SBruce Richardson 			continue;
7856c3169a3SBruce Richardson 
78601ad44fdSHuawei Xie 		stats->opackets += txvq->stats.packets;
78701ad44fdSHuawei Xie 		stats->obytes += txvq->stats.bytes;
78801ad44fdSHuawei Xie 		stats->oerrors += txvq->stats.errors;
7896c3169a3SBruce Richardson 
7906c3169a3SBruce Richardson 		if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) {
79101ad44fdSHuawei Xie 			stats->q_opackets[i] = txvq->stats.packets;
79201ad44fdSHuawei Xie 			stats->q_obytes[i] = txvq->stats.bytes;
7936c3169a3SBruce Richardson 		}
7946c3169a3SBruce Richardson 	}
7956c3169a3SBruce Richardson 
7966c3169a3SBruce Richardson 	for (i = 0; i < dev->data->nb_rx_queues; i++) {
79701ad44fdSHuawei Xie 		const struct virtnet_rx *rxvq = dev->data->rx_queues[i];
7986c3169a3SBruce Richardson 		if (rxvq == NULL)
7996c3169a3SBruce Richardson 			continue;
8006c3169a3SBruce Richardson 
80101ad44fdSHuawei Xie 		stats->ipackets += rxvq->stats.packets;
80201ad44fdSHuawei Xie 		stats->ibytes += rxvq->stats.bytes;
80301ad44fdSHuawei Xie 		stats->ierrors += rxvq->stats.errors;
8046c3169a3SBruce Richardson 
8056c3169a3SBruce Richardson 		if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) {
80601ad44fdSHuawei Xie 			stats->q_ipackets[i] = rxvq->stats.packets;
80701ad44fdSHuawei Xie 			stats->q_ibytes[i] = rxvq->stats.bytes;
8086c3169a3SBruce Richardson 		}
8096c3169a3SBruce Richardson 	}
8106c3169a3SBruce Richardson 
8116c3169a3SBruce Richardson 	stats->rx_nombuf = dev->data->rx_mbuf_alloc_failed;
8126c3169a3SBruce Richardson }
8136c3169a3SBruce Richardson 
814baf91c39SRemy Horton static int virtio_dev_xstats_get_names(struct rte_eth_dev *dev,
815baf91c39SRemy Horton 				       struct rte_eth_xstat_name *xstats_names,
816baf91c39SRemy Horton 				       __rte_unused unsigned limit)
817baf91c39SRemy Horton {
818baf91c39SRemy Horton 	unsigned i;
819baf91c39SRemy Horton 	unsigned count = 0;
820baf91c39SRemy Horton 	unsigned t;
821baf91c39SRemy Horton 
82201ad44fdSHuawei Xie 	unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_TXQ_XSTATS +
82301ad44fdSHuawei Xie 		dev->data->nb_rx_queues * VIRTIO_NB_RXQ_XSTATS;
824baf91c39SRemy Horton 
8257e1eb993SYuanhan Liu 	if (xstats_names != NULL) {
826baf91c39SRemy Horton 		/* Note: limit checked in rte_eth_xstats_names() */
827baf91c39SRemy Horton 
828baf91c39SRemy Horton 		for (i = 0; i < dev->data->nb_rx_queues; i++) {
82943ec842cSDidier Pallard 			struct virtnet_rx *rxvq = dev->data->rx_queues[i];
830baf91c39SRemy Horton 			if (rxvq == NULL)
831baf91c39SRemy Horton 				continue;
83201ad44fdSHuawei Xie 			for (t = 0; t < VIRTIO_NB_RXQ_XSTATS; t++) {
833baf91c39SRemy Horton 				snprintf(xstats_names[count].name,
834baf91c39SRemy Horton 					sizeof(xstats_names[count].name),
835baf91c39SRemy Horton 					"rx_q%u_%s", i,
83601ad44fdSHuawei Xie 					rte_virtio_rxq_stat_strings[t].name);
837baf91c39SRemy Horton 				count++;
838baf91c39SRemy Horton 			}
839baf91c39SRemy Horton 		}
840baf91c39SRemy Horton 
841baf91c39SRemy Horton 		for (i = 0; i < dev->data->nb_tx_queues; i++) {
84243ec842cSDidier Pallard 			struct virtnet_tx *txvq = dev->data->tx_queues[i];
843baf91c39SRemy Horton 			if (txvq == NULL)
844baf91c39SRemy Horton 				continue;
84501ad44fdSHuawei Xie 			for (t = 0; t < VIRTIO_NB_TXQ_XSTATS; t++) {
846baf91c39SRemy Horton 				snprintf(xstats_names[count].name,
847baf91c39SRemy Horton 					sizeof(xstats_names[count].name),
848baf91c39SRemy Horton 					"tx_q%u_%s", i,
84901ad44fdSHuawei Xie 					rte_virtio_txq_stat_strings[t].name);
850baf91c39SRemy Horton 				count++;
851baf91c39SRemy Horton 			}
852baf91c39SRemy Horton 		}
853baf91c39SRemy Horton 		return count;
854baf91c39SRemy Horton 	}
855baf91c39SRemy Horton 	return nstats;
856baf91c39SRemy Horton }
857baf91c39SRemy Horton 
85876d4c652SHarry van Haaren static int
859e2aae1c1SRemy Horton virtio_dev_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
86076d4c652SHarry van Haaren 		      unsigned n)
86176d4c652SHarry van Haaren {
86276d4c652SHarry van Haaren 	unsigned i;
86376d4c652SHarry van Haaren 	unsigned count = 0;
86476d4c652SHarry van Haaren 
86501ad44fdSHuawei Xie 	unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_TXQ_XSTATS +
86601ad44fdSHuawei Xie 		dev->data->nb_rx_queues * VIRTIO_NB_RXQ_XSTATS;
86776d4c652SHarry van Haaren 
86876d4c652SHarry van Haaren 	if (n < nstats)
86976d4c652SHarry van Haaren 		return nstats;
87076d4c652SHarry van Haaren 
87176d4c652SHarry van Haaren 	for (i = 0; i < dev->data->nb_rx_queues; i++) {
87201ad44fdSHuawei Xie 		struct virtnet_rx *rxvq = dev->data->rx_queues[i];
87376d4c652SHarry van Haaren 
87476d4c652SHarry van Haaren 		if (rxvq == NULL)
87576d4c652SHarry van Haaren 			continue;
87676d4c652SHarry van Haaren 
87776d4c652SHarry van Haaren 		unsigned t;
87876d4c652SHarry van Haaren 
87901ad44fdSHuawei Xie 		for (t = 0; t < VIRTIO_NB_RXQ_XSTATS; t++) {
88076d4c652SHarry van Haaren 			xstats[count].value = *(uint64_t *)(((char *)rxvq) +
88101ad44fdSHuawei Xie 				rte_virtio_rxq_stat_strings[t].offset);
882513c78aeSOlivier Matz 			xstats[count].id = count;
88376d4c652SHarry van Haaren 			count++;
88476d4c652SHarry van Haaren 		}
88576d4c652SHarry van Haaren 	}
88676d4c652SHarry van Haaren 
88776d4c652SHarry van Haaren 	for (i = 0; i < dev->data->nb_tx_queues; i++) {
88801ad44fdSHuawei Xie 		struct virtnet_tx *txvq = dev->data->tx_queues[i];
88976d4c652SHarry van Haaren 
89076d4c652SHarry van Haaren 		if (txvq == NULL)
89176d4c652SHarry van Haaren 			continue;
89276d4c652SHarry van Haaren 
89376d4c652SHarry van Haaren 		unsigned t;
89476d4c652SHarry van Haaren 
89501ad44fdSHuawei Xie 		for (t = 0; t < VIRTIO_NB_TXQ_XSTATS; t++) {
89676d4c652SHarry van Haaren 			xstats[count].value = *(uint64_t *)(((char *)txvq) +
89701ad44fdSHuawei Xie 				rte_virtio_txq_stat_strings[t].offset);
898513c78aeSOlivier Matz 			xstats[count].id = count;
89976d4c652SHarry van Haaren 			count++;
90076d4c652SHarry van Haaren 		}
90176d4c652SHarry van Haaren 	}
90276d4c652SHarry van Haaren 
90376d4c652SHarry van Haaren 	return count;
90476d4c652SHarry van Haaren }
90576d4c652SHarry van Haaren 
906d5b0924bSMatan Azrad static int
90776d4c652SHarry van Haaren virtio_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
90876d4c652SHarry van Haaren {
90976d4c652SHarry van Haaren 	virtio_update_stats(dev, stats);
910d5b0924bSMatan Azrad 
911d5b0924bSMatan Azrad 	return 0;
91276d4c652SHarry van Haaren }
91376d4c652SHarry van Haaren 
9146c3169a3SBruce Richardson static void
9156c3169a3SBruce Richardson virtio_dev_stats_reset(struct rte_eth_dev *dev)
9166c3169a3SBruce Richardson {
9176c3169a3SBruce Richardson 	unsigned int i;
9186c3169a3SBruce Richardson 
9196c3169a3SBruce Richardson 	for (i = 0; i < dev->data->nb_tx_queues; i++) {
92001ad44fdSHuawei Xie 		struct virtnet_tx *txvq = dev->data->tx_queues[i];
9216c3169a3SBruce Richardson 		if (txvq == NULL)
9226c3169a3SBruce Richardson 			continue;
9236c3169a3SBruce Richardson 
92401ad44fdSHuawei Xie 		txvq->stats.packets = 0;
92501ad44fdSHuawei Xie 		txvq->stats.bytes = 0;
92601ad44fdSHuawei Xie 		txvq->stats.errors = 0;
92701ad44fdSHuawei Xie 		txvq->stats.multicast = 0;
92801ad44fdSHuawei Xie 		txvq->stats.broadcast = 0;
92901ad44fdSHuawei Xie 		memset(txvq->stats.size_bins, 0,
93001ad44fdSHuawei Xie 		       sizeof(txvq->stats.size_bins[0]) * 8);
9316c3169a3SBruce Richardson 	}
9326c3169a3SBruce Richardson 
9336c3169a3SBruce Richardson 	for (i = 0; i < dev->data->nb_rx_queues; i++) {
93401ad44fdSHuawei Xie 		struct virtnet_rx *rxvq = dev->data->rx_queues[i];
9356c3169a3SBruce Richardson 		if (rxvq == NULL)
9366c3169a3SBruce Richardson 			continue;
9376c3169a3SBruce Richardson 
93801ad44fdSHuawei Xie 		rxvq->stats.packets = 0;
93901ad44fdSHuawei Xie 		rxvq->stats.bytes = 0;
94001ad44fdSHuawei Xie 		rxvq->stats.errors = 0;
94101ad44fdSHuawei Xie 		rxvq->stats.multicast = 0;
94201ad44fdSHuawei Xie 		rxvq->stats.broadcast = 0;
94301ad44fdSHuawei Xie 		memset(rxvq->stats.size_bins, 0,
94401ad44fdSHuawei Xie 		       sizeof(rxvq->stats.size_bins[0]) * 8);
9456c3169a3SBruce Richardson 	}
9466c3169a3SBruce Richardson }
9476c3169a3SBruce Richardson 
9486c3169a3SBruce Richardson static void
9496c3169a3SBruce Richardson virtio_set_hwaddr(struct virtio_hw *hw)
9506c3169a3SBruce Richardson {
9516c3169a3SBruce Richardson 	vtpci_write_dev_config(hw,
9526c3169a3SBruce Richardson 			offsetof(struct virtio_net_config, mac),
9536c3169a3SBruce Richardson 			&hw->mac_addr, ETHER_ADDR_LEN);
9546c3169a3SBruce Richardson }
9556c3169a3SBruce Richardson 
9566c3169a3SBruce Richardson static void
9576c3169a3SBruce Richardson virtio_get_hwaddr(struct virtio_hw *hw)
9586c3169a3SBruce Richardson {
9596c3169a3SBruce Richardson 	if (vtpci_with_feature(hw, VIRTIO_NET_F_MAC)) {
9606c3169a3SBruce Richardson 		vtpci_read_dev_config(hw,
9616c3169a3SBruce Richardson 			offsetof(struct virtio_net_config, mac),
9626c3169a3SBruce Richardson 			&hw->mac_addr, ETHER_ADDR_LEN);
9636c3169a3SBruce Richardson 	} else {
9646c3169a3SBruce Richardson 		eth_random_addr(&hw->mac_addr[0]);
9656c3169a3SBruce Richardson 		virtio_set_hwaddr(hw);
9666c3169a3SBruce Richardson 	}
9676c3169a3SBruce Richardson }
9686c3169a3SBruce Richardson 
9696d01e580SWei Dai static int
9706c3169a3SBruce Richardson virtio_mac_table_set(struct virtio_hw *hw,
9716c3169a3SBruce Richardson 		     const struct virtio_net_ctrl_mac *uc,
9726c3169a3SBruce Richardson 		     const struct virtio_net_ctrl_mac *mc)
9736c3169a3SBruce Richardson {
9746c3169a3SBruce Richardson 	struct virtio_pmd_ctrl ctrl;
9756c3169a3SBruce Richardson 	int err, len[2];
9766c3169a3SBruce Richardson 
97727046236SStephen Hemminger 	if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) {
978e9083127SJianfeng Tan 		PMD_DRV_LOG(INFO, "host does not support mac table");
9796d01e580SWei Dai 		return -1;
98027046236SStephen Hemminger 	}
98127046236SStephen Hemminger 
9826c3169a3SBruce Richardson 	ctrl.hdr.class = VIRTIO_NET_CTRL_MAC;
9836c3169a3SBruce Richardson 	ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_TABLE_SET;
9846c3169a3SBruce Richardson 
9856c3169a3SBruce Richardson 	len[0] = uc->entries * ETHER_ADDR_LEN + sizeof(uc->entries);
9866c3169a3SBruce Richardson 	memcpy(ctrl.data, uc, len[0]);
9876c3169a3SBruce Richardson 
9886c3169a3SBruce Richardson 	len[1] = mc->entries * ETHER_ADDR_LEN + sizeof(mc->entries);
9896c3169a3SBruce Richardson 	memcpy(ctrl.data + len[0], mc, len[1]);
9906c3169a3SBruce Richardson 
9916c3169a3SBruce Richardson 	err = virtio_send_command(hw->cvq, &ctrl, len, 2);
9926c3169a3SBruce Richardson 	if (err != 0)
9936c3169a3SBruce Richardson 		PMD_DRV_LOG(NOTICE, "mac table set failed: %d", err);
9946d01e580SWei Dai 	return err;
9956c3169a3SBruce Richardson }
9966c3169a3SBruce Richardson 
9976d01e580SWei Dai static int
9986c3169a3SBruce Richardson virtio_mac_addr_add(struct rte_eth_dev *dev, struct ether_addr *mac_addr,
9996c3169a3SBruce Richardson 		    uint32_t index, uint32_t vmdq __rte_unused)
10006c3169a3SBruce Richardson {
10016c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
10026c3169a3SBruce Richardson 	const struct ether_addr *addrs = dev->data->mac_addrs;
10036c3169a3SBruce Richardson 	unsigned int i;
10046c3169a3SBruce Richardson 	struct virtio_net_ctrl_mac *uc, *mc;
10056c3169a3SBruce Richardson 
10066c3169a3SBruce Richardson 	if (index >= VIRTIO_MAX_MAC_ADDRS) {
10076c3169a3SBruce Richardson 		PMD_DRV_LOG(ERR, "mac address index %u out of range", index);
10086d01e580SWei Dai 		return -EINVAL;
10096c3169a3SBruce Richardson 	}
10106c3169a3SBruce Richardson 
10116c3169a3SBruce Richardson 	uc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(uc->entries));
10126c3169a3SBruce Richardson 	uc->entries = 0;
10136c3169a3SBruce Richardson 	mc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(mc->entries));
10146c3169a3SBruce Richardson 	mc->entries = 0;
10156c3169a3SBruce Richardson 
10166c3169a3SBruce Richardson 	for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) {
10176c3169a3SBruce Richardson 		const struct ether_addr *addr
10186c3169a3SBruce Richardson 			= (i == index) ? mac_addr : addrs + i;
10196c3169a3SBruce Richardson 		struct virtio_net_ctrl_mac *tbl
10206c3169a3SBruce Richardson 			= is_multicast_ether_addr(addr) ? mc : uc;
10216c3169a3SBruce Richardson 
10226c3169a3SBruce Richardson 		memcpy(&tbl->macs[tbl->entries++], addr, ETHER_ADDR_LEN);
10236c3169a3SBruce Richardson 	}
10246c3169a3SBruce Richardson 
10256d01e580SWei Dai 	return virtio_mac_table_set(hw, uc, mc);
10266c3169a3SBruce Richardson }
10276c3169a3SBruce Richardson 
10286c3169a3SBruce Richardson static void
10296c3169a3SBruce Richardson virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index)
10306c3169a3SBruce Richardson {
10316c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
10326c3169a3SBruce Richardson 	struct ether_addr *addrs = dev->data->mac_addrs;
10336c3169a3SBruce Richardson 	struct virtio_net_ctrl_mac *uc, *mc;
10346c3169a3SBruce Richardson 	unsigned int i;
10356c3169a3SBruce Richardson 
10366c3169a3SBruce Richardson 	if (index >= VIRTIO_MAX_MAC_ADDRS) {
10376c3169a3SBruce Richardson 		PMD_DRV_LOG(ERR, "mac address index %u out of range", index);
10386c3169a3SBruce Richardson 		return;
10396c3169a3SBruce Richardson 	}
10406c3169a3SBruce Richardson 
10416c3169a3SBruce Richardson 	uc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(uc->entries));
10426c3169a3SBruce Richardson 	uc->entries = 0;
10436c3169a3SBruce Richardson 	mc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(mc->entries));
10446c3169a3SBruce Richardson 	mc->entries = 0;
10456c3169a3SBruce Richardson 
10466c3169a3SBruce Richardson 	for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) {
10476c3169a3SBruce Richardson 		struct virtio_net_ctrl_mac *tbl;
10486c3169a3SBruce Richardson 
10496c3169a3SBruce Richardson 		if (i == index || is_zero_ether_addr(addrs + i))
10506c3169a3SBruce Richardson 			continue;
10516c3169a3SBruce Richardson 
10526c3169a3SBruce Richardson 		tbl = is_multicast_ether_addr(addrs + i) ? mc : uc;
10536c3169a3SBruce Richardson 		memcpy(&tbl->macs[tbl->entries++], addrs + i, ETHER_ADDR_LEN);
10546c3169a3SBruce Richardson 	}
10556c3169a3SBruce Richardson 
10566c3169a3SBruce Richardson 	virtio_mac_table_set(hw, uc, mc);
10576c3169a3SBruce Richardson }
10586c3169a3SBruce Richardson 
10596c3169a3SBruce Richardson static void
10606c3169a3SBruce Richardson virtio_mac_addr_set(struct rte_eth_dev *dev, struct ether_addr *mac_addr)
10616c3169a3SBruce Richardson {
10626c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
10636c3169a3SBruce Richardson 
10646c3169a3SBruce Richardson 	memcpy(hw->mac_addr, mac_addr, ETHER_ADDR_LEN);
10656c3169a3SBruce Richardson 
10666c3169a3SBruce Richardson 	/* Use atomic update if available */
10676c3169a3SBruce Richardson 	if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) {
10686c3169a3SBruce Richardson 		struct virtio_pmd_ctrl ctrl;
10696c3169a3SBruce Richardson 		int len = ETHER_ADDR_LEN;
10706c3169a3SBruce Richardson 
10716c3169a3SBruce Richardson 		ctrl.hdr.class = VIRTIO_NET_CTRL_MAC;
10726c3169a3SBruce Richardson 		ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_ADDR_SET;
10736c3169a3SBruce Richardson 
10746c3169a3SBruce Richardson 		memcpy(ctrl.data, mac_addr, ETHER_ADDR_LEN);
10756c3169a3SBruce Richardson 		virtio_send_command(hw->cvq, &ctrl, &len, 1);
10766c3169a3SBruce Richardson 	} else if (vtpci_with_feature(hw, VIRTIO_NET_F_MAC))
10776c3169a3SBruce Richardson 		virtio_set_hwaddr(hw);
10786c3169a3SBruce Richardson }
10796c3169a3SBruce Richardson 
10806c3169a3SBruce Richardson static int
10816c3169a3SBruce Richardson virtio_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
10826c3169a3SBruce Richardson {
10836c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
10846c3169a3SBruce Richardson 	struct virtio_pmd_ctrl ctrl;
10856c3169a3SBruce Richardson 	int len;
10866c3169a3SBruce Richardson 
10876c3169a3SBruce Richardson 	if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN))
10886c3169a3SBruce Richardson 		return -ENOTSUP;
10896c3169a3SBruce Richardson 
10906c3169a3SBruce Richardson 	ctrl.hdr.class = VIRTIO_NET_CTRL_VLAN;
10916c3169a3SBruce Richardson 	ctrl.hdr.cmd = on ? VIRTIO_NET_CTRL_VLAN_ADD : VIRTIO_NET_CTRL_VLAN_DEL;
10926c3169a3SBruce Richardson 	memcpy(ctrl.data, &vlan_id, sizeof(vlan_id));
10936c3169a3SBruce Richardson 	len = sizeof(vlan_id);
10946c3169a3SBruce Richardson 
10956c3169a3SBruce Richardson 	return virtio_send_command(hw->cvq, &ctrl, &len, 1);
10966c3169a3SBruce Richardson }
10976c3169a3SBruce Richardson 
10986ba1f63bSYuanhan Liu static int
1099fe19d49cSZhiyong Yang virtio_intr_enable(struct rte_eth_dev *dev)
1100fe19d49cSZhiyong Yang {
1101fe19d49cSZhiyong Yang 	struct virtio_hw *hw = dev->data->dev_private;
1102fe19d49cSZhiyong Yang 
1103fe19d49cSZhiyong Yang 	if (rte_intr_enable(dev->intr_handle) < 0)
1104fe19d49cSZhiyong Yang 		return -1;
1105fe19d49cSZhiyong Yang 
1106fe19d49cSZhiyong Yang 	if (!hw->virtio_user_dev)
1107fe19d49cSZhiyong Yang 		hw->use_msix = vtpci_msix_detect(RTE_ETH_DEV_TO_PCI(dev));
1108fe19d49cSZhiyong Yang 
1109fe19d49cSZhiyong Yang 	return 0;
1110fe19d49cSZhiyong Yang }
1111fe19d49cSZhiyong Yang 
1112fe19d49cSZhiyong Yang static int
1113fe19d49cSZhiyong Yang virtio_intr_disable(struct rte_eth_dev *dev)
1114fe19d49cSZhiyong Yang {
1115fe19d49cSZhiyong Yang 	struct virtio_hw *hw = dev->data->dev_private;
1116fe19d49cSZhiyong Yang 
1117fe19d49cSZhiyong Yang 	if (rte_intr_disable(dev->intr_handle) < 0)
1118fe19d49cSZhiyong Yang 		return -1;
1119fe19d49cSZhiyong Yang 
1120fe19d49cSZhiyong Yang 	if (!hw->virtio_user_dev)
1121fe19d49cSZhiyong Yang 		hw->use_msix = vtpci_msix_detect(RTE_ETH_DEV_TO_PCI(dev));
1122fe19d49cSZhiyong Yang 
1123fe19d49cSZhiyong Yang 	return 0;
1124fe19d49cSZhiyong Yang }
1125fe19d49cSZhiyong Yang 
1126fe19d49cSZhiyong Yang static int
112760e6f470SOlivier Matz virtio_negotiate_features(struct virtio_hw *hw, uint64_t req_features)
11286c3169a3SBruce Richardson {
11293891f233SYuanhan Liu 	uint64_t host_features;
11306c3169a3SBruce Richardson 
11316c3169a3SBruce Richardson 	/* Prepare guest_features: feature that driver wants to support */
11323891f233SYuanhan Liu 	PMD_INIT_LOG(DEBUG, "guest_features before negotiate = %" PRIx64,
113360e6f470SOlivier Matz 		req_features);
11346c3169a3SBruce Richardson 
11356c3169a3SBruce Richardson 	/* Read device(host) feature bits */
1136553f4593SYuanhan Liu 	host_features = VTPCI_OPS(hw)->get_features(hw);
11373891f233SYuanhan Liu 	PMD_INIT_LOG(DEBUG, "host_features before negotiate = %" PRIx64,
11386c3169a3SBruce Richardson 		host_features);
11396c3169a3SBruce Richardson 
114049d26d9eSMaxime Coquelin 	/* If supported, ensure MTU value is valid before acknowledging it. */
114149d26d9eSMaxime Coquelin 	if (host_features & req_features & (1ULL << VIRTIO_NET_F_MTU)) {
114249d26d9eSMaxime Coquelin 		struct virtio_net_config config;
114349d26d9eSMaxime Coquelin 
114449d26d9eSMaxime Coquelin 		vtpci_read_dev_config(hw,
114549d26d9eSMaxime Coquelin 			offsetof(struct virtio_net_config, mtu),
114649d26d9eSMaxime Coquelin 			&config.mtu, sizeof(config.mtu));
114749d26d9eSMaxime Coquelin 
114849d26d9eSMaxime Coquelin 		if (config.mtu < ETHER_MIN_MTU)
114949d26d9eSMaxime Coquelin 			req_features &= ~(1ULL << VIRTIO_NET_F_MTU);
115049d26d9eSMaxime Coquelin 	}
115149d26d9eSMaxime Coquelin 
11526c3169a3SBruce Richardson 	/*
11536c3169a3SBruce Richardson 	 * Negotiate features: Subset of device feature bits are written back
11546c3169a3SBruce Richardson 	 * guest feature bits.
11556c3169a3SBruce Richardson 	 */
115660e6f470SOlivier Matz 	hw->guest_features = req_features;
11576c3169a3SBruce Richardson 	hw->guest_features = vtpci_negotiate_features(hw, host_features);
11583891f233SYuanhan Liu 	PMD_INIT_LOG(DEBUG, "features after negotiate = %" PRIx64,
11596c3169a3SBruce Richardson 		hw->guest_features);
11606ba1f63bSYuanhan Liu 
11616ba1f63bSYuanhan Liu 	if (hw->modern) {
11626ba1f63bSYuanhan Liu 		if (!vtpci_with_feature(hw, VIRTIO_F_VERSION_1)) {
11636ba1f63bSYuanhan Liu 			PMD_INIT_LOG(ERR,
11646ba1f63bSYuanhan Liu 				"VIRTIO_F_VERSION_1 features is not enabled.");
11656ba1f63bSYuanhan Liu 			return -1;
11666ba1f63bSYuanhan Liu 		}
11676ba1f63bSYuanhan Liu 		vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_FEATURES_OK);
11686ba1f63bSYuanhan Liu 		if (!(vtpci_get_status(hw) & VIRTIO_CONFIG_STATUS_FEATURES_OK)) {
11696ba1f63bSYuanhan Liu 			PMD_INIT_LOG(ERR,
11706ba1f63bSYuanhan Liu 				"failed to set FEATURES_OK status!");
11716ba1f63bSYuanhan Liu 			return -1;
11726ba1f63bSYuanhan Liu 		}
11736ba1f63bSYuanhan Liu 	}
11746ba1f63bSYuanhan Liu 
117560e6f470SOlivier Matz 	hw->req_guest_features = req_features;
117660e6f470SOlivier Matz 
11776ba1f63bSYuanhan Liu 	return 0;
11786c3169a3SBruce Richardson }
11796c3169a3SBruce Richardson 
11801978a9dcSXiao Wang int
11811978a9dcSXiao Wang virtio_dev_pause(struct rte_eth_dev *dev)
11821978a9dcSXiao Wang {
11831978a9dcSXiao Wang 	struct virtio_hw *hw = dev->data->dev_private;
11841978a9dcSXiao Wang 
11851978a9dcSXiao Wang 	rte_spinlock_lock(&hw->state_lock);
11861978a9dcSXiao Wang 
11871978a9dcSXiao Wang 	if (hw->started == 0) {
11881978a9dcSXiao Wang 		/* Device is just stopped. */
11891978a9dcSXiao Wang 		rte_spinlock_unlock(&hw->state_lock);
11901978a9dcSXiao Wang 		return -1;
11911978a9dcSXiao Wang 	}
11921978a9dcSXiao Wang 	hw->started = 0;
11931978a9dcSXiao Wang 	/*
11941978a9dcSXiao Wang 	 * Prevent the worker threads from touching queues to avoid contention,
11951978a9dcSXiao Wang 	 * 1 ms should be enough for the ongoing Tx function to finish.
11961978a9dcSXiao Wang 	 */
11971978a9dcSXiao Wang 	rte_delay_ms(1);
11981978a9dcSXiao Wang 	return 0;
11991978a9dcSXiao Wang }
12001978a9dcSXiao Wang 
12011978a9dcSXiao Wang /*
12021978a9dcSXiao Wang  * Recover hw state to let the worker threads continue.
12031978a9dcSXiao Wang  */
12041978a9dcSXiao Wang void
12051978a9dcSXiao Wang virtio_dev_resume(struct rte_eth_dev *dev)
12061978a9dcSXiao Wang {
12071978a9dcSXiao Wang 	struct virtio_hw *hw = dev->data->dev_private;
12081978a9dcSXiao Wang 
12091978a9dcSXiao Wang 	hw->started = 1;
12101978a9dcSXiao Wang 	rte_spinlock_unlock(&hw->state_lock);
12111978a9dcSXiao Wang }
12121978a9dcSXiao Wang 
12131978a9dcSXiao Wang /*
12141978a9dcSXiao Wang  * Should be called only after device is paused.
12151978a9dcSXiao Wang  */
12161978a9dcSXiao Wang int
12171978a9dcSXiao Wang virtio_inject_pkts(struct rte_eth_dev *dev, struct rte_mbuf **tx_pkts,
12181978a9dcSXiao Wang 		int nb_pkts)
12191978a9dcSXiao Wang {
12201978a9dcSXiao Wang 	struct virtio_hw *hw = dev->data->dev_private;
12211978a9dcSXiao Wang 	struct virtnet_tx *txvq = dev->data->tx_queues[0];
12221978a9dcSXiao Wang 	int ret;
12231978a9dcSXiao Wang 
12241978a9dcSXiao Wang 	hw->inject_pkts = tx_pkts;
12251978a9dcSXiao Wang 	ret = dev->tx_pkt_burst(txvq, tx_pkts, nb_pkts);
12261978a9dcSXiao Wang 	hw->inject_pkts = NULL;
12271978a9dcSXiao Wang 
12281978a9dcSXiao Wang 	return ret;
12291978a9dcSXiao Wang }
12301978a9dcSXiao Wang 
12317365504fSXiao Wang static void
12327365504fSXiao Wang virtio_notify_peers(struct rte_eth_dev *dev)
12337365504fSXiao Wang {
12347365504fSXiao Wang 	struct virtio_hw *hw = dev->data->dev_private;
12357c7f2e60SZhiyong Yang 	struct virtnet_rx *rxvq;
12367365504fSXiao Wang 	struct rte_mbuf *rarp_mbuf;
12377365504fSXiao Wang 
12387c7f2e60SZhiyong Yang 	if (!dev->data->rx_queues)
12397c7f2e60SZhiyong Yang 		return;
12407c7f2e60SZhiyong Yang 
12417c7f2e60SZhiyong Yang 	rxvq = dev->data->rx_queues[0];
12427365504fSXiao Wang 	rarp_mbuf = rte_net_make_rarp_packet(rxvq->mpool,
12437365504fSXiao Wang 			(struct ether_addr *)hw->mac_addr);
12447365504fSXiao Wang 	if (rarp_mbuf == NULL) {
12457365504fSXiao Wang 		PMD_DRV_LOG(ERR, "failed to make RARP packet.");
12467365504fSXiao Wang 		return;
12477365504fSXiao Wang 	}
12487365504fSXiao Wang 
12497365504fSXiao Wang 	/* If virtio port just stopped, no need to send RARP */
12507365504fSXiao Wang 	if (virtio_dev_pause(dev) < 0) {
12517365504fSXiao Wang 		rte_pktmbuf_free(rarp_mbuf);
12527365504fSXiao Wang 		return;
12537365504fSXiao Wang 	}
12547365504fSXiao Wang 
12557365504fSXiao Wang 	virtio_inject_pkts(dev, &rarp_mbuf, 1);
12567365504fSXiao Wang 	virtio_dev_resume(dev);
12577365504fSXiao Wang }
12587365504fSXiao Wang 
12597365504fSXiao Wang static void
12607365504fSXiao Wang virtio_ack_link_announce(struct rte_eth_dev *dev)
12617365504fSXiao Wang {
12627365504fSXiao Wang 	struct virtio_hw *hw = dev->data->dev_private;
12637365504fSXiao Wang 	struct virtio_pmd_ctrl ctrl;
12647365504fSXiao Wang 
12657365504fSXiao Wang 	ctrl.hdr.class = VIRTIO_NET_CTRL_ANNOUNCE;
12667365504fSXiao Wang 	ctrl.hdr.cmd = VIRTIO_NET_CTRL_ANNOUNCE_ACK;
12677365504fSXiao Wang 
12687365504fSXiao Wang 	virtio_send_command(hw->cvq, &ctrl, NULL, 0);
12697365504fSXiao Wang }
12707365504fSXiao Wang 
12716c3169a3SBruce Richardson /*
12727365504fSXiao Wang  * Process virtio config changed interrupt. Call the callback
12737365504fSXiao Wang  * if link state changed, generate gratuitous RARP packet if
12747365504fSXiao Wang  * the status indicates an ANNOUNCE.
12756c3169a3SBruce Richardson  */
1276ef53b603SJianfeng Tan void
1277c23a1a30SQi Zhang virtio_interrupt_handler(void *param)
12786c3169a3SBruce Richardson {
12796c3169a3SBruce Richardson 	struct rte_eth_dev *dev = param;
12806c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
12816c3169a3SBruce Richardson 	uint8_t isr;
12826c3169a3SBruce Richardson 
12836c3169a3SBruce Richardson 	/* Read interrupt status which clears interrupt */
12846c3169a3SBruce Richardson 	isr = vtpci_isr(hw);
12856c3169a3SBruce Richardson 	PMD_DRV_LOG(INFO, "interrupt status = %#x", isr);
12866c3169a3SBruce Richardson 
1287fe19d49cSZhiyong Yang 	if (virtio_intr_enable(dev) < 0)
12886c3169a3SBruce Richardson 		PMD_DRV_LOG(ERR, "interrupt enable failed");
12896c3169a3SBruce Richardson 
12906c3169a3SBruce Richardson 	if (isr & VIRTIO_PCI_ISR_CONFIG) {
12916c3169a3SBruce Richardson 		if (virtio_dev_link_update(dev, 0) == 0)
12926c3169a3SBruce Richardson 			_rte_eth_dev_callback_process(dev,
1293d6af1a13SBernard Iremonger 						      RTE_ETH_EVENT_INTR_LSC,
1294cebe3d7bSThomas Monjalon 						      NULL);
12956c3169a3SBruce Richardson 	}
12966c3169a3SBruce Richardson 
12977365504fSXiao Wang 	if (isr & VIRTIO_NET_S_ANNOUNCE) {
12987365504fSXiao Wang 		virtio_notify_peers(dev);
1299ac860c86SZhiyong Yang 		if (hw->cvq)
13007365504fSXiao Wang 			virtio_ack_link_announce(dev);
13017365504fSXiao Wang 	}
13026c3169a3SBruce Richardson }
13036c3169a3SBruce Richardson 
13044819eae8SOlivier Matz /* set rx and tx handlers according to what is supported */
13056c3169a3SBruce Richardson static void
13064819eae8SOlivier Matz set_rxtx_funcs(struct rte_eth_dev *eth_dev)
13076c3169a3SBruce Richardson {
13086c3169a3SBruce Richardson 	struct virtio_hw *hw = eth_dev->data->dev_private;
13094819eae8SOlivier Matz 
131009649363SOlivier Matz 	if (hw->use_simple_rx) {
13114819eae8SOlivier Matz 		PMD_INIT_LOG(INFO, "virtio: using simple Rx path on port %u",
13124819eae8SOlivier Matz 			eth_dev->data->port_id);
13134819eae8SOlivier Matz 		eth_dev->rx_pkt_burst = virtio_recv_pkts_vec;
13144819eae8SOlivier Matz 	} else if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
13154819eae8SOlivier Matz 		PMD_INIT_LOG(INFO,
13164819eae8SOlivier Matz 			"virtio: using mergeable buffer Rx path on port %u",
13174819eae8SOlivier Matz 			eth_dev->data->port_id);
13186c3169a3SBruce Richardson 		eth_dev->rx_pkt_burst = &virtio_recv_mergeable_pkts;
13194819eae8SOlivier Matz 	} else {
13204819eae8SOlivier Matz 		PMD_INIT_LOG(INFO, "virtio: using standard Rx path on port %u",
13214819eae8SOlivier Matz 			eth_dev->data->port_id);
13226c3169a3SBruce Richardson 		eth_dev->rx_pkt_burst = &virtio_recv_pkts;
13236c3169a3SBruce Richardson 	}
13246c3169a3SBruce Richardson 
132509649363SOlivier Matz 	if (hw->use_simple_tx) {
13264819eae8SOlivier Matz 		PMD_INIT_LOG(INFO, "virtio: using simple Tx path on port %u",
13274819eae8SOlivier Matz 			eth_dev->data->port_id);
13284819eae8SOlivier Matz 		eth_dev->tx_pkt_burst = virtio_xmit_pkts_simple;
13294819eae8SOlivier Matz 	} else {
13304819eae8SOlivier Matz 		PMD_INIT_LOG(INFO, "virtio: using standard Tx path on port %u",
13314819eae8SOlivier Matz 			eth_dev->data->port_id);
13324819eae8SOlivier Matz 		eth_dev->tx_pkt_burst = virtio_xmit_pkts;
13334819eae8SOlivier Matz 	}
13344819eae8SOlivier Matz }
13354819eae8SOlivier Matz 
133626b683b4SJianfeng Tan /* Only support 1:1 queue/interrupt mapping so far.
133726b683b4SJianfeng Tan  * TODO: support n:1 queue/interrupt mapping when there are limited number of
133826b683b4SJianfeng Tan  * interrupt vectors (<N+1).
133926b683b4SJianfeng Tan  */
134026b683b4SJianfeng Tan static int
134126b683b4SJianfeng Tan virtio_queues_bind_intr(struct rte_eth_dev *dev)
134226b683b4SJianfeng Tan {
134326b683b4SJianfeng Tan 	uint32_t i;
134426b683b4SJianfeng Tan 	struct virtio_hw *hw = dev->data->dev_private;
134526b683b4SJianfeng Tan 
1346f2462150SFerruh Yigit 	PMD_INIT_LOG(INFO, "queue/interrupt binding");
134726b683b4SJianfeng Tan 	for (i = 0; i < dev->data->nb_rx_queues; ++i) {
134826b683b4SJianfeng Tan 		dev->intr_handle->intr_vec[i] = i + 1;
134926b683b4SJianfeng Tan 		if (VTPCI_OPS(hw)->set_queue_irq(hw, hw->vqs[i * 2], i + 1) ==
135026b683b4SJianfeng Tan 						 VIRTIO_MSI_NO_VECTOR) {
135126b683b4SJianfeng Tan 			PMD_DRV_LOG(ERR, "failed to set queue vector");
135226b683b4SJianfeng Tan 			return -EBUSY;
135326b683b4SJianfeng Tan 		}
135426b683b4SJianfeng Tan 	}
135526b683b4SJianfeng Tan 
135626b683b4SJianfeng Tan 	return 0;
135726b683b4SJianfeng Tan }
135826b683b4SJianfeng Tan 
13599ebdeefeSJianfeng Tan static void
13609ebdeefeSJianfeng Tan virtio_queues_unbind_intr(struct rte_eth_dev *dev)
13619ebdeefeSJianfeng Tan {
13629ebdeefeSJianfeng Tan 	uint32_t i;
13639ebdeefeSJianfeng Tan 	struct virtio_hw *hw = dev->data->dev_private;
13649ebdeefeSJianfeng Tan 
1365f2462150SFerruh Yigit 	PMD_INIT_LOG(INFO, "queue/interrupt unbinding");
13669ebdeefeSJianfeng Tan 	for (i = 0; i < dev->data->nb_rx_queues; ++i)
13679ebdeefeSJianfeng Tan 		VTPCI_OPS(hw)->set_queue_irq(hw,
13689ebdeefeSJianfeng Tan 					     hw->vqs[i * VTNET_CQ],
13699ebdeefeSJianfeng Tan 					     VIRTIO_MSI_NO_VECTOR);
13709ebdeefeSJianfeng Tan }
13719ebdeefeSJianfeng Tan 
137226b683b4SJianfeng Tan static int
137326b683b4SJianfeng Tan virtio_configure_intr(struct rte_eth_dev *dev)
137426b683b4SJianfeng Tan {
137526b683b4SJianfeng Tan 	struct virtio_hw *hw = dev->data->dev_private;
137626b683b4SJianfeng Tan 
137726b683b4SJianfeng Tan 	if (!rte_intr_cap_multiple(dev->intr_handle)) {
137826b683b4SJianfeng Tan 		PMD_INIT_LOG(ERR, "Multiple intr vector not supported");
137926b683b4SJianfeng Tan 		return -ENOTSUP;
138026b683b4SJianfeng Tan 	}
138126b683b4SJianfeng Tan 
138226b683b4SJianfeng Tan 	if (rte_intr_efd_enable(dev->intr_handle, dev->data->nb_rx_queues)) {
138326b683b4SJianfeng Tan 		PMD_INIT_LOG(ERR, "Fail to create eventfd");
138426b683b4SJianfeng Tan 		return -1;
138526b683b4SJianfeng Tan 	}
138626b683b4SJianfeng Tan 
138726b683b4SJianfeng Tan 	if (!dev->intr_handle->intr_vec) {
138826b683b4SJianfeng Tan 		dev->intr_handle->intr_vec =
138926b683b4SJianfeng Tan 			rte_zmalloc("intr_vec",
139026b683b4SJianfeng Tan 				    hw->max_queue_pairs * sizeof(int), 0);
139126b683b4SJianfeng Tan 		if (!dev->intr_handle->intr_vec) {
139226b683b4SJianfeng Tan 			PMD_INIT_LOG(ERR, "Failed to allocate %u rxq vectors",
139326b683b4SJianfeng Tan 				     hw->max_queue_pairs);
139426b683b4SJianfeng Tan 			return -ENOMEM;
139526b683b4SJianfeng Tan 		}
139626b683b4SJianfeng Tan 	}
139726b683b4SJianfeng Tan 
139826b683b4SJianfeng Tan 	/* Re-register callback to update max_intr */
139926b683b4SJianfeng Tan 	rte_intr_callback_unregister(dev->intr_handle,
140026b683b4SJianfeng Tan 				     virtio_interrupt_handler,
140126b683b4SJianfeng Tan 				     dev);
140226b683b4SJianfeng Tan 	rte_intr_callback_register(dev->intr_handle,
140326b683b4SJianfeng Tan 				   virtio_interrupt_handler,
140426b683b4SJianfeng Tan 				   dev);
140526b683b4SJianfeng Tan 
140626b683b4SJianfeng Tan 	/* DO NOT try to remove this! This function will enable msix, or QEMU
140726b683b4SJianfeng Tan 	 * will encounter SIGSEGV when DRIVER_OK is sent.
140826b683b4SJianfeng Tan 	 * And for legacy devices, this should be done before queue/vec binding
140926b683b4SJianfeng Tan 	 * to change the config size from 20 to 24, or VIRTIO_MSI_QUEUE_VECTOR
141026b683b4SJianfeng Tan 	 * (22) will be ignored.
141126b683b4SJianfeng Tan 	 */
1412fe19d49cSZhiyong Yang 	if (virtio_intr_enable(dev) < 0) {
141326b683b4SJianfeng Tan 		PMD_DRV_LOG(ERR, "interrupt enable failed");
141426b683b4SJianfeng Tan 		return -1;
141526b683b4SJianfeng Tan 	}
141626b683b4SJianfeng Tan 
141726b683b4SJianfeng Tan 	if (virtio_queues_bind_intr(dev) < 0) {
141826b683b4SJianfeng Tan 		PMD_INIT_LOG(ERR, "Failed to bind queue/interrupt");
141926b683b4SJianfeng Tan 		return -1;
142026b683b4SJianfeng Tan 	}
142126b683b4SJianfeng Tan 
142226b683b4SJianfeng Tan 	return 0;
142326b683b4SJianfeng Tan }
142426b683b4SJianfeng Tan 
142560e6f470SOlivier Matz /* reset device and renegotiate features if needed */
1426198ab336SOlivier Matz static int
142760e6f470SOlivier Matz virtio_init_device(struct rte_eth_dev *eth_dev, uint64_t req_features)
14286c3169a3SBruce Richardson {
14296c3169a3SBruce Richardson 	struct virtio_hw *hw = eth_dev->data->dev_private;
14306c3169a3SBruce Richardson 	struct virtio_net_config *config;
14316c3169a3SBruce Richardson 	struct virtio_net_config local_config;
14329470427cSYuanhan Liu 	struct rte_pci_device *pci_dev = NULL;
143369c80d4eSYuanhan Liu 	int ret;
14346c3169a3SBruce Richardson 
14356c3169a3SBruce Richardson 	/* Reset the device although not necessary at startup */
14366c3169a3SBruce Richardson 	vtpci_reset(hw);
14376c3169a3SBruce Richardson 
14383669a1afSOlivier Matz 	if (hw->vqs) {
14393669a1afSOlivier Matz 		virtio_dev_free_mbufs(eth_dev);
14403669a1afSOlivier Matz 		virtio_free_queues(hw);
14413669a1afSOlivier Matz 	}
14423669a1afSOlivier Matz 
14436c3169a3SBruce Richardson 	/* Tell the host we've noticed this device. */
14446c3169a3SBruce Richardson 	vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_ACK);
14456c3169a3SBruce Richardson 
14466c3169a3SBruce Richardson 	/* Tell the host we've known how to drive the device. */
14476c3169a3SBruce Richardson 	vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_DRIVER);
144860e6f470SOlivier Matz 	if (virtio_negotiate_features(hw, req_features) < 0)
14496ba1f63bSYuanhan Liu 		return -1;
14506c3169a3SBruce Richardson 
14512c2201fbSJianfeng Tan 	if (!hw->virtio_user_dev) {
1452c0802544SFerruh Yigit 		pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
1453f229eb41SJianfeng Tan 		rte_eth_copy_pci_info(eth_dev, pci_dev);
1454f229eb41SJianfeng Tan 	}
1455f229eb41SJianfeng Tan 
1456a5ed8448SMatt Peters 	/* If host does not support both status and MSI-X then disable LSC */
1457fe19d49cSZhiyong Yang 	if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS) &&
1458fe19d49cSZhiyong Yang 	    hw->use_msix != VIRTIO_MSIX_NONE)
1459198ab336SOlivier Matz 		eth_dev->data->dev_flags |= RTE_ETH_DEV_INTR_LSC;
1460a5ed8448SMatt Peters 	else
1461a5ed8448SMatt Peters 		eth_dev->data->dev_flags &= ~RTE_ETH_DEV_INTR_LSC;
1462954ea115SStephen Hemminger 
14636c3169a3SBruce Richardson 	/* Setting up rx_header size for the device */
14646ba1f63bSYuanhan Liu 	if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF) ||
14656ba1f63bSYuanhan Liu 	    vtpci_with_feature(hw, VIRTIO_F_VERSION_1))
14666c3169a3SBruce Richardson 		hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr_mrg_rxbuf);
14676c3169a3SBruce Richardson 	else
14686c3169a3SBruce Richardson 		hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr);
14696c3169a3SBruce Richardson 
14706c3169a3SBruce Richardson 	/* Copy the permanent MAC address to: virtio_hw */
14716c3169a3SBruce Richardson 	virtio_get_hwaddr(hw);
14726c3169a3SBruce Richardson 	ether_addr_copy((struct ether_addr *) hw->mac_addr,
14736c3169a3SBruce Richardson 			&eth_dev->data->mac_addrs[0]);
14746c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG,
14756c3169a3SBruce Richardson 		     "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X",
14766c3169a3SBruce Richardson 		     hw->mac_addr[0], hw->mac_addr[1], hw->mac_addr[2],
14776c3169a3SBruce Richardson 		     hw->mac_addr[3], hw->mac_addr[4], hw->mac_addr[5]);
14786c3169a3SBruce Richardson 
14796c3169a3SBruce Richardson 	if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ)) {
14806c3169a3SBruce Richardson 		config = &local_config;
14816c3169a3SBruce Richardson 
14826d7740e2SChangchun Ouyang 		vtpci_read_dev_config(hw,
14836d7740e2SChangchun Ouyang 			offsetof(struct virtio_net_config, mac),
14846d7740e2SChangchun Ouyang 			&config->mac, sizeof(config->mac));
14856d7740e2SChangchun Ouyang 
14866c3169a3SBruce Richardson 		if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) {
14876d7740e2SChangchun Ouyang 			vtpci_read_dev_config(hw,
14886d7740e2SChangchun Ouyang 				offsetof(struct virtio_net_config, status),
14896d7740e2SChangchun Ouyang 				&config->status, sizeof(config->status));
14906c3169a3SBruce Richardson 		} else {
14916c3169a3SBruce Richardson 			PMD_INIT_LOG(DEBUG,
14926c3169a3SBruce Richardson 				     "VIRTIO_NET_F_STATUS is not supported");
14936c3169a3SBruce Richardson 			config->status = 0;
14946c3169a3SBruce Richardson 		}
14956c3169a3SBruce Richardson 
14966c3169a3SBruce Richardson 		if (vtpci_with_feature(hw, VIRTIO_NET_F_MQ)) {
14976d7740e2SChangchun Ouyang 			vtpci_read_dev_config(hw,
14986d7740e2SChangchun Ouyang 				offsetof(struct virtio_net_config, max_virtqueue_pairs),
14996d7740e2SChangchun Ouyang 				&config->max_virtqueue_pairs,
15006d7740e2SChangchun Ouyang 				sizeof(config->max_virtqueue_pairs));
15016c3169a3SBruce Richardson 		} else {
15026c3169a3SBruce Richardson 			PMD_INIT_LOG(DEBUG,
15036c3169a3SBruce Richardson 				     "VIRTIO_NET_F_MQ is not supported");
15046c3169a3SBruce Richardson 			config->max_virtqueue_pairs = 1;
15056c3169a3SBruce Richardson 		}
15066c3169a3SBruce Richardson 
150745e4acd4SOlivier Matz 		hw->max_queue_pairs = config->max_virtqueue_pairs;
15086c3169a3SBruce Richardson 
150949d26d9eSMaxime Coquelin 		if (vtpci_with_feature(hw, VIRTIO_NET_F_MTU)) {
151049d26d9eSMaxime Coquelin 			vtpci_read_dev_config(hw,
151149d26d9eSMaxime Coquelin 				offsetof(struct virtio_net_config, mtu),
151249d26d9eSMaxime Coquelin 				&config->mtu,
151349d26d9eSMaxime Coquelin 				sizeof(config->mtu));
151449d26d9eSMaxime Coquelin 
151549d26d9eSMaxime Coquelin 			/*
151649d26d9eSMaxime Coquelin 			 * MTU value has already been checked at negotiation
151749d26d9eSMaxime Coquelin 			 * time, but check again in case it has changed since
151849d26d9eSMaxime Coquelin 			 * then, which should not happen.
151949d26d9eSMaxime Coquelin 			 */
152049d26d9eSMaxime Coquelin 			if (config->mtu < ETHER_MIN_MTU) {
152149d26d9eSMaxime Coquelin 				PMD_INIT_LOG(ERR, "invalid max MTU value (%u)",
152249d26d9eSMaxime Coquelin 						config->mtu);
152349d26d9eSMaxime Coquelin 				return -1;
152449d26d9eSMaxime Coquelin 			}
152549d26d9eSMaxime Coquelin 
152649d26d9eSMaxime Coquelin 			hw->max_mtu = config->mtu;
152749d26d9eSMaxime Coquelin 			/* Set initial MTU to maximum one supported by vhost */
152849d26d9eSMaxime Coquelin 			eth_dev->data->mtu = config->mtu;
152949d26d9eSMaxime Coquelin 
153049d26d9eSMaxime Coquelin 		} else {
153149d26d9eSMaxime Coquelin 			hw->max_mtu = VIRTIO_MAX_RX_PKTLEN - ETHER_HDR_LEN -
153249d26d9eSMaxime Coquelin 				VLAN_TAG_LEN - hw->vtnet_hdr_size;
153349d26d9eSMaxime Coquelin 		}
153449d26d9eSMaxime Coquelin 
15356c3169a3SBruce Richardson 		PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=%d",
15366c3169a3SBruce Richardson 				config->max_virtqueue_pairs);
15376c3169a3SBruce Richardson 		PMD_INIT_LOG(DEBUG, "config->status=%d", config->status);
15386c3169a3SBruce Richardson 		PMD_INIT_LOG(DEBUG,
15396c3169a3SBruce Richardson 				"PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X",
15406c3169a3SBruce Richardson 				config->mac[0], config->mac[1],
15416c3169a3SBruce Richardson 				config->mac[2], config->mac[3],
15426c3169a3SBruce Richardson 				config->mac[4], config->mac[5]);
15436c3169a3SBruce Richardson 	} else {
154445e4acd4SOlivier Matz 		PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=1");
154545e4acd4SOlivier Matz 		hw->max_queue_pairs = 1;
1546240da8b2SZhike Wang 		hw->max_mtu = VIRTIO_MAX_RX_PKTLEN - ETHER_HDR_LEN -
1547240da8b2SZhike Wang 			VLAN_TAG_LEN - hw->vtnet_hdr_size;
15486c3169a3SBruce Richardson 	}
15496c3169a3SBruce Richardson 
155069c80d4eSYuanhan Liu 	ret = virtio_alloc_queues(eth_dev);
155169c80d4eSYuanhan Liu 	if (ret < 0)
155269c80d4eSYuanhan Liu 		return ret;
155326b683b4SJianfeng Tan 
155426b683b4SJianfeng Tan 	if (eth_dev->data->dev_conf.intr_conf.rxq) {
155526b683b4SJianfeng Tan 		if (virtio_configure_intr(eth_dev) < 0) {
155626b683b4SJianfeng Tan 			PMD_INIT_LOG(ERR, "failed to configure interrupt");
155726b683b4SJianfeng Tan 			return -1;
155826b683b4SJianfeng Tan 		}
155926b683b4SJianfeng Tan 	}
156026b683b4SJianfeng Tan 
1561ee85024cSYuanhan Liu 	vtpci_reinit_complete(hw);
156269c80d4eSYuanhan Liu 
1563ce2eabddSJianfeng Tan 	if (pci_dev)
15646c3169a3SBruce Richardson 		PMD_INIT_LOG(DEBUG, "port %d vendorID=0x%x deviceID=0x%x",
15656c3169a3SBruce Richardson 			eth_dev->data->port_id, pci_dev->id.vendor_id,
15666c3169a3SBruce Richardson 			pci_dev->id.device_id);
15676c3169a3SBruce Richardson 
1568198ab336SOlivier Matz 	return 0;
1569198ab336SOlivier Matz }
1570198ab336SOlivier Matz 
1571198ab336SOlivier Matz /*
15726d890f8aSYuanhan Liu  * Remap the PCI device again (IO port map for legacy device and
15736d890f8aSYuanhan Liu  * memory map for modern device), so that the secondary process
15746d890f8aSYuanhan Liu  * could have the PCI initiated correctly.
15756d890f8aSYuanhan Liu  */
15766d890f8aSYuanhan Liu static int
15776d890f8aSYuanhan Liu virtio_remap_pci(struct rte_pci_device *pci_dev, struct virtio_hw *hw)
15786d890f8aSYuanhan Liu {
15796d890f8aSYuanhan Liu 	if (hw->modern) {
15806d890f8aSYuanhan Liu 		/*
15816d890f8aSYuanhan Liu 		 * We don't have to re-parse the PCI config space, since
15823dcfe039SThomas Monjalon 		 * rte_pci_map_device() makes sure the mapped address
15836d890f8aSYuanhan Liu 		 * in secondary process would equal to the one mapped in
15846d890f8aSYuanhan Liu 		 * the primary process: error will be returned if that
15856d890f8aSYuanhan Liu 		 * requirement is not met.
15866d890f8aSYuanhan Liu 		 *
15876d890f8aSYuanhan Liu 		 * That said, we could simply reuse all cap pointers
15886d890f8aSYuanhan Liu 		 * (such as dev_cfg, common_cfg, etc.) parsed from the
15896d890f8aSYuanhan Liu 		 * primary process, which is stored in shared memory.
15906d890f8aSYuanhan Liu 		 */
15913dcfe039SThomas Monjalon 		if (rte_pci_map_device(pci_dev)) {
15926d890f8aSYuanhan Liu 			PMD_INIT_LOG(DEBUG, "failed to map pci device!");
15936d890f8aSYuanhan Liu 			return -1;
15946d890f8aSYuanhan Liu 		}
15956d890f8aSYuanhan Liu 	} else {
15963dcfe039SThomas Monjalon 		if (rte_pci_ioport_map(pci_dev, 0, VTPCI_IO(hw)) < 0)
15976d890f8aSYuanhan Liu 			return -1;
15986d890f8aSYuanhan Liu 	}
15996d890f8aSYuanhan Liu 
16006d890f8aSYuanhan Liu 	return 0;
16016d890f8aSYuanhan Liu }
16026d890f8aSYuanhan Liu 
16036d890f8aSYuanhan Liu static void
16046d890f8aSYuanhan Liu virtio_set_vtpci_ops(struct virtio_hw *hw)
16056d890f8aSYuanhan Liu {
1606e754c959SThomas Monjalon #ifdef RTE_VIRTIO_USER
16076d890f8aSYuanhan Liu 	if (hw->virtio_user_dev)
16086d890f8aSYuanhan Liu 		VTPCI_OPS(hw) = &virtio_user_ops;
1609e754c959SThomas Monjalon 	else
1610e754c959SThomas Monjalon #endif
1611e754c959SThomas Monjalon 	if (hw->modern)
16126d890f8aSYuanhan Liu 		VTPCI_OPS(hw) = &modern_ops;
16136d890f8aSYuanhan Liu 	else
16146d890f8aSYuanhan Liu 		VTPCI_OPS(hw) = &legacy_ops;
16156d890f8aSYuanhan Liu }
16166d890f8aSYuanhan Liu 
16176d890f8aSYuanhan Liu /*
1618198ab336SOlivier Matz  * This function is based on probe() function in virtio_pci.c
1619198ab336SOlivier Matz  * It returns 0 on success.
1620198ab336SOlivier Matz  */
1621198ab336SOlivier Matz int
1622198ab336SOlivier Matz eth_virtio_dev_init(struct rte_eth_dev *eth_dev)
1623198ab336SOlivier Matz {
1624198ab336SOlivier Matz 	struct virtio_hw *hw = eth_dev->data->dev_private;
1625198ab336SOlivier Matz 	int ret;
1626198ab336SOlivier Matz 
1627198ab336SOlivier Matz 	RTE_BUILD_BUG_ON(RTE_PKTMBUF_HEADROOM < sizeof(struct virtio_net_hdr_mrg_rxbuf));
1628198ab336SOlivier Matz 
1629198ab336SOlivier Matz 	eth_dev->dev_ops = &virtio_eth_dev_ops;
1630198ab336SOlivier Matz 
1631198ab336SOlivier Matz 	if (rte_eal_process_type() == RTE_PROC_SECONDARY) {
16326d890f8aSYuanhan Liu 		if (!hw->virtio_user_dev) {
1633c0802544SFerruh Yigit 			ret = virtio_remap_pci(RTE_ETH_DEV_TO_PCI(eth_dev), hw);
16346d890f8aSYuanhan Liu 			if (ret)
16356d890f8aSYuanhan Liu 				return ret;
16366d890f8aSYuanhan Liu 		}
16376d890f8aSYuanhan Liu 
16386d890f8aSYuanhan Liu 		virtio_set_vtpci_ops(hw);
16394819eae8SOlivier Matz 		set_rxtx_funcs(eth_dev);
16404819eae8SOlivier Matz 
1641198ab336SOlivier Matz 		return 0;
1642198ab336SOlivier Matz 	}
1643198ab336SOlivier Matz 
1644198ab336SOlivier Matz 	/* Allocate memory for storing MAC addresses */
1645198ab336SOlivier Matz 	eth_dev->data->mac_addrs = rte_zmalloc("virtio", VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN, 0);
1646198ab336SOlivier Matz 	if (eth_dev->data->mac_addrs == NULL) {
1647198ab336SOlivier Matz 		PMD_INIT_LOG(ERR,
1648198ab336SOlivier Matz 			"Failed to allocate %d bytes needed to store MAC addresses",
1649198ab336SOlivier Matz 			VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN);
1650198ab336SOlivier Matz 		return -ENOMEM;
1651198ab336SOlivier Matz 	}
1652198ab336SOlivier Matz 
165376873125SYuanhan Liu 	hw->port_id = eth_dev->data->port_id;
16546a7c0dfcSJan Blunck 	/* For virtio_user case the hw->virtio_user_dev is populated by
16556a7c0dfcSJan Blunck 	 * virtio_user_eth_dev_alloc() before eth_virtio_dev_init() is called.
16566a7c0dfcSJan Blunck 	 */
16576a7c0dfcSJan Blunck 	if (!hw->virtio_user_dev) {
1658c0802544SFerruh Yigit 		ret = vtpci_init(RTE_ETH_DEV_TO_PCI(eth_dev), hw);
1659198ab336SOlivier Matz 		if (ret)
166043d18765SPengzhen Liu 			goto out;
1661198ab336SOlivier Matz 	}
1662198ab336SOlivier Matz 
166360e6f470SOlivier Matz 	/* reset device and negotiate default features */
166496cb6711SOlivier Matz 	ret = virtio_init_device(eth_dev, VIRTIO_PMD_DEFAULT_GUEST_FEATURES);
1665198ab336SOlivier Matz 	if (ret < 0)
166643d18765SPengzhen Liu 		goto out;
1667198ab336SOlivier Matz 
16686c3169a3SBruce Richardson 	/* Setup interrupt callback  */
166962a785a6SJianfeng Tan 	if (eth_dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)
167061e3ee17SYuanhan Liu 		rte_intr_callback_register(eth_dev->intr_handle,
16716c3169a3SBruce Richardson 			virtio_interrupt_handler, eth_dev);
16726c3169a3SBruce Richardson 
16736c3169a3SBruce Richardson 	return 0;
167443d18765SPengzhen Liu 
167543d18765SPengzhen Liu out:
167643d18765SPengzhen Liu 	rte_free(eth_dev->data->mac_addrs);
167743d18765SPengzhen Liu 	return ret;
16786c3169a3SBruce Richardson }
16796c3169a3SBruce Richardson 
1680abf4c84bSBernard Iremonger static int
1681abf4c84bSBernard Iremonger eth_virtio_dev_uninit(struct rte_eth_dev *eth_dev)
1682abf4c84bSBernard Iremonger {
1683abf4c84bSBernard Iremonger 	PMD_INIT_FUNC_TRACE();
1684abf4c84bSBernard Iremonger 
1685abf4c84bSBernard Iremonger 	if (rte_eal_process_type() == RTE_PROC_SECONDARY)
1686abf4c84bSBernard Iremonger 		return -EPERM;
1687abf4c84bSBernard Iremonger 
16883f3b3d54SYuanhan Liu 	virtio_dev_stop(eth_dev);
1689abf4c84bSBernard Iremonger 	virtio_dev_close(eth_dev);
1690abf4c84bSBernard Iremonger 
1691abf4c84bSBernard Iremonger 	eth_dev->dev_ops = NULL;
1692abf4c84bSBernard Iremonger 	eth_dev->tx_pkt_burst = NULL;
1693abf4c84bSBernard Iremonger 	eth_dev->rx_pkt_burst = NULL;
1694abf4c84bSBernard Iremonger 
1695abf4c84bSBernard Iremonger 	rte_free(eth_dev->data->mac_addrs);
1696abf4c84bSBernard Iremonger 	eth_dev->data->mac_addrs = NULL;
1697abf4c84bSBernard Iremonger 
1698abf4c84bSBernard Iremonger 	/* reset interrupt callback  */
169962a785a6SJianfeng Tan 	if (eth_dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)
170061e3ee17SYuanhan Liu 		rte_intr_callback_unregister(eth_dev->intr_handle,
1701abf4c84bSBernard Iremonger 						virtio_interrupt_handler,
1702abf4c84bSBernard Iremonger 						eth_dev);
17039470427cSYuanhan Liu 	if (eth_dev->device)
1704c0802544SFerruh Yigit 		rte_pci_unmap_device(RTE_ETH_DEV_TO_PCI(eth_dev));
1705abf4c84bSBernard Iremonger 
1706abf4c84bSBernard Iremonger 	PMD_INIT_LOG(DEBUG, "dev_uninit completed");
1707abf4c84bSBernard Iremonger 
1708abf4c84bSBernard Iremonger 	return 0;
1709abf4c84bSBernard Iremonger }
1710abf4c84bSBernard Iremonger 
1711fdf91e0fSJan Blunck static int eth_virtio_pci_probe(struct rte_pci_driver *pci_drv __rte_unused,
1712fdf91e0fSJan Blunck 	struct rte_pci_device *pci_dev)
1713fdf91e0fSJan Blunck {
1714fdf91e0fSJan Blunck 	return rte_eth_dev_pci_generic_probe(pci_dev, sizeof(struct virtio_hw),
1715fdf91e0fSJan Blunck 		eth_virtio_dev_init);
1716fdf91e0fSJan Blunck }
1717fdf91e0fSJan Blunck 
1718fdf91e0fSJan Blunck static int eth_virtio_pci_remove(struct rte_pci_device *pci_dev)
1719fdf91e0fSJan Blunck {
1720fdf91e0fSJan Blunck 	return rte_eth_dev_pci_generic_remove(pci_dev, eth_virtio_dev_uninit);
1721fdf91e0fSJan Blunck }
1722fdf91e0fSJan Blunck 
1723fdf91e0fSJan Blunck static struct rte_pci_driver rte_virtio_pmd = {
1724cd433ce5SDavid Marchand 	.driver = {
1725cd433ce5SDavid Marchand 		.name = "net_virtio",
1726cd433ce5SDavid Marchand 	},
17276c3169a3SBruce Richardson 	.id_table = pci_id_virtio_map,
172822dda618SBen Walker 	.drv_flags = 0,
1729fdf91e0fSJan Blunck 	.probe = eth_virtio_pci_probe,
1730fdf91e0fSJan Blunck 	.remove = eth_virtio_pci_remove,
17316c3169a3SBruce Richardson };
17326c3169a3SBruce Richardson 
1733c830cb29SDavid Marchand RTE_INIT(rte_virtio_pmd_init);
1734c830cb29SDavid Marchand static void
1735c830cb29SDavid Marchand rte_virtio_pmd_init(void)
17366c3169a3SBruce Richardson {
17376c3169a3SBruce Richardson 	if (rte_eal_iopl_init() != 0) {
17386c3169a3SBruce Richardson 		PMD_INIT_LOG(ERR, "IOPL call failed - cannot use virtio PMD");
1739c830cb29SDavid Marchand 		return;
17406c3169a3SBruce Richardson 	}
17416c3169a3SBruce Richardson 
17423dcfe039SThomas Monjalon 	rte_pci_register(&rte_virtio_pmd);
17436c3169a3SBruce Richardson }
17446c3169a3SBruce Richardson 
17456c3169a3SBruce Richardson /*
17466c3169a3SBruce Richardson  * Configure virtio device
17476c3169a3SBruce Richardson  * It returns 0 on success.
17486c3169a3SBruce Richardson  */
17496c3169a3SBruce Richardson static int
17506c3169a3SBruce Richardson virtio_dev_configure(struct rte_eth_dev *dev)
17516c3169a3SBruce Richardson {
17526c3169a3SBruce Richardson 	const struct rte_eth_rxmode *rxmode = &dev->data->dev_conf.rxmode;
17536c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
1754ec9f3d12SOlivier Matz 	uint64_t req_features;
1755e7b9d1d2SJiayu Hu 	int ret;
17566c3169a3SBruce Richardson 
17576c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG, "configure");
1758ec9f3d12SOlivier Matz 	req_features = VIRTIO_PMD_DEFAULT_GUEST_FEATURES;
17594dab342bSStephen Hemminger 
1760e7b9d1d2SJiayu Hu 	if (dev->data->dev_conf.intr_conf.rxq) {
1761e7b9d1d2SJiayu Hu 		ret = virtio_init_device(dev, hw->req_guest_features);
1762e7b9d1d2SJiayu Hu 		if (ret < 0)
1763e7b9d1d2SJiayu Hu 			return ret;
1764e7b9d1d2SJiayu Hu 	}
1765e7b9d1d2SJiayu Hu 
1766d67d86ceSOlivier Matz 	/* The name hw_ip_checksum is a bit confusing since it can be
1767d67d86ceSOlivier Matz 	 * set by the application to request L3 and/or L4 checksums. In
1768d67d86ceSOlivier Matz 	 * case of virtio, only L4 checksum is supported.
1769d67d86ceSOlivier Matz 	 */
1770d67d86ceSOlivier Matz 	if (rxmode->hw_ip_checksum)
1771d67d86ceSOlivier Matz 		req_features |= (1ULL << VIRTIO_NET_F_GUEST_CSUM);
1772d67d86ceSOlivier Matz 
1773ec9f3d12SOlivier Matz 	if (rxmode->enable_lro)
1774ec9f3d12SOlivier Matz 		req_features |=
1775ec9f3d12SOlivier Matz 			(1ULL << VIRTIO_NET_F_GUEST_TSO4) |
1776ec9f3d12SOlivier Matz 			(1ULL << VIRTIO_NET_F_GUEST_TSO6);
17776c3169a3SBruce Richardson 
1778ec9f3d12SOlivier Matz 	/* if request features changed, reinit the device */
1779ec9f3d12SOlivier Matz 	if (req_features != hw->req_guest_features) {
1780ec9f3d12SOlivier Matz 		ret = virtio_init_device(dev, req_features);
1781ec9f3d12SOlivier Matz 		if (ret < 0)
1782ec9f3d12SOlivier Matz 			return ret;
1783ec9f3d12SOlivier Matz 	}
1784ec9f3d12SOlivier Matz 
1785d67d86ceSOlivier Matz 	if (rxmode->hw_ip_checksum &&
1786d67d86ceSOlivier Matz 		!vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_CSUM)) {
178778fd97c3SOlivier Matz 		PMD_DRV_LOG(ERR,
1788d67d86ceSOlivier Matz 			"rx checksum not available on this host");
1789d67d86ceSOlivier Matz 		return -ENOTSUP;
1790d67d86ceSOlivier Matz 	}
1791d67d86ceSOlivier Matz 
1792ec9f3d12SOlivier Matz 	if (rxmode->enable_lro &&
1793ec9f3d12SOlivier Matz 		(!vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_TSO4) ||
1794b628cb24STiwei Bie 		 !vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_TSO6))) {
179578fd97c3SOlivier Matz 		PMD_DRV_LOG(ERR,
1796ec9f3d12SOlivier Matz 			"Large Receive Offload not available on this host");
179786d59b21SOlivier Matz 		return -ENOTSUP;
179886d59b21SOlivier Matz 	}
179986d59b21SOlivier Matz 
180069c80d4eSYuanhan Liu 	/* start control queue */
180169c80d4eSYuanhan Liu 	if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ))
180245e4acd4SOlivier Matz 		virtio_dev_cq_start(dev);
180345e4acd4SOlivier Matz 
18046c3169a3SBruce Richardson 	hw->vlan_strip = rxmode->hw_vlan_strip;
18056c3169a3SBruce Richardson 
18066c3169a3SBruce Richardson 	if (rxmode->hw_vlan_filter
18076c3169a3SBruce Richardson 	    && !vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) {
180878fd97c3SOlivier Matz 		PMD_DRV_LOG(ERR,
18096c3169a3SBruce Richardson 			    "vlan filtering not available on this host");
18106c3169a3SBruce Richardson 		return -ENOTSUP;
18116c3169a3SBruce Richardson 	}
18126c3169a3SBruce Richardson 
181362a785a6SJianfeng Tan 	if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)
1814981e61f5SJianfeng Tan 		/* Enable vector (0) for Link State Intrerrupt */
1815981e61f5SJianfeng Tan 		if (VTPCI_OPS(hw)->set_config_irq(hw, 0) ==
1816981e61f5SJianfeng Tan 				VIRTIO_MSI_NO_VECTOR) {
18176c3169a3SBruce Richardson 			PMD_DRV_LOG(ERR, "failed to set config vector");
18186c3169a3SBruce Richardson 			return -EBUSY;
18196c3169a3SBruce Richardson 		}
18206c3169a3SBruce Richardson 
18211978a9dcSXiao Wang 	rte_spinlock_init(&hw->state_lock);
18221978a9dcSXiao Wang 
182309649363SOlivier Matz 	hw->use_simple_rx = 1;
182409649363SOlivier Matz 	hw->use_simple_tx = 1;
18254819eae8SOlivier Matz 
18268f3d451dSSamuel Gauthier #if defined RTE_ARCH_ARM64 || defined RTE_ARCH_ARM
182709649363SOlivier Matz 	if (!rte_cpu_get_flag_enabled(RTE_CPUFLAG_NEON)) {
182809649363SOlivier Matz 		hw->use_simple_rx = 0;
182909649363SOlivier Matz 		hw->use_simple_tx = 0;
183009649363SOlivier Matz 	}
18314819eae8SOlivier Matz #endif
183209649363SOlivier Matz 	if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
183309649363SOlivier Matz 		hw->use_simple_rx = 0;
183409649363SOlivier Matz 		hw->use_simple_tx = 0;
183509649363SOlivier Matz 	}
18364819eae8SOlivier Matz 
183716e48c9eSOlivier Matz 	if (rxmode->hw_ip_checksum)
183816e48c9eSOlivier Matz 		hw->use_simple_rx = 0;
183916e48c9eSOlivier Matz 
18406c3169a3SBruce Richardson 	return 0;
18416c3169a3SBruce Richardson }
18426c3169a3SBruce Richardson 
18436c3169a3SBruce Richardson 
18446c3169a3SBruce Richardson static int
18456c3169a3SBruce Richardson virtio_dev_start(struct rte_eth_dev *dev)
18466c3169a3SBruce Richardson {
18476c3169a3SBruce Richardson 	uint16_t nb_queues, i;
184801ad44fdSHuawei Xie 	struct virtnet_rx *rxvq;
184901ad44fdSHuawei Xie 	struct virtnet_tx *txvq __rte_unused;
1850663c7679SYuanhan Liu 	struct virtio_hw *hw = dev->data->dev_private;
1851efc83a1eSOlivier Matz 	int ret;
1852efc83a1eSOlivier Matz 
1853efc83a1eSOlivier Matz 	/* Finish the initialization of the queues */
1854efc83a1eSOlivier Matz 	for (i = 0; i < dev->data->nb_rx_queues; i++) {
1855efc83a1eSOlivier Matz 		ret = virtio_dev_rx_queue_setup_finish(dev, i);
1856efc83a1eSOlivier Matz 		if (ret < 0)
1857efc83a1eSOlivier Matz 			return ret;
1858efc83a1eSOlivier Matz 	}
1859efc83a1eSOlivier Matz 	for (i = 0; i < dev->data->nb_tx_queues; i++) {
1860efc83a1eSOlivier Matz 		ret = virtio_dev_tx_queue_setup_finish(dev, i);
1861efc83a1eSOlivier Matz 		if (ret < 0)
1862efc83a1eSOlivier Matz 			return ret;
1863efc83a1eSOlivier Matz 	}
18646c3169a3SBruce Richardson 
18656c3169a3SBruce Richardson 	/* check if lsc interrupt feature is enabled */
1866954ea115SStephen Hemminger 	if (dev->data->dev_conf.intr_conf.lsc) {
186762a785a6SJianfeng Tan 		if (!(dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)) {
18686c3169a3SBruce Richardson 			PMD_DRV_LOG(ERR, "link status not supported by host");
18696c3169a3SBruce Richardson 			return -ENOTSUP;
18706c3169a3SBruce Richardson 		}
1871349a447bSJianfeng Tan 	}
1872349a447bSJianfeng Tan 
1873349a447bSJianfeng Tan 	/* Enable uio/vfio intr/eventfd mapping: althrough we already did that
1874349a447bSJianfeng Tan 	 * in device configure, but it could be unmapped  when device is
1875349a447bSJianfeng Tan 	 * stopped.
1876349a447bSJianfeng Tan 	 */
1877349a447bSJianfeng Tan 	if (dev->data->dev_conf.intr_conf.lsc ||
1878349a447bSJianfeng Tan 	    dev->data->dev_conf.intr_conf.rxq) {
1879fe19d49cSZhiyong Yang 		virtio_intr_disable(dev);
18806c3169a3SBruce Richardson 
1881fe19d49cSZhiyong Yang 		if (virtio_intr_enable(dev) < 0) {
18826c3169a3SBruce Richardson 			PMD_DRV_LOG(ERR, "interrupt enable failed");
18836c3169a3SBruce Richardson 			return -EIO;
18846c3169a3SBruce Richardson 		}
18856c3169a3SBruce Richardson 	}
18866c3169a3SBruce Richardson 
18876c3169a3SBruce Richardson 	/*Notify the backend
18886c3169a3SBruce Richardson 	 *Otherwise the tap backend might already stop its queue due to fullness.
18896c3169a3SBruce Richardson 	 *vhost backend will have no chance to be waked up
18906c3169a3SBruce Richardson 	 */
189160d4a353SYuanhan Liu 	nb_queues = RTE_MAX(dev->data->nb_rx_queues, dev->data->nb_tx_queues);
1892663c7679SYuanhan Liu 	if (hw->max_queue_pairs > 1) {
18936c3169a3SBruce Richardson 		if (virtio_set_multiple_queues(dev, nb_queues) != 0)
18946c3169a3SBruce Richardson 			return -EINVAL;
18956c3169a3SBruce Richardson 	}
18966c3169a3SBruce Richardson 
18976c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG, "nb_queues=%d", nb_queues);
18986c3169a3SBruce Richardson 
189960d4a353SYuanhan Liu 	for (i = 0; i < dev->data->nb_rx_queues; i++) {
190001ad44fdSHuawei Xie 		rxvq = dev->data->rx_queues[i];
1901d8227497STiwei Bie 		/* Flush the old packets */
1902bcf55c93STiwei Bie 		virtqueue_rxvq_flush(rxvq->vq);
190301ad44fdSHuawei Xie 		virtqueue_notify(rxvq->vq);
190401ad44fdSHuawei Xie 	}
19056c3169a3SBruce Richardson 
1906924da8f1SSteven Luong 	for (i = 0; i < dev->data->nb_tx_queues; i++) {
1907924da8f1SSteven Luong 		txvq = dev->data->tx_queues[i];
1908924da8f1SSteven Luong 		virtqueue_notify(txvq->vq);
1909924da8f1SSteven Luong 	}
1910924da8f1SSteven Luong 
19116c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG, "Notified backend at initialization");
19126c3169a3SBruce Richardson 
191301ad44fdSHuawei Xie 	for (i = 0; i < dev->data->nb_rx_queues; i++) {
191401ad44fdSHuawei Xie 		rxvq = dev->data->rx_queues[i];
191501ad44fdSHuawei Xie 		VIRTQUEUE_DUMP(rxvq->vq);
191601ad44fdSHuawei Xie 	}
19176c3169a3SBruce Richardson 
191801ad44fdSHuawei Xie 	for (i = 0; i < dev->data->nb_tx_queues; i++) {
191901ad44fdSHuawei Xie 		txvq = dev->data->tx_queues[i];
192001ad44fdSHuawei Xie 		VIRTQUEUE_DUMP(txvq->vq);
192101ad44fdSHuawei Xie 	}
192258d9fe40SJianfeng Tan 
19234819eae8SOlivier Matz 	set_rxtx_funcs(dev);
1924aa9f0606SYuanhan Liu 	hw->started = 1;
19256c3169a3SBruce Richardson 
192658d9fe40SJianfeng Tan 	/* Initialize Link state */
192758d9fe40SJianfeng Tan 	virtio_dev_link_update(dev, 0);
192858d9fe40SJianfeng Tan 
19296c3169a3SBruce Richardson 	return 0;
19306c3169a3SBruce Richardson }
19316c3169a3SBruce Richardson 
19326c3169a3SBruce Richardson static void virtio_dev_free_mbufs(struct rte_eth_dev *dev)
19336c3169a3SBruce Richardson {
1934bdb32afbSOlivier Matz 	struct virtio_hw *hw = dev->data->dev_private;
1935bdb32afbSOlivier Matz 	uint16_t nr_vq = virtio_get_nr_vq(hw);
1936bdb32afbSOlivier Matz 	const char *type __rte_unused;
1937bdb32afbSOlivier Matz 	unsigned int i, mbuf_num = 0;
1938bdb32afbSOlivier Matz 	struct virtqueue *vq;
19396c3169a3SBruce Richardson 	struct rte_mbuf *buf;
1940bdb32afbSOlivier Matz 	int queue_type;
19416c3169a3SBruce Richardson 
1942b87c0648SDavid Harton 	if (hw->vqs == NULL)
1943b87c0648SDavid Harton 		return;
1944b87c0648SDavid Harton 
1945bdb32afbSOlivier Matz 	for (i = 0; i < nr_vq; i++) {
1946bdb32afbSOlivier Matz 		vq = hw->vqs[i];
1947bdb32afbSOlivier Matz 		if (!vq)
1948bdb32afbSOlivier Matz 			continue;
194901ad44fdSHuawei Xie 
1950bdb32afbSOlivier Matz 		queue_type = virtio_get_queue_type(hw, i);
1951bdb32afbSOlivier Matz 		if (queue_type == VTNET_RQ)
1952bdb32afbSOlivier Matz 			type = "rxq";
1953bdb32afbSOlivier Matz 		else if (queue_type == VTNET_TQ)
1954bdb32afbSOlivier Matz 			type = "txq";
1955bdb32afbSOlivier Matz 		else
19563669a1afSOlivier Matz 			continue;
19573669a1afSOlivier Matz 
19586c3169a3SBruce Richardson 		PMD_INIT_LOG(DEBUG,
1959bdb32afbSOlivier Matz 			"Before freeing %s[%d] used and unused buf",
1960bdb32afbSOlivier Matz 			type, i);
1961bdb32afbSOlivier Matz 		VIRTQUEUE_DUMP(vq);
19626c3169a3SBruce Richardson 
1963727411f5SOlivier Matz 		while ((buf = virtqueue_detach_unused(vq)) != NULL) {
19646c3169a3SBruce Richardson 			rte_pktmbuf_free(buf);
19656c3169a3SBruce Richardson 			mbuf_num++;
19666c3169a3SBruce Richardson 		}
19676c3169a3SBruce Richardson 
19686c3169a3SBruce Richardson 		PMD_INIT_LOG(DEBUG,
1969bdb32afbSOlivier Matz 			"After freeing %s[%d] used and unused buf",
1970bdb32afbSOlivier Matz 			type, i);
1971bdb32afbSOlivier Matz 		VIRTQUEUE_DUMP(vq);
19726c3169a3SBruce Richardson 	}
19736c3169a3SBruce Richardson 
1974bdb32afbSOlivier Matz 	PMD_INIT_LOG(DEBUG, "%d mbufs freed", mbuf_num);
19756c3169a3SBruce Richardson }
19766c3169a3SBruce Richardson 
19776c3169a3SBruce Richardson /*
19786c3169a3SBruce Richardson  * Stop device: disable interrupt and mark link down
19796c3169a3SBruce Richardson  */
19806c3169a3SBruce Richardson static void
19816c3169a3SBruce Richardson virtio_dev_stop(struct rte_eth_dev *dev)
19826c3169a3SBruce Richardson {
1983aa9f0606SYuanhan Liu 	struct virtio_hw *hw = dev->data->dev_private;
19846c3169a3SBruce Richardson 	struct rte_eth_link link;
1985349a447bSJianfeng Tan 	struct rte_intr_conf *intr_conf = &dev->data->dev_conf.intr_conf;
19866c3169a3SBruce Richardson 
19876c3169a3SBruce Richardson 	PMD_INIT_LOG(DEBUG, "stop");
19886c3169a3SBruce Richardson 
19891978a9dcSXiao Wang 	rte_spinlock_lock(&hw->state_lock);
1990349a447bSJianfeng Tan 	if (intr_conf->lsc || intr_conf->rxq)
1991fe19d49cSZhiyong Yang 		virtio_intr_disable(dev);
19926c3169a3SBruce Richardson 
1993aa9f0606SYuanhan Liu 	hw->started = 0;
19946c3169a3SBruce Richardson 	memset(&link, 0, sizeof(link));
1995717b2e8eSStephen Hemminger 	rte_eth_linkstatus_set(dev, &link);
19961978a9dcSXiao Wang 	rte_spinlock_unlock(&hw->state_lock);
19976c3169a3SBruce Richardson }
19986c3169a3SBruce Richardson 
19996c3169a3SBruce Richardson static int
20006c3169a3SBruce Richardson virtio_dev_link_update(struct rte_eth_dev *dev, __rte_unused int wait_to_complete)
20016c3169a3SBruce Richardson {
2002717b2e8eSStephen Hemminger 	struct rte_eth_link link;
20036c3169a3SBruce Richardson 	uint16_t status;
20046c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
2005717b2e8eSStephen Hemminger 
20066c3169a3SBruce Richardson 	memset(&link, 0, sizeof(link));
200711319000SMarc Sune 	link.link_duplex = ETH_LINK_FULL_DUPLEX;
200867090011SZhiyong Yang 	link.link_speed  = ETH_SPEED_NUM_10G;
2009717b2e8eSStephen Hemminger 	link.link_autoneg = ETH_LINK_FIXED;
20106c3169a3SBruce Richardson 
2011aa9f0606SYuanhan Liu 	if (hw->started == 0) {
2012aa9f0606SYuanhan Liu 		link.link_status = ETH_LINK_DOWN;
2013aa9f0606SYuanhan Liu 	} else if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) {
20146c3169a3SBruce Richardson 		PMD_INIT_LOG(DEBUG, "Get link status from hw");
20156c3169a3SBruce Richardson 		vtpci_read_dev_config(hw,
20166c3169a3SBruce Richardson 				offsetof(struct virtio_net_config, status),
20176c3169a3SBruce Richardson 				&status, sizeof(status));
20186c3169a3SBruce Richardson 		if ((status & VIRTIO_NET_S_LINK_UP) == 0) {
201909419f23SThomas Monjalon 			link.link_status = ETH_LINK_DOWN;
20206c3169a3SBruce Richardson 			PMD_INIT_LOG(DEBUG, "Port %d is down",
20216c3169a3SBruce Richardson 				     dev->data->port_id);
20226c3169a3SBruce Richardson 		} else {
202309419f23SThomas Monjalon 			link.link_status = ETH_LINK_UP;
20246c3169a3SBruce Richardson 			PMD_INIT_LOG(DEBUG, "Port %d is up",
20256c3169a3SBruce Richardson 				     dev->data->port_id);
20266c3169a3SBruce Richardson 		}
20276c3169a3SBruce Richardson 	} else {
202809419f23SThomas Monjalon 		link.link_status = ETH_LINK_UP;
20296c3169a3SBruce Richardson 	}
20306c3169a3SBruce Richardson 
2031717b2e8eSStephen Hemminger 	return rte_eth_linkstatus_set(dev, &link);
20326c3169a3SBruce Richardson }
20336c3169a3SBruce Richardson 
2034289ba0c0SDavid Harton static int
2035289ba0c0SDavid Harton virtio_dev_vlan_offload_set(struct rte_eth_dev *dev, int mask)
2036289ba0c0SDavid Harton {
2037289ba0c0SDavid Harton 	const struct rte_eth_rxmode *rxmode = &dev->data->dev_conf.rxmode;
2038289ba0c0SDavid Harton 	struct virtio_hw *hw = dev->data->dev_private;
2039289ba0c0SDavid Harton 
2040289ba0c0SDavid Harton 	if (mask & ETH_VLAN_FILTER_MASK) {
2041289ba0c0SDavid Harton 		if (rxmode->hw_vlan_filter &&
2042289ba0c0SDavid Harton 				!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) {
2043289ba0c0SDavid Harton 
2044289ba0c0SDavid Harton 			PMD_DRV_LOG(NOTICE,
2045289ba0c0SDavid Harton 				"vlan filtering not available on this host");
2046289ba0c0SDavid Harton 
2047289ba0c0SDavid Harton 			return -ENOTSUP;
2048289ba0c0SDavid Harton 		}
2049289ba0c0SDavid Harton 	}
2050289ba0c0SDavid Harton 
2051289ba0c0SDavid Harton 	if (mask & ETH_VLAN_STRIP_MASK)
2052289ba0c0SDavid Harton 		hw->vlan_strip = rxmode->hw_vlan_strip;
2053289ba0c0SDavid Harton 
2054289ba0c0SDavid Harton 	return 0;
2055289ba0c0SDavid Harton }
2056289ba0c0SDavid Harton 
20576c3169a3SBruce Richardson static void
20586c3169a3SBruce Richardson virtio_dev_info_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info)
20596c3169a3SBruce Richardson {
2060c1e55ed3SOlivier Matz 	uint64_t tso_mask, host_features;
20616c3169a3SBruce Richardson 	struct virtio_hw *hw = dev->data->dev_private;
20626c3169a3SBruce Richardson 
2063b392e987SIdo Barnea 	dev_info->speed_capa = ETH_LINK_SPEED_10G; /* fake value */
2064b392e987SIdo Barnea 
2065c0802544SFerruh Yigit 	dev_info->pci_dev = dev->device ? RTE_ETH_DEV_TO_PCI(dev) : NULL;
206645e4acd4SOlivier Matz 	dev_info->max_rx_queues =
206745e4acd4SOlivier Matz 		RTE_MIN(hw->max_queue_pairs, VIRTIO_MAX_RX_QUEUES);
206845e4acd4SOlivier Matz 	dev_info->max_tx_queues =
206945e4acd4SOlivier Matz 		RTE_MIN(hw->max_queue_pairs, VIRTIO_MAX_TX_QUEUES);
20706c3169a3SBruce Richardson 	dev_info->min_rx_bufsize = VIRTIO_MIN_RX_BUFSIZE;
20716c3169a3SBruce Richardson 	dev_info->max_rx_pktlen = VIRTIO_MAX_RX_PKTLEN;
20726c3169a3SBruce Richardson 	dev_info->max_mac_addrs = VIRTIO_MAX_MAC_ADDRS;
20736c3169a3SBruce Richardson 	dev_info->default_txconf = (struct rte_eth_txconf) {
20746c3169a3SBruce Richardson 		.txq_flags = ETH_TXQ_FLAGS_NOOFFLOADS
20756c3169a3SBruce Richardson 	};
207658169a9cSOlivier Matz 
2077c1e55ed3SOlivier Matz 	host_features = VTPCI_OPS(hw)->get_features(hw);
2078c1e55ed3SOlivier Matz 	dev_info->rx_offload_capa = 0;
2079c1e55ed3SOlivier Matz 	if (host_features & (1ULL << VIRTIO_NET_F_GUEST_CSUM)) {
2080c1e55ed3SOlivier Matz 		dev_info->rx_offload_capa |=
2081c1e55ed3SOlivier Matz 			DEV_RX_OFFLOAD_TCP_CKSUM |
2082c1e55ed3SOlivier Matz 			DEV_RX_OFFLOAD_UDP_CKSUM;
2083c1e55ed3SOlivier Matz 	}
2084c1e55ed3SOlivier Matz 	tso_mask = (1ULL << VIRTIO_NET_F_GUEST_TSO4) |
2085c1e55ed3SOlivier Matz 		(1ULL << VIRTIO_NET_F_GUEST_TSO6);
2086ec9f3d12SOlivier Matz 	if ((host_features & tso_mask) == tso_mask)
2087ec9f3d12SOlivier Matz 		dev_info->rx_offload_capa |= DEV_RX_OFFLOAD_TCP_LRO;
2088c1e55ed3SOlivier Matz 
2089c1e55ed3SOlivier Matz 	dev_info->tx_offload_capa = 0;
209058169a9cSOlivier Matz 	if (hw->guest_features & (1ULL << VIRTIO_NET_F_CSUM)) {
209158169a9cSOlivier Matz 		dev_info->tx_offload_capa |=
209258169a9cSOlivier Matz 			DEV_TX_OFFLOAD_UDP_CKSUM |
209358169a9cSOlivier Matz 			DEV_TX_OFFLOAD_TCP_CKSUM;
209458169a9cSOlivier Matz 	}
209569657304SOlivier Matz 	tso_mask = (1ULL << VIRTIO_NET_F_HOST_TSO4) |
209669657304SOlivier Matz 		(1ULL << VIRTIO_NET_F_HOST_TSO6);
209769657304SOlivier Matz 	if ((hw->guest_features & tso_mask) == tso_mask)
209869657304SOlivier Matz 		dev_info->tx_offload_capa |= DEV_TX_OFFLOAD_TCP_TSO;
20996c3169a3SBruce Richardson }
21006c3169a3SBruce Richardson 
21016c3169a3SBruce Richardson /*
21026c3169a3SBruce Richardson  * It enables testpmd to collect per queue stats.
21036c3169a3SBruce Richardson  */
21046c3169a3SBruce Richardson static int
21056c3169a3SBruce Richardson virtio_dev_queue_stats_mapping_set(__rte_unused struct rte_eth_dev *eth_dev,
21066c3169a3SBruce Richardson __rte_unused uint16_t queue_id, __rte_unused uint8_t stat_idx,
21076c3169a3SBruce Richardson __rte_unused uint8_t is_rx)
21086c3169a3SBruce Richardson {
21096c3169a3SBruce Richardson 	return 0;
21106c3169a3SBruce Richardson }
21116c3169a3SBruce Richardson 
211201f19227SShreyansh Jain RTE_PMD_EXPORT_NAME(net_virtio, __COUNTER__);
211301f19227SShreyansh Jain RTE_PMD_REGISTER_PCI_TABLE(net_virtio, pci_id_virtio_map);
211406e81dc9SDavid Marchand RTE_PMD_REGISTER_KMOD_DEP(net_virtio, "* igb_uio | uio_pci_generic | vfio-pci");
211500628188SStephen Hemminger 
211600628188SStephen Hemminger RTE_INIT(virtio_init_log);
211700628188SStephen Hemminger static void
211800628188SStephen Hemminger virtio_init_log(void)
211900628188SStephen Hemminger {
2120bace76f6SHarry van Haaren 	virtio_logtype_init = rte_log_register("pmd.net.virtio.init");
212100628188SStephen Hemminger 	if (virtio_logtype_init >= 0)
212200628188SStephen Hemminger 		rte_log_set_level(virtio_logtype_init, RTE_LOG_NOTICE);
2123bace76f6SHarry van Haaren 	virtio_logtype_driver = rte_log_register("pmd.net.virtio.driver");
212400628188SStephen Hemminger 	if (virtio_logtype_driver >= 0)
212500628188SStephen Hemminger 		rte_log_set_level(virtio_logtype_driver, RTE_LOG_NOTICE);
212600628188SStephen Hemminger }
2127