1 /*- 2 * BSD LICENSE 3 * 4 * Copyright(c) 2010-2016 Intel Corporation. All rights reserved. 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 11 * * Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * * Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in 15 * the documentation and/or other materials provided with the 16 * distribution. 17 * * Neither the name of Intel Corporation nor the names of its 18 * contributors may be used to endorse or promote products derived 19 * from this software without specific prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 22 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 23 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 24 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 25 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 26 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 27 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 28 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 29 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 30 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 31 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 32 */ 33 34 #include <stdint.h> 35 #include <string.h> 36 #include <stdio.h> 37 #include <errno.h> 38 #include <unistd.h> 39 40 #include <rte_ethdev.h> 41 #include <rte_memcpy.h> 42 #include <rte_string_fns.h> 43 #include <rte_memzone.h> 44 #include <rte_malloc.h> 45 #include <rte_atomic.h> 46 #include <rte_branch_prediction.h> 47 #include <rte_pci.h> 48 #include <rte_ether.h> 49 #include <rte_common.h> 50 #include <rte_errno.h> 51 52 #include <rte_memory.h> 53 #include <rte_eal.h> 54 #include <rte_dev.h> 55 56 #include "virtio_ethdev.h" 57 #include "virtio_pci.h" 58 #include "virtio_logs.h" 59 #include "virtqueue.h" 60 #include "virtio_rxtx.h" 61 62 static int eth_virtio_dev_uninit(struct rte_eth_dev *eth_dev); 63 static int virtio_dev_configure(struct rte_eth_dev *dev); 64 static int virtio_dev_start(struct rte_eth_dev *dev); 65 static void virtio_dev_stop(struct rte_eth_dev *dev); 66 static void virtio_dev_promiscuous_enable(struct rte_eth_dev *dev); 67 static void virtio_dev_promiscuous_disable(struct rte_eth_dev *dev); 68 static void virtio_dev_allmulticast_enable(struct rte_eth_dev *dev); 69 static void virtio_dev_allmulticast_disable(struct rte_eth_dev *dev); 70 static void virtio_dev_info_get(struct rte_eth_dev *dev, 71 struct rte_eth_dev_info *dev_info); 72 static int virtio_dev_link_update(struct rte_eth_dev *dev, 73 __rte_unused int wait_to_complete); 74 75 static void virtio_set_hwaddr(struct virtio_hw *hw); 76 static void virtio_get_hwaddr(struct virtio_hw *hw); 77 78 static void virtio_dev_stats_get(struct rte_eth_dev *dev, 79 struct rte_eth_stats *stats); 80 static int virtio_dev_xstats_get(struct rte_eth_dev *dev, 81 struct rte_eth_xstat *xstats, unsigned n); 82 static int virtio_dev_xstats_get_names(struct rte_eth_dev *dev, 83 struct rte_eth_xstat_name *xstats_names, 84 unsigned limit); 85 static void virtio_dev_stats_reset(struct rte_eth_dev *dev); 86 static void virtio_dev_free_mbufs(struct rte_eth_dev *dev); 87 static int virtio_vlan_filter_set(struct rte_eth_dev *dev, 88 uint16_t vlan_id, int on); 89 static void virtio_mac_addr_add(struct rte_eth_dev *dev, 90 struct ether_addr *mac_addr, 91 uint32_t index, uint32_t vmdq __rte_unused); 92 static void virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index); 93 static void virtio_mac_addr_set(struct rte_eth_dev *dev, 94 struct ether_addr *mac_addr); 95 96 static int virtio_dev_queue_stats_mapping_set( 97 __rte_unused struct rte_eth_dev *eth_dev, 98 __rte_unused uint16_t queue_id, 99 __rte_unused uint8_t stat_idx, 100 __rte_unused uint8_t is_rx); 101 102 /* 103 * The set of PCI devices this driver supports 104 */ 105 static const struct rte_pci_id pci_id_virtio_map[] = { 106 { RTE_PCI_DEVICE(VIRTIO_PCI_VENDORID, VIRTIO_PCI_LEGACY_DEVICEID_NET) }, 107 { RTE_PCI_DEVICE(VIRTIO_PCI_VENDORID, VIRTIO_PCI_MODERN_DEVICEID_NET) }, 108 { .vendor_id = 0, /* sentinel */ }, 109 }; 110 111 struct rte_virtio_xstats_name_off { 112 char name[RTE_ETH_XSTATS_NAME_SIZE]; 113 unsigned offset; 114 }; 115 116 /* [rt]x_qX_ is prepended to the name string here */ 117 static const struct rte_virtio_xstats_name_off rte_virtio_rxq_stat_strings[] = { 118 {"good_packets", offsetof(struct virtnet_rx, stats.packets)}, 119 {"good_bytes", offsetof(struct virtnet_rx, stats.bytes)}, 120 {"errors", offsetof(struct virtnet_rx, stats.errors)}, 121 {"multicast_packets", offsetof(struct virtnet_rx, stats.multicast)}, 122 {"broadcast_packets", offsetof(struct virtnet_rx, stats.broadcast)}, 123 {"undersize_packets", offsetof(struct virtnet_rx, stats.size_bins[0])}, 124 {"size_64_packets", offsetof(struct virtnet_rx, stats.size_bins[1])}, 125 {"size_65_127_packets", offsetof(struct virtnet_rx, stats.size_bins[2])}, 126 {"size_128_255_packets", offsetof(struct virtnet_rx, stats.size_bins[3])}, 127 {"size_256_511_packets", offsetof(struct virtnet_rx, stats.size_bins[4])}, 128 {"size_512_1023_packets", offsetof(struct virtnet_rx, stats.size_bins[5])}, 129 {"size_1024_1518_packets", offsetof(struct virtnet_rx, stats.size_bins[6])}, 130 {"size_1519_max_packets", offsetof(struct virtnet_rx, stats.size_bins[7])}, 131 }; 132 133 /* [rt]x_qX_ is prepended to the name string here */ 134 static const struct rte_virtio_xstats_name_off rte_virtio_txq_stat_strings[] = { 135 {"good_packets", offsetof(struct virtnet_tx, stats.packets)}, 136 {"good_bytes", offsetof(struct virtnet_tx, stats.bytes)}, 137 {"errors", offsetof(struct virtnet_tx, stats.errors)}, 138 {"multicast_packets", offsetof(struct virtnet_tx, stats.multicast)}, 139 {"broadcast_packets", offsetof(struct virtnet_tx, stats.broadcast)}, 140 {"undersize_packets", offsetof(struct virtnet_tx, stats.size_bins[0])}, 141 {"size_64_packets", offsetof(struct virtnet_tx, stats.size_bins[1])}, 142 {"size_65_127_packets", offsetof(struct virtnet_tx, stats.size_bins[2])}, 143 {"size_128_255_packets", offsetof(struct virtnet_tx, stats.size_bins[3])}, 144 {"size_256_511_packets", offsetof(struct virtnet_tx, stats.size_bins[4])}, 145 {"size_512_1023_packets", offsetof(struct virtnet_tx, stats.size_bins[5])}, 146 {"size_1024_1518_packets", offsetof(struct virtnet_tx, stats.size_bins[6])}, 147 {"size_1519_max_packets", offsetof(struct virtnet_tx, stats.size_bins[7])}, 148 }; 149 150 #define VIRTIO_NB_RXQ_XSTATS (sizeof(rte_virtio_rxq_stat_strings) / \ 151 sizeof(rte_virtio_rxq_stat_strings[0])) 152 #define VIRTIO_NB_TXQ_XSTATS (sizeof(rte_virtio_txq_stat_strings) / \ 153 sizeof(rte_virtio_txq_stat_strings[0])) 154 155 static int 156 virtio_send_command(struct virtnet_ctl *cvq, struct virtio_pmd_ctrl *ctrl, 157 int *dlen, int pkt_num) 158 { 159 uint32_t head, i; 160 int k, sum = 0; 161 virtio_net_ctrl_ack status = ~0; 162 struct virtio_pmd_ctrl result; 163 struct virtqueue *vq; 164 165 ctrl->status = status; 166 167 if (!cvq || !cvq->vq) { 168 PMD_INIT_LOG(ERR, "Control queue is not supported."); 169 return -1; 170 } 171 vq = cvq->vq; 172 head = vq->vq_desc_head_idx; 173 174 PMD_INIT_LOG(DEBUG, "vq->vq_desc_head_idx = %d, status = %d, " 175 "vq->hw->cvq = %p vq = %p", 176 vq->vq_desc_head_idx, status, vq->hw->cvq, vq); 177 178 if ((vq->vq_free_cnt < ((uint32_t)pkt_num + 2)) || (pkt_num < 1)) 179 return -1; 180 181 memcpy(cvq->virtio_net_hdr_mz->addr, ctrl, 182 sizeof(struct virtio_pmd_ctrl)); 183 184 /* 185 * Format is enforced in qemu code: 186 * One TX packet for header; 187 * At least one TX packet per argument; 188 * One RX packet for ACK. 189 */ 190 vq->vq_ring.desc[head].flags = VRING_DESC_F_NEXT; 191 vq->vq_ring.desc[head].addr = cvq->virtio_net_hdr_mem; 192 vq->vq_ring.desc[head].len = sizeof(struct virtio_net_ctrl_hdr); 193 vq->vq_free_cnt--; 194 i = vq->vq_ring.desc[head].next; 195 196 for (k = 0; k < pkt_num; k++) { 197 vq->vq_ring.desc[i].flags = VRING_DESC_F_NEXT; 198 vq->vq_ring.desc[i].addr = cvq->virtio_net_hdr_mem 199 + sizeof(struct virtio_net_ctrl_hdr) 200 + sizeof(ctrl->status) + sizeof(uint8_t)*sum; 201 vq->vq_ring.desc[i].len = dlen[k]; 202 sum += dlen[k]; 203 vq->vq_free_cnt--; 204 i = vq->vq_ring.desc[i].next; 205 } 206 207 vq->vq_ring.desc[i].flags = VRING_DESC_F_WRITE; 208 vq->vq_ring.desc[i].addr = cvq->virtio_net_hdr_mem 209 + sizeof(struct virtio_net_ctrl_hdr); 210 vq->vq_ring.desc[i].len = sizeof(ctrl->status); 211 vq->vq_free_cnt--; 212 213 vq->vq_desc_head_idx = vq->vq_ring.desc[i].next; 214 215 vq_update_avail_ring(vq, head); 216 vq_update_avail_idx(vq); 217 218 PMD_INIT_LOG(DEBUG, "vq->vq_queue_index = %d", vq->vq_queue_index); 219 220 virtqueue_notify(vq); 221 222 rte_rmb(); 223 while (VIRTQUEUE_NUSED(vq) == 0) { 224 rte_rmb(); 225 usleep(100); 226 } 227 228 while (VIRTQUEUE_NUSED(vq)) { 229 uint32_t idx, desc_idx, used_idx; 230 struct vring_used_elem *uep; 231 232 used_idx = (uint32_t)(vq->vq_used_cons_idx 233 & (vq->vq_nentries - 1)); 234 uep = &vq->vq_ring.used->ring[used_idx]; 235 idx = (uint32_t) uep->id; 236 desc_idx = idx; 237 238 while (vq->vq_ring.desc[desc_idx].flags & VRING_DESC_F_NEXT) { 239 desc_idx = vq->vq_ring.desc[desc_idx].next; 240 vq->vq_free_cnt++; 241 } 242 243 vq->vq_ring.desc[desc_idx].next = vq->vq_desc_head_idx; 244 vq->vq_desc_head_idx = idx; 245 246 vq->vq_used_cons_idx++; 247 vq->vq_free_cnt++; 248 } 249 250 PMD_INIT_LOG(DEBUG, "vq->vq_free_cnt=%d\nvq->vq_desc_head_idx=%d", 251 vq->vq_free_cnt, vq->vq_desc_head_idx); 252 253 memcpy(&result, cvq->virtio_net_hdr_mz->addr, 254 sizeof(struct virtio_pmd_ctrl)); 255 256 return result.status; 257 } 258 259 static int 260 virtio_set_multiple_queues(struct rte_eth_dev *dev, uint16_t nb_queues) 261 { 262 struct virtio_hw *hw = dev->data->dev_private; 263 struct virtio_pmd_ctrl ctrl; 264 int dlen[1]; 265 int ret; 266 267 ctrl.hdr.class = VIRTIO_NET_CTRL_MQ; 268 ctrl.hdr.cmd = VIRTIO_NET_CTRL_MQ_VQ_PAIRS_SET; 269 memcpy(ctrl.data, &nb_queues, sizeof(uint16_t)); 270 271 dlen[0] = sizeof(uint16_t); 272 273 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 274 if (ret) { 275 PMD_INIT_LOG(ERR, "Multiqueue configured but send command " 276 "failed, this is too late now..."); 277 return -EINVAL; 278 } 279 280 return 0; 281 } 282 283 void 284 virtio_dev_queue_release(struct virtqueue *vq) 285 { 286 struct virtio_hw *hw; 287 288 if (vq) { 289 hw = vq->hw; 290 if (vq->configured) 291 hw->vtpci_ops->del_queue(hw, vq); 292 293 rte_free(vq->sw_ring); 294 rte_free(vq); 295 } 296 } 297 298 int virtio_dev_queue_setup(struct rte_eth_dev *dev, 299 int queue_type, 300 uint16_t queue_idx, 301 uint16_t vtpci_queue_idx, 302 uint16_t nb_desc, 303 unsigned int socket_id, 304 void **pvq) 305 { 306 char vq_name[VIRTQUEUE_MAX_NAME_SZ]; 307 char vq_hdr_name[VIRTQUEUE_MAX_NAME_SZ]; 308 const struct rte_memzone *mz = NULL, *hdr_mz = NULL; 309 unsigned int vq_size, size; 310 struct virtio_hw *hw = dev->data->dev_private; 311 struct virtnet_rx *rxvq = NULL; 312 struct virtnet_tx *txvq = NULL; 313 struct virtnet_ctl *cvq = NULL; 314 struct virtqueue *vq; 315 const char *queue_names[] = {"rvq", "txq", "cvq"}; 316 size_t sz_vq, sz_q = 0, sz_hdr_mz = 0; 317 void *sw_ring = NULL; 318 int ret; 319 320 PMD_INIT_LOG(DEBUG, "setting up queue: %u", vtpci_queue_idx); 321 322 /* 323 * Read the virtqueue size from the Queue Size field 324 * Always power of 2 and if 0 virtqueue does not exist 325 */ 326 vq_size = hw->vtpci_ops->get_queue_num(hw, vtpci_queue_idx); 327 PMD_INIT_LOG(DEBUG, "vq_size: %u nb_desc:%u", vq_size, nb_desc); 328 if (vq_size == 0) { 329 PMD_INIT_LOG(ERR, "virtqueue does not exist"); 330 return -EINVAL; 331 } 332 333 if (!rte_is_power_of_2(vq_size)) { 334 PMD_INIT_LOG(ERR, "virtqueue size is not powerof 2"); 335 return -EINVAL; 336 } 337 338 snprintf(vq_name, sizeof(vq_name), "port%d_%s%d", 339 dev->data->port_id, queue_names[queue_type], queue_idx); 340 341 sz_vq = RTE_ALIGN_CEIL(sizeof(*vq) + 342 vq_size * sizeof(struct vq_desc_extra), 343 RTE_CACHE_LINE_SIZE); 344 if (queue_type == VTNET_RQ) { 345 sz_q = sz_vq + sizeof(*rxvq); 346 } else if (queue_type == VTNET_TQ) { 347 sz_q = sz_vq + sizeof(*txvq); 348 /* 349 * For each xmit packet, allocate a virtio_net_hdr 350 * and indirect ring elements 351 */ 352 sz_hdr_mz = vq_size * sizeof(struct virtio_tx_region); 353 } else if (queue_type == VTNET_CQ) { 354 sz_q = sz_vq + sizeof(*cvq); 355 /* Allocate a page for control vq command, data and status */ 356 sz_hdr_mz = PAGE_SIZE; 357 } 358 359 vq = rte_zmalloc_socket(vq_name, sz_q, RTE_CACHE_LINE_SIZE, socket_id); 360 if (vq == NULL) { 361 PMD_INIT_LOG(ERR, "can not allocate vq"); 362 return -ENOMEM; 363 } 364 vq->hw = hw; 365 vq->vq_queue_index = vtpci_queue_idx; 366 vq->vq_nentries = vq_size; 367 368 if (nb_desc == 0 || nb_desc > vq_size) 369 nb_desc = vq_size; 370 vq->vq_free_cnt = nb_desc; 371 372 /* 373 * Reserve a memzone for vring elements 374 */ 375 size = vring_size(vq_size, VIRTIO_PCI_VRING_ALIGN); 376 vq->vq_ring_size = RTE_ALIGN_CEIL(size, VIRTIO_PCI_VRING_ALIGN); 377 PMD_INIT_LOG(DEBUG, "vring_size: %d, rounded_vring_size: %d", 378 size, vq->vq_ring_size); 379 380 mz = rte_memzone_reserve_aligned(vq_name, vq->vq_ring_size, socket_id, 381 0, VIRTIO_PCI_VRING_ALIGN); 382 if (mz == NULL) { 383 if (rte_errno == EEXIST) 384 mz = rte_memzone_lookup(vq_name); 385 if (mz == NULL) { 386 ret = -ENOMEM; 387 goto fail_q_alloc; 388 } 389 } 390 391 memset(mz->addr, 0, sizeof(mz->len)); 392 393 vq->vq_ring_mem = mz->phys_addr; 394 vq->vq_ring_virt_mem = mz->addr; 395 PMD_INIT_LOG(DEBUG, "vq->vq_ring_mem: 0x%" PRIx64, 396 (uint64_t)mz->phys_addr); 397 PMD_INIT_LOG(DEBUG, "vq->vq_ring_virt_mem: 0x%" PRIx64, 398 (uint64_t)(uintptr_t)mz->addr); 399 400 if (sz_hdr_mz) { 401 snprintf(vq_hdr_name, sizeof(vq_hdr_name), "port%d_%s%d_hdr", 402 dev->data->port_id, queue_names[queue_type], 403 queue_idx); 404 hdr_mz = rte_memzone_reserve_aligned(vq_hdr_name, sz_hdr_mz, 405 socket_id, 0, 406 RTE_CACHE_LINE_SIZE); 407 if (hdr_mz == NULL) { 408 if (rte_errno == EEXIST) 409 hdr_mz = rte_memzone_lookup(vq_hdr_name); 410 if (hdr_mz == NULL) { 411 ret = -ENOMEM; 412 goto fail_q_alloc; 413 } 414 } 415 } 416 417 if (queue_type == VTNET_RQ) { 418 size_t sz_sw = (RTE_PMD_VIRTIO_RX_MAX_BURST + vq_size) * 419 sizeof(vq->sw_ring[0]); 420 421 sw_ring = rte_zmalloc_socket("sw_ring", sz_sw, 422 RTE_CACHE_LINE_SIZE, socket_id); 423 if (!sw_ring) { 424 PMD_INIT_LOG(ERR, "can not allocate RX soft ring"); 425 ret = -ENOMEM; 426 goto fail_q_alloc; 427 } 428 429 vq->sw_ring = sw_ring; 430 rxvq = (struct virtnet_rx *)RTE_PTR_ADD(vq, sz_vq); 431 rxvq->vq = vq; 432 rxvq->port_id = dev->data->port_id; 433 rxvq->queue_id = queue_idx; 434 rxvq->mz = mz; 435 *pvq = rxvq; 436 } else if (queue_type == VTNET_TQ) { 437 txvq = (struct virtnet_tx *)RTE_PTR_ADD(vq, sz_vq); 438 txvq->vq = vq; 439 txvq->port_id = dev->data->port_id; 440 txvq->queue_id = queue_idx; 441 txvq->mz = mz; 442 txvq->virtio_net_hdr_mz = hdr_mz; 443 txvq->virtio_net_hdr_mem = hdr_mz->phys_addr; 444 445 *pvq = txvq; 446 } else if (queue_type == VTNET_CQ) { 447 cvq = (struct virtnet_ctl *)RTE_PTR_ADD(vq, sz_vq); 448 cvq->vq = vq; 449 cvq->mz = mz; 450 cvq->virtio_net_hdr_mz = hdr_mz; 451 cvq->virtio_net_hdr_mem = hdr_mz->phys_addr; 452 memset(cvq->virtio_net_hdr_mz->addr, 0, PAGE_SIZE); 453 *pvq = cvq; 454 } 455 456 /* For virtio_user case (that is when dev->pci_dev is NULL), we use 457 * virtual address. And we need properly set _offset_, please see 458 * VIRTIO_MBUF_DATA_DMA_ADDR in virtqueue.h for more information. 459 */ 460 if (dev->pci_dev) 461 vq->offset = offsetof(struct rte_mbuf, buf_physaddr); 462 else { 463 vq->vq_ring_mem = (uintptr_t)mz->addr; 464 vq->offset = offsetof(struct rte_mbuf, buf_addr); 465 if (queue_type == VTNET_TQ) 466 txvq->virtio_net_hdr_mem = (uintptr_t)hdr_mz->addr; 467 else if (queue_type == VTNET_CQ) 468 cvq->virtio_net_hdr_mem = (uintptr_t)hdr_mz->addr; 469 } 470 471 if (queue_type == VTNET_TQ) { 472 struct virtio_tx_region *txr; 473 unsigned int i; 474 475 txr = hdr_mz->addr; 476 memset(txr, 0, vq_size * sizeof(*txr)); 477 for (i = 0; i < vq_size; i++) { 478 struct vring_desc *start_dp = txr[i].tx_indir; 479 480 vring_desc_init(start_dp, RTE_DIM(txr[i].tx_indir)); 481 482 /* first indirect descriptor is always the tx header */ 483 start_dp->addr = txvq->virtio_net_hdr_mem 484 + i * sizeof(*txr) 485 + offsetof(struct virtio_tx_region, tx_hdr); 486 487 start_dp->len = hw->vtnet_hdr_size; 488 start_dp->flags = VRING_DESC_F_NEXT; 489 } 490 } 491 492 if (hw->vtpci_ops->setup_queue(hw, vq) < 0) { 493 PMD_INIT_LOG(ERR, "setup_queue failed"); 494 virtio_dev_queue_release(vq); 495 return -EINVAL; 496 } 497 498 vq->configured = 1; 499 return 0; 500 501 fail_q_alloc: 502 rte_free(sw_ring); 503 rte_memzone_free(hdr_mz); 504 rte_memzone_free(mz); 505 rte_free(vq); 506 507 return ret; 508 } 509 510 static int 511 virtio_dev_cq_queue_setup(struct rte_eth_dev *dev, uint16_t vtpci_queue_idx, 512 uint32_t socket_id) 513 { 514 struct virtnet_ctl *cvq; 515 int ret; 516 struct virtio_hw *hw = dev->data->dev_private; 517 518 PMD_INIT_FUNC_TRACE(); 519 ret = virtio_dev_queue_setup(dev, VTNET_CQ, VTNET_SQ_CQ_QUEUE_IDX, 520 vtpci_queue_idx, 0, socket_id, (void **)&cvq); 521 if (ret < 0) { 522 PMD_INIT_LOG(ERR, "control vq initialization failed"); 523 return ret; 524 } 525 526 hw->cvq = cvq; 527 return 0; 528 } 529 530 static void 531 virtio_free_queues(struct rte_eth_dev *dev) 532 { 533 unsigned int i; 534 535 for (i = 0; i < dev->data->nb_rx_queues; i++) 536 virtio_dev_rx_queue_release(dev->data->rx_queues[i]); 537 538 dev->data->nb_rx_queues = 0; 539 540 for (i = 0; i < dev->data->nb_tx_queues; i++) 541 virtio_dev_tx_queue_release(dev->data->tx_queues[i]); 542 543 dev->data->nb_tx_queues = 0; 544 } 545 546 static void 547 virtio_dev_close(struct rte_eth_dev *dev) 548 { 549 struct virtio_hw *hw = dev->data->dev_private; 550 551 PMD_INIT_LOG(DEBUG, "virtio_dev_close"); 552 553 if (hw->started == 1) 554 virtio_dev_stop(dev); 555 556 if (hw->cvq) 557 virtio_dev_queue_release(hw->cvq->vq); 558 559 /* reset the NIC */ 560 if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) 561 vtpci_irq_config(hw, VIRTIO_MSI_NO_VECTOR); 562 vtpci_reset(hw); 563 virtio_dev_free_mbufs(dev); 564 virtio_free_queues(dev); 565 } 566 567 static void 568 virtio_dev_promiscuous_enable(struct rte_eth_dev *dev) 569 { 570 struct virtio_hw *hw = dev->data->dev_private; 571 struct virtio_pmd_ctrl ctrl; 572 int dlen[1]; 573 int ret; 574 575 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 576 PMD_INIT_LOG(INFO, "host does not support rx control\n"); 577 return; 578 } 579 580 ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 581 ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC; 582 ctrl.data[0] = 1; 583 dlen[0] = 1; 584 585 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 586 if (ret) 587 PMD_INIT_LOG(ERR, "Failed to enable promisc"); 588 } 589 590 static void 591 virtio_dev_promiscuous_disable(struct rte_eth_dev *dev) 592 { 593 struct virtio_hw *hw = dev->data->dev_private; 594 struct virtio_pmd_ctrl ctrl; 595 int dlen[1]; 596 int ret; 597 598 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 599 PMD_INIT_LOG(INFO, "host does not support rx control\n"); 600 return; 601 } 602 603 ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 604 ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC; 605 ctrl.data[0] = 0; 606 dlen[0] = 1; 607 608 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 609 if (ret) 610 PMD_INIT_LOG(ERR, "Failed to disable promisc"); 611 } 612 613 static void 614 virtio_dev_allmulticast_enable(struct rte_eth_dev *dev) 615 { 616 struct virtio_hw *hw = dev->data->dev_private; 617 struct virtio_pmd_ctrl ctrl; 618 int dlen[1]; 619 int ret; 620 621 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 622 PMD_INIT_LOG(INFO, "host does not support rx control\n"); 623 return; 624 } 625 626 ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 627 ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI; 628 ctrl.data[0] = 1; 629 dlen[0] = 1; 630 631 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 632 if (ret) 633 PMD_INIT_LOG(ERR, "Failed to enable allmulticast"); 634 } 635 636 static void 637 virtio_dev_allmulticast_disable(struct rte_eth_dev *dev) 638 { 639 struct virtio_hw *hw = dev->data->dev_private; 640 struct virtio_pmd_ctrl ctrl; 641 int dlen[1]; 642 int ret; 643 644 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 645 PMD_INIT_LOG(INFO, "host does not support rx control\n"); 646 return; 647 } 648 649 ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 650 ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI; 651 ctrl.data[0] = 0; 652 dlen[0] = 1; 653 654 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 655 if (ret) 656 PMD_INIT_LOG(ERR, "Failed to disable allmulticast"); 657 } 658 659 #define VLAN_TAG_LEN 4 /* 802.3ac tag (not DMA'd) */ 660 static int 661 virtio_mtu_set(struct rte_eth_dev *dev, uint16_t mtu) 662 { 663 struct virtio_hw *hw = dev->data->dev_private; 664 uint32_t ether_hdr_len = ETHER_HDR_LEN + VLAN_TAG_LEN + 665 hw->vtnet_hdr_size; 666 uint32_t frame_size = mtu + ether_hdr_len; 667 668 if (mtu < ETHER_MIN_MTU || frame_size > VIRTIO_MAX_RX_PKTLEN) { 669 PMD_INIT_LOG(ERR, "MTU should be between %d and %d\n", 670 ETHER_MIN_MTU, VIRTIO_MAX_RX_PKTLEN - ether_hdr_len); 671 return -EINVAL; 672 } 673 return 0; 674 } 675 676 /* 677 * dev_ops for virtio, bare necessities for basic operation 678 */ 679 static const struct eth_dev_ops virtio_eth_dev_ops = { 680 .dev_configure = virtio_dev_configure, 681 .dev_start = virtio_dev_start, 682 .dev_stop = virtio_dev_stop, 683 .dev_close = virtio_dev_close, 684 .promiscuous_enable = virtio_dev_promiscuous_enable, 685 .promiscuous_disable = virtio_dev_promiscuous_disable, 686 .allmulticast_enable = virtio_dev_allmulticast_enable, 687 .allmulticast_disable = virtio_dev_allmulticast_disable, 688 .mtu_set = virtio_mtu_set, 689 .dev_infos_get = virtio_dev_info_get, 690 .stats_get = virtio_dev_stats_get, 691 .xstats_get = virtio_dev_xstats_get, 692 .xstats_get_names = virtio_dev_xstats_get_names, 693 .stats_reset = virtio_dev_stats_reset, 694 .xstats_reset = virtio_dev_stats_reset, 695 .link_update = virtio_dev_link_update, 696 .rx_queue_setup = virtio_dev_rx_queue_setup, 697 .rx_queue_release = virtio_dev_rx_queue_release, 698 .tx_queue_setup = virtio_dev_tx_queue_setup, 699 .tx_queue_release = virtio_dev_tx_queue_release, 700 /* collect stats per queue */ 701 .queue_stats_mapping_set = virtio_dev_queue_stats_mapping_set, 702 .vlan_filter_set = virtio_vlan_filter_set, 703 .mac_addr_add = virtio_mac_addr_add, 704 .mac_addr_remove = virtio_mac_addr_remove, 705 .mac_addr_set = virtio_mac_addr_set, 706 }; 707 708 static inline int 709 virtio_dev_atomic_read_link_status(struct rte_eth_dev *dev, 710 struct rte_eth_link *link) 711 { 712 struct rte_eth_link *dst = link; 713 struct rte_eth_link *src = &(dev->data->dev_link); 714 715 if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst, 716 *(uint64_t *)src) == 0) 717 return -1; 718 719 return 0; 720 } 721 722 /** 723 * Atomically writes the link status information into global 724 * structure rte_eth_dev. 725 * 726 * @param dev 727 * - Pointer to the structure rte_eth_dev to read from. 728 * - Pointer to the buffer to be saved with the link status. 729 * 730 * @return 731 * - On success, zero. 732 * - On failure, negative value. 733 */ 734 static inline int 735 virtio_dev_atomic_write_link_status(struct rte_eth_dev *dev, 736 struct rte_eth_link *link) 737 { 738 struct rte_eth_link *dst = &(dev->data->dev_link); 739 struct rte_eth_link *src = link; 740 741 if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst, 742 *(uint64_t *)src) == 0) 743 return -1; 744 745 return 0; 746 } 747 748 static void 749 virtio_update_stats(struct rte_eth_dev *dev, struct rte_eth_stats *stats) 750 { 751 unsigned i; 752 753 for (i = 0; i < dev->data->nb_tx_queues; i++) { 754 const struct virtnet_tx *txvq = dev->data->tx_queues[i]; 755 if (txvq == NULL) 756 continue; 757 758 stats->opackets += txvq->stats.packets; 759 stats->obytes += txvq->stats.bytes; 760 stats->oerrors += txvq->stats.errors; 761 762 if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) { 763 stats->q_opackets[i] = txvq->stats.packets; 764 stats->q_obytes[i] = txvq->stats.bytes; 765 } 766 } 767 768 for (i = 0; i < dev->data->nb_rx_queues; i++) { 769 const struct virtnet_rx *rxvq = dev->data->rx_queues[i]; 770 if (rxvq == NULL) 771 continue; 772 773 stats->ipackets += rxvq->stats.packets; 774 stats->ibytes += rxvq->stats.bytes; 775 stats->ierrors += rxvq->stats.errors; 776 777 if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) { 778 stats->q_ipackets[i] = rxvq->stats.packets; 779 stats->q_ibytes[i] = rxvq->stats.bytes; 780 } 781 } 782 783 stats->rx_nombuf = dev->data->rx_mbuf_alloc_failed; 784 } 785 786 static int virtio_dev_xstats_get_names(struct rte_eth_dev *dev, 787 struct rte_eth_xstat_name *xstats_names, 788 __rte_unused unsigned limit) 789 { 790 unsigned i; 791 unsigned count = 0; 792 unsigned t; 793 794 unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_TXQ_XSTATS + 795 dev->data->nb_rx_queues * VIRTIO_NB_RXQ_XSTATS; 796 797 if (xstats_names != NULL) { 798 /* Note: limit checked in rte_eth_xstats_names() */ 799 800 for (i = 0; i < dev->data->nb_rx_queues; i++) { 801 struct virtqueue *rxvq = dev->data->rx_queues[i]; 802 if (rxvq == NULL) 803 continue; 804 for (t = 0; t < VIRTIO_NB_RXQ_XSTATS; t++) { 805 snprintf(xstats_names[count].name, 806 sizeof(xstats_names[count].name), 807 "rx_q%u_%s", i, 808 rte_virtio_rxq_stat_strings[t].name); 809 count++; 810 } 811 } 812 813 for (i = 0; i < dev->data->nb_tx_queues; i++) { 814 struct virtqueue *txvq = dev->data->tx_queues[i]; 815 if (txvq == NULL) 816 continue; 817 for (t = 0; t < VIRTIO_NB_TXQ_XSTATS; t++) { 818 snprintf(xstats_names[count].name, 819 sizeof(xstats_names[count].name), 820 "tx_q%u_%s", i, 821 rte_virtio_txq_stat_strings[t].name); 822 count++; 823 } 824 } 825 return count; 826 } 827 return nstats; 828 } 829 830 static int 831 virtio_dev_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats, 832 unsigned n) 833 { 834 unsigned i; 835 unsigned count = 0; 836 837 unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_TXQ_XSTATS + 838 dev->data->nb_rx_queues * VIRTIO_NB_RXQ_XSTATS; 839 840 if (n < nstats) 841 return nstats; 842 843 for (i = 0; i < dev->data->nb_rx_queues; i++) { 844 struct virtnet_rx *rxvq = dev->data->rx_queues[i]; 845 846 if (rxvq == NULL) 847 continue; 848 849 unsigned t; 850 851 for (t = 0; t < VIRTIO_NB_RXQ_XSTATS; t++) { 852 xstats[count].value = *(uint64_t *)(((char *)rxvq) + 853 rte_virtio_rxq_stat_strings[t].offset); 854 count++; 855 } 856 } 857 858 for (i = 0; i < dev->data->nb_tx_queues; i++) { 859 struct virtnet_tx *txvq = dev->data->tx_queues[i]; 860 861 if (txvq == NULL) 862 continue; 863 864 unsigned t; 865 866 for (t = 0; t < VIRTIO_NB_TXQ_XSTATS; t++) { 867 xstats[count].value = *(uint64_t *)(((char *)txvq) + 868 rte_virtio_txq_stat_strings[t].offset); 869 count++; 870 } 871 } 872 873 return count; 874 } 875 876 static void 877 virtio_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats) 878 { 879 virtio_update_stats(dev, stats); 880 } 881 882 static void 883 virtio_dev_stats_reset(struct rte_eth_dev *dev) 884 { 885 unsigned int i; 886 887 for (i = 0; i < dev->data->nb_tx_queues; i++) { 888 struct virtnet_tx *txvq = dev->data->tx_queues[i]; 889 if (txvq == NULL) 890 continue; 891 892 txvq->stats.packets = 0; 893 txvq->stats.bytes = 0; 894 txvq->stats.errors = 0; 895 txvq->stats.multicast = 0; 896 txvq->stats.broadcast = 0; 897 memset(txvq->stats.size_bins, 0, 898 sizeof(txvq->stats.size_bins[0]) * 8); 899 } 900 901 for (i = 0; i < dev->data->nb_rx_queues; i++) { 902 struct virtnet_rx *rxvq = dev->data->rx_queues[i]; 903 if (rxvq == NULL) 904 continue; 905 906 rxvq->stats.packets = 0; 907 rxvq->stats.bytes = 0; 908 rxvq->stats.errors = 0; 909 rxvq->stats.multicast = 0; 910 rxvq->stats.broadcast = 0; 911 memset(rxvq->stats.size_bins, 0, 912 sizeof(rxvq->stats.size_bins[0]) * 8); 913 } 914 } 915 916 static void 917 virtio_set_hwaddr(struct virtio_hw *hw) 918 { 919 vtpci_write_dev_config(hw, 920 offsetof(struct virtio_net_config, mac), 921 &hw->mac_addr, ETHER_ADDR_LEN); 922 } 923 924 static void 925 virtio_get_hwaddr(struct virtio_hw *hw) 926 { 927 if (vtpci_with_feature(hw, VIRTIO_NET_F_MAC)) { 928 vtpci_read_dev_config(hw, 929 offsetof(struct virtio_net_config, mac), 930 &hw->mac_addr, ETHER_ADDR_LEN); 931 } else { 932 eth_random_addr(&hw->mac_addr[0]); 933 virtio_set_hwaddr(hw); 934 } 935 } 936 937 static void 938 virtio_mac_table_set(struct virtio_hw *hw, 939 const struct virtio_net_ctrl_mac *uc, 940 const struct virtio_net_ctrl_mac *mc) 941 { 942 struct virtio_pmd_ctrl ctrl; 943 int err, len[2]; 944 945 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) { 946 PMD_DRV_LOG(INFO, "host does not support mac table"); 947 return; 948 } 949 950 ctrl.hdr.class = VIRTIO_NET_CTRL_MAC; 951 ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_TABLE_SET; 952 953 len[0] = uc->entries * ETHER_ADDR_LEN + sizeof(uc->entries); 954 memcpy(ctrl.data, uc, len[0]); 955 956 len[1] = mc->entries * ETHER_ADDR_LEN + sizeof(mc->entries); 957 memcpy(ctrl.data + len[0], mc, len[1]); 958 959 err = virtio_send_command(hw->cvq, &ctrl, len, 2); 960 if (err != 0) 961 PMD_DRV_LOG(NOTICE, "mac table set failed: %d", err); 962 } 963 964 static void 965 virtio_mac_addr_add(struct rte_eth_dev *dev, struct ether_addr *mac_addr, 966 uint32_t index, uint32_t vmdq __rte_unused) 967 { 968 struct virtio_hw *hw = dev->data->dev_private; 969 const struct ether_addr *addrs = dev->data->mac_addrs; 970 unsigned int i; 971 struct virtio_net_ctrl_mac *uc, *mc; 972 973 if (index >= VIRTIO_MAX_MAC_ADDRS) { 974 PMD_DRV_LOG(ERR, "mac address index %u out of range", index); 975 return; 976 } 977 978 uc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(uc->entries)); 979 uc->entries = 0; 980 mc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(mc->entries)); 981 mc->entries = 0; 982 983 for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) { 984 const struct ether_addr *addr 985 = (i == index) ? mac_addr : addrs + i; 986 struct virtio_net_ctrl_mac *tbl 987 = is_multicast_ether_addr(addr) ? mc : uc; 988 989 memcpy(&tbl->macs[tbl->entries++], addr, ETHER_ADDR_LEN); 990 } 991 992 virtio_mac_table_set(hw, uc, mc); 993 } 994 995 static void 996 virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index) 997 { 998 struct virtio_hw *hw = dev->data->dev_private; 999 struct ether_addr *addrs = dev->data->mac_addrs; 1000 struct virtio_net_ctrl_mac *uc, *mc; 1001 unsigned int i; 1002 1003 if (index >= VIRTIO_MAX_MAC_ADDRS) { 1004 PMD_DRV_LOG(ERR, "mac address index %u out of range", index); 1005 return; 1006 } 1007 1008 uc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(uc->entries)); 1009 uc->entries = 0; 1010 mc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(mc->entries)); 1011 mc->entries = 0; 1012 1013 for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) { 1014 struct virtio_net_ctrl_mac *tbl; 1015 1016 if (i == index || is_zero_ether_addr(addrs + i)) 1017 continue; 1018 1019 tbl = is_multicast_ether_addr(addrs + i) ? mc : uc; 1020 memcpy(&tbl->macs[tbl->entries++], addrs + i, ETHER_ADDR_LEN); 1021 } 1022 1023 virtio_mac_table_set(hw, uc, mc); 1024 } 1025 1026 static void 1027 virtio_mac_addr_set(struct rte_eth_dev *dev, struct ether_addr *mac_addr) 1028 { 1029 struct virtio_hw *hw = dev->data->dev_private; 1030 1031 memcpy(hw->mac_addr, mac_addr, ETHER_ADDR_LEN); 1032 1033 /* Use atomic update if available */ 1034 if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) { 1035 struct virtio_pmd_ctrl ctrl; 1036 int len = ETHER_ADDR_LEN; 1037 1038 ctrl.hdr.class = VIRTIO_NET_CTRL_MAC; 1039 ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_ADDR_SET; 1040 1041 memcpy(ctrl.data, mac_addr, ETHER_ADDR_LEN); 1042 virtio_send_command(hw->cvq, &ctrl, &len, 1); 1043 } else if (vtpci_with_feature(hw, VIRTIO_NET_F_MAC)) 1044 virtio_set_hwaddr(hw); 1045 } 1046 1047 static int 1048 virtio_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on) 1049 { 1050 struct virtio_hw *hw = dev->data->dev_private; 1051 struct virtio_pmd_ctrl ctrl; 1052 int len; 1053 1054 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) 1055 return -ENOTSUP; 1056 1057 ctrl.hdr.class = VIRTIO_NET_CTRL_VLAN; 1058 ctrl.hdr.cmd = on ? VIRTIO_NET_CTRL_VLAN_ADD : VIRTIO_NET_CTRL_VLAN_DEL; 1059 memcpy(ctrl.data, &vlan_id, sizeof(vlan_id)); 1060 len = sizeof(vlan_id); 1061 1062 return virtio_send_command(hw->cvq, &ctrl, &len, 1); 1063 } 1064 1065 static int 1066 virtio_negotiate_features(struct virtio_hw *hw, uint64_t req_features) 1067 { 1068 uint64_t host_features; 1069 1070 /* Prepare guest_features: feature that driver wants to support */ 1071 PMD_INIT_LOG(DEBUG, "guest_features before negotiate = %" PRIx64, 1072 req_features); 1073 1074 /* Read device(host) feature bits */ 1075 host_features = hw->vtpci_ops->get_features(hw); 1076 PMD_INIT_LOG(DEBUG, "host_features before negotiate = %" PRIx64, 1077 host_features); 1078 1079 /* 1080 * Negotiate features: Subset of device feature bits are written back 1081 * guest feature bits. 1082 */ 1083 hw->guest_features = req_features; 1084 hw->guest_features = vtpci_negotiate_features(hw, host_features); 1085 PMD_INIT_LOG(DEBUG, "features after negotiate = %" PRIx64, 1086 hw->guest_features); 1087 1088 if (hw->modern) { 1089 if (!vtpci_with_feature(hw, VIRTIO_F_VERSION_1)) { 1090 PMD_INIT_LOG(ERR, 1091 "VIRTIO_F_VERSION_1 features is not enabled."); 1092 return -1; 1093 } 1094 vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_FEATURES_OK); 1095 if (!(vtpci_get_status(hw) & VIRTIO_CONFIG_STATUS_FEATURES_OK)) { 1096 PMD_INIT_LOG(ERR, 1097 "failed to set FEATURES_OK status!"); 1098 return -1; 1099 } 1100 } 1101 1102 hw->req_guest_features = req_features; 1103 1104 return 0; 1105 } 1106 1107 /* 1108 * Process Virtio Config changed interrupt and call the callback 1109 * if link state changed. 1110 */ 1111 static void 1112 virtio_interrupt_handler(__rte_unused struct rte_intr_handle *handle, 1113 void *param) 1114 { 1115 struct rte_eth_dev *dev = param; 1116 struct virtio_hw *hw = dev->data->dev_private; 1117 uint8_t isr; 1118 1119 /* Read interrupt status which clears interrupt */ 1120 isr = vtpci_isr(hw); 1121 PMD_DRV_LOG(INFO, "interrupt status = %#x", isr); 1122 1123 if (rte_intr_enable(&dev->pci_dev->intr_handle) < 0) 1124 PMD_DRV_LOG(ERR, "interrupt enable failed"); 1125 1126 if (isr & VIRTIO_PCI_ISR_CONFIG) { 1127 if (virtio_dev_link_update(dev, 0) == 0) 1128 _rte_eth_dev_callback_process(dev, 1129 RTE_ETH_EVENT_INTR_LSC); 1130 } 1131 1132 } 1133 1134 static void 1135 rx_func_get(struct rte_eth_dev *eth_dev) 1136 { 1137 struct virtio_hw *hw = eth_dev->data->dev_private; 1138 if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) 1139 eth_dev->rx_pkt_burst = &virtio_recv_mergeable_pkts; 1140 else 1141 eth_dev->rx_pkt_burst = &virtio_recv_pkts; 1142 } 1143 1144 /* reset device and renegotiate features if needed */ 1145 static int 1146 virtio_init_device(struct rte_eth_dev *eth_dev, uint64_t req_features) 1147 { 1148 struct virtio_hw *hw = eth_dev->data->dev_private; 1149 struct virtio_net_config *config; 1150 struct virtio_net_config local_config; 1151 struct rte_pci_device *pci_dev = eth_dev->pci_dev; 1152 1153 /* Reset the device although not necessary at startup */ 1154 vtpci_reset(hw); 1155 1156 /* Tell the host we've noticed this device. */ 1157 vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_ACK); 1158 1159 /* Tell the host we've known how to drive the device. */ 1160 vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_DRIVER); 1161 if (virtio_negotiate_features(hw, req_features) < 0) 1162 return -1; 1163 1164 /* If host does not support status then disable LSC */ 1165 if (!vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) 1166 eth_dev->data->dev_flags &= ~RTE_ETH_DEV_INTR_LSC; 1167 else 1168 eth_dev->data->dev_flags |= RTE_ETH_DEV_INTR_LSC; 1169 1170 rte_eth_copy_pci_info(eth_dev, pci_dev); 1171 1172 rx_func_get(eth_dev); 1173 1174 /* Setting up rx_header size for the device */ 1175 if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF) || 1176 vtpci_with_feature(hw, VIRTIO_F_VERSION_1)) 1177 hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr_mrg_rxbuf); 1178 else 1179 hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr); 1180 1181 /* Copy the permanent MAC address to: virtio_hw */ 1182 virtio_get_hwaddr(hw); 1183 ether_addr_copy((struct ether_addr *) hw->mac_addr, 1184 ð_dev->data->mac_addrs[0]); 1185 PMD_INIT_LOG(DEBUG, 1186 "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X", 1187 hw->mac_addr[0], hw->mac_addr[1], hw->mac_addr[2], 1188 hw->mac_addr[3], hw->mac_addr[4], hw->mac_addr[5]); 1189 1190 if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ)) { 1191 config = &local_config; 1192 1193 vtpci_read_dev_config(hw, 1194 offsetof(struct virtio_net_config, mac), 1195 &config->mac, sizeof(config->mac)); 1196 1197 if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) { 1198 vtpci_read_dev_config(hw, 1199 offsetof(struct virtio_net_config, status), 1200 &config->status, sizeof(config->status)); 1201 } else { 1202 PMD_INIT_LOG(DEBUG, 1203 "VIRTIO_NET_F_STATUS is not supported"); 1204 config->status = 0; 1205 } 1206 1207 if (vtpci_with_feature(hw, VIRTIO_NET_F_MQ)) { 1208 vtpci_read_dev_config(hw, 1209 offsetof(struct virtio_net_config, max_virtqueue_pairs), 1210 &config->max_virtqueue_pairs, 1211 sizeof(config->max_virtqueue_pairs)); 1212 } else { 1213 PMD_INIT_LOG(DEBUG, 1214 "VIRTIO_NET_F_MQ is not supported"); 1215 config->max_virtqueue_pairs = 1; 1216 } 1217 1218 hw->max_queue_pairs = config->max_virtqueue_pairs; 1219 1220 PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=%d", 1221 config->max_virtqueue_pairs); 1222 PMD_INIT_LOG(DEBUG, "config->status=%d", config->status); 1223 PMD_INIT_LOG(DEBUG, 1224 "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X", 1225 config->mac[0], config->mac[1], 1226 config->mac[2], config->mac[3], 1227 config->mac[4], config->mac[5]); 1228 } else { 1229 PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=1"); 1230 hw->max_queue_pairs = 1; 1231 } 1232 1233 if (pci_dev) 1234 PMD_INIT_LOG(DEBUG, "port %d vendorID=0x%x deviceID=0x%x", 1235 eth_dev->data->port_id, pci_dev->id.vendor_id, 1236 pci_dev->id.device_id); 1237 1238 return 0; 1239 } 1240 1241 /* 1242 * This function is based on probe() function in virtio_pci.c 1243 * It returns 0 on success. 1244 */ 1245 int 1246 eth_virtio_dev_init(struct rte_eth_dev *eth_dev) 1247 { 1248 struct virtio_hw *hw = eth_dev->data->dev_private; 1249 struct rte_pci_device *pci_dev; 1250 uint32_t dev_flags = RTE_ETH_DEV_DETACHABLE; 1251 int ret; 1252 1253 RTE_BUILD_BUG_ON(RTE_PKTMBUF_HEADROOM < sizeof(struct virtio_net_hdr_mrg_rxbuf)); 1254 1255 eth_dev->dev_ops = &virtio_eth_dev_ops; 1256 eth_dev->tx_pkt_burst = &virtio_xmit_pkts; 1257 1258 if (rte_eal_process_type() == RTE_PROC_SECONDARY) { 1259 rx_func_get(eth_dev); 1260 return 0; 1261 } 1262 1263 /* Allocate memory for storing MAC addresses */ 1264 eth_dev->data->mac_addrs = rte_zmalloc("virtio", VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN, 0); 1265 if (eth_dev->data->mac_addrs == NULL) { 1266 PMD_INIT_LOG(ERR, 1267 "Failed to allocate %d bytes needed to store MAC addresses", 1268 VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN); 1269 return -ENOMEM; 1270 } 1271 1272 pci_dev = eth_dev->pci_dev; 1273 1274 if (pci_dev) { 1275 ret = vtpci_init(pci_dev, hw, &dev_flags); 1276 if (ret) 1277 return ret; 1278 } 1279 1280 eth_dev->data->dev_flags = dev_flags; 1281 1282 /* reset device and negotiate default features */ 1283 ret = virtio_init_device(eth_dev, VIRTIO_PMD_DEFAULT_GUEST_FEATURES); 1284 if (ret < 0) 1285 return ret; 1286 1287 /* Setup interrupt callback */ 1288 if (eth_dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) 1289 rte_intr_callback_register(&pci_dev->intr_handle, 1290 virtio_interrupt_handler, eth_dev); 1291 1292 return 0; 1293 } 1294 1295 static int 1296 eth_virtio_dev_uninit(struct rte_eth_dev *eth_dev) 1297 { 1298 struct rte_pci_device *pci_dev; 1299 1300 PMD_INIT_FUNC_TRACE(); 1301 1302 if (rte_eal_process_type() == RTE_PROC_SECONDARY) 1303 return -EPERM; 1304 1305 /* Close it anyway since there's no way to know if closed */ 1306 virtio_dev_close(eth_dev); 1307 1308 pci_dev = eth_dev->pci_dev; 1309 1310 eth_dev->dev_ops = NULL; 1311 eth_dev->tx_pkt_burst = NULL; 1312 eth_dev->rx_pkt_burst = NULL; 1313 1314 rte_free(eth_dev->data->mac_addrs); 1315 eth_dev->data->mac_addrs = NULL; 1316 1317 /* reset interrupt callback */ 1318 if (eth_dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) 1319 rte_intr_callback_unregister(&pci_dev->intr_handle, 1320 virtio_interrupt_handler, 1321 eth_dev); 1322 rte_eal_pci_unmap_device(pci_dev); 1323 1324 PMD_INIT_LOG(DEBUG, "dev_uninit completed"); 1325 1326 return 0; 1327 } 1328 1329 static struct eth_driver rte_virtio_pmd = { 1330 .pci_drv = { 1331 .driver = { 1332 .name = "net_virtio", 1333 }, 1334 .id_table = pci_id_virtio_map, 1335 .drv_flags = RTE_PCI_DRV_DETACHABLE, 1336 .probe = rte_eth_dev_pci_probe, 1337 .remove = rte_eth_dev_pci_remove, 1338 }, 1339 .eth_dev_init = eth_virtio_dev_init, 1340 .eth_dev_uninit = eth_virtio_dev_uninit, 1341 .dev_private_size = sizeof(struct virtio_hw), 1342 }; 1343 1344 RTE_INIT(rte_virtio_pmd_init); 1345 static void 1346 rte_virtio_pmd_init(void) 1347 { 1348 if (rte_eal_iopl_init() != 0) { 1349 PMD_INIT_LOG(ERR, "IOPL call failed - cannot use virtio PMD"); 1350 return; 1351 } 1352 1353 rte_eal_pci_register(&rte_virtio_pmd.pci_drv); 1354 } 1355 1356 /* 1357 * Configure virtio device 1358 * It returns 0 on success. 1359 */ 1360 static int 1361 virtio_dev_configure(struct rte_eth_dev *dev) 1362 { 1363 const struct rte_eth_rxmode *rxmode = &dev->data->dev_conf.rxmode; 1364 struct virtio_hw *hw = dev->data->dev_private; 1365 uint64_t req_features; 1366 int ret; 1367 1368 PMD_INIT_LOG(DEBUG, "configure"); 1369 req_features = VIRTIO_PMD_DEFAULT_GUEST_FEATURES; 1370 if (rxmode->hw_ip_checksum) 1371 req_features |= (1ULL << VIRTIO_NET_F_GUEST_CSUM); 1372 if (rxmode->enable_lro) 1373 req_features |= 1374 (1ULL << VIRTIO_NET_F_GUEST_TSO4) | 1375 (1ULL << VIRTIO_NET_F_GUEST_TSO6); 1376 1377 /* if request features changed, reinit the device */ 1378 if (req_features != hw->req_guest_features) { 1379 ret = virtio_init_device(dev, req_features); 1380 if (ret < 0) 1381 return ret; 1382 } 1383 1384 if (rxmode->hw_ip_checksum && 1385 !vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_CSUM)) { 1386 PMD_DRV_LOG(NOTICE, 1387 "rx ip checksum not available on this host"); 1388 return -ENOTSUP; 1389 } 1390 1391 if (rxmode->enable_lro && 1392 (!vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_TSO4) || 1393 !vtpci_with_feature(hw, VIRTIO_NET_F_GUEST_TSO4))) { 1394 PMD_DRV_LOG(NOTICE, 1395 "lro not available on this host"); 1396 return -ENOTSUP; 1397 } 1398 1399 /* Setup and start control queue */ 1400 if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ)) { 1401 ret = virtio_dev_cq_queue_setup(dev, 1402 hw->max_queue_pairs * 2, 1403 SOCKET_ID_ANY); 1404 if (ret < 0) 1405 return ret; 1406 virtio_dev_cq_start(dev); 1407 } 1408 1409 hw->vlan_strip = rxmode->hw_vlan_strip; 1410 1411 if (rxmode->hw_vlan_filter 1412 && !vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) { 1413 PMD_DRV_LOG(NOTICE, 1414 "vlan filtering not available on this host"); 1415 return -ENOTSUP; 1416 } 1417 1418 if (dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC) 1419 if (vtpci_irq_config(hw, 0) == VIRTIO_MSI_NO_VECTOR) { 1420 PMD_DRV_LOG(ERR, "failed to set config vector"); 1421 return -EBUSY; 1422 } 1423 1424 return 0; 1425 } 1426 1427 1428 static int 1429 virtio_dev_start(struct rte_eth_dev *dev) 1430 { 1431 uint16_t nb_queues, i; 1432 struct virtio_hw *hw = dev->data->dev_private; 1433 struct virtnet_rx *rxvq; 1434 struct virtnet_tx *txvq __rte_unused; 1435 1436 /* check if lsc interrupt feature is enabled */ 1437 if (dev->data->dev_conf.intr_conf.lsc) { 1438 if (!(dev->data->dev_flags & RTE_ETH_DEV_INTR_LSC)) { 1439 PMD_DRV_LOG(ERR, "link status not supported by host"); 1440 return -ENOTSUP; 1441 } 1442 1443 if (rte_intr_enable(&dev->pci_dev->intr_handle) < 0) { 1444 PMD_DRV_LOG(ERR, "interrupt enable failed"); 1445 return -EIO; 1446 } 1447 } 1448 1449 /* Initialize Link state */ 1450 virtio_dev_link_update(dev, 0); 1451 1452 /* On restart after stop do not touch queues */ 1453 if (hw->started) 1454 return 0; 1455 1456 /* Do final configuration before rx/tx engine starts */ 1457 virtio_dev_rxtx_start(dev); 1458 vtpci_reinit_complete(hw); 1459 1460 hw->started = 1; 1461 1462 /*Notify the backend 1463 *Otherwise the tap backend might already stop its queue due to fullness. 1464 *vhost backend will have no chance to be waked up 1465 */ 1466 nb_queues = dev->data->nb_rx_queues; 1467 if (nb_queues > 1) { 1468 if (virtio_set_multiple_queues(dev, nb_queues) != 0) 1469 return -EINVAL; 1470 } 1471 1472 PMD_INIT_LOG(DEBUG, "nb_queues=%d", nb_queues); 1473 1474 for (i = 0; i < nb_queues; i++) { 1475 rxvq = dev->data->rx_queues[i]; 1476 virtqueue_notify(rxvq->vq); 1477 } 1478 1479 PMD_INIT_LOG(DEBUG, "Notified backend at initialization"); 1480 1481 for (i = 0; i < dev->data->nb_rx_queues; i++) { 1482 rxvq = dev->data->rx_queues[i]; 1483 VIRTQUEUE_DUMP(rxvq->vq); 1484 } 1485 1486 for (i = 0; i < dev->data->nb_tx_queues; i++) { 1487 txvq = dev->data->tx_queues[i]; 1488 VIRTQUEUE_DUMP(txvq->vq); 1489 } 1490 1491 return 0; 1492 } 1493 1494 static void virtio_dev_free_mbufs(struct rte_eth_dev *dev) 1495 { 1496 struct rte_mbuf *buf; 1497 int i, mbuf_num = 0; 1498 1499 for (i = 0; i < dev->data->nb_rx_queues; i++) { 1500 struct virtnet_rx *rxvq = dev->data->rx_queues[i]; 1501 1502 PMD_INIT_LOG(DEBUG, 1503 "Before freeing rxq[%d] used and unused buf", i); 1504 VIRTQUEUE_DUMP(rxvq->vq); 1505 1506 PMD_INIT_LOG(DEBUG, "rx_queues[%d]=%p", i, rxvq); 1507 while ((buf = virtqueue_detatch_unused(rxvq->vq)) != NULL) { 1508 rte_pktmbuf_free(buf); 1509 mbuf_num++; 1510 } 1511 1512 PMD_INIT_LOG(DEBUG, "free %d mbufs", mbuf_num); 1513 PMD_INIT_LOG(DEBUG, 1514 "After freeing rxq[%d] used and unused buf", i); 1515 VIRTQUEUE_DUMP(rxvq->vq); 1516 } 1517 1518 for (i = 0; i < dev->data->nb_tx_queues; i++) { 1519 struct virtnet_tx *txvq = dev->data->tx_queues[i]; 1520 1521 PMD_INIT_LOG(DEBUG, 1522 "Before freeing txq[%d] used and unused bufs", 1523 i); 1524 VIRTQUEUE_DUMP(txvq->vq); 1525 1526 mbuf_num = 0; 1527 while ((buf = virtqueue_detatch_unused(txvq->vq)) != NULL) { 1528 rte_pktmbuf_free(buf); 1529 mbuf_num++; 1530 } 1531 1532 PMD_INIT_LOG(DEBUG, "free %d mbufs", mbuf_num); 1533 PMD_INIT_LOG(DEBUG, 1534 "After freeing txq[%d] used and unused buf", i); 1535 VIRTQUEUE_DUMP(txvq->vq); 1536 } 1537 } 1538 1539 /* 1540 * Stop device: disable interrupt and mark link down 1541 */ 1542 static void 1543 virtio_dev_stop(struct rte_eth_dev *dev) 1544 { 1545 struct rte_eth_link link; 1546 struct virtio_hw *hw = dev->data->dev_private; 1547 1548 PMD_INIT_LOG(DEBUG, "stop"); 1549 1550 hw->started = 0; 1551 1552 if (dev->data->dev_conf.intr_conf.lsc) 1553 rte_intr_disable(&dev->pci_dev->intr_handle); 1554 1555 memset(&link, 0, sizeof(link)); 1556 virtio_dev_atomic_write_link_status(dev, &link); 1557 } 1558 1559 static int 1560 virtio_dev_link_update(struct rte_eth_dev *dev, __rte_unused int wait_to_complete) 1561 { 1562 struct rte_eth_link link, old; 1563 uint16_t status; 1564 struct virtio_hw *hw = dev->data->dev_private; 1565 memset(&link, 0, sizeof(link)); 1566 virtio_dev_atomic_read_link_status(dev, &link); 1567 old = link; 1568 link.link_duplex = ETH_LINK_FULL_DUPLEX; 1569 link.link_speed = SPEED_10G; 1570 1571 if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) { 1572 PMD_INIT_LOG(DEBUG, "Get link status from hw"); 1573 vtpci_read_dev_config(hw, 1574 offsetof(struct virtio_net_config, status), 1575 &status, sizeof(status)); 1576 if ((status & VIRTIO_NET_S_LINK_UP) == 0) { 1577 link.link_status = ETH_LINK_DOWN; 1578 PMD_INIT_LOG(DEBUG, "Port %d is down", 1579 dev->data->port_id); 1580 } else { 1581 link.link_status = ETH_LINK_UP; 1582 PMD_INIT_LOG(DEBUG, "Port %d is up", 1583 dev->data->port_id); 1584 } 1585 } else { 1586 link.link_status = ETH_LINK_UP; 1587 } 1588 virtio_dev_atomic_write_link_status(dev, &link); 1589 1590 return (old.link_status == link.link_status) ? -1 : 0; 1591 } 1592 1593 static void 1594 virtio_dev_info_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info) 1595 { 1596 uint64_t tso_mask; 1597 struct virtio_hw *hw = dev->data->dev_private; 1598 1599 if (dev->pci_dev) 1600 dev_info->driver_name = dev->driver->pci_drv.driver.name; 1601 else 1602 dev_info->driver_name = "virtio_user PMD"; 1603 dev_info->max_rx_queues = 1604 RTE_MIN(hw->max_queue_pairs, VIRTIO_MAX_RX_QUEUES); 1605 dev_info->max_tx_queues = 1606 RTE_MIN(hw->max_queue_pairs, VIRTIO_MAX_TX_QUEUES); 1607 dev_info->min_rx_bufsize = VIRTIO_MIN_RX_BUFSIZE; 1608 dev_info->max_rx_pktlen = VIRTIO_MAX_RX_PKTLEN; 1609 dev_info->max_mac_addrs = VIRTIO_MAX_MAC_ADDRS; 1610 dev_info->default_txconf = (struct rte_eth_txconf) { 1611 .txq_flags = ETH_TXQ_FLAGS_NOOFFLOADS 1612 }; 1613 dev_info->rx_offload_capa = 1614 DEV_RX_OFFLOAD_TCP_CKSUM | 1615 DEV_RX_OFFLOAD_UDP_CKSUM | 1616 DEV_RX_OFFLOAD_TCP_LRO; 1617 dev_info->tx_offload_capa = 0; 1618 1619 if (hw->guest_features & (1ULL << VIRTIO_NET_F_CSUM)) { 1620 dev_info->tx_offload_capa |= 1621 DEV_TX_OFFLOAD_UDP_CKSUM | 1622 DEV_TX_OFFLOAD_TCP_CKSUM; 1623 } 1624 1625 tso_mask = (1ULL << VIRTIO_NET_F_HOST_TSO4) | 1626 (1ULL << VIRTIO_NET_F_HOST_TSO6); 1627 if ((hw->guest_features & tso_mask) == tso_mask) 1628 dev_info->tx_offload_capa |= DEV_TX_OFFLOAD_TCP_TSO; 1629 } 1630 1631 /* 1632 * It enables testpmd to collect per queue stats. 1633 */ 1634 static int 1635 virtio_dev_queue_stats_mapping_set(__rte_unused struct rte_eth_dev *eth_dev, 1636 __rte_unused uint16_t queue_id, __rte_unused uint8_t stat_idx, 1637 __rte_unused uint8_t is_rx) 1638 { 1639 return 0; 1640 } 1641 1642 DRIVER_EXPORT_NAME(net_virtio, __COUNTER__); 1643 DRIVER_REGISTER_PCI_TABLE(net_virtio, pci_id_virtio_map); 1644