Merge tag 'clk-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/clk/linux
[linux-block.git] / drivers / vhost / vringh.c
CommitLineData
09c434b8 1// SPDX-License-Identifier: GPL-2.0-only
f87d0fbb
RR
2/*
3 * Helpers for the host side of a virtio ring.
4 *
5 * Since these may be in userspace, we use (inline) accessors.
6 */
9d1b972f 7#include <linux/compiler.h>
f558a845 8#include <linux/module.h>
f87d0fbb
RR
9#include <linux/vringh.h>
10#include <linux/virtio_ring.h>
11#include <linux/kernel.h>
12#include <linux/ratelimit.h>
13#include <linux/uaccess.h>
14#include <linux/slab.h>
15#include <linux/export.h>
3302363a 16#if IS_REACHABLE(CONFIG_VHOST_IOTLB)
9ad9c49c
JW
17#include <linux/bvec.h>
18#include <linux/highmem.h>
19#include <linux/vhost_iotlb.h>
3302363a 20#endif
b9f7ac8c 21#include <uapi/linux/virtio_config.h>
f87d0fbb
RR
22
23static __printf(1,2) __cold void vringh_bad(const char *fmt, ...)
24{
25 static DEFINE_RATELIMIT_STATE(vringh_rs,
26 DEFAULT_RATELIMIT_INTERVAL,
27 DEFAULT_RATELIMIT_BURST);
28 if (__ratelimit(&vringh_rs)) {
29 va_list ap;
30 va_start(ap, fmt);
31 printk(KERN_NOTICE "vringh:");
32 vprintk(fmt, ap);
33 va_end(ap);
34 }
35}
36
37/* Returns vring->num if empty, -ve on error. */
38static inline int __vringh_get_head(const struct vringh *vrh,
b9f7ac8c
MT
39 int (*getu16)(const struct vringh *vrh,
40 u16 *val, const __virtio16 *p),
f87d0fbb
RR
41 u16 *last_avail_idx)
42{
43 u16 avail_idx, i, head;
44 int err;
45
b9f7ac8c 46 err = getu16(vrh, &avail_idx, &vrh->vring.avail->idx);
f87d0fbb
RR
47 if (err) {
48 vringh_bad("Failed to access avail idx at %p",
49 &vrh->vring.avail->idx);
50 return err;
51 }
52
53 if (*last_avail_idx == avail_idx)
54 return vrh->vring.num;
55
56 /* Only get avail ring entries after they have been exposed by guest. */
57 virtio_rmb(vrh->weak_barriers);
58
59 i = *last_avail_idx & (vrh->vring.num - 1);
60
b9f7ac8c 61 err = getu16(vrh, &head, &vrh->vring.avail->ring[i]);
f87d0fbb
RR
62 if (err) {
63 vringh_bad("Failed to read head: idx %d address %p",
64 *last_avail_idx, &vrh->vring.avail->ring[i]);
65 return err;
66 }
67
68 if (head >= vrh->vring.num) {
69 vringh_bad("Guest says index %u > %u is available",
70 head, vrh->vring.num);
71 return -EINVAL;
72 }
73
74 (*last_avail_idx)++;
75 return head;
76}
77
b8c06ad4
SG
78/**
79 * vringh_kiov_advance - skip bytes from vring_kiov
80 * @iov: an iov passed to vringh_getdesc_*() (updated as we consume)
81 * @len: the maximum length to advance
82 */
83void vringh_kiov_advance(struct vringh_kiov *iov, size_t len)
84{
85 while (len && iov->i < iov->used) {
86 size_t partlen = min(iov->iov[iov->i].iov_len, len);
87
88 iov->consumed += partlen;
89 iov->iov[iov->i].iov_len -= partlen;
90 iov->iov[iov->i].iov_base += partlen;
91
92 if (!iov->iov[iov->i].iov_len) {
93 /* Fix up old iov element then increment. */
94 iov->iov[iov->i].iov_len = iov->consumed;
95 iov->iov[iov->i].iov_base -= iov->consumed;
96
97 iov->consumed = 0;
98 iov->i++;
99 }
100
101 len -= partlen;
102 }
103}
104EXPORT_SYMBOL(vringh_kiov_advance);
105
f87d0fbb 106/* Copy some bytes to/from the iovec. Returns num copied. */
9ad9c49c
JW
107static inline ssize_t vringh_iov_xfer(struct vringh *vrh,
108 struct vringh_kiov *iov,
f87d0fbb 109 void *ptr, size_t len,
9ad9c49c
JW
110 int (*xfer)(const struct vringh *vrh,
111 void *addr, void *ptr,
f87d0fbb
RR
112 size_t len))
113{
114 int err, done = 0;
115
116 while (len && iov->i < iov->used) {
117 size_t partlen;
118
119 partlen = min(iov->iov[iov->i].iov_len, len);
9ad9c49c 120 err = xfer(vrh, iov->iov[iov->i].iov_base, ptr, partlen);
f87d0fbb
RR
121 if (err)
122 return err;
123 done += partlen;
124 len -= partlen;
125 ptr += partlen;
f87d0fbb 126
b8c06ad4 127 vringh_kiov_advance(iov, partlen);
f87d0fbb
RR
128 }
129 return done;
130}
131
132/* May reduce *len if range is shorter. */
133static inline bool range_check(struct vringh *vrh, u64 addr, size_t *len,
134 struct vringh_range *range,
135 bool (*getrange)(struct vringh *,
136 u64, struct vringh_range *))
137{
138 if (addr < range->start || addr > range->end_incl) {
139 if (!getrange(vrh, addr, range))
140 return false;
141 }
142 BUG_ON(addr < range->start || addr > range->end_incl);
143
144 /* To end of memory? */
145 if (unlikely(addr + *len == 0)) {
146 if (range->end_incl == -1ULL)
147 return true;
148 goto truncate;
149 }
150
151 /* Otherwise, don't wrap. */
152 if (addr + *len < addr) {
153 vringh_bad("Wrapping descriptor %zu@0x%llx",
154 *len, (unsigned long long)addr);
155 return false;
156 }
157
158 if (unlikely(addr + *len - 1 > range->end_incl))
159 goto truncate;
160 return true;
161
162truncate:
163 *len = range->end_incl + 1 - addr;
164 return true;
165}
166
167static inline bool no_range_check(struct vringh *vrh, u64 addr, size_t *len,
168 struct vringh_range *range,
169 bool (*getrange)(struct vringh *,
170 u64, struct vringh_range *))
171{
172 return true;
173}
174
175/* No reason for this code to be inline. */
b9f7ac8c
MT
176static int move_to_indirect(const struct vringh *vrh,
177 int *up_next, u16 *i, void *addr,
f87d0fbb
RR
178 const struct vring_desc *desc,
179 struct vring_desc **descs, int *desc_max)
180{
b9f7ac8c
MT
181 u32 len;
182
f87d0fbb
RR
183 /* Indirect tables can't have indirect. */
184 if (*up_next != -1) {
185 vringh_bad("Multilevel indirect %u->%u", *up_next, *i);
186 return -EINVAL;
187 }
188
b9f7ac8c
MT
189 len = vringh32_to_cpu(vrh, desc->len);
190 if (unlikely(len % sizeof(struct vring_desc))) {
f87d0fbb
RR
191 vringh_bad("Strange indirect len %u", desc->len);
192 return -EINVAL;
193 }
194
195 /* We will check this when we follow it! */
b9f7ac8c
MT
196 if (desc->flags & cpu_to_vringh16(vrh, VRING_DESC_F_NEXT))
197 *up_next = vringh16_to_cpu(vrh, desc->next);
f87d0fbb
RR
198 else
199 *up_next = -2;
200 *descs = addr;
b9f7ac8c 201 *desc_max = len / sizeof(struct vring_desc);
f87d0fbb
RR
202
203 /* Now, start at the first indirect. */
204 *i = 0;
205 return 0;
206}
207
208static int resize_iovec(struct vringh_kiov *iov, gfp_t gfp)
209{
210 struct kvec *new;
211 unsigned int flag, new_num = (iov->max_num & ~VRINGH_IOV_ALLOCATED) * 2;
212
213 if (new_num < 8)
214 new_num = 8;
215
216 flag = (iov->max_num & VRINGH_IOV_ALLOCATED);
217 if (flag)
3a999748
BG
218 new = krealloc_array(iov->iov, new_num,
219 sizeof(struct iovec), gfp);
f87d0fbb 220 else {
6da2ec56 221 new = kmalloc_array(new_num, sizeof(struct iovec), gfp);
f87d0fbb
RR
222 if (new) {
223 memcpy(new, iov->iov,
224 iov->max_num * sizeof(struct iovec));
225 flag = VRINGH_IOV_ALLOCATED;
226 }
227 }
228 if (!new)
229 return -ENOMEM;
230 iov->iov = new;
231 iov->max_num = (new_num | flag);
232 return 0;
233}
234
235static u16 __cold return_from_indirect(const struct vringh *vrh, int *up_next,
236 struct vring_desc **descs, int *desc_max)
237{
238 u16 i = *up_next;
239
240 *up_next = -1;
241 *descs = vrh->vring.desc;
242 *desc_max = vrh->vring.num;
243 return i;
244}
245
246static int slow_copy(struct vringh *vrh, void *dst, const void *src,
247 bool (*rcheck)(struct vringh *vrh, u64 addr, size_t *len,
248 struct vringh_range *range,
249 bool (*getrange)(struct vringh *vrh,
250 u64,
251 struct vringh_range *)),
252 bool (*getrange)(struct vringh *vrh,
253 u64 addr,
254 struct vringh_range *r),
255 struct vringh_range *range,
9ad9c49c
JW
256 int (*copy)(const struct vringh *vrh,
257 void *dst, const void *src, size_t len))
f87d0fbb
RR
258{
259 size_t part, len = sizeof(struct vring_desc);
260
261 do {
262 u64 addr;
263 int err;
264
265 part = len;
266 addr = (u64)(unsigned long)src - range->offset;
267
268 if (!rcheck(vrh, addr, &part, range, getrange))
269 return -EINVAL;
270
9ad9c49c 271 err = copy(vrh, dst, src, part);
f87d0fbb
RR
272 if (err)
273 return err;
274
275 dst += part;
276 src += part;
277 len -= part;
278 } while (len);
279 return 0;
280}
281
282static inline int
283__vringh_iov(struct vringh *vrh, u16 i,
284 struct vringh_kiov *riov,
285 struct vringh_kiov *wiov,
286 bool (*rcheck)(struct vringh *vrh, u64 addr, size_t *len,
287 struct vringh_range *range,
288 bool (*getrange)(struct vringh *, u64,
289 struct vringh_range *)),
290 bool (*getrange)(struct vringh *, u64, struct vringh_range *),
291 gfp_t gfp,
9ad9c49c
JW
292 int (*copy)(const struct vringh *vrh,
293 void *dst, const void *src, size_t len))
f87d0fbb 294{
dbd29e07 295 int err, count = 0, indirect_count = 0, up_next, desc_max;
f87d0fbb
RR
296 struct vring_desc desc, *descs;
297 struct vringh_range range = { -1ULL, 0 }, slowrange;
298 bool slow = false;
299
300 /* We start traversing vring's descriptor table. */
301 descs = vrh->vring.desc;
302 desc_max = vrh->vring.num;
303 up_next = -1;
304
5745bcfb
SG
305 /* You must want something! */
306 if (WARN_ON(!riov && !wiov))
307 return -EINVAL;
308
f87d0fbb 309 if (riov)
bbc2c372 310 riov->i = riov->used = riov->consumed = 0;
5745bcfb 311 if (wiov)
bbc2c372 312 wiov->i = wiov->used = wiov->consumed = 0;
f87d0fbb
RR
313
314 for (;;) {
315 void *addr;
316 struct vringh_kiov *iov;
317 size_t len;
318
319 if (unlikely(slow))
320 err = slow_copy(vrh, &desc, &descs[i], rcheck, getrange,
321 &slowrange, copy);
322 else
9ad9c49c 323 err = copy(vrh, &desc, &descs[i], sizeof(desc));
f87d0fbb
RR
324 if (unlikely(err))
325 goto fail;
326
b9f7ac8c
MT
327 if (unlikely(desc.flags &
328 cpu_to_vringh16(vrh, VRING_DESC_F_INDIRECT))) {
329 u64 a = vringh64_to_cpu(vrh, desc.addr);
330
f87d0fbb 331 /* Make sure it's OK, and get offset. */
b9f7ac8c
MT
332 len = vringh32_to_cpu(vrh, desc.len);
333 if (!rcheck(vrh, a, &len, &range, getrange)) {
f87d0fbb
RR
334 err = -EINVAL;
335 goto fail;
336 }
337
b9f7ac8c 338 if (unlikely(len != vringh32_to_cpu(vrh, desc.len))) {
f87d0fbb
RR
339 slow = true;
340 /* We need to save this range to use offset */
341 slowrange = range;
342 }
343
b9f7ac8c
MT
344 addr = (void *)(long)(a + range.offset);
345 err = move_to_indirect(vrh, &up_next, &i, addr, &desc,
f87d0fbb
RR
346 &descs, &desc_max);
347 if (err)
348 goto fail;
349 continue;
350 }
351
dbd29e07
XY
352 if (up_next == -1)
353 count++;
354 else
355 indirect_count++;
356
357 if (count > vrh->vring.num || indirect_count > desc_max) {
f87d0fbb
RR
358 vringh_bad("Descriptor loop in %p", descs);
359 err = -ELOOP;
360 goto fail;
361 }
362
b9f7ac8c 363 if (desc.flags & cpu_to_vringh16(vrh, VRING_DESC_F_WRITE))
f87d0fbb
RR
364 iov = wiov;
365 else {
366 iov = riov;
e74cfa91 367 if (unlikely(wiov && wiov->used)) {
f87d0fbb
RR
368 vringh_bad("Readable desc %p after writable",
369 &descs[i]);
370 err = -EINVAL;
371 goto fail;
372 }
373 }
374
375 if (!iov) {
376 vringh_bad("Unexpected %s desc",
377 !wiov ? "writable" : "readable");
378 err = -EPROTO;
379 goto fail;
380 }
381
382 again:
383 /* Make sure it's OK, and get offset. */
b9f7ac8c
MT
384 len = vringh32_to_cpu(vrh, desc.len);
385 if (!rcheck(vrh, vringh64_to_cpu(vrh, desc.addr), &len, &range,
386 getrange)) {
f87d0fbb
RR
387 err = -EINVAL;
388 goto fail;
389 }
b9f7ac8c
MT
390 addr = (void *)(unsigned long)(vringh64_to_cpu(vrh, desc.addr) +
391 range.offset);
f87d0fbb
RR
392
393 if (unlikely(iov->used == (iov->max_num & ~VRINGH_IOV_ALLOCATED))) {
394 err = resize_iovec(iov, gfp);
395 if (err)
396 goto fail;
397 }
398
399 iov->iov[iov->used].iov_base = addr;
400 iov->iov[iov->used].iov_len = len;
401 iov->used++;
402
b9f7ac8c
MT
403 if (unlikely(len != vringh32_to_cpu(vrh, desc.len))) {
404 desc.len = cpu_to_vringh32(vrh,
405 vringh32_to_cpu(vrh, desc.len) - len);
406 desc.addr = cpu_to_vringh64(vrh,
407 vringh64_to_cpu(vrh, desc.addr) + len);
f87d0fbb
RR
408 goto again;
409 }
410
b9f7ac8c
MT
411 if (desc.flags & cpu_to_vringh16(vrh, VRING_DESC_F_NEXT)) {
412 i = vringh16_to_cpu(vrh, desc.next);
f87d0fbb
RR
413 } else {
414 /* Just in case we need to finish traversing above. */
415 if (unlikely(up_next > 0)) {
416 i = return_from_indirect(vrh, &up_next,
417 &descs, &desc_max);
418 slow = false;
dbd29e07 419 indirect_count = 0;
f87d0fbb
RR
420 } else
421 break;
422 }
423
424 if (i >= desc_max) {
425 vringh_bad("Chained index %u > %u", i, desc_max);
426 err = -EINVAL;
427 goto fail;
428 }
429 }
430
431 return 0;
432
433fail:
434 return err;
435}
436
437static inline int __vringh_complete(struct vringh *vrh,
438 const struct vring_used_elem *used,
439 unsigned int num_used,
b9f7ac8c
MT
440 int (*putu16)(const struct vringh *vrh,
441 __virtio16 *p, u16 val),
9ad9c49c
JW
442 int (*putused)(const struct vringh *vrh,
443 struct vring_used_elem *dst,
f87d0fbb
RR
444 const struct vring_used_elem
445 *src, unsigned num))
446{
447 struct vring_used *used_ring;
448 int err;
449 u16 used_idx, off;
450
451 used_ring = vrh->vring.used;
452 used_idx = vrh->last_used_idx + vrh->completed;
453
454 off = used_idx % vrh->vring.num;
455
456 /* Compiler knows num_used == 1 sometimes, hence extra check */
457 if (num_used > 1 && unlikely(off + num_used >= vrh->vring.num)) {
458 u16 part = vrh->vring.num - off;
9ad9c49c 459 err = putused(vrh, &used_ring->ring[off], used, part);
f87d0fbb 460 if (!err)
9ad9c49c 461 err = putused(vrh, &used_ring->ring[0], used + part,
f87d0fbb
RR
462 num_used - part);
463 } else
9ad9c49c 464 err = putused(vrh, &used_ring->ring[off], used, num_used);
f87d0fbb
RR
465
466 if (err) {
467 vringh_bad("Failed to write %u used entries %u at %p",
468 num_used, off, &used_ring->ring[off]);
469 return err;
470 }
471
472 /* Make sure buffer is written before we update index. */
473 virtio_wmb(vrh->weak_barriers);
474
b9f7ac8c 475 err = putu16(vrh, &vrh->vring.used->idx, used_idx + num_used);
f87d0fbb
RR
476 if (err) {
477 vringh_bad("Failed to update used index at %p",
478 &vrh->vring.used->idx);
479 return err;
480 }
481
482 vrh->completed += num_used;
483 return 0;
484}
485
486
487static inline int __vringh_need_notify(struct vringh *vrh,
b9f7ac8c
MT
488 int (*getu16)(const struct vringh *vrh,
489 u16 *val,
490 const __virtio16 *p))
f87d0fbb
RR
491{
492 bool notify;
493 u16 used_event;
494 int err;
495
496 /* Flush out used index update. This is paired with the
497 * barrier that the Guest executes when enabling
498 * interrupts. */
499 virtio_mb(vrh->weak_barriers);
500
501 /* Old-style, without event indices. */
502 if (!vrh->event_indices) {
503 u16 flags;
b9f7ac8c 504 err = getu16(vrh, &flags, &vrh->vring.avail->flags);
f87d0fbb
RR
505 if (err) {
506 vringh_bad("Failed to get flags at %p",
507 &vrh->vring.avail->flags);
508 return err;
509 }
510 return (!(flags & VRING_AVAIL_F_NO_INTERRUPT));
511 }
512
513 /* Modern: we know when other side wants to know. */
b9f7ac8c 514 err = getu16(vrh, &used_event, &vring_used_event(&vrh->vring));
f87d0fbb
RR
515 if (err) {
516 vringh_bad("Failed to get used event idx at %p",
517 &vring_used_event(&vrh->vring));
518 return err;
519 }
520
521 /* Just in case we added so many that we wrap. */
522 if (unlikely(vrh->completed > 0xffff))
523 notify = true;
524 else
525 notify = vring_need_event(used_event,
526 vrh->last_used_idx + vrh->completed,
527 vrh->last_used_idx);
528
529 vrh->last_used_idx += vrh->completed;
530 vrh->completed = 0;
531 return notify;
532}
533
534static inline bool __vringh_notify_enable(struct vringh *vrh,
b9f7ac8c
MT
535 int (*getu16)(const struct vringh *vrh,
536 u16 *val, const __virtio16 *p),
537 int (*putu16)(const struct vringh *vrh,
538 __virtio16 *p, u16 val))
f87d0fbb
RR
539{
540 u16 avail;
541
542 if (!vrh->event_indices) {
543 /* Old-school; update flags. */
b9f7ac8c 544 if (putu16(vrh, &vrh->vring.used->flags, 0) != 0) {
f87d0fbb
RR
545 vringh_bad("Clearing used flags %p",
546 &vrh->vring.used->flags);
547 return true;
548 }
549 } else {
b9f7ac8c 550 if (putu16(vrh, &vring_avail_event(&vrh->vring),
f87d0fbb
RR
551 vrh->last_avail_idx) != 0) {
552 vringh_bad("Updating avail event index %p",
553 &vring_avail_event(&vrh->vring));
554 return true;
555 }
556 }
557
558 /* They could have slipped one in as we were doing that: make
559 * sure it's written, then check again. */
560 virtio_mb(vrh->weak_barriers);
561
b9f7ac8c 562 if (getu16(vrh, &avail, &vrh->vring.avail->idx) != 0) {
f87d0fbb
RR
563 vringh_bad("Failed to check avail idx at %p",
564 &vrh->vring.avail->idx);
565 return true;
566 }
567
568 /* This is unlikely, so we just leave notifications enabled
569 * (if we're using event_indices, we'll only get one
570 * notification anyway). */
571 return avail == vrh->last_avail_idx;
572}
573
574static inline void __vringh_notify_disable(struct vringh *vrh,
b9f7ac8c
MT
575 int (*putu16)(const struct vringh *vrh,
576 __virtio16 *p, u16 val))
f87d0fbb
RR
577{
578 if (!vrh->event_indices) {
579 /* Old-school; update flags. */
b9f7ac8c
MT
580 if (putu16(vrh, &vrh->vring.used->flags,
581 VRING_USED_F_NO_NOTIFY)) {
f87d0fbb
RR
582 vringh_bad("Setting used flags %p",
583 &vrh->vring.used->flags);
584 }
585 }
586}
587
588/* Userspace access helpers: in this case, addresses are really userspace. */
b9f7ac8c 589static inline int getu16_user(const struct vringh *vrh, u16 *val, const __virtio16 *p)
f87d0fbb 590{
b9f7ac8c
MT
591 __virtio16 v = 0;
592 int rc = get_user(v, (__force __virtio16 __user *)p);
593 *val = vringh16_to_cpu(vrh, v);
594 return rc;
f87d0fbb
RR
595}
596
b9f7ac8c 597static inline int putu16_user(const struct vringh *vrh, __virtio16 *p, u16 val)
f87d0fbb 598{
b9f7ac8c
MT
599 __virtio16 v = cpu_to_vringh16(vrh, val);
600 return put_user(v, (__force __virtio16 __user *)p);
f87d0fbb
RR
601}
602
9ad9c49c
JW
603static inline int copydesc_user(const struct vringh *vrh,
604 void *dst, const void *src, size_t len)
f87d0fbb
RR
605{
606 return copy_from_user(dst, (__force void __user *)src, len) ?
607 -EFAULT : 0;
608}
609
9ad9c49c
JW
610static inline int putused_user(const struct vringh *vrh,
611 struct vring_used_elem *dst,
f87d0fbb
RR
612 const struct vring_used_elem *src,
613 unsigned int num)
614{
615 return copy_to_user((__force void __user *)dst, src,
616 sizeof(*dst) * num) ? -EFAULT : 0;
617}
618
9ad9c49c
JW
619static inline int xfer_from_user(const struct vringh *vrh, void *src,
620 void *dst, size_t len)
f87d0fbb
RR
621{
622 return copy_from_user(dst, (__force void __user *)src, len) ?
623 -EFAULT : 0;
624}
625
9ad9c49c
JW
626static inline int xfer_to_user(const struct vringh *vrh,
627 void *dst, void *src, size_t len)
f87d0fbb
RR
628{
629 return copy_to_user((__force void __user *)dst, src, len) ?
630 -EFAULT : 0;
631}
632
633/**
634 * vringh_init_user - initialize a vringh for a userspace vring.
635 * @vrh: the vringh to initialize.
636 * @features: the feature bits for this ring.
637 * @num: the number of elements.
638 * @weak_barriers: true if we only need memory barriers, not I/O.
905233af
SG
639 * @desc: the userspace descriptor pointer.
640 * @avail: the userspace avail pointer.
641 * @used: the userspace used pointer.
f87d0fbb
RR
642 *
643 * Returns an error if num is invalid: you should check pointers
644 * yourself!
645 */
b97a8a90 646int vringh_init_user(struct vringh *vrh, u64 features,
f87d0fbb 647 unsigned int num, bool weak_barriers,
a865e420
MT
648 vring_desc_t __user *desc,
649 vring_avail_t __user *avail,
650 vring_used_t __user *used)
f87d0fbb
RR
651{
652 /* Sane power of 2 please! */
653 if (!num || num > 0xffff || (num & (num - 1))) {
654 vringh_bad("Bad ring size %u", num);
655 return -EINVAL;
656 }
657
b9f7ac8c 658 vrh->little_endian = (features & (1ULL << VIRTIO_F_VERSION_1));
f87d0fbb
RR
659 vrh->event_indices = (features & (1 << VIRTIO_RING_F_EVENT_IDX));
660 vrh->weak_barriers = weak_barriers;
661 vrh->completed = 0;
662 vrh->last_avail_idx = 0;
663 vrh->last_used_idx = 0;
664 vrh->vring.num = num;
665 /* vring expects kernel addresses, but only used via accessors. */
666 vrh->vring.desc = (__force struct vring_desc *)desc;
667 vrh->vring.avail = (__force struct vring_avail *)avail;
668 vrh->vring.used = (__force struct vring_used *)used;
669 return 0;
670}
671EXPORT_SYMBOL(vringh_init_user);
672
673/**
674 * vringh_getdesc_user - get next available descriptor from userspace ring.
675 * @vrh: the userspace vring.
676 * @riov: where to put the readable descriptors (or NULL)
677 * @wiov: where to put the writable descriptors (or NULL)
678 * @getrange: function to call to check ranges.
679 * @head: head index we received, for passing to vringh_complete_user().
680 *
681 * Returns 0 if there was no descriptor, 1 if there was, or -errno.
682 *
683 * Note that on error return, you can tell the difference between an
684 * invalid ring and a single invalid descriptor: in the former case,
685 * *head will be vrh->vring.num. You may be able to ignore an invalid
686 * descriptor, but there's not much you can do with an invalid ring.
687 *
69c13c58
SG
688 * Note that you can reuse riov and wiov with subsequent calls. Content is
689 * overwritten and memory reallocated if more space is needed.
690 * When you don't have to use riov and wiov anymore, you should clean up them
691 * calling vringh_iov_cleanup() to release the memory, even on error!
f87d0fbb
RR
692 */
693int vringh_getdesc_user(struct vringh *vrh,
694 struct vringh_iov *riov,
695 struct vringh_iov *wiov,
696 bool (*getrange)(struct vringh *vrh,
697 u64 addr, struct vringh_range *r),
698 u16 *head)
699{
700 int err;
701
702 *head = vrh->vring.num;
703 err = __vringh_get_head(vrh, getu16_user, &vrh->last_avail_idx);
704 if (err < 0)
705 return err;
706
707 /* Empty... */
708 if (err == vrh->vring.num)
709 return 0;
710
711 /* We need the layouts to be the identical for this to work */
712 BUILD_BUG_ON(sizeof(struct vringh_kiov) != sizeof(struct vringh_iov));
713 BUILD_BUG_ON(offsetof(struct vringh_kiov, iov) !=
714 offsetof(struct vringh_iov, iov));
715 BUILD_BUG_ON(offsetof(struct vringh_kiov, i) !=
716 offsetof(struct vringh_iov, i));
717 BUILD_BUG_ON(offsetof(struct vringh_kiov, used) !=
718 offsetof(struct vringh_iov, used));
719 BUILD_BUG_ON(offsetof(struct vringh_kiov, max_num) !=
720 offsetof(struct vringh_iov, max_num));
721 BUILD_BUG_ON(sizeof(struct iovec) != sizeof(struct kvec));
722 BUILD_BUG_ON(offsetof(struct iovec, iov_base) !=
723 offsetof(struct kvec, iov_base));
724 BUILD_BUG_ON(offsetof(struct iovec, iov_len) !=
725 offsetof(struct kvec, iov_len));
726 BUILD_BUG_ON(sizeof(((struct iovec *)NULL)->iov_base)
727 != sizeof(((struct kvec *)NULL)->iov_base));
728 BUILD_BUG_ON(sizeof(((struct iovec *)NULL)->iov_len)
729 != sizeof(((struct kvec *)NULL)->iov_len));
730
731 *head = err;
732 err = __vringh_iov(vrh, *head, (struct vringh_kiov *)riov,
733 (struct vringh_kiov *)wiov,
734 range_check, getrange, GFP_KERNEL, copydesc_user);
735 if (err)
736 return err;
737
738 return 1;
739}
740EXPORT_SYMBOL(vringh_getdesc_user);
741
742/**
743 * vringh_iov_pull_user - copy bytes from vring_iov.
744 * @riov: the riov as passed to vringh_getdesc_user() (updated as we consume)
745 * @dst: the place to copy.
746 * @len: the maximum length to copy.
747 *
748 * Returns the bytes copied <= len or a negative errno.
749 */
750ssize_t vringh_iov_pull_user(struct vringh_iov *riov, void *dst, size_t len)
751{
9ad9c49c 752 return vringh_iov_xfer(NULL, (struct vringh_kiov *)riov,
f87d0fbb
RR
753 dst, len, xfer_from_user);
754}
755EXPORT_SYMBOL(vringh_iov_pull_user);
756
757/**
758 * vringh_iov_push_user - copy bytes into vring_iov.
759 * @wiov: the wiov as passed to vringh_getdesc_user() (updated as we consume)
8009b0f4 760 * @src: the place to copy from.
f87d0fbb
RR
761 * @len: the maximum length to copy.
762 *
763 * Returns the bytes copied <= len or a negative errno.
764 */
765ssize_t vringh_iov_push_user(struct vringh_iov *wiov,
766 const void *src, size_t len)
767{
9ad9c49c 768 return vringh_iov_xfer(NULL, (struct vringh_kiov *)wiov,
f87d0fbb
RR
769 (void *)src, len, xfer_to_user);
770}
771EXPORT_SYMBOL(vringh_iov_push_user);
772
773/**
774 * vringh_abandon_user - we've decided not to handle the descriptor(s).
775 * @vrh: the vring.
776 * @num: the number of descriptors to put back (ie. num
777 * vringh_get_user() to undo).
778 *
779 * The next vringh_get_user() will return the old descriptor(s) again.
780 */
781void vringh_abandon_user(struct vringh *vrh, unsigned int num)
782{
783 /* We only update vring_avail_event(vr) when we want to be notified,
784 * so we haven't changed that yet. */
785 vrh->last_avail_idx -= num;
786}
787EXPORT_SYMBOL(vringh_abandon_user);
788
789/**
790 * vringh_complete_user - we've finished with descriptor, publish it.
791 * @vrh: the vring.
792 * @head: the head as filled in by vringh_getdesc_user.
793 * @len: the length of data we have written.
794 *
795 * You should check vringh_need_notify_user() after one or more calls
796 * to this function.
797 */
798int vringh_complete_user(struct vringh *vrh, u16 head, u32 len)
799{
800 struct vring_used_elem used;
801
b9f7ac8c
MT
802 used.id = cpu_to_vringh32(vrh, head);
803 used.len = cpu_to_vringh32(vrh, len);
f87d0fbb
RR
804 return __vringh_complete(vrh, &used, 1, putu16_user, putused_user);
805}
806EXPORT_SYMBOL(vringh_complete_user);
807
808/**
809 * vringh_complete_multi_user - we've finished with many descriptors.
810 * @vrh: the vring.
811 * @used: the head, length pairs.
812 * @num_used: the number of used elements.
813 *
814 * You should check vringh_need_notify_user() after one or more calls
815 * to this function.
816 */
817int vringh_complete_multi_user(struct vringh *vrh,
818 const struct vring_used_elem used[],
819 unsigned num_used)
820{
821 return __vringh_complete(vrh, used, num_used,
822 putu16_user, putused_user);
823}
824EXPORT_SYMBOL(vringh_complete_multi_user);
825
826/**
827 * vringh_notify_enable_user - we want to know if something changes.
828 * @vrh: the vring.
829 *
830 * This always enables notifications, but returns false if there are
831 * now more buffers available in the vring.
832 */
833bool vringh_notify_enable_user(struct vringh *vrh)
834{
835 return __vringh_notify_enable(vrh, getu16_user, putu16_user);
836}
837EXPORT_SYMBOL(vringh_notify_enable_user);
838
839/**
840 * vringh_notify_disable_user - don't tell us if something changes.
841 * @vrh: the vring.
842 *
843 * This is our normal running state: we disable and then only enable when
844 * we're going to sleep.
845 */
846void vringh_notify_disable_user(struct vringh *vrh)
847{
848 __vringh_notify_disable(vrh, putu16_user);
849}
850EXPORT_SYMBOL(vringh_notify_disable_user);
851
852/**
853 * vringh_need_notify_user - must we tell the other side about used buffers?
854 * @vrh: the vring we've called vringh_complete_user() on.
855 *
856 * Returns -errno or 0 if we don't need to tell the other side, 1 if we do.
857 */
858int vringh_need_notify_user(struct vringh *vrh)
859{
860 return __vringh_need_notify(vrh, getu16_user);
861}
862EXPORT_SYMBOL(vringh_need_notify_user);
863
864/* Kernelspace access helpers. */
b9f7ac8c
MT
865static inline int getu16_kern(const struct vringh *vrh,
866 u16 *val, const __virtio16 *p)
f87d0fbb 867{
9d1b972f 868 *val = vringh16_to_cpu(vrh, READ_ONCE(*p));
f87d0fbb
RR
869 return 0;
870}
871
b9f7ac8c 872static inline int putu16_kern(const struct vringh *vrh, __virtio16 *p, u16 val)
f87d0fbb 873{
9d1b972f 874 WRITE_ONCE(*p, cpu_to_vringh16(vrh, val));
f87d0fbb
RR
875 return 0;
876}
877
9ad9c49c
JW
878static inline int copydesc_kern(const struct vringh *vrh,
879 void *dst, const void *src, size_t len)
f87d0fbb
RR
880{
881 memcpy(dst, src, len);
882 return 0;
883}
884
9ad9c49c
JW
885static inline int putused_kern(const struct vringh *vrh,
886 struct vring_used_elem *dst,
f87d0fbb
RR
887 const struct vring_used_elem *src,
888 unsigned int num)
889{
890 memcpy(dst, src, num * sizeof(*dst));
891 return 0;
892}
893
9ad9c49c
JW
894static inline int xfer_kern(const struct vringh *vrh, void *src,
895 void *dst, size_t len)
f87d0fbb
RR
896{
897 memcpy(dst, src, len);
898 return 0;
899}
900
9ad9c49c
JW
901static inline int kern_xfer(const struct vringh *vrh, void *dst,
902 void *src, size_t len)
b3683dee
JW
903{
904 memcpy(dst, src, len);
905 return 0;
906}
907
f87d0fbb
RR
908/**
909 * vringh_init_kern - initialize a vringh for a kernelspace vring.
910 * @vrh: the vringh to initialize.
911 * @features: the feature bits for this ring.
912 * @num: the number of elements.
913 * @weak_barriers: true if we only need memory barriers, not I/O.
905233af
SG
914 * @desc: the userspace descriptor pointer.
915 * @avail: the userspace avail pointer.
916 * @used: the userspace used pointer.
f87d0fbb
RR
917 *
918 * Returns an error if num is invalid.
919 */
b97a8a90 920int vringh_init_kern(struct vringh *vrh, u64 features,
f87d0fbb
RR
921 unsigned int num, bool weak_barriers,
922 struct vring_desc *desc,
923 struct vring_avail *avail,
924 struct vring_used *used)
925{
926 /* Sane power of 2 please! */
927 if (!num || num > 0xffff || (num & (num - 1))) {
928 vringh_bad("Bad ring size %u", num);
929 return -EINVAL;
930 }
931
b9f7ac8c 932 vrh->little_endian = (features & (1ULL << VIRTIO_F_VERSION_1));
f87d0fbb
RR
933 vrh->event_indices = (features & (1 << VIRTIO_RING_F_EVENT_IDX));
934 vrh->weak_barriers = weak_barriers;
935 vrh->completed = 0;
936 vrh->last_avail_idx = 0;
937 vrh->last_used_idx = 0;
938 vrh->vring.num = num;
939 vrh->vring.desc = desc;
940 vrh->vring.avail = avail;
941 vrh->vring.used = used;
942 return 0;
943}
944EXPORT_SYMBOL(vringh_init_kern);
945
946/**
947 * vringh_getdesc_kern - get next available descriptor from kernelspace ring.
948 * @vrh: the kernelspace vring.
949 * @riov: where to put the readable descriptors (or NULL)
950 * @wiov: where to put the writable descriptors (or NULL)
951 * @head: head index we received, for passing to vringh_complete_kern().
952 * @gfp: flags for allocating larger riov/wiov.
953 *
954 * Returns 0 if there was no descriptor, 1 if there was, or -errno.
955 *
956 * Note that on error return, you can tell the difference between an
957 * invalid ring and a single invalid descriptor: in the former case,
958 * *head will be vrh->vring.num. You may be able to ignore an invalid
959 * descriptor, but there's not much you can do with an invalid ring.
960 *
69c13c58
SG
961 * Note that you can reuse riov and wiov with subsequent calls. Content is
962 * overwritten and memory reallocated if more space is needed.
963 * When you don't have to use riov and wiov anymore, you should clean up them
964 * calling vringh_kiov_cleanup() to release the memory, even on error!
f87d0fbb
RR
965 */
966int vringh_getdesc_kern(struct vringh *vrh,
967 struct vringh_kiov *riov,
968 struct vringh_kiov *wiov,
969 u16 *head,
970 gfp_t gfp)
971{
972 int err;
973
974 err = __vringh_get_head(vrh, getu16_kern, &vrh->last_avail_idx);
975 if (err < 0)
976 return err;
977
978 /* Empty... */
979 if (err == vrh->vring.num)
980 return 0;
981
982 *head = err;
983 err = __vringh_iov(vrh, *head, riov, wiov, no_range_check, NULL,
984 gfp, copydesc_kern);
985 if (err)
986 return err;
987
988 return 1;
989}
990EXPORT_SYMBOL(vringh_getdesc_kern);
991
992/**
993 * vringh_iov_pull_kern - copy bytes from vring_iov.
994 * @riov: the riov as passed to vringh_getdesc_kern() (updated as we consume)
995 * @dst: the place to copy.
996 * @len: the maximum length to copy.
997 *
998 * Returns the bytes copied <= len or a negative errno.
999 */
1000ssize_t vringh_iov_pull_kern(struct vringh_kiov *riov, void *dst, size_t len)
1001{
9ad9c49c 1002 return vringh_iov_xfer(NULL, riov, dst, len, xfer_kern);
f87d0fbb
RR
1003}
1004EXPORT_SYMBOL(vringh_iov_pull_kern);
1005
1006/**
1007 * vringh_iov_push_kern - copy bytes into vring_iov.
1008 * @wiov: the wiov as passed to vringh_getdesc_kern() (updated as we consume)
8009b0f4 1009 * @src: the place to copy from.
f87d0fbb
RR
1010 * @len: the maximum length to copy.
1011 *
1012 * Returns the bytes copied <= len or a negative errno.
1013 */
1014ssize_t vringh_iov_push_kern(struct vringh_kiov *wiov,
1015 const void *src, size_t len)
1016{
9ad9c49c 1017 return vringh_iov_xfer(NULL, wiov, (void *)src, len, kern_xfer);
f87d0fbb
RR
1018}
1019EXPORT_SYMBOL(vringh_iov_push_kern);
1020
1021/**
1022 * vringh_abandon_kern - we've decided not to handle the descriptor(s).
1023 * @vrh: the vring.
1024 * @num: the number of descriptors to put back (ie. num
1025 * vringh_get_kern() to undo).
1026 *
1027 * The next vringh_get_kern() will return the old descriptor(s) again.
1028 */
1029void vringh_abandon_kern(struct vringh *vrh, unsigned int num)
1030{
1031 /* We only update vring_avail_event(vr) when we want to be notified,
1032 * so we haven't changed that yet. */
1033 vrh->last_avail_idx -= num;
1034}
1035EXPORT_SYMBOL(vringh_abandon_kern);
1036
1037/**
1038 * vringh_complete_kern - we've finished with descriptor, publish it.
1039 * @vrh: the vring.
1040 * @head: the head as filled in by vringh_getdesc_kern.
1041 * @len: the length of data we have written.
1042 *
1043 * You should check vringh_need_notify_kern() after one or more calls
1044 * to this function.
1045 */
1046int vringh_complete_kern(struct vringh *vrh, u16 head, u32 len)
1047{
1048 struct vring_used_elem used;
1049
b9f7ac8c
MT
1050 used.id = cpu_to_vringh32(vrh, head);
1051 used.len = cpu_to_vringh32(vrh, len);
f87d0fbb
RR
1052
1053 return __vringh_complete(vrh, &used, 1, putu16_kern, putused_kern);
1054}
1055EXPORT_SYMBOL(vringh_complete_kern);
1056
1057/**
1058 * vringh_notify_enable_kern - we want to know if something changes.
1059 * @vrh: the vring.
1060 *
1061 * This always enables notifications, but returns false if there are
1062 * now more buffers available in the vring.
1063 */
1064bool vringh_notify_enable_kern(struct vringh *vrh)
1065{
1066 return __vringh_notify_enable(vrh, getu16_kern, putu16_kern);
1067}
1068EXPORT_SYMBOL(vringh_notify_enable_kern);
1069
1070/**
1071 * vringh_notify_disable_kern - don't tell us if something changes.
1072 * @vrh: the vring.
1073 *
1074 * This is our normal running state: we disable and then only enable when
1075 * we're going to sleep.
1076 */
1077void vringh_notify_disable_kern(struct vringh *vrh)
1078{
1079 __vringh_notify_disable(vrh, putu16_kern);
1080}
1081EXPORT_SYMBOL(vringh_notify_disable_kern);
1082
1083/**
1084 * vringh_need_notify_kern - must we tell the other side about used buffers?
1085 * @vrh: the vring we've called vringh_complete_kern() on.
1086 *
1087 * Returns -errno or 0 if we don't need to tell the other side, 1 if we do.
1088 */
1089int vringh_need_notify_kern(struct vringh *vrh)
1090{
1091 return __vringh_need_notify(vrh, getu16_kern);
1092}
1093EXPORT_SYMBOL(vringh_need_notify_kern);
f558a845 1094
3302363a
MT
1095#if IS_REACHABLE(CONFIG_VHOST_IOTLB)
1096
42823a87
SG
1097struct iotlb_vec {
1098 union {
1099 struct iovec *iovec;
1100 struct bio_vec *bvec;
1101 } iov;
1102 size_t count;
1103};
1104
9ad9c49c 1105static int iotlb_translate(const struct vringh *vrh,
309bba39 1106 u64 addr, u64 len, u64 *translated,
42823a87 1107 struct iotlb_vec *ivec, u32 perm)
9ad9c49c
JW
1108{
1109 struct vhost_iotlb_map *map;
1110 struct vhost_iotlb *iotlb = vrh->iotlb;
1111 int ret = 0;
f85efa9b 1112 u64 s = 0, last = addr + len - 1;
9ad9c49c 1113
f53d9910
SG
1114 spin_lock(vrh->iotlb_lock);
1115
9ad9c49c 1116 while (len > s) {
42823a87
SG
1117 uintptr_t io_addr;
1118 size_t io_len;
1119 u64 size;
9ad9c49c 1120
42823a87 1121 if (unlikely(ret >= ivec->count)) {
9ad9c49c
JW
1122 ret = -ENOBUFS;
1123 break;
1124 }
1125
f85efa9b 1126 map = vhost_iotlb_itree_first(iotlb, addr, last);
9ad9c49c
JW
1127 if (!map || map->start > addr) {
1128 ret = -EINVAL;
1129 break;
1130 } else if (!(map->perm & perm)) {
1131 ret = -EPERM;
1132 break;
1133 }
1134
1135 size = map->size - addr + map->start;
42823a87
SG
1136 io_len = min(len - s, size);
1137 io_addr = map->addr - map->start + addr;
1138
1139 if (vrh->use_va) {
1140 struct iovec *iovec = ivec->iov.iovec;
1141
1142 iovec[ret].iov_len = io_len;
1143 iovec[ret].iov_base = (void __user *)io_addr;
1144 } else {
1145 u64 pfn = io_addr >> PAGE_SHIFT;
1146 struct bio_vec *bvec = ivec->iov.bvec;
1147
1148 bvec_set_page(&bvec[ret], pfn_to_page(pfn), io_len,
1149 io_addr & (PAGE_SIZE - 1));
1150 }
1151
9ad9c49c
JW
1152 s += size;
1153 addr += size;
1154 ++ret;
1155 }
1156
f53d9910
SG
1157 spin_unlock(vrh->iotlb_lock);
1158
309bba39
SG
1159 if (translated)
1160 *translated = min(len, s);
1161
9ad9c49c
JW
1162 return ret;
1163}
1164
f609d6cb
SG
1165#define IOTLB_IOV_STRIDE 16
1166
9ad9c49c
JW
1167static inline int copy_from_iotlb(const struct vringh *vrh, void *dst,
1168 void *src, size_t len)
1169{
42823a87
SG
1170 struct iotlb_vec ivec;
1171 union {
1172 struct iovec iovec[IOTLB_IOV_STRIDE];
1173 struct bio_vec bvec[IOTLB_IOV_STRIDE];
1174 } iov;
309bba39
SG
1175 u64 total_translated = 0;
1176
42823a87
SG
1177 ivec.iov.iovec = iov.iovec;
1178 ivec.count = IOTLB_IOV_STRIDE;
1179
309bba39 1180 while (total_translated < len) {
309bba39
SG
1181 struct iov_iter iter;
1182 u64 translated;
1183 int ret;
1184
1185 ret = iotlb_translate(vrh, (u64)(uintptr_t)src,
1186 len - total_translated, &translated,
42823a87 1187 &ivec, VHOST_MAP_RO);
309bba39 1188 if (ret == -ENOBUFS)
42823a87 1189 ret = IOTLB_IOV_STRIDE;
309bba39
SG
1190 else if (ret < 0)
1191 return ret;
1192
42823a87
SG
1193 if (vrh->use_va) {
1194 iov_iter_init(&iter, ITER_SOURCE, ivec.iov.iovec, ret,
1195 translated);
1196 } else {
1197 iov_iter_bvec(&iter, ITER_SOURCE, ivec.iov.bvec, ret,
1198 translated);
1199 }
309bba39
SG
1200
1201 ret = copy_from_iter(dst, translated, &iter);
1202 if (ret < 0)
1203 return ret;
1204
1205 src += translated;
1206 dst += translated;
1207 total_translated += translated;
1208 }
9ad9c49c 1209
309bba39 1210 return total_translated;
9ad9c49c
JW
1211}
1212
1213static inline int copy_to_iotlb(const struct vringh *vrh, void *dst,
1214 void *src, size_t len)
1215{
42823a87
SG
1216 struct iotlb_vec ivec;
1217 union {
1218 struct iovec iovec[IOTLB_IOV_STRIDE];
1219 struct bio_vec bvec[IOTLB_IOV_STRIDE];
1220 } iov;
309bba39
SG
1221 u64 total_translated = 0;
1222
42823a87
SG
1223 ivec.iov.iovec = iov.iovec;
1224 ivec.count = IOTLB_IOV_STRIDE;
1225
309bba39 1226 while (total_translated < len) {
309bba39
SG
1227 struct iov_iter iter;
1228 u64 translated;
1229 int ret;
1230
1231 ret = iotlb_translate(vrh, (u64)(uintptr_t)dst,
1232 len - total_translated, &translated,
42823a87 1233 &ivec, VHOST_MAP_WO);
309bba39 1234 if (ret == -ENOBUFS)
42823a87 1235 ret = IOTLB_IOV_STRIDE;
309bba39
SG
1236 else if (ret < 0)
1237 return ret;
1238
42823a87
SG
1239 if (vrh->use_va) {
1240 iov_iter_init(&iter, ITER_DEST, ivec.iov.iovec, ret,
1241 translated);
1242 } else {
1243 iov_iter_bvec(&iter, ITER_DEST, ivec.iov.bvec, ret,
1244 translated);
1245 }
309bba39
SG
1246
1247 ret = copy_to_iter(src, translated, &iter);
1248 if (ret < 0)
1249 return ret;
1250
1251 src += translated;
1252 dst += translated;
1253 total_translated += translated;
1254 }
9ad9c49c 1255
309bba39 1256 return total_translated;
9ad9c49c
JW
1257}
1258
1259static inline int getu16_iotlb(const struct vringh *vrh,
1260 u16 *val, const __virtio16 *p)
1261{
42823a87
SG
1262 struct iotlb_vec ivec;
1263 union {
1264 struct iovec iovec[1];
1265 struct bio_vec bvec[1];
1266 } iov;
1267 __virtio16 tmp;
9ad9c49c
JW
1268 int ret;
1269
42823a87
SG
1270 ivec.iov.iovec = iov.iovec;
1271 ivec.count = 1;
1272
9ad9c49c 1273 /* Atomic read is needed for getu16 */
42823a87
SG
1274 ret = iotlb_translate(vrh, (u64)(uintptr_t)p, sizeof(*p),
1275 NULL, &ivec, VHOST_MAP_RO);
9ad9c49c
JW
1276 if (ret < 0)
1277 return ret;
1278
42823a87
SG
1279 if (vrh->use_va) {
1280 ret = __get_user(tmp, (__virtio16 __user *)ivec.iov.iovec[0].iov_base);
1281 if (ret)
1282 return ret;
1283 } else {
1284 void *kaddr = kmap_local_page(ivec.iov.bvec[0].bv_page);
1285 void *from = kaddr + ivec.iov.bvec[0].bv_offset;
1286
1287 tmp = READ_ONCE(*(__virtio16 *)from);
1288 kunmap_local(kaddr);
1289 }
1290
1291 *val = vringh16_to_cpu(vrh, tmp);
9ad9c49c
JW
1292
1293 return 0;
1294}
1295
1296static inline int putu16_iotlb(const struct vringh *vrh,
1297 __virtio16 *p, u16 val)
1298{
42823a87
SG
1299 struct iotlb_vec ivec;
1300 union {
1301 struct iovec iovec;
1302 struct bio_vec bvec;
1303 } iov;
1304 __virtio16 tmp;
9ad9c49c
JW
1305 int ret;
1306
42823a87
SG
1307 ivec.iov.iovec = &iov.iovec;
1308 ivec.count = 1;
1309
9ad9c49c 1310 /* Atomic write is needed for putu16 */
42823a87
SG
1311 ret = iotlb_translate(vrh, (u64)(uintptr_t)p, sizeof(*p),
1312 NULL, &ivec, VHOST_MAP_RO);
9ad9c49c
JW
1313 if (ret < 0)
1314 return ret;
1315
42823a87
SG
1316 tmp = cpu_to_vringh16(vrh, val);
1317
1318 if (vrh->use_va) {
1319 ret = __put_user(tmp, (__virtio16 __user *)ivec.iov.iovec[0].iov_base);
1320 if (ret)
1321 return ret;
1322 } else {
1323 void *kaddr = kmap_local_page(ivec.iov.bvec[0].bv_page);
1324 void *to = kaddr + ivec.iov.bvec[0].bv_offset;
1325
1326 WRITE_ONCE(*(__virtio16 *)to, tmp);
1327 kunmap_local(kaddr);
1328 }
9ad9c49c
JW
1329
1330 return 0;
1331}
1332
1333static inline int copydesc_iotlb(const struct vringh *vrh,
1334 void *dst, const void *src, size_t len)
1335{
1336 int ret;
1337
1338 ret = copy_from_iotlb(vrh, dst, (void *)src, len);
1339 if (ret != len)
1340 return -EFAULT;
1341
1342 return 0;
1343}
1344
1345static inline int xfer_from_iotlb(const struct vringh *vrh, void *src,
1346 void *dst, size_t len)
1347{
1348 int ret;
1349
1350 ret = copy_from_iotlb(vrh, dst, src, len);
1351 if (ret != len)
1352 return -EFAULT;
1353
1354 return 0;
1355}
1356
1357static inline int xfer_to_iotlb(const struct vringh *vrh,
1358 void *dst, void *src, size_t len)
1359{
1360 int ret;
1361
1362 ret = copy_to_iotlb(vrh, dst, src, len);
1363 if (ret != len)
1364 return -EFAULT;
1365
1366 return 0;
1367}
1368
1369static inline int putused_iotlb(const struct vringh *vrh,
1370 struct vring_used_elem *dst,
1371 const struct vring_used_elem *src,
1372 unsigned int num)
1373{
1374 int size = num * sizeof(*dst);
1375 int ret;
1376
1377 ret = copy_to_iotlb(vrh, dst, (void *)src, num * sizeof(*dst));
1378 if (ret != size)
1379 return -EFAULT;
1380
1381 return 0;
1382}
1383
1384/**
1385 * vringh_init_iotlb - initialize a vringh for a ring with IOTLB.
1386 * @vrh: the vringh to initialize.
1387 * @features: the feature bits for this ring.
1388 * @num: the number of elements.
1389 * @weak_barriers: true if we only need memory barriers, not I/O.
905233af
SG
1390 * @desc: the userspace descriptor pointer.
1391 * @avail: the userspace avail pointer.
1392 * @used: the userspace used pointer.
9ad9c49c
JW
1393 *
1394 * Returns an error if num is invalid.
1395 */
1396int vringh_init_iotlb(struct vringh *vrh, u64 features,
1397 unsigned int num, bool weak_barriers,
1398 struct vring_desc *desc,
1399 struct vring_avail *avail,
1400 struct vring_used *used)
1401{
42823a87
SG
1402 vrh->use_va = false;
1403
9ad9c49c
JW
1404 return vringh_init_kern(vrh, features, num, weak_barriers,
1405 desc, avail, used);
1406}
1407EXPORT_SYMBOL(vringh_init_iotlb);
1408
42823a87
SG
1409/**
1410 * vringh_init_iotlb_va - initialize a vringh for a ring with IOTLB containing
1411 * user VA.
1412 * @vrh: the vringh to initialize.
1413 * @features: the feature bits for this ring.
1414 * @num: the number of elements.
1415 * @weak_barriers: true if we only need memory barriers, not I/O.
1416 * @desc: the userspace descriptor pointer.
1417 * @avail: the userspace avail pointer.
1418 * @used: the userspace used pointer.
1419 *
1420 * Returns an error if num is invalid.
1421 */
1422int vringh_init_iotlb_va(struct vringh *vrh, u64 features,
1423 unsigned int num, bool weak_barriers,
1424 struct vring_desc *desc,
1425 struct vring_avail *avail,
1426 struct vring_used *used)
1427{
1428 vrh->use_va = true;
1429
1430 return vringh_init_kern(vrh, features, num, weak_barriers,
1431 desc, avail, used);
1432}
1433EXPORT_SYMBOL(vringh_init_iotlb_va);
1434
9ad9c49c
JW
1435/**
1436 * vringh_set_iotlb - initialize a vringh for a ring with IOTLB.
1437 * @vrh: the vring
1438 * @iotlb: iotlb associated with this vring
f53d9910 1439 * @iotlb_lock: spinlock to synchronize the iotlb accesses
9ad9c49c 1440 */
f53d9910
SG
1441void vringh_set_iotlb(struct vringh *vrh, struct vhost_iotlb *iotlb,
1442 spinlock_t *iotlb_lock)
9ad9c49c
JW
1443{
1444 vrh->iotlb = iotlb;
f53d9910 1445 vrh->iotlb_lock = iotlb_lock;
9ad9c49c
JW
1446}
1447EXPORT_SYMBOL(vringh_set_iotlb);
1448
1449/**
1450 * vringh_getdesc_iotlb - get next available descriptor from ring with
1451 * IOTLB.
1452 * @vrh: the kernelspace vring.
1453 * @riov: where to put the readable descriptors (or NULL)
1454 * @wiov: where to put the writable descriptors (or NULL)
1455 * @head: head index we received, for passing to vringh_complete_iotlb().
1456 * @gfp: flags for allocating larger riov/wiov.
1457 *
1458 * Returns 0 if there was no descriptor, 1 if there was, or -errno.
1459 *
1460 * Note that on error return, you can tell the difference between an
1461 * invalid ring and a single invalid descriptor: in the former case,
1462 * *head will be vrh->vring.num. You may be able to ignore an invalid
1463 * descriptor, but there's not much you can do with an invalid ring.
1464 *
69c13c58
SG
1465 * Note that you can reuse riov and wiov with subsequent calls. Content is
1466 * overwritten and memory reallocated if more space is needed.
1467 * When you don't have to use riov and wiov anymore, you should clean up them
1468 * calling vringh_kiov_cleanup() to release the memory, even on error!
9ad9c49c
JW
1469 */
1470int vringh_getdesc_iotlb(struct vringh *vrh,
1471 struct vringh_kiov *riov,
1472 struct vringh_kiov *wiov,
1473 u16 *head,
1474 gfp_t gfp)
1475{
1476 int err;
1477
1478 err = __vringh_get_head(vrh, getu16_iotlb, &vrh->last_avail_idx);
1479 if (err < 0)
1480 return err;
1481
1482 /* Empty... */
1483 if (err == vrh->vring.num)
1484 return 0;
1485
1486 *head = err;
1487 err = __vringh_iov(vrh, *head, riov, wiov, no_range_check, NULL,
1488 gfp, copydesc_iotlb);
1489 if (err)
1490 return err;
1491
1492 return 1;
1493}
1494EXPORT_SYMBOL(vringh_getdesc_iotlb);
1495
1496/**
1497 * vringh_iov_pull_iotlb - copy bytes from vring_iov.
1498 * @vrh: the vring.
1499 * @riov: the riov as passed to vringh_getdesc_iotlb() (updated as we consume)
1500 * @dst: the place to copy.
1501 * @len: the maximum length to copy.
1502 *
1503 * Returns the bytes copied <= len or a negative errno.
1504 */
1505ssize_t vringh_iov_pull_iotlb(struct vringh *vrh,
1506 struct vringh_kiov *riov,
1507 void *dst, size_t len)
1508{
1509 return vringh_iov_xfer(vrh, riov, dst, len, xfer_from_iotlb);
1510}
1511EXPORT_SYMBOL(vringh_iov_pull_iotlb);
1512
1513/**
1514 * vringh_iov_push_iotlb - copy bytes into vring_iov.
1515 * @vrh: the vring.
1516 * @wiov: the wiov as passed to vringh_getdesc_iotlb() (updated as we consume)
8009b0f4 1517 * @src: the place to copy from.
9ad9c49c
JW
1518 * @len: the maximum length to copy.
1519 *
1520 * Returns the bytes copied <= len or a negative errno.
1521 */
1522ssize_t vringh_iov_push_iotlb(struct vringh *vrh,
1523 struct vringh_kiov *wiov,
1524 const void *src, size_t len)
1525{
1526 return vringh_iov_xfer(vrh, wiov, (void *)src, len, xfer_to_iotlb);
1527}
1528EXPORT_SYMBOL(vringh_iov_push_iotlb);
1529
1530/**
1531 * vringh_abandon_iotlb - we've decided not to handle the descriptor(s).
1532 * @vrh: the vring.
1533 * @num: the number of descriptors to put back (ie. num
1534 * vringh_get_iotlb() to undo).
1535 *
1536 * The next vringh_get_iotlb() will return the old descriptor(s) again.
1537 */
1538void vringh_abandon_iotlb(struct vringh *vrh, unsigned int num)
1539{
1540 /* We only update vring_avail_event(vr) when we want to be notified,
1541 * so we haven't changed that yet.
1542 */
1543 vrh->last_avail_idx -= num;
1544}
1545EXPORT_SYMBOL(vringh_abandon_iotlb);
1546
1547/**
1548 * vringh_complete_iotlb - we've finished with descriptor, publish it.
1549 * @vrh: the vring.
1550 * @head: the head as filled in by vringh_getdesc_iotlb.
1551 * @len: the length of data we have written.
1552 *
1553 * You should check vringh_need_notify_iotlb() after one or more calls
1554 * to this function.
1555 */
1556int vringh_complete_iotlb(struct vringh *vrh, u16 head, u32 len)
1557{
1558 struct vring_used_elem used;
1559
1560 used.id = cpu_to_vringh32(vrh, head);
1561 used.len = cpu_to_vringh32(vrh, len);
1562
1563 return __vringh_complete(vrh, &used, 1, putu16_iotlb, putused_iotlb);
1564}
1565EXPORT_SYMBOL(vringh_complete_iotlb);
1566
1567/**
1568 * vringh_notify_enable_iotlb - we want to know if something changes.
1569 * @vrh: the vring.
1570 *
1571 * This always enables notifications, but returns false if there are
1572 * now more buffers available in the vring.
1573 */
1574bool vringh_notify_enable_iotlb(struct vringh *vrh)
1575{
1576 return __vringh_notify_enable(vrh, getu16_iotlb, putu16_iotlb);
1577}
1578EXPORT_SYMBOL(vringh_notify_enable_iotlb);
1579
1580/**
1581 * vringh_notify_disable_iotlb - don't tell us if something changes.
1582 * @vrh: the vring.
1583 *
1584 * This is our normal running state: we disable and then only enable when
1585 * we're going to sleep.
1586 */
1587void vringh_notify_disable_iotlb(struct vringh *vrh)
1588{
1589 __vringh_notify_disable(vrh, putu16_iotlb);
1590}
1591EXPORT_SYMBOL(vringh_notify_disable_iotlb);
1592
1593/**
1594 * vringh_need_notify_iotlb - must we tell the other side about used buffers?
1595 * @vrh: the vring we've called vringh_complete_iotlb() on.
1596 *
1597 * Returns -errno or 0 if we don't need to tell the other side, 1 if we do.
1598 */
1599int vringh_need_notify_iotlb(struct vringh *vrh)
1600{
1601 return __vringh_need_notify(vrh, getu16_iotlb);
1602}
1603EXPORT_SYMBOL(vringh_need_notify_iotlb);
1604
3302363a 1605#endif
9ad9c49c 1606
f558a845 1607MODULE_LICENSE("GPL");