virtio.c 44.6 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;
C
Cornelia Huck 已提交
63
    unsigned int num_default;
64
    unsigned int align;
A
Avi Kivity 已提交
65 66 67
    hwaddr desc;
    hwaddr avail;
    hwaddr used;
A
aliguori 已提交
68 69 70 71 72 73
} VRing;

struct VirtQueue
{
    VRing vring;
    uint16_t last_avail_idx;
M
Michael S. Tsirkin 已提交
74 75 76 77 78 79 80 81 82
    /* 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;

83 84
    uint16_t queue_index;

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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;

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

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

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

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

266 267 268 269 270
    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 已提交
271 272 273 274 275 276 277 278 279
    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 已提交
280
    uint16_t old, new;
A
aliguori 已提交
281
    /* Make sure buffer is written before we update index. */
282
    smp_wmb();
283
    trace_virtqueue_flush(vq, count);
M
Michael S. Tsirkin 已提交
284 285 286
    old = vring_used_idx(vq);
    new = old + count;
    vring_used_idx_set(vq, new);
A
aliguori 已提交
287
    vq->inuse -= count;
M
Michael S. Tsirkin 已提交
288 289
    if (unlikely((int16_t)(new - vq->signalled_used) < (uint16_t)(new - old)))
        vq->signalled_used_valid = false;
A
aliguori 已提交
290 291 292 293 294 295 296 297 298 299 300 301 302 303
}

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

    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 已提交
327
    if (head >= vq->vring.num) {
328
        error_report("Guest says index %u is available", head);
A
aliguori 已提交
329 330
        exit(1);
    }
A
aliguori 已提交
331 332 333 334

    return head;
}

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

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

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

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

    return next;
}

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

    idx = vq->last_avail_idx;

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

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

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

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

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

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

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

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

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

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

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

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

K
Kevin Wolf 已提交
450 451 452 453
    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 已提交
454
            error_report("virtio: error trying to map MMIO memory");
K
Kevin Wolf 已提交
455 456 457 458 459
            exit(1);
        }
    }
}

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

    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;

472 473
    max = vq->vring.num;

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

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

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

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

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

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

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

K
Kevin Wolf 已提交
520 521 522 523
    /* 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 已提交
524 525 526 527
    elem->index = head;

    vq->inuse++;

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

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

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

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

548 549 550 551 552 553 554 555 556 557 558 559
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)
560
{
561
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
562 563
    trace_virtio_set_status(vdev, val);

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

729 730 731
    if (k->set_config) {
        k->set_config(vdev, vdev->config);
    }
A
aliguori 已提交
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 828 829
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 已提交
830
void virtio_queue_set_addr(VirtIODevice *vdev, int n, hwaddr addr)
A
aliguori 已提交
831
{
832 833
    vdev->vq[n].vring.desc = addr;
    virtio_queue_update_rings(vdev, n);
P
Paul Brook 已提交
834 835
}

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

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

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

877 878 879 880
int virtio_get_num_queues(VirtIODevice *vdev)
{
    int i;

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

    return i;
}

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

897 898 899 900 901
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);

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

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

922 923 924 925 926
        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
        vq->handle_output(vdev, vq);
    }
}

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

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

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

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

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

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

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

    vdev->vq[i].vring.num = queue_size;
C
Cornelia Huck 已提交
969
    vdev->vq[i].vring.num_default = queue_size;
970
    vdev->vq[i].vring.align = VIRTIO_PCI_VRING_ALIGN;
A
aliguori 已提交
971 972 973 974 975
    vdev->vq[i].handle_output = handle_output;

    return &vdev->vq[i];
}

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

    vdev->vq[n].vring.num = 0;
C
Cornelia Huck 已提交
983
    vdev->vq[n].vring.num_default = 0;
984 985
}

986 987
void virtio_irq(VirtQueue *vq)
{
988
    trace_virtio_irq(vq);
989 990 991 992
    vq->vdev->isr |= 0x01;
    virtio_notify_vector(vq->vdev, vq->vector);
}

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

1005
    if (!virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
M
Michael S. Tsirkin 已提交
1006 1007 1008 1009 1010 1011 1012
        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);
1013
    return !v || vring_need_event(vring_get_used_event(vq), new, old);
M
Michael S. Tsirkin 已提交
1014 1015 1016 1017 1018
}

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

1022
    trace_virtio_notify(vdev, vq);
A
aliguori 已提交
1023
    vdev->isr |= 0x01;
1024
    virtio_notify_vector(vdev, vq->vector);
A
aliguori 已提交
1025 1026 1027 1028
}

void virtio_notify_config(VirtIODevice *vdev)
{
1029 1030 1031
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
        return;

A
aliguori 已提交
1032
    vdev->isr |= 0x03;
1033
    vdev->generation++;
1034
    virtio_notify_vector(vdev, vdev->config_vector);
A
aliguori 已提交
1035 1036
}

1037 1038 1039 1040 1041
static bool virtio_device_endian_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    assert(vdev->device_endian != VIRTIO_DEVICE_ENDIAN_UNKNOWN);
1042
    if (!virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1043 1044 1045 1046
        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;
1047 1048
}

G
Gerd Hoffmann 已提交
1049 1050 1051 1052 1053 1054 1055
static bool virtio_64bit_features_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

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

J
Jason Wang 已提交
1056 1057 1058 1059 1060 1061 1062
static bool virtio_virtqueue_needed(void *opaque)
{
    VirtIODevice *vdev = opaque;

    return virtio_host_has_feature(vdev, VIRTIO_F_VERSION_1);
}

C
Cornelia Huck 已提交
1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075
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;
}

J
Jason Wang 已提交
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 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123
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()
    }
};

C
Cornelia Huck 已提交
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
static void put_ringsize_state(QEMUFile *f, void *pv, size_t size)
{
    VirtIODevice *vdev = pv;
    int i;

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

static int get_ringsize_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.num_default = qemu_get_be32(f);
    }
    return 0;
}

static VMStateInfo vmstate_info_ringsize = {
    .name = "ringsize_state",
    .get = get_ringsize_state,
    .put = put_ringsize_state,
};

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

1170 1171 1172 1173
static const VMStateDescription vmstate_virtio_device_endian = {
    .name = "virtio/device_endian",
    .version_id = 1,
    .minimum_version_id = 1,
1174
    .needed = &virtio_device_endian_needed,
1175 1176 1177 1178 1179 1180
    .fields = (VMStateField[]) {
        VMSTATE_UINT8(device_endian, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

G
Gerd Hoffmann 已提交
1181 1182 1183 1184
static const VMStateDescription vmstate_virtio_64bit_features = {
    .name = "virtio/64bit_features",
    .version_id = 1,
    .minimum_version_id = 1,
1185
    .needed = &virtio_64bit_features_needed,
G
Gerd Hoffmann 已提交
1186 1187 1188 1189 1190 1191
    .fields = (VMStateField[]) {
        VMSTATE_UINT64(guest_features, VirtIODevice),
        VMSTATE_END_OF_LIST()
    }
};

1192 1193 1194 1195 1196 1197 1198
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()
1199
    },
1200 1201 1202
    .subsections = (const VMStateDescription*[]) {
        &vmstate_virtio_device_endian,
        &vmstate_virtio_64bit_features,
J
Jason Wang 已提交
1203
        &vmstate_virtio_virtqueues,
C
Cornelia Huck 已提交
1204
        &vmstate_virtio_ringsize,
1205
        NULL
1206 1207 1208
    }
};

A
aliguori 已提交
1209 1210
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
{
K
KONRAD Frederic 已提交
1211 1212
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1213
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
G
Gerd Hoffmann 已提交
1214
    uint32_t guest_features_lo = (vdev->guest_features & 0xffffffff);
A
aliguori 已提交
1215 1216
    int i;

K
KONRAD Frederic 已提交
1217 1218 1219
    if (k->save_config) {
        k->save_config(qbus->parent, f);
    }
A
aliguori 已提交
1220 1221 1222 1223

    qemu_put_8s(f, &vdev->status);
    qemu_put_8s(f, &vdev->isr);
    qemu_put_be16s(f, &vdev->queue_sel);
G
Gerd Hoffmann 已提交
1224
    qemu_put_be32s(f, &guest_features_lo);
A
aliguori 已提交
1225 1226 1227
    qemu_put_be32(f, vdev->config_len);
    qemu_put_buffer(f, vdev->config, vdev->config_len);

1228
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1229 1230 1231 1232 1233 1234
        if (vdev->vq[i].vring.num == 0)
            break;
    }

    qemu_put_be32(f, i);

1235
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
A
aliguori 已提交
1236 1237 1238 1239
        if (vdev->vq[i].vring.num == 0)
            break;

        qemu_put_be32(f, vdev->vq[i].vring.num);
1240 1241 1242
        if (k->has_variable_vring_alignment) {
            qemu_put_be32(f, vdev->vq[i].vring.align);
        }
1243 1244
        /* XXX virtio-1 devices */
        qemu_put_be64(f, vdev->vq[i].vring.desc);
A
aliguori 已提交
1245
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
K
KONRAD Frederic 已提交
1246 1247 1248
        if (k->save_queue) {
            k->save_queue(qbus->parent, i, f);
        }
A
aliguori 已提交
1249
    }
1250 1251 1252 1253

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

    /* Subsections */
1256
    vmstate_save_state(f, &vmstate_virtio, vdev, NULL);
A
aliguori 已提交
1257 1258
}

1259
static int virtio_set_features_nocheck(VirtIODevice *vdev, uint64_t val)
1260
{
1261
    VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
C
Cornelia Huck 已提交
1262
    bool bad = (val & ~(vdev->host_features)) != 0;
1263

C
Cornelia Huck 已提交
1264
    val &= vdev->host_features;
1265 1266
    if (k->set_features) {
        k->set_features(vdev, val);
1267 1268 1269 1270 1271
    }
    vdev->guest_features = val;
    return bad ? -1 : 0;
}

1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283
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);
}

1284
int virtio_load(VirtIODevice *vdev, QEMUFile *f, int version_id)
A
aliguori 已提交
1285
{
1286
    int i, ret;
1287
    int32_t config_len;
1288
    uint32_t num;
1289
    uint32_t features;
K
KONRAD Frederic 已提交
1290 1291
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1292
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
A
aliguori 已提交
1293

1294 1295 1296 1297 1298 1299
    /*
     * 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 已提交
1300 1301
    if (k->load_config) {
        ret = k->load_config(qbus->parent, f);
1302 1303 1304
        if (ret)
            return ret;
    }
A
aliguori 已提交
1305 1306 1307 1308

    qemu_get_8s(f, &vdev->status);
    qemu_get_8s(f, &vdev->isr);
    qemu_get_be16s(f, &vdev->queue_sel);
1309
    if (vdev->queue_sel >= VIRTIO_QUEUE_MAX) {
1310 1311
        return -1;
    }
1312
    qemu_get_be32s(f, &features);
1313

1314
    config_len = qemu_get_be32(f);
1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325

    /*
     * 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--;
1326
    }
A
aliguori 已提交
1327 1328 1329

    num = qemu_get_be32(f);

1330
    if (num > VIRTIO_QUEUE_MAX) {
1331 1332 1333 1334
        error_report("Invalid number of PCI queues: 0x%x", num);
        return -1;
    }

A
aliguori 已提交
1335 1336
    for (i = 0; i < num; i++) {
        vdev->vq[i].vring.num = qemu_get_be32(f);
1337 1338 1339
        if (k->has_variable_vring_alignment) {
            vdev->vq[i].vring.align = qemu_get_be32(f);
        }
1340
        vdev->vq[i].vring.desc = qemu_get_be64(f);
A
aliguori 已提交
1341
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
M
Michael S. Tsirkin 已提交
1342 1343
        vdev->vq[i].signalled_used_valid = false;
        vdev->vq[i].notification = true;
A
aliguori 已提交
1344

1345 1346 1347
        if (vdev->vq[i].vring.desc) {
            /* XXX virtio-1 devices */
            virtio_queue_update_rings(vdev, i);
M
Michael S. Tsirkin 已提交
1348 1349
        } else if (vdev->vq[i].last_avail_idx) {
            error_report("VQ %d address 0x0 "
1350
                         "inconsistent with Host index 0x%x",
M
Michael S. Tsirkin 已提交
1351 1352
                         i, vdev->vq[i].last_avail_idx);
                return -1;
1353
	}
K
KONRAD Frederic 已提交
1354 1355
        if (k->load_queue) {
            ret = k->load_queue(qbus->parent, i, f);
1356 1357
            if (ret)
                return ret;
1358
        }
A
aliguori 已提交
1359 1360
    }

1361
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
1362 1363

    if (vdc->load != NULL) {
1364 1365 1366 1367
        ret = vdc->load(vdev, f, version_id);
        if (ret) {
            return ret;
        }
1368 1369
    }

1370 1371 1372 1373 1374 1375 1376 1377 1378 1379
    /* 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 已提交
1380 1381 1382 1383 1384 1385 1386
    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;
1387
        if (virtio_set_features_nocheck(vdev, features64) < 0) {
G
Gerd Hoffmann 已提交
1388 1389 1390 1391 1392 1393
            error_report("Features 0x%" PRIx64 " unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features64, vdev->host_features);
            return -1;
        }
    } else {
1394
        if (virtio_set_features_nocheck(vdev, features) < 0) {
G
Gerd Hoffmann 已提交
1395 1396 1397 1398 1399 1400 1401
            error_report("Features 0x%x unsupported. "
                         "Allowed features: 0x%" PRIx64,
                         features, vdev->host_features);
            return -1;
        }
    }

1402
    for (i = 0; i < num; i++) {
1403
        if (vdev->vq[i].vring.desc) {
1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418
            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 已提交
1419 1420
}

1421
void virtio_cleanup(VirtIODevice *vdev)
1422
{
1423
    qemu_del_vm_change_state_handler(vdev->vmstate);
1424
    g_free(vdev->config);
1425
    g_free(vdev->vq);
1426
    g_free(vdev->vector_queues);
1427 1428
}

1429
static void virtio_vmstate_change(void *opaque, int running, RunState state)
1430 1431
{
    VirtIODevice *vdev = opaque;
K
KONRAD Frederic 已提交
1432 1433
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1434
    bool backend_run = running && (vdev->status & VIRTIO_CONFIG_S_DRIVER_OK);
1435
    vdev->vm_running = running;
1436 1437 1438 1439 1440

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

K
KONRAD Frederic 已提交
1441 1442
    if (k->vmstate_change) {
        k->vmstate_change(qbus->parent, backend_run);
1443 1444 1445 1446 1447 1448 1449
    }

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

1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460
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);
}

1461 1462
void virtio_init(VirtIODevice *vdev, const char *name,
                 uint16_t device_id, size_t config_size)
A
aliguori 已提交
1463
{
1464 1465
    BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
    VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1466
    int i;
1467 1468 1469 1470 1471 1472 1473
    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 已提交
1474
    vdev->device_id = device_id;
A
aliguori 已提交
1475 1476 1477
    vdev->status = 0;
    vdev->isr = 0;
    vdev->queue_sel = 0;
1478
    vdev->config_vector = VIRTIO_NO_VECTOR;
1479
    vdev->vq = g_malloc0(sizeof(VirtQueue) * VIRTIO_QUEUE_MAX);
1480
    vdev->vm_running = runstate_is_running();
1481
    for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1482
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
1483
        vdev->vq[i].vdev = vdev;
1484
        vdev->vq[i].queue_index = i;
1485
    }
A
aliguori 已提交
1486 1487 1488

    vdev->name = name;
    vdev->config_len = config_size;
1489
    if (vdev->config_len) {
1490
        vdev->config = g_malloc0(config_size);
1491
    } else {
A
aliguori 已提交
1492
        vdev->config = NULL;
1493 1494 1495
    }
    vdev->vmstate = qemu_add_vm_change_state_handler(virtio_vmstate_change,
                                                     vdev);
1496
    vdev->device_endian = virtio_default_endian();
1497
}
A
aliguori 已提交
1498

A
Avi Kivity 已提交
1499
hwaddr virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
1500 1501 1502 1503
{
    return vdev->vq[n].vring.desc;
}

A
Avi Kivity 已提交
1504
hwaddr virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
1505 1506 1507 1508
{
    return vdev->vq[n].vring.avail;
}

A
Avi Kivity 已提交
1509
hwaddr virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
1510 1511 1512 1513
{
    return vdev->vq[n].vring.used;
}

A
Avi Kivity 已提交
1514
hwaddr virtio_queue_get_ring_addr(VirtIODevice *vdev, int n)
1515 1516 1517 1518
{
    return vdev->vq[n].vring.desc;
}

A
Avi Kivity 已提交
1519
hwaddr virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
1520 1521 1522 1523
{
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
}

A
Avi Kivity 已提交
1524
hwaddr virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
1525 1526
{
    return offsetof(VRingAvail, ring) +
1527
        sizeof(uint16_t) * vdev->vq[n].vring.num;
1528 1529
}

A
Avi Kivity 已提交
1530
hwaddr virtio_queue_get_used_size(VirtIODevice *vdev, int n)
1531 1532 1533 1534 1535
{
    return offsetof(VRingUsed, ring) +
        sizeof(VRingUsedElem) * vdev->vq[n].vring.num;
}

A
Avi Kivity 已提交
1536
hwaddr virtio_queue_get_ring_size(VirtIODevice *vdev, int n)
1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551
{
    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;
}

1552 1553 1554 1555 1556
void virtio_queue_invalidate_signalled_used(VirtIODevice *vdev, int n)
{
    vdev->vq[n].signalled_used_valid = false;
}

1557 1558 1559 1560 1561
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
{
    return vdev->vq + n;
}

1562 1563 1564 1565 1566
uint16_t virtio_get_queue_index(VirtQueue *vq)
{
    return vq->queue_index;
}

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

1591 1592 1593 1594
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
{
    return &vq->guest_notifier;
}
1595 1596 1597 1598 1599 1600 1601 1602 1603

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 已提交
1604 1605
void virtio_queue_set_host_notifier_fd_handler(VirtQueue *vq, bool assign,
                                               bool set_handler)
1606
{
P
Paolo Bonzini 已提交
1607
    if (assign && set_handler) {
1608 1609 1610 1611
        event_notifier_set_handler(&vq->host_notifier,
                                   virtio_queue_host_notifier_read);
    } else {
        event_notifier_set_handler(&vq->host_notifier, NULL);
P
Paolo Bonzini 已提交
1612 1613
    }
    if (!assign) {
1614 1615 1616 1617 1618 1619
        /* 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);
    }
}

1620 1621 1622 1623
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
{
    return &vq->host_notifier;
}
1624

1625 1626
void virtio_device_set_child_bus_name(VirtIODevice *vdev, char *bus_name)
{
1627
    g_free(vdev->bus_name);
1628
    vdev->bus_name = g_strdup(bus_name);
1629 1630
}

1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642
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;
        }
1643
    }
J
Jason Wang 已提交
1644 1645 1646 1647 1648 1649

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

1652
static void virtio_device_unrealize(DeviceState *dev, Error **errp)
1653
{
1654
    VirtIODevice *vdev = VIRTIO_DEVICE(dev);
1655 1656
    VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
    Error *err = NULL;
1657

1658 1659
    virtio_bus_device_unplugged(vdev);

1660 1661 1662 1663 1664 1665
    if (vdc->unrealize != NULL) {
        vdc->unrealize(dev, &err);
        if (err != NULL) {
            error_propagate(errp, err);
            return;
        }
1666
    }
1667

1668 1669
    g_free(vdev->bus_name);
    vdev->bus_name = NULL;
1670 1671
}

C
Cornelia Huck 已提交
1672 1673 1674 1675 1676
static Property virtio_properties[] = {
    DEFINE_VIRTIO_COMMON_FEATURES(VirtIODevice, host_features),
    DEFINE_PROP_END_OF_LIST(),
};

1677 1678 1679 1680
static void virtio_device_class_init(ObjectClass *klass, void *data)
{
    /* Set the default value here. */
    DeviceClass *dc = DEVICE_CLASS(klass);
1681 1682 1683

    dc->realize = virtio_device_realize;
    dc->unrealize = virtio_device_unrealize;
1684
    dc->bus_type = TYPE_VIRTIO_BUS;
C
Cornelia Huck 已提交
1685
    dc->props = virtio_properties;
1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702
}

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)