Statistics
| Branch: | Revision:

root / hw / virtio.c @ a43f9c90

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