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