drivers/net/virtio/virtio_ethdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2010-2016 Intel Corporation
   3  */
   4
   5 #include <stdint.h>
   6 #include <string.h>
   7 #include <stdio.h>
   8 #include <errno.h>
   9 #include <unistd.h>
  10
  11 #include <ethdev_driver.h>
  12 #include <ethdev_pci.h>
  13 #include <rte_memcpy.h>
  14 #include <rte_string_fns.h>
  15 #include <rte_memzone.h>
  16 #include <rte_malloc.h>
  17 #include <rte_branch_prediction.h>
  18 #include <rte_pci.h>
  19 #include <rte_bus_pci.h>
  20 #include <rte_ether.h>
  21 #include <rte_ip.h>
  22 #include <rte_arp.h>
  23 #include <rte_common.h>
  24 #include <rte_errno.h>
  25 #include <rte_cpuflags.h>
  26 #include <rte_vect.h>
  27
  28 #include <rte_memory.h>
  29 #include <rte_eal.h>
  30 #include <rte_dev.h>
  31 #include <rte_cycles.h>
  32 #include <rte_kvargs.h>
  33
  34 #include "virtio_ethdev.h"
  35 #include "virtio_pci.h"
  36 #include "virtio_logs.h"
  37 #include "virtqueue.h"
  38 #include "virtio_rxtx.h"
  39 #include "virtio_user/virtio_user_dev.h"
  40
  41 static int  virtio_dev_configure(struct rte_eth_dev *dev);
  42 static int  virtio_dev_start(struct rte_eth_dev *dev);
  43 static int virtio_dev_promiscuous_enable(struct rte_eth_dev *dev);
  44 static int virtio_dev_promiscuous_disable(struct rte_eth_dev *dev);
  45 static int virtio_dev_allmulticast_enable(struct rte_eth_dev *dev);
  46 static int virtio_dev_allmulticast_disable(struct rte_eth_dev *dev);
  47 static uint32_t virtio_dev_speed_capa_get(uint32_t speed);
  48 static int virtio_dev_devargs_parse(struct rte_devargs *devargs,
  49         uint32_t *speed,
  50         int *vectorized);
  51 static int virtio_dev_info_get(struct rte_eth_dev *dev,
  52                                 struct rte_eth_dev_info *dev_info);
  53 static int virtio_dev_link_update(struct rte_eth_dev *dev,
  54         int wait_to_complete);
  55 static int virtio_dev_vlan_offload_set(struct rte_eth_dev *dev, int mask);
  56
  57 static void virtio_set_hwaddr(struct virtio_hw *hw);
  58 static void virtio_get_hwaddr(struct virtio_hw *hw);
  59
  60 static int virtio_dev_stats_get(struct rte_eth_dev *dev,
  61                                  struct rte_eth_stats *stats);
  62 static int virtio_dev_xstats_get(struct rte_eth_dev *dev,
  63                                  struct rte_eth_xstat *xstats, unsigned n);
  64 static int virtio_dev_xstats_get_names(struct rte_eth_dev *dev,
  65                                        struct rte_eth_xstat_name *xstats_names,
  66                                        unsigned limit);
  67 static int virtio_dev_stats_reset(struct rte_eth_dev *dev);
  68 static void virtio_dev_free_mbufs(struct rte_eth_dev *dev);
  69 static int virtio_vlan_filter_set(struct rte_eth_dev *dev,
  70                                 uint16_t vlan_id, int on);
  71 static int virtio_mac_addr_add(struct rte_eth_dev *dev,
  72                                 struct rte_ether_addr *mac_addr,
  73                                 uint32_t index, uint32_t vmdq);
  74 static void virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index);
  75 static int virtio_mac_addr_set(struct rte_eth_dev *dev,
  76                                 struct rte_ether_addr *mac_addr);
  77
  78 static int virtio_intr_disable(struct rte_eth_dev *dev);
  79
  80 static int virtio_dev_queue_stats_mapping_set(
  81         struct rte_eth_dev *eth_dev,
  82         uint16_t queue_id,
  83         uint8_t stat_idx,
  84         uint8_t is_rx);
  85
  86 static void virtio_notify_peers(struct rte_eth_dev *dev);
  87 static void virtio_ack_link_announce(struct rte_eth_dev *dev);
  88
  89 struct rte_virtio_xstats_name_off {
  90         char name[RTE_ETH_XSTATS_NAME_SIZE];
  91         unsigned offset;
  92 };
  93
  94 /* [rt]x_qX_ is prepended to the name string here */
  95 static const struct rte_virtio_xstats_name_off rte_virtio_rxq_stat_strings[] = {
  96         {"good_packets",           offsetof(struct virtnet_rx, stats.packets)},
  97         {"good_bytes",             offsetof(struct virtnet_rx, stats.bytes)},
  98         {"errors",                 offsetof(struct virtnet_rx, stats.errors)},
  99         {"multicast_packets",      offsetof(struct virtnet_rx, stats.multicast)},
 100         {"broadcast_packets",      offsetof(struct virtnet_rx, stats.broadcast)},
 101         {"undersize_packets",      offsetof(struct virtnet_rx, stats.size_bins[0])},
 102         {"size_64_packets",        offsetof(struct virtnet_rx, stats.size_bins[1])},
 103         {"size_65_127_packets",    offsetof(struct virtnet_rx, stats.size_bins[2])},
 104         {"size_128_255_packets",   offsetof(struct virtnet_rx, stats.size_bins[3])},
 105         {"size_256_511_packets",   offsetof(struct virtnet_rx, stats.size_bins[4])},
 106         {"size_512_1023_packets",  offsetof(struct virtnet_rx, stats.size_bins[5])},
 107         {"size_1024_1518_packets", offsetof(struct virtnet_rx, stats.size_bins[6])},
 108         {"size_1519_max_packets",  offsetof(struct virtnet_rx, stats.size_bins[7])},
 109 };
 110
 111 /* [rt]x_qX_ is prepended to the name string here */
 112 static const struct rte_virtio_xstats_name_off rte_virtio_txq_stat_strings[] = {
 113         {"good_packets",           offsetof(struct virtnet_tx, stats.packets)},
 114         {"good_bytes",             offsetof(struct virtnet_tx, stats.bytes)},
 115         {"multicast_packets",      offsetof(struct virtnet_tx, stats.multicast)},
 116         {"broadcast_packets",      offsetof(struct virtnet_tx, stats.broadcast)},
 117         {"undersize_packets",      offsetof(struct virtnet_tx, stats.size_bins[0])},
 118         {"size_64_packets",        offsetof(struct virtnet_tx, stats.size_bins[1])},
 119         {"size_65_127_packets",    offsetof(struct virtnet_tx, stats.size_bins[2])},
 120         {"size_128_255_packets",   offsetof(struct virtnet_tx, stats.size_bins[3])},
 121         {"size_256_511_packets",   offsetof(struct virtnet_tx, stats.size_bins[4])},
 122         {"size_512_1023_packets",  offsetof(struct virtnet_tx, stats.size_bins[5])},
 123         {"size_1024_1518_packets", offsetof(struct virtnet_tx, stats.size_bins[6])},
 124         {"size_1519_max_packets",  offsetof(struct virtnet_tx, stats.size_bins[7])},
 125 };
 126
 127 #define VIRTIO_NB_RXQ_XSTATS (sizeof(rte_virtio_rxq_stat_strings) / \
 128                             sizeof(rte_virtio_rxq_stat_strings[0]))
 129 #define VIRTIO_NB_TXQ_XSTATS (sizeof(rte_virtio_txq_stat_strings) / \
 130                             sizeof(rte_virtio_txq_stat_strings[0]))
 131
 132 struct virtio_hw_internal virtio_hw_internal[RTE_MAX_ETHPORTS];
 133
 134 static struct virtio_pmd_ctrl *
 135 virtio_send_command_packed(struct virtnet_ctl *cvq,
 136                            struct virtio_pmd_ctrl *ctrl,
 137                            int *dlen, int pkt_num)
 138 {
 139         struct virtqueue *vq = cvq->vq;
 140         int head;
 141         struct vring_packed_desc *desc = vq->vq_packed.ring.desc;
 142         struct virtio_pmd_ctrl *result;
 143         uint16_t flags;
 144         int sum = 0;
 145         int nb_descs = 0;
 146         int k;
 147
 148         /*
 149          * Format is enforced in qemu code:
 150          * One TX packet for header;
 151          * At least one TX packet per argument;
 152          * One RX packet for ACK.
 153          */
 154         head = vq->vq_avail_idx;
 155         flags = vq->vq_packed.cached_flags;
 156         desc[head].addr = cvq->virtio_net_hdr_mem;
 157         desc[head].len = sizeof(struct virtio_net_ctrl_hdr);
 158         vq->vq_free_cnt--;
 159         nb_descs++;
 160         if (++vq->vq_avail_idx >= vq->vq_nentries) {
 161                 vq->vq_avail_idx -= vq->vq_nentries;
 162                 vq->vq_packed.cached_flags ^= VRING_PACKED_DESC_F_AVAIL_USED;
 163         }
 164
 165         for (k = 0; k < pkt_num; k++) {
 166                 desc[vq->vq_avail_idx].addr = cvq->virtio_net_hdr_mem
 167                         + sizeof(struct virtio_net_ctrl_hdr)
 168                         + sizeof(ctrl->status) + sizeof(uint8_t) * sum;
 169                 desc[vq->vq_avail_idx].len = dlen[k];
 170                 desc[vq->vq_avail_idx].flags = VRING_DESC_F_NEXT |
 171                         vq->vq_packed.cached_flags;
 172                 sum += dlen[k];
 173                 vq->vq_free_cnt--;
 174                 nb_descs++;
 175                 if (++vq->vq_avail_idx >= vq->vq_nentries) {
 176                         vq->vq_avail_idx -= vq->vq_nentries;
 177                         vq->vq_packed.cached_flags ^=
 178                                 VRING_PACKED_DESC_F_AVAIL_USED;
 179                 }
 180         }
 181
 182         desc[vq->vq_avail_idx].addr = cvq->virtio_net_hdr_mem
 183                 + sizeof(struct virtio_net_ctrl_hdr);
 184         desc[vq->vq_avail_idx].len = sizeof(ctrl->status);
 185         desc[vq->vq_avail_idx].flags = VRING_DESC_F_WRITE |
 186                 vq->vq_packed.cached_flags;
 187         vq->vq_free_cnt--;
 188         nb_descs++;
 189         if (++vq->vq_avail_idx >= vq->vq_nentries) {
 190                 vq->vq_avail_idx -= vq->vq_nentries;
 191                 vq->vq_packed.cached_flags ^= VRING_PACKED_DESC_F_AVAIL_USED;
 192         }
 193
 194         virtqueue_store_flags_packed(&desc[head], VRING_DESC_F_NEXT | flags,
 195                         vq->hw->weak_barriers);
 196
 197         virtio_wmb(vq->hw->weak_barriers);
 198         virtqueue_notify(vq);
 199
 200         /* wait for used desc in virtqueue
 201          * desc_is_used has a load-acquire or rte_io_rmb inside
 202          */
 203         while (!desc_is_used(&desc[head], vq))
 204                 usleep(100);
 205
 206         /* now get used descriptors */
 207         vq->vq_free_cnt += nb_descs;
 208         vq->vq_used_cons_idx += nb_descs;
 209         if (vq->vq_used_cons_idx >= vq->vq_nentries) {
 210                 vq->vq_used_cons_idx -= vq->vq_nentries;
 211                 vq->vq_packed.used_wrap_counter ^= 1;
 212         }
 213
 214         PMD_INIT_LOG(DEBUG, "vq->vq_free_cnt=%d\n"
 215                         "vq->vq_avail_idx=%d\n"
 216                         "vq->vq_used_cons_idx=%d\n"
 217                         "vq->vq_packed.cached_flags=0x%x\n"
 218                         "vq->vq_packed.used_wrap_counter=%d\n",
 219                         vq->vq_free_cnt,
 220                         vq->vq_avail_idx,
 221                         vq->vq_used_cons_idx,
 222                         vq->vq_packed.cached_flags,
 223                         vq->vq_packed.used_wrap_counter);
 224
 225         result = cvq->virtio_net_hdr_mz->addr;
 226         return result;
 227 }
 228
 229 static struct virtio_pmd_ctrl *
 230 virtio_send_command_split(struct virtnet_ctl *cvq,
 231                           struct virtio_pmd_ctrl *ctrl,
 232                           int *dlen, int pkt_num)
 233 {
 234         struct virtio_pmd_ctrl *result;
 235         struct virtqueue *vq = cvq->vq;
 236         uint32_t head, i;
 237         int k, sum = 0;
 238
 239         head = vq->vq_desc_head_idx;
 240
 241         /*
 242          * Format is enforced in qemu code:
 243          * One TX packet for header;
 244          * At least one TX packet per argument;
 245          * One RX packet for ACK.
 246          */
 247         vq->vq_split.ring.desc[head].flags = VRING_DESC_F_NEXT;
 248         vq->vq_split.ring.desc[head].addr = cvq->virtio_net_hdr_mem;
 249         vq->vq_split.ring.desc[head].len = sizeof(struct virtio_net_ctrl_hdr);
 250         vq->vq_free_cnt--;
 251         i = vq->vq_split.ring.desc[head].next;
 252
 253         for (k = 0; k < pkt_num; k++) {
 254                 vq->vq_split.ring.desc[i].flags = VRING_DESC_F_NEXT;
 255                 vq->vq_split.ring.desc[i].addr = cvq->virtio_net_hdr_mem
 256                         + sizeof(struct virtio_net_ctrl_hdr)
 257                         + sizeof(ctrl->status) + sizeof(uint8_t)*sum;
 258                 vq->vq_split.ring.desc[i].len = dlen[k];
 259                 sum += dlen[k];
 260                 vq->vq_free_cnt--;
 261                 i = vq->vq_split.ring.desc[i].next;
 262         }
 263
 264         vq->vq_split.ring.desc[i].flags = VRING_DESC_F_WRITE;
 265         vq->vq_split.ring.desc[i].addr = cvq->virtio_net_hdr_mem
 266                         + sizeof(struct virtio_net_ctrl_hdr);
 267         vq->vq_split.ring.desc[i].len = sizeof(ctrl->status);
 268         vq->vq_free_cnt--;
 269
 270         vq->vq_desc_head_idx = vq->vq_split.ring.desc[i].next;
 271
 272         vq_update_avail_ring(vq, head);
 273         vq_update_avail_idx(vq);
 274
 275         PMD_INIT_LOG(DEBUG, "vq->vq_queue_index = %d", vq->vq_queue_index);
 276
 277         virtqueue_notify(vq);
 278
 279         while (virtqueue_nused(vq) == 0)
 280                 usleep(100);
 281
 282         while (virtqueue_nused(vq)) {
 283                 uint32_t idx, desc_idx, used_idx;
 284                 struct vring_used_elem *uep;
 285
 286                 used_idx = (uint32_t)(vq->vq_used_cons_idx
 287                                 & (vq->vq_nentries - 1));
 288                 uep = &vq->vq_split.ring.used->ring[used_idx];
 289                 idx = (uint32_t) uep->id;
 290                 desc_idx = idx;
 291
 292                 while (vq->vq_split.ring.desc[desc_idx].flags &
 293                                 VRING_DESC_F_NEXT) {
 294                         desc_idx = vq->vq_split.ring.desc[desc_idx].next;
 295                         vq->vq_free_cnt++;
 296                 }
 297
 298                 vq->vq_split.ring.desc[desc_idx].next = vq->vq_desc_head_idx;
 299                 vq->vq_desc_head_idx = idx;
 300
 301                 vq->vq_used_cons_idx++;
 302                 vq->vq_free_cnt++;
 303         }
 304
 305         PMD_INIT_LOG(DEBUG, "vq->vq_free_cnt=%d\nvq->vq_desc_head_idx=%d",
 306                         vq->vq_free_cnt, vq->vq_desc_head_idx);
 307
 308         result = cvq->virtio_net_hdr_mz->addr;
 309         return result;
 310 }
 311
 312 static int
 313 virtio_send_command(struct virtnet_ctl *cvq, struct virtio_pmd_ctrl *ctrl,
 314                     int *dlen, int pkt_num)
 315 {
 316         virtio_net_ctrl_ack status = ~0;
 317         struct virtio_pmd_ctrl *result;
 318         struct virtqueue *vq;
 319
 320         ctrl->status = status;
 321
 322         if (!cvq || !cvq->vq) {
 323                 PMD_INIT_LOG(ERR, "Control queue is not supported.");
 324                 return -1;
 325         }
 326
 327         rte_spinlock_lock(&cvq->lock);
 328         vq = cvq->vq;
 329
 330         PMD_INIT_LOG(DEBUG, "vq->vq_desc_head_idx = %d, status = %d, "
 331                 "vq->hw->cvq = %p vq = %p",
 332                 vq->vq_desc_head_idx, status, vq->hw->cvq, vq);
 333
 334         if (vq->vq_free_cnt < pkt_num + 2 || pkt_num < 1) {
 335                 rte_spinlock_unlock(&cvq->lock);
 336                 return -1;
 337         }
 338
 339         memcpy(cvq->virtio_net_hdr_mz->addr, ctrl,
 340                 sizeof(struct virtio_pmd_ctrl));
 341
 342         if (virtio_with_packed_queue(vq->hw))
 343                 result = virtio_send_command_packed(cvq, ctrl, dlen, pkt_num);
 344         else
 345                 result = virtio_send_command_split(cvq, ctrl, dlen, pkt_num);
 346
 347         rte_spinlock_unlock(&cvq->lock);
 348         return result->status;
 349 }
 350
 351 static int
 352 virtio_set_multiple_queues(struct rte_eth_dev *dev, uint16_t nb_queues)
 353 {
 354         struct virtio_hw *hw = dev->data->dev_private;
 355         struct virtio_pmd_ctrl ctrl;
 356         int dlen[1];
 357         int ret;
 358
 359         ctrl.hdr.class = VIRTIO_NET_CTRL_MQ;
 360         ctrl.hdr.cmd = VIRTIO_NET_CTRL_MQ_VQ_PAIRS_SET;
 361         memcpy(ctrl.data, &nb_queues, sizeof(uint16_t));
 362
 363         dlen[0] = sizeof(uint16_t);
 364
 365         ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
 366         if (ret) {
 367                 PMD_INIT_LOG(ERR, "Multiqueue configured but send command "
 368                           "failed, this is too late now...");
 369                 return -EINVAL;
 370         }
 371
 372         return 0;
 373 }
 374
 375 static void
 376 virtio_dev_queue_release(void *queue __rte_unused)
 377 {
 378         /* do nothing */
 379 }
 380
 381 static uint16_t
 382 virtio_get_nr_vq(struct virtio_hw *hw)
 383 {
 384         uint16_t nr_vq = hw->max_queue_pairs * 2;
 385
 386         if (virtio_with_feature(hw, VIRTIO_NET_F_CTRL_VQ))
 387                 nr_vq += 1;
 388
 389         return nr_vq;
 390 }
 391
 392 static void
 393 virtio_init_vring(struct virtqueue *vq)
 394 {
 395         int size = vq->vq_nentries;
 396         uint8_t *ring_mem = vq->vq_ring_virt_mem;
 397
 398         PMD_INIT_FUNC_TRACE();
 399
 400         memset(ring_mem, 0, vq->vq_ring_size);
 401
 402         vq->vq_used_cons_idx = 0;
 403         vq->vq_desc_head_idx = 0;
 404         vq->vq_avail_idx = 0;
 405         vq->vq_desc_tail_idx = (uint16_t)(vq->vq_nentries - 1);
 406         vq->vq_free_cnt = vq->vq_nentries;
 407         memset(vq->vq_descx, 0, sizeof(struct vq_desc_extra) * vq->vq_nentries);
 408         if (virtio_with_packed_queue(vq->hw)) {
 409                 vring_init_packed(&vq->vq_packed.ring, ring_mem,
 410                                   VIRTIO_PCI_VRING_ALIGN, size);
 411                 vring_desc_init_packed(vq, size);
 412         } else {
 413                 struct vring *vr = &vq->vq_split.ring;
 414
 415                 vring_init_split(vr, ring_mem, VIRTIO_PCI_VRING_ALIGN, size);
 416                 vring_desc_init_split(vr->desc, size);
 417         }
 418         /*
 419          * Disable device(host) interrupting guest
 420          */
 421         virtqueue_disable_intr(vq);
 422 }
 423
 424 static int
 425 virtio_init_queue(struct rte_eth_dev *dev, uint16_t vtpci_queue_idx)
 426 {
 427         char vq_name[VIRTQUEUE_MAX_NAME_SZ];
 428         char vq_hdr_name[VIRTQUEUE_MAX_NAME_SZ];
 429         const struct rte_memzone *mz = NULL, *hdr_mz = NULL;
 430         unsigned int vq_size, size;
 431         struct virtio_hw *hw = dev->data->dev_private;
 432         struct virtnet_rx *rxvq = NULL;
 433         struct virtnet_tx *txvq = NULL;
 434         struct virtnet_ctl *cvq = NULL;
 435         struct virtqueue *vq;
 436         size_t sz_hdr_mz = 0;
 437         void *sw_ring = NULL;
 438         int queue_type = virtio_get_queue_type(hw, vtpci_queue_idx);
 439         int ret;
 440         int numa_node = dev->device->numa_node;
 441
 442         PMD_INIT_LOG(INFO, "setting up queue: %u on NUMA node %d",
 443                         vtpci_queue_idx, numa_node);
 444
 445         /*
 446          * Read the virtqueue size from the Queue Size field
 447          * Always power of 2 and if 0 virtqueue does not exist
 448          */
 449         vq_size = VIRTIO_OPS(hw)->get_queue_num(hw, vtpci_queue_idx);
 450         PMD_INIT_LOG(DEBUG, "vq_size: %u", vq_size);
 451         if (vq_size == 0) {
 452                 PMD_INIT_LOG(ERR, "virtqueue does not exist");
 453                 return -EINVAL;
 454         }
 455
 456         if (!virtio_with_packed_queue(hw) && !rte_is_power_of_2(vq_size)) {
 457                 PMD_INIT_LOG(ERR, "split virtqueue size is not power of 2");
 458                 return -EINVAL;
 459         }
 460
 461         snprintf(vq_name, sizeof(vq_name), "port%d_vq%d",
 462                  dev->data->port_id, vtpci_queue_idx);
 463
 464         size = RTE_ALIGN_CEIL(sizeof(*vq) +
 465                                 vq_size * sizeof(struct vq_desc_extra),
 466                                 RTE_CACHE_LINE_SIZE);
 467         if (queue_type == VTNET_TQ) {
 468                 /*
 469                  * For each xmit packet, allocate a virtio_net_hdr
 470                  * and indirect ring elements
 471                  */
 472                 sz_hdr_mz = vq_size * sizeof(struct virtio_tx_region);
 473         } else if (queue_type == VTNET_CQ) {
 474                 /* Allocate a page for control vq command, data and status */
 475                 sz_hdr_mz = PAGE_SIZE;
 476         }
 477
 478         vq = rte_zmalloc_socket(vq_name, size, RTE_CACHE_LINE_SIZE,
 479                                 numa_node);
 480         if (vq == NULL) {
 481                 PMD_INIT_LOG(ERR, "can not allocate vq");
 482                 return -ENOMEM;
 483         }
 484         hw->vqs[vtpci_queue_idx] = vq;
 485
 486         vq->hw = hw;
 487         vq->vq_queue_index = vtpci_queue_idx;
 488         vq->vq_nentries = vq_size;
 489         if (virtio_with_packed_queue(hw)) {
 490                 vq->vq_packed.used_wrap_counter = 1;
 491                 vq->vq_packed.cached_flags = VRING_PACKED_DESC_F_AVAIL;
 492                 vq->vq_packed.event_flags_shadow = 0;
 493                 if (queue_type == VTNET_RQ)
 494                         vq->vq_packed.cached_flags |= VRING_DESC_F_WRITE;
 495         }
 496
 497         /*
 498          * Reserve a memzone for vring elements
 499          */
 500         size = vring_size(hw, vq_size, VIRTIO_PCI_VRING_ALIGN);
 501         vq->vq_ring_size = RTE_ALIGN_CEIL(size, VIRTIO_PCI_VRING_ALIGN);
 502         PMD_INIT_LOG(DEBUG, "vring_size: %d, rounded_vring_size: %d",
 503                      size, vq->vq_ring_size);
 504
 505         mz = rte_memzone_reserve_aligned(vq_name, vq->vq_ring_size,
 506                         numa_node, RTE_MEMZONE_IOVA_CONTIG,
 507                         VIRTIO_PCI_VRING_ALIGN);
 508         if (mz == NULL) {
 509                 if (rte_errno == EEXIST)
 510                         mz = rte_memzone_lookup(vq_name);
 511                 if (mz == NULL) {
 512                         ret = -ENOMEM;
 513                         goto fail_q_alloc;
 514                 }
 515         }
 516
 517         memset(mz->addr, 0, mz->len);
 518
 519         vq->vq_ring_mem = mz->iova;
 520         vq->vq_ring_virt_mem = mz->addr;
 521         PMD_INIT_LOG(DEBUG, "vq->vq_ring_mem:      0x%" PRIx64,
 522                      (uint64_t)mz->iova);
 523         PMD_INIT_LOG(DEBUG, "vq->vq_ring_virt_mem: 0x%" PRIx64,
 524                      (uint64_t)(uintptr_t)mz->addr);
 525
 526         virtio_init_vring(vq);
 527
 528         if (sz_hdr_mz) {
 529                 snprintf(vq_hdr_name, sizeof(vq_hdr_name), "port%d_vq%d_hdr",
 530                          dev->data->port_id, vtpci_queue_idx);
 531                 hdr_mz = rte_memzone_reserve_aligned(vq_hdr_name, sz_hdr_mz,
 532                                 numa_node, RTE_MEMZONE_IOVA_CONTIG,
 533                                 RTE_CACHE_LINE_SIZE);
 534                 if (hdr_mz == NULL) {
 535                         if (rte_errno == EEXIST)
 536                                 hdr_mz = rte_memzone_lookup(vq_hdr_name);
 537                         if (hdr_mz == NULL) {
 538                                 ret = -ENOMEM;
 539                                 goto fail_q_alloc;
 540                         }
 541                 }
 542         }
 543
 544         if (queue_type == VTNET_RQ) {
 545                 size_t sz_sw = (RTE_PMD_VIRTIO_RX_MAX_BURST + vq_size) *
 546                                sizeof(vq->sw_ring[0]);
 547
 548                 sw_ring = rte_zmalloc_socket("sw_ring", sz_sw,
 549                                 RTE_CACHE_LINE_SIZE, numa_node);
 550                 if (!sw_ring) {
 551                         PMD_INIT_LOG(ERR, "can not allocate RX soft ring");
 552                         ret = -ENOMEM;
 553                         goto fail_q_alloc;
 554                 }
 555
 556                 vq->sw_ring = sw_ring;
 557                 rxvq = &vq->rxq;
 558                 rxvq->vq = vq;
 559                 rxvq->port_id = dev->data->port_id;
 560                 rxvq->mz = mz;
 561         } else if (queue_type == VTNET_TQ) {
 562                 txvq = &vq->txq;
 563                 txvq->vq = vq;
 564                 txvq->port_id = dev->data->port_id;
 565                 txvq->mz = mz;
 566                 txvq->virtio_net_hdr_mz = hdr_mz;
 567                 txvq->virtio_net_hdr_mem = hdr_mz->iova;
 568         } else if (queue_type == VTNET_CQ) {
 569                 cvq = &vq->cq;
 570                 cvq->vq = vq;
 571                 cvq->mz = mz;
 572                 cvq->virtio_net_hdr_mz = hdr_mz;
 573                 cvq->virtio_net_hdr_mem = hdr_mz->iova;
 574                 memset(cvq->virtio_net_hdr_mz->addr, 0, PAGE_SIZE);
 575
 576                 hw->cvq = cvq;
 577         }
 578
 579         if (queue_type == VTNET_TQ) {
 580                 struct virtio_tx_region *txr;
 581                 unsigned int i;
 582
 583                 txr = hdr_mz->addr;
 584                 memset(txr, 0, vq_size * sizeof(*txr));
 585                 for (i = 0; i < vq_size; i++) {
 586                         /* first indirect descriptor is always the tx header */
 587                         if (!virtio_with_packed_queue(hw)) {
 588                                 struct vring_desc *start_dp = txr[i].tx_indir;
 589                                 vring_desc_init_split(start_dp,
 590                                                       RTE_DIM(txr[i].tx_indir));
 591                                 start_dp->addr = txvq->virtio_net_hdr_mem
 592                                         + i * sizeof(*txr)
 593                                         + offsetof(struct virtio_tx_region,
 594                                                    tx_hdr);
 595                                 start_dp->len = hw->vtnet_hdr_size;
 596                                 start_dp->flags = VRING_DESC_F_NEXT;
 597                         } else {
 598                                 struct vring_packed_desc *start_dp =
 599                                         txr[i].tx_packed_indir;
 600                                 vring_desc_init_indirect_packed(start_dp,
 601                                       RTE_DIM(txr[i].tx_packed_indir));
 602                                 start_dp->addr = txvq->virtio_net_hdr_mem
 603                                         + i * sizeof(*txr)
 604                                         + offsetof(struct virtio_tx_region,
 605                                                    tx_hdr);
 606                                 start_dp->len = hw->vtnet_hdr_size;
 607                         }
 608                 }
 609         }
 610
 611         if (VIRTIO_OPS(hw)->setup_queue(hw, vq) < 0) {
 612                 PMD_INIT_LOG(ERR, "setup_queue failed");
 613                 return -EINVAL;
 614         }
 615
 616         return 0;
 617
 618 fail_q_alloc:
 619         rte_free(sw_ring);
 620         rte_memzone_free(hdr_mz);
 621         rte_memzone_free(mz);
 622         rte_free(vq);
 623
 624         return ret;
 625 }
 626
 627 static void
 628 virtio_free_queues(struct virtio_hw *hw)
 629 {
 630         uint16_t nr_vq = virtio_get_nr_vq(hw);
 631         struct virtqueue *vq;
 632         int queue_type;
 633         uint16_t i;
 634
 635         if (hw->vqs == NULL)
 636                 return;
 637
 638         for (i = 0; i < nr_vq; i++) {
 639                 vq = hw->vqs[i];
 640                 if (!vq)
 641                         continue;
 642
 643                 queue_type = virtio_get_queue_type(hw, i);
 644                 if (queue_type == VTNET_RQ) {
 645                         rte_free(vq->sw_ring);
 646                         rte_memzone_free(vq->rxq.mz);
 647                 } else if (queue_type == VTNET_TQ) {
 648                         rte_memzone_free(vq->txq.mz);
 649                         rte_memzone_free(vq->txq.virtio_net_hdr_mz);
 650                 } else {
 651                         rte_memzone_free(vq->cq.mz);
 652                         rte_memzone_free(vq->cq.virtio_net_hdr_mz);
 653                 }
 654
 655                 rte_free(vq);
 656                 hw->vqs[i] = NULL;
 657         }
 658
 659         rte_free(hw->vqs);
 660         hw->vqs = NULL;
 661 }
 662
 663 static int
 664 virtio_alloc_queues(struct rte_eth_dev *dev)
 665 {
 666         struct virtio_hw *hw = dev->data->dev_private;
 667         uint16_t nr_vq = virtio_get_nr_vq(hw);
 668         uint16_t i;
 669         int ret;
 670
 671         hw->vqs = rte_zmalloc(NULL, sizeof(struct virtqueue *) * nr_vq, 0);
 672         if (!hw->vqs) {
 673                 PMD_INIT_LOG(ERR, "failed to allocate vqs");
 674                 return -ENOMEM;
 675         }
 676
 677         for (i = 0; i < nr_vq; i++) {
 678                 ret = virtio_init_queue(dev, i);
 679                 if (ret < 0) {
 680                         virtio_free_queues(hw);
 681                         return ret;
 682                 }
 683         }
 684
 685         return 0;
 686 }
 687
 688 static void virtio_queues_unbind_intr(struct rte_eth_dev *dev);
 689
 690 int
 691 virtio_dev_close(struct rte_eth_dev *dev)
 692 {
 693         struct virtio_hw *hw = dev->data->dev_private;
 694         struct rte_intr_conf *intr_conf = &dev->data->dev_conf.intr_conf;
 695
 696         PMD_INIT_LOG(DEBUG, "virtio_dev_close");
 697         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 698                 return 0;
 699
 700         if (!hw->opened)
 701                 return 0;
 702         hw->opened = 0;
 703
 704         /* reset the NIC */
 705         if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)
 706                 VIRTIO_OPS(hw)->set_config_irq(hw, VIRTIO_MSI_NO_VECTOR);
 707         if (intr_conf->rxq)
 708                 virtio_queues_unbind_intr(dev);
 709
 710         if (intr_conf->lsc || intr_conf->rxq) {
 711                 virtio_intr_disable(dev);
 712                 rte_intr_efd_disable(dev->intr_handle);
 713                 rte_free(dev->intr_handle->intr_vec);
 714                 dev->intr_handle->intr_vec = NULL;
 715         }
 716
 717         virtio_reset(hw);
 718         virtio_dev_free_mbufs(dev);
 719         virtio_free_queues(hw);
 720
 721         return VIRTIO_OPS(hw)->dev_close(hw);
 722 }
 723
 724 static int
 725 virtio_dev_promiscuous_enable(struct rte_eth_dev *dev)
 726 {
 727         struct virtio_hw *hw = dev->data->dev_private;
 728         struct virtio_pmd_ctrl ctrl;
 729         int dlen[1];
 730         int ret;
 731
 732         if (!virtio_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) {
 733                 PMD_INIT_LOG(INFO, "host does not support rx control");
 734                 return -ENOTSUP;
 735         }
 736
 737         ctrl.hdr.class = VIRTIO_NET_CTRL_RX;
 738         ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC;
 739         ctrl.data[0] = 1;
 740         dlen[0] = 1;
 741
 742         ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
 743         if (ret) {
 744                 PMD_INIT_LOG(ERR, "Failed to enable promisc");
 745                 return -EAGAIN;
 746         }
 747
 748         return 0;
 749 }
 750
 751 static int
 752 virtio_dev_promiscuous_disable(struct rte_eth_dev *dev)
 753 {
 754         struct virtio_hw *hw = dev->data->dev_private;
 755         struct virtio_pmd_ctrl ctrl;
 756         int dlen[1];
 757         int ret;
 758
 759         if (!virtio_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) {
 760                 PMD_INIT_LOG(INFO, "host does not support rx control");
 761                 return -ENOTSUP;
 762         }
 763
 764         ctrl.hdr.class = VIRTIO_NET_CTRL_RX;
 765         ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC;
 766         ctrl.data[0] = 0;
 767         dlen[0] = 1;
 768
 769         ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
 770         if (ret) {
 771                 PMD_INIT_LOG(ERR, "Failed to disable promisc");
 772                 return -EAGAIN;
 773         }
 774
 775         return 0;
 776 }
 777
 778 static int
 779 virtio_dev_allmulticast_enable(struct rte_eth_dev *dev)
 780 {
 781         struct virtio_hw *hw = dev->data->dev_private;
 782         struct virtio_pmd_ctrl ctrl;
 783         int dlen[1];
 784         int ret;
 785
 786         if (!virtio_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) {
 787                 PMD_INIT_LOG(INFO, "host does not support rx control");
 788                 return -ENOTSUP;
 789         }
 790
 791         ctrl.hdr.class = VIRTIO_NET_CTRL_RX;
 792         ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI;
 793         ctrl.data[0] = 1;
 794         dlen[0] = 1;
 795
 796         ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
 797         if (ret) {
 798                 PMD_INIT_LOG(ERR, "Failed to enable allmulticast");
 799                 return -EAGAIN;
 800         }
 801
 802         return 0;
 803 }
 804
 805 static int
 806 virtio_dev_allmulticast_disable(struct rte_eth_dev *dev)
 807 {
 808         struct virtio_hw *hw = dev->data->dev_private;
 809         struct virtio_pmd_ctrl ctrl;
 810         int dlen[1];
 811         int ret;
 812
 813         if (!virtio_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) {
 814                 PMD_INIT_LOG(INFO, "host does not support rx control");
 815                 return -ENOTSUP;
 816         }
 817
 818         ctrl.hdr.class = VIRTIO_NET_CTRL_RX;
 819         ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI;
 820         ctrl.data[0] = 0;
 821         dlen[0] = 1;
 822
 823         ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1);
 824         if (ret) {
 825                 PMD_INIT_LOG(ERR, "Failed to disable allmulticast");
 826                 return -EAGAIN;
 827         }
 828
 829         return 0;
 830 }
 831
 832 #define VLAN_TAG_LEN           4    /* 802.3ac tag (not DMA'd) */
 833 static int
 834 virtio_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
 835 {
 836         struct virtio_hw *hw = dev->data->dev_private;
 837         uint32_t ether_hdr_len = RTE_ETHER_HDR_LEN + VLAN_TAG_LEN +
 838                                  hw->vtnet_hdr_size;
 839         uint32_t frame_size = mtu + ether_hdr_len;
 840         uint32_t max_frame_size = hw->max_mtu + ether_hdr_len;
 841
 842         max_frame_size = RTE_MIN(max_frame_size, VIRTIO_MAX_RX_PKTLEN);
 843
 844         if (mtu < RTE_ETHER_MIN_MTU || frame_size > max_frame_size) {
 845                 PMD_INIT_LOG(ERR, "MTU should be between %d and %d",
 846                         RTE_ETHER_MIN_MTU, max_frame_size - ether_hdr_len);
 847                 return -EINVAL;
 848         }
 849         return 0;
 850 }
 851
 852 static int
 853 virtio_dev_rx_queue_intr_enable(struct rte_eth_dev *dev, uint16_t queue_id)
 854 {
 855         struct virtio_hw *hw = dev->data->dev_private;
 856         struct virtnet_rx *rxvq = dev->data->rx_queues[queue_id];
 857         struct virtqueue *vq = rxvq->vq;
 858
 859         virtqueue_enable_intr(vq);
 860         virtio_mb(hw->weak_barriers);
 861         return 0;
 862 }
 863
 864 static int
 865 virtio_dev_rx_queue_intr_disable(struct rte_eth_dev *dev, uint16_t queue_id)
 866 {
 867         struct virtnet_rx *rxvq = dev->data->rx_queues[queue_id];
 868         struct virtqueue *vq = rxvq->vq;
 869
 870         virtqueue_disable_intr(vq);
 871         return 0;
 872 }
 873
 874 /*
 875  * dev_ops for virtio, bare necessities for basic operation
 876  */
 877 static const struct eth_dev_ops virtio_eth_dev_ops = {
 878         .dev_configure           = virtio_dev_configure,
 879         .dev_start               = virtio_dev_start,
 880         .dev_stop                = virtio_dev_stop,
 881         .dev_close               = virtio_dev_close,
 882         .promiscuous_enable      = virtio_dev_promiscuous_enable,
 883         .promiscuous_disable     = virtio_dev_promiscuous_disable,
 884         .allmulticast_enable     = virtio_dev_allmulticast_enable,
 885         .allmulticast_disable    = virtio_dev_allmulticast_disable,
 886         .mtu_set                 = virtio_mtu_set,
 887         .dev_infos_get           = virtio_dev_info_get,
 888         .stats_get               = virtio_dev_stats_get,
 889         .xstats_get              = virtio_dev_xstats_get,
 890         .xstats_get_names        = virtio_dev_xstats_get_names,
 891         .stats_reset             = virtio_dev_stats_reset,
 892         .xstats_reset            = virtio_dev_stats_reset,
 893         .link_update             = virtio_dev_link_update,
 894         .vlan_offload_set        = virtio_dev_vlan_offload_set,
 895         .rx_queue_setup          = virtio_dev_rx_queue_setup,
 896         .rx_queue_intr_enable    = virtio_dev_rx_queue_intr_enable,
 897         .rx_queue_intr_disable   = virtio_dev_rx_queue_intr_disable,
 898         .rx_queue_release        = virtio_dev_queue_release,
 899         .tx_queue_setup          = virtio_dev_tx_queue_setup,
 900         .tx_queue_release        = virtio_dev_queue_release,
 901         /* collect stats per queue */
 902         .queue_stats_mapping_set = virtio_dev_queue_stats_mapping_set,
 903         .vlan_filter_set         = virtio_vlan_filter_set,
 904         .mac_addr_add            = virtio_mac_addr_add,
 905         .mac_addr_remove         = virtio_mac_addr_remove,
 906         .mac_addr_set            = virtio_mac_addr_set,
 907 };
 908
 909 /*
 910  * dev_ops for virtio-user in secondary processes, as we just have
 911  * some limited supports currently.
 912  */
 913 const struct eth_dev_ops virtio_user_secondary_eth_dev_ops = {
 914         .dev_infos_get           = virtio_dev_info_get,
 915         .stats_get               = virtio_dev_stats_get,
 916         .xstats_get              = virtio_dev_xstats_get,
 917         .xstats_get_names        = virtio_dev_xstats_get_names,
 918         .stats_reset             = virtio_dev_stats_reset,
 919         .xstats_reset            = virtio_dev_stats_reset,
 920         /* collect stats per queue */
 921         .queue_stats_mapping_set = virtio_dev_queue_stats_mapping_set,
 922 };
 923
 924 static void
 925 virtio_update_stats(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
 926 {
 927         unsigned i;
 928
 929         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 930                 const struct virtnet_tx *txvq = dev->data->tx_queues[i];
 931                 if (txvq == NULL)
 932                         continue;
 933
 934                 stats->opackets += txvq->stats.packets;
 935                 stats->obytes += txvq->stats.bytes;
 936
 937                 if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) {
 938                         stats->q_opackets[i] = txvq->stats.packets;
 939                         stats->q_obytes[i] = txvq->stats.bytes;
 940                 }
 941         }
 942
 943         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 944                 const struct virtnet_rx *rxvq = dev->data->rx_queues[i];
 945                 if (rxvq == NULL)
 946                         continue;
 947
 948                 stats->ipackets += rxvq->stats.packets;
 949                 stats->ibytes += rxvq->stats.bytes;
 950                 stats->ierrors += rxvq->stats.errors;
 951
 952                 if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) {
 953                         stats->q_ipackets[i] = rxvq->stats.packets;
 954                         stats->q_ibytes[i] = rxvq->stats.bytes;
 955                 }
 956         }
 957
 958         stats->rx_nombuf = dev->data->rx_mbuf_alloc_failed;
 959 }
 960
 961 static int virtio_dev_xstats_get_names(struct rte_eth_dev *dev,
 962                                        struct rte_eth_xstat_name *xstats_names,
 963                                        __rte_unused unsigned limit)
 964 {
 965         unsigned i;
 966         unsigned count = 0;
 967         unsigned t;
 968
 969         unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_TXQ_XSTATS +
 970                 dev->data->nb_rx_queues * VIRTIO_NB_RXQ_XSTATS;
 971
 972         if (xstats_names != NULL) {
 973                 /* Note: limit checked in rte_eth_xstats_names() */
 974
 975                 for (i = 0; i < dev->data->nb_rx_queues; i++) {
 976                         struct virtnet_rx *rxvq = dev->data->rx_queues[i];
 977                         if (rxvq == NULL)
 978                                 continue;
 979                         for (t = 0; t < VIRTIO_NB_RXQ_XSTATS; t++) {
 980                                 snprintf(xstats_names[count].name,
 981                                         sizeof(xstats_names[count].name),
 982                                         "rx_q%u_%s", i,
 983                                         rte_virtio_rxq_stat_strings[t].name);
 984                                 count++;
 985                         }
 986                 }
 987
 988                 for (i = 0; i < dev->data->nb_tx_queues; i++) {
 989                         struct virtnet_tx *txvq = dev->data->tx_queues[i];
 990                         if (txvq == NULL)
 991                                 continue;
 992                         for (t = 0; t < VIRTIO_NB_TXQ_XSTATS; t++) {
 993                                 snprintf(xstats_names[count].name,
 994                                         sizeof(xstats_names[count].name),
 995                                         "tx_q%u_%s", i,
 996                                         rte_virtio_txq_stat_strings[t].name);
 997                                 count++;
 998                         }
 999                 }
1000                 return count;
1001         }
1002         return nstats;
1003 }
1004
1005 static int
1006 virtio_dev_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
1007                       unsigned n)
1008 {
1009         unsigned i;
1010         unsigned count = 0;
1011
1012         unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_TXQ_XSTATS +
1013                 dev->data->nb_rx_queues * VIRTIO_NB_RXQ_XSTATS;
1014
1015         if (n < nstats)
1016                 return nstats;
1017
1018         for (i = 0; i < dev->data->nb_rx_queues; i++) {
1019                 struct virtnet_rx *rxvq = dev->data->rx_queues[i];
1020
1021                 if (rxvq == NULL)
1022                         continue;
1023
1024                 unsigned t;
1025
1026                 for (t = 0; t < VIRTIO_NB_RXQ_XSTATS; t++) {
1027                         xstats[count].value = *(uint64_t *)(((char *)rxvq) +
1028                                 rte_virtio_rxq_stat_strings[t].offset);
1029                         xstats[count].id = count;
1030                         count++;
1031                 }
1032         }
1033
1034         for (i = 0; i < dev->data->nb_tx_queues; i++) {
1035                 struct virtnet_tx *txvq = dev->data->tx_queues[i];
1036
1037                 if (txvq == NULL)
1038                         continue;
1039
1040                 unsigned t;
1041
1042                 for (t = 0; t < VIRTIO_NB_TXQ_XSTATS; t++) {
1043                         xstats[count].value = *(uint64_t *)(((char *)txvq) +
1044                                 rte_virtio_txq_stat_strings[t].offset);
1045                         xstats[count].id = count;
1046                         count++;
1047                 }
1048         }
1049
1050         return count;
1051 }
1052
1053 static int
1054 virtio_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
1055 {
1056         virtio_update_stats(dev, stats);
1057
1058         return 0;
1059 }
1060
1061 static int
1062 virtio_dev_stats_reset(struct rte_eth_dev *dev)
1063 {
1064         unsigned int i;
1065
1066         for (i = 0; i < dev->data->nb_tx_queues; i++) {
1067                 struct virtnet_tx *txvq = dev->data->tx_queues[i];
1068                 if (txvq == NULL)
1069                         continue;
1070
1071                 txvq->stats.packets = 0;
1072                 txvq->stats.bytes = 0;
1073                 txvq->stats.multicast = 0;
1074                 txvq->stats.broadcast = 0;
1075                 memset(txvq->stats.size_bins, 0,
1076                        sizeof(txvq->stats.size_bins[0]) * 8);
1077         }
1078
1079         for (i = 0; i < dev->data->nb_rx_queues; i++) {
1080                 struct virtnet_rx *rxvq = dev->data->rx_queues[i];
1081                 if (rxvq == NULL)
1082                         continue;
1083
1084                 rxvq->stats.packets = 0;
1085                 rxvq->stats.bytes = 0;
1086                 rxvq->stats.errors = 0;
1087                 rxvq->stats.multicast = 0;
1088                 rxvq->stats.broadcast = 0;
1089                 memset(rxvq->stats.size_bins, 0,
1090                        sizeof(rxvq->stats.size_bins[0]) * 8);
1091         }
1092
1093         return 0;
1094 }
1095
1096 static void
1097 virtio_set_hwaddr(struct virtio_hw *hw)
1098 {
1099         virtio_write_dev_config(hw,
1100                         offsetof(struct virtio_net_config, mac),
1101                         &hw->mac_addr, RTE_ETHER_ADDR_LEN);
1102 }
1103
1104 static void
1105 virtio_get_hwaddr(struct virtio_hw *hw)
1106 {
1107         if (virtio_with_feature(hw, VIRTIO_NET_F_MAC)) {
1108                 virtio_read_dev_config(hw,
1109                         offsetof(struct virtio_net_config, mac),
1110                         &hw->mac_addr, RTE_ETHER_ADDR_LEN);
1111         } else {
1112                 rte_eth_random_addr(&hw->mac_addr[0]);
1113                 virtio_set_hwaddr(hw);
1114         }
1115 }
1116
1117 static int
1118 virtio_mac_table_set(struct virtio_hw *hw,
1119                      const struct virtio_net_ctrl_mac *uc,
1120                      const struct virtio_net_ctrl_mac *mc)
1121 {
1122         struct virtio_pmd_ctrl ctrl;
1123         int err, len[2];
1124
1125         if (!virtio_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) {
1126                 PMD_DRV_LOG(INFO, "host does not support mac table");
1127                 return -1;
1128         }
1129
1130         ctrl.hdr.class = VIRTIO_NET_CTRL_MAC;
1131         ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_TABLE_SET;
1132
1133         len[0] = uc->entries * RTE_ETHER_ADDR_LEN + sizeof(uc->entries);
1134         memcpy(ctrl.data, uc, len[0]);
1135
1136         len[1] = mc->entries * RTE_ETHER_ADDR_LEN + sizeof(mc->entries);
1137         memcpy(ctrl.data + len[0], mc, len[1]);
1138
1139         err = virtio_send_command(hw->cvq, &ctrl, len, 2);
1140         if (err != 0)
1141                 PMD_DRV_LOG(NOTICE, "mac table set failed: %d", err);
1142         return err;
1143 }
1144
1145 static int
1146 virtio_mac_addr_add(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr,
1147                     uint32_t index, uint32_t vmdq __rte_unused)
1148 {
1149         struct virtio_hw *hw = dev->data->dev_private;
1150         const struct rte_ether_addr *addrs = dev->data->mac_addrs;
1151         unsigned int i;
1152         struct virtio_net_ctrl_mac *uc, *mc;
1153
1154         if (index >= VIRTIO_MAX_MAC_ADDRS) {
1155                 PMD_DRV_LOG(ERR, "mac address index %u out of range", index);
1156                 return -EINVAL;
1157         }
1158
1159         uc = alloca(VIRTIO_MAX_MAC_ADDRS * RTE_ETHER_ADDR_LEN +
1160                 sizeof(uc->entries));
1161         uc->entries = 0;
1162         mc = alloca(VIRTIO_MAX_MAC_ADDRS * RTE_ETHER_ADDR_LEN +
1163                 sizeof(mc->entries));
1164         mc->entries = 0;
1165
1166         for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) {
1167                 const struct rte_ether_addr *addr
1168                         = (i == index) ? mac_addr : addrs + i;
1169                 struct virtio_net_ctrl_mac *tbl
1170                         = rte_is_multicast_ether_addr(addr) ? mc : uc;
1171
1172                 memcpy(&tbl->macs[tbl->entries++], addr, RTE_ETHER_ADDR_LEN);
1173         }
1174
1175         return virtio_mac_table_set(hw, uc, mc);
1176 }
1177
1178 static void
1179 virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index)
1180 {
1181         struct virtio_hw *hw = dev->data->dev_private;
1182         struct rte_ether_addr *addrs = dev->data->mac_addrs;
1183         struct virtio_net_ctrl_mac *uc, *mc;
1184         unsigned int i;
1185
1186         if (index >= VIRTIO_MAX_MAC_ADDRS) {
1187                 PMD_DRV_LOG(ERR, "mac address index %u out of range", index);
1188                 return;
1189         }
1190
1191         uc = alloca(VIRTIO_MAX_MAC_ADDRS * RTE_ETHER_ADDR_LEN +
1192                 sizeof(uc->entries));
1193         uc->entries = 0;
1194         mc = alloca(VIRTIO_MAX_MAC_ADDRS * RTE_ETHER_ADDR_LEN +
1195                 sizeof(mc->entries));
1196         mc->entries = 0;
1197
1198         for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) {
1199                 struct virtio_net_ctrl_mac *tbl;
1200
1201                 if (i == index || rte_is_zero_ether_addr(addrs + i))
1202                         continue;
1203
1204                 tbl = rte_is_multicast_ether_addr(addrs + i) ? mc : uc;
1205                 memcpy(&tbl->macs[tbl->entries++], addrs + i,
1206                         RTE_ETHER_ADDR_LEN);
1207         }
1208
1209         virtio_mac_table_set(hw, uc, mc);
1210 }
1211
1212 static int
1213 virtio_mac_addr_set(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr)
1214 {
1215         struct virtio_hw *hw = dev->data->dev_private;
1216
1217         memcpy(hw->mac_addr, mac_addr, RTE_ETHER_ADDR_LEN);
1218
1219         /* Use atomic update if available */
1220         if (virtio_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) {
1221                 struct virtio_pmd_ctrl ctrl;
1222                 int len = RTE_ETHER_ADDR_LEN;
1223
1224                 ctrl.hdr.class = VIRTIO_NET_CTRL_MAC;
1225                 ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_ADDR_SET;
1226
1227                 memcpy(ctrl.data, mac_addr, RTE_ETHER_ADDR_LEN);
1228                 return virtio_send_command(hw->cvq, &ctrl, &len, 1);
1229         }
1230
1231         if (!virtio_with_feature(hw, VIRTIO_NET_F_MAC))
1232                 return -ENOTSUP;
1233
1234         virtio_set_hwaddr(hw);
1235         return 0;
1236 }
1237
1238 static int
1239 virtio_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
1240 {
1241         struct virtio_hw *hw = dev->data->dev_private;
1242         struct virtio_pmd_ctrl ctrl;
1243         int len;
1244
1245         if (!virtio_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN))
1246                 return -ENOTSUP;
1247
1248         ctrl.hdr.class = VIRTIO_NET_CTRL_VLAN;
1249         ctrl.hdr.cmd = on ? VIRTIO_NET_CTRL_VLAN_ADD : VIRTIO_NET_CTRL_VLAN_DEL;
1250         memcpy(ctrl.data, &vlan_id, sizeof(vlan_id));
1251         len = sizeof(vlan_id);
1252
1253         return virtio_send_command(hw->cvq, &ctrl, &len, 1);
1254 }
1255
1256 static int
1257 virtio_intr_unmask(struct rte_eth_dev *dev)
1258 {
1259         struct virtio_hw *hw = dev->data->dev_private;
1260
1261         if (rte_intr_ack(dev->intr_handle) < 0)
1262                 return -1;
1263
1264         if (VIRTIO_OPS(hw)->intr_detect)
1265                 VIRTIO_OPS(hw)->intr_detect(hw);
1266
1267         return 0;
1268 }
1269
1270 static int
1271 virtio_intr_enable(struct rte_eth_dev *dev)
1272 {
1273         struct virtio_hw *hw = dev->data->dev_private;
1274
1275         if (rte_intr_enable(dev->intr_handle) < 0)
1276                 return -1;
1277
1278         if (VIRTIO_OPS(hw)->intr_detect)
1279                 VIRTIO_OPS(hw)->intr_detect(hw);
1280
1281         return 0;
1282 }
1283
1284 static int
1285 virtio_intr_disable(struct rte_eth_dev *dev)
1286 {
1287         struct virtio_hw *hw = dev->data->dev_private;
1288
1289         if (rte_intr_disable(dev->intr_handle) < 0)
1290                 return -1;
1291
1292         if (VIRTIO_OPS(hw)->intr_detect)
1293                 VIRTIO_OPS(hw)->intr_detect(hw);
1294
1295         return 0;
1296 }
1297
1298 static int
1299 virtio_ethdev_negotiate_features(struct virtio_hw *hw, uint64_t req_features)
1300 {
1301         uint64_t host_features;
1302
1303         /* Prepare guest_features: feature that driver wants to support */
1304         PMD_INIT_LOG(DEBUG, "guest_features before negotiate = %" PRIx64,
1305                 req_features);
1306
1307         /* Read device(host) feature bits */
1308         host_features = VIRTIO_OPS(hw)->get_features(hw);
1309         PMD_INIT_LOG(DEBUG, "host_features before negotiate = %" PRIx64,
1310                 host_features);
1311
1312         /* If supported, ensure MTU value is valid before acknowledging it. */
1313         if (host_features & req_features & (1ULL << VIRTIO_NET_F_MTU)) {
1314                 struct virtio_net_config config;
1315
1316                 virtio_read_dev_config(hw,
1317                         offsetof(struct virtio_net_config, mtu),
1318                         &config.mtu, sizeof(config.mtu));
1319
1320                 if (config.mtu < RTE_ETHER_MIN_MTU)
1321                         req_features &= ~(1ULL << VIRTIO_NET_F_MTU);
1322         }
1323
1324         /*
1325          * Negotiate features: Subset of device feature bits are written back
1326          * guest feature bits.
1327          */
1328         hw->guest_features = req_features;
1329         hw->guest_features = virtio_negotiate_features(hw, host_features);
1330         PMD_INIT_LOG(DEBUG, "features after negotiate = %" PRIx64,
1331                 hw->guest_features);
1332
1333         if (VIRTIO_OPS(hw)->features_ok(hw) < 0)
1334                 return -1;
1335
1336         if (virtio_with_feature(hw, VIRTIO_F_VERSION_1)) {
1337                 virtio_set_status(hw, VIRTIO_CONFIG_STATUS_FEATURES_OK);
1338
1339                 if (!(virtio_get_status(hw) & VIRTIO_CONFIG_STATUS_FEATURES_OK)) {
1340                         PMD_INIT_LOG(ERR, "Failed to set FEATURES_OK status!");
1341                         return -1;
1342                 }
1343         }
1344
1345         hw->req_guest_features = req_features;
1346
1347         return 0;
1348 }
1349
1350 int
1351 virtio_dev_pause(struct rte_eth_dev *dev)
1352 {
1353         struct virtio_hw *hw = dev->data->dev_private;
1354
1355         rte_spinlock_lock(&hw->state_lock);
1356
1357         if (hw->started == 0) {
1358                 /* Device is just stopped. */
1359                 rte_spinlock_unlock(&hw->state_lock);
1360                 return -1;
1361         }
1362         hw->started = 0;
1363         /*
1364          * Prevent the worker threads from touching queues to avoid contention,
1365          * 1 ms should be enough for the ongoing Tx function to finish.
1366          */
1367         rte_delay_ms(1);
1368         return 0;
1369 }
1370
1371 /*
1372  * Recover hw state to let the worker threads continue.
1373  */
1374 void
1375 virtio_dev_resume(struct rte_eth_dev *dev)
1376 {
1377         struct virtio_hw *hw = dev->data->dev_private;
1378
1379         hw->started = 1;
1380         rte_spinlock_unlock(&hw->state_lock);
1381 }
1382
1383 /*
1384  * Should be called only after device is paused.
1385  */
1386 int
1387 virtio_inject_pkts(struct rte_eth_dev *dev, struct rte_mbuf **tx_pkts,
1388                 int nb_pkts)
1389 {
1390         struct virtio_hw *hw = dev->data->dev_private;
1391         struct virtnet_tx *txvq = dev->data->tx_queues[0];
1392         int ret;
1393
1394         hw->inject_pkts = tx_pkts;
1395         ret = dev->tx_pkt_burst(txvq, tx_pkts, nb_pkts);
1396         hw->inject_pkts = NULL;
1397
1398         return ret;
1399 }
1400
1401 static void
1402 virtio_notify_peers(struct rte_eth_dev *dev)
1403 {
1404         struct virtio_hw *hw = dev->data->dev_private;
1405         struct virtnet_rx *rxvq;
1406         struct rte_mbuf *rarp_mbuf;
1407
1408         if (!dev->data->rx_queues)
1409                 return;
1410
1411         rxvq = dev->data->rx_queues[0];
1412         if (!rxvq)
1413                 return;
1414
1415         rarp_mbuf = rte_net_make_rarp_packet(rxvq->mpool,
1416                         (struct rte_ether_addr *)hw->mac_addr);
1417         if (rarp_mbuf == NULL) {
1418                 PMD_DRV_LOG(ERR, "failed to make RARP packet.");
1419                 return;
1420         }
1421
1422         /* If virtio port just stopped, no need to send RARP */
1423         if (virtio_dev_pause(dev) < 0) {
1424                 rte_pktmbuf_free(rarp_mbuf);
1425                 return;
1426         }
1427
1428         virtio_inject_pkts(dev, &rarp_mbuf, 1);
1429         virtio_dev_resume(dev);
1430 }
1431
1432 static void
1433 virtio_ack_link_announce(struct rte_eth_dev *dev)
1434 {
1435         struct virtio_hw *hw = dev->data->dev_private;
1436         struct virtio_pmd_ctrl ctrl;
1437
1438         ctrl.hdr.class = VIRTIO_NET_CTRL_ANNOUNCE;
1439         ctrl.hdr.cmd = VIRTIO_NET_CTRL_ANNOUNCE_ACK;
1440
1441         virtio_send_command(hw->cvq, &ctrl, NULL, 0);
1442 }
1443
1444 /*
1445  * Process virtio config changed interrupt. Call the callback
1446  * if link state changed, generate gratuitous RARP packet if
1447  * the status indicates an ANNOUNCE.
1448  */
1449 void
1450 virtio_interrupt_handler(void *param)
1451 {
1452         struct rte_eth_dev *dev = param;
1453         struct virtio_hw *hw = dev->data->dev_private;
1454         uint8_t isr;
1455         uint16_t status;
1456
1457         /* Read interrupt status which clears interrupt */
1458         isr = virtio_get_isr(hw);
1459         PMD_DRV_LOG(INFO, "interrupt status = %#x", isr);
1460
1461         if (virtio_intr_unmask(dev) < 0)
1462                 PMD_DRV_LOG(ERR, "interrupt enable failed");
1463
1464         if (isr & VIRTIO_ISR_CONFIG) {
1465                 if (virtio_dev_link_update(dev, 0) == 0)
1466                         rte_eth_dev_callback_process(dev,
1467                                                      RTE_ETH_EVENT_INTR_LSC,
1468                                                      NULL);
1469
1470                 if (virtio_with_feature(hw, VIRTIO_NET_F_STATUS)) {
1471                         virtio_read_dev_config(hw,
1472                                 offsetof(struct virtio_net_config, status),
1473                                 &status, sizeof(status));
1474                         if (status & VIRTIO_NET_S_ANNOUNCE) {
1475                                 virtio_notify_peers(dev);
1476                                 if (hw->cvq)
1477                                         virtio_ack_link_announce(dev);
1478                         }
1479                 }
1480         }
1481 }
1482
1483 /* set rx and tx handlers according to what is supported */
1484 static void
1485 set_rxtx_funcs(struct rte_eth_dev *eth_dev)
1486 {
1487         struct virtio_hw *hw = eth_dev->data->dev_private;
1488
1489         eth_dev->tx_pkt_prepare = virtio_xmit_pkts_prepare;
1490         if (virtio_with_packed_queue(hw)) {
1491                 PMD_INIT_LOG(INFO,
1492                         "virtio: using packed ring %s Tx path on port %u",
1493                         hw->use_vec_tx ? "vectorized" : "standard",
1494                         eth_dev->data->port_id);
1495                 if (hw->use_vec_tx)
1496                         eth_dev->tx_pkt_burst = virtio_xmit_pkts_packed_vec;
1497                 else
1498                         eth_dev->tx_pkt_burst = virtio_xmit_pkts_packed;
1499         } else {
1500                 if (hw->use_inorder_tx) {
1501                         PMD_INIT_LOG(INFO, "virtio: using inorder Tx path on port %u",
1502                                 eth_dev->data->port_id);
1503                         eth_dev->tx_pkt_burst = virtio_xmit_pkts_inorder;
1504                 } else {
1505                         PMD_INIT_LOG(INFO, "virtio: using standard Tx path on port %u",
1506                                 eth_dev->data->port_id);
1507                         eth_dev->tx_pkt_burst = virtio_xmit_pkts;
1508                 }
1509         }
1510
1511         if (virtio_with_packed_queue(hw)) {
1512                 if (hw->use_vec_rx) {
1513                         PMD_INIT_LOG(INFO,
1514                                 "virtio: using packed ring vectorized Rx path on port %u",
1515                                 eth_dev->data->port_id);
1516                         eth_dev->rx_pkt_burst =
1517                                 &virtio_recv_pkts_packed_vec;
1518                 } else if (virtio_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
1519                         PMD_INIT_LOG(INFO,
1520                                 "virtio: using packed ring mergeable buffer Rx path on port %u",
1521                                 eth_dev->data->port_id);
1522                         eth_dev->rx_pkt_burst =
1523                                 &virtio_recv_mergeable_pkts_packed;
1524                 } else {
1525                         PMD_INIT_LOG(INFO,
1526                                 "virtio: using packed ring standard Rx path on port %u",
1527                                 eth_dev->data->port_id);
1528                         eth_dev->rx_pkt_burst = &virtio_recv_pkts_packed;
1529                 }
1530         } else {
1531                 if (hw->use_vec_rx) {
1532                         PMD_INIT_LOG(INFO, "virtio: using vectorized Rx path on port %u",
1533                                 eth_dev->data->port_id);
1534                         eth_dev->rx_pkt_burst = virtio_recv_pkts_vec;
1535                 } else if (hw->use_inorder_rx) {
1536                         PMD_INIT_LOG(INFO,
1537                                 "virtio: using inorder Rx path on port %u",
1538                                 eth_dev->data->port_id);
1539                         eth_dev->rx_pkt_burst = &virtio_recv_pkts_inorder;
1540                 } else if (virtio_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
1541                         PMD_INIT_LOG(INFO,
1542                                 "virtio: using mergeable buffer Rx path on port %u",
1543                                 eth_dev->data->port_id);
1544                         eth_dev->rx_pkt_burst = &virtio_recv_mergeable_pkts;
1545                 } else {
1546                         PMD_INIT_LOG(INFO, "virtio: using standard Rx path on port %u",
1547                                 eth_dev->data->port_id);
1548                         eth_dev->rx_pkt_burst = &virtio_recv_pkts;
1549                 }
1550         }
1551
1552 }
1553
1554 /* Only support 1:1 queue/interrupt mapping so far.
1555  * TODO: support n:1 queue/interrupt mapping when there are limited number of
1556  * interrupt vectors (<N+1).
1557  */
1558 static int
1559 virtio_queues_bind_intr(struct rte_eth_dev *dev)
1560 {
1561         uint32_t i;
1562         struct virtio_hw *hw = dev->data->dev_private;
1563
1564         PMD_INIT_LOG(INFO, "queue/interrupt binding");
1565         for (i = 0; i < dev->data->nb_rx_queues; ++i) {
1566                 dev->intr_handle->intr_vec[i] = i + 1;
1567                 if (VIRTIO_OPS(hw)->set_queue_irq(hw, hw->vqs[i * 2], i + 1) ==
1568                                                  VIRTIO_MSI_NO_VECTOR) {
1569                         PMD_DRV_LOG(ERR, "failed to set queue vector");
1570                         return -EBUSY;
1571                 }
1572         }
1573
1574         return 0;
1575 }
1576
1577 static void
1578 virtio_queues_unbind_intr(struct rte_eth_dev *dev)
1579 {
1580         uint32_t i;
1581         struct virtio_hw *hw = dev->data->dev_private;
1582
1583         PMD_INIT_LOG(INFO, "queue/interrupt unbinding");
1584         for (i = 0; i < dev->data->nb_rx_queues; ++i)
1585                 VIRTIO_OPS(hw)->set_queue_irq(hw,
1586                                              hw->vqs[i * VTNET_CQ],
1587                                              VIRTIO_MSI_NO_VECTOR);
1588 }
1589
1590 static int
1591 virtio_configure_intr(struct rte_eth_dev *dev)
1592 {
1593         struct virtio_hw *hw = dev->data->dev_private;
1594
1595         if (!rte_intr_cap_multiple(dev->intr_handle)) {
1596                 PMD_INIT_LOG(ERR, "Multiple intr vector not supported");
1597                 return -ENOTSUP;
1598         }
1599
1600         if (rte_intr_efd_enable(dev->intr_handle, dev->data->nb_rx_queues)) {
1601                 PMD_INIT_LOG(ERR, "Fail to create eventfd");
1602                 return -1;
1603         }
1604
1605         if (!dev->intr_handle->intr_vec) {
1606                 dev->intr_handle->intr_vec =
1607                         rte_zmalloc("intr_vec",
1608                                     hw->max_queue_pairs * sizeof(int), 0);
1609                 if (!dev->intr_handle->intr_vec) {
1610                         PMD_INIT_LOG(ERR, "Failed to allocate %u rxq vectors",
1611                                      hw->max_queue_pairs);
1612                         return -ENOMEM;
1613                 }
1614         }
1615
1616         /* Re-register callback to update max_intr */
1617         rte_intr_callback_unregister(dev->intr_handle,
1618                                      virtio_interrupt_handler,
1619                                      dev);
1620         rte_intr_callback_register(dev->intr_handle,
1621                                    virtio_interrupt_handler,
1622                                    dev);
1623
1624         /* DO NOT try to remove this! This function will enable msix, or QEMU
1625          * will encounter SIGSEGV when DRIVER_OK is sent.
1626          * And for legacy devices, this should be done before queue/vec binding
1627          * to change the config size from 20 to 24, or VIRTIO_MSI_QUEUE_VECTOR
1628          * (22) will be ignored.
1629          */
1630         if (virtio_intr_enable(dev) < 0) {
1631                 PMD_DRV_LOG(ERR, "interrupt enable failed");
1632                 return -1;
1633         }
1634
1635         if (virtio_queues_bind_intr(dev) < 0) {
1636                 PMD_INIT_LOG(ERR, "Failed to bind queue/interrupt");
1637                 return -1;
1638         }
1639
1640         return 0;
1641 }
1642 #define DUPLEX_UNKNOWN   0xff
1643 /* reset device and renegotiate features if needed */
1644 static int
1645 virtio_init_device(struct rte_eth_dev *eth_dev, uint64_t req_features)
1646 {
1647         struct virtio_hw *hw = eth_dev->data->dev_private;
1648         struct virtio_net_config *config;
1649         struct virtio_net_config local_config;
1650         int ret;
1651
1652         /* Reset the device although not necessary at startup */
1653         virtio_reset(hw);
1654
1655         if (hw->vqs) {
1656                 virtio_dev_free_mbufs(eth_dev);
1657                 virtio_free_queues(hw);
1658         }
1659
1660         /* Tell the host we've noticed this device. */
1661         virtio_set_status(hw, VIRTIO_CONFIG_STATUS_ACK);
1662
1663         /* Tell the host we've known how to drive the device. */
1664         virtio_set_status(hw, VIRTIO_CONFIG_STATUS_DRIVER);
1665         if (virtio_ethdev_negotiate_features(hw, req_features) < 0)
1666                 return -1;
1667
1668         hw->weak_barriers = !virtio_with_feature(hw, VIRTIO_F_ORDER_PLATFORM);
1669
1670         /* If host does not support both status and MSI-X then disable LSC */
1671         if (virtio_with_feature(hw, VIRTIO_NET_F_STATUS) && hw->intr_lsc)
1672                 eth_dev->data->dev_flags |= RTE_ETH_DEV_INTR_LSC;
1673         else
1674                 eth_dev->data->dev_flags &= ~RTE_ETH_DEV_INTR_LSC;
1675
1676         eth_dev->data->dev_flags |= RTE_ETH_DEV_AUTOFILL_QUEUE_XSTATS;
1677
1678         /* Setting up rx_header size for the device */
1679         if (virtio_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF) ||
1680             virtio_with_feature(hw, VIRTIO_F_VERSION_1) ||
1681             virtio_with_packed_queue(hw))
1682                 hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr_mrg_rxbuf);
1683         else
1684                 hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr);
1685
1686         /* Copy the permanent MAC address to: virtio_hw */
1687         virtio_get_hwaddr(hw);
1688         rte_ether_addr_copy((struct rte_ether_addr *)hw->mac_addr,
1689                         &eth_dev->data->mac_addrs[0]);
1690         PMD_INIT_LOG(DEBUG,
1691                      "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X",
1692                      hw->mac_addr[0], hw->mac_addr[1], hw->mac_addr[2],
1693                      hw->mac_addr[3], hw->mac_addr[4], hw->mac_addr[5]);
1694
1695         if (hw->speed == ETH_SPEED_NUM_UNKNOWN) {
1696                 if (virtio_with_feature(hw, VIRTIO_NET_F_SPEED_DUPLEX)) {
1697                         config = &local_config;
1698                         virtio_read_dev_config(hw,
1699                                 offsetof(struct virtio_net_config, speed),
1700                                 &config->speed, sizeof(config->speed));
1701                         virtio_read_dev_config(hw,
1702                                 offsetof(struct virtio_net_config, duplex),
1703                                 &config->duplex, sizeof(config->duplex));
1704                         hw->speed = config->speed;
1705                         hw->duplex = config->duplex;
1706                 }
1707         }
1708         if (hw->duplex == DUPLEX_UNKNOWN)
1709                 hw->duplex = ETH_LINK_FULL_DUPLEX;
1710         PMD_INIT_LOG(DEBUG, "link speed = %d, duplex = %d",
1711                 hw->speed, hw->duplex);
1712         if (virtio_with_feature(hw, VIRTIO_NET_F_CTRL_VQ)) {
1713                 config = &local_config;
1714
1715                 virtio_read_dev_config(hw,
1716                         offsetof(struct virtio_net_config, mac),
1717                         &config->mac, sizeof(config->mac));
1718
1719                 if (virtio_with_feature(hw, VIRTIO_NET_F_STATUS)) {
1720                         virtio_read_dev_config(hw,
1721                                 offsetof(struct virtio_net_config, status),
1722                                 &config->status, sizeof(config->status));
1723                 } else {
1724                         PMD_INIT_LOG(DEBUG,
1725                                      "VIRTIO_NET_F_STATUS is not supported");
1726                         config->status = 0;
1727                 }
1728
1729                 if (virtio_with_feature(hw, VIRTIO_NET_F_MQ)) {
1730                         virtio_read_dev_config(hw,
1731                                 offsetof(struct virtio_net_config, max_virtqueue_pairs),
1732                                 &config->max_virtqueue_pairs,
1733                                 sizeof(config->max_virtqueue_pairs));
1734                 } else {
1735                         PMD_INIT_LOG(DEBUG,
1736                                      "VIRTIO_NET_F_MQ is not supported");
1737                         config->max_virtqueue_pairs = 1;
1738                 }
1739
1740                 hw->max_queue_pairs = config->max_virtqueue_pairs;
1741
1742                 if (virtio_with_feature(hw, VIRTIO_NET_F_MTU)) {
1743                         virtio_read_dev_config(hw,
1744                                 offsetof(struct virtio_net_config, mtu),
1745                                 &config->mtu,
1746                                 sizeof(config->mtu));
1747
1748                         /*
1749                          * MTU value has already been checked at negotiation
1750                          * time, but check again in case it has changed since
1751                          * then, which should not happen.
1752                          */
1753                         if (config->mtu < RTE_ETHER_MIN_MTU) {
1754                                 PMD_INIT_LOG(ERR, "invalid max MTU value (%u)",
1755                                                 config->mtu);
1756                                 return -1;
1757                         }
1758
1759                         hw->max_mtu = config->mtu;
1760                         /* Set initial MTU to maximum one supported by vhost */
1761                         eth_dev->data->mtu = config->mtu;
1762
1763                 } else {
1764                         hw->max_mtu = VIRTIO_MAX_RX_PKTLEN - RTE_ETHER_HDR_LEN -
1765                                 VLAN_TAG_LEN - hw->vtnet_hdr_size;
1766                 }
1767
1768                 PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=%d",
1769                                 config->max_virtqueue_pairs);
1770                 PMD_INIT_LOG(DEBUG, "config->status=%d", config->status);
1771                 PMD_INIT_LOG(DEBUG,
1772                                 "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X",
1773                                 config->mac[0], config->mac[1],
1774                                 config->mac[2], config->mac[3],
1775                                 config->mac[4], config->mac[5]);
1776         } else {
1777                 PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=1");
1778                 hw->max_queue_pairs = 1;
1779                 hw->max_mtu = VIRTIO_MAX_RX_PKTLEN - RTE_ETHER_HDR_LEN -
1780                         VLAN_TAG_LEN - hw->vtnet_hdr_size;
1781         }
1782
1783         ret = virtio_alloc_queues(eth_dev);
1784         if (ret < 0)
1785                 return ret;
1786
1787         if (eth_dev->data->dev_conf.intr_conf.rxq) {
1788                 if (virtio_configure_intr(eth_dev) < 0) {
1789                         PMD_INIT_LOG(ERR, "failed to configure interrupt");
1790                         virtio_free_queues(hw);
1791                         return -1;
1792                 }
1793         }
1794
1795         virtio_reinit_complete(hw);
1796
1797         return 0;
1798 }
1799
1800 /*
1801  * This function is based on probe() function in virtio_pci.c
1802  * It returns 0 on success.
1803  */
1804 int
1805 eth_virtio_dev_init(struct rte_eth_dev *eth_dev)
1806 {
1807         struct virtio_hw *hw = eth_dev->data->dev_private;
1808         uint32_t speed = ETH_SPEED_NUM_UNKNOWN;
1809         int vectorized = 0;
1810         int ret;
1811
1812         if (sizeof(struct virtio_net_hdr_mrg_rxbuf) > RTE_PKTMBUF_HEADROOM) {
1813                 PMD_INIT_LOG(ERR,
1814                         "Not sufficient headroom required = %d, avail = %d",
1815                         (int)sizeof(struct virtio_net_hdr_mrg_rxbuf),
1816                         RTE_PKTMBUF_HEADROOM);
1817
1818                 return -1;
1819         }
1820
1821         eth_dev->dev_ops = &virtio_eth_dev_ops;
1822         eth_dev->rx_descriptor_done = virtio_dev_rx_queue_done;
1823
1824         if (rte_eal_process_type() == RTE_PROC_SECONDARY) {
1825                 set_rxtx_funcs(eth_dev);
1826                 return 0;
1827         }
1828
1829         ret = virtio_dev_devargs_parse(eth_dev->device->devargs, &speed, &vectorized);
1830         if (ret < 0)
1831                 return ret;
1832         hw->speed = speed;
1833
1834         /* Allocate memory for storing MAC addresses */
1835         eth_dev->data->mac_addrs = rte_zmalloc("virtio",
1836                                 VIRTIO_MAX_MAC_ADDRS * RTE_ETHER_ADDR_LEN, 0);
1837         if (eth_dev->data->mac_addrs == NULL) {
1838                 PMD_INIT_LOG(ERR,
1839                         "Failed to allocate %d bytes needed to store MAC addresses",
1840                         VIRTIO_MAX_MAC_ADDRS * RTE_ETHER_ADDR_LEN);
1841                 return -ENOMEM;
1842         }
1843
1844         hw->port_id = eth_dev->data->port_id;
1845         rte_spinlock_init(&hw->state_lock);
1846
1847         /* reset device and negotiate default features */
1848         ret = virtio_init_device(eth_dev, VIRTIO_PMD_DEFAULT_GUEST_FEATURES);
1849         if (ret < 0)
1850                 goto err_virtio_init;
1851
1852         if (vectorized) {
1853                 if (!virtio_with_packed_queue(hw)) {
1854                         hw->use_vec_rx = 1;
1855                 } else {
1856 #if defined(CC_AVX512_SUPPORT) || defined(RTE_ARCH_ARM)
1857                         hw->use_vec_rx = 1;
1858                         hw->use_vec_tx = 1;
1859 #else
1860                         PMD_DRV_LOG(INFO,
1861                                 "building environment do not support packed ring vectorized");
1862 #endif
1863                 }
1864         }
1865
1866         hw->opened = 1;
1867
1868         return 0;
1869
1870 err_virtio_init:
1871         rte_free(eth_dev->data->mac_addrs);
1872         eth_dev->data->mac_addrs = NULL;
1873         return ret;
1874 }
1875
1876 static uint32_t
1877 virtio_dev_speed_capa_get(uint32_t speed)
1878 {
1879         switch (speed) {
1880         case ETH_SPEED_NUM_10G:
1881                 return ETH_LINK_SPEED_10G;
1882         case ETH_SPEED_NUM_20G:
1883                 return ETH_LINK_SPEED_20G;
1884         case ETH_SPEED_NUM_25G:
1885                 return ETH_LINK_SPEED_25G;
1886         case ETH_SPEED_NUM_40G:
1887                 return ETH_LINK_SPEED_40G;
1888         case ETH_SPEED_NUM_50G:
1889                 return ETH_LINK_SPEED_50G;
1890         case ETH_SPEED_NUM_56G:
1891                 return ETH_LINK_SPEED_56G;
1892         case ETH_SPEED_NUM_100G:
1893                 return ETH_LINK_SPEED_100G;
1894         case ETH_SPEED_NUM_200G:
1895                 return ETH_LINK_SPEED_200G;
1896         default:
1897                 return 0;
1898         }
1899 }
1900
1901 static int vectorized_check_handler(__rte_unused const char *key,
1902                 const char *value, void *ret_val)
1903 {
1904         if (strcmp(value, "1") == 0)
1905                 *(int *)ret_val = 1;
1906         else
1907                 *(int *)ret_val = 0;
1908
1909         return 0;
1910 }
1911
1912 #define VIRTIO_ARG_SPEED      "speed"
1913 #define VIRTIO_ARG_VECTORIZED "vectorized"
1914
1915 static int
1916 link_speed_handler(const char *key __rte_unused,
1917                 const char *value, void *ret_val)
1918 {
1919         uint32_t val;
1920         if (!value || !ret_val)
1921                 return -EINVAL;
1922         val = strtoul(value, NULL, 0);
1923         /* validate input */
1924         if (virtio_dev_speed_capa_get(val) == 0)
1925                 return -EINVAL;
1926         *(uint32_t *)ret_val = val;
1927
1928         return 0;
1929 }
1930
1931
1932 static int
1933 virtio_dev_devargs_parse(struct rte_devargs *devargs, uint32_t *speed, int *vectorized)
1934 {
1935         struct rte_kvargs *kvlist;
1936         int ret = 0;
1937
1938         if (devargs == NULL)
1939                 return 0;
1940
1941         kvlist = rte_kvargs_parse(devargs->args, NULL);
1942         if (kvlist == NULL) {
1943                 PMD_INIT_LOG(ERR, "error when parsing param");
1944                 return 0;
1945         }
1946
1947         if (speed && rte_kvargs_count(kvlist, VIRTIO_ARG_SPEED) == 1) {
1948                 ret = rte_kvargs_process(kvlist,
1949                                         VIRTIO_ARG_SPEED,
1950                                         link_speed_handler, speed);
1951                 if (ret < 0) {
1952                         PMD_INIT_LOG(ERR, "Failed to parse %s",
1953                                         VIRTIO_ARG_SPEED);
1954                         goto exit;
1955                 }
1956         }
1957
1958         if (vectorized &&
1959                 rte_kvargs_count(kvlist, VIRTIO_ARG_VECTORIZED) == 1) {
1960                 ret = rte_kvargs_process(kvlist,
1961                                 VIRTIO_ARG_VECTORIZED,
1962                                 vectorized_check_handler, vectorized);
1963                 if (ret < 0) {
1964                         PMD_INIT_LOG(ERR, "Failed to parse %s",
1965                                         VIRTIO_ARG_VECTORIZED);
1966                         goto exit;
1967                 }
1968         }
1969
1970 exit:
1971         rte_kvargs_free(kvlist);
1972         return ret;
1973 }
1974
1975 static uint8_t
1976 rx_offload_enabled(struct virtio_hw *hw)
1977 {
1978         return virtio_with_feature(hw, VIRTIO_NET_F_GUEST_CSUM) ||
1979                 virtio_with_feature(hw, VIRTIO_NET_F_GUEST_TSO4) ||
1980                 virtio_with_feature(hw, VIRTIO_NET_F_GUEST_TSO6);
1981 }
1982
1983 static uint8_t
1984 tx_offload_enabled(struct virtio_hw *hw)
1985 {
1986         return virtio_with_feature(hw, VIRTIO_NET_F_CSUM) ||
1987                 virtio_with_feature(hw, VIRTIO_NET_F_HOST_TSO4) ||
1988                 virtio_with_feature(hw, VIRTIO_NET_F_HOST_TSO6);
1989 }
1990
1991 /*
1992  * Configure virtio device
1993  * It returns 0 on success.
1994  */
1995 static int
1996 virtio_dev_configure(struct rte_eth_dev *dev)
1997 {
1998         const struct rte_eth_rxmode *rxmode = &dev->data->dev_conf.rxmode;
1999         const struct rte_eth_txmode *txmode = &dev->data->dev_conf.txmode;
2000         struct virtio_hw *hw = dev->data->dev_private;
2001         uint32_t ether_hdr_len = RTE_ETHER_HDR_LEN + VLAN_TAG_LEN +
2002                 hw->vtnet_hdr_size;
2003         uint64_t rx_offloads = rxmode->offloads;
2004         uint64_t tx_offloads = txmode->offloads;
2005         uint64_t req_features;
2006         int ret;
2007
2008         PMD_INIT_LOG(DEBUG, "configure");
2009         req_features = VIRTIO_PMD_DEFAULT_GUEST_FEATURES;
2010
2011         if (rxmode->mq_mode != ETH_MQ_RX_NONE) {
2012                 PMD_DRV_LOG(ERR,
2013                         "Unsupported Rx multi queue mode %d",
2014                         rxmode->mq_mode);
2015                 return -EINVAL;
2016         }
2017
2018         if (txmode->mq_mode != ETH_MQ_TX_NONE) {
2019                 PMD_DRV_LOG(ERR,
2020                         "Unsupported Tx multi queue mode %d",
2021                         txmode->mq_mode);
2022                 return -EINVAL;
2023         }
2024
2025         if (dev->data->dev_conf.intr_conf.rxq) {
2026                 ret = virtio_init_device(dev, hw->req_guest_features);
2027                 if (ret < 0)
2028                         return ret;
2029         }
2030
2031         if (rxmode->max_rx_pkt_len > hw->max_mtu + ether_hdr_len)
2032                 req_features &= ~(1ULL << VIRTIO_NET_F_MTU);
2033
2034         if (rx_offloads & (DEV_RX_OFFLOAD_UDP_CKSUM |
2035                            DEV_RX_OFFLOAD_TCP_CKSUM))
2036                 req_features |= (1ULL << VIRTIO_NET_F_GUEST_CSUM);
2037
2038         if (rx_offloads & DEV_RX_OFFLOAD_TCP_LRO)
2039                 req_features |=
2040                         (1ULL << VIRTIO_NET_F_GUEST_TSO4) |
2041                         (1ULL << VIRTIO_NET_F_GUEST_TSO6);
2042
2043         if (tx_offloads & (DEV_TX_OFFLOAD_UDP_CKSUM |
2044                            DEV_TX_OFFLOAD_TCP_CKSUM))
2045                 req_features |= (1ULL << VIRTIO_NET_F_CSUM);
2046
2047         if (tx_offloads & DEV_TX_OFFLOAD_TCP_TSO)
2048                 req_features |=
2049                         (1ULL << VIRTIO_NET_F_HOST_TSO4) |
2050                         (1ULL << VIRTIO_NET_F_HOST_TSO6);
2051
2052         /* if request features changed, reinit the device */
2053         if (req_features != hw->req_guest_features) {
2054                 ret = virtio_init_device(dev, req_features);
2055                 if (ret < 0)
2056                         return ret;
2057         }
2058
2059         if ((rx_offloads & (DEV_RX_OFFLOAD_UDP_CKSUM |
2060                             DEV_RX_OFFLOAD_TCP_CKSUM)) &&
2061                 !virtio_with_feature(hw, VIRTIO_NET_F_GUEST_CSUM)) {
2062                 PMD_DRV_LOG(ERR,
2063                         "rx checksum not available on this host");
2064                 return -ENOTSUP;
2065         }
2066
2067         if ((rx_offloads & DEV_RX_OFFLOAD_TCP_LRO) &&
2068                 (!virtio_with_feature(hw, VIRTIO_NET_F_GUEST_TSO4) ||
2069                  !virtio_with_feature(hw, VIRTIO_NET_F_GUEST_TSO6))) {
2070                 PMD_DRV_LOG(ERR,
2071                         "Large Receive Offload not available on this host");
2072                 return -ENOTSUP;
2073         }
2074
2075         /* start control queue */
2076         if (virtio_with_feature(hw, VIRTIO_NET_F_CTRL_VQ))
2077                 virtio_dev_cq_start(dev);
2078
2079         if (rx_offloads & DEV_RX_OFFLOAD_VLAN_STRIP)
2080                 hw->vlan_strip = 1;
2081
2082         if ((rx_offloads & DEV_RX_OFFLOAD_VLAN_FILTER) &&
2083                         !virtio_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) {
2084                 PMD_DRV_LOG(ERR,
2085                             "vlan filtering not available on this host");
2086                 return -ENOTSUP;
2087         }
2088
2089         hw->has_tx_offload = tx_offload_enabled(hw);
2090         hw->has_rx_offload = rx_offload_enabled(hw);
2091
2092         if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)
2093                 /* Enable vector (0) for Link State Intrerrupt */
2094                 if (VIRTIO_OPS(hw)->set_config_irq(hw, 0) ==
2095                                 VIRTIO_MSI_NO_VECTOR) {
2096                         PMD_DRV_LOG(ERR, "failed to set config vector");
2097                         return -EBUSY;
2098                 }
2099
2100         if (virtio_with_packed_queue(hw)) {
2101 #if defined(RTE_ARCH_X86_64) && defined(CC_AVX512_SUPPORT)
2102                 if ((hw->use_vec_rx || hw->use_vec_tx) &&
2103                     (!rte_cpu_get_flag_enabled(RTE_CPUFLAG_AVX512F) ||
2104                      !virtio_with_feature(hw, VIRTIO_F_IN_ORDER) ||
2105                      !virtio_with_feature(hw, VIRTIO_F_VERSION_1) ||
2106                      rte_vect_get_max_simd_bitwidth() < RTE_VECT_SIMD_512)) {
2107                         PMD_DRV_LOG(INFO,
2108                                 "disabled packed ring vectorized path for requirements not met");
2109                         hw->use_vec_rx = 0;
2110                         hw->use_vec_tx = 0;
2111                 }
2112 #elif defined(RTE_ARCH_ARM)
2113                 if ((hw->use_vec_rx || hw->use_vec_tx) &&
2114                     (!rte_cpu_get_flag_enabled(RTE_CPUFLAG_NEON) ||
2115                      !virtio_with_feature(hw, VIRTIO_F_IN_ORDER) ||
2116                      !virtio_with_feature(hw, VIRTIO_F_VERSION_1) ||
2117                      rte_vect_get_max_simd_bitwidth() < RTE_VECT_SIMD_128)) {
2118                         PMD_DRV_LOG(INFO,
2119                                 "disabled packed ring vectorized path for requirements not met");
2120                         hw->use_vec_rx = 0;
2121                         hw->use_vec_tx = 0;
2122                 }
2123 #else
2124                 hw->use_vec_rx = 0;
2125                 hw->use_vec_tx = 0;
2126 #endif
2127
2128                 if (hw->use_vec_rx) {
2129                         if (virtio_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
2130                                 PMD_DRV_LOG(INFO,
2131                                         "disabled packed ring vectorized rx for mrg_rxbuf enabled");
2132                                 hw->use_vec_rx = 0;
2133                         }
2134
2135                         if (rx_offloads & DEV_RX_OFFLOAD_TCP_LRO) {
2136                                 PMD_DRV_LOG(INFO,
2137                                         "disabled packed ring vectorized rx for TCP_LRO enabled");
2138                                 hw->use_vec_rx = 0;
2139                         }
2140                 }
2141         } else {
2142                 if (virtio_with_feature(hw, VIRTIO_F_IN_ORDER)) {
2143                         hw->use_inorder_tx = 1;
2144                         hw->use_inorder_rx = 1;
2145                         hw->use_vec_rx = 0;
2146                 }
2147
2148                 if (hw->use_vec_rx) {
2149 #if defined RTE_ARCH_ARM
2150                         if (!rte_cpu_get_flag_enabled(RTE_CPUFLAG_NEON)) {
2151                                 PMD_DRV_LOG(INFO,
2152                                         "disabled split ring vectorized path for requirement not met");
2153                                 hw->use_vec_rx = 0;
2154                         }
2155 #endif
2156                         if (virtio_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) {
2157                                 PMD_DRV_LOG(INFO,
2158                                         "disabled split ring vectorized rx for mrg_rxbuf enabled");
2159                                 hw->use_vec_rx = 0;
2160                         }
2161
2162                         if (rx_offloads & (DEV_RX_OFFLOAD_UDP_CKSUM |
2163                                            DEV_RX_OFFLOAD_TCP_CKSUM |
2164                                            DEV_RX_OFFLOAD_TCP_LRO |
2165                                            DEV_RX_OFFLOAD_VLAN_STRIP)) {
2166                                 PMD_DRV_LOG(INFO,
2167                                         "disabled split ring vectorized rx for offloading enabled");
2168                                 hw->use_vec_rx = 0;
2169                         }
2170
2171                         if (rte_vect_get_max_simd_bitwidth() < RTE_VECT_SIMD_128) {
2172                                 PMD_DRV_LOG(INFO,
2173                                         "disabled split ring vectorized rx, max SIMD bitwidth too low");
2174                                 hw->use_vec_rx = 0;
2175                         }
2176                 }
2177         }
2178
2179         return 0;
2180 }
2181
2182
2183 static int
2184 virtio_dev_start(struct rte_eth_dev *dev)
2185 {
2186         uint16_t nb_queues, i;
2187         struct virtnet_rx *rxvq;
2188         struct virtnet_tx *txvq __rte_unused;
2189         struct virtio_hw *hw = dev->data->dev_private;
2190         int ret;
2191
2192         /* Finish the initialization of the queues */
2193         for (i = 0; i < dev->data->nb_rx_queues; i++) {
2194                 ret = virtio_dev_rx_queue_setup_finish(dev, i);
2195                 if (ret < 0)
2196                         return ret;
2197         }
2198         for (i = 0; i < dev->data->nb_tx_queues; i++) {
2199                 ret = virtio_dev_tx_queue_setup_finish(dev, i);
2200                 if (ret < 0)
2201                         return ret;
2202         }
2203
2204         /* check if lsc interrupt feature is enabled */
2205         if (dev->data->dev_conf.intr_conf.lsc) {
2206                 if (!(dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)) {
2207                         PMD_DRV_LOG(ERR, "link status not supported by host");
2208                         return -ENOTSUP;
2209                 }
2210         }
2211
2212         /* Enable uio/vfio intr/eventfd mapping: althrough we already did that
2213          * in device configure, but it could be unmapped  when device is
2214          * stopped.
2215          */
2216         if (dev->data->dev_conf.intr_conf.lsc ||
2217             dev->data->dev_conf.intr_conf.rxq) {
2218                 virtio_intr_disable(dev);
2219
2220                 /* Setup interrupt callback  */
2221                 if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)
2222                         rte_intr_callback_register(dev->intr_handle,
2223                                                    virtio_interrupt_handler,
2224                                                    dev);
2225
2226                 if (virtio_intr_enable(dev) < 0) {
2227                         PMD_DRV_LOG(ERR, "interrupt enable failed");
2228                         return -EIO;
2229                 }
2230         }
2231
2232         /*Notify the backend
2233          *Otherwise the tap backend might already stop its queue due to fullness.
2234          *vhost backend will have no chance to be waked up
2235          */
2236         nb_queues = RTE_MAX(dev->data->nb_rx_queues, dev->data->nb_tx_queues);
2237         if (hw->max_queue_pairs > 1) {
2238                 if (virtio_set_multiple_queues(dev, nb_queues) != 0)
2239                         return -EINVAL;
2240         }
2241
2242         PMD_INIT_LOG(DEBUG, "nb_queues=%d", nb_queues);
2243
2244         for (i = 0; i < dev->data->nb_rx_queues; i++) {
2245                 rxvq = dev->data->rx_queues[i];
2246                 /* Flush the old packets */
2247                 virtqueue_rxvq_flush(rxvq->vq);
2248                 virtqueue_notify(rxvq->vq);
2249         }
2250
2251         for (i = 0; i < dev->data->nb_tx_queues; i++) {
2252                 txvq = dev->data->tx_queues[i];
2253                 virtqueue_notify(txvq->vq);
2254         }
2255
2256         PMD_INIT_LOG(DEBUG, "Notified backend at initialization");
2257
2258         for (i = 0; i < dev->data->nb_rx_queues; i++) {
2259                 rxvq = dev->data->rx_queues[i];
2260                 VIRTQUEUE_DUMP(rxvq->vq);
2261         }
2262
2263         for (i = 0; i < dev->data->nb_tx_queues; i++) {
2264                 txvq = dev->data->tx_queues[i];
2265                 VIRTQUEUE_DUMP(txvq->vq);
2266         }
2267
2268         set_rxtx_funcs(dev);
2269         hw->started = 1;
2270
2271         /* Initialize Link state */
2272         virtio_dev_link_update(dev, 0);
2273
2274         return 0;
2275 }
2276
2277 static void virtio_dev_free_mbufs(struct rte_eth_dev *dev)
2278 {
2279         struct virtio_hw *hw = dev->data->dev_private;
2280         uint16_t nr_vq = virtio_get_nr_vq(hw);
2281         const char *type __rte_unused;
2282         unsigned int i, mbuf_num = 0;
2283         struct virtqueue *vq;
2284         struct rte_mbuf *buf;
2285         int queue_type;
2286
2287         if (hw->vqs == NULL)
2288                 return;
2289
2290         for (i = 0; i < nr_vq; i++) {
2291                 vq = hw->vqs[i];
2292                 if (!vq)
2293                         continue;
2294
2295                 queue_type = virtio_get_queue_type(hw, i);
2296                 if (queue_type == VTNET_RQ)
2297                         type = "rxq";
2298                 else if (queue_type == VTNET_TQ)
2299                         type = "txq";
2300                 else
2301                         continue;
2302
2303                 PMD_INIT_LOG(DEBUG,
2304                         "Before freeing %s[%d] used and unused buf",
2305                         type, i);
2306                 VIRTQUEUE_DUMP(vq);
2307
2308                 while ((buf = virtqueue_detach_unused(vq)) != NULL) {
2309                         rte_pktmbuf_free(buf);
2310                         mbuf_num++;
2311                 }
2312
2313                 PMD_INIT_LOG(DEBUG,
2314                         "After freeing %s[%d] used and unused buf",
2315                         type, i);
2316                 VIRTQUEUE_DUMP(vq);
2317         }
2318
2319         PMD_INIT_LOG(DEBUG, "%d mbufs freed", mbuf_num);
2320 }
2321
2322 /*
2323  * Stop device: disable interrupt and mark link down
2324  */
2325 int
2326 virtio_dev_stop(struct rte_eth_dev *dev)
2327 {
2328         struct virtio_hw *hw = dev->data->dev_private;
2329         struct rte_eth_link link;
2330         struct rte_intr_conf *intr_conf = &dev->data->dev_conf.intr_conf;
2331
2332         PMD_INIT_LOG(DEBUG, "stop");
2333         dev->data->dev_started = 0;
2334
2335         rte_spinlock_lock(&hw->state_lock);
2336         if (!hw->started)
2337                 goto out_unlock;
2338         hw->started = 0;
2339
2340         if (intr_conf->lsc || intr_conf->rxq) {
2341                 virtio_intr_disable(dev);
2342
2343                 /* Reset interrupt callback  */
2344                 if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) {
2345                         rte_intr_callback_unregister(dev->intr_handle,
2346                                                      virtio_interrupt_handler,
2347                                                      dev);
2348                 }
2349         }
2350
2351         memset(&link, 0, sizeof(link));
2352         rte_eth_linkstatus_set(dev, &link);
2353 out_unlock:
2354         rte_spinlock_unlock(&hw->state_lock);
2355
2356         return 0;
2357 }
2358
2359 static int
2360 virtio_dev_link_update(struct rte_eth_dev *dev, __rte_unused int wait_to_complete)
2361 {
2362         struct rte_eth_link link;
2363         uint16_t status;
2364         struct virtio_hw *hw = dev->data->dev_private;
2365
2366         memset(&link, 0, sizeof(link));
2367         link.link_duplex = hw->duplex;
2368         link.link_speed  = hw->speed;
2369         link.link_autoneg = ETH_LINK_AUTONEG;
2370
2371         if (!hw->started) {
2372                 link.link_status = ETH_LINK_DOWN;
2373                 link.link_speed = ETH_SPEED_NUM_NONE;
2374         } else if (virtio_with_feature(hw, VIRTIO_NET_F_STATUS)) {
2375                 PMD_INIT_LOG(DEBUG, "Get link status from hw");
2376                 virtio_read_dev_config(hw,
2377                                 offsetof(struct virtio_net_config, status),
2378                                 &status, sizeof(status));
2379                 if ((status & VIRTIO_NET_S_LINK_UP) == 0) {
2380                         link.link_status = ETH_LINK_DOWN;
2381                         link.link_speed = ETH_SPEED_NUM_NONE;
2382                         PMD_INIT_LOG(DEBUG, "Port %d is down",
2383                                      dev->data->port_id);
2384                 } else {
2385                         link.link_status = ETH_LINK_UP;
2386                         PMD_INIT_LOG(DEBUG, "Port %d is up",
2387                                      dev->data->port_id);
2388                 }
2389         } else {
2390                 link.link_status = ETH_LINK_UP;
2391         }
2392
2393         return rte_eth_linkstatus_set(dev, &link);
2394 }
2395
2396 static int
2397 virtio_dev_vlan_offload_set(struct rte_eth_dev *dev, int mask)
2398 {
2399         const struct rte_eth_rxmode *rxmode = &dev->data->dev_conf.rxmode;
2400         struct virtio_hw *hw = dev->data->dev_private;
2401         uint64_t offloads = rxmode->offloads;
2402
2403         if (mask & ETH_VLAN_FILTER_MASK) {
2404                 if ((offloads & DEV_RX_OFFLOAD_VLAN_FILTER) &&
2405                                 !virtio_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) {
2406
2407                         PMD_DRV_LOG(NOTICE,
2408                                 "vlan filtering not available on this host");
2409
2410                         return -ENOTSUP;
2411                 }
2412         }
2413
2414         if (mask & ETH_VLAN_STRIP_MASK)
2415                 hw->vlan_strip = !!(offloads & DEV_RX_OFFLOAD_VLAN_STRIP);
2416
2417         return 0;
2418 }
2419
2420 static int
2421 virtio_dev_info_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info)
2422 {
2423         uint64_t tso_mask, host_features;
2424         struct virtio_hw *hw = dev->data->dev_private;
2425         dev_info->speed_capa = virtio_dev_speed_capa_get(hw->speed);
2426
2427         dev_info->max_rx_queues =
2428                 RTE_MIN(hw->max_queue_pairs, VIRTIO_MAX_RX_QUEUES);
2429         dev_info->max_tx_queues =
2430                 RTE_MIN(hw->max_queue_pairs, VIRTIO_MAX_TX_QUEUES);
2431         dev_info->min_rx_bufsize = VIRTIO_MIN_RX_BUFSIZE;
2432         dev_info->max_rx_pktlen = VIRTIO_MAX_RX_PKTLEN;
2433         dev_info->max_mac_addrs = VIRTIO_MAX_MAC_ADDRS;
2434
2435         host_features = VIRTIO_OPS(hw)->get_features(hw);
2436         dev_info->rx_offload_capa = DEV_RX_OFFLOAD_VLAN_STRIP;
2437         dev_info->rx_offload_capa |= DEV_RX_OFFLOAD_JUMBO_FRAME;
2438         if (host_features & (1ULL << VIRTIO_NET_F_GUEST_CSUM)) {
2439                 dev_info->rx_offload_capa |=
2440                         DEV_RX_OFFLOAD_TCP_CKSUM |
2441                         DEV_RX_OFFLOAD_UDP_CKSUM;
2442         }
2443         if (host_features & (1ULL << VIRTIO_NET_F_CTRL_VLAN))
2444                 dev_info->rx_offload_capa |= DEV_RX_OFFLOAD_VLAN_FILTER;
2445         tso_mask = (1ULL << VIRTIO_NET_F_GUEST_TSO4) |
2446                 (1ULL << VIRTIO_NET_F_GUEST_TSO6);
2447         if ((host_features & tso_mask) == tso_mask)
2448                 dev_info->rx_offload_capa |= DEV_RX_OFFLOAD_TCP_LRO;
2449
2450         dev_info->tx_offload_capa = DEV_TX_OFFLOAD_MULTI_SEGS |
2451                                     DEV_TX_OFFLOAD_VLAN_INSERT;
2452         if (host_features & (1ULL << VIRTIO_NET_F_CSUM)) {
2453                 dev_info->tx_offload_capa |=
2454                         DEV_TX_OFFLOAD_UDP_CKSUM |
2455                         DEV_TX_OFFLOAD_TCP_CKSUM;
2456         }
2457         tso_mask = (1ULL << VIRTIO_NET_F_HOST_TSO4) |
2458                 (1ULL << VIRTIO_NET_F_HOST_TSO6);
2459         if ((host_features & tso_mask) == tso_mask)
2460                 dev_info->tx_offload_capa |= DEV_TX_OFFLOAD_TCP_TSO;
2461
2462         return 0;
2463 }
2464
2465 /*
2466  * It enables testpmd to collect per queue stats.
2467  */
2468 static int
2469 virtio_dev_queue_stats_mapping_set(__rte_unused struct rte_eth_dev *eth_dev,
2470 __rte_unused uint16_t queue_id, __rte_unused uint8_t stat_idx,
2471 __rte_unused uint8_t is_rx)
2472 {
2473         return 0;
2474 }
2475
2476 RTE_LOG_REGISTER(virtio_logtype_init, pmd.net.virtio.init, NOTICE);
2477 RTE_LOG_REGISTER(virtio_logtype_driver, pmd.net.virtio.driver, NOTICE);