Statistics
| Branch: | Revision:

root / hw / virtio.c @ e4c7d2ae

History | View | Annotate | Download (20.8 kB)

1
/*
2
 * Virtio Support
3
 *
4
 * Copyright IBM, Corp. 2007
5
 *
6
 * Authors:
7
 *  Anthony Liguori   <aliguori@us.ibm.com>
8
 *
9
 * This work is licensed under the terms of the GNU GPL, version 2.  See
10
 * the COPYING file in the top-level directory.
11
 *
12
 */
13

    
14
#include <inttypes.h>
15

    
16
#include "virtio.h"
17
#include "sysemu.h"
18

    
19
/* The alignment to use between consumer and producer parts of vring.
20
 * x86 pagesize again. */
21
#define VIRTIO_PCI_VRING_ALIGN         4096
22

    
23
/* QEMU doesn't strictly need write barriers since everything runs in
24
 * lock-step.  We'll leave the calls to wmb() in though to make it obvious for
25
 * KVM or if kqemu gets SMP support.
26
 * In any case, we must prevent the compiler from reordering the code.
27
 * TODO: we likely need some rmb()/mb() as well.
28
 */
29

    
30
#define wmb() __asm__ __volatile__("": : :"memory")
31

    
32
typedef struct VRingDesc
33
{
34
    uint64_t addr;
35
    uint32_t len;
36
    uint16_t flags;
37
    uint16_t next;
38
} VRingDesc;
39

    
40
typedef struct VRingAvail
41
{
42
    uint16_t flags;
43
    uint16_t idx;
44
    uint16_t ring[0];
45
} VRingAvail;
46

    
47
typedef struct VRingUsedElem
48
{
49
    uint32_t id;
50
    uint32_t len;
51
} VRingUsedElem;
52

    
53
typedef struct VRingUsed
54
{
55
    uint16_t flags;
56
    uint16_t idx;
57
    VRingUsedElem ring[0];
58
} VRingUsed;
59

    
60
typedef struct VRing
61
{
62
    unsigned int num;
63
    target_phys_addr_t desc;
64
    target_phys_addr_t avail;
65
    target_phys_addr_t used;
66
} VRing;
67

    
68
struct VirtQueue
69
{
70
    VRing vring;
71
    target_phys_addr_t pa;
72
    uint16_t last_avail_idx;
73
    int inuse;
74
    uint16_t vector;
75
    void (*handle_output)(VirtIODevice *vdev, VirtQueue *vq);
76
    VirtIODevice *vdev;
77
    EventNotifier guest_notifier;
78
    EventNotifier host_notifier;
79
};
80

    
81
/* virt queue functions */
82
static void virtqueue_init(VirtQueue *vq)
83
{
84
    target_phys_addr_t pa = vq->pa;
85

    
86
    vq->vring.desc = pa;
87
    vq->vring.avail = pa + vq->vring.num * sizeof(VRingDesc);
88
    vq->vring.used = vring_align(vq->vring.avail +
89
                                 offsetof(VRingAvail, ring[vq->vring.num]),
90
                                 VIRTIO_PCI_VRING_ALIGN);
91
}
92

    
93
static inline uint64_t vring_desc_addr(target_phys_addr_t desc_pa, int i)
94
{
95
    target_phys_addr_t pa;
96
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, addr);
97
    return ldq_phys(pa);
98
}
99

    
100
static inline uint32_t vring_desc_len(target_phys_addr_t desc_pa, int i)
101
{
102
    target_phys_addr_t pa;
103
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, len);
104
    return ldl_phys(pa);
105
}
106

    
107
static inline uint16_t vring_desc_flags(target_phys_addr_t desc_pa, int i)
108
{
109
    target_phys_addr_t pa;
110
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, flags);
111
    return lduw_phys(pa);
112
}
113

    
114
static inline uint16_t vring_desc_next(target_phys_addr_t desc_pa, int i)
115
{
116
    target_phys_addr_t pa;
117
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, next);
118
    return lduw_phys(pa);
119
}
120

    
121
static inline uint16_t vring_avail_flags(VirtQueue *vq)
122
{
123
    target_phys_addr_t pa;
124
    pa = vq->vring.avail + offsetof(VRingAvail, flags);
125
    return lduw_phys(pa);
126
}
127

    
128
static inline uint16_t vring_avail_idx(VirtQueue *vq)
129
{
130
    target_phys_addr_t pa;
131
    pa = vq->vring.avail + offsetof(VRingAvail, idx);
132
    return lduw_phys(pa);
133
}
134

    
135
static inline uint16_t vring_avail_ring(VirtQueue *vq, int i)
136
{
137
    target_phys_addr_t pa;
138
    pa = vq->vring.avail + offsetof(VRingAvail, ring[i]);
139
    return lduw_phys(pa);
140
}
141

    
142
static inline void vring_used_ring_id(VirtQueue *vq, int i, uint32_t val)
143
{
144
    target_phys_addr_t pa;
145
    pa = vq->vring.used + offsetof(VRingUsed, ring[i].id);
146
    stl_phys(pa, val);
147
}
148

    
149
static inline void vring_used_ring_len(VirtQueue *vq, int i, uint32_t val)
150
{
151
    target_phys_addr_t pa;
152
    pa = vq->vring.used + offsetof(VRingUsed, ring[i].len);
153
    stl_phys(pa, val);
154
}
155

    
156
static uint16_t vring_used_idx(VirtQueue *vq)
157
{
158
    target_phys_addr_t pa;
159
    pa = vq->vring.used + offsetof(VRingUsed, idx);
160
    return lduw_phys(pa);
161
}
162

    
163
static inline void vring_used_idx_increment(VirtQueue *vq, uint16_t val)
164
{
165
    target_phys_addr_t pa;
166
    pa = vq->vring.used + offsetof(VRingUsed, idx);
167
    stw_phys(pa, vring_used_idx(vq) + val);
168
}
169

    
170
static inline void vring_used_flags_set_bit(VirtQueue *vq, int mask)
171
{
172
    target_phys_addr_t pa;
173
    pa = vq->vring.used + offsetof(VRingUsed, flags);
174
    stw_phys(pa, lduw_phys(pa) | mask);
175
}
176

    
177
static inline void vring_used_flags_unset_bit(VirtQueue *vq, int mask)
178
{
179
    target_phys_addr_t pa;
180
    pa = vq->vring.used + offsetof(VRingUsed, flags);
181
    stw_phys(pa, lduw_phys(pa) & ~mask);
182
}
183

    
184
void virtio_queue_set_notification(VirtQueue *vq, int enable)
185
{
186
    if (enable)
187
        vring_used_flags_unset_bit(vq, VRING_USED_F_NO_NOTIFY);
188
    else
189
        vring_used_flags_set_bit(vq, VRING_USED_F_NO_NOTIFY);
190
}
191

    
192
int virtio_queue_ready(VirtQueue *vq)
193
{
194
    return vq->vring.avail != 0;
195
}
196

    
197
int virtio_queue_empty(VirtQueue *vq)
198
{
199
    return vring_avail_idx(vq) == vq->last_avail_idx;
200
}
201

    
202
void virtqueue_fill(VirtQueue *vq, const VirtQueueElement *elem,
203
                    unsigned int len, unsigned int idx)
204
{
205
    unsigned int offset;
206
    int i;
207

    
208
    offset = 0;
209
    for (i = 0; i < elem->in_num; i++) {
210
        size_t size = MIN(len - offset, elem->in_sg[i].iov_len);
211

    
212
        cpu_physical_memory_unmap(elem->in_sg[i].iov_base,
213
                                  elem->in_sg[i].iov_len,
214
                                  1, size);
215

    
216
        offset += elem->in_sg[i].iov_len;
217
    }
218

    
219
    for (i = 0; i < elem->out_num; i++)
220
        cpu_physical_memory_unmap(elem->out_sg[i].iov_base,
221
                                  elem->out_sg[i].iov_len,
222
                                  0, elem->out_sg[i].iov_len);
223

    
224
    idx = (idx + vring_used_idx(vq)) % vq->vring.num;
225

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

    
231
void virtqueue_flush(VirtQueue *vq, unsigned int count)
232
{
233
    /* Make sure buffer is written before we update index. */
234
    wmb();
235
    vring_used_idx_increment(vq, count);
236
    vq->inuse -= count;
237
}
238

    
239
void virtqueue_push(VirtQueue *vq, const VirtQueueElement *elem,
240
                    unsigned int len)
241
{
242
    virtqueue_fill(vq, elem, len, 0);
243
    virtqueue_flush(vq, 1);
244
}
245

    
246
static int virtqueue_num_heads(VirtQueue *vq, unsigned int idx)
247
{
248
    uint16_t num_heads = vring_avail_idx(vq) - idx;
249

    
250
    /* Check it isn't doing very strange things with descriptor numbers. */
251
    if (num_heads > vq->vring.num) {
252
        fprintf(stderr, "Guest moved used index from %u to %u",
253
                idx, vring_avail_idx(vq));
254
        exit(1);
255
    }
256

    
257
    return num_heads;
258
}
259

    
260
static unsigned int virtqueue_get_head(VirtQueue *vq, unsigned int idx)
261
{
262
    unsigned int head;
263

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

    
268
    /* If their number is silly, that's a fatal mistake. */
269
    if (head >= vq->vring.num) {
270
        fprintf(stderr, "Guest says index %u is available", head);
271
        exit(1);
272
    }
273

    
274
    return head;
275
}
276

    
277
static unsigned virtqueue_next_desc(target_phys_addr_t desc_pa,
278
                                    unsigned int i, unsigned int max)
279
{
280
    unsigned int next;
281

    
282
    /* If this descriptor says it doesn't chain, we're done. */
283
    if (!(vring_desc_flags(desc_pa, i) & VRING_DESC_F_NEXT))
284
        return max;
285

    
286
    /* Check they're not leading us off end of descriptors. */
287
    next = vring_desc_next(desc_pa, i);
288
    /* Make sure compiler knows to grab that: we don't want it changing! */
289
    wmb();
290

    
291
    if (next >= max) {
292
        fprintf(stderr, "Desc next is %u", next);
293
        exit(1);
294
    }
295

    
296
    return next;
297
}
298

    
299
int virtqueue_avail_bytes(VirtQueue *vq, int in_bytes, int out_bytes)
300
{
301
    unsigned int idx;
302
    int total_bufs, in_total, out_total;
303

    
304
    idx = vq->last_avail_idx;
305

    
306
    total_bufs = in_total = out_total = 0;
307
    while (virtqueue_num_heads(vq, idx)) {
308
        unsigned int max, num_bufs, indirect = 0;
309
        target_phys_addr_t desc_pa;
310
        int i;
311

    
312
        max = vq->vring.num;
313
        num_bufs = total_bufs;
314
        i = virtqueue_get_head(vq, idx++);
315
        desc_pa = vq->vring.desc;
316

    
317
        if (vring_desc_flags(desc_pa, i) & VRING_DESC_F_INDIRECT) {
318
            if (vring_desc_len(desc_pa, i) % sizeof(VRingDesc)) {
319
                fprintf(stderr, "Invalid size for indirect buffer table\n");
320
                exit(1);
321
            }
322

    
323
            /* If we've got too many, that implies a descriptor loop. */
324
            if (num_bufs >= max) {
325
                fprintf(stderr, "Looped descriptor");
326
                exit(1);
327
            }
328

    
329
            /* loop over the indirect descriptor table */
330
            indirect = 1;
331
            max = vring_desc_len(desc_pa, i) / sizeof(VRingDesc);
332
            num_bufs = i = 0;
333
            desc_pa = vring_desc_addr(desc_pa, i);
334
        }
335

    
336
        do {
337
            /* If we've got too many, that implies a descriptor loop. */
338
            if (++num_bufs > max) {
339
                fprintf(stderr, "Looped descriptor");
340
                exit(1);
341
            }
342

    
343
            if (vring_desc_flags(desc_pa, i) & VRING_DESC_F_WRITE) {
344
                if (in_bytes > 0 &&
345
                    (in_total += vring_desc_len(desc_pa, i)) >= in_bytes)
346
                    return 1;
347
            } else {
348
                if (out_bytes > 0 &&
349
                    (out_total += vring_desc_len(desc_pa, i)) >= out_bytes)
350
                    return 1;
351
            }
352
        } while ((i = virtqueue_next_desc(desc_pa, i, max)) != max);
353

    
354
        if (!indirect)
355
            total_bufs = num_bufs;
356
        else
357
            total_bufs++;
358
    }
359

    
360
    return 0;
361
}
362

    
363
int virtqueue_pop(VirtQueue *vq, VirtQueueElement *elem)
364
{
365
    unsigned int i, head, max;
366
    target_phys_addr_t desc_pa = vq->vring.desc;
367
    target_phys_addr_t len;
368

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

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

    
375
    max = vq->vring.num;
376

    
377
    i = head = virtqueue_get_head(vq, vq->last_avail_idx++);
378

    
379
    if (vring_desc_flags(desc_pa, i) & VRING_DESC_F_INDIRECT) {
380
        if (vring_desc_len(desc_pa, i) % sizeof(VRingDesc)) {
381
            fprintf(stderr, "Invalid size for indirect buffer table\n");
382
            exit(1);
383
        }
384

    
385
        /* loop over the indirect descriptor table */
386
        max = vring_desc_len(desc_pa, i) / sizeof(VRingDesc);
387
        desc_pa = vring_desc_addr(desc_pa, i);
388
        i = 0;
389
    }
390

    
391
    do {
392
        struct iovec *sg;
393
        int is_write = 0;
394

    
395
        if (vring_desc_flags(desc_pa, i) & VRING_DESC_F_WRITE) {
396
            elem->in_addr[elem->in_num] = vring_desc_addr(desc_pa, i);
397
            sg = &elem->in_sg[elem->in_num++];
398
            is_write = 1;
399
        } else
400
            sg = &elem->out_sg[elem->out_num++];
401

    
402
        /* Grab the first descriptor, and check it's OK. */
403
        sg->iov_len = vring_desc_len(desc_pa, i);
404
        len = sg->iov_len;
405

    
406
        sg->iov_base = cpu_physical_memory_map(vring_desc_addr(desc_pa, i),
407
                                               &len, is_write);
408

    
409
        if (sg->iov_base == NULL || len != sg->iov_len) {
410
            fprintf(stderr, "virtio: trying to map MMIO memory\n");
411
            exit(1);
412
        }
413

    
414
        /* If we've got too many, that implies a descriptor loop. */
415
        if ((elem->in_num + elem->out_num) > max) {
416
            fprintf(stderr, "Looped descriptor");
417
            exit(1);
418
        }
419
    } while ((i = virtqueue_next_desc(desc_pa, i, max)) != max);
420

    
421
    elem->index = head;
422

    
423
    vq->inuse++;
424

    
425
    return elem->in_num + elem->out_num;
426
}
427

    
428
/* virtio device */
429
static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
430
{
431
    if (vdev->binding->notify) {
432
        vdev->binding->notify(vdev->binding_opaque, vector);
433
    }
434
}
435

    
436
void virtio_update_irq(VirtIODevice *vdev)
437
{
438
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
439
}
440

    
441
void virtio_reset(void *opaque)
442
{
443
    VirtIODevice *vdev = opaque;
444
    int i;
445

    
446
    if (vdev->reset)
447
        vdev->reset(vdev);
448

    
449
    vdev->guest_features = 0;
450
    vdev->queue_sel = 0;
451
    vdev->status = 0;
452
    vdev->isr = 0;
453
    vdev->config_vector = VIRTIO_NO_VECTOR;
454
    virtio_notify_vector(vdev, vdev->config_vector);
455

    
456
    for(i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
457
        vdev->vq[i].vring.desc = 0;
458
        vdev->vq[i].vring.avail = 0;
459
        vdev->vq[i].vring.used = 0;
460
        vdev->vq[i].last_avail_idx = 0;
461
        vdev->vq[i].pa = 0;
462
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
463
    }
464
}
465

    
466
uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
467
{
468
    uint8_t val;
469

    
470
    vdev->get_config(vdev, vdev->config);
471

    
472
    if (addr > (vdev->config_len - sizeof(val)))
473
        return (uint32_t)-1;
474

    
475
    memcpy(&val, vdev->config + addr, sizeof(val));
476
    return val;
477
}
478

    
479
uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr)
480
{
481
    uint16_t val;
482

    
483
    vdev->get_config(vdev, vdev->config);
484

    
485
    if (addr > (vdev->config_len - sizeof(val)))
486
        return (uint32_t)-1;
487

    
488
    memcpy(&val, vdev->config + addr, sizeof(val));
489
    return val;
490
}
491

    
492
uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr)
493
{
494
    uint32_t val;
495

    
496
    vdev->get_config(vdev, vdev->config);
497

    
498
    if (addr > (vdev->config_len - sizeof(val)))
499
        return (uint32_t)-1;
500

    
501
    memcpy(&val, vdev->config + addr, sizeof(val));
502
    return val;
503
}
504

    
505
void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data)
506
{
507
    uint8_t val = data;
508

    
509
    if (addr > (vdev->config_len - sizeof(val)))
510
        return;
511

    
512
    memcpy(vdev->config + addr, &val, sizeof(val));
513

    
514
    if (vdev->set_config)
515
        vdev->set_config(vdev, vdev->config);
516
}
517

    
518
void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data)
519
{
520
    uint16_t val = data;
521

    
522
    if (addr > (vdev->config_len - sizeof(val)))
523
        return;
524

    
525
    memcpy(vdev->config + addr, &val, sizeof(val));
526

    
527
    if (vdev->set_config)
528
        vdev->set_config(vdev, vdev->config);
529
}
530

    
531
void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
532
{
533
    uint32_t val = data;
534

    
535
    if (addr > (vdev->config_len - sizeof(val)))
536
        return;
537

    
538
    memcpy(vdev->config + addr, &val, sizeof(val));
539

    
540
    if (vdev->set_config)
541
        vdev->set_config(vdev, vdev->config);
542
}
543

    
544
void virtio_queue_set_addr(VirtIODevice *vdev, int n, target_phys_addr_t addr)
545
{
546
    vdev->vq[n].pa = addr;
547
    virtqueue_init(&vdev->vq[n]);
548
}
549

    
550
target_phys_addr_t virtio_queue_get_addr(VirtIODevice *vdev, int n)
551
{
552
    return vdev->vq[n].pa;
553
}
554

    
555
int virtio_queue_get_num(VirtIODevice *vdev, int n)
556
{
557
    return vdev->vq[n].vring.num;
558
}
559

    
560
void virtio_queue_notify(VirtIODevice *vdev, int n)
561
{
562
    if (n < VIRTIO_PCI_QUEUE_MAX && vdev->vq[n].vring.desc) {
563
        vdev->vq[n].handle_output(vdev, &vdev->vq[n]);
564
    }
565
}
566

    
567
uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
568
{
569
    return n < VIRTIO_PCI_QUEUE_MAX ? vdev->vq[n].vector :
570
        VIRTIO_NO_VECTOR;
571
}
572

    
573
void virtio_queue_set_vector(VirtIODevice *vdev, int n, uint16_t vector)
574
{
575
    if (n < VIRTIO_PCI_QUEUE_MAX)
576
        vdev->vq[n].vector = vector;
577
}
578

    
579
VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
580
                            void (*handle_output)(VirtIODevice *, VirtQueue *))
581
{
582
    int i;
583

    
584
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
585
        if (vdev->vq[i].vring.num == 0)
586
            break;
587
    }
588

    
589
    if (i == VIRTIO_PCI_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
590
        abort();
591

    
592
    vdev->vq[i].vring.num = queue_size;
593
    vdev->vq[i].handle_output = handle_output;
594

    
595
    return &vdev->vq[i];
596
}
597

    
598
void virtio_irq(VirtQueue *vq)
599
{
600
    vq->vdev->isr |= 0x01;
601
    virtio_notify_vector(vq->vdev, vq->vector);
602
}
603

    
604
void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
605
{
606
    /* Always notify when queue is empty (when feature acknowledge) */
607
    if ((vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT) &&
608
        (!(vdev->guest_features & (1 << VIRTIO_F_NOTIFY_ON_EMPTY)) ||
609
         (vq->inuse || vring_avail_idx(vq) != vq->last_avail_idx)))
610
        return;
611

    
612
    vdev->isr |= 0x01;
613
    virtio_notify_vector(vdev, vq->vector);
614
}
615

    
616
void virtio_notify_config(VirtIODevice *vdev)
617
{
618
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
619
        return;
620

    
621
    vdev->isr |= 0x03;
622
    virtio_notify_vector(vdev, vdev->config_vector);
623
}
624

    
625
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
626
{
627
    int i;
628

    
629
    if (vdev->binding->save_config)
630
        vdev->binding->save_config(vdev->binding_opaque, f);
631

    
632
    qemu_put_8s(f, &vdev->status);
633
    qemu_put_8s(f, &vdev->isr);
634
    qemu_put_be16s(f, &vdev->queue_sel);
635
    qemu_put_be32s(f, &vdev->guest_features);
636
    qemu_put_be32(f, vdev->config_len);
637
    qemu_put_buffer(f, vdev->config, vdev->config_len);
638

    
639
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
640
        if (vdev->vq[i].vring.num == 0)
641
            break;
642
    }
643

    
644
    qemu_put_be32(f, i);
645

    
646
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
647
        if (vdev->vq[i].vring.num == 0)
648
            break;
649

    
650
        qemu_put_be32(f, vdev->vq[i].vring.num);
651
        qemu_put_be64(f, vdev->vq[i].pa);
652
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
653
        if (vdev->binding->save_queue)
654
            vdev->binding->save_queue(vdev->binding_opaque, i, f);
655
    }
656
}
657

    
658
int virtio_load(VirtIODevice *vdev, QEMUFile *f)
659
{
660
    int num, i, ret;
661
    uint32_t features;
662
    uint32_t supported_features =
663
        vdev->binding->get_features(vdev->binding_opaque);
664

    
665
    if (vdev->binding->load_config) {
666
        ret = vdev->binding->load_config(vdev->binding_opaque, f);
667
        if (ret)
668
            return ret;
669
    }
670

    
671
    qemu_get_8s(f, &vdev->status);
672
    qemu_get_8s(f, &vdev->isr);
673
    qemu_get_be16s(f, &vdev->queue_sel);
674
    qemu_get_be32s(f, &features);
675
    if (features & ~supported_features) {
676
        fprintf(stderr, "Features 0x%x unsupported. Allowed features: 0x%x\n",
677
                features, supported_features);
678
        return -1;
679
    }
680
    if (vdev->set_features)
681
        vdev->set_features(vdev, features);
682
    vdev->guest_features = features;
683
    vdev->config_len = qemu_get_be32(f);
684
    qemu_get_buffer(f, vdev->config, vdev->config_len);
685

    
686
    num = qemu_get_be32(f);
687

    
688
    for (i = 0; i < num; i++) {
689
        vdev->vq[i].vring.num = qemu_get_be32(f);
690
        vdev->vq[i].pa = qemu_get_be64(f);
691
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
692

    
693
        if (vdev->vq[i].pa) {
694
            virtqueue_init(&vdev->vq[i]);
695
        }
696
        if (vdev->binding->load_queue) {
697
            ret = vdev->binding->load_queue(vdev->binding_opaque, i, f);
698
            if (ret)
699
                return ret;
700
        }
701
    }
702

    
703
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
704
    return 0;
705
}
706

    
707
void virtio_cleanup(VirtIODevice *vdev)
708
{
709
    if (vdev->config)
710
        qemu_free(vdev->config);
711
    qemu_free(vdev->vq);
712
}
713

    
714
VirtIODevice *virtio_common_init(const char *name, uint16_t device_id,
715
                                 size_t config_size, size_t struct_size)
716
{
717
    VirtIODevice *vdev;
718
    int i;
719

    
720
    vdev = qemu_mallocz(struct_size);
721

    
722
    vdev->device_id = device_id;
723
    vdev->status = 0;
724
    vdev->isr = 0;
725
    vdev->queue_sel = 0;
726
    vdev->config_vector = VIRTIO_NO_VECTOR;
727
    vdev->vq = qemu_mallocz(sizeof(VirtQueue) * VIRTIO_PCI_QUEUE_MAX);
728
    for(i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
729
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
730
        vdev->vq[i].vdev = vdev;
731
    }
732

    
733
    vdev->name = name;
734
    vdev->config_len = config_size;
735
    if (vdev->config_len)
736
        vdev->config = qemu_mallocz(config_size);
737
    else
738
        vdev->config = NULL;
739

    
740
    return vdev;
741
}
742

    
743
void virtio_bind_device(VirtIODevice *vdev, const VirtIOBindings *binding,
744
                        void *opaque)
745
{
746
    vdev->binding = binding;
747
    vdev->binding_opaque = opaque;
748
}
749

    
750
target_phys_addr_t virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
751
{
752
    return vdev->vq[n].vring.desc;
753
}
754

    
755
target_phys_addr_t virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
756
{
757
    return vdev->vq[n].vring.avail;
758
}
759

    
760
target_phys_addr_t virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
761
{
762
    return vdev->vq[n].vring.used;
763
}
764

    
765
target_phys_addr_t virtio_queue_get_ring_addr(VirtIODevice *vdev, int n)
766
{
767
    return vdev->vq[n].vring.desc;
768
}
769

    
770
target_phys_addr_t virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
771
{
772
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
773
}
774

    
775
target_phys_addr_t virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
776
{
777
    return offsetof(VRingAvail, ring) +
778
        sizeof(uint64_t) * vdev->vq[n].vring.num;
779
}
780

    
781
target_phys_addr_t virtio_queue_get_used_size(VirtIODevice *vdev, int n)
782
{
783
    return offsetof(VRingUsed, ring) +
784
        sizeof(VRingUsedElem) * vdev->vq[n].vring.num;
785
}
786

    
787
target_phys_addr_t virtio_queue_get_ring_size(VirtIODevice *vdev, int n)
788
{
789
    return vdev->vq[n].vring.used - vdev->vq[n].vring.desc +
790
            virtio_queue_get_used_size(vdev, n);
791
}
792

    
793
uint16_t virtio_queue_get_last_avail_idx(VirtIODevice *vdev, int n)
794
{
795
    return vdev->vq[n].last_avail_idx;
796
}
797

    
798
void virtio_queue_set_last_avail_idx(VirtIODevice *vdev, int n, uint16_t idx)
799
{
800
    vdev->vq[n].last_avail_idx = idx;
801
}
802

    
803
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
804
{
805
    return vdev->vq + n;
806
}
807

    
808
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
809
{
810
    return &vq->guest_notifier;
811
}
812
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
813
{
814
    return &vq->host_notifier;
815
}