xref: /kvmtool/virtio/core.c (revision 08861bcf44aba7d5dd59a34bdf50c47ff3628e49)
139d6af07SAsias He #include <linux/virtio_ring.h>
23fdf659dSSasha Levin #include <linux/types.h>
339d6af07SAsias He #include <sys/uio.h>
42caa836dSIngo Molnar 
52caa836dSIngo Molnar #include "kvm/barrier.h"
62caa836dSIngo Molnar 
739d6af07SAsias He #include "kvm/kvm.h"
839d6af07SAsias He #include "kvm/virtio.h"
939d6af07SAsias He 
103fdf659dSSasha Levin struct vring_used_elem *virt_queue__set_used_elem(struct virt_queue *queue, u32 head, u32 len)
1139d6af07SAsias He {
1239d6af07SAsias He 	struct vring_used_elem *used_elem;
13407475bfSPekka Enberg 
1494902782SSasha Levin 	used_elem	= &queue->vring.used->ring[queue->vring.used->idx % queue->vring.num];
1539d6af07SAsias He 	used_elem->id	= head;
1639d6af07SAsias He 	used_elem->len	= len;
1794902782SSasha Levin 
1894902782SSasha Levin 	/*
1994902782SSasha Levin 	 * Use wmb to assure that used elem was updated with head and len.
2094902782SSasha Levin 	 * We need a wmb here since we can't advance idx unless we're ready
2194902782SSasha Levin 	 * to pass the used element to the guest.
2294902782SSasha Levin 	 */
2394902782SSasha Levin 	wmb();
2494902782SSasha Levin 	queue->vring.used->idx++;
2594902782SSasha Levin 
2694902782SSasha Levin 	/*
2794902782SSasha Levin 	 * Use wmb to assure used idx has been increased before we signal the guest.
2894902782SSasha Levin 	 * Without a wmb here the guest may ignore the queue since it won't see
2994902782SSasha Levin 	 * an updated idx.
3094902782SSasha Levin 	 */
3194902782SSasha Levin 	wmb();
3294902782SSasha Levin 
3339d6af07SAsias He 	return used_elem;
3439d6af07SAsias He }
3539d6af07SAsias He 
363fdf659dSSasha Levin u16 virt_queue__get_iov(struct virt_queue *queue, struct iovec iov[], u16 *out, u16 *in, struct kvm *kvm)
3739d6af07SAsias He {
3839d6af07SAsias He 	struct vring_desc *desc;
393fdf659dSSasha Levin 	u16 head, idx;
4039d6af07SAsias He 
4139d6af07SAsias He 	idx = head = virt_queue__pop(queue);
4239d6af07SAsias He 	*out = *in = 0;
4339d6af07SAsias He 
4439d6af07SAsias He 	do {
4539d6af07SAsias He 		desc				= virt_queue__get_desc(queue, idx);
4639d6af07SAsias He 		iov[*out + *in].iov_base	= guest_flat_to_host(kvm, desc->addr);
4739d6af07SAsias He 		iov[*out + *in].iov_len		= desc->len;
4839d6af07SAsias He 		if (desc->flags & VRING_DESC_F_WRITE)
4939d6af07SAsias He 			(*in)++;
5039d6af07SAsias He 		else
5139d6af07SAsias He 			(*out)++;
5239d6af07SAsias He 		if (desc->flags & VRING_DESC_F_NEXT)
5339d6af07SAsias He 			idx = desc->next;
5439d6af07SAsias He 		else
5539d6af07SAsias He 			break;
5639d6af07SAsias He 	} while (1);
5739d6af07SAsias He 
5839d6af07SAsias He 	return head;
5939d6af07SAsias He }
607f5ffaf5SAsias He 
61*08861bcfSAneesh Kumar K.V /* in and out are relative to guest */
62*08861bcfSAneesh Kumar K.V u16 virt_queue__get_inout_iov(struct kvm *kvm, struct virt_queue *queue,
63*08861bcfSAneesh Kumar K.V 			      struct iovec in_iov[], struct iovec out_iov[],
64*08861bcfSAneesh Kumar K.V 			      u16 *in, u16 *out)
65*08861bcfSAneesh Kumar K.V {
66*08861bcfSAneesh Kumar K.V 	u16 head, idx;
67*08861bcfSAneesh Kumar K.V 	struct vring_desc *desc;
68*08861bcfSAneesh Kumar K.V 
69*08861bcfSAneesh Kumar K.V 	idx = head = virt_queue__pop(queue);
70*08861bcfSAneesh Kumar K.V 	*out = *in = 0;
71*08861bcfSAneesh Kumar K.V 	do {
72*08861bcfSAneesh Kumar K.V 		desc = virt_queue__get_desc(queue, idx);
73*08861bcfSAneesh Kumar K.V 		if (desc->flags & VRING_DESC_F_WRITE) {
74*08861bcfSAneesh Kumar K.V 			in_iov[*in].iov_base = guest_flat_to_host(kvm,
75*08861bcfSAneesh Kumar K.V 								  desc->addr);
76*08861bcfSAneesh Kumar K.V 			in_iov[*in].iov_len = desc->len;
77*08861bcfSAneesh Kumar K.V 			(*in)++;
78*08861bcfSAneesh Kumar K.V 		} else {
79*08861bcfSAneesh Kumar K.V 			out_iov[*out].iov_base = guest_flat_to_host(kvm,
80*08861bcfSAneesh Kumar K.V 								    desc->addr);
81*08861bcfSAneesh Kumar K.V 			out_iov[*out].iov_len = desc->len;
82*08861bcfSAneesh Kumar K.V 			(*out)++;
83*08861bcfSAneesh Kumar K.V 		}
84*08861bcfSAneesh Kumar K.V 		if (desc->flags & VRING_DESC_F_NEXT)
85*08861bcfSAneesh Kumar K.V 			idx = desc->next;
86*08861bcfSAneesh Kumar K.V 		else
87*08861bcfSAneesh Kumar K.V 			break;
88*08861bcfSAneesh Kumar K.V 	} while (1);
89*08861bcfSAneesh Kumar K.V 	return head;
90*08861bcfSAneesh Kumar K.V }
91*08861bcfSAneesh Kumar K.V 
92*08861bcfSAneesh Kumar K.V 
937f5ffaf5SAsias He void virt_queue__trigger_irq(struct virt_queue *vq, int irq, u8 *isr, struct kvm *kvm)
947f5ffaf5SAsias He {
959b6022b8SAsias He 	if (vq->vring.avail->flags & VRING_AVAIL_F_NO_INTERRUPT)
969b6022b8SAsias He 		return;
979b6022b8SAsias He 
987f5ffaf5SAsias He 	if (*isr == VIRTIO_IRQ_LOW) {
997f5ffaf5SAsias He 		*isr = VIRTIO_IRQ_HIGH;
1007f5ffaf5SAsias He 		kvm__irq_line(kvm, irq, VIRTIO_IRQ_HIGH);
1017f5ffaf5SAsias He 	}
1027f5ffaf5SAsias He }
103