Statistics
| Branch: | Revision:

root / hw / virtio.c @ 258dc7c9

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