Statistics
| Branch: | Revision:

root / hw / virtio.c @ 6bde6aaa

History | View | Annotate | Download (20.8 kB)

1 967f97fa aliguori
/*
2 967f97fa aliguori
 * Virtio Support
3 967f97fa aliguori
 *
4 967f97fa aliguori
 * Copyright IBM, Corp. 2007
5 967f97fa aliguori
 *
6 967f97fa aliguori
 * Authors:
7 967f97fa aliguori
 *  Anthony Liguori   <aliguori@us.ibm.com>
8 967f97fa aliguori
 *
9 967f97fa aliguori
 * This work is licensed under the terms of the GNU GPL, version 2.  See
10 967f97fa aliguori
 * the COPYING file in the top-level directory.
11 967f97fa aliguori
 *
12 967f97fa aliguori
 */
13 967f97fa aliguori
14 967f97fa aliguori
#include <inttypes.h>
15 967f97fa aliguori
16 967f97fa aliguori
#include "virtio.h"
17 967f97fa aliguori
#include "sysemu.h"
18 967f97fa aliguori
19 f46f15bc aliguori
/* The alignment to use between consumer and producer parts of vring.
20 f46f15bc aliguori
 * x86 pagesize again. */
21 f46f15bc aliguori
#define VIRTIO_PCI_VRING_ALIGN         4096
22 f46f15bc aliguori
23 967f97fa aliguori
/* QEMU doesn't strictly need write barriers since everything runs in
24 967f97fa aliguori
 * lock-step.  We'll leave the calls to wmb() in though to make it obvious for
25 967f97fa aliguori
 * KVM or if kqemu gets SMP support.
26 79758e95 Michael S. Tsirkin
 * In any case, we must prevent the compiler from reordering the code.
27 79758e95 Michael S. Tsirkin
 * TODO: we likely need some rmb()/mb() as well.
28 967f97fa aliguori
 */
29 79758e95 Michael S. Tsirkin
30 79758e95 Michael S. Tsirkin
#define wmb() __asm__ __volatile__("": : :"memory")
31 967f97fa aliguori
32 967f97fa aliguori
typedef struct VRingDesc
33 967f97fa aliguori
{
34 967f97fa aliguori
    uint64_t addr;
35 967f97fa aliguori
    uint32_t len;
36 967f97fa aliguori
    uint16_t flags;
37 967f97fa aliguori
    uint16_t next;
38 967f97fa aliguori
} VRingDesc;
39 967f97fa aliguori
40 967f97fa aliguori
typedef struct VRingAvail
41 967f97fa aliguori
{
42 967f97fa aliguori
    uint16_t flags;
43 967f97fa aliguori
    uint16_t idx;
44 967f97fa aliguori
    uint16_t ring[0];
45 967f97fa aliguori
} VRingAvail;
46 967f97fa aliguori
47 967f97fa aliguori
typedef struct VRingUsedElem
48 967f97fa aliguori
{
49 967f97fa aliguori
    uint32_t id;
50 967f97fa aliguori
    uint32_t len;
51 967f97fa aliguori
} VRingUsedElem;
52 967f97fa aliguori
53 967f97fa aliguori
typedef struct VRingUsed
54 967f97fa aliguori
{
55 967f97fa aliguori
    uint16_t flags;
56 967f97fa aliguori
    uint16_t idx;
57 967f97fa aliguori
    VRingUsedElem ring[0];
58 967f97fa aliguori
} VRingUsed;
59 967f97fa aliguori
60 967f97fa aliguori
typedef struct VRing
61 967f97fa aliguori
{
62 967f97fa aliguori
    unsigned int num;
63 c227f099 Anthony Liguori
    target_phys_addr_t desc;
64 c227f099 Anthony Liguori
    target_phys_addr_t avail;
65 c227f099 Anthony Liguori
    target_phys_addr_t used;
66 967f97fa aliguori
} VRing;
67 967f97fa aliguori
68 967f97fa aliguori
struct VirtQueue
69 967f97fa aliguori
{
70 967f97fa aliguori
    VRing vring;
71 c227f099 Anthony Liguori
    target_phys_addr_t pa;
72 967f97fa aliguori
    uint16_t last_avail_idx;
73 967f97fa aliguori
    int inuse;
74 7055e687 Michael S. Tsirkin
    uint16_t vector;
75 967f97fa aliguori
    void (*handle_output)(VirtIODevice *vdev, VirtQueue *vq);
76 1cbdabe2 Michael S. Tsirkin
    VirtIODevice *vdev;
77 1cbdabe2 Michael S. Tsirkin
    EventNotifier guest_notifier;
78 1cbdabe2 Michael S. Tsirkin
    EventNotifier host_notifier;
79 967f97fa aliguori
};
80 967f97fa aliguori
81 967f97fa aliguori
/* virt queue functions */
82 53c25cea Paul Brook
static void virtqueue_init(VirtQueue *vq)
83 967f97fa aliguori
{
84 c227f099 Anthony Liguori
    target_phys_addr_t pa = vq->pa;
85 53c25cea Paul Brook
86 967f97fa aliguori
    vq->vring.desc = pa;
87 967f97fa aliguori
    vq->vring.avail = pa + vq->vring.num * sizeof(VRingDesc);
88 f46f15bc aliguori
    vq->vring.used = vring_align(vq->vring.avail +
89 f46f15bc aliguori
                                 offsetof(VRingAvail, ring[vq->vring.num]),
90 f46f15bc aliguori
                                 VIRTIO_PCI_VRING_ALIGN);
91 967f97fa aliguori
}
92 967f97fa aliguori
93 c227f099 Anthony Liguori
static inline uint64_t vring_desc_addr(target_phys_addr_t desc_pa, int i)
94 967f97fa aliguori
{
95 c227f099 Anthony Liguori
    target_phys_addr_t pa;
96 5774cf98 Mark McLoughlin
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, addr);
97 967f97fa aliguori
    return ldq_phys(pa);
98 967f97fa aliguori
}
99 967f97fa aliguori
100 c227f099 Anthony Liguori
static inline uint32_t vring_desc_len(target_phys_addr_t desc_pa, int i)
101 967f97fa aliguori
{
102 c227f099 Anthony Liguori
    target_phys_addr_t pa;
103 5774cf98 Mark McLoughlin
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, len);
104 967f97fa aliguori
    return ldl_phys(pa);
105 967f97fa aliguori
}
106 967f97fa aliguori
107 c227f099 Anthony Liguori
static inline uint16_t vring_desc_flags(target_phys_addr_t desc_pa, int i)
108 967f97fa aliguori
{
109 c227f099 Anthony Liguori
    target_phys_addr_t pa;
110 5774cf98 Mark McLoughlin
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, flags);
111 967f97fa aliguori
    return lduw_phys(pa);
112 967f97fa aliguori
}
113 967f97fa aliguori
114 c227f099 Anthony Liguori
static inline uint16_t vring_desc_next(target_phys_addr_t desc_pa, int i)
115 967f97fa aliguori
{
116 c227f099 Anthony Liguori
    target_phys_addr_t pa;
117 5774cf98 Mark McLoughlin
    pa = desc_pa + sizeof(VRingDesc) * i + offsetof(VRingDesc, next);
118 967f97fa aliguori
    return lduw_phys(pa);
119 967f97fa aliguori
}
120 967f97fa aliguori
121 967f97fa aliguori
static inline uint16_t vring_avail_flags(VirtQueue *vq)
122 967f97fa aliguori
{
123 c227f099 Anthony Liguori
    target_phys_addr_t pa;
124 967f97fa aliguori
    pa = vq->vring.avail + offsetof(VRingAvail, flags);
125 967f97fa aliguori
    return lduw_phys(pa);
126 967f97fa aliguori
}
127 967f97fa aliguori
128 967f97fa aliguori
static inline uint16_t vring_avail_idx(VirtQueue *vq)
129 967f97fa aliguori
{
130 c227f099 Anthony Liguori
    target_phys_addr_t pa;
131 967f97fa aliguori
    pa = vq->vring.avail + offsetof(VRingAvail, idx);
132 967f97fa aliguori
    return lduw_phys(pa);
133 967f97fa aliguori
}
134 967f97fa aliguori
135 967f97fa aliguori
static inline uint16_t vring_avail_ring(VirtQueue *vq, int i)
136 967f97fa aliguori
{
137 c227f099 Anthony Liguori
    target_phys_addr_t pa;
138 967f97fa aliguori
    pa = vq->vring.avail + offsetof(VRingAvail, ring[i]);
139 967f97fa aliguori
    return lduw_phys(pa);
140 967f97fa aliguori
}
141 967f97fa aliguori
142 967f97fa aliguori
static inline void vring_used_ring_id(VirtQueue *vq, int i, uint32_t val)
143 967f97fa aliguori
{
144 c227f099 Anthony Liguori
    target_phys_addr_t pa;
145 967f97fa aliguori
    pa = vq->vring.used + offsetof(VRingUsed, ring[i].id);
146 967f97fa aliguori
    stl_phys(pa, val);
147 967f97fa aliguori
}
148 967f97fa aliguori
149 967f97fa aliguori
static inline void vring_used_ring_len(VirtQueue *vq, int i, uint32_t val)
150 967f97fa aliguori
{
151 c227f099 Anthony Liguori
    target_phys_addr_t pa;
152 967f97fa aliguori
    pa = vq->vring.used + offsetof(VRingUsed, ring[i].len);
153 967f97fa aliguori
    stl_phys(pa, val);
154 967f97fa aliguori
}
155 967f97fa aliguori
156 967f97fa aliguori
static uint16_t vring_used_idx(VirtQueue *vq)
157 967f97fa aliguori
{
158 c227f099 Anthony Liguori
    target_phys_addr_t pa;
159 967f97fa aliguori
    pa = vq->vring.used + offsetof(VRingUsed, idx);
160 967f97fa aliguori
    return lduw_phys(pa);
161 967f97fa aliguori
}
162 967f97fa aliguori
163 967f97fa aliguori
static inline void vring_used_idx_increment(VirtQueue *vq, uint16_t val)
164 967f97fa aliguori
{
165 c227f099 Anthony Liguori
    target_phys_addr_t pa;
166 967f97fa aliguori
    pa = vq->vring.used + offsetof(VRingUsed, idx);
167 967f97fa aliguori
    stw_phys(pa, vring_used_idx(vq) + val);
168 967f97fa aliguori
}
169 967f97fa aliguori
170 967f97fa aliguori
static inline void vring_used_flags_set_bit(VirtQueue *vq, int mask)
171 967f97fa aliguori
{
172 c227f099 Anthony Liguori
    target_phys_addr_t pa;
173 967f97fa aliguori
    pa = vq->vring.used + offsetof(VRingUsed, flags);
174 967f97fa aliguori
    stw_phys(pa, lduw_phys(pa) | mask);
175 967f97fa aliguori
}
176 967f97fa aliguori
177 967f97fa aliguori
static inline void vring_used_flags_unset_bit(VirtQueue *vq, int mask)
178 967f97fa aliguori
{
179 c227f099 Anthony Liguori
    target_phys_addr_t pa;
180 967f97fa aliguori
    pa = vq->vring.used + offsetof(VRingUsed, flags);
181 967f97fa aliguori
    stw_phys(pa, lduw_phys(pa) & ~mask);
182 967f97fa aliguori
}
183 967f97fa aliguori
184 967f97fa aliguori
void virtio_queue_set_notification(VirtQueue *vq, int enable)
185 967f97fa aliguori
{
186 967f97fa aliguori
    if (enable)
187 967f97fa aliguori
        vring_used_flags_unset_bit(vq, VRING_USED_F_NO_NOTIFY);
188 967f97fa aliguori
    else
189 967f97fa aliguori
        vring_used_flags_set_bit(vq, VRING_USED_F_NO_NOTIFY);
190 967f97fa aliguori
}
191 967f97fa aliguori
192 967f97fa aliguori
int virtio_queue_ready(VirtQueue *vq)
193 967f97fa aliguori
{
194 967f97fa aliguori
    return vq->vring.avail != 0;
195 967f97fa aliguori
}
196 967f97fa aliguori
197 967f97fa aliguori
int virtio_queue_empty(VirtQueue *vq)
198 967f97fa aliguori
{
199 967f97fa aliguori
    return vring_avail_idx(vq) == vq->last_avail_idx;
200 967f97fa aliguori
}
201 967f97fa aliguori
202 967f97fa aliguori
void virtqueue_fill(VirtQueue *vq, const VirtQueueElement *elem,
203 967f97fa aliguori
                    unsigned int len, unsigned int idx)
204 967f97fa aliguori
{
205 967f97fa aliguori
    unsigned int offset;
206 967f97fa aliguori
    int i;
207 967f97fa aliguori
208 967f97fa aliguori
    offset = 0;
209 967f97fa aliguori
    for (i = 0; i < elem->in_num; i++) {
210 967f97fa aliguori
        size_t size = MIN(len - offset, elem->in_sg[i].iov_len);
211 967f97fa aliguori
212 26b258e1 aliguori
        cpu_physical_memory_unmap(elem->in_sg[i].iov_base,
213 26b258e1 aliguori
                                  elem->in_sg[i].iov_len,
214 26b258e1 aliguori
                                  1, size);
215 967f97fa aliguori
216 26b258e1 aliguori
        offset += elem->in_sg[i].iov_len;
217 967f97fa aliguori
    }
218 967f97fa aliguori
219 26b258e1 aliguori
    for (i = 0; i < elem->out_num; i++)
220 26b258e1 aliguori
        cpu_physical_memory_unmap(elem->out_sg[i].iov_base,
221 26b258e1 aliguori
                                  elem->out_sg[i].iov_len,
222 26b258e1 aliguori
                                  0, elem->out_sg[i].iov_len);
223 26b258e1 aliguori
224 967f97fa aliguori
    idx = (idx + vring_used_idx(vq)) % vq->vring.num;
225 967f97fa aliguori
226 967f97fa aliguori
    /* Get a pointer to the next entry in the used ring. */
227 967f97fa aliguori
    vring_used_ring_id(vq, idx, elem->index);
228 967f97fa aliguori
    vring_used_ring_len(vq, idx, len);
229 967f97fa aliguori
}
230 967f97fa aliguori
231 967f97fa aliguori
void virtqueue_flush(VirtQueue *vq, unsigned int count)
232 967f97fa aliguori
{
233 967f97fa aliguori
    /* Make sure buffer is written before we update index. */
234 967f97fa aliguori
    wmb();
235 967f97fa aliguori
    vring_used_idx_increment(vq, count);
236 967f97fa aliguori
    vq->inuse -= count;
237 967f97fa aliguori
}
238 967f97fa aliguori
239 967f97fa aliguori
void virtqueue_push(VirtQueue *vq, const VirtQueueElement *elem,
240 967f97fa aliguori
                    unsigned int len)
241 967f97fa aliguori
{
242 967f97fa aliguori
    virtqueue_fill(vq, elem, len, 0);
243 967f97fa aliguori
    virtqueue_flush(vq, 1);
244 967f97fa aliguori
}
245 967f97fa aliguori
246 967f97fa aliguori
static int virtqueue_num_heads(VirtQueue *vq, unsigned int idx)
247 967f97fa aliguori
{
248 967f97fa aliguori
    uint16_t num_heads = vring_avail_idx(vq) - idx;
249 967f97fa aliguori
250 967f97fa aliguori
    /* Check it isn't doing very strange things with descriptor numbers. */
251 bb6834cf aliguori
    if (num_heads > vq->vring.num) {
252 bb6834cf aliguori
        fprintf(stderr, "Guest moved used index from %u to %u",
253 bb6834cf aliguori
                idx, vring_avail_idx(vq));
254 bb6834cf aliguori
        exit(1);
255 bb6834cf aliguori
    }
256 967f97fa aliguori
257 967f97fa aliguori
    return num_heads;
258 967f97fa aliguori
}
259 967f97fa aliguori
260 967f97fa aliguori
static unsigned int virtqueue_get_head(VirtQueue *vq, unsigned int idx)
261 967f97fa aliguori
{
262 967f97fa aliguori
    unsigned int head;
263 967f97fa aliguori
264 967f97fa aliguori
    /* Grab the next descriptor number they're advertising, and increment
265 967f97fa aliguori
     * the index we've seen. */
266 967f97fa aliguori
    head = vring_avail_ring(vq, idx % vq->vring.num);
267 967f97fa aliguori
268 967f97fa aliguori
    /* If their number is silly, that's a fatal mistake. */
269 bb6834cf aliguori
    if (head >= vq->vring.num) {
270 bb6834cf aliguori
        fprintf(stderr, "Guest says index %u is available", head);
271 bb6834cf aliguori
        exit(1);
272 bb6834cf aliguori
    }
273 967f97fa aliguori
274 967f97fa aliguori
    return head;
275 967f97fa aliguori
}
276 967f97fa aliguori
277 c227f099 Anthony Liguori
static unsigned virtqueue_next_desc(target_phys_addr_t desc_pa,
278 5774cf98 Mark McLoughlin
                                    unsigned int i, unsigned int max)
279 967f97fa aliguori
{
280 967f97fa aliguori
    unsigned int next;
281 967f97fa aliguori
282 967f97fa aliguori
    /* If this descriptor says it doesn't chain, we're done. */
283 5774cf98 Mark McLoughlin
    if (!(vring_desc_flags(desc_pa, i) & VRING_DESC_F_NEXT))
284 5774cf98 Mark McLoughlin
        return max;
285 967f97fa aliguori
286 967f97fa aliguori
    /* Check they're not leading us off end of descriptors. */
287 5774cf98 Mark McLoughlin
    next = vring_desc_next(desc_pa, i);
288 967f97fa aliguori
    /* Make sure compiler knows to grab that: we don't want it changing! */
289 967f97fa aliguori
    wmb();
290 967f97fa aliguori
291 5774cf98 Mark McLoughlin
    if (next >= max) {
292 bb6834cf aliguori
        fprintf(stderr, "Desc next is %u", next);
293 bb6834cf aliguori
        exit(1);
294 bb6834cf aliguori
    }
295 967f97fa aliguori
296 967f97fa aliguori
    return next;
297 967f97fa aliguori
}
298 967f97fa aliguori
299 967f97fa aliguori
int virtqueue_avail_bytes(VirtQueue *vq, int in_bytes, int out_bytes)
300 967f97fa aliguori
{
301 efeea6d0 Mark McLoughlin
    unsigned int idx;
302 efeea6d0 Mark McLoughlin
    int total_bufs, in_total, out_total;
303 967f97fa aliguori
304 967f97fa aliguori
    idx = vq->last_avail_idx;
305 967f97fa aliguori
306 efeea6d0 Mark McLoughlin
    total_bufs = in_total = out_total = 0;
307 967f97fa aliguori
    while (virtqueue_num_heads(vq, idx)) {
308 efeea6d0 Mark McLoughlin
        unsigned int max, num_bufs, indirect = 0;
309 c227f099 Anthony Liguori
        target_phys_addr_t desc_pa;
310 967f97fa aliguori
        int i;
311 967f97fa aliguori
312 efeea6d0 Mark McLoughlin
        max = vq->vring.num;
313 efeea6d0 Mark McLoughlin
        num_bufs = total_bufs;
314 967f97fa aliguori
        i = virtqueue_get_head(vq, idx++);
315 efeea6d0 Mark McLoughlin
        desc_pa = vq->vring.desc;
316 efeea6d0 Mark McLoughlin
317 efeea6d0 Mark McLoughlin
        if (vring_desc_flags(desc_pa, i) & VRING_DESC_F_INDIRECT) {
318 efeea6d0 Mark McLoughlin
            if (vring_desc_len(desc_pa, i) % sizeof(VRingDesc)) {
319 efeea6d0 Mark McLoughlin
                fprintf(stderr, "Invalid size for indirect buffer table\n");
320 efeea6d0 Mark McLoughlin
                exit(1);
321 efeea6d0 Mark McLoughlin
            }
322 efeea6d0 Mark McLoughlin
323 efeea6d0 Mark McLoughlin
            /* If we've got too many, that implies a descriptor loop. */
324 efeea6d0 Mark McLoughlin
            if (num_bufs >= max) {
325 efeea6d0 Mark McLoughlin
                fprintf(stderr, "Looped descriptor");
326 efeea6d0 Mark McLoughlin
                exit(1);
327 efeea6d0 Mark McLoughlin
            }
328 efeea6d0 Mark McLoughlin
329 efeea6d0 Mark McLoughlin
            /* loop over the indirect descriptor table */
330 efeea6d0 Mark McLoughlin
            indirect = 1;
331 efeea6d0 Mark McLoughlin
            max = vring_desc_len(desc_pa, i) / sizeof(VRingDesc);
332 efeea6d0 Mark McLoughlin
            num_bufs = i = 0;
333 efeea6d0 Mark McLoughlin
            desc_pa = vring_desc_addr(desc_pa, i);
334 efeea6d0 Mark McLoughlin
        }
335 efeea6d0 Mark McLoughlin
336 967f97fa aliguori
        do {
337 967f97fa aliguori
            /* If we've got too many, that implies a descriptor loop. */
338 5774cf98 Mark McLoughlin
            if (++num_bufs > max) {
339 bb6834cf aliguori
                fprintf(stderr, "Looped descriptor");
340 bb6834cf aliguori
                exit(1);
341 bb6834cf aliguori
            }
342 967f97fa aliguori
343 5774cf98 Mark McLoughlin
            if (vring_desc_flags(desc_pa, i) & VRING_DESC_F_WRITE) {
344 967f97fa aliguori
                if (in_bytes > 0 &&
345 5774cf98 Mark McLoughlin
                    (in_total += vring_desc_len(desc_pa, i)) >= in_bytes)
346 967f97fa aliguori
                    return 1;
347 967f97fa aliguori
            } else {
348 967f97fa aliguori
                if (out_bytes > 0 &&
349 5774cf98 Mark McLoughlin
                    (out_total += vring_desc_len(desc_pa, i)) >= out_bytes)
350 967f97fa aliguori
                    return 1;
351 967f97fa aliguori
            }
352 5774cf98 Mark McLoughlin
        } while ((i = virtqueue_next_desc(desc_pa, i, max)) != max);
353 efeea6d0 Mark McLoughlin
354 efeea6d0 Mark McLoughlin
        if (!indirect)
355 efeea6d0 Mark McLoughlin
            total_bufs = num_bufs;
356 efeea6d0 Mark McLoughlin
        else
357 efeea6d0 Mark McLoughlin
            total_bufs++;
358 967f97fa aliguori
    }
359 967f97fa aliguori
360 967f97fa aliguori
    return 0;
361 967f97fa aliguori
}
362 967f97fa aliguori
363 967f97fa aliguori
int virtqueue_pop(VirtQueue *vq, VirtQueueElement *elem)
364 967f97fa aliguori
{
365 5774cf98 Mark McLoughlin
    unsigned int i, head, max;
366 c227f099 Anthony Liguori
    target_phys_addr_t desc_pa = vq->vring.desc;
367 c227f099 Anthony Liguori
    target_phys_addr_t len;
368 967f97fa aliguori
369 967f97fa aliguori
    if (!virtqueue_num_heads(vq, vq->last_avail_idx))
370 967f97fa aliguori
        return 0;
371 967f97fa aliguori
372 967f97fa aliguori
    /* When we start there are none of either input nor output. */
373 967f97fa aliguori
    elem->out_num = elem->in_num = 0;
374 967f97fa aliguori
375 5774cf98 Mark McLoughlin
    max = vq->vring.num;
376 5774cf98 Mark McLoughlin
377 967f97fa aliguori
    i = head = virtqueue_get_head(vq, vq->last_avail_idx++);
378 efeea6d0 Mark McLoughlin
379 efeea6d0 Mark McLoughlin
    if (vring_desc_flags(desc_pa, i) & VRING_DESC_F_INDIRECT) {
380 efeea6d0 Mark McLoughlin
        if (vring_desc_len(desc_pa, i) % sizeof(VRingDesc)) {
381 efeea6d0 Mark McLoughlin
            fprintf(stderr, "Invalid size for indirect buffer table\n");
382 efeea6d0 Mark McLoughlin
            exit(1);
383 efeea6d0 Mark McLoughlin
        }
384 efeea6d0 Mark McLoughlin
385 efeea6d0 Mark McLoughlin
        /* loop over the indirect descriptor table */
386 efeea6d0 Mark McLoughlin
        max = vring_desc_len(desc_pa, i) / sizeof(VRingDesc);
387 efeea6d0 Mark McLoughlin
        desc_pa = vring_desc_addr(desc_pa, i);
388 efeea6d0 Mark McLoughlin
        i = 0;
389 efeea6d0 Mark McLoughlin
    }
390 efeea6d0 Mark McLoughlin
391 967f97fa aliguori
    do {
392 967f97fa aliguori
        struct iovec *sg;
393 26b258e1 aliguori
        int is_write = 0;
394 967f97fa aliguori
395 5774cf98 Mark McLoughlin
        if (vring_desc_flags(desc_pa, i) & VRING_DESC_F_WRITE) {
396 5774cf98 Mark McLoughlin
            elem->in_addr[elem->in_num] = vring_desc_addr(desc_pa, i);
397 967f97fa aliguori
            sg = &elem->in_sg[elem->in_num++];
398 26b258e1 aliguori
            is_write = 1;
399 967f97fa aliguori
        } else
400 967f97fa aliguori
            sg = &elem->out_sg[elem->out_num++];
401 967f97fa aliguori
402 967f97fa aliguori
        /* Grab the first descriptor, and check it's OK. */
403 5774cf98 Mark McLoughlin
        sg->iov_len = vring_desc_len(desc_pa, i);
404 26b258e1 aliguori
        len = sg->iov_len;
405 967f97fa aliguori
406 5774cf98 Mark McLoughlin
        sg->iov_base = cpu_physical_memory_map(vring_desc_addr(desc_pa, i),
407 5774cf98 Mark McLoughlin
                                               &len, is_write);
408 26b258e1 aliguori
409 26b258e1 aliguori
        if (sg->iov_base == NULL || len != sg->iov_len) {
410 26b258e1 aliguori
            fprintf(stderr, "virtio: trying to map MMIO memory\n");
411 bb6834cf aliguori
            exit(1);
412 bb6834cf aliguori
        }
413 967f97fa aliguori
414 967f97fa aliguori
        /* If we've got too many, that implies a descriptor loop. */
415 5774cf98 Mark McLoughlin
        if ((elem->in_num + elem->out_num) > max) {
416 bb6834cf aliguori
            fprintf(stderr, "Looped descriptor");
417 bb6834cf aliguori
            exit(1);
418 bb6834cf aliguori
        }
419 5774cf98 Mark McLoughlin
    } while ((i = virtqueue_next_desc(desc_pa, i, max)) != max);
420 967f97fa aliguori
421 967f97fa aliguori
    elem->index = head;
422 967f97fa aliguori
423 967f97fa aliguori
    vq->inuse++;
424 967f97fa aliguori
425 967f97fa aliguori
    return elem->in_num + elem->out_num;
426 967f97fa aliguori
}
427 967f97fa aliguori
428 967f97fa aliguori
/* virtio device */
429 7055e687 Michael S. Tsirkin
static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
430 7055e687 Michael S. Tsirkin
{
431 7055e687 Michael S. Tsirkin
    if (vdev->binding->notify) {
432 7055e687 Michael S. Tsirkin
        vdev->binding->notify(vdev->binding_opaque, vector);
433 7055e687 Michael S. Tsirkin
    }
434 7055e687 Michael S. Tsirkin
}
435 967f97fa aliguori
436 53c25cea Paul Brook
void virtio_update_irq(VirtIODevice *vdev)
437 967f97fa aliguori
{
438 7055e687 Michael S. Tsirkin
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
439 967f97fa aliguori
}
440 967f97fa aliguori
441 53c25cea Paul Brook
void virtio_reset(void *opaque)
442 967f97fa aliguori
{
443 967f97fa aliguori
    VirtIODevice *vdev = opaque;
444 967f97fa aliguori
    int i;
445 967f97fa aliguori
446 967f97fa aliguori
    if (vdev->reset)
447 967f97fa aliguori
        vdev->reset(vdev);
448 967f97fa aliguori
449 704a76fc Michael S. Tsirkin
    vdev->guest_features = 0;
450 967f97fa aliguori
    vdev->queue_sel = 0;
451 967f97fa aliguori
    vdev->status = 0;
452 967f97fa aliguori
    vdev->isr = 0;
453 7055e687 Michael S. Tsirkin
    vdev->config_vector = VIRTIO_NO_VECTOR;
454 7055e687 Michael S. Tsirkin
    virtio_notify_vector(vdev, vdev->config_vector);
455 967f97fa aliguori
456 967f97fa aliguori
    for(i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
457 967f97fa aliguori
        vdev->vq[i].vring.desc = 0;
458 967f97fa aliguori
        vdev->vq[i].vring.avail = 0;
459 967f97fa aliguori
        vdev->vq[i].vring.used = 0;
460 967f97fa aliguori
        vdev->vq[i].last_avail_idx = 0;
461 53c25cea Paul Brook
        vdev->vq[i].pa = 0;
462 7055e687 Michael S. Tsirkin
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
463 967f97fa aliguori
    }
464 967f97fa aliguori
}
465 967f97fa aliguori
466 53c25cea Paul Brook
uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
467 967f97fa aliguori
{
468 967f97fa aliguori
    uint8_t val;
469 967f97fa aliguori
470 967f97fa aliguori
    vdev->get_config(vdev, vdev->config);
471 967f97fa aliguori
472 967f97fa aliguori
    if (addr > (vdev->config_len - sizeof(val)))
473 967f97fa aliguori
        return (uint32_t)-1;
474 967f97fa aliguori
475 967f97fa aliguori
    memcpy(&val, vdev->config + addr, sizeof(val));
476 967f97fa aliguori
    return val;
477 967f97fa aliguori
}
478 967f97fa aliguori
479 53c25cea Paul Brook
uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr)
480 967f97fa aliguori
{
481 967f97fa aliguori
    uint16_t val;
482 967f97fa aliguori
483 967f97fa aliguori
    vdev->get_config(vdev, vdev->config);
484 967f97fa aliguori
485 967f97fa aliguori
    if (addr > (vdev->config_len - sizeof(val)))
486 967f97fa aliguori
        return (uint32_t)-1;
487 967f97fa aliguori
488 967f97fa aliguori
    memcpy(&val, vdev->config + addr, sizeof(val));
489 967f97fa aliguori
    return val;
490 967f97fa aliguori
}
491 967f97fa aliguori
492 53c25cea Paul Brook
uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr)
493 967f97fa aliguori
{
494 967f97fa aliguori
    uint32_t val;
495 967f97fa aliguori
496 967f97fa aliguori
    vdev->get_config(vdev, vdev->config);
497 967f97fa aliguori
498 967f97fa aliguori
    if (addr > (vdev->config_len - sizeof(val)))
499 967f97fa aliguori
        return (uint32_t)-1;
500 967f97fa aliguori
501 967f97fa aliguori
    memcpy(&val, vdev->config + addr, sizeof(val));
502 967f97fa aliguori
    return val;
503 967f97fa aliguori
}
504 967f97fa aliguori
505 53c25cea Paul Brook
void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data)
506 967f97fa aliguori
{
507 967f97fa aliguori
    uint8_t val = data;
508 967f97fa aliguori
509 967f97fa aliguori
    if (addr > (vdev->config_len - sizeof(val)))
510 967f97fa aliguori
        return;
511 967f97fa aliguori
512 967f97fa aliguori
    memcpy(vdev->config + addr, &val, sizeof(val));
513 967f97fa aliguori
514 967f97fa aliguori
    if (vdev->set_config)
515 967f97fa aliguori
        vdev->set_config(vdev, vdev->config);
516 967f97fa aliguori
}
517 967f97fa aliguori
518 53c25cea Paul Brook
void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data)
519 967f97fa aliguori
{
520 967f97fa aliguori
    uint16_t val = data;
521 967f97fa aliguori
522 967f97fa aliguori
    if (addr > (vdev->config_len - sizeof(val)))
523 967f97fa aliguori
        return;
524 967f97fa aliguori
525 967f97fa aliguori
    memcpy(vdev->config + addr, &val, sizeof(val));
526 967f97fa aliguori
527 967f97fa aliguori
    if (vdev->set_config)
528 967f97fa aliguori
        vdev->set_config(vdev, vdev->config);
529 967f97fa aliguori
}
530 967f97fa aliguori
531 53c25cea Paul Brook
void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
532 967f97fa aliguori
{
533 967f97fa aliguori
    uint32_t val = data;
534 967f97fa aliguori
535 967f97fa aliguori
    if (addr > (vdev->config_len - sizeof(val)))
536 967f97fa aliguori
        return;
537 967f97fa aliguori
538 967f97fa aliguori
    memcpy(vdev->config + addr, &val, sizeof(val));
539 967f97fa aliguori
540 967f97fa aliguori
    if (vdev->set_config)
541 967f97fa aliguori
        vdev->set_config(vdev, vdev->config);
542 967f97fa aliguori
}
543 967f97fa aliguori
544 c227f099 Anthony Liguori
void virtio_queue_set_addr(VirtIODevice *vdev, int n, target_phys_addr_t addr)
545 967f97fa aliguori
{
546 7055e687 Michael S. Tsirkin
    vdev->vq[n].pa = addr;
547 7055e687 Michael S. Tsirkin
    virtqueue_init(&vdev->vq[n]);
548 53c25cea Paul Brook
}
549 53c25cea Paul Brook
550 c227f099 Anthony Liguori
target_phys_addr_t virtio_queue_get_addr(VirtIODevice *vdev, int n)
551 53c25cea Paul Brook
{
552 53c25cea Paul Brook
    return vdev->vq[n].pa;
553 53c25cea Paul Brook
}
554 53c25cea Paul Brook
555 53c25cea Paul Brook
int virtio_queue_get_num(VirtIODevice *vdev, int n)
556 53c25cea Paul Brook
{
557 53c25cea Paul Brook
    return vdev->vq[n].vring.num;
558 53c25cea Paul Brook
}
559 967f97fa aliguori
560 53c25cea Paul Brook
void virtio_queue_notify(VirtIODevice *vdev, int n)
561 53c25cea Paul Brook
{
562 53c25cea Paul Brook
    if (n < VIRTIO_PCI_QUEUE_MAX && vdev->vq[n].vring.desc) {
563 53c25cea Paul Brook
        vdev->vq[n].handle_output(vdev, &vdev->vq[n]);
564 967f97fa aliguori
    }
565 967f97fa aliguori
}
566 967f97fa aliguori
567 7055e687 Michael S. Tsirkin
uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
568 7055e687 Michael S. Tsirkin
{
569 7055e687 Michael S. Tsirkin
    return n < VIRTIO_PCI_QUEUE_MAX ? vdev->vq[n].vector :
570 7055e687 Michael S. Tsirkin
        VIRTIO_NO_VECTOR;
571 7055e687 Michael S. Tsirkin
}
572 7055e687 Michael S. Tsirkin
573 7055e687 Michael S. Tsirkin
void virtio_queue_set_vector(VirtIODevice *vdev, int n, uint16_t vector)
574 7055e687 Michael S. Tsirkin
{
575 7055e687 Michael S. Tsirkin
    if (n < VIRTIO_PCI_QUEUE_MAX)
576 7055e687 Michael S. Tsirkin
        vdev->vq[n].vector = vector;
577 7055e687 Michael S. Tsirkin
}
578 7055e687 Michael S. Tsirkin
579 967f97fa aliguori
VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
580 967f97fa aliguori
                            void (*handle_output)(VirtIODevice *, VirtQueue *))
581 967f97fa aliguori
{
582 967f97fa aliguori
    int i;
583 967f97fa aliguori
584 967f97fa aliguori
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
585 967f97fa aliguori
        if (vdev->vq[i].vring.num == 0)
586 967f97fa aliguori
            break;
587 967f97fa aliguori
    }
588 967f97fa aliguori
589 967f97fa aliguori
    if (i == VIRTIO_PCI_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
590 967f97fa aliguori
        abort();
591 967f97fa aliguori
592 967f97fa aliguori
    vdev->vq[i].vring.num = queue_size;
593 967f97fa aliguori
    vdev->vq[i].handle_output = handle_output;
594 967f97fa aliguori
595 967f97fa aliguori
    return &vdev->vq[i];
596 967f97fa aliguori
}
597 967f97fa aliguori
598 1cbdabe2 Michael S. Tsirkin
void virtio_irq(VirtQueue *vq)
599 1cbdabe2 Michael S. Tsirkin
{
600 1cbdabe2 Michael S. Tsirkin
    vq->vdev->isr |= 0x01;
601 1cbdabe2 Michael S. Tsirkin
    virtio_notify_vector(vq->vdev, vq->vector);
602 1cbdabe2 Michael S. Tsirkin
}
603 1cbdabe2 Michael S. Tsirkin
604 967f97fa aliguori
void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
605 967f97fa aliguori
{
606 97b83deb aliguori
    /* Always notify when queue is empty (when feature acknowledge) */
607 97b83deb aliguori
    if ((vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT) &&
608 704a76fc Michael S. Tsirkin
        (!(vdev->guest_features & (1 << VIRTIO_F_NOTIFY_ON_EMPTY)) ||
609 97b83deb aliguori
         (vq->inuse || vring_avail_idx(vq) != vq->last_avail_idx)))
610 967f97fa aliguori
        return;
611 967f97fa aliguori
612 967f97fa aliguori
    vdev->isr |= 0x01;
613 7055e687 Michael S. Tsirkin
    virtio_notify_vector(vdev, vq->vector);
614 967f97fa aliguori
}
615 967f97fa aliguori
616 967f97fa aliguori
void virtio_notify_config(VirtIODevice *vdev)
617 967f97fa aliguori
{
618 7625162c aliguori
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
619 7625162c aliguori
        return;
620 7625162c aliguori
621 967f97fa aliguori
    vdev->isr |= 0x03;
622 7055e687 Michael S. Tsirkin
    virtio_notify_vector(vdev, vdev->config_vector);
623 967f97fa aliguori
}
624 967f97fa aliguori
625 967f97fa aliguori
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
626 967f97fa aliguori
{
627 967f97fa aliguori
    int i;
628 967f97fa aliguori
629 ff24bd58 Michael S. Tsirkin
    if (vdev->binding->save_config)
630 ff24bd58 Michael S. Tsirkin
        vdev->binding->save_config(vdev->binding_opaque, f);
631 967f97fa aliguori
632 967f97fa aliguori
    qemu_put_8s(f, &vdev->status);
633 967f97fa aliguori
    qemu_put_8s(f, &vdev->isr);
634 967f97fa aliguori
    qemu_put_be16s(f, &vdev->queue_sel);
635 704a76fc Michael S. Tsirkin
    qemu_put_be32s(f, &vdev->guest_features);
636 967f97fa aliguori
    qemu_put_be32(f, vdev->config_len);
637 967f97fa aliguori
    qemu_put_buffer(f, vdev->config, vdev->config_len);
638 967f97fa aliguori
639 967f97fa aliguori
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
640 967f97fa aliguori
        if (vdev->vq[i].vring.num == 0)
641 967f97fa aliguori
            break;
642 967f97fa aliguori
    }
643 967f97fa aliguori
644 967f97fa aliguori
    qemu_put_be32(f, i);
645 967f97fa aliguori
646 967f97fa aliguori
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
647 967f97fa aliguori
        if (vdev->vq[i].vring.num == 0)
648 967f97fa aliguori
            break;
649 967f97fa aliguori
650 967f97fa aliguori
        qemu_put_be32(f, vdev->vq[i].vring.num);
651 53c25cea Paul Brook
        qemu_put_be64(f, vdev->vq[i].pa);
652 967f97fa aliguori
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
653 ff24bd58 Michael S. Tsirkin
        if (vdev->binding->save_queue)
654 ff24bd58 Michael S. Tsirkin
            vdev->binding->save_queue(vdev->binding_opaque, i, f);
655 967f97fa aliguori
    }
656 967f97fa aliguori
}
657 967f97fa aliguori
658 ff24bd58 Michael S. Tsirkin
int virtio_load(VirtIODevice *vdev, QEMUFile *f)
659 967f97fa aliguori
{
660 ff24bd58 Michael S. Tsirkin
    int num, i, ret;
661 6d74ca5a Michael S. Tsirkin
    uint32_t features;
662 8172539d Michael S. Tsirkin
    uint32_t supported_features =
663 6d74ca5a Michael S. Tsirkin
        vdev->binding->get_features(vdev->binding_opaque);
664 967f97fa aliguori
665 ff24bd58 Michael S. Tsirkin
    if (vdev->binding->load_config) {
666 ff24bd58 Michael S. Tsirkin
        ret = vdev->binding->load_config(vdev->binding_opaque, f);
667 ff24bd58 Michael S. Tsirkin
        if (ret)
668 ff24bd58 Michael S. Tsirkin
            return ret;
669 ff24bd58 Michael S. Tsirkin
    }
670 967f97fa aliguori
671 967f97fa aliguori
    qemu_get_8s(f, &vdev->status);
672 967f97fa aliguori
    qemu_get_8s(f, &vdev->isr);
673 967f97fa aliguori
    qemu_get_be16s(f, &vdev->queue_sel);
674 6d74ca5a Michael S. Tsirkin
    qemu_get_be32s(f, &features);
675 6d74ca5a Michael S. Tsirkin
    if (features & ~supported_features) {
676 6d74ca5a Michael S. Tsirkin
        fprintf(stderr, "Features 0x%x unsupported. Allowed features: 0x%x\n",
677 6d74ca5a Michael S. Tsirkin
                features, supported_features);
678 6d74ca5a Michael S. Tsirkin
        return -1;
679 6d74ca5a Michael S. Tsirkin
    }
680 fae054b0 Michael S. Tsirkin
    if (vdev->set_features)
681 fae054b0 Michael S. Tsirkin
        vdev->set_features(vdev, features);
682 704a76fc Michael S. Tsirkin
    vdev->guest_features = features;
683 967f97fa aliguori
    vdev->config_len = qemu_get_be32(f);
684 967f97fa aliguori
    qemu_get_buffer(f, vdev->config, vdev->config_len);
685 967f97fa aliguori
686 967f97fa aliguori
    num = qemu_get_be32(f);
687 967f97fa aliguori
688 967f97fa aliguori
    for (i = 0; i < num; i++) {
689 967f97fa aliguori
        vdev->vq[i].vring.num = qemu_get_be32(f);
690 53c25cea Paul Brook
        vdev->vq[i].pa = qemu_get_be64(f);
691 967f97fa aliguori
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
692 967f97fa aliguori
693 53c25cea Paul Brook
        if (vdev->vq[i].pa) {
694 53c25cea Paul Brook
            virtqueue_init(&vdev->vq[i]);
695 967f97fa aliguori
        }
696 ff24bd58 Michael S. Tsirkin
        if (vdev->binding->load_queue) {
697 ff24bd58 Michael S. Tsirkin
            ret = vdev->binding->load_queue(vdev->binding_opaque, i, f);
698 ff24bd58 Michael S. Tsirkin
            if (ret)
699 ff24bd58 Michael S. Tsirkin
                return ret;
700 7055e687 Michael S. Tsirkin
        }
701 967f97fa aliguori
    }
702 967f97fa aliguori
703 7055e687 Michael S. Tsirkin
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
704 ff24bd58 Michael S. Tsirkin
    return 0;
705 967f97fa aliguori
}
706 967f97fa aliguori
707 b946a153 aliguori
void virtio_cleanup(VirtIODevice *vdev)
708 b946a153 aliguori
{
709 b946a153 aliguori
    if (vdev->config)
710 b946a153 aliguori
        qemu_free(vdev->config);
711 b946a153 aliguori
    qemu_free(vdev->vq);
712 b946a153 aliguori
}
713 b946a153 aliguori
714 53c25cea Paul Brook
VirtIODevice *virtio_common_init(const char *name, uint16_t device_id,
715 53c25cea Paul Brook
                                 size_t config_size, size_t struct_size)
716 967f97fa aliguori
{
717 967f97fa aliguori
    VirtIODevice *vdev;
718 b8193adb Michael S. Tsirkin
    int i;
719 967f97fa aliguori
720 53c25cea Paul Brook
    vdev = qemu_mallocz(struct_size);
721 967f97fa aliguori
722 53c25cea Paul Brook
    vdev->device_id = device_id;
723 967f97fa aliguori
    vdev->status = 0;
724 967f97fa aliguori
    vdev->isr = 0;
725 967f97fa aliguori
    vdev->queue_sel = 0;
726 7055e687 Michael S. Tsirkin
    vdev->config_vector = VIRTIO_NO_VECTOR;
727 967f97fa aliguori
    vdev->vq = qemu_mallocz(sizeof(VirtQueue) * VIRTIO_PCI_QUEUE_MAX);
728 1cbdabe2 Michael S. Tsirkin
    for(i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
729 b8193adb Michael S. Tsirkin
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
730 1cbdabe2 Michael S. Tsirkin
        vdev->vq[i].vdev = vdev;
731 1cbdabe2 Michael S. Tsirkin
    }
732 967f97fa aliguori
733 967f97fa aliguori
    vdev->name = name;
734 967f97fa aliguori
    vdev->config_len = config_size;
735 967f97fa aliguori
    if (vdev->config_len)
736 967f97fa aliguori
        vdev->config = qemu_mallocz(config_size);
737 967f97fa aliguori
    else
738 967f97fa aliguori
        vdev->config = NULL;
739 967f97fa aliguori
740 967f97fa aliguori
    return vdev;
741 967f97fa aliguori
}
742 53c25cea Paul Brook
743 53c25cea Paul Brook
void virtio_bind_device(VirtIODevice *vdev, const VirtIOBindings *binding,
744 53c25cea Paul Brook
                        void *opaque)
745 53c25cea Paul Brook
{
746 53c25cea Paul Brook
    vdev->binding = binding;
747 53c25cea Paul Brook
    vdev->binding_opaque = opaque;
748 53c25cea Paul Brook
}
749 1cbdabe2 Michael S. Tsirkin
750 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
751 1cbdabe2 Michael S. Tsirkin
{
752 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.desc;
753 1cbdabe2 Michael S. Tsirkin
}
754 1cbdabe2 Michael S. Tsirkin
755 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
756 1cbdabe2 Michael S. Tsirkin
{
757 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.avail;
758 1cbdabe2 Michael S. Tsirkin
}
759 1cbdabe2 Michael S. Tsirkin
760 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
761 1cbdabe2 Michael S. Tsirkin
{
762 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.used;
763 1cbdabe2 Michael S. Tsirkin
}
764 1cbdabe2 Michael S. Tsirkin
765 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_ring_addr(VirtIODevice *vdev, int n)
766 1cbdabe2 Michael S. Tsirkin
{
767 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.desc;
768 1cbdabe2 Michael S. Tsirkin
}
769 1cbdabe2 Michael S. Tsirkin
770 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
771 1cbdabe2 Michael S. Tsirkin
{
772 1cbdabe2 Michael S. Tsirkin
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
773 1cbdabe2 Michael S. Tsirkin
}
774 1cbdabe2 Michael S. Tsirkin
775 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
776 1cbdabe2 Michael S. Tsirkin
{
777 1cbdabe2 Michael S. Tsirkin
    return offsetof(VRingAvail, ring) +
778 2b3af999 Stefan Weil
        sizeof(uint64_t) * vdev->vq[n].vring.num;
779 1cbdabe2 Michael S. Tsirkin
}
780 1cbdabe2 Michael S. Tsirkin
781 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_used_size(VirtIODevice *vdev, int n)
782 1cbdabe2 Michael S. Tsirkin
{
783 1cbdabe2 Michael S. Tsirkin
    return offsetof(VRingUsed, ring) +
784 1cbdabe2 Michael S. Tsirkin
        sizeof(VRingUsedElem) * vdev->vq[n].vring.num;
785 1cbdabe2 Michael S. Tsirkin
}
786 1cbdabe2 Michael S. Tsirkin
787 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_ring_size(VirtIODevice *vdev, int n)
788 1cbdabe2 Michael S. Tsirkin
{
789 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.used - vdev->vq[n].vring.desc +
790 1cbdabe2 Michael S. Tsirkin
            virtio_queue_get_used_size(vdev, n);
791 1cbdabe2 Michael S. Tsirkin
}
792 1cbdabe2 Michael S. Tsirkin
793 1cbdabe2 Michael S. Tsirkin
uint16_t virtio_queue_get_last_avail_idx(VirtIODevice *vdev, int n)
794 1cbdabe2 Michael S. Tsirkin
{
795 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].last_avail_idx;
796 1cbdabe2 Michael S. Tsirkin
}
797 1cbdabe2 Michael S. Tsirkin
798 1cbdabe2 Michael S. Tsirkin
void virtio_queue_set_last_avail_idx(VirtIODevice *vdev, int n, uint16_t idx)
799 1cbdabe2 Michael S. Tsirkin
{
800 1cbdabe2 Michael S. Tsirkin
    vdev->vq[n].last_avail_idx = idx;
801 1cbdabe2 Michael S. Tsirkin
}
802 1cbdabe2 Michael S. Tsirkin
803 1cbdabe2 Michael S. Tsirkin
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
804 1cbdabe2 Michael S. Tsirkin
{
805 1cbdabe2 Michael S. Tsirkin
    return vdev->vq + n;
806 1cbdabe2 Michael S. Tsirkin
}
807 1cbdabe2 Michael S. Tsirkin
808 1cbdabe2 Michael S. Tsirkin
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
809 1cbdabe2 Michael S. Tsirkin
{
810 1cbdabe2 Michael S. Tsirkin
    return &vq->guest_notifier;
811 1cbdabe2 Michael S. Tsirkin
}
812 1cbdabe2 Michael S. Tsirkin
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
813 1cbdabe2 Michael S. Tsirkin
{
814 1cbdabe2 Michael S. Tsirkin
    return &vq->host_notifier;
815 1cbdabe2 Michael S. Tsirkin
}