virtio.c 64.8 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 123
static void vring_desc_read(VirtIODevice *vdev, VRingDesc *desc,
                            hwaddr desc_pa, int i)
A
aliguori 已提交
124
{
J
Jason Wang 已提交
125
    address_space_read(vdev->dma_as, desc_pa + i * sizeof(VRingDesc),
126 127 128 129 130
                       MEMTXATTRS_UNSPECIFIED, (void *)desc, sizeof(VRingDesc));
    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 411 412 413
static int virtqueue_read_next_desc(VirtIODevice *vdev, VRingDesc *desc,
                                    hwaddr desc_pa, unsigned int max,
                                    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 430
    vring_desc_read(vdev, desc, desc_pa, *next);
    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
    unsigned int idx;
438
    unsigned int total_bufs, in_total, out_total;
439
    int rc;
A
aliguori 已提交
440 441 442

    idx = vq->last_avail_idx;

443
    total_bufs = in_total = out_total = 0;
444
    while ((rc = virtqueue_num_heads(vq, idx)) > 0) {
445
        VirtIODevice *vdev = vq->vdev;
446
        unsigned int max, num_bufs, indirect = 0;
447
        VRingDesc desc;
A
Avi Kivity 已提交
448
        hwaddr desc_pa;
449
        unsigned int i;
A
aliguori 已提交
450

451 452
        max = vq->vring.num;
        num_bufs = total_bufs;
453 454 455 456 457

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

458
        desc_pa = vq->vring.desc;
459
        vring_desc_read(vdev, &desc, desc_pa, i);
460

461 462
        if (desc.flags & VRING_DESC_F_INDIRECT) {
            if (desc.len % sizeof(VRingDesc)) {
463 464
                virtio_error(vdev, "Invalid size for indirect buffer table");
                goto err;
465 466 467 468
            }

            /* If we've got too many, that implies a descriptor loop. */
            if (num_bufs >= max) {
469 470
                virtio_error(vdev, "Looped descriptor");
                goto err;
471 472 473 474
            }

            /* loop over the indirect descriptor table */
            indirect = 1;
475 476
            max = desc.len / sizeof(VRingDesc);
            desc_pa = desc.addr;
477
            num_bufs = i = 0;
478
            vring_desc_read(vdev, &desc, desc_pa, i);
479 480
        }

A
aliguori 已提交
481 482
        do {
            /* If we've got too many, that implies a descriptor loop. */
483
            if (++num_bufs > max) {
484 485
                virtio_error(vdev, "Looped descriptor");
                goto err;
A
aliguori 已提交
486
            }
A
aliguori 已提交
487

488 489
            if (desc.flags & VRING_DESC_F_WRITE) {
                in_total += desc.len;
A
aliguori 已提交
490
            } else {
491
                out_total += desc.len;
A
aliguori 已提交
492
            }
493 494 495
            if (in_total >= max_in_bytes && out_total >= max_out_bytes) {
                goto done;
            }
496 497 498 499 500 501 502

            rc = virtqueue_read_next_desc(vdev, &desc, desc_pa, max, &i);
        } while (rc == VIRTQUEUE_READ_DESC_MORE);

        if (rc == VIRTQUEUE_READ_DESC_ERROR) {
            goto err;
        }
503 504 505 506 507

        if (!indirect)
            total_bufs = num_bufs;
        else
            total_bufs++;
A
aliguori 已提交
508
    }
509 510 511 512 513

    if (rc < 0) {
        goto err;
    }

514
done:
515 516 517 518 519 520
    if (in_bytes) {
        *in_bytes = in_total;
    }
    if (out_bytes) {
        *out_bytes = out_total;
    }
521 522 523 524 525
    return;

err:
    in_total = out_total = 0;
    goto done;
526
}
A
aliguori 已提交
527

528 529 530 531 532
int virtqueue_avail_bytes(VirtQueue *vq, unsigned int in_bytes,
                          unsigned int out_bytes)
{
    unsigned int in_total, out_total;

533 534
    virtqueue_get_avail_bytes(vq, &in_total, &out_total, in_bytes, out_bytes);
    return in_bytes <= in_total && out_bytes <= out_total;
A
aliguori 已提交
535 536
}

537 538
static bool virtqueue_map_desc(VirtIODevice *vdev, unsigned int *p_num_sg,
                               hwaddr *addr, struct iovec *iov,
539 540 541
                               unsigned int max_num_sg, bool is_write,
                               hwaddr pa, size_t sz)
{
542
    bool ok = false;
543 544 545
    unsigned num_sg = *p_num_sg;
    assert(num_sg <= max_num_sg);

546
    if (!sz) {
547 548
        virtio_error(vdev, "virtio: zero sized buffers are not allowed");
        goto out;
549 550
    }

551 552 553 554
    while (sz) {
        hwaddr len = sz;

        if (num_sg == max_num_sg) {
555 556 557
            virtio_error(vdev, "virtio: too many write descriptors in "
                               "indirect table");
            goto out;
558 559
        }

J
Jason Wang 已提交
560 561 562 563
        iov[num_sg].iov_base = dma_memory_map(vdev->dma_as, pa, &len,
                                              is_write ?
                                              DMA_DIRECTION_FROM_DEVICE :
                                              DMA_DIRECTION_TO_DEVICE);
564
        if (!iov[num_sg].iov_base) {
565 566
            virtio_error(vdev, "virtio: bogus descriptor or out of resources");
            goto out;
567 568
        }

569 570 571 572 573 574 575
        iov[num_sg].iov_len = len;
        addr[num_sg] = pa;

        sz -= len;
        pa += len;
        num_sg++;
    }
576 577 578
    ok = true;

out:
579
    *p_num_sg = num_sg;
580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597
    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++;
    }
598 599
}

J
Jason Wang 已提交
600 601
static void virtqueue_map_iovec(VirtIODevice *vdev, struct iovec *sg,
                                hwaddr *addr, unsigned int *num_sg,
602
                                int is_write)
K
Kevin Wolf 已提交
603 604
{
    unsigned int i;
A
Avi Kivity 已提交
605
    hwaddr len;
K
Kevin Wolf 已提交
606

M
Michael S. Tsirkin 已提交
607
    for (i = 0; i < *num_sg; i++) {
K
Kevin Wolf 已提交
608
        len = sg[i].iov_len;
J
Jason Wang 已提交
609 610 611 612
        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 已提交
613
        if (!sg[i].iov_base) {
M
Michael Tokarev 已提交
614
            error_report("virtio: error trying to map MMIO memory");
K
Kevin Wolf 已提交
615 616
            exit(1);
        }
617 618
        if (len != sg[i].iov_len) {
            error_report("virtio: unexpected memory split");
M
Michael S. Tsirkin 已提交
619 620
            exit(1);
        }
K
Kevin Wolf 已提交
621 622 623
    }
}

J
Jason Wang 已提交
624
void virtqueue_map(VirtIODevice *vdev, VirtQueueElement *elem)
M
Michael S. Tsirkin 已提交
625
{
626 627
    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);
628 629
}

630
static void *virtqueue_alloc_element(size_t sz, unsigned out_num, unsigned in_num)
631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648
{
    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 已提交
649 650
}

651
void *virtqueue_pop(VirtQueue *vq, size_t sz)
A
aliguori 已提交
652
{
653
    unsigned int i, head, max;
A
Avi Kivity 已提交
654
    hwaddr desc_pa = vq->vring.desc;
655
    VirtIODevice *vdev = vq->vdev;
656
    VirtQueueElement *elem;
657 658 659
    unsigned out_num, in_num;
    hwaddr addr[VIRTQUEUE_MAX_SIZE];
    struct iovec iov[VIRTQUEUE_MAX_SIZE];
660
    VRingDesc desc;
661
    int rc;
A
aliguori 已提交
662

663 664 665
    if (unlikely(vdev->broken)) {
        return NULL;
    }
666
    if (virtio_queue_empty(vq)) {
667 668
        return NULL;
    }
669 670 671
    /* Needed after virtio_queue_empty(), see comment in
     * virtqueue_num_heads(). */
    smp_rmb();
A
aliguori 已提交
672 673

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

676 677
    max = vq->vring.num;

678
    if (vq->inuse >= vq->vring.num) {
679 680
        virtio_error(vdev, "Virtqueue size exceeded");
        return NULL;
681 682
    }

683 684 685 686
    if (!virtqueue_get_head(vq, vq->last_avail_idx++, &head)) {
        return NULL;
    }

687
    if (virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
688
        vring_set_avail_event(vq, vq->last_avail_idx);
M
Michael S. Tsirkin 已提交
689
    }
690

691
    i = head;
692 693 694
    vring_desc_read(vdev, &desc, desc_pa, i);
    if (desc.flags & VRING_DESC_F_INDIRECT) {
        if (desc.len % sizeof(VRingDesc)) {
695 696
            virtio_error(vdev, "Invalid size for indirect buffer table");
            return NULL;
697 698 699
        }

        /* loop over the indirect descriptor table */
700 701
        max = desc.len / sizeof(VRingDesc);
        desc_pa = desc.addr;
702
        i = 0;
703
        vring_desc_read(vdev, &desc, desc_pa, i);
704 705
    }

K
Kevin Wolf 已提交
706
    /* Collect all the descriptors */
A
aliguori 已提交
707
    do {
708 709
        bool map_ok;

710
        if (desc.flags & VRING_DESC_F_WRITE) {
711 712 713 714
            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 已提交
715
        } else {
716
            if (in_num) {
717 718
                virtio_error(vdev, "Incorrect order for descriptors");
                goto err_undo_map;
719
            }
720 721 722 723 724 725
            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 已提交
726
        }
A
aliguori 已提交
727 728

        /* If we've got too many, that implies a descriptor loop. */
729
        if ((in_num + out_num) > max) {
730 731
            virtio_error(vdev, "Looped descriptor");
            goto err_undo_map;
A
aliguori 已提交
732
        }
733 734 735 736 737 738 739

        rc = virtqueue_read_next_desc(vdev, &desc, desc_pa, max, &i);
    } while (rc == VIRTQUEUE_READ_DESC_MORE);

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

741 742
    /* Now copy what we have collected and mapped */
    elem = virtqueue_alloc_element(sz, out_num, in_num);
A
aliguori 已提交
743
    elem->index = head;
744 745 746 747 748 749 750 751
    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 已提交
752 753 754

    vq->inuse++;

755
    trace_virtqueue_pop(vq, elem, elem->in_num, elem->out_num);
756
    return elem;
757 758 759 760

err_undo_map:
    virtqueue_undo_map_desc(out_num, in_num, iov);
    return NULL;
A
aliguori 已提交
761 762
}

763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800
/* 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;
}

801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817
/* 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 已提交
818
void *qemu_get_virtqueue_element(VirtIODevice *vdev, QEMUFile *f, size_t sz)
819
{
820 821 822 823 824 825
    VirtQueueElement *elem;
    VirtQueueElementOld data;
    int i;

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

826 827 828 829 830 831 832 833 834 835
    /* 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);

836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858
    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 已提交
859
    virtqueue_map(vdev, elem);
860 861 862 863 864
    return elem;
}

void qemu_put_virtqueue_element(QEMUFile *f, VirtQueueElement *elem)
{
865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891
    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));
892 893
}

A
aliguori 已提交
894
/* virtio device */
895 896
static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
{
K
KONRAD Frederic 已提交
897 898 899
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

900 901 902 903
    if (unlikely(vdev->broken)) {
        return;
    }

K
KONRAD Frederic 已提交
904 905
    if (k->notify) {
        k->notify(qbus->parent, vector);
906 907
    }
}
A
aliguori 已提交
908

P
Paul Brook 已提交
909
void virtio_update_irq(VirtIODevice *vdev)
A
aliguori 已提交
910
{
911
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
A
aliguori 已提交
912 913
}

914 915 916 917
static int virtio_validate_features(VirtIODevice *vdev)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);

J
Jason Wang 已提交
918 919 920 921 922
    if (virtio_host_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM) &&
        !virtio_vdev_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM)) {
        return -EFAULT;
    }

923 924 925 926 927 928 929 930
    if (k->validate_features) {
        return k->validate_features(vdev);
    } else {
        return 0;
    }
}

int virtio_set_status(VirtIODevice *vdev, uint8_t val)
931
{
932
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
933 934
    trace_virtio_set_status(vdev, val);

935
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
936 937 938 939 940 941 942 943 944
        if (!(vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) &&
            val & VIRTIO_CONFIG_S_FEATURES_OK) {
            int ret = virtio_validate_features(vdev);

            if (ret) {
                return ret;
            }
        }
    }
945 946
    if (k->set_status) {
        k->set_status(vdev, val);
947 948
    }
    vdev->status = val;
949
    return 0;
950 951
}

952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972
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 已提交
973
void virtio_reset(void *opaque)
A
aliguori 已提交
974 975
{
    VirtIODevice *vdev = opaque;
976
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
977 978
    int i;

979
    virtio_set_status(vdev, 0);
980 981 982 983 984 985 986
    if (current_cpu) {
        /* Guest initiated reset */
        vdev->device_endian = virtio_current_cpu_endian();
    } else {
        /* System reset */
        vdev->device_endian = virtio_default_endian();
    }
987

988 989 990
    if (k->reset) {
        k->reset(vdev);
    }
A
aliguori 已提交
991

992
    vdev->broken = false;
993
    vdev->guest_features = 0;
A
aliguori 已提交
994 995
    vdev->queue_sel = 0;
    vdev->status = 0;
P
Paolo Bonzini 已提交
996
    atomic_set(&vdev->isr, 0);
997 998
    vdev->config_vector = VIRTIO_NO_VECTOR;
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
999

1000
    for(i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1001 1002 1003 1004
        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;
1005
        vdev->vq[i].shadow_avail_idx = 0;
1006
        vdev->vq[i].used_idx = 0;
1007
        virtio_queue_set_vector(vdev, i, VIRTIO_NO_VECTOR);
M
Michael S. Tsirkin 已提交
1008 1009
        vdev->vq[i].signalled_used = 0;
        vdev->vq[i].signalled_used_valid = false;
1010
        vdev->vq[i].notification = true;
C
Cornelia Huck 已提交
1011
        vdev->vq[i].vring.num = vdev->vq[i].vring.num_default;
1012
        vdev->vq[i].inuse = 0;
A
aliguori 已提交
1013 1014 1015
    }
}

P
Paul Brook 已提交
1016
uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1017
{
1018
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1019 1020
    uint8_t val;

1021
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1022
        return (uint32_t)-1;
1023 1024 1025
    }

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

1027
    val = ldub_p(vdev->config + addr);
A
aliguori 已提交
1028 1029 1030
    return val;
}

P
Paul Brook 已提交
1031
uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1032
{
1033
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1034 1035
    uint16_t val;

1036
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1037
        return (uint32_t)-1;
1038 1039 1040
    }

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

1042
    val = lduw_p(vdev->config + addr);
A
aliguori 已提交
1043 1044 1045
    return val;
}

P
Paul Brook 已提交
1046
uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
1047
{
1048
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1049 1050
    uint32_t val;

1051
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
1052
        return (uint32_t)-1;
1053 1054 1055
    }

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

1057
    val = ldl_p(vdev->config + addr);
A
aliguori 已提交
1058 1059 1060
    return val;
}

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

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

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

1072 1073 1074
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1075 1076
}

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

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

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

1088 1089 1090
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1091 1092
}

P
Paul Brook 已提交
1093
void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
1094
{
1095
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1096 1097
    uint32_t val = data;

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

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

1104 1105 1106
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
1107 1108
}

1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 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
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 已提交
1205
void virtio_queue_set_addr(VirtIODevice *vdev, int n, hwaddr addr)
A
aliguori 已提交
1206
{
1207 1208
    vdev->vq[n].vring.desc = addr;
    virtio_queue_update_rings(vdev, n);
P
Paul Brook 已提交
1209 1210
}

A
Avi Kivity 已提交
1211
hwaddr virtio_queue_get_addr(VirtIODevice *vdev, int n)
P
Paul Brook 已提交
1212
{
1213 1214 1215 1216 1217 1218 1219 1220 1221
    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 已提交
1222 1223
}

1224 1225
void virtio_queue_set_num(VirtIODevice *vdev, int n, int num)
{
1226 1227 1228 1229 1230 1231 1232
    /* 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;
1233
    }
1234
    vdev->vq[n].vring.num = num;
1235 1236
}

1237 1238 1239 1240 1241 1242 1243 1244 1245 1246
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 已提交
1247 1248 1249 1250
int virtio_queue_get_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num;
}
A
aliguori 已提交
1251

M
Michael S. Tsirkin 已提交
1252 1253 1254 1255 1256
int virtio_queue_get_max_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num_default;
}

1257 1258 1259 1260
int virtio_get_num_queues(VirtIODevice *vdev)
{
    int i;

1261
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1262 1263 1264 1265 1266 1267 1268 1269
        if (!virtio_queue_get_num(vdev, i)) {
            break;
        }
    }

    return i;
}

1270 1271 1272 1273 1274
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);

1275
    /* virtio-1 compliant devices cannot change the alignment */
1276
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1277 1278 1279
        error_report("tried to modify queue alignment for virtio-1 device");
        return;
    }
1280 1281 1282 1283 1284 1285 1286
    /* 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;
1287
    virtio_queue_update_rings(vdev, n);
1288 1289
}

1290
static bool virtio_queue_notify_aio_vq(VirtQueue *vq)
M
Michael S. Tsirkin 已提交
1291 1292 1293 1294 1295
{
    if (vq->vring.desc && vq->handle_aio_output) {
        VirtIODevice *vdev = vq->vdev;

        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
1296
        return vq->handle_aio_output(vdev, vq);
M
Michael S. Tsirkin 已提交
1297
    }
1298 1299

    return false;
M
Michael S. Tsirkin 已提交
1300 1301
}

1302
static void virtio_queue_notify_vq(VirtQueue *vq)
1303
{
1304
    if (vq->vring.desc && vq->handle_output) {
1305
        VirtIODevice *vdev = vq->vdev;
1306

1307 1308 1309 1310
        if (unlikely(vdev->broken)) {
            return;
        }

1311 1312 1313 1314 1315
        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
        vq->handle_output(vdev, vq);
    }
}

P
Paul Brook 已提交
1316 1317
void virtio_queue_notify(VirtIODevice *vdev, int n)
{
1318
    virtio_queue_notify_vq(&vdev->vq[n]);
A
aliguori 已提交
1319 1320
}

1321 1322
uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
{
1323
    return n < VIRTIO_QUEUE_MAX ? vdev->vq[n].vector :
1324 1325 1326 1327 1328
        VIRTIO_NO_VECTOR;
}

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

1331
    if (n < VIRTIO_QUEUE_MAX) {
1332 1333 1334 1335
        if (vdev->vector_queues &&
            vdev->vq[n].vector != VIRTIO_NO_VECTOR) {
            QLIST_REMOVE(vq, node);
        }
1336
        vdev->vq[n].vector = vector;
1337 1338 1339 1340 1341
        if (vdev->vector_queues &&
            vector != VIRTIO_NO_VECTOR) {
            QLIST_INSERT_HEAD(&vdev->vector_queues[vector], vq, node);
        }
    }
1342 1343
}

1344 1345
VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
                            VirtIOHandleOutput handle_output)
A
aliguori 已提交
1346 1347 1348
{
    int i;

1349
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1350 1351 1352 1353
        if (vdev->vq[i].vring.num == 0)
            break;
    }

1354
    if (i == VIRTIO_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
A
aliguori 已提交
1355 1356 1357
        abort();

    vdev->vq[i].vring.num = queue_size;
C
Cornelia Huck 已提交
1358
    vdev->vq[i].vring.num_default = queue_size;
1359
    vdev->vq[i].vring.align = VIRTIO_PCI_VRING_ALIGN;
A
aliguori 已提交
1360
    vdev->vq[i].handle_output = handle_output;
M
Michael S. Tsirkin 已提交
1361
    vdev->vq[i].handle_aio_output = NULL;
A
aliguori 已提交
1362 1363 1364 1365

    return &vdev->vq[i];
}

1366 1367
void virtio_del_queue(VirtIODevice *vdev, int n)
{
1368
    if (n < 0 || n >= VIRTIO_QUEUE_MAX) {
1369 1370 1371 1372
        abort();
    }

    vdev->vq[n].vring.num = 0;
C
Cornelia Huck 已提交
1373
    vdev->vq[n].vring.num_default = 0;
1374 1375
}

P
Paolo Bonzini 已提交
1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387
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);
    }
}

1388
static bool virtio_should_notify(VirtIODevice *vdev, VirtQueue *vq)
M
Michael S. Tsirkin 已提交
1389 1390 1391
{
    uint16_t old, new;
    bool v;
1392 1393
    /* We need to expose used array entries before checking used event. */
    smp_mb();
1394
    /* Always notify when queue is empty (when feature acknowledge) */
1395
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_NOTIFY_ON_EMPTY) &&
1396
        !vq->inuse && virtio_queue_empty(vq)) {
M
Michael S. Tsirkin 已提交
1397 1398 1399
        return true;
    }

1400
    if (!virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
M
Michael S. Tsirkin 已提交
1401 1402 1403 1404 1405 1406
        return !(vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT);
    }

    v = vq->signalled_used_valid;
    vq->signalled_used_valid = true;
    old = vq->signalled_used;
1407
    new = vq->signalled_used = vq->used_idx;
1408
    return !v || vring_need_event(vring_get_used_event(vq), new, old);
M
Michael S. Tsirkin 已提交
1409 1410
}

1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437
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 已提交
1438 1439
void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
{
1440
    if (!virtio_should_notify(vdev, vq)) {
A
aliguori 已提交
1441
        return;
M
Michael S. Tsirkin 已提交
1442
    }
A
aliguori 已提交
1443

1444
    trace_virtio_notify(vdev, vq);
P
Paolo Bonzini 已提交
1445
    virtio_set_isr(vq->vdev, 0x1);
1446
    virtio_notify_vector(vdev, vq->vector);
A
aliguori 已提交
1447 1448 1449 1450
}

void virtio_notify_config(VirtIODevice *vdev)
{
1451 1452 1453
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
        return;

P
Paolo Bonzini 已提交
1454
    virtio_set_isr(vdev, 0x3);
1455
    vdev->generation++;
1456
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1457 1458
}

1459 1460 1461 1462 1463
static bool virtio_device_endian_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    assert(vdev->device_endian != VIRTIO_DEVICE_ENDIAN_UNKNOWN);
1464
    if (!virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1465 1466 1467 1468
        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;
1469 1470
}

G
Gerd Hoffmann 已提交
1471 1472 1473 1474 1475 1476 1477
static bool virtio_64bit_features_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

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

J
Jason Wang 已提交
1478 1479 1480 1481 1482 1483 1484
static bool virtio_virtqueue_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return virtio_host_has_feature(vdev, VIRTIO_F_VERSION_1);
}

C
Cornelia Huck 已提交
1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497
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;
}

1498 1499 1500 1501 1502 1503 1504 1505 1506 1507
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);
}

1508 1509 1510 1511 1512 1513 1514
static bool virtio_broken_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return vdev->broken;
}

1515
static const VMStateDescription vmstate_virtqueue = {
J
Jason Wang 已提交
1516
    .name = "virtqueue_state",
1517 1518 1519 1520 1521 1522 1523
    .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 已提交
1524 1525 1526 1527 1528 1529 1530 1531
};

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 已提交
1532 1533
        VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
                      VIRTIO_QUEUE_MAX, 0, vmstate_virtqueue, VirtQueue),
J
Jason Wang 已提交
1534 1535 1536 1537
        VMSTATE_END_OF_LIST()
    }
};

1538
static const VMStateDescription vmstate_ringsize = {
C
Cornelia Huck 已提交
1539
    .name = "ringsize_state",
1540 1541 1542 1543 1544 1545
    .version_id = 1,
    .minimum_version_id = 1,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(vring.num_default, struct VirtQueue),
        VMSTATE_END_OF_LIST()
    }
C
Cornelia Huck 已提交
1546 1547 1548 1549 1550 1551 1552 1553
};

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 已提交
1554 1555
        VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
                      VIRTIO_QUEUE_MAX, 0, vmstate_ringsize, VirtQueue),
C
Cornelia Huck 已提交
1556 1557 1558 1559
        VMSTATE_END_OF_LIST()
    }
};

J
Jianjun Duan 已提交
1560 1561
static int get_extra_state(QEMUFile *f, void *pv, size_t size,
                           VMStateField *field)
1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573
{
    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 已提交
1574 1575
static int put_extra_state(QEMUFile *f, void *pv, size_t size,
                           VMStateField *field, QJSON *vmdesc)
1576 1577 1578 1579 1580 1581
{
    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 已提交
1582
    return 0;
1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609
}

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

1610 1611 1612 1613
static const VMStateDescription vmstate_virtio_device_endian = {
    .name = "virtio/device_endian",
    .version_id = 1,
    .minimum_version_id = 1,
1614
    .needed = &virtio_device_endian_needed,
1615 1616 1617 1618 1619 1620
    .fields = (VMStateField[]) {
        VMSTATE_UINT8(device_endian, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

G
Gerd Hoffmann 已提交
1621 1622 1623 1624
static const VMStateDescription vmstate_virtio_64bit_features = {
    .name = "virtio/64bit_features",
    .version_id = 1,
    .minimum_version_id = 1,
1625
    .needed = &virtio_64bit_features_needed,
G
Gerd Hoffmann 已提交
1626 1627 1628 1629 1630 1631
    .fields = (VMStateField[]) {
        VMSTATE_UINT64(guest_features, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642
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()
    }
};

1643 1644 1645 1646 1647 1648 1649
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()
1650
    },
1651 1652 1653
    .subsections = (const VMStateDescription*[]) {
        &vmstate_virtio_device_endian,
        &vmstate_virtio_64bit_features,
J
Jason Wang 已提交
1654
        &vmstate_virtio_virtqueues,
C
Cornelia Huck 已提交
1655
        &vmstate_virtio_ringsize,
1656
        &vmstate_virtio_broken,
1657
        &vmstate_virtio_extra_state,
1658
        NULL
1659 1660 1661
    }
};

A
aliguori 已提交
1662 1663
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
{
K
KONRAD Frederic 已提交
1664 1665
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1666
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
G
Gerd Hoffmann 已提交
1667
    uint32_t guest_features_lo = (vdev->guest_features & 0xffffffff);
A
aliguori 已提交
1668 1669
    int i;

K
KONRAD Frederic 已提交
1670 1671 1672
    if (k->save_config) {
        k->save_config(qbus->parent, f);
    }
A
aliguori 已提交
1673 1674 1675 1676

    qemu_put_8s(f, &vdev->status);
    qemu_put_8s(f, &vdev->isr);
    qemu_put_be16s(f, &vdev->queue_sel);
G
Gerd Hoffmann 已提交
1677
    qemu_put_be32s(f, &guest_features_lo);
A
aliguori 已提交
1678 1679 1680
    qemu_put_be32(f, vdev->config_len);
    qemu_put_buffer(f, vdev->config, vdev->config_len);

1681
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1682 1683 1684 1685 1686 1687
        if (vdev->vq[i].vring.num == 0)
            break;
    }

    qemu_put_be32(f, i);

1688
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1689 1690 1691 1692
        if (vdev->vq[i].vring.num == 0)
            break;

        qemu_put_be32(f, vdev->vq[i].vring.num);
1693 1694 1695
        if (k->has_variable_vring_alignment) {
            qemu_put_be32(f, vdev->vq[i].vring.align);
        }
1696 1697
        /* XXX virtio-1 devices */
        qemu_put_be64(f, vdev->vq[i].vring.desc);
A
aliguori 已提交
1698
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
K
KONRAD Frederic 已提交
1699 1700 1701
        if (k->save_queue) {
            k->save_queue(qbus->parent, i, f);
        }
A
aliguori 已提交
1702
    }
1703 1704 1705 1706

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

1708 1709 1710 1711
    if (vdc->vmsd) {
        vmstate_save_state(f, vdc->vmsd, vdev, NULL);
    }

1712
    /* Subsections */
1713
    vmstate_save_state(f, &vmstate_virtio, vdev, NULL);
A
aliguori 已提交
1714 1715
}

1716
/* A wrapper for use as a VMState .put function */
J
Jianjun Duan 已提交
1717 1718
static int virtio_device_put(QEMUFile *f, void *opaque, size_t size,
                              VMStateField *field, QJSON *vmdesc)
1719 1720
{
    virtio_save(VIRTIO_DEVICE(opaque), f);
J
Jianjun Duan 已提交
1721 1722

    return 0;
1723 1724 1725
}

/* A wrapper for use as a VMState .get function */
J
Jianjun Duan 已提交
1726 1727
static int virtio_device_get(QEMUFile *f, void *opaque, size_t size,
                             VMStateField *field)
1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740
{
    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,
};

1741
static int virtio_set_features_nocheck(VirtIODevice *vdev, uint64_t val)
1742
{
1743
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
C
Cornelia Huck 已提交
1744
    bool bad = (val & ~(vdev->host_features)) != 0;
1745

C
Cornelia Huck 已提交
1746
    val &= vdev->host_features;
1747 1748
    if (k->set_features) {
        k->set_features(vdev, val);
1749 1750 1751 1752 1753
    }
    vdev->guest_features = val;
    return bad ? -1 : 0;
}

1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765
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);
}

1766
int virtio_load(VirtIODevice *vdev, QEMUFile *f, int version_id)
A
aliguori 已提交
1767
{
1768
    int i, ret;
1769
    int32_t config_len;
1770
    uint32_t num;
1771
    uint32_t features;
K
KONRAD Frederic 已提交
1772 1773
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1774
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1775

1776 1777 1778 1779 1780 1781
    /*
     * 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 已提交
1782 1783
    if (k->load_config) {
        ret = k->load_config(qbus->parent, f);
1784 1785 1786
        if (ret)
            return ret;
    }
A
aliguori 已提交
1787 1788 1789 1790

    qemu_get_8s(f, &vdev->status);
    qemu_get_8s(f, &vdev->isr);
    qemu_get_be16s(f, &vdev->queue_sel);
1791
    if (vdev->queue_sel >= VIRTIO_QUEUE_MAX) {
1792 1793
        return -1;
    }
1794
    qemu_get_be32s(f, &features);
1795

1796 1797 1798 1799 1800 1801 1802 1803 1804 1805
    /*
     * 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;

1806
    config_len = qemu_get_be32(f);
1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817

    /*
     * 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--;
1818
    }
A
aliguori 已提交
1819 1820 1821

    num = qemu_get_be32(f);

1822
    if (num > VIRTIO_QUEUE_MAX) {
1823
        error_report("Invalid number of virtqueues: 0x%x", num);
1824 1825 1826
        return -1;
    }

A
aliguori 已提交
1827 1828
    for (i = 0; i < num; i++) {
        vdev->vq[i].vring.num = qemu_get_be32(f);
1829 1830 1831
        if (k->has_variable_vring_alignment) {
            vdev->vq[i].vring.align = qemu_get_be32(f);
        }
1832
        vdev->vq[i].vring.desc = qemu_get_be64(f);
A
aliguori 已提交
1833
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
M
Michael S. Tsirkin 已提交
1834
        vdev->vq[i].signalled_used_valid = false;
1835
        vdev->vq[i].notification = true;
A
aliguori 已提交
1836

1837 1838 1839
        if (vdev->vq[i].vring.desc) {
            /* XXX virtio-1 devices */
            virtio_queue_update_rings(vdev, i);
M
Michael S. Tsirkin 已提交
1840 1841
        } else if (vdev->vq[i].last_avail_idx) {
            error_report("VQ %d address 0x0 "
1842
                         "inconsistent with Host index 0x%x",
M
Michael S. Tsirkin 已提交
1843 1844
                         i, vdev->vq[i].last_avail_idx);
                return -1;
1845
        }
K
KONRAD Frederic 已提交
1846 1847
        if (k->load_queue) {
            ret = k->load_queue(qbus->parent, i, f);
1848 1849
            if (ret)
                return ret;
1850
        }
A
aliguori 已提交
1851 1852
    }

1853
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
1854 1855

    if (vdc->load != NULL) {
1856 1857 1858 1859
        ret = vdc->load(vdev, f, version_id);
        if (ret) {
            return ret;
        }
1860 1861
    }

1862 1863 1864 1865 1866 1867 1868
    if (vdc->vmsd) {
        ret = vmstate_load_state(f, vdc->vmsd, vdev, version_id);
        if (ret) {
            return ret;
        }
    }

1869 1870 1871 1872 1873 1874 1875 1876 1877 1878
    /* 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 已提交
1879 1880 1881 1882 1883 1884 1885
    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;
1886
        if (virtio_set_features_nocheck(vdev, features64) < 0) {
G
Gerd Hoffmann 已提交
1887 1888 1889 1890 1891 1892
            error_report("Features 0x%" PRIx64 " unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features64, vdev->host_features);
            return -1;
        }
    } else {
1893
        if (virtio_set_features_nocheck(vdev, features) < 0) {
G
Gerd Hoffmann 已提交
1894 1895 1896 1897 1898 1899 1900
            error_report("Features 0x%x unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features, vdev->host_features);
            return -1;
        }
    }

1901
    for (i = 0; i < num; i++) {
1902
        if (vdev->vq[i].vring.desc) {
1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913
            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;
            }
1914
            vdev->vq[i].used_idx = vring_used_idx(&vdev->vq[i]);
1915
            vdev->vq[i].shadow_avail_idx = vring_avail_idx(&vdev->vq[i]);
1916 1917 1918 1919

            /*
             * Some devices migrate VirtQueueElements that have been popped
             * from the avail ring but not yet returned to the used ring.
1920 1921
             * Since max ring size < UINT16_MAX it's safe to use modulo
             * UINT16_MAX + 1 subtraction.
1922
             */
1923 1924
            vdev->vq[i].inuse = (uint16_t)(vdev->vq[i].last_avail_idx -
                                vdev->vq[i].used_idx);
1925 1926 1927 1928 1929 1930 1931 1932
            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;
            }
1933 1934 1935 1936
        }
    }

    return 0;
A
aliguori 已提交
1937 1938
}

1939
void virtio_cleanup(VirtIODevice *vdev)
1940
{
1941
    qemu_del_vm_change_state_handler(vdev->vmstate);
1942
    g_free(vdev->config);
1943
    g_free(vdev->vq);
1944
    g_free(vdev->vector_queues);
1945 1946
}

1947
static void virtio_vmstate_change(void *opaque, int running, RunState state)
1948 1949
{
    VirtIODevice *vdev = opaque;
K
KONRAD Frederic 已提交
1950 1951
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1952
    bool backend_run = running && (vdev->status & VIRTIO_CONFIG_S_DRIVER_OK);
1953
    vdev->vm_running = running;
1954 1955 1956 1957 1958

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

K
KONRAD Frederic 已提交
1959 1960
    if (k->vmstate_change) {
        k->vmstate_change(qbus->parent, backend_run);
1961 1962 1963 1964 1965 1966 1967
    }

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

1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978
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);
}

1979 1980
void virtio_init(VirtIODevice *vdev, const char *name,
                 uint16_t device_id, size_t config_size)
A
aliguori 已提交
1981
{
1982 1983
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1984
    int i;
1985 1986 1987 1988 1989 1990 1991
    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 已提交
1992
    vdev->device_id = device_id;
A
aliguori 已提交
1993
    vdev->status = 0;
P
Paolo Bonzini 已提交
1994
    atomic_set(&vdev->isr, 0);
A
aliguori 已提交
1995
    vdev->queue_sel = 0;
1996
    vdev->config_vector = VIRTIO_NO_VECTOR;
1997
    vdev->vq = g_malloc0(sizeof(VirtQueue) * VIRTIO_QUEUE_MAX);
1998
    vdev->vm_running = runstate_is_running();
1999
    vdev->broken = false;
2000
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
2001
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
2002
        vdev->vq[i].vdev = vdev;
2003
        vdev->vq[i].queue_index = i;
2004
    }
A
aliguori 已提交
2005 2006 2007

    vdev->name = name;
    vdev->config_len = config_size;
2008
    if (vdev->config_len) {
2009
        vdev->config = g_malloc0(config_size);
2010
    } else {
A
aliguori 已提交
2011
        vdev->config = NULL;
2012 2013 2014
    }
    vdev->vmstate = qemu_add_vm_change_state_handler(virtio_vmstate_change,
                                                     vdev);
2015
    vdev->device_endian = virtio_default_endian();
2016
    vdev->use_guest_notifier_mask = true;
2017
}
A
aliguori 已提交
2018

A
Avi Kivity 已提交
2019
hwaddr virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
2020 2021 2022 2023
{
    return vdev->vq[n].vring.desc;
}

A
Avi Kivity 已提交
2024
hwaddr virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
2025 2026 2027 2028
{
    return vdev->vq[n].vring.avail;
}

A
Avi Kivity 已提交
2029
hwaddr virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
2030 2031 2032 2033
{
    return vdev->vq[n].vring.used;
}

A
Avi Kivity 已提交
2034
hwaddr virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
2035 2036 2037 2038
{
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
}

A
Avi Kivity 已提交
2039
hwaddr virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
2040 2041
{
    return offsetof(VRingAvail, ring) +
2042
        sizeof(uint16_t) * vdev->vq[n].vring.num;
2043 2044
}

A
Avi Kivity 已提交
2045
hwaddr virtio_queue_get_used_size(VirtIODevice *vdev, int n)
2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058
{
    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;
2059
    vdev->vq[n].shadow_avail_idx = idx;
2060 2061
}

2062 2063 2064 2065 2066
void virtio_queue_update_used_idx(VirtIODevice *vdev, int n)
{
    vdev->vq[n].used_idx = vring_used_idx(&vdev->vq[n]);
}

2067 2068 2069 2070 2071
void virtio_queue_invalidate_signalled_used(VirtIODevice *vdev, int n)
{
    vdev->vq[n].signalled_used_valid = false;
}

2072 2073 2074 2075 2076
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
{
    return vdev->vq + n;
}

2077 2078 2079 2080 2081
uint16_t virtio_get_queue_index(VirtQueue *vq)
{
    return vq->queue_index;
}

2082 2083 2084 2085
static void virtio_queue_guest_notifier_read(EventNotifier *n)
{
    VirtQueue *vq = container_of(n, VirtQueue, guest_notifier);
    if (event_notifier_test_and_clear(n)) {
2086
        virtio_notify_vector(vq->vdev, vq->vector);
2087 2088 2089 2090 2091 2092 2093
    }
}

void virtio_queue_set_guest_notifier_fd_handler(VirtQueue *vq, bool assign,
                                                bool with_irqfd)
{
    if (assign && !with_irqfd) {
2094
        event_notifier_set_handler(&vq->guest_notifier,
2095 2096
                                   virtio_queue_guest_notifier_read);
    } else {
2097
        event_notifier_set_handler(&vq->guest_notifier, NULL);
2098 2099 2100 2101 2102 2103 2104 2105
    }
    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);
    }
}

2106 2107 2108 2109
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
{
    return &vq->guest_notifier;
}
2110

M
Michael S. Tsirkin 已提交
2111
static void virtio_queue_host_notifier_aio_read(EventNotifier *n)
2112 2113 2114
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
M
Michael S. Tsirkin 已提交
2115
        virtio_queue_notify_aio_vq(vq);
2116 2117 2118
    }
}

2119 2120 2121 2122 2123 2124 2125
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);
}

2126 2127 2128 2129
static bool virtio_queue_host_notifier_aio_poll(void *opaque)
{
    EventNotifier *n = opaque;
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
2130
    bool progress;
2131 2132 2133 2134 2135

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

2136
    progress = virtio_queue_notify_aio_vq(vq);
2137 2138 2139

    /* In case the handler function re-enabled notifications */
    virtio_queue_set_notification(vq, 0);
2140
    return progress;
2141 2142
}

2143 2144 2145 2146 2147 2148 2149 2150
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);
}

2151
void virtio_queue_aio_set_host_notifier_handler(VirtQueue *vq, AioContext *ctx,
2152
                                                VirtIOHandleAIOOutput handle_output)
2153
{
2154 2155
    if (handle_output) {
        vq->handle_aio_output = handle_output;
2156
        aio_set_event_notifier(ctx, &vq->host_notifier, true,
2157 2158
                               virtio_queue_host_notifier_aio_read,
                               virtio_queue_host_notifier_aio_poll);
2159 2160 2161
        aio_set_event_notifier_poll(ctx, &vq->host_notifier,
                                    virtio_queue_host_notifier_aio_poll_begin,
                                    virtio_queue_host_notifier_aio_poll_end);
2162
    } else {
2163
        aio_set_event_notifier(ctx, &vq->host_notifier, true, NULL, NULL);
2164 2165
        /* Test and clear notifier before after disabling event,
         * in case poll callback didn't have time to run. */
M
Michael S. Tsirkin 已提交
2166
        virtio_queue_host_notifier_aio_read(&vq->host_notifier);
2167
        vq->handle_aio_output = NULL;
M
Michael S. Tsirkin 已提交
2168 2169 2170
    }
}

2171
void virtio_queue_host_notifier_read(EventNotifier *n)
M
Michael S. Tsirkin 已提交
2172 2173 2174 2175
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
        virtio_queue_notify_vq(vq);
2176 2177 2178
    }
}

2179 2180 2181 2182
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
{
    return &vq->host_notifier;
}
2183

2184 2185
void virtio_device_set_child_bus_name(VirtIODevice *vdev, char *bus_name)
{
2186
    g_free(vdev->bus_name);
2187
    vdev->bus_name = g_strdup(bus_name);
2188 2189
}

2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205
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);
    }
}

2206 2207 2208 2209 2210 2211
static void virtio_device_realize(DeviceState *dev, Error **errp)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;

2212 2213 2214
    /* Devices should either use vmsd or the load/save methods */
    assert(!vdc->vmsd || !vdc->load);

2215 2216 2217 2218 2219 2220
    if (vdc->realize != NULL) {
        vdc->realize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
2221
    }
J
Jason Wang 已提交
2222 2223 2224 2225 2226 2227

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

2230
static void virtio_device_unrealize(DeviceState *dev, Error **errp)
2231
{
2232
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
2233 2234
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;
2235

2236 2237
    virtio_bus_device_unplugged(vdev);

2238 2239 2240 2241 2242 2243
    if (vdc->unrealize != NULL) {
        vdc->unrealize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
2244
    }
2245

2246 2247
    g_free(vdev->bus_name);
    vdev->bus_name = NULL;
2248 2249
}

C
Cornelia Huck 已提交
2250 2251 2252 2253 2254
static Property virtio_properties[] = {
    DEFINE_VIRTIO_COMMON_FEATURES(VirtIODevice, host_features),
    DEFINE_PROP_END_OF_LIST(),
};

2255 2256 2257 2258 2259 2260
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++) {
2261
        VirtQueue *vq = &vdev->vq[n];
2262 2263 2264
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }
2265
        r = virtio_bus_set_host_notifier(qbus, n, true);
2266 2267 2268 2269
        if (r < 0) {
            err = r;
            goto assign_error;
        }
2270
        event_notifier_set_handler(&vq->host_notifier,
2271
                                   virtio_queue_host_notifier_read);
2272 2273 2274 2275 2276 2277 2278 2279 2280
    }

    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);
2281 2282 2283 2284 2285
    }
    return 0;

assign_error:
    while (--n >= 0) {
2286
        VirtQueue *vq = &vdev->vq[n];
2287 2288 2289 2290
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }

2291
        event_notifier_set_handler(&vq->host_notifier, NULL);
2292
        r = virtio_bus_set_host_notifier(qbus, n, false);
2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311
        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++) {
2312 2313
        VirtQueue *vq = &vdev->vq[n];

2314 2315 2316
        if (!virtio_queue_get_num(vdev, n)) {
            continue;
        }
2317
        event_notifier_set_handler(&vq->host_notifier, NULL);
2318
        r = virtio_bus_set_host_notifier(qbus, n, false);
2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330
        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);
}

2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346
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);
}

2347 2348 2349
static void virtio_device_class_init(ObjectClass *klass, void *data)
{
    /* Set the default value here. */
2350
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
2351
    DeviceClass *dc = DEVICE_CLASS(klass);
2352 2353 2354

    dc->realize = virtio_device_realize;
    dc->unrealize = virtio_device_unrealize;
2355
    dc->bus_type = TYPE_VIRTIO_BUS;
C
Cornelia Huck 已提交
2356
    dc->props = virtio_properties;
2357 2358
    vdc->start_ioeventfd = virtio_device_start_ioeventfd_impl;
    vdc->stop_ioeventfd = virtio_device_stop_ioeventfd_impl;
2359 2360

    vdc->legacy_features |= VIRTIO_LEGACY_FEATURES;
2361 2362
}

2363 2364 2365 2366 2367 2368 2369 2370
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);
}

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