]>
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_queue_isr(const QVirtioBus
*bus
, QVirtioDevice
*d
,
82 QVirtQueue
*vq
, uint64_t timeout
)
86 if (bus
->get_queue_isr_status(d
, vq
)) {
87 break; /* It has ended */
94 bool qvirtio_wait_config_isr(const QVirtioBus
*bus
, QVirtioDevice
*d
,
99 if (bus
->get_config_isr_status(d
)) {
100 break; /* It has ended */
107 void qvring_init(const QGuestAllocator
*alloc
, QVirtQueue
*vq
, uint64_t addr
)
112 vq
->avail
= vq
->desc
+ vq
->size
*sizeof(QVRingDesc
);
113 vq
->used
= (uint64_t)((vq
->avail
+ sizeof(uint16_t) * (3 + vq
->size
)
114 + vq
->align
- 1) & ~(vq
->align
- 1));
116 for (i
= 0; i
< vq
->size
- 1; i
++) {
117 /* vq->desc[i].addr */
118 writew(vq
->desc
+ (16 * i
), 0);
119 /* vq->desc[i].next */
120 writew(vq
->desc
+ (16 * i
) + 14, i
+ 1);
123 /* vq->avail->flags */
124 writew(vq
->avail
, 0);
126 writew(vq
->avail
+ 2, 0);
127 /* vq->avail->used_event */
128 writew(vq
->avail
+ 4 + (2 * vq
->size
), 0);
130 /* vq->used->flags */
132 /* vq->used->avail_event */
133 writew(vq
->used
+2+(sizeof(struct QVRingUsedElem
)*vq
->size
), 0);
136 QVRingIndirectDesc
*qvring_indirect_desc_setup(QVirtioDevice
*d
,
137 QGuestAllocator
*alloc
, uint16_t elem
)
140 QVRingIndirectDesc
*indirect
= g_malloc(sizeof(*indirect
));
143 indirect
->elem
= elem
;
144 indirect
->desc
= guest_alloc(alloc
, sizeof(QVRingDesc
)*elem
);
146 for (i
= 0; i
< elem
- 1; ++i
) {
147 /* indirect->desc[i].addr */
148 writeq(indirect
->desc
+ (16 * i
), 0);
149 /* indirect->desc[i].flags */
150 writew(indirect
->desc
+ (16 * i
) + 12, QVRING_DESC_F_NEXT
);
151 /* indirect->desc[i].next */
152 writew(indirect
->desc
+ (16 * i
) + 14, i
+ 1);
158 void qvring_indirect_desc_add(QVRingIndirectDesc
*indirect
, uint64_t data
,
159 uint32_t len
, bool write
)
163 g_assert_cmpint(indirect
->index
, <, indirect
->elem
);
165 flags
= readw(indirect
->desc
+ (16 * indirect
->index
) + 12);
168 flags
|= QVRING_DESC_F_WRITE
;
171 /* indirect->desc[indirect->index].addr */
172 writeq(indirect
->desc
+ (16 * indirect
->index
), data
);
173 /* indirect->desc[indirect->index].len */
174 writel(indirect
->desc
+ (16 * indirect
->index
) + 8, len
);
175 /* indirect->desc[indirect->index].flags */
176 writew(indirect
->desc
+ (16 * indirect
->index
) + 12, flags
);
181 uint32_t qvirtqueue_add(QVirtQueue
*vq
, uint64_t data
, uint32_t len
, bool write
,
188 flags
|= QVRING_DESC_F_WRITE
;
192 flags
|= QVRING_DESC_F_NEXT
;
195 /* vq->desc[vq->free_head].addr */
196 writeq(vq
->desc
+ (16 * vq
->free_head
), data
);
197 /* vq->desc[vq->free_head].len */
198 writel(vq
->desc
+ (16 * vq
->free_head
) + 8, len
);
199 /* vq->desc[vq->free_head].flags */
200 writew(vq
->desc
+ (16 * vq
->free_head
) + 12, flags
);
202 return vq
->free_head
++; /* Return and increase, in this order */
205 uint32_t qvirtqueue_add_indirect(QVirtQueue
*vq
, QVRingIndirectDesc
*indirect
)
207 g_assert(vq
->indirect
);
208 g_assert_cmpint(vq
->size
, >=, indirect
->elem
);
209 g_assert_cmpint(indirect
->index
, ==, indirect
->elem
);
213 /* vq->desc[vq->free_head].addr */
214 writeq(vq
->desc
+ (16 * vq
->free_head
), indirect
->desc
);
215 /* vq->desc[vq->free_head].len */
216 writel(vq
->desc
+ (16 * vq
->free_head
) + 8,
217 sizeof(QVRingDesc
) * indirect
->elem
);
218 /* vq->desc[vq->free_head].flags */
219 writew(vq
->desc
+ (16 * vq
->free_head
) + 12, QVRING_DESC_F_INDIRECT
);
221 return vq
->free_head
++; /* Return and increase, in this order */
224 void qvirtqueue_kick(const QVirtioBus
*bus
, QVirtioDevice
*d
, QVirtQueue
*vq
,
228 uint16_t idx
= readl(vq
->avail
+ 2);
229 /* vq->used->flags */
231 /* vq->used->avail_event */
232 uint16_t avail_event
;
234 /* vq->avail->ring[idx % vq->size] */
235 writel(vq
->avail
+ 4 + (2 * (idx
% vq
->size
)), free_head
);
237 writel(vq
->avail
+ 2, idx
+ 1);
239 /* Must read after idx is updated */
240 flags
= readw(vq
->avail
);
241 avail_event
= readw(vq
->used
+ 4 +
242 (sizeof(struct QVRingUsedElem
) * vq
->size
));
244 /* < 1 because we add elements to avail queue one by one */
245 if ((flags
& QVRING_USED_F_NO_NOTIFY
) == 0 &&
246 (!vq
->event
|| (uint16_t)(idx
-avail_event
) < 1)) {
247 bus
->virtqueue_kick(d
, vq
);
251 void qvirtqueue_set_used_event(QVirtQueue
*vq
, uint16_t idx
)
255 /* vq->avail->used_event */
256 writew(vq
->avail
+ 4 + (2 * vq
->size
), idx
);