Linux Audio

Check our new training course

Loading...
v3.1
 
  1/* Copyright (C) 2009 Red Hat, Inc.
  2 * Author: Michael S. Tsirkin <mst@redhat.com>
  3 *
  4 * This work is licensed under the terms of the GNU GPL, version 2.
  5 *
  6 * virtio-net server in host kernel.
  7 */
  8
  9#include <linux/compat.h>
 10#include <linux/eventfd.h>
 11#include <linux/vhost.h>
 12#include <linux/virtio_net.h>
 13#include <linux/miscdevice.h>
 14#include <linux/module.h>
 15#include <linux/moduleparam.h>
 16#include <linux/mutex.h>
 17#include <linux/workqueue.h>
 18#include <linux/rcupdate.h>
 19#include <linux/file.h>
 20#include <linux/slab.h>
 
 
 
 21
 22#include <linux/net.h>
 23#include <linux/if_packet.h>
 24#include <linux/if_arp.h>
 25#include <linux/if_tun.h>
 26#include <linux/if_macvlan.h>
 
 
 
 
 27
 28#include <net/sock.h>
 
 29
 30#include "vhost.h"
 31
 32static int experimental_zcopytx;
 33module_param(experimental_zcopytx, int, 0444);
 34MODULE_PARM_DESC(experimental_zcopytx, "Enable Experimental Zero Copy TX");
 
 35
 36/* Max number of bytes transferred before requeueing the job.
 37 * Using this limit prevents one virtqueue from starving others. */
 38#define VHOST_NET_WEIGHT 0x80000
 39
 
 
 
 
 
 
 40/* MAX number of TX used buffers for outstanding zerocopy */
 41#define VHOST_MAX_PEND 128
 42#define VHOST_GOODCOPY_LEN 256
 43
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 44enum {
 45	VHOST_NET_VQ_RX = 0,
 46	VHOST_NET_VQ_TX = 1,
 47	VHOST_NET_VQ_MAX = 2,
 48};
 49
 50enum vhost_net_poll_state {
 51	VHOST_NET_POLL_DISABLED = 0,
 52	VHOST_NET_POLL_STARTED = 1,
 53	VHOST_NET_POLL_STOPPED = 2,
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 54};
 55
 56struct vhost_net {
 57	struct vhost_dev dev;
 58	struct vhost_virtqueue vqs[VHOST_NET_VQ_MAX];
 59	struct vhost_poll poll[VHOST_NET_VQ_MAX];
 60	/* Tells us whether we are polling a socket for TX.
 61	 * We only do this when socket buffer fills up.
 62	 * Protected by tx vq lock. */
 63	enum vhost_net_poll_state tx_poll_state;
 
 
 
 
 
 
 
 
 
 64};
 65
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 66static bool vhost_sock_zcopy(struct socket *sock)
 67{
 68	return unlikely(experimental_zcopytx) &&
 69		sock_flag(sock->sk, SOCK_ZEROCOPY);
 70}
 71
 72/* Pop first len bytes from iovec. Return number of segments used. */
 73static int move_iovec_hdr(struct iovec *from, struct iovec *to,
 74			  size_t len, int iov_count)
 75{
 76	int seg = 0;
 77	size_t size;
 78
 79	while (len && seg < iov_count) {
 80		size = min(from->iov_len, len);
 81		to->iov_base = from->iov_base;
 82		to->iov_len = size;
 83		from->iov_len -= size;
 84		from->iov_base += size;
 85		len -= size;
 86		++from;
 87		++to;
 88		++seg;
 89	}
 90	return seg;
 91}
 92/* Copy iovec entries for len bytes from iovec. */
 93static void copy_iovec_hdr(const struct iovec *from, struct iovec *to,
 94			   size_t len, int iovcount)
 95{
 96	int seg = 0;
 97	size_t size;
 98
 99	while (len && seg < iovcount) {
100		size = min(from->iov_len, len);
101		to->iov_base = from->iov_base;
102		to->iov_len = size;
103		len -= size;
104		++from;
105		++to;
106		++seg;
 
 
107	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
108}
109
110/* Caller must have TX VQ lock */
111static void tx_poll_stop(struct vhost_net *net)
112{
113	if (likely(net->tx_poll_state != VHOST_NET_POLL_STARTED))
 
 
 
114		return;
115	vhost_poll_stop(net->poll + VHOST_NET_VQ_TX);
116	net->tx_poll_state = VHOST_NET_POLL_STOPPED;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
117}
118
119/* Caller must have TX VQ lock */
120static void tx_poll_start(struct vhost_net *net, struct socket *sock)
121{
122	if (unlikely(net->tx_poll_state != VHOST_NET_POLL_STOPPED))
 
 
 
123		return;
124	vhost_poll_start(net->poll + VHOST_NET_VQ_TX, sock->file);
125	net->tx_poll_state = VHOST_NET_POLL_STARTED;
 
126}
127
128/* Expects to be always run from workqueue - which acts as
129 * read-size critical section for our kind of RCU. */
130static void handle_tx(struct vhost_net *net)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
131{
132	struct vhost_virtqueue *vq = &net->dev.vqs[VHOST_NET_VQ_TX];
133	unsigned out, in, s;
 
134	int head;
135	struct msghdr msg = {
136		.msg_name = NULL,
137		.msg_namelen = 0,
138		.msg_control = NULL,
139		.msg_controllen = 0,
140		.msg_iov = vq->iov,
141		.msg_flags = MSG_DONTWAIT,
142	};
143	size_t len, total_len = 0;
144	int err, wmem;
145	size_t hdr_size;
146	struct socket *sock;
147	struct vhost_ubuf_ref *uninitialized_var(ubufs);
148	bool zcopy;
149
150	/* TODO: check that we are running from vhost_worker? */
151	sock = rcu_dereference_check(vq->private_data, 1);
152	if (!sock)
153		return;
154
155	wmem = atomic_read(&sock->sk->sk_wmem_alloc);
156	if (wmem >= sock->sk->sk_sndbuf) {
157		mutex_lock(&vq->mutex);
158		tx_poll_start(net, sock);
159		mutex_unlock(&vq->mutex);
160		return;
161	}
162
163	mutex_lock(&vq->mutex);
164	vhost_disable_notify(&net->dev, vq);
165
166	if (wmem < sock->sk->sk_sndbuf / 2)
167		tx_poll_stop(net);
168	hdr_size = vq->vhost_hlen;
169	zcopy = vhost_sock_zcopy(sock);
170
171	for (;;) {
172		/* Release DMAs done buffers first */
173		if (zcopy)
174			vhost_zerocopy_signal_used(vq);
175
176		head = vhost_get_vq_desc(&net->dev, vq, vq->iov,
177					 ARRAY_SIZE(vq->iov),
178					 &out, &in,
179					 NULL, NULL);
180		/* On error, stop handling until the next kick. */
181		if (unlikely(head < 0))
182			break;
183		/* Nothing new?  Wait for eventfd to tell us they refilled. */
184		if (head == vq->num) {
185			int num_pends;
 
 
 
 
 
 
 
 
 
 
186
187			wmem = atomic_read(&sock->sk->sk_wmem_alloc);
188			if (wmem >= sock->sk->sk_sndbuf * 3 / 4) {
189				tx_poll_start(net, sock);
190				set_bit(SOCK_ASYNC_NOSPACE, &sock->flags);
 
 
 
 
 
 
 
191				break;
192			}
193			/* If more outstanding DMAs, queue the work.
194			 * Handle upend_idx wrap around
 
 
195			 */
196			num_pends = likely(vq->upend_idx >= vq->done_idx) ?
197				    (vq->upend_idx - vq->done_idx) :
198				    (vq->upend_idx + UIO_MAXIOV - vq->done_idx);
199			if (unlikely(num_pends > VHOST_MAX_PEND)) {
200				tx_poll_start(net, sock);
201				set_bit(SOCK_ASYNC_NOSPACE, &sock->flags);
 
 
 
 
 
 
 
 
202				break;
203			}
204			if (unlikely(vhost_enable_notify(&net->dev, vq))) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
205				vhost_disable_notify(&net->dev, vq);
206				continue;
207			}
208			break;
209		}
210		if (in) {
211			vq_err(vq, "Unexpected descriptor format for TX: "
212			       "out %d, int %d\n", out, in);
213			break;
214		}
215		/* Skip header. TODO: support TSO. */
216		s = move_iovec_hdr(vq->iov, vq->hdr, hdr_size, out);
217		msg.msg_iovlen = out;
218		len = iov_length(vq->iov, out);
219		/* Sanity check */
220		if (!len) {
221			vq_err(vq, "Unexpected header len for TX: "
222			       "%zd expected %zd\n",
223			       iov_length(vq->hdr, s), hdr_size);
224			break;
225		}
226		/* use msg_control to pass vhost zerocopy ubuf info to skb */
227		if (zcopy) {
228			vq->heads[vq->upend_idx].id = head;
229			if (len < VHOST_GOODCOPY_LEN) {
230				/* copy don't need to wait for DMA done */
231				vq->heads[vq->upend_idx].len =
232							VHOST_DMA_DONE_LEN;
233				msg.msg_control = NULL;
234				msg.msg_controllen = 0;
235				ubufs = NULL;
236			} else {
237				struct ubuf_info *ubuf = &vq->ubuf_info[head];
238
239				vq->heads[vq->upend_idx].len = len;
240				ubuf->callback = vhost_zerocopy_callback;
241				ubuf->arg = vq->ubufs;
242				ubuf->desc = vq->upend_idx;
243				msg.msg_control = ubuf;
244				msg.msg_controllen = sizeof(ubuf);
245				ubufs = vq->ubufs;
246				kref_get(&ubufs->kref);
247			}
248			vq->upend_idx = (vq->upend_idx + 1) % UIO_MAXIOV;
 
 
 
 
249		}
250		/* TODO: Check specific error and bomb out unless ENOBUFS? */
251		err = sock->ops->sendmsg(NULL, sock, &msg, len);
252		if (unlikely(err < 0)) {
253			if (zcopy) {
254				if (ubufs)
255					vhost_ubuf_put(ubufs);
256				vq->upend_idx = ((unsigned)vq->upend_idx - 1) %
257					UIO_MAXIOV;
 
 
 
 
 
258			}
259			vhost_discard_vq_desc(vq, 1);
260			tx_poll_start(net, sock);
261			break;
262		}
263		if (err != len)
 
 
264			pr_debug("Truncated TX packet: "
265				 " len %d != %zd\n", err, len);
266		if (!zcopy)
267			vhost_add_used_and_signal(&net->dev, vq, head, 0);
268		total_len += len;
269		if (unlikely(total_len >= VHOST_NET_WEIGHT)) {
270			vhost_poll_queue(&vq->poll);
271			break;
272		}
273	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
274
 
 
 
 
 
 
275	mutex_unlock(&vq->mutex);
276}
277
278static int peek_head_len(struct sock *sk)
279{
280	struct sk_buff *head;
281	int len = 0;
282	unsigned long flags;
283
 
 
 
284	spin_lock_irqsave(&sk->sk_receive_queue.lock, flags);
285	head = skb_peek(&sk->sk_receive_queue);
286	if (likely(head))
287		len = head->len;
 
 
 
 
288	spin_unlock_irqrestore(&sk->sk_receive_queue.lock, flags);
289	return len;
290}
291
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
292/* This is a multi-buffer version of vhost_get_desc, that works if
293 *	vq has read descriptors only.
294 * @vq		- the relevant virtqueue
295 * @datalen	- data length we'll be reading
296 * @iovcount	- returned count of io vectors we fill
297 * @log		- vhost log
298 * @log_num	- log offset
299 * @quota       - headcount quota, 1 for big buffer
300 *	returns number of buffer heads allocated, negative on error
301 */
302static int get_rx_bufs(struct vhost_virtqueue *vq,
303		       struct vring_used_elem *heads,
304		       int datalen,
305		       unsigned *iovcount,
306		       struct vhost_log *log,
307		       unsigned *log_num,
308		       unsigned int quota)
309{
310	unsigned int out, in;
311	int seg = 0;
312	int headcount = 0;
313	unsigned d;
314	int r, nlogs = 0;
 
 
 
 
315
316	while (datalen > 0 && headcount < quota) {
317		if (unlikely(seg >= UIO_MAXIOV)) {
318			r = -ENOBUFS;
319			goto err;
320		}
321		d = vhost_get_vq_desc(vq->dev, vq, vq->iov + seg,
322				      ARRAY_SIZE(vq->iov) - seg, &out,
323				      &in, log, log_num);
 
 
 
 
324		if (d == vq->num) {
325			r = 0;
326			goto err;
327		}
328		if (unlikely(out || in <= 0)) {
329			vq_err(vq, "unexpected descriptor format for RX: "
330				"out %d, in %d\n", out, in);
331			r = -EINVAL;
332			goto err;
333		}
334		if (unlikely(log)) {
335			nlogs += *log_num;
336			log += *log_num;
337		}
338		heads[headcount].id = d;
339		heads[headcount].len = iov_length(vq->iov + seg, in);
340		datalen -= heads[headcount].len;
 
341		++headcount;
342		seg += in;
343	}
344	heads[headcount - 1].len += datalen;
345	*iovcount = seg;
346	if (unlikely(log))
347		*log_num = nlogs;
 
 
 
 
 
 
348	return headcount;
349err:
350	vhost_discard_vq_desc(vq, headcount);
351	return r;
352}
353
354/* Expects to be always run from workqueue - which acts as
355 * read-size critical section for our kind of RCU. */
356static void handle_rx(struct vhost_net *net)
357{
358	struct vhost_virtqueue *vq = &net->dev.vqs[VHOST_NET_VQ_RX];
359	unsigned uninitialized_var(in), log;
 
360	struct vhost_log *vq_log;
361	struct msghdr msg = {
362		.msg_name = NULL,
363		.msg_namelen = 0,
364		.msg_control = NULL, /* FIXME: get and handle RX aux data. */
365		.msg_controllen = 0,
366		.msg_iov = vq->iov,
367		.msg_flags = MSG_DONTWAIT,
368	};
369	struct virtio_net_hdr_mrg_rxbuf hdr = {
370		.hdr.flags = 0,
371		.hdr.gso_type = VIRTIO_NET_HDR_GSO_NONE
372	};
373	size_t total_len = 0;
374	int err, headcount, mergeable;
 
375	size_t vhost_hlen, sock_hlen;
376	size_t vhost_len, sock_len;
377	/* TODO: check that we are running from vhost_worker? */
378	struct socket *sock = rcu_dereference_check(vq->private_data, 1);
 
 
 
379
 
 
380	if (!sock)
381		return;
 
 
 
382
383	mutex_lock(&vq->mutex);
384	vhost_disable_notify(&net->dev, vq);
385	vhost_hlen = vq->vhost_hlen;
386	sock_hlen = vq->sock_hlen;
 
 
387
388	vq_log = unlikely(vhost_has_feature(&net->dev, VHOST_F_LOG_ALL)) ?
389		vq->log : NULL;
390	mergeable = vhost_has_feature(&net->dev, VIRTIO_NET_F_MRG_RXBUF);
391
392	while ((sock_len = peek_head_len(sock->sk))) {
 
 
 
 
393		sock_len += sock_hlen;
394		vhost_len = sock_len + vhost_hlen;
395		headcount = get_rx_bufs(vq, vq->heads, vhost_len,
396					&in, vq_log, &log,
397					likely(mergeable) ? UIO_MAXIOV : 1);
398		/* On error, stop handling until the next kick. */
399		if (unlikely(headcount < 0))
400			break;
401		/* OK, now we need to know about added descriptors. */
402		if (!headcount) {
403			if (unlikely(vhost_enable_notify(&net->dev, vq))) {
 
 
404				/* They have slipped one in as we were
405				 * doing that: check again. */
406				vhost_disable_notify(&net->dev, vq);
407				continue;
408			}
409			/* Nothing new?  Wait for eventfd to tell us
410			 * they refilled. */
411			break;
 
 
 
 
 
 
 
 
 
 
 
412		}
413		/* We don't need to be notified again. */
414		if (unlikely((vhost_hlen)))
415			/* Skip header. TODO: support TSO. */
416			move_iovec_hdr(vq->iov, vq->hdr, vhost_hlen, in);
417		else
418			/* Copy the header for use in VIRTIO_NET_F_MRG_RXBUF:
419			 * needed because recvmsg can modify msg_iov. */
420			copy_iovec_hdr(vq->iov, vq->hdr, sock_hlen, in);
421		msg.msg_iovlen = in;
422		err = sock->ops->recvmsg(NULL, sock, &msg,
423					 sock_len, MSG_DONTWAIT | MSG_TRUNC);
424		/* Userspace might have consumed the packet meanwhile:
425		 * it's not supposed to do this usually, but might be hard
426		 * to prevent. Discard data we got (if any) and keep going. */
427		if (unlikely(err != sock_len)) {
428			pr_debug("Discarded rx packet: "
429				 " len %d, expected %zd\n", err, sock_len);
430			vhost_discard_vq_desc(vq, headcount);
431			continue;
432		}
433		if (unlikely(vhost_hlen) &&
434		    memcpy_toiovecend(vq->hdr, (unsigned char *)&hdr, 0,
435				      vhost_hlen)) {
436			vq_err(vq, "Unable to write vnet_hdr at addr %p\n",
437			       vq->iov->iov_base);
438			break;
 
 
 
 
 
 
 
439		}
440		/* TODO: Should check and handle checksum. */
 
 
441		if (likely(mergeable) &&
442		    memcpy_toiovecend(vq->hdr, (unsigned char *)&headcount,
443				      offsetof(typeof(hdr), num_buffers),
444				      sizeof hdr.num_buffers)) {
445			vq_err(vq, "Failed num_buffers write");
446			vhost_discard_vq_desc(vq, headcount);
447			break;
448		}
449		vhost_add_used_and_signal_n(&net->dev, vq, vq->heads,
450					    headcount);
 
451		if (unlikely(vq_log))
452			vhost_log_write(vq, vq_log, log, vhost_len);
 
453		total_len += vhost_len;
454		if (unlikely(total_len >= VHOST_NET_WEIGHT)) {
455			vhost_poll_queue(&vq->poll);
456			break;
457		}
458	}
459
 
 
 
 
 
 
460	mutex_unlock(&vq->mutex);
461}
462
463static void handle_tx_kick(struct vhost_work *work)
464{
465	struct vhost_virtqueue *vq = container_of(work, struct vhost_virtqueue,
466						  poll.work);
467	struct vhost_net *net = container_of(vq->dev, struct vhost_net, dev);
468
469	handle_tx(net);
470}
471
472static void handle_rx_kick(struct vhost_work *work)
473{
474	struct vhost_virtqueue *vq = container_of(work, struct vhost_virtqueue,
475						  poll.work);
476	struct vhost_net *net = container_of(vq->dev, struct vhost_net, dev);
477
478	handle_rx(net);
479}
480
481static void handle_tx_net(struct vhost_work *work)
482{
483	struct vhost_net *net = container_of(work, struct vhost_net,
484					     poll[VHOST_NET_VQ_TX].work);
485	handle_tx(net);
486}
487
488static void handle_rx_net(struct vhost_work *work)
489{
490	struct vhost_net *net = container_of(work, struct vhost_net,
491					     poll[VHOST_NET_VQ_RX].work);
492	handle_rx(net);
493}
494
495static int vhost_net_open(struct inode *inode, struct file *f)
496{
497	struct vhost_net *n = kmalloc(sizeof *n, GFP_KERNEL);
498	struct vhost_dev *dev;
499	int r;
 
 
 
500
 
501	if (!n)
502		return -ENOMEM;
 
 
 
 
 
503
504	dev = &n->dev;
505	n->vqs[VHOST_NET_VQ_TX].handle_kick = handle_tx_kick;
506	n->vqs[VHOST_NET_VQ_RX].handle_kick = handle_rx_kick;
507	r = vhost_dev_init(dev, n->vqs, VHOST_NET_VQ_MAX);
508	if (r < 0) {
509		kfree(n);
510		return r;
511	}
 
512
513	vhost_poll_init(n->poll + VHOST_NET_VQ_TX, handle_tx_net, POLLOUT, dev);
514	vhost_poll_init(n->poll + VHOST_NET_VQ_RX, handle_rx_net, POLLIN, dev);
515	n->tx_poll_state = VHOST_NET_POLL_DISABLED;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
516
517	f->private_data = n;
 
 
518
519	return 0;
520}
521
522static void vhost_net_disable_vq(struct vhost_net *n,
523				 struct vhost_virtqueue *vq)
524{
525	if (!vq->private_data)
526		return;
527	if (vq == n->vqs + VHOST_NET_VQ_TX) {
528		tx_poll_stop(n);
529		n->tx_poll_state = VHOST_NET_POLL_DISABLED;
530	} else
531		vhost_poll_stop(n->poll + VHOST_NET_VQ_RX);
532}
533
534static void vhost_net_enable_vq(struct vhost_net *n,
535				struct vhost_virtqueue *vq)
536{
537	struct socket *sock;
538
539	sock = rcu_dereference_protected(vq->private_data,
540					 lockdep_is_held(&vq->mutex));
541	if (!sock)
542		return;
543	if (vq == n->vqs + VHOST_NET_VQ_TX) {
544		n->tx_poll_state = VHOST_NET_POLL_STOPPED;
545		tx_poll_start(n, sock);
546	} else
547		vhost_poll_start(n->poll + VHOST_NET_VQ_RX, sock->file);
548}
549
550static struct socket *vhost_net_stop_vq(struct vhost_net *n,
551					struct vhost_virtqueue *vq)
552{
553	struct socket *sock;
 
 
554
555	mutex_lock(&vq->mutex);
556	sock = rcu_dereference_protected(vq->private_data,
557					 lockdep_is_held(&vq->mutex));
558	vhost_net_disable_vq(n, vq);
559	rcu_assign_pointer(vq->private_data, NULL);
 
 
560	mutex_unlock(&vq->mutex);
561	return sock;
562}
563
564static void vhost_net_stop(struct vhost_net *n, struct socket **tx_sock,
565			   struct socket **rx_sock)
566{
567	*tx_sock = vhost_net_stop_vq(n, n->vqs + VHOST_NET_VQ_TX);
568	*rx_sock = vhost_net_stop_vq(n, n->vqs + VHOST_NET_VQ_RX);
569}
570
571static void vhost_net_flush_vq(struct vhost_net *n, int index)
572{
573	vhost_poll_flush(n->poll + index);
574	vhost_poll_flush(&n->dev.vqs[index].poll);
575}
576
577static void vhost_net_flush(struct vhost_net *n)
578{
579	vhost_net_flush_vq(n, VHOST_NET_VQ_TX);
580	vhost_net_flush_vq(n, VHOST_NET_VQ_RX);
 
 
 
 
 
 
 
 
 
 
581}
582
583static int vhost_net_release(struct inode *inode, struct file *f)
584{
585	struct vhost_net *n = f->private_data;
586	struct socket *tx_sock;
587	struct socket *rx_sock;
588
589	vhost_net_stop(n, &tx_sock, &rx_sock);
590	vhost_net_flush(n);
 
591	vhost_dev_cleanup(&n->dev);
 
592	if (tx_sock)
593		fput(tx_sock->file);
594	if (rx_sock)
595		fput(rx_sock->file);
 
 
596	/* We do an extra flush before freeing memory,
597	 * since jobs can re-queue themselves. */
598	vhost_net_flush(n);
599	kfree(n);
 
 
 
 
 
600	return 0;
601}
602
603static struct socket *get_raw_socket(int fd)
604{
605	struct {
606		struct sockaddr_ll sa;
607		char  buf[MAX_ADDR_LEN];
608	} uaddr;
609	int uaddr_len = sizeof uaddr, r;
610	struct socket *sock = sockfd_lookup(fd, &r);
611
612	if (!sock)
613		return ERR_PTR(-ENOTSOCK);
614
615	/* Parameter checking */
616	if (sock->sk->sk_type != SOCK_RAW) {
617		r = -ESOCKTNOSUPPORT;
618		goto err;
619	}
620
621	r = sock->ops->getname(sock, (struct sockaddr *)&uaddr.sa,
622			       &uaddr_len, 0);
623	if (r)
624		goto err;
625
626	if (uaddr.sa.sll_family != AF_PACKET) {
627		r = -EPFNOSUPPORT;
628		goto err;
629	}
630	return sock;
631err:
632	fput(sock->file);
633	return ERR_PTR(r);
634}
635
 
 
 
 
 
 
 
 
 
 
 
 
 
 
636static struct socket *get_tap_socket(int fd)
637{
638	struct file *file = fget(fd);
639	struct socket *sock;
640
641	if (!file)
642		return ERR_PTR(-EBADF);
643	sock = tun_get_socket(file);
644	if (!IS_ERR(sock))
645		return sock;
646	sock = macvtap_get_socket(file);
647	if (IS_ERR(sock))
648		fput(file);
649	return sock;
650}
651
652static struct socket *get_socket(int fd)
653{
654	struct socket *sock;
655
656	/* special case to disable backend */
657	if (fd == -1)
658		return NULL;
659	sock = get_raw_socket(fd);
660	if (!IS_ERR(sock))
661		return sock;
662	sock = get_tap_socket(fd);
663	if (!IS_ERR(sock))
664		return sock;
665	return ERR_PTR(-ENOTSOCK);
666}
667
668static long vhost_net_set_backend(struct vhost_net *n, unsigned index, int fd)
669{
670	struct socket *sock, *oldsock;
671	struct vhost_virtqueue *vq;
672	struct vhost_ubuf_ref *ubufs, *oldubufs = NULL;
 
673	int r;
674
675	mutex_lock(&n->dev.mutex);
676	r = vhost_dev_check_owner(&n->dev);
677	if (r)
678		goto err;
679
680	if (index >= VHOST_NET_VQ_MAX) {
681		r = -ENOBUFS;
682		goto err;
683	}
684	vq = n->vqs + index;
 
685	mutex_lock(&vq->mutex);
686
 
 
 
687	/* Verify that ring has been setup correctly. */
688	if (!vhost_vq_access_ok(vq)) {
689		r = -EFAULT;
690		goto err_vq;
691	}
692	sock = get_socket(fd);
693	if (IS_ERR(sock)) {
694		r = PTR_ERR(sock);
695		goto err_vq;
696	}
697
698	/* start polling new socket */
699	oldsock = rcu_dereference_protected(vq->private_data,
700					    lockdep_is_held(&vq->mutex));
701	if (sock != oldsock) {
702		ubufs = vhost_ubuf_alloc(vq, sock && vhost_sock_zcopy(sock));
 
703		if (IS_ERR(ubufs)) {
704			r = PTR_ERR(ubufs);
705			goto err_ubufs;
706		}
707		oldubufs = vq->ubufs;
708		vq->ubufs = ubufs;
709		vhost_net_disable_vq(n, vq);
710		rcu_assign_pointer(vq->private_data, sock);
711		vhost_net_enable_vq(n, vq);
712
713		r = vhost_init_used(vq);
 
 
 
 
 
 
714		if (r)
715			goto err_vq;
 
 
 
 
 
 
 
 
 
 
 
 
 
716	}
717
718	mutex_unlock(&vq->mutex);
719
720	if (oldubufs) {
721		vhost_ubuf_put_and_wait(oldubufs);
722		mutex_lock(&vq->mutex);
723		vhost_zerocopy_signal_used(vq);
724		mutex_unlock(&vq->mutex);
725	}
726
727	if (oldsock) {
728		vhost_net_flush_vq(n, index);
729		fput(oldsock->file);
730	}
731
732	mutex_unlock(&n->dev.mutex);
733	return 0;
734
 
 
 
 
 
735err_ubufs:
736	fput(sock->file);
 
737err_vq:
738	mutex_unlock(&vq->mutex);
739err:
740	mutex_unlock(&n->dev.mutex);
741	return r;
742}
743
744static long vhost_net_reset_owner(struct vhost_net *n)
745{
746	struct socket *tx_sock = NULL;
747	struct socket *rx_sock = NULL;
748	long err;
 
749
750	mutex_lock(&n->dev.mutex);
751	err = vhost_dev_check_owner(&n->dev);
752	if (err)
753		goto done;
 
 
 
 
 
754	vhost_net_stop(n, &tx_sock, &rx_sock);
755	vhost_net_flush(n);
756	err = vhost_dev_reset_owner(&n->dev);
 
 
757done:
758	mutex_unlock(&n->dev.mutex);
759	if (tx_sock)
760		fput(tx_sock->file);
761	if (rx_sock)
762		fput(rx_sock->file);
763	return err;
764}
765
766static int vhost_net_set_features(struct vhost_net *n, u64 features)
767{
768	size_t vhost_hlen, sock_hlen, hdr_len;
769	int i;
770
771	hdr_len = (features & (1 << VIRTIO_NET_F_MRG_RXBUF)) ?
 
772			sizeof(struct virtio_net_hdr_mrg_rxbuf) :
773			sizeof(struct virtio_net_hdr);
774	if (features & (1 << VHOST_NET_F_VIRTIO_NET_HDR)) {
775		/* vhost provides vnet_hdr */
776		vhost_hlen = hdr_len;
777		sock_hlen = 0;
778	} else {
779		/* socket provides vnet_hdr */
780		vhost_hlen = 0;
781		sock_hlen = hdr_len;
782	}
783	mutex_lock(&n->dev.mutex);
784	if ((features & (1 << VHOST_F_LOG_ALL)) &&
785	    !vhost_log_access_ok(&n->dev)) {
786		mutex_unlock(&n->dev.mutex);
787		return -EFAULT;
 
 
 
788	}
789	n->dev.acked_features = features;
790	smp_wmb();
791	for (i = 0; i < VHOST_NET_VQ_MAX; ++i) {
792		mutex_lock(&n->vqs[i].mutex);
 
793		n->vqs[i].vhost_hlen = vhost_hlen;
794		n->vqs[i].sock_hlen = sock_hlen;
795		mutex_unlock(&n->vqs[i].mutex);
796	}
797	vhost_net_flush(n);
798	mutex_unlock(&n->dev.mutex);
799	return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
800}
801
802static long vhost_net_ioctl(struct file *f, unsigned int ioctl,
803			    unsigned long arg)
804{
805	struct vhost_net *n = f->private_data;
806	void __user *argp = (void __user *)arg;
807	u64 __user *featurep = argp;
808	struct vhost_vring_file backend;
809	u64 features;
810	int r;
811
812	switch (ioctl) {
813	case VHOST_NET_SET_BACKEND:
814		if (copy_from_user(&backend, argp, sizeof backend))
815			return -EFAULT;
816		return vhost_net_set_backend(n, backend.index, backend.fd);
817	case VHOST_GET_FEATURES:
818		features = VHOST_FEATURES;
819		if (copy_to_user(featurep, &features, sizeof features))
820			return -EFAULT;
821		return 0;
822	case VHOST_SET_FEATURES:
823		if (copy_from_user(&features, featurep, sizeof features))
824			return -EFAULT;
825		if (features & ~VHOST_FEATURES)
826			return -EOPNOTSUPP;
827		return vhost_net_set_features(n, features);
 
 
 
 
 
 
 
 
 
 
 
 
828	case VHOST_RESET_OWNER:
829		return vhost_net_reset_owner(n);
 
 
830	default:
831		mutex_lock(&n->dev.mutex);
832		r = vhost_dev_ioctl(&n->dev, ioctl, arg);
833		vhost_net_flush(n);
 
 
 
834		mutex_unlock(&n->dev.mutex);
835		return r;
836	}
837}
838
839#ifdef CONFIG_COMPAT
840static long vhost_net_compat_ioctl(struct file *f, unsigned int ioctl,
841				   unsigned long arg)
842{
843	return vhost_net_ioctl(f, ioctl, (unsigned long)compat_ptr(arg));
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
844}
845#endif
846
847static const struct file_operations vhost_net_fops = {
848	.owner          = THIS_MODULE,
849	.release        = vhost_net_release,
 
 
 
850	.unlocked_ioctl = vhost_net_ioctl,
851#ifdef CONFIG_COMPAT
852	.compat_ioctl   = vhost_net_compat_ioctl,
853#endif
854	.open           = vhost_net_open,
855	.llseek		= noop_llseek,
856};
857
858static struct miscdevice vhost_net_misc = {
859	MISC_DYNAMIC_MINOR,
860	"vhost-net",
861	&vhost_net_fops,
862};
863
864static int vhost_net_init(void)
865{
866	if (experimental_zcopytx)
867		vhost_enable_zcopy(VHOST_NET_VQ_TX);
868	return misc_register(&vhost_net_misc);
869}
870module_init(vhost_net_init);
871
872static void vhost_net_exit(void)
873{
874	misc_deregister(&vhost_net_misc);
875}
876module_exit(vhost_net_exit);
877
878MODULE_VERSION("0.0.1");
879MODULE_LICENSE("GPL v2");
880MODULE_AUTHOR("Michael S. Tsirkin");
881MODULE_DESCRIPTION("Host kernel accelerator for virtio net");
v6.8
   1// SPDX-License-Identifier: GPL-2.0-only
   2/* Copyright (C) 2009 Red Hat, Inc.
   3 * Author: Michael S. Tsirkin <mst@redhat.com>
   4 *
 
 
   5 * virtio-net server in host kernel.
   6 */
   7
   8#include <linux/compat.h>
   9#include <linux/eventfd.h>
  10#include <linux/vhost.h>
  11#include <linux/virtio_net.h>
  12#include <linux/miscdevice.h>
  13#include <linux/module.h>
  14#include <linux/moduleparam.h>
  15#include <linux/mutex.h>
  16#include <linux/workqueue.h>
 
  17#include <linux/file.h>
  18#include <linux/slab.h>
  19#include <linux/sched/clock.h>
  20#include <linux/sched/signal.h>
  21#include <linux/vmalloc.h>
  22
  23#include <linux/net.h>
  24#include <linux/if_packet.h>
  25#include <linux/if_arp.h>
  26#include <linux/if_tun.h>
  27#include <linux/if_macvlan.h>
  28#include <linux/if_tap.h>
  29#include <linux/if_vlan.h>
  30#include <linux/skb_array.h>
  31#include <linux/skbuff.h>
  32
  33#include <net/sock.h>
  34#include <net/xdp.h>
  35
  36#include "vhost.h"
  37
  38static int experimental_zcopytx = 0;
  39module_param(experimental_zcopytx, int, 0444);
  40MODULE_PARM_DESC(experimental_zcopytx, "Enable Zero Copy TX;"
  41		                       " 1 -Enable; 0 - Disable");
  42
  43/* Max number of bytes transferred before requeueing the job.
  44 * Using this limit prevents one virtqueue from starving others. */
  45#define VHOST_NET_WEIGHT 0x80000
  46
  47/* Max number of packets transferred before requeueing the job.
  48 * Using this limit prevents one virtqueue from starving others with small
  49 * pkts.
  50 */
  51#define VHOST_NET_PKT_WEIGHT 256
  52
  53/* MAX number of TX used buffers for outstanding zerocopy */
  54#define VHOST_MAX_PEND 128
  55#define VHOST_GOODCOPY_LEN 256
  56
  57/*
  58 * For transmit, used buffer len is unused; we override it to track buffer
  59 * status internally; used for zerocopy tx only.
  60 */
  61/* Lower device DMA failed */
  62#define VHOST_DMA_FAILED_LEN	((__force __virtio32)3)
  63/* Lower device DMA done */
  64#define VHOST_DMA_DONE_LEN	((__force __virtio32)2)
  65/* Lower device DMA in progress */
  66#define VHOST_DMA_IN_PROGRESS	((__force __virtio32)1)
  67/* Buffer unused */
  68#define VHOST_DMA_CLEAR_LEN	((__force __virtio32)0)
  69
  70#define VHOST_DMA_IS_DONE(len) ((__force u32)(len) >= (__force u32)VHOST_DMA_DONE_LEN)
  71
  72enum {
  73	VHOST_NET_FEATURES = VHOST_FEATURES |
  74			 (1ULL << VHOST_NET_F_VIRTIO_NET_HDR) |
  75			 (1ULL << VIRTIO_NET_F_MRG_RXBUF) |
  76			 (1ULL << VIRTIO_F_ACCESS_PLATFORM) |
  77			 (1ULL << VIRTIO_F_RING_RESET)
  78};
  79
  80enum {
  81	VHOST_NET_BACKEND_FEATURES = (1ULL << VHOST_BACKEND_F_IOTLB_MSG_V2)
  82};
  83
  84enum {
  85	VHOST_NET_VQ_RX = 0,
  86	VHOST_NET_VQ_TX = 1,
  87	VHOST_NET_VQ_MAX = 2,
  88};
  89
  90struct vhost_net_ubuf_ref {
  91	/* refcount follows semantics similar to kref:
  92	 *  0: object is released
  93	 *  1: no outstanding ubufs
  94	 * >1: outstanding ubufs
  95	 */
  96	atomic_t refcount;
  97	wait_queue_head_t wait;
  98	struct vhost_virtqueue *vq;
  99};
 100
 101#define VHOST_NET_BATCH 64
 102struct vhost_net_buf {
 103	void **queue;
 104	int tail;
 105	int head;
 106};
 107
 108struct vhost_net_virtqueue {
 109	struct vhost_virtqueue vq;
 110	size_t vhost_hlen;
 111	size_t sock_hlen;
 112	/* vhost zerocopy support fields below: */
 113	/* last used idx for outstanding DMA zerocopy buffers */
 114	int upend_idx;
 115	/* For TX, first used idx for DMA done zerocopy buffers
 116	 * For RX, number of batched heads
 117	 */
 118	int done_idx;
 119	/* Number of XDP frames batched */
 120	int batched_xdp;
 121	/* an array of userspace buffers info */
 122	struct ubuf_info_msgzc *ubuf_info;
 123	/* Reference counting for outstanding ubufs.
 124	 * Protected by vq mutex. Writers must also take device mutex. */
 125	struct vhost_net_ubuf_ref *ubufs;
 126	struct ptr_ring *rx_ring;
 127	struct vhost_net_buf rxq;
 128	/* Batched XDP buffs */
 129	struct xdp_buff *xdp;
 130};
 131
 132struct vhost_net {
 133	struct vhost_dev dev;
 134	struct vhost_net_virtqueue vqs[VHOST_NET_VQ_MAX];
 135	struct vhost_poll poll[VHOST_NET_VQ_MAX];
 136	/* Number of TX recently submitted.
 
 137	 * Protected by tx vq lock. */
 138	unsigned tx_packets;
 139	/* Number of times zerocopy TX recently failed.
 140	 * Protected by tx vq lock. */
 141	unsigned tx_zcopy_err;
 142	/* Flush in progress. Protected by tx vq lock. */
 143	bool tx_flush;
 144	/* Private page frag */
 145	struct page_frag page_frag;
 146	/* Refcount bias of page frag */
 147	int refcnt_bias;
 148};
 149
 150static unsigned vhost_net_zcopy_mask __read_mostly;
 151
 152static void *vhost_net_buf_get_ptr(struct vhost_net_buf *rxq)
 153{
 154	if (rxq->tail != rxq->head)
 155		return rxq->queue[rxq->head];
 156	else
 157		return NULL;
 158}
 159
 160static int vhost_net_buf_get_size(struct vhost_net_buf *rxq)
 161{
 162	return rxq->tail - rxq->head;
 163}
 164
 165static int vhost_net_buf_is_empty(struct vhost_net_buf *rxq)
 166{
 167	return rxq->tail == rxq->head;
 168}
 169
 170static void *vhost_net_buf_consume(struct vhost_net_buf *rxq)
 171{
 172	void *ret = vhost_net_buf_get_ptr(rxq);
 173	++rxq->head;
 174	return ret;
 175}
 176
 177static int vhost_net_buf_produce(struct vhost_net_virtqueue *nvq)
 178{
 179	struct vhost_net_buf *rxq = &nvq->rxq;
 180
 181	rxq->head = 0;
 182	rxq->tail = ptr_ring_consume_batched(nvq->rx_ring, rxq->queue,
 183					      VHOST_NET_BATCH);
 184	return rxq->tail;
 185}
 186
 187static void vhost_net_buf_unproduce(struct vhost_net_virtqueue *nvq)
 188{
 189	struct vhost_net_buf *rxq = &nvq->rxq;
 190
 191	if (nvq->rx_ring && !vhost_net_buf_is_empty(rxq)) {
 192		ptr_ring_unconsume(nvq->rx_ring, rxq->queue + rxq->head,
 193				   vhost_net_buf_get_size(rxq),
 194				   tun_ptr_free);
 195		rxq->head = rxq->tail = 0;
 196	}
 197}
 198
 199static int vhost_net_buf_peek_len(void *ptr)
 200{
 201	if (tun_is_xdp_frame(ptr)) {
 202		struct xdp_frame *xdpf = tun_ptr_to_xdp(ptr);
 203
 204		return xdpf->len;
 205	}
 206
 207	return __skb_array_len_with_tag(ptr);
 208}
 209
 210static int vhost_net_buf_peek(struct vhost_net_virtqueue *nvq)
 211{
 212	struct vhost_net_buf *rxq = &nvq->rxq;
 213
 214	if (!vhost_net_buf_is_empty(rxq))
 215		goto out;
 216
 217	if (!vhost_net_buf_produce(nvq))
 218		return 0;
 219
 220out:
 221	return vhost_net_buf_peek_len(vhost_net_buf_get_ptr(rxq));
 222}
 223
 224static void vhost_net_buf_init(struct vhost_net_buf *rxq)
 225{
 226	rxq->head = rxq->tail = 0;
 227}
 228
 229static void vhost_net_enable_zcopy(int vq)
 230{
 231	vhost_net_zcopy_mask |= 0x1 << vq;
 232}
 233
 234static struct vhost_net_ubuf_ref *
 235vhost_net_ubuf_alloc(struct vhost_virtqueue *vq, bool zcopy)
 236{
 237	struct vhost_net_ubuf_ref *ubufs;
 238	/* No zero copy backend? Nothing to count. */
 239	if (!zcopy)
 240		return NULL;
 241	ubufs = kmalloc(sizeof(*ubufs), GFP_KERNEL);
 242	if (!ubufs)
 243		return ERR_PTR(-ENOMEM);
 244	atomic_set(&ubufs->refcount, 1);
 245	init_waitqueue_head(&ubufs->wait);
 246	ubufs->vq = vq;
 247	return ubufs;
 248}
 249
 250static int vhost_net_ubuf_put(struct vhost_net_ubuf_ref *ubufs)
 251{
 252	int r = atomic_sub_return(1, &ubufs->refcount);
 253	if (unlikely(!r))
 254		wake_up(&ubufs->wait);
 255	return r;
 256}
 257
 258static void vhost_net_ubuf_put_and_wait(struct vhost_net_ubuf_ref *ubufs)
 259{
 260	vhost_net_ubuf_put(ubufs);
 261	wait_event(ubufs->wait, !atomic_read(&ubufs->refcount));
 262}
 263
 264static void vhost_net_ubuf_put_wait_and_free(struct vhost_net_ubuf_ref *ubufs)
 265{
 266	vhost_net_ubuf_put_and_wait(ubufs);
 267	kfree(ubufs);
 268}
 269
 270static void vhost_net_clear_ubuf_info(struct vhost_net *n)
 271{
 272	int i;
 273
 274	for (i = 0; i < VHOST_NET_VQ_MAX; ++i) {
 275		kfree(n->vqs[i].ubuf_info);
 276		n->vqs[i].ubuf_info = NULL;
 277	}
 278}
 279
 280static int vhost_net_set_ubuf_info(struct vhost_net *n)
 281{
 282	bool zcopy;
 283	int i;
 284
 285	for (i = 0; i < VHOST_NET_VQ_MAX; ++i) {
 286		zcopy = vhost_net_zcopy_mask & (0x1 << i);
 287		if (!zcopy)
 288			continue;
 289		n->vqs[i].ubuf_info =
 290			kmalloc_array(UIO_MAXIOV,
 291				      sizeof(*n->vqs[i].ubuf_info),
 292				      GFP_KERNEL);
 293		if  (!n->vqs[i].ubuf_info)
 294			goto err;
 295	}
 296	return 0;
 297
 298err:
 299	vhost_net_clear_ubuf_info(n);
 300	return -ENOMEM;
 301}
 302
 303static void vhost_net_vq_reset(struct vhost_net *n)
 304{
 305	int i;
 306
 307	vhost_net_clear_ubuf_info(n);
 308
 309	for (i = 0; i < VHOST_NET_VQ_MAX; i++) {
 310		n->vqs[i].done_idx = 0;
 311		n->vqs[i].upend_idx = 0;
 312		n->vqs[i].ubufs = NULL;
 313		n->vqs[i].vhost_hlen = 0;
 314		n->vqs[i].sock_hlen = 0;
 315		vhost_net_buf_init(&n->vqs[i].rxq);
 316	}
 317
 318}
 319
 320static void vhost_net_tx_packet(struct vhost_net *net)
 321{
 322	++net->tx_packets;
 323	if (net->tx_packets < 1024)
 324		return;
 325	net->tx_packets = 0;
 326	net->tx_zcopy_err = 0;
 327}
 328
 329static void vhost_net_tx_err(struct vhost_net *net)
 330{
 331	++net->tx_zcopy_err;
 332}
 333
 334static bool vhost_net_tx_select_zcopy(struct vhost_net *net)
 335{
 336	/* TX flush waits for outstanding DMAs to be done.
 337	 * Don't start new DMAs.
 338	 */
 339	return !net->tx_flush &&
 340		net->tx_packets / 64 >= net->tx_zcopy_err;
 341}
 342
 343static bool vhost_sock_zcopy(struct socket *sock)
 344{
 345	return unlikely(experimental_zcopytx) &&
 346		sock_flag(sock->sk, SOCK_ZEROCOPY);
 347}
 348
 349static bool vhost_sock_xdp(struct socket *sock)
 
 
 350{
 351	return sock_flag(sock->sk, SOCK_XDP);
 352}
 353
 354/* In case of DMA done not in order in lower device driver for some reason.
 355 * upend_idx is used to track end of used idx, done_idx is used to track head
 356 * of used idx. Once lower device DMA done contiguously, we will signal KVM
 357 * guest used idx.
 358 */
 359static void vhost_zerocopy_signal_used(struct vhost_net *net,
 360				       struct vhost_virtqueue *vq)
 
 
 
 
 
 
 
 
 
 361{
 362	struct vhost_net_virtqueue *nvq =
 363		container_of(vq, struct vhost_net_virtqueue, vq);
 364	int i, add;
 365	int j = 0;
 366
 367	for (i = nvq->done_idx; i != nvq->upend_idx; i = (i + 1) % UIO_MAXIOV) {
 368		if (vq->heads[i].len == VHOST_DMA_FAILED_LEN)
 369			vhost_net_tx_err(net);
 370		if (VHOST_DMA_IS_DONE(vq->heads[i].len)) {
 371			vq->heads[i].len = VHOST_DMA_CLEAR_LEN;
 372			++j;
 373		} else
 374			break;
 375	}
 376	while (j) {
 377		add = min(UIO_MAXIOV - nvq->done_idx, j);
 378		vhost_add_used_and_signal_n(vq->dev, vq,
 379					    &vq->heads[nvq->done_idx], add);
 380		nvq->done_idx = (nvq->done_idx + add) % UIO_MAXIOV;
 381		j -= add;
 382	}
 383}
 384
 385static void vhost_zerocopy_callback(struct sk_buff *skb,
 386				    struct ubuf_info *ubuf_base, bool success)
 387{
 388	struct ubuf_info_msgzc *ubuf = uarg_to_msgzc(ubuf_base);
 389	struct vhost_net_ubuf_ref *ubufs = ubuf->ctx;
 390	struct vhost_virtqueue *vq = ubufs->vq;
 391	int cnt;
 392
 393	rcu_read_lock_bh();
 394
 395	/* set len to mark this desc buffers done DMA */
 396	vq->heads[ubuf->desc].len = success ?
 397		VHOST_DMA_DONE_LEN : VHOST_DMA_FAILED_LEN;
 398	cnt = vhost_net_ubuf_put(ubufs);
 399
 400	/*
 401	 * Trigger polling thread if guest stopped submitting new buffers:
 402	 * in this case, the refcount after decrement will eventually reach 1.
 403	 * We also trigger polling periodically after each 16 packets
 404	 * (the value 16 here is more or less arbitrary, it's tuned to trigger
 405	 * less than 10% of times).
 406	 */
 407	if (cnt <= 1 || !(cnt % 16))
 408		vhost_poll_queue(&vq->poll);
 409
 410	rcu_read_unlock_bh();
 411}
 412
 413static inline unsigned long busy_clock(void)
 414{
 415	return local_clock() >> 10;
 416}
 417
 418static bool vhost_can_busy_poll(unsigned long endtime)
 419{
 420	return likely(!need_resched() && !time_after(busy_clock(), endtime) &&
 421		      !signal_pending(current));
 422}
 423
 424static void vhost_net_disable_vq(struct vhost_net *n,
 425				 struct vhost_virtqueue *vq)
 426{
 427	struct vhost_net_virtqueue *nvq =
 428		container_of(vq, struct vhost_net_virtqueue, vq);
 429	struct vhost_poll *poll = n->poll + (nvq - n->vqs);
 430	if (!vhost_vq_get_backend(vq))
 431		return;
 432	vhost_poll_stop(poll);
 433}
 434
 435static int vhost_net_enable_vq(struct vhost_net *n,
 436				struct vhost_virtqueue *vq)
 437{
 438	struct vhost_net_virtqueue *nvq =
 439		container_of(vq, struct vhost_net_virtqueue, vq);
 440	struct vhost_poll *poll = n->poll + (nvq - n->vqs);
 441	struct socket *sock;
 442
 443	sock = vhost_vq_get_backend(vq);
 444	if (!sock)
 445		return 0;
 446
 447	return vhost_poll_start(poll, sock->file);
 448}
 449
 450static void vhost_net_signal_used(struct vhost_net_virtqueue *nvq)
 
 451{
 452	struct vhost_virtqueue *vq = &nvq->vq;
 453	struct vhost_dev *dev = vq->dev;
 454
 455	if (!nvq->done_idx)
 456		return;
 457
 458	vhost_add_used_and_signal_n(dev, vq, vq->heads, nvq->done_idx);
 459	nvq->done_idx = 0;
 460}
 461
 462static void vhost_tx_batch(struct vhost_net *net,
 463			   struct vhost_net_virtqueue *nvq,
 464			   struct socket *sock,
 465			   struct msghdr *msghdr)
 466{
 467	struct tun_msg_ctl ctl = {
 468		.type = TUN_MSG_PTR,
 469		.num = nvq->batched_xdp,
 470		.ptr = nvq->xdp,
 471	};
 472	int i, err;
 473
 474	if (nvq->batched_xdp == 0)
 475		goto signal_used;
 476
 477	msghdr->msg_control = &ctl;
 478	msghdr->msg_controllen = sizeof(ctl);
 479	err = sock->ops->sendmsg(sock, msghdr, 0);
 480	if (unlikely(err < 0)) {
 481		vq_err(&nvq->vq, "Fail to batch sending packets\n");
 482
 483		/* free pages owned by XDP; since this is an unlikely error path,
 484		 * keep it simple and avoid more complex bulk update for the
 485		 * used pages
 486		 */
 487		for (i = 0; i < nvq->batched_xdp; ++i)
 488			put_page(virt_to_head_page(nvq->xdp[i].data));
 489		nvq->batched_xdp = 0;
 490		nvq->done_idx = 0;
 491		return;
 492	}
 493
 494signal_used:
 495	vhost_net_signal_used(nvq);
 496	nvq->batched_xdp = 0;
 497}
 498
 499static int sock_has_rx_data(struct socket *sock)
 500{
 501	if (unlikely(!sock))
 502		return 0;
 503
 504	if (sock->ops->peek_len)
 505		return sock->ops->peek_len(sock);
 506
 507	return skb_queue_empty(&sock->sk->sk_receive_queue);
 508}
 509
 510static void vhost_net_busy_poll_try_queue(struct vhost_net *net,
 511					  struct vhost_virtqueue *vq)
 512{
 513	if (!vhost_vq_avail_empty(&net->dev, vq)) {
 514		vhost_poll_queue(&vq->poll);
 515	} else if (unlikely(vhost_enable_notify(&net->dev, vq))) {
 516		vhost_disable_notify(&net->dev, vq);
 517		vhost_poll_queue(&vq->poll);
 518	}
 519}
 520
 521static void vhost_net_busy_poll(struct vhost_net *net,
 522				struct vhost_virtqueue *rvq,
 523				struct vhost_virtqueue *tvq,
 524				bool *busyloop_intr,
 525				bool poll_rx)
 526{
 527	unsigned long busyloop_timeout;
 528	unsigned long endtime;
 529	struct socket *sock;
 530	struct vhost_virtqueue *vq = poll_rx ? tvq : rvq;
 531
 532	/* Try to hold the vq mutex of the paired virtqueue. We can't
 533	 * use mutex_lock() here since we could not guarantee a
 534	 * consistenet lock ordering.
 535	 */
 536	if (!mutex_trylock(&vq->mutex))
 537		return;
 538
 539	vhost_disable_notify(&net->dev, vq);
 540	sock = vhost_vq_get_backend(rvq);
 541
 542	busyloop_timeout = poll_rx ? rvq->busyloop_timeout:
 543				     tvq->busyloop_timeout;
 544
 545	preempt_disable();
 546	endtime = busy_clock() + busyloop_timeout;
 547
 548	while (vhost_can_busy_poll(endtime)) {
 549		if (vhost_vq_has_work(vq)) {
 550			*busyloop_intr = true;
 551			break;
 552		}
 553
 554		if ((sock_has_rx_data(sock) &&
 555		     !vhost_vq_avail_empty(&net->dev, rvq)) ||
 556		    !vhost_vq_avail_empty(&net->dev, tvq))
 557			break;
 558
 559		cpu_relax();
 560	}
 561
 562	preempt_enable();
 563
 564	if (poll_rx || sock_has_rx_data(sock))
 565		vhost_net_busy_poll_try_queue(net, vq);
 566	else if (!poll_rx) /* On tx here, sock has no rx data. */
 567		vhost_enable_notify(&net->dev, rvq);
 568
 569	mutex_unlock(&vq->mutex);
 570}
 571
 572static int vhost_net_tx_get_vq_desc(struct vhost_net *net,
 573				    struct vhost_net_virtqueue *tnvq,
 574				    unsigned int *out_num, unsigned int *in_num,
 575				    struct msghdr *msghdr, bool *busyloop_intr)
 576{
 577	struct vhost_net_virtqueue *rnvq = &net->vqs[VHOST_NET_VQ_RX];
 578	struct vhost_virtqueue *rvq = &rnvq->vq;
 579	struct vhost_virtqueue *tvq = &tnvq->vq;
 580
 581	int r = vhost_get_vq_desc(tvq, tvq->iov, ARRAY_SIZE(tvq->iov),
 582				  out_num, in_num, NULL, NULL);
 583
 584	if (r == tvq->num && tvq->busyloop_timeout) {
 585		/* Flush batched packets first */
 586		if (!vhost_sock_zcopy(vhost_vq_get_backend(tvq)))
 587			vhost_tx_batch(net, tnvq,
 588				       vhost_vq_get_backend(tvq),
 589				       msghdr);
 590
 591		vhost_net_busy_poll(net, rvq, tvq, busyloop_intr, false);
 592
 593		r = vhost_get_vq_desc(tvq, tvq->iov, ARRAY_SIZE(tvq->iov),
 594				      out_num, in_num, NULL, NULL);
 595	}
 596
 597	return r;
 598}
 599
 600static bool vhost_exceeds_maxpend(struct vhost_net *net)
 601{
 602	struct vhost_net_virtqueue *nvq = &net->vqs[VHOST_NET_VQ_TX];
 603	struct vhost_virtqueue *vq = &nvq->vq;
 604
 605	return (nvq->upend_idx + UIO_MAXIOV - nvq->done_idx) % UIO_MAXIOV >
 606	       min_t(unsigned int, VHOST_MAX_PEND, vq->num >> 2);
 607}
 608
 609static size_t init_iov_iter(struct vhost_virtqueue *vq, struct iov_iter *iter,
 610			    size_t hdr_size, int out)
 611{
 612	/* Skip header. TODO: support TSO. */
 613	size_t len = iov_length(vq->iov, out);
 614
 615	iov_iter_init(iter, ITER_SOURCE, vq->iov, out, len);
 616	iov_iter_advance(iter, hdr_size);
 617
 618	return iov_iter_count(iter);
 619}
 620
 621static int get_tx_bufs(struct vhost_net *net,
 622		       struct vhost_net_virtqueue *nvq,
 623		       struct msghdr *msg,
 624		       unsigned int *out, unsigned int *in,
 625		       size_t *len, bool *busyloop_intr)
 626{
 627	struct vhost_virtqueue *vq = &nvq->vq;
 628	int ret;
 629
 630	ret = vhost_net_tx_get_vq_desc(net, nvq, out, in, msg, busyloop_intr);
 631
 632	if (ret < 0 || ret == vq->num)
 633		return ret;
 634
 635	if (*in) {
 636		vq_err(vq, "Unexpected descriptor format for TX: out %d, int %d\n",
 637			*out, *in);
 638		return -EFAULT;
 639	}
 640
 641	/* Sanity check */
 642	*len = init_iov_iter(vq, &msg->msg_iter, nvq->vhost_hlen, *out);
 643	if (*len == 0) {
 644		vq_err(vq, "Unexpected header len for TX: %zd expected %zd\n",
 645			*len, nvq->vhost_hlen);
 646		return -EFAULT;
 647	}
 648
 649	return ret;
 650}
 651
 652static bool tx_can_batch(struct vhost_virtqueue *vq, size_t total_len)
 653{
 654	return total_len < VHOST_NET_WEIGHT &&
 655	       !vhost_vq_avail_empty(vq->dev, vq);
 656}
 657
 658static bool vhost_net_page_frag_refill(struct vhost_net *net, unsigned int sz,
 659				       struct page_frag *pfrag, gfp_t gfp)
 660{
 661	if (pfrag->page) {
 662		if (pfrag->offset + sz <= pfrag->size)
 663			return true;
 664		__page_frag_cache_drain(pfrag->page, net->refcnt_bias);
 665	}
 666
 667	pfrag->offset = 0;
 668	net->refcnt_bias = 0;
 669	if (SKB_FRAG_PAGE_ORDER) {
 670		/* Avoid direct reclaim but allow kswapd to wake */
 671		pfrag->page = alloc_pages((gfp & ~__GFP_DIRECT_RECLAIM) |
 672					  __GFP_COMP | __GFP_NOWARN |
 673					  __GFP_NORETRY,
 674					  SKB_FRAG_PAGE_ORDER);
 675		if (likely(pfrag->page)) {
 676			pfrag->size = PAGE_SIZE << SKB_FRAG_PAGE_ORDER;
 677			goto done;
 678		}
 679	}
 680	pfrag->page = alloc_page(gfp);
 681	if (likely(pfrag->page)) {
 682		pfrag->size = PAGE_SIZE;
 683		goto done;
 684	}
 685	return false;
 686
 687done:
 688	net->refcnt_bias = USHRT_MAX;
 689	page_ref_add(pfrag->page, USHRT_MAX - 1);
 690	return true;
 691}
 692
 693#define VHOST_NET_RX_PAD (NET_IP_ALIGN + NET_SKB_PAD)
 694
 695static int vhost_net_build_xdp(struct vhost_net_virtqueue *nvq,
 696			       struct iov_iter *from)
 697{
 698	struct vhost_virtqueue *vq = &nvq->vq;
 699	struct vhost_net *net = container_of(vq->dev, struct vhost_net,
 700					     dev);
 701	struct socket *sock = vhost_vq_get_backend(vq);
 702	struct page_frag *alloc_frag = &net->page_frag;
 703	struct virtio_net_hdr *gso;
 704	struct xdp_buff *xdp = &nvq->xdp[nvq->batched_xdp];
 705	struct tun_xdp_hdr *hdr;
 706	size_t len = iov_iter_count(from);
 707	int headroom = vhost_sock_xdp(sock) ? XDP_PACKET_HEADROOM : 0;
 708	int buflen = SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
 709	int pad = SKB_DATA_ALIGN(VHOST_NET_RX_PAD + headroom + nvq->sock_hlen);
 710	int sock_hlen = nvq->sock_hlen;
 711	void *buf;
 712	int copied;
 713
 714	if (unlikely(len < nvq->sock_hlen))
 715		return -EFAULT;
 716
 717	if (SKB_DATA_ALIGN(len + pad) +
 718	    SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) > PAGE_SIZE)
 719		return -ENOSPC;
 720
 721	buflen += SKB_DATA_ALIGN(len + pad);
 722	alloc_frag->offset = ALIGN((u64)alloc_frag->offset, SMP_CACHE_BYTES);
 723	if (unlikely(!vhost_net_page_frag_refill(net, buflen,
 724						 alloc_frag, GFP_KERNEL)))
 725		return -ENOMEM;
 726
 727	buf = (char *)page_address(alloc_frag->page) + alloc_frag->offset;
 728	copied = copy_page_from_iter(alloc_frag->page,
 729				     alloc_frag->offset +
 730				     offsetof(struct tun_xdp_hdr, gso),
 731				     sock_hlen, from);
 732	if (copied != sock_hlen)
 733		return -EFAULT;
 734
 735	hdr = buf;
 736	gso = &hdr->gso;
 737
 738	if ((gso->flags & VIRTIO_NET_HDR_F_NEEDS_CSUM) &&
 739	    vhost16_to_cpu(vq, gso->csum_start) +
 740	    vhost16_to_cpu(vq, gso->csum_offset) + 2 >
 741	    vhost16_to_cpu(vq, gso->hdr_len)) {
 742		gso->hdr_len = cpu_to_vhost16(vq,
 743			       vhost16_to_cpu(vq, gso->csum_start) +
 744			       vhost16_to_cpu(vq, gso->csum_offset) + 2);
 745
 746		if (vhost16_to_cpu(vq, gso->hdr_len) > len)
 747			return -EINVAL;
 748	}
 749
 750	len -= sock_hlen;
 751	copied = copy_page_from_iter(alloc_frag->page,
 752				     alloc_frag->offset + pad,
 753				     len, from);
 754	if (copied != len)
 755		return -EFAULT;
 756
 757	xdp_init_buff(xdp, buflen, NULL);
 758	xdp_prepare_buff(xdp, buf, pad, len, true);
 759	hdr->buflen = buflen;
 760
 761	--net->refcnt_bias;
 762	alloc_frag->offset += buflen;
 763
 764	++nvq->batched_xdp;
 765
 766	return 0;
 767}
 768
 769static void handle_tx_copy(struct vhost_net *net, struct socket *sock)
 770{
 771	struct vhost_net_virtqueue *nvq = &net->vqs[VHOST_NET_VQ_TX];
 772	struct vhost_virtqueue *vq = &nvq->vq;
 773	unsigned out, in;
 774	int head;
 775	struct msghdr msg = {
 776		.msg_name = NULL,
 777		.msg_namelen = 0,
 778		.msg_control = NULL,
 779		.msg_controllen = 0,
 
 780		.msg_flags = MSG_DONTWAIT,
 781	};
 782	size_t len, total_len = 0;
 783	int err;
 784	int sent_pkts = 0;
 785	bool sock_can_batch = (sock->sk->sk_sndbuf == INT_MAX);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 786
 787	do {
 788		bool busyloop_intr = false;
 
 
 789
 790		if (nvq->done_idx == VHOST_NET_BATCH)
 791			vhost_tx_batch(net, nvq, sock, &msg);
 
 
 792
 793		head = get_tx_bufs(net, nvq, &msg, &out, &in, &len,
 794				   &busyloop_intr);
 
 
 795		/* On error, stop handling until the next kick. */
 796		if (unlikely(head < 0))
 797			break;
 798		/* Nothing new?  Wait for eventfd to tell us they refilled. */
 799		if (head == vq->num) {
 800			if (unlikely(busyloop_intr)) {
 801				vhost_poll_queue(&vq->poll);
 802			} else if (unlikely(vhost_enable_notify(&net->dev,
 803								vq))) {
 804				vhost_disable_notify(&net->dev, vq);
 805				continue;
 806			}
 807			break;
 808		}
 809
 810		total_len += len;
 811
 812		/* For simplicity, TX batching is only enabled if
 813		 * sndbuf is unlimited.
 814		 */
 815		if (sock_can_batch) {
 816			err = vhost_net_build_xdp(nvq, &msg.msg_iter);
 817			if (!err) {
 818				goto done;
 819			} else if (unlikely(err != -ENOSPC)) {
 820				vhost_tx_batch(net, nvq, sock, &msg);
 821				vhost_discard_vq_desc(vq, 1);
 822				vhost_net_enable_vq(net, vq);
 823				break;
 824			}
 825
 826			/* We can't build XDP buff, go for single
 827			 * packet path but let's flush batched
 828			 * packets.
 829			 */
 830			vhost_tx_batch(net, nvq, sock, &msg);
 831			msg.msg_control = NULL;
 832		} else {
 833			if (tx_can_batch(vq, total_len))
 834				msg.msg_flags |= MSG_MORE;
 835			else
 836				msg.msg_flags &= ~MSG_MORE;
 837		}
 838
 839		err = sock->ops->sendmsg(sock, &msg, len);
 840		if (unlikely(err < 0)) {
 841			if (err == -EAGAIN || err == -ENOMEM || err == -ENOBUFS) {
 842				vhost_discard_vq_desc(vq, 1);
 843				vhost_net_enable_vq(net, vq);
 844				break;
 845			}
 846			pr_debug("Fail to send packet: err %d", err);
 847		} else if (unlikely(err != len))
 848			pr_debug("Truncated TX packet: len %d != %zd\n",
 849				 err, len);
 850done:
 851		vq->heads[nvq->done_idx].id = cpu_to_vhost32(vq, head);
 852		vq->heads[nvq->done_idx].len = 0;
 853		++nvq->done_idx;
 854	} while (likely(!vhost_exceeds_weight(vq, ++sent_pkts, total_len)));
 855
 856	vhost_tx_batch(net, nvq, sock, &msg);
 857}
 858
 859static void handle_tx_zerocopy(struct vhost_net *net, struct socket *sock)
 860{
 861	struct vhost_net_virtqueue *nvq = &net->vqs[VHOST_NET_VQ_TX];
 862	struct vhost_virtqueue *vq = &nvq->vq;
 863	unsigned out, in;
 864	int head;
 865	struct msghdr msg = {
 866		.msg_name = NULL,
 867		.msg_namelen = 0,
 868		.msg_control = NULL,
 869		.msg_controllen = 0,
 870		.msg_flags = MSG_DONTWAIT,
 871	};
 872	struct tun_msg_ctl ctl;
 873	size_t len, total_len = 0;
 874	int err;
 875	struct vhost_net_ubuf_ref *ubufs;
 876	struct ubuf_info_msgzc *ubuf;
 877	bool zcopy_used;
 878	int sent_pkts = 0;
 879
 880	do {
 881		bool busyloop_intr;
 882
 883		/* Release DMAs done buffers first */
 884		vhost_zerocopy_signal_used(net, vq);
 885
 886		busyloop_intr = false;
 887		head = get_tx_bufs(net, nvq, &msg, &out, &in, &len,
 888				   &busyloop_intr);
 889		/* On error, stop handling until the next kick. */
 890		if (unlikely(head < 0))
 891			break;
 892		/* Nothing new?  Wait for eventfd to tell us they refilled. */
 893		if (head == vq->num) {
 894			if (unlikely(busyloop_intr)) {
 895				vhost_poll_queue(&vq->poll);
 896			} else if (unlikely(vhost_enable_notify(&net->dev, vq))) {
 897				vhost_disable_notify(&net->dev, vq);
 898				continue;
 899			}
 900			break;
 901		}
 902
 903		zcopy_used = len >= VHOST_GOODCOPY_LEN
 904			     && !vhost_exceeds_maxpend(net)
 905			     && vhost_net_tx_select_zcopy(net);
 906
 
 
 
 
 
 
 
 
 
 
 
 907		/* use msg_control to pass vhost zerocopy ubuf info to skb */
 908		if (zcopy_used) {
 909			ubuf = nvq->ubuf_info + nvq->upend_idx;
 910			vq->heads[nvq->upend_idx].id = cpu_to_vhost32(vq, head);
 911			vq->heads[nvq->upend_idx].len = VHOST_DMA_IN_PROGRESS;
 912			ubuf->ctx = nvq->ubufs;
 913			ubuf->desc = nvq->upend_idx;
 914			ubuf->ubuf.callback = vhost_zerocopy_callback;
 915			ubuf->ubuf.flags = SKBFL_ZEROCOPY_FRAG;
 916			refcount_set(&ubuf->ubuf.refcnt, 1);
 917			msg.msg_control = &ctl;
 918			ctl.type = TUN_MSG_UBUF;
 919			ctl.ptr = &ubuf->ubuf;
 920			msg.msg_controllen = sizeof(ctl);
 921			ubufs = nvq->ubufs;
 922			atomic_inc(&ubufs->refcount);
 923			nvq->upend_idx = (nvq->upend_idx + 1) % UIO_MAXIOV;
 924		} else {
 925			msg.msg_control = NULL;
 926			ubufs = NULL;
 927		}
 928		total_len += len;
 929		if (tx_can_batch(vq, total_len) &&
 930		    likely(!vhost_exceeds_maxpend(net))) {
 931			msg.msg_flags |= MSG_MORE;
 932		} else {
 933			msg.msg_flags &= ~MSG_MORE;
 934		}
 935
 936		err = sock->ops->sendmsg(sock, &msg, len);
 937		if (unlikely(err < 0)) {
 938			bool retry = err == -EAGAIN || err == -ENOMEM || err == -ENOBUFS;
 939
 940			if (zcopy_used) {
 941				if (vq->heads[ubuf->desc].len == VHOST_DMA_IN_PROGRESS)
 942					vhost_net_ubuf_put(ubufs);
 943				if (retry)
 944					nvq->upend_idx = ((unsigned)nvq->upend_idx - 1)
 945						% UIO_MAXIOV;
 946				else
 947					vq->heads[ubuf->desc].len = VHOST_DMA_DONE_LEN;
 948			}
 949			if (retry) {
 950				vhost_discard_vq_desc(vq, 1);
 951				vhost_net_enable_vq(net, vq);
 952				break;
 953			}
 954			pr_debug("Fail to send packet: err %d", err);
 955		} else if (unlikely(err != len))
 956			pr_debug("Truncated TX packet: "
 957				 " len %d != %zd\n", err, len);
 958		if (!zcopy_used)
 959			vhost_add_used_and_signal(&net->dev, vq, head, 0);
 960		else
 961			vhost_zerocopy_signal_used(net, vq);
 962		vhost_net_tx_packet(net);
 963	} while (likely(!vhost_exceeds_weight(vq, ++sent_pkts, total_len)));
 964}
 965
 966/* Expects to be always run from workqueue - which acts as
 967 * read-size critical section for our kind of RCU. */
 968static void handle_tx(struct vhost_net *net)
 969{
 970	struct vhost_net_virtqueue *nvq = &net->vqs[VHOST_NET_VQ_TX];
 971	struct vhost_virtqueue *vq = &nvq->vq;
 972	struct socket *sock;
 973
 974	mutex_lock_nested(&vq->mutex, VHOST_NET_VQ_TX);
 975	sock = vhost_vq_get_backend(vq);
 976	if (!sock)
 977		goto out;
 978
 979	if (!vq_meta_prefetch(vq))
 980		goto out;
 981
 982	vhost_disable_notify(&net->dev, vq);
 983	vhost_net_disable_vq(net, vq);
 984
 985	if (vhost_sock_zcopy(sock))
 986		handle_tx_zerocopy(net, sock);
 987	else
 988		handle_tx_copy(net, sock);
 989
 990out:
 991	mutex_unlock(&vq->mutex);
 992}
 993
 994static int peek_head_len(struct vhost_net_virtqueue *rvq, struct sock *sk)
 995{
 996	struct sk_buff *head;
 997	int len = 0;
 998	unsigned long flags;
 999
1000	if (rvq->rx_ring)
1001		return vhost_net_buf_peek(rvq);
1002
1003	spin_lock_irqsave(&sk->sk_receive_queue.lock, flags);
1004	head = skb_peek(&sk->sk_receive_queue);
1005	if (likely(head)) {
1006		len = head->len;
1007		if (skb_vlan_tag_present(head))
1008			len += VLAN_HLEN;
1009	}
1010
1011	spin_unlock_irqrestore(&sk->sk_receive_queue.lock, flags);
1012	return len;
1013}
1014
1015static int vhost_net_rx_peek_head_len(struct vhost_net *net, struct sock *sk,
1016				      bool *busyloop_intr)
1017{
1018	struct vhost_net_virtqueue *rnvq = &net->vqs[VHOST_NET_VQ_RX];
1019	struct vhost_net_virtqueue *tnvq = &net->vqs[VHOST_NET_VQ_TX];
1020	struct vhost_virtqueue *rvq = &rnvq->vq;
1021	struct vhost_virtqueue *tvq = &tnvq->vq;
1022	int len = peek_head_len(rnvq, sk);
1023
1024	if (!len && rvq->busyloop_timeout) {
1025		/* Flush batched heads first */
1026		vhost_net_signal_used(rnvq);
1027		/* Both tx vq and rx socket were polled here */
1028		vhost_net_busy_poll(net, rvq, tvq, busyloop_intr, true);
1029
1030		len = peek_head_len(rnvq, sk);
1031	}
1032
1033	return len;
1034}
1035
1036/* This is a multi-buffer version of vhost_get_desc, that works if
1037 *	vq has read descriptors only.
1038 * @vq		- the relevant virtqueue
1039 * @datalen	- data length we'll be reading
1040 * @iovcount	- returned count of io vectors we fill
1041 * @log		- vhost log
1042 * @log_num	- log offset
1043 * @quota       - headcount quota, 1 for big buffer
1044 *	returns number of buffer heads allocated, negative on error
1045 */
1046static int get_rx_bufs(struct vhost_virtqueue *vq,
1047		       struct vring_used_elem *heads,
1048		       int datalen,
1049		       unsigned *iovcount,
1050		       struct vhost_log *log,
1051		       unsigned *log_num,
1052		       unsigned int quota)
1053{
1054	unsigned int out, in;
1055	int seg = 0;
1056	int headcount = 0;
1057	unsigned d;
1058	int r, nlogs = 0;
1059	/* len is always initialized before use since we are always called with
1060	 * datalen > 0.
1061	 */
1062	u32 len;
1063
1064	while (datalen > 0 && headcount < quota) {
1065		if (unlikely(seg >= UIO_MAXIOV)) {
1066			r = -ENOBUFS;
1067			goto err;
1068		}
1069		r = vhost_get_vq_desc(vq, vq->iov + seg,
1070				      ARRAY_SIZE(vq->iov) - seg, &out,
1071				      &in, log, log_num);
1072		if (unlikely(r < 0))
1073			goto err;
1074
1075		d = r;
1076		if (d == vq->num) {
1077			r = 0;
1078			goto err;
1079		}
1080		if (unlikely(out || in <= 0)) {
1081			vq_err(vq, "unexpected descriptor format for RX: "
1082				"out %d, in %d\n", out, in);
1083			r = -EINVAL;
1084			goto err;
1085		}
1086		if (unlikely(log)) {
1087			nlogs += *log_num;
1088			log += *log_num;
1089		}
1090		heads[headcount].id = cpu_to_vhost32(vq, d);
1091		len = iov_length(vq->iov + seg, in);
1092		heads[headcount].len = cpu_to_vhost32(vq, len);
1093		datalen -= len;
1094		++headcount;
1095		seg += in;
1096	}
1097	heads[headcount - 1].len = cpu_to_vhost32(vq, len + datalen);
1098	*iovcount = seg;
1099	if (unlikely(log))
1100		*log_num = nlogs;
1101
1102	/* Detect overrun */
1103	if (unlikely(datalen > 0)) {
1104		r = UIO_MAXIOV + 1;
1105		goto err;
1106	}
1107	return headcount;
1108err:
1109	vhost_discard_vq_desc(vq, headcount);
1110	return r;
1111}
1112
1113/* Expects to be always run from workqueue - which acts as
1114 * read-size critical section for our kind of RCU. */
1115static void handle_rx(struct vhost_net *net)
1116{
1117	struct vhost_net_virtqueue *nvq = &net->vqs[VHOST_NET_VQ_RX];
1118	struct vhost_virtqueue *vq = &nvq->vq;
1119	unsigned in, log;
1120	struct vhost_log *vq_log;
1121	struct msghdr msg = {
1122		.msg_name = NULL,
1123		.msg_namelen = 0,
1124		.msg_control = NULL, /* FIXME: get and handle RX aux data. */
1125		.msg_controllen = 0,
 
1126		.msg_flags = MSG_DONTWAIT,
1127	};
1128	struct virtio_net_hdr hdr = {
1129		.flags = 0,
1130		.gso_type = VIRTIO_NET_HDR_GSO_NONE
1131	};
1132	size_t total_len = 0;
1133	int err, mergeable;
1134	s16 headcount;
1135	size_t vhost_hlen, sock_hlen;
1136	size_t vhost_len, sock_len;
1137	bool busyloop_intr = false;
1138	struct socket *sock;
1139	struct iov_iter fixup;
1140	__virtio16 num_buffers;
1141	int recv_pkts = 0;
1142
1143	mutex_lock_nested(&vq->mutex, VHOST_NET_VQ_RX);
1144	sock = vhost_vq_get_backend(vq);
1145	if (!sock)
1146		goto out;
1147
1148	if (!vq_meta_prefetch(vq))
1149		goto out;
1150
 
1151	vhost_disable_notify(&net->dev, vq);
1152	vhost_net_disable_vq(net, vq);
1153
1154	vhost_hlen = nvq->vhost_hlen;
1155	sock_hlen = nvq->sock_hlen;
1156
1157	vq_log = unlikely(vhost_has_feature(vq, VHOST_F_LOG_ALL)) ?
1158		vq->log : NULL;
1159	mergeable = vhost_has_feature(vq, VIRTIO_NET_F_MRG_RXBUF);
1160
1161	do {
1162		sock_len = vhost_net_rx_peek_head_len(net, sock->sk,
1163						      &busyloop_intr);
1164		if (!sock_len)
1165			break;
1166		sock_len += sock_hlen;
1167		vhost_len = sock_len + vhost_hlen;
1168		headcount = get_rx_bufs(vq, vq->heads + nvq->done_idx,
1169					vhost_len, &in, vq_log, &log,
1170					likely(mergeable) ? UIO_MAXIOV : 1);
1171		/* On error, stop handling until the next kick. */
1172		if (unlikely(headcount < 0))
1173			goto out;
1174		/* OK, now we need to know about added descriptors. */
1175		if (!headcount) {
1176			if (unlikely(busyloop_intr)) {
1177				vhost_poll_queue(&vq->poll);
1178			} else if (unlikely(vhost_enable_notify(&net->dev, vq))) {
1179				/* They have slipped one in as we were
1180				 * doing that: check again. */
1181				vhost_disable_notify(&net->dev, vq);
1182				continue;
1183			}
1184			/* Nothing new?  Wait for eventfd to tell us
1185			 * they refilled. */
1186			goto out;
1187		}
1188		busyloop_intr = false;
1189		if (nvq->rx_ring)
1190			msg.msg_control = vhost_net_buf_consume(&nvq->rxq);
1191		/* On overrun, truncate and discard */
1192		if (unlikely(headcount > UIO_MAXIOV)) {
1193			iov_iter_init(&msg.msg_iter, ITER_DEST, vq->iov, 1, 1);
1194			err = sock->ops->recvmsg(sock, &msg,
1195						 1, MSG_DONTWAIT | MSG_TRUNC);
1196			pr_debug("Discarded rx packet: len %zd\n", sock_len);
1197			continue;
1198		}
1199		/* We don't need to be notified again. */
1200		iov_iter_init(&msg.msg_iter, ITER_DEST, vq->iov, in, vhost_len);
1201		fixup = msg.msg_iter;
1202		if (unlikely((vhost_hlen))) {
1203			/* We will supply the header ourselves
1204			 * TODO: support TSO.
1205			 */
1206			iov_iter_advance(&msg.msg_iter, vhost_hlen);
1207		}
1208		err = sock->ops->recvmsg(sock, &msg,
1209					 sock_len, MSG_DONTWAIT | MSG_TRUNC);
1210		/* Userspace might have consumed the packet meanwhile:
1211		 * it's not supposed to do this usually, but might be hard
1212		 * to prevent. Discard data we got (if any) and keep going. */
1213		if (unlikely(err != sock_len)) {
1214			pr_debug("Discarded rx packet: "
1215				 " len %d, expected %zd\n", err, sock_len);
1216			vhost_discard_vq_desc(vq, headcount);
1217			continue;
1218		}
1219		/* Supply virtio_net_hdr if VHOST_NET_F_VIRTIO_NET_HDR */
1220		if (unlikely(vhost_hlen)) {
1221			if (copy_to_iter(&hdr, sizeof(hdr),
1222					 &fixup) != sizeof(hdr)) {
1223				vq_err(vq, "Unable to write vnet_hdr "
1224				       "at addr %p\n", vq->iov->iov_base);
1225				goto out;
1226			}
1227		} else {
1228			/* Header came from socket; we'll need to patch
1229			 * ->num_buffers over if VIRTIO_NET_F_MRG_RXBUF
1230			 */
1231			iov_iter_advance(&fixup, sizeof(hdr));
1232		}
1233		/* TODO: Should check and handle checksum. */
1234
1235		num_buffers = cpu_to_vhost16(vq, headcount);
1236		if (likely(mergeable) &&
1237		    copy_to_iter(&num_buffers, sizeof num_buffers,
1238				 &fixup) != sizeof num_buffers) {
 
1239			vq_err(vq, "Failed num_buffers write");
1240			vhost_discard_vq_desc(vq, headcount);
1241			goto out;
1242		}
1243		nvq->done_idx += headcount;
1244		if (nvq->done_idx > VHOST_NET_BATCH)
1245			vhost_net_signal_used(nvq);
1246		if (unlikely(vq_log))
1247			vhost_log_write(vq, vq_log, log, vhost_len,
1248					vq->iov, in);
1249		total_len += vhost_len;
1250	} while (likely(!vhost_exceeds_weight(vq, ++recv_pkts, total_len)));
 
 
 
 
1251
1252	if (unlikely(busyloop_intr))
1253		vhost_poll_queue(&vq->poll);
1254	else if (!sock_len)
1255		vhost_net_enable_vq(net, vq);
1256out:
1257	vhost_net_signal_used(nvq);
1258	mutex_unlock(&vq->mutex);
1259}
1260
1261static void handle_tx_kick(struct vhost_work *work)
1262{
1263	struct vhost_virtqueue *vq = container_of(work, struct vhost_virtqueue,
1264						  poll.work);
1265	struct vhost_net *net = container_of(vq->dev, struct vhost_net, dev);
1266
1267	handle_tx(net);
1268}
1269
1270static void handle_rx_kick(struct vhost_work *work)
1271{
1272	struct vhost_virtqueue *vq = container_of(work, struct vhost_virtqueue,
1273						  poll.work);
1274	struct vhost_net *net = container_of(vq->dev, struct vhost_net, dev);
1275
1276	handle_rx(net);
1277}
1278
1279static void handle_tx_net(struct vhost_work *work)
1280{
1281	struct vhost_net *net = container_of(work, struct vhost_net,
1282					     poll[VHOST_NET_VQ_TX].work);
1283	handle_tx(net);
1284}
1285
1286static void handle_rx_net(struct vhost_work *work)
1287{
1288	struct vhost_net *net = container_of(work, struct vhost_net,
1289					     poll[VHOST_NET_VQ_RX].work);
1290	handle_rx(net);
1291}
1292
1293static int vhost_net_open(struct inode *inode, struct file *f)
1294{
1295	struct vhost_net *n;
1296	struct vhost_dev *dev;
1297	struct vhost_virtqueue **vqs;
1298	void **queue;
1299	struct xdp_buff *xdp;
1300	int i;
1301
1302	n = kvmalloc(sizeof *n, GFP_KERNEL | __GFP_RETRY_MAYFAIL);
1303	if (!n)
1304		return -ENOMEM;
1305	vqs = kmalloc_array(VHOST_NET_VQ_MAX, sizeof(*vqs), GFP_KERNEL);
1306	if (!vqs) {
1307		kvfree(n);
1308		return -ENOMEM;
1309	}
1310
1311	queue = kmalloc_array(VHOST_NET_BATCH, sizeof(void *),
1312			      GFP_KERNEL);
1313	if (!queue) {
1314		kfree(vqs);
1315		kvfree(n);
1316		return -ENOMEM;
 
1317	}
1318	n->vqs[VHOST_NET_VQ_RX].rxq.queue = queue;
1319
1320	xdp = kmalloc_array(VHOST_NET_BATCH, sizeof(*xdp), GFP_KERNEL);
1321	if (!xdp) {
1322		kfree(vqs);
1323		kvfree(n);
1324		kfree(queue);
1325		return -ENOMEM;
1326	}
1327	n->vqs[VHOST_NET_VQ_TX].xdp = xdp;
1328
1329	dev = &n->dev;
1330	vqs[VHOST_NET_VQ_TX] = &n->vqs[VHOST_NET_VQ_TX].vq;
1331	vqs[VHOST_NET_VQ_RX] = &n->vqs[VHOST_NET_VQ_RX].vq;
1332	n->vqs[VHOST_NET_VQ_TX].vq.handle_kick = handle_tx_kick;
1333	n->vqs[VHOST_NET_VQ_RX].vq.handle_kick = handle_rx_kick;
1334	for (i = 0; i < VHOST_NET_VQ_MAX; i++) {
1335		n->vqs[i].ubufs = NULL;
1336		n->vqs[i].ubuf_info = NULL;
1337		n->vqs[i].upend_idx = 0;
1338		n->vqs[i].done_idx = 0;
1339		n->vqs[i].batched_xdp = 0;
1340		n->vqs[i].vhost_hlen = 0;
1341		n->vqs[i].sock_hlen = 0;
1342		n->vqs[i].rx_ring = NULL;
1343		vhost_net_buf_init(&n->vqs[i].rxq);
1344	}
1345	vhost_dev_init(dev, vqs, VHOST_NET_VQ_MAX,
1346		       UIO_MAXIOV + VHOST_NET_BATCH,
1347		       VHOST_NET_PKT_WEIGHT, VHOST_NET_WEIGHT, true,
1348		       NULL);
1349
1350	vhost_poll_init(n->poll + VHOST_NET_VQ_TX, handle_tx_net, EPOLLOUT, dev,
1351			vqs[VHOST_NET_VQ_TX]);
1352	vhost_poll_init(n->poll + VHOST_NET_VQ_RX, handle_rx_net, EPOLLIN, dev,
1353			vqs[VHOST_NET_VQ_RX]);
1354
1355	f->private_data = n;
1356	n->page_frag.page = NULL;
1357	n->refcnt_bias = 0;
1358
1359	return 0;
1360}
1361
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1362static struct socket *vhost_net_stop_vq(struct vhost_net *n,
1363					struct vhost_virtqueue *vq)
1364{
1365	struct socket *sock;
1366	struct vhost_net_virtqueue *nvq =
1367		container_of(vq, struct vhost_net_virtqueue, vq);
1368
1369	mutex_lock(&vq->mutex);
1370	sock = vhost_vq_get_backend(vq);
 
1371	vhost_net_disable_vq(n, vq);
1372	vhost_vq_set_backend(vq, NULL);
1373	vhost_net_buf_unproduce(nvq);
1374	nvq->rx_ring = NULL;
1375	mutex_unlock(&vq->mutex);
1376	return sock;
1377}
1378
1379static void vhost_net_stop(struct vhost_net *n, struct socket **tx_sock,
1380			   struct socket **rx_sock)
1381{
1382	*tx_sock = vhost_net_stop_vq(n, &n->vqs[VHOST_NET_VQ_TX].vq);
1383	*rx_sock = vhost_net_stop_vq(n, &n->vqs[VHOST_NET_VQ_RX].vq);
 
 
 
 
 
 
1384}
1385
1386static void vhost_net_flush(struct vhost_net *n)
1387{
1388	vhost_dev_flush(&n->dev);
1389	if (n->vqs[VHOST_NET_VQ_TX].ubufs) {
1390		mutex_lock(&n->vqs[VHOST_NET_VQ_TX].vq.mutex);
1391		n->tx_flush = true;
1392		mutex_unlock(&n->vqs[VHOST_NET_VQ_TX].vq.mutex);
1393		/* Wait for all lower device DMAs done. */
1394		vhost_net_ubuf_put_and_wait(n->vqs[VHOST_NET_VQ_TX].ubufs);
1395		mutex_lock(&n->vqs[VHOST_NET_VQ_TX].vq.mutex);
1396		n->tx_flush = false;
1397		atomic_set(&n->vqs[VHOST_NET_VQ_TX].ubufs->refcount, 1);
1398		mutex_unlock(&n->vqs[VHOST_NET_VQ_TX].vq.mutex);
1399	}
1400}
1401
1402static int vhost_net_release(struct inode *inode, struct file *f)
1403{
1404	struct vhost_net *n = f->private_data;
1405	struct socket *tx_sock;
1406	struct socket *rx_sock;
1407
1408	vhost_net_stop(n, &tx_sock, &rx_sock);
1409	vhost_net_flush(n);
1410	vhost_dev_stop(&n->dev);
1411	vhost_dev_cleanup(&n->dev);
1412	vhost_net_vq_reset(n);
1413	if (tx_sock)
1414		sockfd_put(tx_sock);
1415	if (rx_sock)
1416		sockfd_put(rx_sock);
1417	/* Make sure no callbacks are outstanding */
1418	synchronize_rcu();
1419	/* We do an extra flush before freeing memory,
1420	 * since jobs can re-queue themselves. */
1421	vhost_net_flush(n);
1422	kfree(n->vqs[VHOST_NET_VQ_RX].rxq.queue);
1423	kfree(n->vqs[VHOST_NET_VQ_TX].xdp);
1424	kfree(n->dev.vqs);
1425	if (n->page_frag.page)
1426		__page_frag_cache_drain(n->page_frag.page, n->refcnt_bias);
1427	kvfree(n);
1428	return 0;
1429}
1430
1431static struct socket *get_raw_socket(int fd)
1432{
1433	int r;
 
 
 
 
1434	struct socket *sock = sockfd_lookup(fd, &r);
1435
1436	if (!sock)
1437		return ERR_PTR(-ENOTSOCK);
1438
1439	/* Parameter checking */
1440	if (sock->sk->sk_type != SOCK_RAW) {
1441		r = -ESOCKTNOSUPPORT;
1442		goto err;
1443	}
1444
1445	if (sock->sk->sk_family != AF_PACKET) {
 
 
 
 
 
1446		r = -EPFNOSUPPORT;
1447		goto err;
1448	}
1449	return sock;
1450err:
1451	sockfd_put(sock);
1452	return ERR_PTR(r);
1453}
1454
1455static struct ptr_ring *get_tap_ptr_ring(struct file *file)
1456{
1457	struct ptr_ring *ring;
1458	ring = tun_get_tx_ring(file);
1459	if (!IS_ERR(ring))
1460		goto out;
1461	ring = tap_get_ptr_ring(file);
1462	if (!IS_ERR(ring))
1463		goto out;
1464	ring = NULL;
1465out:
1466	return ring;
1467}
1468
1469static struct socket *get_tap_socket(int fd)
1470{
1471	struct file *file = fget(fd);
1472	struct socket *sock;
1473
1474	if (!file)
1475		return ERR_PTR(-EBADF);
1476	sock = tun_get_socket(file);
1477	if (!IS_ERR(sock))
1478		return sock;
1479	sock = tap_get_socket(file);
1480	if (IS_ERR(sock))
1481		fput(file);
1482	return sock;
1483}
1484
1485static struct socket *get_socket(int fd)
1486{
1487	struct socket *sock;
1488
1489	/* special case to disable backend */
1490	if (fd == -1)
1491		return NULL;
1492	sock = get_raw_socket(fd);
1493	if (!IS_ERR(sock))
1494		return sock;
1495	sock = get_tap_socket(fd);
1496	if (!IS_ERR(sock))
1497		return sock;
1498	return ERR_PTR(-ENOTSOCK);
1499}
1500
1501static long vhost_net_set_backend(struct vhost_net *n, unsigned index, int fd)
1502{
1503	struct socket *sock, *oldsock;
1504	struct vhost_virtqueue *vq;
1505	struct vhost_net_virtqueue *nvq;
1506	struct vhost_net_ubuf_ref *ubufs, *oldubufs = NULL;
1507	int r;
1508
1509	mutex_lock(&n->dev.mutex);
1510	r = vhost_dev_check_owner(&n->dev);
1511	if (r)
1512		goto err;
1513
1514	if (index >= VHOST_NET_VQ_MAX) {
1515		r = -ENOBUFS;
1516		goto err;
1517	}
1518	vq = &n->vqs[index].vq;
1519	nvq = &n->vqs[index];
1520	mutex_lock(&vq->mutex);
1521
1522	if (fd == -1)
1523		vhost_clear_msg(&n->dev);
1524
1525	/* Verify that ring has been setup correctly. */
1526	if (!vhost_vq_access_ok(vq)) {
1527		r = -EFAULT;
1528		goto err_vq;
1529	}
1530	sock = get_socket(fd);
1531	if (IS_ERR(sock)) {
1532		r = PTR_ERR(sock);
1533		goto err_vq;
1534	}
1535
1536	/* start polling new socket */
1537	oldsock = vhost_vq_get_backend(vq);
 
1538	if (sock != oldsock) {
1539		ubufs = vhost_net_ubuf_alloc(vq,
1540					     sock && vhost_sock_zcopy(sock));
1541		if (IS_ERR(ubufs)) {
1542			r = PTR_ERR(ubufs);
1543			goto err_ubufs;
1544		}
 
 
 
 
 
1545
1546		vhost_net_disable_vq(n, vq);
1547		vhost_vq_set_backend(vq, sock);
1548		vhost_net_buf_unproduce(nvq);
1549		r = vhost_vq_init_access(vq);
1550		if (r)
1551			goto err_used;
1552		r = vhost_net_enable_vq(n, vq);
1553		if (r)
1554			goto err_used;
1555		if (index == VHOST_NET_VQ_RX) {
1556			if (sock)
1557				nvq->rx_ring = get_tap_ptr_ring(sock->file);
1558			else
1559				nvq->rx_ring = NULL;
1560		}
1561
1562		oldubufs = nvq->ubufs;
1563		nvq->ubufs = ubufs;
1564
1565		n->tx_packets = 0;
1566		n->tx_zcopy_err = 0;
1567		n->tx_flush = false;
1568	}
1569
1570	mutex_unlock(&vq->mutex);
1571
1572	if (oldubufs) {
1573		vhost_net_ubuf_put_wait_and_free(oldubufs);
1574		mutex_lock(&vq->mutex);
1575		vhost_zerocopy_signal_used(n, vq);
1576		mutex_unlock(&vq->mutex);
1577	}
1578
1579	if (oldsock) {
1580		vhost_dev_flush(&n->dev);
1581		sockfd_put(oldsock);
1582	}
1583
1584	mutex_unlock(&n->dev.mutex);
1585	return 0;
1586
1587err_used:
1588	vhost_vq_set_backend(vq, oldsock);
1589	vhost_net_enable_vq(n, vq);
1590	if (ubufs)
1591		vhost_net_ubuf_put_wait_and_free(ubufs);
1592err_ubufs:
1593	if (sock)
1594		sockfd_put(sock);
1595err_vq:
1596	mutex_unlock(&vq->mutex);
1597err:
1598	mutex_unlock(&n->dev.mutex);
1599	return r;
1600}
1601
1602static long vhost_net_reset_owner(struct vhost_net *n)
1603{
1604	struct socket *tx_sock = NULL;
1605	struct socket *rx_sock = NULL;
1606	long err;
1607	struct vhost_iotlb *umem;
1608
1609	mutex_lock(&n->dev.mutex);
1610	err = vhost_dev_check_owner(&n->dev);
1611	if (err)
1612		goto done;
1613	umem = vhost_dev_reset_owner_prepare();
1614	if (!umem) {
1615		err = -ENOMEM;
1616		goto done;
1617	}
1618	vhost_net_stop(n, &tx_sock, &rx_sock);
1619	vhost_net_flush(n);
1620	vhost_dev_stop(&n->dev);
1621	vhost_dev_reset_owner(&n->dev, umem);
1622	vhost_net_vq_reset(n);
1623done:
1624	mutex_unlock(&n->dev.mutex);
1625	if (tx_sock)
1626		sockfd_put(tx_sock);
1627	if (rx_sock)
1628		sockfd_put(rx_sock);
1629	return err;
1630}
1631
1632static int vhost_net_set_features(struct vhost_net *n, u64 features)
1633{
1634	size_t vhost_hlen, sock_hlen, hdr_len;
1635	int i;
1636
1637	hdr_len = (features & ((1ULL << VIRTIO_NET_F_MRG_RXBUF) |
1638			       (1ULL << VIRTIO_F_VERSION_1))) ?
1639			sizeof(struct virtio_net_hdr_mrg_rxbuf) :
1640			sizeof(struct virtio_net_hdr);
1641	if (features & (1 << VHOST_NET_F_VIRTIO_NET_HDR)) {
1642		/* vhost provides vnet_hdr */
1643		vhost_hlen = hdr_len;
1644		sock_hlen = 0;
1645	} else {
1646		/* socket provides vnet_hdr */
1647		vhost_hlen = 0;
1648		sock_hlen = hdr_len;
1649	}
1650	mutex_lock(&n->dev.mutex);
1651	if ((features & (1 << VHOST_F_LOG_ALL)) &&
1652	    !vhost_log_access_ok(&n->dev))
1653		goto out_unlock;
1654
1655	if ((features & (1ULL << VIRTIO_F_ACCESS_PLATFORM))) {
1656		if (vhost_init_device_iotlb(&n->dev))
1657			goto out_unlock;
1658	}
1659
 
1660	for (i = 0; i < VHOST_NET_VQ_MAX; ++i) {
1661		mutex_lock(&n->vqs[i].vq.mutex);
1662		n->vqs[i].vq.acked_features = features;
1663		n->vqs[i].vhost_hlen = vhost_hlen;
1664		n->vqs[i].sock_hlen = sock_hlen;
1665		mutex_unlock(&n->vqs[i].vq.mutex);
1666	}
 
1667	mutex_unlock(&n->dev.mutex);
1668	return 0;
1669
1670out_unlock:
1671	mutex_unlock(&n->dev.mutex);
1672	return -EFAULT;
1673}
1674
1675static long vhost_net_set_owner(struct vhost_net *n)
1676{
1677	int r;
1678
1679	mutex_lock(&n->dev.mutex);
1680	if (vhost_dev_has_owner(&n->dev)) {
1681		r = -EBUSY;
1682		goto out;
1683	}
1684	r = vhost_net_set_ubuf_info(n);
1685	if (r)
1686		goto out;
1687	r = vhost_dev_set_owner(&n->dev);
1688	if (r)
1689		vhost_net_clear_ubuf_info(n);
1690	vhost_net_flush(n);
1691out:
1692	mutex_unlock(&n->dev.mutex);
1693	return r;
1694}
1695
1696static long vhost_net_ioctl(struct file *f, unsigned int ioctl,
1697			    unsigned long arg)
1698{
1699	struct vhost_net *n = f->private_data;
1700	void __user *argp = (void __user *)arg;
1701	u64 __user *featurep = argp;
1702	struct vhost_vring_file backend;
1703	u64 features;
1704	int r;
1705
1706	switch (ioctl) {
1707	case VHOST_NET_SET_BACKEND:
1708		if (copy_from_user(&backend, argp, sizeof backend))
1709			return -EFAULT;
1710		return vhost_net_set_backend(n, backend.index, backend.fd);
1711	case VHOST_GET_FEATURES:
1712		features = VHOST_NET_FEATURES;
1713		if (copy_to_user(featurep, &features, sizeof features))
1714			return -EFAULT;
1715		return 0;
1716	case VHOST_SET_FEATURES:
1717		if (copy_from_user(&features, featurep, sizeof features))
1718			return -EFAULT;
1719		if (features & ~VHOST_NET_FEATURES)
1720			return -EOPNOTSUPP;
1721		return vhost_net_set_features(n, features);
1722	case VHOST_GET_BACKEND_FEATURES:
1723		features = VHOST_NET_BACKEND_FEATURES;
1724		if (copy_to_user(featurep, &features, sizeof(features)))
1725			return -EFAULT;
1726		return 0;
1727	case VHOST_SET_BACKEND_FEATURES:
1728		if (copy_from_user(&features, featurep, sizeof(features)))
1729			return -EFAULT;
1730		if (features & ~VHOST_NET_BACKEND_FEATURES)
1731			return -EOPNOTSUPP;
1732		vhost_set_backend_features(&n->dev, features);
1733		return 0;
1734	case VHOST_RESET_OWNER:
1735		return vhost_net_reset_owner(n);
1736	case VHOST_SET_OWNER:
1737		return vhost_net_set_owner(n);
1738	default:
1739		mutex_lock(&n->dev.mutex);
1740		r = vhost_dev_ioctl(&n->dev, ioctl, argp);
1741		if (r == -ENOIOCTLCMD)
1742			r = vhost_vring_ioctl(&n->dev, ioctl, argp);
1743		else
1744			vhost_net_flush(n);
1745		mutex_unlock(&n->dev.mutex);
1746		return r;
1747	}
1748}
1749
1750static ssize_t vhost_net_chr_read_iter(struct kiocb *iocb, struct iov_iter *to)
 
 
1751{
1752	struct file *file = iocb->ki_filp;
1753	struct vhost_net *n = file->private_data;
1754	struct vhost_dev *dev = &n->dev;
1755	int noblock = file->f_flags & O_NONBLOCK;
1756
1757	return vhost_chr_read_iter(dev, to, noblock);
1758}
1759
1760static ssize_t vhost_net_chr_write_iter(struct kiocb *iocb,
1761					struct iov_iter *from)
1762{
1763	struct file *file = iocb->ki_filp;
1764	struct vhost_net *n = file->private_data;
1765	struct vhost_dev *dev = &n->dev;
1766
1767	return vhost_chr_write_iter(dev, from);
1768}
1769
1770static __poll_t vhost_net_chr_poll(struct file *file, poll_table *wait)
1771{
1772	struct vhost_net *n = file->private_data;
1773	struct vhost_dev *dev = &n->dev;
1774
1775	return vhost_chr_poll(file, dev, wait);
1776}
 
1777
1778static const struct file_operations vhost_net_fops = {
1779	.owner          = THIS_MODULE,
1780	.release        = vhost_net_release,
1781	.read_iter      = vhost_net_chr_read_iter,
1782	.write_iter     = vhost_net_chr_write_iter,
1783	.poll           = vhost_net_chr_poll,
1784	.unlocked_ioctl = vhost_net_ioctl,
1785	.compat_ioctl   = compat_ptr_ioctl,
 
 
1786	.open           = vhost_net_open,
1787	.llseek		= noop_llseek,
1788};
1789
1790static struct miscdevice vhost_net_misc = {
1791	.minor = VHOST_NET_MINOR,
1792	.name = "vhost-net",
1793	.fops = &vhost_net_fops,
1794};
1795
1796static int __init vhost_net_init(void)
1797{
1798	if (experimental_zcopytx)
1799		vhost_net_enable_zcopy(VHOST_NET_VQ_TX);
1800	return misc_register(&vhost_net_misc);
1801}
1802module_init(vhost_net_init);
1803
1804static void __exit vhost_net_exit(void)
1805{
1806	misc_deregister(&vhost_net_misc);
1807}
1808module_exit(vhost_net_exit);
1809
1810MODULE_VERSION("0.0.1");
1811MODULE_LICENSE("GPL v2");
1812MODULE_AUTHOR("Michael S. Tsirkin");
1813MODULE_DESCRIPTION("Host kernel accelerator for virtio net");
1814MODULE_ALIAS_MISCDEV(VHOST_NET_MINOR);
1815MODULE_ALIAS("devname:vhost-net");