16c3169a3SBruce Richardson /*- 26c3169a3SBruce Richardson * BSD LICENSE 36c3169a3SBruce Richardson * 4baf91c39SRemy Horton * Copyright(c) 2010-2016 Intel Corporation. All rights reserved. 56c3169a3SBruce Richardson * All rights reserved. 66c3169a3SBruce Richardson * 76c3169a3SBruce Richardson * Redistribution and use in source and binary forms, with or without 86c3169a3SBruce Richardson * modification, are permitted provided that the following conditions 96c3169a3SBruce Richardson * are met: 106c3169a3SBruce Richardson * 116c3169a3SBruce Richardson * * Redistributions of source code must retain the above copyright 126c3169a3SBruce Richardson * notice, this list of conditions and the following disclaimer. 136c3169a3SBruce Richardson * * Redistributions in binary form must reproduce the above copyright 146c3169a3SBruce Richardson * notice, this list of conditions and the following disclaimer in 156c3169a3SBruce Richardson * the documentation and/or other materials provided with the 166c3169a3SBruce Richardson * distribution. 176c3169a3SBruce Richardson * * Neither the name of Intel Corporation nor the names of its 186c3169a3SBruce Richardson * contributors may be used to endorse or promote products derived 196c3169a3SBruce Richardson * from this software without specific prior written permission. 206c3169a3SBruce Richardson * 216c3169a3SBruce Richardson * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 226c3169a3SBruce Richardson * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 236c3169a3SBruce Richardson * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 246c3169a3SBruce Richardson * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 256c3169a3SBruce Richardson * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 266c3169a3SBruce Richardson * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 276c3169a3SBruce Richardson * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 286c3169a3SBruce Richardson * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 296c3169a3SBruce Richardson * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 306c3169a3SBruce Richardson * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 316c3169a3SBruce Richardson * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 326c3169a3SBruce Richardson */ 336c3169a3SBruce Richardson 346c3169a3SBruce Richardson #include <stdint.h> 356c3169a3SBruce Richardson #include <string.h> 366c3169a3SBruce Richardson #include <stdio.h> 376c3169a3SBruce Richardson #include <errno.h> 386c3169a3SBruce Richardson #include <unistd.h> 396c3169a3SBruce Richardson 406c3169a3SBruce Richardson #include <rte_ethdev.h> 41fdf91e0fSJan Blunck #include <rte_ethdev_pci.h> 426c3169a3SBruce Richardson #include <rte_memcpy.h> 436c3169a3SBruce Richardson #include <rte_string_fns.h> 446c3169a3SBruce Richardson #include <rte_memzone.h> 456c3169a3SBruce Richardson #include <rte_malloc.h> 466c3169a3SBruce Richardson #include <rte_atomic.h> 476c3169a3SBruce Richardson #include <rte_branch_prediction.h> 486c3169a3SBruce Richardson #include <rte_pci.h> 496c3169a3SBruce Richardson #include <rte_ether.h> 506c3169a3SBruce Richardson #include <rte_common.h> 51abf4c84bSBernard Iremonger #include <rte_errno.h> 526c3169a3SBruce Richardson 536c3169a3SBruce Richardson #include <rte_memory.h> 546c3169a3SBruce Richardson #include <rte_eal.h> 556c3169a3SBruce Richardson #include <rte_dev.h> 566c3169a3SBruce Richardson 576c3169a3SBruce Richardson #include "virtio_ethdev.h" 586c3169a3SBruce Richardson #include "virtio_pci.h" 596c3169a3SBruce Richardson #include "virtio_logs.h" 606c3169a3SBruce Richardson #include "virtqueue.h" 61cab04612SHuawei Xie #include "virtio_rxtx.h" 626c3169a3SBruce Richardson 63abf4c84bSBernard Iremonger static int eth_virtio_dev_uninit(struct rte_eth_dev *eth_dev); 646c3169a3SBruce Richardson static int virtio_dev_configure(struct rte_eth_dev *dev); 656c3169a3SBruce Richardson static int virtio_dev_start(struct rte_eth_dev *dev); 666c3169a3SBruce Richardson static void virtio_dev_stop(struct rte_eth_dev *dev); 676c3169a3SBruce Richardson static void virtio_dev_promiscuous_enable(struct rte_eth_dev *dev); 686c3169a3SBruce Richardson static void virtio_dev_promiscuous_disable(struct rte_eth_dev *dev); 696c3169a3SBruce Richardson static void virtio_dev_allmulticast_enable(struct rte_eth_dev *dev); 706c3169a3SBruce Richardson static void virtio_dev_allmulticast_disable(struct rte_eth_dev *dev); 716c3169a3SBruce Richardson static void virtio_dev_info_get(struct rte_eth_dev *dev, 726c3169a3SBruce Richardson struct rte_eth_dev_info *dev_info); 736c3169a3SBruce Richardson static int virtio_dev_link_update(struct rte_eth_dev *dev, 746c3169a3SBruce Richardson __rte_unused int wait_to_complete); 756c3169a3SBruce Richardson 766c3169a3SBruce Richardson static void virtio_set_hwaddr(struct virtio_hw *hw); 776c3169a3SBruce Richardson static void virtio_get_hwaddr(struct virtio_hw *hw); 786c3169a3SBruce Richardson 7976d4c652SHarry van Haaren static void virtio_dev_stats_get(struct rte_eth_dev *dev, 8076d4c652SHarry van Haaren struct rte_eth_stats *stats); 8176d4c652SHarry van Haaren static int virtio_dev_xstats_get(struct rte_eth_dev *dev, 82e2aae1c1SRemy Horton struct rte_eth_xstat *xstats, unsigned n); 83baf91c39SRemy Horton static int virtio_dev_xstats_get_names(struct rte_eth_dev *dev, 84baf91c39SRemy Horton struct rte_eth_xstat_name *xstats_names, 85baf91c39SRemy Horton unsigned limit); 866c3169a3SBruce Richardson static void virtio_dev_stats_reset(struct rte_eth_dev *dev); 876c3169a3SBruce Richardson static void virtio_dev_free_mbufs(struct rte_eth_dev *dev); 886c3169a3SBruce Richardson static int virtio_vlan_filter_set(struct rte_eth_dev *dev, 896c3169a3SBruce Richardson uint16_t vlan_id, int on); 906c3169a3SBruce Richardson static void virtio_mac_addr_add(struct rte_eth_dev *dev, 916c3169a3SBruce Richardson struct ether_addr *mac_addr, 926c3169a3SBruce Richardson uint32_t index, uint32_t vmdq __rte_unused); 936c3169a3SBruce Richardson static void virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index); 946c3169a3SBruce Richardson static void virtio_mac_addr_set(struct rte_eth_dev *dev, 956c3169a3SBruce Richardson struct ether_addr *mac_addr); 966c3169a3SBruce Richardson 976c3169a3SBruce Richardson static int virtio_dev_queue_stats_mapping_set( 986c3169a3SBruce Richardson __rte_unused struct rte_eth_dev *eth_dev, 996c3169a3SBruce Richardson __rte_unused uint16_t queue_id, 1006c3169a3SBruce Richardson __rte_unused uint8_t stat_idx, 1016c3169a3SBruce Richardson __rte_unused uint8_t is_rx); 1026c3169a3SBruce Richardson 1036c3169a3SBruce Richardson /* 1046c3169a3SBruce Richardson * The set of PCI devices this driver supports 1056c3169a3SBruce Richardson */ 1066c3169a3SBruce Richardson static const struct rte_pci_id pci_id_virtio_map[] = { 1074c790365SJason Wang { RTE_PCI_DEVICE(VIRTIO_PCI_VENDORID, VIRTIO_PCI_LEGACY_DEVICEID_NET) }, 1084c790365SJason Wang { RTE_PCI_DEVICE(VIRTIO_PCI_VENDORID, VIRTIO_PCI_MODERN_DEVICEID_NET) }, 1096c3169a3SBruce Richardson { .vendor_id = 0, /* sentinel */ }, 1106c3169a3SBruce Richardson }; 1116c3169a3SBruce Richardson 11276d4c652SHarry van Haaren struct rte_virtio_xstats_name_off { 11376d4c652SHarry van Haaren char name[RTE_ETH_XSTATS_NAME_SIZE]; 11476d4c652SHarry van Haaren unsigned offset; 11576d4c652SHarry van Haaren }; 11676d4c652SHarry van Haaren 11776d4c652SHarry van Haaren /* [rt]x_qX_ is prepended to the name string here */ 11801ad44fdSHuawei Xie static const struct rte_virtio_xstats_name_off rte_virtio_rxq_stat_strings[] = { 11901ad44fdSHuawei Xie {"good_packets", offsetof(struct virtnet_rx, stats.packets)}, 12001ad44fdSHuawei Xie {"good_bytes", offsetof(struct virtnet_rx, stats.bytes)}, 12101ad44fdSHuawei Xie {"errors", offsetof(struct virtnet_rx, stats.errors)}, 12201ad44fdSHuawei Xie {"multicast_packets", offsetof(struct virtnet_rx, stats.multicast)}, 12301ad44fdSHuawei Xie {"broadcast_packets", offsetof(struct virtnet_rx, stats.broadcast)}, 12401ad44fdSHuawei Xie {"undersize_packets", offsetof(struct virtnet_rx, stats.size_bins[0])}, 12501ad44fdSHuawei Xie {"size_64_packets", offsetof(struct virtnet_rx, stats.size_bins[1])}, 12601ad44fdSHuawei Xie {"size_65_127_packets", offsetof(struct virtnet_rx, stats.size_bins[2])}, 12701ad44fdSHuawei Xie {"size_128_255_packets", offsetof(struct virtnet_rx, stats.size_bins[3])}, 12801ad44fdSHuawei Xie {"size_256_511_packets", offsetof(struct virtnet_rx, stats.size_bins[4])}, 12901ad44fdSHuawei Xie {"size_512_1023_packets", offsetof(struct virtnet_rx, stats.size_bins[5])}, 13081f7234bSZhiyong Yang {"size_1024_1518_packets", offsetof(struct virtnet_rx, stats.size_bins[6])}, 13181f7234bSZhiyong Yang {"size_1519_max_packets", offsetof(struct virtnet_rx, stats.size_bins[7])}, 13276d4c652SHarry van Haaren }; 13376d4c652SHarry van Haaren 13401ad44fdSHuawei Xie /* [rt]x_qX_ is prepended to the name string here */ 13501ad44fdSHuawei Xie static const struct rte_virtio_xstats_name_off rte_virtio_txq_stat_strings[] = { 13601ad44fdSHuawei Xie {"good_packets", offsetof(struct virtnet_tx, stats.packets)}, 13701ad44fdSHuawei Xie {"good_bytes", offsetof(struct virtnet_tx, stats.bytes)}, 13801ad44fdSHuawei Xie {"errors", offsetof(struct virtnet_tx, stats.errors)}, 13901ad44fdSHuawei Xie {"multicast_packets", offsetof(struct virtnet_tx, stats.multicast)}, 14001ad44fdSHuawei Xie {"broadcast_packets", offsetof(struct virtnet_tx, stats.broadcast)}, 14101ad44fdSHuawei Xie {"undersize_packets", offsetof(struct virtnet_tx, stats.size_bins[0])}, 14201ad44fdSHuawei Xie {"size_64_packets", offsetof(struct virtnet_tx, stats.size_bins[1])}, 14301ad44fdSHuawei Xie {"size_65_127_packets", offsetof(struct virtnet_tx, stats.size_bins[2])}, 14401ad44fdSHuawei Xie {"size_128_255_packets", offsetof(struct virtnet_tx, stats.size_bins[3])}, 14501ad44fdSHuawei Xie {"size_256_511_packets", offsetof(struct virtnet_tx, stats.size_bins[4])}, 14601ad44fdSHuawei Xie {"size_512_1023_packets", offsetof(struct virtnet_tx, stats.size_bins[5])}, 14781f7234bSZhiyong Yang {"size_1024_1518_packets", offsetof(struct virtnet_tx, stats.size_bins[6])}, 14881f7234bSZhiyong Yang {"size_1519_max_packets", offsetof(struct virtnet_tx, stats.size_bins[7])}, 14901ad44fdSHuawei Xie }; 15001ad44fdSHuawei Xie 15101ad44fdSHuawei Xie #define VIRTIO_NB_RXQ_XSTATS (sizeof(rte_virtio_rxq_stat_strings) / \ 15201ad44fdSHuawei Xie sizeof(rte_virtio_rxq_stat_strings[0])) 15301ad44fdSHuawei Xie #define VIRTIO_NB_TXQ_XSTATS (sizeof(rte_virtio_txq_stat_strings) / \ 15401ad44fdSHuawei Xie sizeof(rte_virtio_txq_stat_strings[0])) 15576d4c652SHarry van Haaren 156553f4593SYuanhan Liu struct virtio_hw_internal virtio_hw_internal[RTE_MAX_ETHPORTS]; 157553f4593SYuanhan Liu 1586c3169a3SBruce Richardson static int 15901ad44fdSHuawei Xie virtio_send_command(struct virtnet_ctl *cvq, struct virtio_pmd_ctrl *ctrl, 1606c3169a3SBruce Richardson int *dlen, int pkt_num) 1616c3169a3SBruce Richardson { 1629e71668bSDamjan Marion uint32_t head, i; 1636c3169a3SBruce Richardson int k, sum = 0; 1646c3169a3SBruce Richardson virtio_net_ctrl_ack status = ~0; 1656c3169a3SBruce Richardson struct virtio_pmd_ctrl result; 16601ad44fdSHuawei Xie struct virtqueue *vq; 1676c3169a3SBruce Richardson 1686c3169a3SBruce Richardson ctrl->status = status; 1696c3169a3SBruce Richardson 1703bd60a27SJianfeng Tan if (!cvq || !cvq->vq) { 1710bb159adSHuawei Xie PMD_INIT_LOG(ERR, "Control queue is not supported."); 1726c3169a3SBruce Richardson return -1; 1736c3169a3SBruce Richardson } 17401ad44fdSHuawei Xie vq = cvq->vq; 1759e71668bSDamjan Marion head = vq->vq_desc_head_idx; 1766c3169a3SBruce Richardson 1776c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "vq->vq_desc_head_idx = %d, status = %d, " 1786c3169a3SBruce Richardson "vq->hw->cvq = %p vq = %p", 1796c3169a3SBruce Richardson vq->vq_desc_head_idx, status, vq->hw->cvq, vq); 1806c3169a3SBruce Richardson 1816c3169a3SBruce Richardson if ((vq->vq_free_cnt < ((uint32_t)pkt_num + 2)) || (pkt_num < 1)) 1826c3169a3SBruce Richardson return -1; 1836c3169a3SBruce Richardson 18401ad44fdSHuawei Xie memcpy(cvq->virtio_net_hdr_mz->addr, ctrl, 1856c3169a3SBruce Richardson sizeof(struct virtio_pmd_ctrl)); 1866c3169a3SBruce Richardson 1876c3169a3SBruce Richardson /* 1886c3169a3SBruce Richardson * Format is enforced in qemu code: 1896c3169a3SBruce Richardson * One TX packet for header; 1906c3169a3SBruce Richardson * At least one TX packet per argument; 1916c3169a3SBruce Richardson * One RX packet for ACK. 1926c3169a3SBruce Richardson */ 1936c3169a3SBruce Richardson vq->vq_ring.desc[head].flags = VRING_DESC_F_NEXT; 194f24f8f9fSJianfeng Tan vq->vq_ring.desc[head].addr = cvq->virtio_net_hdr_mem; 1956c3169a3SBruce Richardson vq->vq_ring.desc[head].len = sizeof(struct virtio_net_ctrl_hdr); 1966c3169a3SBruce Richardson vq->vq_free_cnt--; 1976c3169a3SBruce Richardson i = vq->vq_ring.desc[head].next; 1986c3169a3SBruce Richardson 1996c3169a3SBruce Richardson for (k = 0; k < pkt_num; k++) { 2006c3169a3SBruce Richardson vq->vq_ring.desc[i].flags = VRING_DESC_F_NEXT; 201f24f8f9fSJianfeng Tan vq->vq_ring.desc[i].addr = cvq->virtio_net_hdr_mem 2026c3169a3SBruce Richardson + sizeof(struct virtio_net_ctrl_hdr) 2036c3169a3SBruce Richardson + sizeof(ctrl->status) + sizeof(uint8_t)*sum; 2046c3169a3SBruce Richardson vq->vq_ring.desc[i].len = dlen[k]; 2056c3169a3SBruce Richardson sum += dlen[k]; 2066c3169a3SBruce Richardson vq->vq_free_cnt--; 2076c3169a3SBruce Richardson i = vq->vq_ring.desc[i].next; 2086c3169a3SBruce Richardson } 2096c3169a3SBruce Richardson 2106c3169a3SBruce Richardson vq->vq_ring.desc[i].flags = VRING_DESC_F_WRITE; 211f24f8f9fSJianfeng Tan vq->vq_ring.desc[i].addr = cvq->virtio_net_hdr_mem 2126c3169a3SBruce Richardson + sizeof(struct virtio_net_ctrl_hdr); 2136c3169a3SBruce Richardson vq->vq_ring.desc[i].len = sizeof(ctrl->status); 2146c3169a3SBruce Richardson vq->vq_free_cnt--; 2156c3169a3SBruce Richardson 2166c3169a3SBruce Richardson vq->vq_desc_head_idx = vq->vq_ring.desc[i].next; 2176c3169a3SBruce Richardson 2186c3169a3SBruce Richardson vq_update_avail_ring(vq, head); 2196c3169a3SBruce Richardson vq_update_avail_idx(vq); 2206c3169a3SBruce Richardson 2216c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "vq->vq_queue_index = %d", vq->vq_queue_index); 2226c3169a3SBruce Richardson 2236c3169a3SBruce Richardson virtqueue_notify(vq); 2246c3169a3SBruce Richardson 2256c3169a3SBruce Richardson rte_rmb(); 226b81026f1SHuawei Xie while (VIRTQUEUE_NUSED(vq) == 0) { 2276c3169a3SBruce Richardson rte_rmb(); 2286c3169a3SBruce Richardson usleep(100); 2296c3169a3SBruce Richardson } 2306c3169a3SBruce Richardson 231b81026f1SHuawei Xie while (VIRTQUEUE_NUSED(vq)) { 2326c3169a3SBruce Richardson uint32_t idx, desc_idx, used_idx; 2336c3169a3SBruce Richardson struct vring_used_elem *uep; 2346c3169a3SBruce Richardson 2356c3169a3SBruce Richardson used_idx = (uint32_t)(vq->vq_used_cons_idx 2366c3169a3SBruce Richardson & (vq->vq_nentries - 1)); 2376c3169a3SBruce Richardson uep = &vq->vq_ring.used->ring[used_idx]; 2386c3169a3SBruce Richardson idx = (uint32_t) uep->id; 2396c3169a3SBruce Richardson desc_idx = idx; 2406c3169a3SBruce Richardson 2416c3169a3SBruce Richardson while (vq->vq_ring.desc[desc_idx].flags & VRING_DESC_F_NEXT) { 2426c3169a3SBruce Richardson desc_idx = vq->vq_ring.desc[desc_idx].next; 2436c3169a3SBruce Richardson vq->vq_free_cnt++; 2446c3169a3SBruce Richardson } 2456c3169a3SBruce Richardson 2466c3169a3SBruce Richardson vq->vq_ring.desc[desc_idx].next = vq->vq_desc_head_idx; 2476c3169a3SBruce Richardson vq->vq_desc_head_idx = idx; 2486c3169a3SBruce Richardson 2496c3169a3SBruce Richardson vq->vq_used_cons_idx++; 2506c3169a3SBruce Richardson vq->vq_free_cnt++; 2516c3169a3SBruce Richardson } 2526c3169a3SBruce Richardson 2536c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "vq->vq_free_cnt=%d\nvq->vq_desc_head_idx=%d", 2546c3169a3SBruce Richardson vq->vq_free_cnt, vq->vq_desc_head_idx); 2556c3169a3SBruce Richardson 25601ad44fdSHuawei Xie memcpy(&result, cvq->virtio_net_hdr_mz->addr, 2576c3169a3SBruce Richardson sizeof(struct virtio_pmd_ctrl)); 2586c3169a3SBruce Richardson 2596c3169a3SBruce Richardson return result.status; 2606c3169a3SBruce Richardson } 2616c3169a3SBruce Richardson 2626c3169a3SBruce Richardson static int 2636c3169a3SBruce Richardson virtio_set_multiple_queues(struct rte_eth_dev *dev, uint16_t nb_queues) 2646c3169a3SBruce Richardson { 2656c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 2666c3169a3SBruce Richardson struct virtio_pmd_ctrl ctrl; 2676c3169a3SBruce Richardson int dlen[1]; 2686c3169a3SBruce Richardson int ret; 2696c3169a3SBruce Richardson 2706c3169a3SBruce Richardson ctrl.hdr.class = VIRTIO_NET_CTRL_MQ; 2716c3169a3SBruce Richardson ctrl.hdr.cmd = VIRTIO_NET_CTRL_MQ_VQ_PAIRS_SET; 2726c3169a3SBruce Richardson memcpy(ctrl.data, &nb_queues, sizeof(uint16_t)); 2736c3169a3SBruce Richardson 2746c3169a3SBruce Richardson dlen[0] = sizeof(uint16_t); 2756c3169a3SBruce Richardson 2766c3169a3SBruce Richardson ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 2776c3169a3SBruce Richardson if (ret) { 2786c3169a3SBruce Richardson PMD_INIT_LOG(ERR, "Multiqueue configured but send command " 2796c3169a3SBruce Richardson "failed, this is too late now..."); 2806c3169a3SBruce Richardson return -EINVAL; 2816c3169a3SBruce Richardson } 2826c3169a3SBruce Richardson 2836c3169a3SBruce Richardson return 0; 2846c3169a3SBruce Richardson } 2856c3169a3SBruce Richardson 28669c80d4eSYuanhan Liu static void 28769c80d4eSYuanhan Liu virtio_dev_queue_release(void *queue __rte_unused) 2882963d99aSJianfeng Tan { 28969c80d4eSYuanhan Liu /* do nothing */ 2905382b188SBernard Iremonger } 2915382b188SBernard Iremonger 29269c80d4eSYuanhan Liu static int 29369c80d4eSYuanhan Liu virtio_get_queue_type(struct virtio_hw *hw, uint16_t vtpci_queue_idx) 29469c80d4eSYuanhan Liu { 29569c80d4eSYuanhan Liu if (vtpci_queue_idx == hw->max_queue_pairs * 2) 29669c80d4eSYuanhan Liu return VTNET_CQ; 29769c80d4eSYuanhan Liu else if (vtpci_queue_idx % 2 == 0) 29869c80d4eSYuanhan Liu return VTNET_RQ; 29969c80d4eSYuanhan Liu else 30069c80d4eSYuanhan Liu return VTNET_TQ; 30169c80d4eSYuanhan Liu } 30269c80d4eSYuanhan Liu 30369c80d4eSYuanhan Liu static uint16_t 30469c80d4eSYuanhan Liu virtio_get_nr_vq(struct virtio_hw *hw) 30569c80d4eSYuanhan Liu { 30669c80d4eSYuanhan Liu uint16_t nr_vq = hw->max_queue_pairs * 2; 30769c80d4eSYuanhan Liu 30869c80d4eSYuanhan Liu if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ)) 30969c80d4eSYuanhan Liu nr_vq += 1; 31069c80d4eSYuanhan Liu 31169c80d4eSYuanhan Liu return nr_vq; 31269c80d4eSYuanhan Liu } 31369c80d4eSYuanhan Liu 314f4d1ad15SYuanhan Liu static void 315f4d1ad15SYuanhan Liu virtio_init_vring(struct virtqueue *vq) 316f4d1ad15SYuanhan Liu { 317f4d1ad15SYuanhan Liu int size = vq->vq_nentries; 318f4d1ad15SYuanhan Liu struct vring *vr = &vq->vq_ring; 319f4d1ad15SYuanhan Liu uint8_t *ring_mem = vq->vq_ring_virt_mem; 320f4d1ad15SYuanhan Liu 321f4d1ad15SYuanhan Liu PMD_INIT_FUNC_TRACE(); 322f4d1ad15SYuanhan Liu 323f4d1ad15SYuanhan Liu /* 324f4d1ad15SYuanhan Liu * Reinitialise since virtio port might have been stopped and restarted 325f4d1ad15SYuanhan Liu */ 326f4d1ad15SYuanhan Liu memset(ring_mem, 0, vq->vq_ring_size); 327f4d1ad15SYuanhan Liu vring_init(vr, size, ring_mem, VIRTIO_PCI_VRING_ALIGN); 328f4d1ad15SYuanhan Liu vq->vq_used_cons_idx = 0; 329f4d1ad15SYuanhan Liu vq->vq_desc_head_idx = 0; 330f4d1ad15SYuanhan Liu vq->vq_avail_idx = 0; 331f4d1ad15SYuanhan Liu vq->vq_desc_tail_idx = (uint16_t)(vq->vq_nentries - 1); 332f4d1ad15SYuanhan Liu vq->vq_free_cnt = vq->vq_nentries; 333f4d1ad15SYuanhan Liu memset(vq->vq_descx, 0, sizeof(struct vq_desc_extra) * vq->vq_nentries); 334f4d1ad15SYuanhan Liu 335f4d1ad15SYuanhan Liu vring_desc_init(vr->desc, size); 336f4d1ad15SYuanhan Liu 337f4d1ad15SYuanhan Liu /* 338f4d1ad15SYuanhan Liu * Disable device(host) interrupting guest 339f4d1ad15SYuanhan Liu */ 340f4d1ad15SYuanhan Liu virtqueue_disable_intr(vq); 341f4d1ad15SYuanhan Liu } 342f4d1ad15SYuanhan Liu 34369c80d4eSYuanhan Liu static int 34469c80d4eSYuanhan Liu virtio_init_queue(struct rte_eth_dev *dev, uint16_t vtpci_queue_idx) 3456c3169a3SBruce Richardson { 3466c3169a3SBruce Richardson char vq_name[VIRTQUEUE_MAX_NAME_SZ]; 34701ad44fdSHuawei Xie char vq_hdr_name[VIRTQUEUE_MAX_NAME_SZ]; 34801ad44fdSHuawei Xie const struct rte_memzone *mz = NULL, *hdr_mz = NULL; 3491e7bd238SStephen Hemminger unsigned int vq_size, size; 3506c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 351f24f8f9fSJianfeng Tan struct virtnet_rx *rxvq = NULL; 352f24f8f9fSJianfeng Tan struct virtnet_tx *txvq = NULL; 353f24f8f9fSJianfeng Tan struct virtnet_ctl *cvq = NULL; 35401ad44fdSHuawei Xie struct virtqueue *vq; 355905a2469SYuanhan Liu size_t sz_hdr_mz = 0; 35601ad44fdSHuawei Xie void *sw_ring = NULL; 35769c80d4eSYuanhan Liu int queue_type = virtio_get_queue_type(hw, vtpci_queue_idx); 35801ad44fdSHuawei Xie int ret; 3596c3169a3SBruce Richardson 360d5bbeefcSYuanhan Liu PMD_INIT_LOG(DEBUG, "setting up queue: %u", vtpci_queue_idx); 3616c3169a3SBruce Richardson 3626c3169a3SBruce Richardson /* 3636c3169a3SBruce Richardson * Read the virtqueue size from the Queue Size field 3646c3169a3SBruce Richardson * Always power of 2 and if 0 virtqueue does not exist 3656c3169a3SBruce Richardson */ 366553f4593SYuanhan Liu vq_size = VTPCI_OPS(hw)->get_queue_num(hw, vtpci_queue_idx); 36769c80d4eSYuanhan Liu PMD_INIT_LOG(DEBUG, "vq_size: %u", vq_size); 3686c3169a3SBruce Richardson if (vq_size == 0) { 3690bb159adSHuawei Xie PMD_INIT_LOG(ERR, "virtqueue does not exist"); 3706c3169a3SBruce Richardson return -EINVAL; 371d78deadaSStephen Hemminger } 372d78deadaSStephen Hemminger 373d78deadaSStephen Hemminger if (!rte_is_power_of_2(vq_size)) { 3740bb159adSHuawei Xie PMD_INIT_LOG(ERR, "virtqueue size is not powerof 2"); 3756c3169a3SBruce Richardson return -EINVAL; 376d78deadaSStephen Hemminger } 377d78deadaSStephen Hemminger 37873d017ddSYuanhan Liu snprintf(vq_name, sizeof(vq_name), "port%d_vq%d", 37973d017ddSYuanhan Liu dev->data->port_id, vtpci_queue_idx); 38001ad44fdSHuawei Xie 381905a2469SYuanhan Liu size = RTE_ALIGN_CEIL(sizeof(*vq) + 3826c3169a3SBruce Richardson vq_size * sizeof(struct vq_desc_extra), 3836c3169a3SBruce Richardson RTE_CACHE_LINE_SIZE); 384905a2469SYuanhan Liu if (queue_type == VTNET_TQ) { 38501ad44fdSHuawei Xie /* 38601ad44fdSHuawei Xie * For each xmit packet, allocate a virtio_net_hdr 38701ad44fdSHuawei Xie * and indirect ring elements 38801ad44fdSHuawei Xie */ 38901ad44fdSHuawei Xie sz_hdr_mz = vq_size * sizeof(struct virtio_tx_region); 39001ad44fdSHuawei Xie } else if (queue_type == VTNET_CQ) { 39101ad44fdSHuawei Xie /* Allocate a page for control vq command, data and status */ 39201ad44fdSHuawei Xie sz_hdr_mz = PAGE_SIZE; 39301ad44fdSHuawei Xie } 3944166bbf6SJianfeng Tan 39569c80d4eSYuanhan Liu vq = rte_zmalloc_socket(vq_name, size, RTE_CACHE_LINE_SIZE, 39669c80d4eSYuanhan Liu SOCKET_ID_ANY); 39701ad44fdSHuawei Xie if (vq == NULL) { 39801ad44fdSHuawei Xie PMD_INIT_LOG(ERR, "can not allocate vq"); 399cab04612SHuawei Xie return -ENOMEM; 400cab04612SHuawei Xie } 40169c80d4eSYuanhan Liu hw->vqs[vtpci_queue_idx] = vq; 40269c80d4eSYuanhan Liu 4036c3169a3SBruce Richardson vq->hw = hw; 4046c3169a3SBruce Richardson vq->vq_queue_index = vtpci_queue_idx; 4056c3169a3SBruce Richardson vq->vq_nentries = vq_size; 4066c3169a3SBruce Richardson 4076c3169a3SBruce Richardson /* 4086c3169a3SBruce Richardson * Reserve a memzone for vring elements 4096c3169a3SBruce Richardson */ 4106c3169a3SBruce Richardson size = vring_size(vq_size, VIRTIO_PCI_VRING_ALIGN); 4116c3169a3SBruce Richardson vq->vq_ring_size = RTE_ALIGN_CEIL(size, VIRTIO_PCI_VRING_ALIGN); 41201ad44fdSHuawei Xie PMD_INIT_LOG(DEBUG, "vring_size: %d, rounded_vring_size: %d", 41301ad44fdSHuawei Xie size, vq->vq_ring_size); 4146c3169a3SBruce Richardson 41569c80d4eSYuanhan Liu mz = rte_memzone_reserve_aligned(vq_name, vq->vq_ring_size, 41669c80d4eSYuanhan Liu SOCKET_ID_ANY, 41701ad44fdSHuawei Xie 0, VIRTIO_PCI_VRING_ALIGN); 4186c3169a3SBruce Richardson if (mz == NULL) { 419abf4c84bSBernard Iremonger if (rte_errno == EEXIST) 420abf4c84bSBernard Iremonger mz = rte_memzone_lookup(vq_name); 421abf4c84bSBernard Iremonger if (mz == NULL) { 42201ad44fdSHuawei Xie ret = -ENOMEM; 42301ad44fdSHuawei Xie goto fail_q_alloc; 4246c3169a3SBruce Richardson } 425abf4c84bSBernard Iremonger } 4266c3169a3SBruce Richardson 4276c3169a3SBruce Richardson memset(mz->addr, 0, sizeof(mz->len)); 42801ad44fdSHuawei Xie 4296c3169a3SBruce Richardson vq->vq_ring_mem = mz->phys_addr; 4306c3169a3SBruce Richardson vq->vq_ring_virt_mem = mz->addr; 43101ad44fdSHuawei Xie PMD_INIT_LOG(DEBUG, "vq->vq_ring_mem: 0x%" PRIx64, 43201ad44fdSHuawei Xie (uint64_t)mz->phys_addr); 43301ad44fdSHuawei Xie PMD_INIT_LOG(DEBUG, "vq->vq_ring_virt_mem: 0x%" PRIx64, 43401ad44fdSHuawei Xie (uint64_t)(uintptr_t)mz->addr); 4356c3169a3SBruce Richardson 436f4d1ad15SYuanhan Liu virtio_init_vring(vq); 437f4d1ad15SYuanhan Liu 43801ad44fdSHuawei Xie if (sz_hdr_mz) { 43973d017ddSYuanhan Liu snprintf(vq_hdr_name, sizeof(vq_hdr_name), "port%d_vq%d_hdr", 44073d017ddSYuanhan Liu dev->data->port_id, vtpci_queue_idx); 44101ad44fdSHuawei Xie hdr_mz = rte_memzone_reserve_aligned(vq_hdr_name, sz_hdr_mz, 44269c80d4eSYuanhan Liu SOCKET_ID_ANY, 0, 4436dc5de3aSStephen Hemminger RTE_CACHE_LINE_SIZE); 4446dc5de3aSStephen Hemminger if (hdr_mz == NULL) { 445abf4c84bSBernard Iremonger if (rte_errno == EEXIST) 44601ad44fdSHuawei Xie hdr_mz = rte_memzone_lookup(vq_hdr_name); 4476dc5de3aSStephen Hemminger if (hdr_mz == NULL) { 44801ad44fdSHuawei Xie ret = -ENOMEM; 44901ad44fdSHuawei Xie goto fail_q_alloc; 4506c3169a3SBruce Richardson } 451abf4c84bSBernard Iremonger } 45201ad44fdSHuawei Xie } 45301ad44fdSHuawei Xie 45401ad44fdSHuawei Xie if (queue_type == VTNET_RQ) { 45501ad44fdSHuawei Xie size_t sz_sw = (RTE_PMD_VIRTIO_RX_MAX_BURST + vq_size) * 45601ad44fdSHuawei Xie sizeof(vq->sw_ring[0]); 45701ad44fdSHuawei Xie 45801ad44fdSHuawei Xie sw_ring = rte_zmalloc_socket("sw_ring", sz_sw, 45969c80d4eSYuanhan Liu RTE_CACHE_LINE_SIZE, SOCKET_ID_ANY); 46001ad44fdSHuawei Xie if (!sw_ring) { 46101ad44fdSHuawei Xie PMD_INIT_LOG(ERR, "can not allocate RX soft ring"); 46201ad44fdSHuawei Xie ret = -ENOMEM; 46301ad44fdSHuawei Xie goto fail_q_alloc; 46401ad44fdSHuawei Xie } 46501ad44fdSHuawei Xie 46601ad44fdSHuawei Xie vq->sw_ring = sw_ring; 467905a2469SYuanhan Liu rxvq = &vq->rxq; 46801ad44fdSHuawei Xie rxvq->vq = vq; 46901ad44fdSHuawei Xie rxvq->port_id = dev->data->port_id; 47001ad44fdSHuawei Xie rxvq->mz = mz; 47101ad44fdSHuawei Xie } else if (queue_type == VTNET_TQ) { 472905a2469SYuanhan Liu txvq = &vq->txq; 47301ad44fdSHuawei Xie txvq->vq = vq; 47401ad44fdSHuawei Xie txvq->port_id = dev->data->port_id; 47501ad44fdSHuawei Xie txvq->mz = mz; 47601ad44fdSHuawei Xie txvq->virtio_net_hdr_mz = hdr_mz; 47701ad44fdSHuawei Xie txvq->virtio_net_hdr_mem = hdr_mz->phys_addr; 478f24f8f9fSJianfeng Tan } else if (queue_type == VTNET_CQ) { 479905a2469SYuanhan Liu cvq = &vq->cq; 480f24f8f9fSJianfeng Tan cvq->vq = vq; 481f24f8f9fSJianfeng Tan cvq->mz = mz; 482f24f8f9fSJianfeng Tan cvq->virtio_net_hdr_mz = hdr_mz; 483f24f8f9fSJianfeng Tan cvq->virtio_net_hdr_mem = hdr_mz->phys_addr; 484f24f8f9fSJianfeng Tan memset(cvq->virtio_net_hdr_mz->addr, 0, PAGE_SIZE); 48569c80d4eSYuanhan Liu 48669c80d4eSYuanhan Liu hw->cvq = cvq; 487f24f8f9fSJianfeng Tan } 488f24f8f9fSJianfeng Tan 4896a7c0dfcSJan Blunck /* For virtio_user case (that is when hw->dev is NULL), we use 490f24f8f9fSJianfeng Tan * virtual address. And we need properly set _offset_, please see 49125f80d10SOlivier Matz * VIRTIO_MBUF_DATA_DMA_ADDR in virtqueue.h for more information. 492f24f8f9fSJianfeng Tan */ 4939470427cSYuanhan Liu if (!hw->virtio_user_dev) 494f24f8f9fSJianfeng Tan vq->offset = offsetof(struct rte_mbuf, buf_physaddr); 495f24f8f9fSJianfeng Tan else { 496f24f8f9fSJianfeng Tan vq->vq_ring_mem = (uintptr_t)mz->addr; 497f24f8f9fSJianfeng Tan vq->offset = offsetof(struct rte_mbuf, buf_addr); 498f24f8f9fSJianfeng Tan if (queue_type == VTNET_TQ) 499f24f8f9fSJianfeng Tan txvq->virtio_net_hdr_mem = (uintptr_t)hdr_mz->addr; 500f24f8f9fSJianfeng Tan else if (queue_type == VTNET_CQ) 501f24f8f9fSJianfeng Tan cvq->virtio_net_hdr_mem = (uintptr_t)hdr_mz->addr; 502f24f8f9fSJianfeng Tan } 503f24f8f9fSJianfeng Tan 504f24f8f9fSJianfeng Tan if (queue_type == VTNET_TQ) { 505f24f8f9fSJianfeng Tan struct virtio_tx_region *txr; 506f24f8f9fSJianfeng Tan unsigned int i; 507f24f8f9fSJianfeng Tan 5086dc5de3aSStephen Hemminger txr = hdr_mz->addr; 5096dc5de3aSStephen Hemminger memset(txr, 0, vq_size * sizeof(*txr)); 5106dc5de3aSStephen Hemminger for (i = 0; i < vq_size; i++) { 5116dc5de3aSStephen Hemminger struct vring_desc *start_dp = txr[i].tx_indir; 5126dc5de3aSStephen Hemminger 5136dc5de3aSStephen Hemminger vring_desc_init(start_dp, RTE_DIM(txr[i].tx_indir)); 5146dc5de3aSStephen Hemminger 5156dc5de3aSStephen Hemminger /* first indirect descriptor is always the tx header */ 51601ad44fdSHuawei Xie start_dp->addr = txvq->virtio_net_hdr_mem 5176dc5de3aSStephen Hemminger + i * sizeof(*txr) 5186dc5de3aSStephen Hemminger + offsetof(struct virtio_tx_region, tx_hdr); 5196dc5de3aSStephen Hemminger 52001ad44fdSHuawei Xie start_dp->len = hw->vtnet_hdr_size; 5216dc5de3aSStephen Hemminger start_dp->flags = VRING_DESC_F_NEXT; 5226dc5de3aSStephen Hemminger } 5236c3169a3SBruce Richardson } 5246c3169a3SBruce Richardson 525553f4593SYuanhan Liu if (VTPCI_OPS(hw)->setup_queue(hw, vq) < 0) { 526595454c5SJianfeng Tan PMD_INIT_LOG(ERR, "setup_queue failed"); 527595454c5SJianfeng Tan return -EINVAL; 528595454c5SJianfeng Tan } 529595454c5SJianfeng Tan 5306c3169a3SBruce Richardson return 0; 53101ad44fdSHuawei Xie 53201ad44fdSHuawei Xie fail_q_alloc: 53301ad44fdSHuawei Xie rte_free(sw_ring); 53401ad44fdSHuawei Xie rte_memzone_free(hdr_mz); 53501ad44fdSHuawei Xie rte_memzone_free(mz); 53601ad44fdSHuawei Xie rte_free(vq); 53701ad44fdSHuawei Xie 53801ad44fdSHuawei Xie return ret; 5396c3169a3SBruce Richardson } 5406c3169a3SBruce Richardson 54169c80d4eSYuanhan Liu static void 54269c80d4eSYuanhan Liu virtio_free_queues(struct virtio_hw *hw) 5436c3169a3SBruce Richardson { 54469c80d4eSYuanhan Liu uint16_t nr_vq = virtio_get_nr_vq(hw); 54569c80d4eSYuanhan Liu struct virtqueue *vq; 54669c80d4eSYuanhan Liu int queue_type; 54769c80d4eSYuanhan Liu uint16_t i; 5486c3169a3SBruce Richardson 5490e78cfddSHuanle Han if (hw->vqs == NULL) 5500e78cfddSHuanle Han return; 5510e78cfddSHuanle Han 55269c80d4eSYuanhan Liu for (i = 0; i < nr_vq; i++) { 55369c80d4eSYuanhan Liu vq = hw->vqs[i]; 55469c80d4eSYuanhan Liu if (!vq) 55569c80d4eSYuanhan Liu continue; 55669c80d4eSYuanhan Liu 55769c80d4eSYuanhan Liu queue_type = virtio_get_queue_type(hw, i); 55869c80d4eSYuanhan Liu if (queue_type == VTNET_RQ) { 55969c80d4eSYuanhan Liu rte_free(vq->sw_ring); 56069c80d4eSYuanhan Liu rte_memzone_free(vq->rxq.mz); 56169c80d4eSYuanhan Liu } else if (queue_type == VTNET_TQ) { 56269c80d4eSYuanhan Liu rte_memzone_free(vq->txq.mz); 56369c80d4eSYuanhan Liu rte_memzone_free(vq->txq.virtio_net_hdr_mz); 56469c80d4eSYuanhan Liu } else { 56569c80d4eSYuanhan Liu rte_memzone_free(vq->cq.mz); 56669c80d4eSYuanhan Liu rte_memzone_free(vq->cq.virtio_net_hdr_mz); 56769c80d4eSYuanhan Liu } 56869c80d4eSYuanhan Liu 56969c80d4eSYuanhan Liu rte_free(vq); 5700e78cfddSHuanle Han hw->vqs[i] = NULL; 57169c80d4eSYuanhan Liu } 57269c80d4eSYuanhan Liu 57369c80d4eSYuanhan Liu rte_free(hw->vqs); 5740e78cfddSHuanle Han hw->vqs = NULL; 57569c80d4eSYuanhan Liu } 57669c80d4eSYuanhan Liu 57769c80d4eSYuanhan Liu static int 57869c80d4eSYuanhan Liu virtio_alloc_queues(struct rte_eth_dev *dev) 57969c80d4eSYuanhan Liu { 58069c80d4eSYuanhan Liu struct virtio_hw *hw = dev->data->dev_private; 58169c80d4eSYuanhan Liu uint16_t nr_vq = virtio_get_nr_vq(hw); 58269c80d4eSYuanhan Liu uint16_t i; 58369c80d4eSYuanhan Liu int ret; 58469c80d4eSYuanhan Liu 58569c80d4eSYuanhan Liu hw->vqs = rte_zmalloc(NULL, sizeof(struct virtqueue *) * nr_vq, 0); 58669c80d4eSYuanhan Liu if (!hw->vqs) { 58769c80d4eSYuanhan Liu PMD_INIT_LOG(ERR, "failed to allocate vqs"); 58869c80d4eSYuanhan Liu return -ENOMEM; 58969c80d4eSYuanhan Liu } 59069c80d4eSYuanhan Liu 59169c80d4eSYuanhan Liu for (i = 0; i < nr_vq; i++) { 59269c80d4eSYuanhan Liu ret = virtio_init_queue(dev, i); 5936c3169a3SBruce Richardson if (ret < 0) { 59469c80d4eSYuanhan Liu virtio_free_queues(hw); 5956c3169a3SBruce Richardson return ret; 5966c3169a3SBruce Richardson } 5976c3169a3SBruce Richardson } 5986c3169a3SBruce Richardson 59969c80d4eSYuanhan Liu return 0; 600941d64b5SBernard Iremonger } 601941d64b5SBernard Iremonger 6029ebdeefeSJianfeng Tan static void virtio_queues_unbind_intr(struct rte_eth_dev *dev); 6039ebdeefeSJianfeng Tan 604941d64b5SBernard Iremonger static void 6056c3169a3SBruce Richardson virtio_dev_close(struct rte_eth_dev *dev) 6066c3169a3SBruce Richardson { 6076c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 6089ebdeefeSJianfeng Tan struct rte_intr_conf *intr_conf = &dev->data->dev_conf.intr_conf; 6096c3169a3SBruce Richardson 6106c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "virtio_dev_close"); 6116c3169a3SBruce Richardson 6126c3169a3SBruce Richardson /* reset the NIC */ 61362a785a6SJianfeng Tan if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) 614981e61f5SJianfeng Tan VTPCI_OPS(hw)->set_config_irq(hw, VIRTIO_MSI_NO_VECTOR); 6159ebdeefeSJianfeng Tan if (intr_conf->rxq) 6169ebdeefeSJianfeng Tan virtio_queues_unbind_intr(dev); 6179ebdeefeSJianfeng Tan 6189ebdeefeSJianfeng Tan if (intr_conf->lsc || intr_conf->rxq) { 6199ebdeefeSJianfeng Tan rte_intr_disable(dev->intr_handle); 6209ebdeefeSJianfeng Tan rte_intr_efd_disable(dev->intr_handle); 6219ebdeefeSJianfeng Tan rte_free(dev->intr_handle->intr_vec); 6229ebdeefeSJianfeng Tan dev->intr_handle->intr_vec = NULL; 6239ebdeefeSJianfeng Tan } 6249ebdeefeSJianfeng Tan 6256c3169a3SBruce Richardson vtpci_reset(hw); 6266c3169a3SBruce Richardson virtio_dev_free_mbufs(dev); 62769c80d4eSYuanhan Liu virtio_free_queues(hw); 6286c3169a3SBruce Richardson } 6296c3169a3SBruce Richardson 6306c3169a3SBruce Richardson static void 6316c3169a3SBruce Richardson virtio_dev_promiscuous_enable(struct rte_eth_dev *dev) 6326c3169a3SBruce Richardson { 6336c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 6346c3169a3SBruce Richardson struct virtio_pmd_ctrl ctrl; 6356c3169a3SBruce Richardson int dlen[1]; 6366c3169a3SBruce Richardson int ret; 6376c3169a3SBruce Richardson 638e9e414a4SStephen Hemminger if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 639f2462150SFerruh Yigit PMD_INIT_LOG(INFO, "host does not support rx control"); 640e9e414a4SStephen Hemminger return; 641e9e414a4SStephen Hemminger } 642e9e414a4SStephen Hemminger 6436c3169a3SBruce Richardson ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 6446c3169a3SBruce Richardson ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC; 6456c3169a3SBruce Richardson ctrl.data[0] = 1; 6466c3169a3SBruce Richardson dlen[0] = 1; 6476c3169a3SBruce Richardson 6486c3169a3SBruce Richardson ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 6496c3169a3SBruce Richardson if (ret) 6506c3169a3SBruce Richardson PMD_INIT_LOG(ERR, "Failed to enable promisc"); 6516c3169a3SBruce Richardson } 6526c3169a3SBruce Richardson 6536c3169a3SBruce Richardson static void 6546c3169a3SBruce Richardson virtio_dev_promiscuous_disable(struct rte_eth_dev *dev) 6556c3169a3SBruce Richardson { 6566c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 6576c3169a3SBruce Richardson struct virtio_pmd_ctrl ctrl; 6586c3169a3SBruce Richardson int dlen[1]; 6596c3169a3SBruce Richardson int ret; 6606c3169a3SBruce Richardson 661e9e414a4SStephen Hemminger if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 662f2462150SFerruh Yigit PMD_INIT_LOG(INFO, "host does not support rx control"); 663e9e414a4SStephen Hemminger return; 664e9e414a4SStephen Hemminger } 665e9e414a4SStephen Hemminger 6666c3169a3SBruce Richardson ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 6676c3169a3SBruce Richardson ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC; 6686c3169a3SBruce Richardson ctrl.data[0] = 0; 6696c3169a3SBruce Richardson dlen[0] = 1; 6706c3169a3SBruce Richardson 6716c3169a3SBruce Richardson ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 6726c3169a3SBruce Richardson if (ret) 6736c3169a3SBruce Richardson PMD_INIT_LOG(ERR, "Failed to disable promisc"); 6746c3169a3SBruce Richardson } 6756c3169a3SBruce Richardson 6766c3169a3SBruce Richardson static void 6776c3169a3SBruce Richardson virtio_dev_allmulticast_enable(struct rte_eth_dev *dev) 6786c3169a3SBruce Richardson { 6796c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 6806c3169a3SBruce Richardson struct virtio_pmd_ctrl ctrl; 6816c3169a3SBruce Richardson int dlen[1]; 6826c3169a3SBruce Richardson int ret; 6836c3169a3SBruce Richardson 684e9e414a4SStephen Hemminger if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 685f2462150SFerruh Yigit PMD_INIT_LOG(INFO, "host does not support rx control"); 686e9e414a4SStephen Hemminger return; 687e9e414a4SStephen Hemminger } 688e9e414a4SStephen Hemminger 6896c3169a3SBruce Richardson ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 6906c3169a3SBruce Richardson ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI; 6916c3169a3SBruce Richardson ctrl.data[0] = 1; 6926c3169a3SBruce Richardson dlen[0] = 1; 6936c3169a3SBruce Richardson 6946c3169a3SBruce Richardson ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 6956c3169a3SBruce Richardson if (ret) 6966c3169a3SBruce Richardson PMD_INIT_LOG(ERR, "Failed to enable allmulticast"); 6976c3169a3SBruce Richardson } 6986c3169a3SBruce Richardson 6996c3169a3SBruce Richardson static void 7006c3169a3SBruce Richardson virtio_dev_allmulticast_disable(struct rte_eth_dev *dev) 7016c3169a3SBruce Richardson { 7026c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 7036c3169a3SBruce Richardson struct virtio_pmd_ctrl ctrl; 7046c3169a3SBruce Richardson int dlen[1]; 7056c3169a3SBruce Richardson int ret; 7066c3169a3SBruce Richardson 707e9e414a4SStephen Hemminger if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 708f2462150SFerruh Yigit PMD_INIT_LOG(INFO, "host does not support rx control"); 709e9e414a4SStephen Hemminger return; 710e9e414a4SStephen Hemminger } 711e9e414a4SStephen Hemminger 7126c3169a3SBruce Richardson ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 7136c3169a3SBruce Richardson ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI; 7146c3169a3SBruce Richardson ctrl.data[0] = 0; 7156c3169a3SBruce Richardson dlen[0] = 1; 7166c3169a3SBruce Richardson 7176c3169a3SBruce Richardson ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 7186c3169a3SBruce Richardson if (ret) 7196c3169a3SBruce Richardson PMD_INIT_LOG(ERR, "Failed to disable allmulticast"); 7206c3169a3SBruce Richardson } 7216c3169a3SBruce Richardson 7224ec2424aSSouvik Dey #define VLAN_TAG_LEN 4 /* 802.3ac tag (not DMA'd) */ 7234ec2424aSSouvik Dey static int 7244ec2424aSSouvik Dey virtio_mtu_set(struct rte_eth_dev *dev, uint16_t mtu) 7254ec2424aSSouvik Dey { 7264ec2424aSSouvik Dey struct virtio_hw *hw = dev->data->dev_private; 7274ec2424aSSouvik Dey uint32_t ether_hdr_len = ETHER_HDR_LEN + VLAN_TAG_LEN + 7284ec2424aSSouvik Dey hw->vtnet_hdr_size; 7294ec2424aSSouvik Dey uint32_t frame_size = mtu + ether_hdr_len; 73049d26d9eSMaxime Coquelin uint32_t max_frame_size = hw->max_mtu + ether_hdr_len; 7314ec2424aSSouvik Dey 73249d26d9eSMaxime Coquelin max_frame_size = RTE_MIN(max_frame_size, VIRTIO_MAX_RX_PKTLEN); 73349d26d9eSMaxime Coquelin 73449d26d9eSMaxime Coquelin if (mtu < ETHER_MIN_MTU || frame_size > max_frame_size) { 735f2462150SFerruh Yigit PMD_INIT_LOG(ERR, "MTU should be between %d and %d", 73649d26d9eSMaxime Coquelin ETHER_MIN_MTU, max_frame_size - ether_hdr_len); 7374ec2424aSSouvik Dey return -EINVAL; 7384ec2424aSSouvik Dey } 7394ec2424aSSouvik Dey return 0; 7404ec2424aSSouvik Dey } 7414ec2424aSSouvik Dey 742c056be23SJianfeng Tan static int 743c056be23SJianfeng Tan virtio_dev_rx_queue_intr_enable(struct rte_eth_dev *dev, uint16_t queue_id) 744c056be23SJianfeng Tan { 745c056be23SJianfeng Tan struct virtnet_rx *rxvq = dev->data->rx_queues[queue_id]; 746c056be23SJianfeng Tan struct virtqueue *vq = rxvq->vq; 747c056be23SJianfeng Tan 748c056be23SJianfeng Tan virtqueue_enable_intr(vq); 749c056be23SJianfeng Tan return 0; 750c056be23SJianfeng Tan } 751c056be23SJianfeng Tan 752c056be23SJianfeng Tan static int 753c056be23SJianfeng Tan virtio_dev_rx_queue_intr_disable(struct rte_eth_dev *dev, uint16_t queue_id) 754c056be23SJianfeng Tan { 755c056be23SJianfeng Tan struct virtnet_rx *rxvq = dev->data->rx_queues[queue_id]; 756c056be23SJianfeng Tan struct virtqueue *vq = rxvq->vq; 757c056be23SJianfeng Tan 758c056be23SJianfeng Tan virtqueue_disable_intr(vq); 759c056be23SJianfeng Tan return 0; 760c056be23SJianfeng Tan } 761c056be23SJianfeng Tan 7626c3169a3SBruce Richardson /* 7636c3169a3SBruce Richardson * dev_ops for virtio, bare necessities for basic operation 7646c3169a3SBruce Richardson */ 7656c3169a3SBruce Richardson static const struct eth_dev_ops virtio_eth_dev_ops = { 7666c3169a3SBruce Richardson .dev_configure = virtio_dev_configure, 7676c3169a3SBruce Richardson .dev_start = virtio_dev_start, 7686c3169a3SBruce Richardson .dev_stop = virtio_dev_stop, 7696c3169a3SBruce Richardson .dev_close = virtio_dev_close, 7706c3169a3SBruce Richardson .promiscuous_enable = virtio_dev_promiscuous_enable, 7716c3169a3SBruce Richardson .promiscuous_disable = virtio_dev_promiscuous_disable, 7726c3169a3SBruce Richardson .allmulticast_enable = virtio_dev_allmulticast_enable, 7736c3169a3SBruce Richardson .allmulticast_disable = virtio_dev_allmulticast_disable, 7744ec2424aSSouvik Dey .mtu_set = virtio_mtu_set, 7756c3169a3SBruce Richardson .dev_infos_get = virtio_dev_info_get, 7766c3169a3SBruce Richardson .stats_get = virtio_dev_stats_get, 77776d4c652SHarry van Haaren .xstats_get = virtio_dev_xstats_get, 778baf91c39SRemy Horton .xstats_get_names = virtio_dev_xstats_get_names, 7796c3169a3SBruce Richardson .stats_reset = virtio_dev_stats_reset, 78076d4c652SHarry van Haaren .xstats_reset = virtio_dev_stats_reset, 7816c3169a3SBruce Richardson .link_update = virtio_dev_link_update, 7826c3169a3SBruce Richardson .rx_queue_setup = virtio_dev_rx_queue_setup, 783c056be23SJianfeng Tan .rx_queue_intr_enable = virtio_dev_rx_queue_intr_enable, 784c056be23SJianfeng Tan .rx_queue_intr_disable = virtio_dev_rx_queue_intr_disable, 78569c80d4eSYuanhan Liu .rx_queue_release = virtio_dev_queue_release, 786b0caba1aSJianfeng Tan .rx_descriptor_done = virtio_dev_rx_queue_done, 7876c3169a3SBruce Richardson .tx_queue_setup = virtio_dev_tx_queue_setup, 78869c80d4eSYuanhan Liu .tx_queue_release = virtio_dev_queue_release, 7896c3169a3SBruce Richardson /* collect stats per queue */ 7906c3169a3SBruce Richardson .queue_stats_mapping_set = virtio_dev_queue_stats_mapping_set, 7916c3169a3SBruce Richardson .vlan_filter_set = virtio_vlan_filter_set, 7926c3169a3SBruce Richardson .mac_addr_add = virtio_mac_addr_add, 7936c3169a3SBruce Richardson .mac_addr_remove = virtio_mac_addr_remove, 7946c3169a3SBruce Richardson .mac_addr_set = virtio_mac_addr_set, 7956c3169a3SBruce Richardson }; 7966c3169a3SBruce Richardson 7976c3169a3SBruce Richardson static inline int 7986c3169a3SBruce Richardson virtio_dev_atomic_read_link_status(struct rte_eth_dev *dev, 7996c3169a3SBruce Richardson struct rte_eth_link *link) 8006c3169a3SBruce Richardson { 8016c3169a3SBruce Richardson struct rte_eth_link *dst = link; 8026c3169a3SBruce Richardson struct rte_eth_link *src = &(dev->data->dev_link); 8036c3169a3SBruce Richardson 8046c3169a3SBruce Richardson if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst, 8056c3169a3SBruce Richardson *(uint64_t *)src) == 0) 8066c3169a3SBruce Richardson return -1; 8076c3169a3SBruce Richardson 8086c3169a3SBruce Richardson return 0; 8096c3169a3SBruce Richardson } 8106c3169a3SBruce Richardson 8116c3169a3SBruce Richardson /** 8126c3169a3SBruce Richardson * Atomically writes the link status information into global 8136c3169a3SBruce Richardson * structure rte_eth_dev. 8146c3169a3SBruce Richardson * 8156c3169a3SBruce Richardson * @param dev 8166c3169a3SBruce Richardson * - Pointer to the structure rte_eth_dev to read from. 8176c3169a3SBruce Richardson * - Pointer to the buffer to be saved with the link status. 8186c3169a3SBruce Richardson * 8196c3169a3SBruce Richardson * @return 8206c3169a3SBruce Richardson * - On success, zero. 8216c3169a3SBruce Richardson * - On failure, negative value. 8226c3169a3SBruce Richardson */ 8236c3169a3SBruce Richardson static inline int 8246c3169a3SBruce Richardson virtio_dev_atomic_write_link_status(struct rte_eth_dev *dev, 8256c3169a3SBruce Richardson struct rte_eth_link *link) 8266c3169a3SBruce Richardson { 8276c3169a3SBruce Richardson struct rte_eth_link *dst = &(dev->data->dev_link); 8286c3169a3SBruce Richardson struct rte_eth_link *src = link; 8296c3169a3SBruce Richardson 8306c3169a3SBruce Richardson if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst, 8316c3169a3SBruce Richardson *(uint64_t *)src) == 0) 8326c3169a3SBruce Richardson return -1; 8336c3169a3SBruce Richardson 8346c3169a3SBruce Richardson return 0; 8356c3169a3SBruce Richardson } 8366c3169a3SBruce Richardson 8376c3169a3SBruce Richardson static void 83876d4c652SHarry van Haaren virtio_update_stats(struct rte_eth_dev *dev, struct rte_eth_stats *stats) 8396c3169a3SBruce Richardson { 8406c3169a3SBruce Richardson unsigned i; 8416c3169a3SBruce Richardson 8426c3169a3SBruce Richardson for (i = 0; i < dev->data->nb_tx_queues; i++) { 84301ad44fdSHuawei Xie const struct virtnet_tx *txvq = dev->data->tx_queues[i]; 8446c3169a3SBruce Richardson if (txvq == NULL) 8456c3169a3SBruce Richardson continue; 8466c3169a3SBruce Richardson 84701ad44fdSHuawei Xie stats->opackets += txvq->stats.packets; 84801ad44fdSHuawei Xie stats->obytes += txvq->stats.bytes; 84901ad44fdSHuawei Xie stats->oerrors += txvq->stats.errors; 8506c3169a3SBruce Richardson 8516c3169a3SBruce Richardson if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) { 85201ad44fdSHuawei Xie stats->q_opackets[i] = txvq->stats.packets; 85301ad44fdSHuawei Xie stats->q_obytes[i] = txvq->stats.bytes; 8546c3169a3SBruce Richardson } 8556c3169a3SBruce Richardson } 8566c3169a3SBruce Richardson 8576c3169a3SBruce Richardson for (i = 0; i < dev->data->nb_rx_queues; i++) { 85801ad44fdSHuawei Xie const struct virtnet_rx *rxvq = dev->data->rx_queues[i]; 8596c3169a3SBruce Richardson if (rxvq == NULL) 8606c3169a3SBruce Richardson continue; 8616c3169a3SBruce Richardson 86201ad44fdSHuawei Xie stats->ipackets += rxvq->stats.packets; 86301ad44fdSHuawei Xie stats->ibytes += rxvq->stats.bytes; 86401ad44fdSHuawei Xie stats->ierrors += rxvq->stats.errors; 8656c3169a3SBruce Richardson 8666c3169a3SBruce Richardson if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) { 86701ad44fdSHuawei Xie stats->q_ipackets[i] = rxvq->stats.packets; 86801ad44fdSHuawei Xie stats->q_ibytes[i] = rxvq->stats.bytes; 8696c3169a3SBruce Richardson } 8706c3169a3SBruce Richardson } 8716c3169a3SBruce Richardson 8726c3169a3SBruce Richardson stats->rx_nombuf = dev->data->rx_mbuf_alloc_failed; 8736c3169a3SBruce Richardson } 8746c3169a3SBruce Richardson 875baf91c39SRemy Horton static int virtio_dev_xstats_get_names(struct rte_eth_dev *dev, 876baf91c39SRemy Horton struct rte_eth_xstat_name *xstats_names, 877baf91c39SRemy Horton __rte_unused unsigned limit) 878baf91c39SRemy Horton { 879baf91c39SRemy Horton unsigned i; 880baf91c39SRemy Horton unsigned count = 0; 881baf91c39SRemy Horton unsigned t; 882baf91c39SRemy Horton 88301ad44fdSHuawei Xie unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_TXQ_XSTATS + 88401ad44fdSHuawei Xie dev->data->nb_rx_queues * VIRTIO_NB_RXQ_XSTATS; 885baf91c39SRemy Horton 8867e1eb993SYuanhan Liu if (xstats_names != NULL) { 887baf91c39SRemy Horton /* Note: limit checked in rte_eth_xstats_names() */ 888baf91c39SRemy Horton 889baf91c39SRemy Horton for (i = 0; i < dev->data->nb_rx_queues; i++) { 890baf91c39SRemy Horton struct virtqueue *rxvq = dev->data->rx_queues[i]; 891baf91c39SRemy Horton if (rxvq == NULL) 892baf91c39SRemy Horton continue; 89301ad44fdSHuawei Xie for (t = 0; t < VIRTIO_NB_RXQ_XSTATS; t++) { 894baf91c39SRemy Horton snprintf(xstats_names[count].name, 895baf91c39SRemy Horton sizeof(xstats_names[count].name), 896baf91c39SRemy Horton "rx_q%u_%s", i, 89701ad44fdSHuawei Xie rte_virtio_rxq_stat_strings[t].name); 898baf91c39SRemy Horton count++; 899baf91c39SRemy Horton } 900baf91c39SRemy Horton } 901baf91c39SRemy Horton 902baf91c39SRemy Horton for (i = 0; i < dev->data->nb_tx_queues; i++) { 903baf91c39SRemy Horton struct virtqueue *txvq = dev->data->tx_queues[i]; 904baf91c39SRemy Horton if (txvq == NULL) 905baf91c39SRemy Horton continue; 90601ad44fdSHuawei Xie for (t = 0; t < VIRTIO_NB_TXQ_XSTATS; t++) { 907baf91c39SRemy Horton snprintf(xstats_names[count].name, 908baf91c39SRemy Horton sizeof(xstats_names[count].name), 909baf91c39SRemy Horton "tx_q%u_%s", i, 91001ad44fdSHuawei Xie rte_virtio_txq_stat_strings[t].name); 911baf91c39SRemy Horton count++; 912baf91c39SRemy Horton } 913baf91c39SRemy Horton } 914baf91c39SRemy Horton return count; 915baf91c39SRemy Horton } 916baf91c39SRemy Horton return nstats; 917baf91c39SRemy Horton } 918baf91c39SRemy Horton 91976d4c652SHarry van Haaren static int 920e2aae1c1SRemy Horton virtio_dev_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats, 92176d4c652SHarry van Haaren unsigned n) 92276d4c652SHarry van Haaren { 92376d4c652SHarry van Haaren unsigned i; 92476d4c652SHarry van Haaren unsigned count = 0; 92576d4c652SHarry van Haaren 92601ad44fdSHuawei Xie unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_TXQ_XSTATS + 92701ad44fdSHuawei Xie dev->data->nb_rx_queues * VIRTIO_NB_RXQ_XSTATS; 92876d4c652SHarry van Haaren 92976d4c652SHarry van Haaren if (n < nstats) 93076d4c652SHarry van Haaren return nstats; 93176d4c652SHarry van Haaren 93276d4c652SHarry van Haaren for (i = 0; i < dev->data->nb_rx_queues; i++) { 93301ad44fdSHuawei Xie struct virtnet_rx *rxvq = dev->data->rx_queues[i]; 93476d4c652SHarry van Haaren 93576d4c652SHarry van Haaren if (rxvq == NULL) 93676d4c652SHarry van Haaren continue; 93776d4c652SHarry van Haaren 93876d4c652SHarry van Haaren unsigned t; 93976d4c652SHarry van Haaren 94001ad44fdSHuawei Xie for (t = 0; t < VIRTIO_NB_RXQ_XSTATS; t++) { 94176d4c652SHarry van Haaren xstats[count].value = *(uint64_t *)(((char *)rxvq) + 94201ad44fdSHuawei Xie rte_virtio_rxq_stat_strings[t].offset); 943513c78aeSOlivier Matz xstats[count].id = count; 94476d4c652SHarry van Haaren count++; 94576d4c652SHarry van Haaren } 94676d4c652SHarry van Haaren } 94776d4c652SHarry van Haaren 94876d4c652SHarry van Haaren for (i = 0; i < dev->data->nb_tx_queues; i++) { 94901ad44fdSHuawei Xie struct virtnet_tx *txvq = dev->data->tx_queues[i]; 95076d4c652SHarry van Haaren 95176d4c652SHarry van Haaren if (txvq == NULL) 95276d4c652SHarry van Haaren continue; 95376d4c652SHarry van Haaren 95476d4c652SHarry van Haaren unsigned t; 95576d4c652SHarry van Haaren 95601ad44fdSHuawei Xie for (t = 0; t < VIRTIO_NB_TXQ_XSTATS; t++) { 95776d4c652SHarry van Haaren xstats[count].value = *(uint64_t *)(((char *)txvq) + 95801ad44fdSHuawei Xie rte_virtio_txq_stat_strings[t].offset); 959513c78aeSOlivier Matz xstats[count].id = count; 96076d4c652SHarry van Haaren count++; 96176d4c652SHarry van Haaren } 96276d4c652SHarry van Haaren } 96376d4c652SHarry van Haaren 96476d4c652SHarry van Haaren return count; 96576d4c652SHarry van Haaren } 96676d4c652SHarry van Haaren 96776d4c652SHarry van Haaren static void 96876d4c652SHarry van Haaren virtio_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats) 96976d4c652SHarry van Haaren { 97076d4c652SHarry van Haaren virtio_update_stats(dev, stats); 97176d4c652SHarry van Haaren } 97276d4c652SHarry van Haaren 9736c3169a3SBruce Richardson static void 9746c3169a3SBruce Richardson virtio_dev_stats_reset(struct rte_eth_dev *dev) 9756c3169a3SBruce Richardson { 9766c3169a3SBruce Richardson unsigned int i; 9776c3169a3SBruce Richardson 9786c3169a3SBruce Richardson for (i = 0; i < dev->data->nb_tx_queues; i++) { 97901ad44fdSHuawei Xie struct virtnet_tx *txvq = dev->data->tx_queues[i]; 9806c3169a3SBruce Richardson if (txvq == NULL) 9816c3169a3SBruce Richardson continue; 9826c3169a3SBruce Richardson 98301ad44fdSHuawei Xie txvq->stats.packets = 0; 98401ad44fdSHuawei Xie txvq->stats.bytes = 0; 98501ad44fdSHuawei Xie txvq->stats.errors = 0; 98601ad44fdSHuawei Xie txvq->stats.multicast = 0; 98701ad44fdSHuawei Xie txvq->stats.broadcast = 0; 98801ad44fdSHuawei Xie memset(txvq->stats.size_bins, 0, 98901ad44fdSHuawei Xie sizeof(txvq->stats.size_bins[0]) * 8); 9906c3169a3SBruce Richardson } 9916c3169a3SBruce Richardson 9926c3169a3SBruce Richardson for (i = 0; i < dev->data->nb_rx_queues; i++) { 99301ad44fdSHuawei Xie struct virtnet_rx *rxvq = dev->data->rx_queues[i]; 9946c3169a3SBruce Richardson if (rxvq == NULL) 9956c3169a3SBruce Richardson continue; 9966c3169a3SBruce Richardson 99701ad44fdSHuawei Xie rxvq->stats.packets = 0; 99801ad44fdSHuawei Xie rxvq->stats.bytes = 0; 99901ad44fdSHuawei Xie rxvq->stats.errors = 0; 100001ad44fdSHuawei Xie rxvq->stats.multicast = 0; 100101ad44fdSHuawei Xie rxvq->stats.broadcast = 0; 100201ad44fdSHuawei Xie memset(rxvq->stats.size_bins, 0, 100301ad44fdSHuawei Xie sizeof(rxvq->stats.size_bins[0]) * 8); 10046c3169a3SBruce Richardson } 10056c3169a3SBruce Richardson } 10066c3169a3SBruce Richardson 10076c3169a3SBruce Richardson static void 10086c3169a3SBruce Richardson virtio_set_hwaddr(struct virtio_hw *hw) 10096c3169a3SBruce Richardson { 10106c3169a3SBruce Richardson vtpci_write_dev_config(hw, 10116c3169a3SBruce Richardson offsetof(struct virtio_net_config, mac), 10126c3169a3SBruce Richardson &hw->mac_addr, ETHER_ADDR_LEN); 10136c3169a3SBruce Richardson } 10146c3169a3SBruce Richardson 10156c3169a3SBruce Richardson static void 10166c3169a3SBruce Richardson virtio_get_hwaddr(struct virtio_hw *hw) 10176c3169a3SBruce Richardson { 10186c3169a3SBruce Richardson if (vtpci_with_feature(hw, VIRTIO_NET_F_MAC)) { 10196c3169a3SBruce Richardson vtpci_read_dev_config(hw, 10206c3169a3SBruce Richardson offsetof(struct virtio_net_config, mac), 10216c3169a3SBruce Richardson &hw->mac_addr, ETHER_ADDR_LEN); 10226c3169a3SBruce Richardson } else { 10236c3169a3SBruce Richardson eth_random_addr(&hw->mac_addr[0]); 10246c3169a3SBruce Richardson virtio_set_hwaddr(hw); 10256c3169a3SBruce Richardson } 10266c3169a3SBruce Richardson } 10276c3169a3SBruce Richardson 102827046236SStephen Hemminger static void 10296c3169a3SBruce Richardson virtio_mac_table_set(struct virtio_hw *hw, 10306c3169a3SBruce Richardson const struct virtio_net_ctrl_mac *uc, 10316c3169a3SBruce Richardson const struct virtio_net_ctrl_mac *mc) 10326c3169a3SBruce Richardson { 10336c3169a3SBruce Richardson struct virtio_pmd_ctrl ctrl; 10346c3169a3SBruce Richardson int err, len[2]; 10356c3169a3SBruce Richardson 103627046236SStephen Hemminger if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) { 1037e9083127SJianfeng Tan PMD_DRV_LOG(INFO, "host does not support mac table"); 103827046236SStephen Hemminger return; 103927046236SStephen Hemminger } 104027046236SStephen Hemminger 10416c3169a3SBruce Richardson ctrl.hdr.class = VIRTIO_NET_CTRL_MAC; 10426c3169a3SBruce Richardson ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_TABLE_SET; 10436c3169a3SBruce Richardson 10446c3169a3SBruce Richardson len[0] = uc->entries * ETHER_ADDR_LEN + sizeof(uc->entries); 10456c3169a3SBruce Richardson memcpy(ctrl.data, uc, len[0]); 10466c3169a3SBruce Richardson 10476c3169a3SBruce Richardson len[1] = mc->entries * ETHER_ADDR_LEN + sizeof(mc->entries); 10486c3169a3SBruce Richardson memcpy(ctrl.data + len[0], mc, len[1]); 10496c3169a3SBruce Richardson 10506c3169a3SBruce Richardson err = virtio_send_command(hw->cvq, &ctrl, len, 2); 10516c3169a3SBruce Richardson if (err != 0) 10526c3169a3SBruce Richardson PMD_DRV_LOG(NOTICE, "mac table set failed: %d", err); 10536c3169a3SBruce Richardson } 10546c3169a3SBruce Richardson 10556c3169a3SBruce Richardson static void 10566c3169a3SBruce Richardson virtio_mac_addr_add(struct rte_eth_dev *dev, struct ether_addr *mac_addr, 10576c3169a3SBruce Richardson uint32_t index, uint32_t vmdq __rte_unused) 10586c3169a3SBruce Richardson { 10596c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 10606c3169a3SBruce Richardson const struct ether_addr *addrs = dev->data->mac_addrs; 10616c3169a3SBruce Richardson unsigned int i; 10626c3169a3SBruce Richardson struct virtio_net_ctrl_mac *uc, *mc; 10636c3169a3SBruce Richardson 10646c3169a3SBruce Richardson if (index >= VIRTIO_MAX_MAC_ADDRS) { 10656c3169a3SBruce Richardson PMD_DRV_LOG(ERR, "mac address index %u out of range", index); 10666c3169a3SBruce Richardson return; 10676c3169a3SBruce Richardson } 10686c3169a3SBruce Richardson 10696c3169a3SBruce Richardson uc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(uc->entries)); 10706c3169a3SBruce Richardson uc->entries = 0; 10716c3169a3SBruce Richardson mc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(mc->entries)); 10726c3169a3SBruce Richardson mc->entries = 0; 10736c3169a3SBruce Richardson 10746c3169a3SBruce Richardson for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) { 10756c3169a3SBruce Richardson const struct ether_addr *addr 10766c3169a3SBruce Richardson = (i == index) ? mac_addr : addrs + i; 10776c3169a3SBruce Richardson struct virtio_net_ctrl_mac *tbl 10786c3169a3SBruce Richardson = is_multicast_ether_addr(addr) ? mc : uc; 10796c3169a3SBruce Richardson 10806c3169a3SBruce Richardson memcpy(&tbl->macs[tbl->entries++], addr, ETHER_ADDR_LEN); 10816c3169a3SBruce Richardson } 10826c3169a3SBruce Richardson 10836c3169a3SBruce Richardson virtio_mac_table_set(hw, uc, mc); 10846c3169a3SBruce Richardson } 10856c3169a3SBruce Richardson 10866c3169a3SBruce Richardson static void 10876c3169a3SBruce Richardson virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index) 10886c3169a3SBruce Richardson { 10896c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 10906c3169a3SBruce Richardson struct ether_addr *addrs = dev->data->mac_addrs; 10916c3169a3SBruce Richardson struct virtio_net_ctrl_mac *uc, *mc; 10926c3169a3SBruce Richardson unsigned int i; 10936c3169a3SBruce Richardson 10946c3169a3SBruce Richardson if (index >= VIRTIO_MAX_MAC_ADDRS) { 10956c3169a3SBruce Richardson PMD_DRV_LOG(ERR, "mac address index %u out of range", index); 10966c3169a3SBruce Richardson return; 10976c3169a3SBruce Richardson } 10986c3169a3SBruce Richardson 10996c3169a3SBruce Richardson uc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(uc->entries)); 11006c3169a3SBruce Richardson uc->entries = 0; 11016c3169a3SBruce Richardson mc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(mc->entries)); 11026c3169a3SBruce Richardson mc->entries = 0; 11036c3169a3SBruce Richardson 11046c3169a3SBruce Richardson for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) { 11056c3169a3SBruce Richardson struct virtio_net_ctrl_mac *tbl; 11066c3169a3SBruce Richardson 11076c3169a3SBruce Richardson if (i == index || is_zero_ether_addr(addrs + i)) 11086c3169a3SBruce Richardson continue; 11096c3169a3SBruce Richardson 11106c3169a3SBruce Richardson tbl = is_multicast_ether_addr(addrs + i) ? mc : uc; 11116c3169a3SBruce Richardson memcpy(&tbl->macs[tbl->entries++], addrs + i, ETHER_ADDR_LEN); 11126c3169a3SBruce Richardson } 11136c3169a3SBruce Richardson 11146c3169a3SBruce Richardson virtio_mac_table_set(hw, uc, mc); 11156c3169a3SBruce Richardson } 11166c3169a3SBruce Richardson 11176c3169a3SBruce Richardson static void 11186c3169a3SBruce Richardson virtio_mac_addr_set(struct rte_eth_dev *dev, struct ether_addr *mac_addr) 11196c3169a3SBruce Richardson { 11206c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 11216c3169a3SBruce Richardson 11226c3169a3SBruce Richardson memcpy(hw->mac_addr, mac_addr, ETHER_ADDR_LEN); 11236c3169a3SBruce Richardson 11246c3169a3SBruce Richardson /* Use atomic update if available */ 11256c3169a3SBruce Richardson if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) { 11266c3169a3SBruce Richardson struct virtio_pmd_ctrl ctrl; 11276c3169a3SBruce Richardson int len = ETHER_ADDR_LEN; 11286c3169a3SBruce Richardson 11296c3169a3SBruce Richardson ctrl.hdr.class = VIRTIO_NET_CTRL_MAC; 11306c3169a3SBruce Richardson ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_ADDR_SET; 11316c3169a3SBruce Richardson 11326c3169a3SBruce Richardson memcpy(ctrl.data, mac_addr, ETHER_ADDR_LEN); 11336c3169a3SBruce Richardson virtio_send_command(hw->cvq, &ctrl, &len, 1); 11346c3169a3SBruce Richardson } else if (vtpci_with_feature(hw, VIRTIO_NET_F_MAC)) 11356c3169a3SBruce Richardson virtio_set_hwaddr(hw); 11366c3169a3SBruce Richardson } 11376c3169a3SBruce Richardson 11386c3169a3SBruce Richardson static int 11396c3169a3SBruce Richardson virtio_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on) 11406c3169a3SBruce Richardson { 11416c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 11426c3169a3SBruce Richardson struct virtio_pmd_ctrl ctrl; 11436c3169a3SBruce Richardson int len; 11446c3169a3SBruce Richardson 11456c3169a3SBruce Richardson if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) 11466c3169a3SBruce Richardson return -ENOTSUP; 11476c3169a3SBruce Richardson 11486c3169a3SBruce Richardson ctrl.hdr.class = VIRTIO_NET_CTRL_VLAN; 11496c3169a3SBruce Richardson ctrl.hdr.cmd = on ? VIRTIO_NET_CTRL_VLAN_ADD : VIRTIO_NET_CTRL_VLAN_DEL; 11506c3169a3SBruce Richardson memcpy(ctrl.data, &vlan_id, sizeof(vlan_id)); 11516c3169a3SBruce Richardson len = sizeof(vlan_id); 11526c3169a3SBruce Richardson 11536c3169a3SBruce Richardson return virtio_send_command(hw->cvq, &ctrl, &len, 1); 11546c3169a3SBruce Richardson } 11556c3169a3SBruce Richardson 11566ba1f63bSYuanhan Liu static int 115760e6f470SOlivier Matz virtio_negotiate_features(struct virtio_hw *hw, uint64_t req_features) 11586c3169a3SBruce Richardson { 11593891f233SYuanhan Liu uint64_t host_features; 11606c3169a3SBruce Richardson 11616c3169a3SBruce Richardson /* Prepare guest_features: feature that driver wants to support */ 11623891f233SYuanhan Liu PMD_INIT_LOG(DEBUG, "guest_features before negotiate = %" PRIx64, 116360e6f470SOlivier Matz req_features); 11646c3169a3SBruce Richardson 11656c3169a3SBruce Richardson /* Read device(host) feature bits */ 1166553f4593SYuanhan Liu host_features = VTPCI_OPS(hw)->get_features(hw); 11673891f233SYuanhan Liu PMD_INIT_LOG(DEBUG, "host_features before negotiate = %" PRIx64, 11686c3169a3SBruce Richardson host_features); 11696c3169a3SBruce Richardson 117049d26d9eSMaxime Coquelin /* If supported, ensure MTU value is valid before acknowledging it. */ 117149d26d9eSMaxime Coquelin if (host_features & req_features & (1ULL << VIRTIO_NET_F_MTU)) { 117249d26d9eSMaxime Coquelin struct virtio_net_config config; 117349d26d9eSMaxime Coquelin 117449d26d9eSMaxime Coquelin vtpci_read_dev_config(hw, 117549d26d9eSMaxime Coquelin offsetof(struct virtio_net_config, mtu), 117649d26d9eSMaxime Coquelin &config.mtu, sizeof(config.mtu)); 117749d26d9eSMaxime Coquelin 117849d26d9eSMaxime Coquelin if (config.mtu < ETHER_MIN_MTU) 117949d26d9eSMaxime Coquelin req_features &= ~(1ULL << VIRTIO_NET_F_MTU); 118049d26d9eSMaxime Coquelin } 118149d26d9eSMaxime Coquelin 11826c3169a3SBruce Richardson /* 11836c3169a3SBruce Richardson * Negotiate features: Subset of device feature bits are written back 11846c3169a3SBruce Richardson * guest feature bits. 11856c3169a3SBruce Richardson */ 118660e6f470SOlivier Matz hw->guest_features = req_features; 11876c3169a3SBruce Richardson hw->guest_features = vtpci_negotiate_features(hw, host_features); 11883891f233SYuanhan Liu PMD_INIT_LOG(DEBUG, "features after negotiate = %" PRIx64, 11896c3169a3SBruce Richardson hw->guest_features); 11906ba1f63bSYuanhan Liu 11916ba1f63bSYuanhan Liu if (hw->modern) { 11926ba1f63bSYuanhan Liu if (!vtpci_with_feature(hw, VIRTIO_F_VERSION_1)) { 11936ba1f63bSYuanhan Liu PMD_INIT_LOG(ERR, 11946ba1f63bSYuanhan Liu "VIRTIO_F_VERSION_1 features is not enabled."); 11956ba1f63bSYuanhan Liu return -1; 11966ba1f63bSYuanhan Liu } 11976ba1f63bSYuanhan Liu vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_FEATURES_OK); 11986ba1f63bSYuanhan Liu if (!(vtpci_get_status(hw) & VIRTIO_CONFIG_STATUS_FEATURES_OK)) { 11996ba1f63bSYuanhan Liu PMD_INIT_LOG(ERR, 12006ba1f63bSYuanhan Liu "failed to set FEATURES_OK status!"); 12016ba1f63bSYuanhan Liu return -1; 12026ba1f63bSYuanhan Liu } 12036ba1f63bSYuanhan Liu } 12046ba1f63bSYuanhan Liu 120560e6f470SOlivier Matz hw->req_guest_features = req_features; 120660e6f470SOlivier Matz 12076ba1f63bSYuanhan Liu return 0; 12086c3169a3SBruce Richardson } 12096c3169a3SBruce Richardson 12106c3169a3SBruce Richardson /* 12116c3169a3SBruce Richardson * Process Virtio Config changed interrupt and call the callback 12126c3169a3SBruce Richardson * if link state changed. 12136c3169a3SBruce Richardson */ 1214ef53b603SJianfeng Tan void 1215c23a1a30SQi Zhang virtio_interrupt_handler(void *param) 12166c3169a3SBruce Richardson { 12176c3169a3SBruce Richardson struct rte_eth_dev *dev = param; 12186c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 12196c3169a3SBruce Richardson uint8_t isr; 12206c3169a3SBruce Richardson 12216c3169a3SBruce Richardson /* Read interrupt status which clears interrupt */ 12226c3169a3SBruce Richardson isr = vtpci_isr(hw); 12236c3169a3SBruce Richardson PMD_DRV_LOG(INFO, "interrupt status = %#x", isr); 12246c3169a3SBruce Richardson 1225c23a1a30SQi Zhang if (rte_intr_enable(dev->intr_handle) < 0) 12266c3169a3SBruce Richardson PMD_DRV_LOG(ERR, "interrupt enable failed"); 12276c3169a3SBruce Richardson 12286c3169a3SBruce Richardson if (isr & VIRTIO_PCI_ISR_CONFIG) { 12296c3169a3SBruce Richardson if (virtio_dev_link_update(dev, 0) == 0) 12306c3169a3SBruce Richardson _rte_eth_dev_callback_process(dev, 1231c1ceaf3aSBernard Iremonger RTE_ETH_EVENT_INTR_LSC, NULL); 12326c3169a3SBruce Richardson } 12336c3169a3SBruce Richardson 12346c3169a3SBruce Richardson } 12356c3169a3SBruce Richardson 12366c3169a3SBruce Richardson static void 12376c3169a3SBruce Richardson rx_func_get(struct rte_eth_dev *eth_dev) 12386c3169a3SBruce Richardson { 12396c3169a3SBruce Richardson struct virtio_hw *hw = eth_dev->data->dev_private; 12406c3169a3SBruce Richardson if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) 12416c3169a3SBruce Richardson eth_dev->rx_pkt_burst = &virtio_recv_mergeable_pkts; 12426c3169a3SBruce Richardson else 12436c3169a3SBruce Richardson eth_dev->rx_pkt_burst = &virtio_recv_pkts; 12446c3169a3SBruce Richardson } 12456c3169a3SBruce Richardson 124626b683b4SJianfeng Tan /* Only support 1:1 queue/interrupt mapping so far. 124726b683b4SJianfeng Tan * TODO: support n:1 queue/interrupt mapping when there are limited number of 124826b683b4SJianfeng Tan * interrupt vectors (<N+1). 124926b683b4SJianfeng Tan */ 125026b683b4SJianfeng Tan static int 125126b683b4SJianfeng Tan virtio_queues_bind_intr(struct rte_eth_dev *dev) 125226b683b4SJianfeng Tan { 125326b683b4SJianfeng Tan uint32_t i; 125426b683b4SJianfeng Tan struct virtio_hw *hw = dev->data->dev_private; 125526b683b4SJianfeng Tan 1256f2462150SFerruh Yigit PMD_INIT_LOG(INFO, "queue/interrupt binding"); 125726b683b4SJianfeng Tan for (i = 0; i < dev->data->nb_rx_queues; ++i) { 125826b683b4SJianfeng Tan dev->intr_handle->intr_vec[i] = i + 1; 125926b683b4SJianfeng Tan if (VTPCI_OPS(hw)->set_queue_irq(hw, hw->vqs[i * 2], i + 1) == 126026b683b4SJianfeng Tan VIRTIO_MSI_NO_VECTOR) { 126126b683b4SJianfeng Tan PMD_DRV_LOG(ERR, "failed to set queue vector"); 126226b683b4SJianfeng Tan return -EBUSY; 126326b683b4SJianfeng Tan } 126426b683b4SJianfeng Tan } 126526b683b4SJianfeng Tan 126626b683b4SJianfeng Tan return 0; 126726b683b4SJianfeng Tan } 126826b683b4SJianfeng Tan 12699ebdeefeSJianfeng Tan static void 12709ebdeefeSJianfeng Tan virtio_queues_unbind_intr(struct rte_eth_dev *dev) 12719ebdeefeSJianfeng Tan { 12729ebdeefeSJianfeng Tan uint32_t i; 12739ebdeefeSJianfeng Tan struct virtio_hw *hw = dev->data->dev_private; 12749ebdeefeSJianfeng Tan 1275f2462150SFerruh Yigit PMD_INIT_LOG(INFO, "queue/interrupt unbinding"); 12769ebdeefeSJianfeng Tan for (i = 0; i < dev->data->nb_rx_queues; ++i) 12779ebdeefeSJianfeng Tan VTPCI_OPS(hw)->set_queue_irq(hw, 12789ebdeefeSJianfeng Tan hw->vqs[i * VTNET_CQ], 12799ebdeefeSJianfeng Tan VIRTIO_MSI_NO_VECTOR); 12809ebdeefeSJianfeng Tan } 12819ebdeefeSJianfeng Tan 128226b683b4SJianfeng Tan static int 128326b683b4SJianfeng Tan virtio_configure_intr(struct rte_eth_dev *dev) 128426b683b4SJianfeng Tan { 128526b683b4SJianfeng Tan struct virtio_hw *hw = dev->data->dev_private; 128626b683b4SJianfeng Tan 128726b683b4SJianfeng Tan if (!rte_intr_cap_multiple(dev->intr_handle)) { 128826b683b4SJianfeng Tan PMD_INIT_LOG(ERR, "Multiple intr vector not supported"); 128926b683b4SJianfeng Tan return -ENOTSUP; 129026b683b4SJianfeng Tan } 129126b683b4SJianfeng Tan 129226b683b4SJianfeng Tan if (rte_intr_efd_enable(dev->intr_handle, dev->data->nb_rx_queues)) { 129326b683b4SJianfeng Tan PMD_INIT_LOG(ERR, "Fail to create eventfd"); 129426b683b4SJianfeng Tan return -1; 129526b683b4SJianfeng Tan } 129626b683b4SJianfeng Tan 129726b683b4SJianfeng Tan if (!dev->intr_handle->intr_vec) { 129826b683b4SJianfeng Tan dev->intr_handle->intr_vec = 129926b683b4SJianfeng Tan rte_zmalloc("intr_vec", 130026b683b4SJianfeng Tan hw->max_queue_pairs * sizeof(int), 0); 130126b683b4SJianfeng Tan if (!dev->intr_handle->intr_vec) { 130226b683b4SJianfeng Tan PMD_INIT_LOG(ERR, "Failed to allocate %u rxq vectors", 130326b683b4SJianfeng Tan hw->max_queue_pairs); 130426b683b4SJianfeng Tan return -ENOMEM; 130526b683b4SJianfeng Tan } 130626b683b4SJianfeng Tan } 130726b683b4SJianfeng Tan 130826b683b4SJianfeng Tan /* Re-register callback to update max_intr */ 130926b683b4SJianfeng Tan rte_intr_callback_unregister(dev->intr_handle, 131026b683b4SJianfeng Tan virtio_interrupt_handler, 131126b683b4SJianfeng Tan dev); 131226b683b4SJianfeng Tan rte_intr_callback_register(dev->intr_handle, 131326b683b4SJianfeng Tan virtio_interrupt_handler, 131426b683b4SJianfeng Tan dev); 131526b683b4SJianfeng Tan 131626b683b4SJianfeng Tan /* DO NOT try to remove this! This function will enable msix, or QEMU 131726b683b4SJianfeng Tan * will encounter SIGSEGV when DRIVER_OK is sent. 131826b683b4SJianfeng Tan * And for legacy devices, this should be done before queue/vec binding 131926b683b4SJianfeng Tan * to change the config size from 20 to 24, or VIRTIO_MSI_QUEUE_VECTOR 132026b683b4SJianfeng Tan * (22) will be ignored. 132126b683b4SJianfeng Tan */ 132226b683b4SJianfeng Tan if (rte_intr_enable(dev->intr_handle) < 0) { 132326b683b4SJianfeng Tan PMD_DRV_LOG(ERR, "interrupt enable failed"); 132426b683b4SJianfeng Tan return -1; 132526b683b4SJianfeng Tan } 132626b683b4SJianfeng Tan 132726b683b4SJianfeng Tan if (virtio_queues_bind_intr(dev) < 0) { 132826b683b4SJianfeng Tan PMD_INIT_LOG(ERR, "Failed to bind queue/interrupt"); 132926b683b4SJianfeng Tan return -1; 133026b683b4SJianfeng Tan } 133126b683b4SJianfeng Tan 133226b683b4SJianfeng Tan return 0; 133326b683b4SJianfeng Tan } 133426b683b4SJianfeng Tan 133560e6f470SOlivier Matz /* reset device and renegotiate features if needed */ 1336198ab336SOlivier Matz static int 133760e6f470SOlivier Matz virtio_init_device(struct rte_eth_dev *eth_dev, uint64_t req_features) 13386c3169a3SBruce Richardson { 13396c3169a3SBruce Richardson struct virtio_hw *hw = eth_dev->data->dev_private; 13406c3169a3SBruce Richardson struct virtio_net_config *config; 13416c3169a3SBruce Richardson struct virtio_net_config local_config; 13429470427cSYuanhan Liu struct rte_pci_device *pci_dev = NULL; 134369c80d4eSYuanhan Liu int ret; 13446c3169a3SBruce Richardson 13456c3169a3SBruce Richardson /* Reset the device although not necessary at startup */ 13466c3169a3SBruce Richardson vtpci_reset(hw); 13476c3169a3SBruce Richardson 13486c3169a3SBruce Richardson /* Tell the host we've noticed this device. */ 13496c3169a3SBruce Richardson vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_ACK); 13506c3169a3SBruce Richardson 13516c3169a3SBruce Richardson /* Tell the host we've known how to drive the device. */ 13526c3169a3SBruce Richardson vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_DRIVER); 135360e6f470SOlivier Matz if (virtio_negotiate_features(hw, req_features) < 0) 13546ba1f63bSYuanhan Liu return -1; 13556c3169a3SBruce Richardson 13562c2201fbSJianfeng Tan if (!hw->virtio_user_dev) { 1357f229eb41SJianfeng Tan pci_dev = RTE_DEV_TO_PCI(eth_dev->device); 1358f229eb41SJianfeng Tan rte_eth_copy_pci_info(eth_dev, pci_dev); 1359f229eb41SJianfeng Tan } 1360f229eb41SJianfeng Tan 1361a60a0c15SJianfeng Tan eth_dev->data->dev_flags = RTE_ETH_DEV_DETACHABLE; 1362a5ed8448SMatt Peters /* If host does not support both status and MSI-X then disable LSC */ 1363a5ed8448SMatt Peters if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS) && hw->use_msix) 1364198ab336SOlivier Matz eth_dev->data->dev_flags |= RTE_ETH_DEV_INTR_LSC; 1365a5ed8448SMatt Peters else 1366a5ed8448SMatt Peters eth_dev->data->dev_flags &= ~RTE_ETH_DEV_INTR_LSC; 1367954ea115SStephen Hemminger 13686c3169a3SBruce Richardson rx_func_get(eth_dev); 13696c3169a3SBruce Richardson 13706c3169a3SBruce Richardson /* Setting up rx_header size for the device */ 13716ba1f63bSYuanhan Liu if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF) || 13726ba1f63bSYuanhan Liu vtpci_with_feature(hw, VIRTIO_F_VERSION_1)) 13736c3169a3SBruce Richardson hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr_mrg_rxbuf); 13746c3169a3SBruce Richardson else 13756c3169a3SBruce Richardson hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr); 13766c3169a3SBruce Richardson 13776c3169a3SBruce Richardson /* Copy the permanent MAC address to: virtio_hw */ 13786c3169a3SBruce Richardson virtio_get_hwaddr(hw); 13796c3169a3SBruce Richardson ether_addr_copy((struct ether_addr *) hw->mac_addr, 13806c3169a3SBruce Richardson ð_dev->data->mac_addrs[0]); 13816c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, 13826c3169a3SBruce Richardson "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X", 13836c3169a3SBruce Richardson hw->mac_addr[0], hw->mac_addr[1], hw->mac_addr[2], 13846c3169a3SBruce Richardson hw->mac_addr[3], hw->mac_addr[4], hw->mac_addr[5]); 13856c3169a3SBruce Richardson 13866c3169a3SBruce Richardson if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ)) { 13876c3169a3SBruce Richardson config = &local_config; 13886c3169a3SBruce Richardson 13896d7740e2SChangchun Ouyang vtpci_read_dev_config(hw, 13906d7740e2SChangchun Ouyang offsetof(struct virtio_net_config, mac), 13916d7740e2SChangchun Ouyang &config->mac, sizeof(config->mac)); 13926d7740e2SChangchun Ouyang 13936c3169a3SBruce Richardson if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) { 13946d7740e2SChangchun Ouyang vtpci_read_dev_config(hw, 13956d7740e2SChangchun Ouyang offsetof(struct virtio_net_config, status), 13966d7740e2SChangchun Ouyang &config->status, sizeof(config->status)); 13976c3169a3SBruce Richardson } else { 13986c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, 13996c3169a3SBruce Richardson "VIRTIO_NET_F_STATUS is not supported"); 14006c3169a3SBruce Richardson config->status = 0; 14016c3169a3SBruce Richardson } 14026c3169a3SBruce Richardson 14036c3169a3SBruce Richardson if (vtpci_with_feature(hw, VIRTIO_NET_F_MQ)) { 14046d7740e2SChangchun Ouyang vtpci_read_dev_config(hw, 14056d7740e2SChangchun Ouyang offsetof(struct virtio_net_config, max_virtqueue_pairs), 14066d7740e2SChangchun Ouyang &config->max_virtqueue_pairs, 14076d7740e2SChangchun Ouyang sizeof(config->max_virtqueue_pairs)); 14086c3169a3SBruce Richardson } else { 14096c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, 14106c3169a3SBruce Richardson "VIRTIO_NET_F_MQ is not supported"); 14116c3169a3SBruce Richardson config->max_virtqueue_pairs = 1; 14126c3169a3SBruce Richardson } 14136c3169a3SBruce Richardson 141445e4acd4SOlivier Matz hw->max_queue_pairs = config->max_virtqueue_pairs; 14156c3169a3SBruce Richardson 141649d26d9eSMaxime Coquelin if (vtpci_with_feature(hw, VIRTIO_NET_F_MTU)) { 141749d26d9eSMaxime Coquelin vtpci_read_dev_config(hw, 141849d26d9eSMaxime Coquelin offsetof(struct virtio_net_config, mtu), 141949d26d9eSMaxime Coquelin &config->mtu, 142049d26d9eSMaxime Coquelin sizeof(config->mtu)); 142149d26d9eSMaxime Coquelin 142249d26d9eSMaxime Coquelin /* 142349d26d9eSMaxime Coquelin * MTU value has already been checked at negotiation 142449d26d9eSMaxime Coquelin * time, but check again in case it has changed since 142549d26d9eSMaxime Coquelin * then, which should not happen. 142649d26d9eSMaxime Coquelin */ 142749d26d9eSMaxime Coquelin if (config->mtu < ETHER_MIN_MTU) { 142849d26d9eSMaxime Coquelin PMD_INIT_LOG(ERR, "invalid max MTU value (%u)", 142949d26d9eSMaxime Coquelin config->mtu); 143049d26d9eSMaxime Coquelin return -1; 143149d26d9eSMaxime Coquelin } 143249d26d9eSMaxime Coquelin 143349d26d9eSMaxime Coquelin hw->max_mtu = config->mtu; 143449d26d9eSMaxime Coquelin /* Set initial MTU to maximum one supported by vhost */ 143549d26d9eSMaxime Coquelin eth_dev->data->mtu = config->mtu; 143649d26d9eSMaxime Coquelin 143749d26d9eSMaxime Coquelin } else { 143849d26d9eSMaxime Coquelin hw->max_mtu = VIRTIO_MAX_RX_PKTLEN - ETHER_HDR_LEN - 143949d26d9eSMaxime Coquelin VLAN_TAG_LEN - hw->vtnet_hdr_size; 144049d26d9eSMaxime Coquelin } 144149d26d9eSMaxime Coquelin 14426c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=%d", 14436c3169a3SBruce Richardson config->max_virtqueue_pairs); 14446c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "config->status=%d", config->status); 14456c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, 14466c3169a3SBruce Richardson "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X", 14476c3169a3SBruce Richardson config->mac[0], config->mac[1], 14486c3169a3SBruce Richardson config->mac[2], config->mac[3], 14496c3169a3SBruce Richardson config->mac[4], config->mac[5]); 14506c3169a3SBruce Richardson } else { 145145e4acd4SOlivier Matz PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=1"); 145245e4acd4SOlivier Matz hw->max_queue_pairs = 1; 14536c3169a3SBruce Richardson } 14546c3169a3SBruce Richardson 145569c80d4eSYuanhan Liu ret = virtio_alloc_queues(eth_dev); 145669c80d4eSYuanhan Liu if (ret < 0) 145769c80d4eSYuanhan Liu return ret; 145826b683b4SJianfeng Tan 145926b683b4SJianfeng Tan if (eth_dev->data->dev_conf.intr_conf.rxq) { 146026b683b4SJianfeng Tan if (virtio_configure_intr(eth_dev) < 0) { 146126b683b4SJianfeng Tan PMD_INIT_LOG(ERR, "failed to configure interrupt"); 146226b683b4SJianfeng Tan return -1; 146326b683b4SJianfeng Tan } 146426b683b4SJianfeng Tan } 146526b683b4SJianfeng Tan 1466ee85024cSYuanhan Liu vtpci_reinit_complete(hw); 146769c80d4eSYuanhan Liu 1468ce2eabddSJianfeng Tan if (pci_dev) 14696c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "port %d vendorID=0x%x deviceID=0x%x", 14706c3169a3SBruce Richardson eth_dev->data->port_id, pci_dev->id.vendor_id, 14716c3169a3SBruce Richardson pci_dev->id.device_id); 14726c3169a3SBruce Richardson 1473198ab336SOlivier Matz return 0; 1474198ab336SOlivier Matz } 1475198ab336SOlivier Matz 1476198ab336SOlivier Matz /* 14776d890f8aSYuanhan Liu * Remap the PCI device again (IO port map for legacy device and 14786d890f8aSYuanhan Liu * memory map for modern device), so that the secondary process 14796d890f8aSYuanhan Liu * could have the PCI initiated correctly. 14806d890f8aSYuanhan Liu */ 14816d890f8aSYuanhan Liu static int 14826d890f8aSYuanhan Liu virtio_remap_pci(struct rte_pci_device *pci_dev, struct virtio_hw *hw) 14836d890f8aSYuanhan Liu { 14846d890f8aSYuanhan Liu if (hw->modern) { 14856d890f8aSYuanhan Liu /* 14866d890f8aSYuanhan Liu * We don't have to re-parse the PCI config space, since 1487*3dcfe039SThomas Monjalon * rte_pci_map_device() makes sure the mapped address 14886d890f8aSYuanhan Liu * in secondary process would equal to the one mapped in 14896d890f8aSYuanhan Liu * the primary process: error will be returned if that 14906d890f8aSYuanhan Liu * requirement is not met. 14916d890f8aSYuanhan Liu * 14926d890f8aSYuanhan Liu * That said, we could simply reuse all cap pointers 14936d890f8aSYuanhan Liu * (such as dev_cfg, common_cfg, etc.) parsed from the 14946d890f8aSYuanhan Liu * primary process, which is stored in shared memory. 14956d890f8aSYuanhan Liu */ 1496*3dcfe039SThomas Monjalon if (rte_pci_map_device(pci_dev)) { 14976d890f8aSYuanhan Liu PMD_INIT_LOG(DEBUG, "failed to map pci device!"); 14986d890f8aSYuanhan Liu return -1; 14996d890f8aSYuanhan Liu } 15006d890f8aSYuanhan Liu } else { 1501*3dcfe039SThomas Monjalon if (rte_pci_ioport_map(pci_dev, 0, VTPCI_IO(hw)) < 0) 15026d890f8aSYuanhan Liu return -1; 15036d890f8aSYuanhan Liu } 15046d890f8aSYuanhan Liu 15056d890f8aSYuanhan Liu return 0; 15066d890f8aSYuanhan Liu } 15076d890f8aSYuanhan Liu 15086d890f8aSYuanhan Liu static void 15096d890f8aSYuanhan Liu virtio_set_vtpci_ops(struct virtio_hw *hw) 15106d890f8aSYuanhan Liu { 1511e754c959SThomas Monjalon #ifdef RTE_VIRTIO_USER 15126d890f8aSYuanhan Liu if (hw->virtio_user_dev) 15136d890f8aSYuanhan Liu VTPCI_OPS(hw) = &virtio_user_ops; 1514e754c959SThomas Monjalon else 1515e754c959SThomas Monjalon #endif 1516e754c959SThomas Monjalon if (hw->modern) 15176d890f8aSYuanhan Liu VTPCI_OPS(hw) = &modern_ops; 15186d890f8aSYuanhan Liu else 15196d890f8aSYuanhan Liu VTPCI_OPS(hw) = &legacy_ops; 15206d890f8aSYuanhan Liu } 15216d890f8aSYuanhan Liu 15226d890f8aSYuanhan Liu /* 1523198ab336SOlivier Matz * This function is based on probe() function in virtio_pci.c 1524198ab336SOlivier Matz * It returns 0 on success. 1525198ab336SOlivier Matz */ 1526198ab336SOlivier Matz int 1527198ab336SOlivier Matz eth_virtio_dev_init(struct rte_eth_dev *eth_dev) 1528198ab336SOlivier Matz { 1529198ab336SOlivier Matz struct virtio_hw *hw = eth_dev->data->dev_private; 1530198ab336SOlivier Matz int ret; 1531198ab336SOlivier Matz 1532198ab336SOlivier Matz RTE_BUILD_BUG_ON(RTE_PKTMBUF_HEADROOM < sizeof(struct virtio_net_hdr_mrg_rxbuf)); 1533198ab336SOlivier Matz 1534198ab336SOlivier Matz eth_dev->dev_ops = &virtio_eth_dev_ops; 1535198ab336SOlivier Matz eth_dev->tx_pkt_burst = &virtio_xmit_pkts; 1536198ab336SOlivier Matz 1537198ab336SOlivier Matz if (rte_eal_process_type() == RTE_PROC_SECONDARY) { 15386d890f8aSYuanhan Liu if (!hw->virtio_user_dev) { 15396d890f8aSYuanhan Liu ret = virtio_remap_pci(RTE_DEV_TO_PCI(eth_dev->device), 15406d890f8aSYuanhan Liu hw); 15416d890f8aSYuanhan Liu if (ret) 15426d890f8aSYuanhan Liu return ret; 15436d890f8aSYuanhan Liu } 15446d890f8aSYuanhan Liu 15456d890f8aSYuanhan Liu virtio_set_vtpci_ops(hw); 1546d4be35a9SYuanhan Liu if (hw->use_simple_rxtx) { 1547d4be35a9SYuanhan Liu eth_dev->tx_pkt_burst = virtio_xmit_pkts_simple; 1548d4be35a9SYuanhan Liu eth_dev->rx_pkt_burst = virtio_recv_pkts_vec; 1549d4be35a9SYuanhan Liu } else { 1550198ab336SOlivier Matz rx_func_get(eth_dev); 1551d4be35a9SYuanhan Liu } 1552198ab336SOlivier Matz return 0; 1553198ab336SOlivier Matz } 1554198ab336SOlivier Matz 1555198ab336SOlivier Matz /* Allocate memory for storing MAC addresses */ 1556198ab336SOlivier Matz eth_dev->data->mac_addrs = rte_zmalloc("virtio", VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN, 0); 1557198ab336SOlivier Matz if (eth_dev->data->mac_addrs == NULL) { 1558198ab336SOlivier Matz PMD_INIT_LOG(ERR, 1559198ab336SOlivier Matz "Failed to allocate %d bytes needed to store MAC addresses", 1560198ab336SOlivier Matz VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN); 1561198ab336SOlivier Matz return -ENOMEM; 1562198ab336SOlivier Matz } 1563198ab336SOlivier Matz 156476873125SYuanhan Liu hw->port_id = eth_dev->data->port_id; 15656a7c0dfcSJan Blunck /* For virtio_user case the hw->virtio_user_dev is populated by 15666a7c0dfcSJan Blunck * virtio_user_eth_dev_alloc() before eth_virtio_dev_init() is called. 15676a7c0dfcSJan Blunck */ 15686a7c0dfcSJan Blunck if (!hw->virtio_user_dev) { 1569a60a0c15SJianfeng Tan ret = vtpci_init(RTE_DEV_TO_PCI(eth_dev->device), hw); 1570198ab336SOlivier Matz if (ret) 1571198ab336SOlivier Matz return ret; 1572198ab336SOlivier Matz } 1573198ab336SOlivier Matz 157460e6f470SOlivier Matz /* reset device and negotiate default features */ 157596cb6711SOlivier Matz ret = virtio_init_device(eth_dev, VIRTIO_PMD_DEFAULT_GUEST_FEATURES); 1576198ab336SOlivier Matz if (ret < 0) 1577198ab336SOlivier Matz return ret; 1578198ab336SOlivier Matz 15796c3169a3SBruce Richardson /* Setup interrupt callback */ 158062a785a6SJianfeng Tan if (eth_dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) 158161e3ee17SYuanhan Liu rte_intr_callback_register(eth_dev->intr_handle, 15826c3169a3SBruce Richardson virtio_interrupt_handler, eth_dev); 15836c3169a3SBruce Richardson 15846c3169a3SBruce Richardson return 0; 15856c3169a3SBruce Richardson } 15866c3169a3SBruce Richardson 1587abf4c84bSBernard Iremonger static int 1588abf4c84bSBernard Iremonger eth_virtio_dev_uninit(struct rte_eth_dev *eth_dev) 1589abf4c84bSBernard Iremonger { 1590abf4c84bSBernard Iremonger PMD_INIT_FUNC_TRACE(); 1591abf4c84bSBernard Iremonger 1592abf4c84bSBernard Iremonger if (rte_eal_process_type() == RTE_PROC_SECONDARY) 1593abf4c84bSBernard Iremonger return -EPERM; 1594abf4c84bSBernard Iremonger 15953f3b3d54SYuanhan Liu virtio_dev_stop(eth_dev); 1596abf4c84bSBernard Iremonger virtio_dev_close(eth_dev); 1597abf4c84bSBernard Iremonger 1598abf4c84bSBernard Iremonger eth_dev->dev_ops = NULL; 1599abf4c84bSBernard Iremonger eth_dev->tx_pkt_burst = NULL; 1600abf4c84bSBernard Iremonger eth_dev->rx_pkt_burst = NULL; 1601abf4c84bSBernard Iremonger 1602abf4c84bSBernard Iremonger rte_free(eth_dev->data->mac_addrs); 1603abf4c84bSBernard Iremonger eth_dev->data->mac_addrs = NULL; 1604abf4c84bSBernard Iremonger 1605abf4c84bSBernard Iremonger /* reset interrupt callback */ 160662a785a6SJianfeng Tan if (eth_dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) 160761e3ee17SYuanhan Liu rte_intr_callback_unregister(eth_dev->intr_handle, 1608abf4c84bSBernard Iremonger virtio_interrupt_handler, 1609abf4c84bSBernard Iremonger eth_dev); 16109470427cSYuanhan Liu if (eth_dev->device) 1611*3dcfe039SThomas Monjalon rte_pci_unmap_device(RTE_DEV_TO_PCI(eth_dev->device)); 1612abf4c84bSBernard Iremonger 1613abf4c84bSBernard Iremonger PMD_INIT_LOG(DEBUG, "dev_uninit completed"); 1614abf4c84bSBernard Iremonger 1615abf4c84bSBernard Iremonger return 0; 1616abf4c84bSBernard Iremonger } 1617abf4c84bSBernard Iremonger 1618fdf91e0fSJan Blunck static int eth_virtio_pci_probe(struct rte_pci_driver *pci_drv __rte_unused, 1619fdf91e0fSJan Blunck struct rte_pci_device *pci_dev) 1620fdf91e0fSJan Blunck { 1621fdf91e0fSJan Blunck return rte_eth_dev_pci_generic_probe(pci_dev, sizeof(struct virtio_hw), 1622fdf91e0fSJan Blunck eth_virtio_dev_init); 1623fdf91e0fSJan Blunck } 1624fdf91e0fSJan Blunck 1625fdf91e0fSJan Blunck static int eth_virtio_pci_remove(struct rte_pci_device *pci_dev) 1626fdf91e0fSJan Blunck { 1627fdf91e0fSJan Blunck return rte_eth_dev_pci_generic_remove(pci_dev, eth_virtio_dev_uninit); 1628fdf91e0fSJan Blunck } 1629fdf91e0fSJan Blunck 1630fdf91e0fSJan Blunck static struct rte_pci_driver rte_virtio_pmd = { 1631cd433ce5SDavid Marchand .driver = { 1632cd433ce5SDavid Marchand .name = "net_virtio", 1633cd433ce5SDavid Marchand }, 16346c3169a3SBruce Richardson .id_table = pci_id_virtio_map, 163522dda618SBen Walker .drv_flags = 0, 1636fdf91e0fSJan Blunck .probe = eth_virtio_pci_probe, 1637fdf91e0fSJan Blunck .remove = eth_virtio_pci_remove, 16386c3169a3SBruce Richardson }; 16396c3169a3SBruce Richardson 1640c830cb29SDavid Marchand RTE_INIT(rte_virtio_pmd_init); 1641c830cb29SDavid Marchand static void 1642c830cb29SDavid Marchand rte_virtio_pmd_init(void) 16436c3169a3SBruce Richardson { 16446c3169a3SBruce Richardson if (rte_eal_iopl_init() != 0) { 16456c3169a3SBruce Richardson PMD_INIT_LOG(ERR, "IOPL call failed - cannot use virtio PMD"); 1646c830cb29SDavid Marchand return; 16476c3169a3SBruce Richardson } 16486c3169a3SBruce Richardson 1649*3dcfe039SThomas Monjalon rte_pci_register(&rte_virtio_pmd); 16506c3169a3SBruce Richardson } 16516c3169a3SBruce Richardson 16526c3169a3SBruce Richardson /* 16536c3169a3SBruce Richardson * Configure virtio device 16546c3169a3SBruce Richardson * It returns 0 on success. 16556c3169a3SBruce Richardson */ 16566c3169a3SBruce Richardson static int 16576c3169a3SBruce Richardson virtio_dev_configure(struct rte_eth_dev *dev) 16586c3169a3SBruce Richardson { 16596c3169a3SBruce Richardson const struct rte_eth_rxmode *rxmode = &dev->data->dev_conf.rxmode; 16606c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 166160e6f470SOlivier Matz uint64_t req_features; 166245e4acd4SOlivier Matz int ret; 16636c3169a3SBruce Richardson 16646c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "configure"); 166596cb6711SOlivier Matz req_features = VIRTIO_PMD_DEFAULT_GUEST_FEATURES; 166696cb6711SOlivier Matz if (rxmode->hw_ip_checksum) 166796cb6711SOlivier Matz req_features |= (1ULL << VIRTIO_NET_F_GUEST_CSUM); 166886d59b21SOlivier Matz if (rxmode->enable_lro) 166986d59b21SOlivier Matz req_features |= 167086d59b21SOlivier Matz (1ULL << VIRTIO_NET_F_GUEST_TSO4) | 167186d59b21SOlivier Matz (1ULL << VIRTIO_NET_F_GUEST_TSO6); 16726c3169a3SBruce Richardson 167360e6f470SOlivier Matz /* if request features changed, reinit the device */ 167460e6f470SOlivier Matz if (req_features != hw->req_guest_features) { 167560e6f470SOlivier Matz ret = virtio_init_device(dev, req_features); 167660e6f470SOlivier Matz if (ret < 0) 167760e6f470SOlivier Matz return ret; 167860e6f470SOlivier Matz } 167960e6f470SOlivier Matz 168096cb6711SOlivier Matz if (rxmode->hw_ip_checksum && 168196cb6711SOlivier Matz !vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_CSUM)) { 168296cb6711SOlivier Matz PMD_DRV_LOG(NOTICE, 168396cb6711SOlivier Matz "rx ip checksum not available on this host"); 168496cb6711SOlivier Matz return -ENOTSUP; 168596cb6711SOlivier Matz } 168696cb6711SOlivier Matz 168786d59b21SOlivier Matz if (rxmode->enable_lro && 168886d59b21SOlivier Matz (!vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_TSO4) || 168986d59b21SOlivier Matz !vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_TSO4))) { 169086d59b21SOlivier Matz PMD_DRV_LOG(NOTICE, 169186d59b21SOlivier Matz "lro not available on this host"); 169286d59b21SOlivier Matz return -ENOTSUP; 169386d59b21SOlivier Matz } 169486d59b21SOlivier Matz 169569c80d4eSYuanhan Liu /* start control queue */ 169669c80d4eSYuanhan Liu if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ)) 169745e4acd4SOlivier Matz virtio_dev_cq_start(dev); 169845e4acd4SOlivier Matz 16996c3169a3SBruce Richardson hw->vlan_strip = rxmode->hw_vlan_strip; 17006c3169a3SBruce Richardson 17016c3169a3SBruce Richardson if (rxmode->hw_vlan_filter 17026c3169a3SBruce Richardson && !vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) { 17036c3169a3SBruce Richardson PMD_DRV_LOG(NOTICE, 17046c3169a3SBruce Richardson "vlan filtering not available on this host"); 17056c3169a3SBruce Richardson return -ENOTSUP; 17066c3169a3SBruce Richardson } 17076c3169a3SBruce Richardson 170862a785a6SJianfeng Tan if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) 1709981e61f5SJianfeng Tan /* Enable vector (0) for Link State Intrerrupt */ 1710981e61f5SJianfeng Tan if (VTPCI_OPS(hw)->set_config_irq(hw, 0) == 1711981e61f5SJianfeng Tan VIRTIO_MSI_NO_VECTOR) { 17126c3169a3SBruce Richardson PMD_DRV_LOG(ERR, "failed to set config vector"); 17136c3169a3SBruce Richardson return -EBUSY; 17146c3169a3SBruce Richardson } 17156c3169a3SBruce Richardson 17166c3169a3SBruce Richardson return 0; 17176c3169a3SBruce Richardson } 17186c3169a3SBruce Richardson 17196c3169a3SBruce Richardson 17206c3169a3SBruce Richardson static int 17216c3169a3SBruce Richardson virtio_dev_start(struct rte_eth_dev *dev) 17226c3169a3SBruce Richardson { 17236c3169a3SBruce Richardson uint16_t nb_queues, i; 172401ad44fdSHuawei Xie struct virtnet_rx *rxvq; 172501ad44fdSHuawei Xie struct virtnet_tx *txvq __rte_unused; 1726663c7679SYuanhan Liu struct virtio_hw *hw = dev->data->dev_private; 17276c3169a3SBruce Richardson 17286c3169a3SBruce Richardson /* check if lsc interrupt feature is enabled */ 1729954ea115SStephen Hemminger if (dev->data->dev_conf.intr_conf.lsc) { 173062a785a6SJianfeng Tan if (!(dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)) { 17316c3169a3SBruce Richardson PMD_DRV_LOG(ERR, "link status not supported by host"); 17326c3169a3SBruce Richardson return -ENOTSUP; 17336c3169a3SBruce Richardson } 1734349a447bSJianfeng Tan } 1735349a447bSJianfeng Tan 1736349a447bSJianfeng Tan /* Enable uio/vfio intr/eventfd mapping: althrough we already did that 1737349a447bSJianfeng Tan * in device configure, but it could be unmapped when device is 1738349a447bSJianfeng Tan * stopped. 1739349a447bSJianfeng Tan */ 1740349a447bSJianfeng Tan if (dev->data->dev_conf.intr_conf.lsc || 1741349a447bSJianfeng Tan dev->data->dev_conf.intr_conf.rxq) { 1742349a447bSJianfeng Tan rte_intr_disable(dev->intr_handle); 17436c3169a3SBruce Richardson 174461e3ee17SYuanhan Liu if (rte_intr_enable(dev->intr_handle) < 0) { 17456c3169a3SBruce Richardson PMD_DRV_LOG(ERR, "interrupt enable failed"); 17466c3169a3SBruce Richardson return -EIO; 17476c3169a3SBruce Richardson } 17486c3169a3SBruce Richardson } 17496c3169a3SBruce Richardson 17506c3169a3SBruce Richardson /*Notify the backend 17516c3169a3SBruce Richardson *Otherwise the tap backend might already stop its queue due to fullness. 17526c3169a3SBruce Richardson *vhost backend will have no chance to be waked up 17536c3169a3SBruce Richardson */ 175460d4a353SYuanhan Liu nb_queues = RTE_MAX(dev->data->nb_rx_queues, dev->data->nb_tx_queues); 1755663c7679SYuanhan Liu if (hw->max_queue_pairs > 1) { 17566c3169a3SBruce Richardson if (virtio_set_multiple_queues(dev, nb_queues) != 0) 17576c3169a3SBruce Richardson return -EINVAL; 17586c3169a3SBruce Richardson } 17596c3169a3SBruce Richardson 17606c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "nb_queues=%d", nb_queues); 17616c3169a3SBruce Richardson 176260d4a353SYuanhan Liu for (i = 0; i < dev->data->nb_rx_queues; i++) { 176301ad44fdSHuawei Xie rxvq = dev->data->rx_queues[i]; 176401ad44fdSHuawei Xie virtqueue_notify(rxvq->vq); 176501ad44fdSHuawei Xie } 17666c3169a3SBruce Richardson 17676c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "Notified backend at initialization"); 17686c3169a3SBruce Richardson 176901ad44fdSHuawei Xie for (i = 0; i < dev->data->nb_rx_queues; i++) { 177001ad44fdSHuawei Xie rxvq = dev->data->rx_queues[i]; 177101ad44fdSHuawei Xie VIRTQUEUE_DUMP(rxvq->vq); 177201ad44fdSHuawei Xie } 17736c3169a3SBruce Richardson 177401ad44fdSHuawei Xie for (i = 0; i < dev->data->nb_tx_queues; i++) { 177501ad44fdSHuawei Xie txvq = dev->data->tx_queues[i]; 177601ad44fdSHuawei Xie VIRTQUEUE_DUMP(txvq->vq); 177701ad44fdSHuawei Xie } 177858d9fe40SJianfeng Tan 1779aa9f0606SYuanhan Liu hw->started = 1; 17806c3169a3SBruce Richardson 178158d9fe40SJianfeng Tan /* Initialize Link state */ 178258d9fe40SJianfeng Tan virtio_dev_link_update(dev, 0); 178358d9fe40SJianfeng Tan 17846c3169a3SBruce Richardson return 0; 17856c3169a3SBruce Richardson } 17866c3169a3SBruce Richardson 17876c3169a3SBruce Richardson static void virtio_dev_free_mbufs(struct rte_eth_dev *dev) 17886c3169a3SBruce Richardson { 17896c3169a3SBruce Richardson struct rte_mbuf *buf; 17906c3169a3SBruce Richardson int i, mbuf_num = 0; 17916c3169a3SBruce Richardson 17926c3169a3SBruce Richardson for (i = 0; i < dev->data->nb_rx_queues; i++) { 179301ad44fdSHuawei Xie struct virtnet_rx *rxvq = dev->data->rx_queues[i]; 179401ad44fdSHuawei Xie 17956c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, 17966c3169a3SBruce Richardson "Before freeing rxq[%d] used and unused buf", i); 179701ad44fdSHuawei Xie VIRTQUEUE_DUMP(rxvq->vq); 17986c3169a3SBruce Richardson 179901ad44fdSHuawei Xie PMD_INIT_LOG(DEBUG, "rx_queues[%d]=%p", i, rxvq); 180001ad44fdSHuawei Xie while ((buf = virtqueue_detatch_unused(rxvq->vq)) != NULL) { 18016c3169a3SBruce Richardson rte_pktmbuf_free(buf); 18026c3169a3SBruce Richardson mbuf_num++; 18036c3169a3SBruce Richardson } 18046c3169a3SBruce Richardson 18056c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "free %d mbufs", mbuf_num); 18066c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, 18076c3169a3SBruce Richardson "After freeing rxq[%d] used and unused buf", i); 180801ad44fdSHuawei Xie VIRTQUEUE_DUMP(rxvq->vq); 18096c3169a3SBruce Richardson } 18106c3169a3SBruce Richardson 18116c3169a3SBruce Richardson for (i = 0; i < dev->data->nb_tx_queues; i++) { 181201ad44fdSHuawei Xie struct virtnet_tx *txvq = dev->data->tx_queues[i]; 181301ad44fdSHuawei Xie 18146c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, 18156c3169a3SBruce Richardson "Before freeing txq[%d] used and unused bufs", 18166c3169a3SBruce Richardson i); 181701ad44fdSHuawei Xie VIRTQUEUE_DUMP(txvq->vq); 18186c3169a3SBruce Richardson 18196c3169a3SBruce Richardson mbuf_num = 0; 182001ad44fdSHuawei Xie while ((buf = virtqueue_detatch_unused(txvq->vq)) != NULL) { 18216c3169a3SBruce Richardson rte_pktmbuf_free(buf); 18226c3169a3SBruce Richardson mbuf_num++; 18236c3169a3SBruce Richardson } 18246c3169a3SBruce Richardson 18256c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "free %d mbufs", mbuf_num); 18266c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, 18276c3169a3SBruce Richardson "After freeing txq[%d] used and unused buf", i); 182801ad44fdSHuawei Xie VIRTQUEUE_DUMP(txvq->vq); 18296c3169a3SBruce Richardson } 18306c3169a3SBruce Richardson } 18316c3169a3SBruce Richardson 18326c3169a3SBruce Richardson /* 18336c3169a3SBruce Richardson * Stop device: disable interrupt and mark link down 18346c3169a3SBruce Richardson */ 18356c3169a3SBruce Richardson static void 18366c3169a3SBruce Richardson virtio_dev_stop(struct rte_eth_dev *dev) 18376c3169a3SBruce Richardson { 1838aa9f0606SYuanhan Liu struct virtio_hw *hw = dev->data->dev_private; 18396c3169a3SBruce Richardson struct rte_eth_link link; 1840349a447bSJianfeng Tan struct rte_intr_conf *intr_conf = &dev->data->dev_conf.intr_conf; 18416c3169a3SBruce Richardson 18426c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "stop"); 18436c3169a3SBruce Richardson 1844349a447bSJianfeng Tan if (intr_conf->lsc || intr_conf->rxq) 184561e3ee17SYuanhan Liu rte_intr_disable(dev->intr_handle); 18466c3169a3SBruce Richardson 1847aa9f0606SYuanhan Liu hw->started = 0; 18486c3169a3SBruce Richardson memset(&link, 0, sizeof(link)); 18496c3169a3SBruce Richardson virtio_dev_atomic_write_link_status(dev, &link); 18506c3169a3SBruce Richardson } 18516c3169a3SBruce Richardson 18526c3169a3SBruce Richardson static int 18536c3169a3SBruce Richardson virtio_dev_link_update(struct rte_eth_dev *dev, __rte_unused int wait_to_complete) 18546c3169a3SBruce Richardson { 18556c3169a3SBruce Richardson struct rte_eth_link link, old; 18566c3169a3SBruce Richardson uint16_t status; 18576c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 18586c3169a3SBruce Richardson memset(&link, 0, sizeof(link)); 18596c3169a3SBruce Richardson virtio_dev_atomic_read_link_status(dev, &link); 18606c3169a3SBruce Richardson old = link; 186111319000SMarc Sune link.link_duplex = ETH_LINK_FULL_DUPLEX; 18626c3169a3SBruce Richardson link.link_speed = SPEED_10G; 18636c3169a3SBruce Richardson 1864aa9f0606SYuanhan Liu if (hw->started == 0) { 1865aa9f0606SYuanhan Liu link.link_status = ETH_LINK_DOWN; 1866aa9f0606SYuanhan Liu } else if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) { 18676c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "Get link status from hw"); 18686c3169a3SBruce Richardson vtpci_read_dev_config(hw, 18696c3169a3SBruce Richardson offsetof(struct virtio_net_config, status), 18706c3169a3SBruce Richardson &status, sizeof(status)); 18716c3169a3SBruce Richardson if ((status & VIRTIO_NET_S_LINK_UP) == 0) { 187209419f23SThomas Monjalon link.link_status = ETH_LINK_DOWN; 18736c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "Port %d is down", 18746c3169a3SBruce Richardson dev->data->port_id); 18756c3169a3SBruce Richardson } else { 187609419f23SThomas Monjalon link.link_status = ETH_LINK_UP; 18776c3169a3SBruce Richardson PMD_INIT_LOG(DEBUG, "Port %d is up", 18786c3169a3SBruce Richardson dev->data->port_id); 18796c3169a3SBruce Richardson } 18806c3169a3SBruce Richardson } else { 188109419f23SThomas Monjalon link.link_status = ETH_LINK_UP; 18826c3169a3SBruce Richardson } 18836c3169a3SBruce Richardson virtio_dev_atomic_write_link_status(dev, &link); 18846c3169a3SBruce Richardson 18856c3169a3SBruce Richardson return (old.link_status == link.link_status) ? -1 : 0; 18866c3169a3SBruce Richardson } 18876c3169a3SBruce Richardson 18886c3169a3SBruce Richardson static void 18896c3169a3SBruce Richardson virtio_dev_info_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info) 18906c3169a3SBruce Richardson { 1891c1e55ed3SOlivier Matz uint64_t tso_mask, host_features; 18926c3169a3SBruce Richardson struct virtio_hw *hw = dev->data->dev_private; 18936c3169a3SBruce Richardson 1894b392e987SIdo Barnea dev_info->speed_capa = ETH_LINK_SPEED_10G; /* fake value */ 1895b392e987SIdo Barnea 18969470427cSYuanhan Liu dev_info->pci_dev = dev->device ? RTE_DEV_TO_PCI(dev->device) : NULL; 189745e4acd4SOlivier Matz dev_info->max_rx_queues = 189845e4acd4SOlivier Matz RTE_MIN(hw->max_queue_pairs, VIRTIO_MAX_RX_QUEUES); 189945e4acd4SOlivier Matz dev_info->max_tx_queues = 190045e4acd4SOlivier Matz RTE_MIN(hw->max_queue_pairs, VIRTIO_MAX_TX_QUEUES); 19016c3169a3SBruce Richardson dev_info->min_rx_bufsize = VIRTIO_MIN_RX_BUFSIZE; 19026c3169a3SBruce Richardson dev_info->max_rx_pktlen = VIRTIO_MAX_RX_PKTLEN; 19036c3169a3SBruce Richardson dev_info->max_mac_addrs = VIRTIO_MAX_MAC_ADDRS; 19046c3169a3SBruce Richardson dev_info->default_txconf = (struct rte_eth_txconf) { 19056c3169a3SBruce Richardson .txq_flags = ETH_TXQ_FLAGS_NOOFFLOADS 19066c3169a3SBruce Richardson }; 190758169a9cSOlivier Matz 1908c1e55ed3SOlivier Matz host_features = VTPCI_OPS(hw)->get_features(hw); 1909c1e55ed3SOlivier Matz dev_info->rx_offload_capa = 0; 1910c1e55ed3SOlivier Matz if (host_features & (1ULL << VIRTIO_NET_F_GUEST_CSUM)) { 1911c1e55ed3SOlivier Matz dev_info->rx_offload_capa |= 1912c1e55ed3SOlivier Matz DEV_RX_OFFLOAD_TCP_CKSUM | 1913c1e55ed3SOlivier Matz DEV_RX_OFFLOAD_UDP_CKSUM; 1914c1e55ed3SOlivier Matz } 1915c1e55ed3SOlivier Matz tso_mask = (1ULL << VIRTIO_NET_F_GUEST_TSO4) | 1916c1e55ed3SOlivier Matz (1ULL << VIRTIO_NET_F_GUEST_TSO6); 1917c1e55ed3SOlivier Matz if ((host_features & tso_mask) == tso_mask) 1918c1e55ed3SOlivier Matz dev_info->rx_offload_capa |= DEV_RX_OFFLOAD_TCP_LRO; 1919c1e55ed3SOlivier Matz 1920c1e55ed3SOlivier Matz dev_info->tx_offload_capa = 0; 192158169a9cSOlivier Matz if (hw->guest_features & (1ULL << VIRTIO_NET_F_CSUM)) { 192258169a9cSOlivier Matz dev_info->tx_offload_capa |= 192358169a9cSOlivier Matz DEV_TX_OFFLOAD_UDP_CKSUM | 192458169a9cSOlivier Matz DEV_TX_OFFLOAD_TCP_CKSUM; 192558169a9cSOlivier Matz } 192669657304SOlivier Matz tso_mask = (1ULL << VIRTIO_NET_F_HOST_TSO4) | 192769657304SOlivier Matz (1ULL << VIRTIO_NET_F_HOST_TSO6); 192869657304SOlivier Matz if ((hw->guest_features & tso_mask) == tso_mask) 192969657304SOlivier Matz dev_info->tx_offload_capa |= DEV_TX_OFFLOAD_TCP_TSO; 19306c3169a3SBruce Richardson } 19316c3169a3SBruce Richardson 19326c3169a3SBruce Richardson /* 19336c3169a3SBruce Richardson * It enables testpmd to collect per queue stats. 19346c3169a3SBruce Richardson */ 19356c3169a3SBruce Richardson static int 19366c3169a3SBruce Richardson virtio_dev_queue_stats_mapping_set(__rte_unused struct rte_eth_dev *eth_dev, 19376c3169a3SBruce Richardson __rte_unused uint16_t queue_id, __rte_unused uint8_t stat_idx, 19386c3169a3SBruce Richardson __rte_unused uint8_t is_rx) 19396c3169a3SBruce Richardson { 19406c3169a3SBruce Richardson return 0; 19416c3169a3SBruce Richardson } 19426c3169a3SBruce Richardson 194301f19227SShreyansh Jain RTE_PMD_EXPORT_NAME(net_virtio, __COUNTER__); 194401f19227SShreyansh Jain RTE_PMD_REGISTER_PCI_TABLE(net_virtio, pci_id_virtio_map); 19450880c401SOlivier Matz RTE_PMD_REGISTER_KMOD_DEP(net_virtio, "* igb_uio | uio_pci_generic | vfio"); 1946