virtio-net.c 51.1 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.
 *
 */

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

28
#define VIRTIO_NET_VM_VERSION    11
29

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

33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54
/*
 * 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)},
    {}
};

J
Jason Wang 已提交
55
static VirtIONetQueue *virtio_net_get_subqueue(NetClientState *nc)
56 57 58
{
    VirtIONet *n = qemu_get_nic_opaque(nc);

J
Jason Wang 已提交
59
    return &n->vqs[nc->queue_index];
60
}
J
Jason Wang 已提交
61 62 63 64 65 66

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

A
aliguori 已提交
67 68 69 70
/* TODO
 * - we could suppress RX interrupt if we were so inclined.
 */

71
static void virtio_net_get_config(VirtIODevice *vdev, uint8_t *config)
A
aliguori 已提交
72
{
73
    VirtIONet *n = VIRTIO_NET(vdev);
A
aliguori 已提交
74 75
    struct virtio_net_config netcfg;

76 77
    virtio_stw_p(vdev, &netcfg.status, n->status);
    virtio_stw_p(vdev, &netcfg.max_virtqueue_pairs, n->max_queues);
78
    memcpy(netcfg.mac, n->mac, ETH_ALEN);
79
    memcpy(config, &netcfg, n->config_size);
A
aliguori 已提交
80 81
}

82 83
static void virtio_net_set_config(VirtIODevice *vdev, const uint8_t *config)
{
84
    VirtIONet *n = VIRTIO_NET(vdev);
85
    struct virtio_net_config netcfg = {};
86

87
    memcpy(&netcfg, config, n->config_size);
88

89
    if (!(vdev->guest_features >> VIRTIO_NET_F_CTRL_MAC_ADDR & 1) &&
90
        memcmp(netcfg.mac, n->mac, ETH_ALEN)) {
91
        memcpy(n->mac, netcfg.mac, ETH_ALEN);
J
Jason Wang 已提交
92
        qemu_format_nic_info_str(qemu_get_queue(n->nic), n->mac);
93 94 95
    }
}

96 97
static bool virtio_net_started(VirtIONet *n, uint8_t status)
{
98
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
99
    return (status & VIRTIO_CONFIG_S_DRIVER_OK) &&
100
        (n->status & VIRTIO_NET_S_LINK_UP) && vdev->vm_running;
101 102
}

J
Jason Wang 已提交
103 104 105 106 107 108 109 110 111 112
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);
}

113
static void virtio_net_vhost_status(VirtIONet *n, uint8_t status)
114
{
115
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
J
Jason Wang 已提交
116
    NetClientState *nc = qemu_get_queue(n->nic);
J
Jason Wang 已提交
117
    int queues = n->multiqueue ? n->max_queues : 1;
J
Jason Wang 已提交
118

119
    if (!get_vhost_net(nc->peer)) {
120 121
        return;
    }
J
Jason Wang 已提交
122

123 124
    if (!!n->vhost_started ==
        (virtio_net_started(n, status) && !nc->peer->link_down)) {
125 126 127
        return;
    }
    if (!n->vhost_started) {
128
        int r;
129
        if (!vhost_net_query(get_vhost_net(nc->peer), vdev)) {
130 131
            return;
        }
132
        n->vhost_started = 1;
133
        r = vhost_net_start(vdev, n->nic->ncs, queues);
134
        if (r < 0) {
135 136
            error_report("unable to start vhost net: %d: "
                         "falling back on userspace virtio", -r);
137
            n->vhost_started = 0;
138 139
        }
    } else {
140
        vhost_net_stop(vdev, n->nic->ncs, queues);
141 142 143 144
        n->vhost_started = 0;
    }
}

145 146
static void virtio_net_set_status(struct VirtIODevice *vdev, uint8_t status)
{
147
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
148 149 150
    VirtIONetQueue *q;
    int i;
    uint8_t queue_status;
151 152 153

    virtio_net_vhost_status(n, status);

J
Jason Wang 已提交
154 155
    for (i = 0; i < n->max_queues; i++) {
        q = &n->vqs[i];
156

J
Jason Wang 已提交
157 158
        if ((!n->multiqueue && i != 0) || i >= n->curr_queues) {
            queue_status = 0;
159
        } else {
J
Jason Wang 已提交
160
            queue_status = status;
161
        }
J
Jason Wang 已提交
162 163 164 165 166 167 168

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

        if (virtio_net_started(n, queue_status) && !n->vhost_started) {
            if (q->tx_timer) {
169 170
                timer_mod(q->tx_timer,
                               qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + n->tx_timeout);
J
Jason Wang 已提交
171 172 173
            } else {
                qemu_bh_schedule(q->tx_bh);
            }
174
        } else {
J
Jason Wang 已提交
175
            if (q->tx_timer) {
176
                timer_del(q->tx_timer);
J
Jason Wang 已提交
177 178 179
            } else {
                qemu_bh_cancel(q->tx_bh);
            }
180 181 182 183
        }
    }
}

184
static void virtio_net_set_link_status(NetClientState *nc)
185
{
J
Jason Wang 已提交
186
    VirtIONet *n = qemu_get_nic_opaque(nc);
187
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
188 189
    uint16_t old_status = n->status;

M
Mark McLoughlin 已提交
190
    if (nc->link_down)
191 192 193 194 195
        n->status &= ~VIRTIO_NET_S_LINK_UP;
    else
        n->status |= VIRTIO_NET_S_LINK_UP;

    if (n->status != old_status)
196
        virtio_notify_config(vdev);
197

198
    virtio_net_set_status(vdev, vdev->status);
199 200
}

201 202 203 204 205
static void rxfilter_notify(NetClientState *nc)
{
    VirtIONet *n = qemu_get_nic_opaque(nc);

    if (nc->rxfilter_notify_enabled) {
206
        gchar *path = object_get_canonical_path(OBJECT(n->qdev));
207 208
        qapi_event_send_nic_rx_filter_changed(!!n->netclient_name,
                                              n->netclient_name, path, &error_abort);
209
        g_free(path);
210 211 212 213 214 215 216 217 218 219 220 221

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

static char *mac_strdup_printf(const uint8_t *mac)
{
    return g_strdup_printf("%.2x:%.2x:%.2x:%.2x:%.2x:%.2x", mac[0],
                            mac[1], mac[2], mac[3], mac[4], mac[5]);
}

222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241
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;
}

242 243 244
static RxFilterInfo *virtio_net_query_rxfilter(NetClientState *nc)
{
    VirtIONet *n = qemu_get_nic_opaque(nc);
245
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
246 247
    RxFilterInfo *info;
    strList *str_list, *entry;
248
    int i;
249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292

    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;

    info->main_mac = mac_strdup_printf(n->mac);

    str_list = NULL;
    for (i = 0; i < n->mac_table.first_multi; i++) {
        entry = g_malloc0(sizeof(*entry));
        entry->value = mac_strdup_printf(n->mac_table.macs + i * ETH_ALEN);
        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));
        entry->value = mac_strdup_printf(n->mac_table.macs + i * ETH_ALEN);
        entry->next = str_list;
        str_list = entry;
    }
    info->multicast_table = str_list;
293
    info->vlan_table = get_vlan_table(n);
294

295 296 297 298 299 300
    if (!((1 << VIRTIO_NET_F_CTRL_VLAN) & vdev->guest_features)) {
        info->vlan = RX_STATE_ALL;
    } else if (!info->vlan_table) {
        info->vlan = RX_STATE_NONE;
    } else {
        info->vlan = RX_STATE_NORMAL;
301 302 303 304 305 306 307 308
    }

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

    return info;
}

309 310
static void virtio_net_reset(VirtIODevice *vdev)
{
311
    VirtIONet *n = VIRTIO_NET(vdev);
312 313 314 315

    /* Reset back to compatibility mode */
    n->promisc = 1;
    n->allmulti = 0;
316 317 318 319
    n->alluni = 0;
    n->nomulti = 0;
    n->nouni = 0;
    n->nobcast = 0;
J
Jason Wang 已提交
320 321
    /* multiqueue is disabled by default */
    n->curr_queues = 1;
J
Jason Wang 已提交
322 323 324
    timer_del(n->announce_timer);
    n->announce_counter = 0;
    n->status &= ~VIRTIO_NET_S_ANNOUNCE;
325

326
    /* Flush any MAC and VLAN filter table state */
327
    n->mac_table.in_use = 0;
328
    n->mac_table.first_multi = 0;
329 330
    n->mac_table.multi_overflow = 0;
    n->mac_table.uni_overflow = 0;
331
    memset(n->mac_table.macs, 0, MAC_TABLE_ENTRIES * ETH_ALEN);
332
    memcpy(&n->mac[0], &n->nic->conf->macaddr, sizeof(n->mac));
333
    qemu_format_nic_info_str(qemu_get_queue(n->nic), n->mac);
334
    memset(n->vlans, 0, MAX_VLAN >> 3);
335 336
}

337
static void peer_test_vnet_hdr(VirtIONet *n)
M
Mark McLoughlin 已提交
338
{
J
Jason Wang 已提交
339 340
    NetClientState *nc = qemu_get_queue(n->nic);
    if (!nc->peer) {
341
        return;
J
Jason Wang 已提交
342
    }
M
Mark McLoughlin 已提交
343

344
    n->has_vnet_hdr = qemu_has_vnet_hdr(nc->peer);
345
}
M
Mark McLoughlin 已提交
346

347 348
static int peer_has_vnet_hdr(VirtIONet *n)
{
M
Mark McLoughlin 已提交
349 350 351
    return n->has_vnet_hdr;
}

352 353 354 355 356
static int peer_has_ufo(VirtIONet *n)
{
    if (!peer_has_vnet_hdr(n))
        return 0;

357
    n->has_ufo = qemu_has_ufo(qemu_get_queue(n->nic)->peer);
358 359 360 361

    return n->has_ufo;
}

362 363
static void virtio_net_set_mrg_rx_bufs(VirtIONet *n, int mergeable_rx_bufs)
{
J
Jason Wang 已提交
364 365 366
    int i;
    NetClientState *nc;

367 368 369 370 371
    n->mergeable_rx_bufs = mergeable_rx_bufs;

    n->guest_hdr_len = n->mergeable_rx_bufs ?
        sizeof(struct virtio_net_hdr_mrg_rxbuf) : sizeof(struct virtio_net_hdr);

J
Jason Wang 已提交
372 373 374 375
    for (i = 0; i < n->max_queues; i++) {
        nc = qemu_get_subqueue(n->nic, i);

        if (peer_has_vnet_hdr(n) &&
376 377
            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 已提交
378 379
            n->host_hdr_len = n->guest_hdr_len;
        }
380 381 382
    }
}

J
Jason Wang 已提交
383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415
static int peer_attach(VirtIONet *n, int index)
{
    NetClientState *nc = qemu_get_subqueue(n->nic, index);

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

    if (nc->peer->info->type != NET_CLIENT_OPTIONS_KIND_TAP) {
        return 0;
    }

    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;
    }

    if (nc->peer->info->type !=  NET_CLIENT_OPTIONS_KIND_TAP) {
        return 0;
    }

    return tap_disable(nc->peer);
}

static void virtio_net_set_queues(VirtIONet *n)
{
    int i;
416
    int r;
J
Jason Wang 已提交
417 418 419

    for (i = 0; i < n->max_queues; i++) {
        if (i < n->curr_queues) {
420 421
            r = peer_attach(n, i);
            assert(!r);
J
Jason Wang 已提交
422
        } else {
423 424
            r = peer_detach(n, i);
            assert(!r);
J
Jason Wang 已提交
425 426 427 428
        }
    }
}

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

431
static uint32_t virtio_net_get_features(VirtIODevice *vdev, uint32_t features)
A
aliguori 已提交
432
{
433
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
434
    NetClientState *nc = qemu_get_queue(n->nic);
A
aliguori 已提交
435

436 437
    features |= (1 << VIRTIO_NET_F_MAC);

438
    if (!peer_has_vnet_hdr(n)) {
439 440 441 442 443 444 445 446 447 448
        features &= ~(0x1 << VIRTIO_NET_F_CSUM);
        features &= ~(0x1 << VIRTIO_NET_F_HOST_TSO4);
        features &= ~(0x1 << VIRTIO_NET_F_HOST_TSO6);
        features &= ~(0x1 << VIRTIO_NET_F_HOST_ECN);

        features &= ~(0x1 << VIRTIO_NET_F_GUEST_CSUM);
        features &= ~(0x1 << VIRTIO_NET_F_GUEST_TSO4);
        features &= ~(0x1 << VIRTIO_NET_F_GUEST_TSO6);
        features &= ~(0x1 << VIRTIO_NET_F_GUEST_ECN);
    }
M
Mark McLoughlin 已提交
449

450 451 452
    if (!peer_has_vnet_hdr(n) || !peer_has_ufo(n)) {
        features &= ~(0x1 << VIRTIO_NET_F_GUEST_UFO);
        features &= ~(0x1 << VIRTIO_NET_F_HOST_UFO);
M
Mark McLoughlin 已提交
453 454
    }

455
    if (!get_vhost_net(nc->peer)) {
456 457
        return features;
    }
458
    return vhost_net_get_features(get_vhost_net(nc->peer), features);
A
aliguori 已提交
459 460
}

461 462 463 464 465 466 467
static uint32_t virtio_net_bad_features(VirtIODevice *vdev)
{
    uint32_t features = 0;

    /* Linux kernel 2.6.25.  It understood MAC (as everyone must),
     * but also these: */
    features |= (1 << VIRTIO_NET_F_MAC);
468 469 470 471
    features |= (1 << VIRTIO_NET_F_CSUM);
    features |= (1 << VIRTIO_NET_F_HOST_TSO4);
    features |= (1 << VIRTIO_NET_F_HOST_TSO6);
    features |= (1 << VIRTIO_NET_F_HOST_ECN);
472

473
    return features;
474 475
}

476 477
static void virtio_net_apply_guest_offloads(VirtIONet *n)
{
478
    qemu_set_offload(qemu_get_queue(n->nic)->peer,
479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503
            !!(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);
}

A
aliguori 已提交
504 505
static void virtio_net_set_features(VirtIODevice *vdev, uint32_t features)
{
506
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
507 508
    int i;

J
Jason Wang 已提交
509
    virtio_net_set_multiqueue(n, !!(features & (1 << VIRTIO_NET_F_MQ)));
A
aliguori 已提交
510

511
    virtio_net_set_mrg_rx_bufs(n, !!(features & (1 << VIRTIO_NET_F_MRG_RXBUF)));
512 513

    if (n->has_vnet_hdr) {
514 515 516
        n->curr_guest_offloads =
            virtio_net_guest_offloads_by_features(features);
        virtio_net_apply_guest_offloads(n);
517
    }
J
Jason Wang 已提交
518 519 520 521

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

522
        if (!get_vhost_net(nc->peer)) {
J
Jason Wang 已提交
523 524
            continue;
        }
525
        vhost_net_ack_features(get_vhost_net(nc->peer), features);
D
David L Stevens 已提交
526
    }
527 528 529 530 531 532

    if ((1 << VIRTIO_NET_F_CTRL_VLAN) & features) {
        memset(n->vlans, 0, MAX_VLAN >> 3);
    } else {
        memset(n->vlans, 0xff, MAX_VLAN >> 3);
    }
A
aliguori 已提交
533 534
}

535
static int virtio_net_handle_rx_mode(VirtIONet *n, uint8_t cmd,
536
                                     struct iovec *iov, unsigned int iov_cnt)
537 538
{
    uint8_t on;
539
    size_t s;
540
    NetClientState *nc = qemu_get_queue(n->nic);
541

542 543 544
    s = iov_to_buf(iov, iov_cnt, 0, &on, sizeof(on));
    if (s != sizeof(on)) {
        return VIRTIO_NET_ERR;
545 546
    }

A
Amos Kong 已提交
547
    if (cmd == VIRTIO_NET_CTRL_RX_PROMISC) {
548
        n->promisc = on;
A
Amos Kong 已提交
549
    } else if (cmd == VIRTIO_NET_CTRL_RX_ALLMULTI) {
550
        n->allmulti = on;
A
Amos Kong 已提交
551
    } else if (cmd == VIRTIO_NET_CTRL_RX_ALLUNI) {
552
        n->alluni = on;
A
Amos Kong 已提交
553
    } else if (cmd == VIRTIO_NET_CTRL_RX_NOMULTI) {
554
        n->nomulti = on;
A
Amos Kong 已提交
555
    } else if (cmd == VIRTIO_NET_CTRL_RX_NOUNI) {
556
        n->nouni = on;
A
Amos Kong 已提交
557
    } else if (cmd == VIRTIO_NET_CTRL_RX_NOBCAST) {
558
        n->nobcast = on;
559
    } else {
560
        return VIRTIO_NET_ERR;
561
    }
562

563 564
    rxfilter_notify(nc);

565 566 567
    return VIRTIO_NET_OK;
}

568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604
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;

    if (!((1 << VIRTIO_NET_F_CTRL_GUEST_OFFLOADS) & vdev->guest_features)) {
        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;
    }
}

605
static int virtio_net_handle_mac(VirtIONet *n, uint8_t cmd,
606
                                 struct iovec *iov, unsigned int iov_cnt)
607
{
608
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
609
    struct virtio_net_ctrl_mac mac_data;
610
    size_t s;
611
    NetClientState *nc = qemu_get_queue(n->nic);
612

613 614 615 616 617 618
    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 已提交
619
        qemu_format_nic_info_str(qemu_get_queue(n->nic), n->mac);
620 621
        rxfilter_notify(nc);

622 623 624
        return VIRTIO_NET_OK;
    }

625
    if (cmd != VIRTIO_NET_CTRL_MAC_TABLE_SET) {
626
        return VIRTIO_NET_ERR;
627
    }
628

629 630 631 632 633
    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);
634

635 636
    s = iov_to_buf(iov, iov_cnt, 0, &mac_data.entries,
                   sizeof(mac_data.entries));
637
    mac_data.entries = virtio_ldl_p(vdev, &mac_data.entries);
638
    if (s != sizeof(mac_data.entries)) {
639
        goto error;
640 641
    }
    iov_discard_front(&iov, &iov_cnt, s);
642

643
    if (mac_data.entries * ETH_ALEN > iov_size(iov, iov_cnt)) {
644
        goto error;
645
    }
646 647

    if (mac_data.entries <= MAC_TABLE_ENTRIES) {
648
        s = iov_to_buf(iov, iov_cnt, 0, macs,
649 650
                       mac_data.entries * ETH_ALEN);
        if (s != mac_data.entries * ETH_ALEN) {
651
            goto error;
652
        }
653
        in_use += mac_data.entries;
654
    } else {
655
        uni_overflow = 1;
656 657
    }

658 659
    iov_discard_front(&iov, &iov_cnt, mac_data.entries * ETH_ALEN);

660
    first_multi = in_use;
661

662 663
    s = iov_to_buf(iov, iov_cnt, 0, &mac_data.entries,
                   sizeof(mac_data.entries));
664
    mac_data.entries = virtio_ldl_p(vdev, &mac_data.entries);
665
    if (s != sizeof(mac_data.entries)) {
666
        goto error;
667 668 669
    }

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

671
    if (mac_data.entries * ETH_ALEN != iov_size(iov, iov_cnt)) {
672
        goto error;
673
    }
674

675
    if (mac_data.entries <= MAC_TABLE_ENTRIES - in_use) {
676
        s = iov_to_buf(iov, iov_cnt, 0, &macs[in_use * ETH_ALEN],
677 678
                       mac_data.entries * ETH_ALEN);
        if (s != mac_data.entries * ETH_ALEN) {
679
            goto error;
680
        }
681
        in_use += mac_data.entries;
682
    } else {
683
        multi_overflow = 1;
684 685
    }

686 687 688 689 690 691
    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);
692 693
    rxfilter_notify(nc);

694
    return VIRTIO_NET_OK;
695 696

error:
697
    g_free(macs);
698
    return VIRTIO_NET_ERR;
699 700
}

701
static int virtio_net_handle_vlan_table(VirtIONet *n, uint8_t cmd,
702
                                        struct iovec *iov, unsigned int iov_cnt)
703
{
704
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
705
    uint16_t vid;
706
    size_t s;
707
    NetClientState *nc = qemu_get_queue(n->nic);
708

709
    s = iov_to_buf(iov, iov_cnt, 0, &vid, sizeof(vid));
710
    vid = virtio_lduw_p(vdev, &vid);
711
    if (s != sizeof(vid)) {
712 713 714 715 716 717 718 719 720 721 722 723 724
        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;

725 726
    rxfilter_notify(nc);

727 728 729
    return VIRTIO_NET_OK;
}

J
Jason Wang 已提交
730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746
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 已提交
747
static int virtio_net_handle_mq(VirtIONet *n, uint8_t cmd,
748
                                struct iovec *iov, unsigned int iov_cnt)
J
Jason Wang 已提交
749
{
750
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
751 752 753
    struct virtio_net_ctrl_mq mq;
    size_t s;
    uint16_t queues;
J
Jason Wang 已提交
754

755 756
    s = iov_to_buf(iov, iov_cnt, 0, &mq, sizeof(mq));
    if (s != sizeof(mq)) {
J
Jason Wang 已提交
757 758 759 760 761 762 763
        return VIRTIO_NET_ERR;
    }

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

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

766 767 768
    if (queues < VIRTIO_NET_CTRL_MQ_VQ_PAIRS_MIN ||
        queues > VIRTIO_NET_CTRL_MQ_VQ_PAIRS_MAX ||
        queues > n->max_queues ||
J
Jason Wang 已提交
769 770 771 772
        !n->multiqueue) {
        return VIRTIO_NET_ERR;
    }

773
    n->curr_queues = queues;
J
Jason Wang 已提交
774 775
    /* stop the backend before changing the number of queues to avoid handling a
     * disabled queue */
776
    virtio_net_set_status(vdev, vdev->status);
J
Jason Wang 已提交
777 778 779 780
    virtio_net_set_queues(n);

    return VIRTIO_NET_OK;
}
781 782
static void virtio_net_handle_ctrl(VirtIODevice *vdev, VirtQueue *vq)
{
783
    VirtIONet *n = VIRTIO_NET(vdev);
784 785 786
    struct virtio_net_ctrl_hdr ctrl;
    virtio_net_ctrl_ack status = VIRTIO_NET_ERR;
    VirtQueueElement elem;
787 788 789
    size_t s;
    struct iovec *iov;
    unsigned int iov_cnt;
790 791

    while (virtqueue_pop(vq, &elem)) {
792 793
        if (iov_size(elem.in_sg, elem.in_num) < sizeof(status) ||
            iov_size(elem.out_sg, elem.out_num) < sizeof(ctrl)) {
794
            error_report("virtio-net ctrl missing headers");
795 796 797
            exit(1);
        }

798 799 800 801 802 803
        iov = elem.out_sg;
        iov_cnt = elem.out_num;
        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 已提交
804
        } else if (ctrl.class == VIRTIO_NET_CTRL_RX) {
805 806 807 808 809
            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 已提交
810 811
        } else if (ctrl.class == VIRTIO_NET_CTRL_ANNOUNCE) {
            status = virtio_net_handle_announce(n, ctrl.cmd, iov, iov_cnt);
J
Jason Wang 已提交
812
        } else if (ctrl.class == VIRTIO_NET_CTRL_MQ) {
813
            status = virtio_net_handle_mq(n, ctrl.cmd, iov, iov_cnt);
814 815
        } else if (ctrl.class == VIRTIO_NET_CTRL_GUEST_OFFLOADS) {
            status = virtio_net_handle_offloads(n, ctrl.cmd, iov, iov_cnt);
816 817
        }

818 819
        s = iov_from_buf(elem.in_sg, elem.in_num, 0, &status, sizeof(status));
        assert(s == sizeof(status));
820 821 822 823 824 825

        virtqueue_push(vq, &elem, sizeof(status));
        virtio_notify(vdev, vq);
    }
}

A
aliguori 已提交
826 827 828 829
/* RX */

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

J
Jason Wang 已提交
833
    qemu_flush_queued_packets(qemu_get_subqueue(n->nic, queue_index));
A
aliguori 已提交
834 835
}

836
static int virtio_net_can_receive(NetClientState *nc)
A
aliguori 已提交
837
{
J
Jason Wang 已提交
838
    VirtIONet *n = qemu_get_nic_opaque(nc);
839
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
J
Jason Wang 已提交
840
    VirtIONetQueue *q = virtio_net_get_subqueue(nc);
841

842
    if (!vdev->vm_running) {
843 844
        return 0;
    }
845

J
Jason Wang 已提交
846 847 848 849
    if (nc->queue_index >= n->curr_queues) {
        return 0;
    }

850
    if (!virtio_queue_ready(q->rx_vq) ||
851
        !(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
A
aliguori 已提交
852
        return 0;
853
    }
A
aliguori 已提交
854

855 856 857
    return 1;
}

858
static int virtio_net_has_buffers(VirtIONetQueue *q, int bufsize)
859
{
860 861
    VirtIONet *n = q->n;
    if (virtio_queue_empty(q->rx_vq) ||
A
aliguori 已提交
862
        (n->mergeable_rx_bufs &&
863 864
         !virtqueue_avail_bytes(q->rx_vq, bufsize, 0))) {
        virtio_queue_set_notification(q->rx_vq, 1);
865 866 867 868 869

        /* 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.
         */
870
        if (virtio_queue_empty(q->rx_vq) ||
871
            (n->mergeable_rx_bufs &&
872
             !virtqueue_avail_bytes(q->rx_vq, bufsize, 0))) {
873
            return 0;
874
        }
A
aliguori 已提交
875 876
    }

877
    virtio_queue_set_notification(q->rx_vq, 0);
A
aliguori 已提交
878 879 880
    return 1;
}

881
static void virtio_net_hdr_swap(VirtIODevice *vdev, struct virtio_net_hdr *hdr)
882
{
883 884 885 886
    virtio_tswap16s(vdev, &hdr->hdr_len);
    virtio_tswap16s(vdev, &hdr->gso_size);
    virtio_tswap16s(vdev, &hdr->csum_start);
    virtio_tswap16s(vdev, &hdr->csum_offset);
887 888
}

A
Anthony Liguori 已提交
889 890 891 892 893 894 895 896 897 898 899 900 901 902 903
/* 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 已提交
904
                                        uint8_t *buf, size_t size)
A
Anthony Liguori 已提交
905 906 907 908 909 910
{
    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 已提交
911
        net_checksum_calculate(buf, size);
A
Anthony Liguori 已提交
912 913 914 915
        hdr->flags &= ~VIRTIO_NET_HDR_F_NEEDS_CSUM;
    }
}

916 917
static void receive_header(VirtIONet *n, const struct iovec *iov, int iov_cnt,
                           const void *buf, size_t size)
A
aliguori 已提交
918
{
M
Mark McLoughlin 已提交
919
    if (n->has_vnet_hdr) {
M
Michael S. Tsirkin 已提交
920 921
        /* FIXME this cast is evil */
        void *wbuf = (void *)buf;
922 923
        work_around_broken_dhclient(wbuf, wbuf + n->host_hdr_len,
                                    size - n->host_hdr_len);
924
        virtio_net_hdr_swap(VIRTIO_DEVICE(n), wbuf);
925
        iov_from_buf(iov, iov_cnt, 0, buf, sizeof(struct virtio_net_hdr));
M
Michael S. Tsirkin 已提交
926 927 928 929 930 931
    } 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 已提交
932
    }
A
aliguori 已提交
933 934
}

935 936 937
static int receive_filter(VirtIONet *n, const uint8_t *buf, int size)
{
    static const uint8_t bcast[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
938
    static const uint8_t vlan[] = {0x81, 0x00};
939
    uint8_t *ptr = (uint8_t *)buf;
940
    int i;
941 942 943 944

    if (n->promisc)
        return 1;

945
    ptr += n->host_hdr_len;
M
Mark McLoughlin 已提交
946

947 948 949 950 951 952
    if (!memcmp(&ptr[12], vlan, sizeof(vlan))) {
        int vid = be16_to_cpup((uint16_t *)(ptr + 14)) & 0xfff;
        if (!(n->vlans[vid >> 5] & (1U << (vid & 0x1f))))
            return 0;
    }

953 954
    if (ptr[0] & 1) { // multicast
        if (!memcmp(ptr, bcast, sizeof(bcast))) {
955 956 957
            return !n->nobcast;
        } else if (n->nomulti) {
            return 0;
958
        } else if (n->allmulti || n->mac_table.multi_overflow) {
959 960
            return 1;
        }
961 962 963 964 965 966

        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;
            }
        }
967
    } else { // unicast
968 969 970
        if (n->nouni) {
            return 0;
        } else if (n->alluni || n->mac_table.uni_overflow) {
971 972
            return 1;
        } else if (!memcmp(ptr, n->mac, ETH_ALEN)) {
973 974
            return 1;
        }
975

976 977 978 979 980
        for (i = 0; i < n->mac_table.first_multi; i++) {
            if (!memcmp(ptr, &n->mac_table.macs[i * ETH_ALEN], ETH_ALEN)) {
                return 1;
            }
        }
981 982
    }

983 984 985
    return 0;
}

986
static ssize_t virtio_net_receive(NetClientState *nc, const uint8_t *buf, size_t size)
A
aliguori 已提交
987
{
J
Jason Wang 已提交
988
    VirtIONet *n = qemu_get_nic_opaque(nc);
J
Jason Wang 已提交
989
    VirtIONetQueue *q = virtio_net_get_subqueue(nc);
990
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
991 992 993
    struct iovec mhdr_sg[VIRTQUEUE_MAX_SIZE];
    struct virtio_net_hdr_mrg_rxbuf mhdr;
    unsigned mhdr_cnt = 0;
M
Michael S. Tsirkin 已提交
994
    size_t offset, i, guest_offset;
A
aliguori 已提交
995

J
Jason Wang 已提交
996
    if (!virtio_net_can_receive(nc)) {
997
        return -1;
J
Jason Wang 已提交
998
    }
999

1000
    /* hdr_len refers to the header we supply to the guest */
1001
    if (!virtio_net_has_buffers(q, size + n->guest_hdr_len - n->host_hdr_len)) {
1002
        return 0;
1003
    }
A
aliguori 已提交
1004

1005
    if (!receive_filter(n, buf, size))
1006
        return size;
1007

A
aliguori 已提交
1008 1009 1010 1011 1012
    offset = i = 0;

    while (offset < size) {
        VirtQueueElement elem;
        int len, total;
M
Michael S. Tsirkin 已提交
1013
        const struct iovec *sg = elem.in_sg;
A
aliguori 已提交
1014

A
Amit Shah 已提交
1015
        total = 0;
A
aliguori 已提交
1016

1017
        if (virtqueue_pop(q->rx_vq, &elem) == 0) {
A
aliguori 已提交
1018
            if (i == 0)
1019
                return -1;
1020
            error_report("virtio-net unexpected empty queue: "
1021
                    "i %zd mergeable %d offset %zd, size %zd, "
1022
                    "guest hdr len %zd, host hdr len %zd guest features 0x%x",
1023
                    i, n->mergeable_rx_bufs, offset, size,
1024
                    n->guest_hdr_len, n->host_hdr_len, vdev->guest_features);
A
aliguori 已提交
1025 1026 1027 1028
            exit(1);
        }

        if (elem.in_num < 1) {
1029
            error_report("virtio-net receive queue contains no in buffers");
A
aliguori 已提交
1030 1031 1032 1033
            exit(1);
        }

        if (i == 0) {
1034
            assert(offset == 0);
1035 1036 1037 1038 1039 1040
            if (n->mergeable_rx_bufs) {
                mhdr_cnt = iov_copy(mhdr_sg, ARRAY_SIZE(mhdr_sg),
                                    sg, elem.in_num,
                                    offsetof(typeof(mhdr), num_buffers),
                                    sizeof(mhdr.num_buffers));
            }
A
aliguori 已提交
1041

1042 1043
            receive_header(n, sg, elem.in_num, buf, size);
            offset = n->host_hdr_len;
1044
            total += n->guest_hdr_len;
M
Michael S. Tsirkin 已提交
1045 1046 1047
            guest_offset = n->guest_hdr_len;
        } else {
            guest_offset = 0;
A
aliguori 已提交
1048 1049 1050
        }

        /* copy in packet.  ugh */
M
Michael S. Tsirkin 已提交
1051
        len = iov_from_buf(sg, elem.in_num, guest_offset,
1052
                           buf + offset, size - offset);
A
aliguori 已提交
1053
        total += len;
1054 1055 1056 1057 1058 1059
        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) {
#if 0
1060 1061 1062 1063
            error_report("virtio-net truncated non-mergeable packet: "
                         "i %zd mergeable %d offset %zd, size %zd, "
                         "guest hdr len %zd, host hdr len %zd",
                         i, n->mergeable_rx_bufs,
1064
                         offset, size, n->guest_hdr_len, n->host_hdr_len);
1065 1066 1067
#endif
            return size;
        }
A
aliguori 已提交
1068 1069

        /* signal other side */
1070
        virtqueue_fill(q->rx_vq, &elem, total, i++);
A
aliguori 已提交
1071 1072
    }

1073
    if (mhdr_cnt) {
1074
        virtio_stw_p(vdev, &mhdr.num_buffers, i);
1075 1076 1077
        iov_from_buf(mhdr_sg, mhdr_cnt,
                     0,
                     &mhdr.num_buffers, sizeof mhdr.num_buffers);
1078
    }
A
aliguori 已提交
1079

1080
    virtqueue_flush(q->rx_vq, i);
1081
    virtio_notify(vdev, q->rx_vq);
1082 1083

    return size;
A
aliguori 已提交
1084 1085
}

1086
static int32_t virtio_net_flush_tx(VirtIONetQueue *q);
1087

1088
static void virtio_net_tx_complete(NetClientState *nc, ssize_t len)
1089
{
J
Jason Wang 已提交
1090
    VirtIONet *n = qemu_get_nic_opaque(nc);
J
Jason Wang 已提交
1091
    VirtIONetQueue *q = virtio_net_get_subqueue(nc);
1092
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1093

1094
    virtqueue_push(q->tx_vq, &q->async_tx.elem, 0);
1095
    virtio_notify(vdev, q->tx_vq);
1096

1097
    q->async_tx.elem.out_num = q->async_tx.len = 0;
1098

1099 1100
    virtio_queue_set_notification(q->tx_vq, 1);
    virtio_net_flush_tx(q);
1101 1102
}

A
aliguori 已提交
1103
/* TX */
1104
static int32_t virtio_net_flush_tx(VirtIONetQueue *q)
A
aliguori 已提交
1105
{
1106
    VirtIONet *n = q->n;
1107
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
A
aliguori 已提交
1108
    VirtQueueElement elem;
1109
    int32_t num_packets = 0;
J
Jason Wang 已提交
1110
    int queue_index = vq2q(virtio_get_queue_index(q->tx_vq));
1111
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
1112 1113
        return num_packets;
    }
A
aliguori 已提交
1114

1115
    assert(vdev->vm_running);
1116

1117 1118
    if (q->async_tx.elem.out_num) {
        virtio_queue_set_notification(q->tx_vq, 0);
1119
        return num_packets;
1120 1121
    }

1122
    while (virtqueue_pop(q->tx_vq, &elem)) {
1123
        ssize_t ret, len;
A
aliguori 已提交
1124 1125
        unsigned int out_num = elem.out_num;
        struct iovec *out_sg = &elem.out_sg[0];
1126
        struct iovec sg[VIRTQUEUE_MAX_SIZE];
A
aliguori 已提交
1127

M
Michael S. Tsirkin 已提交
1128
        if (out_num < 1) {
1129
            error_report("virtio-net header not in first element");
A
aliguori 已提交
1130 1131 1132
            exit(1);
        }

1133 1134 1135 1136 1137
        if (n->has_vnet_hdr) {
            if (out_sg[0].iov_len < n->guest_hdr_len) {
                error_report("virtio-net header incorrect");
                exit(1);
            }
1138
            virtio_net_hdr_swap(vdev, (void *) out_sg[0].iov_base);
1139 1140
        }

1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155
        /*
         * 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 已提交
1156 1157
        }

M
Michael S. Tsirkin 已提交
1158
        len = n->guest_hdr_len;
1159

J
Jason Wang 已提交
1160 1161
        ret = qemu_sendv_packet_async(qemu_get_subqueue(n->nic, queue_index),
                                      out_sg, out_num, virtio_net_tx_complete);
1162
        if (ret == 0) {
1163 1164 1165
            virtio_queue_set_notification(q->tx_vq, 0);
            q->async_tx.elem = elem;
            q->async_tx.len  = len;
1166
            return -EBUSY;
1167 1168 1169
        }

        len += ret;
A
aliguori 已提交
1170

1171
        virtqueue_push(q->tx_vq, &elem, 0);
1172
        virtio_notify(vdev, q->tx_vq);
1173 1174 1175 1176

        if (++num_packets >= n->tx_burst) {
            break;
        }
A
aliguori 已提交
1177
    }
1178
    return num_packets;
A
aliguori 已提交
1179 1180
}

1181
static void virtio_net_handle_tx_timer(VirtIODevice *vdev, VirtQueue *vq)
A
aliguori 已提交
1182
{
1183
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
1184
    VirtIONetQueue *q = &n->vqs[vq2q(virtio_get_queue_index(vq))];
A
aliguori 已提交
1185

1186
    /* This happens when device was stopped but VCPU wasn't. */
1187
    if (!vdev->vm_running) {
1188
        q->tx_waiting = 1;
1189 1190 1191
        return;
    }

1192
    if (q->tx_waiting) {
A
aliguori 已提交
1193
        virtio_queue_set_notification(vq, 1);
1194
        timer_del(q->tx_timer);
1195 1196
        q->tx_waiting = 0;
        virtio_net_flush_tx(q);
A
aliguori 已提交
1197
    } else {
1198 1199
        timer_mod(q->tx_timer,
                       qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + n->tx_timeout);
1200
        q->tx_waiting = 1;
A
aliguori 已提交
1201 1202 1203 1204
        virtio_queue_set_notification(vq, 0);
    }
}

1205 1206
static void virtio_net_handle_tx_bh(VirtIODevice *vdev, VirtQueue *vq)
{
1207
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
1208
    VirtIONetQueue *q = &n->vqs[vq2q(virtio_get_queue_index(vq))];
1209

1210
    if (unlikely(q->tx_waiting)) {
1211 1212
        return;
    }
1213
    q->tx_waiting = 1;
1214
    /* This happens when device was stopped but VCPU wasn't. */
1215
    if (!vdev->vm_running) {
1216 1217
        return;
    }
1218
    virtio_queue_set_notification(vq, 0);
1219
    qemu_bh_schedule(q->tx_bh);
1220 1221
}

A
aliguori 已提交
1222 1223
static void virtio_net_tx_timer(void *opaque)
{
1224 1225
    VirtIONetQueue *q = opaque;
    VirtIONet *n = q->n;
1226
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1227 1228 1229 1230 1231 1232
    /* 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 已提交
1233

1234
    q->tx_waiting = 0;
A
aliguori 已提交
1235 1236

    /* Just in case the driver is not ready on more */
1237
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
A
aliguori 已提交
1238
        return;
1239
    }
A
aliguori 已提交
1240

1241 1242
    virtio_queue_set_notification(q->tx_vq, 1);
    virtio_net_flush_tx(q);
A
aliguori 已提交
1243 1244
}

1245 1246
static void virtio_net_tx_bh(void *opaque)
{
1247 1248
    VirtIONetQueue *q = opaque;
    VirtIONet *n = q->n;
1249
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
1250 1251
    int32_t ret;

1252 1253 1254 1255 1256 1257
    /* 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;
    }
1258

1259
    q->tx_waiting = 0;
1260 1261

    /* Just in case the driver is not ready on more */
1262
    if (unlikely(!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))) {
1263
        return;
1264
    }
1265

1266
    ret = virtio_net_flush_tx(q);
1267 1268 1269 1270 1271 1272 1273
    if (ret == -EBUSY) {
        return; /* Notification re-enable handled by tx_complete */
    }

    /* If we flush a full burst of packets, assume there are
     * more coming and immediately reschedule */
    if (ret >= n->tx_burst) {
1274 1275
        qemu_bh_schedule(q->tx_bh);
        q->tx_waiting = 1;
1276 1277 1278 1279 1280 1281
        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 */
1282 1283 1284 1285 1286
    virtio_queue_set_notification(q->tx_vq, 1);
    if (virtio_net_flush_tx(q) > 0) {
        virtio_queue_set_notification(q->tx_vq, 0);
        qemu_bh_schedule(q->tx_bh);
        q->tx_waiting = 1;
1287 1288 1289
    }
}

J
Jason Wang 已提交
1290
static void virtio_net_set_multiqueue(VirtIONet *n, int multiqueue)
J
Jason Wang 已提交
1291
{
1292
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
J
Jason Wang 已提交
1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305
    int i, max = multiqueue ? n->max_queues : 1;

    n->multiqueue = multiqueue;

    for (i = 2; i <= n->max_queues * 2 + 1; i++) {
        virtio_del_queue(vdev, i);
    }

    for (i = 1; i < max; i++) {
        n->vqs[i].rx_vq = virtio_add_queue(vdev, 256, virtio_net_handle_rx);
        if (n->vqs[i].tx_timer) {
            n->vqs[i].tx_vq =
                virtio_add_queue(vdev, 256, virtio_net_handle_tx_timer);
1306
            n->vqs[i].tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
J
Jason Wang 已提交
1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
                                                   virtio_net_tx_timer,
                                                   &n->vqs[i]);
        } else {
            n->vqs[i].tx_vq =
                virtio_add_queue(vdev, 256, virtio_net_handle_tx_bh);
            n->vqs[i].tx_bh = qemu_bh_new(virtio_net_tx_bh, &n->vqs[i]);
        }

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

J
Jason Wang 已提交
1319 1320 1321 1322 1323
    /* Note: Minux Guests (version 3.2.1) use ctrl vq but don't ack
     * VIRTIO_NET_F_CTRL_VQ. Create ctrl vq unconditionally to avoid
     * breaking them.
     */
    n->ctrl_vq = virtio_add_queue(vdev, 64, virtio_net_handle_ctrl);
J
Jason Wang 已提交
1324 1325 1326 1327

    virtio_net_set_queues(n);
}

A
aliguori 已提交
1328 1329 1330
static void virtio_net_save(QEMUFile *f, void *opaque)
{
    VirtIONet *n = opaque;
1331
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
A
aliguori 已提交
1332

1333 1334 1335
    /* At this point, backend must be stopped, otherwise
     * it might keep writing to memory. */
    assert(!n->vhost_started);
1336
    virtio_save(vdev, f);
1337 1338 1339 1340 1341 1342
}

static void virtio_net_save_device(VirtIODevice *vdev, QEMUFile *f)
{
    VirtIONet *n = VIRTIO_NET(vdev);
    int i;
A
aliguori 已提交
1343

1344
    qemu_put_buffer(f, n->mac, ETH_ALEN);
1345
    qemu_put_be32(f, n->vqs[0].tx_waiting);
1346
    qemu_put_be32(f, n->mergeable_rx_bufs);
1347
    qemu_put_be16(f, n->status);
1348 1349
    qemu_put_byte(f, n->promisc);
    qemu_put_byte(f, n->allmulti);
1350 1351
    qemu_put_be32(f, n->mac_table.in_use);
    qemu_put_buffer(f, n->mac_table.macs, n->mac_table.in_use * ETH_ALEN);
1352
    qemu_put_buffer(f, (uint8_t *)n->vlans, MAX_VLAN >> 3);
M
Mark McLoughlin 已提交
1353
    qemu_put_be32(f, n->has_vnet_hdr);
1354 1355
    qemu_put_byte(f, n->mac_table.multi_overflow);
    qemu_put_byte(f, n->mac_table.uni_overflow);
1356 1357 1358 1359
    qemu_put_byte(f, n->alluni);
    qemu_put_byte(f, n->nomulti);
    qemu_put_byte(f, n->nouni);
    qemu_put_byte(f, n->nobcast);
1360
    qemu_put_byte(f, n->has_ufo);
1361 1362 1363 1364 1365 1366 1367
    if (n->max_queues > 1) {
        qemu_put_be16(f, n->max_queues);
        qemu_put_be16(f, n->curr_queues);
        for (i = 1; i < n->curr_queues; i++) {
            qemu_put_be32(f, n->vqs[i].tx_waiting);
        }
    }
1368 1369 1370 1371

    if ((1 << VIRTIO_NET_F_CTRL_GUEST_OFFLOADS) & vdev->guest_features) {
        qemu_put_be64(f, n->curr_guest_offloads);
    }
A
aliguori 已提交
1372 1373 1374 1375 1376
}

static int virtio_net_load(QEMUFile *f, void *opaque, int version_id)
{
    VirtIONet *n = opaque;
1377
    VirtIODevice *vdev = VIRTIO_DEVICE(n);
A
aliguori 已提交
1378

1379
    if (version_id < 2 || version_id > VIRTIO_NET_VM_VERSION)
A
aliguori 已提交
1380 1381
        return -EINVAL;

1382 1383 1384 1385 1386 1387 1388 1389
    return virtio_load(vdev, f, version_id);
}

static int virtio_net_load_device(VirtIODevice *vdev, QEMUFile *f,
                                  int version_id)
{
    VirtIONet *n = VIRTIO_NET(vdev);
    int i, link_down;
A
aliguori 已提交
1390

1391
    qemu_get_buffer(f, n->mac, ETH_ALEN);
1392
    n->vqs[0].tx_waiting = qemu_get_be32(f);
1393 1394

    virtio_net_set_mrg_rx_bufs(n, qemu_get_be32(f));
A
aliguori 已提交
1395

1396 1397 1398
    if (version_id >= 3)
        n->status = qemu_get_be16(f);

1399
    if (version_id >= 4) {
1400 1401 1402 1403 1404 1405 1406
        if (version_id < 8) {
            n->promisc = qemu_get_be32(f);
            n->allmulti = qemu_get_be32(f);
        } else {
            n->promisc = qemu_get_byte(f);
            n->allmulti = qemu_get_byte(f);
        }
1407 1408
    }

1409 1410 1411 1412 1413 1414
    if (version_id >= 5) {
        n->mac_table.in_use = qemu_get_be32(f);
        /* MAC_TABLE_ENTRIES may be different from the saved image */
        if (n->mac_table.in_use <= MAC_TABLE_ENTRIES) {
            qemu_get_buffer(f, n->mac_table.macs,
                            n->mac_table.in_use * ETH_ALEN);
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425
        } else {
            int64_t i;

            /* Overflow detected - can happen if source has a larger MAC table.
             * We simply set overflow flag so there's no need to maintain the
             * table of addresses, discard them all.
             * Note: 64 bit math to avoid integer overflow.
             */
            for (i = 0; i < (int64_t)n->mac_table.in_use * ETH_ALEN; ++i) {
                qemu_get_byte(f);
            }
1426
            n->mac_table.multi_overflow = n->mac_table.uni_overflow = 1;
1427 1428 1429 1430
            n->mac_table.in_use = 0;
        }
    }
 
1431 1432 1433
    if (version_id >= 6)
        qemu_get_buffer(f, (uint8_t *)n->vlans, MAX_VLAN >> 3);

M
Mark McLoughlin 已提交
1434 1435
    if (version_id >= 7) {
        if (qemu_get_be32(f) && !peer_has_vnet_hdr(n)) {
1436
            error_report("virtio-net: saved image requires vnet_hdr=on");
M
Mark McLoughlin 已提交
1437 1438
            return -1;
        }
1439 1440
    }

1441 1442 1443 1444 1445
    if (version_id >= 9) {
        n->mac_table.multi_overflow = qemu_get_byte(f);
        n->mac_table.uni_overflow = qemu_get_byte(f);
    }

1446 1447 1448 1449 1450 1451 1452
    if (version_id >= 10) {
        n->alluni = qemu_get_byte(f);
        n->nomulti = qemu_get_byte(f);
        n->nouni = qemu_get_byte(f);
        n->nobcast = qemu_get_byte(f);
    }

1453 1454
    if (version_id >= 11) {
        if (qemu_get_byte(f) && !peer_has_ufo(n)) {
1455
            error_report("virtio-net: saved image requires TUN_F_UFO support");
1456 1457 1458 1459
            return -1;
        }
    }

1460 1461 1462 1463 1464 1465 1466
    if (n->max_queues > 1) {
        if (n->max_queues != qemu_get_be16(f)) {
            error_report("virtio-net: different max_queues ");
            return -1;
        }

        n->curr_queues = qemu_get_be16(f);
1467 1468 1469 1470 1471
        if (n->curr_queues > n->max_queues) {
            error_report("virtio-net: curr_queues %x > max_queues %x",
                         n->curr_queues, n->max_queues);
            return -1;
        }
1472 1473 1474 1475 1476
        for (i = 1; i < n->curr_queues; i++) {
            n->vqs[i].tx_waiting = qemu_get_be32(f);
        }
    }

1477 1478 1479 1480 1481 1482 1483 1484 1485 1486
    if ((1 << VIRTIO_NET_F_CTRL_GUEST_OFFLOADS) & vdev->guest_features) {
        n->curr_guest_offloads = qemu_get_be64(f);
    } else {
        n->curr_guest_offloads = virtio_net_supported_guest_offloads(n);
    }

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

1487 1488
    virtio_net_set_queues(n);

1489 1490 1491 1492 1493 1494 1495
    /* 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;
1496 1497 1498

    /* nc.link_down can't be migrated, so infer link_down according
     * to link status bit in n->status */
1499 1500 1501 1502
    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;
    }
1503

J
Jason Wang 已提交
1504 1505 1506 1507 1508 1509
    if (vdev->guest_features & (0x1 << VIRTIO_NET_F_GUEST_ANNOUNCE) &&
        vdev->guest_features & (0x1 << 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 已提交
1510 1511 1512
    return 0;
}

1513
static void virtio_net_cleanup(NetClientState *nc)
1514
{
J
Jason Wang 已提交
1515
    VirtIONet *n = qemu_get_nic_opaque(nc);
1516

M
Mark McLoughlin 已提交
1517
    n->nic = NULL;
1518 1519
}

M
Mark McLoughlin 已提交
1520
static NetClientInfo net_virtio_info = {
1521
    .type = NET_CLIENT_OPTIONS_KIND_NIC,
M
Mark McLoughlin 已提交
1522 1523 1524
    .size = sizeof(NICState),
    .can_receive = virtio_net_can_receive,
    .receive = virtio_net_receive,
Z
Zhi Yong Wu 已提交
1525
    .cleanup = virtio_net_cleanup,
M
Mark McLoughlin 已提交
1526
    .link_status_changed = virtio_net_set_link_status,
1527
    .query_rx_filter = virtio_net_query_rxfilter,
M
Mark McLoughlin 已提交
1528 1529
};

1530 1531
static bool virtio_net_guest_notifier_pending(VirtIODevice *vdev, int idx)
{
1532
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
1533
    NetClientState *nc = qemu_get_subqueue(n->nic, vq2q(idx));
1534
    assert(n->vhost_started);
1535
    return vhost_net_virtqueue_pending(get_vhost_net(nc->peer), idx);
1536 1537 1538 1539 1540
}

static void virtio_net_guest_notifier_mask(VirtIODevice *vdev, int idx,
                                           bool mask)
{
1541
    VirtIONet *n = VIRTIO_NET(vdev);
J
Jason Wang 已提交
1542
    NetClientState *nc = qemu_get_subqueue(n->nic, vq2q(idx));
1543
    assert(n->vhost_started);
1544
    vhost_net_virtqueue_mask(get_vhost_net(nc->peer),
1545 1546 1547
                             vdev, idx, mask);
}

1548
void virtio_net_set_config_size(VirtIONet *n, uint32_t host_features)
A
aliguori 已提交
1549
{
1550
    int i, config_size = 0;
1551
    host_features |= (1 << VIRTIO_NET_F_MAC);
1552 1553 1554 1555 1556
    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);
        }
    }
1557 1558 1559
    n->config_size = config_size;
}

1560 1561 1562 1563 1564 1565 1566 1567
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);

1568 1569
    g_free(n->netclient_name);
    g_free(n->netclient_type);
1570
    n->netclient_name = g_strdup(name);
1571 1572 1573
    n->netclient_type = g_strdup(type);
}

1574
static void virtio_net_device_realize(DeviceState *dev, Error **errp)
1575
{
1576
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
1577
    VirtIONet *n = VIRTIO_NET(dev);
1578
    NetClientState *nc;
1579
    int i;
1580

1581
    virtio_init(vdev, "virtio-net", VIRTIO_ID_NET, n->config_size);
A
aliguori 已提交
1582

1583
    n->max_queues = MAX(n->nic_conf.peers.queues, 1);
1584
    n->vqs = g_malloc0(sizeof(VirtIONetQueue) * n->max_queues);
1585
    n->vqs[0].rx_vq = virtio_add_queue(vdev, 256, virtio_net_handle_rx);
J
Jason Wang 已提交
1586 1587
    n->curr_queues = 1;
    n->vqs[0].n = n;
1588
    n->tx_timeout = n->net_conf.txtimer;
1589

1590 1591
    if (n->net_conf.tx && strcmp(n->net_conf.tx, "timer")
                       && strcmp(n->net_conf.tx, "bh")) {
1592 1593
        error_report("virtio-net: "
                     "Unknown option tx=%s, valid options: \"timer\" \"bh\"",
1594
                     n->net_conf.tx);
1595
        error_report("Defaulting to \"bh\"");
1596 1597
    }

1598
    if (n->net_conf.tx && !strcmp(n->net_conf.tx, "timer")) {
1599
        n->vqs[0].tx_vq = virtio_add_queue(vdev, 256,
J
Jason Wang 已提交
1600
                                           virtio_net_handle_tx_timer);
1601
        n->vqs[0].tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, virtio_net_tx_timer,
J
Jason Wang 已提交
1602
                                               &n->vqs[0]);
1603
    } else {
1604
        n->vqs[0].tx_vq = virtio_add_queue(vdev, 256,
J
Jason Wang 已提交
1605 1606
                                           virtio_net_handle_tx_bh);
        n->vqs[0].tx_bh = qemu_bh_new(virtio_net_tx_bh, &n->vqs[0]);
1607
    }
1608
    n->ctrl_vq = virtio_add_queue(vdev, 64, virtio_net_handle_ctrl);
1609 1610
    qemu_macaddr_default_if_unset(&n->nic_conf.macaddr);
    memcpy(&n->mac[0], &n->nic_conf.macaddr, sizeof(n->mac));
1611
    n->status = VIRTIO_NET_S_LINK_UP;
J
Jason Wang 已提交
1612 1613
    n->announce_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL,
                                     virtio_net_announce_timer, n);
A
aliguori 已提交
1614

1615 1616 1617 1618 1619 1620 1621 1622
    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,
1623
                              object_get_typename(OBJECT(dev)), dev->id, n);
1624 1625
    }

1626 1627
    peer_test_vnet_hdr(n);
    if (peer_has_vnet_hdr(n)) {
J
Jason Wang 已提交
1628
        for (i = 0; i < n->max_queues; i++) {
1629
            qemu_using_vnet_hdr(qemu_get_subqueue(n->nic, i)->peer, true);
J
Jason Wang 已提交
1630
        }
1631 1632 1633 1634
        n->host_hdr_len = sizeof(struct virtio_net_hdr);
    } else {
        n->host_hdr_len = 0;
    }
M
Mark McLoughlin 已提交
1635

1636
    qemu_format_nic_info_str(qemu_get_queue(n->nic), n->nic_conf.macaddr.a);
1637

J
Jason Wang 已提交
1638
    n->vqs[0].tx_waiting = 0;
1639
    n->tx_burst = n->net_conf.txburst;
1640
    virtio_net_set_mrg_rx_bufs(n, 0);
1641
    n->promisc = 1; /* for compatibility */
A
aliguori 已提交
1642

1643
    n->mac_table.macs = g_malloc0(MAC_TABLE_ENTRIES * ETH_ALEN);
1644

1645
    n->vlans = g_malloc0(MAX_VLAN >> 3);
1646

1647 1648 1649
    nc = qemu_get_queue(n->nic);
    nc->rxfilter_notify_enabled = 1;

1650 1651
    n->qdev = dev;
    register_savevm(dev, "virtio-net", -1, VIRTIO_NET_VM_VERSION,
A
aliguori 已提交
1652
                    virtio_net_save, virtio_net_load, n);
P
Paul Brook 已提交
1653

1654
    add_boot_device_path(n->nic_conf.bootindex, dev, "/ethernet-phy@0");
1655 1656
}

1657
static void virtio_net_device_unrealize(DeviceState *dev, Error **errp)
1658
{
1659 1660
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
    VirtIONet *n = VIRTIO_NET(dev);
1661 1662 1663 1664 1665
    int i;

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

1666
    unregister_savevm(dev, "virtio-net", n);
1667

1668 1669 1670 1671
    g_free(n->netclient_name);
    n->netclient_name = NULL;
    g_free(n->netclient_type);
    n->netclient_type = NULL;
1672

1673 1674 1675 1676 1677 1678 1679 1680 1681 1682
    g_free(n->mac_table.macs);
    g_free(n->vlans);

    for (i = 0; i < n->max_queues; i++) {
        VirtIONetQueue *q = &n->vqs[i];
        NetClientState *nc = qemu_get_subqueue(n->nic, i);

        qemu_purge_queued_packets(nc);

        if (q->tx_timer) {
1683 1684
            timer_del(q->tx_timer);
            timer_free(q->tx_timer);
1685
        } else if (q->tx_bh) {
1686 1687 1688 1689
            qemu_bh_delete(q->tx_bh);
        }
    }

J
Jason Wang 已提交
1690 1691
    timer_del(n->announce_timer);
    timer_free(n->announce_timer);
1692 1693
    g_free(n->vqs);
    qemu_del_nic(n->nic);
1694
    virtio_cleanup(vdev);
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
}

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);
}

static Property virtio_net_properties[] = {
    DEFINE_NIC_PROPERTIES(VirtIONet, nic_conf),
    DEFINE_PROP_UINT32("x-txtimer", VirtIONet, net_conf.txtimer,
                                               TX_TIMER_INTERVAL),
    DEFINE_PROP_INT32("x-txburst", VirtIONet, net_conf.txburst, TX_BURST),
    DEFINE_PROP_STRING("tx", VirtIONet, net_conf.tx),
    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);
1721

1722
    dc->props = virtio_net_properties;
1723
    set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
1724
    vdc->realize = virtio_net_device_realize;
1725
    vdc->unrealize = virtio_net_device_unrealize;
1726 1727 1728 1729 1730 1731 1732 1733 1734
    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;
1735 1736
    vdc->load = virtio_net_load_device;
    vdc->save = virtio_net_save_device;
1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752
}

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)