virtio.c 69.3 KB
Newer Older
A
aliguori 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13
/*
 * Virtio Support
 *
 * 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 "qapi/error.h"
16 17
#include "qemu-common.h"
#include "cpu.h"
18
#include "trace.h"
19
#include "exec/address-spaces.h"
20
#include "qemu/error-report.h"
P
Paolo Bonzini 已提交
21
#include "hw/virtio/virtio.h"
22
#include "qemu/atomic.h"
P
Paolo Bonzini 已提交
23
#include "hw/virtio/virtio-bus.h"
24
#include "migration/migration.h"
25
#include "hw/virtio/virtio-access.h"
J
Jason Wang 已提交
26
#include "sysemu/dma.h"
A
aliguori 已提交
27

28 29 30 31 32
/*
 * The alignment to use between consumer and producer parts of vring.
 * x86 pagesize again. This is the default, used by transports like PCI
 * which don't provide a means for the guest to tell the host the alignment.
 */
33 34
#define VIRTIO_PCI_VRING_ALIGN         4096

A
aliguori 已提交
35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62
typedef struct VRingDesc
{
    uint64_t addr;
    uint32_t len;
    uint16_t flags;
    uint16_t next;
} VRingDesc;

typedef struct VRingAvail
{
    uint16_t flags;
    uint16_t idx;
    uint16_t ring[0];
} VRingAvail;

typedef struct VRingUsedElem
{
    uint32_t id;
    uint32_t len;
} VRingUsedElem;

typedef struct VRingUsed
{
    uint16_t flags;
    uint16_t idx;
    VRingUsedElem ring[0];
} VRingUsed;

63 64 65 66 67 68 69
typedef struct VRingMemoryRegionCaches {
    struct rcu_head rcu;
    MemoryRegionCache desc;
    MemoryRegionCache avail;
    MemoryRegionCache used;
} VRingMemoryRegionCaches;

A
aliguori 已提交
70 71 72
typedef struct VRing
{
    unsigned int num;
C
Cornelia Huck 已提交
73
    unsigned int num_default;
74
    unsigned int align;
A
Avi Kivity 已提交
75 76 77
    hwaddr desc;
    hwaddr avail;
    hwaddr used;
78
    VRingMemoryRegionCaches *caches;
A
aliguori 已提交
79 80 81 82 83
} VRing;

struct VirtQueue
{
    VRing vring;
84 85

    /* Next head to pop */
A
aliguori 已提交
86
    uint16_t last_avail_idx;
87

88 89 90
    /* Last avail_idx read from VQ. */
    uint16_t shadow_avail_idx;

91 92
    uint16_t used_idx;

M
Michael S. Tsirkin 已提交
93 94 95 96 97 98
    /* Last used index value we have signalled on */
    uint16_t signalled_used;

    /* Last used index value we have signalled on */
    bool signalled_used_valid;

99 100
    /* Notification enabled? */
    bool notification;
M
Michael S. Tsirkin 已提交
101

102 103
    uint16_t queue_index;

104
    unsigned int inuse;
M
Michael S. Tsirkin 已提交
105

106
    uint16_t vector;
107
    VirtIOHandleOutput handle_output;
108
    VirtIOHandleAIOOutput handle_aio_output;
109 110 111
    VirtIODevice *vdev;
    EventNotifier guest_notifier;
    EventNotifier host_notifier;
112
    QLIST_ENTRY(VirtQueue) node;
A
aliguori 已提交
113 114
};

115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159
static void virtio_free_region_cache(VRingMemoryRegionCaches *caches)
{
    if (!caches) {
        return;
    }

    address_space_cache_destroy(&caches->desc);
    address_space_cache_destroy(&caches->avail);
    address_space_cache_destroy(&caches->used);
    g_free(caches);
}

static void virtio_init_region_cache(VirtIODevice *vdev, int n)
{
    VirtQueue *vq = &vdev->vq[n];
    VRingMemoryRegionCaches *old = vq->vring.caches;
    VRingMemoryRegionCaches *new;
    hwaddr addr, size;
    int event_size;

    event_size = virtio_vdev_has_feature(vq->vdev, VIRTIO_RING_F_EVENT_IDX) ? 2 : 0;

    addr = vq->vring.desc;
    if (!addr) {
        return;
    }
    new = g_new0(VRingMemoryRegionCaches, 1);
    size = virtio_queue_get_desc_size(vdev, n);
    address_space_cache_init(&new->desc, vdev->dma_as,
                             addr, size, false);

    size = virtio_queue_get_used_size(vdev, n) + event_size;
    address_space_cache_init(&new->used, vdev->dma_as,
                             vq->vring.used, size, true);

    size = virtio_queue_get_avail_size(vdev, n) + event_size;
    address_space_cache_init(&new->avail, vdev->dma_as,
                             vq->vring.avail, size, false);

    atomic_rcu_set(&vq->vring.caches, new);
    if (old) {
        call_rcu(old, virtio_free_region_cache, rcu);
    }
}

A
aliguori 已提交
160
/* virt queue functions */
161
void virtio_queue_update_rings(VirtIODevice *vdev, int n)
A
aliguori 已提交
162
{
163
    VRing *vring = &vdev->vq[n].vring;
P
Paul Brook 已提交
164

165 166 167 168 169 170 171 172
    if (!vring->desc) {
        /* not yet setup -> nothing to do */
        return;
    }
    vring->avail = vring->desc + vring->num * sizeof(VRingDesc);
    vring->used = vring_align(vring->avail +
                              offsetof(VRingAvail, ring[vring->num]),
                              vring->align);
173
    virtio_init_region_cache(vdev, n);
A
aliguori 已提交
174 175
}

176
static void vring_desc_read(VirtIODevice *vdev, VRingDesc *desc,
177
                            MemoryRegionCache *cache, int i)
A
aliguori 已提交
178
{
179 180
    address_space_read_cached(cache, i * sizeof(VRingDesc),
                              desc, sizeof(VRingDesc));
181 182 183 184
    virtio_tswap64s(vdev, &desc->addr);
    virtio_tswap32s(vdev, &desc->len);
    virtio_tswap16s(vdev, &desc->flags);
    virtio_tswap16s(vdev, &desc->next);
A
aliguori 已提交
185 186 187 188
}

static inline uint16_t vring_avail_flags(VirtQueue *vq)
{
A
Avi Kivity 已提交
189
    hwaddr pa;
A
aliguori 已提交
190
    pa = vq->vring.avail + offsetof(VRingAvail, flags);
191
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
192 193 194 195
}

static inline uint16_t vring_avail_idx(VirtQueue *vq)
{
A
Avi Kivity 已提交
196
    hwaddr pa;
A
aliguori 已提交
197
    pa = vq->vring.avail + offsetof(VRingAvail, idx);
198 199
    vq->shadow_avail_idx = virtio_lduw_phys(vq->vdev, pa);
    return vq->shadow_avail_idx;
A
aliguori 已提交
200 201 202 203
}

static inline uint16_t vring_avail_ring(VirtQueue *vq, int i)
{
A
Avi Kivity 已提交
204
    hwaddr pa;
A
aliguori 已提交
205
    pa = vq->vring.avail + offsetof(VRingAvail, ring[i]);
206
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
207 208
}

209
static inline uint16_t vring_get_used_event(VirtQueue *vq)
M
Michael S. Tsirkin 已提交
210 211 212 213
{
    return vring_avail_ring(vq, vq->vring.num);
}

214 215
static inline void vring_used_write(VirtQueue *vq, VRingUsedElem *uelem,
                                    int i)
A
aliguori 已提交
216
{
A
Avi Kivity 已提交
217
    hwaddr pa;
218 219 220
    virtio_tswap32s(vq->vdev, &uelem->id);
    virtio_tswap32s(vq->vdev, &uelem->len);
    pa = vq->vring.used + offsetof(VRingUsed, ring[i]);
J
Jason Wang 已提交
221
    address_space_write(vq->vdev->dma_as, pa, MEMTXATTRS_UNSPECIFIED,
222
                       (void *)uelem, sizeof(VRingUsedElem));
A
aliguori 已提交
223 224 225 226
}

static uint16_t vring_used_idx(VirtQueue *vq)
{
A
Avi Kivity 已提交
227
    hwaddr pa;
A
aliguori 已提交
228
    pa = vq->vring.used + offsetof(VRingUsed, idx);
229
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
230 231
}

M
Michael S. Tsirkin 已提交
232
static inline void vring_used_idx_set(VirtQueue *vq, uint16_t val)
A
aliguori 已提交
233
{
A
Avi Kivity 已提交
234
    hwaddr pa;
A
aliguori 已提交
235
    pa = vq->vring.used + offsetof(VRingUsed, idx);
236
    virtio_stw_phys(vq->vdev, pa, val);
237
    vq->used_idx = val;
A
aliguori 已提交
238 239 240 241
}

static inline void vring_used_flags_set_bit(VirtQueue *vq, int mask)
{
242
    VirtIODevice *vdev = vq->vdev;
A
Avi Kivity 已提交
243
    hwaddr pa;
A
aliguori 已提交
244
    pa = vq->vring.used + offsetof(VRingUsed, flags);
245
    virtio_stw_phys(vdev, pa, virtio_lduw_phys(vdev, pa) | mask);
A
aliguori 已提交
246 247 248 249
}

static inline void vring_used_flags_unset_bit(VirtQueue *vq, int mask)
{
250
    VirtIODevice *vdev = vq->vdev;
A
Avi Kivity 已提交
251
    hwaddr pa;
A
aliguori 已提交
252
    pa = vq->vring.used + offsetof(VRingUsed, flags);
253
    virtio_stw_phys(vdev, pa, virtio_lduw_phys(vdev, pa) & ~mask);
A
aliguori 已提交
254 255
}

256
static inline void vring_set_avail_event(VirtQueue *vq, uint16_t val)
M
Michael S. Tsirkin 已提交
257
{
A
Avi Kivity 已提交
258
    hwaddr pa;
259
    if (!vq->notification) {
M
Michael S. Tsirkin 已提交
260 261 262
        return;
    }
    pa = vq->vring.used + offsetof(VRingUsed, ring[vq->vring.num]);
263
    virtio_stw_phys(vq->vdev, pa, val);
M
Michael S. Tsirkin 已提交
264 265
}

A
aliguori 已提交
266 267
void virtio_queue_set_notification(VirtQueue *vq, int enable)
{
268
    vq->notification = enable;
269
    if (virtio_vdev_has_feature(vq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
270
        vring_set_avail_event(vq, vring_avail_idx(vq));
M
Michael S. Tsirkin 已提交
271
    } else if (enable) {
A
aliguori 已提交
272
        vring_used_flags_unset_bit(vq, VRING_USED_F_NO_NOTIFY);
M
Michael S. Tsirkin 已提交
273
    } else {
A
aliguori 已提交
274
        vring_used_flags_set_bit(vq, VRING_USED_F_NO_NOTIFY);
M
Michael S. Tsirkin 已提交
275
    }
276 277 278 279
    if (enable) {
        /* Expose avail event/used flags before caller checks the avail idx. */
        smp_mb();
    }
A
aliguori 已提交
280 281 282 283 284 285 286
}

int virtio_queue_ready(VirtQueue *vq)
{
    return vq->vring.avail != 0;
}

287 288
/* Fetch avail_idx from VQ memory only when we really need to know if
 * guest has added some buffers. */
A
aliguori 已提交
289 290
int virtio_queue_empty(VirtQueue *vq)
{
291 292 293 294
    if (vq->shadow_avail_idx != vq->last_avail_idx) {
        return 0;
    }

A
aliguori 已提交
295 296 297
    return vring_avail_idx(vq) == vq->last_avail_idx;
}

298 299
static void virtqueue_unmap_sg(VirtQueue *vq, const VirtQueueElement *elem,
                               unsigned int len)
A
aliguori 已提交
300
{
J
Jason Wang 已提交
301
    AddressSpace *dma_as = vq->vdev->dma_as;
A
aliguori 已提交
302 303 304 305 306 307 308
    unsigned int offset;
    int i;

    offset = 0;
    for (i = 0; i < elem->in_num; i++) {
        size_t size = MIN(len - offset, elem->in_sg[i].iov_len);

J
Jason Wang 已提交
309 310 311
        dma_memory_unmap(dma_as, elem->in_sg[i].iov_base,
                         elem->in_sg[i].iov_len,
                         DMA_DIRECTION_FROM_DEVICE, size);
A
aliguori 已提交
312

313
        offset += size;
A
aliguori 已提交
314 315
    }

316
    for (i = 0; i < elem->out_num; i++)
J
Jason Wang 已提交
317 318 319 320
        dma_memory_unmap(dma_as, elem->out_sg[i].iov_base,
                         elem->out_sg[i].iov_len,
                         DMA_DIRECTION_TO_DEVICE,
                         elem->out_sg[i].iov_len);
321 322
}

323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338
/* virtqueue_detach_element:
 * @vq: The #VirtQueue
 * @elem: The #VirtQueueElement
 * @len: number of bytes written
 *
 * Detach the element from the virtqueue.  This function is suitable for device
 * reset or other situations where a #VirtQueueElement is simply freed and will
 * not be pushed or discarded.
 */
void virtqueue_detach_element(VirtQueue *vq, const VirtQueueElement *elem,
                              unsigned int len)
{
    vq->inuse--;
    virtqueue_unmap_sg(vq, elem, len);
}

339
/* virtqueue_unpop:
340 341 342 343 344 345 346
 * @vq: The #VirtQueue
 * @elem: The #VirtQueueElement
 * @len: number of bytes written
 *
 * Pretend the most recent element wasn't popped from the virtqueue.  The next
 * call to virtqueue_pop() will refetch the element.
 */
347 348
void virtqueue_unpop(VirtQueue *vq, const VirtQueueElement *elem,
                     unsigned int len)
J
Jason Wang 已提交
349 350
{
    vq->last_avail_idx--;
351
    virtqueue_detach_element(vq, elem, len);
J
Jason Wang 已提交
352 353
}

S
Stefan Hajnoczi 已提交
354 355 356 357 358 359 360
/* virtqueue_rewind:
 * @vq: The #VirtQueue
 * @num: Number of elements to push back
 *
 * Pretend that elements weren't popped from the virtqueue.  The next
 * virtqueue_pop() will refetch the oldest element.
 *
361
 * Use virtqueue_unpop() instead if you have a VirtQueueElement.
S
Stefan Hajnoczi 已提交
362 363 364 365 366 367 368 369 370 371 372 373 374 375
 *
 * Returns: true on success, false if @num is greater than the number of in use
 * elements.
 */
bool virtqueue_rewind(VirtQueue *vq, unsigned int num)
{
    if (num > vq->inuse) {
        return false;
    }
    vq->last_avail_idx -= num;
    vq->inuse -= num;
    return true;
}

376 377 378
void virtqueue_fill(VirtQueue *vq, const VirtQueueElement *elem,
                    unsigned int len, unsigned int idx)
{
379 380
    VRingUsedElem uelem;

381 382 383
    trace_virtqueue_fill(vq, elem, len, idx);

    virtqueue_unmap_sg(vq, elem, len);
384

385 386 387 388
    if (unlikely(vq->vdev->broken)) {
        return;
    }

389
    idx = (idx + vq->used_idx) % vq->vring.num;
A
aliguori 已提交
390

391 392 393
    uelem.id = elem->index;
    uelem.len = len;
    vring_used_write(vq, &uelem, idx);
A
aliguori 已提交
394 395 396 397
}

void virtqueue_flush(VirtQueue *vq, unsigned int count)
{
M
Michael S. Tsirkin 已提交
398
    uint16_t old, new;
399 400 401 402 403 404

    if (unlikely(vq->vdev->broken)) {
        vq->inuse -= count;
        return;
    }

A
aliguori 已提交
405
    /* Make sure buffer is written before we update index. */
406
    smp_wmb();
407
    trace_virtqueue_flush(vq, count);
408
    old = vq->used_idx;
M
Michael S. Tsirkin 已提交
409 410
    new = old + count;
    vring_used_idx_set(vq, new);
A
aliguori 已提交
411
    vq->inuse -= count;
M
Michael S. Tsirkin 已提交
412 413
    if (unlikely((int16_t)(new - vq->signalled_used) < (uint16_t)(new - old)))
        vq->signalled_used_valid = false;
A
aliguori 已提交
414 415 416 417 418 419 420 421 422 423 424 425 426 427
}

void virtqueue_push(VirtQueue *vq, const VirtQueueElement *elem,
                    unsigned int len)
{
    virtqueue_fill(vq, elem, len, 0);
    virtqueue_flush(vq, 1);
}

static int virtqueue_num_heads(VirtQueue *vq, unsigned int idx)
{
    uint16_t num_heads = vring_avail_idx(vq) - idx;

    /* Check it isn't doing very strange things with descriptor numbers. */
A
aliguori 已提交
428
    if (num_heads > vq->vring.num) {
429
        virtio_error(vq->vdev, "Guest moved used index from %u to %u",
430
                     idx, vq->shadow_avail_idx);
431
        return -EINVAL;
A
aliguori 已提交
432
    }
433 434 435 436 437
    /* On success, callers read a descriptor at vq->last_avail_idx.
     * Make sure descriptor read does not bypass avail index read. */
    if (num_heads) {
        smp_rmb();
    }
A
aliguori 已提交
438 439 440 441

    return num_heads;
}

442 443
static bool virtqueue_get_head(VirtQueue *vq, unsigned int idx,
                               unsigned int *head)
A
aliguori 已提交
444 445 446
{
    /* Grab the next descriptor number they're advertising, and increment
     * the index we've seen. */
447
    *head = vring_avail_ring(vq, idx % vq->vring.num);
A
aliguori 已提交
448 449

    /* If their number is silly, that's a fatal mistake. */
450 451 452
    if (*head >= vq->vring.num) {
        virtio_error(vq->vdev, "Guest says index %u is available", *head);
        return false;
A
aliguori 已提交
453
    }
A
aliguori 已提交
454

455
    return true;
A
aliguori 已提交
456 457
}

458 459 460 461 462
enum {
    VIRTQUEUE_READ_DESC_ERROR = -1,
    VIRTQUEUE_READ_DESC_DONE = 0,   /* end of chain */
    VIRTQUEUE_READ_DESC_MORE = 1,   /* more buffers in chain */
};
A
aliguori 已提交
463

464
static int virtqueue_read_next_desc(VirtIODevice *vdev, VRingDesc *desc,
465
                                    MemoryRegionCache *desc_cache, unsigned int max,
466 467
                                    unsigned int *next)
{
A
aliguori 已提交
468
    /* If this descriptor says it doesn't chain, we're done. */
469
    if (!(desc->flags & VRING_DESC_F_NEXT)) {
470
        return VIRTQUEUE_READ_DESC_DONE;
471
    }
A
aliguori 已提交
472 473

    /* Check they're not leading us off end of descriptors. */
474
    *next = desc->next;
A
aliguori 已提交
475
    /* Make sure compiler knows to grab that: we don't want it changing! */
476
    smp_wmb();
A
aliguori 已提交
477

478 479 480
    if (*next >= max) {
        virtio_error(vdev, "Desc next is %u", *next);
        return VIRTQUEUE_READ_DESC_ERROR;
A
aliguori 已提交
481
    }
A
aliguori 已提交
482

483
    vring_desc_read(vdev, desc, desc_cache, *next);
484
    return VIRTQUEUE_READ_DESC_MORE;
A
aliguori 已提交
485 486
}

487
void virtqueue_get_avail_bytes(VirtQueue *vq, unsigned int *in_bytes,
488 489
                               unsigned int *out_bytes,
                               unsigned max_in_bytes, unsigned max_out_bytes)
A
aliguori 已提交
490
{
491 492
    VirtIODevice *vdev = vq->vdev;
    unsigned int max, idx;
493
    unsigned int total_bufs, in_total, out_total;
494 495 496
    MemoryRegionCache vring_desc_cache;
    MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
    int64_t len = 0;
497
    int rc;
A
aliguori 已提交
498 499

    idx = vq->last_avail_idx;
500
    total_bufs = in_total = out_total = 0;
501 502

    max = vq->vring.num;
503 504 505
    len = address_space_cache_init(&vring_desc_cache, vdev->dma_as,
                                   vq->vring.desc, max * sizeof(VRingDesc),
                                   false);
506 507 508 509 510
    if (len < max * sizeof(VRingDesc)) {
        virtio_error(vdev, "Cannot map descriptor ring");
        goto err;
    }

511
    while ((rc = virtqueue_num_heads(vq, idx)) > 0) {
512
        MemoryRegionCache *desc_cache = &vring_desc_cache;
513
        unsigned int num_bufs;
514
        VRingDesc desc;
515
        unsigned int i;
A
aliguori 已提交
516

517
        num_bufs = total_bufs;
518 519 520 521 522

        if (!virtqueue_get_head(vq, idx++, &i)) {
            goto err;
        }

523
        vring_desc_read(vdev, &desc, desc_cache, i);
524

525 526
        if (desc.flags & VRING_DESC_F_INDIRECT) {
            if (desc.len % sizeof(VRingDesc)) {
527 528
                virtio_error(vdev, "Invalid size for indirect buffer table");
                goto err;
529 530 531 532
            }

            /* If we've got too many, that implies a descriptor loop. */
            if (num_bufs >= max) {
533 534
                virtio_error(vdev, "Looped descriptor");
                goto err;
535 536 537
            }

            /* loop over the indirect descriptor table */
538 539 540 541
            len = address_space_cache_init(&indirect_desc_cache,
                                           vdev->dma_as,
                                           desc.addr, desc.len, false);
            desc_cache = &indirect_desc_cache;
542 543 544 545 546
            if (len < desc.len) {
                virtio_error(vdev, "Cannot map indirect buffer");
                goto err;
            }

547
            max = desc.len / sizeof(VRingDesc);
548
            num_bufs = i = 0;
549
            vring_desc_read(vdev, &desc, desc_cache, i);
550 551
        }

A
aliguori 已提交
552 553
        do {
            /* If we've got too many, that implies a descriptor loop. */
554
            if (++num_bufs > max) {
555 556
                virtio_error(vdev, "Looped descriptor");
                goto err;
A
aliguori 已提交
557
            }
A
aliguori 已提交
558

559 560
            if (desc.flags & VRING_DESC_F_WRITE) {
                in_total += desc.len;
A
aliguori 已提交
561
            } else {
562
                out_total += desc.len;
A
aliguori 已提交
563
            }
564 565 566
            if (in_total >= max_in_bytes && out_total >= max_out_bytes) {
                goto done;
            }
567

568
            rc = virtqueue_read_next_desc(vdev, &desc, desc_cache, max, &i);
569 570 571 572 573
        } while (rc == VIRTQUEUE_READ_DESC_MORE);

        if (rc == VIRTQUEUE_READ_DESC_ERROR) {
            goto err;
        }
574

575 576
        if (desc_cache == &indirect_desc_cache) {
            address_space_cache_destroy(&indirect_desc_cache);
577
            total_bufs++;
578 579 580
        } else {
            total_bufs = num_bufs;
        }
A
aliguori 已提交
581
    }
582 583 584 585 586

    if (rc < 0) {
        goto err;
    }

587
done:
588 589
    address_space_cache_destroy(&indirect_desc_cache);
    address_space_cache_destroy(&vring_desc_cache);
590 591 592 593 594 595
    if (in_bytes) {
        *in_bytes = in_total;
    }
    if (out_bytes) {
        *out_bytes = out_total;
    }
596 597 598 599 600
    return;

err:
    in_total = out_total = 0;
    goto done;
601
}
A
aliguori 已提交
602

603 604 605 606 607
int virtqueue_avail_bytes(VirtQueue *vq, unsigned int in_bytes,
                          unsigned int out_bytes)
{
    unsigned int in_total, out_total;

608 609
    virtqueue_get_avail_bytes(vq, &in_total, &out_total, in_bytes, out_bytes);
    return in_bytes <= in_total && out_bytes <= out_total;
A
aliguori 已提交
610 611
}

612 613
static bool virtqueue_map_desc(VirtIODevice *vdev, unsigned int *p_num_sg,
                               hwaddr *addr, struct iovec *iov,
614 615 616
                               unsigned int max_num_sg, bool is_write,
                               hwaddr pa, size_t sz)
{
617
    bool ok = false;
618 619 620
    unsigned num_sg = *p_num_sg;
    assert(num_sg <= max_num_sg);

621
    if (!sz) {
622 623
        virtio_error(vdev, "virtio: zero sized buffers are not allowed");
        goto out;
624 625
    }

626 627 628 629
    while (sz) {
        hwaddr len = sz;

        if (num_sg == max_num_sg) {
630 631 632
            virtio_error(vdev, "virtio: too many write descriptors in "
                               "indirect table");
            goto out;
633 634
        }

J
Jason Wang 已提交
635 636 637 638
        iov[num_sg].iov_base = dma_memory_map(vdev->dma_as, pa, &len,
                                              is_write ?
                                              DMA_DIRECTION_FROM_DEVICE :
                                              DMA_DIRECTION_TO_DEVICE);
639
        if (!iov[num_sg].iov_base) {
640 641
            virtio_error(vdev, "virtio: bogus descriptor or out of resources");
            goto out;
642 643
        }

644 645 646 647 648 649 650
        iov[num_sg].iov_len = len;
        addr[num_sg] = pa;

        sz -= len;
        pa += len;
        num_sg++;
    }
651 652 653
    ok = true;

out:
654
    *p_num_sg = num_sg;
655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672
    return ok;
}

/* Only used by error code paths before we have a VirtQueueElement (therefore
 * virtqueue_unmap_sg() can't be used).  Assumes buffers weren't written to
 * yet.
 */
static void virtqueue_undo_map_desc(unsigned int out_num, unsigned int in_num,
                                    struct iovec *iov)
{
    unsigned int i;

    for (i = 0; i < out_num + in_num; i++) {
        int is_write = i >= out_num;

        cpu_physical_memory_unmap(iov->iov_base, iov->iov_len, is_write, 0);
        iov++;
    }
673 674
}

J
Jason Wang 已提交
675 676
static void virtqueue_map_iovec(VirtIODevice *vdev, struct iovec *sg,
                                hwaddr *addr, unsigned int *num_sg,
677
                                int is_write)
K
Kevin Wolf 已提交
678 679
{
    unsigned int i;
A
Avi Kivity 已提交
680
    hwaddr len;
K
Kevin Wolf 已提交
681

M
Michael S. Tsirkin 已提交
682
    for (i = 0; i < *num_sg; i++) {
K
Kevin Wolf 已提交
683
        len = sg[i].iov_len;
J
Jason Wang 已提交
684 685 686 687
        sg[i].iov_base = dma_memory_map(vdev->dma_as,
                                        addr[i], &len, is_write ?
                                        DMA_DIRECTION_FROM_DEVICE :
                                        DMA_DIRECTION_TO_DEVICE);
M
Michael S. Tsirkin 已提交
688
        if (!sg[i].iov_base) {
M
Michael Tokarev 已提交
689
            error_report("virtio: error trying to map MMIO memory");
K
Kevin Wolf 已提交
690 691
            exit(1);
        }
692 693
        if (len != sg[i].iov_len) {
            error_report("virtio: unexpected memory split");
M
Michael S. Tsirkin 已提交
694 695
            exit(1);
        }
K
Kevin Wolf 已提交
696 697 698
    }
}

J
Jason Wang 已提交
699
void virtqueue_map(VirtIODevice *vdev, VirtQueueElement *elem)
M
Michael S. Tsirkin 已提交
700
{
701 702
    virtqueue_map_iovec(vdev, elem->in_sg, elem->in_addr, &elem->in_num, 1);
    virtqueue_map_iovec(vdev, elem->out_sg, elem->out_addr, &elem->out_num, 0);
703 704
}

705
static void *virtqueue_alloc_element(size_t sz, unsigned out_num, unsigned in_num)
706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723
{
    VirtQueueElement *elem;
    size_t in_addr_ofs = QEMU_ALIGN_UP(sz, __alignof__(elem->in_addr[0]));
    size_t out_addr_ofs = in_addr_ofs + in_num * sizeof(elem->in_addr[0]);
    size_t out_addr_end = out_addr_ofs + out_num * sizeof(elem->out_addr[0]);
    size_t in_sg_ofs = QEMU_ALIGN_UP(out_addr_end, __alignof__(elem->in_sg[0]));
    size_t out_sg_ofs = in_sg_ofs + in_num * sizeof(elem->in_sg[0]);
    size_t out_sg_end = out_sg_ofs + out_num * sizeof(elem->out_sg[0]);

    assert(sz >= sizeof(VirtQueueElement));
    elem = g_malloc(out_sg_end);
    elem->out_num = out_num;
    elem->in_num = in_num;
    elem->in_addr = (void *)elem + in_addr_ofs;
    elem->out_addr = (void *)elem + out_addr_ofs;
    elem->in_sg = (void *)elem + in_sg_ofs;
    elem->out_sg = (void *)elem + out_sg_ofs;
    return elem;
M
Michael S. Tsirkin 已提交
724 725
}

726
void *virtqueue_pop(VirtQueue *vq, size_t sz)
A
aliguori 已提交
727
{
728
    unsigned int i, head, max;
729 730 731 732
    MemoryRegionCache vring_desc_cache;
    MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
    MemoryRegionCache *desc_cache;
    int64_t len;
733
    VirtIODevice *vdev = vq->vdev;
734
    VirtQueueElement *elem = NULL;
735 736 737
    unsigned out_num, in_num;
    hwaddr addr[VIRTQUEUE_MAX_SIZE];
    struct iovec iov[VIRTQUEUE_MAX_SIZE];
738
    VRingDesc desc;
739
    int rc;
A
aliguori 已提交
740

741 742 743
    if (unlikely(vdev->broken)) {
        return NULL;
    }
744
    if (virtio_queue_empty(vq)) {
745 746
        return NULL;
    }
747 748 749
    /* Needed after virtio_queue_empty(), see comment in
     * virtqueue_num_heads(). */
    smp_rmb();
A
aliguori 已提交
750 751

    /* When we start there are none of either input nor output. */
752
    out_num = in_num = 0;
A
aliguori 已提交
753

754 755
    max = vq->vring.num;

756
    if (vq->inuse >= vq->vring.num) {
757 758
        virtio_error(vdev, "Virtqueue size exceeded");
        return NULL;
759 760
    }

761 762 763 764
    if (!virtqueue_get_head(vq, vq->last_avail_idx++, &head)) {
        return NULL;
    }

765
    if (virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
766
        vring_set_avail_event(vq, vq->last_avail_idx);
M
Michael S. Tsirkin 已提交
767
    }
768

769
    i = head;
770

771 772 773
    len = address_space_cache_init(&vring_desc_cache, vdev->dma_as,
                                   vq->vring.desc, max * sizeof(VRingDesc),
                                   false);
774 775 776 777 778
    if (len < max * sizeof(VRingDesc)) {
        virtio_error(vdev, "Cannot map descriptor ring");
        goto done;
    }

779 780
    desc_cache = &vring_desc_cache;
    vring_desc_read(vdev, &desc, desc_cache, i);
781 782
    if (desc.flags & VRING_DESC_F_INDIRECT) {
        if (desc.len % sizeof(VRingDesc)) {
783
            virtio_error(vdev, "Invalid size for indirect buffer table");
784
            goto done;
785 786 787
        }

        /* loop over the indirect descriptor table */
788 789 790
        len = address_space_cache_init(&indirect_desc_cache, vdev->dma_as,
                                       desc.addr, desc.len, false);
        desc_cache = &indirect_desc_cache;
791 792 793 794 795
        if (len < desc.len) {
            virtio_error(vdev, "Cannot map indirect buffer");
            goto done;
        }

796
        max = desc.len / sizeof(VRingDesc);
797
        i = 0;
798
        vring_desc_read(vdev, &desc, desc_cache, i);
799 800
    }

K
Kevin Wolf 已提交
801
    /* Collect all the descriptors */
A
aliguori 已提交
802
    do {
803 804
        bool map_ok;

805
        if (desc.flags & VRING_DESC_F_WRITE) {
806 807 808 809
            map_ok = virtqueue_map_desc(vdev, &in_num, addr + out_num,
                                        iov + out_num,
                                        VIRTQUEUE_MAX_SIZE - out_num, true,
                                        desc.addr, desc.len);
K
Kevin Wolf 已提交
810
        } else {
811
            if (in_num) {
812 813
                virtio_error(vdev, "Incorrect order for descriptors");
                goto err_undo_map;
814
            }
815 816 817 818 819 820
            map_ok = virtqueue_map_desc(vdev, &out_num, addr, iov,
                                        VIRTQUEUE_MAX_SIZE, false,
                                        desc.addr, desc.len);
        }
        if (!map_ok) {
            goto err_undo_map;
K
Kevin Wolf 已提交
821
        }
A
aliguori 已提交
822 823

        /* If we've got too many, that implies a descriptor loop. */
824
        if ((in_num + out_num) > max) {
825 826
            virtio_error(vdev, "Looped descriptor");
            goto err_undo_map;
A
aliguori 已提交
827
        }
828

829
        rc = virtqueue_read_next_desc(vdev, &desc, desc_cache, max, &i);
830 831 832 833 834
    } while (rc == VIRTQUEUE_READ_DESC_MORE);

    if (rc == VIRTQUEUE_READ_DESC_ERROR) {
        goto err_undo_map;
    }
A
aliguori 已提交
835

836 837
    /* Now copy what we have collected and mapped */
    elem = virtqueue_alloc_element(sz, out_num, in_num);
A
aliguori 已提交
838
    elem->index = head;
839 840 841 842 843 844 845 846
    for (i = 0; i < out_num; i++) {
        elem->out_addr[i] = addr[i];
        elem->out_sg[i] = iov[i];
    }
    for (i = 0; i < in_num; i++) {
        elem->in_addr[i] = addr[out_num + i];
        elem->in_sg[i] = iov[out_num + i];
    }
A
aliguori 已提交
847 848 849

    vq->inuse++;

850
    trace_virtqueue_pop(vq, elem, elem->in_num, elem->out_num);
851
done:
852 853
    address_space_cache_destroy(&indirect_desc_cache);
    address_space_cache_destroy(&vring_desc_cache);
854

855
    return elem;
856 857 858

err_undo_map:
    virtqueue_undo_map_desc(out_num, in_num, iov);
859
    goto done;
A
aliguori 已提交
860 861
}

862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899
/* virtqueue_drop_all:
 * @vq: The #VirtQueue
 * Drops all queued buffers and indicates them to the guest
 * as if they are done. Useful when buffers can not be
 * processed but must be returned to the guest.
 */
unsigned int virtqueue_drop_all(VirtQueue *vq)
{
    unsigned int dropped = 0;
    VirtQueueElement elem = {};
    VirtIODevice *vdev = vq->vdev;
    bool fEventIdx = virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX);

    if (unlikely(vdev->broken)) {
        return 0;
    }

    while (!virtio_queue_empty(vq) && vq->inuse < vq->vring.num) {
        /* works similar to virtqueue_pop but does not map buffers
        * and does not allocate any memory */
        smp_rmb();
        if (!virtqueue_get_head(vq, vq->last_avail_idx, &elem.index)) {
            break;
        }
        vq->inuse++;
        vq->last_avail_idx++;
        if (fEventIdx) {
            vring_set_avail_event(vq, vq->last_avail_idx);
        }
        /* immediately push the element, nothing to unmap
         * as both in_num and out_num are set to 0 */
        virtqueue_push(vq, &elem, 0);
        dropped++;
    }

    return dropped;
}

900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916
/* Reading and writing a structure directly to QEMUFile is *awful*, but
 * it is what QEMU has always done by mistake.  We can change it sooner
 * or later by bumping the version number of the affected vm states.
 * In the meanwhile, since the in-memory layout of VirtQueueElement
 * has changed, we need to marshal to and from the layout that was
 * used before the change.
 */
typedef struct VirtQueueElementOld {
    unsigned int index;
    unsigned int out_num;
    unsigned int in_num;
    hwaddr in_addr[VIRTQUEUE_MAX_SIZE];
    hwaddr out_addr[VIRTQUEUE_MAX_SIZE];
    struct iovec in_sg[VIRTQUEUE_MAX_SIZE];
    struct iovec out_sg[VIRTQUEUE_MAX_SIZE];
} VirtQueueElementOld;

J
Jason Wang 已提交
917
void *qemu_get_virtqueue_element(VirtIODevice *vdev, QEMUFile *f, size_t sz)
918
{
919 920 921 922 923 924
    VirtQueueElement *elem;
    VirtQueueElementOld data;
    int i;

    qemu_get_buffer(f, (uint8_t *)&data, sizeof(VirtQueueElementOld));

925 926 927 928 929 930 931 932 933 934
    /* TODO: teach all callers that this can fail, and return failure instead
     * of asserting here.
     * When we do, we might be able to re-enable NDEBUG below.
     */
#ifdef NDEBUG
#error building with NDEBUG is not supported
#endif
    assert(ARRAY_SIZE(data.in_addr) >= data.in_num);
    assert(ARRAY_SIZE(data.out_addr) >= data.out_num);

935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957
    elem = virtqueue_alloc_element(sz, data.out_num, data.in_num);
    elem->index = data.index;

    for (i = 0; i < elem->in_num; i++) {
        elem->in_addr[i] = data.in_addr[i];
    }

    for (i = 0; i < elem->out_num; i++) {
        elem->out_addr[i] = data.out_addr[i];
    }

    for (i = 0; i < elem->in_num; i++) {
        /* Base is overwritten by virtqueue_map.  */
        elem->in_sg[i].iov_base = 0;
        elem->in_sg[i].iov_len = data.in_sg[i].iov_len;
    }

    for (i = 0; i < elem->out_num; i++) {
        /* Base is overwritten by virtqueue_map.  */
        elem->out_sg[i].iov_base = 0;
        elem->out_sg[i].iov_len = data.out_sg[i].iov_len;
    }

J
Jason Wang 已提交
958
    virtqueue_map(vdev, elem);
959 960 961 962 963
    return elem;
}

void qemu_put_virtqueue_element(QEMUFile *f, VirtQueueElement *elem)
{
964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990
    VirtQueueElementOld data;
    int i;

    memset(&data, 0, sizeof(data));
    data.index = elem->index;
    data.in_num = elem->in_num;
    data.out_num = elem->out_num;

    for (i = 0; i < elem->in_num; i++) {
        data.in_addr[i] = elem->in_addr[i];
    }

    for (i = 0; i < elem->out_num; i++) {
        data.out_addr[i] = elem->out_addr[i];
    }

    for (i = 0; i < elem->in_num; i++) {
        /* Base is overwritten by virtqueue_map when loading.  Do not
         * save it, as it would leak the QEMU address space layout.  */
        data.in_sg[i].iov_len = elem->in_sg[i].iov_len;
    }

    for (i = 0; i < elem->out_num; i++) {
        /* Do not save iov_base as above.  */
        data.out_sg[i].iov_len = elem->out_sg[i].iov_len;
    }
    qemu_put_buffer(f, (uint8_t *)&data, sizeof(VirtQueueElementOld));
991 992
}

A
aliguori 已提交
993
/* virtio device */
994 995
static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
{
K
KONRAD Frederic 已提交
996 997 998
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

999 1000 1001 1002
    if (unlikely(vdev->broken)) {
        return;
    }

K
KONRAD Frederic 已提交
1003 1004
    if (k->notify) {
        k->notify(qbus->parent, vector);
1005 1006
    }
}
A
aliguori 已提交
1007

P
Paul Brook 已提交
1008
void virtio_update_irq(VirtIODevice *vdev)
A
aliguori 已提交
1009
{
1010
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
A
aliguori 已提交
1011 1012
}

1013 1014 1015 1016
static int virtio_validate_features(VirtIODevice *vdev)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);

J
Jason Wang 已提交
1017 1018 1019 1020 1021
    if (virtio_host_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM) &&
        !virtio_vdev_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM)) {
        return -EFAULT;
    }

1022 1023 1024 1025 1026 1027 1028 1029
    if (k->validate_features) {
        return k->validate_features(vdev);
    } else {
        return 0;
    }
}

int virtio_set_status(VirtIODevice *vdev, uint8_t val)
1030
{
1031
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
1032 1033
    trace_virtio_set_status(vdev, val);

1034
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1035 1036 1037 1038 1039 1040 1041 1042 1043
        if (!(vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) &&
            val & VIRTIO_CONFIG_S_FEATURES_OK) {
            int ret = virtio_validate_features(vdev);

            if (ret) {
                return ret;
            }
        }
    }
1044 1045
    if (k->set_status) {
        k->set_status(vdev, val);
1046 1047
    }
    vdev->status = val;
1048
    return 0;
1049 1050
}

1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071
bool target_words_bigendian(void);
static enum virtio_device_endian virtio_default_endian(void)
{
    if (target_words_bigendian()) {
        return VIRTIO_DEVICE_ENDIAN_BIG;
    } else {
        return VIRTIO_DEVICE_ENDIAN_LITTLE;
    }
}

static enum virtio_device_endian virtio_current_cpu_endian(void)
{
    CPUClass *cc = CPU_GET_CLASS(current_cpu);

    if (cc->virtio_is_big_endian(current_cpu)) {
        return VIRTIO_DEVICE_ENDIAN_BIG;
    } else {
        return VIRTIO_DEVICE_ENDIAN_LITTLE;
    }
}

P
Paul Brook 已提交
1072
void virtio_reset(void *opaque)
A
aliguori 已提交
1073 1074
{
    VirtIODevice *vdev = opaque;
1075
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1076 1077
    int i;

1078
    virtio_set_status(vdev, 0);
1079 1080 1081 1082 1083 1084 1085
    if (current_cpu) {
        /* Guest initiated reset */
        vdev->device_endian = virtio_current_cpu_endian();
    } else {
        /* System reset */
        vdev->device_endian = virtio_default_endian();
    }
1086

1087 1088 1089
    if (k->reset) {
        k->reset(vdev);
    }
A
aliguori 已提交
1090

1091
    vdev->broken = false;
1092
    vdev->guest_features = 0;
A
aliguori 已提交
1093 1094
    vdev->queue_sel = 0;
    vdev->status = 0;
P
Paolo Bonzini 已提交
1095
    atomic_set(&vdev->isr, 0);
1096 1097
    vdev->config_vector = VIRTIO_NO_VECTOR;
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1098

1099
    for(i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1100 1101 1102 1103
        vdev->vq[i].vring.desc = 0;
        vdev->vq[i].vring.avail = 0;
        vdev->vq[i].vring.used = 0;
        vdev->vq[i].last_avail_idx = 0;
1104
        vdev->vq[i].shadow_avail_idx = 0;
1105
        vdev->vq[i].used_idx = 0;
1106
        virtio_queue_set_vector(vdev, i, VIRTIO_NO_VECTOR);
M
Michael S. Tsirkin 已提交
1107 1108
        vdev->vq[i].signalled_used = 0;
        vdev->vq[i].signalled_used_valid = false;
1109
        vdev->vq[i].notification = true;
C
Cornelia Huck 已提交
1110
        vdev->vq[i].vring.num = vdev->vq[i].vring.num_default;
1111
        vdev->vq[i].inuse = 0;
A
aliguori 已提交
1112 1113 1114
    }
}

P
Paul Brook 已提交
1115
uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1116
{
1117
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1118 1119
    uint8_t val;

1120
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1121
        return (uint32_t)-1;
1122 1123 1124
    }

    k->get_config(vdev, vdev->config);
A
aliguori 已提交
1125

1126
    val = ldub_p(vdev->config + addr);
A
aliguori 已提交
1127 1128 1129
    return val;
}

P
Paul Brook 已提交
1130
uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1131
{
1132
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1133 1134
    uint16_t val;

1135
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1136
        return (uint32_t)-1;
1137 1138 1139
    }

    k->get_config(vdev, vdev->config);
A
aliguori 已提交
1140

1141
    val = lduw_p(vdev->config + addr);
A
aliguori 已提交
1142 1143 1144
    return val;
}

P
Paul Brook 已提交
1145
uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1146
{
1147
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1148 1149
    uint32_t val;

1150
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1151
        return (uint32_t)-1;
1152 1153 1154
    }

    k->get_config(vdev, vdev->config);
A
aliguori 已提交
1155

1156
    val = ldl_p(vdev->config + addr);
A
aliguori 已提交
1157 1158 1159
    return val;
}

P
Paul Brook 已提交
1160
void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1161
{
1162
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1163 1164
    uint8_t val = data;

1165
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1166
        return;
1167
    }
A
aliguori 已提交
1168

1169
    stb_p(vdev->config + addr, val);
A
aliguori 已提交
1170

1171 1172 1173
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1174 1175
}

P
Paul Brook 已提交
1176
void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1177
{
1178
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1179 1180
    uint16_t val = data;

1181
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1182
        return;
1183
    }
A
aliguori 已提交
1184

1185
    stw_p(vdev->config + addr, val);
A
aliguori 已提交
1186

1187 1188 1189
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1190 1191
}

P
Paul Brook 已提交
1192
void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1193
{
1194
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1195 1196
    uint32_t val = data;

1197
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1198
        return;
1199
    }
A
aliguori 已提交
1200

1201
    stl_p(vdev->config + addr, val);
A
aliguori 已提交
1202

1203 1204 1205
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1206 1207
}

1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303
uint32_t virtio_config_modern_readb(VirtIODevice *vdev, uint32_t addr)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
    uint8_t val;

    if (addr + sizeof(val) > vdev->config_len) {
        return (uint32_t)-1;
    }

    k->get_config(vdev, vdev->config);

    val = ldub_p(vdev->config + addr);
    return val;
}

uint32_t virtio_config_modern_readw(VirtIODevice *vdev, uint32_t addr)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
    uint16_t val;

    if (addr + sizeof(val) > vdev->config_len) {
        return (uint32_t)-1;
    }

    k->get_config(vdev, vdev->config);

    val = lduw_le_p(vdev->config + addr);
    return val;
}

uint32_t virtio_config_modern_readl(VirtIODevice *vdev, uint32_t addr)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
    uint32_t val;

    if (addr + sizeof(val) > vdev->config_len) {
        return (uint32_t)-1;
    }

    k->get_config(vdev, vdev->config);

    val = ldl_le_p(vdev->config + addr);
    return val;
}

void virtio_config_modern_writeb(VirtIODevice *vdev,
                                 uint32_t addr, uint32_t data)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
    uint8_t val = data;

    if (addr + sizeof(val) > vdev->config_len) {
        return;
    }

    stb_p(vdev->config + addr, val);

    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
}

void virtio_config_modern_writew(VirtIODevice *vdev,
                                 uint32_t addr, uint32_t data)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
    uint16_t val = data;

    if (addr + sizeof(val) > vdev->config_len) {
        return;
    }

    stw_le_p(vdev->config + addr, val);

    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
}

void virtio_config_modern_writel(VirtIODevice *vdev,
                                 uint32_t addr, uint32_t data)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
    uint32_t val = data;

    if (addr + sizeof(val) > vdev->config_len) {
        return;
    }

    stl_le_p(vdev->config + addr, val);

    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
}

A
Avi Kivity 已提交
1304
void virtio_queue_set_addr(VirtIODevice *vdev, int n, hwaddr addr)
A
aliguori 已提交
1305
{
1306 1307
    vdev->vq[n].vring.desc = addr;
    virtio_queue_update_rings(vdev, n);
P
Paul Brook 已提交
1308 1309
}

A
Avi Kivity 已提交
1310
hwaddr virtio_queue_get_addr(VirtIODevice *vdev, int n)
P
Paul Brook 已提交
1311
{
1312 1313 1314 1315 1316 1317 1318 1319 1320
    return vdev->vq[n].vring.desc;
}

void virtio_queue_set_rings(VirtIODevice *vdev, int n, hwaddr desc,
                            hwaddr avail, hwaddr used)
{
    vdev->vq[n].vring.desc = desc;
    vdev->vq[n].vring.avail = avail;
    vdev->vq[n].vring.used = used;
1321
    virtio_init_region_cache(vdev, n);
P
Paul Brook 已提交
1322 1323
}

1324 1325
void virtio_queue_set_num(VirtIODevice *vdev, int n, int num)
{
1326 1327 1328 1329 1330 1331 1332
    /* Don't allow guest to flip queue between existent and
     * nonexistent states, or to set it to an invalid size.
     */
    if (!!num != !!vdev->vq[n].vring.num ||
        num > VIRTQUEUE_MAX_SIZE ||
        num < 0) {
        return;
1333
    }
1334
    vdev->vq[n].vring.num = num;
1335 1336
}

1337 1338 1339 1340 1341 1342 1343 1344 1345 1346
VirtQueue *virtio_vector_first_queue(VirtIODevice *vdev, uint16_t vector)
{
    return QLIST_FIRST(&vdev->vector_queues[vector]);
}

VirtQueue *virtio_vector_next_queue(VirtQueue *vq)
{
    return QLIST_NEXT(vq, node);
}

P
Paul Brook 已提交
1347 1348 1349 1350
int virtio_queue_get_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num;
}
A
aliguori 已提交
1351

M
Michael S. Tsirkin 已提交
1352 1353 1354 1355 1356
int virtio_queue_get_max_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num_default;
}

1357 1358 1359 1360
int virtio_get_num_queues(VirtIODevice *vdev)
{
    int i;

1361
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1362 1363 1364 1365 1366 1367 1368 1369
        if (!virtio_queue_get_num(vdev, i)) {
            break;
        }
    }

    return i;
}

1370 1371 1372 1373 1374
void virtio_queue_set_align(VirtIODevice *vdev, int n, int align)
{
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

1375
    /* virtio-1 compliant devices cannot change the alignment */
1376
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1377 1378 1379
        error_report("tried to modify queue alignment for virtio-1 device");
        return;
    }
1380 1381 1382 1383 1384 1385 1386
    /* Check that the transport told us it was going to do this
     * (so a buggy transport will immediately assert rather than
     * silently failing to migrate this state)
     */
    assert(k->has_variable_vring_alignment);

    vdev->vq[n].vring.align = align;
1387
    virtio_queue_update_rings(vdev, n);
1388 1389
}

1390
static bool virtio_queue_notify_aio_vq(VirtQueue *vq)
M
Michael S. Tsirkin 已提交
1391 1392 1393 1394 1395
{
    if (vq->vring.desc && vq->handle_aio_output) {
        VirtIODevice *vdev = vq->vdev;

        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
1396
        return vq->handle_aio_output(vdev, vq);
M
Michael S. Tsirkin 已提交
1397
    }
1398 1399

    return false;
M
Michael S. Tsirkin 已提交
1400 1401
}

1402
static void virtio_queue_notify_vq(VirtQueue *vq)
1403
{
1404
    if (vq->vring.desc && vq->handle_output) {
1405
        VirtIODevice *vdev = vq->vdev;
1406

1407 1408 1409 1410
        if (unlikely(vdev->broken)) {
            return;
        }

1411 1412 1413 1414 1415
        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
        vq->handle_output(vdev, vq);
    }
}

P
Paul Brook 已提交
1416 1417
void virtio_queue_notify(VirtIODevice *vdev, int n)
{
1418
    virtio_queue_notify_vq(&vdev->vq[n]);
A
aliguori 已提交
1419 1420
}

1421 1422
uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
{
1423
    return n < VIRTIO_QUEUE_MAX ? vdev->vq[n].vector :
1424 1425 1426 1427 1428
        VIRTIO_NO_VECTOR;
}

void virtio_queue_set_vector(VirtIODevice *vdev, int n, uint16_t vector)
{
1429 1430
    VirtQueue *vq = &vdev->vq[n];

1431
    if (n < VIRTIO_QUEUE_MAX) {
1432 1433 1434 1435
        if (vdev->vector_queues &&
            vdev->vq[n].vector != VIRTIO_NO_VECTOR) {
            QLIST_REMOVE(vq, node);
        }
1436
        vdev->vq[n].vector = vector;
1437 1438 1439 1440 1441
        if (vdev->vector_queues &&
            vector != VIRTIO_NO_VECTOR) {
            QLIST_INSERT_HEAD(&vdev->vector_queues[vector], vq, node);
        }
    }
1442 1443
}

1444 1445
VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
                            VirtIOHandleOutput handle_output)
A
aliguori 已提交
1446 1447 1448
{
    int i;

1449
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1450 1451 1452 1453
        if (vdev->vq[i].vring.num == 0)
            break;
    }

1454
    if (i == VIRTIO_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
A
aliguori 已提交
1455 1456 1457
        abort();

    vdev->vq[i].vring.num = queue_size;
C
Cornelia Huck 已提交
1458
    vdev->vq[i].vring.num_default = queue_size;
1459
    vdev->vq[i].vring.align = VIRTIO_PCI_VRING_ALIGN;
A
aliguori 已提交
1460
    vdev->vq[i].handle_output = handle_output;
M
Michael S. Tsirkin 已提交
1461
    vdev->vq[i].handle_aio_output = NULL;
A
aliguori 已提交
1462 1463 1464 1465

    return &vdev->vq[i];
}

1466 1467
void virtio_del_queue(VirtIODevice *vdev, int n)
{
1468
    if (n < 0 || n >= VIRTIO_QUEUE_MAX) {
1469 1470 1471 1472
        abort();
    }

    vdev->vq[n].vring.num = 0;
C
Cornelia Huck 已提交
1473
    vdev->vq[n].vring.num_default = 0;
1474 1475
}

P
Paolo Bonzini 已提交
1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487
static void virtio_set_isr(VirtIODevice *vdev, int value)
{
    uint8_t old = atomic_read(&vdev->isr);

    /* Do not write ISR if it does not change, so that its cacheline remains
     * shared in the common case where the guest does not read it.
     */
    if ((old & value) != value) {
        atomic_or(&vdev->isr, value);
    }
}

1488
static bool virtio_should_notify(VirtIODevice *vdev, VirtQueue *vq)
M
Michael S. Tsirkin 已提交
1489 1490 1491
{
    uint16_t old, new;
    bool v;
1492 1493
    /* We need to expose used array entries before checking used event. */
    smp_mb();
1494
    /* Always notify when queue is empty (when feature acknowledge) */
1495
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_NOTIFY_ON_EMPTY) &&
1496
        !vq->inuse && virtio_queue_empty(vq)) {
M
Michael S. Tsirkin 已提交
1497 1498 1499
        return true;
    }

1500
    if (!virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
M
Michael S. Tsirkin 已提交
1501 1502 1503 1504 1505 1506
        return !(vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT);
    }

    v = vq->signalled_used_valid;
    vq->signalled_used_valid = true;
    old = vq->signalled_used;
1507
    new = vq->signalled_used = vq->used_idx;
1508
    return !v || vring_need_event(vring_get_used_event(vq), new, old);
M
Michael S. Tsirkin 已提交
1509 1510
}

1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537
void virtio_notify_irqfd(VirtIODevice *vdev, VirtQueue *vq)
{
    if (!virtio_should_notify(vdev, vq)) {
        return;
    }

    trace_virtio_notify_irqfd(vdev, vq);

    /*
     * virtio spec 1.0 says ISR bit 0 should be ignored with MSI, but
     * windows drivers included in virtio-win 1.8.0 (circa 2015) are
     * incorrectly polling this bit during crashdump and hibernation
     * in MSI mode, causing a hang if this bit is never updated.
     * Recent releases of Windows do not really shut down, but rather
     * log out and hibernate to make the next startup faster.  Hence,
     * this manifested as a more serious hang during shutdown with
     *
     * Next driver release from 2016 fixed this problem, so working around it
     * is not a must, but it's easy to do so let's do it here.
     *
     * Note: it's safe to update ISR from any thread as it was switched
     * to an atomic operation.
     */
    virtio_set_isr(vq->vdev, 0x1);
    event_notifier_set(&vq->guest_notifier);
}

M
Michael S. Tsirkin 已提交
1538 1539
void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
{
1540
    if (!virtio_should_notify(vdev, vq)) {
A
aliguori 已提交
1541
        return;
M
Michael S. Tsirkin 已提交
1542
    }
A
aliguori 已提交
1543

1544
    trace_virtio_notify(vdev, vq);
P
Paolo Bonzini 已提交
1545
    virtio_set_isr(vq->vdev, 0x1);
1546
    virtio_notify_vector(vdev, vq->vector);
A
aliguori 已提交
1547 1548 1549 1550
}

void virtio_notify_config(VirtIODevice *vdev)
{
1551 1552 1553
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
        return;

P
Paolo Bonzini 已提交
1554
    virtio_set_isr(vdev, 0x3);
1555
    vdev->generation++;
1556
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1557 1558
}

1559 1560 1561 1562 1563
static bool virtio_device_endian_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    assert(vdev->device_endian != VIRTIO_DEVICE_ENDIAN_UNKNOWN);
1564
    if (!virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1565 1566 1567 1568
        return vdev->device_endian != virtio_default_endian();
    }
    /* Devices conforming to VIRTIO 1.0 or later are always LE. */
    return vdev->device_endian != VIRTIO_DEVICE_ENDIAN_LITTLE;
1569 1570
}

G
Gerd Hoffmann 已提交
1571 1572 1573 1574 1575 1576 1577
static bool virtio_64bit_features_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return (vdev->host_features >> 32) != 0;
}

J
Jason Wang 已提交
1578 1579 1580 1581 1582 1583 1584
static bool virtio_virtqueue_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return virtio_host_has_feature(vdev, VIRTIO_F_VERSION_1);
}

C
Cornelia Huck 已提交
1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
static bool virtio_ringsize_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;
    int i;

    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
        if (vdev->vq[i].vring.num != vdev->vq[i].vring.num_default) {
            return true;
        }
    }
    return false;
}

1598 1599 1600 1601 1602 1603 1604 1605 1606 1607
static bool virtio_extra_state_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

    return k->has_extra_state &&
        k->has_extra_state(qbus->parent);
}

1608 1609 1610 1611 1612 1613 1614
static bool virtio_broken_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return vdev->broken;
}

1615
static const VMStateDescription vmstate_virtqueue = {
J
Jason Wang 已提交
1616
    .name = "virtqueue_state",
1617 1618 1619 1620 1621 1622 1623
    .version_id = 1,
    .minimum_version_id = 1,
    .fields = (VMStateField[]) {
        VMSTATE_UINT64(vring.avail, struct VirtQueue),
        VMSTATE_UINT64(vring.used, struct VirtQueue),
        VMSTATE_END_OF_LIST()
    }
J
Jason Wang 已提交
1624 1625 1626 1627 1628 1629 1630 1631
};

static const VMStateDescription vmstate_virtio_virtqueues = {
    .name = "virtio/virtqueues",
    .version_id = 1,
    .minimum_version_id = 1,
    .needed = &virtio_virtqueue_needed,
    .fields = (VMStateField[]) {
D
Dr. David Alan Gilbert 已提交
1632 1633
        VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
                      VIRTIO_QUEUE_MAX, 0, vmstate_virtqueue, VirtQueue),
J
Jason Wang 已提交
1634 1635 1636 1637
        VMSTATE_END_OF_LIST()
    }
};

1638
static const VMStateDescription vmstate_ringsize = {
C
Cornelia Huck 已提交
1639
    .name = "ringsize_state",
1640 1641 1642 1643 1644 1645
    .version_id = 1,
    .minimum_version_id = 1,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(vring.num_default, struct VirtQueue),
        VMSTATE_END_OF_LIST()
    }
C
Cornelia Huck 已提交
1646 1647 1648 1649 1650 1651 1652 1653
};

static const VMStateDescription vmstate_virtio_ringsize = {
    .name = "virtio/ringsize",
    .version_id = 1,
    .minimum_version_id = 1,
    .needed = &virtio_ringsize_needed,
    .fields = (VMStateField[]) {
D
Dr. David Alan Gilbert 已提交
1654 1655
        VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
                      VIRTIO_QUEUE_MAX, 0, vmstate_ringsize, VirtQueue),
C
Cornelia Huck 已提交
1656 1657 1658 1659
        VMSTATE_END_OF_LIST()
    }
};

J
Jianjun Duan 已提交
1660 1661
static int get_extra_state(QEMUFile *f, void *pv, size_t size,
                           VMStateField *field)
1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673
{
    VirtIODevice *vdev = pv;
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

    if (!k->load_extra_state) {
        return -1;
    } else {
        return k->load_extra_state(qbus->parent, f);
    }
}

J
Jianjun Duan 已提交
1674 1675
static int put_extra_state(QEMUFile *f, void *pv, size_t size,
                           VMStateField *field, QJSON *vmdesc)
1676 1677 1678 1679 1680 1681
{
    VirtIODevice *vdev = pv;
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

    k->save_extra_state(qbus->parent, f);
J
Jianjun Duan 已提交
1682
    return 0;
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
}

static const VMStateInfo vmstate_info_extra_state = {
    .name = "virtqueue_extra_state",
    .get = get_extra_state,
    .put = put_extra_state,
};

static const VMStateDescription vmstate_virtio_extra_state = {
    .name = "virtio/extra_state",
    .version_id = 1,
    .minimum_version_id = 1,
    .needed = &virtio_extra_state_needed,
    .fields = (VMStateField[]) {
        {
            .name         = "extra_state",
            .version_id   = 0,
            .field_exists = NULL,
            .size         = 0,
            .info         = &vmstate_info_extra_state,
            .flags        = VMS_SINGLE,
            .offset       = 0,
        },
        VMSTATE_END_OF_LIST()
    }
};

1710 1711 1712 1713
static const VMStateDescription vmstate_virtio_device_endian = {
    .name = "virtio/device_endian",
    .version_id = 1,
    .minimum_version_id = 1,
1714
    .needed = &virtio_device_endian_needed,
1715 1716 1717 1718 1719 1720
    .fields = (VMStateField[]) {
        VMSTATE_UINT8(device_endian, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

G
Gerd Hoffmann 已提交
1721 1722 1723 1724
static const VMStateDescription vmstate_virtio_64bit_features = {
    .name = "virtio/64bit_features",
    .version_id = 1,
    .minimum_version_id = 1,
1725
    .needed = &virtio_64bit_features_needed,
G
Gerd Hoffmann 已提交
1726 1727 1728 1729 1730 1731
    .fields = (VMStateField[]) {
        VMSTATE_UINT64(guest_features, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742
static const VMStateDescription vmstate_virtio_broken = {
    .name = "virtio/broken",
    .version_id = 1,
    .minimum_version_id = 1,
    .needed = &virtio_broken_needed,
    .fields = (VMStateField[]) {
        VMSTATE_BOOL(broken, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

1743 1744 1745 1746 1747 1748 1749
static const VMStateDescription vmstate_virtio = {
    .name = "virtio",
    .version_id = 1,
    .minimum_version_id = 1,
    .minimum_version_id_old = 1,
    .fields = (VMStateField[]) {
        VMSTATE_END_OF_LIST()
1750
    },
1751 1752 1753
    .subsections = (const VMStateDescription*[]) {
        &vmstate_virtio_device_endian,
        &vmstate_virtio_64bit_features,
J
Jason Wang 已提交
1754
        &vmstate_virtio_virtqueues,
C
Cornelia Huck 已提交
1755
        &vmstate_virtio_ringsize,
1756
        &vmstate_virtio_broken,
1757
        &vmstate_virtio_extra_state,
1758
        NULL
1759 1760 1761
    }
};

A
aliguori 已提交
1762 1763
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
{
K
KONRAD Frederic 已提交
1764 1765
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1766
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
G
Gerd Hoffmann 已提交
1767
    uint32_t guest_features_lo = (vdev->guest_features & 0xffffffff);
A
aliguori 已提交
1768 1769
    int i;

K
KONRAD Frederic 已提交
1770 1771 1772
    if (k->save_config) {
        k->save_config(qbus->parent, f);
    }
A
aliguori 已提交
1773 1774 1775 1776

    qemu_put_8s(f, &vdev->status);
    qemu_put_8s(f, &vdev->isr);
    qemu_put_be16s(f, &vdev->queue_sel);
G
Gerd Hoffmann 已提交
1777
    qemu_put_be32s(f, &guest_features_lo);
A
aliguori 已提交
1778 1779 1780
    qemu_put_be32(f, vdev->config_len);
    qemu_put_buffer(f, vdev->config, vdev->config_len);

1781
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1782 1783 1784 1785 1786 1787
        if (vdev->vq[i].vring.num == 0)
            break;
    }

    qemu_put_be32(f, i);

1788
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1789 1790 1791 1792
        if (vdev->vq[i].vring.num == 0)
            break;

        qemu_put_be32(f, vdev->vq[i].vring.num);
1793 1794 1795
        if (k->has_variable_vring_alignment) {
            qemu_put_be32(f, vdev->vq[i].vring.align);
        }
1796 1797
        /* XXX virtio-1 devices */
        qemu_put_be64(f, vdev->vq[i].vring.desc);
A
aliguori 已提交
1798
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
K
KONRAD Frederic 已提交
1799 1800 1801
        if (k->save_queue) {
            k->save_queue(qbus->parent, i, f);
        }
A
aliguori 已提交
1802
    }
1803 1804 1805 1806

    if (vdc->save != NULL) {
        vdc->save(vdev, f);
    }
1807

1808 1809 1810 1811
    if (vdc->vmsd) {
        vmstate_save_state(f, vdc->vmsd, vdev, NULL);
    }

1812
    /* Subsections */
1813
    vmstate_save_state(f, &vmstate_virtio, vdev, NULL);
A
aliguori 已提交
1814 1815
}

1816
/* A wrapper for use as a VMState .put function */
J
Jianjun Duan 已提交
1817 1818
static int virtio_device_put(QEMUFile *f, void *opaque, size_t size,
                              VMStateField *field, QJSON *vmdesc)
1819 1820
{
    virtio_save(VIRTIO_DEVICE(opaque), f);
J
Jianjun Duan 已提交
1821 1822

    return 0;
1823 1824 1825
}

/* A wrapper for use as a VMState .get function */
J
Jianjun Duan 已提交
1826 1827
static int virtio_device_get(QEMUFile *f, void *opaque, size_t size,
                             VMStateField *field)
1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840
{
    VirtIODevice *vdev = VIRTIO_DEVICE(opaque);
    DeviceClass *dc = DEVICE_CLASS(VIRTIO_DEVICE_GET_CLASS(vdev));

    return virtio_load(vdev, f, dc->vmsd->version_id);
}

const VMStateInfo  virtio_vmstate_info = {
    .name = "virtio",
    .get = virtio_device_get,
    .put = virtio_device_put,
};

1841
static int virtio_set_features_nocheck(VirtIODevice *vdev, uint64_t val)
1842
{
1843
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
C
Cornelia Huck 已提交
1844
    bool bad = (val & ~(vdev->host_features)) != 0;
1845

C
Cornelia Huck 已提交
1846
    val &= vdev->host_features;
1847 1848
    if (k->set_features) {
        k->set_features(vdev, val);
1849 1850 1851 1852 1853
    }
    vdev->guest_features = val;
    return bad ? -1 : 0;
}

1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865
int virtio_set_features(VirtIODevice *vdev, uint64_t val)
{
   /*
     * The driver must not attempt to set features after feature negotiation
     * has finished.
     */
    if (vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) {
        return -EINVAL;
    }
    return virtio_set_features_nocheck(vdev, val);
}

1866
int virtio_load(VirtIODevice *vdev, QEMUFile *f, int version_id)
A
aliguori 已提交
1867
{
1868
    int i, ret;
1869
    int32_t config_len;
1870
    uint32_t num;
1871
    uint32_t features;
K
KONRAD Frederic 已提交
1872 1873
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1874
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1875

1876 1877 1878 1879 1880 1881
    /*
     * We poison the endianness to ensure it does not get used before
     * subsections have been loaded.
     */
    vdev->device_endian = VIRTIO_DEVICE_ENDIAN_UNKNOWN;

K
KONRAD Frederic 已提交
1882 1883
    if (k->load_config) {
        ret = k->load_config(qbus->parent, f);
1884 1885 1886
        if (ret)
            return ret;
    }
A
aliguori 已提交
1887 1888 1889 1890

    qemu_get_8s(f, &vdev->status);
    qemu_get_8s(f, &vdev->isr);
    qemu_get_be16s(f, &vdev->queue_sel);
1891
    if (vdev->queue_sel >= VIRTIO_QUEUE_MAX) {
1892 1893
        return -1;
    }
1894
    qemu_get_be32s(f, &features);
1895

1896 1897 1898 1899 1900 1901 1902 1903 1904 1905
    /*
     * Temporarily set guest_features low bits - needed by
     * virtio net load code testing for VIRTIO_NET_F_CTRL_GUEST_OFFLOADS
     * VIRTIO_NET_F_GUEST_ANNOUNCE and VIRTIO_NET_F_CTRL_VQ.
     *
     * Note: devices should always test host features in future - don't create
     * new dependencies like this.
     */
    vdev->guest_features = features;

1906
    config_len = qemu_get_be32(f);
1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917

    /*
     * There are cases where the incoming config can be bigger or smaller
     * than what we have; so load what we have space for, and skip
     * any excess that's in the stream.
     */
    qemu_get_buffer(f, vdev->config, MIN(config_len, vdev->config_len));

    while (config_len > vdev->config_len) {
        qemu_get_byte(f);
        config_len--;
1918
    }
A
aliguori 已提交
1919 1920 1921

    num = qemu_get_be32(f);

1922
    if (num > VIRTIO_QUEUE_MAX) {
1923
        error_report("Invalid number of virtqueues: 0x%x", num);
1924 1925 1926
        return -1;
    }

A
aliguori 已提交
1927 1928
    for (i = 0; i < num; i++) {
        vdev->vq[i].vring.num = qemu_get_be32(f);
1929 1930 1931
        if (k->has_variable_vring_alignment) {
            vdev->vq[i].vring.align = qemu_get_be32(f);
        }
1932
        vdev->vq[i].vring.desc = qemu_get_be64(f);
A
aliguori 已提交
1933
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
M
Michael S. Tsirkin 已提交
1934
        vdev->vq[i].signalled_used_valid = false;
1935
        vdev->vq[i].notification = true;
A
aliguori 已提交
1936

1937 1938 1939
        if (vdev->vq[i].vring.desc) {
            /* XXX virtio-1 devices */
            virtio_queue_update_rings(vdev, i);
M
Michael S. Tsirkin 已提交
1940 1941
        } else if (vdev->vq[i].last_avail_idx) {
            error_report("VQ %d address 0x0 "
1942
                         "inconsistent with Host index 0x%x",
M
Michael S. Tsirkin 已提交
1943 1944
                         i, vdev->vq[i].last_avail_idx);
                return -1;
1945
        }
K
KONRAD Frederic 已提交
1946 1947
        if (k->load_queue) {
            ret = k->load_queue(qbus->parent, i, f);
1948 1949
            if (ret)
                return ret;
1950
        }
A
aliguori 已提交
1951 1952
    }

1953
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
1954 1955

    if (vdc->load != NULL) {
1956 1957 1958 1959
        ret = vdc->load(vdev, f, version_id);
        if (ret) {
            return ret;
        }
1960 1961
    }

1962 1963 1964 1965 1966 1967 1968
    if (vdc->vmsd) {
        ret = vmstate_load_state(f, vdc->vmsd, vdev, version_id);
        if (ret) {
            return ret;
        }
    }

1969 1970 1971 1972 1973 1974 1975 1976 1977 1978
    /* Subsections */
    ret = vmstate_load_state(f, &vmstate_virtio, vdev, 1);
    if (ret) {
        return ret;
    }

    if (vdev->device_endian == VIRTIO_DEVICE_ENDIAN_UNKNOWN) {
        vdev->device_endian = virtio_default_endian();
    }

G
Gerd Hoffmann 已提交
1979 1980 1981 1982 1983 1984 1985
    if (virtio_64bit_features_needed(vdev)) {
        /*
         * Subsection load filled vdev->guest_features.  Run them
         * through virtio_set_features to sanity-check them against
         * host_features.
         */
        uint64_t features64 = vdev->guest_features;
1986
        if (virtio_set_features_nocheck(vdev, features64) < 0) {
G
Gerd Hoffmann 已提交
1987 1988 1989 1990 1991 1992
            error_report("Features 0x%" PRIx64 " unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features64, vdev->host_features);
            return -1;
        }
    } else {
1993
        if (virtio_set_features_nocheck(vdev, features) < 0) {
G
Gerd Hoffmann 已提交
1994 1995 1996 1997 1998 1999 2000
            error_report("Features 0x%x unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features, vdev->host_features);
            return -1;
        }
    }

2001
    for (i = 0; i < num; i++) {
2002
        if (vdev->vq[i].vring.desc) {
2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013
            uint16_t nheads;
            nheads = vring_avail_idx(&vdev->vq[i]) - vdev->vq[i].last_avail_idx;
            /* Check it isn't doing strange things with descriptor numbers. */
            if (nheads > vdev->vq[i].vring.num) {
                error_report("VQ %d size 0x%x Guest index 0x%x "
                             "inconsistent with Host index 0x%x: delta 0x%x",
                             i, vdev->vq[i].vring.num,
                             vring_avail_idx(&vdev->vq[i]),
                             vdev->vq[i].last_avail_idx, nheads);
                return -1;
            }
2014
            vdev->vq[i].used_idx = vring_used_idx(&vdev->vq[i]);
2015
            vdev->vq[i].shadow_avail_idx = vring_avail_idx(&vdev->vq[i]);
2016 2017 2018 2019

            /*
             * Some devices migrate VirtQueueElements that have been popped
             * from the avail ring but not yet returned to the used ring.
2020 2021
             * Since max ring size < UINT16_MAX it's safe to use modulo
             * UINT16_MAX + 1 subtraction.
2022
             */
2023 2024
            vdev->vq[i].inuse = (uint16_t)(vdev->vq[i].last_avail_idx -
                                vdev->vq[i].used_idx);
2025 2026 2027 2028 2029 2030 2031 2032
            if (vdev->vq[i].inuse > vdev->vq[i].vring.num) {
                error_report("VQ %d size 0x%x < last_avail_idx 0x%x - "
                             "used_idx 0x%x",
                             i, vdev->vq[i].vring.num,
                             vdev->vq[i].last_avail_idx,
                             vdev->vq[i].used_idx);
                return -1;
            }
2033 2034 2035 2036
        }
    }

    return 0;
A
aliguori 已提交
2037 2038
}

2039
void virtio_cleanup(VirtIODevice *vdev)
2040
{
2041
    qemu_del_vm_change_state_handler(vdev->vmstate);
2042 2043
}

2044
static void virtio_vmstate_change(void *opaque, int running, RunState state)
2045 2046
{
    VirtIODevice *vdev = opaque;
K
KONRAD Frederic 已提交
2047 2048
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
2049
    bool backend_run = running && (vdev->status & VIRTIO_CONFIG_S_DRIVER_OK);
2050
    vdev->vm_running = running;
2051 2052 2053 2054 2055

    if (backend_run) {
        virtio_set_status(vdev, vdev->status);
    }

K
KONRAD Frederic 已提交
2056 2057
    if (k->vmstate_change) {
        k->vmstate_change(qbus->parent, backend_run);
2058 2059 2060 2061 2062 2063 2064
    }

    if (!backend_run) {
        virtio_set_status(vdev, vdev->status);
    }
}

2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075
void virtio_instance_init_common(Object *proxy_obj, void *data,
                                 size_t vdev_size, const char *vdev_name)
{
    DeviceState *vdev = data;

    object_initialize(vdev, vdev_size, vdev_name);
    object_property_add_child(proxy_obj, "virtio-backend", OBJECT(vdev), NULL);
    object_unref(OBJECT(vdev));
    qdev_alias_all_properties(vdev, proxy_obj);
}

2076 2077
void virtio_init(VirtIODevice *vdev, const char *name,
                 uint16_t device_id, size_t config_size)
A
aliguori 已提交
2078
{
2079 2080
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
2081
    int i;
2082 2083 2084 2085 2086 2087 2088
    int nvectors = k->query_nvectors ? k->query_nvectors(qbus->parent) : 0;

    if (nvectors) {
        vdev->vector_queues =
            g_malloc0(sizeof(*vdev->vector_queues) * nvectors);
    }

P
Paul Brook 已提交
2089
    vdev->device_id = device_id;
A
aliguori 已提交
2090
    vdev->status = 0;
P
Paolo Bonzini 已提交
2091
    atomic_set(&vdev->isr, 0);
A
aliguori 已提交
2092
    vdev->queue_sel = 0;
2093
    vdev->config_vector = VIRTIO_NO_VECTOR;
2094
    vdev->vq = g_malloc0(sizeof(VirtQueue) * VIRTIO_QUEUE_MAX);
2095
    vdev->vm_running = runstate_is_running();
2096
    vdev->broken = false;
2097
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
2098
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
2099
        vdev->vq[i].vdev = vdev;
2100
        vdev->vq[i].queue_index = i;
2101
    }
A
aliguori 已提交
2102 2103 2104

    vdev->name = name;
    vdev->config_len = config_size;
2105
    if (vdev->config_len) {
2106
        vdev->config = g_malloc0(config_size);
2107
    } else {
A
aliguori 已提交
2108
        vdev->config = NULL;
2109 2110 2111
    }
    vdev->vmstate = qemu_add_vm_change_state_handler(virtio_vmstate_change,
                                                     vdev);
2112
    vdev->device_endian = virtio_default_endian();
2113
    vdev->use_guest_notifier_mask = true;
2114
}
A
aliguori 已提交
2115

A
Avi Kivity 已提交
2116
hwaddr virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
2117 2118 2119 2120
{
    return vdev->vq[n].vring.desc;
}

A
Avi Kivity 已提交
2121
hwaddr virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
2122 2123 2124 2125
{
    return vdev->vq[n].vring.avail;
}

A
Avi Kivity 已提交
2126
hwaddr virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
2127 2128 2129 2130
{
    return vdev->vq[n].vring.used;
}

A
Avi Kivity 已提交
2131
hwaddr virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
2132 2133 2134 2135
{
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
}

A
Avi Kivity 已提交
2136
hwaddr virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
2137 2138
{
    return offsetof(VRingAvail, ring) +
2139
        sizeof(uint16_t) * vdev->vq[n].vring.num;
2140 2141
}

A
Avi Kivity 已提交
2142
hwaddr virtio_queue_get_used_size(VirtIODevice *vdev, int n)
2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155
{
    return offsetof(VRingUsed, ring) +
        sizeof(VRingUsedElem) * vdev->vq[n].vring.num;
}

uint16_t virtio_queue_get_last_avail_idx(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].last_avail_idx;
}

void virtio_queue_set_last_avail_idx(VirtIODevice *vdev, int n, uint16_t idx)
{
    vdev->vq[n].last_avail_idx = idx;
2156
    vdev->vq[n].shadow_avail_idx = idx;
2157 2158
}

2159 2160 2161 2162 2163
void virtio_queue_update_used_idx(VirtIODevice *vdev, int n)
{
    vdev->vq[n].used_idx = vring_used_idx(&vdev->vq[n]);
}

2164 2165 2166 2167 2168
void virtio_queue_invalidate_signalled_used(VirtIODevice *vdev, int n)
{
    vdev->vq[n].signalled_used_valid = false;
}

2169 2170 2171 2172 2173
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
{
    return vdev->vq + n;
}

2174 2175 2176 2177 2178
uint16_t virtio_get_queue_index(VirtQueue *vq)
{
    return vq->queue_index;
}

2179 2180 2181 2182
static void virtio_queue_guest_notifier_read(EventNotifier *n)
{
    VirtQueue *vq = container_of(n, VirtQueue, guest_notifier);
    if (event_notifier_test_and_clear(n)) {
2183
        virtio_notify_vector(vq->vdev, vq->vector);
2184 2185 2186 2187 2188 2189 2190
    }
}

void virtio_queue_set_guest_notifier_fd_handler(VirtQueue *vq, bool assign,
                                                bool with_irqfd)
{
    if (assign && !with_irqfd) {
2191
        event_notifier_set_handler(&vq->guest_notifier,
2192 2193
                                   virtio_queue_guest_notifier_read);
    } else {
2194
        event_notifier_set_handler(&vq->guest_notifier, NULL);
2195 2196 2197 2198 2199 2200 2201 2202
    }
    if (!assign) {
        /* Test and clear notifier before closing it,
         * in case poll callback didn't have time to run. */
        virtio_queue_guest_notifier_read(&vq->guest_notifier);
    }
}

2203 2204 2205 2206
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
{
    return &vq->guest_notifier;
}
2207

M
Michael S. Tsirkin 已提交
2208
static void virtio_queue_host_notifier_aio_read(EventNotifier *n)
2209 2210 2211
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
M
Michael S. Tsirkin 已提交
2212
        virtio_queue_notify_aio_vq(vq);
2213 2214 2215
    }
}

2216 2217 2218 2219 2220 2221 2222
static void virtio_queue_host_notifier_aio_poll_begin(EventNotifier *n)
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);

    virtio_queue_set_notification(vq, 0);
}

2223 2224 2225 2226
static bool virtio_queue_host_notifier_aio_poll(void *opaque)
{
    EventNotifier *n = opaque;
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
2227
    bool progress;
2228 2229 2230 2231 2232

    if (virtio_queue_empty(vq)) {
        return false;
    }

2233
    progress = virtio_queue_notify_aio_vq(vq);
2234 2235 2236

    /* In case the handler function re-enabled notifications */
    virtio_queue_set_notification(vq, 0);
2237
    return progress;
2238 2239
}

2240 2241 2242 2243 2244 2245 2246 2247
static void virtio_queue_host_notifier_aio_poll_end(EventNotifier *n)
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);

    /* Caller polls once more after this to catch requests that race with us */
    virtio_queue_set_notification(vq, 1);
}

2248
void virtio_queue_aio_set_host_notifier_handler(VirtQueue *vq, AioContext *ctx,
2249
                                                VirtIOHandleAIOOutput handle_output)
2250
{
2251 2252
    if (handle_output) {
        vq->handle_aio_output = handle_output;
2253
        aio_set_event_notifier(ctx, &vq->host_notifier, true,
2254 2255
                               virtio_queue_host_notifier_aio_read,
                               virtio_queue_host_notifier_aio_poll);
2256 2257 2258
        aio_set_event_notifier_poll(ctx, &vq->host_notifier,
                                    virtio_queue_host_notifier_aio_poll_begin,
                                    virtio_queue_host_notifier_aio_poll_end);
2259
    } else {
2260
        aio_set_event_notifier(ctx, &vq->host_notifier, true, NULL, NULL);
2261 2262
        /* Test and clear notifier before after disabling event,
         * in case poll callback didn't have time to run. */
M
Michael S. Tsirkin 已提交
2263
        virtio_queue_host_notifier_aio_read(&vq->host_notifier);
2264
        vq->handle_aio_output = NULL;
M
Michael S. Tsirkin 已提交
2265 2266 2267
    }
}

2268
void virtio_queue_host_notifier_read(EventNotifier *n)
M
Michael S. Tsirkin 已提交
2269 2270 2271 2272
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
        virtio_queue_notify_vq(vq);
2273 2274 2275
    }
}

2276 2277 2278 2279
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
{
    return &vq->host_notifier;
}
2280

2281 2282
void virtio_device_set_child_bus_name(VirtIODevice *vdev, char *bus_name)
{
2283
    g_free(vdev->bus_name);
2284
    vdev->bus_name = g_strdup(bus_name);
2285 2286
}

2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302
void GCC_FMT_ATTR(2, 3) virtio_error(VirtIODevice *vdev, const char *fmt, ...)
{
    va_list ap;

    va_start(ap, fmt);
    error_vreport(fmt, ap);
    va_end(ap);

    vdev->broken = true;

    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
        virtio_set_status(vdev, vdev->status | VIRTIO_CONFIG_S_NEEDS_RESET);
        virtio_notify_config(vdev);
    }
}

2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315
static void virtio_memory_listener_commit(MemoryListener *listener)
{
    VirtIODevice *vdev = container_of(listener, VirtIODevice, listener);
    int i;

    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
        if (vdev->vq[i].vring.num == 0) {
            break;
        }
        virtio_init_region_cache(vdev, i);
    }
}

2316 2317 2318 2319 2320 2321
static void virtio_device_realize(DeviceState *dev, Error **errp)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;

2322 2323 2324
    /* Devices should either use vmsd or the load/save methods */
    assert(!vdc->vmsd || !vdc->load);

2325 2326 2327 2328 2329 2330
    if (vdc->realize != NULL) {
        vdc->realize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
2331
    }
J
Jason Wang 已提交
2332 2333 2334 2335 2336 2337

    virtio_bus_device_plugged(vdev, &err);
    if (err != NULL) {
        error_propagate(errp, err);
        return;
    }
2338 2339 2340

    vdev->listener.commit = virtio_memory_listener_commit;
    memory_listener_register(&vdev->listener, vdev->dma_as);
2341 2342
}

2343
static void virtio_device_unrealize(DeviceState *dev, Error **errp)
2344
{
2345
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
2346 2347
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;
2348

2349 2350
    virtio_bus_device_unplugged(vdev);

2351 2352 2353 2354 2355 2356
    if (vdc->unrealize != NULL) {
        vdc->unrealize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
2357
    }
2358

2359 2360
    g_free(vdev->bus_name);
    vdev->bus_name = NULL;
2361 2362
}

2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392
static void virtio_device_free_virtqueues(VirtIODevice *vdev)
{
    int i;
    if (!vdev->vq) {
        return;
    }

    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
        VRingMemoryRegionCaches *caches;
        if (vdev->vq[i].vring.num == 0) {
            break;
        }
        caches = atomic_read(&vdev->vq[i].vring.caches);
        atomic_set(&vdev->vq[i].vring.caches, NULL);
        virtio_free_region_cache(caches);
    }
    g_free(vdev->vq);
}

static void virtio_device_instance_finalize(Object *obj)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(obj);

    memory_listener_unregister(&vdev->listener);
    virtio_device_free_virtqueues(vdev);

    g_free(vdev->config);
    g_free(vdev->vector_queues);
}

C
Cornelia Huck 已提交
2393 2394 2395 2396 2397
static Property virtio_properties[] = {
    DEFINE_VIRTIO_COMMON_FEATURES(VirtIODevice, host_features),
    DEFINE_PROP_END_OF_LIST(),
};

2398 2399 2400 2401 2402 2403
static int virtio_device_start_ioeventfd_impl(VirtIODevice *vdev)
{
    VirtioBusState *qbus = VIRTIO_BUS(qdev_get_parent_bus(DEVICE(vdev)));
    int n, r, err;

    for (n = 0; n < VIRTIO_QUEUE_MAX; n++) {
2404
        VirtQueue *vq = &vdev->vq[n];
2405 2406 2407
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }
2408
        r = virtio_bus_set_host_notifier(qbus, n, true);
2409 2410 2411 2412
        if (r < 0) {
            err = r;
            goto assign_error;
        }
2413
        event_notifier_set_handler(&vq->host_notifier,
2414
                                   virtio_queue_host_notifier_read);
2415 2416 2417 2418 2419 2420 2421 2422 2423
    }

    for (n = 0; n < VIRTIO_QUEUE_MAX; n++) {
        /* Kick right away to begin processing requests already in vring */
        VirtQueue *vq = &vdev->vq[n];
        if (!vq->vring.num) {
            continue;
        }
        event_notifier_set(&vq->host_notifier);
2424 2425 2426 2427 2428
    }
    return 0;

assign_error:
    while (--n >= 0) {
2429
        VirtQueue *vq = &vdev->vq[n];
2430 2431 2432 2433
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }

2434
        event_notifier_set_handler(&vq->host_notifier, NULL);
2435
        r = virtio_bus_set_host_notifier(qbus, n, false);
2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454
        assert(r >= 0);
    }
    return err;
}

int virtio_device_start_ioeventfd(VirtIODevice *vdev)
{
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusState *vbus = VIRTIO_BUS(qbus);

    return virtio_bus_start_ioeventfd(vbus);
}

static void virtio_device_stop_ioeventfd_impl(VirtIODevice *vdev)
{
    VirtioBusState *qbus = VIRTIO_BUS(qdev_get_parent_bus(DEVICE(vdev)));
    int n, r;

    for (n = 0; n < VIRTIO_QUEUE_MAX; n++) {
2455 2456
        VirtQueue *vq = &vdev->vq[n];

2457 2458 2459
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }
2460
        event_notifier_set_handler(&vq->host_notifier, NULL);
2461
        r = virtio_bus_set_host_notifier(qbus, n, false);
2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473
        assert(r >= 0);
    }
}

void virtio_device_stop_ioeventfd(VirtIODevice *vdev)
{
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusState *vbus = VIRTIO_BUS(qbus);

    virtio_bus_stop_ioeventfd(vbus);
}

2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489
int virtio_device_grab_ioeventfd(VirtIODevice *vdev)
{
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusState *vbus = VIRTIO_BUS(qbus);

    return virtio_bus_grab_ioeventfd(vbus);
}

void virtio_device_release_ioeventfd(VirtIODevice *vdev)
{
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusState *vbus = VIRTIO_BUS(qbus);

    virtio_bus_release_ioeventfd(vbus);
}

2490 2491 2492
static void virtio_device_class_init(ObjectClass *klass, void *data)
{
    /* Set the default value here. */
2493
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
2494
    DeviceClass *dc = DEVICE_CLASS(klass);
2495 2496 2497

    dc->realize = virtio_device_realize;
    dc->unrealize = virtio_device_unrealize;
2498
    dc->bus_type = TYPE_VIRTIO_BUS;
C
Cornelia Huck 已提交
2499
    dc->props = virtio_properties;
2500 2501
    vdc->start_ioeventfd = virtio_device_start_ioeventfd_impl;
    vdc->stop_ioeventfd = virtio_device_stop_ioeventfd_impl;
2502 2503

    vdc->legacy_features |= VIRTIO_LEGACY_FEATURES;
2504 2505
}

2506 2507 2508 2509 2510 2511 2512 2513
bool virtio_device_ioeventfd_enabled(VirtIODevice *vdev)
{
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusState *vbus = VIRTIO_BUS(qbus);

    return virtio_bus_ioeventfd_enabled(vbus);
}

2514 2515 2516 2517 2518
static const TypeInfo virtio_device_info = {
    .name = TYPE_VIRTIO_DEVICE,
    .parent = TYPE_DEVICE,
    .instance_size = sizeof(VirtIODevice),
    .class_init = virtio_device_class_init,
2519
    .instance_finalize = virtio_device_instance_finalize,
2520 2521 2522 2523 2524 2525 2526 2527 2528 2529
    .abstract = true,
    .class_size = sizeof(VirtioDeviceClass),
};

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

type_init(virtio_register_types)