]>
git.proxmox.com Git - mirror_qemu.git/blob - tests/libqos/virtio.c
4 * Copyright (c) 2014 Marc MarĂ
6 * This work is licensed under the terms of the GNU GPL, version 2 or later.
7 * See the COPYING file in the top-level directory.
12 #include "libqos/virtio.h"
14 uint8_t qvirtio_config_readb(const QVirtioBus
*bus
, QVirtioDevice
*d
,
17 return bus
->config_readb(d
, addr
);
20 uint16_t qvirtio_config_readw(const QVirtioBus
*bus
, QVirtioDevice
*d
,
23 return bus
->config_readw(d
, addr
);
26 uint32_t qvirtio_config_readl(const QVirtioBus
*bus
, QVirtioDevice
*d
,
29 return bus
->config_readl(d
, addr
);
32 uint64_t qvirtio_config_readq(const QVirtioBus
*bus
, QVirtioDevice
*d
,
35 return bus
->config_readq(d
, addr
);
38 uint32_t qvirtio_get_features(const QVirtioBus
*bus
, QVirtioDevice
*d
)
40 return bus
->get_features(d
);
43 void qvirtio_set_features(const QVirtioBus
*bus
, QVirtioDevice
*d
,
46 bus
->set_features(d
, features
);
49 QVirtQueue
*qvirtqueue_setup(const QVirtioBus
*bus
, QVirtioDevice
*d
,
50 QGuestAllocator
*alloc
, uint16_t index
)
52 return bus
->virtqueue_setup(d
, alloc
, index
);
55 void qvirtio_reset(const QVirtioBus
*bus
, QVirtioDevice
*d
)
57 bus
->set_status(d
, QVIRTIO_RESET
);
58 g_assert_cmphex(bus
->get_status(d
), ==, QVIRTIO_RESET
);
61 void qvirtio_set_acknowledge(const QVirtioBus
*bus
, QVirtioDevice
*d
)
63 bus
->set_status(d
, bus
->get_status(d
) | QVIRTIO_ACKNOWLEDGE
);
64 g_assert_cmphex(bus
->get_status(d
), ==, QVIRTIO_ACKNOWLEDGE
);
67 void qvirtio_set_driver(const QVirtioBus
*bus
, QVirtioDevice
*d
)
69 bus
->set_status(d
, bus
->get_status(d
) | QVIRTIO_DRIVER
);
70 g_assert_cmphex(bus
->get_status(d
), ==,
71 QVIRTIO_DRIVER
| QVIRTIO_ACKNOWLEDGE
);
74 void qvirtio_set_driver_ok(const QVirtioBus
*bus
, QVirtioDevice
*d
)
76 bus
->set_status(d
, bus
->get_status(d
) | QVIRTIO_DRIVER_OK
);
77 g_assert_cmphex(bus
->get_status(d
), ==,
78 QVIRTIO_DRIVER_OK
| QVIRTIO_DRIVER
| QVIRTIO_ACKNOWLEDGE
);
81 bool qvirtio_wait_isr(const QVirtioBus
*bus
, QVirtioDevice
*d
, uint8_t mask
,
86 if (bus
->get_isr_status(d
) & mask
) {
87 break; /* It has ended */
94 void qvring_init(const QGuestAllocator
*alloc
, QVirtQueue
*vq
, uint64_t addr
)
99 vq
->avail
= vq
->desc
+ vq
->size
*sizeof(QVRingDesc
);
100 vq
->used
= (uint64_t)((vq
->avail
+ sizeof(uint16_t) * (3 + vq
->size
)
101 + vq
->align
- 1) & ~(vq
->align
- 1));
103 for (i
= 0; i
< vq
->size
- 1; i
++) {
104 /* vq->desc[i].addr */
105 writew(vq
->desc
+ (16 * i
), 0);
106 /* vq->desc[i].next */
107 writew(vq
->desc
+ (16 * i
) + 14, i
+ 1);
110 /* vq->avail->flags */
111 writew(vq
->avail
, 0);
113 writew(vq
->avail
+ 2, 0);
115 /* vq->used->flags */
119 uint32_t qvirtqueue_add(QVirtQueue
*vq
, uint64_t data
, uint32_t len
, bool write
,
126 flags
|= QVRING_DESC_F_WRITE
;
130 flags
|= QVRING_DESC_F_NEXT
;
133 /* vq->desc[vq->free_head].addr */
134 writeq(vq
->desc
+ (16 * vq
->free_head
), data
);
135 /* vq->desc[vq->free_head].len */
136 writel(vq
->desc
+ (16 * vq
->free_head
) + 8, len
);
137 /* vq->desc[vq->free_head].flags */
138 writew(vq
->desc
+ (16 * vq
->free_head
) + 12, flags
);
140 return vq
->free_head
++; /* Return and increase, in this order */
143 void qvirtqueue_kick(const QVirtioBus
*bus
, QVirtioDevice
*d
, QVirtQueue
*vq
,
147 uint16_t idx
= readl(vq
->avail
+ 2);
149 /* vq->avail->ring[idx % vq->size] */
150 writel(vq
->avail
+ 4 + (2 * (idx
% vq
->size
)), free_head
);
152 writel(vq
->avail
+ 2, idx
+ 1);
154 bus
->virtqueue_kick(d
, vq
);