virtio.c 71.4 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
/* Called within rcu_read_lock().  */
177
static void vring_desc_read(VirtIODevice *vdev, VRingDesc *desc,
178
                            MemoryRegionCache *cache, int i)
A
aliguori 已提交
179
{
180 181
    address_space_read_cached(cache, i * sizeof(VRingDesc),
                              desc, sizeof(VRingDesc));
182 183 184 185
    virtio_tswap64s(vdev, &desc->addr);
    virtio_tswap32s(vdev, &desc->len);
    virtio_tswap16s(vdev, &desc->flags);
    virtio_tswap16s(vdev, &desc->next);
A
aliguori 已提交
186 187
}

188
/* Called within rcu_read_lock().  */
A
aliguori 已提交
189 190
static inline uint16_t vring_avail_flags(VirtQueue *vq)
{
191 192 193
    VRingMemoryRegionCaches *caches = atomic_rcu_read(&vq->vring.caches);
    hwaddr pa = offsetof(VRingAvail, flags);
    return virtio_lduw_phys_cached(vq->vdev, &caches->avail, pa);
A
aliguori 已提交
194 195
}

196
/* Called within rcu_read_lock().  */
A
aliguori 已提交
197 198
static inline uint16_t vring_avail_idx(VirtQueue *vq)
{
199 200 201
    VRingMemoryRegionCaches *caches = atomic_rcu_read(&vq->vring.caches);
    hwaddr pa = offsetof(VRingAvail, idx);
    vq->shadow_avail_idx = virtio_lduw_phys_cached(vq->vdev, &caches->avail, pa);
202
    return vq->shadow_avail_idx;
A
aliguori 已提交
203 204
}

205
/* Called within rcu_read_lock().  */
A
aliguori 已提交
206 207
static inline uint16_t vring_avail_ring(VirtQueue *vq, int i)
{
208 209 210
    VRingMemoryRegionCaches *caches = atomic_rcu_read(&vq->vring.caches);
    hwaddr pa = offsetof(VRingAvail, ring[i]);
    return virtio_lduw_phys_cached(vq->vdev, &caches->avail, pa);
A
aliguori 已提交
211 212
}

213
/* Called within rcu_read_lock().  */
214
static inline uint16_t vring_get_used_event(VirtQueue *vq)
M
Michael S. Tsirkin 已提交
215 216 217 218
{
    return vring_avail_ring(vq, vq->vring.num);
}

219
/* Called within rcu_read_lock().  */
220 221
static inline void vring_used_write(VirtQueue *vq, VRingUsedElem *uelem,
                                    int i)
A
aliguori 已提交
222
{
223 224
    VRingMemoryRegionCaches *caches = atomic_rcu_read(&vq->vring.caches);
    hwaddr pa = offsetof(VRingUsed, ring[i]);
225 226
    virtio_tswap32s(vq->vdev, &uelem->id);
    virtio_tswap32s(vq->vdev, &uelem->len);
227 228
    address_space_write_cached(&caches->used, pa, uelem, sizeof(VRingUsedElem));
    address_space_cache_invalidate(&caches->used, pa, sizeof(VRingUsedElem));
A
aliguori 已提交
229 230
}

231
/* Called within rcu_read_lock().  */
A
aliguori 已提交
232 233
static uint16_t vring_used_idx(VirtQueue *vq)
{
234 235 236
    VRingMemoryRegionCaches *caches = atomic_rcu_read(&vq->vring.caches);
    hwaddr pa = offsetof(VRingUsed, idx);
    return virtio_lduw_phys_cached(vq->vdev, &caches->used, pa);
A
aliguori 已提交
237 238
}

239
/* Called within rcu_read_lock().  */
M
Michael S. Tsirkin 已提交
240
static inline void vring_used_idx_set(VirtQueue *vq, uint16_t val)
A
aliguori 已提交
241
{
242 243 244 245
    VRingMemoryRegionCaches *caches = atomic_rcu_read(&vq->vring.caches);
    hwaddr pa = offsetof(VRingUsed, idx);
    virtio_stw_phys_cached(vq->vdev, &caches->used, pa, val);
    address_space_cache_invalidate(&caches->used, pa, sizeof(val));
246
    vq->used_idx = val;
A
aliguori 已提交
247 248
}

249
/* Called within rcu_read_lock().  */
A
aliguori 已提交
250 251
static inline void vring_used_flags_set_bit(VirtQueue *vq, int mask)
{
252
    VRingMemoryRegionCaches *caches = atomic_rcu_read(&vq->vring.caches);
253
    VirtIODevice *vdev = vq->vdev;
254 255 256 257 258
    hwaddr pa = offsetof(VRingUsed, flags);
    uint16_t flags = virtio_lduw_phys_cached(vq->vdev, &caches->used, pa);

    virtio_stw_phys_cached(vdev, &caches->used, pa, flags | mask);
    address_space_cache_invalidate(&caches->used, pa, sizeof(flags));
A
aliguori 已提交
259 260
}

261
/* Called within rcu_read_lock().  */
A
aliguori 已提交
262 263
static inline void vring_used_flags_unset_bit(VirtQueue *vq, int mask)
{
264
    VRingMemoryRegionCaches *caches = atomic_rcu_read(&vq->vring.caches);
265
    VirtIODevice *vdev = vq->vdev;
266 267 268 269 270
    hwaddr pa = offsetof(VRingUsed, flags);
    uint16_t flags = virtio_lduw_phys_cached(vq->vdev, &caches->used, pa);

    virtio_stw_phys_cached(vdev, &caches->used, pa, flags & ~mask);
    address_space_cache_invalidate(&caches->used, pa, sizeof(flags));
A
aliguori 已提交
271 272
}

273
/* Called within rcu_read_lock().  */
274
static inline void vring_set_avail_event(VirtQueue *vq, uint16_t val)
M
Michael S. Tsirkin 已提交
275
{
276
    VRingMemoryRegionCaches *caches;
A
Avi Kivity 已提交
277
    hwaddr pa;
278
    if (!vq->notification) {
M
Michael S. Tsirkin 已提交
279 280
        return;
    }
281 282 283 284

    caches = atomic_rcu_read(&vq->vring.caches);
    pa = offsetof(VRingUsed, ring[vq->vring.num]);
    virtio_stw_phys_cached(vq->vdev, &caches->used, pa, val);
M
Michael S. Tsirkin 已提交
285 286
}

A
aliguori 已提交
287 288
void virtio_queue_set_notification(VirtQueue *vq, int enable)
{
289
    vq->notification = enable;
290

291 292 293 294
    if (!vq->vring.desc) {
        return;
    }

295
    rcu_read_lock();
296
    if (virtio_vdev_has_feature(vq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
297
        vring_set_avail_event(vq, vring_avail_idx(vq));
M
Michael S. Tsirkin 已提交
298
    } else if (enable) {
A
aliguori 已提交
299
        vring_used_flags_unset_bit(vq, VRING_USED_F_NO_NOTIFY);
M
Michael S. Tsirkin 已提交
300
    } else {
A
aliguori 已提交
301
        vring_used_flags_set_bit(vq, VRING_USED_F_NO_NOTIFY);
M
Michael S. Tsirkin 已提交
302
    }
303 304 305 306
    if (enable) {
        /* Expose avail event/used flags before caller checks the avail idx. */
        smp_mb();
    }
307
    rcu_read_unlock();
A
aliguori 已提交
308 309 310 311 312 313 314
}

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

315
/* Fetch avail_idx from VQ memory only when we really need to know if
316 317 318
 * guest has added some buffers.
 * Called within rcu_read_lock().  */
static int virtio_queue_empty_rcu(VirtQueue *vq)
A
aliguori 已提交
319
{
320 321 322 323
    if (vq->shadow_avail_idx != vq->last_avail_idx) {
        return 0;
    }

A
aliguori 已提交
324 325 326
    return vring_avail_idx(vq) == vq->last_avail_idx;
}

327 328 329 330 331 332 333 334 335 336 337 338 339 340
int virtio_queue_empty(VirtQueue *vq)
{
    bool empty;

    if (vq->shadow_avail_idx != vq->last_avail_idx) {
        return 0;
    }

    rcu_read_lock();
    empty = vring_avail_idx(vq) == vq->last_avail_idx;
    rcu_read_unlock();
    return empty;
}

341 342
static void virtqueue_unmap_sg(VirtQueue *vq, const VirtQueueElement *elem,
                               unsigned int len)
A
aliguori 已提交
343
{
J
Jason Wang 已提交
344
    AddressSpace *dma_as = vq->vdev->dma_as;
A
aliguori 已提交
345 346 347 348 349 350 351
    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 已提交
352 353 354
        dma_memory_unmap(dma_as, elem->in_sg[i].iov_base,
                         elem->in_sg[i].iov_len,
                         DMA_DIRECTION_FROM_DEVICE, size);
A
aliguori 已提交
355

356
        offset += size;
A
aliguori 已提交
357 358
    }

359
    for (i = 0; i < elem->out_num; i++)
J
Jason Wang 已提交
360 361 362 363
        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);
364 365
}

366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
/* 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);
}

382
/* virtqueue_unpop:
383 384 385 386 387 388 389
 * @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.
 */
390 391
void virtqueue_unpop(VirtQueue *vq, const VirtQueueElement *elem,
                     unsigned int len)
J
Jason Wang 已提交
392 393
{
    vq->last_avail_idx--;
394
    virtqueue_detach_element(vq, elem, len);
J
Jason Wang 已提交
395 396
}

S
Stefan Hajnoczi 已提交
397 398 399 400 401 402 403
/* 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.
 *
404
 * Use virtqueue_unpop() instead if you have a VirtQueueElement.
S
Stefan Hajnoczi 已提交
405 406 407 408 409 410 411 412 413 414 415 416 417 418
 *
 * 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;
}

419
/* Called within rcu_read_lock().  */
420 421 422
void virtqueue_fill(VirtQueue *vq, const VirtQueueElement *elem,
                    unsigned int len, unsigned int idx)
{
423 424
    VRingUsedElem uelem;

425 426 427
    trace_virtqueue_fill(vq, elem, len, idx);

    virtqueue_unmap_sg(vq, elem, len);
428

429 430 431 432
    if (unlikely(vq->vdev->broken)) {
        return;
    }

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

435 436 437
    uelem.id = elem->index;
    uelem.len = len;
    vring_used_write(vq, &uelem, idx);
A
aliguori 已提交
438 439
}

440
/* Called within rcu_read_lock().  */
A
aliguori 已提交
441 442
void virtqueue_flush(VirtQueue *vq, unsigned int count)
{
M
Michael S. Tsirkin 已提交
443
    uint16_t old, new;
444 445 446 447 448 449

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

A
aliguori 已提交
450
    /* Make sure buffer is written before we update index. */
451
    smp_wmb();
452
    trace_virtqueue_flush(vq, count);
453
    old = vq->used_idx;
M
Michael S. Tsirkin 已提交
454 455
    new = old + count;
    vring_used_idx_set(vq, new);
A
aliguori 已提交
456
    vq->inuse -= count;
M
Michael S. Tsirkin 已提交
457 458
    if (unlikely((int16_t)(new - vq->signalled_used) < (uint16_t)(new - old)))
        vq->signalled_used_valid = false;
A
aliguori 已提交
459 460 461 462 463
}

void virtqueue_push(VirtQueue *vq, const VirtQueueElement *elem,
                    unsigned int len)
{
464
    rcu_read_lock();
A
aliguori 已提交
465 466
    virtqueue_fill(vq, elem, len, 0);
    virtqueue_flush(vq, 1);
467
    rcu_read_unlock();
A
aliguori 已提交
468 469
}

470
/* Called within rcu_read_lock().  */
A
aliguori 已提交
471 472 473 474 475
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 已提交
476
    if (num_heads > vq->vring.num) {
477
        virtio_error(vq->vdev, "Guest moved used index from %u to %u",
478
                     idx, vq->shadow_avail_idx);
479
        return -EINVAL;
A
aliguori 已提交
480
    }
481 482 483 484 485
    /* 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 已提交
486 487 488 489

    return num_heads;
}

490
/* Called within rcu_read_lock().  */
491 492
static bool virtqueue_get_head(VirtQueue *vq, unsigned int idx,
                               unsigned int *head)
A
aliguori 已提交
493 494 495
{
    /* Grab the next descriptor number they're advertising, and increment
     * the index we've seen. */
496
    *head = vring_avail_ring(vq, idx % vq->vring.num);
A
aliguori 已提交
497 498

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

504
    return true;
A
aliguori 已提交
505 506
}

507 508 509 510 511
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 已提交
512

513
static int virtqueue_read_next_desc(VirtIODevice *vdev, VRingDesc *desc,
514
                                    MemoryRegionCache *desc_cache, unsigned int max,
515 516
                                    unsigned int *next)
{
A
aliguori 已提交
517
    /* If this descriptor says it doesn't chain, we're done. */
518
    if (!(desc->flags & VRING_DESC_F_NEXT)) {
519
        return VIRTQUEUE_READ_DESC_DONE;
520
    }
A
aliguori 已提交
521 522

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

527 528 529
    if (*next >= max) {
        virtio_error(vdev, "Desc next is %u", *next);
        return VIRTQUEUE_READ_DESC_ERROR;
A
aliguori 已提交
530
    }
A
aliguori 已提交
531

532
    vring_desc_read(vdev, desc, desc_cache, *next);
533
    return VIRTQUEUE_READ_DESC_MORE;
A
aliguori 已提交
534 535
}

536
void virtqueue_get_avail_bytes(VirtQueue *vq, unsigned int *in_bytes,
537 538
                               unsigned int *out_bytes,
                               unsigned max_in_bytes, unsigned max_out_bytes)
A
aliguori 已提交
539
{
540 541
    VirtIODevice *vdev = vq->vdev;
    unsigned int max, idx;
542
    unsigned int total_bufs, in_total, out_total;
543
    VRingMemoryRegionCaches *caches;
544 545
    MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
    int64_t len = 0;
546
    int rc;
A
aliguori 已提交
547

548
    rcu_read_lock();
A
aliguori 已提交
549
    idx = vq->last_avail_idx;
550
    total_bufs = in_total = out_total = 0;
551 552

    max = vq->vring.num;
553 554
    caches = atomic_rcu_read(&vq->vring.caches);
    if (caches->desc.len < max * sizeof(VRingDesc)) {
555 556 557 558
        virtio_error(vdev, "Cannot map descriptor ring");
        goto err;
    }

559
    while ((rc = virtqueue_num_heads(vq, idx)) > 0) {
560
        MemoryRegionCache *desc_cache = &caches->desc;
561
        unsigned int num_bufs;
562
        VRingDesc desc;
563
        unsigned int i;
A
aliguori 已提交
564

565
        num_bufs = total_bufs;
566 567 568 569 570

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

571
        vring_desc_read(vdev, &desc, desc_cache, i);
572

573 574
        if (desc.flags & VRING_DESC_F_INDIRECT) {
            if (desc.len % sizeof(VRingDesc)) {
575 576
                virtio_error(vdev, "Invalid size for indirect buffer table");
                goto err;
577 578 579 580
            }

            /* If we've got too many, that implies a descriptor loop. */
            if (num_bufs >= max) {
581 582
                virtio_error(vdev, "Looped descriptor");
                goto err;
583 584 585
            }

            /* loop over the indirect descriptor table */
586 587 588 589
            len = address_space_cache_init(&indirect_desc_cache,
                                           vdev->dma_as,
                                           desc.addr, desc.len, false);
            desc_cache = &indirect_desc_cache;
590 591 592 593 594
            if (len < desc.len) {
                virtio_error(vdev, "Cannot map indirect buffer");
                goto err;
            }

595
            max = desc.len / sizeof(VRingDesc);
596
            num_bufs = i = 0;
597
            vring_desc_read(vdev, &desc, desc_cache, i);
598 599
        }

A
aliguori 已提交
600 601
        do {
            /* If we've got too many, that implies a descriptor loop. */
602
            if (++num_bufs > max) {
603 604
                virtio_error(vdev, "Looped descriptor");
                goto err;
A
aliguori 已提交
605
            }
A
aliguori 已提交
606

607 608
            if (desc.flags & VRING_DESC_F_WRITE) {
                in_total += desc.len;
A
aliguori 已提交
609
            } else {
610
                out_total += desc.len;
A
aliguori 已提交
611
            }
612 613 614
            if (in_total >= max_in_bytes && out_total >= max_out_bytes) {
                goto done;
            }
615

616
            rc = virtqueue_read_next_desc(vdev, &desc, desc_cache, max, &i);
617 618 619 620 621
        } while (rc == VIRTQUEUE_READ_DESC_MORE);

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

623 624
        if (desc_cache == &indirect_desc_cache) {
            address_space_cache_destroy(&indirect_desc_cache);
625
            total_bufs++;
626 627 628
        } else {
            total_bufs = num_bufs;
        }
A
aliguori 已提交
629
    }
630 631 632 633 634

    if (rc < 0) {
        goto err;
    }

635
done:
636
    address_space_cache_destroy(&indirect_desc_cache);
637 638 639 640 641 642
    if (in_bytes) {
        *in_bytes = in_total;
    }
    if (out_bytes) {
        *out_bytes = out_total;
    }
643
    rcu_read_unlock();
644 645 646 647 648
    return;

err:
    in_total = out_total = 0;
    goto done;
649
}
A
aliguori 已提交
650

651 652 653 654 655
int virtqueue_avail_bytes(VirtQueue *vq, unsigned int in_bytes,
                          unsigned int out_bytes)
{
    unsigned int in_total, out_total;

656 657
    virtqueue_get_avail_bytes(vq, &in_total, &out_total, in_bytes, out_bytes);
    return in_bytes <= in_total && out_bytes <= out_total;
A
aliguori 已提交
658 659
}

660 661
static bool virtqueue_map_desc(VirtIODevice *vdev, unsigned int *p_num_sg,
                               hwaddr *addr, struct iovec *iov,
662 663 664
                               unsigned int max_num_sg, bool is_write,
                               hwaddr pa, size_t sz)
{
665
    bool ok = false;
666 667 668
    unsigned num_sg = *p_num_sg;
    assert(num_sg <= max_num_sg);

669
    if (!sz) {
670 671
        virtio_error(vdev, "virtio: zero sized buffers are not allowed");
        goto out;
672 673
    }

674 675 676 677
    while (sz) {
        hwaddr len = sz;

        if (num_sg == max_num_sg) {
678 679 680
            virtio_error(vdev, "virtio: too many write descriptors in "
                               "indirect table");
            goto out;
681 682
        }

J
Jason Wang 已提交
683 684 685 686
        iov[num_sg].iov_base = dma_memory_map(vdev->dma_as, pa, &len,
                                              is_write ?
                                              DMA_DIRECTION_FROM_DEVICE :
                                              DMA_DIRECTION_TO_DEVICE);
687
        if (!iov[num_sg].iov_base) {
688 689
            virtio_error(vdev, "virtio: bogus descriptor or out of resources");
            goto out;
690 691
        }

692 693 694 695 696 697 698
        iov[num_sg].iov_len = len;
        addr[num_sg] = pa;

        sz -= len;
        pa += len;
        num_sg++;
    }
699 700 701
    ok = true;

out:
702
    *p_num_sg = num_sg;
703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720
    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++;
    }
721 722
}

J
Jason Wang 已提交
723 724
static void virtqueue_map_iovec(VirtIODevice *vdev, struct iovec *sg,
                                hwaddr *addr, unsigned int *num_sg,
725
                                int is_write)
K
Kevin Wolf 已提交
726 727
{
    unsigned int i;
A
Avi Kivity 已提交
728
    hwaddr len;
K
Kevin Wolf 已提交
729

M
Michael S. Tsirkin 已提交
730
    for (i = 0; i < *num_sg; i++) {
K
Kevin Wolf 已提交
731
        len = sg[i].iov_len;
J
Jason Wang 已提交
732 733 734 735
        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 已提交
736
        if (!sg[i].iov_base) {
M
Michael Tokarev 已提交
737
            error_report("virtio: error trying to map MMIO memory");
K
Kevin Wolf 已提交
738 739
            exit(1);
        }
740 741
        if (len != sg[i].iov_len) {
            error_report("virtio: unexpected memory split");
M
Michael S. Tsirkin 已提交
742 743
            exit(1);
        }
K
Kevin Wolf 已提交
744 745 746
    }
}

J
Jason Wang 已提交
747
void virtqueue_map(VirtIODevice *vdev, VirtQueueElement *elem)
M
Michael S. Tsirkin 已提交
748
{
749 750
    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);
751 752
}

753
static void *virtqueue_alloc_element(size_t sz, unsigned out_num, unsigned in_num)
754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771
{
    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 已提交
772 773
}

774
void *virtqueue_pop(VirtQueue *vq, size_t sz)
A
aliguori 已提交
775
{
776
    unsigned int i, head, max;
777
    VRingMemoryRegionCaches *caches;
778 779 780
    MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
    MemoryRegionCache *desc_cache;
    int64_t len;
781
    VirtIODevice *vdev = vq->vdev;
782
    VirtQueueElement *elem = NULL;
783 784 785
    unsigned out_num, in_num;
    hwaddr addr[VIRTQUEUE_MAX_SIZE];
    struct iovec iov[VIRTQUEUE_MAX_SIZE];
786
    VRingDesc desc;
787
    int rc;
A
aliguori 已提交
788

789 790 791
    if (unlikely(vdev->broken)) {
        return NULL;
    }
792 793 794
    rcu_read_lock();
    if (virtio_queue_empty_rcu(vq)) {
        goto done;
795
    }
796 797 798
    /* Needed after virtio_queue_empty(), see comment in
     * virtqueue_num_heads(). */
    smp_rmb();
A
aliguori 已提交
799 800

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

803 804
    max = vq->vring.num;

805
    if (vq->inuse >= vq->vring.num) {
806
        virtio_error(vdev, "Virtqueue size exceeded");
807
        goto done;
808 809
    }

810
    if (!virtqueue_get_head(vq, vq->last_avail_idx++, &head)) {
811
        goto done;
812 813
    }

814
    if (virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
815
        vring_set_avail_event(vq, vq->last_avail_idx);
M
Michael S. Tsirkin 已提交
816
    }
817

818
    i = head;
819

820 821
    caches = atomic_rcu_read(&vq->vring.caches);
    if (caches->desc.len < max * sizeof(VRingDesc)) {
822 823 824 825
        virtio_error(vdev, "Cannot map descriptor ring");
        goto done;
    }

826
    desc_cache = &caches->desc;
827
    vring_desc_read(vdev, &desc, desc_cache, i);
828 829
    if (desc.flags & VRING_DESC_F_INDIRECT) {
        if (desc.len % sizeof(VRingDesc)) {
830
            virtio_error(vdev, "Invalid size for indirect buffer table");
831
            goto done;
832 833 834
        }

        /* loop over the indirect descriptor table */
835 836 837
        len = address_space_cache_init(&indirect_desc_cache, vdev->dma_as,
                                       desc.addr, desc.len, false);
        desc_cache = &indirect_desc_cache;
838 839 840 841 842
        if (len < desc.len) {
            virtio_error(vdev, "Cannot map indirect buffer");
            goto done;
        }

843
        max = desc.len / sizeof(VRingDesc);
844
        i = 0;
845
        vring_desc_read(vdev, &desc, desc_cache, i);
846 847
    }

K
Kevin Wolf 已提交
848
    /* Collect all the descriptors */
A
aliguori 已提交
849
    do {
850 851
        bool map_ok;

852
        if (desc.flags & VRING_DESC_F_WRITE) {
853 854 855 856
            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 已提交
857
        } else {
858
            if (in_num) {
859 860
                virtio_error(vdev, "Incorrect order for descriptors");
                goto err_undo_map;
861
            }
862 863 864 865 866 867
            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 已提交
868
        }
A
aliguori 已提交
869 870

        /* If we've got too many, that implies a descriptor loop. */
871
        if ((in_num + out_num) > max) {
872 873
            virtio_error(vdev, "Looped descriptor");
            goto err_undo_map;
A
aliguori 已提交
874
        }
875

876
        rc = virtqueue_read_next_desc(vdev, &desc, desc_cache, max, &i);
877 878 879 880 881
    } while (rc == VIRTQUEUE_READ_DESC_MORE);

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

883 884
    /* Now copy what we have collected and mapped */
    elem = virtqueue_alloc_element(sz, out_num, in_num);
A
aliguori 已提交
885
    elem->index = head;
886 887 888 889 890 891 892 893
    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 已提交
894 895 896

    vq->inuse++;

897
    trace_virtqueue_pop(vq, elem, elem->in_num, elem->out_num);
898
done:
899
    address_space_cache_destroy(&indirect_desc_cache);
900
    rcu_read_unlock();
901

902
    return elem;
903 904 905

err_undo_map:
    virtqueue_undo_map_desc(out_num, in_num, iov);
906
    goto done;
A
aliguori 已提交
907 908
}

909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946
/* 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;
}

947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963
/* 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 已提交
964
void *qemu_get_virtqueue_element(VirtIODevice *vdev, QEMUFile *f, size_t sz)
965
{
966 967 968 969 970 971
    VirtQueueElement *elem;
    VirtQueueElementOld data;
    int i;

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

972 973 974 975 976 977 978 979 980 981
    /* 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);

982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004
    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 已提交
1005
    virtqueue_map(vdev, elem);
1006 1007 1008 1009 1010
    return elem;
}

void qemu_put_virtqueue_element(QEMUFile *f, VirtQueueElement *elem)
{
1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037
    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));
1038 1039
}

A
aliguori 已提交
1040
/* virtio device */
1041 1042
static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
{
K
KONRAD Frederic 已提交
1043 1044 1045
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

1046 1047 1048 1049
    if (unlikely(vdev->broken)) {
        return;
    }

K
KONRAD Frederic 已提交
1050 1051
    if (k->notify) {
        k->notify(qbus->parent, vector);
1052 1053
    }
}
A
aliguori 已提交
1054

P
Paul Brook 已提交
1055
void virtio_update_irq(VirtIODevice *vdev)
A
aliguori 已提交
1056
{
1057
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
A
aliguori 已提交
1058 1059
}

1060 1061 1062 1063
static int virtio_validate_features(VirtIODevice *vdev)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);

J
Jason Wang 已提交
1064 1065 1066 1067 1068
    if (virtio_host_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM) &&
        !virtio_vdev_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM)) {
        return -EFAULT;
    }

1069 1070 1071 1072 1073 1074 1075 1076
    if (k->validate_features) {
        return k->validate_features(vdev);
    } else {
        return 0;
    }
}

int virtio_set_status(VirtIODevice *vdev, uint8_t val)
1077
{
1078
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
1079 1080
    trace_virtio_set_status(vdev, val);

1081
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1082 1083 1084 1085 1086 1087 1088 1089 1090
        if (!(vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) &&
            val & VIRTIO_CONFIG_S_FEATURES_OK) {
            int ret = virtio_validate_features(vdev);

            if (ret) {
                return ret;
            }
        }
    }
1091 1092
    if (k->set_status) {
        k->set_status(vdev, val);
1093 1094
    }
    vdev->status = val;
1095
    return 0;
1096 1097
}

1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118
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 已提交
1119
void virtio_reset(void *opaque)
A
aliguori 已提交
1120 1121
{
    VirtIODevice *vdev = opaque;
1122
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1123 1124
    int i;

1125
    virtio_set_status(vdev, 0);
1126 1127 1128 1129 1130 1131 1132
    if (current_cpu) {
        /* Guest initiated reset */
        vdev->device_endian = virtio_current_cpu_endian();
    } else {
        /* System reset */
        vdev->device_endian = virtio_default_endian();
    }
1133

1134 1135 1136
    if (k->reset) {
        k->reset(vdev);
    }
A
aliguori 已提交
1137

1138
    vdev->broken = false;
1139
    vdev->guest_features = 0;
A
aliguori 已提交
1140 1141
    vdev->queue_sel = 0;
    vdev->status = 0;
P
Paolo Bonzini 已提交
1142
    atomic_set(&vdev->isr, 0);
1143 1144
    vdev->config_vector = VIRTIO_NO_VECTOR;
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1145

1146
    for(i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1147 1148 1149 1150
        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;
1151
        vdev->vq[i].shadow_avail_idx = 0;
1152
        vdev->vq[i].used_idx = 0;
1153
        virtio_queue_set_vector(vdev, i, VIRTIO_NO_VECTOR);
M
Michael S. Tsirkin 已提交
1154 1155
        vdev->vq[i].signalled_used = 0;
        vdev->vq[i].signalled_used_valid = false;
1156
        vdev->vq[i].notification = true;
C
Cornelia Huck 已提交
1157
        vdev->vq[i].vring.num = vdev->vq[i].vring.num_default;
1158
        vdev->vq[i].inuse = 0;
A
aliguori 已提交
1159 1160 1161
    }
}

P
Paul Brook 已提交
1162
uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1163
{
1164
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1165 1166
    uint8_t val;

1167
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1168
        return (uint32_t)-1;
1169 1170 1171
    }

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

1173
    val = ldub_p(vdev->config + addr);
A
aliguori 已提交
1174 1175 1176
    return val;
}

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

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

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

1188
    val = lduw_p(vdev->config + addr);
A
aliguori 已提交
1189 1190 1191
    return val;
}

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

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

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

1203
    val = ldl_p(vdev->config + addr);
A
aliguori 已提交
1204 1205 1206
    return val;
}

P
Paul Brook 已提交
1207
void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1208
{
1209
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1210 1211
    uint8_t val = data;

1212
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1213
        return;
1214
    }
A
aliguori 已提交
1215

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

1218 1219 1220
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1221 1222
}

P
Paul Brook 已提交
1223
void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1224
{
1225
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1226 1227
    uint16_t val = data;

1228
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1229
        return;
1230
    }
A
aliguori 已提交
1231

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

1234 1235 1236
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1237 1238
}

P
Paul Brook 已提交
1239
void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1240
{
1241
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1242 1243
    uint32_t val = data;

1244
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1245
        return;
1246
    }
A
aliguori 已提交
1247

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

1250 1251 1252
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
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 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350
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 已提交
1351
void virtio_queue_set_addr(VirtIODevice *vdev, int n, hwaddr addr)
A
aliguori 已提交
1352
{
1353 1354
    vdev->vq[n].vring.desc = addr;
    virtio_queue_update_rings(vdev, n);
P
Paul Brook 已提交
1355 1356
}

A
Avi Kivity 已提交
1357
hwaddr virtio_queue_get_addr(VirtIODevice *vdev, int n)
P
Paul Brook 已提交
1358
{
1359 1360 1361 1362 1363 1364 1365 1366 1367
    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;
1368
    virtio_init_region_cache(vdev, n);
P
Paul Brook 已提交
1369 1370
}

1371 1372
void virtio_queue_set_num(VirtIODevice *vdev, int n, int num)
{
1373 1374 1375 1376 1377 1378 1379
    /* 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;
1380
    }
1381
    vdev->vq[n].vring.num = num;
1382 1383
}

1384 1385 1386 1387 1388 1389 1390 1391 1392 1393
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 已提交
1394 1395 1396 1397
int virtio_queue_get_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num;
}
A
aliguori 已提交
1398

M
Michael S. Tsirkin 已提交
1399 1400 1401 1402 1403
int virtio_queue_get_max_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num_default;
}

1404 1405 1406 1407
int virtio_get_num_queues(VirtIODevice *vdev)
{
    int i;

1408
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1409 1410 1411 1412 1413 1414 1415 1416
        if (!virtio_queue_get_num(vdev, i)) {
            break;
        }
    }

    return i;
}

1417 1418 1419 1420 1421
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);

1422
    /* virtio-1 compliant devices cannot change the alignment */
1423
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1424 1425 1426
        error_report("tried to modify queue alignment for virtio-1 device");
        return;
    }
1427 1428 1429 1430 1431 1432 1433
    /* 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;
1434
    virtio_queue_update_rings(vdev, n);
1435 1436
}

1437
static bool virtio_queue_notify_aio_vq(VirtQueue *vq)
M
Michael S. Tsirkin 已提交
1438 1439 1440 1441 1442
{
    if (vq->vring.desc && vq->handle_aio_output) {
        VirtIODevice *vdev = vq->vdev;

        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
1443
        return vq->handle_aio_output(vdev, vq);
M
Michael S. Tsirkin 已提交
1444
    }
1445 1446

    return false;
M
Michael S. Tsirkin 已提交
1447 1448
}

1449
static void virtio_queue_notify_vq(VirtQueue *vq)
1450
{
1451
    if (vq->vring.desc && vq->handle_output) {
1452
        VirtIODevice *vdev = vq->vdev;
1453

1454 1455 1456 1457
        if (unlikely(vdev->broken)) {
            return;
        }

1458 1459 1460 1461 1462
        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
        vq->handle_output(vdev, vq);
    }
}

P
Paul Brook 已提交
1463 1464
void virtio_queue_notify(VirtIODevice *vdev, int n)
{
1465
    virtio_queue_notify_vq(&vdev->vq[n]);
A
aliguori 已提交
1466 1467
}

1468 1469
uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
{
1470
    return n < VIRTIO_QUEUE_MAX ? vdev->vq[n].vector :
1471 1472 1473 1474 1475
        VIRTIO_NO_VECTOR;
}

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

1478
    if (n < VIRTIO_QUEUE_MAX) {
1479 1480 1481 1482
        if (vdev->vector_queues &&
            vdev->vq[n].vector != VIRTIO_NO_VECTOR) {
            QLIST_REMOVE(vq, node);
        }
1483
        vdev->vq[n].vector = vector;
1484 1485 1486 1487 1488
        if (vdev->vector_queues &&
            vector != VIRTIO_NO_VECTOR) {
            QLIST_INSERT_HEAD(&vdev->vector_queues[vector], vq, node);
        }
    }
1489 1490
}

1491 1492
VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
                            VirtIOHandleOutput handle_output)
A
aliguori 已提交
1493 1494 1495
{
    int i;

1496
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1497 1498 1499 1500
        if (vdev->vq[i].vring.num == 0)
            break;
    }

1501
    if (i == VIRTIO_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
A
aliguori 已提交
1502 1503 1504
        abort();

    vdev->vq[i].vring.num = queue_size;
C
Cornelia Huck 已提交
1505
    vdev->vq[i].vring.num_default = queue_size;
1506
    vdev->vq[i].vring.align = VIRTIO_PCI_VRING_ALIGN;
A
aliguori 已提交
1507
    vdev->vq[i].handle_output = handle_output;
M
Michael S. Tsirkin 已提交
1508
    vdev->vq[i].handle_aio_output = NULL;
A
aliguori 已提交
1509 1510 1511 1512

    return &vdev->vq[i];
}

1513 1514
void virtio_del_queue(VirtIODevice *vdev, int n)
{
1515
    if (n < 0 || n >= VIRTIO_QUEUE_MAX) {
1516 1517 1518 1519
        abort();
    }

    vdev->vq[n].vring.num = 0;
C
Cornelia Huck 已提交
1520
    vdev->vq[n].vring.num_default = 0;
1521 1522
}

P
Paolo Bonzini 已提交
1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534
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);
    }
}

1535
/* Called within rcu_read_lock().  */
1536
static bool virtio_should_notify(VirtIODevice *vdev, VirtQueue *vq)
M
Michael S. Tsirkin 已提交
1537 1538 1539
{
    uint16_t old, new;
    bool v;
1540 1541
    /* We need to expose used array entries before checking used event. */
    smp_mb();
1542
    /* Always notify when queue is empty (when feature acknowledge) */
1543
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_NOTIFY_ON_EMPTY) &&
1544
        !vq->inuse && virtio_queue_empty(vq)) {
M
Michael S. Tsirkin 已提交
1545 1546 1547
        return true;
    }

1548
    if (!virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
M
Michael S. Tsirkin 已提交
1549 1550 1551 1552 1553 1554
        return !(vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT);
    }

    v = vq->signalled_used_valid;
    vq->signalled_used_valid = true;
    old = vq->signalled_used;
1555
    new = vq->signalled_used = vq->used_idx;
1556
    return !v || vring_need_event(vring_get_used_event(vq), new, old);
M
Michael S. Tsirkin 已提交
1557 1558
}

1559 1560
void virtio_notify_irqfd(VirtIODevice *vdev, VirtQueue *vq)
{
1561 1562 1563 1564 1565 1566
    bool should_notify;
    rcu_read_lock();
    should_notify = virtio_should_notify(vdev, vq);
    rcu_read_unlock();

    if (!should_notify) {
1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590
        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);
}

1591 1592 1593 1594 1595 1596
static void virtio_irq(VirtQueue *vq)
{
    virtio_set_isr(vq->vdev, 0x1);
    virtio_notify_vector(vq->vdev, vq->vector);
}

M
Michael S. Tsirkin 已提交
1597 1598
void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
{
1599 1600 1601 1602 1603 1604
    bool should_notify;
    rcu_read_lock();
    should_notify = virtio_should_notify(vdev, vq);
    rcu_read_unlock();

    if (!should_notify) {
A
aliguori 已提交
1605
        return;
M
Michael S. Tsirkin 已提交
1606
    }
A
aliguori 已提交
1607

1608
    trace_virtio_notify(vdev, vq);
1609
    virtio_irq(vq);
A
aliguori 已提交
1610 1611 1612 1613
}

void virtio_notify_config(VirtIODevice *vdev)
{
1614 1615 1616
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
        return;

P
Paolo Bonzini 已提交
1617
    virtio_set_isr(vdev, 0x3);
1618
    vdev->generation++;
1619
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1620 1621
}

1622 1623 1624 1625 1626
static bool virtio_device_endian_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    assert(vdev->device_endian != VIRTIO_DEVICE_ENDIAN_UNKNOWN);
1627
    if (!virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1628 1629 1630 1631
        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;
1632 1633
}

G
Gerd Hoffmann 已提交
1634 1635 1636 1637 1638 1639 1640
static bool virtio_64bit_features_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

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

J
Jason Wang 已提交
1641 1642 1643 1644 1645 1646 1647
static bool virtio_virtqueue_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return virtio_host_has_feature(vdev, VIRTIO_F_VERSION_1);
}

C
Cornelia Huck 已提交
1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660
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;
}

1661 1662 1663 1664 1665 1666 1667 1668 1669 1670
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);
}

1671 1672 1673 1674 1675 1676 1677
static bool virtio_broken_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return vdev->broken;
}

1678
static const VMStateDescription vmstate_virtqueue = {
J
Jason Wang 已提交
1679
    .name = "virtqueue_state",
1680 1681 1682 1683 1684 1685 1686
    .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 已提交
1687 1688 1689 1690 1691 1692 1693 1694
};

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 已提交
1695 1696
        VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
                      VIRTIO_QUEUE_MAX, 0, vmstate_virtqueue, VirtQueue),
J
Jason Wang 已提交
1697 1698 1699 1700
        VMSTATE_END_OF_LIST()
    }
};

1701
static const VMStateDescription vmstate_ringsize = {
C
Cornelia Huck 已提交
1702
    .name = "ringsize_state",
1703 1704 1705 1706 1707 1708
    .version_id = 1,
    .minimum_version_id = 1,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(vring.num_default, struct VirtQueue),
        VMSTATE_END_OF_LIST()
    }
C
Cornelia Huck 已提交
1709 1710 1711 1712 1713 1714 1715 1716
};

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 已提交
1717 1718
        VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
                      VIRTIO_QUEUE_MAX, 0, vmstate_ringsize, VirtQueue),
C
Cornelia Huck 已提交
1719 1720 1721 1722
        VMSTATE_END_OF_LIST()
    }
};

J
Jianjun Duan 已提交
1723 1724
static int get_extra_state(QEMUFile *f, void *pv, size_t size,
                           VMStateField *field)
1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736
{
    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 已提交
1737 1738
static int put_extra_state(QEMUFile *f, void *pv, size_t size,
                           VMStateField *field, QJSON *vmdesc)
1739 1740 1741 1742 1743 1744
{
    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 已提交
1745
    return 0;
1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772
}

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

1773 1774 1775 1776
static const VMStateDescription vmstate_virtio_device_endian = {
    .name = "virtio/device_endian",
    .version_id = 1,
    .minimum_version_id = 1,
1777
    .needed = &virtio_device_endian_needed,
1778 1779 1780 1781 1782 1783
    .fields = (VMStateField[]) {
        VMSTATE_UINT8(device_endian, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

G
Gerd Hoffmann 已提交
1784 1785 1786 1787
static const VMStateDescription vmstate_virtio_64bit_features = {
    .name = "virtio/64bit_features",
    .version_id = 1,
    .minimum_version_id = 1,
1788
    .needed = &virtio_64bit_features_needed,
G
Gerd Hoffmann 已提交
1789 1790 1791 1792 1793 1794
    .fields = (VMStateField[]) {
        VMSTATE_UINT64(guest_features, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805
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()
    }
};

1806 1807 1808 1809 1810 1811 1812
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()
1813
    },
1814 1815 1816
    .subsections = (const VMStateDescription*[]) {
        &vmstate_virtio_device_endian,
        &vmstate_virtio_64bit_features,
J
Jason Wang 已提交
1817
        &vmstate_virtio_virtqueues,
C
Cornelia Huck 已提交
1818
        &vmstate_virtio_ringsize,
1819
        &vmstate_virtio_broken,
1820
        &vmstate_virtio_extra_state,
1821
        NULL
1822 1823 1824
    }
};

A
aliguori 已提交
1825 1826
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
{
K
KONRAD Frederic 已提交
1827 1828
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1829
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
G
Gerd Hoffmann 已提交
1830
    uint32_t guest_features_lo = (vdev->guest_features & 0xffffffff);
A
aliguori 已提交
1831 1832
    int i;

K
KONRAD Frederic 已提交
1833 1834 1835
    if (k->save_config) {
        k->save_config(qbus->parent, f);
    }
A
aliguori 已提交
1836 1837 1838 1839

    qemu_put_8s(f, &vdev->status);
    qemu_put_8s(f, &vdev->isr);
    qemu_put_be16s(f, &vdev->queue_sel);
G
Gerd Hoffmann 已提交
1840
    qemu_put_be32s(f, &guest_features_lo);
A
aliguori 已提交
1841 1842 1843
    qemu_put_be32(f, vdev->config_len);
    qemu_put_buffer(f, vdev->config, vdev->config_len);

1844
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1845 1846 1847 1848 1849 1850
        if (vdev->vq[i].vring.num == 0)
            break;
    }

    qemu_put_be32(f, i);

1851
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1852 1853 1854 1855
        if (vdev->vq[i].vring.num == 0)
            break;

        qemu_put_be32(f, vdev->vq[i].vring.num);
1856 1857 1858
        if (k->has_variable_vring_alignment) {
            qemu_put_be32(f, vdev->vq[i].vring.align);
        }
1859 1860
        /* XXX virtio-1 devices */
        qemu_put_be64(f, vdev->vq[i].vring.desc);
A
aliguori 已提交
1861
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
K
KONRAD Frederic 已提交
1862 1863 1864
        if (k->save_queue) {
            k->save_queue(qbus->parent, i, f);
        }
A
aliguori 已提交
1865
    }
1866 1867 1868 1869

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

1871 1872 1873 1874
    if (vdc->vmsd) {
        vmstate_save_state(f, vdc->vmsd, vdev, NULL);
    }

1875
    /* Subsections */
1876
    vmstate_save_state(f, &vmstate_virtio, vdev, NULL);
A
aliguori 已提交
1877 1878
}

1879
/* A wrapper for use as a VMState .put function */
J
Jianjun Duan 已提交
1880 1881
static int virtio_device_put(QEMUFile *f, void *opaque, size_t size,
                              VMStateField *field, QJSON *vmdesc)
1882 1883
{
    virtio_save(VIRTIO_DEVICE(opaque), f);
J
Jianjun Duan 已提交
1884 1885

    return 0;
1886 1887 1888
}

/* A wrapper for use as a VMState .get function */
J
Jianjun Duan 已提交
1889 1890
static int virtio_device_get(QEMUFile *f, void *opaque, size_t size,
                             VMStateField *field)
1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903
{
    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,
};

1904
static int virtio_set_features_nocheck(VirtIODevice *vdev, uint64_t val)
1905
{
1906
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
C
Cornelia Huck 已提交
1907
    bool bad = (val & ~(vdev->host_features)) != 0;
1908

C
Cornelia Huck 已提交
1909
    val &= vdev->host_features;
1910 1911
    if (k->set_features) {
        k->set_features(vdev, val);
1912 1913 1914 1915 1916
    }
    vdev->guest_features = val;
    return bad ? -1 : 0;
}

1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928
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);
}

1929
int virtio_load(VirtIODevice *vdev, QEMUFile *f, int version_id)
A
aliguori 已提交
1930
{
1931
    int i, ret;
1932
    int32_t config_len;
1933
    uint32_t num;
1934
    uint32_t features;
K
KONRAD Frederic 已提交
1935 1936
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1937
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1938

1939 1940 1941 1942 1943 1944
    /*
     * 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 已提交
1945 1946
    if (k->load_config) {
        ret = k->load_config(qbus->parent, f);
1947 1948 1949
        if (ret)
            return ret;
    }
A
aliguori 已提交
1950 1951 1952 1953

    qemu_get_8s(f, &vdev->status);
    qemu_get_8s(f, &vdev->isr);
    qemu_get_be16s(f, &vdev->queue_sel);
1954
    if (vdev->queue_sel >= VIRTIO_QUEUE_MAX) {
1955 1956
        return -1;
    }
1957
    qemu_get_be32s(f, &features);
1958

1959 1960 1961 1962 1963 1964 1965 1966 1967 1968
    /*
     * 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;

1969
    config_len = qemu_get_be32(f);
1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980

    /*
     * 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--;
1981
    }
A
aliguori 已提交
1982 1983 1984

    num = qemu_get_be32(f);

1985
    if (num > VIRTIO_QUEUE_MAX) {
1986
        error_report("Invalid number of virtqueues: 0x%x", num);
1987 1988 1989
        return -1;
    }

A
aliguori 已提交
1990 1991
    for (i = 0; i < num; i++) {
        vdev->vq[i].vring.num = qemu_get_be32(f);
1992 1993 1994
        if (k->has_variable_vring_alignment) {
            vdev->vq[i].vring.align = qemu_get_be32(f);
        }
1995
        vdev->vq[i].vring.desc = qemu_get_be64(f);
A
aliguori 已提交
1996
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
M
Michael S. Tsirkin 已提交
1997
        vdev->vq[i].signalled_used_valid = false;
1998
        vdev->vq[i].notification = true;
A
aliguori 已提交
1999

2000 2001 2002
        if (vdev->vq[i].vring.desc) {
            /* XXX virtio-1 devices */
            virtio_queue_update_rings(vdev, i);
M
Michael S. Tsirkin 已提交
2003 2004
        } else if (vdev->vq[i].last_avail_idx) {
            error_report("VQ %d address 0x0 "
2005
                         "inconsistent with Host index 0x%x",
M
Michael S. Tsirkin 已提交
2006 2007
                         i, vdev->vq[i].last_avail_idx);
                return -1;
2008
        }
K
KONRAD Frederic 已提交
2009 2010
        if (k->load_queue) {
            ret = k->load_queue(qbus->parent, i, f);
2011 2012
            if (ret)
                return ret;
2013
        }
A
aliguori 已提交
2014 2015
    }

2016
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
2017 2018

    if (vdc->load != NULL) {
2019 2020 2021 2022
        ret = vdc->load(vdev, f, version_id);
        if (ret) {
            return ret;
        }
2023 2024
    }

2025 2026 2027 2028 2029 2030 2031
    if (vdc->vmsd) {
        ret = vmstate_load_state(f, vdc->vmsd, vdev, version_id);
        if (ret) {
            return ret;
        }
    }

2032 2033 2034 2035 2036 2037 2038 2039 2040 2041
    /* 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 已提交
2042 2043 2044 2045 2046 2047 2048
    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;
2049
        if (virtio_set_features_nocheck(vdev, features64) < 0) {
G
Gerd Hoffmann 已提交
2050 2051 2052 2053 2054 2055
            error_report("Features 0x%" PRIx64 " unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features64, vdev->host_features);
            return -1;
        }
    } else {
2056
        if (virtio_set_features_nocheck(vdev, features) < 0) {
G
Gerd Hoffmann 已提交
2057 2058 2059 2060 2061 2062 2063
            error_report("Features 0x%x unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features, vdev->host_features);
            return -1;
        }
    }

2064
    rcu_read_lock();
2065
    for (i = 0; i < num; i++) {
2066
        if (vdev->vq[i].vring.desc) {
2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077
            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;
            }
2078
            vdev->vq[i].used_idx = vring_used_idx(&vdev->vq[i]);
2079
            vdev->vq[i].shadow_avail_idx = vring_avail_idx(&vdev->vq[i]);
2080 2081 2082 2083

            /*
             * Some devices migrate VirtQueueElements that have been popped
             * from the avail ring but not yet returned to the used ring.
2084 2085
             * Since max ring size < UINT16_MAX it's safe to use modulo
             * UINT16_MAX + 1 subtraction.
2086
             */
2087 2088
            vdev->vq[i].inuse = (uint16_t)(vdev->vq[i].last_avail_idx -
                                vdev->vq[i].used_idx);
2089 2090 2091 2092 2093 2094 2095 2096
            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;
            }
2097 2098
        }
    }
2099
    rcu_read_unlock();
2100 2101

    return 0;
A
aliguori 已提交
2102 2103
}

2104
void virtio_cleanup(VirtIODevice *vdev)
2105
{
2106
    qemu_del_vm_change_state_handler(vdev->vmstate);
2107 2108
}

2109
static void virtio_vmstate_change(void *opaque, int running, RunState state)
2110 2111
{
    VirtIODevice *vdev = opaque;
K
KONRAD Frederic 已提交
2112 2113
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
2114
    bool backend_run = running && (vdev->status & VIRTIO_CONFIG_S_DRIVER_OK);
2115
    vdev->vm_running = running;
2116 2117 2118 2119 2120

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

K
KONRAD Frederic 已提交
2121 2122
    if (k->vmstate_change) {
        k->vmstate_change(qbus->parent, backend_run);
2123 2124 2125 2126 2127 2128 2129
    }

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

2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140
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);
}

2141 2142
void virtio_init(VirtIODevice *vdev, const char *name,
                 uint16_t device_id, size_t config_size)
A
aliguori 已提交
2143
{
2144 2145
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
2146
    int i;
2147 2148 2149 2150 2151 2152 2153
    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 已提交
2154
    vdev->device_id = device_id;
A
aliguori 已提交
2155
    vdev->status = 0;
P
Paolo Bonzini 已提交
2156
    atomic_set(&vdev->isr, 0);
A
aliguori 已提交
2157
    vdev->queue_sel = 0;
2158
    vdev->config_vector = VIRTIO_NO_VECTOR;
2159
    vdev->vq = g_malloc0(sizeof(VirtQueue) * VIRTIO_QUEUE_MAX);
2160
    vdev->vm_running = runstate_is_running();
2161
    vdev->broken = false;
2162
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
2163
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
2164
        vdev->vq[i].vdev = vdev;
2165
        vdev->vq[i].queue_index = i;
2166
    }
A
aliguori 已提交
2167 2168 2169

    vdev->name = name;
    vdev->config_len = config_size;
2170
    if (vdev->config_len) {
2171
        vdev->config = g_malloc0(config_size);
2172
    } else {
A
aliguori 已提交
2173
        vdev->config = NULL;
2174 2175 2176
    }
    vdev->vmstate = qemu_add_vm_change_state_handler(virtio_vmstate_change,
                                                     vdev);
2177
    vdev->device_endian = virtio_default_endian();
2178
    vdev->use_guest_notifier_mask = true;
2179
}
A
aliguori 已提交
2180

A
Avi Kivity 已提交
2181
hwaddr virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
2182 2183 2184 2185
{
    return vdev->vq[n].vring.desc;
}

A
Avi Kivity 已提交
2186
hwaddr virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
2187 2188 2189 2190
{
    return vdev->vq[n].vring.avail;
}

A
Avi Kivity 已提交
2191
hwaddr virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
2192 2193 2194 2195
{
    return vdev->vq[n].vring.used;
}

A
Avi Kivity 已提交
2196
hwaddr virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
2197 2198 2199 2200
{
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
}

A
Avi Kivity 已提交
2201
hwaddr virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
2202 2203
{
    return offsetof(VRingAvail, ring) +
2204
        sizeof(uint16_t) * vdev->vq[n].vring.num;
2205 2206
}

A
Avi Kivity 已提交
2207
hwaddr virtio_queue_get_used_size(VirtIODevice *vdev, int n)
2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220
{
    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;
2221
    vdev->vq[n].shadow_avail_idx = idx;
2222 2223
}

2224 2225
void virtio_queue_update_used_idx(VirtIODevice *vdev, int n)
{
2226
    rcu_read_lock();
2227 2228 2229
    if (vdev->vq[n].vring.desc) {
        vdev->vq[n].used_idx = vring_used_idx(&vdev->vq[n]);
    }
2230
    rcu_read_unlock();
2231 2232
}

2233 2234 2235 2236 2237
void virtio_queue_invalidate_signalled_used(VirtIODevice *vdev, int n)
{
    vdev->vq[n].signalled_used_valid = false;
}

2238 2239 2240 2241 2242
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
{
    return vdev->vq + n;
}

2243 2244 2245 2246 2247
uint16_t virtio_get_queue_index(VirtQueue *vq)
{
    return vq->queue_index;
}

2248 2249 2250 2251
static void virtio_queue_guest_notifier_read(EventNotifier *n)
{
    VirtQueue *vq = container_of(n, VirtQueue, guest_notifier);
    if (event_notifier_test_and_clear(n)) {
2252
        virtio_irq(vq);
2253 2254 2255 2256 2257 2258 2259
    }
}

void virtio_queue_set_guest_notifier_fd_handler(VirtQueue *vq, bool assign,
                                                bool with_irqfd)
{
    if (assign && !with_irqfd) {
2260
        event_notifier_set_handler(&vq->guest_notifier,
2261 2262
                                   virtio_queue_guest_notifier_read);
    } else {
2263
        event_notifier_set_handler(&vq->guest_notifier, NULL);
2264 2265 2266 2267 2268 2269 2270 2271
    }
    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);
    }
}

2272 2273 2274 2275
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
{
    return &vq->guest_notifier;
}
2276

M
Michael S. Tsirkin 已提交
2277
static void virtio_queue_host_notifier_aio_read(EventNotifier *n)
2278 2279 2280
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
M
Michael S. Tsirkin 已提交
2281
        virtio_queue_notify_aio_vq(vq);
2282 2283 2284
    }
}

2285 2286 2287 2288 2289 2290 2291
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);
}

2292 2293 2294 2295
static bool virtio_queue_host_notifier_aio_poll(void *opaque)
{
    EventNotifier *n = opaque;
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
2296
    bool progress;
2297

2298
    if (!vq->vring.desc || virtio_queue_empty(vq)) {
2299 2300 2301
        return false;
    }

2302
    progress = virtio_queue_notify_aio_vq(vq);
2303 2304 2305

    /* In case the handler function re-enabled notifications */
    virtio_queue_set_notification(vq, 0);
2306
    return progress;
2307 2308
}

2309 2310 2311 2312 2313 2314 2315 2316
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);
}

2317
void virtio_queue_aio_set_host_notifier_handler(VirtQueue *vq, AioContext *ctx,
2318
                                                VirtIOHandleAIOOutput handle_output)
2319
{
2320 2321
    if (handle_output) {
        vq->handle_aio_output = handle_output;
2322
        aio_set_event_notifier(ctx, &vq->host_notifier, true,
2323 2324
                               virtio_queue_host_notifier_aio_read,
                               virtio_queue_host_notifier_aio_poll);
2325 2326 2327
        aio_set_event_notifier_poll(ctx, &vq->host_notifier,
                                    virtio_queue_host_notifier_aio_poll_begin,
                                    virtio_queue_host_notifier_aio_poll_end);
2328
    } else {
2329
        aio_set_event_notifier(ctx, &vq->host_notifier, true, NULL, NULL);
2330 2331
        /* Test and clear notifier before after disabling event,
         * in case poll callback didn't have time to run. */
M
Michael S. Tsirkin 已提交
2332
        virtio_queue_host_notifier_aio_read(&vq->host_notifier);
2333
        vq->handle_aio_output = NULL;
M
Michael S. Tsirkin 已提交
2334 2335 2336
    }
}

2337
void virtio_queue_host_notifier_read(EventNotifier *n)
M
Michael S. Tsirkin 已提交
2338 2339 2340 2341
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
        virtio_queue_notify_vq(vq);
2342 2343 2344
    }
}

2345 2346 2347 2348
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
{
    return &vq->host_notifier;
}
2349

2350 2351
void virtio_device_set_child_bus_name(VirtIODevice *vdev, char *bus_name)
{
2352
    g_free(vdev->bus_name);
2353
    vdev->bus_name = g_strdup(bus_name);
2354 2355
}

2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371
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);
    }
}

2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384
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);
    }
}

2385 2386 2387 2388 2389 2390
static void virtio_device_realize(DeviceState *dev, Error **errp)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;

2391 2392 2393
    /* Devices should either use vmsd or the load/save methods */
    assert(!vdc->vmsd || !vdc->load);

2394 2395 2396 2397 2398 2399
    if (vdc->realize != NULL) {
        vdc->realize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
2400
    }
J
Jason Wang 已提交
2401 2402 2403 2404 2405 2406

    virtio_bus_device_plugged(vdev, &err);
    if (err != NULL) {
        error_propagate(errp, err);
        return;
    }
2407 2408 2409

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

2412
static void virtio_device_unrealize(DeviceState *dev, Error **errp)
2413
{
2414
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
2415 2416
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;
2417

2418 2419
    virtio_bus_device_unplugged(vdev);

2420 2421 2422 2423 2424 2425
    if (vdc->unrealize != NULL) {
        vdc->unrealize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
2426
    }
2427

2428 2429
    g_free(vdev->bus_name);
    vdev->bus_name = NULL;
2430 2431
}

2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461
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 已提交
2462 2463 2464 2465 2466
static Property virtio_properties[] = {
    DEFINE_VIRTIO_COMMON_FEATURES(VirtIODevice, host_features),
    DEFINE_PROP_END_OF_LIST(),
};

2467 2468 2469 2470 2471 2472
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++) {
2473
        VirtQueue *vq = &vdev->vq[n];
2474 2475 2476
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }
2477
        r = virtio_bus_set_host_notifier(qbus, n, true);
2478 2479 2480 2481
        if (r < 0) {
            err = r;
            goto assign_error;
        }
2482
        event_notifier_set_handler(&vq->host_notifier,
2483
                                   virtio_queue_host_notifier_read);
2484 2485 2486 2487 2488 2489 2490 2491 2492
    }

    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);
2493 2494 2495 2496 2497
    }
    return 0;

assign_error:
    while (--n >= 0) {
2498
        VirtQueue *vq = &vdev->vq[n];
2499 2500 2501 2502
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }

2503
        event_notifier_set_handler(&vq->host_notifier, NULL);
2504
        r = virtio_bus_set_host_notifier(qbus, n, false);
2505 2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523
        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++) {
2524 2525
        VirtQueue *vq = &vdev->vq[n];

2526 2527 2528
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }
2529
        event_notifier_set_handler(&vq->host_notifier, NULL);
2530
        r = virtio_bus_set_host_notifier(qbus, n, false);
2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542
        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);
}

2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558
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);
}

2559 2560 2561
static void virtio_device_class_init(ObjectClass *klass, void *data)
{
    /* Set the default value here. */
2562
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
2563
    DeviceClass *dc = DEVICE_CLASS(klass);
2564 2565 2566

    dc->realize = virtio_device_realize;
    dc->unrealize = virtio_device_unrealize;
2567
    dc->bus_type = TYPE_VIRTIO_BUS;
C
Cornelia Huck 已提交
2568
    dc->props = virtio_properties;
2569 2570
    vdc->start_ioeventfd = virtio_device_start_ioeventfd_impl;
    vdc->stop_ioeventfd = virtio_device_stop_ioeventfd_impl;
2571 2572

    vdc->legacy_features |= VIRTIO_LEGACY_FEATURES;
2573 2574
}

2575 2576 2577 2578 2579 2580 2581 2582
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);
}

2583 2584 2585 2586 2587
static const TypeInfo virtio_device_info = {
    .name = TYPE_VIRTIO_DEVICE,
    .parent = TYPE_DEVICE,
    .instance_size = sizeof(VirtIODevice),
    .class_init = virtio_device_class_init,
2588
    .instance_finalize = virtio_device_instance_finalize,
2589 2590 2591 2592 2593 2594 2595 2596 2597 2598
    .abstract = true,
    .class_size = sizeof(VirtioDeviceClass),
};

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

type_init(virtio_register_types)