xref: /qemu/hw/virtio/virtio.c (revision 69b205bb)
1 /*
2  * Virtio Support
3  *
4  * Copyright IBM, Corp. 2007
5  *
6  * Authors:
7  *  Anthony Liguori   <aliguori@us.ibm.com>
8  *
9  * This work is licensed under the terms of the GNU GPL, version 2.  See
10  * the COPYING file in the top-level directory.
11  *
12  */
13 
14 #include "qemu/osdep.h"
15 #include "qapi/error.h"
16 #include "qemu-common.h"
17 #include "cpu.h"
18 #include "trace.h"
19 #include "exec/address-spaces.h"
20 #include "qemu/error-report.h"
21 #include "hw/virtio/virtio.h"
22 #include "qemu/atomic.h"
23 #include "hw/virtio/virtio-bus.h"
24 #include "migration/migration.h"
25 #include "hw/virtio/virtio-access.h"
26 
27 /*
28  * The alignment to use between consumer and producer parts of vring.
29  * x86 pagesize again. This is the default, used by transports like PCI
30  * which don't provide a means for the guest to tell the host the alignment.
31  */
32 #define VIRTIO_PCI_VRING_ALIGN         4096
33 
34 typedef struct VRingDesc
35 {
36     uint64_t addr;
37     uint32_t len;
38     uint16_t flags;
39     uint16_t next;
40 } VRingDesc;
41 
42 typedef struct VRingAvail
43 {
44     uint16_t flags;
45     uint16_t idx;
46     uint16_t ring[0];
47 } VRingAvail;
48 
49 typedef struct VRingUsedElem
50 {
51     uint32_t id;
52     uint32_t len;
53 } VRingUsedElem;
54 
55 typedef struct VRingUsed
56 {
57     uint16_t flags;
58     uint16_t idx;
59     VRingUsedElem ring[0];
60 } VRingUsed;
61 
62 typedef struct VRing
63 {
64     unsigned int num;
65     unsigned int num_default;
66     unsigned int align;
67     hwaddr desc;
68     hwaddr avail;
69     hwaddr used;
70 } VRing;
71 
72 struct VirtQueue
73 {
74     VRing vring;
75 
76     /* Next head to pop */
77     uint16_t last_avail_idx;
78 
79     /* Last avail_idx read from VQ. */
80     uint16_t shadow_avail_idx;
81 
82     uint16_t used_idx;
83 
84     /* Last used index value we have signalled on */
85     uint16_t signalled_used;
86 
87     /* Last used index value we have signalled on */
88     bool signalled_used_valid;
89 
90     /* Notification enabled? */
91     bool notification;
92 
93     uint16_t queue_index;
94 
95     int inuse;
96 
97     uint16_t vector;
98     void (*handle_output)(VirtIODevice *vdev, VirtQueue *vq);
99     void (*handle_aio_output)(VirtIODevice *vdev, VirtQueue *vq);
100     VirtIODevice *vdev;
101     EventNotifier guest_notifier;
102     EventNotifier host_notifier;
103     QLIST_ENTRY(VirtQueue) node;
104 };
105 
106 /* virt queue functions */
107 void virtio_queue_update_rings(VirtIODevice *vdev, int n)
108 {
109     VRing *vring = &vdev->vq[n].vring;
110 
111     if (!vring->desc) {
112         /* not yet setup -> nothing to do */
113         return;
114     }
115     vring->avail = vring->desc + vring->num * sizeof(VRingDesc);
116     vring->used = vring_align(vring->avail +
117                               offsetof(VRingAvail, ring[vring->num]),
118                               vring->align);
119 }
120 
121 static void vring_desc_read(VirtIODevice *vdev, VRingDesc *desc,
122                             hwaddr desc_pa, int i)
123 {
124     address_space_read(&address_space_memory, desc_pa + i * sizeof(VRingDesc),
125                        MEMTXATTRS_UNSPECIFIED, (void *)desc, sizeof(VRingDesc));
126     virtio_tswap64s(vdev, &desc->addr);
127     virtio_tswap32s(vdev, &desc->len);
128     virtio_tswap16s(vdev, &desc->flags);
129     virtio_tswap16s(vdev, &desc->next);
130 }
131 
132 static inline uint16_t vring_avail_flags(VirtQueue *vq)
133 {
134     hwaddr pa;
135     pa = vq->vring.avail + offsetof(VRingAvail, flags);
136     return virtio_lduw_phys(vq->vdev, pa);
137 }
138 
139 static inline uint16_t vring_avail_idx(VirtQueue *vq)
140 {
141     hwaddr pa;
142     pa = vq->vring.avail + offsetof(VRingAvail, idx);
143     vq->shadow_avail_idx = virtio_lduw_phys(vq->vdev, pa);
144     return vq->shadow_avail_idx;
145 }
146 
147 static inline uint16_t vring_avail_ring(VirtQueue *vq, int i)
148 {
149     hwaddr pa;
150     pa = vq->vring.avail + offsetof(VRingAvail, ring[i]);
151     return virtio_lduw_phys(vq->vdev, pa);
152 }
153 
154 static inline uint16_t vring_get_used_event(VirtQueue *vq)
155 {
156     return vring_avail_ring(vq, vq->vring.num);
157 }
158 
159 static inline void vring_used_write(VirtQueue *vq, VRingUsedElem *uelem,
160                                     int i)
161 {
162     hwaddr pa;
163     virtio_tswap32s(vq->vdev, &uelem->id);
164     virtio_tswap32s(vq->vdev, &uelem->len);
165     pa = vq->vring.used + offsetof(VRingUsed, ring[i]);
166     address_space_write(&address_space_memory, pa, MEMTXATTRS_UNSPECIFIED,
167                        (void *)uelem, sizeof(VRingUsedElem));
168 }
169 
170 static uint16_t vring_used_idx(VirtQueue *vq)
171 {
172     hwaddr pa;
173     pa = vq->vring.used + offsetof(VRingUsed, idx);
174     return virtio_lduw_phys(vq->vdev, pa);
175 }
176 
177 static inline void vring_used_idx_set(VirtQueue *vq, uint16_t val)
178 {
179     hwaddr pa;
180     pa = vq->vring.used + offsetof(VRingUsed, idx);
181     virtio_stw_phys(vq->vdev, pa, val);
182     vq->used_idx = val;
183 }
184 
185 static inline void vring_used_flags_set_bit(VirtQueue *vq, int mask)
186 {
187     VirtIODevice *vdev = vq->vdev;
188     hwaddr pa;
189     pa = vq->vring.used + offsetof(VRingUsed, flags);
190     virtio_stw_phys(vdev, pa, virtio_lduw_phys(vdev, pa) | mask);
191 }
192 
193 static inline void vring_used_flags_unset_bit(VirtQueue *vq, int mask)
194 {
195     VirtIODevice *vdev = vq->vdev;
196     hwaddr pa;
197     pa = vq->vring.used + offsetof(VRingUsed, flags);
198     virtio_stw_phys(vdev, pa, virtio_lduw_phys(vdev, pa) & ~mask);
199 }
200 
201 static inline void vring_set_avail_event(VirtQueue *vq, uint16_t val)
202 {
203     hwaddr pa;
204     if (!vq->notification) {
205         return;
206     }
207     pa = vq->vring.used + offsetof(VRingUsed, ring[vq->vring.num]);
208     virtio_stw_phys(vq->vdev, pa, val);
209 }
210 
211 void virtio_queue_set_notification(VirtQueue *vq, int enable)
212 {
213     vq->notification = enable;
214     if (virtio_vdev_has_feature(vq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
215         vring_set_avail_event(vq, vring_avail_idx(vq));
216     } else if (enable) {
217         vring_used_flags_unset_bit(vq, VRING_USED_F_NO_NOTIFY);
218     } else {
219         vring_used_flags_set_bit(vq, VRING_USED_F_NO_NOTIFY);
220     }
221     if (enable) {
222         /* Expose avail event/used flags before caller checks the avail idx. */
223         smp_mb();
224     }
225 }
226 
227 int virtio_queue_ready(VirtQueue *vq)
228 {
229     return vq->vring.avail != 0;
230 }
231 
232 /* Fetch avail_idx from VQ memory only when we really need to know if
233  * guest has added some buffers. */
234 int virtio_queue_empty(VirtQueue *vq)
235 {
236     if (vq->shadow_avail_idx != vq->last_avail_idx) {
237         return 0;
238     }
239 
240     return vring_avail_idx(vq) == vq->last_avail_idx;
241 }
242 
243 static void virtqueue_unmap_sg(VirtQueue *vq, const VirtQueueElement *elem,
244                                unsigned int len)
245 {
246     unsigned int offset;
247     int i;
248 
249     offset = 0;
250     for (i = 0; i < elem->in_num; i++) {
251         size_t size = MIN(len - offset, elem->in_sg[i].iov_len);
252 
253         cpu_physical_memory_unmap(elem->in_sg[i].iov_base,
254                                   elem->in_sg[i].iov_len,
255                                   1, size);
256 
257         offset += size;
258     }
259 
260     for (i = 0; i < elem->out_num; i++)
261         cpu_physical_memory_unmap(elem->out_sg[i].iov_base,
262                                   elem->out_sg[i].iov_len,
263                                   0, elem->out_sg[i].iov_len);
264 }
265 
266 void virtqueue_discard(VirtQueue *vq, const VirtQueueElement *elem,
267                        unsigned int len)
268 {
269     vq->last_avail_idx--;
270     virtqueue_unmap_sg(vq, elem, len);
271 }
272 
273 void virtqueue_fill(VirtQueue *vq, const VirtQueueElement *elem,
274                     unsigned int len, unsigned int idx)
275 {
276     VRingUsedElem uelem;
277 
278     trace_virtqueue_fill(vq, elem, len, idx);
279 
280     virtqueue_unmap_sg(vq, elem, len);
281 
282     idx = (idx + vq->used_idx) % vq->vring.num;
283 
284     uelem.id = elem->index;
285     uelem.len = len;
286     vring_used_write(vq, &uelem, idx);
287 }
288 
289 void virtqueue_flush(VirtQueue *vq, unsigned int count)
290 {
291     uint16_t old, new;
292     /* Make sure buffer is written before we update index. */
293     smp_wmb();
294     trace_virtqueue_flush(vq, count);
295     old = vq->used_idx;
296     new = old + count;
297     vring_used_idx_set(vq, new);
298     vq->inuse -= count;
299     if (unlikely((int16_t)(new - vq->signalled_used) < (uint16_t)(new - old)))
300         vq->signalled_used_valid = false;
301 }
302 
303 void virtqueue_push(VirtQueue *vq, const VirtQueueElement *elem,
304                     unsigned int len)
305 {
306     virtqueue_fill(vq, elem, len, 0);
307     virtqueue_flush(vq, 1);
308 }
309 
310 static int virtqueue_num_heads(VirtQueue *vq, unsigned int idx)
311 {
312     uint16_t num_heads = vring_avail_idx(vq) - idx;
313 
314     /* Check it isn't doing very strange things with descriptor numbers. */
315     if (num_heads > vq->vring.num) {
316         error_report("Guest moved used index from %u to %u",
317                      idx, vq->shadow_avail_idx);
318         exit(1);
319     }
320     /* On success, callers read a descriptor at vq->last_avail_idx.
321      * Make sure descriptor read does not bypass avail index read. */
322     if (num_heads) {
323         smp_rmb();
324     }
325 
326     return num_heads;
327 }
328 
329 static unsigned int virtqueue_get_head(VirtQueue *vq, unsigned int idx)
330 {
331     unsigned int head;
332 
333     /* Grab the next descriptor number they're advertising, and increment
334      * the index we've seen. */
335     head = vring_avail_ring(vq, idx % vq->vring.num);
336 
337     /* If their number is silly, that's a fatal mistake. */
338     if (head >= vq->vring.num) {
339         error_report("Guest says index %u is available", head);
340         exit(1);
341     }
342 
343     return head;
344 }
345 
346 static unsigned virtqueue_read_next_desc(VirtIODevice *vdev, VRingDesc *desc,
347                                          hwaddr desc_pa, unsigned int max)
348 {
349     unsigned int next;
350 
351     /* If this descriptor says it doesn't chain, we're done. */
352     if (!(desc->flags & VRING_DESC_F_NEXT)) {
353         return max;
354     }
355 
356     /* Check they're not leading us off end of descriptors. */
357     next = desc->next;
358     /* Make sure compiler knows to grab that: we don't want it changing! */
359     smp_wmb();
360 
361     if (next >= max) {
362         error_report("Desc next is %u", next);
363         exit(1);
364     }
365 
366     vring_desc_read(vdev, desc, desc_pa, next);
367     return next;
368 }
369 
370 void virtqueue_get_avail_bytes(VirtQueue *vq, unsigned int *in_bytes,
371                                unsigned int *out_bytes,
372                                unsigned max_in_bytes, unsigned max_out_bytes)
373 {
374     unsigned int idx;
375     unsigned int total_bufs, in_total, out_total;
376 
377     idx = vq->last_avail_idx;
378 
379     total_bufs = in_total = out_total = 0;
380     while (virtqueue_num_heads(vq, idx)) {
381         VirtIODevice *vdev = vq->vdev;
382         unsigned int max, num_bufs, indirect = 0;
383         VRingDesc desc;
384         hwaddr desc_pa;
385         int i;
386 
387         max = vq->vring.num;
388         num_bufs = total_bufs;
389         i = virtqueue_get_head(vq, idx++);
390         desc_pa = vq->vring.desc;
391         vring_desc_read(vdev, &desc, desc_pa, i);
392 
393         if (desc.flags & VRING_DESC_F_INDIRECT) {
394             if (desc.len % sizeof(VRingDesc)) {
395                 error_report("Invalid size for indirect buffer table");
396                 exit(1);
397             }
398 
399             /* If we've got too many, that implies a descriptor loop. */
400             if (num_bufs >= max) {
401                 error_report("Looped descriptor");
402                 exit(1);
403             }
404 
405             /* loop over the indirect descriptor table */
406             indirect = 1;
407             max = desc.len / sizeof(VRingDesc);
408             desc_pa = desc.addr;
409             num_bufs = i = 0;
410             vring_desc_read(vdev, &desc, desc_pa, i);
411         }
412 
413         do {
414             /* If we've got too many, that implies a descriptor loop. */
415             if (++num_bufs > max) {
416                 error_report("Looped descriptor");
417                 exit(1);
418             }
419 
420             if (desc.flags & VRING_DESC_F_WRITE) {
421                 in_total += desc.len;
422             } else {
423                 out_total += desc.len;
424             }
425             if (in_total >= max_in_bytes && out_total >= max_out_bytes) {
426                 goto done;
427             }
428         } while ((i = virtqueue_read_next_desc(vdev, &desc, desc_pa, max)) != max);
429 
430         if (!indirect)
431             total_bufs = num_bufs;
432         else
433             total_bufs++;
434     }
435 done:
436     if (in_bytes) {
437         *in_bytes = in_total;
438     }
439     if (out_bytes) {
440         *out_bytes = out_total;
441     }
442 }
443 
444 int virtqueue_avail_bytes(VirtQueue *vq, unsigned int in_bytes,
445                           unsigned int out_bytes)
446 {
447     unsigned int in_total, out_total;
448 
449     virtqueue_get_avail_bytes(vq, &in_total, &out_total, in_bytes, out_bytes);
450     return in_bytes <= in_total && out_bytes <= out_total;
451 }
452 
453 static void virtqueue_map_desc(unsigned int *p_num_sg, hwaddr *addr, struct iovec *iov,
454                                unsigned int max_num_sg, bool is_write,
455                                hwaddr pa, size_t sz)
456 {
457     unsigned num_sg = *p_num_sg;
458     assert(num_sg <= max_num_sg);
459 
460     while (sz) {
461         hwaddr len = sz;
462 
463         if (num_sg == max_num_sg) {
464             error_report("virtio: too many write descriptors in indirect table");
465             exit(1);
466         }
467 
468         iov[num_sg].iov_base = cpu_physical_memory_map(pa, &len, is_write);
469         iov[num_sg].iov_len = len;
470         addr[num_sg] = pa;
471 
472         sz -= len;
473         pa += len;
474         num_sg++;
475     }
476     *p_num_sg = num_sg;
477 }
478 
479 static void virtqueue_map_iovec(struct iovec *sg, hwaddr *addr,
480                                 unsigned int *num_sg, unsigned int max_size,
481                                 int is_write)
482 {
483     unsigned int i;
484     hwaddr len;
485 
486     /* Note: this function MUST validate input, some callers
487      * are passing in num_sg values received over the network.
488      */
489     /* TODO: teach all callers that this can fail, and return failure instead
490      * of asserting here.
491      * When we do, we might be able to re-enable NDEBUG below.
492      */
493 #ifdef NDEBUG
494 #error building with NDEBUG is not supported
495 #endif
496     assert(*num_sg <= max_size);
497 
498     for (i = 0; i < *num_sg; i++) {
499         len = sg[i].iov_len;
500         sg[i].iov_base = cpu_physical_memory_map(addr[i], &len, is_write);
501         if (!sg[i].iov_base) {
502             error_report("virtio: error trying to map MMIO memory");
503             exit(1);
504         }
505         if (len != sg[i].iov_len) {
506             error_report("virtio: unexpected memory split");
507             exit(1);
508         }
509     }
510 }
511 
512 void virtqueue_map(VirtQueueElement *elem)
513 {
514     virtqueue_map_iovec(elem->in_sg, elem->in_addr, &elem->in_num,
515                         VIRTQUEUE_MAX_SIZE, 1);
516     virtqueue_map_iovec(elem->out_sg, elem->out_addr, &elem->out_num,
517                         VIRTQUEUE_MAX_SIZE, 0);
518 }
519 
520 void *virtqueue_alloc_element(size_t sz, unsigned out_num, unsigned in_num)
521 {
522     VirtQueueElement *elem;
523     size_t in_addr_ofs = QEMU_ALIGN_UP(sz, __alignof__(elem->in_addr[0]));
524     size_t out_addr_ofs = in_addr_ofs + in_num * sizeof(elem->in_addr[0]);
525     size_t out_addr_end = out_addr_ofs + out_num * sizeof(elem->out_addr[0]);
526     size_t in_sg_ofs = QEMU_ALIGN_UP(out_addr_end, __alignof__(elem->in_sg[0]));
527     size_t out_sg_ofs = in_sg_ofs + in_num * sizeof(elem->in_sg[0]);
528     size_t out_sg_end = out_sg_ofs + out_num * sizeof(elem->out_sg[0]);
529 
530     assert(sz >= sizeof(VirtQueueElement));
531     elem = g_malloc(out_sg_end);
532     elem->out_num = out_num;
533     elem->in_num = in_num;
534     elem->in_addr = (void *)elem + in_addr_ofs;
535     elem->out_addr = (void *)elem + out_addr_ofs;
536     elem->in_sg = (void *)elem + in_sg_ofs;
537     elem->out_sg = (void *)elem + out_sg_ofs;
538     return elem;
539 }
540 
541 void *virtqueue_pop(VirtQueue *vq, size_t sz)
542 {
543     unsigned int i, head, max;
544     hwaddr desc_pa = vq->vring.desc;
545     VirtIODevice *vdev = vq->vdev;
546     VirtQueueElement *elem;
547     unsigned out_num, in_num;
548     hwaddr addr[VIRTQUEUE_MAX_SIZE];
549     struct iovec iov[VIRTQUEUE_MAX_SIZE];
550     VRingDesc desc;
551 
552     if (virtio_queue_empty(vq)) {
553         return NULL;
554     }
555     /* Needed after virtio_queue_empty(), see comment in
556      * virtqueue_num_heads(). */
557     smp_rmb();
558 
559     /* When we start there are none of either input nor output. */
560     out_num = in_num = 0;
561 
562     max = vq->vring.num;
563 
564     i = head = virtqueue_get_head(vq, vq->last_avail_idx++);
565     if (virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
566         vring_set_avail_event(vq, vq->last_avail_idx);
567     }
568 
569     vring_desc_read(vdev, &desc, desc_pa, i);
570     if (desc.flags & VRING_DESC_F_INDIRECT) {
571         if (desc.len % sizeof(VRingDesc)) {
572             error_report("Invalid size for indirect buffer table");
573             exit(1);
574         }
575 
576         /* loop over the indirect descriptor table */
577         max = desc.len / sizeof(VRingDesc);
578         desc_pa = desc.addr;
579         i = 0;
580         vring_desc_read(vdev, &desc, desc_pa, i);
581     }
582 
583     /* Collect all the descriptors */
584     do {
585         if (desc.flags & VRING_DESC_F_WRITE) {
586             virtqueue_map_desc(&in_num, addr + out_num, iov + out_num,
587                                VIRTQUEUE_MAX_SIZE - out_num, true, desc.addr, desc.len);
588         } else {
589             if (in_num) {
590                 error_report("Incorrect order for descriptors");
591                 exit(1);
592             }
593             virtqueue_map_desc(&out_num, addr, iov,
594                                VIRTQUEUE_MAX_SIZE, false, desc.addr, desc.len);
595         }
596 
597         /* If we've got too many, that implies a descriptor loop. */
598         if ((in_num + out_num) > max) {
599             error_report("Looped descriptor");
600             exit(1);
601         }
602     } while ((i = virtqueue_read_next_desc(vdev, &desc, desc_pa, max)) != max);
603 
604     /* Now copy what we have collected and mapped */
605     elem = virtqueue_alloc_element(sz, out_num, in_num);
606     elem->index = head;
607     for (i = 0; i < out_num; i++) {
608         elem->out_addr[i] = addr[i];
609         elem->out_sg[i] = iov[i];
610     }
611     for (i = 0; i < in_num; i++) {
612         elem->in_addr[i] = addr[out_num + i];
613         elem->in_sg[i] = iov[out_num + i];
614     }
615 
616     vq->inuse++;
617 
618     trace_virtqueue_pop(vq, elem, elem->in_num, elem->out_num);
619     return elem;
620 }
621 
622 /* Reading and writing a structure directly to QEMUFile is *awful*, but
623  * it is what QEMU has always done by mistake.  We can change it sooner
624  * or later by bumping the version number of the affected vm states.
625  * In the meanwhile, since the in-memory layout of VirtQueueElement
626  * has changed, we need to marshal to and from the layout that was
627  * used before the change.
628  */
629 typedef struct VirtQueueElementOld {
630     unsigned int index;
631     unsigned int out_num;
632     unsigned int in_num;
633     hwaddr in_addr[VIRTQUEUE_MAX_SIZE];
634     hwaddr out_addr[VIRTQUEUE_MAX_SIZE];
635     struct iovec in_sg[VIRTQUEUE_MAX_SIZE];
636     struct iovec out_sg[VIRTQUEUE_MAX_SIZE];
637 } VirtQueueElementOld;
638 
639 void *qemu_get_virtqueue_element(QEMUFile *f, size_t sz)
640 {
641     VirtQueueElement *elem;
642     VirtQueueElementOld data;
643     int i;
644 
645     qemu_get_buffer(f, (uint8_t *)&data, sizeof(VirtQueueElementOld));
646 
647     elem = virtqueue_alloc_element(sz, data.out_num, data.in_num);
648     elem->index = data.index;
649 
650     for (i = 0; i < elem->in_num; i++) {
651         elem->in_addr[i] = data.in_addr[i];
652     }
653 
654     for (i = 0; i < elem->out_num; i++) {
655         elem->out_addr[i] = data.out_addr[i];
656     }
657 
658     for (i = 0; i < elem->in_num; i++) {
659         /* Base is overwritten by virtqueue_map.  */
660         elem->in_sg[i].iov_base = 0;
661         elem->in_sg[i].iov_len = data.in_sg[i].iov_len;
662     }
663 
664     for (i = 0; i < elem->out_num; i++) {
665         /* Base is overwritten by virtqueue_map.  */
666         elem->out_sg[i].iov_base = 0;
667         elem->out_sg[i].iov_len = data.out_sg[i].iov_len;
668     }
669 
670     virtqueue_map(elem);
671     return elem;
672 }
673 
674 void qemu_put_virtqueue_element(QEMUFile *f, VirtQueueElement *elem)
675 {
676     VirtQueueElementOld data;
677     int i;
678 
679     memset(&data, 0, sizeof(data));
680     data.index = elem->index;
681     data.in_num = elem->in_num;
682     data.out_num = elem->out_num;
683 
684     for (i = 0; i < elem->in_num; i++) {
685         data.in_addr[i] = elem->in_addr[i];
686     }
687 
688     for (i = 0; i < elem->out_num; i++) {
689         data.out_addr[i] = elem->out_addr[i];
690     }
691 
692     for (i = 0; i < elem->in_num; i++) {
693         /* Base is overwritten by virtqueue_map when loading.  Do not
694          * save it, as it would leak the QEMU address space layout.  */
695         data.in_sg[i].iov_len = elem->in_sg[i].iov_len;
696     }
697 
698     for (i = 0; i < elem->out_num; i++) {
699         /* Do not save iov_base as above.  */
700         data.out_sg[i].iov_len = elem->out_sg[i].iov_len;
701     }
702     qemu_put_buffer(f, (uint8_t *)&data, sizeof(VirtQueueElementOld));
703 }
704 
705 /* virtio device */
706 static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
707 {
708     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
709     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
710 
711     if (k->notify) {
712         k->notify(qbus->parent, vector);
713     }
714 }
715 
716 void virtio_update_irq(VirtIODevice *vdev)
717 {
718     virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
719 }
720 
721 static int virtio_validate_features(VirtIODevice *vdev)
722 {
723     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
724 
725     if (k->validate_features) {
726         return k->validate_features(vdev);
727     } else {
728         return 0;
729     }
730 }
731 
732 int virtio_set_status(VirtIODevice *vdev, uint8_t val)
733 {
734     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
735     trace_virtio_set_status(vdev, val);
736 
737     if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
738         if (!(vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) &&
739             val & VIRTIO_CONFIG_S_FEATURES_OK) {
740             int ret = virtio_validate_features(vdev);
741 
742             if (ret) {
743                 return ret;
744             }
745         }
746     }
747     if (k->set_status) {
748         k->set_status(vdev, val);
749     }
750     vdev->status = val;
751     return 0;
752 }
753 
754 bool target_words_bigendian(void);
755 static enum virtio_device_endian virtio_default_endian(void)
756 {
757     if (target_words_bigendian()) {
758         return VIRTIO_DEVICE_ENDIAN_BIG;
759     } else {
760         return VIRTIO_DEVICE_ENDIAN_LITTLE;
761     }
762 }
763 
764 static enum virtio_device_endian virtio_current_cpu_endian(void)
765 {
766     CPUClass *cc = CPU_GET_CLASS(current_cpu);
767 
768     if (cc->virtio_is_big_endian(current_cpu)) {
769         return VIRTIO_DEVICE_ENDIAN_BIG;
770     } else {
771         return VIRTIO_DEVICE_ENDIAN_LITTLE;
772     }
773 }
774 
775 void virtio_reset(void *opaque)
776 {
777     VirtIODevice *vdev = opaque;
778     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
779     int i;
780 
781     virtio_set_status(vdev, 0);
782     if (current_cpu) {
783         /* Guest initiated reset */
784         vdev->device_endian = virtio_current_cpu_endian();
785     } else {
786         /* System reset */
787         vdev->device_endian = virtio_default_endian();
788     }
789 
790     if (k->reset) {
791         k->reset(vdev);
792     }
793 
794     vdev->guest_features = 0;
795     vdev->queue_sel = 0;
796     vdev->status = 0;
797     vdev->isr = 0;
798     vdev->config_vector = VIRTIO_NO_VECTOR;
799     virtio_notify_vector(vdev, vdev->config_vector);
800 
801     for(i = 0; i < VIRTIO_QUEUE_MAX; i++) {
802         vdev->vq[i].vring.desc = 0;
803         vdev->vq[i].vring.avail = 0;
804         vdev->vq[i].vring.used = 0;
805         vdev->vq[i].last_avail_idx = 0;
806         vdev->vq[i].shadow_avail_idx = 0;
807         vdev->vq[i].used_idx = 0;
808         virtio_queue_set_vector(vdev, i, VIRTIO_NO_VECTOR);
809         vdev->vq[i].signalled_used = 0;
810         vdev->vq[i].signalled_used_valid = false;
811         vdev->vq[i].notification = true;
812         vdev->vq[i].vring.num = vdev->vq[i].vring.num_default;
813     }
814 }
815 
816 uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
817 {
818     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
819     uint8_t val;
820 
821     if (addr + sizeof(val) > vdev->config_len) {
822         return (uint32_t)-1;
823     }
824 
825     k->get_config(vdev, vdev->config);
826 
827     val = ldub_p(vdev->config + addr);
828     return val;
829 }
830 
831 uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr)
832 {
833     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
834     uint16_t val;
835 
836     if (addr + sizeof(val) > vdev->config_len) {
837         return (uint32_t)-1;
838     }
839 
840     k->get_config(vdev, vdev->config);
841 
842     val = lduw_p(vdev->config + addr);
843     return val;
844 }
845 
846 uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr)
847 {
848     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
849     uint32_t val;
850 
851     if (addr + sizeof(val) > vdev->config_len) {
852         return (uint32_t)-1;
853     }
854 
855     k->get_config(vdev, vdev->config);
856 
857     val = ldl_p(vdev->config + addr);
858     return val;
859 }
860 
861 void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data)
862 {
863     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
864     uint8_t val = data;
865 
866     if (addr + sizeof(val) > vdev->config_len) {
867         return;
868     }
869 
870     stb_p(vdev->config + addr, val);
871 
872     if (k->set_config) {
873         k->set_config(vdev, vdev->config);
874     }
875 }
876 
877 void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data)
878 {
879     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
880     uint16_t val = data;
881 
882     if (addr + sizeof(val) > vdev->config_len) {
883         return;
884     }
885 
886     stw_p(vdev->config + addr, val);
887 
888     if (k->set_config) {
889         k->set_config(vdev, vdev->config);
890     }
891 }
892 
893 void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
894 {
895     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
896     uint32_t val = data;
897 
898     if (addr + sizeof(val) > vdev->config_len) {
899         return;
900     }
901 
902     stl_p(vdev->config + addr, val);
903 
904     if (k->set_config) {
905         k->set_config(vdev, vdev->config);
906     }
907 }
908 
909 uint32_t virtio_config_modern_readb(VirtIODevice *vdev, uint32_t addr)
910 {
911     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
912     uint8_t val;
913 
914     if (addr + sizeof(val) > vdev->config_len) {
915         return (uint32_t)-1;
916     }
917 
918     k->get_config(vdev, vdev->config);
919 
920     val = ldub_p(vdev->config + addr);
921     return val;
922 }
923 
924 uint32_t virtio_config_modern_readw(VirtIODevice *vdev, uint32_t addr)
925 {
926     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
927     uint16_t val;
928 
929     if (addr + sizeof(val) > vdev->config_len) {
930         return (uint32_t)-1;
931     }
932 
933     k->get_config(vdev, vdev->config);
934 
935     val = lduw_le_p(vdev->config + addr);
936     return val;
937 }
938 
939 uint32_t virtio_config_modern_readl(VirtIODevice *vdev, uint32_t addr)
940 {
941     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
942     uint32_t val;
943 
944     if (addr + sizeof(val) > vdev->config_len) {
945         return (uint32_t)-1;
946     }
947 
948     k->get_config(vdev, vdev->config);
949 
950     val = ldl_le_p(vdev->config + addr);
951     return val;
952 }
953 
954 void virtio_config_modern_writeb(VirtIODevice *vdev,
955                                  uint32_t addr, uint32_t data)
956 {
957     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
958     uint8_t val = data;
959 
960     if (addr + sizeof(val) > vdev->config_len) {
961         return;
962     }
963 
964     stb_p(vdev->config + addr, val);
965 
966     if (k->set_config) {
967         k->set_config(vdev, vdev->config);
968     }
969 }
970 
971 void virtio_config_modern_writew(VirtIODevice *vdev,
972                                  uint32_t addr, uint32_t data)
973 {
974     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
975     uint16_t val = data;
976 
977     if (addr + sizeof(val) > vdev->config_len) {
978         return;
979     }
980 
981     stw_le_p(vdev->config + addr, val);
982 
983     if (k->set_config) {
984         k->set_config(vdev, vdev->config);
985     }
986 }
987 
988 void virtio_config_modern_writel(VirtIODevice *vdev,
989                                  uint32_t addr, uint32_t data)
990 {
991     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
992     uint32_t val = data;
993 
994     if (addr + sizeof(val) > vdev->config_len) {
995         return;
996     }
997 
998     stl_le_p(vdev->config + addr, val);
999 
1000     if (k->set_config) {
1001         k->set_config(vdev, vdev->config);
1002     }
1003 }
1004 
1005 void virtio_queue_set_addr(VirtIODevice *vdev, int n, hwaddr addr)
1006 {
1007     vdev->vq[n].vring.desc = addr;
1008     virtio_queue_update_rings(vdev, n);
1009 }
1010 
1011 hwaddr virtio_queue_get_addr(VirtIODevice *vdev, int n)
1012 {
1013     return vdev->vq[n].vring.desc;
1014 }
1015 
1016 void virtio_queue_set_rings(VirtIODevice *vdev, int n, hwaddr desc,
1017                             hwaddr avail, hwaddr used)
1018 {
1019     vdev->vq[n].vring.desc = desc;
1020     vdev->vq[n].vring.avail = avail;
1021     vdev->vq[n].vring.used = used;
1022 }
1023 
1024 void virtio_queue_set_num(VirtIODevice *vdev, int n, int num)
1025 {
1026     /* Don't allow guest to flip queue between existent and
1027      * nonexistent states, or to set it to an invalid size.
1028      */
1029     if (!!num != !!vdev->vq[n].vring.num ||
1030         num > VIRTQUEUE_MAX_SIZE ||
1031         num < 0) {
1032         return;
1033     }
1034     vdev->vq[n].vring.num = num;
1035 }
1036 
1037 VirtQueue *virtio_vector_first_queue(VirtIODevice *vdev, uint16_t vector)
1038 {
1039     return QLIST_FIRST(&vdev->vector_queues[vector]);
1040 }
1041 
1042 VirtQueue *virtio_vector_next_queue(VirtQueue *vq)
1043 {
1044     return QLIST_NEXT(vq, node);
1045 }
1046 
1047 int virtio_queue_get_num(VirtIODevice *vdev, int n)
1048 {
1049     return vdev->vq[n].vring.num;
1050 }
1051 
1052 int virtio_get_num_queues(VirtIODevice *vdev)
1053 {
1054     int i;
1055 
1056     for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1057         if (!virtio_queue_get_num(vdev, i)) {
1058             break;
1059         }
1060     }
1061 
1062     return i;
1063 }
1064 
1065 void virtio_queue_set_align(VirtIODevice *vdev, int n, int align)
1066 {
1067     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
1068     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1069 
1070     /* virtio-1 compliant devices cannot change the alignment */
1071     if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1072         error_report("tried to modify queue alignment for virtio-1 device");
1073         return;
1074     }
1075     /* Check that the transport told us it was going to do this
1076      * (so a buggy transport will immediately assert rather than
1077      * silently failing to migrate this state)
1078      */
1079     assert(k->has_variable_vring_alignment);
1080 
1081     vdev->vq[n].vring.align = align;
1082     virtio_queue_update_rings(vdev, n);
1083 }
1084 
1085 static void virtio_queue_notify_aio_vq(VirtQueue *vq)
1086 {
1087     if (vq->vring.desc && vq->handle_aio_output) {
1088         VirtIODevice *vdev = vq->vdev;
1089 
1090         trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
1091         vq->handle_aio_output(vdev, vq);
1092     }
1093 }
1094 
1095 static void virtio_queue_notify_vq(VirtQueue *vq)
1096 {
1097     if (vq->vring.desc && vq->handle_output) {
1098         VirtIODevice *vdev = vq->vdev;
1099 
1100         trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
1101         vq->handle_output(vdev, vq);
1102     }
1103 }
1104 
1105 void virtio_queue_notify(VirtIODevice *vdev, int n)
1106 {
1107     virtio_queue_notify_vq(&vdev->vq[n]);
1108 }
1109 
1110 uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
1111 {
1112     return n < VIRTIO_QUEUE_MAX ? vdev->vq[n].vector :
1113         VIRTIO_NO_VECTOR;
1114 }
1115 
1116 void virtio_queue_set_vector(VirtIODevice *vdev, int n, uint16_t vector)
1117 {
1118     VirtQueue *vq = &vdev->vq[n];
1119 
1120     if (n < VIRTIO_QUEUE_MAX) {
1121         if (vdev->vector_queues &&
1122             vdev->vq[n].vector != VIRTIO_NO_VECTOR) {
1123             QLIST_REMOVE(vq, node);
1124         }
1125         vdev->vq[n].vector = vector;
1126         if (vdev->vector_queues &&
1127             vector != VIRTIO_NO_VECTOR) {
1128             QLIST_INSERT_HEAD(&vdev->vector_queues[vector], vq, node);
1129         }
1130     }
1131 }
1132 
1133 VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
1134                             void (*handle_output)(VirtIODevice *, VirtQueue *))
1135 {
1136     int i;
1137 
1138     for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1139         if (vdev->vq[i].vring.num == 0)
1140             break;
1141     }
1142 
1143     if (i == VIRTIO_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
1144         abort();
1145 
1146     vdev->vq[i].vring.num = queue_size;
1147     vdev->vq[i].vring.num_default = queue_size;
1148     vdev->vq[i].vring.align = VIRTIO_PCI_VRING_ALIGN;
1149     vdev->vq[i].handle_output = handle_output;
1150     vdev->vq[i].handle_aio_output = NULL;
1151 
1152     return &vdev->vq[i];
1153 }
1154 
1155 void virtio_del_queue(VirtIODevice *vdev, int n)
1156 {
1157     if (n < 0 || n >= VIRTIO_QUEUE_MAX) {
1158         abort();
1159     }
1160 
1161     vdev->vq[n].vring.num = 0;
1162     vdev->vq[n].vring.num_default = 0;
1163 }
1164 
1165 void virtio_irq(VirtQueue *vq)
1166 {
1167     trace_virtio_irq(vq);
1168     vq->vdev->isr |= 0x01;
1169     virtio_notify_vector(vq->vdev, vq->vector);
1170 }
1171 
1172 bool virtio_should_notify(VirtIODevice *vdev, VirtQueue *vq)
1173 {
1174     uint16_t old, new;
1175     bool v;
1176     /* We need to expose used array entries before checking used event. */
1177     smp_mb();
1178     /* Always notify when queue is empty (when feature acknowledge) */
1179     if (virtio_vdev_has_feature(vdev, VIRTIO_F_NOTIFY_ON_EMPTY) &&
1180         !vq->inuse && virtio_queue_empty(vq)) {
1181         return true;
1182     }
1183 
1184     if (!virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
1185         return !(vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT);
1186     }
1187 
1188     v = vq->signalled_used_valid;
1189     vq->signalled_used_valid = true;
1190     old = vq->signalled_used;
1191     new = vq->signalled_used = vq->used_idx;
1192     return !v || vring_need_event(vring_get_used_event(vq), new, old);
1193 }
1194 
1195 void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
1196 {
1197     if (!virtio_should_notify(vdev, vq)) {
1198         return;
1199     }
1200 
1201     trace_virtio_notify(vdev, vq);
1202     vdev->isr |= 0x01;
1203     virtio_notify_vector(vdev, vq->vector);
1204 }
1205 
1206 void virtio_notify_config(VirtIODevice *vdev)
1207 {
1208     if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
1209         return;
1210 
1211     vdev->isr |= 0x03;
1212     vdev->generation++;
1213     virtio_notify_vector(vdev, vdev->config_vector);
1214 }
1215 
1216 static bool virtio_device_endian_needed(void *opaque)
1217 {
1218     VirtIODevice *vdev = opaque;
1219 
1220     assert(vdev->device_endian != VIRTIO_DEVICE_ENDIAN_UNKNOWN);
1221     if (!virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1222         return vdev->device_endian != virtio_default_endian();
1223     }
1224     /* Devices conforming to VIRTIO 1.0 or later are always LE. */
1225     return vdev->device_endian != VIRTIO_DEVICE_ENDIAN_LITTLE;
1226 }
1227 
1228 static bool virtio_64bit_features_needed(void *opaque)
1229 {
1230     VirtIODevice *vdev = opaque;
1231 
1232     return (vdev->host_features >> 32) != 0;
1233 }
1234 
1235 static bool virtio_virtqueue_needed(void *opaque)
1236 {
1237     VirtIODevice *vdev = opaque;
1238 
1239     return virtio_host_has_feature(vdev, VIRTIO_F_VERSION_1);
1240 }
1241 
1242 static bool virtio_ringsize_needed(void *opaque)
1243 {
1244     VirtIODevice *vdev = opaque;
1245     int i;
1246 
1247     for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1248         if (vdev->vq[i].vring.num != vdev->vq[i].vring.num_default) {
1249             return true;
1250         }
1251     }
1252     return false;
1253 }
1254 
1255 static bool virtio_extra_state_needed(void *opaque)
1256 {
1257     VirtIODevice *vdev = opaque;
1258     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
1259     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1260 
1261     return k->has_extra_state &&
1262         k->has_extra_state(qbus->parent);
1263 }
1264 
1265 static const VMStateDescription vmstate_virtqueue = {
1266     .name = "virtqueue_state",
1267     .version_id = 1,
1268     .minimum_version_id = 1,
1269     .fields = (VMStateField[]) {
1270         VMSTATE_UINT64(vring.avail, struct VirtQueue),
1271         VMSTATE_UINT64(vring.used, struct VirtQueue),
1272         VMSTATE_END_OF_LIST()
1273     }
1274 };
1275 
1276 static const VMStateDescription vmstate_virtio_virtqueues = {
1277     .name = "virtio/virtqueues",
1278     .version_id = 1,
1279     .minimum_version_id = 1,
1280     .needed = &virtio_virtqueue_needed,
1281     .fields = (VMStateField[]) {
1282         VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
1283                       VIRTIO_QUEUE_MAX, 0, vmstate_virtqueue, VirtQueue),
1284         VMSTATE_END_OF_LIST()
1285     }
1286 };
1287 
1288 static const VMStateDescription vmstate_ringsize = {
1289     .name = "ringsize_state",
1290     .version_id = 1,
1291     .minimum_version_id = 1,
1292     .fields = (VMStateField[]) {
1293         VMSTATE_UINT32(vring.num_default, struct VirtQueue),
1294         VMSTATE_END_OF_LIST()
1295     }
1296 };
1297 
1298 static const VMStateDescription vmstate_virtio_ringsize = {
1299     .name = "virtio/ringsize",
1300     .version_id = 1,
1301     .minimum_version_id = 1,
1302     .needed = &virtio_ringsize_needed,
1303     .fields = (VMStateField[]) {
1304         VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
1305                       VIRTIO_QUEUE_MAX, 0, vmstate_ringsize, VirtQueue),
1306         VMSTATE_END_OF_LIST()
1307     }
1308 };
1309 
1310 static int get_extra_state(QEMUFile *f, void *pv, size_t size)
1311 {
1312     VirtIODevice *vdev = pv;
1313     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
1314     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1315 
1316     if (!k->load_extra_state) {
1317         return -1;
1318     } else {
1319         return k->load_extra_state(qbus->parent, f);
1320     }
1321 }
1322 
1323 static void put_extra_state(QEMUFile *f, void *pv, size_t size)
1324 {
1325     VirtIODevice *vdev = pv;
1326     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
1327     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1328 
1329     k->save_extra_state(qbus->parent, f);
1330 }
1331 
1332 static const VMStateInfo vmstate_info_extra_state = {
1333     .name = "virtqueue_extra_state",
1334     .get = get_extra_state,
1335     .put = put_extra_state,
1336 };
1337 
1338 static const VMStateDescription vmstate_virtio_extra_state = {
1339     .name = "virtio/extra_state",
1340     .version_id = 1,
1341     .minimum_version_id = 1,
1342     .needed = &virtio_extra_state_needed,
1343     .fields = (VMStateField[]) {
1344         {
1345             .name         = "extra_state",
1346             .version_id   = 0,
1347             .field_exists = NULL,
1348             .size         = 0,
1349             .info         = &vmstate_info_extra_state,
1350             .flags        = VMS_SINGLE,
1351             .offset       = 0,
1352         },
1353         VMSTATE_END_OF_LIST()
1354     }
1355 };
1356 
1357 static const VMStateDescription vmstate_virtio_device_endian = {
1358     .name = "virtio/device_endian",
1359     .version_id = 1,
1360     .minimum_version_id = 1,
1361     .needed = &virtio_device_endian_needed,
1362     .fields = (VMStateField[]) {
1363         VMSTATE_UINT8(device_endian, VirtIODevice),
1364         VMSTATE_END_OF_LIST()
1365     }
1366 };
1367 
1368 static const VMStateDescription vmstate_virtio_64bit_features = {
1369     .name = "virtio/64bit_features",
1370     .version_id = 1,
1371     .minimum_version_id = 1,
1372     .needed = &virtio_64bit_features_needed,
1373     .fields = (VMStateField[]) {
1374         VMSTATE_UINT64(guest_features, VirtIODevice),
1375         VMSTATE_END_OF_LIST()
1376     }
1377 };
1378 
1379 static const VMStateDescription vmstate_virtio = {
1380     .name = "virtio",
1381     .version_id = 1,
1382     .minimum_version_id = 1,
1383     .minimum_version_id_old = 1,
1384     .fields = (VMStateField[]) {
1385         VMSTATE_END_OF_LIST()
1386     },
1387     .subsections = (const VMStateDescription*[]) {
1388         &vmstate_virtio_device_endian,
1389         &vmstate_virtio_64bit_features,
1390         &vmstate_virtio_virtqueues,
1391         &vmstate_virtio_ringsize,
1392         &vmstate_virtio_extra_state,
1393         NULL
1394     }
1395 };
1396 
1397 void virtio_save(VirtIODevice *vdev, QEMUFile *f)
1398 {
1399     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
1400     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1401     VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
1402     uint32_t guest_features_lo = (vdev->guest_features & 0xffffffff);
1403     int i;
1404 
1405     if (k->save_config) {
1406         k->save_config(qbus->parent, f);
1407     }
1408 
1409     qemu_put_8s(f, &vdev->status);
1410     qemu_put_8s(f, &vdev->isr);
1411     qemu_put_be16s(f, &vdev->queue_sel);
1412     qemu_put_be32s(f, &guest_features_lo);
1413     qemu_put_be32(f, vdev->config_len);
1414     qemu_put_buffer(f, vdev->config, vdev->config_len);
1415 
1416     for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1417         if (vdev->vq[i].vring.num == 0)
1418             break;
1419     }
1420 
1421     qemu_put_be32(f, i);
1422 
1423     for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1424         if (vdev->vq[i].vring.num == 0)
1425             break;
1426 
1427         qemu_put_be32(f, vdev->vq[i].vring.num);
1428         if (k->has_variable_vring_alignment) {
1429             qemu_put_be32(f, vdev->vq[i].vring.align);
1430         }
1431         /* XXX virtio-1 devices */
1432         qemu_put_be64(f, vdev->vq[i].vring.desc);
1433         qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
1434         if (k->save_queue) {
1435             k->save_queue(qbus->parent, i, f);
1436         }
1437     }
1438 
1439     if (vdc->save != NULL) {
1440         vdc->save(vdev, f);
1441     }
1442 
1443     /* Subsections */
1444     vmstate_save_state(f, &vmstate_virtio, vdev, NULL);
1445 }
1446 
1447 static int virtio_set_features_nocheck(VirtIODevice *vdev, uint64_t val)
1448 {
1449     VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
1450     bool bad = (val & ~(vdev->host_features)) != 0;
1451 
1452     val &= vdev->host_features;
1453     if (k->set_features) {
1454         k->set_features(vdev, val);
1455     }
1456     vdev->guest_features = val;
1457     return bad ? -1 : 0;
1458 }
1459 
1460 int virtio_set_features(VirtIODevice *vdev, uint64_t val)
1461 {
1462    /*
1463      * The driver must not attempt to set features after feature negotiation
1464      * has finished.
1465      */
1466     if (vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) {
1467         return -EINVAL;
1468     }
1469     return virtio_set_features_nocheck(vdev, val);
1470 }
1471 
1472 int virtio_load(VirtIODevice *vdev, QEMUFile *f, int version_id)
1473 {
1474     int i, ret;
1475     int32_t config_len;
1476     uint32_t num;
1477     uint32_t features;
1478     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
1479     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1480     VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
1481 
1482     /*
1483      * We poison the endianness to ensure it does not get used before
1484      * subsections have been loaded.
1485      */
1486     vdev->device_endian = VIRTIO_DEVICE_ENDIAN_UNKNOWN;
1487 
1488     if (k->load_config) {
1489         ret = k->load_config(qbus->parent, f);
1490         if (ret)
1491             return ret;
1492     }
1493 
1494     qemu_get_8s(f, &vdev->status);
1495     qemu_get_8s(f, &vdev->isr);
1496     qemu_get_be16s(f, &vdev->queue_sel);
1497     if (vdev->queue_sel >= VIRTIO_QUEUE_MAX) {
1498         return -1;
1499     }
1500     qemu_get_be32s(f, &features);
1501 
1502     /*
1503      * Temporarily set guest_features low bits - needed by
1504      * virtio net load code testing for VIRTIO_NET_F_CTRL_GUEST_OFFLOADS
1505      * VIRTIO_NET_F_GUEST_ANNOUNCE and VIRTIO_NET_F_CTRL_VQ.
1506      *
1507      * Note: devices should always test host features in future - don't create
1508      * new dependencies like this.
1509      */
1510     vdev->guest_features = features;
1511 
1512     config_len = qemu_get_be32(f);
1513 
1514     /*
1515      * There are cases where the incoming config can be bigger or smaller
1516      * than what we have; so load what we have space for, and skip
1517      * any excess that's in the stream.
1518      */
1519     qemu_get_buffer(f, vdev->config, MIN(config_len, vdev->config_len));
1520 
1521     while (config_len > vdev->config_len) {
1522         qemu_get_byte(f);
1523         config_len--;
1524     }
1525 
1526     num = qemu_get_be32(f);
1527 
1528     if (num > VIRTIO_QUEUE_MAX) {
1529         error_report("Invalid number of virtqueues: 0x%x", num);
1530         return -1;
1531     }
1532 
1533     for (i = 0; i < num; i++) {
1534         vdev->vq[i].vring.num = qemu_get_be32(f);
1535         if (k->has_variable_vring_alignment) {
1536             vdev->vq[i].vring.align = qemu_get_be32(f);
1537         }
1538         vdev->vq[i].vring.desc = qemu_get_be64(f);
1539         qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
1540         vdev->vq[i].signalled_used_valid = false;
1541         vdev->vq[i].notification = true;
1542 
1543         if (vdev->vq[i].vring.desc) {
1544             /* XXX virtio-1 devices */
1545             virtio_queue_update_rings(vdev, i);
1546         } else if (vdev->vq[i].last_avail_idx) {
1547             error_report("VQ %d address 0x0 "
1548                          "inconsistent with Host index 0x%x",
1549                          i, vdev->vq[i].last_avail_idx);
1550                 return -1;
1551 	}
1552         if (k->load_queue) {
1553             ret = k->load_queue(qbus->parent, i, f);
1554             if (ret)
1555                 return ret;
1556         }
1557     }
1558 
1559     virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
1560 
1561     if (vdc->load != NULL) {
1562         ret = vdc->load(vdev, f, version_id);
1563         if (ret) {
1564             return ret;
1565         }
1566     }
1567 
1568     /* Subsections */
1569     ret = vmstate_load_state(f, &vmstate_virtio, vdev, 1);
1570     if (ret) {
1571         return ret;
1572     }
1573 
1574     if (vdev->device_endian == VIRTIO_DEVICE_ENDIAN_UNKNOWN) {
1575         vdev->device_endian = virtio_default_endian();
1576     }
1577 
1578     if (virtio_64bit_features_needed(vdev)) {
1579         /*
1580          * Subsection load filled vdev->guest_features.  Run them
1581          * through virtio_set_features to sanity-check them against
1582          * host_features.
1583          */
1584         uint64_t features64 = vdev->guest_features;
1585         if (virtio_set_features_nocheck(vdev, features64) < 0) {
1586             error_report("Features 0x%" PRIx64 " unsupported. "
1587                          "Allowed features: 0x%" PRIx64,
1588                          features64, vdev->host_features);
1589             return -1;
1590         }
1591     } else {
1592         if (virtio_set_features_nocheck(vdev, features) < 0) {
1593             error_report("Features 0x%x unsupported. "
1594                          "Allowed features: 0x%" PRIx64,
1595                          features, vdev->host_features);
1596             return -1;
1597         }
1598     }
1599 
1600     for (i = 0; i < num; i++) {
1601         if (vdev->vq[i].vring.desc) {
1602             uint16_t nheads;
1603             nheads = vring_avail_idx(&vdev->vq[i]) - vdev->vq[i].last_avail_idx;
1604             /* Check it isn't doing strange things with descriptor numbers. */
1605             if (nheads > vdev->vq[i].vring.num) {
1606                 error_report("VQ %d size 0x%x Guest index 0x%x "
1607                              "inconsistent with Host index 0x%x: delta 0x%x",
1608                              i, vdev->vq[i].vring.num,
1609                              vring_avail_idx(&vdev->vq[i]),
1610                              vdev->vq[i].last_avail_idx, nheads);
1611                 return -1;
1612             }
1613             vdev->vq[i].used_idx = vring_used_idx(&vdev->vq[i]);
1614             vdev->vq[i].shadow_avail_idx = vring_avail_idx(&vdev->vq[i]);
1615         }
1616     }
1617 
1618     return 0;
1619 }
1620 
1621 void virtio_cleanup(VirtIODevice *vdev)
1622 {
1623     qemu_del_vm_change_state_handler(vdev->vmstate);
1624     g_free(vdev->config);
1625     g_free(vdev->vq);
1626     g_free(vdev->vector_queues);
1627 }
1628 
1629 static void virtio_vmstate_change(void *opaque, int running, RunState state)
1630 {
1631     VirtIODevice *vdev = opaque;
1632     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
1633     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1634     bool backend_run = running && (vdev->status & VIRTIO_CONFIG_S_DRIVER_OK);
1635     vdev->vm_running = running;
1636 
1637     if (backend_run) {
1638         virtio_set_status(vdev, vdev->status);
1639     }
1640 
1641     if (k->vmstate_change) {
1642         k->vmstate_change(qbus->parent, backend_run);
1643     }
1644 
1645     if (!backend_run) {
1646         virtio_set_status(vdev, vdev->status);
1647     }
1648 }
1649 
1650 void virtio_instance_init_common(Object *proxy_obj, void *data,
1651                                  size_t vdev_size, const char *vdev_name)
1652 {
1653     DeviceState *vdev = data;
1654 
1655     object_initialize(vdev, vdev_size, vdev_name);
1656     object_property_add_child(proxy_obj, "virtio-backend", OBJECT(vdev), NULL);
1657     object_unref(OBJECT(vdev));
1658     qdev_alias_all_properties(vdev, proxy_obj);
1659 }
1660 
1661 void virtio_init(VirtIODevice *vdev, const char *name,
1662                  uint16_t device_id, size_t config_size)
1663 {
1664     BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
1665     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
1666     int i;
1667     int nvectors = k->query_nvectors ? k->query_nvectors(qbus->parent) : 0;
1668 
1669     if (nvectors) {
1670         vdev->vector_queues =
1671             g_malloc0(sizeof(*vdev->vector_queues) * nvectors);
1672     }
1673 
1674     vdev->device_id = device_id;
1675     vdev->status = 0;
1676     vdev->isr = 0;
1677     vdev->queue_sel = 0;
1678     vdev->config_vector = VIRTIO_NO_VECTOR;
1679     vdev->vq = g_malloc0(sizeof(VirtQueue) * VIRTIO_QUEUE_MAX);
1680     vdev->vm_running = runstate_is_running();
1681     for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
1682         vdev->vq[i].vector = VIRTIO_NO_VECTOR;
1683         vdev->vq[i].vdev = vdev;
1684         vdev->vq[i].queue_index = i;
1685     }
1686 
1687     vdev->name = name;
1688     vdev->config_len = config_size;
1689     if (vdev->config_len) {
1690         vdev->config = g_malloc0(config_size);
1691     } else {
1692         vdev->config = NULL;
1693     }
1694     vdev->vmstate = qemu_add_vm_change_state_handler(virtio_vmstate_change,
1695                                                      vdev);
1696     vdev->device_endian = virtio_default_endian();
1697     vdev->use_guest_notifier_mask = true;
1698 }
1699 
1700 hwaddr virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
1701 {
1702     return vdev->vq[n].vring.desc;
1703 }
1704 
1705 hwaddr virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
1706 {
1707     return vdev->vq[n].vring.avail;
1708 }
1709 
1710 hwaddr virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
1711 {
1712     return vdev->vq[n].vring.used;
1713 }
1714 
1715 hwaddr virtio_queue_get_ring_addr(VirtIODevice *vdev, int n)
1716 {
1717     return vdev->vq[n].vring.desc;
1718 }
1719 
1720 hwaddr virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
1721 {
1722     return sizeof(VRingDesc) * vdev->vq[n].vring.num;
1723 }
1724 
1725 hwaddr virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
1726 {
1727     return offsetof(VRingAvail, ring) +
1728         sizeof(uint16_t) * vdev->vq[n].vring.num;
1729 }
1730 
1731 hwaddr virtio_queue_get_used_size(VirtIODevice *vdev, int n)
1732 {
1733     return offsetof(VRingUsed, ring) +
1734         sizeof(VRingUsedElem) * vdev->vq[n].vring.num;
1735 }
1736 
1737 hwaddr virtio_queue_get_ring_size(VirtIODevice *vdev, int n)
1738 {
1739     return vdev->vq[n].vring.used - vdev->vq[n].vring.desc +
1740 	    virtio_queue_get_used_size(vdev, n);
1741 }
1742 
1743 uint16_t virtio_queue_get_last_avail_idx(VirtIODevice *vdev, int n)
1744 {
1745     return vdev->vq[n].last_avail_idx;
1746 }
1747 
1748 void virtio_queue_set_last_avail_idx(VirtIODevice *vdev, int n, uint16_t idx)
1749 {
1750     vdev->vq[n].last_avail_idx = idx;
1751     vdev->vq[n].shadow_avail_idx = idx;
1752 }
1753 
1754 void virtio_queue_invalidate_signalled_used(VirtIODevice *vdev, int n)
1755 {
1756     vdev->vq[n].signalled_used_valid = false;
1757 }
1758 
1759 VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
1760 {
1761     return vdev->vq + n;
1762 }
1763 
1764 uint16_t virtio_get_queue_index(VirtQueue *vq)
1765 {
1766     return vq->queue_index;
1767 }
1768 
1769 static void virtio_queue_guest_notifier_read(EventNotifier *n)
1770 {
1771     VirtQueue *vq = container_of(n, VirtQueue, guest_notifier);
1772     if (event_notifier_test_and_clear(n)) {
1773         virtio_irq(vq);
1774     }
1775 }
1776 
1777 void virtio_queue_set_guest_notifier_fd_handler(VirtQueue *vq, bool assign,
1778                                                 bool with_irqfd)
1779 {
1780     if (assign && !with_irqfd) {
1781         event_notifier_set_handler(&vq->guest_notifier, false,
1782                                    virtio_queue_guest_notifier_read);
1783     } else {
1784         event_notifier_set_handler(&vq->guest_notifier, false, NULL);
1785     }
1786     if (!assign) {
1787         /* Test and clear notifier before closing it,
1788          * in case poll callback didn't have time to run. */
1789         virtio_queue_guest_notifier_read(&vq->guest_notifier);
1790     }
1791 }
1792 
1793 EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
1794 {
1795     return &vq->guest_notifier;
1796 }
1797 
1798 static void virtio_queue_host_notifier_aio_read(EventNotifier *n)
1799 {
1800     VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
1801     if (event_notifier_test_and_clear(n)) {
1802         virtio_queue_notify_aio_vq(vq);
1803     }
1804 }
1805 
1806 void virtio_queue_aio_set_host_notifier_handler(VirtQueue *vq, AioContext *ctx,
1807                                                 void (*handle_output)(VirtIODevice *,
1808                                                                       VirtQueue *))
1809 {
1810     if (handle_output) {
1811         vq->handle_aio_output = handle_output;
1812         aio_set_event_notifier(ctx, &vq->host_notifier, true,
1813                                virtio_queue_host_notifier_aio_read);
1814     } else {
1815         aio_set_event_notifier(ctx, &vq->host_notifier, true, NULL);
1816         /* Test and clear notifier before after disabling event,
1817          * in case poll callback didn't have time to run. */
1818         virtio_queue_host_notifier_aio_read(&vq->host_notifier);
1819         vq->handle_aio_output = NULL;
1820     }
1821 }
1822 
1823 static void virtio_queue_host_notifier_read(EventNotifier *n)
1824 {
1825     VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
1826     if (event_notifier_test_and_clear(n)) {
1827         virtio_queue_notify_vq(vq);
1828     }
1829 }
1830 
1831 void virtio_queue_set_host_notifier_fd_handler(VirtQueue *vq, bool assign,
1832                                                bool set_handler)
1833 {
1834     if (assign && set_handler) {
1835         event_notifier_set_handler(&vq->host_notifier, true,
1836                                    virtio_queue_host_notifier_read);
1837     } else {
1838         event_notifier_set_handler(&vq->host_notifier, true, NULL);
1839     }
1840     if (!assign) {
1841         /* Test and clear notifier before after disabling event,
1842          * in case poll callback didn't have time to run. */
1843         virtio_queue_host_notifier_read(&vq->host_notifier);
1844     }
1845 }
1846 
1847 EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
1848 {
1849     return &vq->host_notifier;
1850 }
1851 
1852 void virtio_device_set_child_bus_name(VirtIODevice *vdev, char *bus_name)
1853 {
1854     g_free(vdev->bus_name);
1855     vdev->bus_name = g_strdup(bus_name);
1856 }
1857 
1858 static void virtio_device_realize(DeviceState *dev, Error **errp)
1859 {
1860     VirtIODevice *vdev = VIRTIO_DEVICE(dev);
1861     VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
1862     Error *err = NULL;
1863 
1864     if (vdc->realize != NULL) {
1865         vdc->realize(dev, &err);
1866         if (err != NULL) {
1867             error_propagate(errp, err);
1868             return;
1869         }
1870     }
1871 
1872     virtio_bus_device_plugged(vdev, &err);
1873     if (err != NULL) {
1874         error_propagate(errp, err);
1875         return;
1876     }
1877 }
1878 
1879 static void virtio_device_unrealize(DeviceState *dev, Error **errp)
1880 {
1881     VirtIODevice *vdev = VIRTIO_DEVICE(dev);
1882     VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
1883     Error *err = NULL;
1884 
1885     virtio_bus_device_unplugged(vdev);
1886 
1887     if (vdc->unrealize != NULL) {
1888         vdc->unrealize(dev, &err);
1889         if (err != NULL) {
1890             error_propagate(errp, err);
1891             return;
1892         }
1893     }
1894 
1895     g_free(vdev->bus_name);
1896     vdev->bus_name = NULL;
1897 }
1898 
1899 static Property virtio_properties[] = {
1900     DEFINE_VIRTIO_COMMON_FEATURES(VirtIODevice, host_features),
1901     DEFINE_PROP_END_OF_LIST(),
1902 };
1903 
1904 static void virtio_device_class_init(ObjectClass *klass, void *data)
1905 {
1906     /* Set the default value here. */
1907     DeviceClass *dc = DEVICE_CLASS(klass);
1908 
1909     dc->realize = virtio_device_realize;
1910     dc->unrealize = virtio_device_unrealize;
1911     dc->bus_type = TYPE_VIRTIO_BUS;
1912     dc->props = virtio_properties;
1913 }
1914 
1915 static const TypeInfo virtio_device_info = {
1916     .name = TYPE_VIRTIO_DEVICE,
1917     .parent = TYPE_DEVICE,
1918     .instance_size = sizeof(VirtIODevice),
1919     .class_init = virtio_device_class_init,
1920     .abstract = true,
1921     .class_size = sizeof(VirtioDeviceClass),
1922 };
1923 
1924 static void virtio_register_types(void)
1925 {
1926     type_register_static(&virtio_device_info);
1927 }
1928 
1929 type_init(virtio_register_types)
1930