Statistics
| Branch: | Revision:

root / hw / virtio.c @ d3674c57

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
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 ce67ed65 Stefan Hajnoczi
        error_report("Guest moved used index from %u to %u",
257 ce67ed65 Stefan Hajnoczi
                     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 ce67ed65 Stefan Hajnoczi
        error_report("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 ce67ed65 Stefan Hajnoczi
        error_report("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 ce67ed65 Stefan Hajnoczi
                error_report("Invalid size for indirect buffer table");
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 ce67ed65 Stefan Hajnoczi
                error_report("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 ce67ed65 Stefan Hajnoczi
                error_report("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 ce67ed65 Stefan Hajnoczi
            error_report("virtio: trying to map MMIO memory");
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 ce67ed65 Stefan Hajnoczi
            error_report("Invalid size for indirect buffer table");
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 ce67ed65 Stefan Hajnoczi
            error_report("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 25db9ebe Stefan Hajnoczi
void virtio_queue_notify_vq(VirtQueue *vq)
578 25db9ebe Stefan Hajnoczi
{
579 25db9ebe Stefan Hajnoczi
    if (vq->vring.desc) {
580 25db9ebe Stefan Hajnoczi
        VirtIODevice *vdev = vq->vdev;
581 25db9ebe Stefan Hajnoczi
        trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
582 25db9ebe Stefan Hajnoczi
        vq->handle_output(vdev, vq);
583 25db9ebe Stefan Hajnoczi
    }
584 25db9ebe Stefan Hajnoczi
}
585 25db9ebe Stefan Hajnoczi
586 53c25cea Paul Brook
void virtio_queue_notify(VirtIODevice *vdev, int n)
587 53c25cea Paul Brook
{
588 7157e2e2 Stefan Hajnoczi
    virtio_queue_notify_vq(&vdev->vq[n]);
589 967f97fa aliguori
}
590 967f97fa aliguori
591 7055e687 Michael S. Tsirkin
uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
592 7055e687 Michael S. Tsirkin
{
593 7055e687 Michael S. Tsirkin
    return n < VIRTIO_PCI_QUEUE_MAX ? vdev->vq[n].vector :
594 7055e687 Michael S. Tsirkin
        VIRTIO_NO_VECTOR;
595 7055e687 Michael S. Tsirkin
}
596 7055e687 Michael S. Tsirkin
597 7055e687 Michael S. Tsirkin
void virtio_queue_set_vector(VirtIODevice *vdev, int n, uint16_t vector)
598 7055e687 Michael S. Tsirkin
{
599 7055e687 Michael S. Tsirkin
    if (n < VIRTIO_PCI_QUEUE_MAX)
600 7055e687 Michael S. Tsirkin
        vdev->vq[n].vector = vector;
601 7055e687 Michael S. Tsirkin
}
602 7055e687 Michael S. Tsirkin
603 967f97fa aliguori
VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
604 967f97fa aliguori
                            void (*handle_output)(VirtIODevice *, VirtQueue *))
605 967f97fa aliguori
{
606 967f97fa aliguori
    int i;
607 967f97fa aliguori
608 967f97fa aliguori
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
609 967f97fa aliguori
        if (vdev->vq[i].vring.num == 0)
610 967f97fa aliguori
            break;
611 967f97fa aliguori
    }
612 967f97fa aliguori
613 967f97fa aliguori
    if (i == VIRTIO_PCI_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
614 967f97fa aliguori
        abort();
615 967f97fa aliguori
616 967f97fa aliguori
    vdev->vq[i].vring.num = queue_size;
617 967f97fa aliguori
    vdev->vq[i].handle_output = handle_output;
618 967f97fa aliguori
619 967f97fa aliguori
    return &vdev->vq[i];
620 967f97fa aliguori
}
621 967f97fa aliguori
622 1cbdabe2 Michael S. Tsirkin
void virtio_irq(VirtQueue *vq)
623 1cbdabe2 Michael S. Tsirkin
{
624 64979a4d Stefan Hajnoczi
    trace_virtio_irq(vq);
625 1cbdabe2 Michael S. Tsirkin
    vq->vdev->isr |= 0x01;
626 1cbdabe2 Michael S. Tsirkin
    virtio_notify_vector(vq->vdev, vq->vector);
627 1cbdabe2 Michael S. Tsirkin
}
628 1cbdabe2 Michael S. Tsirkin
629 967f97fa aliguori
void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
630 967f97fa aliguori
{
631 97b83deb aliguori
    /* Always notify when queue is empty (when feature acknowledge) */
632 97b83deb aliguori
    if ((vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT) &&
633 704a76fc Michael S. Tsirkin
        (!(vdev->guest_features & (1 << VIRTIO_F_NOTIFY_ON_EMPTY)) ||
634 97b83deb aliguori
         (vq->inuse || vring_avail_idx(vq) != vq->last_avail_idx)))
635 967f97fa aliguori
        return;
636 967f97fa aliguori
637 64979a4d Stefan Hajnoczi
    trace_virtio_notify(vdev, vq);
638 967f97fa aliguori
    vdev->isr |= 0x01;
639 7055e687 Michael S. Tsirkin
    virtio_notify_vector(vdev, vq->vector);
640 967f97fa aliguori
}
641 967f97fa aliguori
642 967f97fa aliguori
void virtio_notify_config(VirtIODevice *vdev)
643 967f97fa aliguori
{
644 7625162c aliguori
    if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
645 7625162c aliguori
        return;
646 7625162c aliguori
647 967f97fa aliguori
    vdev->isr |= 0x03;
648 7055e687 Michael S. Tsirkin
    virtio_notify_vector(vdev, vdev->config_vector);
649 967f97fa aliguori
}
650 967f97fa aliguori
651 967f97fa aliguori
void virtio_save(VirtIODevice *vdev, QEMUFile *f)
652 967f97fa aliguori
{
653 967f97fa aliguori
    int i;
654 967f97fa aliguori
655 ff24bd58 Michael S. Tsirkin
    if (vdev->binding->save_config)
656 ff24bd58 Michael S. Tsirkin
        vdev->binding->save_config(vdev->binding_opaque, f);
657 967f97fa aliguori
658 967f97fa aliguori
    qemu_put_8s(f, &vdev->status);
659 967f97fa aliguori
    qemu_put_8s(f, &vdev->isr);
660 967f97fa aliguori
    qemu_put_be16s(f, &vdev->queue_sel);
661 704a76fc Michael S. Tsirkin
    qemu_put_be32s(f, &vdev->guest_features);
662 967f97fa aliguori
    qemu_put_be32(f, vdev->config_len);
663 967f97fa aliguori
    qemu_put_buffer(f, vdev->config, vdev->config_len);
664 967f97fa aliguori
665 967f97fa aliguori
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
666 967f97fa aliguori
        if (vdev->vq[i].vring.num == 0)
667 967f97fa aliguori
            break;
668 967f97fa aliguori
    }
669 967f97fa aliguori
670 967f97fa aliguori
    qemu_put_be32(f, i);
671 967f97fa aliguori
672 967f97fa aliguori
    for (i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
673 967f97fa aliguori
        if (vdev->vq[i].vring.num == 0)
674 967f97fa aliguori
            break;
675 967f97fa aliguori
676 967f97fa aliguori
        qemu_put_be32(f, vdev->vq[i].vring.num);
677 53c25cea Paul Brook
        qemu_put_be64(f, vdev->vq[i].pa);
678 967f97fa aliguori
        qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
679 ff24bd58 Michael S. Tsirkin
        if (vdev->binding->save_queue)
680 ff24bd58 Michael S. Tsirkin
            vdev->binding->save_queue(vdev->binding_opaque, i, f);
681 967f97fa aliguori
    }
682 967f97fa aliguori
}
683 967f97fa aliguori
684 ff24bd58 Michael S. Tsirkin
int virtio_load(VirtIODevice *vdev, QEMUFile *f)
685 967f97fa aliguori
{
686 ff24bd58 Michael S. Tsirkin
    int num, i, ret;
687 6d74ca5a Michael S. Tsirkin
    uint32_t features;
688 8172539d Michael S. Tsirkin
    uint32_t supported_features =
689 6d74ca5a Michael S. Tsirkin
        vdev->binding->get_features(vdev->binding_opaque);
690 967f97fa aliguori
691 ff24bd58 Michael S. Tsirkin
    if (vdev->binding->load_config) {
692 ff24bd58 Michael S. Tsirkin
        ret = vdev->binding->load_config(vdev->binding_opaque, f);
693 ff24bd58 Michael S. Tsirkin
        if (ret)
694 ff24bd58 Michael S. Tsirkin
            return ret;
695 ff24bd58 Michael S. Tsirkin
    }
696 967f97fa aliguori
697 967f97fa aliguori
    qemu_get_8s(f, &vdev->status);
698 967f97fa aliguori
    qemu_get_8s(f, &vdev->isr);
699 967f97fa aliguori
    qemu_get_be16s(f, &vdev->queue_sel);
700 6d74ca5a Michael S. Tsirkin
    qemu_get_be32s(f, &features);
701 6d74ca5a Michael S. Tsirkin
    if (features & ~supported_features) {
702 ce67ed65 Stefan Hajnoczi
        error_report("Features 0x%x unsupported. Allowed features: 0x%x",
703 ce67ed65 Stefan Hajnoczi
                     features, supported_features);
704 6d74ca5a Michael S. Tsirkin
        return -1;
705 6d74ca5a Michael S. Tsirkin
    }
706 fae054b0 Michael S. Tsirkin
    if (vdev->set_features)
707 fae054b0 Michael S. Tsirkin
        vdev->set_features(vdev, features);
708 704a76fc Michael S. Tsirkin
    vdev->guest_features = features;
709 967f97fa aliguori
    vdev->config_len = qemu_get_be32(f);
710 967f97fa aliguori
    qemu_get_buffer(f, vdev->config, vdev->config_len);
711 967f97fa aliguori
712 967f97fa aliguori
    num = qemu_get_be32(f);
713 967f97fa aliguori
714 967f97fa aliguori
    for (i = 0; i < num; i++) {
715 967f97fa aliguori
        vdev->vq[i].vring.num = qemu_get_be32(f);
716 53c25cea Paul Brook
        vdev->vq[i].pa = qemu_get_be64(f);
717 967f97fa aliguori
        qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
718 967f97fa aliguori
719 53c25cea Paul Brook
        if (vdev->vq[i].pa) {
720 1abeb5a6 Michael S. Tsirkin
            uint16_t nheads;
721 53c25cea Paul Brook
            virtqueue_init(&vdev->vq[i]);
722 1abeb5a6 Michael S. Tsirkin
            nheads = vring_avail_idx(&vdev->vq[i]) - vdev->vq[i].last_avail_idx;
723 1abeb5a6 Michael S. Tsirkin
            /* Check it isn't doing very strange things with descriptor numbers. */
724 1abeb5a6 Michael S. Tsirkin
            if (nheads > vdev->vq[i].vring.num) {
725 1abeb5a6 Michael S. Tsirkin
                error_report("VQ %d size 0x%x Guest index 0x%x "
726 1abeb5a6 Michael S. Tsirkin
                             "inconsistent with Host index 0x%x: delta 0x%x\n",
727 1abeb5a6 Michael S. Tsirkin
                             i, vdev->vq[i].vring.num,
728 1abeb5a6 Michael S. Tsirkin
                             vring_avail_idx(&vdev->vq[i]),
729 1abeb5a6 Michael S. Tsirkin
                             vdev->vq[i].last_avail_idx, nheads);
730 1abeb5a6 Michael S. Tsirkin
                return -1;
731 1abeb5a6 Michael S. Tsirkin
            }
732 1abeb5a6 Michael S. Tsirkin
        } else if (vdev->vq[i].last_avail_idx) {
733 1abeb5a6 Michael S. Tsirkin
            error_report("VQ %d address 0x0 "
734 1abeb5a6 Michael S. Tsirkin
                         "inconsistent with Host index 0x%x\n",
735 1abeb5a6 Michael S. Tsirkin
                         i, vdev->vq[i].last_avail_idx);
736 1abeb5a6 Michael S. Tsirkin
                return -1;
737 258dc7c9 Michael S. Tsirkin
        }
738 ff24bd58 Michael S. Tsirkin
        if (vdev->binding->load_queue) {
739 ff24bd58 Michael S. Tsirkin
            ret = vdev->binding->load_queue(vdev->binding_opaque, i, f);
740 ff24bd58 Michael S. Tsirkin
            if (ret)
741 ff24bd58 Michael S. Tsirkin
                return ret;
742 7055e687 Michael S. Tsirkin
        }
743 967f97fa aliguori
    }
744 967f97fa aliguori
745 7055e687 Michael S. Tsirkin
    virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
746 ff24bd58 Michael S. Tsirkin
    return 0;
747 967f97fa aliguori
}
748 967f97fa aliguori
749 b946a153 aliguori
void virtio_cleanup(VirtIODevice *vdev)
750 b946a153 aliguori
{
751 85cf2a8d Michael S. Tsirkin
    qemu_del_vm_change_state_handler(vdev->vmstate);
752 b946a153 aliguori
    if (vdev->config)
753 b946a153 aliguori
        qemu_free(vdev->config);
754 b946a153 aliguori
    qemu_free(vdev->vq);
755 b946a153 aliguori
}
756 b946a153 aliguori
757 85cf2a8d Michael S. Tsirkin
static void virtio_vmstate_change(void *opaque, int running, int reason)
758 85cf2a8d Michael S. Tsirkin
{
759 85cf2a8d Michael S. Tsirkin
    VirtIODevice *vdev = opaque;
760 85cf2a8d Michael S. Tsirkin
    bool backend_run = running && (vdev->status & VIRTIO_CONFIG_S_DRIVER_OK);
761 85cf2a8d Michael S. Tsirkin
    vdev->vm_running = running;
762 85cf2a8d Michael S. Tsirkin
763 85cf2a8d Michael S. Tsirkin
    if (backend_run) {
764 85cf2a8d Michael S. Tsirkin
        virtio_set_status(vdev, vdev->status);
765 85cf2a8d Michael S. Tsirkin
    }
766 85cf2a8d Michael S. Tsirkin
767 85cf2a8d Michael S. Tsirkin
    if (vdev->binding->vmstate_change) {
768 85cf2a8d Michael S. Tsirkin
        vdev->binding->vmstate_change(vdev->binding_opaque, backend_run);
769 85cf2a8d Michael S. Tsirkin
    }
770 85cf2a8d Michael S. Tsirkin
771 85cf2a8d Michael S. Tsirkin
    if (!backend_run) {
772 85cf2a8d Michael S. Tsirkin
        virtio_set_status(vdev, vdev->status);
773 85cf2a8d Michael S. Tsirkin
    }
774 85cf2a8d Michael S. Tsirkin
}
775 85cf2a8d Michael S. Tsirkin
776 53c25cea Paul Brook
VirtIODevice *virtio_common_init(const char *name, uint16_t device_id,
777 53c25cea Paul Brook
                                 size_t config_size, size_t struct_size)
778 967f97fa aliguori
{
779 967f97fa aliguori
    VirtIODevice *vdev;
780 b8193adb Michael S. Tsirkin
    int i;
781 967f97fa aliguori
782 53c25cea Paul Brook
    vdev = qemu_mallocz(struct_size);
783 967f97fa aliguori
784 53c25cea Paul Brook
    vdev->device_id = device_id;
785 967f97fa aliguori
    vdev->status = 0;
786 967f97fa aliguori
    vdev->isr = 0;
787 967f97fa aliguori
    vdev->queue_sel = 0;
788 7055e687 Michael S. Tsirkin
    vdev->config_vector = VIRTIO_NO_VECTOR;
789 967f97fa aliguori
    vdev->vq = qemu_mallocz(sizeof(VirtQueue) * VIRTIO_PCI_QUEUE_MAX);
790 d3674c57 Jason Wang
    vdev->vm_running = vm_running;
791 1cbdabe2 Michael S. Tsirkin
    for(i = 0; i < VIRTIO_PCI_QUEUE_MAX; i++) {
792 b8193adb Michael S. Tsirkin
        vdev->vq[i].vector = VIRTIO_NO_VECTOR;
793 1cbdabe2 Michael S. Tsirkin
        vdev->vq[i].vdev = vdev;
794 1cbdabe2 Michael S. Tsirkin
    }
795 967f97fa aliguori
796 967f97fa aliguori
    vdev->name = name;
797 967f97fa aliguori
    vdev->config_len = config_size;
798 967f97fa aliguori
    if (vdev->config_len)
799 967f97fa aliguori
        vdev->config = qemu_mallocz(config_size);
800 967f97fa aliguori
    else
801 967f97fa aliguori
        vdev->config = NULL;
802 967f97fa aliguori
803 85cf2a8d Michael S. Tsirkin
    vdev->vmstate = qemu_add_vm_change_state_handler(virtio_vmstate_change, vdev);
804 85cf2a8d Michael S. Tsirkin
805 967f97fa aliguori
    return vdev;
806 967f97fa aliguori
}
807 53c25cea Paul Brook
808 53c25cea Paul Brook
void virtio_bind_device(VirtIODevice *vdev, const VirtIOBindings *binding,
809 53c25cea Paul Brook
                        void *opaque)
810 53c25cea Paul Brook
{
811 53c25cea Paul Brook
    vdev->binding = binding;
812 53c25cea Paul Brook
    vdev->binding_opaque = opaque;
813 53c25cea Paul Brook
}
814 1cbdabe2 Michael S. Tsirkin
815 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
816 1cbdabe2 Michael S. Tsirkin
{
817 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.desc;
818 1cbdabe2 Michael S. Tsirkin
}
819 1cbdabe2 Michael S. Tsirkin
820 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
821 1cbdabe2 Michael S. Tsirkin
{
822 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.avail;
823 1cbdabe2 Michael S. Tsirkin
}
824 1cbdabe2 Michael S. Tsirkin
825 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
826 1cbdabe2 Michael S. Tsirkin
{
827 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.used;
828 1cbdabe2 Michael S. Tsirkin
}
829 1cbdabe2 Michael S. Tsirkin
830 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_ring_addr(VirtIODevice *vdev, int n)
831 1cbdabe2 Michael S. Tsirkin
{
832 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.desc;
833 1cbdabe2 Michael S. Tsirkin
}
834 1cbdabe2 Michael S. Tsirkin
835 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
836 1cbdabe2 Michael S. Tsirkin
{
837 1cbdabe2 Michael S. Tsirkin
    return sizeof(VRingDesc) * vdev->vq[n].vring.num;
838 1cbdabe2 Michael S. Tsirkin
}
839 1cbdabe2 Michael S. Tsirkin
840 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
841 1cbdabe2 Michael S. Tsirkin
{
842 1cbdabe2 Michael S. Tsirkin
    return offsetof(VRingAvail, ring) +
843 2b3af999 Stefan Weil
        sizeof(uint64_t) * vdev->vq[n].vring.num;
844 1cbdabe2 Michael S. Tsirkin
}
845 1cbdabe2 Michael S. Tsirkin
846 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_used_size(VirtIODevice *vdev, int n)
847 1cbdabe2 Michael S. Tsirkin
{
848 1cbdabe2 Michael S. Tsirkin
    return offsetof(VRingUsed, ring) +
849 1cbdabe2 Michael S. Tsirkin
        sizeof(VRingUsedElem) * vdev->vq[n].vring.num;
850 1cbdabe2 Michael S. Tsirkin
}
851 1cbdabe2 Michael S. Tsirkin
852 1cbdabe2 Michael S. Tsirkin
target_phys_addr_t virtio_queue_get_ring_size(VirtIODevice *vdev, int n)
853 1cbdabe2 Michael S. Tsirkin
{
854 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].vring.used - vdev->vq[n].vring.desc +
855 1cbdabe2 Michael S. Tsirkin
            virtio_queue_get_used_size(vdev, n);
856 1cbdabe2 Michael S. Tsirkin
}
857 1cbdabe2 Michael S. Tsirkin
858 1cbdabe2 Michael S. Tsirkin
uint16_t virtio_queue_get_last_avail_idx(VirtIODevice *vdev, int n)
859 1cbdabe2 Michael S. Tsirkin
{
860 1cbdabe2 Michael S. Tsirkin
    return vdev->vq[n].last_avail_idx;
861 1cbdabe2 Michael S. Tsirkin
}
862 1cbdabe2 Michael S. Tsirkin
863 1cbdabe2 Michael S. Tsirkin
void virtio_queue_set_last_avail_idx(VirtIODevice *vdev, int n, uint16_t idx)
864 1cbdabe2 Michael S. Tsirkin
{
865 1cbdabe2 Michael S. Tsirkin
    vdev->vq[n].last_avail_idx = idx;
866 1cbdabe2 Michael S. Tsirkin
}
867 1cbdabe2 Michael S. Tsirkin
868 1cbdabe2 Michael S. Tsirkin
VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
869 1cbdabe2 Michael S. Tsirkin
{
870 1cbdabe2 Michael S. Tsirkin
    return vdev->vq + n;
871 1cbdabe2 Michael S. Tsirkin
}
872 1cbdabe2 Michael S. Tsirkin
873 1cbdabe2 Michael S. Tsirkin
EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
874 1cbdabe2 Michael S. Tsirkin
{
875 1cbdabe2 Michael S. Tsirkin
    return &vq->guest_notifier;
876 1cbdabe2 Michael S. Tsirkin
}
877 1cbdabe2 Michael S. Tsirkin
EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
878 1cbdabe2 Michael S. Tsirkin
{
879 1cbdabe2 Michael S. Tsirkin
    return &vq->host_notifier;
880 1cbdabe2 Michael S. Tsirkin
}