virtio-net.c 64.9 KB
Newer Older
A
aliguori 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13
/*
 * Virtio Network Device
 *
 * Copyright IBM, Corp. 2007
 *
 * Authors:
 *  Anthony Liguori   <aliguori@us.ibm.com>
 *
 * This work is licensed under the terms of the GNU GPL, version 2.  See
 * the COPYING file in the top-level directory.
 *
 */

P
Peter Maydell 已提交
14
#include "qemu/osdep.h"
15
#include "qemu/iov.h"
P
Paolo Bonzini 已提交
16
#include "hw/virtio/virtio.h"
P
Paolo Bonzini 已提交
17
#include "net/net.h"
18
#include "net/checksum.h"
19
#include "net/tap.h"
20 21
#include "qemu/error-report.h"
#include "qemu/timer.h"
P
Paolo Bonzini 已提交
22 23
#include "hw/virtio/virtio-net.h"
#include "net/vhost_net.h"
24
#include "hw/virtio/virtio-bus.h"
25
#include "qapi/qmp/qjson.h"
26
#include "qapi-event.h"
27
#include "hw/virtio/virtio-access.h"
A
aliguori 已提交
28

29
#define VIRTIO_NET_VM_VERSION    11
30

31
#define MAC_TABLE_ENTRIES    64
32
#define MAX_VLAN    (1 << 12)   /* Per 802.1Q definition */
33

34 35 36 37 38
/* previously fixed value */
#define VIRTIO_NET_RX_QUEUE_DEFAULT_SIZE 256
/* for now, only allow larger queues; with virtio-1, guest can downsize */
#define VIRTIO_NET_RX_QUEUE_MIN_SIZE VIRTIO_NET_RX_QUEUE_DEFAULT_SIZE

39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57
/*
 * Calculate the number of bytes up to and including the given 'field' of
 * 'container'.
 */
#define endof(container, field) \
    (offsetof(container, field) + sizeof(((container *)0)->field))

typedef struct VirtIOFeature {
    uint32_t flags;
    size_t end;
} VirtIOFeature;

static VirtIOFeature feature_sizes[] = {
    {.flags = 1 << VIRTIO_NET_F_MAC,
     .end = endof(struct virtio_net_config, mac)},
    {.flags = 1 << VIRTIO_NET_F_STATUS,
     .end = endof(struct virtio_net_config, status)},
    {.flags = 1 << VIRTIO_NET_F_MQ,
     .end = endof(struct virtio_net_config, max_virtqueue_pairs)},
58 59
    {.flags = 1 << VIRTIO_NET_F_MTU,
     .end = endof(struct virtio_net_config, mtu)},
60 61 62
    {}
};

J
Jason Wang 已提交
63
static VirtIONetQueue *virtio_net_get_subqueue(NetClientState *nc)
64 65 66
{
    VirtIONet *n = qemu_get_nic_opaque(nc);

J
Jason Wang 已提交
67
    return &n->vqs[nc->queue_index];
68
}
J
Jason Wang 已提交
69 70 71 72 73 74

static int vq2q(int queue_index)
{
    return queue_index / 2;
}

A
aliguori 已提交
75 76 77 78
/* TODO
 * - we could suppress RX interrupt if we were so inclined.
 */

79
static void virtio_net_get_config(VirtIODevice *vdev, uint8_t *config)
A
aliguori 已提交
80
{
81
    VirtIONet *n = VIRTIO_NET(vdev);
A
aliguori 已提交
82 83
    struct virtio_net_config netcfg;

84 85
    virtio_stw_p(vdev, &netcfg.status, n->status);
    virtio_stw_p(vdev, &netcfg.max_virtqueue_pairs, n->max_queues);
86
    virtio_stw_p(vdev, &netcfg.mtu, n->net_conf.mtu);
87
    memcpy(netcfg.mac, n->mac, ETH_ALEN);
88
    memcpy(config, &netcfg, n->config_size);
A
aliguori 已提交
89 90
}

91 92
static void virtio_net_set_config(VirtIODevice *vdev, const uint8_t *config)
{
93
    VirtIONet *n = VIRTIO_NET(vdev);
94
    struct virtio_net_config netcfg = {};
95

96
    memcpy(&netcfg, config, n->config_size);
97

98 99
    if (!virtio_vdev_has_feature(vdev, VIRTIO_NET_F_CTRL_MAC_ADDR) &&
        !virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1) &&
100
        memcmp(netcfg.mac, n->mac, ETH_ALEN)) {
101
        memcpy(n->mac, netcfg.mac, ETH_ALEN);
J
Jason Wang 已提交
102
        qemu_format_nic_info_str(qemu_get_queue(n->nic), n->mac);
103 104 105
    }
}

106 107
static bool virtio_net_started(VirtIONet *n, uint8_t status)
{
108
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
109
    return (status & VIRTIO_CONFIG_S_DRIVER_OK) &&
110
        (n->status & VIRTIO_NET_S_LINK_UP) && vdev->vm_running;
111 112
}

J
Jason Wang 已提交
113 114 115 116 117 118 119 120 121 122
static void virtio_net_announce_timer(void *opaque)
{
    VirtIONet *n = opaque;
    VirtIODevice *vdev = VIRTIO_DEVICE(n);

    n->announce_counter--;
    n->status |= VIRTIO_NET_S_ANNOUNCE;
    virtio_notify_config(vdev);
}

123
static void virtio_net_vhost_status(VirtIONet *n, uint8_t status)
124
{
125
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
J
Jason Wang 已提交
126
    NetClientState *nc = qemu_get_queue(n->nic);
J
Jason Wang 已提交
127
    int queues = n->multiqueue ? n->max_queues : 1;
J
Jason Wang 已提交
128

129
    if (!get_vhost_net(nc->peer)) {
130 131
        return;
    }
J
Jason Wang 已提交
132

133 134
    if ((virtio_net_started(n, status) && !nc->peer->link_down) ==
        !!n->vhost_started) {
135 136 137
        return;
    }
    if (!n->vhost_started) {
138 139
        int r, i;

140 141 142 143 144 145 146
        if (n->needs_vnet_hdr_swap) {
            error_report("backend does not support %s vnet headers; "
                         "falling back on userspace virtio",
                         virtio_is_big_endian(vdev) ? "BE" : "LE");
            return;
        }

147 148 149 150 151 152 153 154 155 156 157
        /* Any packets outstanding? Purge them to avoid touching rings
         * when vhost is running.
         */
        for (i = 0;  i < queues; i++) {
            NetClientState *qnc = qemu_get_subqueue(n->nic, i);

            /* Purge both directions: TX and RX. */
            qemu_net_queue_purge(qnc->peer->incoming_queue, qnc);
            qemu_net_queue_purge(qnc->incoming_queue, qnc->peer);
        }

158 159 160 161 162 163 164 165 166 167
        if (virtio_has_feature(vdev->guest_features, VIRTIO_NET_F_MTU)) {
            r = vhost_net_set_mtu(get_vhost_net(nc->peer), n->net_conf.mtu);
            if (r < 0) {
                error_report("%uBytes MTU not supported by the backend",
                             n->net_conf.mtu);

                return;
            }
        }

168
        n->vhost_started = 1;
169
        r = vhost_net_start(vdev, n->nic->ncs, queues);
170
        if (r < 0) {
171 172
            error_report("unable to start vhost net: %d: "
                         "falling back on userspace virtio", -r);
173
            n->vhost_started = 0;
174 175
        }
    } else {
176
        vhost_net_stop(vdev, n->nic->ncs, queues);
177 178 179 180
        n->vhost_started = 0;
    }
}

181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233
static int virtio_net_set_vnet_endian_one(VirtIODevice *vdev,
                                          NetClientState *peer,
                                          bool enable)
{
    if (virtio_is_big_endian(vdev)) {
        return qemu_set_vnet_be(peer, enable);
    } else {
        return qemu_set_vnet_le(peer, enable);
    }
}

static bool virtio_net_set_vnet_endian(VirtIODevice *vdev, NetClientState *ncs,
                                       int queues, bool enable)
{
    int i;

    for (i = 0; i < queues; i++) {
        if (virtio_net_set_vnet_endian_one(vdev, ncs[i].peer, enable) < 0 &&
            enable) {
            while (--i >= 0) {
                virtio_net_set_vnet_endian_one(vdev, ncs[i].peer, false);
            }

            return true;
        }
    }

    return false;
}

static void virtio_net_vnet_endian_status(VirtIONet *n, uint8_t status)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
    int queues = n->multiqueue ? n->max_queues : 1;

    if (virtio_net_started(n, status)) {
        /* Before using the device, we tell the network backend about the
         * endianness to use when parsing vnet headers. If the backend
         * can't do it, we fallback onto fixing the headers in the core
         * virtio-net code.
         */
        n->needs_vnet_hdr_swap = virtio_net_set_vnet_endian(vdev, n->nic->ncs,
                                                            queues, true);
    } else if (virtio_net_started(n, vdev->status)) {
        /* After using the device, we need to reset the network backend to
         * the default (guest native endianness), otherwise the guest may
         * lose network connectivity if it is rebooted into a different
         * endianness.
         */
        virtio_net_set_vnet_endian(vdev, n->nic->ncs, queues, false);
    }
}

234 235 236 237 238 239 240 241
static void virtio_net_drop_tx_queue_data(VirtIODevice *vdev, VirtQueue *vq)
{
    unsigned int dropped = virtqueue_drop_all(vq);
    if (dropped) {
        virtio_notify(vdev, vq);
    }
}

242 243
static void virtio_net_set_status(struct VirtIODevice *vdev, uint8_t status)
{
244
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
245 246 247
    VirtIONetQueue *q;
    int i;
    uint8_t queue_status;
248

249
    virtio_net_vnet_endian_status(n, status);
250 251
    virtio_net_vhost_status(n, status);

J
Jason Wang 已提交
252
    for (i = 0; i < n->max_queues; i++) {
253 254
        NetClientState *ncs = qemu_get_subqueue(n->nic, i);
        bool queue_started;
J
Jason Wang 已提交
255
        q = &n->vqs[i];
256

J
Jason Wang 已提交
257 258
        if ((!n->multiqueue && i != 0) || i >= n->curr_queues) {
            queue_status = 0;
259
        } else {
J
Jason Wang 已提交
260
            queue_status = status;
261
        }
262 263 264 265 266 267
        queue_started =
            virtio_net_started(n, queue_status) && !n->vhost_started;

        if (queue_started) {
            qemu_flush_queued_packets(ncs);
        }
J
Jason Wang 已提交
268 269 270 271 272

        if (!q->tx_waiting) {
            continue;
        }

273
        if (queue_started) {
J
Jason Wang 已提交
274
            if (q->tx_timer) {
275 276
                timer_mod(q->tx_timer,
                               qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + n->tx_timeout);
J
Jason Wang 已提交
277 278 279
            } else {
                qemu_bh_schedule(q->tx_bh);
            }
280
        } else {
J
Jason Wang 已提交
281
            if (q->tx_timer) {
282
                timer_del(q->tx_timer);
J
Jason Wang 已提交
283 284 285
            } else {
                qemu_bh_cancel(q->tx_bh);
            }
286 287 288 289 290 291 292 293
            if ((n->status & VIRTIO_NET_S_LINK_UP) == 0 &&
                (queue_status & VIRTIO_CONFIG_S_DRIVER_OK)) {
                /* if tx is waiting we are likely have some packets in tx queue
                 * and disabled notification */
                q->tx_waiting = 0;
                virtio_queue_set_notification(q->tx_vq, 1);
                virtio_net_drop_tx_queue_data(vdev, q->tx_vq);
            }
294 295 296 297
        }
    }
}

298
static void virtio_net_set_link_status(NetClientState *nc)
299
{
J
Jason Wang 已提交
300
    VirtIONet *n = qemu_get_nic_opaque(nc);
301
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
302 303
    uint16_t old_status = n->status;

M
Mark McLoughlin 已提交
304
    if (nc->link_down)
305 306 307 308 309
        n->status &= ~VIRTIO_NET_S_LINK_UP;
    else
        n->status |= VIRTIO_NET_S_LINK_UP;

    if (n->status != old_status)
310
        virtio_notify_config(vdev);
311

312
    virtio_net_set_status(vdev, vdev->status);
313 314
}

315 316 317 318 319
static void rxfilter_notify(NetClientState *nc)
{
    VirtIONet *n = qemu_get_nic_opaque(nc);

    if (nc->rxfilter_notify_enabled) {
320
        gchar *path = object_get_canonical_path(OBJECT(n->qdev));
321 322
        qapi_event_send_nic_rx_filter_changed(!!n->netclient_name,
                                              n->netclient_name, path, &error_abort);
323
        g_free(path);
324 325 326 327 328 329

        /* disable event notification to avoid events flooding */
        nc->rxfilter_notify_enabled = 0;
    }
}

330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349
static intList *get_vlan_table(VirtIONet *n)
{
    intList *list, *entry;
    int i, j;

    list = NULL;
    for (i = 0; i < MAX_VLAN >> 5; i++) {
        for (j = 0; n->vlans[i] && j <= 0x1f; j++) {
            if (n->vlans[i] & (1U << j)) {
                entry = g_malloc0(sizeof(*entry));
                entry->value = (i << 5) + j;
                entry->next = list;
                list = entry;
            }
        }
    }

    return list;
}

350 351 352
static RxFilterInfo *virtio_net_query_rxfilter(NetClientState *nc)
{
    VirtIONet *n = qemu_get_nic_opaque(nc);
353
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
354 355
    RxFilterInfo *info;
    strList *str_list, *entry;
356
    int i;
357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381

    info = g_malloc0(sizeof(*info));
    info->name = g_strdup(nc->name);
    info->promiscuous = n->promisc;

    if (n->nouni) {
        info->unicast = RX_STATE_NONE;
    } else if (n->alluni) {
        info->unicast = RX_STATE_ALL;
    } else {
        info->unicast = RX_STATE_NORMAL;
    }

    if (n->nomulti) {
        info->multicast = RX_STATE_NONE;
    } else if (n->allmulti) {
        info->multicast = RX_STATE_ALL;
    } else {
        info->multicast = RX_STATE_NORMAL;
    }

    info->broadcast_allowed = n->nobcast;
    info->multicast_overflow = n->mac_table.multi_overflow;
    info->unicast_overflow = n->mac_table.uni_overflow;

382
    info->main_mac = qemu_mac_strdup_printf(n->mac);
383 384 385 386

    str_list = NULL;
    for (i = 0; i < n->mac_table.first_multi; i++) {
        entry = g_malloc0(sizeof(*entry));
387
        entry->value = qemu_mac_strdup_printf(n->mac_table.macs + i * ETH_ALEN);
388 389 390 391 392 393 394 395
        entry->next = str_list;
        str_list = entry;
    }
    info->unicast_table = str_list;

    str_list = NULL;
    for (i = n->mac_table.first_multi; i < n->mac_table.in_use; i++) {
        entry = g_malloc0(sizeof(*entry));
396
        entry->value = qemu_mac_strdup_printf(n->mac_table.macs + i * ETH_ALEN);
397 398 399 400
        entry->next = str_list;
        str_list = entry;
    }
    info->multicast_table = str_list;
401
    info->vlan_table = get_vlan_table(n);
402

403
    if (!virtio_vdev_has_feature(vdev, VIRTIO_NET_F_CTRL_VLAN)) {
404 405 406 407 408
        info->vlan = RX_STATE_ALL;
    } else if (!info->vlan_table) {
        info->vlan = RX_STATE_NONE;
    } else {
        info->vlan = RX_STATE_NORMAL;
409 410 411 412 413 414 415 416
    }

    /* enable event notification after query */
    nc->rxfilter_notify_enabled = 1;

    return info;
}

417 418
static void virtio_net_reset(VirtIODevice *vdev)
{
419
    VirtIONet *n = VIRTIO_NET(vdev);
420 421 422 423

    /* Reset back to compatibility mode */
    n->promisc = 1;
    n->allmulti = 0;
424 425 426 427
    n->alluni = 0;
    n->nomulti = 0;
    n->nouni = 0;
    n->nobcast = 0;
J
Jason Wang 已提交
428 429
    /* multiqueue is disabled by default */
    n->curr_queues = 1;
J
Jason Wang 已提交
430 431 432
    timer_del(n->announce_timer);
    n->announce_counter = 0;
    n->status &= ~VIRTIO_NET_S_ANNOUNCE;
433

434
    /* Flush any MAC and VLAN filter table state */
435
    n->mac_table.in_use = 0;
436
    n->mac_table.first_multi = 0;
437 438
    n->mac_table.multi_overflow = 0;
    n->mac_table.uni_overflow = 0;
439
    memset(n->mac_table.macs, 0, MAC_TABLE_ENTRIES * ETH_ALEN);
440
    memcpy(&n->mac[0], &n->nic->conf->macaddr, sizeof(n->mac));
441
    qemu_format_nic_info_str(qemu_get_queue(n->nic), n->mac);
442
    memset(n->vlans, 0, MAX_VLAN >> 3);
443 444
}

445
static void peer_test_vnet_hdr(VirtIONet *n)
M
Mark McLoughlin 已提交
446
{
J
Jason Wang 已提交
447 448
    NetClientState *nc = qemu_get_queue(n->nic);
    if (!nc->peer) {
449
        return;
J
Jason Wang 已提交
450
    }
M
Mark McLoughlin 已提交
451

452
    n->has_vnet_hdr = qemu_has_vnet_hdr(nc->peer);
453
}
M
Mark McLoughlin 已提交
454

455 456
static int peer_has_vnet_hdr(VirtIONet *n)
{
M
Mark McLoughlin 已提交
457 458 459
    return n->has_vnet_hdr;
}

460 461 462 463 464
static int peer_has_ufo(VirtIONet *n)
{
    if (!peer_has_vnet_hdr(n))
        return 0;

465
    n->has_ufo = qemu_has_ufo(qemu_get_queue(n->nic)->peer);
466 467 468 469

    return n->has_ufo;
}

470 471
static void virtio_net_set_mrg_rx_bufs(VirtIONet *n, int mergeable_rx_bufs,
                                       int version_1)
472
{
J
Jason Wang 已提交
473 474 475
    int i;
    NetClientState *nc;

476 477
    n->mergeable_rx_bufs = mergeable_rx_bufs;

478 479 480 481 482 483 484
    if (version_1) {
        n->guest_hdr_len = sizeof(struct virtio_net_hdr_mrg_rxbuf);
    } else {
        n->guest_hdr_len = n->mergeable_rx_bufs ?
            sizeof(struct virtio_net_hdr_mrg_rxbuf) :
            sizeof(struct virtio_net_hdr);
    }
485

J
Jason Wang 已提交
486 487 488 489
    for (i = 0; i < n->max_queues; i++) {
        nc = qemu_get_subqueue(n->nic, i);

        if (peer_has_vnet_hdr(n) &&
490 491
            qemu_has_vnet_hdr_len(nc->peer, n->guest_hdr_len)) {
            qemu_set_vnet_hdr_len(nc->peer, n->guest_hdr_len);
J
Jason Wang 已提交
492 493
            n->host_hdr_len = n->guest_hdr_len;
        }
494 495 496
    }
}

J
Jason Wang 已提交
497 498 499 500 501 502 503 504
static int peer_attach(VirtIONet *n, int index)
{
    NetClientState *nc = qemu_get_subqueue(n->nic, index);

    if (!nc->peer) {
        return 0;
    }

505
    if (nc->peer->info->type == NET_CLIENT_DRIVER_VHOST_USER) {
506 507 508
        vhost_set_vring_enable(nc->peer, 1);
    }

509
    if (nc->peer->info->type != NET_CLIENT_DRIVER_TAP) {
J
Jason Wang 已提交
510 511 512
        return 0;
    }

513 514 515 516
    if (n->max_queues == 1) {
        return 0;
    }

J
Jason Wang 已提交
517 518 519 520 521 522 523 524 525 526 527
    return tap_enable(nc->peer);
}

static int peer_detach(VirtIONet *n, int index)
{
    NetClientState *nc = qemu_get_subqueue(n->nic, index);

    if (!nc->peer) {
        return 0;
    }

528
    if (nc->peer->info->type == NET_CLIENT_DRIVER_VHOST_USER) {
529 530 531
        vhost_set_vring_enable(nc->peer, 0);
    }

532
    if (nc->peer->info->type !=  NET_CLIENT_DRIVER_TAP) {
J
Jason Wang 已提交
533 534 535 536 537 538 539 540 541
        return 0;
    }

    return tap_disable(nc->peer);
}

static void virtio_net_set_queues(VirtIONet *n)
{
    int i;
542
    int r;
J
Jason Wang 已提交
543

544 545 546 547
    if (n->nic->peer_deleted) {
        return;
    }

J
Jason Wang 已提交
548 549
    for (i = 0; i < n->max_queues; i++) {
        if (i < n->curr_queues) {
550 551
            r = peer_attach(n, i);
            assert(!r);
J
Jason Wang 已提交
552
        } else {
553 554
            r = peer_detach(n, i);
            assert(!r);
J
Jason Wang 已提交
555 556 557 558
        }
    }
}

J
Jason Wang 已提交
559
static void virtio_net_set_multiqueue(VirtIONet *n, int multiqueue);
J
Jason Wang 已提交
560

J
Jason Wang 已提交
561 562
static uint64_t virtio_net_get_features(VirtIODevice *vdev, uint64_t features,
                                        Error **errp)
A
aliguori 已提交
563
{
564
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
565
    NetClientState *nc = qemu_get_queue(n->nic);
A
aliguori 已提交
566

567 568 569
    /* Firstly sync all virtio-net possible supported features */
    features |= n->host_features;

570
    virtio_add_feature(&features, VIRTIO_NET_F_MAC);
571

572
    if (!peer_has_vnet_hdr(n)) {
573 574 575 576
        virtio_clear_feature(&features, VIRTIO_NET_F_CSUM);
        virtio_clear_feature(&features, VIRTIO_NET_F_HOST_TSO4);
        virtio_clear_feature(&features, VIRTIO_NET_F_HOST_TSO6);
        virtio_clear_feature(&features, VIRTIO_NET_F_HOST_ECN);
577

578 579 580 581
        virtio_clear_feature(&features, VIRTIO_NET_F_GUEST_CSUM);
        virtio_clear_feature(&features, VIRTIO_NET_F_GUEST_TSO4);
        virtio_clear_feature(&features, VIRTIO_NET_F_GUEST_TSO6);
        virtio_clear_feature(&features, VIRTIO_NET_F_GUEST_ECN);
582
    }
M
Mark McLoughlin 已提交
583

584
    if (!peer_has_vnet_hdr(n) || !peer_has_ufo(n)) {
585 586
        virtio_clear_feature(&features, VIRTIO_NET_F_GUEST_UFO);
        virtio_clear_feature(&features, VIRTIO_NET_F_HOST_UFO);
M
Mark McLoughlin 已提交
587 588
    }

589
    if (!get_vhost_net(nc->peer)) {
590 591
        return features;
    }
592
    return vhost_net_get_features(get_vhost_net(nc->peer), features);
A
aliguori 已提交
593 594
}

G
Gerd Hoffmann 已提交
595
static uint64_t virtio_net_bad_features(VirtIODevice *vdev)
596
{
G
Gerd Hoffmann 已提交
597
    uint64_t features = 0;
598 599 600

    /* Linux kernel 2.6.25.  It understood MAC (as everyone must),
     * but also these: */
601 602 603 604 605
    virtio_add_feature(&features, VIRTIO_NET_F_MAC);
    virtio_add_feature(&features, VIRTIO_NET_F_CSUM);
    virtio_add_feature(&features, VIRTIO_NET_F_HOST_TSO4);
    virtio_add_feature(&features, VIRTIO_NET_F_HOST_TSO6);
    virtio_add_feature(&features, VIRTIO_NET_F_HOST_ECN);
606

607
    return features;
608 609
}

610 611
static void virtio_net_apply_guest_offloads(VirtIONet *n)
{
612
    qemu_set_offload(qemu_get_queue(n->nic)->peer,
613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637
            !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_CSUM)),
            !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_TSO4)),
            !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_TSO6)),
            !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_ECN)),
            !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_UFO)));
}

static uint64_t virtio_net_guest_offloads_by_features(uint32_t features)
{
    static const uint64_t guest_offloads_mask =
        (1ULL << VIRTIO_NET_F_GUEST_CSUM) |
        (1ULL << VIRTIO_NET_F_GUEST_TSO4) |
        (1ULL << VIRTIO_NET_F_GUEST_TSO6) |
        (1ULL << VIRTIO_NET_F_GUEST_ECN)  |
        (1ULL << VIRTIO_NET_F_GUEST_UFO);

    return guest_offloads_mask & features;
}

static inline uint64_t virtio_net_supported_guest_offloads(VirtIONet *n)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
    return virtio_net_guest_offloads_by_features(vdev->guest_features);
}

G
Gerd Hoffmann 已提交
638
static void virtio_net_set_features(VirtIODevice *vdev, uint64_t features)
A
aliguori 已提交
639
{
640
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
641 642
    int i;

643
    virtio_net_set_multiqueue(n,
644
                              virtio_has_feature(features, VIRTIO_NET_F_MQ));
A
aliguori 已提交
645

646
    virtio_net_set_mrg_rx_bufs(n,
647 648 649 650
                               virtio_has_feature(features,
                                                  VIRTIO_NET_F_MRG_RXBUF),
                               virtio_has_feature(features,
                                                  VIRTIO_F_VERSION_1));
651 652

    if (n->has_vnet_hdr) {
653 654 655
        n->curr_guest_offloads =
            virtio_net_guest_offloads_by_features(features);
        virtio_net_apply_guest_offloads(n);
656
    }
J
Jason Wang 已提交
657 658 659 660

    for (i = 0;  i < n->max_queues; i++) {
        NetClientState *nc = qemu_get_subqueue(n->nic, i);

661
        if (!get_vhost_net(nc->peer)) {
J
Jason Wang 已提交
662 663
            continue;
        }
664
        vhost_net_ack_features(get_vhost_net(nc->peer), features);
D
David L Stevens 已提交
665
    }
666

667
    if (virtio_has_feature(features, VIRTIO_NET_F_CTRL_VLAN)) {
668 669 670 671
        memset(n->vlans, 0, MAX_VLAN >> 3);
    } else {
        memset(n->vlans, 0xff, MAX_VLAN >> 3);
    }
A
aliguori 已提交
672 673
}

674
static int virtio_net_handle_rx_mode(VirtIONet *n, uint8_t cmd,
675
                                     struct iovec *iov, unsigned int iov_cnt)
676 677
{
    uint8_t on;
678
    size_t s;
679
    NetClientState *nc = qemu_get_queue(n->nic);
680

681 682 683
    s = iov_to_buf(iov, iov_cnt, 0, &on, sizeof(on));
    if (s != sizeof(on)) {
        return VIRTIO_NET_ERR;
684 685
    }

A
Amos Kong 已提交
686
    if (cmd == VIRTIO_NET_CTRL_RX_PROMISC) {
687
        n->promisc = on;
A
Amos Kong 已提交
688
    } else if (cmd == VIRTIO_NET_CTRL_RX_ALLMULTI) {
689
        n->allmulti = on;
A
Amos Kong 已提交
690
    } else if (cmd == VIRTIO_NET_CTRL_RX_ALLUNI) {
691
        n->alluni = on;
A
Amos Kong 已提交
692
    } else if (cmd == VIRTIO_NET_CTRL_RX_NOMULTI) {
693
        n->nomulti = on;
A
Amos Kong 已提交
694
    } else if (cmd == VIRTIO_NET_CTRL_RX_NOUNI) {
695
        n->nouni = on;
A
Amos Kong 已提交
696
    } else if (cmd == VIRTIO_NET_CTRL_RX_NOBCAST) {
697
        n->nobcast = on;
698
    } else {
699
        return VIRTIO_NET_ERR;
700
    }
701

702 703
    rxfilter_notify(nc);

704 705 706
    return VIRTIO_NET_OK;
}

707 708 709 710 711 712 713
static int virtio_net_handle_offloads(VirtIONet *n, uint8_t cmd,
                                     struct iovec *iov, unsigned int iov_cnt)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
    uint64_t offloads;
    size_t s;

714
    if (!virtio_vdev_has_feature(vdev, VIRTIO_NET_F_CTRL_GUEST_OFFLOADS)) {
715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743
        return VIRTIO_NET_ERR;
    }

    s = iov_to_buf(iov, iov_cnt, 0, &offloads, sizeof(offloads));
    if (s != sizeof(offloads)) {
        return VIRTIO_NET_ERR;
    }

    if (cmd == VIRTIO_NET_CTRL_GUEST_OFFLOADS_SET) {
        uint64_t supported_offloads;

        if (!n->has_vnet_hdr) {
            return VIRTIO_NET_ERR;
        }

        supported_offloads = virtio_net_supported_guest_offloads(n);
        if (offloads & ~supported_offloads) {
            return VIRTIO_NET_ERR;
        }

        n->curr_guest_offloads = offloads;
        virtio_net_apply_guest_offloads(n);

        return VIRTIO_NET_OK;
    } else {
        return VIRTIO_NET_ERR;
    }
}

744
static int virtio_net_handle_mac(VirtIONet *n, uint8_t cmd,
745
                                 struct iovec *iov, unsigned int iov_cnt)
746
{
747
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
748
    struct virtio_net_ctrl_mac mac_data;
749
    size_t s;
750
    NetClientState *nc = qemu_get_queue(n->nic);
751

752 753 754 755 756 757
    if (cmd == VIRTIO_NET_CTRL_MAC_ADDR_SET) {
        if (iov_size(iov, iov_cnt) != sizeof(n->mac)) {
            return VIRTIO_NET_ERR;
        }
        s = iov_to_buf(iov, iov_cnt, 0, &n->mac, sizeof(n->mac));
        assert(s == sizeof(n->mac));
J
Jason Wang 已提交
758
        qemu_format_nic_info_str(qemu_get_queue(n->nic), n->mac);
759 760
        rxfilter_notify(nc);

761 762 763
        return VIRTIO_NET_OK;
    }

764
    if (cmd != VIRTIO_NET_CTRL_MAC_TABLE_SET) {
765
        return VIRTIO_NET_ERR;
766
    }
767

768 769 770 771 772
    int in_use = 0;
    int first_multi = 0;
    uint8_t uni_overflow = 0;
    uint8_t multi_overflow = 0;
    uint8_t *macs = g_malloc0(MAC_TABLE_ENTRIES * ETH_ALEN);
773

774 775
    s = iov_to_buf(iov, iov_cnt, 0, &mac_data.entries,
                   sizeof(mac_data.entries));
776
    mac_data.entries = virtio_ldl_p(vdev, &mac_data.entries);
777
    if (s != sizeof(mac_data.entries)) {
778
        goto error;
779 780
    }
    iov_discard_front(&iov, &iov_cnt, s);
781

782
    if (mac_data.entries * ETH_ALEN > iov_size(iov, iov_cnt)) {
783
        goto error;
784
    }
785 786

    if (mac_data.entries <= MAC_TABLE_ENTRIES) {
787
        s = iov_to_buf(iov, iov_cnt, 0, macs,
788 789
                       mac_data.entries * ETH_ALEN);
        if (s != mac_data.entries * ETH_ALEN) {
790
            goto error;
791
        }
792
        in_use += mac_data.entries;
793
    } else {
794
        uni_overflow = 1;
795 796
    }

797 798
    iov_discard_front(&iov, &iov_cnt, mac_data.entries * ETH_ALEN);

799
    first_multi = in_use;
800

801 802
    s = iov_to_buf(iov, iov_cnt, 0, &mac_data.entries,
                   sizeof(mac_data.entries));
803
    mac_data.entries = virtio_ldl_p(vdev, &mac_data.entries);
804
    if (s != sizeof(mac_data.entries)) {
805
        goto error;
806 807 808
    }

    iov_discard_front(&iov, &iov_cnt, s);
809

810
    if (mac_data.entries * ETH_ALEN != iov_size(iov, iov_cnt)) {
811
        goto error;
812
    }
813

814
    if (mac_data.entries <= MAC_TABLE_ENTRIES - in_use) {
815
        s = iov_to_buf(iov, iov_cnt, 0, &macs[in_use * ETH_ALEN],
816 817
                       mac_data.entries * ETH_ALEN);
        if (s != mac_data.entries * ETH_ALEN) {
818
            goto error;
819
        }
820
        in_use += mac_data.entries;
821
    } else {
822
        multi_overflow = 1;
823 824
    }

825 826 827 828 829 830
    n->mac_table.in_use = in_use;
    n->mac_table.first_multi = first_multi;
    n->mac_table.uni_overflow = uni_overflow;
    n->mac_table.multi_overflow = multi_overflow;
    memcpy(n->mac_table.macs, macs, MAC_TABLE_ENTRIES * ETH_ALEN);
    g_free(macs);
831 832
    rxfilter_notify(nc);

833
    return VIRTIO_NET_OK;
834 835

error:
836
    g_free(macs);
837
    return VIRTIO_NET_ERR;
838 839
}

840
static int virtio_net_handle_vlan_table(VirtIONet *n, uint8_t cmd,
841
                                        struct iovec *iov, unsigned int iov_cnt)
842
{
843
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
844
    uint16_t vid;
845
    size_t s;
846
    NetClientState *nc = qemu_get_queue(n->nic);
847

848
    s = iov_to_buf(iov, iov_cnt, 0, &vid, sizeof(vid));
849
    vid = virtio_lduw_p(vdev, &vid);
850
    if (s != sizeof(vid)) {
851 852 853 854 855 856 857 858 859 860 861 862 863
        return VIRTIO_NET_ERR;
    }

    if (vid >= MAX_VLAN)
        return VIRTIO_NET_ERR;

    if (cmd == VIRTIO_NET_CTRL_VLAN_ADD)
        n->vlans[vid >> 5] |= (1U << (vid & 0x1f));
    else if (cmd == VIRTIO_NET_CTRL_VLAN_DEL)
        n->vlans[vid >> 5] &= ~(1U << (vid & 0x1f));
    else
        return VIRTIO_NET_ERR;

864 865
    rxfilter_notify(nc);

866 867 868
    return VIRTIO_NET_OK;
}

J
Jason Wang 已提交
869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885
static int virtio_net_handle_announce(VirtIONet *n, uint8_t cmd,
                                      struct iovec *iov, unsigned int iov_cnt)
{
    if (cmd == VIRTIO_NET_CTRL_ANNOUNCE_ACK &&
        n->status & VIRTIO_NET_S_ANNOUNCE) {
        n->status &= ~VIRTIO_NET_S_ANNOUNCE;
        if (n->announce_counter) {
            timer_mod(n->announce_timer,
                      qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) +
                      self_announce_delay(n->announce_counter));
        }
        return VIRTIO_NET_OK;
    } else {
        return VIRTIO_NET_ERR;
    }
}

J
Jason Wang 已提交
886
static int virtio_net_handle_mq(VirtIONet *n, uint8_t cmd,
887
                                struct iovec *iov, unsigned int iov_cnt)
J
Jason Wang 已提交
888
{
889
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
890 891 892
    struct virtio_net_ctrl_mq mq;
    size_t s;
    uint16_t queues;
J
Jason Wang 已提交
893

894 895
    s = iov_to_buf(iov, iov_cnt, 0, &mq, sizeof(mq));
    if (s != sizeof(mq)) {
J
Jason Wang 已提交
896 897 898 899 900 901 902
        return VIRTIO_NET_ERR;
    }

    if (cmd != VIRTIO_NET_CTRL_MQ_VQ_PAIRS_SET) {
        return VIRTIO_NET_ERR;
    }

903
    queues = virtio_lduw_p(vdev, &mq.virtqueue_pairs);
J
Jason Wang 已提交
904

905 906 907
    if (queues < VIRTIO_NET_CTRL_MQ_VQ_PAIRS_MIN ||
        queues > VIRTIO_NET_CTRL_MQ_VQ_PAIRS_MAX ||
        queues > n->max_queues ||
J
Jason Wang 已提交
908 909 910 911
        !n->multiqueue) {
        return VIRTIO_NET_ERR;
    }

912
    n->curr_queues = queues;
J
Jason Wang 已提交
913 914
    /* stop the backend before changing the number of queues to avoid handling a
     * disabled queue */
915
    virtio_net_set_status(vdev, vdev->status);
J
Jason Wang 已提交
916 917 918 919
    virtio_net_set_queues(n);

    return VIRTIO_NET_OK;
}
920

921 922
static void virtio_net_handle_ctrl(VirtIODevice *vdev, VirtQueue *vq)
{
923
    VirtIONet *n = VIRTIO_NET(vdev);
924 925
    struct virtio_net_ctrl_hdr ctrl;
    virtio_net_ctrl_ack status = VIRTIO_NET_ERR;
926
    VirtQueueElement *elem;
927
    size_t s;
J
Jason Wang 已提交
928
    struct iovec *iov, *iov2;
929
    unsigned int iov_cnt;
930

931 932 933 934 935 936 937
    for (;;) {
        elem = virtqueue_pop(vq, sizeof(VirtQueueElement));
        if (!elem) {
            break;
        }
        if (iov_size(elem->in_sg, elem->in_num) < sizeof(status) ||
            iov_size(elem->out_sg, elem->out_num) < sizeof(ctrl)) {
938 939 940 941
            virtio_error(vdev, "virtio-net ctrl missing headers");
            virtqueue_detach_element(vq, elem, 0);
            g_free(elem);
            break;
942 943
        }

944 945
        iov_cnt = elem->out_num;
        iov2 = iov = g_memdup(elem->out_sg, sizeof(struct iovec) * elem->out_num);
946 947 948 949
        s = iov_to_buf(iov, iov_cnt, 0, &ctrl, sizeof(ctrl));
        iov_discard_front(&iov, &iov_cnt, sizeof(ctrl));
        if (s != sizeof(ctrl)) {
            status = VIRTIO_NET_ERR;
A
Amos Kong 已提交
950
        } else if (ctrl.class == VIRTIO_NET_CTRL_RX) {
951 952 953 954 955
            status = virtio_net_handle_rx_mode(n, ctrl.cmd, iov, iov_cnt);
        } else if (ctrl.class == VIRTIO_NET_CTRL_MAC) {
            status = virtio_net_handle_mac(n, ctrl.cmd, iov, iov_cnt);
        } else if (ctrl.class == VIRTIO_NET_CTRL_VLAN) {
            status = virtio_net_handle_vlan_table(n, ctrl.cmd, iov, iov_cnt);
J
Jason Wang 已提交
956 957
        } else if (ctrl.class == VIRTIO_NET_CTRL_ANNOUNCE) {
            status = virtio_net_handle_announce(n, ctrl.cmd, iov, iov_cnt);
J
Jason Wang 已提交
958
        } else if (ctrl.class == VIRTIO_NET_CTRL_MQ) {
959
            status = virtio_net_handle_mq(n, ctrl.cmd, iov, iov_cnt);
960 961
        } else if (ctrl.class == VIRTIO_NET_CTRL_GUEST_OFFLOADS) {
            status = virtio_net_handle_offloads(n, ctrl.cmd, iov, iov_cnt);
962 963
        }

964
        s = iov_from_buf(elem->in_sg, elem->in_num, 0, &status, sizeof(status));
965
        assert(s == sizeof(status));
966

967
        virtqueue_push(vq, elem, sizeof(status));
968
        virtio_notify(vdev, vq);
J
Jason Wang 已提交
969
        g_free(iov2);
970
        g_free(elem);
971 972 973
    }
}

A
aliguori 已提交
974 975 976 977
/* RX */

static void virtio_net_handle_rx(VirtIODevice *vdev, VirtQueue *vq)
{
978
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
979
    int queue_index = vq2q(virtio_get_queue_index(vq));
980

J
Jason Wang 已提交
981
    qemu_flush_queued_packets(qemu_get_subqueue(n->nic, queue_index));
A
aliguori 已提交
982 983
}

984
static int virtio_net_can_receive(NetClientState *nc)
A
aliguori 已提交
985
{
J
Jason Wang 已提交
986
    VirtIONet *n = qemu_get_nic_opaque(nc);
987
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
J
Jason Wang 已提交
988
    VirtIONetQueue *q = virtio_net_get_subqueue(nc);
989

990
    if (!vdev->vm_running) {
991 992
        return 0;
    }
993

J
Jason Wang 已提交
994 995 996 997
    if (nc->queue_index >= n->curr_queues) {
        return 0;
    }

998
    if (!virtio_queue_ready(q->rx_vq) ||
999
        !(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
A
aliguori 已提交
1000
        return 0;
1001
    }
A
aliguori 已提交
1002

1003 1004 1005
    return 1;
}

1006
static int virtio_net_has_buffers(VirtIONetQueue *q, int bufsize)
1007
{
1008 1009
    VirtIONet *n = q->n;
    if (virtio_queue_empty(q->rx_vq) ||
A
aliguori 已提交
1010
        (n->mergeable_rx_bufs &&
1011 1012
         !virtqueue_avail_bytes(q->rx_vq, bufsize, 0))) {
        virtio_queue_set_notification(q->rx_vq, 1);
1013 1014 1015 1016 1017

        /* To avoid a race condition where the guest has made some buffers
         * available after the above check but before notification was
         * enabled, check for available buffers again.
         */
1018
        if (virtio_queue_empty(q->rx_vq) ||
1019
            (n->mergeable_rx_bufs &&
1020
             !virtqueue_avail_bytes(q->rx_vq, bufsize, 0))) {
1021
            return 0;
1022
        }
A
aliguori 已提交
1023 1024
    }

1025
    virtio_queue_set_notification(q->rx_vq, 0);
A
aliguori 已提交
1026 1027 1028
    return 1;
}

1029
static void virtio_net_hdr_swap(VirtIODevice *vdev, struct virtio_net_hdr *hdr)
1030
{
1031 1032 1033 1034
    virtio_tswap16s(vdev, &hdr->hdr_len);
    virtio_tswap16s(vdev, &hdr->gso_size);
    virtio_tswap16s(vdev, &hdr->csum_start);
    virtio_tswap16s(vdev, &hdr->csum_offset);
1035 1036
}

A
Anthony Liguori 已提交
1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051
/* dhclient uses AF_PACKET but doesn't pass auxdata to the kernel so
 * it never finds out that the packets don't have valid checksums.  This
 * causes dhclient to get upset.  Fedora's carried a patch for ages to
 * fix this with Xen but it hasn't appeared in an upstream release of
 * dhclient yet.
 *
 * To avoid breaking existing guests, we catch udp packets and add
 * checksums.  This is terrible but it's better than hacking the guest
 * kernels.
 *
 * N.B. if we introduce a zero-copy API, this operation is no longer free so
 * we should provide a mechanism to disable it to avoid polluting the host
 * cache.
 */
static void work_around_broken_dhclient(struct virtio_net_hdr *hdr,
M
Michael S. Tsirkin 已提交
1052
                                        uint8_t *buf, size_t size)
A
Anthony Liguori 已提交
1053 1054 1055 1056 1057 1058
{
    if ((hdr->flags & VIRTIO_NET_HDR_F_NEEDS_CSUM) && /* missing csum */
        (size > 27 && size < 1500) && /* normal sized MTU */
        (buf[12] == 0x08 && buf[13] == 0x00) && /* ethertype == IPv4 */
        (buf[23] == 17) && /* ip.protocol == UDP */
        (buf[34] == 0 && buf[35] == 67)) { /* udp.srcport == bootps */
M
Michael S. Tsirkin 已提交
1059
        net_checksum_calculate(buf, size);
A
Anthony Liguori 已提交
1060 1061 1062 1063
        hdr->flags &= ~VIRTIO_NET_HDR_F_NEEDS_CSUM;
    }
}

1064 1065
static void receive_header(VirtIONet *n, const struct iovec *iov, int iov_cnt,
                           const void *buf, size_t size)
A
aliguori 已提交
1066
{
M
Mark McLoughlin 已提交
1067
    if (n->has_vnet_hdr) {
M
Michael S. Tsirkin 已提交
1068 1069
        /* FIXME this cast is evil */
        void *wbuf = (void *)buf;
1070 1071
        work_around_broken_dhclient(wbuf, wbuf + n->host_hdr_len,
                                    size - n->host_hdr_len);
1072 1073 1074 1075

        if (n->needs_vnet_hdr_swap) {
            virtio_net_hdr_swap(VIRTIO_DEVICE(n), wbuf);
        }
1076
        iov_from_buf(iov, iov_cnt, 0, buf, sizeof(struct virtio_net_hdr));
M
Michael S. Tsirkin 已提交
1077 1078 1079 1080 1081 1082
    } else {
        struct virtio_net_hdr hdr = {
            .flags = 0,
            .gso_type = VIRTIO_NET_HDR_GSO_NONE
        };
        iov_from_buf(iov, iov_cnt, 0, &hdr, sizeof hdr);
M
Mark McLoughlin 已提交
1083
    }
A
aliguori 已提交
1084 1085
}

1086 1087 1088
static int receive_filter(VirtIONet *n, const uint8_t *buf, int size)
{
    static const uint8_t bcast[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
1089
    static const uint8_t vlan[] = {0x81, 0x00};
1090
    uint8_t *ptr = (uint8_t *)buf;
1091
    int i;
1092 1093 1094 1095

    if (n->promisc)
        return 1;

1096
    ptr += n->host_hdr_len;
M
Mark McLoughlin 已提交
1097

1098
    if (!memcmp(&ptr[12], vlan, sizeof(vlan))) {
1099
        int vid = lduw_be_p(ptr + 14) & 0xfff;
1100 1101 1102 1103
        if (!(n->vlans[vid >> 5] & (1U << (vid & 0x1f))))
            return 0;
    }

1104 1105
    if (ptr[0] & 1) { // multicast
        if (!memcmp(ptr, bcast, sizeof(bcast))) {
1106 1107 1108
            return !n->nobcast;
        } else if (n->nomulti) {
            return 0;
1109
        } else if (n->allmulti || n->mac_table.multi_overflow) {
1110 1111
            return 1;
        }
1112 1113 1114 1115 1116 1117

        for (i = n->mac_table.first_multi; i < n->mac_table.in_use; i++) {
            if (!memcmp(ptr, &n->mac_table.macs[i * ETH_ALEN], ETH_ALEN)) {
                return 1;
            }
        }
1118
    } else { // unicast
1119 1120 1121
        if (n->nouni) {
            return 0;
        } else if (n->alluni || n->mac_table.uni_overflow) {
1122 1123
            return 1;
        } else if (!memcmp(ptr, n->mac, ETH_ALEN)) {
1124 1125
            return 1;
        }
1126

1127 1128 1129 1130 1131
        for (i = 0; i < n->mac_table.first_multi; i++) {
            if (!memcmp(ptr, &n->mac_table.macs[i * ETH_ALEN], ETH_ALEN)) {
                return 1;
            }
        }
1132 1133
    }

1134 1135 1136
    return 0;
}

1137 1138
static ssize_t virtio_net_receive_rcu(NetClientState *nc, const uint8_t *buf,
                                      size_t size)
A
aliguori 已提交
1139
{
J
Jason Wang 已提交
1140
    VirtIONet *n = qemu_get_nic_opaque(nc);
J
Jason Wang 已提交
1141
    VirtIONetQueue *q = virtio_net_get_subqueue(nc);
1142
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1143 1144 1145
    struct iovec mhdr_sg[VIRTQUEUE_MAX_SIZE];
    struct virtio_net_hdr_mrg_rxbuf mhdr;
    unsigned mhdr_cnt = 0;
M
Michael S. Tsirkin 已提交
1146
    size_t offset, i, guest_offset;
A
aliguori 已提交
1147

J
Jason Wang 已提交
1148
    if (!virtio_net_can_receive(nc)) {
1149
        return -1;
J
Jason Wang 已提交
1150
    }
1151

1152
    /* hdr_len refers to the header we supply to the guest */
1153
    if (!virtio_net_has_buffers(q, size + n->guest_hdr_len - n->host_hdr_len)) {
1154
        return 0;
1155
    }
A
aliguori 已提交
1156

1157
    if (!receive_filter(n, buf, size))
1158
        return size;
1159

A
aliguori 已提交
1160 1161 1162
    offset = i = 0;

    while (offset < size) {
1163
        VirtQueueElement *elem;
A
aliguori 已提交
1164
        int len, total;
1165
        const struct iovec *sg;
A
aliguori 已提交
1166

A
Amit Shah 已提交
1167
        total = 0;
A
aliguori 已提交
1168

1169 1170
        elem = virtqueue_pop(q->rx_vq, sizeof(VirtQueueElement));
        if (!elem) {
1171 1172 1173 1174 1175 1176 1177 1178 1179 1180
            if (i) {
                virtio_error(vdev, "virtio-net unexpected empty queue: "
                             "i %zd mergeable %d offset %zd, size %zd, "
                             "guest hdr len %zd, host hdr len %zd "
                             "guest features 0x%" PRIx64,
                             i, n->mergeable_rx_bufs, offset, size,
                             n->guest_hdr_len, n->host_hdr_len,
                             vdev->guest_features);
            }
            return -1;
A
aliguori 已提交
1181 1182
        }

1183
        if (elem->in_num < 1) {
1184 1185 1186 1187 1188
            virtio_error(vdev,
                         "virtio-net receive queue contains no in buffers");
            virtqueue_detach_element(q->rx_vq, elem, 0);
            g_free(elem);
            return -1;
A
aliguori 已提交
1189 1190
        }

1191
        sg = elem->in_sg;
A
aliguori 已提交
1192
        if (i == 0) {
1193
            assert(offset == 0);
1194 1195
            if (n->mergeable_rx_bufs) {
                mhdr_cnt = iov_copy(mhdr_sg, ARRAY_SIZE(mhdr_sg),
1196
                                    sg, elem->in_num,
1197 1198 1199
                                    offsetof(typeof(mhdr), num_buffers),
                                    sizeof(mhdr.num_buffers));
            }
A
aliguori 已提交
1200

1201
            receive_header(n, sg, elem->in_num, buf, size);
1202
            offset = n->host_hdr_len;
1203
            total += n->guest_hdr_len;
M
Michael S. Tsirkin 已提交
1204 1205 1206
            guest_offset = n->guest_hdr_len;
        } else {
            guest_offset = 0;
A
aliguori 已提交
1207 1208 1209
        }

        /* copy in packet.  ugh */
1210
        len = iov_from_buf(sg, elem->in_num, guest_offset,
1211
                           buf + offset, size - offset);
A
aliguori 已提交
1212
        total += len;
1213 1214 1215 1216 1217
        offset += len;
        /* If buffers can't be merged, at this point we
         * must have consumed the complete packet.
         * Otherwise, drop it. */
        if (!n->mergeable_rx_bufs && offset < size) {
1218
            virtqueue_unpop(q->rx_vq, elem, total);
1219
            g_free(elem);
1220 1221
            return size;
        }
A
aliguori 已提交
1222 1223

        /* signal other side */
1224 1225
        virtqueue_fill(q->rx_vq, elem, total, i++);
        g_free(elem);
A
aliguori 已提交
1226 1227
    }

1228
    if (mhdr_cnt) {
1229
        virtio_stw_p(vdev, &mhdr.num_buffers, i);
1230 1231 1232
        iov_from_buf(mhdr_sg, mhdr_cnt,
                     0,
                     &mhdr.num_buffers, sizeof mhdr.num_buffers);
1233
    }
A
aliguori 已提交
1234

1235
    virtqueue_flush(q->rx_vq, i);
1236
    virtio_notify(vdev, q->rx_vq);
1237 1238

    return size;
A
aliguori 已提交
1239 1240
}

1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251
static ssize_t virtio_net_receive(NetClientState *nc, const uint8_t *buf,
                                  size_t size)
{
    ssize_t r;

    rcu_read_lock();
    r = virtio_net_receive_rcu(nc, buf, size);
    rcu_read_unlock();
    return r;
}

1252
static int32_t virtio_net_flush_tx(VirtIONetQueue *q);
1253

1254
static void virtio_net_tx_complete(NetClientState *nc, ssize_t len)
1255
{
J
Jason Wang 已提交
1256
    VirtIONet *n = qemu_get_nic_opaque(nc);
J
Jason Wang 已提交
1257
    VirtIONetQueue *q = virtio_net_get_subqueue(nc);
1258
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1259

1260
    virtqueue_push(q->tx_vq, q->async_tx.elem, 0);
1261
    virtio_notify(vdev, q->tx_vq);
1262

1263 1264
    g_free(q->async_tx.elem);
    q->async_tx.elem = NULL;
1265

1266 1267
    virtio_queue_set_notification(q->tx_vq, 1);
    virtio_net_flush_tx(q);
1268 1269
}

A
aliguori 已提交
1270
/* TX */
1271
static int32_t virtio_net_flush_tx(VirtIONetQueue *q)
A
aliguori 已提交
1272
{
1273
    VirtIONet *n = q->n;
1274
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1275
    VirtQueueElement *elem;
1276
    int32_t num_packets = 0;
J
Jason Wang 已提交
1277
    int queue_index = vq2q(virtio_get_queue_index(q->tx_vq));
1278
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
1279 1280
        return num_packets;
    }
A
aliguori 已提交
1281

1282
    if (q->async_tx.elem) {
1283
        virtio_queue_set_notification(q->tx_vq, 0);
1284
        return num_packets;
1285 1286
    }

1287
    for (;;) {
J
Jason Wang 已提交
1288
        ssize_t ret;
1289 1290
        unsigned int out_num;
        struct iovec sg[VIRTQUEUE_MAX_SIZE], sg2[VIRTQUEUE_MAX_SIZE + 1], *out_sg;
J
Jason Wang 已提交
1291
        struct virtio_net_hdr_mrg_rxbuf mhdr;
A
aliguori 已提交
1292

1293 1294 1295 1296 1297 1298 1299
        elem = virtqueue_pop(q->tx_vq, sizeof(VirtQueueElement));
        if (!elem) {
            break;
        }

        out_num = elem->out_num;
        out_sg = elem->out_sg;
M
Michael S. Tsirkin 已提交
1300
        if (out_num < 1) {
1301 1302 1303 1304
            virtio_error(vdev, "virtio-net header not in first element");
            virtqueue_detach_element(q->tx_vq, elem, 0);
            g_free(elem);
            return -EINVAL;
A
aliguori 已提交
1305 1306
        }

1307
        if (n->has_vnet_hdr) {
J
Jason Wang 已提交
1308 1309
            if (iov_to_buf(out_sg, out_num, 0, &mhdr, n->guest_hdr_len) <
                n->guest_hdr_len) {
1310 1311 1312 1313
                virtio_error(vdev, "virtio-net header incorrect");
                virtqueue_detach_element(q->tx_vq, elem, 0);
                g_free(elem);
                return -EINVAL;
1314
            }
1315
            if (n->needs_vnet_hdr_swap) {
J
Jason Wang 已提交
1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327
                virtio_net_hdr_swap(vdev, (void *) &mhdr);
                sg2[0].iov_base = &mhdr;
                sg2[0].iov_len = n->guest_hdr_len;
                out_num = iov_copy(&sg2[1], ARRAY_SIZE(sg2) - 1,
                                   out_sg, out_num,
                                   n->guest_hdr_len, -1);
                if (out_num == VIRTQUEUE_MAX_SIZE) {
                    goto drop;
		}
                out_num += 1;
                out_sg = sg2;
	    }
1328
        }
1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343
        /*
         * If host wants to see the guest header as is, we can
         * pass it on unchanged. Otherwise, copy just the parts
         * that host is interested in.
         */
        assert(n->host_hdr_len <= n->guest_hdr_len);
        if (n->host_hdr_len != n->guest_hdr_len) {
            unsigned sg_num = iov_copy(sg, ARRAY_SIZE(sg),
                                       out_sg, out_num,
                                       0, n->host_hdr_len);
            sg_num += iov_copy(sg + sg_num, ARRAY_SIZE(sg) - sg_num,
                             out_sg, out_num,
                             n->guest_hdr_len, -1);
            out_num = sg_num;
            out_sg = sg;
A
aliguori 已提交
1344 1345
        }

J
Jason Wang 已提交
1346 1347
        ret = qemu_sendv_packet_async(qemu_get_subqueue(n->nic, queue_index),
                                      out_sg, out_num, virtio_net_tx_complete);
1348
        if (ret == 0) {
1349 1350
            virtio_queue_set_notification(q->tx_vq, 0);
            q->async_tx.elem = elem;
1351
            return -EBUSY;
1352 1353
        }

J
Jason Wang 已提交
1354
drop:
1355
        virtqueue_push(q->tx_vq, elem, 0);
1356
        virtio_notify(vdev, q->tx_vq);
1357
        g_free(elem);
1358 1359 1360 1361

        if (++num_packets >= n->tx_burst) {
            break;
        }
A
aliguori 已提交
1362
    }
1363
    return num_packets;
A
aliguori 已提交
1364 1365
}

1366
static void virtio_net_handle_tx_timer(VirtIODevice *vdev, VirtQueue *vq)
A
aliguori 已提交
1367
{
1368
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
1369
    VirtIONetQueue *q = &n->vqs[vq2q(virtio_get_queue_index(vq))];
A
aliguori 已提交
1370

1371 1372 1373 1374 1375
    if (unlikely((n->status & VIRTIO_NET_S_LINK_UP) == 0)) {
        virtio_net_drop_tx_queue_data(vdev, vq);
        return;
    }

1376
    /* This happens when device was stopped but VCPU wasn't. */
1377
    if (!vdev->vm_running) {
1378
        q->tx_waiting = 1;
1379 1380 1381
        return;
    }

1382
    if (q->tx_waiting) {
A
aliguori 已提交
1383
        virtio_queue_set_notification(vq, 1);
1384
        timer_del(q->tx_timer);
1385
        q->tx_waiting = 0;
1386 1387 1388
        if (virtio_net_flush_tx(q) == -EINVAL) {
            return;
        }
A
aliguori 已提交
1389
    } else {
1390 1391
        timer_mod(q->tx_timer,
                       qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + n->tx_timeout);
1392
        q->tx_waiting = 1;
A
aliguori 已提交
1393 1394 1395 1396
        virtio_queue_set_notification(vq, 0);
    }
}

1397 1398
static void virtio_net_handle_tx_bh(VirtIODevice *vdev, VirtQueue *vq)
{
1399
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
1400
    VirtIONetQueue *q = &n->vqs[vq2q(virtio_get_queue_index(vq))];
1401

1402 1403 1404 1405 1406
    if (unlikely((n->status & VIRTIO_NET_S_LINK_UP) == 0)) {
        virtio_net_drop_tx_queue_data(vdev, vq);
        return;
    }

1407
    if (unlikely(q->tx_waiting)) {
1408 1409
        return;
    }
1410
    q->tx_waiting = 1;
1411
    /* This happens when device was stopped but VCPU wasn't. */
1412
    if (!vdev->vm_running) {
1413 1414
        return;
    }
1415
    virtio_queue_set_notification(vq, 0);
1416
    qemu_bh_schedule(q->tx_bh);
1417 1418
}

A
aliguori 已提交
1419 1420
static void virtio_net_tx_timer(void *opaque)
{
1421 1422
    VirtIONetQueue *q = opaque;
    VirtIONet *n = q->n;
1423
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1424 1425 1426 1427 1428 1429
    /* This happens when device was stopped but BH wasn't. */
    if (!vdev->vm_running) {
        /* Make sure tx waiting is set, so we'll run when restarted. */
        assert(q->tx_waiting);
        return;
    }
A
aliguori 已提交
1430

1431
    q->tx_waiting = 0;
A
aliguori 已提交
1432 1433

    /* Just in case the driver is not ready on more */
1434
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
A
aliguori 已提交
1435
        return;
1436
    }
A
aliguori 已提交
1437

1438 1439
    virtio_queue_set_notification(q->tx_vq, 1);
    virtio_net_flush_tx(q);
A
aliguori 已提交
1440 1441
}

1442 1443
static void virtio_net_tx_bh(void *opaque)
{
1444 1445
    VirtIONetQueue *q = opaque;
    VirtIONet *n = q->n;
1446
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1447 1448
    int32_t ret;

1449 1450 1451 1452 1453 1454
    /* This happens when device was stopped but BH wasn't. */
    if (!vdev->vm_running) {
        /* Make sure tx waiting is set, so we'll run when restarted. */
        assert(q->tx_waiting);
        return;
    }
1455

1456
    q->tx_waiting = 0;
1457 1458

    /* Just in case the driver is not ready on more */
1459
    if (unlikely(!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))) {
1460
        return;
1461
    }
1462

1463
    ret = virtio_net_flush_tx(q);
1464 1465 1466
    if (ret == -EBUSY || ret == -EINVAL) {
        return; /* Notification re-enable handled by tx_complete or device
                 * broken */
1467 1468 1469 1470 1471
    }

    /* If we flush a full burst of packets, assume there are
     * more coming and immediately reschedule */
    if (ret >= n->tx_burst) {
1472 1473
        qemu_bh_schedule(q->tx_bh);
        q->tx_waiting = 1;
1474 1475 1476 1477 1478 1479
        return;
    }

    /* If less than a full burst, re-enable notification and flush
     * anything that may have come in while we weren't looking.  If
     * we find something, assume the guest is still active and reschedule */
1480
    virtio_queue_set_notification(q->tx_vq, 1);
1481 1482 1483 1484
    ret = virtio_net_flush_tx(q);
    if (ret == -EINVAL) {
        return;
    } else if (ret > 0) {
1485 1486 1487
        virtio_queue_set_notification(q->tx_vq, 0);
        qemu_bh_schedule(q->tx_bh);
        q->tx_waiting = 1;
1488 1489 1490
    }
}

1491 1492 1493 1494
static void virtio_net_add_queue(VirtIONet *n, int index)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(n);

1495 1496
    n->vqs[index].rx_vq = virtio_add_queue(vdev, n->net_conf.rx_queue_size,
                                           virtio_net_handle_rx);
1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524
    if (n->net_conf.tx && !strcmp(n->net_conf.tx, "timer")) {
        n->vqs[index].tx_vq =
            virtio_add_queue(vdev, 256, virtio_net_handle_tx_timer);
        n->vqs[index].tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
                                              virtio_net_tx_timer,
                                              &n->vqs[index]);
    } else {
        n->vqs[index].tx_vq =
            virtio_add_queue(vdev, 256, virtio_net_handle_tx_bh);
        n->vqs[index].tx_bh = qemu_bh_new(virtio_net_tx_bh, &n->vqs[index]);
    }

    n->vqs[index].tx_waiting = 0;
    n->vqs[index].n = n;
}

static void virtio_net_del_queue(VirtIONet *n, int index)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
    VirtIONetQueue *q = &n->vqs[index];
    NetClientState *nc = qemu_get_subqueue(n->nic, index);

    qemu_purge_queued_packets(nc);

    virtio_del_queue(vdev, index * 2);
    if (q->tx_timer) {
        timer_del(q->tx_timer);
        timer_free(q->tx_timer);
1525
        q->tx_timer = NULL;
1526 1527
    } else {
        qemu_bh_delete(q->tx_bh);
1528
        q->tx_bh = NULL;
1529
    }
1530
    q->tx_waiting = 0;
1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568
    virtio_del_queue(vdev, index * 2 + 1);
}

static void virtio_net_change_num_queues(VirtIONet *n, int new_max_queues)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
    int old_num_queues = virtio_get_num_queues(vdev);
    int new_num_queues = new_max_queues * 2 + 1;
    int i;

    assert(old_num_queues >= 3);
    assert(old_num_queues % 2 == 1);

    if (old_num_queues == new_num_queues) {
        return;
    }

    /*
     * We always need to remove and add ctrl vq if
     * old_num_queues != new_num_queues. Remove ctrl_vq first,
     * and then we only enter one of the following too loops.
     */
    virtio_del_queue(vdev, old_num_queues - 1);

    for (i = new_num_queues - 1; i < old_num_queues - 1; i += 2) {
        /* new_num_queues < old_num_queues */
        virtio_net_del_queue(n, i / 2);
    }

    for (i = old_num_queues - 1; i < new_num_queues - 1; i += 2) {
        /* new_num_queues > old_num_queues */
        virtio_net_add_queue(n, i / 2);
    }

    /* add ctrl_vq last */
    n->ctrl_vq = virtio_add_queue(vdev, 64, virtio_net_handle_ctrl);
}

J
Jason Wang 已提交
1569
static void virtio_net_set_multiqueue(VirtIONet *n, int multiqueue)
J
Jason Wang 已提交
1570
{
1571 1572
    int max = multiqueue ? n->max_queues : 1;

J
Jason Wang 已提交
1573
    n->multiqueue = multiqueue;
1574
    virtio_net_change_num_queues(n, max);
J
Jason Wang 已提交
1575 1576 1577 1578

    virtio_net_set_queues(n);
}

1579
static int virtio_net_post_load_device(void *opaque, int version_id)
1580
{
1581 1582
    VirtIONet *n = opaque;
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1583
    int i, link_down;
A
aliguori 已提交
1584

1585
    virtio_net_set_mrg_rx_bufs(n, n->mergeable_rx_bufs,
1586 1587
                               virtio_vdev_has_feature(vdev,
                                                       VIRTIO_F_VERSION_1));
A
aliguori 已提交
1588

1589
    /* MAC_TABLE_ENTRIES may be different from the saved image */
1590
    if (n->mac_table.in_use > MAC_TABLE_ENTRIES) {
1591
        n->mac_table.in_use = 0;
1592
    }
1593

1594
    if (!virtio_vdev_has_feature(vdev, VIRTIO_NET_F_CTRL_GUEST_OFFLOADS)) {
1595 1596 1597 1598 1599 1600 1601
        n->curr_guest_offloads = virtio_net_supported_guest_offloads(n);
    }

    if (peer_has_vnet_hdr(n)) {
        virtio_net_apply_guest_offloads(n);
    }

1602 1603
    virtio_net_set_queues(n);

1604 1605 1606 1607 1608 1609 1610
    /* Find the first multicast entry in the saved MAC filter */
    for (i = 0; i < n->mac_table.in_use; i++) {
        if (n->mac_table.macs[i * ETH_ALEN] & 1) {
            break;
        }
    }
    n->mac_table.first_multi = i;
1611 1612 1613

    /* nc.link_down can't be migrated, so infer link_down according
     * to link status bit in n->status */
1614 1615 1616 1617
    link_down = (n->status & VIRTIO_NET_S_LINK_UP) == 0;
    for (i = 0; i < n->max_queues; i++) {
        qemu_get_subqueue(n->nic, i)->link_down = link_down;
    }
1618

1619 1620 1621 1622 1623 1624
    if (virtio_vdev_has_feature(vdev, VIRTIO_NET_F_GUEST_ANNOUNCE) &&
        virtio_vdev_has_feature(vdev, VIRTIO_NET_F_CTRL_VQ)) {
        n->announce_counter = SELF_ANNOUNCE_ROUNDS;
        timer_mod(n->announce_timer, qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL));
    }

A
aliguori 已提交
1625 1626 1627
    return 0;
}

1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831
/* tx_waiting field of a VirtIONetQueue */
static const VMStateDescription vmstate_virtio_net_queue_tx_waiting = {
    .name = "virtio-net-queue-tx_waiting",
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(tx_waiting, VirtIONetQueue),
        VMSTATE_END_OF_LIST()
   },
};

static bool max_queues_gt_1(void *opaque, int version_id)
{
    return VIRTIO_NET(opaque)->max_queues > 1;
}

static bool has_ctrl_guest_offloads(void *opaque, int version_id)
{
    return virtio_vdev_has_feature(VIRTIO_DEVICE(opaque),
                                   VIRTIO_NET_F_CTRL_GUEST_OFFLOADS);
}

static bool mac_table_fits(void *opaque, int version_id)
{
    return VIRTIO_NET(opaque)->mac_table.in_use <= MAC_TABLE_ENTRIES;
}

static bool mac_table_doesnt_fit(void *opaque, int version_id)
{
    return !mac_table_fits(opaque, version_id);
}

/* This temporary type is shared by all the WITH_TMP methods
 * although only some fields are used by each.
 */
struct VirtIONetMigTmp {
    VirtIONet      *parent;
    VirtIONetQueue *vqs_1;
    uint16_t        curr_queues_1;
    uint8_t         has_ufo;
    uint32_t        has_vnet_hdr;
};

/* The 2nd and subsequent tx_waiting flags are loaded later than
 * the 1st entry in the queues and only if there's more than one
 * entry.  We use the tmp mechanism to calculate a temporary
 * pointer and count and also validate the count.
 */

static void virtio_net_tx_waiting_pre_save(void *opaque)
{
    struct VirtIONetMigTmp *tmp = opaque;

    tmp->vqs_1 = tmp->parent->vqs + 1;
    tmp->curr_queues_1 = tmp->parent->curr_queues - 1;
    if (tmp->parent->curr_queues == 0) {
        tmp->curr_queues_1 = 0;
    }
}

static int virtio_net_tx_waiting_pre_load(void *opaque)
{
    struct VirtIONetMigTmp *tmp = opaque;

    /* Reuse the pointer setup from save */
    virtio_net_tx_waiting_pre_save(opaque);

    if (tmp->parent->curr_queues > tmp->parent->max_queues) {
        error_report("virtio-net: curr_queues %x > max_queues %x",
            tmp->parent->curr_queues, tmp->parent->max_queues);

        return -EINVAL;
    }

    return 0; /* all good */
}

static const VMStateDescription vmstate_virtio_net_tx_waiting = {
    .name      = "virtio-net-tx_waiting",
    .pre_load  = virtio_net_tx_waiting_pre_load,
    .pre_save  = virtio_net_tx_waiting_pre_save,
    .fields    = (VMStateField[]) {
        VMSTATE_STRUCT_VARRAY_POINTER_UINT16(vqs_1, struct VirtIONetMigTmp,
                                     curr_queues_1,
                                     vmstate_virtio_net_queue_tx_waiting,
                                     struct VirtIONetQueue),
        VMSTATE_END_OF_LIST()
    },
};

/* the 'has_ufo' flag is just tested; if the incoming stream has the
 * flag set we need to check that we have it
 */
static int virtio_net_ufo_post_load(void *opaque, int version_id)
{
    struct VirtIONetMigTmp *tmp = opaque;

    if (tmp->has_ufo && !peer_has_ufo(tmp->parent)) {
        error_report("virtio-net: saved image requires TUN_F_UFO support");
        return -EINVAL;
    }

    return 0;
}

static void virtio_net_ufo_pre_save(void *opaque)
{
    struct VirtIONetMigTmp *tmp = opaque;

    tmp->has_ufo = tmp->parent->has_ufo;
}

static const VMStateDescription vmstate_virtio_net_has_ufo = {
    .name      = "virtio-net-ufo",
    .post_load = virtio_net_ufo_post_load,
    .pre_save  = virtio_net_ufo_pre_save,
    .fields    = (VMStateField[]) {
        VMSTATE_UINT8(has_ufo, struct VirtIONetMigTmp),
        VMSTATE_END_OF_LIST()
    },
};

/* the 'has_vnet_hdr' flag is just tested; if the incoming stream has the
 * flag set we need to check that we have it
 */
static int virtio_net_vnet_post_load(void *opaque, int version_id)
{
    struct VirtIONetMigTmp *tmp = opaque;

    if (tmp->has_vnet_hdr && !peer_has_vnet_hdr(tmp->parent)) {
        error_report("virtio-net: saved image requires vnet_hdr=on");
        return -EINVAL;
    }

    return 0;
}

static void virtio_net_vnet_pre_save(void *opaque)
{
    struct VirtIONetMigTmp *tmp = opaque;

    tmp->has_vnet_hdr = tmp->parent->has_vnet_hdr;
}

static const VMStateDescription vmstate_virtio_net_has_vnet = {
    .name      = "virtio-net-vnet",
    .post_load = virtio_net_vnet_post_load,
    .pre_save  = virtio_net_vnet_pre_save,
    .fields    = (VMStateField[]) {
        VMSTATE_UINT32(has_vnet_hdr, struct VirtIONetMigTmp),
        VMSTATE_END_OF_LIST()
    },
};

static const VMStateDescription vmstate_virtio_net_device = {
    .name = "virtio-net-device",
    .version_id = VIRTIO_NET_VM_VERSION,
    .minimum_version_id = VIRTIO_NET_VM_VERSION,
    .post_load = virtio_net_post_load_device,
    .fields = (VMStateField[]) {
        VMSTATE_UINT8_ARRAY(mac, VirtIONet, ETH_ALEN),
        VMSTATE_STRUCT_POINTER(vqs, VirtIONet,
                               vmstate_virtio_net_queue_tx_waiting,
                               VirtIONetQueue),
        VMSTATE_UINT32(mergeable_rx_bufs, VirtIONet),
        VMSTATE_UINT16(status, VirtIONet),
        VMSTATE_UINT8(promisc, VirtIONet),
        VMSTATE_UINT8(allmulti, VirtIONet),
        VMSTATE_UINT32(mac_table.in_use, VirtIONet),

        /* Guarded pair: If it fits we load it, else we throw it away
         * - can happen if source has a larger MAC table.; post-load
         *  sets flags in this case.
         */
        VMSTATE_VBUFFER_MULTIPLY(mac_table.macs, VirtIONet,
                                0, mac_table_fits, mac_table.in_use,
                                 ETH_ALEN),
        VMSTATE_UNUSED_VARRAY_UINT32(VirtIONet, mac_table_doesnt_fit, 0,
                                     mac_table.in_use, ETH_ALEN),

        /* Note: This is an array of uint32's that's always been saved as a
         * buffer; hold onto your endiannesses; it's actually used as a bitmap
         * but based on the uint.
         */
        VMSTATE_BUFFER_POINTER_UNSAFE(vlans, VirtIONet, 0, MAX_VLAN >> 3),
        VMSTATE_WITH_TMP(VirtIONet, struct VirtIONetMigTmp,
                         vmstate_virtio_net_has_vnet),
        VMSTATE_UINT8(mac_table.multi_overflow, VirtIONet),
        VMSTATE_UINT8(mac_table.uni_overflow, VirtIONet),
        VMSTATE_UINT8(alluni, VirtIONet),
        VMSTATE_UINT8(nomulti, VirtIONet),
        VMSTATE_UINT8(nouni, VirtIONet),
        VMSTATE_UINT8(nobcast, VirtIONet),
        VMSTATE_WITH_TMP(VirtIONet, struct VirtIONetMigTmp,
                         vmstate_virtio_net_has_ufo),
        VMSTATE_SINGLE_TEST(max_queues, VirtIONet, max_queues_gt_1, 0,
                            vmstate_info_uint16_equal, uint16_t),
        VMSTATE_UINT16_TEST(curr_queues, VirtIONet, max_queues_gt_1),
        VMSTATE_WITH_TMP(VirtIONet, struct VirtIONetMigTmp,
                         vmstate_virtio_net_tx_waiting),
        VMSTATE_UINT64_TEST(curr_guest_offloads, VirtIONet,
                            has_ctrl_guest_offloads),
        VMSTATE_END_OF_LIST()
   },
};

M
Mark McLoughlin 已提交
1832
static NetClientInfo net_virtio_info = {
1833
    .type = NET_CLIENT_DRIVER_NIC,
M
Mark McLoughlin 已提交
1834 1835 1836 1837
    .size = sizeof(NICState),
    .can_receive = virtio_net_can_receive,
    .receive = virtio_net_receive,
    .link_status_changed = virtio_net_set_link_status,
1838
    .query_rx_filter = virtio_net_query_rxfilter,
M
Mark McLoughlin 已提交
1839 1840
};

1841 1842
static bool virtio_net_guest_notifier_pending(VirtIODevice *vdev, int idx)
{
1843
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
1844
    NetClientState *nc = qemu_get_subqueue(n->nic, vq2q(idx));
1845
    assert(n->vhost_started);
1846
    return vhost_net_virtqueue_pending(get_vhost_net(nc->peer), idx);
1847 1848 1849 1850 1851
}

static void virtio_net_guest_notifier_mask(VirtIODevice *vdev, int idx,
                                           bool mask)
{
1852
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
1853
    NetClientState *nc = qemu_get_subqueue(n->nic, vq2q(idx));
1854
    assert(n->vhost_started);
1855
    vhost_net_virtqueue_mask(get_vhost_net(nc->peer),
1856 1857 1858
                             vdev, idx, mask);
}

G
Gerd Hoffmann 已提交
1859
static void virtio_net_set_config_size(VirtIONet *n, uint64_t host_features)
A
aliguori 已提交
1860
{
1861
    int i, config_size = 0;
1862
    virtio_add_feature(&host_features, VIRTIO_NET_F_MAC);
1863

1864 1865 1866 1867 1868
    for (i = 0; feature_sizes[i].flags != 0; i++) {
        if (host_features & feature_sizes[i].flags) {
            config_size = MAX(feature_sizes[i].end, config_size);
        }
    }
1869 1870 1871
    n->config_size = config_size;
}

1872 1873 1874 1875 1876 1877 1878 1879
void virtio_net_set_netclient_name(VirtIONet *n, const char *name,
                                   const char *type)
{
    /*
     * The name can be NULL, the netclient name will be type.x.
     */
    assert(type != NULL);

1880 1881
    g_free(n->netclient_name);
    g_free(n->netclient_type);
1882
    n->netclient_name = g_strdup(name);
1883 1884 1885
    n->netclient_type = g_strdup(type);
}

1886
static void virtio_net_device_realize(DeviceState *dev, Error **errp)
1887
{
1888
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
1889
    VirtIONet *n = VIRTIO_NET(dev);
1890
    NetClientState *nc;
1891
    int i;
1892

1893 1894 1895 1896
    if (n->net_conf.mtu) {
        n->host_features |= (0x1 << VIRTIO_NET_F_MTU);
    }

1897
    virtio_net_set_config_size(n, n->host_features);
1898
    virtio_init(vdev, "virtio-net", VIRTIO_ID_NET, n->config_size);
A
aliguori 已提交
1899

1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915
    /*
     * We set a lower limit on RX queue size to what it always was.
     * Guests that want a smaller ring can always resize it without
     * help from us (using virtio 1 and up).
     */
    if (n->net_conf.rx_queue_size < VIRTIO_NET_RX_QUEUE_MIN_SIZE ||
        n->net_conf.rx_queue_size > VIRTQUEUE_MAX_SIZE ||
        (n->net_conf.rx_queue_size & (n->net_conf.rx_queue_size - 1))) {
        error_setg(errp, "Invalid rx_queue_size (= %" PRIu16 "), "
                   "must be a power of 2 between %d and %d.",
                   n->net_conf.rx_queue_size, VIRTIO_NET_RX_QUEUE_MIN_SIZE,
                   VIRTQUEUE_MAX_SIZE);
        virtio_cleanup(vdev);
        return;
    }

1916
    n->max_queues = MAX(n->nic_conf.peers.queues, 1);
1917
    if (n->max_queues * 2 + 1 > VIRTIO_QUEUE_MAX) {
1918
        error_setg(errp, "Invalid number of queues (= %" PRIu32 "), "
S
Stefan Weil 已提交
1919
                   "must be a positive integer less than %d.",
1920
                   n->max_queues, (VIRTIO_QUEUE_MAX - 1) / 2);
1921 1922 1923
        virtio_cleanup(vdev);
        return;
    }
1924
    n->vqs = g_malloc0(sizeof(VirtIONetQueue) * n->max_queues);
J
Jason Wang 已提交
1925
    n->curr_queues = 1;
1926
    n->tx_timeout = n->net_conf.txtimer;
1927

1928 1929
    if (n->net_conf.tx && strcmp(n->net_conf.tx, "timer")
                       && strcmp(n->net_conf.tx, "bh")) {
1930 1931
        error_report("virtio-net: "
                     "Unknown option tx=%s, valid options: \"timer\" \"bh\"",
1932
                     n->net_conf.tx);
1933
        error_report("Defaulting to \"bh\"");
1934 1935
    }

1936
    for (i = 0; i < n->max_queues; i++) {
1937
        virtio_net_add_queue(n, i);
1938
    }
1939

1940
    n->ctrl_vq = virtio_add_queue(vdev, 64, virtio_net_handle_ctrl);
1941 1942
    qemu_macaddr_default_if_unset(&n->nic_conf.macaddr);
    memcpy(&n->mac[0], &n->nic_conf.macaddr, sizeof(n->mac));
1943
    n->status = VIRTIO_NET_S_LINK_UP;
J
Jason Wang 已提交
1944 1945
    n->announce_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL,
                                     virtio_net_announce_timer, n);
A
aliguori 已提交
1946

1947 1948 1949 1950 1951 1952 1953 1954
    if (n->netclient_type) {
        /*
         * Happen when virtio_net_set_netclient_name has been called.
         */
        n->nic = qemu_new_nic(&net_virtio_info, &n->nic_conf,
                              n->netclient_type, n->netclient_name, n);
    } else {
        n->nic = qemu_new_nic(&net_virtio_info, &n->nic_conf,
1955
                              object_get_typename(OBJECT(dev)), dev->id, n);
1956 1957
    }

1958 1959
    peer_test_vnet_hdr(n);
    if (peer_has_vnet_hdr(n)) {
J
Jason Wang 已提交
1960
        for (i = 0; i < n->max_queues; i++) {
1961
            qemu_using_vnet_hdr(qemu_get_subqueue(n->nic, i)->peer, true);
J
Jason Wang 已提交
1962
        }
1963 1964 1965 1966
        n->host_hdr_len = sizeof(struct virtio_net_hdr);
    } else {
        n->host_hdr_len = 0;
    }
M
Mark McLoughlin 已提交
1967

1968
    qemu_format_nic_info_str(qemu_get_queue(n->nic), n->nic_conf.macaddr.a);
1969

J
Jason Wang 已提交
1970
    n->vqs[0].tx_waiting = 0;
1971
    n->tx_burst = n->net_conf.txburst;
1972
    virtio_net_set_mrg_rx_bufs(n, 0, 0);
1973
    n->promisc = 1; /* for compatibility */
A
aliguori 已提交
1974

1975
    n->mac_table.macs = g_malloc0(MAC_TABLE_ENTRIES * ETH_ALEN);
1976

1977
    n->vlans = g_malloc0(MAX_VLAN >> 3);
1978

1979 1980 1981
    nc = qemu_get_queue(n->nic);
    nc->rxfilter_notify_enabled = 1;

1982
    n->qdev = dev;
1983 1984
}

1985
static void virtio_net_device_unrealize(DeviceState *dev, Error **errp)
1986
{
1987 1988
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
    VirtIONet *n = VIRTIO_NET(dev);
1989
    int i, max_queues;
1990 1991 1992 1993

    /* This will stop vhost backend if appropriate. */
    virtio_net_set_status(vdev, 0);

1994 1995 1996 1997
    g_free(n->netclient_name);
    n->netclient_name = NULL;
    g_free(n->netclient_type);
    n->netclient_type = NULL;
1998

1999 2000 2001
    g_free(n->mac_table.macs);
    g_free(n->vlans);

2002 2003 2004
    max_queues = n->multiqueue ? n->max_queues : 1;
    for (i = 0; i < max_queues; i++) {
        virtio_net_del_queue(n, i);
2005 2006
    }

J
Jason Wang 已提交
2007 2008
    timer_del(n->announce_timer);
    timer_free(n->announce_timer);
2009 2010
    g_free(n->vqs);
    qemu_del_nic(n->nic);
2011
    virtio_cleanup(vdev);
2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022
}

static void virtio_net_instance_init(Object *obj)
{
    VirtIONet *n = VIRTIO_NET(obj);

    /*
     * The default config_size is sizeof(struct virtio_net_config).
     * Can be overriden with virtio_net_set_config_size.
     */
    n->config_size = sizeof(struct virtio_net_config);
2023 2024 2025
    device_add_bootindex_property(obj, &n->nic_conf.bootindex,
                                  "bootindex", "/ethernet-phy@0",
                                  DEVICE(n), NULL);
2026 2027
}

2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046
static void virtio_net_pre_save(void *opaque)
{
    VirtIONet *n = opaque;

    /* At this point, backend must be stopped, otherwise
     * it might keep writing to memory. */
    assert(!n->vhost_started);
}

static const VMStateDescription vmstate_virtio_net = {
    .name = "virtio-net",
    .minimum_version_id = VIRTIO_NET_VM_VERSION,
    .version_id = VIRTIO_NET_VM_VERSION,
    .fields = (VMStateField[]) {
        VMSTATE_VIRTIO_DEVICE,
        VMSTATE_END_OF_LIST()
    },
    .pre_save = virtio_net_pre_save,
};
2047

2048
static Property virtio_net_properties[] = {
2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087
    DEFINE_PROP_BIT("csum", VirtIONet, host_features, VIRTIO_NET_F_CSUM, true),
    DEFINE_PROP_BIT("guest_csum", VirtIONet, host_features,
                    VIRTIO_NET_F_GUEST_CSUM, true),
    DEFINE_PROP_BIT("gso", VirtIONet, host_features, VIRTIO_NET_F_GSO, true),
    DEFINE_PROP_BIT("guest_tso4", VirtIONet, host_features,
                    VIRTIO_NET_F_GUEST_TSO4, true),
    DEFINE_PROP_BIT("guest_tso6", VirtIONet, host_features,
                    VIRTIO_NET_F_GUEST_TSO6, true),
    DEFINE_PROP_BIT("guest_ecn", VirtIONet, host_features,
                    VIRTIO_NET_F_GUEST_ECN, true),
    DEFINE_PROP_BIT("guest_ufo", VirtIONet, host_features,
                    VIRTIO_NET_F_GUEST_UFO, true),
    DEFINE_PROP_BIT("guest_announce", VirtIONet, host_features,
                    VIRTIO_NET_F_GUEST_ANNOUNCE, true),
    DEFINE_PROP_BIT("host_tso4", VirtIONet, host_features,
                    VIRTIO_NET_F_HOST_TSO4, true),
    DEFINE_PROP_BIT("host_tso6", VirtIONet, host_features,
                    VIRTIO_NET_F_HOST_TSO6, true),
    DEFINE_PROP_BIT("host_ecn", VirtIONet, host_features,
                    VIRTIO_NET_F_HOST_ECN, true),
    DEFINE_PROP_BIT("host_ufo", VirtIONet, host_features,
                    VIRTIO_NET_F_HOST_UFO, true),
    DEFINE_PROP_BIT("mrg_rxbuf", VirtIONet, host_features,
                    VIRTIO_NET_F_MRG_RXBUF, true),
    DEFINE_PROP_BIT("status", VirtIONet, host_features,
                    VIRTIO_NET_F_STATUS, true),
    DEFINE_PROP_BIT("ctrl_vq", VirtIONet, host_features,
                    VIRTIO_NET_F_CTRL_VQ, true),
    DEFINE_PROP_BIT("ctrl_rx", VirtIONet, host_features,
                    VIRTIO_NET_F_CTRL_RX, true),
    DEFINE_PROP_BIT("ctrl_vlan", VirtIONet, host_features,
                    VIRTIO_NET_F_CTRL_VLAN, true),
    DEFINE_PROP_BIT("ctrl_rx_extra", VirtIONet, host_features,
                    VIRTIO_NET_F_CTRL_RX_EXTRA, true),
    DEFINE_PROP_BIT("ctrl_mac_addr", VirtIONet, host_features,
                    VIRTIO_NET_F_CTRL_MAC_ADDR, true),
    DEFINE_PROP_BIT("ctrl_guest_offloads", VirtIONet, host_features,
                    VIRTIO_NET_F_CTRL_GUEST_OFFLOADS, true),
    DEFINE_PROP_BIT("mq", VirtIONet, host_features, VIRTIO_NET_F_MQ, false),
2088 2089
    DEFINE_NIC_PROPERTIES(VirtIONet, nic_conf),
    DEFINE_PROP_UINT32("x-txtimer", VirtIONet, net_conf.txtimer,
2090
                       TX_TIMER_INTERVAL),
2091 2092
    DEFINE_PROP_INT32("x-txburst", VirtIONet, net_conf.txburst, TX_BURST),
    DEFINE_PROP_STRING("tx", VirtIONet, net_conf.tx),
2093 2094
    DEFINE_PROP_UINT16("rx_queue_size", VirtIONet, net_conf.rx_queue_size,
                       VIRTIO_NET_RX_QUEUE_DEFAULT_SIZE),
2095
    DEFINE_PROP_UINT16("host_mtu", VirtIONet, net_conf.mtu, 0),
2096 2097 2098 2099 2100 2101 2102
    DEFINE_PROP_END_OF_LIST(),
};

static void virtio_net_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
2103

2104
    dc->props = virtio_net_properties;
2105
    dc->vmsd = &vmstate_virtio_net;
2106
    set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
2107
    vdc->realize = virtio_net_device_realize;
2108
    vdc->unrealize = virtio_net_device_unrealize;
2109 2110 2111 2112 2113 2114 2115 2116 2117
    vdc->get_config = virtio_net_get_config;
    vdc->set_config = virtio_net_set_config;
    vdc->get_features = virtio_net_get_features;
    vdc->set_features = virtio_net_set_features;
    vdc->bad_features = virtio_net_bad_features;
    vdc->reset = virtio_net_reset;
    vdc->set_status = virtio_net_set_status;
    vdc->guest_notifier_mask = virtio_net_guest_notifier_mask;
    vdc->guest_notifier_pending = virtio_net_guest_notifier_pending;
2118
    vdc->legacy_features |= (0x1 << VIRTIO_NET_F_GSO);
2119
    vdc->vmsd = &vmstate_virtio_net_device;
2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135
}

static const TypeInfo virtio_net_info = {
    .name = TYPE_VIRTIO_NET,
    .parent = TYPE_VIRTIO_DEVICE,
    .instance_size = sizeof(VirtIONet),
    .instance_init = virtio_net_instance_init,
    .class_init = virtio_net_class_init,
};

static void virtio_register_types(void)
{
    type_register_static(&virtio_net_info);
}

type_init(virtio_register_types)