virtio.c 43.0 KB
Newer Older
A
aliguori 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/*
 * 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.
 *
 */

#include <inttypes.h>

16
#include "trace.h"
17
#include "exec/address-spaces.h"
18
#include "qemu/error-report.h"
P
Paolo Bonzini 已提交
19
#include "hw/virtio/virtio.h"
20
#include "qemu/atomic.h"
P
Paolo Bonzini 已提交
21
#include "hw/virtio/virtio-bus.h"
22
#include "migration/migration.h"
23
#include "hw/virtio/virtio-access.h"
A
aliguori 已提交
24

25 26 27 28 29
/*
 * 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.
 */
30 31
#define VIRTIO_PCI_VRING_ALIGN         4096

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

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

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

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

typedef struct VRing
{
    unsigned int num;
63
    unsigned int align;
A
Avi Kivity 已提交
64 65 66
    hwaddr desc;
    hwaddr avail;
    hwaddr used;
A
aliguori 已提交
67 68 69 70 71 72
} VRing;

struct VirtQueue
{
    VRing vring;
    uint16_t last_avail_idx;
M
Michael S. Tsirkin 已提交
73 74 75 76 77 78 79 80 81
    /* Last used index value we have signalled on */
    uint16_t signalled_used;

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

    /* Notification enabled? */
    bool notification;

82 83
    uint16_t queue_index;

A
aliguori 已提交
84
    int inuse;
M
Michael S. Tsirkin 已提交
85

86
    uint16_t vector;
A
aliguori 已提交
87
    void (*handle_output)(VirtIODevice *vdev, VirtQueue *vq);
88 89 90
    VirtIODevice *vdev;
    EventNotifier guest_notifier;
    EventNotifier host_notifier;
91
    QLIST_ENTRY(VirtQueue) node;
A
aliguori 已提交
92 93 94
};

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

99 100 101 102 103 104 105 106
    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 已提交
107 108
}

109 110
static inline uint64_t vring_desc_addr(VirtIODevice *vdev, hwaddr desc_pa,
                                       int i)
A
aliguori 已提交
111
{
A
Avi Kivity 已提交
112
    hwaddr pa;
113
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, addr);
114
    return virtio_ldq_phys(vdev, pa);
A
aliguori 已提交
115 116
}

117
static inline uint32_t vring_desc_len(VirtIODevice *vdev, hwaddr desc_pa, int i)
A
aliguori 已提交
118
{
A
Avi Kivity 已提交
119
    hwaddr pa;
120
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, len);
121
    return virtio_ldl_phys(vdev, pa);
A
aliguori 已提交
122 123
}

124 125
static inline uint16_t vring_desc_flags(VirtIODevice *vdev, hwaddr desc_pa,
                                        int i)
A
aliguori 已提交
126
{
A
Avi Kivity 已提交
127
    hwaddr pa;
128
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, flags);
129
    return virtio_lduw_phys(vdev, pa);
A
aliguori 已提交
130 131
}

132 133
static inline uint16_t vring_desc_next(VirtIODevice *vdev, hwaddr desc_pa,
                                       int i)
A
aliguori 已提交
134
{
A
Avi Kivity 已提交
135
    hwaddr pa;
136
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, next);
137
    return virtio_lduw_phys(vdev, pa);
A
aliguori 已提交
138 139 140 141
}

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

static inline uint16_t vring_avail_idx(VirtQueue *vq)
{
A
Avi Kivity 已提交
149
    hwaddr pa;
A
aliguori 已提交
150
    pa = vq->vring.avail + offsetof(VRingAvail, idx);
151
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
152 153 154 155
}

static inline uint16_t vring_avail_ring(VirtQueue *vq, int i)
{
A
Avi Kivity 已提交
156
    hwaddr pa;
A
aliguori 已提交
157
    pa = vq->vring.avail + offsetof(VRingAvail, ring[i]);
158
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
159 160
}

161
static inline uint16_t vring_get_used_event(VirtQueue *vq)
M
Michael S. Tsirkin 已提交
162 163 164 165
{
    return vring_avail_ring(vq, vq->vring.num);
}

A
aliguori 已提交
166 167
static inline void vring_used_ring_id(VirtQueue *vq, int i, uint32_t val)
{
A
Avi Kivity 已提交
168
    hwaddr pa;
A
aliguori 已提交
169
    pa = vq->vring.used + offsetof(VRingUsed, ring[i].id);
170
    virtio_stl_phys(vq->vdev, pa, val);
A
aliguori 已提交
171 172 173 174
}

static inline void vring_used_ring_len(VirtQueue *vq, int i, uint32_t val)
{
A
Avi Kivity 已提交
175
    hwaddr pa;
A
aliguori 已提交
176
    pa = vq->vring.used + offsetof(VRingUsed, ring[i].len);
177
    virtio_stl_phys(vq->vdev, pa, val);
A
aliguori 已提交
178 179 180 181
}

static uint16_t vring_used_idx(VirtQueue *vq)
{
A
Avi Kivity 已提交
182
    hwaddr pa;
A
aliguori 已提交
183
    pa = vq->vring.used + offsetof(VRingUsed, idx);
184
    return virtio_lduw_phys(vq->vdev, pa);
A
aliguori 已提交
185 186
}

M
Michael S. Tsirkin 已提交
187
static inline void vring_used_idx_set(VirtQueue *vq, uint16_t val)
A
aliguori 已提交
188
{
A
Avi Kivity 已提交
189
    hwaddr pa;
A
aliguori 已提交
190
    pa = vq->vring.used + offsetof(VRingUsed, idx);
191
    virtio_stw_phys(vq->vdev, pa, val);
A
aliguori 已提交
192 193 194 195
}

static inline void vring_used_flags_set_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 203
}

static inline void vring_used_flags_unset_bit(VirtQueue *vq, int mask)
{
204
    VirtIODevice *vdev = vq->vdev;
A
Avi Kivity 已提交
205
    hwaddr pa;
A
aliguori 已提交
206
    pa = vq->vring.used + offsetof(VRingUsed, flags);
207
    virtio_stw_phys(vdev, pa, virtio_lduw_phys(vdev, pa) & ~mask);
A
aliguori 已提交
208 209
}

210
static inline void vring_set_avail_event(VirtQueue *vq, uint16_t val)
M
Michael S. Tsirkin 已提交
211
{
A
Avi Kivity 已提交
212
    hwaddr pa;
M
Michael S. Tsirkin 已提交
213 214 215 216
    if (!vq->notification) {
        return;
    }
    pa = vq->vring.used + offsetof(VRingUsed, ring[vq->vring.num]);
217
    virtio_stw_phys(vq->vdev, pa, val);
M
Michael S. Tsirkin 已提交
218 219
}

A
aliguori 已提交
220 221
void virtio_queue_set_notification(VirtQueue *vq, int enable)
{
M
Michael S. Tsirkin 已提交
222
    vq->notification = enable;
223
    if (virtio_vdev_has_feature(vq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
224
        vring_set_avail_event(vq, vring_avail_idx(vq));
M
Michael S. Tsirkin 已提交
225
    } else if (enable) {
A
aliguori 已提交
226
        vring_used_flags_unset_bit(vq, VRING_USED_F_NO_NOTIFY);
M
Michael S. Tsirkin 已提交
227
    } else {
A
aliguori 已提交
228
        vring_used_flags_set_bit(vq, VRING_USED_F_NO_NOTIFY);
M
Michael S. Tsirkin 已提交
229
    }
230 231 232 233
    if (enable) {
        /* Expose avail event/used flags before caller checks the avail idx. */
        smp_mb();
    }
A
aliguori 已提交
234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251
}

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

int virtio_queue_empty(VirtQueue *vq)
{
    return vring_avail_idx(vq) == vq->last_avail_idx;
}

void virtqueue_fill(VirtQueue *vq, const VirtQueueElement *elem,
                    unsigned int len, unsigned int idx)
{
    unsigned int offset;
    int i;

252 253
    trace_virtqueue_fill(vq, elem, len, idx);

A
aliguori 已提交
254 255 256 257
    offset = 0;
    for (i = 0; i < elem->in_num; i++) {
        size_t size = MIN(len - offset, elem->in_sg[i].iov_len);

258 259 260
        cpu_physical_memory_unmap(elem->in_sg[i].iov_base,
                                  elem->in_sg[i].iov_len,
                                  1, size);
A
aliguori 已提交
261

262
        offset += size;
A
aliguori 已提交
263 264
    }

265 266 267 268 269
    for (i = 0; i < elem->out_num; i++)
        cpu_physical_memory_unmap(elem->out_sg[i].iov_base,
                                  elem->out_sg[i].iov_len,
                                  0, elem->out_sg[i].iov_len);

A
aliguori 已提交
270 271 272 273 274 275 276 277 278
    idx = (idx + vring_used_idx(vq)) % vq->vring.num;

    /* Get a pointer to the next entry in the used ring. */
    vring_used_ring_id(vq, idx, elem->index);
    vring_used_ring_len(vq, idx, len);
}

void virtqueue_flush(VirtQueue *vq, unsigned int count)
{
M
Michael S. Tsirkin 已提交
279
    uint16_t old, new;
A
aliguori 已提交
280
    /* Make sure buffer is written before we update index. */
281
    smp_wmb();
282
    trace_virtqueue_flush(vq, count);
M
Michael S. Tsirkin 已提交
283 284 285
    old = vring_used_idx(vq);
    new = old + count;
    vring_used_idx_set(vq, new);
A
aliguori 已提交
286
    vq->inuse -= count;
M
Michael S. Tsirkin 已提交
287 288
    if (unlikely((int16_t)(new - vq->signalled_used) < (uint16_t)(new - old)))
        vq->signalled_used_valid = false;
A
aliguori 已提交
289 290 291 292 293 294 295 296 297 298 299 300 301 302
}

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 已提交
303
    if (num_heads > vq->vring.num) {
304 305
        error_report("Guest moved used index from %u to %u",
                     idx, vring_avail_idx(vq));
A
aliguori 已提交
306 307
        exit(1);
    }
308 309 310 311 312
    /* 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 已提交
313 314 315 316 317 318 319 320 321 322 323 324 325

    return num_heads;
}

static unsigned int virtqueue_get_head(VirtQueue *vq, unsigned int idx)
{
    unsigned int head;

    /* Grab the next descriptor number they're advertising, and increment
     * the index we've seen. */
    head = vring_avail_ring(vq, idx % vq->vring.num);

    /* If their number is silly, that's a fatal mistake. */
A
aliguori 已提交
326
    if (head >= vq->vring.num) {
327
        error_report("Guest says index %u is available", head);
A
aliguori 已提交
328 329
        exit(1);
    }
A
aliguori 已提交
330 331 332 333

    return head;
}

334
static unsigned virtqueue_next_desc(VirtIODevice *vdev, hwaddr desc_pa,
335
                                    unsigned int i, unsigned int max)
A
aliguori 已提交
336 337 338 339
{
    unsigned int next;

    /* If this descriptor says it doesn't chain, we're done. */
340
    if (!(vring_desc_flags(vdev, desc_pa, i) & VRING_DESC_F_NEXT)) {
341
        return max;
342
    }
A
aliguori 已提交
343 344

    /* Check they're not leading us off end of descriptors. */
345
    next = vring_desc_next(vdev, desc_pa, i);
A
aliguori 已提交
346
    /* Make sure compiler knows to grab that: we don't want it changing! */
347
    smp_wmb();
A
aliguori 已提交
348

349
    if (next >= max) {
350
        error_report("Desc next is %u", next);
A
aliguori 已提交
351 352
        exit(1);
    }
A
aliguori 已提交
353 354 355 356

    return next;
}

357
void virtqueue_get_avail_bytes(VirtQueue *vq, unsigned int *in_bytes,
358 359
                               unsigned int *out_bytes,
                               unsigned max_in_bytes, unsigned max_out_bytes)
A
aliguori 已提交
360
{
361
    unsigned int idx;
362
    unsigned int total_bufs, in_total, out_total;
A
aliguori 已提交
363 364 365

    idx = vq->last_avail_idx;

366
    total_bufs = in_total = out_total = 0;
A
aliguori 已提交
367
    while (virtqueue_num_heads(vq, idx)) {
368
        VirtIODevice *vdev = vq->vdev;
369
        unsigned int max, num_bufs, indirect = 0;
A
Avi Kivity 已提交
370
        hwaddr desc_pa;
A
aliguori 已提交
371 372
        int i;

373 374
        max = vq->vring.num;
        num_bufs = total_bufs;
A
aliguori 已提交
375
        i = virtqueue_get_head(vq, idx++);
376 377
        desc_pa = vq->vring.desc;

378 379
        if (vring_desc_flags(vdev, desc_pa, i) & VRING_DESC_F_INDIRECT) {
            if (vring_desc_len(vdev, desc_pa, i) % sizeof(VRingDesc)) {
380
                error_report("Invalid size for indirect buffer table");
381 382 383 384 385
                exit(1);
            }

            /* If we've got too many, that implies a descriptor loop. */
            if (num_bufs >= max) {
386
                error_report("Looped descriptor");
387 388 389 390 391
                exit(1);
            }

            /* loop over the indirect descriptor table */
            indirect = 1;
392 393
            max = vring_desc_len(vdev, desc_pa, i) / sizeof(VRingDesc);
            desc_pa = vring_desc_addr(vdev, desc_pa, i);
394
            num_bufs = i = 0;
395 396
        }

A
aliguori 已提交
397 398
        do {
            /* If we've got too many, that implies a descriptor loop. */
399
            if (++num_bufs > max) {
400
                error_report("Looped descriptor");
A
aliguori 已提交
401 402
                exit(1);
            }
A
aliguori 已提交
403

404 405
            if (vring_desc_flags(vdev, desc_pa, i) & VRING_DESC_F_WRITE) {
                in_total += vring_desc_len(vdev, desc_pa, i);
A
aliguori 已提交
406
            } else {
407
                out_total += vring_desc_len(vdev, desc_pa, i);
A
aliguori 已提交
408
            }
409 410 411
            if (in_total >= max_in_bytes && out_total >= max_out_bytes) {
                goto done;
            }
412
        } while ((i = virtqueue_next_desc(vdev, desc_pa, i, max)) != max);
413 414 415 416 417

        if (!indirect)
            total_bufs = num_bufs;
        else
            total_bufs++;
A
aliguori 已提交
418
    }
419
done:
420 421 422 423 424 425 426
    if (in_bytes) {
        *in_bytes = in_total;
    }
    if (out_bytes) {
        *out_bytes = out_total;
    }
}
A
aliguori 已提交
427

428 429 430 431 432
int virtqueue_avail_bytes(VirtQueue *vq, unsigned int in_bytes,
                          unsigned int out_bytes)
{
    unsigned int in_total, out_total;

433 434
    virtqueue_get_avail_bytes(vq, &in_total, &out_total, in_bytes, out_bytes);
    return in_bytes <= in_total && out_bytes <= out_total;
A
aliguori 已提交
435 436
}

A
Avi Kivity 已提交
437
void virtqueue_map_sg(struct iovec *sg, hwaddr *addr,
K
Kevin Wolf 已提交
438 439 440
    size_t num_sg, int is_write)
{
    unsigned int i;
A
Avi Kivity 已提交
441
    hwaddr len;
K
Kevin Wolf 已提交
442

443
    if (num_sg > VIRTQUEUE_MAX_SIZE) {
444 445 446 447 448
        error_report("virtio: map attempt out of bounds: %zd > %d",
                     num_sg, VIRTQUEUE_MAX_SIZE);
        exit(1);
    }

K
Kevin Wolf 已提交
449 450 451 452
    for (i = 0; i < num_sg; i++) {
        len = sg[i].iov_len;
        sg[i].iov_base = cpu_physical_memory_map(addr[i], &len, is_write);
        if (sg[i].iov_base == NULL || len != sg[i].iov_len) {
M
Michael Tokarev 已提交
453
            error_report("virtio: error trying to map MMIO memory");
K
Kevin Wolf 已提交
454 455 456 457 458
            exit(1);
        }
    }
}

A
aliguori 已提交
459 460
int virtqueue_pop(VirtQueue *vq, VirtQueueElement *elem)
{
461
    unsigned int i, head, max;
A
Avi Kivity 已提交
462
    hwaddr desc_pa = vq->vring.desc;
463
    VirtIODevice *vdev = vq->vdev;
A
aliguori 已提交
464 465 466 467 468 469 470

    if (!virtqueue_num_heads(vq, vq->last_avail_idx))
        return 0;

    /* When we start there are none of either input nor output. */
    elem->out_num = elem->in_num = 0;

471 472
    max = vq->vring.num;

A
aliguori 已提交
473
    i = head = virtqueue_get_head(vq, vq->last_avail_idx++);
474
    if (virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
475
        vring_set_avail_event(vq, vq->last_avail_idx);
M
Michael S. Tsirkin 已提交
476
    }
477

478 479
    if (vring_desc_flags(vdev, desc_pa, i) & VRING_DESC_F_INDIRECT) {
        if (vring_desc_len(vdev, desc_pa, i) % sizeof(VRingDesc)) {
480
            error_report("Invalid size for indirect buffer table");
481 482 483 484
            exit(1);
        }

        /* loop over the indirect descriptor table */
485 486
        max = vring_desc_len(vdev, desc_pa, i) / sizeof(VRingDesc);
        desc_pa = vring_desc_addr(vdev, desc_pa, i);
487 488 489
        i = 0;
    }

K
Kevin Wolf 已提交
490
    /* Collect all the descriptors */
A
aliguori 已提交
491 492 493
    do {
        struct iovec *sg;

494
        if (vring_desc_flags(vdev, desc_pa, i) & VRING_DESC_F_WRITE) {
495 496 497 498
            if (elem->in_num >= ARRAY_SIZE(elem->in_sg)) {
                error_report("Too many write descriptors in indirect table");
                exit(1);
            }
499
            elem->in_addr[elem->in_num] = vring_desc_addr(vdev, desc_pa, i);
A
aliguori 已提交
500
            sg = &elem->in_sg[elem->in_num++];
K
Kevin Wolf 已提交
501
        } else {
502 503 504 505
            if (elem->out_num >= ARRAY_SIZE(elem->out_sg)) {
                error_report("Too many read descriptors in indirect table");
                exit(1);
            }
506
            elem->out_addr[elem->out_num] = vring_desc_addr(vdev, desc_pa, i);
A
aliguori 已提交
507
            sg = &elem->out_sg[elem->out_num++];
K
Kevin Wolf 已提交
508
        }
A
aliguori 已提交
509

510
        sg->iov_len = vring_desc_len(vdev, desc_pa, i);
A
aliguori 已提交
511 512

        /* If we've got too many, that implies a descriptor loop. */
513
        if ((elem->in_num + elem->out_num) > max) {
514
            error_report("Looped descriptor");
A
aliguori 已提交
515 516
            exit(1);
        }
517
    } while ((i = virtqueue_next_desc(vdev, desc_pa, i, max)) != max);
A
aliguori 已提交
518

K
Kevin Wolf 已提交
519 520 521 522
    /* Now map what we have collected */
    virtqueue_map_sg(elem->in_sg, elem->in_addr, elem->in_num, 1);
    virtqueue_map_sg(elem->out_sg, elem->out_addr, elem->out_num, 0);

A
aliguori 已提交
523 524 525 526
    elem->index = head;

    vq->inuse++;

527
    trace_virtqueue_pop(vq, elem, elem->in_num, elem->out_num);
A
aliguori 已提交
528 529 530 531
    return elem->in_num + elem->out_num;
}

/* virtio device */
532 533
static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
{
K
KONRAD Frederic 已提交
534 535 536 537 538
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);

    if (k->notify) {
        k->notify(qbus->parent, vector);
539 540
    }
}
A
aliguori 已提交
541

P
Paul Brook 已提交
542
void virtio_update_irq(VirtIODevice *vdev)
A
aliguori 已提交
543
{
544
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
A
aliguori 已提交
545 546
}

547 548 549 550 551 552 553 554 555 556 557 558
static int virtio_validate_features(VirtIODevice *vdev)
{
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);

    if (k->validate_features) {
        return k->validate_features(vdev);
    } else {
        return 0;
    }
}

int virtio_set_status(VirtIODevice *vdev, uint8_t val)
559
{
560
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
561 562
    trace_virtio_set_status(vdev, val);

563
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
564 565 566 567 568 569 570 571 572
        if (!(vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) &&
            val & VIRTIO_CONFIG_S_FEATURES_OK) {
            int ret = virtio_validate_features(vdev);

            if (ret) {
                return ret;
            }
        }
    }
573 574
    if (k->set_status) {
        k->set_status(vdev, val);
575 576
    }
    vdev->status = val;
577
    return 0;
578 579
}

580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600
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 已提交
601
void virtio_reset(void *opaque)
A
aliguori 已提交
602 603
{
    VirtIODevice *vdev = opaque;
604
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
605 606
    int i;

607
    virtio_set_status(vdev, 0);
608 609 610 611 612 613 614
    if (current_cpu) {
        /* Guest initiated reset */
        vdev->device_endian = virtio_current_cpu_endian();
    } else {
        /* System reset */
        vdev->device_endian = virtio_default_endian();
    }
615

616 617 618
    if (k->reset) {
        k->reset(vdev);
    }
A
aliguori 已提交
619

620
    vdev->guest_features = 0;
A
aliguori 已提交
621 622 623
    vdev->queue_sel = 0;
    vdev->status = 0;
    vdev->isr = 0;
624 625
    vdev->config_vector = VIRTIO_NO_VECTOR;
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
626

627
    for(i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
628 629 630 631
        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;
632
        virtio_queue_set_vector(vdev, i, VIRTIO_NO_VECTOR);
M
Michael S. Tsirkin 已提交
633 634 635
        vdev->vq[i].signalled_used = 0;
        vdev->vq[i].signalled_used_valid = false;
        vdev->vq[i].notification = true;
A
aliguori 已提交
636 637 638
    }
}

P
Paul Brook 已提交
639
uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
640
{
641
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
642 643
    uint8_t val;

644
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
645
        return (uint32_t)-1;
646 647 648
    }

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

650
    val = ldub_p(vdev->config + addr);
A
aliguori 已提交
651 652 653
    return val;
}

P
Paul Brook 已提交
654
uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
655
{
656
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
657 658
    uint16_t val;

659
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
660
        return (uint32_t)-1;
661 662 663
    }

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

665
    val = lduw_p(vdev->config + addr);
A
aliguori 已提交
666 667 668
    return val;
}

P
Paul Brook 已提交
669
uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr)
A
aliguori 已提交
670
{
671
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
672 673
    uint32_t val;

674
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
675
        return (uint32_t)-1;
676 677 678
    }

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

680
    val = ldl_p(vdev->config + addr);
A
aliguori 已提交
681 682 683
    return val;
}

P
Paul Brook 已提交
684
void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
685
{
686
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
687 688
    uint8_t val = data;

689
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
690
        return;
691
    }
A
aliguori 已提交
692

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

695 696 697
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
698 699
}

P
Paul Brook 已提交
700
void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
701
{
702
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
703 704
    uint16_t val = data;

705
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
706
        return;
707
    }
A
aliguori 已提交
708

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

711 712 713
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
714 715
}

P
Paul Brook 已提交
716
void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
A
aliguori 已提交
717
{
718
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
719 720
    uint32_t val = data;

721
    if (addr + sizeof(val) > vdev->config_len) {
A
aliguori 已提交
722
        return;
723
    }
A
aliguori 已提交
724

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

727 728 729
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
730 731
}

732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 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 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827
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 已提交
828
void virtio_queue_set_addr(VirtIODevice *vdev, int n, hwaddr addr)
A
aliguori 已提交
829
{
830 831
    vdev->vq[n].vring.desc = addr;
    virtio_queue_update_rings(vdev, n);
P
Paul Brook 已提交
832 833
}

A
Avi Kivity 已提交
834
hwaddr virtio_queue_get_addr(VirtIODevice *vdev, int n)
P
Paul Brook 已提交
835
{
836 837 838 839 840 841 842 843 844
    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 已提交
845 846
}

847 848
void virtio_queue_set_num(VirtIODevice *vdev, int n, int num)
{
849 850 851 852 853 854 855
    /* 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;
856
    }
857
    vdev->vq[n].vring.num = num;
858 859
}

860 861 862 863 864 865 866 867 868 869
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 已提交
870 871 872 873
int virtio_queue_get_num(VirtIODevice *vdev, int n)
{
    return vdev->vq[n].vring.num;
}
A
aliguori 已提交
874

875 876 877 878
int virtio_get_num_queues(VirtIODevice *vdev)
{
    int i;

879
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
880 881 882 883 884 885 886 887
        if (!virtio_queue_get_num(vdev, i)) {
            break;
        }
    }

    return i;
}

P
Paolo Bonzini 已提交
888 889 890
int virtio_queue_get_id(VirtQueue *vq)
{
    VirtIODevice *vdev = vq->vdev;
891
    assert(vq >= &vdev->vq[0] && vq < &vdev->vq[VIRTIO_QUEUE_MAX]);
P
Paolo Bonzini 已提交
892 893 894
    return vq - &vdev->vq[0];
}

895 896 897 898 899
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);

900
    /* virtio-1 compliant devices cannot change the alignment */
901
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
902 903 904
        error_report("tried to modify queue alignment for virtio-1 device");
        return;
    }
905 906 907 908 909 910 911
    /* 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;
912
    virtio_queue_update_rings(vdev, n);
913 914
}

915 916
void virtio_queue_notify_vq(VirtQueue *vq)
{
917
    if (vq->vring.desc && vq->handle_output) {
918
        VirtIODevice *vdev = vq->vdev;
919

920 921 922 923 924
        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
        vq->handle_output(vdev, vq);
    }
}

P
Paul Brook 已提交
925 926
void virtio_queue_notify(VirtIODevice *vdev, int n)
{
927
    virtio_queue_notify_vq(&vdev->vq[n]);
A
aliguori 已提交
928 929
}

930 931
uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
{
932
    return n < VIRTIO_QUEUE_MAX ? vdev->vq[n].vector :
933 934 935 936 937
        VIRTIO_NO_VECTOR;
}

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

940
    if (n < VIRTIO_QUEUE_MAX) {
941 942 943 944
        if (vdev->vector_queues &&
            vdev->vq[n].vector != VIRTIO_NO_VECTOR) {
            QLIST_REMOVE(vq, node);
        }
945
        vdev->vq[n].vector = vector;
946 947 948 949 950
        if (vdev->vector_queues &&
            vector != VIRTIO_NO_VECTOR) {
            QLIST_INSERT_HEAD(&vdev->vector_queues[vector], vq, node);
        }
    }
951 952
}

A
aliguori 已提交
953 954 955 956 957
VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
                            void (*handle_output)(VirtIODevice *, VirtQueue *))
{
    int i;

958
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
959 960 961 962
        if (vdev->vq[i].vring.num == 0)
            break;
    }

963
    if (i == VIRTIO_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
A
aliguori 已提交
964 965 966
        abort();

    vdev->vq[i].vring.num = queue_size;
967
    vdev->vq[i].vring.align = VIRTIO_PCI_VRING_ALIGN;
A
aliguori 已提交
968 969 970 971 972
    vdev->vq[i].handle_output = handle_output;

    return &vdev->vq[i];
}

973 974
void virtio_del_queue(VirtIODevice *vdev, int n)
{
975
    if (n < 0 || n >= VIRTIO_QUEUE_MAX) {
976 977 978 979 980 981
        abort();
    }

    vdev->vq[n].vring.num = 0;
}

982 983
void virtio_irq(VirtQueue *vq)
{
984
    trace_virtio_irq(vq);
985 986 987 988
    vq->vdev->isr |= 0x01;
    virtio_notify_vector(vq->vdev, vq->vector);
}

M
Michael S. Tsirkin 已提交
989 990 991 992
static bool vring_notify(VirtIODevice *vdev, VirtQueue *vq)
{
    uint16_t old, new;
    bool v;
993 994
    /* We need to expose used array entries before checking used event. */
    smp_mb();
995
    /* Always notify when queue is empty (when feature acknowledge) */
996
    if (virtio_vdev_has_feature(vdev, VIRTIO_F_NOTIFY_ON_EMPTY) &&
997
        !vq->inuse && vring_avail_idx(vq) == vq->last_avail_idx) {
M
Michael S. Tsirkin 已提交
998 999 1000
        return true;
    }

1001
    if (!virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
M
Michael S. Tsirkin 已提交
1002 1003 1004 1005 1006 1007 1008
        return !(vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT);
    }

    v = vq->signalled_used_valid;
    vq->signalled_used_valid = true;
    old = vq->signalled_used;
    new = vq->signalled_used = vring_used_idx(vq);
1009
    return !v || vring_need_event(vring_get_used_event(vq), new, old);
M
Michael S. Tsirkin 已提交
1010 1011 1012 1013 1014
}

void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
{
    if (!vring_notify(vdev, vq)) {
A
aliguori 已提交
1015
        return;
M
Michael S. Tsirkin 已提交
1016
    }
A
aliguori 已提交
1017

1018
    trace_virtio_notify(vdev, vq);
A
aliguori 已提交
1019
    vdev->isr |= 0x01;
1020
    virtio_notify_vector(vdev, vq->vector);
A
aliguori 已提交
1021 1022 1023 1024
}

void virtio_notify_config(VirtIODevice *vdev)
{
1025 1026 1027
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
        return;

A
aliguori 已提交
1028
    vdev->isr |= 0x03;
1029
    vdev->generation++;
1030
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1031 1032
}

1033 1034 1035 1036 1037
static bool virtio_device_endian_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    assert(vdev->device_endian != VIRTIO_DEVICE_ENDIAN_UNKNOWN);
1038
    if (!virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1039 1040 1041 1042
        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;
1043 1044
}

G
Gerd Hoffmann 已提交
1045 1046 1047 1048 1049 1050 1051
static bool virtio_64bit_features_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

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

J
Jason Wang 已提交
1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106
static bool virtio_virtqueue_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return virtio_host_has_feature(vdev, VIRTIO_F_VERSION_1);
}

static void put_virtqueue_state(QEMUFile *f, void *pv, size_t size)
{
    VirtIODevice *vdev = pv;
    int i;

    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
        qemu_put_be64(f, vdev->vq[i].vring.avail);
        qemu_put_be64(f, vdev->vq[i].vring.used);
    }
}

static int get_virtqueue_state(QEMUFile *f, void *pv, size_t size)
{
    VirtIODevice *vdev = pv;
    int i;

    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
        vdev->vq[i].vring.avail = qemu_get_be64(f);
        vdev->vq[i].vring.used = qemu_get_be64(f);
    }
    return 0;
}

static VMStateInfo vmstate_info_virtqueue = {
    .name = "virtqueue_state",
    .get = get_virtqueue_state,
    .put = put_virtqueue_state,
};

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

1107 1108 1109 1110
static const VMStateDescription vmstate_virtio_device_endian = {
    .name = "virtio/device_endian",
    .version_id = 1,
    .minimum_version_id = 1,
1111
    .needed = &virtio_device_endian_needed,
1112 1113 1114 1115 1116 1117
    .fields = (VMStateField[]) {
        VMSTATE_UINT8(device_endian, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

G
Gerd Hoffmann 已提交
1118 1119 1120 1121
static const VMStateDescription vmstate_virtio_64bit_features = {
    .name = "virtio/64bit_features",
    .version_id = 1,
    .minimum_version_id = 1,
1122
    .needed = &virtio_64bit_features_needed,
G
Gerd Hoffmann 已提交
1123 1124 1125 1126 1127 1128
    .fields = (VMStateField[]) {
        VMSTATE_UINT64(guest_features, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

1129 1130 1131 1132 1133 1134 1135
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()
1136
    },
1137 1138 1139
    .subsections = (const VMStateDescription*[]) {
        &vmstate_virtio_device_endian,
        &vmstate_virtio_64bit_features,
J
Jason Wang 已提交
1140
        &vmstate_virtio_virtqueues,
1141
        NULL
1142 1143 1144
    }
};

A
aliguori 已提交
1145 1146
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
{
K
KONRAD Frederic 已提交
1147 1148
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1149
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
G
Gerd Hoffmann 已提交
1150
    uint32_t guest_features_lo = (vdev->guest_features & 0xffffffff);
A
aliguori 已提交
1151 1152
    int i;

K
KONRAD Frederic 已提交
1153 1154 1155
    if (k->save_config) {
        k->save_config(qbus->parent, f);
    }
A
aliguori 已提交
1156 1157 1158 1159

    qemu_put_8s(f, &vdev->status);
    qemu_put_8s(f, &vdev->isr);
    qemu_put_be16s(f, &vdev->queue_sel);
G
Gerd Hoffmann 已提交
1160
    qemu_put_be32s(f, &guest_features_lo);
A
aliguori 已提交
1161 1162 1163
    qemu_put_be32(f, vdev->config_len);
    qemu_put_buffer(f, vdev->config, vdev->config_len);

1164
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1165 1166 1167 1168 1169 1170
        if (vdev->vq[i].vring.num == 0)
            break;
    }

    qemu_put_be32(f, i);

1171
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1172 1173 1174 1175
        if (vdev->vq[i].vring.num == 0)
            break;

        qemu_put_be32(f, vdev->vq[i].vring.num);
1176 1177 1178
        if (k->has_variable_vring_alignment) {
            qemu_put_be32(f, vdev->vq[i].vring.align);
        }
1179 1180
        /* XXX virtio-1 devices */
        qemu_put_be64(f, vdev->vq[i].vring.desc);
A
aliguori 已提交
1181
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
K
KONRAD Frederic 已提交
1182 1183 1184
        if (k->save_queue) {
            k->save_queue(qbus->parent, i, f);
        }
A
aliguori 已提交
1185
    }
1186 1187 1188 1189

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

    /* Subsections */
1192
    vmstate_save_state(f, &vmstate_virtio, vdev, NULL);
A
aliguori 已提交
1193 1194
}

1195
static int virtio_set_features_nocheck(VirtIODevice *vdev, uint64_t val)
1196
{
1197
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
C
Cornelia Huck 已提交
1198
    bool bad = (val & ~(vdev->host_features)) != 0;
1199

C
Cornelia Huck 已提交
1200
    val &= vdev->host_features;
1201 1202
    if (k->set_features) {
        k->set_features(vdev, val);
1203 1204 1205 1206 1207
    }
    vdev->guest_features = val;
    return bad ? -1 : 0;
}

1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219
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);
}

1220
int virtio_load(VirtIODevice *vdev, QEMUFile *f, int version_id)
A
aliguori 已提交
1221
{
1222
    int i, ret;
1223
    int32_t config_len;
1224
    uint32_t num;
1225
    uint32_t features;
K
KONRAD Frederic 已提交
1226 1227
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1228
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1229

1230 1231 1232 1233 1234 1235
    /*
     * 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 已提交
1236 1237
    if (k->load_config) {
        ret = k->load_config(qbus->parent, f);
1238 1239 1240
        if (ret)
            return ret;
    }
A
aliguori 已提交
1241 1242 1243 1244

    qemu_get_8s(f, &vdev->status);
    qemu_get_8s(f, &vdev->isr);
    qemu_get_be16s(f, &vdev->queue_sel);
1245
    if (vdev->queue_sel >= VIRTIO_QUEUE_MAX) {
1246 1247
        return -1;
    }
1248
    qemu_get_be32s(f, &features);
1249

1250
    config_len = qemu_get_be32(f);
1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261

    /*
     * 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--;
1262
    }
A
aliguori 已提交
1263 1264 1265

    num = qemu_get_be32(f);

1266
    if (num > VIRTIO_QUEUE_MAX) {
1267 1268 1269 1270
        error_report("Invalid number of PCI queues: 0x%x", num);
        return -1;
    }

A
aliguori 已提交
1271 1272
    for (i = 0; i < num; i++) {
        vdev->vq[i].vring.num = qemu_get_be32(f);
1273 1274 1275
        if (k->has_variable_vring_alignment) {
            vdev->vq[i].vring.align = qemu_get_be32(f);
        }
1276
        vdev->vq[i].vring.desc = qemu_get_be64(f);
A
aliguori 已提交
1277
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
M
Michael S. Tsirkin 已提交
1278 1279
        vdev->vq[i].signalled_used_valid = false;
        vdev->vq[i].notification = true;
A
aliguori 已提交
1280

1281 1282 1283
        if (vdev->vq[i].vring.desc) {
            /* XXX virtio-1 devices */
            virtio_queue_update_rings(vdev, i);
M
Michael S. Tsirkin 已提交
1284 1285
        } else if (vdev->vq[i].last_avail_idx) {
            error_report("VQ %d address 0x0 "
1286
                         "inconsistent with Host index 0x%x",
M
Michael S. Tsirkin 已提交
1287 1288
                         i, vdev->vq[i].last_avail_idx);
                return -1;
1289
	}
K
KONRAD Frederic 已提交
1290 1291
        if (k->load_queue) {
            ret = k->load_queue(qbus->parent, i, f);
1292 1293
            if (ret)
                return ret;
1294
        }
A
aliguori 已提交
1295 1296
    }

1297
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
1298 1299

    if (vdc->load != NULL) {
1300 1301 1302 1303
        ret = vdc->load(vdev, f, version_id);
        if (ret) {
            return ret;
        }
1304 1305
    }

1306 1307 1308 1309 1310 1311 1312 1313 1314 1315
    /* 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 已提交
1316 1317 1318 1319 1320 1321 1322
    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;
1323
        if (virtio_set_features_nocheck(vdev, features64) < 0) {
G
Gerd Hoffmann 已提交
1324 1325 1326 1327 1328 1329
            error_report("Features 0x%" PRIx64 " unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features64, vdev->host_features);
            return -1;
        }
    } else {
1330
        if (virtio_set_features_nocheck(vdev, features) < 0) {
G
Gerd Hoffmann 已提交
1331 1332 1333 1334 1335 1336 1337
            error_report("Features 0x%x unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features, vdev->host_features);
            return -1;
        }
    }

1338
    for (i = 0; i < num; i++) {
1339
        if (vdev->vq[i].vring.desc) {
1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354
            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;
            }
        }
    }

    return 0;
A
aliguori 已提交
1355 1356
}

1357
void virtio_cleanup(VirtIODevice *vdev)
1358
{
1359
    qemu_del_vm_change_state_handler(vdev->vmstate);
1360
    g_free(vdev->config);
1361
    g_free(vdev->vq);
1362
    g_free(vdev->vector_queues);
1363 1364
}

1365
static void virtio_vmstate_change(void *opaque, int running, RunState state)
1366 1367
{
    VirtIODevice *vdev = opaque;
K
KONRAD Frederic 已提交
1368 1369
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1370
    bool backend_run = running && (vdev->status & VIRTIO_CONFIG_S_DRIVER_OK);
1371
    vdev->vm_running = running;
1372 1373 1374 1375 1376

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

K
KONRAD Frederic 已提交
1377 1378
    if (k->vmstate_change) {
        k->vmstate_change(qbus->parent, backend_run);
1379 1380 1381 1382 1383 1384 1385
    }

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

1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396
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);
}

1397 1398
void virtio_init(VirtIODevice *vdev, const char *name,
                 uint16_t device_id, size_t config_size)
A
aliguori 已提交
1399
{
1400 1401
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1402
    int i;
1403 1404 1405 1406 1407 1408 1409
    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 已提交
1410
    vdev->device_id = device_id;
A
aliguori 已提交
1411 1412 1413
    vdev->status = 0;
    vdev->isr = 0;
    vdev->queue_sel = 0;
1414
    vdev->config_vector = VIRTIO_NO_VECTOR;
1415
    vdev->vq = g_malloc0(sizeof(VirtQueue) * VIRTIO_QUEUE_MAX);
1416
    vdev->vm_running = runstate_is_running();
1417
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1418
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
1419
        vdev->vq[i].vdev = vdev;
1420
        vdev->vq[i].queue_index = i;
1421
    }
A
aliguori 已提交
1422 1423 1424

    vdev->name = name;
    vdev->config_len = config_size;
1425
    if (vdev->config_len) {
1426
        vdev->config = g_malloc0(config_size);
1427
    } else {
A
aliguori 已提交
1428
        vdev->config = NULL;
1429 1430 1431
    }
    vdev->vmstate = qemu_add_vm_change_state_handler(virtio_vmstate_change,
                                                     vdev);
1432
    vdev->device_endian = virtio_default_endian();
1433
}
A
aliguori 已提交
1434

A
Avi Kivity 已提交
1435
hwaddr virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
1436 1437 1438 1439
{
    return vdev->vq[n].vring.desc;
}

A
Avi Kivity 已提交
1440
hwaddr virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
1441 1442 1443 1444
{
    return vdev->vq[n].vring.avail;
}

A
Avi Kivity 已提交
1445
hwaddr virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
1446 1447 1448 1449
{
    return vdev->vq[n].vring.used;
}

A
Avi Kivity 已提交
1450
hwaddr virtio_queue_get_ring_addr(VirtIODevice *vdev, int n)
1451 1452 1453 1454
{
    return vdev->vq[n].vring.desc;
}

A
Avi Kivity 已提交
1455
hwaddr virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
1456 1457 1458 1459
{
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
}

A
Avi Kivity 已提交
1460
hwaddr virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
1461 1462
{
    return offsetof(VRingAvail, ring) +
1463
        sizeof(uint16_t) * vdev->vq[n].vring.num;
1464 1465
}

A
Avi Kivity 已提交
1466
hwaddr virtio_queue_get_used_size(VirtIODevice *vdev, int n)
1467 1468 1469 1470 1471
{
    return offsetof(VRingUsed, ring) +
        sizeof(VRingUsedElem) * vdev->vq[n].vring.num;
}

A
Avi Kivity 已提交
1472
hwaddr virtio_queue_get_ring_size(VirtIODevice *vdev, int n)
1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487
{
    return vdev->vq[n].vring.used - vdev->vq[n].vring.desc +
	    virtio_queue_get_used_size(vdev, n);
}

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

1488 1489 1490 1491 1492
void virtio_queue_invalidate_signalled_used(VirtIODevice *vdev, int n)
{
    vdev->vq[n].signalled_used_valid = false;
}

1493 1494 1495 1496 1497
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
{
    return vdev->vq + n;
}

1498 1499 1500 1501 1502
uint16_t virtio_get_queue_index(VirtQueue *vq)
{
    return vq->queue_index;
}

1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526
static void virtio_queue_guest_notifier_read(EventNotifier *n)
{
    VirtQueue *vq = container_of(n, VirtQueue, guest_notifier);
    if (event_notifier_test_and_clear(n)) {
        virtio_irq(vq);
    }
}

void virtio_queue_set_guest_notifier_fd_handler(VirtQueue *vq, bool assign,
                                                bool with_irqfd)
{
    if (assign && !with_irqfd) {
        event_notifier_set_handler(&vq->guest_notifier,
                                   virtio_queue_guest_notifier_read);
    } else {
        event_notifier_set_handler(&vq->guest_notifier, NULL);
    }
    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);
    }
}

1527 1528 1529 1530
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
{
    return &vq->guest_notifier;
}
1531 1532 1533 1534 1535 1536 1537 1538 1539

static void virtio_queue_host_notifier_read(EventNotifier *n)
{
    VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
    if (event_notifier_test_and_clear(n)) {
        virtio_queue_notify_vq(vq);
    }
}

P
Paolo Bonzini 已提交
1540 1541
void virtio_queue_set_host_notifier_fd_handler(VirtQueue *vq, bool assign,
                                               bool set_handler)
1542
{
P
Paolo Bonzini 已提交
1543
    if (assign && set_handler) {
1544 1545 1546 1547
        event_notifier_set_handler(&vq->host_notifier,
                                   virtio_queue_host_notifier_read);
    } else {
        event_notifier_set_handler(&vq->host_notifier, NULL);
P
Paolo Bonzini 已提交
1548 1549
    }
    if (!assign) {
1550 1551 1552 1553 1554 1555
        /* Test and clear notifier before after disabling event,
         * in case poll callback didn't have time to run. */
        virtio_queue_host_notifier_read(&vq->host_notifier);
    }
}

1556 1557 1558 1559
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
{
    return &vq->host_notifier;
}
1560

1561 1562
void virtio_device_set_child_bus_name(VirtIODevice *vdev, char *bus_name)
{
1563
    g_free(vdev->bus_name);
1564
    vdev->bus_name = g_strdup(bus_name);
1565 1566
}

1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578
static void virtio_device_realize(DeviceState *dev, Error **errp)
{
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;

    if (vdc->realize != NULL) {
        vdc->realize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
1579
    }
J
Jason Wang 已提交
1580 1581 1582 1583 1584 1585

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

1588
static void virtio_device_unrealize(DeviceState *dev, Error **errp)
1589
{
1590
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
1591 1592
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;
1593

1594 1595
    virtio_bus_device_unplugged(vdev);

1596 1597 1598 1599 1600 1601
    if (vdc->unrealize != NULL) {
        vdc->unrealize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
1602
    }
1603

1604 1605
    g_free(vdev->bus_name);
    vdev->bus_name = NULL;
1606 1607
}

C
Cornelia Huck 已提交
1608 1609 1610 1611 1612
static Property virtio_properties[] = {
    DEFINE_VIRTIO_COMMON_FEATURES(VirtIODevice, host_features),
    DEFINE_PROP_END_OF_LIST(),
};

1613 1614 1615 1616
static void virtio_device_class_init(ObjectClass *klass, void *data)
{
    /* Set the default value here. */
    DeviceClass *dc = DEVICE_CLASS(klass);
1617 1618 1619

    dc->realize = virtio_device_realize;
    dc->unrealize = virtio_device_unrealize;
1620
    dc->bus_type = TYPE_VIRTIO_BUS;
C
Cornelia Huck 已提交
1621
    dc->props = virtio_properties;
1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638
}

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)