1 /*- 2 * BSD LICENSE 3 * 4 * Copyright(c) 2010-2015 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 63 static int eth_virtio_dev_init(struct rte_eth_dev *eth_dev); 64 static int eth_virtio_dev_uninit(struct rte_eth_dev *eth_dev); 65 static int virtio_dev_configure(struct rte_eth_dev *dev); 66 static int virtio_dev_start(struct rte_eth_dev *dev); 67 static void virtio_dev_stop(struct rte_eth_dev *dev); 68 static void virtio_dev_promiscuous_enable(struct rte_eth_dev *dev); 69 static void virtio_dev_promiscuous_disable(struct rte_eth_dev *dev); 70 static void virtio_dev_allmulticast_enable(struct rte_eth_dev *dev); 71 static void virtio_dev_allmulticast_disable(struct rte_eth_dev *dev); 72 static void virtio_dev_info_get(struct rte_eth_dev *dev, 73 struct rte_eth_dev_info *dev_info); 74 static int virtio_dev_link_update(struct rte_eth_dev *dev, 75 __rte_unused int wait_to_complete); 76 77 static void virtio_set_hwaddr(struct virtio_hw *hw); 78 static void virtio_get_hwaddr(struct virtio_hw *hw); 79 80 static void virtio_dev_stats_get(struct rte_eth_dev *dev, 81 struct rte_eth_stats *stats); 82 static int virtio_dev_xstats_get(struct rte_eth_dev *dev, 83 struct rte_eth_xstats *xstats, unsigned n); 84 static void virtio_dev_stats_reset(struct rte_eth_dev *dev); 85 static void virtio_dev_free_mbufs(struct rte_eth_dev *dev); 86 static int virtio_vlan_filter_set(struct rte_eth_dev *dev, 87 uint16_t vlan_id, int on); 88 static void virtio_mac_addr_add(struct rte_eth_dev *dev, 89 struct ether_addr *mac_addr, 90 uint32_t index, uint32_t vmdq __rte_unused); 91 static void virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index); 92 static void virtio_mac_addr_set(struct rte_eth_dev *dev, 93 struct ether_addr *mac_addr); 94 95 static int virtio_dev_queue_stats_mapping_set( 96 __rte_unused struct rte_eth_dev *eth_dev, 97 __rte_unused uint16_t queue_id, 98 __rte_unused uint8_t stat_idx, 99 __rte_unused uint8_t is_rx); 100 101 /* 102 * The set of PCI devices this driver supports 103 */ 104 static const struct rte_pci_id pci_id_virtio_map[] = { 105 106 #define RTE_PCI_DEV_ID_DECL_VIRTIO(vend, dev) {RTE_PCI_DEVICE(vend, dev)}, 107 #include "rte_pci_dev_ids.h" 108 109 { .vendor_id = 0, /* sentinel */ }, 110 }; 111 112 struct rte_virtio_xstats_name_off { 113 char name[RTE_ETH_XSTATS_NAME_SIZE]; 114 unsigned offset; 115 }; 116 117 /* [rt]x_qX_ is prepended to the name string here */ 118 static const struct rte_virtio_xstats_name_off rte_virtio_q_stat_strings[] = { 119 {"good_packets", offsetof(struct virtqueue, packets)}, 120 {"good_bytes", offsetof(struct virtqueue, bytes)}, 121 {"errors", offsetof(struct virtqueue, errors)}, 122 {"multicast_packets", offsetof(struct virtqueue, multicast)}, 123 {"broadcast_packets", offsetof(struct virtqueue, broadcast)}, 124 {"undersize_packets", offsetof(struct virtqueue, size_bins[0])}, 125 {"size_64_packets", offsetof(struct virtqueue, size_bins[1])}, 126 {"size_65_127_packets", offsetof(struct virtqueue, size_bins[2])}, 127 {"size_128_255_packets", offsetof(struct virtqueue, size_bins[3])}, 128 {"size_256_511_packets", offsetof(struct virtqueue, size_bins[4])}, 129 {"size_512_1023_packets", offsetof(struct virtqueue, size_bins[5])}, 130 {"size_1024_1517_packets", offsetof(struct virtqueue, size_bins[6])}, 131 {"size_1518_max_packets", offsetof(struct virtqueue, size_bins[7])}, 132 }; 133 134 #define VIRTIO_NB_Q_XSTATS (sizeof(rte_virtio_q_stat_strings) / \ 135 sizeof(rte_virtio_q_stat_strings[0])) 136 137 static int 138 virtio_send_command(struct virtqueue *vq, struct virtio_pmd_ctrl *ctrl, 139 int *dlen, int pkt_num) 140 { 141 uint32_t head, i; 142 int k, sum = 0; 143 virtio_net_ctrl_ack status = ~0; 144 struct virtio_pmd_ctrl result; 145 146 ctrl->status = status; 147 148 if (!(vq && vq->hw->cvq)) { 149 PMD_INIT_LOG(ERR, 150 "%s(): Control queue is not supported.", 151 __func__); 152 return -1; 153 } 154 head = vq->vq_desc_head_idx; 155 156 PMD_INIT_LOG(DEBUG, "vq->vq_desc_head_idx = %d, status = %d, " 157 "vq->hw->cvq = %p vq = %p", 158 vq->vq_desc_head_idx, status, vq->hw->cvq, vq); 159 160 if ((vq->vq_free_cnt < ((uint32_t)pkt_num + 2)) || (pkt_num < 1)) 161 return -1; 162 163 memcpy(vq->virtio_net_hdr_mz->addr, ctrl, 164 sizeof(struct virtio_pmd_ctrl)); 165 166 /* 167 * Format is enforced in qemu code: 168 * One TX packet for header; 169 * At least one TX packet per argument; 170 * One RX packet for ACK. 171 */ 172 vq->vq_ring.desc[head].flags = VRING_DESC_F_NEXT; 173 vq->vq_ring.desc[head].addr = vq->virtio_net_hdr_mz->phys_addr; 174 vq->vq_ring.desc[head].len = sizeof(struct virtio_net_ctrl_hdr); 175 vq->vq_free_cnt--; 176 i = vq->vq_ring.desc[head].next; 177 178 for (k = 0; k < pkt_num; k++) { 179 vq->vq_ring.desc[i].flags = VRING_DESC_F_NEXT; 180 vq->vq_ring.desc[i].addr = vq->virtio_net_hdr_mz->phys_addr 181 + sizeof(struct virtio_net_ctrl_hdr) 182 + sizeof(ctrl->status) + sizeof(uint8_t)*sum; 183 vq->vq_ring.desc[i].len = dlen[k]; 184 sum += dlen[k]; 185 vq->vq_free_cnt--; 186 i = vq->vq_ring.desc[i].next; 187 } 188 189 vq->vq_ring.desc[i].flags = VRING_DESC_F_WRITE; 190 vq->vq_ring.desc[i].addr = vq->virtio_net_hdr_mz->phys_addr 191 + sizeof(struct virtio_net_ctrl_hdr); 192 vq->vq_ring.desc[i].len = sizeof(ctrl->status); 193 vq->vq_free_cnt--; 194 195 vq->vq_desc_head_idx = vq->vq_ring.desc[i].next; 196 197 vq_update_avail_ring(vq, head); 198 vq_update_avail_idx(vq); 199 200 PMD_INIT_LOG(DEBUG, "vq->vq_queue_index = %d", vq->vq_queue_index); 201 202 virtqueue_notify(vq); 203 204 rte_rmb(); 205 while (vq->vq_used_cons_idx == vq->vq_ring.used->idx) { 206 rte_rmb(); 207 usleep(100); 208 } 209 210 while (vq->vq_used_cons_idx != vq->vq_ring.used->idx) { 211 uint32_t idx, desc_idx, used_idx; 212 struct vring_used_elem *uep; 213 214 used_idx = (uint32_t)(vq->vq_used_cons_idx 215 & (vq->vq_nentries - 1)); 216 uep = &vq->vq_ring.used->ring[used_idx]; 217 idx = (uint32_t) uep->id; 218 desc_idx = idx; 219 220 while (vq->vq_ring.desc[desc_idx].flags & VRING_DESC_F_NEXT) { 221 desc_idx = vq->vq_ring.desc[desc_idx].next; 222 vq->vq_free_cnt++; 223 } 224 225 vq->vq_ring.desc[desc_idx].next = vq->vq_desc_head_idx; 226 vq->vq_desc_head_idx = idx; 227 228 vq->vq_used_cons_idx++; 229 vq->vq_free_cnt++; 230 } 231 232 PMD_INIT_LOG(DEBUG, "vq->vq_free_cnt=%d\nvq->vq_desc_head_idx=%d", 233 vq->vq_free_cnt, vq->vq_desc_head_idx); 234 235 memcpy(&result, vq->virtio_net_hdr_mz->addr, 236 sizeof(struct virtio_pmd_ctrl)); 237 238 return result.status; 239 } 240 241 static int 242 virtio_set_multiple_queues(struct rte_eth_dev *dev, uint16_t nb_queues) 243 { 244 struct virtio_hw *hw = dev->data->dev_private; 245 struct virtio_pmd_ctrl ctrl; 246 int dlen[1]; 247 int ret; 248 249 ctrl.hdr.class = VIRTIO_NET_CTRL_MQ; 250 ctrl.hdr.cmd = VIRTIO_NET_CTRL_MQ_VQ_PAIRS_SET; 251 memcpy(ctrl.data, &nb_queues, sizeof(uint16_t)); 252 253 dlen[0] = sizeof(uint16_t); 254 255 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 256 if (ret) { 257 PMD_INIT_LOG(ERR, "Multiqueue configured but send command " 258 "failed, this is too late now..."); 259 return -EINVAL; 260 } 261 262 return 0; 263 } 264 265 void 266 virtio_dev_queue_release(struct virtqueue *vq) { 267 struct virtio_hw *hw; 268 269 if (vq) { 270 hw = vq->hw; 271 hw->vtpci_ops->del_queue(hw, vq); 272 273 rte_free(vq->sw_ring); 274 rte_free(vq); 275 } 276 } 277 278 int virtio_dev_queue_setup(struct rte_eth_dev *dev, 279 int queue_type, 280 uint16_t queue_idx, 281 uint16_t vtpci_queue_idx, 282 uint16_t nb_desc, 283 unsigned int socket_id, 284 struct virtqueue **pvq) 285 { 286 char vq_name[VIRTQUEUE_MAX_NAME_SZ]; 287 const struct rte_memzone *mz; 288 unsigned int vq_size, size; 289 struct virtio_hw *hw = dev->data->dev_private; 290 struct virtqueue *vq = NULL; 291 292 PMD_INIT_LOG(DEBUG, "setting up queue: %u", vtpci_queue_idx); 293 294 /* 295 * Read the virtqueue size from the Queue Size field 296 * Always power of 2 and if 0 virtqueue does not exist 297 */ 298 vq_size = hw->vtpci_ops->get_queue_num(hw, vtpci_queue_idx); 299 PMD_INIT_LOG(DEBUG, "vq_size: %u nb_desc:%u", vq_size, nb_desc); 300 if (vq_size == 0) { 301 PMD_INIT_LOG(ERR, "%s: virtqueue does not exist", __func__); 302 return -EINVAL; 303 } 304 305 if (!rte_is_power_of_2(vq_size)) { 306 PMD_INIT_LOG(ERR, "%s: virtqueue size is not powerof 2", __func__); 307 return -EINVAL; 308 } 309 310 if (queue_type == VTNET_RQ) { 311 snprintf(vq_name, sizeof(vq_name), "port%d_rvq%d", 312 dev->data->port_id, queue_idx); 313 vq = rte_zmalloc(vq_name, sizeof(struct virtqueue) + 314 vq_size * sizeof(struct vq_desc_extra), RTE_CACHE_LINE_SIZE); 315 vq->sw_ring = rte_zmalloc_socket("rxq->sw_ring", 316 (RTE_PMD_VIRTIO_RX_MAX_BURST + vq_size) * 317 sizeof(vq->sw_ring[0]), RTE_CACHE_LINE_SIZE, socket_id); 318 } else if (queue_type == VTNET_TQ) { 319 snprintf(vq_name, sizeof(vq_name), "port%d_tvq%d", 320 dev->data->port_id, queue_idx); 321 vq = rte_zmalloc(vq_name, sizeof(struct virtqueue) + 322 vq_size * sizeof(struct vq_desc_extra), RTE_CACHE_LINE_SIZE); 323 } else if (queue_type == VTNET_CQ) { 324 snprintf(vq_name, sizeof(vq_name), "port%d_cvq", 325 dev->data->port_id); 326 vq = rte_zmalloc(vq_name, sizeof(struct virtqueue) + 327 vq_size * sizeof(struct vq_desc_extra), 328 RTE_CACHE_LINE_SIZE); 329 } 330 if (vq == NULL) { 331 PMD_INIT_LOG(ERR, "%s: Can not allocate virtqueue", __func__); 332 return -ENOMEM; 333 } 334 if (queue_type == VTNET_RQ && vq->sw_ring == NULL) { 335 PMD_INIT_LOG(ERR, "%s: Can not allocate RX soft ring", 336 __func__); 337 rte_free(vq); 338 return -ENOMEM; 339 } 340 341 vq->hw = hw; 342 vq->port_id = dev->data->port_id; 343 vq->queue_id = queue_idx; 344 vq->vq_queue_index = vtpci_queue_idx; 345 vq->vq_nentries = vq_size; 346 347 if (nb_desc == 0 || nb_desc > vq_size) 348 nb_desc = vq_size; 349 vq->vq_free_cnt = nb_desc; 350 351 /* 352 * Reserve a memzone for vring elements 353 */ 354 size = vring_size(vq_size, VIRTIO_PCI_VRING_ALIGN); 355 vq->vq_ring_size = RTE_ALIGN_CEIL(size, VIRTIO_PCI_VRING_ALIGN); 356 PMD_INIT_LOG(DEBUG, "vring_size: %d, rounded_vring_size: %d", size, vq->vq_ring_size); 357 358 mz = rte_memzone_reserve_aligned(vq_name, vq->vq_ring_size, 359 socket_id, 0, VIRTIO_PCI_VRING_ALIGN); 360 if (mz == NULL) { 361 if (rte_errno == EEXIST) 362 mz = rte_memzone_lookup(vq_name); 363 if (mz == NULL) { 364 rte_free(vq); 365 return -ENOMEM; 366 } 367 } 368 369 /* 370 * Virtio PCI device VIRTIO_PCI_QUEUE_PF register is 32bit, 371 * and only accepts 32 bit page frame number. 372 * Check if the allocated physical memory exceeds 16TB. 373 */ 374 if ((mz->phys_addr + vq->vq_ring_size - 1) >> (VIRTIO_PCI_QUEUE_ADDR_SHIFT + 32)) { 375 PMD_INIT_LOG(ERR, "vring address shouldn't be above 16TB!"); 376 rte_free(vq); 377 return -ENOMEM; 378 } 379 380 memset(mz->addr, 0, sizeof(mz->len)); 381 vq->mz = mz; 382 vq->vq_ring_mem = mz->phys_addr; 383 vq->vq_ring_virt_mem = mz->addr; 384 PMD_INIT_LOG(DEBUG, "vq->vq_ring_mem: 0x%"PRIx64, (uint64_t)mz->phys_addr); 385 PMD_INIT_LOG(DEBUG, "vq->vq_ring_virt_mem: 0x%"PRIx64, (uint64_t)(uintptr_t)mz->addr); 386 vq->virtio_net_hdr_mz = NULL; 387 vq->virtio_net_hdr_mem = 0; 388 389 if (queue_type == VTNET_TQ) { 390 /* 391 * For each xmit packet, allocate a virtio_net_hdr 392 */ 393 snprintf(vq_name, sizeof(vq_name), "port%d_tvq%d_hdrzone", 394 dev->data->port_id, queue_idx); 395 vq->virtio_net_hdr_mz = rte_memzone_reserve_aligned(vq_name, 396 vq_size * hw->vtnet_hdr_size, 397 socket_id, 0, RTE_CACHE_LINE_SIZE); 398 if (vq->virtio_net_hdr_mz == NULL) { 399 if (rte_errno == EEXIST) 400 vq->virtio_net_hdr_mz = 401 rte_memzone_lookup(vq_name); 402 if (vq->virtio_net_hdr_mz == NULL) { 403 rte_free(vq); 404 return -ENOMEM; 405 } 406 } 407 vq->virtio_net_hdr_mem = 408 vq->virtio_net_hdr_mz->phys_addr; 409 memset(vq->virtio_net_hdr_mz->addr, 0, 410 vq_size * hw->vtnet_hdr_size); 411 } else if (queue_type == VTNET_CQ) { 412 /* Allocate a page for control vq command, data and status */ 413 snprintf(vq_name, sizeof(vq_name), "port%d_cvq_hdrzone", 414 dev->data->port_id); 415 vq->virtio_net_hdr_mz = rte_memzone_reserve_aligned(vq_name, 416 PAGE_SIZE, socket_id, 0, RTE_CACHE_LINE_SIZE); 417 if (vq->virtio_net_hdr_mz == NULL) { 418 if (rte_errno == EEXIST) 419 vq->virtio_net_hdr_mz = 420 rte_memzone_lookup(vq_name); 421 if (vq->virtio_net_hdr_mz == NULL) { 422 rte_free(vq); 423 return -ENOMEM; 424 } 425 } 426 vq->virtio_net_hdr_mem = 427 vq->virtio_net_hdr_mz->phys_addr; 428 memset(vq->virtio_net_hdr_mz->addr, 0, PAGE_SIZE); 429 } 430 431 hw->vtpci_ops->setup_queue(hw, vq); 432 433 *pvq = vq; 434 return 0; 435 } 436 437 static int 438 virtio_dev_cq_queue_setup(struct rte_eth_dev *dev, uint16_t vtpci_queue_idx, 439 uint32_t socket_id) 440 { 441 struct virtqueue *vq; 442 int ret; 443 struct virtio_hw *hw = dev->data->dev_private; 444 445 PMD_INIT_FUNC_TRACE(); 446 ret = virtio_dev_queue_setup(dev, VTNET_CQ, VTNET_SQ_CQ_QUEUE_IDX, 447 vtpci_queue_idx, 0, socket_id, &vq); 448 if (ret < 0) { 449 PMD_INIT_LOG(ERR, "control vq initialization failed"); 450 return ret; 451 } 452 453 hw->cvq = vq; 454 return 0; 455 } 456 457 static void 458 virtio_free_queues(struct rte_eth_dev *dev) 459 { 460 unsigned int i; 461 462 for (i = 0; i < dev->data->nb_rx_queues; i++) 463 virtio_dev_rx_queue_release(dev->data->rx_queues[i]); 464 465 dev->data->nb_rx_queues = 0; 466 467 for (i = 0; i < dev->data->nb_tx_queues; i++) 468 virtio_dev_tx_queue_release(dev->data->tx_queues[i]); 469 470 dev->data->nb_tx_queues = 0; 471 } 472 473 static void 474 virtio_dev_close(struct rte_eth_dev *dev) 475 { 476 struct virtio_hw *hw = dev->data->dev_private; 477 struct rte_pci_device *pci_dev = dev->pci_dev; 478 479 PMD_INIT_LOG(DEBUG, "virtio_dev_close"); 480 481 /* reset the NIC */ 482 if (pci_dev->driver->drv_flags & RTE_PCI_DRV_INTR_LSC) 483 vtpci_irq_config(hw, VIRTIO_MSI_NO_VECTOR); 484 vtpci_reset(hw); 485 hw->started = 0; 486 virtio_dev_free_mbufs(dev); 487 virtio_free_queues(dev); 488 } 489 490 static void 491 virtio_dev_promiscuous_enable(struct rte_eth_dev *dev) 492 { 493 struct virtio_hw *hw = dev->data->dev_private; 494 struct virtio_pmd_ctrl ctrl; 495 int dlen[1]; 496 int ret; 497 498 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 499 PMD_INIT_LOG(INFO, "host does not support rx control\n"); 500 return; 501 } 502 503 ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 504 ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC; 505 ctrl.data[0] = 1; 506 dlen[0] = 1; 507 508 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 509 if (ret) 510 PMD_INIT_LOG(ERR, "Failed to enable promisc"); 511 } 512 513 static void 514 virtio_dev_promiscuous_disable(struct rte_eth_dev *dev) 515 { 516 struct virtio_hw *hw = dev->data->dev_private; 517 struct virtio_pmd_ctrl ctrl; 518 int dlen[1]; 519 int ret; 520 521 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 522 PMD_INIT_LOG(INFO, "host does not support rx control\n"); 523 return; 524 } 525 526 ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 527 ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_PROMISC; 528 ctrl.data[0] = 0; 529 dlen[0] = 1; 530 531 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 532 if (ret) 533 PMD_INIT_LOG(ERR, "Failed to disable promisc"); 534 } 535 536 static void 537 virtio_dev_allmulticast_enable(struct rte_eth_dev *dev) 538 { 539 struct virtio_hw *hw = dev->data->dev_private; 540 struct virtio_pmd_ctrl ctrl; 541 int dlen[1]; 542 int ret; 543 544 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 545 PMD_INIT_LOG(INFO, "host does not support rx control\n"); 546 return; 547 } 548 549 ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 550 ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI; 551 ctrl.data[0] = 1; 552 dlen[0] = 1; 553 554 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 555 if (ret) 556 PMD_INIT_LOG(ERR, "Failed to enable allmulticast"); 557 } 558 559 static void 560 virtio_dev_allmulticast_disable(struct rte_eth_dev *dev) 561 { 562 struct virtio_hw *hw = dev->data->dev_private; 563 struct virtio_pmd_ctrl ctrl; 564 int dlen[1]; 565 int ret; 566 567 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_RX)) { 568 PMD_INIT_LOG(INFO, "host does not support rx control\n"); 569 return; 570 } 571 572 ctrl.hdr.class = VIRTIO_NET_CTRL_RX; 573 ctrl.hdr.cmd = VIRTIO_NET_CTRL_RX_ALLMULTI; 574 ctrl.data[0] = 0; 575 dlen[0] = 1; 576 577 ret = virtio_send_command(hw->cvq, &ctrl, dlen, 1); 578 if (ret) 579 PMD_INIT_LOG(ERR, "Failed to disable allmulticast"); 580 } 581 582 /* 583 * dev_ops for virtio, bare necessities for basic operation 584 */ 585 static const struct eth_dev_ops virtio_eth_dev_ops = { 586 .dev_configure = virtio_dev_configure, 587 .dev_start = virtio_dev_start, 588 .dev_stop = virtio_dev_stop, 589 .dev_close = virtio_dev_close, 590 .promiscuous_enable = virtio_dev_promiscuous_enable, 591 .promiscuous_disable = virtio_dev_promiscuous_disable, 592 .allmulticast_enable = virtio_dev_allmulticast_enable, 593 .allmulticast_disable = virtio_dev_allmulticast_disable, 594 595 .dev_infos_get = virtio_dev_info_get, 596 .stats_get = virtio_dev_stats_get, 597 .xstats_get = virtio_dev_xstats_get, 598 .stats_reset = virtio_dev_stats_reset, 599 .xstats_reset = virtio_dev_stats_reset, 600 .link_update = virtio_dev_link_update, 601 .rx_queue_setup = virtio_dev_rx_queue_setup, 602 .rx_queue_release = virtio_dev_rx_queue_release, 603 .tx_queue_setup = virtio_dev_tx_queue_setup, 604 .tx_queue_release = virtio_dev_tx_queue_release, 605 /* collect stats per queue */ 606 .queue_stats_mapping_set = virtio_dev_queue_stats_mapping_set, 607 .vlan_filter_set = virtio_vlan_filter_set, 608 .mac_addr_add = virtio_mac_addr_add, 609 .mac_addr_remove = virtio_mac_addr_remove, 610 .mac_addr_set = virtio_mac_addr_set, 611 }; 612 613 static inline int 614 virtio_dev_atomic_read_link_status(struct rte_eth_dev *dev, 615 struct rte_eth_link *link) 616 { 617 struct rte_eth_link *dst = link; 618 struct rte_eth_link *src = &(dev->data->dev_link); 619 620 if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst, 621 *(uint64_t *)src) == 0) 622 return -1; 623 624 return 0; 625 } 626 627 /** 628 * Atomically writes the link status information into global 629 * structure rte_eth_dev. 630 * 631 * @param dev 632 * - Pointer to the structure rte_eth_dev to read from. 633 * - Pointer to the buffer to be saved with the link status. 634 * 635 * @return 636 * - On success, zero. 637 * - On failure, negative value. 638 */ 639 static inline int 640 virtio_dev_atomic_write_link_status(struct rte_eth_dev *dev, 641 struct rte_eth_link *link) 642 { 643 struct rte_eth_link *dst = &(dev->data->dev_link); 644 struct rte_eth_link *src = link; 645 646 if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst, 647 *(uint64_t *)src) == 0) 648 return -1; 649 650 return 0; 651 } 652 653 static void 654 virtio_update_stats(struct rte_eth_dev *dev, struct rte_eth_stats *stats) 655 { 656 unsigned i; 657 658 for (i = 0; i < dev->data->nb_tx_queues; i++) { 659 const struct virtqueue *txvq = dev->data->tx_queues[i]; 660 if (txvq == NULL) 661 continue; 662 663 stats->opackets += txvq->packets; 664 stats->obytes += txvq->bytes; 665 stats->oerrors += txvq->errors; 666 667 if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) { 668 stats->q_opackets[i] = txvq->packets; 669 stats->q_obytes[i] = txvq->bytes; 670 } 671 } 672 673 for (i = 0; i < dev->data->nb_rx_queues; i++) { 674 const struct virtqueue *rxvq = dev->data->rx_queues[i]; 675 if (rxvq == NULL) 676 continue; 677 678 stats->ipackets += rxvq->packets; 679 stats->ibytes += rxvq->bytes; 680 stats->ierrors += rxvq->errors; 681 682 if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) { 683 stats->q_ipackets[i] = rxvq->packets; 684 stats->q_ibytes[i] = rxvq->bytes; 685 } 686 } 687 688 stats->rx_nombuf = dev->data->rx_mbuf_alloc_failed; 689 } 690 691 static int 692 virtio_dev_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstats *xstats, 693 unsigned n) 694 { 695 unsigned i; 696 unsigned count = 0; 697 698 unsigned nstats = dev->data->nb_tx_queues * VIRTIO_NB_Q_XSTATS + 699 dev->data->nb_rx_queues * VIRTIO_NB_Q_XSTATS; 700 701 if (n < nstats) 702 return nstats; 703 704 for (i = 0; i < dev->data->nb_rx_queues; i++) { 705 struct virtqueue *rxvq = dev->data->rx_queues[i]; 706 707 if (rxvq == NULL) 708 continue; 709 710 unsigned t; 711 712 for (t = 0; t < VIRTIO_NB_Q_XSTATS; t++) { 713 snprintf(xstats[count].name, sizeof(xstats[count].name), 714 "rx_q%u_%s", i, 715 rte_virtio_q_stat_strings[t].name); 716 xstats[count].value = *(uint64_t *)(((char *)rxvq) + 717 rte_virtio_q_stat_strings[t].offset); 718 count++; 719 } 720 } 721 722 for (i = 0; i < dev->data->nb_tx_queues; i++) { 723 struct virtqueue *txvq = dev->data->tx_queues[i]; 724 725 if (txvq == NULL) 726 continue; 727 728 unsigned t; 729 730 for (t = 0; t < VIRTIO_NB_Q_XSTATS; t++) { 731 snprintf(xstats[count].name, sizeof(xstats[count].name), 732 "tx_q%u_%s", i, 733 rte_virtio_q_stat_strings[t].name); 734 xstats[count].value = *(uint64_t *)(((char *)txvq) + 735 rte_virtio_q_stat_strings[t].offset); 736 count++; 737 } 738 } 739 740 return count; 741 } 742 743 static void 744 virtio_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats) 745 { 746 virtio_update_stats(dev, stats); 747 } 748 749 static void 750 virtio_dev_stats_reset(struct rte_eth_dev *dev) 751 { 752 unsigned int i; 753 754 for (i = 0; i < dev->data->nb_tx_queues; i++) { 755 struct virtqueue *txvq = dev->data->tx_queues[i]; 756 if (txvq == NULL) 757 continue; 758 759 txvq->packets = 0; 760 txvq->bytes = 0; 761 txvq->errors = 0; 762 txvq->multicast = 0; 763 txvq->broadcast = 0; 764 memset(txvq->size_bins, 0, sizeof(txvq->size_bins[0]) * 8); 765 } 766 767 for (i = 0; i < dev->data->nb_rx_queues; i++) { 768 struct virtqueue *rxvq = dev->data->rx_queues[i]; 769 if (rxvq == NULL) 770 continue; 771 772 rxvq->packets = 0; 773 rxvq->bytes = 0; 774 rxvq->errors = 0; 775 rxvq->multicast = 0; 776 rxvq->broadcast = 0; 777 memset(rxvq->size_bins, 0, sizeof(rxvq->size_bins[0]) * 8); 778 } 779 } 780 781 static void 782 virtio_set_hwaddr(struct virtio_hw *hw) 783 { 784 vtpci_write_dev_config(hw, 785 offsetof(struct virtio_net_config, mac), 786 &hw->mac_addr, ETHER_ADDR_LEN); 787 } 788 789 static void 790 virtio_get_hwaddr(struct virtio_hw *hw) 791 { 792 if (vtpci_with_feature(hw, VIRTIO_NET_F_MAC)) { 793 vtpci_read_dev_config(hw, 794 offsetof(struct virtio_net_config, mac), 795 &hw->mac_addr, ETHER_ADDR_LEN); 796 } else { 797 eth_random_addr(&hw->mac_addr[0]); 798 virtio_set_hwaddr(hw); 799 } 800 } 801 802 static void 803 virtio_mac_table_set(struct virtio_hw *hw, 804 const struct virtio_net_ctrl_mac *uc, 805 const struct virtio_net_ctrl_mac *mc) 806 { 807 struct virtio_pmd_ctrl ctrl; 808 int err, len[2]; 809 810 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) { 811 PMD_DRV_LOG(INFO, "host does not support mac table\n"); 812 return; 813 } 814 815 ctrl.hdr.class = VIRTIO_NET_CTRL_MAC; 816 ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_TABLE_SET; 817 818 len[0] = uc->entries * ETHER_ADDR_LEN + sizeof(uc->entries); 819 memcpy(ctrl.data, uc, len[0]); 820 821 len[1] = mc->entries * ETHER_ADDR_LEN + sizeof(mc->entries); 822 memcpy(ctrl.data + len[0], mc, len[1]); 823 824 err = virtio_send_command(hw->cvq, &ctrl, len, 2); 825 if (err != 0) 826 PMD_DRV_LOG(NOTICE, "mac table set failed: %d", err); 827 } 828 829 static void 830 virtio_mac_addr_add(struct rte_eth_dev *dev, struct ether_addr *mac_addr, 831 uint32_t index, uint32_t vmdq __rte_unused) 832 { 833 struct virtio_hw *hw = dev->data->dev_private; 834 const struct ether_addr *addrs = dev->data->mac_addrs; 835 unsigned int i; 836 struct virtio_net_ctrl_mac *uc, *mc; 837 838 if (index >= VIRTIO_MAX_MAC_ADDRS) { 839 PMD_DRV_LOG(ERR, "mac address index %u out of range", index); 840 return; 841 } 842 843 uc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(uc->entries)); 844 uc->entries = 0; 845 mc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(mc->entries)); 846 mc->entries = 0; 847 848 for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) { 849 const struct ether_addr *addr 850 = (i == index) ? mac_addr : addrs + i; 851 struct virtio_net_ctrl_mac *tbl 852 = is_multicast_ether_addr(addr) ? mc : uc; 853 854 memcpy(&tbl->macs[tbl->entries++], addr, ETHER_ADDR_LEN); 855 } 856 857 virtio_mac_table_set(hw, uc, mc); 858 } 859 860 static void 861 virtio_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index) 862 { 863 struct virtio_hw *hw = dev->data->dev_private; 864 struct ether_addr *addrs = dev->data->mac_addrs; 865 struct virtio_net_ctrl_mac *uc, *mc; 866 unsigned int i; 867 868 if (index >= VIRTIO_MAX_MAC_ADDRS) { 869 PMD_DRV_LOG(ERR, "mac address index %u out of range", index); 870 return; 871 } 872 873 uc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(uc->entries)); 874 uc->entries = 0; 875 mc = alloca(VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN + sizeof(mc->entries)); 876 mc->entries = 0; 877 878 for (i = 0; i < VIRTIO_MAX_MAC_ADDRS; i++) { 879 struct virtio_net_ctrl_mac *tbl; 880 881 if (i == index || is_zero_ether_addr(addrs + i)) 882 continue; 883 884 tbl = is_multicast_ether_addr(addrs + i) ? mc : uc; 885 memcpy(&tbl->macs[tbl->entries++], addrs + i, ETHER_ADDR_LEN); 886 } 887 888 virtio_mac_table_set(hw, uc, mc); 889 } 890 891 static void 892 virtio_mac_addr_set(struct rte_eth_dev *dev, struct ether_addr *mac_addr) 893 { 894 struct virtio_hw *hw = dev->data->dev_private; 895 896 memcpy(hw->mac_addr, mac_addr, ETHER_ADDR_LEN); 897 898 /* Use atomic update if available */ 899 if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_MAC_ADDR)) { 900 struct virtio_pmd_ctrl ctrl; 901 int len = ETHER_ADDR_LEN; 902 903 ctrl.hdr.class = VIRTIO_NET_CTRL_MAC; 904 ctrl.hdr.cmd = VIRTIO_NET_CTRL_MAC_ADDR_SET; 905 906 memcpy(ctrl.data, mac_addr, ETHER_ADDR_LEN); 907 virtio_send_command(hw->cvq, &ctrl, &len, 1); 908 } else if (vtpci_with_feature(hw, VIRTIO_NET_F_MAC)) 909 virtio_set_hwaddr(hw); 910 } 911 912 static int 913 virtio_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on) 914 { 915 struct virtio_hw *hw = dev->data->dev_private; 916 struct virtio_pmd_ctrl ctrl; 917 int len; 918 919 if (!vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) 920 return -ENOTSUP; 921 922 ctrl.hdr.class = VIRTIO_NET_CTRL_VLAN; 923 ctrl.hdr.cmd = on ? VIRTIO_NET_CTRL_VLAN_ADD : VIRTIO_NET_CTRL_VLAN_DEL; 924 memcpy(ctrl.data, &vlan_id, sizeof(vlan_id)); 925 len = sizeof(vlan_id); 926 927 return virtio_send_command(hw->cvq, &ctrl, &len, 1); 928 } 929 930 static int 931 virtio_negotiate_features(struct virtio_hw *hw) 932 { 933 uint64_t host_features; 934 935 /* Prepare guest_features: feature that driver wants to support */ 936 hw->guest_features = VIRTIO_PMD_GUEST_FEATURES; 937 PMD_INIT_LOG(DEBUG, "guest_features before negotiate = %" PRIx64, 938 hw->guest_features); 939 940 /* Read device(host) feature bits */ 941 host_features = hw->vtpci_ops->get_features(hw); 942 PMD_INIT_LOG(DEBUG, "host_features before negotiate = %" PRIx64, 943 host_features); 944 945 /* 946 * Negotiate features: Subset of device feature bits are written back 947 * guest feature bits. 948 */ 949 hw->guest_features = vtpci_negotiate_features(hw, host_features); 950 PMD_INIT_LOG(DEBUG, "features after negotiate = %" PRIx64, 951 hw->guest_features); 952 953 if (hw->modern) { 954 if (!vtpci_with_feature(hw, VIRTIO_F_VERSION_1)) { 955 PMD_INIT_LOG(ERR, 956 "VIRTIO_F_VERSION_1 features is not enabled."); 957 return -1; 958 } 959 vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_FEATURES_OK); 960 if (!(vtpci_get_status(hw) & VIRTIO_CONFIG_STATUS_FEATURES_OK)) { 961 PMD_INIT_LOG(ERR, 962 "failed to set FEATURES_OK status!"); 963 return -1; 964 } 965 } 966 967 return 0; 968 } 969 970 /* 971 * Process Virtio Config changed interrupt and call the callback 972 * if link state changed. 973 */ 974 static void 975 virtio_interrupt_handler(__rte_unused struct rte_intr_handle *handle, 976 void *param) 977 { 978 struct rte_eth_dev *dev = param; 979 struct virtio_hw *hw = dev->data->dev_private; 980 uint8_t isr; 981 982 /* Read interrupt status which clears interrupt */ 983 isr = vtpci_isr(hw); 984 PMD_DRV_LOG(INFO, "interrupt status = %#x", isr); 985 986 if (rte_intr_enable(&dev->pci_dev->intr_handle) < 0) 987 PMD_DRV_LOG(ERR, "interrupt enable failed"); 988 989 if (isr & VIRTIO_PCI_ISR_CONFIG) { 990 if (virtio_dev_link_update(dev, 0) == 0) 991 _rte_eth_dev_callback_process(dev, 992 RTE_ETH_EVENT_INTR_LSC); 993 } 994 995 } 996 997 static void 998 rx_func_get(struct rte_eth_dev *eth_dev) 999 { 1000 struct virtio_hw *hw = eth_dev->data->dev_private; 1001 if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF)) 1002 eth_dev->rx_pkt_burst = &virtio_recv_mergeable_pkts; 1003 else 1004 eth_dev->rx_pkt_burst = &virtio_recv_pkts; 1005 } 1006 1007 /* 1008 * This function is based on probe() function in virtio_pci.c 1009 * It returns 0 on success. 1010 */ 1011 static int 1012 eth_virtio_dev_init(struct rte_eth_dev *eth_dev) 1013 { 1014 struct virtio_hw *hw = eth_dev->data->dev_private; 1015 struct virtio_net_config *config; 1016 struct virtio_net_config local_config; 1017 struct rte_pci_device *pci_dev; 1018 int ret; 1019 1020 RTE_BUILD_BUG_ON(RTE_PKTMBUF_HEADROOM < sizeof(struct virtio_net_hdr)); 1021 1022 eth_dev->dev_ops = &virtio_eth_dev_ops; 1023 eth_dev->tx_pkt_burst = &virtio_xmit_pkts; 1024 1025 if (rte_eal_process_type() == RTE_PROC_SECONDARY) { 1026 rx_func_get(eth_dev); 1027 return 0; 1028 } 1029 1030 /* Allocate memory for storing MAC addresses */ 1031 eth_dev->data->mac_addrs = rte_zmalloc("virtio", VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN, 0); 1032 if (eth_dev->data->mac_addrs == NULL) { 1033 PMD_INIT_LOG(ERR, 1034 "Failed to allocate %d bytes needed to store MAC addresses", 1035 VIRTIO_MAX_MAC_ADDRS * ETHER_ADDR_LEN); 1036 return -ENOMEM; 1037 } 1038 1039 pci_dev = eth_dev->pci_dev; 1040 1041 ret = vtpci_init(pci_dev, hw); 1042 if (ret) 1043 return ret; 1044 1045 /* Reset the device although not necessary at startup */ 1046 vtpci_reset(hw); 1047 1048 /* Tell the host we've noticed this device. */ 1049 vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_ACK); 1050 1051 /* Tell the host we've known how to drive the device. */ 1052 vtpci_set_status(hw, VIRTIO_CONFIG_STATUS_DRIVER); 1053 if (virtio_negotiate_features(hw) < 0) 1054 return -1; 1055 1056 /* If host does not support status then disable LSC */ 1057 if (!vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) 1058 pci_dev->driver->drv_flags &= ~RTE_PCI_DRV_INTR_LSC; 1059 1060 rte_eth_copy_pci_info(eth_dev, pci_dev); 1061 1062 rx_func_get(eth_dev); 1063 1064 /* Setting up rx_header size for the device */ 1065 if (vtpci_with_feature(hw, VIRTIO_NET_F_MRG_RXBUF) || 1066 vtpci_with_feature(hw, VIRTIO_F_VERSION_1)) 1067 hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr_mrg_rxbuf); 1068 else 1069 hw->vtnet_hdr_size = sizeof(struct virtio_net_hdr); 1070 1071 /* Copy the permanent MAC address to: virtio_hw */ 1072 virtio_get_hwaddr(hw); 1073 ether_addr_copy((struct ether_addr *) hw->mac_addr, 1074 ð_dev->data->mac_addrs[0]); 1075 PMD_INIT_LOG(DEBUG, 1076 "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X", 1077 hw->mac_addr[0], hw->mac_addr[1], hw->mac_addr[2], 1078 hw->mac_addr[3], hw->mac_addr[4], hw->mac_addr[5]); 1079 1080 if (vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VQ)) { 1081 config = &local_config; 1082 1083 vtpci_read_dev_config(hw, 1084 offsetof(struct virtio_net_config, mac), 1085 &config->mac, sizeof(config->mac)); 1086 1087 if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) { 1088 vtpci_read_dev_config(hw, 1089 offsetof(struct virtio_net_config, status), 1090 &config->status, sizeof(config->status)); 1091 } else { 1092 PMD_INIT_LOG(DEBUG, 1093 "VIRTIO_NET_F_STATUS is not supported"); 1094 config->status = 0; 1095 } 1096 1097 if (vtpci_with_feature(hw, VIRTIO_NET_F_MQ)) { 1098 vtpci_read_dev_config(hw, 1099 offsetof(struct virtio_net_config, max_virtqueue_pairs), 1100 &config->max_virtqueue_pairs, 1101 sizeof(config->max_virtqueue_pairs)); 1102 } else { 1103 PMD_INIT_LOG(DEBUG, 1104 "VIRTIO_NET_F_MQ is not supported"); 1105 config->max_virtqueue_pairs = 1; 1106 } 1107 1108 hw->max_rx_queues = 1109 (VIRTIO_MAX_RX_QUEUES < config->max_virtqueue_pairs) ? 1110 VIRTIO_MAX_RX_QUEUES : config->max_virtqueue_pairs; 1111 hw->max_tx_queues = 1112 (VIRTIO_MAX_TX_QUEUES < config->max_virtqueue_pairs) ? 1113 VIRTIO_MAX_TX_QUEUES : config->max_virtqueue_pairs; 1114 1115 virtio_dev_cq_queue_setup(eth_dev, 1116 config->max_virtqueue_pairs * 2, 1117 SOCKET_ID_ANY); 1118 1119 PMD_INIT_LOG(DEBUG, "config->max_virtqueue_pairs=%d", 1120 config->max_virtqueue_pairs); 1121 PMD_INIT_LOG(DEBUG, "config->status=%d", config->status); 1122 PMD_INIT_LOG(DEBUG, 1123 "PORT MAC: %02X:%02X:%02X:%02X:%02X:%02X", 1124 config->mac[0], config->mac[1], 1125 config->mac[2], config->mac[3], 1126 config->mac[4], config->mac[5]); 1127 } else { 1128 hw->max_rx_queues = 1; 1129 hw->max_tx_queues = 1; 1130 } 1131 1132 eth_dev->data->nb_rx_queues = hw->max_rx_queues; 1133 eth_dev->data->nb_tx_queues = hw->max_tx_queues; 1134 1135 PMD_INIT_LOG(DEBUG, "hw->max_rx_queues=%d hw->max_tx_queues=%d", 1136 hw->max_rx_queues, hw->max_tx_queues); 1137 PMD_INIT_LOG(DEBUG, "port %d vendorID=0x%x deviceID=0x%x", 1138 eth_dev->data->port_id, pci_dev->id.vendor_id, 1139 pci_dev->id.device_id); 1140 1141 /* Setup interrupt callback */ 1142 if (pci_dev->driver->drv_flags & RTE_PCI_DRV_INTR_LSC) 1143 rte_intr_callback_register(&pci_dev->intr_handle, 1144 virtio_interrupt_handler, eth_dev); 1145 1146 virtio_dev_cq_start(eth_dev); 1147 1148 return 0; 1149 } 1150 1151 static int 1152 eth_virtio_dev_uninit(struct rte_eth_dev *eth_dev) 1153 { 1154 struct rte_pci_device *pci_dev; 1155 struct virtio_hw *hw = eth_dev->data->dev_private; 1156 1157 PMD_INIT_FUNC_TRACE(); 1158 1159 if (rte_eal_process_type() == RTE_PROC_SECONDARY) 1160 return -EPERM; 1161 1162 if (hw->started == 1) { 1163 virtio_dev_stop(eth_dev); 1164 virtio_dev_close(eth_dev); 1165 } 1166 pci_dev = eth_dev->pci_dev; 1167 1168 eth_dev->dev_ops = NULL; 1169 eth_dev->tx_pkt_burst = NULL; 1170 eth_dev->rx_pkt_burst = NULL; 1171 1172 virtio_dev_queue_release(hw->cvq); 1173 1174 rte_free(eth_dev->data->mac_addrs); 1175 eth_dev->data->mac_addrs = NULL; 1176 1177 /* reset interrupt callback */ 1178 if (pci_dev->driver->drv_flags & RTE_PCI_DRV_INTR_LSC) 1179 rte_intr_callback_unregister(&pci_dev->intr_handle, 1180 virtio_interrupt_handler, 1181 eth_dev); 1182 rte_eal_pci_unmap_device(pci_dev); 1183 1184 PMD_INIT_LOG(DEBUG, "dev_uninit completed"); 1185 1186 return 0; 1187 } 1188 1189 static struct eth_driver rte_virtio_pmd = { 1190 .pci_drv = { 1191 .name = "rte_virtio_pmd", 1192 .id_table = pci_id_virtio_map, 1193 .drv_flags = RTE_PCI_DRV_DETACHABLE, 1194 }, 1195 .eth_dev_init = eth_virtio_dev_init, 1196 .eth_dev_uninit = eth_virtio_dev_uninit, 1197 .dev_private_size = sizeof(struct virtio_hw), 1198 }; 1199 1200 /* 1201 * Driver initialization routine. 1202 * Invoked once at EAL init time. 1203 * Register itself as the [Poll Mode] Driver of PCI virtio devices. 1204 * Returns 0 on success. 1205 */ 1206 static int 1207 rte_virtio_pmd_init(const char *name __rte_unused, 1208 const char *param __rte_unused) 1209 { 1210 if (rte_eal_iopl_init() != 0) { 1211 PMD_INIT_LOG(ERR, "IOPL call failed - cannot use virtio PMD"); 1212 return -1; 1213 } 1214 1215 rte_eth_driver_register(&rte_virtio_pmd); 1216 return 0; 1217 } 1218 1219 /* 1220 * Configure virtio device 1221 * It returns 0 on success. 1222 */ 1223 static int 1224 virtio_dev_configure(struct rte_eth_dev *dev) 1225 { 1226 const struct rte_eth_rxmode *rxmode = &dev->data->dev_conf.rxmode; 1227 struct virtio_hw *hw = dev->data->dev_private; 1228 struct rte_pci_device *pci_dev = dev->pci_dev; 1229 1230 PMD_INIT_LOG(DEBUG, "configure"); 1231 1232 if (rxmode->hw_ip_checksum) { 1233 PMD_DRV_LOG(ERR, "HW IP checksum not supported"); 1234 return -EINVAL; 1235 } 1236 1237 hw->vlan_strip = rxmode->hw_vlan_strip; 1238 1239 if (rxmode->hw_vlan_filter 1240 && !vtpci_with_feature(hw, VIRTIO_NET_F_CTRL_VLAN)) { 1241 PMD_DRV_LOG(NOTICE, 1242 "vlan filtering not available on this host"); 1243 return -ENOTSUP; 1244 } 1245 1246 if (pci_dev->driver->drv_flags & RTE_PCI_DRV_INTR_LSC) 1247 if (vtpci_irq_config(hw, 0) == VIRTIO_MSI_NO_VECTOR) { 1248 PMD_DRV_LOG(ERR, "failed to set config vector"); 1249 return -EBUSY; 1250 } 1251 1252 return 0; 1253 } 1254 1255 1256 static int 1257 virtio_dev_start(struct rte_eth_dev *dev) 1258 { 1259 uint16_t nb_queues, i; 1260 struct virtio_hw *hw = dev->data->dev_private; 1261 struct rte_pci_device *pci_dev = dev->pci_dev; 1262 1263 /* check if lsc interrupt feature is enabled */ 1264 if (dev->data->dev_conf.intr_conf.lsc) { 1265 if (!(pci_dev->driver->drv_flags & RTE_PCI_DRV_INTR_LSC)) { 1266 PMD_DRV_LOG(ERR, "link status not supported by host"); 1267 return -ENOTSUP; 1268 } 1269 1270 if (rte_intr_enable(&dev->pci_dev->intr_handle) < 0) { 1271 PMD_DRV_LOG(ERR, "interrupt enable failed"); 1272 return -EIO; 1273 } 1274 } 1275 1276 /* Initialize Link state */ 1277 virtio_dev_link_update(dev, 0); 1278 1279 /* On restart after stop do not touch queues */ 1280 if (hw->started) 1281 return 0; 1282 1283 /* Do final configuration before rx/tx engine starts */ 1284 virtio_dev_rxtx_start(dev); 1285 vtpci_reinit_complete(hw); 1286 1287 hw->started = 1; 1288 1289 /*Notify the backend 1290 *Otherwise the tap backend might already stop its queue due to fullness. 1291 *vhost backend will have no chance to be waked up 1292 */ 1293 nb_queues = dev->data->nb_rx_queues; 1294 if (nb_queues > 1) { 1295 if (virtio_set_multiple_queues(dev, nb_queues) != 0) 1296 return -EINVAL; 1297 } 1298 1299 PMD_INIT_LOG(DEBUG, "nb_queues=%d", nb_queues); 1300 1301 for (i = 0; i < nb_queues; i++) 1302 virtqueue_notify(dev->data->rx_queues[i]); 1303 1304 PMD_INIT_LOG(DEBUG, "Notified backend at initialization"); 1305 1306 for (i = 0; i < dev->data->nb_rx_queues; i++) 1307 VIRTQUEUE_DUMP((struct virtqueue *)dev->data->rx_queues[i]); 1308 1309 for (i = 0; i < dev->data->nb_tx_queues; i++) 1310 VIRTQUEUE_DUMP((struct virtqueue *)dev->data->tx_queues[i]); 1311 1312 return 0; 1313 } 1314 1315 static void virtio_dev_free_mbufs(struct rte_eth_dev *dev) 1316 { 1317 struct rte_mbuf *buf; 1318 int i, mbuf_num = 0; 1319 1320 for (i = 0; i < dev->data->nb_rx_queues; i++) { 1321 PMD_INIT_LOG(DEBUG, 1322 "Before freeing rxq[%d] used and unused buf", i); 1323 VIRTQUEUE_DUMP((struct virtqueue *)dev->data->rx_queues[i]); 1324 1325 PMD_INIT_LOG(DEBUG, "rx_queues[%d]=%p", 1326 i, dev->data->rx_queues[i]); 1327 while ((buf = (struct rte_mbuf *)virtqueue_detatch_unused( 1328 dev->data->rx_queues[i])) != NULL) { 1329 rte_pktmbuf_free(buf); 1330 mbuf_num++; 1331 } 1332 1333 PMD_INIT_LOG(DEBUG, "free %d mbufs", mbuf_num); 1334 PMD_INIT_LOG(DEBUG, 1335 "After freeing rxq[%d] used and unused buf", i); 1336 VIRTQUEUE_DUMP((struct virtqueue *)dev->data->rx_queues[i]); 1337 } 1338 1339 for (i = 0; i < dev->data->nb_tx_queues; i++) { 1340 PMD_INIT_LOG(DEBUG, 1341 "Before freeing txq[%d] used and unused bufs", 1342 i); 1343 VIRTQUEUE_DUMP((struct virtqueue *)dev->data->tx_queues[i]); 1344 1345 mbuf_num = 0; 1346 while ((buf = (struct rte_mbuf *)virtqueue_detatch_unused( 1347 dev->data->tx_queues[i])) != NULL) { 1348 rte_pktmbuf_free(buf); 1349 1350 mbuf_num++; 1351 } 1352 1353 PMD_INIT_LOG(DEBUG, "free %d mbufs", mbuf_num); 1354 PMD_INIT_LOG(DEBUG, 1355 "After freeing txq[%d] used and unused buf", i); 1356 VIRTQUEUE_DUMP((struct virtqueue *)dev->data->tx_queues[i]); 1357 } 1358 } 1359 1360 /* 1361 * Stop device: disable interrupt and mark link down 1362 */ 1363 static void 1364 virtio_dev_stop(struct rte_eth_dev *dev) 1365 { 1366 struct rte_eth_link link; 1367 1368 PMD_INIT_LOG(DEBUG, "stop"); 1369 1370 if (dev->data->dev_conf.intr_conf.lsc) 1371 rte_intr_disable(&dev->pci_dev->intr_handle); 1372 1373 memset(&link, 0, sizeof(link)); 1374 virtio_dev_atomic_write_link_status(dev, &link); 1375 } 1376 1377 static int 1378 virtio_dev_link_update(struct rte_eth_dev *dev, __rte_unused int wait_to_complete) 1379 { 1380 struct rte_eth_link link, old; 1381 uint16_t status; 1382 struct virtio_hw *hw = dev->data->dev_private; 1383 memset(&link, 0, sizeof(link)); 1384 virtio_dev_atomic_read_link_status(dev, &link); 1385 old = link; 1386 link.link_duplex = FULL_DUPLEX; 1387 link.link_speed = SPEED_10G; 1388 1389 if (vtpci_with_feature(hw, VIRTIO_NET_F_STATUS)) { 1390 PMD_INIT_LOG(DEBUG, "Get link status from hw"); 1391 vtpci_read_dev_config(hw, 1392 offsetof(struct virtio_net_config, status), 1393 &status, sizeof(status)); 1394 if ((status & VIRTIO_NET_S_LINK_UP) == 0) { 1395 link.link_status = 0; 1396 PMD_INIT_LOG(DEBUG, "Port %d is down", 1397 dev->data->port_id); 1398 } else { 1399 link.link_status = 1; 1400 PMD_INIT_LOG(DEBUG, "Port %d is up", 1401 dev->data->port_id); 1402 } 1403 } else { 1404 link.link_status = 1; /* Link up */ 1405 } 1406 virtio_dev_atomic_write_link_status(dev, &link); 1407 1408 return (old.link_status == link.link_status) ? -1 : 0; 1409 } 1410 1411 static void 1412 virtio_dev_info_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info) 1413 { 1414 struct virtio_hw *hw = dev->data->dev_private; 1415 1416 dev_info->driver_name = dev->driver->pci_drv.name; 1417 dev_info->max_rx_queues = (uint16_t)hw->max_rx_queues; 1418 dev_info->max_tx_queues = (uint16_t)hw->max_tx_queues; 1419 dev_info->min_rx_bufsize = VIRTIO_MIN_RX_BUFSIZE; 1420 dev_info->max_rx_pktlen = VIRTIO_MAX_RX_PKTLEN; 1421 dev_info->max_mac_addrs = VIRTIO_MAX_MAC_ADDRS; 1422 dev_info->default_txconf = (struct rte_eth_txconf) { 1423 .txq_flags = ETH_TXQ_FLAGS_NOOFFLOADS 1424 }; 1425 } 1426 1427 /* 1428 * It enables testpmd to collect per queue stats. 1429 */ 1430 static int 1431 virtio_dev_queue_stats_mapping_set(__rte_unused struct rte_eth_dev *eth_dev, 1432 __rte_unused uint16_t queue_id, __rte_unused uint8_t stat_idx, 1433 __rte_unused uint8_t is_rx) 1434 { 1435 return 0; 1436 } 1437 1438 static struct rte_driver rte_virtio_driver = { 1439 .type = PMD_PDEV, 1440 .init = rte_virtio_pmd_init, 1441 }; 1442 1443 PMD_REGISTER_DRIVER(rte_virtio_driver); 1444