Linux Audio

Check our new training course

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