virtio.c 66.6 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 63 64 65
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;

typedef struct VRing
{
    unsigned int num;
C
Cornelia Huck 已提交
66
    unsigned int num_default;
67
    unsigned int align;
A
Avi Kivity 已提交
68 69 70
    hwaddr desc;
    hwaddr avail;
    hwaddr used;
A
aliguori 已提交
71 72 73 74 75
} VRing;

struct VirtQueue
{
    VRing vring;
76 77

    /* Next head to pop */
A
aliguori 已提交
78
    uint16_t last_avail_idx;
79

80 81 82
    /* Last avail_idx read from VQ. */
    uint16_t shadow_avail_idx;

83 84
    uint16_t used_idx;

M
Michael S. Tsirkin 已提交
85 86 87 88 89 90
    /* Last used index value we have signalled on */
    uint16_t signalled_used;

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

91 92
    /* Notification enabled? */
    bool notification;
M
Michael S. Tsirkin 已提交
93

94 95
    uint16_t queue_index;

96
    unsigned int inuse;
M
Michael S. Tsirkin 已提交
97

98
    uint16_t vector;
99
    VirtIOHandleOutput handle_output;
100
    VirtIOHandleAIOOutput handle_aio_output;
101 102 103
    VirtIODevice *vdev;
    EventNotifier guest_notifier;
    EventNotifier host_notifier;
104
    QLIST_ENTRY(VirtQueue) node;
A
aliguori 已提交
105 106 107
};

/* virt queue functions */
108
void virtio_queue_update_rings(VirtIODevice *vdev, int n)
A
aliguori 已提交
109
{
110
    VRing *vring = &vdev->vq[n].vring;
P
Paul Brook 已提交
111

112 113 114 115 116 117 118 119
    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);
A
aliguori 已提交
120 121
}

122
static void vring_desc_read(VirtIODevice *vdev, VRingDesc *desc,
123
                            MemoryRegionCache *cache, int i)
A
aliguori 已提交
124
{
125 126
    address_space_read_cached(cache, i * sizeof(VRingDesc),
                              desc, sizeof(VRingDesc));
127 128 129 130
    virtio_tswap64s(vdev, &desc->addr);
    virtio_tswap32s(vdev, &desc->len);
    virtio_tswap16s(vdev, &desc->flags);
    virtio_tswap16s(vdev, &desc->next);
A
aliguori 已提交
131 132 133 134
}

static inline uint16_t vring_avail_flags(VirtQueue *vq)
{
A
Avi Kivity 已提交
135
    hwaddr pa;
A
aliguori 已提交
136
    pa = vq->vring.avail + offsetof(VRingAvail, flags);
137
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
138 139 140 141
}

static inline uint16_t vring_avail_idx(VirtQueue *vq)
{
A
Avi Kivity 已提交
142
    hwaddr pa;
A
aliguori 已提交
143
    pa = vq->vring.avail + offsetof(VRingAvail, idx);
144 145
    vq->shadow_avail_idx = virtio_lduw_phys(vq->vdev, pa);
    return vq->shadow_avail_idx;
A
aliguori 已提交
146 147 148 149
}

static inline uint16_t vring_avail_ring(VirtQueue *vq, int i)
{
A
Avi Kivity 已提交
150
    hwaddr pa;
A
aliguori 已提交
151
    pa = vq->vring.avail + offsetof(VRingAvail, ring[i]);
152
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
153 154
}

155
static inline uint16_t vring_get_used_event(VirtQueue *vq)
M
Michael S. Tsirkin 已提交
156 157 158 159
{
    return vring_avail_ring(vq, vq->vring.num);
}

160 161
static inline void vring_used_write(VirtQueue *vq, VRingUsedElem *uelem,
                                    int i)
A
aliguori 已提交
162
{
A
Avi Kivity 已提交
163
    hwaddr pa;
164 165 166
    virtio_tswap32s(vq->vdev, &uelem->id);
    virtio_tswap32s(vq->vdev, &uelem->len);
    pa = vq->vring.used + offsetof(VRingUsed, ring[i]);
J
Jason Wang 已提交
167
    address_space_write(vq->vdev->dma_as, pa, MEMTXATTRS_UNSPECIFIED,
168
                       (void *)uelem, sizeof(VRingUsedElem));
A
aliguori 已提交
169 170 171 172
}

static uint16_t vring_used_idx(VirtQueue *vq)
{
A
Avi Kivity 已提交
173
    hwaddr pa;
A
aliguori 已提交
174
    pa = vq->vring.used + offsetof(VRingUsed, idx);
175
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
176 177
}

M
Michael S. Tsirkin 已提交
178
static inline void vring_used_idx_set(VirtQueue *vq, uint16_t val)
A
aliguori 已提交
179
{
A
Avi Kivity 已提交
180
    hwaddr pa;
A
aliguori 已提交
181
    pa = vq->vring.used + offsetof(VRingUsed, idx);
182
    virtio_stw_phys(vq->vdev, pa, val);
183
    vq->used_idx = val;
A
aliguori 已提交
184 185 186 187
}

static inline void vring_used_flags_set_bit(VirtQueue *vq, int mask)
{
188
    VirtIODevice *vdev = vq->vdev;
A
Avi Kivity 已提交
189
    hwaddr pa;
A
aliguori 已提交
190
    pa = vq->vring.used + offsetof(VRingUsed, flags);
191
    virtio_stw_phys(vdev, pa, virtio_lduw_phys(vdev, pa) | mask);
A
aliguori 已提交
192 193 194 195
}

static inline void vring_used_flags_unset_bit(VirtQueue *vq, int mask)
{
196
    VirtIODevice *vdev = vq->vdev;
A
Avi Kivity 已提交
197
    hwaddr pa;
A
aliguori 已提交
198
    pa = vq->vring.used + offsetof(VRingUsed, flags);
199
    virtio_stw_phys(vdev, pa, virtio_lduw_phys(vdev, pa) & ~mask);
A
aliguori 已提交
200 201
}

202
static inline void vring_set_avail_event(VirtQueue *vq, uint16_t val)
M
Michael S. Tsirkin 已提交
203
{
A
Avi Kivity 已提交
204
    hwaddr pa;
205
    if (!vq->notification) {
M
Michael S. Tsirkin 已提交
206 207 208
        return;
    }
    pa = vq->vring.used + offsetof(VRingUsed, ring[vq->vring.num]);
209
    virtio_stw_phys(vq->vdev, pa, val);
M
Michael S. Tsirkin 已提交
210 211
}

A
aliguori 已提交
212 213
void virtio_queue_set_notification(VirtQueue *vq, int enable)
{
214
    vq->notification = enable;
215
    if (virtio_vdev_has_feature(vq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
216
        vring_set_avail_event(vq, vring_avail_idx(vq));
M
Michael S. Tsirkin 已提交
217
    } else if (enable) {
A
aliguori 已提交
218
        vring_used_flags_unset_bit(vq, VRING_USED_F_NO_NOTIFY);
M
Michael S. Tsirkin 已提交
219
    } else {
A
aliguori 已提交
220
        vring_used_flags_set_bit(vq, VRING_USED_F_NO_NOTIFY);
M
Michael S. Tsirkin 已提交
221
    }
222 223 224 225
    if (enable) {
        /* Expose avail event/used flags before caller checks the avail idx. */
        smp_mb();
    }
A
aliguori 已提交
226 227 228 229 230 231 232
}

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

233 234
/* Fetch avail_idx from VQ memory only when we really need to know if
 * guest has added some buffers. */
A
aliguori 已提交
235 236
int virtio_queue_empty(VirtQueue *vq)
{
237 238 239 240
    if (vq->shadow_avail_idx != vq->last_avail_idx) {
        return 0;
    }

A
aliguori 已提交
241 242 243
    return vring_avail_idx(vq) == vq->last_avail_idx;
}

244 245
static void virtqueue_unmap_sg(VirtQueue *vq, const VirtQueueElement *elem,
                               unsigned int len)
A
aliguori 已提交
246
{
J
Jason Wang 已提交
247
    AddressSpace *dma_as = vq->vdev->dma_as;
A
aliguori 已提交
248 249 250 251 252 253 254
    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 已提交
255 256 257
        dma_memory_unmap(dma_as, elem->in_sg[i].iov_base,
                         elem->in_sg[i].iov_len,
                         DMA_DIRECTION_FROM_DEVICE, size);
A
aliguori 已提交
258

259
        offset += size;
A
aliguori 已提交
260 261
    }

262
    for (i = 0; i < elem->out_num; i++)
J
Jason Wang 已提交
263 264 265 266
        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);
267 268
}

269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284
/* 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);
}

285
/* virtqueue_unpop:
286 287 288 289 290 291 292
 * @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.
 */
293 294
void virtqueue_unpop(VirtQueue *vq, const VirtQueueElement *elem,
                     unsigned int len)
J
Jason Wang 已提交
295 296
{
    vq->last_avail_idx--;
297
    virtqueue_detach_element(vq, elem, len);
J
Jason Wang 已提交
298 299
}

S
Stefan Hajnoczi 已提交
300 301 302 303 304 305 306
/* 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.
 *
307
 * Use virtqueue_unpop() instead if you have a VirtQueueElement.
S
Stefan Hajnoczi 已提交
308 309 310 311 312 313 314 315 316 317 318 319 320 321
 *
 * 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;
}

322 323 324
void virtqueue_fill(VirtQueue *vq, const VirtQueueElement *elem,
                    unsigned int len, unsigned int idx)
{
325 326
    VRingUsedElem uelem;

327 328 329
    trace_virtqueue_fill(vq, elem, len, idx);

    virtqueue_unmap_sg(vq, elem, len);
330

331 332 333 334
    if (unlikely(vq->vdev->broken)) {
        return;
    }

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

337 338 339
    uelem.id = elem->index;
    uelem.len = len;
    vring_used_write(vq, &uelem, idx);
A
aliguori 已提交
340 341 342 343
}

void virtqueue_flush(VirtQueue *vq, unsigned int count)
{
M
Michael S. Tsirkin 已提交
344
    uint16_t old, new;
345 346 347 348 349 350

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

A
aliguori 已提交
351
    /* Make sure buffer is written before we update index. */
352
    smp_wmb();
353
    trace_virtqueue_flush(vq, count);
354
    old = vq->used_idx;
M
Michael S. Tsirkin 已提交
355 356
    new = old + count;
    vring_used_idx_set(vq, new);
A
aliguori 已提交
357
    vq->inuse -= count;
M
Michael S. Tsirkin 已提交
358 359
    if (unlikely((int16_t)(new - vq->signalled_used) < (uint16_t)(new - old)))
        vq->signalled_used_valid = false;
A
aliguori 已提交
360 361 362 363 364 365 366 367 368 369 370 371 372 373
}

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 已提交
374
    if (num_heads > vq->vring.num) {
375
        virtio_error(vq->vdev, "Guest moved used index from %u to %u",
376
                     idx, vq->shadow_avail_idx);
377
        return -EINVAL;
A
aliguori 已提交
378
    }
379 380 381 382 383
    /* 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 已提交
384 385 386 387

    return num_heads;
}

388 389
static bool virtqueue_get_head(VirtQueue *vq, unsigned int idx,
                               unsigned int *head)
A
aliguori 已提交
390 391 392
{
    /* Grab the next descriptor number they're advertising, and increment
     * the index we've seen. */
393
    *head = vring_avail_ring(vq, idx % vq->vring.num);
A
aliguori 已提交
394 395

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

401
    return true;
A
aliguori 已提交
402 403
}

404 405 406 407 408
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 已提交
409

410
static int virtqueue_read_next_desc(VirtIODevice *vdev, VRingDesc *desc,
411
                                    MemoryRegionCache *desc_cache, unsigned int max,
412 413
                                    unsigned int *next)
{
A
aliguori 已提交
414
    /* If this descriptor says it doesn't chain, we're done. */
415
    if (!(desc->flags & VRING_DESC_F_NEXT)) {
416
        return VIRTQUEUE_READ_DESC_DONE;
417
    }
A
aliguori 已提交
418 419

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

424 425 426
    if (*next >= max) {
        virtio_error(vdev, "Desc next is %u", *next);
        return VIRTQUEUE_READ_DESC_ERROR;
A
aliguori 已提交
427
    }
A
aliguori 已提交
428

429
    vring_desc_read(vdev, desc, desc_cache, *next);
430
    return VIRTQUEUE_READ_DESC_MORE;
A
aliguori 已提交
431 432
}

433
void virtqueue_get_avail_bytes(VirtQueue *vq, unsigned int *in_bytes,
434 435
                               unsigned int *out_bytes,
                               unsigned max_in_bytes, unsigned max_out_bytes)
A
aliguori 已提交
436
{
437 438
    VirtIODevice *vdev = vq->vdev;
    unsigned int max, idx;
439
    unsigned int total_bufs, in_total, out_total;
440 441 442
    MemoryRegionCache vring_desc_cache;
    MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
    int64_t len = 0;
443
    int rc;
A
aliguori 已提交
444 445

    idx = vq->last_avail_idx;
446
    total_bufs = in_total = out_total = 0;
447 448

    max = vq->vring.num;
449 450 451
    len = address_space_cache_init(&vring_desc_cache, vdev->dma_as,
                                   vq->vring.desc, max * sizeof(VRingDesc),
                                   false);
452 453 454 455 456
    if (len < max * sizeof(VRingDesc)) {
        virtio_error(vdev, "Cannot map descriptor ring");
        goto err;
    }

457
    while ((rc = virtqueue_num_heads(vq, idx)) > 0) {
458
        MemoryRegionCache *desc_cache = &vring_desc_cache;
459
        unsigned int num_bufs;
460
        VRingDesc desc;
461
        unsigned int i;
A
aliguori 已提交
462

463
        num_bufs = total_bufs;
464 465 466 467 468

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

469
        vring_desc_read(vdev, &desc, desc_cache, i);
470

471 472
        if (desc.flags & VRING_DESC_F_INDIRECT) {
            if (desc.len % sizeof(VRingDesc)) {
473 474
                virtio_error(vdev, "Invalid size for indirect buffer table");
                goto err;
475 476 477 478
            }

            /* If we've got too many, that implies a descriptor loop. */
            if (num_bufs >= max) {
479 480
                virtio_error(vdev, "Looped descriptor");
                goto err;
481 482 483
            }

            /* loop over the indirect descriptor table */
484 485 486 487
            len = address_space_cache_init(&indirect_desc_cache,
                                           vdev->dma_as,
                                           desc.addr, desc.len, false);
            desc_cache = &indirect_desc_cache;
488 489 490 491 492
            if (len < desc.len) {
                virtio_error(vdev, "Cannot map indirect buffer");
                goto err;
            }

493
            max = desc.len / sizeof(VRingDesc);
494
            num_bufs = i = 0;
495
            vring_desc_read(vdev, &desc, desc_cache, i);
496 497
        }

A
aliguori 已提交
498 499
        do {
            /* If we've got too many, that implies a descriptor loop. */
500
            if (++num_bufs > max) {
501 502
                virtio_error(vdev, "Looped descriptor");
                goto err;
A
aliguori 已提交
503
            }
A
aliguori 已提交
504

505 506
            if (desc.flags & VRING_DESC_F_WRITE) {
                in_total += desc.len;
A
aliguori 已提交
507
            } else {
508
                out_total += desc.len;
A
aliguori 已提交
509
            }
510 511 512
            if (in_total >= max_in_bytes && out_total >= max_out_bytes) {
                goto done;
            }
513

514
            rc = virtqueue_read_next_desc(vdev, &desc, desc_cache, max, &i);
515 516 517 518 519
        } while (rc == VIRTQUEUE_READ_DESC_MORE);

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

521 522
        if (desc_cache == &indirect_desc_cache) {
            address_space_cache_destroy(&indirect_desc_cache);
523
            total_bufs++;
524 525 526
        } else {
            total_bufs = num_bufs;
        }
A
aliguori 已提交
527
    }
528 529 530 531 532

    if (rc < 0) {
        goto err;
    }

533
done:
534 535
    address_space_cache_destroy(&indirect_desc_cache);
    address_space_cache_destroy(&vring_desc_cache);
536 537 538 539 540 541
    if (in_bytes) {
        *in_bytes = in_total;
    }
    if (out_bytes) {
        *out_bytes = out_total;
    }
542 543 544 545 546
    return;

err:
    in_total = out_total = 0;
    goto done;
547
}
A
aliguori 已提交
548

549 550 551 552 553
int virtqueue_avail_bytes(VirtQueue *vq, unsigned int in_bytes,
                          unsigned int out_bytes)
{
    unsigned int in_total, out_total;

554 555
    virtqueue_get_avail_bytes(vq, &in_total, &out_total, in_bytes, out_bytes);
    return in_bytes <= in_total && out_bytes <= out_total;
A
aliguori 已提交
556 557
}

558 559
static bool virtqueue_map_desc(VirtIODevice *vdev, unsigned int *p_num_sg,
                               hwaddr *addr, struct iovec *iov,
560 561 562
                               unsigned int max_num_sg, bool is_write,
                               hwaddr pa, size_t sz)
{
563
    bool ok = false;
564 565 566
    unsigned num_sg = *p_num_sg;
    assert(num_sg <= max_num_sg);

567
    if (!sz) {
568 569
        virtio_error(vdev, "virtio: zero sized buffers are not allowed");
        goto out;
570 571
    }

572 573 574 575
    while (sz) {
        hwaddr len = sz;

        if (num_sg == max_num_sg) {
576 577 578
            virtio_error(vdev, "virtio: too many write descriptors in "
                               "indirect table");
            goto out;
579 580
        }

J
Jason Wang 已提交
581 582 583 584
        iov[num_sg].iov_base = dma_memory_map(vdev->dma_as, pa, &len,
                                              is_write ?
                                              DMA_DIRECTION_FROM_DEVICE :
                                              DMA_DIRECTION_TO_DEVICE);
585
        if (!iov[num_sg].iov_base) {
586 587
            virtio_error(vdev, "virtio: bogus descriptor or out of resources");
            goto out;
588 589
        }

590 591 592 593 594 595 596
        iov[num_sg].iov_len = len;
        addr[num_sg] = pa;

        sz -= len;
        pa += len;
        num_sg++;
    }
597 598 599
    ok = true;

out:
600
    *p_num_sg = num_sg;
601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618
    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++;
    }
619 620
}

J
Jason Wang 已提交
621 622
static void virtqueue_map_iovec(VirtIODevice *vdev, struct iovec *sg,
                                hwaddr *addr, unsigned int *num_sg,
623
                                int is_write)
K
Kevin Wolf 已提交
624 625
{
    unsigned int i;
A
Avi Kivity 已提交
626
    hwaddr len;
K
Kevin Wolf 已提交
627

M
Michael S. Tsirkin 已提交
628
    for (i = 0; i < *num_sg; i++) {
K
Kevin Wolf 已提交
629
        len = sg[i].iov_len;
J
Jason Wang 已提交
630 631 632 633
        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 已提交
634
        if (!sg[i].iov_base) {
M
Michael Tokarev 已提交
635
            error_report("virtio: error trying to map MMIO memory");
K
Kevin Wolf 已提交
636 637
            exit(1);
        }
638 639
        if (len != sg[i].iov_len) {
            error_report("virtio: unexpected memory split");
M
Michael S. Tsirkin 已提交
640 641
            exit(1);
        }
K
Kevin Wolf 已提交
642 643 644
    }
}

J
Jason Wang 已提交
645
void virtqueue_map(VirtIODevice *vdev, VirtQueueElement *elem)
M
Michael S. Tsirkin 已提交
646
{
647 648
    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);
649 650
}

651
static void *virtqueue_alloc_element(size_t sz, unsigned out_num, unsigned in_num)
652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669
{
    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 已提交
670 671
}

672
void *virtqueue_pop(VirtQueue *vq, size_t sz)
A
aliguori 已提交
673
{
674
    unsigned int i, head, max;
675 676 677 678
    MemoryRegionCache vring_desc_cache;
    MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
    MemoryRegionCache *desc_cache;
    int64_t len;
679
    VirtIODevice *vdev = vq->vdev;
680
    VirtQueueElement *elem = NULL;
681 682 683
    unsigned out_num, in_num;
    hwaddr addr[VIRTQUEUE_MAX_SIZE];
    struct iovec iov[VIRTQUEUE_MAX_SIZE];
684
    VRingDesc desc;
685
    int rc;
A
aliguori 已提交
686

687 688 689
    if (unlikely(vdev->broken)) {
        return NULL;
    }
690
    if (virtio_queue_empty(vq)) {
691 692
        return NULL;
    }
693 694 695
    /* Needed after virtio_queue_empty(), see comment in
     * virtqueue_num_heads(). */
    smp_rmb();
A
aliguori 已提交
696 697

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

700 701
    max = vq->vring.num;

702
    if (vq->inuse >= vq->vring.num) {
703 704
        virtio_error(vdev, "Virtqueue size exceeded");
        return NULL;
705 706
    }

707 708 709 710
    if (!virtqueue_get_head(vq, vq->last_avail_idx++, &head)) {
        return NULL;
    }

711
    if (virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
712
        vring_set_avail_event(vq, vq->last_avail_idx);
M
Michael S. Tsirkin 已提交
713
    }
714

715
    i = head;
716

717 718 719
    len = address_space_cache_init(&vring_desc_cache, vdev->dma_as,
                                   vq->vring.desc, max * sizeof(VRingDesc),
                                   false);
720 721 722 723 724
    if (len < max * sizeof(VRingDesc)) {
        virtio_error(vdev, "Cannot map descriptor ring");
        goto done;
    }

725 726
    desc_cache = &vring_desc_cache;
    vring_desc_read(vdev, &desc, desc_cache, i);
727 728
    if (desc.flags & VRING_DESC_F_INDIRECT) {
        if (desc.len % sizeof(VRingDesc)) {
729
            virtio_error(vdev, "Invalid size for indirect buffer table");
730
            goto done;
731 732 733
        }

        /* loop over the indirect descriptor table */
734 735 736
        len = address_space_cache_init(&indirect_desc_cache, vdev->dma_as,
                                       desc.addr, desc.len, false);
        desc_cache = &indirect_desc_cache;
737 738 739 740 741
        if (len < desc.len) {
            virtio_error(vdev, "Cannot map indirect buffer");
            goto done;
        }

742
        max = desc.len / sizeof(VRingDesc);
743
        i = 0;
744
        vring_desc_read(vdev, &desc, desc_cache, i);
745 746
    }

K
Kevin Wolf 已提交
747
    /* Collect all the descriptors */
A
aliguori 已提交
748
    do {
749 750
        bool map_ok;

751
        if (desc.flags & VRING_DESC_F_WRITE) {
752 753 754 755
            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 已提交
756
        } else {
757
            if (in_num) {
758 759
                virtio_error(vdev, "Incorrect order for descriptors");
                goto err_undo_map;
760
            }
761 762 763 764 765 766
            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 已提交
767
        }
A
aliguori 已提交
768 769

        /* If we've got too many, that implies a descriptor loop. */
770
        if ((in_num + out_num) > max) {
771 772
            virtio_error(vdev, "Looped descriptor");
            goto err_undo_map;
A
aliguori 已提交
773
        }
774

775
        rc = virtqueue_read_next_desc(vdev, &desc, desc_cache, max, &i);
776 777 778 779 780
    } while (rc == VIRTQUEUE_READ_DESC_MORE);

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

782 783
    /* Now copy what we have collected and mapped */
    elem = virtqueue_alloc_element(sz, out_num, in_num);
A
aliguori 已提交
784
    elem->index = head;
785 786 787 788 789 790 791 792
    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 已提交
793 794 795

    vq->inuse++;

796
    trace_virtqueue_pop(vq, elem, elem->in_num, elem->out_num);
797
done:
798 799
    address_space_cache_destroy(&indirect_desc_cache);
    address_space_cache_destroy(&vring_desc_cache);
800

801
    return elem;
802 803 804

err_undo_map:
    virtqueue_undo_map_desc(out_num, in_num, iov);
805
    goto done;
A
aliguori 已提交
806 807
}

808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845
/* 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;
}

846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862
/* 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 已提交
863
void *qemu_get_virtqueue_element(VirtIODevice *vdev, QEMUFile *f, size_t sz)
864
{
865 866 867 868 869 870
    VirtQueueElement *elem;
    VirtQueueElementOld data;
    int i;

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

871 872 873 874 875 876 877 878 879 880
    /* 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);

881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903
    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 已提交
904
    virtqueue_map(vdev, elem);
905 906 907 908 909
    return elem;
}

void qemu_put_virtqueue_element(QEMUFile *f, VirtQueueElement *elem)
{
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
    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));
937 938
}

A
aliguori 已提交
939
/* virtio device */
940 941
static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
{
K
KONRAD Frederic 已提交
942 943 944
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

945 946 947 948
    if (unlikely(vdev->broken)) {
        return;
    }

K
KONRAD Frederic 已提交
949 950
    if (k->notify) {
        k->notify(qbus->parent, vector);
951 952
    }
}
A
aliguori 已提交
953

P
Paul Brook 已提交
954
void virtio_update_irq(VirtIODevice *vdev)
A
aliguori 已提交
955
{
956
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
A
aliguori 已提交
957 958
}

959 960 961 962
static int virtio_validate_features(VirtIODevice *vdev)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);

J
Jason Wang 已提交
963 964 965 966 967
    if (virtio_host_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM) &&
        !virtio_vdev_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM)) {
        return -EFAULT;
    }

968 969 970 971 972 973 974 975
    if (k->validate_features) {
        return k->validate_features(vdev);
    } else {
        return 0;
    }
}

int virtio_set_status(VirtIODevice *vdev, uint8_t val)
976
{
977
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
978 979
    trace_virtio_set_status(vdev, val);

980
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
981 982 983 984 985 986 987 988 989
        if (!(vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) &&
            val & VIRTIO_CONFIG_S_FEATURES_OK) {
            int ret = virtio_validate_features(vdev);

            if (ret) {
                return ret;
            }
        }
    }
990 991
    if (k->set_status) {
        k->set_status(vdev, val);
992 993
    }
    vdev->status = val;
994
    return 0;
995 996
}

997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017
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 已提交
1018
void virtio_reset(void *opaque)
A
aliguori 已提交
1019 1020
{
    VirtIODevice *vdev = opaque;
1021
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1022 1023
    int i;

1024
    virtio_set_status(vdev, 0);
1025 1026 1027 1028 1029 1030 1031
    if (current_cpu) {
        /* Guest initiated reset */
        vdev->device_endian = virtio_current_cpu_endian();
    } else {
        /* System reset */
        vdev->device_endian = virtio_default_endian();
    }
1032

1033 1034 1035
    if (k->reset) {
        k->reset(vdev);
    }
A
aliguori 已提交
1036

1037
    vdev->broken = false;
1038
    vdev->guest_features = 0;
A
aliguori 已提交
1039 1040
    vdev->queue_sel = 0;
    vdev->status = 0;
P
Paolo Bonzini 已提交
1041
    atomic_set(&vdev->isr, 0);
1042 1043
    vdev->config_vector = VIRTIO_NO_VECTOR;
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1044

1045
    for(i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1046 1047 1048 1049
        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;
1050
        vdev->vq[i].shadow_avail_idx = 0;
1051
        vdev->vq[i].used_idx = 0;
1052
        virtio_queue_set_vector(vdev, i, VIRTIO_NO_VECTOR);
M
Michael S. Tsirkin 已提交
1053 1054
        vdev->vq[i].signalled_used = 0;
        vdev->vq[i].signalled_used_valid = false;
1055
        vdev->vq[i].notification = true;
C
Cornelia Huck 已提交
1056
        vdev->vq[i].vring.num = vdev->vq[i].vring.num_default;
1057
        vdev->vq[i].inuse = 0;
A
aliguori 已提交
1058 1059 1060
    }
}

P
Paul Brook 已提交
1061
uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1062
{
1063
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1064 1065
    uint8_t val;

1066
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1067
        return (uint32_t)-1;
1068 1069 1070
    }

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

1072
    val = ldub_p(vdev->config + addr);
A
aliguori 已提交
1073 1074 1075
    return val;
}

P
Paul Brook 已提交
1076
uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1077
{
1078
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1079 1080
    uint16_t val;

1081
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1082
        return (uint32_t)-1;
1083 1084 1085
    }

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

1087
    val = lduw_p(vdev->config + addr);
A
aliguori 已提交
1088 1089 1090
    return val;
}

P
Paul Brook 已提交
1091
uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1092
{
1093
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1094 1095
    uint32_t val;

1096
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1097
        return (uint32_t)-1;
1098 1099 1100
    }

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

1102
    val = ldl_p(vdev->config + addr);
A
aliguori 已提交
1103 1104 1105
    return val;
}

P
Paul Brook 已提交
1106
void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1107
{
1108
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1109 1110
    uint8_t val = data;

1111
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1112
        return;
1113
    }
A
aliguori 已提交
1114

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

1117 1118 1119
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1120 1121
}

P
Paul Brook 已提交
1122
void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1123
{
1124
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1125 1126
    uint16_t val = data;

1127
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1128
        return;
1129
    }
A
aliguori 已提交
1130

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

1133 1134 1135
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1136 1137
}

P
Paul Brook 已提交
1138
void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1139
{
1140
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1141 1142
    uint32_t val = data;

1143
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1144
        return;
1145
    }
A
aliguori 已提交
1146

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

1149 1150 1151
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1152 1153
}

1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 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
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 已提交
1250
void virtio_queue_set_addr(VirtIODevice *vdev, int n, hwaddr addr)
A
aliguori 已提交
1251
{
1252 1253
    vdev->vq[n].vring.desc = addr;
    virtio_queue_update_rings(vdev, n);
P
Paul Brook 已提交
1254 1255
}

A
Avi Kivity 已提交
1256
hwaddr virtio_queue_get_addr(VirtIODevice *vdev, int n)
P
Paul Brook 已提交
1257
{
1258 1259 1260 1261 1262 1263 1264 1265 1266
    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;
P
Paul Brook 已提交
1267 1268
}

1269 1270
void virtio_queue_set_num(VirtIODevice *vdev, int n, int num)
{
1271 1272 1273 1274 1275 1276 1277
    /* 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;
1278
    }
1279
    vdev->vq[n].vring.num = num;
1280 1281
}

1282 1283 1284 1285 1286 1287 1288 1289 1290 1291
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 已提交
1292 1293 1294 1295
int virtio_queue_get_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num;
}
A
aliguori 已提交
1296

M
Michael S. Tsirkin 已提交
1297 1298 1299 1300 1301
int virtio_queue_get_max_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num_default;
}

1302 1303 1304 1305
int virtio_get_num_queues(VirtIODevice *vdev)
{
    int i;

1306
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1307 1308 1309 1310 1311 1312 1313 1314
        if (!virtio_queue_get_num(vdev, i)) {
            break;
        }
    }

    return i;
}

1315 1316 1317 1318 1319
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);

1320
    /* virtio-1 compliant devices cannot change the alignment */
1321
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1322 1323 1324
        error_report("tried to modify queue alignment for virtio-1 device");
        return;
    }
1325 1326 1327 1328 1329 1330 1331
    /* 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;
1332
    virtio_queue_update_rings(vdev, n);
1333 1334
}

1335
static bool virtio_queue_notify_aio_vq(VirtQueue *vq)
M
Michael S. Tsirkin 已提交
1336 1337 1338 1339 1340
{
    if (vq->vring.desc && vq->handle_aio_output) {
        VirtIODevice *vdev = vq->vdev;

        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
1341
        return vq->handle_aio_output(vdev, vq);
M
Michael S. Tsirkin 已提交
1342
    }
1343 1344

    return false;
M
Michael S. Tsirkin 已提交
1345 1346
}

1347
static void virtio_queue_notify_vq(VirtQueue *vq)
1348
{
1349
    if (vq->vring.desc && vq->handle_output) {
1350
        VirtIODevice *vdev = vq->vdev;
1351

1352 1353 1354 1355
        if (unlikely(vdev->broken)) {
            return;
        }

1356 1357 1358 1359 1360
        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
        vq->handle_output(vdev, vq);
    }
}

P
Paul Brook 已提交
1361 1362
void virtio_queue_notify(VirtIODevice *vdev, int n)
{
1363
    virtio_queue_notify_vq(&vdev->vq[n]);
A
aliguori 已提交
1364 1365
}

1366 1367
uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
{
1368
    return n < VIRTIO_QUEUE_MAX ? vdev->vq[n].vector :
1369 1370 1371 1372 1373
        VIRTIO_NO_VECTOR;
}

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

1376
    if (n < VIRTIO_QUEUE_MAX) {
1377 1378 1379 1380
        if (vdev->vector_queues &&
            vdev->vq[n].vector != VIRTIO_NO_VECTOR) {
            QLIST_REMOVE(vq, node);
        }
1381
        vdev->vq[n].vector = vector;
1382 1383 1384 1385 1386
        if (vdev->vector_queues &&
            vector != VIRTIO_NO_VECTOR) {
            QLIST_INSERT_HEAD(&vdev->vector_queues[vector], vq, node);
        }
    }
1387 1388
}

1389 1390
VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
                            VirtIOHandleOutput handle_output)
A
aliguori 已提交
1391 1392 1393
{
    int i;

1394
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1395 1396 1397 1398
        if (vdev->vq[i].vring.num == 0)
            break;
    }

1399
    if (i == VIRTIO_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
A
aliguori 已提交
1400 1401 1402
        abort();

    vdev->vq[i].vring.num = queue_size;
C
Cornelia Huck 已提交
1403
    vdev->vq[i].vring.num_default = queue_size;
1404
    vdev->vq[i].vring.align = VIRTIO_PCI_VRING_ALIGN;
A
aliguori 已提交
1405
    vdev->vq[i].handle_output = handle_output;
M
Michael S. Tsirkin 已提交
1406
    vdev->vq[i].handle_aio_output = NULL;
A
aliguori 已提交
1407 1408 1409 1410

    return &vdev->vq[i];
}

1411 1412
void virtio_del_queue(VirtIODevice *vdev, int n)
{
1413
    if (n < 0 || n >= VIRTIO_QUEUE_MAX) {
1414 1415 1416 1417
        abort();
    }

    vdev->vq[n].vring.num = 0;
C
Cornelia Huck 已提交
1418
    vdev->vq[n].vring.num_default = 0;
1419 1420
}

P
Paolo Bonzini 已提交
1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432
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);
    }
}

1433
static bool virtio_should_notify(VirtIODevice *vdev, VirtQueue *vq)
M
Michael S. Tsirkin 已提交
1434 1435 1436
{
    uint16_t old, new;
    bool v;
1437 1438
    /* We need to expose used array entries before checking used event. */
    smp_mb();
1439
    /* Always notify when queue is empty (when feature acknowledge) */
1440
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_NOTIFY_ON_EMPTY) &&
1441
        !vq->inuse && virtio_queue_empty(vq)) {
M
Michael S. Tsirkin 已提交
1442 1443 1444
        return true;
    }

1445
    if (!virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
M
Michael S. Tsirkin 已提交
1446 1447 1448 1449 1450 1451
        return !(vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT);
    }

    v = vq->signalled_used_valid;
    vq->signalled_used_valid = true;
    old = vq->signalled_used;
1452
    new = vq->signalled_used = vq->used_idx;
1453
    return !v || vring_need_event(vring_get_used_event(vq), new, old);
M
Michael S. Tsirkin 已提交
1454 1455
}

1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482
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 已提交
1483 1484
void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
{
1485
    if (!virtio_should_notify(vdev, vq)) {
A
aliguori 已提交
1486
        return;
M
Michael S. Tsirkin 已提交
1487
    }
A
aliguori 已提交
1488

1489
    trace_virtio_notify(vdev, vq);
P
Paolo Bonzini 已提交
1490
    virtio_set_isr(vq->vdev, 0x1);
1491
    virtio_notify_vector(vdev, vq->vector);
A
aliguori 已提交
1492 1493 1494 1495
}

void virtio_notify_config(VirtIODevice *vdev)
{
1496 1497 1498
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
        return;

P
Paolo Bonzini 已提交
1499
    virtio_set_isr(vdev, 0x3);
1500
    vdev->generation++;
1501
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1502 1503
}

1504 1505 1506 1507 1508
static bool virtio_device_endian_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    assert(vdev->device_endian != VIRTIO_DEVICE_ENDIAN_UNKNOWN);
1509
    if (!virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1510 1511 1512 1513
        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;
1514 1515
}

G
Gerd Hoffmann 已提交
1516 1517 1518 1519 1520 1521 1522
static bool virtio_64bit_features_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

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

J
Jason Wang 已提交
1523 1524 1525 1526 1527 1528 1529
static bool virtio_virtqueue_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return virtio_host_has_feature(vdev, VIRTIO_F_VERSION_1);
}

C
Cornelia Huck 已提交
1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542
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;
}

1543 1544 1545 1546 1547 1548 1549 1550 1551 1552
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);
}

1553 1554 1555 1556 1557 1558 1559
static bool virtio_broken_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return vdev->broken;
}

1560
static const VMStateDescription vmstate_virtqueue = {
J
Jason Wang 已提交
1561
    .name = "virtqueue_state",
1562 1563 1564 1565 1566 1567 1568
    .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 已提交
1569 1570 1571 1572 1573 1574 1575 1576
};

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 已提交
1577 1578
        VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
                      VIRTIO_QUEUE_MAX, 0, vmstate_virtqueue, VirtQueue),
J
Jason Wang 已提交
1579 1580 1581 1582
        VMSTATE_END_OF_LIST()
    }
};

1583
static const VMStateDescription vmstate_ringsize = {
C
Cornelia Huck 已提交
1584
    .name = "ringsize_state",
1585 1586 1587 1588 1589 1590
    .version_id = 1,
    .minimum_version_id = 1,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(vring.num_default, struct VirtQueue),
        VMSTATE_END_OF_LIST()
    }
C
Cornelia Huck 已提交
1591 1592 1593 1594 1595 1596 1597 1598
};

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 已提交
1599 1600
        VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
                      VIRTIO_QUEUE_MAX, 0, vmstate_ringsize, VirtQueue),
C
Cornelia Huck 已提交
1601 1602 1603 1604
        VMSTATE_END_OF_LIST()
    }
};

J
Jianjun Duan 已提交
1605 1606
static int get_extra_state(QEMUFile *f, void *pv, size_t size,
                           VMStateField *field)
1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618
{
    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 已提交
1619 1620
static int put_extra_state(QEMUFile *f, void *pv, size_t size,
                           VMStateField *field, QJSON *vmdesc)
1621 1622 1623 1624 1625 1626
{
    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 已提交
1627
    return 0;
1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654
}

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

1655 1656 1657 1658
static const VMStateDescription vmstate_virtio_device_endian = {
    .name = "virtio/device_endian",
    .version_id = 1,
    .minimum_version_id = 1,
1659
    .needed = &virtio_device_endian_needed,
1660 1661 1662 1663 1664 1665
    .fields = (VMStateField[]) {
        VMSTATE_UINT8(device_endian, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

G
Gerd Hoffmann 已提交
1666 1667 1668 1669
static const VMStateDescription vmstate_virtio_64bit_features = {
    .name = "virtio/64bit_features",
    .version_id = 1,
    .minimum_version_id = 1,
1670
    .needed = &virtio_64bit_features_needed,
G
Gerd Hoffmann 已提交
1671 1672 1673 1674 1675 1676
    .fields = (VMStateField[]) {
        VMSTATE_UINT64(guest_features, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687
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()
    }
};

1688 1689 1690 1691 1692 1693 1694
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()
1695
    },
1696 1697 1698
    .subsections = (const VMStateDescription*[]) {
        &vmstate_virtio_device_endian,
        &vmstate_virtio_64bit_features,
J
Jason Wang 已提交
1699
        &vmstate_virtio_virtqueues,
C
Cornelia Huck 已提交
1700
        &vmstate_virtio_ringsize,
1701
        &vmstate_virtio_broken,
1702
        &vmstate_virtio_extra_state,
1703
        NULL
1704 1705 1706
    }
};

A
aliguori 已提交
1707 1708
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
{
K
KONRAD Frederic 已提交
1709 1710
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1711
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
G
Gerd Hoffmann 已提交
1712
    uint32_t guest_features_lo = (vdev->guest_features & 0xffffffff);
A
aliguori 已提交
1713 1714
    int i;

K
KONRAD Frederic 已提交
1715 1716 1717
    if (k->save_config) {
        k->save_config(qbus->parent, f);
    }
A
aliguori 已提交
1718 1719 1720 1721

    qemu_put_8s(f, &vdev->status);
    qemu_put_8s(f, &vdev->isr);
    qemu_put_be16s(f, &vdev->queue_sel);
G
Gerd Hoffmann 已提交
1722
    qemu_put_be32s(f, &guest_features_lo);
A
aliguori 已提交
1723 1724 1725
    qemu_put_be32(f, vdev->config_len);
    qemu_put_buffer(f, vdev->config, vdev->config_len);

1726
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1727 1728 1729 1730 1731 1732
        if (vdev->vq[i].vring.num == 0)
            break;
    }

    qemu_put_be32(f, i);

1733
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1734 1735 1736 1737
        if (vdev->vq[i].vring.num == 0)
            break;

        qemu_put_be32(f, vdev->vq[i].vring.num);
1738 1739 1740
        if (k->has_variable_vring_alignment) {
            qemu_put_be32(f, vdev->vq[i].vring.align);
        }
1741 1742
        /* XXX virtio-1 devices */
        qemu_put_be64(f, vdev->vq[i].vring.desc);
A
aliguori 已提交
1743
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
K
KONRAD Frederic 已提交
1744 1745 1746
        if (k->save_queue) {
            k->save_queue(qbus->parent, i, f);
        }
A
aliguori 已提交
1747
    }
1748 1749 1750 1751

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

1753 1754 1755 1756
    if (vdc->vmsd) {
        vmstate_save_state(f, vdc->vmsd, vdev, NULL);
    }

1757
    /* Subsections */
1758
    vmstate_save_state(f, &vmstate_virtio, vdev, NULL);
A
aliguori 已提交
1759 1760
}

1761
/* A wrapper for use as a VMState .put function */
J
Jianjun Duan 已提交
1762 1763
static int virtio_device_put(QEMUFile *f, void *opaque, size_t size,
                              VMStateField *field, QJSON *vmdesc)
1764 1765
{
    virtio_save(VIRTIO_DEVICE(opaque), f);
J
Jianjun Duan 已提交
1766 1767

    return 0;
1768 1769 1770
}

/* A wrapper for use as a VMState .get function */
J
Jianjun Duan 已提交
1771 1772
static int virtio_device_get(QEMUFile *f, void *opaque, size_t size,
                             VMStateField *field)
1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785
{
    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,
};

1786
static int virtio_set_features_nocheck(VirtIODevice *vdev, uint64_t val)
1787
{
1788
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
C
Cornelia Huck 已提交
1789
    bool bad = (val & ~(vdev->host_features)) != 0;
1790

C
Cornelia Huck 已提交
1791
    val &= vdev->host_features;
1792 1793
    if (k->set_features) {
        k->set_features(vdev, val);
1794 1795 1796 1797 1798
    }
    vdev->guest_features = val;
    return bad ? -1 : 0;
}

1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810
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);
}

1811
int virtio_load(VirtIODevice *vdev, QEMUFile *f, int version_id)
A
aliguori 已提交
1812
{
1813
    int i, ret;
1814
    int32_t config_len;
1815
    uint32_t num;
1816
    uint32_t features;
K
KONRAD Frederic 已提交
1817 1818
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1819
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1820

1821 1822 1823 1824 1825 1826
    /*
     * 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 已提交
1827 1828
    if (k->load_config) {
        ret = k->load_config(qbus->parent, f);
1829 1830 1831
        if (ret)
            return ret;
    }
A
aliguori 已提交
1832 1833 1834 1835

    qemu_get_8s(f, &vdev->status);
    qemu_get_8s(f, &vdev->isr);
    qemu_get_be16s(f, &vdev->queue_sel);
1836
    if (vdev->queue_sel >= VIRTIO_QUEUE_MAX) {
1837 1838
        return -1;
    }
1839
    qemu_get_be32s(f, &features);
1840

1841 1842 1843 1844 1845 1846 1847 1848 1849 1850
    /*
     * 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;

1851
    config_len = qemu_get_be32(f);
1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862

    /*
     * 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--;
1863
    }
A
aliguori 已提交
1864 1865 1866

    num = qemu_get_be32(f);

1867
    if (num > VIRTIO_QUEUE_MAX) {
1868
        error_report("Invalid number of virtqueues: 0x%x", num);
1869 1870 1871
        return -1;
    }

A
aliguori 已提交
1872 1873
    for (i = 0; i < num; i++) {
        vdev->vq[i].vring.num = qemu_get_be32(f);
1874 1875 1876
        if (k->has_variable_vring_alignment) {
            vdev->vq[i].vring.align = qemu_get_be32(f);
        }
1877
        vdev->vq[i].vring.desc = qemu_get_be64(f);
A
aliguori 已提交
1878
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
M
Michael S. Tsirkin 已提交
1879
        vdev->vq[i].signalled_used_valid = false;
1880
        vdev->vq[i].notification = true;
A
aliguori 已提交
1881

1882 1883 1884
        if (vdev->vq[i].vring.desc) {
            /* XXX virtio-1 devices */
            virtio_queue_update_rings(vdev, i);
M
Michael S. Tsirkin 已提交
1885 1886
        } else if (vdev->vq[i].last_avail_idx) {
            error_report("VQ %d address 0x0 "
1887
                         "inconsistent with Host index 0x%x",
M
Michael S. Tsirkin 已提交
1888 1889
                         i, vdev->vq[i].last_avail_idx);
                return -1;
1890
        }
K
KONRAD Frederic 已提交
1891 1892
        if (k->load_queue) {
            ret = k->load_queue(qbus->parent, i, f);
1893 1894
            if (ret)
                return ret;
1895
        }
A
aliguori 已提交
1896 1897
    }

1898
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
1899 1900

    if (vdc->load != NULL) {
1901 1902 1903 1904
        ret = vdc->load(vdev, f, version_id);
        if (ret) {
            return ret;
        }
1905 1906
    }

1907 1908 1909 1910 1911 1912 1913
    if (vdc->vmsd) {
        ret = vmstate_load_state(f, vdc->vmsd, vdev, version_id);
        if (ret) {
            return ret;
        }
    }

1914 1915 1916 1917 1918 1919 1920 1921 1922 1923
    /* 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 已提交
1924 1925 1926 1927 1928 1929 1930
    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;
1931
        if (virtio_set_features_nocheck(vdev, features64) < 0) {
G
Gerd Hoffmann 已提交
1932 1933 1934 1935 1936 1937
            error_report("Features 0x%" PRIx64 " unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features64, vdev->host_features);
            return -1;
        }
    } else {
1938
        if (virtio_set_features_nocheck(vdev, features) < 0) {
G
Gerd Hoffmann 已提交
1939 1940 1941 1942 1943 1944 1945
            error_report("Features 0x%x unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features, vdev->host_features);
            return -1;
        }
    }

1946
    for (i = 0; i < num; i++) {
1947
        if (vdev->vq[i].vring.desc) {
1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958
            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;
            }
1959
            vdev->vq[i].used_idx = vring_used_idx(&vdev->vq[i]);
1960
            vdev->vq[i].shadow_avail_idx = vring_avail_idx(&vdev->vq[i]);
1961 1962 1963 1964

            /*
             * Some devices migrate VirtQueueElements that have been popped
             * from the avail ring but not yet returned to the used ring.
1965 1966
             * Since max ring size < UINT16_MAX it's safe to use modulo
             * UINT16_MAX + 1 subtraction.
1967
             */
1968 1969
            vdev->vq[i].inuse = (uint16_t)(vdev->vq[i].last_avail_idx -
                                vdev->vq[i].used_idx);
1970 1971 1972 1973 1974 1975 1976 1977
            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;
            }
1978 1979 1980 1981
        }
    }

    return 0;
A
aliguori 已提交
1982 1983
}

1984
void virtio_cleanup(VirtIODevice *vdev)
1985
{
1986
    qemu_del_vm_change_state_handler(vdev->vmstate);
1987
    g_free(vdev->config);
1988
    g_free(vdev->vq);
1989
    g_free(vdev->vector_queues);
1990 1991
}

1992
static void virtio_vmstate_change(void *opaque, int running, RunState state)
1993 1994
{
    VirtIODevice *vdev = opaque;
K
KONRAD Frederic 已提交
1995 1996
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1997
    bool backend_run = running && (vdev->status & VIRTIO_CONFIG_S_DRIVER_OK);
1998
    vdev->vm_running = running;
1999 2000 2001 2002 2003

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

K
KONRAD Frederic 已提交
2004 2005
    if (k->vmstate_change) {
        k->vmstate_change(qbus->parent, backend_run);
2006 2007 2008 2009 2010 2011 2012
    }

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

2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023
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);
}

2024 2025
void virtio_init(VirtIODevice *vdev, const char *name,
                 uint16_t device_id, size_t config_size)
A
aliguori 已提交
2026
{
2027 2028
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
2029
    int i;
2030 2031 2032 2033 2034 2035 2036
    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 已提交
2037
    vdev->device_id = device_id;
A
aliguori 已提交
2038
    vdev->status = 0;
P
Paolo Bonzini 已提交
2039
    atomic_set(&vdev->isr, 0);
A
aliguori 已提交
2040
    vdev->queue_sel = 0;
2041
    vdev->config_vector = VIRTIO_NO_VECTOR;
2042
    vdev->vq = g_malloc0(sizeof(VirtQueue) * VIRTIO_QUEUE_MAX);
2043
    vdev->vm_running = runstate_is_running();
2044
    vdev->broken = false;
2045
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
2046
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
2047
        vdev->vq[i].vdev = vdev;
2048
        vdev->vq[i].queue_index = i;
2049
    }
A
aliguori 已提交
2050 2051 2052

    vdev->name = name;
    vdev->config_len = config_size;
2053
    if (vdev->config_len) {
2054
        vdev->config = g_malloc0(config_size);
2055
    } else {
A
aliguori 已提交
2056
        vdev->config = NULL;
2057 2058 2059
    }
    vdev->vmstate = qemu_add_vm_change_state_handler(virtio_vmstate_change,
                                                     vdev);
2060
    vdev->device_endian = virtio_default_endian();
2061
    vdev->use_guest_notifier_mask = true;
2062
}
A
aliguori 已提交
2063

A
Avi Kivity 已提交
2064
hwaddr virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
2065 2066 2067 2068
{
    return vdev->vq[n].vring.desc;
}

A
Avi Kivity 已提交
2069
hwaddr virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
2070 2071 2072 2073
{
    return vdev->vq[n].vring.avail;
}

A
Avi Kivity 已提交
2074
hwaddr virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
2075 2076 2077 2078
{
    return vdev->vq[n].vring.used;
}

A
Avi Kivity 已提交
2079
hwaddr virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
2080 2081 2082 2083
{
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
}

A
Avi Kivity 已提交
2084
hwaddr virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
2085 2086
{
    return offsetof(VRingAvail, ring) +
2087
        sizeof(uint16_t) * vdev->vq[n].vring.num;
2088 2089
}

A
Avi Kivity 已提交
2090
hwaddr virtio_queue_get_used_size(VirtIODevice *vdev, int n)
2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103
{
    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;
2104
    vdev->vq[n].shadow_avail_idx = idx;
2105 2106
}

2107 2108 2109 2110 2111
void virtio_queue_update_used_idx(VirtIODevice *vdev, int n)
{
    vdev->vq[n].used_idx = vring_used_idx(&vdev->vq[n]);
}

2112 2113 2114 2115 2116
void virtio_queue_invalidate_signalled_used(VirtIODevice *vdev, int n)
{
    vdev->vq[n].signalled_used_valid = false;
}

2117 2118 2119 2120 2121
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
{
    return vdev->vq + n;
}

2122 2123 2124 2125 2126
uint16_t virtio_get_queue_index(VirtQueue *vq)
{
    return vq->queue_index;
}

2127 2128 2129 2130
static void virtio_queue_guest_notifier_read(EventNotifier *n)
{
    VirtQueue *vq = container_of(n, VirtQueue, guest_notifier);
    if (event_notifier_test_and_clear(n)) {
2131
        virtio_notify_vector(vq->vdev, vq->vector);
2132 2133 2134 2135 2136 2137 2138
    }
}

void virtio_queue_set_guest_notifier_fd_handler(VirtQueue *vq, bool assign,
                                                bool with_irqfd)
{
    if (assign && !with_irqfd) {
2139
        event_notifier_set_handler(&vq->guest_notifier,
2140 2141
                                   virtio_queue_guest_notifier_read);
    } else {
2142
        event_notifier_set_handler(&vq->guest_notifier, NULL);
2143 2144 2145 2146 2147 2148 2149 2150
    }
    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);
    }
}

2151 2152 2153 2154
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
{
    return &vq->guest_notifier;
}
2155

M
Michael S. Tsirkin 已提交
2156
static void virtio_queue_host_notifier_aio_read(EventNotifier *n)
2157 2158 2159
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
M
Michael S. Tsirkin 已提交
2160
        virtio_queue_notify_aio_vq(vq);
2161 2162 2163
    }
}

2164 2165 2166 2167 2168 2169 2170
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);
}

2171 2172 2173 2174
static bool virtio_queue_host_notifier_aio_poll(void *opaque)
{
    EventNotifier *n = opaque;
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
2175
    bool progress;
2176 2177 2178 2179 2180

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

2181
    progress = virtio_queue_notify_aio_vq(vq);
2182 2183 2184

    /* In case the handler function re-enabled notifications */
    virtio_queue_set_notification(vq, 0);
2185
    return progress;
2186 2187
}

2188 2189 2190 2191 2192 2193 2194 2195
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);
}

2196
void virtio_queue_aio_set_host_notifier_handler(VirtQueue *vq, AioContext *ctx,
2197
                                                VirtIOHandleAIOOutput handle_output)
2198
{
2199 2200
    if (handle_output) {
        vq->handle_aio_output = handle_output;
2201
        aio_set_event_notifier(ctx, &vq->host_notifier, true,
2202 2203
                               virtio_queue_host_notifier_aio_read,
                               virtio_queue_host_notifier_aio_poll);
2204 2205 2206
        aio_set_event_notifier_poll(ctx, &vq->host_notifier,
                                    virtio_queue_host_notifier_aio_poll_begin,
                                    virtio_queue_host_notifier_aio_poll_end);
2207
    } else {
2208
        aio_set_event_notifier(ctx, &vq->host_notifier, true, NULL, NULL);
2209 2210
        /* Test and clear notifier before after disabling event,
         * in case poll callback didn't have time to run. */
M
Michael S. Tsirkin 已提交
2211
        virtio_queue_host_notifier_aio_read(&vq->host_notifier);
2212
        vq->handle_aio_output = NULL;
M
Michael S. Tsirkin 已提交
2213 2214 2215
    }
}

2216
void virtio_queue_host_notifier_read(EventNotifier *n)
M
Michael S. Tsirkin 已提交
2217 2218 2219 2220
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
        virtio_queue_notify_vq(vq);
2221 2222 2223
    }
}

2224 2225 2226 2227
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
{
    return &vq->host_notifier;
}
2228

2229 2230
void virtio_device_set_child_bus_name(VirtIODevice *vdev, char *bus_name)
{
2231
    g_free(vdev->bus_name);
2232
    vdev->bus_name = g_strdup(bus_name);
2233 2234
}

2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250
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);
    }
}

2251 2252 2253 2254 2255 2256
static void virtio_device_realize(DeviceState *dev, Error **errp)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;

2257 2258 2259
    /* Devices should either use vmsd or the load/save methods */
    assert(!vdc->vmsd || !vdc->load);

2260 2261 2262 2263 2264 2265
    if (vdc->realize != NULL) {
        vdc->realize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
2266
    }
J
Jason Wang 已提交
2267 2268 2269 2270 2271 2272

    virtio_bus_device_plugged(vdev, &err);
    if (err != NULL) {
        error_propagate(errp, err);
        return;
    }
2273 2274
}

2275
static void virtio_device_unrealize(DeviceState *dev, Error **errp)
2276
{
2277
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
2278 2279
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;
2280

2281 2282
    virtio_bus_device_unplugged(vdev);

2283 2284 2285 2286 2287 2288
    if (vdc->unrealize != NULL) {
        vdc->unrealize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
2289
    }
2290

2291 2292
    g_free(vdev->bus_name);
    vdev->bus_name = NULL;
2293 2294
}

C
Cornelia Huck 已提交
2295 2296 2297 2298 2299
static Property virtio_properties[] = {
    DEFINE_VIRTIO_COMMON_FEATURES(VirtIODevice, host_features),
    DEFINE_PROP_END_OF_LIST(),
};

2300 2301 2302 2303 2304 2305
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++) {
2306
        VirtQueue *vq = &vdev->vq[n];
2307 2308 2309
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }
2310
        r = virtio_bus_set_host_notifier(qbus, n, true);
2311 2312 2313 2314
        if (r < 0) {
            err = r;
            goto assign_error;
        }
2315
        event_notifier_set_handler(&vq->host_notifier,
2316
                                   virtio_queue_host_notifier_read);
2317 2318 2319 2320 2321 2322 2323 2324 2325
    }

    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);
2326 2327 2328 2329 2330
    }
    return 0;

assign_error:
    while (--n >= 0) {
2331
        VirtQueue *vq = &vdev->vq[n];
2332 2333 2334 2335
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }

2336
        event_notifier_set_handler(&vq->host_notifier, NULL);
2337
        r = virtio_bus_set_host_notifier(qbus, n, false);
2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356
        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++) {
2357 2358
        VirtQueue *vq = &vdev->vq[n];

2359 2360 2361
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }
2362
        event_notifier_set_handler(&vq->host_notifier, NULL);
2363
        r = virtio_bus_set_host_notifier(qbus, n, false);
2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375
        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);
}

2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391
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);
}

2392 2393 2394
static void virtio_device_class_init(ObjectClass *klass, void *data)
{
    /* Set the default value here. */
2395
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
2396
    DeviceClass *dc = DEVICE_CLASS(klass);
2397 2398 2399

    dc->realize = virtio_device_realize;
    dc->unrealize = virtio_device_unrealize;
2400
    dc->bus_type = TYPE_VIRTIO_BUS;
C
Cornelia Huck 已提交
2401
    dc->props = virtio_properties;
2402 2403
    vdc->start_ioeventfd = virtio_device_start_ioeventfd_impl;
    vdc->stop_ioeventfd = virtio_device_stop_ioeventfd_impl;
2404 2405

    vdc->legacy_features |= VIRTIO_LEGACY_FEATURES;
2406 2407
}

2408 2409 2410 2411 2412 2413 2414 2415
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);
}

2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430
static const TypeInfo virtio_device_info = {
    .name = TYPE_VIRTIO_DEVICE,
    .parent = TYPE_DEVICE,
    .instance_size = sizeof(VirtIODevice),
    .class_init = virtio_device_class_init,
    .abstract = true,
    .class_size = sizeof(VirtioDeviceClass),
};

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

type_init(virtio_register_types)