38 static inline int __vringh_get_head(const struct vringh *vrh,  in __vringh_get_head()  argument
39 				    int (*getu16)(const struct vringh *vrh,  in __vringh_get_head()  argument
46 	err = getu16(vrh, &avail_idx, &vrh->vring.avail->idx);  in __vringh_get_head()
49 			   &vrh->vring.avail->idx);  in __vringh_get_head()
54 		return vrh->vring.num;  in __vringh_get_head()
57 	virtio_rmb(vrh->weak_barriers);  in __vringh_get_head()
59 	i = *last_avail_idx & (vrh->vring.num - 1);  in __vringh_get_head()
61 	err = getu16(vrh, &head, &vrh->vring.avail->ring[i]);  in __vringh_get_head()
64 			   *last_avail_idx, &vrh->vring.avail->ring[i]);  in __vringh_get_head()
68 	if (head >= vrh->vring.num) {  in __vringh_get_head()
70 			   head, vrh->vring.num);  in __vringh_get_head()
79 static inline ssize_t vringh_iov_xfer(struct vringh *vrh,  in vringh_iov_xfer()  argument
82 				      int (*xfer)(const struct vringh *vrh,  in vringh_iov_xfer()  argument
92 		err = xfer(vrh, iov->iov[iov->i].iov_base, ptr, partlen);  in vringh_iov_xfer()
116 static inline bool range_check(struct vringh *vrh, u64 addr, size_t *len,  in range_check()  argument
122 		if (!getrange(vrh, addr, range))  in range_check()
150 static inline bool no_range_check(struct vringh *vrh, u64 addr, size_t *len,  in no_range_check()  argument
159 static int move_to_indirect(const struct vringh *vrh,  in move_to_indirect()  argument
172 	len = vringh32_to_cpu(vrh, desc->len);  in move_to_indirect()
179 	if (desc->flags & cpu_to_vringh16(vrh, VRING_DESC_F_NEXT))  in move_to_indirect()
180 		*up_next = vringh16_to_cpu(vrh, desc->next);  in move_to_indirect()
217 static u16 __cold return_from_indirect(const struct vringh *vrh, int *up_next,  in return_from_indirect()  argument
223 	*descs = vrh->vring.desc;  in return_from_indirect()
224 	*desc_max = vrh->vring.num;  in return_from_indirect()
228 static int slow_copy(struct vringh *vrh, void *dst, const void *src,  in slow_copy()  argument
229 		     bool (*rcheck)(struct vringh *vrh, u64 addr, size_t *len,  in slow_copy()  argument
231 				    bool (*getrange)(struct vringh *vrh,  in slow_copy()  argument
234 		     bool (*getrange)(struct vringh *vrh,  in slow_copy()
238 		     int (*copy)(const struct vringh *vrh,  in slow_copy()  argument
250 		if (!rcheck(vrh, addr, &part, range, getrange))  in slow_copy()
253 		err = copy(vrh, dst, src, part);  in slow_copy()
265 __vringh_iov(struct vringh *vrh, u16 i,  in __vringh_iov()  argument
268 	     bool (*rcheck)(struct vringh *vrh, u64 addr, size_t *len,  in __vringh_iov()  argument
274 	     int (*copy)(const struct vringh *vrh,  in __vringh_iov()  argument
283 	descs = vrh->vring.desc;  in __vringh_iov()
284 	desc_max = vrh->vring.num;  in __vringh_iov()
302 			err = slow_copy(vrh, &desc, &descs[i], rcheck, getrange,  in __vringh_iov()
305 			err = copy(vrh, &desc, &descs[i], sizeof(desc));  in __vringh_iov()
310 			     cpu_to_vringh16(vrh, VRING_DESC_F_INDIRECT))) {  in __vringh_iov()
311 			u64 a = vringh64_to_cpu(vrh, desc.addr);  in __vringh_iov()
314 			len = vringh32_to_cpu(vrh, desc.len);  in __vringh_iov()
315 			if (!rcheck(vrh, a, &len, &range, getrange)) {  in __vringh_iov()
320 			if (unlikely(len != vringh32_to_cpu(vrh, desc.len))) {  in __vringh_iov()
327 			err = move_to_indirect(vrh, &up_next, &i, addr, &desc,  in __vringh_iov()
339 		if (count > vrh->vring.num || indirect_count > desc_max) {  in __vringh_iov()
345 		if (desc.flags & cpu_to_vringh16(vrh, VRING_DESC_F_WRITE))  in __vringh_iov()
366 		len = vringh32_to_cpu(vrh, desc.len);  in __vringh_iov()
367 		if (!rcheck(vrh, vringh64_to_cpu(vrh, desc.addr), &len, &range,  in __vringh_iov()
372 		addr = (void *)(unsigned long)(vringh64_to_cpu(vrh, desc.addr) +  in __vringh_iov()
385 		if (unlikely(len != vringh32_to_cpu(vrh, desc.len))) {  in __vringh_iov()
386 			desc.len = cpu_to_vringh32(vrh,  in __vringh_iov()
387 				   vringh32_to_cpu(vrh, desc.len) - len);  in __vringh_iov()
388 			desc.addr = cpu_to_vringh64(vrh,  in __vringh_iov()
389 				    vringh64_to_cpu(vrh, desc.addr) + len);  in __vringh_iov()
393 		if (desc.flags & cpu_to_vringh16(vrh, VRING_DESC_F_NEXT)) {  in __vringh_iov()
394 			i = vringh16_to_cpu(vrh, desc.next);  in __vringh_iov()
398 				i = return_from_indirect(vrh, &up_next,  in __vringh_iov()
419 static inline int __vringh_complete(struct vringh *vrh,  in __vringh_complete()  argument
422 				    int (*putu16)(const struct vringh *vrh,  in __vringh_complete()  argument
424 				    int (*putused)(const struct vringh *vrh,  in __vringh_complete()  argument
433 	used_ring = vrh->vring.used;  in __vringh_complete()
434 	used_idx = vrh->last_used_idx + vrh->completed;  in __vringh_complete()
436 	off = used_idx % vrh->vring.num;  in __vringh_complete()
439 	if (num_used > 1 && unlikely(off + num_used >= vrh->vring.num)) {  in __vringh_complete()
440 		u16 part = vrh->vring.num - off;  in __vringh_complete()
441 		err = putused(vrh, &used_ring->ring[off], used, part);  in __vringh_complete()
443 			err = putused(vrh, &used_ring->ring[0], used + part,  in __vringh_complete()
446 		err = putused(vrh, &used_ring->ring[off], used, num_used);  in __vringh_complete()
455 	virtio_wmb(vrh->weak_barriers);  in __vringh_complete()
457 	err = putu16(vrh, &vrh->vring.used->idx, used_idx + num_used);  in __vringh_complete()
460 			   &vrh->vring.used->idx);  in __vringh_complete()
464 	vrh->completed += num_used;  in __vringh_complete()
469 static inline int __vringh_need_notify(struct vringh *vrh,  in __vringh_need_notify()  argument
470 				       int (*getu16)(const struct vringh *vrh,  in __vringh_need_notify()  argument
481 	virtio_mb(vrh->weak_barriers);  in __vringh_need_notify()
484 	if (!vrh->event_indices) {  in __vringh_need_notify()
486 		err = getu16(vrh, &flags, &vrh->vring.avail->flags);  in __vringh_need_notify()
489 				   &vrh->vring.avail->flags);  in __vringh_need_notify()
496 	err = getu16(vrh, &used_event, &vring_used_event(&vrh->vring));  in __vringh_need_notify()
499 			   &vring_used_event(&vrh->vring));  in __vringh_need_notify()
504 	if (unlikely(vrh->completed > 0xffff))  in __vringh_need_notify()
508 					  vrh->last_used_idx + vrh->completed,  in __vringh_need_notify()
509 					  vrh->last_used_idx);  in __vringh_need_notify()
511 	vrh->last_used_idx += vrh->completed;  in __vringh_need_notify()
512 	vrh->completed = 0;  in __vringh_need_notify()
516 static inline bool __vringh_notify_enable(struct vringh *vrh,  in __vringh_notify_enable()  argument
517 					  int (*getu16)(const struct vringh *vrh,  in __vringh_notify_enable()  argument
519 					  int (*putu16)(const struct vringh *vrh,  in __vringh_notify_enable()  argument
524 	if (!vrh->event_indices) {  in __vringh_notify_enable()
526 		if (putu16(vrh, &vrh->vring.used->flags, 0) != 0) {  in __vringh_notify_enable()
528 				   &vrh->vring.used->flags);  in __vringh_notify_enable()
532 		if (putu16(vrh, &vring_avail_event(&vrh->vring),  in __vringh_notify_enable()
533 			   vrh->last_avail_idx) != 0) {  in __vringh_notify_enable()
535 				   &vring_avail_event(&vrh->vring));  in __vringh_notify_enable()
542 	virtio_mb(vrh->weak_barriers);  in __vringh_notify_enable()
544 	if (getu16(vrh, &avail, &vrh->vring.avail->idx) != 0) {  in __vringh_notify_enable()
546 			   &vrh->vring.avail->idx);  in __vringh_notify_enable()
553 	return avail == vrh->last_avail_idx;  in __vringh_notify_enable()
556 static inline void __vringh_notify_disable(struct vringh *vrh,  in __vringh_notify_disable()  argument
557 					   int (*putu16)(const struct vringh *vrh,  in __vringh_notify_disable()  argument
560 	if (!vrh->event_indices) {  in __vringh_notify_disable()
562 		if (putu16(vrh, &vrh->vring.used->flags,  in __vringh_notify_disable()
565 				   &vrh->vring.used->flags);  in __vringh_notify_disable()
571 static inline int getu16_user(const struct vringh *vrh, u16 *val, const __virtio16 *p)  in getu16_user()  argument
575 	*val = vringh16_to_cpu(vrh, v);  in getu16_user()
579 static inline int putu16_user(const struct vringh *vrh, __virtio16 *p, u16 val)  in putu16_user()  argument
581 	__virtio16 v = cpu_to_vringh16(vrh, val);  in putu16_user()
585 static inline int copydesc_user(const struct vringh *vrh,  in copydesc_user()  argument
592 static inline int putused_user(const struct vringh *vrh,  in putused_user()  argument
601 static inline int xfer_from_user(const struct vringh *vrh, void *src,  in xfer_from_user()  argument
608 static inline int xfer_to_user(const struct vringh *vrh,  in xfer_to_user()  argument
628 int vringh_init_user(struct vringh *vrh, u64 features,  in vringh_init_user()  argument
640 	vrh->little_endian = (features & (1ULL << VIRTIO_F_VERSION_1));  in vringh_init_user()
641 	vrh->event_indices = (features & (1 << VIRTIO_RING_F_EVENT_IDX));  in vringh_init_user()
642 	vrh->weak_barriers = weak_barriers;  in vringh_init_user()
643 	vrh->completed = 0;  in vringh_init_user()
644 	vrh->last_avail_idx = 0;  in vringh_init_user()
645 	vrh->last_used_idx = 0;  in vringh_init_user()
646 	vrh->vring.num = num;  in vringh_init_user()
648 	vrh->vring.desc = (__force struct vring_desc *)desc;  in vringh_init_user()
649 	vrh->vring.avail = (__force struct vring_avail *)avail;  in vringh_init_user()
650 	vrh->vring.used = (__force struct vring_used *)used;  in vringh_init_user()
672 int vringh_getdesc_user(struct vringh *vrh,  in vringh_getdesc_user()  argument
675 			bool (*getrange)(struct vringh *vrh,  in vringh_getdesc_user()  argument
681 	*head = vrh->vring.num;  in vringh_getdesc_user()
682 	err = __vringh_get_head(vrh, getu16_user, &vrh->last_avail_idx);  in vringh_getdesc_user()
687 	if (err == vrh->vring.num)  in vringh_getdesc_user()
711 	err = __vringh_iov(vrh, *head, (struct vringh_kiov *)riov,  in vringh_getdesc_user()
760 void vringh_abandon_user(struct vringh *vrh, unsigned int num)  in vringh_abandon_user()  argument
764 	vrh->last_avail_idx -= num;  in vringh_abandon_user()
777 int vringh_complete_user(struct vringh *vrh, u16 head, u32 len)  in vringh_complete_user()  argument
781 	used.id = cpu_to_vringh32(vrh, head);  in vringh_complete_user()
782 	used.len = cpu_to_vringh32(vrh, len);  in vringh_complete_user()
783 	return __vringh_complete(vrh, &used, 1, putu16_user, putused_user);  in vringh_complete_user()
796 int vringh_complete_multi_user(struct vringh *vrh,  in vringh_complete_multi_user()  argument
800 	return __vringh_complete(vrh, used, num_used,  in vringh_complete_multi_user()
812 bool vringh_notify_enable_user(struct vringh *vrh)  in vringh_notify_enable_user()  argument
814 	return __vringh_notify_enable(vrh, getu16_user, putu16_user);  in vringh_notify_enable_user()
825 void vringh_notify_disable_user(struct vringh *vrh)  in vringh_notify_disable_user()  argument
827 	__vringh_notify_disable(vrh, putu16_user);  in vringh_notify_disable_user()
837 int vringh_need_notify_user(struct vringh *vrh)  in vringh_need_notify_user()  argument
839 	return __vringh_need_notify(vrh, getu16_user);  in vringh_need_notify_user()
844 static inline int getu16_kern(const struct vringh *vrh,  in getu16_kern()  argument
847 	*val = vringh16_to_cpu(vrh, READ_ONCE(*p));  in getu16_kern()
851 static inline int putu16_kern(const struct vringh *vrh, __virtio16 *p, u16 val)  in putu16_kern()  argument
853 	WRITE_ONCE(*p, cpu_to_vringh16(vrh, val));  in putu16_kern()
857 static inline int copydesc_kern(const struct vringh *vrh,  in copydesc_kern()  argument
864 static inline int putused_kern(const struct vringh *vrh,  in putused_kern()  argument
873 static inline int xfer_kern(const struct vringh *vrh, void *src,  in xfer_kern()  argument
880 static inline int kern_xfer(const struct vringh *vrh, void *dst,  in kern_xfer()  argument
899 int vringh_init_kern(struct vringh *vrh, u64 features,  in vringh_init_kern()  argument
911 	vrh->little_endian = (features & (1ULL << VIRTIO_F_VERSION_1));  in vringh_init_kern()
912 	vrh->event_indices = (features & (1 << VIRTIO_RING_F_EVENT_IDX));  in vringh_init_kern()
913 	vrh->weak_barriers = weak_barriers;  in vringh_init_kern()
914 	vrh->completed = 0;  in vringh_init_kern()
915 	vrh->last_avail_idx = 0;  in vringh_init_kern()
916 	vrh->last_used_idx = 0;  in vringh_init_kern()
917 	vrh->vring.num = num;  in vringh_init_kern()
918 	vrh->vring.desc = desc;  in vringh_init_kern()
919 	vrh->vring.avail = avail;  in vringh_init_kern()
920 	vrh->vring.used = used;  in vringh_init_kern()
942 int vringh_getdesc_kern(struct vringh *vrh,  in vringh_getdesc_kern()  argument
950 	err = __vringh_get_head(vrh, getu16_kern, &vrh->last_avail_idx);  in vringh_getdesc_kern()
955 	if (err == vrh->vring.num)  in vringh_getdesc_kern()
959 	err = __vringh_iov(vrh, *head, riov, wiov, no_range_check, NULL,  in vringh_getdesc_kern()
1005 void vringh_abandon_kern(struct vringh *vrh, unsigned int num)  in vringh_abandon_kern()  argument
1009 	vrh->last_avail_idx -= num;  in vringh_abandon_kern()
1022 int vringh_complete_kern(struct vringh *vrh, u16 head, u32 len)  in vringh_complete_kern()  argument
1026 	used.id = cpu_to_vringh32(vrh, head);  in vringh_complete_kern()
1027 	used.len = cpu_to_vringh32(vrh, len);  in vringh_complete_kern()
1029 	return __vringh_complete(vrh, &used, 1, putu16_kern, putused_kern);  in vringh_complete_kern()
1040 bool vringh_notify_enable_kern(struct vringh *vrh)  in vringh_notify_enable_kern()  argument
1042 	return __vringh_notify_enable(vrh, getu16_kern, putu16_kern);  in vringh_notify_enable_kern()
1053 void vringh_notify_disable_kern(struct vringh *vrh)  in vringh_notify_disable_kern()  argument
1055 	__vringh_notify_disable(vrh, putu16_kern);  in vringh_notify_disable_kern()
1065 int vringh_need_notify_kern(struct vringh *vrh)  in vringh_need_notify_kern()  argument
1067 	return __vringh_need_notify(vrh, getu16_kern);  in vringh_need_notify_kern()
1073 static int iotlb_translate(const struct vringh *vrh,  in iotlb_translate()  argument
1078 	struct vhost_iotlb *iotlb = vrh->iotlb;  in iotlb_translate()
1114 static inline int copy_from_iotlb(const struct vringh *vrh, void *dst,  in copy_from_iotlb()  argument
1121 	ret = iotlb_translate(vrh, (u64)(uintptr_t)src,  in copy_from_iotlb()
1133 static inline int copy_to_iotlb(const struct vringh *vrh, void *dst,  in copy_to_iotlb()  argument
1140 	ret = iotlb_translate(vrh, (u64)(uintptr_t)dst,  in copy_to_iotlb()
1150 static inline int getu16_iotlb(const struct vringh *vrh,  in getu16_iotlb()  argument
1158 	ret = iotlb_translate(vrh, (u64)(uintptr_t)p, sizeof(*p),  in getu16_iotlb()
1165 	*val = vringh16_to_cpu(vrh, READ_ONCE(*(__virtio16 *)from));  in getu16_iotlb()
1171 static inline int putu16_iotlb(const struct vringh *vrh,  in putu16_iotlb()  argument
1179 	ret = iotlb_translate(vrh, (u64)(uintptr_t)p, sizeof(*p),  in putu16_iotlb()
1186 	WRITE_ONCE(*(__virtio16 *)to, cpu_to_vringh16(vrh, val));  in putu16_iotlb()
1192 static inline int copydesc_iotlb(const struct vringh *vrh,  in copydesc_iotlb()  argument
1197 	ret = copy_from_iotlb(vrh, dst, (void *)src, len);  in copydesc_iotlb()
1204 static inline int xfer_from_iotlb(const struct vringh *vrh, void *src,  in xfer_from_iotlb()  argument
1209 	ret = copy_from_iotlb(vrh, dst, src, len);  in xfer_from_iotlb()
1216 static inline int xfer_to_iotlb(const struct vringh *vrh,  in xfer_to_iotlb()  argument
1221 	ret = copy_to_iotlb(vrh, dst, src, len);  in xfer_to_iotlb()
1228 static inline int putused_iotlb(const struct vringh *vrh,  in putused_iotlb()  argument
1236 	ret = copy_to_iotlb(vrh, dst, (void *)src, num * sizeof(*dst));  in putused_iotlb()
1255 int vringh_init_iotlb(struct vringh *vrh, u64 features,  in vringh_init_iotlb()  argument
1261 	return vringh_init_kern(vrh, features, num, weak_barriers,  in vringh_init_iotlb()
1271 void vringh_set_iotlb(struct vringh *vrh, struct vhost_iotlb *iotlb)  in vringh_set_iotlb()  argument
1273 	vrh->iotlb = iotlb;  in vringh_set_iotlb()
1295 int vringh_getdesc_iotlb(struct vringh *vrh,  in vringh_getdesc_iotlb()  argument
1303 	err = __vringh_get_head(vrh, getu16_iotlb, &vrh->last_avail_idx);  in vringh_getdesc_iotlb()
1308 	if (err == vrh->vring.num)  in vringh_getdesc_iotlb()
1312 	err = __vringh_iov(vrh, *head, riov, wiov, no_range_check, NULL,  in vringh_getdesc_iotlb()
1330 ssize_t vringh_iov_pull_iotlb(struct vringh *vrh,  in vringh_iov_pull_iotlb()  argument
1334 	return vringh_iov_xfer(vrh, riov, dst, len, xfer_from_iotlb);  in vringh_iov_pull_iotlb()
1347 ssize_t vringh_iov_push_iotlb(struct vringh *vrh,  in vringh_iov_push_iotlb()  argument
1351 	return vringh_iov_xfer(vrh, wiov, (void *)src, len, xfer_to_iotlb);  in vringh_iov_push_iotlb()
1363 void vringh_abandon_iotlb(struct vringh *vrh, unsigned int num)  in vringh_abandon_iotlb()  argument
1368 	vrh->last_avail_idx -= num;  in vringh_abandon_iotlb()
1381 int vringh_complete_iotlb(struct vringh *vrh, u16 head, u32 len)  in vringh_complete_iotlb()  argument
1385 	used.id = cpu_to_vringh32(vrh, head);  in vringh_complete_iotlb()
1386 	used.len = cpu_to_vringh32(vrh, len);  in vringh_complete_iotlb()
1388 	return __vringh_complete(vrh, &used, 1, putu16_iotlb, putused_iotlb);  in vringh_complete_iotlb()
1399 bool vringh_notify_enable_iotlb(struct vringh *vrh)  in vringh_notify_enable_iotlb()  argument
1401 	return __vringh_notify_enable(vrh, getu16_iotlb, putu16_iotlb);  in vringh_notify_enable_iotlb()
1412 void vringh_notify_disable_iotlb(struct vringh *vrh)  in vringh_notify_disable_iotlb()  argument
1414 	__vringh_notify_disable(vrh, putu16_iotlb);  in vringh_notify_disable_iotlb()
1424 int vringh_need_notify_iotlb(struct vringh *vrh)  in vringh_need_notify_iotlb()  argument
1426 	return __vringh_need_notify(vrh, getu16_iotlb);  in vringh_need_notify_iotlb()