drivers/net/vhost/rte_eth_vhost.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2016 IGEL Co., Ltd.
   3  * Copyright(c) 2016-2018 Intel Corporation
   4  */
   5 #include <unistd.h>
   6 #include <pthread.h>
   7 #include <stdbool.h>
   8
   9 #include <rte_mbuf.h>
  10 #include <rte_ethdev_driver.h>
  11 #include <rte_ethdev_vdev.h>
  12 #include <rte_malloc.h>
  13 #include <rte_memcpy.h>
  14 #include <rte_bus_vdev.h>
  15 #include <rte_kvargs.h>
  16 #include <rte_vhost.h>
  17 #include <rte_spinlock.h>
  18
  19 #include "rte_eth_vhost.h"
  20
  21 static int vhost_logtype;
  22
  23 #define VHOST_LOG(level, ...) \
  24         rte_log(RTE_LOG_ ## level, vhost_logtype, __VA_ARGS__)
  25
  26 enum {VIRTIO_RXQ, VIRTIO_TXQ, VIRTIO_QNUM};
  27
  28 #define ETH_VHOST_IFACE_ARG             "iface"
  29 #define ETH_VHOST_QUEUES_ARG            "queues"
  30 #define ETH_VHOST_CLIENT_ARG            "client"
  31 #define ETH_VHOST_DEQUEUE_ZERO_COPY     "dequeue-zero-copy"
  32 #define ETH_VHOST_IOMMU_SUPPORT         "iommu-support"
  33 #define ETH_VHOST_POSTCOPY_SUPPORT      "postcopy-support"
  34 #define ETH_VHOST_VIRTIO_NET_F_HOST_TSO "tso"
  35 #define ETH_VHOST_LINEAR_BUF  "linear-buffer"
  36 #define ETH_VHOST_EXT_BUF  "ext-buffer"
  37 #define VHOST_MAX_PKT_BURST 32
  38
  39 static const char *valid_arguments[] = {
  40         ETH_VHOST_IFACE_ARG,
  41         ETH_VHOST_QUEUES_ARG,
  42         ETH_VHOST_CLIENT_ARG,
  43         ETH_VHOST_DEQUEUE_ZERO_COPY,
  44         ETH_VHOST_IOMMU_SUPPORT,
  45         ETH_VHOST_POSTCOPY_SUPPORT,
  46         ETH_VHOST_VIRTIO_NET_F_HOST_TSO,
  47         ETH_VHOST_LINEAR_BUF,
  48         ETH_VHOST_EXT_BUF,
  49         NULL
  50 };
  51
  52 static struct rte_ether_addr base_eth_addr = {
  53         .addr_bytes = {
  54                 0x56 /* V */,
  55                 0x48 /* H */,
  56                 0x4F /* O */,
  57                 0x53 /* S */,
  58                 0x54 /* T */,
  59                 0x00
  60         }
  61 };
  62
  63 enum vhost_xstats_pkts {
  64         VHOST_UNDERSIZE_PKT = 0,
  65         VHOST_64_PKT,
  66         VHOST_65_TO_127_PKT,
  67         VHOST_128_TO_255_PKT,
  68         VHOST_256_TO_511_PKT,
  69         VHOST_512_TO_1023_PKT,
  70         VHOST_1024_TO_1522_PKT,
  71         VHOST_1523_TO_MAX_PKT,
  72         VHOST_BROADCAST_PKT,
  73         VHOST_MULTICAST_PKT,
  74         VHOST_UNICAST_PKT,
  75         VHOST_ERRORS_PKT,
  76         VHOST_ERRORS_FRAGMENTED,
  77         VHOST_ERRORS_JABBER,
  78         VHOST_UNKNOWN_PROTOCOL,
  79         VHOST_XSTATS_MAX,
  80 };
  81
  82 struct vhost_stats {
  83         uint64_t pkts;
  84         uint64_t bytes;
  85         uint64_t missed_pkts;
  86         uint64_t xstats[VHOST_XSTATS_MAX];
  87 };
  88
  89 struct vhost_queue {
  90         int vid;
  91         rte_atomic32_t allow_queuing;
  92         rte_atomic32_t while_queuing;
  93         struct pmd_internal *internal;
  94         struct rte_mempool *mb_pool;
  95         uint16_t port;
  96         uint16_t virtqueue_id;
  97         struct vhost_stats stats;
  98 };
  99
 100 struct pmd_internal {
 101         rte_atomic32_t dev_attached;
 102         char *iface_name;
 103         uint64_t flags;
 104         uint64_t disable_flags;
 105         uint16_t max_queues;
 106         int vid;
 107         rte_atomic32_t started;
 108         uint8_t vlan_strip;
 109 };
 110
 111 struct internal_list {
 112         TAILQ_ENTRY(internal_list) next;
 113         struct rte_eth_dev *eth_dev;
 114 };
 115
 116 TAILQ_HEAD(internal_list_head, internal_list);
 117 static struct internal_list_head internal_list =
 118         TAILQ_HEAD_INITIALIZER(internal_list);
 119
 120 static pthread_mutex_t internal_list_lock = PTHREAD_MUTEX_INITIALIZER;
 121
 122 static struct rte_eth_link pmd_link = {
 123                 .link_speed = 10000,
 124                 .link_duplex = ETH_LINK_FULL_DUPLEX,
 125                 .link_status = ETH_LINK_DOWN
 126 };
 127
 128 struct rte_vhost_vring_state {
 129         rte_spinlock_t lock;
 130
 131         bool cur[RTE_MAX_QUEUES_PER_PORT * 2];
 132         bool seen[RTE_MAX_QUEUES_PER_PORT * 2];
 133         unsigned int index;
 134         unsigned int max_vring;
 135 };
 136
 137 static struct rte_vhost_vring_state *vring_states[RTE_MAX_ETHPORTS];
 138
 139 #define VHOST_XSTATS_NAME_SIZE 64
 140
 141 struct vhost_xstats_name_off {
 142         char name[VHOST_XSTATS_NAME_SIZE];
 143         uint64_t offset;
 144 };
 145
 146 /* [rx]_is prepended to the name string here */
 147 static const struct vhost_xstats_name_off vhost_rxport_stat_strings[] = {
 148         {"good_packets",
 149          offsetof(struct vhost_queue, stats.pkts)},
 150         {"total_bytes",
 151          offsetof(struct vhost_queue, stats.bytes)},
 152         {"missed_pkts",
 153          offsetof(struct vhost_queue, stats.missed_pkts)},
 154         {"broadcast_packets",
 155          offsetof(struct vhost_queue, stats.xstats[VHOST_BROADCAST_PKT])},
 156         {"multicast_packets",
 157          offsetof(struct vhost_queue, stats.xstats[VHOST_MULTICAST_PKT])},
 158         {"unicast_packets",
 159          offsetof(struct vhost_queue, stats.xstats[VHOST_UNICAST_PKT])},
 160          {"undersize_packets",
 161          offsetof(struct vhost_queue, stats.xstats[VHOST_UNDERSIZE_PKT])},
 162         {"size_64_packets",
 163          offsetof(struct vhost_queue, stats.xstats[VHOST_64_PKT])},
 164         {"size_65_to_127_packets",
 165          offsetof(struct vhost_queue, stats.xstats[VHOST_65_TO_127_PKT])},
 166         {"size_128_to_255_packets",
 167          offsetof(struct vhost_queue, stats.xstats[VHOST_128_TO_255_PKT])},
 168         {"size_256_to_511_packets",
 169          offsetof(struct vhost_queue, stats.xstats[VHOST_256_TO_511_PKT])},
 170         {"size_512_to_1023_packets",
 171          offsetof(struct vhost_queue, stats.xstats[VHOST_512_TO_1023_PKT])},
 172         {"size_1024_to_1522_packets",
 173          offsetof(struct vhost_queue, stats.xstats[VHOST_1024_TO_1522_PKT])},
 174         {"size_1523_to_max_packets",
 175          offsetof(struct vhost_queue, stats.xstats[VHOST_1523_TO_MAX_PKT])},
 176         {"errors_with_bad_CRC",
 177          offsetof(struct vhost_queue, stats.xstats[VHOST_ERRORS_PKT])},
 178         {"fragmented_errors",
 179          offsetof(struct vhost_queue, stats.xstats[VHOST_ERRORS_FRAGMENTED])},
 180         {"jabber_errors",
 181          offsetof(struct vhost_queue, stats.xstats[VHOST_ERRORS_JABBER])},
 182         {"unknown_protos_packets",
 183          offsetof(struct vhost_queue, stats.xstats[VHOST_UNKNOWN_PROTOCOL])},
 184 };
 185
 186 /* [tx]_ is prepended to the name string here */
 187 static const struct vhost_xstats_name_off vhost_txport_stat_strings[] = {
 188         {"good_packets",
 189          offsetof(struct vhost_queue, stats.pkts)},
 190         {"total_bytes",
 191          offsetof(struct vhost_queue, stats.bytes)},
 192         {"missed_pkts",
 193          offsetof(struct vhost_queue, stats.missed_pkts)},
 194         {"broadcast_packets",
 195          offsetof(struct vhost_queue, stats.xstats[VHOST_BROADCAST_PKT])},
 196         {"multicast_packets",
 197          offsetof(struct vhost_queue, stats.xstats[VHOST_MULTICAST_PKT])},
 198         {"unicast_packets",
 199          offsetof(struct vhost_queue, stats.xstats[VHOST_UNICAST_PKT])},
 200         {"undersize_packets",
 201          offsetof(struct vhost_queue, stats.xstats[VHOST_UNDERSIZE_PKT])},
 202         {"size_64_packets",
 203          offsetof(struct vhost_queue, stats.xstats[VHOST_64_PKT])},
 204         {"size_65_to_127_packets",
 205          offsetof(struct vhost_queue, stats.xstats[VHOST_65_TO_127_PKT])},
 206         {"size_128_to_255_packets",
 207          offsetof(struct vhost_queue, stats.xstats[VHOST_128_TO_255_PKT])},
 208         {"size_256_to_511_packets",
 209          offsetof(struct vhost_queue, stats.xstats[VHOST_256_TO_511_PKT])},
 210         {"size_512_to_1023_packets",
 211          offsetof(struct vhost_queue, stats.xstats[VHOST_512_TO_1023_PKT])},
 212         {"size_1024_to_1522_packets",
 213          offsetof(struct vhost_queue, stats.xstats[VHOST_1024_TO_1522_PKT])},
 214         {"size_1523_to_max_packets",
 215          offsetof(struct vhost_queue, stats.xstats[VHOST_1523_TO_MAX_PKT])},
 216         {"errors_with_bad_CRC",
 217          offsetof(struct vhost_queue, stats.xstats[VHOST_ERRORS_PKT])},
 218 };
 219
 220 #define VHOST_NB_XSTATS_RXPORT (sizeof(vhost_rxport_stat_strings) / \
 221                                 sizeof(vhost_rxport_stat_strings[0]))
 222
 223 #define VHOST_NB_XSTATS_TXPORT (sizeof(vhost_txport_stat_strings) / \
 224                                 sizeof(vhost_txport_stat_strings[0]))
 225
 226 static int
 227 vhost_dev_xstats_reset(struct rte_eth_dev *dev)
 228 {
 229         struct vhost_queue *vq = NULL;
 230         unsigned int i = 0;
 231
 232         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 233                 vq = dev->data->rx_queues[i];
 234                 if (!vq)
 235                         continue;
 236                 memset(&vq->stats, 0, sizeof(vq->stats));
 237         }
 238         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 239                 vq = dev->data->tx_queues[i];
 240                 if (!vq)
 241                         continue;
 242                 memset(&vq->stats, 0, sizeof(vq->stats));
 243         }
 244
 245         return 0;
 246 }
 247
 248 static int
 249 vhost_dev_xstats_get_names(struct rte_eth_dev *dev __rte_unused,
 250                            struct rte_eth_xstat_name *xstats_names,
 251                            unsigned int limit __rte_unused)
 252 {
 253         unsigned int t = 0;
 254         int count = 0;
 255         int nstats = VHOST_NB_XSTATS_RXPORT + VHOST_NB_XSTATS_TXPORT;
 256
 257         if (!xstats_names)
 258                 return nstats;
 259         for (t = 0; t < VHOST_NB_XSTATS_RXPORT; t++) {
 260                 snprintf(xstats_names[count].name,
 261                          sizeof(xstats_names[count].name),
 262                          "rx_%s", vhost_rxport_stat_strings[t].name);
 263                 count++;
 264         }
 265         for (t = 0; t < VHOST_NB_XSTATS_TXPORT; t++) {
 266                 snprintf(xstats_names[count].name,
 267                          sizeof(xstats_names[count].name),
 268                          "tx_%s", vhost_txport_stat_strings[t].name);
 269                 count++;
 270         }
 271         return count;
 272 }
 273
 274 static int
 275 vhost_dev_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
 276                      unsigned int n)
 277 {
 278         unsigned int i;
 279         unsigned int t;
 280         unsigned int count = 0;
 281         struct vhost_queue *vq = NULL;
 282         unsigned int nxstats = VHOST_NB_XSTATS_RXPORT + VHOST_NB_XSTATS_TXPORT;
 283
 284         if (n < nxstats)
 285                 return nxstats;
 286
 287         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 288                 vq = dev->data->rx_queues[i];
 289                 if (!vq)
 290                         continue;
 291                 vq->stats.xstats[VHOST_UNICAST_PKT] = vq->stats.pkts
 292                                 - (vq->stats.xstats[VHOST_BROADCAST_PKT]
 293                                 + vq->stats.xstats[VHOST_MULTICAST_PKT]);
 294         }
 295         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 296                 vq = dev->data->tx_queues[i];
 297                 if (!vq)
 298                         continue;
 299                 vq->stats.xstats[VHOST_UNICAST_PKT] = vq->stats.pkts
 300                                 + vq->stats.missed_pkts
 301                                 - (vq->stats.xstats[VHOST_BROADCAST_PKT]
 302                                 + vq->stats.xstats[VHOST_MULTICAST_PKT]);
 303         }
 304         for (t = 0; t < VHOST_NB_XSTATS_RXPORT; t++) {
 305                 xstats[count].value = 0;
 306                 for (i = 0; i < dev->data->nb_rx_queues; i++) {
 307                         vq = dev->data->rx_queues[i];
 308                         if (!vq)
 309                                 continue;
 310                         xstats[count].value +=
 311                                 *(uint64_t *)(((char *)vq)
 312                                 + vhost_rxport_stat_strings[t].offset);
 313                 }
 314                 xstats[count].id = count;
 315                 count++;
 316         }
 317         for (t = 0; t < VHOST_NB_XSTATS_TXPORT; t++) {
 318                 xstats[count].value = 0;
 319                 for (i = 0; i < dev->data->nb_tx_queues; i++) {
 320                         vq = dev->data->tx_queues[i];
 321                         if (!vq)
 322                                 continue;
 323                         xstats[count].value +=
 324                                 *(uint64_t *)(((char *)vq)
 325                                 + vhost_txport_stat_strings[t].offset);
 326                 }
 327                 xstats[count].id = count;
 328                 count++;
 329         }
 330         return count;
 331 }
 332
 333 static inline void
 334 vhost_count_multicast_broadcast(struct vhost_queue *vq,
 335                                 struct rte_mbuf *mbuf)
 336 {
 337         struct rte_ether_addr *ea = NULL;
 338         struct vhost_stats *pstats = &vq->stats;
 339
 340         ea = rte_pktmbuf_mtod(mbuf, struct rte_ether_addr *);
 341         if (rte_is_multicast_ether_addr(ea)) {
 342                 if (rte_is_broadcast_ether_addr(ea))
 343                         pstats->xstats[VHOST_BROADCAST_PKT]++;
 344                 else
 345                         pstats->xstats[VHOST_MULTICAST_PKT]++;
 346         }
 347 }
 348
 349 static void
 350 vhost_update_packet_xstats(struct vhost_queue *vq,
 351                            struct rte_mbuf **bufs,
 352                            uint16_t count)
 353 {
 354         uint32_t pkt_len = 0;
 355         uint64_t i = 0;
 356         uint64_t index;
 357         struct vhost_stats *pstats = &vq->stats;
 358
 359         for (i = 0; i < count ; i++) {
 360                 pkt_len = bufs[i]->pkt_len;
 361                 if (pkt_len == 64) {
 362                         pstats->xstats[VHOST_64_PKT]++;
 363                 } else if (pkt_len > 64 && pkt_len < 1024) {
 364                         index = (sizeof(pkt_len) * 8)
 365                                 - __builtin_clz(pkt_len) - 5;
 366                         pstats->xstats[index]++;
 367                 } else {
 368                         if (pkt_len < 64)
 369                                 pstats->xstats[VHOST_UNDERSIZE_PKT]++;
 370                         else if (pkt_len <= 1522)
 371                                 pstats->xstats[VHOST_1024_TO_1522_PKT]++;
 372                         else if (pkt_len > 1522)
 373                                 pstats->xstats[VHOST_1523_TO_MAX_PKT]++;
 374                 }
 375                 vhost_count_multicast_broadcast(vq, bufs[i]);
 376         }
 377 }
 378
 379 static uint16_t
 380 eth_vhost_rx(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
 381 {
 382         struct vhost_queue *r = q;
 383         uint16_t i, nb_rx = 0;
 384         uint16_t nb_receive = nb_bufs;
 385
 386         if (unlikely(rte_atomic32_read(&r->allow_queuing) == 0))
 387                 return 0;
 388
 389         rte_atomic32_set(&r->while_queuing, 1);
 390
 391         if (unlikely(rte_atomic32_read(&r->allow_queuing) == 0))
 392                 goto out;
 393
 394         /* Dequeue packets from guest TX queue */
 395         while (nb_receive) {
 396                 uint16_t nb_pkts;
 397                 uint16_t num = (uint16_t)RTE_MIN(nb_receive,
 398                                                  VHOST_MAX_PKT_BURST);
 399
 400                 nb_pkts = rte_vhost_dequeue_burst(r->vid, r->virtqueue_id,
 401                                                   r->mb_pool, &bufs[nb_rx],
 402                                                   num);
 403
 404                 nb_rx += nb_pkts;
 405                 nb_receive -= nb_pkts;
 406                 if (nb_pkts < num)
 407                         break;
 408         }
 409
 410         r->stats.pkts += nb_rx;
 411
 412         for (i = 0; likely(i < nb_rx); i++) {
 413                 bufs[i]->port = r->port;
 414                 bufs[i]->vlan_tci = 0;
 415
 416                 if (r->internal->vlan_strip)
 417                         rte_vlan_strip(bufs[i]);
 418
 419                 r->stats.bytes += bufs[i]->pkt_len;
 420         }
 421
 422         vhost_update_packet_xstats(r, bufs, nb_rx);
 423
 424 out:
 425         rte_atomic32_set(&r->while_queuing, 0);
 426
 427         return nb_rx;
 428 }
 429
 430 static uint16_t
 431 eth_vhost_tx(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
 432 {
 433         struct vhost_queue *r = q;
 434         uint16_t i, nb_tx = 0;
 435         uint16_t nb_send = 0;
 436
 437         if (unlikely(rte_atomic32_read(&r->allow_queuing) == 0))
 438                 return 0;
 439
 440         rte_atomic32_set(&r->while_queuing, 1);
 441
 442         if (unlikely(rte_atomic32_read(&r->allow_queuing) == 0))
 443                 goto out;
 444
 445         for (i = 0; i < nb_bufs; i++) {
 446                 struct rte_mbuf *m = bufs[i];
 447
 448                 /* Do VLAN tag insertion */
 449                 if (m->ol_flags & PKT_TX_VLAN_PKT) {
 450                         int error = rte_vlan_insert(&m);
 451                         if (unlikely(error)) {
 452                                 rte_pktmbuf_free(m);
 453                                 continue;
 454                         }
 455                 }
 456
 457                 bufs[nb_send] = m;
 458                 ++nb_send;
 459         }
 460
 461         /* Enqueue packets to guest RX queue */
 462         while (nb_send) {
 463                 uint16_t nb_pkts;
 464                 uint16_t num = (uint16_t)RTE_MIN(nb_send,
 465                                                  VHOST_MAX_PKT_BURST);
 466
 467                 nb_pkts = rte_vhost_enqueue_burst(r->vid, r->virtqueue_id,
 468                                                   &bufs[nb_tx], num);
 469
 470                 nb_tx += nb_pkts;
 471                 nb_send -= nb_pkts;
 472                 if (nb_pkts < num)
 473                         break;
 474         }
 475
 476         r->stats.pkts += nb_tx;
 477         r->stats.missed_pkts += nb_bufs - nb_tx;
 478
 479         for (i = 0; likely(i < nb_tx); i++)
 480                 r->stats.bytes += bufs[i]->pkt_len;
 481
 482         vhost_update_packet_xstats(r, bufs, nb_tx);
 483
 484         /* According to RFC2863 page42 section ifHCOutMulticastPkts and
 485          * ifHCOutBroadcastPkts, the counters "multicast" and "broadcast"
 486          * are increased when packets are not transmitted successfully.
 487          */
 488         for (i = nb_tx; i < nb_bufs; i++)
 489                 vhost_count_multicast_broadcast(r, bufs[i]);
 490
 491         for (i = 0; likely(i < nb_tx); i++)
 492                 rte_pktmbuf_free(bufs[i]);
 493 out:
 494         rte_atomic32_set(&r->while_queuing, 0);
 495
 496         return nb_tx;
 497 }
 498
 499 static inline struct internal_list *
 500 find_internal_resource(char *ifname)
 501 {
 502         int found = 0;
 503         struct internal_list *list;
 504         struct pmd_internal *internal;
 505
 506         if (ifname == NULL)
 507                 return NULL;
 508
 509         pthread_mutex_lock(&internal_list_lock);
 510
 511         TAILQ_FOREACH(list, &internal_list, next) {
 512                 internal = list->eth_dev->data->dev_private;
 513                 if (!strcmp(internal->iface_name, ifname)) {
 514                         found = 1;
 515                         break;
 516                 }
 517         }
 518
 519         pthread_mutex_unlock(&internal_list_lock);
 520
 521         if (!found)
 522                 return NULL;
 523
 524         return list;
 525 }
 526
 527 static int
 528 eth_rxq_intr_enable(struct rte_eth_dev *dev, uint16_t qid)
 529 {
 530         struct rte_vhost_vring vring;
 531         struct vhost_queue *vq;
 532         int ret = 0;
 533
 534         vq = dev->data->rx_queues[qid];
 535         if (!vq) {
 536                 VHOST_LOG(ERR, "rxq%d is not setup yet\n", qid);
 537                 return -1;
 538         }
 539
 540         ret = rte_vhost_get_vhost_vring(vq->vid, (qid << 1) + 1, &vring);
 541         if (ret < 0) {
 542                 VHOST_LOG(ERR, "Failed to get rxq%d's vring\n", qid);
 543                 return ret;
 544         }
 545         VHOST_LOG(INFO, "Enable interrupt for rxq%d\n", qid);
 546         rte_vhost_enable_guest_notification(vq->vid, (qid << 1) + 1, 1);
 547         rte_wmb();
 548
 549         return ret;
 550 }
 551
 552 static int
 553 eth_rxq_intr_disable(struct rte_eth_dev *dev, uint16_t qid)
 554 {
 555         struct rte_vhost_vring vring;
 556         struct vhost_queue *vq;
 557         int ret = 0;
 558
 559         vq = dev->data->rx_queues[qid];
 560         if (!vq) {
 561                 VHOST_LOG(ERR, "rxq%d is not setup yet\n", qid);
 562                 return -1;
 563         }
 564
 565         ret = rte_vhost_get_vhost_vring(vq->vid, (qid << 1) + 1, &vring);
 566         if (ret < 0) {
 567                 VHOST_LOG(ERR, "Failed to get rxq%d's vring", qid);
 568                 return ret;
 569         }
 570         VHOST_LOG(INFO, "Disable interrupt for rxq%d\n", qid);
 571         rte_vhost_enable_guest_notification(vq->vid, (qid << 1) + 1, 0);
 572         rte_wmb();
 573
 574         return 0;
 575 }
 576
 577 static void
 578 eth_vhost_uninstall_intr(struct rte_eth_dev *dev)
 579 {
 580         struct rte_intr_handle *intr_handle = dev->intr_handle;
 581
 582         if (intr_handle) {
 583                 if (intr_handle->intr_vec)
 584                         free(intr_handle->intr_vec);
 585                 free(intr_handle);
 586         }
 587
 588         dev->intr_handle = NULL;
 589 }
 590
 591 static int
 592 eth_vhost_install_intr(struct rte_eth_dev *dev)
 593 {
 594         struct rte_vhost_vring vring;
 595         struct vhost_queue *vq;
 596         int count = 0;
 597         int nb_rxq = dev->data->nb_rx_queues;
 598         int i;
 599         int ret;
 600
 601         /* uninstall firstly if we are reconnecting */
 602         if (dev->intr_handle)
 603                 eth_vhost_uninstall_intr(dev);
 604
 605         dev->intr_handle = malloc(sizeof(*dev->intr_handle));
 606         if (!dev->intr_handle) {
 607                 VHOST_LOG(ERR, "Fail to allocate intr_handle\n");
 608                 return -ENOMEM;
 609         }
 610         memset(dev->intr_handle, 0, sizeof(*dev->intr_handle));
 611
 612         dev->intr_handle->efd_counter_size = sizeof(uint64_t);
 613
 614         dev->intr_handle->intr_vec =
 615                 malloc(nb_rxq * sizeof(dev->intr_handle->intr_vec[0]));
 616
 617         if (!dev->intr_handle->intr_vec) {
 618                 VHOST_LOG(ERR,
 619                         "Failed to allocate memory for interrupt vector\n");
 620                 free(dev->intr_handle);
 621                 return -ENOMEM;
 622         }
 623
 624         VHOST_LOG(INFO, "Prepare intr vec\n");
 625         for (i = 0; i < nb_rxq; i++) {
 626                 vq = dev->data->rx_queues[i];
 627                 if (!vq) {
 628                         VHOST_LOG(INFO, "rxq-%d not setup yet, skip!\n", i);
 629                         continue;
 630                 }
 631
 632                 ret = rte_vhost_get_vhost_vring(vq->vid, (i << 1) + 1, &vring);
 633                 if (ret < 0) {
 634                         VHOST_LOG(INFO,
 635                                 "Failed to get rxq-%d's vring, skip!\n", i);
 636                         continue;
 637                 }
 638
 639                 if (vring.kickfd < 0) {
 640                         VHOST_LOG(INFO,
 641                                 "rxq-%d's kickfd is invalid, skip!\n", i);
 642                         continue;
 643                 }
 644                 dev->intr_handle->intr_vec[i] = RTE_INTR_VEC_RXTX_OFFSET + i;
 645                 dev->intr_handle->efds[i] = vring.kickfd;
 646                 count++;
 647                 VHOST_LOG(INFO, "Installed intr vec for rxq-%d\n", i);
 648         }
 649
 650         dev->intr_handle->nb_efd = count;
 651         dev->intr_handle->max_intr = count + 1;
 652         dev->intr_handle->type = RTE_INTR_HANDLE_VDEV;
 653
 654         return 0;
 655 }
 656
 657 static void
 658 update_queuing_status(struct rte_eth_dev *dev)
 659 {
 660         struct pmd_internal *internal = dev->data->dev_private;
 661         struct vhost_queue *vq;
 662         unsigned int i;
 663         int allow_queuing = 1;
 664
 665         if (!dev->data->rx_queues || !dev->data->tx_queues)
 666                 return;
 667
 668         if (rte_atomic32_read(&internal->started) == 0 ||
 669             rte_atomic32_read(&internal->dev_attached) == 0)
 670                 allow_queuing = 0;
 671
 672         /* Wait until rx/tx_pkt_burst stops accessing vhost device */
 673         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 674                 vq = dev->data->rx_queues[i];
 675                 if (vq == NULL)
 676                         continue;
 677                 rte_atomic32_set(&vq->allow_queuing, allow_queuing);
 678                 while (rte_atomic32_read(&vq->while_queuing))
 679                         rte_pause();
 680         }
 681
 682         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 683                 vq = dev->data->tx_queues[i];
 684                 if (vq == NULL)
 685                         continue;
 686                 rte_atomic32_set(&vq->allow_queuing, allow_queuing);
 687                 while (rte_atomic32_read(&vq->while_queuing))
 688                         rte_pause();
 689         }
 690 }
 691
 692 static void
 693 queue_setup(struct rte_eth_dev *eth_dev, struct pmd_internal *internal)
 694 {
 695         struct vhost_queue *vq;
 696         int i;
 697
 698         for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
 699                 vq = eth_dev->data->rx_queues[i];
 700                 if (!vq)
 701                         continue;
 702                 vq->vid = internal->vid;
 703                 vq->internal = internal;
 704                 vq->port = eth_dev->data->port_id;
 705         }
 706         for (i = 0; i < eth_dev->data->nb_tx_queues; i++) {
 707                 vq = eth_dev->data->tx_queues[i];
 708                 if (!vq)
 709                         continue;
 710                 vq->vid = internal->vid;
 711                 vq->internal = internal;
 712                 vq->port = eth_dev->data->port_id;
 713         }
 714 }
 715
 716 static int
 717 new_device(int vid)
 718 {
 719         struct rte_eth_dev *eth_dev;
 720         struct internal_list *list;
 721         struct pmd_internal *internal;
 722         struct rte_eth_conf *dev_conf;
 723         unsigned i;
 724         char ifname[PATH_MAX];
 725 #ifdef RTE_LIBRTE_VHOST_NUMA
 726         int newnode;
 727 #endif
 728
 729         rte_vhost_get_ifname(vid, ifname, sizeof(ifname));
 730         list = find_internal_resource(ifname);
 731         if (list == NULL) {
 732                 VHOST_LOG(INFO, "Invalid device name: %s\n", ifname);
 733                 return -1;
 734         }
 735
 736         eth_dev = list->eth_dev;
 737         internal = eth_dev->data->dev_private;
 738         dev_conf = &eth_dev->data->dev_conf;
 739
 740 #ifdef RTE_LIBRTE_VHOST_NUMA
 741         newnode = rte_vhost_get_numa_node(vid);
 742         if (newnode >= 0)
 743                 eth_dev->data->numa_node = newnode;
 744 #endif
 745
 746         internal->vid = vid;
 747         if (rte_atomic32_read(&internal->started) == 1) {
 748                 queue_setup(eth_dev, internal);
 749
 750                 if (dev_conf->intr_conf.rxq) {
 751                         if (eth_vhost_install_intr(eth_dev) < 0) {
 752                                 VHOST_LOG(INFO,
 753                                         "Failed to install interrupt handler.");
 754                                         return -1;
 755                         }
 756                 }
 757         } else {
 758                 VHOST_LOG(INFO, "RX/TX queues not exist yet\n");
 759         }
 760
 761         for (i = 0; i < rte_vhost_get_vring_num(vid); i++)
 762                 rte_vhost_enable_guest_notification(vid, i, 0);
 763
 764         rte_vhost_get_mtu(vid, &eth_dev->data->mtu);
 765
 766         eth_dev->data->dev_link.link_status = ETH_LINK_UP;
 767
 768         rte_atomic32_set(&internal->dev_attached, 1);
 769         update_queuing_status(eth_dev);
 770
 771         VHOST_LOG(INFO, "Vhost device %d created\n", vid);
 772
 773         _rte_eth_dev_callback_process(eth_dev, RTE_ETH_EVENT_INTR_LSC, NULL);
 774
 775         return 0;
 776 }
 777
 778 static void
 779 destroy_device(int vid)
 780 {
 781         struct rte_eth_dev *eth_dev;
 782         struct pmd_internal *internal;
 783         struct vhost_queue *vq;
 784         struct internal_list *list;
 785         char ifname[PATH_MAX];
 786         unsigned i;
 787         struct rte_vhost_vring_state *state;
 788
 789         rte_vhost_get_ifname(vid, ifname, sizeof(ifname));
 790         list = find_internal_resource(ifname);
 791         if (list == NULL) {
 792                 VHOST_LOG(ERR, "Invalid interface name: %s\n", ifname);
 793                 return;
 794         }
 795         eth_dev = list->eth_dev;
 796         internal = eth_dev->data->dev_private;
 797
 798         rte_atomic32_set(&internal->dev_attached, 0);
 799         update_queuing_status(eth_dev);
 800
 801         eth_dev->data->dev_link.link_status = ETH_LINK_DOWN;
 802
 803         if (eth_dev->data->rx_queues && eth_dev->data->tx_queues) {
 804                 for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
 805                         vq = eth_dev->data->rx_queues[i];
 806                         if (!vq)
 807                                 continue;
 808                         vq->vid = -1;
 809                 }
 810                 for (i = 0; i < eth_dev->data->nb_tx_queues; i++) {
 811                         vq = eth_dev->data->tx_queues[i];
 812                         if (!vq)
 813                                 continue;
 814                         vq->vid = -1;
 815                 }
 816         }
 817
 818         state = vring_states[eth_dev->data->port_id];
 819         rte_spinlock_lock(&state->lock);
 820         for (i = 0; i <= state->max_vring; i++) {
 821                 state->cur[i] = false;
 822                 state->seen[i] = false;
 823         }
 824         state->max_vring = 0;
 825         rte_spinlock_unlock(&state->lock);
 826
 827         VHOST_LOG(INFO, "Vhost device %d destroyed\n", vid);
 828         eth_vhost_uninstall_intr(eth_dev);
 829
 830         _rte_eth_dev_callback_process(eth_dev, RTE_ETH_EVENT_INTR_LSC, NULL);
 831 }
 832
 833 static int
 834 vring_state_changed(int vid, uint16_t vring, int enable)
 835 {
 836         struct rte_vhost_vring_state *state;
 837         struct rte_eth_dev *eth_dev;
 838         struct internal_list *list;
 839         char ifname[PATH_MAX];
 840
 841         rte_vhost_get_ifname(vid, ifname, sizeof(ifname));
 842         list = find_internal_resource(ifname);
 843         if (list == NULL) {
 844                 VHOST_LOG(ERR, "Invalid interface name: %s\n", ifname);
 845                 return -1;
 846         }
 847
 848         eth_dev = list->eth_dev;
 849         /* won't be NULL */
 850         state = vring_states[eth_dev->data->port_id];
 851         rte_spinlock_lock(&state->lock);
 852         if (state->cur[vring] == enable) {
 853                 rte_spinlock_unlock(&state->lock);
 854                 return 0;
 855         }
 856         state->cur[vring] = enable;
 857         state->max_vring = RTE_MAX(vring, state->max_vring);
 858         rte_spinlock_unlock(&state->lock);
 859
 860         VHOST_LOG(INFO, "vring%u is %s\n",
 861                         vring, enable ? "enabled" : "disabled");
 862
 863         _rte_eth_dev_callback_process(eth_dev, RTE_ETH_EVENT_QUEUE_STATE, NULL);
 864
 865         return 0;
 866 }
 867
 868 static struct vhost_device_ops vhost_ops = {
 869         .new_device          = new_device,
 870         .destroy_device      = destroy_device,
 871         .vring_state_changed = vring_state_changed,
 872 };
 873
 874 static int
 875 vhost_driver_setup(struct rte_eth_dev *eth_dev)
 876 {
 877         struct pmd_internal *internal = eth_dev->data->dev_private;
 878         struct internal_list *list = NULL;
 879         struct rte_vhost_vring_state *vring_state = NULL;
 880         unsigned int numa_node = eth_dev->device->numa_node;
 881         const char *name = eth_dev->device->name;
 882
 883         /* Don't try to setup again if it has already been done. */
 884         list = find_internal_resource(internal->iface_name);
 885         if (list)
 886                 return 0;
 887
 888         list = rte_zmalloc_socket(name, sizeof(*list), 0, numa_node);
 889         if (list == NULL)
 890                 return -1;
 891
 892         vring_state = rte_zmalloc_socket(name, sizeof(*vring_state),
 893                                          0, numa_node);
 894         if (vring_state == NULL)
 895                 goto free_list;
 896
 897         list->eth_dev = eth_dev;
 898         pthread_mutex_lock(&internal_list_lock);
 899         TAILQ_INSERT_TAIL(&internal_list, list, next);
 900         pthread_mutex_unlock(&internal_list_lock);
 901
 902         rte_spinlock_init(&vring_state->lock);
 903         vring_states[eth_dev->data->port_id] = vring_state;
 904
 905         if (rte_vhost_driver_register(internal->iface_name, internal->flags))
 906                 goto list_remove;
 907
 908         if (internal->disable_flags) {
 909                 if (rte_vhost_driver_disable_features(internal->iface_name,
 910                                                       internal->disable_flags))
 911                         goto drv_unreg;
 912         }
 913
 914         if (rte_vhost_driver_callback_register(internal->iface_name,
 915                                                &vhost_ops) < 0) {
 916                 VHOST_LOG(ERR, "Can't register callbacks\n");
 917                 goto drv_unreg;
 918         }
 919
 920         if (rte_vhost_driver_start(internal->iface_name) < 0) {
 921                 VHOST_LOG(ERR, "Failed to start driver for %s\n",
 922                           internal->iface_name);
 923                 goto drv_unreg;
 924         }
 925
 926         return 0;
 927
 928 drv_unreg:
 929         rte_vhost_driver_unregister(internal->iface_name);
 930 list_remove:
 931         vring_states[eth_dev->data->port_id] = NULL;
 932         pthread_mutex_lock(&internal_list_lock);
 933         TAILQ_REMOVE(&internal_list, list, next);
 934         pthread_mutex_unlock(&internal_list_lock);
 935         rte_free(vring_state);
 936 free_list:
 937         rte_free(list);
 938
 939         return -1;
 940 }
 941
 942 int
 943 rte_eth_vhost_get_queue_event(uint16_t port_id,
 944                 struct rte_eth_vhost_queue_event *event)
 945 {
 946         struct rte_vhost_vring_state *state;
 947         unsigned int i;
 948         int idx;
 949
 950         if (port_id >= RTE_MAX_ETHPORTS) {
 951                 VHOST_LOG(ERR, "Invalid port id\n");
 952                 return -1;
 953         }
 954
 955         state = vring_states[port_id];
 956         if (!state) {
 957                 VHOST_LOG(ERR, "Unused port\n");
 958                 return -1;
 959         }
 960
 961         rte_spinlock_lock(&state->lock);
 962         for (i = 0; i <= state->max_vring; i++) {
 963                 idx = state->index++ % (state->max_vring + 1);
 964
 965                 if (state->cur[idx] != state->seen[idx]) {
 966                         state->seen[idx] = state->cur[idx];
 967                         event->queue_id = idx / 2;
 968                         event->rx = idx & 1;
 969                         event->enable = state->cur[idx];
 970                         rte_spinlock_unlock(&state->lock);
 971                         return 0;
 972                 }
 973         }
 974         rte_spinlock_unlock(&state->lock);
 975
 976         return -1;
 977 }
 978
 979 int
 980 rte_eth_vhost_get_vid_from_port_id(uint16_t port_id)
 981 {
 982         struct internal_list *list;
 983         struct rte_eth_dev *eth_dev;
 984         struct vhost_queue *vq;
 985         int vid = -1;
 986
 987         if (!rte_eth_dev_is_valid_port(port_id))
 988                 return -1;
 989
 990         pthread_mutex_lock(&internal_list_lock);
 991
 992         TAILQ_FOREACH(list, &internal_list, next) {
 993                 eth_dev = list->eth_dev;
 994                 if (eth_dev->data->port_id == port_id) {
 995                         vq = eth_dev->data->rx_queues[0];
 996                         if (vq) {
 997                                 vid = vq->vid;
 998                         }
 999                         break;
1000                 }
1001         }
1002
1003         pthread_mutex_unlock(&internal_list_lock);
1004
1005         return vid;
1006 }
1007
1008 static int
1009 eth_dev_configure(struct rte_eth_dev *dev)
1010 {
1011         struct pmd_internal *internal = dev->data->dev_private;
1012         const struct rte_eth_rxmode *rxmode = &dev->data->dev_conf.rxmode;
1013
1014         /* NOTE: the same process has to operate a vhost interface
1015          * from beginning to end (from eth_dev configure to eth_dev close).
1016          * It is user's responsibility at the moment.
1017          */
1018         if (vhost_driver_setup(dev) < 0)
1019                 return -1;
1020
1021         internal->vlan_strip = !!(rxmode->offloads & DEV_RX_OFFLOAD_VLAN_STRIP);
1022
1023         return 0;
1024 }
1025
1026 static int
1027 eth_dev_start(struct rte_eth_dev *eth_dev)
1028 {
1029         struct pmd_internal *internal = eth_dev->data->dev_private;
1030         struct rte_eth_conf *dev_conf = &eth_dev->data->dev_conf;
1031
1032         queue_setup(eth_dev, internal);
1033
1034         if (rte_atomic32_read(&internal->dev_attached) == 1) {
1035                 if (dev_conf->intr_conf.rxq) {
1036                         if (eth_vhost_install_intr(eth_dev) < 0) {
1037                                 VHOST_LOG(INFO,
1038                                         "Failed to install interrupt handler.");
1039                                         return -1;
1040                         }
1041                 }
1042         }
1043
1044         rte_atomic32_set(&internal->started, 1);
1045         update_queuing_status(eth_dev);
1046
1047         return 0;
1048 }
1049
1050 static void
1051 eth_dev_stop(struct rte_eth_dev *dev)
1052 {
1053         struct pmd_internal *internal = dev->data->dev_private;
1054
1055         rte_atomic32_set(&internal->started, 0);
1056         update_queuing_status(dev);
1057 }
1058
1059 static void
1060 eth_dev_close(struct rte_eth_dev *dev)
1061 {
1062         struct pmd_internal *internal;
1063         struct internal_list *list;
1064         unsigned int i;
1065
1066         internal = dev->data->dev_private;
1067         if (!internal)
1068                 return;
1069
1070         eth_dev_stop(dev);
1071
1072         rte_vhost_driver_unregister(internal->iface_name);
1073
1074         list = find_internal_resource(internal->iface_name);
1075         if (!list)
1076                 return;
1077
1078         pthread_mutex_lock(&internal_list_lock);
1079         TAILQ_REMOVE(&internal_list, list, next);
1080         pthread_mutex_unlock(&internal_list_lock);
1081         rte_free(list);
1082
1083         if (dev->data->rx_queues)
1084                 for (i = 0; i < dev->data->nb_rx_queues; i++)
1085                         rte_free(dev->data->rx_queues[i]);
1086
1087         if (dev->data->tx_queues)
1088                 for (i = 0; i < dev->data->nb_tx_queues; i++)
1089                         rte_free(dev->data->tx_queues[i]);
1090
1091         rte_free(internal->iface_name);
1092         rte_free(internal);
1093
1094         dev->data->dev_private = NULL;
1095
1096         rte_free(vring_states[dev->data->port_id]);
1097         vring_states[dev->data->port_id] = NULL;
1098 }
1099
1100 static int
1101 eth_rx_queue_setup(struct rte_eth_dev *dev, uint16_t rx_queue_id,
1102                    uint16_t nb_rx_desc __rte_unused,
1103                    unsigned int socket_id,
1104                    const struct rte_eth_rxconf *rx_conf __rte_unused,
1105                    struct rte_mempool *mb_pool)
1106 {
1107         struct vhost_queue *vq;
1108
1109         vq = rte_zmalloc_socket(NULL, sizeof(struct vhost_queue),
1110                         RTE_CACHE_LINE_SIZE, socket_id);
1111         if (vq == NULL) {
1112                 VHOST_LOG(ERR, "Failed to allocate memory for rx queue\n");
1113                 return -ENOMEM;
1114         }
1115
1116         vq->mb_pool = mb_pool;
1117         vq->virtqueue_id = rx_queue_id * VIRTIO_QNUM + VIRTIO_TXQ;
1118         dev->data->rx_queues[rx_queue_id] = vq;
1119
1120         return 0;
1121 }
1122
1123 static int
1124 eth_tx_queue_setup(struct rte_eth_dev *dev, uint16_t tx_queue_id,
1125                    uint16_t nb_tx_desc __rte_unused,
1126                    unsigned int socket_id,
1127                    const struct rte_eth_txconf *tx_conf __rte_unused)
1128 {
1129         struct vhost_queue *vq;
1130
1131         vq = rte_zmalloc_socket(NULL, sizeof(struct vhost_queue),
1132                         RTE_CACHE_LINE_SIZE, socket_id);
1133         if (vq == NULL) {
1134                 VHOST_LOG(ERR, "Failed to allocate memory for tx queue\n");
1135                 return -ENOMEM;
1136         }
1137
1138         vq->virtqueue_id = tx_queue_id * VIRTIO_QNUM + VIRTIO_RXQ;
1139         dev->data->tx_queues[tx_queue_id] = vq;
1140
1141         return 0;
1142 }
1143
1144 static int
1145 eth_dev_info(struct rte_eth_dev *dev,
1146              struct rte_eth_dev_info *dev_info)
1147 {
1148         struct pmd_internal *internal;
1149
1150         internal = dev->data->dev_private;
1151         if (internal == NULL) {
1152                 VHOST_LOG(ERR, "Invalid device specified\n");
1153                 return -ENODEV;
1154         }
1155
1156         dev_info->max_mac_addrs = 1;
1157         dev_info->max_rx_pktlen = (uint32_t)-1;
1158         dev_info->max_rx_queues = internal->max_queues;
1159         dev_info->max_tx_queues = internal->max_queues;
1160         dev_info->min_rx_bufsize = 0;
1161
1162         dev_info->tx_offload_capa = DEV_TX_OFFLOAD_MULTI_SEGS |
1163                                 DEV_TX_OFFLOAD_VLAN_INSERT;
1164         dev_info->rx_offload_capa = DEV_RX_OFFLOAD_VLAN_STRIP;
1165
1166         return 0;
1167 }
1168
1169 static int
1170 eth_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
1171 {
1172         unsigned i;
1173         unsigned long rx_total = 0, tx_total = 0;
1174         unsigned long rx_total_bytes = 0, tx_total_bytes = 0;
1175         struct vhost_queue *vq;
1176
1177         for (i = 0; i < RTE_ETHDEV_QUEUE_STAT_CNTRS &&
1178                         i < dev->data->nb_rx_queues; i++) {
1179                 if (dev->data->rx_queues[i] == NULL)
1180                         continue;
1181                 vq = dev->data->rx_queues[i];
1182                 stats->q_ipackets[i] = vq->stats.pkts;
1183                 rx_total += stats->q_ipackets[i];
1184
1185                 stats->q_ibytes[i] = vq->stats.bytes;
1186                 rx_total_bytes += stats->q_ibytes[i];
1187         }
1188
1189         for (i = 0; i < RTE_ETHDEV_QUEUE_STAT_CNTRS &&
1190                         i < dev->data->nb_tx_queues; i++) {
1191                 if (dev->data->tx_queues[i] == NULL)
1192                         continue;
1193                 vq = dev->data->tx_queues[i];
1194                 stats->q_opackets[i] = vq->stats.pkts;
1195                 tx_total += stats->q_opackets[i];
1196
1197                 stats->q_obytes[i] = vq->stats.bytes;
1198                 tx_total_bytes += stats->q_obytes[i];
1199         }
1200
1201         stats->ipackets = rx_total;
1202         stats->opackets = tx_total;
1203         stats->ibytes = rx_total_bytes;
1204         stats->obytes = tx_total_bytes;
1205
1206         return 0;
1207 }
1208
1209 static int
1210 eth_stats_reset(struct rte_eth_dev *dev)
1211 {
1212         struct vhost_queue *vq;
1213         unsigned i;
1214
1215         for (i = 0; i < dev->data->nb_rx_queues; i++) {
1216                 if (dev->data->rx_queues[i] == NULL)
1217                         continue;
1218                 vq = dev->data->rx_queues[i];
1219                 vq->stats.pkts = 0;
1220                 vq->stats.bytes = 0;
1221         }
1222         for (i = 0; i < dev->data->nb_tx_queues; i++) {
1223                 if (dev->data->tx_queues[i] == NULL)
1224                         continue;
1225                 vq = dev->data->tx_queues[i];
1226                 vq->stats.pkts = 0;
1227                 vq->stats.bytes = 0;
1228                 vq->stats.missed_pkts = 0;
1229         }
1230
1231         return 0;
1232 }
1233
1234 static void
1235 eth_queue_release(void *q)
1236 {
1237         rte_free(q);
1238 }
1239
1240 static int
1241 eth_tx_done_cleanup(void *txq __rte_unused, uint32_t free_cnt __rte_unused)
1242 {
1243         /*
1244          * vHost does not hang onto mbuf. eth_vhost_tx() copies packet data
1245          * and releases mbuf, so nothing to cleanup.
1246          */
1247         return 0;
1248 }
1249
1250 static int
1251 eth_link_update(struct rte_eth_dev *dev __rte_unused,
1252                 int wait_to_complete __rte_unused)
1253 {
1254         return 0;
1255 }
1256
1257 static uint32_t
1258 eth_rx_queue_count(struct rte_eth_dev *dev, uint16_t rx_queue_id)
1259 {
1260         struct vhost_queue *vq;
1261
1262         vq = dev->data->rx_queues[rx_queue_id];
1263         if (vq == NULL)
1264                 return 0;
1265
1266         return rte_vhost_rx_queue_count(vq->vid, vq->virtqueue_id);
1267 }
1268
1269 static const struct eth_dev_ops ops = {
1270         .dev_start = eth_dev_start,
1271         .dev_stop = eth_dev_stop,
1272         .dev_close = eth_dev_close,
1273         .dev_configure = eth_dev_configure,
1274         .dev_infos_get = eth_dev_info,
1275         .rx_queue_setup = eth_rx_queue_setup,
1276         .tx_queue_setup = eth_tx_queue_setup,
1277         .rx_queue_release = eth_queue_release,
1278         .tx_queue_release = eth_queue_release,
1279         .tx_done_cleanup = eth_tx_done_cleanup,
1280         .rx_queue_count = eth_rx_queue_count,
1281         .link_update = eth_link_update,
1282         .stats_get = eth_stats_get,
1283         .stats_reset = eth_stats_reset,
1284         .xstats_reset = vhost_dev_xstats_reset,
1285         .xstats_get = vhost_dev_xstats_get,
1286         .xstats_get_names = vhost_dev_xstats_get_names,
1287         .rx_queue_intr_enable = eth_rxq_intr_enable,
1288         .rx_queue_intr_disable = eth_rxq_intr_disable,
1289 };
1290
1291 static int
1292 eth_dev_vhost_create(struct rte_vdev_device *dev, char *iface_name,
1293         int16_t queues, const unsigned int numa_node, uint64_t flags,
1294         uint64_t disable_flags)
1295 {
1296         const char *name = rte_vdev_device_name(dev);
1297         struct rte_eth_dev_data *data;
1298         struct pmd_internal *internal = NULL;
1299         struct rte_eth_dev *eth_dev = NULL;
1300         struct rte_ether_addr *eth_addr = NULL;
1301
1302         VHOST_LOG(INFO, "Creating VHOST-USER backend on numa socket %u\n",
1303                 numa_node);
1304
1305         /* reserve an ethdev entry */
1306         eth_dev = rte_eth_vdev_allocate(dev, sizeof(*internal));
1307         if (eth_dev == NULL)
1308                 goto error;
1309         data = eth_dev->data;
1310
1311         eth_addr = rte_zmalloc_socket(name, sizeof(*eth_addr), 0, numa_node);
1312         if (eth_addr == NULL)
1313                 goto error;
1314         data->mac_addrs = eth_addr;
1315         *eth_addr = base_eth_addr;
1316         eth_addr->addr_bytes[5] = eth_dev->data->port_id;
1317
1318         /* now put it all together
1319          * - store queue data in internal,
1320          * - point eth_dev_data to internals
1321          * - and point eth_dev structure to new eth_dev_data structure
1322          */
1323         internal = eth_dev->data->dev_private;
1324         internal->iface_name = rte_malloc_socket(name, strlen(iface_name) + 1,
1325                                                  0, numa_node);
1326         if (internal->iface_name == NULL)
1327                 goto error;
1328         strcpy(internal->iface_name, iface_name);
1329
1330         data->nb_rx_queues = queues;
1331         data->nb_tx_queues = queues;
1332         internal->max_queues = queues;
1333         internal->vid = -1;
1334         internal->flags = flags;
1335         internal->disable_flags = disable_flags;
1336         data->dev_link = pmd_link;
1337         data->dev_flags = RTE_ETH_DEV_INTR_LSC | RTE_ETH_DEV_CLOSE_REMOVE;
1338         data->promiscuous = 1;
1339         data->all_multicast = 1;
1340
1341         eth_dev->dev_ops = &ops;
1342
1343         /* finally assign rx and tx ops */
1344         eth_dev->rx_pkt_burst = eth_vhost_rx;
1345         eth_dev->tx_pkt_burst = eth_vhost_tx;
1346
1347         rte_eth_dev_probing_finish(eth_dev);
1348         return 0;
1349
1350 error:
1351         if (internal)
1352                 rte_free(internal->iface_name);
1353         rte_eth_dev_release_port(eth_dev);
1354
1355         return -1;
1356 }
1357
1358 static inline int
1359 open_iface(const char *key __rte_unused, const char *value, void *extra_args)
1360 {
1361         const char **iface_name = extra_args;
1362
1363         if (value == NULL)
1364                 return -1;
1365
1366         *iface_name = value;
1367
1368         return 0;
1369 }
1370
1371 static inline int
1372 open_int(const char *key __rte_unused, const char *value, void *extra_args)
1373 {
1374         uint16_t *n = extra_args;
1375
1376         if (value == NULL || extra_args == NULL)
1377                 return -EINVAL;
1378
1379         *n = (uint16_t)strtoul(value, NULL, 0);
1380         if (*n == USHRT_MAX && errno == ERANGE)
1381                 return -1;
1382
1383         return 0;
1384 }
1385
1386 static int
1387 rte_pmd_vhost_probe(struct rte_vdev_device *dev)
1388 {
1389         struct rte_kvargs *kvlist = NULL;
1390         int ret = 0;
1391         char *iface_name;
1392         uint16_t queues;
1393         uint64_t flags = 0;
1394         uint64_t disable_flags = 0;
1395         int client_mode = 0;
1396         int dequeue_zero_copy = 0;
1397         int iommu_support = 0;
1398         int postcopy_support = 0;
1399         int tso = 0;
1400         int linear_buf = 0;
1401         int ext_buf = 0;
1402         struct rte_eth_dev *eth_dev;
1403         const char *name = rte_vdev_device_name(dev);
1404
1405         VHOST_LOG(INFO, "Initializing pmd_vhost for %s\n", name);
1406
1407         if (rte_eal_process_type() == RTE_PROC_SECONDARY) {
1408                 eth_dev = rte_eth_dev_attach_secondary(name);
1409                 if (!eth_dev) {
1410                         VHOST_LOG(ERR, "Failed to probe %s\n", name);
1411                         return -1;
1412                 }
1413                 eth_dev->rx_pkt_burst = eth_vhost_rx;
1414                 eth_dev->tx_pkt_burst = eth_vhost_tx;
1415                 eth_dev->dev_ops = &ops;
1416                 if (dev->device.numa_node == SOCKET_ID_ANY)
1417                         dev->device.numa_node = rte_socket_id();
1418                 eth_dev->device = &dev->device;
1419                 rte_eth_dev_probing_finish(eth_dev);
1420                 return 0;
1421         }
1422
1423         kvlist = rte_kvargs_parse(rte_vdev_device_args(dev), valid_arguments);
1424         if (kvlist == NULL)
1425                 return -1;
1426
1427         if (rte_kvargs_count(kvlist, ETH_VHOST_IFACE_ARG) == 1) {
1428                 ret = rte_kvargs_process(kvlist, ETH_VHOST_IFACE_ARG,
1429                                          &open_iface, &iface_name);
1430                 if (ret < 0)
1431                         goto out_free;
1432         } else {
1433                 ret = -1;
1434                 goto out_free;
1435         }
1436
1437         if (rte_kvargs_count(kvlist, ETH_VHOST_QUEUES_ARG) == 1) {
1438                 ret = rte_kvargs_process(kvlist, ETH_VHOST_QUEUES_ARG,
1439                                          &open_int, &queues);
1440                 if (ret < 0 || queues > RTE_MAX_QUEUES_PER_PORT)
1441                         goto out_free;
1442
1443         } else
1444                 queues = 1;
1445
1446         if (rte_kvargs_count(kvlist, ETH_VHOST_CLIENT_ARG) == 1) {
1447                 ret = rte_kvargs_process(kvlist, ETH_VHOST_CLIENT_ARG,
1448                                          &open_int, &client_mode);
1449                 if (ret < 0)
1450                         goto out_free;
1451
1452                 if (client_mode)
1453                         flags |= RTE_VHOST_USER_CLIENT;
1454         }
1455
1456         if (rte_kvargs_count(kvlist, ETH_VHOST_DEQUEUE_ZERO_COPY) == 1) {
1457                 ret = rte_kvargs_process(kvlist, ETH_VHOST_DEQUEUE_ZERO_COPY,
1458                                          &open_int, &dequeue_zero_copy);
1459                 if (ret < 0)
1460                         goto out_free;
1461
1462                 if (dequeue_zero_copy)
1463                         flags |= RTE_VHOST_USER_DEQUEUE_ZERO_COPY;
1464         }
1465
1466         if (rte_kvargs_count(kvlist, ETH_VHOST_IOMMU_SUPPORT) == 1) {
1467                 ret = rte_kvargs_process(kvlist, ETH_VHOST_IOMMU_SUPPORT,
1468                                          &open_int, &iommu_support);
1469                 if (ret < 0)
1470                         goto out_free;
1471
1472                 if (iommu_support)
1473                         flags |= RTE_VHOST_USER_IOMMU_SUPPORT;
1474         }
1475
1476         if (rte_kvargs_count(kvlist, ETH_VHOST_POSTCOPY_SUPPORT) == 1) {
1477                 ret = rte_kvargs_process(kvlist, ETH_VHOST_POSTCOPY_SUPPORT,
1478                                          &open_int, &postcopy_support);
1479                 if (ret < 0)
1480                         goto out_free;
1481
1482                 if (postcopy_support)
1483                         flags |= RTE_VHOST_USER_POSTCOPY_SUPPORT;
1484         }
1485
1486         if (rte_kvargs_count(kvlist, ETH_VHOST_VIRTIO_NET_F_HOST_TSO) == 1) {
1487                 ret = rte_kvargs_process(kvlist,
1488                                 ETH_VHOST_VIRTIO_NET_F_HOST_TSO,
1489                                 &open_int, &tso);
1490                 if (ret < 0)
1491                         goto out_free;
1492
1493                 if (tso == 0) {
1494                         disable_flags |= (1ULL << VIRTIO_NET_F_HOST_TSO4);
1495                         disable_flags |= (1ULL << VIRTIO_NET_F_HOST_TSO6);
1496                 }
1497         }
1498
1499         if (rte_kvargs_count(kvlist, ETH_VHOST_LINEAR_BUF) == 1) {
1500                 ret = rte_kvargs_process(kvlist,
1501                                 ETH_VHOST_LINEAR_BUF,
1502                                 &open_int, &linear_buf);
1503                 if (ret < 0)
1504                         goto out_free;
1505
1506                 if (linear_buf == 1)
1507                         flags |= RTE_VHOST_USER_LINEARBUF_SUPPORT;
1508         }
1509
1510         if (rte_kvargs_count(kvlist, ETH_VHOST_EXT_BUF) == 1) {
1511                 ret = rte_kvargs_process(kvlist,
1512                                 ETH_VHOST_EXT_BUF,
1513                                 &open_int, &ext_buf);
1514                 if (ret < 0)
1515                         goto out_free;
1516
1517                 if (ext_buf == 1)
1518                         flags |= RTE_VHOST_USER_EXTBUF_SUPPORT;
1519         }
1520
1521         if (dev->device.numa_node == SOCKET_ID_ANY)
1522                 dev->device.numa_node = rte_socket_id();
1523
1524         ret = eth_dev_vhost_create(dev, iface_name, queues,
1525                                    dev->device.numa_node, flags, disable_flags);
1526         if (ret == -1)
1527                 VHOST_LOG(ERR, "Failed to create %s\n", name);
1528
1529 out_free:
1530         rte_kvargs_free(kvlist);
1531         return ret;
1532 }
1533
1534 static int
1535 rte_pmd_vhost_remove(struct rte_vdev_device *dev)
1536 {
1537         const char *name;
1538         struct rte_eth_dev *eth_dev = NULL;
1539
1540         name = rte_vdev_device_name(dev);
1541         VHOST_LOG(INFO, "Un-Initializing pmd_vhost for %s\n", name);
1542
1543         /* find an ethdev entry */
1544         eth_dev = rte_eth_dev_allocated(name);
1545         if (eth_dev == NULL)
1546                 return 0;
1547
1548         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1549                 return rte_eth_dev_release_port(eth_dev);
1550
1551         eth_dev_close(eth_dev);
1552
1553         rte_eth_dev_release_port(eth_dev);
1554
1555         return 0;
1556 }
1557
1558 static struct rte_vdev_driver pmd_vhost_drv = {
1559         .probe = rte_pmd_vhost_probe,
1560         .remove = rte_pmd_vhost_remove,
1561 };
1562
1563 RTE_PMD_REGISTER_VDEV(net_vhost, pmd_vhost_drv);
1564 RTE_PMD_REGISTER_ALIAS(net_vhost, eth_vhost);
1565 RTE_PMD_REGISTER_PARAM_STRING(net_vhost,
1566         "iface=<ifc> "
1567         "queues=<int> "
1568         "client=<0|1> "
1569         "dequeue-zero-copy=<0|1> "
1570         "iommu-support=<0|1> "
1571         "postcopy-support=<0|1> "
1572         "tso=<0|1> "
1573         "linear-buffer=<0|1> "
1574         "ext-buffer=<0|1>");
1575
1576 RTE_INIT(vhost_init_log)
1577 {
1578         vhost_logtype = rte_log_register("pmd.net.vhost");
1579         if (vhost_logtype >= 0)
1580                 rte_log_set_level(vhost_logtype, RTE_LOG_NOTICE);
1581 }