tun.c 83.6 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0-or-later
L
Linus Torvalds 已提交
2 3 4 5 6 7 8 9 10 11
/*
 *  TUN - Universal TUN/TAP device driver.
 *  Copyright (C) 1999-2002 Maxim Krasnyansky <maxk@qualcomm.com>
 *
 *  $Id: tun.c,v 1.15 2002/03/01 02:44:24 maxk Exp $
 */

/*
 *  Changes:
 *
12 13 14
 *  Mike Kershaw <dragorn@kismetwireless.net> 2005/08/14
 *    Add TUNSETLINK ioctl to set the link encapsulation
 *
L
Linus Torvalds 已提交
15
 *  Mark Smith <markzzzsmith@yahoo.com.au>
J
Joe Perches 已提交
16
 *    Use eth_random_addr() for tap MAC address.
L
Linus Torvalds 已提交
17 18 19 20 21 22 23 24 25 26 27
 *
 *  Harald Roelle <harald.roelle@ifi.lmu.de>  2004/04/20
 *    Fixes in packet dropping, queue length setting and queue wakeup.
 *    Increased default tx queue length.
 *    Added ethtool API.
 *    Minor cleanups
 *
 *  Daniel Podlejski <underley@underley.eu.org>
 *    Modifications for 2.3.99-pre5 kernel.
 */

28 29
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

L
Linus Torvalds 已提交
30 31 32 33 34 35 36 37
#define DRV_NAME	"tun"
#define DRV_VERSION	"1.6"
#define DRV_DESCRIPTION	"Universal TUN/TAP device driver"
#define DRV_COPYRIGHT	"(C) 1999-2004 Max Krasnyansky <maxk@qualcomm.com>"

#include <linux/module.h>
#include <linux/errno.h>
#include <linux/kernel.h>
38
#include <linux/sched/signal.h>
L
Linus Torvalds 已提交
39 40 41 42 43 44 45 46 47 48 49
#include <linux/major.h>
#include <linux/slab.h>
#include <linux/poll.h>
#include <linux/fcntl.h>
#include <linux/init.h>
#include <linux/skbuff.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/miscdevice.h>
#include <linux/ethtool.h>
#include <linux/rtnetlink.h>
50
#include <linux/compat.h>
L
Linus Torvalds 已提交
51 52 53 54
#include <linux/if.h>
#include <linux/if_arp.h>
#include <linux/if_ether.h>
#include <linux/if_tun.h>
J
Jason Wang 已提交
55
#include <linux/if_vlan.h>
L
Linus Torvalds 已提交
56
#include <linux/crc32.h>
57
#include <linux/nsproxy.h>
58
#include <linux/virtio_net.h>
M
Michael S. Tsirkin 已提交
59
#include <linux/rcupdate.h>
60
#include <net/net_namespace.h>
61
#include <net/netns/generic.h>
62
#include <net/rtnetlink.h>
63
#include <net/sock.h>
64
#include <net/xdp.h>
65
#include <net/ip_tunnels.h>
66
#include <linux/seq_file.h>
H
Herbert Xu 已提交
67
#include <linux/uio.h>
J
Jason Wang 已提交
68
#include <linux/skb_array.h>
J
Jason Wang 已提交
69 70
#include <linux/bpf.h>
#include <linux/bpf_trace.h>
71
#include <linux/mutex.h>
L
Linus Torvalds 已提交
72

73
#include <linux/uaccess.h>
74
#include <linux/proc_fs.h>
L
Linus Torvalds 已提交
75

76 77 78
static void tun_default_link_ksettings(struct net_device *dev,
				       struct ethtool_link_ksettings *cmd);

79
#define TUN_RX_PAD (NET_IP_ALIGN + NET_SKB_PAD)
80

81 82 83 84 85 86
/* TUN device flags */

/* IFF_ATTACH_QUEUE is never stored in device flags,
 * overload it to mean fasync when stored there.
 */
#define TUN_FASYNC	IFF_ATTACH_QUEUE
M
Michael S. Tsirkin 已提交
87 88
/* High bits in flags field are unused. */
#define TUN_VNET_LE     0x80000000
89
#define TUN_VNET_BE     0x40000000
90 91

#define TUN_FEATURES (IFF_NO_PI | IFF_ONE_QUEUE | IFF_VNET_HDR | \
92 93
		      IFF_MULTI_QUEUE | IFF_NAPI | IFF_NAPI_FRAGS)

94 95
#define GOODCOPY_LEN 128

96 97 98 99 100 101 102
#define FLT_EXACT_COUNT 8
struct tap_filter {
	unsigned int    count;    /* Number of addrs. Zero means disabled */
	u32             mask[2];  /* Mask of the hashed addrs */
	unsigned char	addr[FLT_EXACT_COUNT][ETH_ALEN];
};

103 104 105
/* MAX_TAP_QUEUES 256 is chosen to allow rx/tx queues to be equal
 * to max number of VCPUs in guest. */
#define MAX_TAP_QUEUES 256
106
#define MAX_TAP_FLOWS  4096
J
Jason Wang 已提交
107

J
Jason Wang 已提交
108 109
#define TUN_FLOW_EXPIRE (3 * HZ)

J
Jason Wang 已提交
110
/* A tun_file connects an open character device to a tuntap netdevice. It
S
stephen hemminger 已提交
111
 * also contains all socket related structures (except sock_fprog and tap_filter)
J
Jason Wang 已提交
112 113
 * to serve as one transmit queue for tuntap device. The sock_fprog and
 * tap_filter were kept in tun_struct since they were used for filtering for the
R
Rami Rosen 已提交
114
 * netdevice not for a specific queue (at least I didn't see the requirement for
J
Jason Wang 已提交
115
 * this).
116 117
 *
 * RCU usage:
R
Rami Rosen 已提交
118
 * The tun_file and tun_struct are loosely coupled, the pointer from one to the
119
 * other can only be read while rcu_read_lock or rtnl_lock is held.
J
Jason Wang 已提交
120
 */
E
Eric W. Biederman 已提交
121
struct tun_file {
J
Jason Wang 已提交
122 123
	struct sock sk;
	struct socket socket;
124
	struct tun_struct __rcu *tun;
J
Jason Wang 已提交
125 126 127
	struct fasync_struct *fasync;
	/* only used for fasnyc */
	unsigned int flags;
128 129 130 131
	union {
		u16 queue_index;
		unsigned int ifindex;
	};
132
	struct napi_struct napi;
133
	bool napi_enabled;
E
Eric Dumazet 已提交
134
	bool napi_frags_enabled;
135
	struct mutex napi_mutex;	/* Protects access to the above napi */
J
Jason Wang 已提交
136 137
	struct list_head next;
	struct tun_struct *detached;
138
	struct ptr_ring tx_ring;
J
Jesper Dangaard Brouer 已提交
139
	struct xdp_rxq_info xdp_rxq;
E
Eric W. Biederman 已提交
140 141
};

142 143 144 145 146
struct tun_page {
	struct page *page;
	int count;
};

J
Jason Wang 已提交
147 148 149 150 151 152
struct tun_flow_entry {
	struct hlist_node hash_link;
	struct rcu_head rcu;
	struct tun_struct *tun;

	u32 rxhash;
153
	u32 rps_rxhash;
J
Jason Wang 已提交
154
	int queue_index;
155
	unsigned long updated ____cacheline_aligned_in_smp;
J
Jason Wang 已提交
156 157 158
};

#define TUN_NUM_FLOW_ENTRIES 1024
L
Li RongQing 已提交
159
#define TUN_MASK_FLOW_ENTRIES (TUN_NUM_FLOW_ENTRIES - 1)
J
Jason Wang 已提交
160

161
struct tun_prog {
162 163 164 165
	struct rcu_head rcu;
	struct bpf_prog *prog;
};

J
Jason Wang 已提交
166
/* Since the socket were moved to tun_file, to preserve the behavior of persist
R
Rami Rosen 已提交
167
 * device, socket filter, sndbuf and vnet header size were restore when the
J
Jason Wang 已提交
168 169
 * file were attached to a persist device.
 */
170
struct tun_struct {
J
Jason Wang 已提交
171 172
	struct tun_file __rcu	*tfiles[MAX_TAP_QUEUES];
	unsigned int            numqueues;
173
	unsigned int 		flags;
174 175
	kuid_t			owner;
	kgid_t			group;
176 177

	struct net_device	*dev;
178
	netdev_features_t	set_features;
179
#define TUN_USER_FEATURES (NETIF_F_HW_CSUM|NETIF_F_TSO_ECN|NETIF_F_TSO| \
180
			  NETIF_F_TSO6)
181

182
	int			align;
183
	int			vnet_hdr_sz;
J
Jason Wang 已提交
184 185 186 187 188
	int			sndbuf;
	struct tap_filter	txflt;
	struct sock_fprog	fprog;
	/* protected by rtnl lock */
	bool			filter_attached;
189
	u32			msg_enable;
J
Jason Wang 已提交
190 191 192 193
	spinlock_t lock;
	struct hlist_head flows[TUN_NUM_FLOW_ENTRIES];
	struct timer_list flow_gc_timer;
	unsigned long ageing_time;
J
Jason Wang 已提交
194 195
	unsigned int numdisabled;
	struct list_head disabled;
196
	void *security;
197
	u32 flow_count;
J
Jason Wang 已提交
198
	u32 rx_batched;
199
	atomic_long_t rx_frame_errors;
J
Jason Wang 已提交
200
	struct bpf_prog __rcu *xdp_prog;
201
	struct tun_prog __rcu *steering_prog;
202
	struct tun_prog __rcu *filter_prog;
203
	struct ethtool_link_ksettings link_ksettings;
204
};
L
Linus Torvalds 已提交
205

206 207 208
struct veth {
	__be16 h_vlan_proto;
	__be16 h_vlan_TCI;
209
};
L
Linus Torvalds 已提交
210

211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251
static int tun_napi_receive(struct napi_struct *napi, int budget)
{
	struct tun_file *tfile = container_of(napi, struct tun_file, napi);
	struct sk_buff_head *queue = &tfile->sk.sk_write_queue;
	struct sk_buff_head process_queue;
	struct sk_buff *skb;
	int received = 0;

	__skb_queue_head_init(&process_queue);

	spin_lock(&queue->lock);
	skb_queue_splice_tail_init(queue, &process_queue);
	spin_unlock(&queue->lock);

	while (received < budget && (skb = __skb_dequeue(&process_queue))) {
		napi_gro_receive(napi, skb);
		++received;
	}

	if (!skb_queue_empty(&process_queue)) {
		spin_lock(&queue->lock);
		skb_queue_splice(&process_queue, queue);
		spin_unlock(&queue->lock);
	}

	return received;
}

static int tun_napi_poll(struct napi_struct *napi, int budget)
{
	unsigned int received;

	received = tun_napi_receive(napi, budget);

	if (received < budget)
		napi_complete_done(napi, received);

	return received;
}

static void tun_napi_init(struct tun_struct *tun, struct tun_file *tfile,
E
Eric Dumazet 已提交
252
			  bool napi_en, bool napi_frags)
253
{
254
	tfile->napi_enabled = napi_en;
E
Eric Dumazet 已提交
255
	tfile->napi_frags_enabled = napi_en && napi_frags;
256
	if (napi_en) {
257 258
		netif_tx_napi_add(tun->dev, &tfile->napi, tun_napi_poll,
				  NAPI_POLL_WEIGHT);
259 260 261 262
		napi_enable(&tfile->napi);
	}
}

E
Eric Dumazet 已提交
263
static void tun_napi_disable(struct tun_file *tfile)
264
{
265
	if (tfile->napi_enabled)
266 267 268
		napi_disable(&tfile->napi);
}

E
Eric Dumazet 已提交
269
static void tun_napi_del(struct tun_file *tfile)
270
{
271
	if (tfile->napi_enabled)
272 273 274
		netif_napi_del(&tfile->napi);
}

E
Eric Dumazet 已提交
275
static bool tun_napi_frags_enabled(const struct tun_file *tfile)
276
{
E
Eric Dumazet 已提交
277
	return tfile->napi_frags_enabled;
278 279
}

280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327
#ifdef CONFIG_TUN_VNET_CROSS_LE
static inline bool tun_legacy_is_little_endian(struct tun_struct *tun)
{
	return tun->flags & TUN_VNET_BE ? false :
		virtio_legacy_is_little_endian();
}

static long tun_get_vnet_be(struct tun_struct *tun, int __user *argp)
{
	int be = !!(tun->flags & TUN_VNET_BE);

	if (put_user(be, argp))
		return -EFAULT;

	return 0;
}

static long tun_set_vnet_be(struct tun_struct *tun, int __user *argp)
{
	int be;

	if (get_user(be, argp))
		return -EFAULT;

	if (be)
		tun->flags |= TUN_VNET_BE;
	else
		tun->flags &= ~TUN_VNET_BE;

	return 0;
}
#else
static inline bool tun_legacy_is_little_endian(struct tun_struct *tun)
{
	return virtio_legacy_is_little_endian();
}

static long tun_get_vnet_be(struct tun_struct *tun, int __user *argp)
{
	return -EINVAL;
}

static long tun_set_vnet_be(struct tun_struct *tun, int __user *argp)
{
	return -EINVAL;
}
#endif /* CONFIG_TUN_VNET_CROSS_LE */

328 329
static inline bool tun_is_little_endian(struct tun_struct *tun)
{
330
	return tun->flags & TUN_VNET_LE ||
331
		tun_legacy_is_little_endian(tun);
332 333
}

334 335
static inline u16 tun16_to_cpu(struct tun_struct *tun, __virtio16 val)
{
336
	return __virtio16_to_cpu(tun_is_little_endian(tun), val);
337 338 339 340
}

static inline __virtio16 cpu_to_tun16(struct tun_struct *tun, u16 val)
{
341
	return __cpu_to_virtio16(tun_is_little_endian(tun), val);
342 343
}

J
Jason Wang 已提交
344 345
static inline u32 tun_hashfn(u32 rxhash)
{
L
Li RongQing 已提交
346
	return rxhash & TUN_MASK_FLOW_ENTRIES;
J
Jason Wang 已提交
347 348 349 350 351 352
}

static struct tun_flow_entry *tun_flow_find(struct hlist_head *head, u32 rxhash)
{
	struct tun_flow_entry *e;

353
	hlist_for_each_entry_rcu(e, head, hash_link) {
J
Jason Wang 已提交
354 355 356 357 358 359 360 361 362 363
		if (e->rxhash == rxhash)
			return e;
	}
	return NULL;
}

static struct tun_flow_entry *tun_flow_create(struct tun_struct *tun,
					      struct hlist_head *head,
					      u32 rxhash, u16 queue_index)
{
364 365
	struct tun_flow_entry *e = kmalloc(sizeof(*e), GFP_ATOMIC);

J
Jason Wang 已提交
366
	if (e) {
367 368 369
		netif_info(tun, tx_queued, tun->dev,
			   "create flow: hash %u index %u\n",
			   rxhash, queue_index);
J
Jason Wang 已提交
370 371
		e->updated = jiffies;
		e->rxhash = rxhash;
372
		e->rps_rxhash = 0;
J
Jason Wang 已提交
373 374 375
		e->queue_index = queue_index;
		e->tun = tun;
		hlist_add_head_rcu(&e->hash_link, head);
376
		++tun->flow_count;
J
Jason Wang 已提交
377 378 379 380 381 382
	}
	return e;
}

static void tun_flow_delete(struct tun_struct *tun, struct tun_flow_entry *e)
{
383 384
	netif_info(tun, tx_queued, tun->dev, "delete flow: hash %u index %u\n",
		   e->rxhash, e->queue_index);
J
Jason Wang 已提交
385
	hlist_del_rcu(&e->hash_link);
386
	kfree_rcu(e, rcu);
387
	--tun->flow_count;
J
Jason Wang 已提交
388 389 390 391 392 393 394 395 396
}

static void tun_flow_flush(struct tun_struct *tun)
{
	int i;

	spin_lock_bh(&tun->lock);
	for (i = 0; i < TUN_NUM_FLOW_ENTRIES; i++) {
		struct tun_flow_entry *e;
397
		struct hlist_node *n;
J
Jason Wang 已提交
398

399
		hlist_for_each_entry_safe(e, n, &tun->flows[i], hash_link)
J
Jason Wang 已提交
400 401 402 403 404 405 406 407 408 409 410 411
			tun_flow_delete(tun, e);
	}
	spin_unlock_bh(&tun->lock);
}

static void tun_flow_delete_by_queue(struct tun_struct *tun, u16 queue_index)
{
	int i;

	spin_lock_bh(&tun->lock);
	for (i = 0; i < TUN_NUM_FLOW_ENTRIES; i++) {
		struct tun_flow_entry *e;
412
		struct hlist_node *n;
J
Jason Wang 已提交
413

414
		hlist_for_each_entry_safe(e, n, &tun->flows[i], hash_link) {
J
Jason Wang 已提交
415 416 417 418 419 420 421
			if (e->queue_index == queue_index)
				tun_flow_delete(tun, e);
		}
	}
	spin_unlock_bh(&tun->lock);
}

422
static void tun_flow_cleanup(struct timer_list *t)
J
Jason Wang 已提交
423
{
424
	struct tun_struct *tun = from_timer(tun, t, flow_gc_timer);
J
Jason Wang 已提交
425 426 427 428 429
	unsigned long delay = tun->ageing_time;
	unsigned long next_timer = jiffies + delay;
	unsigned long count = 0;
	int i;

430
	spin_lock(&tun->lock);
J
Jason Wang 已提交
431 432
	for (i = 0; i < TUN_NUM_FLOW_ENTRIES; i++) {
		struct tun_flow_entry *e;
433
		struct hlist_node *n;
J
Jason Wang 已提交
434

435
		hlist_for_each_entry_safe(e, n, &tun->flows[i], hash_link) {
J
Jason Wang 已提交
436
			unsigned long this_timer;
437

J
Jason Wang 已提交
438
			this_timer = e->updated + delay;
439
			if (time_before_eq(this_timer, jiffies)) {
J
Jason Wang 已提交
440
				tun_flow_delete(tun, e);
441 442 443 444
				continue;
			}
			count++;
			if (time_before(this_timer, next_timer))
J
Jason Wang 已提交
445 446 447 448 449 450
				next_timer = this_timer;
		}
	}

	if (count)
		mod_timer(&tun->flow_gc_timer, round_jiffies_up(next_timer));
451
	spin_unlock(&tun->lock);
J
Jason Wang 已提交
452 453
}

454
static void tun_flow_update(struct tun_struct *tun, u32 rxhash,
455
			    struct tun_file *tfile)
J
Jason Wang 已提交
456 457 458 459
{
	struct hlist_head *head;
	struct tun_flow_entry *e;
	unsigned long delay = tun->ageing_time;
460
	u16 queue_index = tfile->queue_index;
J
Jason Wang 已提交
461

462
	head = &tun->flows[tun_hashfn(rxhash)];
J
Jason Wang 已提交
463 464 465 466 467 468

	rcu_read_lock();

	e = tun_flow_find(head, rxhash);
	if (likely(e)) {
		/* TODO: keep queueing to old queue until it's empty? */
469 470
		if (READ_ONCE(e->queue_index) != queue_index)
			WRITE_ONCE(e->queue_index, queue_index);
471 472
		if (e->updated != jiffies)
			e->updated = jiffies;
473
		sock_rps_record_flow_hash(e->rps_rxhash);
J
Jason Wang 已提交
474 475
	} else {
		spin_lock_bh(&tun->lock);
476 477
		if (!tun_flow_find(head, rxhash) &&
		    tun->flow_count < MAX_TAP_FLOWS)
J
Jason Wang 已提交
478 479 480 481 482 483 484 485 486 487 488
			tun_flow_create(tun, head, rxhash, queue_index);

		if (!timer_pending(&tun->flow_gc_timer))
			mod_timer(&tun->flow_gc_timer,
				  round_jiffies_up(jiffies + delay));
		spin_unlock_bh(&tun->lock);
	}

	rcu_read_unlock();
}

489
/* Save the hash received in the stack receive path and update the
490 491 492 493
 * flow_hash table accordingly.
 */
static inline void tun_flow_save_rps_rxhash(struct tun_flow_entry *e, u32 hash)
{
494
	if (unlikely(e->rps_rxhash != hash))
495 496 497
		e->rps_rxhash = hash;
}

498
/* We try to identify a flow through its rxhash. The reason that
S
stephen hemminger 已提交
499
 * we do not check rxq no. is because some cards(e.g 82599), chooses
J
Jason Wang 已提交
500 501
 * the rxq based on the txq where the last packet of the flow comes. As
 * the userspace application move between processors, we may get a
502
 * different rxq no. here.
J
Jason Wang 已提交
503
 */
504
static u16 tun_automq_select_queue(struct tun_struct *tun, struct sk_buff *skb)
J
Jason Wang 已提交
505
{
J
Jason Wang 已提交
506
	struct tun_flow_entry *e;
J
Jason Wang 已提交
507 508 509
	u32 txq = 0;
	u32 numqueues = 0;

510
	numqueues = READ_ONCE(tun->numqueues);
J
Jason Wang 已提交
511

J
Jason Wang 已提交
512
	txq = __skb_get_hash_symmetric(skb);
513 514 515 516 517 518 519
	e = tun_flow_find(&tun->flows[tun_hashfn(txq)], txq);
	if (e) {
		tun_flow_save_rps_rxhash(e, txq);
		txq = e->queue_index;
	} else {
		/* use multiply and shift instead of expensive divide */
		txq = ((u64)txq * numqueues) >> 32;
J
Jason Wang 已提交
520 521 522 523 524
	}

	return txq;
}

525 526
static u16 tun_ebpf_select_queue(struct tun_struct *tun, struct sk_buff *skb)
{
527
	struct tun_prog *prog;
528
	u32 numqueues;
529 530
	u16 ret = 0;

531 532 533 534
	numqueues = READ_ONCE(tun->numqueues);
	if (!numqueues)
		return 0;

535 536 537 538
	prog = rcu_dereference(tun->steering_prog);
	if (prog)
		ret = bpf_prog_run_clear_cb(prog->prog, skb);

539
	return ret % numqueues;
540 541 542
}

static u16 tun_select_queue(struct net_device *dev, struct sk_buff *skb,
543
			    struct net_device *sb_dev)
544 545 546 547 548 549 550 551 552 553 554 555 556 557
{
	struct tun_struct *tun = netdev_priv(dev);
	u16 ret;

	rcu_read_lock();
	if (rcu_dereference(tun->steering_prog))
		ret = tun_ebpf_select_queue(tun, skb);
	else
		ret = tun_automq_select_queue(tun, skb);
	rcu_read_unlock();

	return ret;
}

558 559 560
static inline bool tun_not_capable(struct tun_struct *tun)
{
	const struct cred *cred = current_cred();
561
	struct net *net = dev_net(tun->dev);
562 563 564

	return ((uid_valid(tun->owner) && !uid_eq(cred->euid, tun->owner)) ||
		  (gid_valid(tun->group) && !in_egroup_p(tun->group))) &&
565
		!ns_capable(net->user_ns, CAP_NET_ADMIN);
566 567
}

J
Jason Wang 已提交
568 569 570 571 572 573
static void tun_set_real_num_queues(struct tun_struct *tun)
{
	netif_set_real_num_tx_queues(tun->dev, tun->numqueues);
	netif_set_real_num_rx_queues(tun->dev, tun->numqueues);
}

J
Jason Wang 已提交
574 575 576 577 578 579 580
static void tun_disable_queue(struct tun_struct *tun, struct tun_file *tfile)
{
	tfile->detached = tun;
	list_add_tail(&tfile->next, &tun->disabled);
	++tun->numdisabled;
}

J
Jason Wang 已提交
581
static struct tun_struct *tun_enable_queue(struct tun_file *tfile)
J
Jason Wang 已提交
582 583 584 585 586 587 588 589 590
{
	struct tun_struct *tun = tfile->detached;

	tfile->detached = NULL;
	list_del_init(&tfile->next);
	--tun->numdisabled;
	return tun;
}

591
void tun_ptr_free(void *ptr)
J
Jason Wang 已提交
592 593 594
{
	if (!ptr)
		return;
595 596
	if (tun_is_xdp_frame(ptr)) {
		struct xdp_frame *xdpf = tun_ptr_to_xdp(ptr);
J
Jason Wang 已提交
597

598
		xdp_return_frame(xdpf);
J
Jason Wang 已提交
599 600 601 602
	} else {
		__skb_array_destroy_skb(ptr);
	}
}
603
EXPORT_SYMBOL_GPL(tun_ptr_free);
J
Jason Wang 已提交
604

605 606
static void tun_queue_purge(struct tun_file *tfile)
{
J
Jason Wang 已提交
607
	void *ptr;
J
Jason Wang 已提交
608

J
Jason Wang 已提交
609 610
	while ((ptr = ptr_ring_consume(&tfile->tx_ring)) != NULL)
		tun_ptr_free(ptr);
J
Jason Wang 已提交
611

J
Jason Wang 已提交
612
	skb_queue_purge(&tfile->sk.sk_write_queue);
613 614 615
	skb_queue_purge(&tfile->sk.sk_error_queue);
}

J
Jason Wang 已提交
616 617 618 619 620
static void __tun_detach(struct tun_file *tfile, bool clean)
{
	struct tun_file *ntfile;
	struct tun_struct *tun;

621 622
	tun = rtnl_dereference(tfile->tun);

623
	if (tun && clean) {
E
Eric Dumazet 已提交
624 625
		tun_napi_disable(tfile);
		tun_napi_del(tfile);
626 627
	}

628
	if (tun && !tfile->detached) {
J
Jason Wang 已提交
629 630 631 632 633
		u16 index = tfile->queue_index;
		BUG_ON(index >= tun->numqueues);

		rcu_assign_pointer(tun->tfiles[index],
				   tun->tfiles[tun->numqueues - 1]);
634
		ntfile = rtnl_dereference(tun->tfiles[index]);
J
Jason Wang 已提交
635
		ntfile->queue_index = index;
636 637
		rcu_assign_pointer(tun->tfiles[tun->numqueues - 1],
				   NULL);
J
Jason Wang 已提交
638 639

		--tun->numqueues;
640
		if (clean) {
641
			RCU_INIT_POINTER(tfile->tun, NULL);
J
Jason Wang 已提交
642
			sock_put(&tfile->sk);
643
		} else
J
Jason Wang 已提交
644
			tun_disable_queue(tun, tfile);
J
Jason Wang 已提交
645 646

		synchronize_net();
J
Jason Wang 已提交
647
		tun_flow_delete_by_queue(tun, tun->numqueues + 1);
J
Jason Wang 已提交
648
		/* Drop read queue */
649
		tun_queue_purge(tfile);
J
Jason Wang 已提交
650
		tun_set_real_num_queues(tun);
J
Jason Wang 已提交
651
	} else if (tfile->detached && clean) {
J
Jason Wang 已提交
652
		tun = tun_enable_queue(tfile);
J
Jason Wang 已提交
653 654
		sock_put(&tfile->sk);
	}
J
Jason Wang 已提交
655 656

	if (clean) {
657 658 659
		if (tun && tun->numqueues == 0 && tun->numdisabled == 0) {
			netif_carrier_off(tun->dev);

M
Michael S. Tsirkin 已提交
660
			if (!(tun->flags & IFF_PERSIST) &&
661
			    tun->dev->reg_state == NETREG_REGISTERED)
J
Jason Wang 已提交
662
				unregister_netdevice(tun->dev);
663
		}
664 665
		if (tun)
			xdp_rxq_info_unreg(&tfile->xdp_rxq);
666
		ptr_ring_cleanup(&tfile->tx_ring, tun_ptr_free);
667
		sock_put(&tfile->sk);
J
Jason Wang 已提交
668 669 670 671 672
	}
}

static void tun_detach(struct tun_file *tfile, bool clean)
{
673 674 675
	struct tun_struct *tun;
	struct net_device *dev;

J
Jason Wang 已提交
676
	rtnl_lock();
677 678
	tun = rtnl_dereference(tfile->tun);
	dev = tun ? tun->dev : NULL;
J
Jason Wang 已提交
679
	__tun_detach(tfile, clean);
680 681
	if (dev)
		netdev_state_change(dev);
J
Jason Wang 已提交
682 683 684 685 686 687
	rtnl_unlock();
}

static void tun_detach_all(struct net_device *dev)
{
	struct tun_struct *tun = netdev_priv(dev);
J
Jason Wang 已提交
688
	struct tun_file *tfile, *tmp;
J
Jason Wang 已提交
689 690 691
	int i, n = tun->numqueues;

	for (i = 0; i < n; i++) {
692
		tfile = rtnl_dereference(tun->tfiles[i]);
J
Jason Wang 已提交
693
		BUG_ON(!tfile);
E
Eric Dumazet 已提交
694
		tun_napi_disable(tfile);
695
		tfile->socket.sk->sk_shutdown = RCV_SHUTDOWN;
696
		tfile->socket.sk->sk_data_ready(tfile->socket.sk);
697
		RCU_INIT_POINTER(tfile->tun, NULL);
J
Jason Wang 已提交
698 699
		--tun->numqueues;
	}
700
	list_for_each_entry(tfile, &tun->disabled, next) {
701
		tfile->socket.sk->sk_shutdown = RCV_SHUTDOWN;
702
		tfile->socket.sk->sk_data_ready(tfile->socket.sk);
703
		RCU_INIT_POINTER(tfile->tun, NULL);
704
	}
J
Jason Wang 已提交
705 706 707 708
	BUG_ON(tun->numqueues != 0);

	synchronize_net();
	for (i = 0; i < n; i++) {
709
		tfile = rtnl_dereference(tun->tfiles[i]);
E
Eric Dumazet 已提交
710
		tun_napi_del(tfile);
J
Jason Wang 已提交
711
		/* Drop read queue */
712
		tun_queue_purge(tfile);
713
		xdp_rxq_info_unreg(&tfile->xdp_rxq);
J
Jason Wang 已提交
714 715
		sock_put(&tfile->sk);
	}
J
Jason Wang 已提交
716 717
	list_for_each_entry_safe(tfile, tmp, &tun->disabled, next) {
		tun_enable_queue(tfile);
718
		tun_queue_purge(tfile);
719
		xdp_rxq_info_unreg(&tfile->xdp_rxq);
J
Jason Wang 已提交
720 721 722
		sock_put(&tfile->sk);
	}
	BUG_ON(tun->numdisabled != 0);
J
Jason Wang 已提交
723

M
Michael S. Tsirkin 已提交
724
	if (tun->flags & IFF_PERSIST)
J
Jason Wang 已提交
725
		module_put(THIS_MODULE);
J
Jason Wang 已提交
726 727
}

728
static int tun_attach(struct tun_struct *tun, struct file *file,
729 730
		      bool skip_filter, bool napi, bool napi_frags,
		      bool publish_tun)
731
{
E
Eric W. Biederman 已提交
732
	struct tun_file *tfile = file->private_data;
J
Jason Wang 已提交
733
	struct net_device *dev = tun->dev;
734
	int err;
735

736 737 738 739
	err = security_tun_dev_attach(tfile->socket.sk, tun->security);
	if (err < 0)
		goto out;

740
	err = -EINVAL;
741
	if (rtnl_dereference(tfile->tun) && !tfile->detached)
742 743 744
		goto out;

	err = -EBUSY;
M
Michael S. Tsirkin 已提交
745
	if (!(tun->flags & IFF_MULTI_QUEUE) && tun->numqueues == 1)
J
Jason Wang 已提交
746 747 748
		goto out;

	err = -E2BIG;
J
Jason Wang 已提交
749 750
	if (!tfile->detached &&
	    tun->numqueues + tun->numdisabled == MAX_TAP_QUEUES)
751 752 753
		goto out;

	err = 0;
J
Jason Wang 已提交
754

S
stephen hemminger 已提交
755
	/* Re-attach the filter to persist device */
756
	if (!skip_filter && (tun->filter_attached == true)) {
757 758 759
		lock_sock(tfile->socket.sk);
		err = sk_attach_filter(&tun->fprog, tfile->socket.sk);
		release_sock(tfile->socket.sk);
J
Jason Wang 已提交
760 761 762
		if (!err)
			goto out;
	}
J
Jason Wang 已提交
763 764

	if (!tfile->detached &&
765 766
	    ptr_ring_resize(&tfile->tx_ring, dev->tx_queue_len,
			    GFP_KERNEL, tun_ptr_free)) {
J
Jason Wang 已提交
767 768 769 770
		err = -ENOMEM;
		goto out;
	}

J
Jason Wang 已提交
771
	tfile->queue_index = tun->numqueues;
772
	tfile->socket.sk->sk_shutdown &= ~RCV_SHUTDOWN;
J
Jesper Dangaard Brouer 已提交
773 774 775 776 777 778 779 780 781 782 783 784 785

	if (tfile->detached) {
		/* Re-attach detached tfile, updating XDP queue_index */
		WARN_ON(!xdp_rxq_info_is_reg(&tfile->xdp_rxq));

		if (tfile->xdp_rxq.queue_index    != tfile->queue_index)
			tfile->xdp_rxq.queue_index = tfile->queue_index;
	} else {
		/* Setup XDP RX-queue info, for new tfile getting attached */
		err = xdp_rxq_info_reg(&tfile->xdp_rxq,
				       tun->dev, tfile->queue_index);
		if (err < 0)
			goto out;
786 787 788 789 790 791
		err = xdp_rxq_info_reg_mem_model(&tfile->xdp_rxq,
						 MEM_TYPE_PAGE_SHARED, NULL);
		if (err < 0) {
			xdp_rxq_info_unreg(&tfile->xdp_rxq);
			goto out;
		}
J
Jesper Dangaard Brouer 已提交
792 793 794
		err = 0;
	}

795
	if (tfile->detached) {
J
Jason Wang 已提交
796
		tun_enable_queue(tfile);
797
	} else {
J
Jason Wang 已提交
798
		sock_hold(&tfile->sk);
E
Eric Dumazet 已提交
799
		tun_napi_init(tun, tfile, napi, napi_frags);
800
	}
J
Jason Wang 已提交
801

J
Jason Wang 已提交
802 803 804
	if (rtnl_dereference(tun->xdp_prog))
		sock_set_flag(&tfile->sk, SOCK_XDP);

J
Jason Wang 已提交
805 806 807 808
	/* device is allowed to go away first, so no need to hold extra
	 * refcnt.
	 */

809 810 811 812
	/* Publish tfile->tun and tun->tfiles only after we've fully
	 * initialized tfile; otherwise we risk using half-initialized
	 * object.
	 */
813 814
	if (publish_tun)
		rcu_assign_pointer(tfile->tun, tun);
815 816
	rcu_assign_pointer(tun->tfiles[tun->numqueues], tfile);
	tun->numqueues++;
817
	tun_set_real_num_queues(tun);
J
Jason Wang 已提交
818 819
out:
	return err;
E
Eric W. Biederman 已提交
820 821
}

822
static struct tun_struct *tun_get(struct tun_file *tfile)
E
Eric W. Biederman 已提交
823
{
824
	struct tun_struct *tun;
825

826 827 828 829 830
	rcu_read_lock();
	tun = rcu_dereference(tfile->tun);
	if (tun)
		dev_hold(tun->dev);
	rcu_read_unlock();
831 832

	return tun;
E
Eric W. Biederman 已提交
833 834 835 836
}

static void tun_put(struct tun_struct *tun)
{
837
	dev_put(tun->dev);
E
Eric W. Biederman 已提交
838 839
}

840
/* TAP filtering */
841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868
static void addr_hash_set(u32 *mask, const u8 *addr)
{
	int n = ether_crc(ETH_ALEN, addr) >> 26;
	mask[n >> 5] |= (1 << (n & 31));
}

static unsigned int addr_hash_test(const u32 *mask, const u8 *addr)
{
	int n = ether_crc(ETH_ALEN, addr) >> 26;
	return mask[n >> 5] & (1 << (n & 31));
}

static int update_filter(struct tap_filter *filter, void __user *arg)
{
	struct { u8 u[ETH_ALEN]; } *addr;
	struct tun_filter uf;
	int err, alen, n, nexact;

	if (copy_from_user(&uf, arg, sizeof(uf)))
		return -EFAULT;

	if (!uf.count) {
		/* Disabled */
		filter->count = 0;
		return 0;
	}

	alen = ETH_ALEN * uf.count;
869 870 871
	addr = memdup_user(arg + sizeof(uf), alen);
	if (IS_ERR(addr))
		return PTR_ERR(addr);
872 873 874 875 876 877 878 879 880 881 882 883 884

	/* The filter is updated without holding any locks. Which is
	 * perfectly safe. We disable it first and in the worst
	 * case we'll accept a few undesired packets. */
	filter->count = 0;
	wmb();

	/* Use first set of addresses as an exact filter */
	for (n = 0; n < uf.count && n < FLT_EXACT_COUNT; n++)
		memcpy(filter->addr[n], addr[n].u, ETH_ALEN);

	nexact = n;

885 886
	/* Remaining multicast addresses are hashed,
	 * unicast will leave the filter disabled. */
887
	memset(filter->mask, 0, sizeof(filter->mask));
888 889 890
	for (; n < uf.count; n++) {
		if (!is_multicast_ether_addr(addr[n].u)) {
			err = 0; /* no filter */
891
			goto free_addr;
892
		}
893
		addr_hash_set(filter->mask, addr[n].u);
894
	}
895 896 897 898 899 900 901 902 903 904 905 906

	/* For ALLMULTI just set the mask to all ones.
	 * This overrides the mask populated above. */
	if ((uf.flags & TUN_FLT_ALLMULTI))
		memset(filter->mask, ~0, sizeof(filter->mask));

	/* Now enable the filter */
	wmb();
	filter->count = nexact;

	/* Return the number of exact filters */
	err = nexact;
907
free_addr:
908 909 910 911 912 913 914 915 916 917 918 919 920 921
	kfree(addr);
	return err;
}

/* Returns: 0 - drop, !=0 - accept */
static int run_filter(struct tap_filter *filter, const struct sk_buff *skb)
{
	/* Cannot use eth_hdr(skb) here because skb_mac_hdr() is incorrect
	 * at this point. */
	struct ethhdr *eh = (struct ethhdr *) skb->data;
	int i;

	/* Exact match */
	for (i = 0; i < filter->count; i++)
922
		if (ether_addr_equal(eh->h_dest, filter->addr[i]))
923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943
			return 1;

	/* Inexact match (multicast only) */
	if (is_multicast_ether_addr(eh->h_dest))
		return addr_hash_test(filter->mask, eh->h_dest);

	return 0;
}

/*
 * Checks whether the packet is accepted or not.
 * Returns: 0 - drop, !=0 - accept
 */
static int check_filter(struct tap_filter *filter, const struct sk_buff *skb)
{
	if (!filter->count)
		return 1;

	return run_filter(filter, skb);
}

L
Linus Torvalds 已提交
944 945
/* Network device part of the driver */

946
static const struct ethtool_ops tun_ethtool_ops;
L
Linus Torvalds 已提交
947

948 949 950
/* Net device detach from fd. */
static void tun_net_uninit(struct net_device *dev)
{
J
Jason Wang 已提交
951
	tun_detach_all(dev);
952 953
}

L
Linus Torvalds 已提交
954 955 956
/* Net device open. */
static int tun_net_open(struct net_device *dev)
{
J
Jason Wang 已提交
957
	netif_tx_start_all_queues(dev);
958

L
Linus Torvalds 已提交
959 960 961 962 963 964
	return 0;
}

/* Net device close. */
static int tun_net_close(struct net_device *dev)
{
J
Jason Wang 已提交
965
	netif_tx_stop_all_queues(dev);
L
Linus Torvalds 已提交
966 967 968 969
	return 0;
}

/* Net device start xmit */
970
static void tun_automq_xmit(struct tun_struct *tun, struct sk_buff *skb)
L
Linus Torvalds 已提交
971
{
972
#ifdef CONFIG_RPS
973
	if (tun->numqueues == 1 && static_branch_unlikely(&rps_needed)) {
974 975 976
		/* Select queue was not called for the skbuff, so we extract the
		 * RPS hash and save it into the flow_table here.
		 */
977
		struct tun_flow_entry *e;
978 979
		__u32 rxhash;

J
Jason Wang 已提交
980
		rxhash = __skb_get_hash_symmetric(skb);
981 982 983
		e = tun_flow_find(&tun->flows[tun_hashfn(rxhash)], rxhash);
		if (e)
			tun_flow_save_rps_rxhash(e, rxhash);
984
	}
985
#endif
986 987
}

988 989 990 991 992 993 994 995 996 997 998 999
static unsigned int run_ebpf_filter(struct tun_struct *tun,
				    struct sk_buff *skb,
				    int len)
{
	struct tun_prog *prog = rcu_dereference(tun->filter_prog);

	if (prog)
		len = bpf_prog_run_clear_cb(prog->prog, skb);

	return len;
}

1000 1001 1002 1003 1004 1005
/* Net device start xmit */
static netdev_tx_t tun_net_xmit(struct sk_buff *skb, struct net_device *dev)
{
	struct tun_struct *tun = netdev_priv(dev);
	int txq = skb->queue_mapping;
	struct tun_file *tfile;
1006
	int len = skb->len;
1007 1008 1009 1010 1011

	rcu_read_lock();
	tfile = rcu_dereference(tun->tfiles[txq]);

	/* Drop packet if interface is not attached */
1012
	if (!tfile)
1013 1014 1015 1016
		goto drop;

	if (!rcu_dereference(tun->steering_prog))
		tun_automq_xmit(tun, skb);
1017

1018
	netif_info(tun, tx_queued, tun->dev, "%s %d\n", __func__, skb->len);
1019

1020 1021 1022 1023 1024 1025
	/* Drop if the filter does not like it.
	 * This is a noop if the filter is disabled.
	 * Filter can be enabled only for the TAP devices. */
	if (!check_filter(&tun->txflt, skb))
		goto drop;

J
Jason Wang 已提交
1026 1027
	if (tfile->socket.sk->sk_filter &&
	    sk_filter(tfile->socket.sk, skb))
M
Michael S. Tsirkin 已提交
1028 1029
		goto drop;

1030
	len = run_ebpf_filter(tun, skb, len);
B
Bjørn Mork 已提交
1031
	if (len == 0 || pskb_trim(skb, len))
1032 1033
		goto drop;

W
Willem de Bruijn 已提交
1034
	if (unlikely(skb_orphan_frags_rx(skb, GFP_ATOMIC)))
1035 1036
		goto drop;

1037
	skb_tx_timestamp(skb);
1038

M
Michael S. Tsirkin 已提交
1039
	/* Orphan the skb - required as we might hang on to it
1040 1041
	 * for indefinite time.
	 */
M
Michael S. Tsirkin 已提交
1042 1043
	skb_orphan(skb);

1044
	nf_reset_ct(skb);
1045

1046
	if (ptr_ring_produce(&tfile->tx_ring, skb))
J
Jason Wang 已提交
1047
		goto drop;
L
Linus Torvalds 已提交
1048 1049

	/* Notify and wake up reader process */
J
Jason Wang 已提交
1050 1051
	if (tfile->flags & TUN_FASYNC)
		kill_fasync(&tfile->fasync, SIGIO, POLL_IN);
1052
	tfile->socket.sk->sk_data_ready(tfile->socket.sk);
1053 1054

	rcu_read_unlock();
1055
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
1056 1057

drop:
1058
	atomic_long_inc(&dev->tx_dropped);
1059
	skb_tx_error(skb);
L
Linus Torvalds 已提交
1060
	kfree_skb(skb);
1061
	rcu_read_unlock();
1062
	return NET_XMIT_DROP;
L
Linus Torvalds 已提交
1063 1064
}

1065
static void tun_net_mclist(struct net_device *dev)
L
Linus Torvalds 已提交
1066
{
1067 1068 1069 1070 1071
	/*
	 * This callback is supposed to deal with mc filter in
	 * _rx_ path and has nothing to do with the _tx_ path.
	 * In rx path we always accept everything userspace gives us.
	 */
L
Linus Torvalds 已提交
1072 1073
}

1074 1075
static netdev_features_t tun_net_fix_features(struct net_device *dev,
	netdev_features_t features)
1076 1077 1078 1079 1080
{
	struct tun_struct *tun = netdev_priv(dev);

	return (features & tun->set_features) | (features & ~TUN_USER_FEATURES);
}
1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091

static void tun_set_headroom(struct net_device *dev, int new_hr)
{
	struct tun_struct *tun = netdev_priv(dev);

	if (new_hr < NET_SKB_PAD)
		new_hr = NET_SKB_PAD;

	tun->align = new_hr;
}

1092
static void
1093 1094 1095 1096
tun_net_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *stats)
{
	struct tun_struct *tun = netdev_priv(dev);

1097
	dev_get_tstats64(dev, stats);
1098

1099 1100
	stats->rx_frame_errors +=
		(unsigned long)atomic_long_read(&tun->rx_frame_errors);
1101 1102
}

J
Jason Wang 已提交
1103 1104 1105 1106
static int tun_xdp_set(struct net_device *dev, struct bpf_prog *prog,
		       struct netlink_ext_ack *extack)
{
	struct tun_struct *tun = netdev_priv(dev);
J
Jason Wang 已提交
1107
	struct tun_file *tfile;
J
Jason Wang 已提交
1108
	struct bpf_prog *old_prog;
J
Jason Wang 已提交
1109
	int i;
J
Jason Wang 已提交
1110 1111 1112 1113 1114 1115

	old_prog = rtnl_dereference(tun->xdp_prog);
	rcu_assign_pointer(tun->xdp_prog, prog);
	if (old_prog)
		bpf_prog_put(old_prog);

J
Jason Wang 已提交
1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129
	for (i = 0; i < tun->numqueues; i++) {
		tfile = rtnl_dereference(tun->tfiles[i]);
		if (prog)
			sock_set_flag(&tfile->sk, SOCK_XDP);
		else
			sock_reset_flag(&tfile->sk, SOCK_XDP);
	}
	list_for_each_entry(tfile, &tun->disabled, next) {
		if (prog)
			sock_set_flag(&tfile->sk, SOCK_XDP);
		else
			sock_reset_flag(&tfile->sk, SOCK_XDP);
	}

J
Jason Wang 已提交
1130 1131 1132
	return 0;
}

1133
static int tun_xdp(struct net_device *dev, struct netdev_bpf *xdp)
J
Jason Wang 已提交
1134 1135 1136 1137 1138 1139 1140 1141 1142
{
	switch (xdp->command) {
	case XDP_SETUP_PROG:
		return tun_xdp_set(dev, xdp->prog, xdp->extack);
	default:
		return -EINVAL;
	}
}

N
Nicolas Dichtel 已提交
1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157
static int tun_net_change_carrier(struct net_device *dev, bool new_carrier)
{
	if (new_carrier) {
		struct tun_struct *tun = netdev_priv(dev);

		if (!tun->numqueues)
			return -EPERM;

		netif_carrier_on(dev);
	} else {
		netif_carrier_off(dev);
	}
	return 0;
}

S
Stephen Hemminger 已提交
1158
static const struct net_device_ops tun_netdev_ops = {
1159
	.ndo_uninit		= tun_net_uninit,
S
Stephen Hemminger 已提交
1160 1161
	.ndo_open		= tun_net_open,
	.ndo_stop		= tun_net_close,
1162
	.ndo_start_xmit		= tun_net_xmit,
1163
	.ndo_fix_features	= tun_net_fix_features,
J
Jason Wang 已提交
1164
	.ndo_select_queue	= tun_select_queue,
1165
	.ndo_set_rx_headroom	= tun_set_headroom,
1166
	.ndo_get_stats64	= tun_net_get_stats64,
N
Nicolas Dichtel 已提交
1167
	.ndo_change_carrier	= tun_net_change_carrier,
S
Stephen Hemminger 已提交
1168 1169
};

1170 1171 1172 1173 1174 1175 1176 1177
static void __tun_xdp_flush_tfile(struct tun_file *tfile)
{
	/* Notify and wake up reader process */
	if (tfile->flags & TUN_FASYNC)
		kill_fasync(&tfile->fasync, SIGIO, POLL_IN);
	tfile->socket.sk->sk_data_ready(tfile->socket.sk);
}

1178 1179
static int tun_xdp_xmit(struct net_device *dev, int n,
			struct xdp_frame **frames, u32 flags)
J
Jason Wang 已提交
1180 1181 1182 1183
{
	struct tun_struct *tun = netdev_priv(dev);
	struct tun_file *tfile;
	u32 numqueues;
1184 1185 1186
	int drops = 0;
	int cnt = n;
	int i;
J
Jason Wang 已提交
1187

1188
	if (unlikely(flags & ~XDP_XMIT_FLAGS_MASK))
1189 1190
		return -EINVAL;

J
Jason Wang 已提交
1191 1192
	rcu_read_lock();

1193
resample:
J
Jason Wang 已提交
1194 1195
	numqueues = READ_ONCE(tun->numqueues);
	if (!numqueues) {
1196 1197
		rcu_read_unlock();
		return -ENXIO; /* Caller will free/return all frames */
J
Jason Wang 已提交
1198 1199 1200 1201
	}

	tfile = rcu_dereference(tun->tfiles[smp_processor_id() %
					    numqueues]);
1202 1203
	if (unlikely(!tfile))
		goto resample;
1204 1205 1206 1207 1208 1209 1210 1211 1212 1213

	spin_lock(&tfile->tx_ring.producer_lock);
	for (i = 0; i < n; i++) {
		struct xdp_frame *xdp = frames[i];
		/* Encode the XDP flag into lowest bit for consumer to differ
		 * XDP buffer from sk_buff.
		 */
		void *frame = tun_xdp_to_ptr(xdp);

		if (__ptr_ring_produce(&tfile->tx_ring, frame)) {
1214
			atomic_long_inc(&dev->tx_dropped);
1215 1216 1217
			xdp_return_frame_rx_napi(xdp);
			drops++;
		}
J
Jason Wang 已提交
1218
	}
1219
	spin_unlock(&tfile->tx_ring.producer_lock);
J
Jason Wang 已提交
1220

1221 1222 1223
	if (flags & XDP_XMIT_FLUSH)
		__tun_xdp_flush_tfile(tfile);

J
Jason Wang 已提交
1224
	rcu_read_unlock();
1225
	return cnt - drops;
J
Jason Wang 已提交
1226 1227
}

1228 1229
static int tun_xdp_tx(struct net_device *dev, struct xdp_buff *xdp)
{
1230
	struct xdp_frame *frame = xdp_convert_buff_to_frame(xdp);
1231 1232 1233 1234

	if (unlikely(!frame))
		return -EOVERFLOW;

1235
	return tun_xdp_xmit(dev, 1, &frame, XDP_XMIT_FLUSH);
J
Jason Wang 已提交
1236 1237
}

S
Stephen Hemminger 已提交
1238
static const struct net_device_ops tap_netdev_ops = {
1239
	.ndo_uninit		= tun_net_uninit,
S
Stephen Hemminger 已提交
1240 1241
	.ndo_open		= tun_net_open,
	.ndo_stop		= tun_net_close,
1242
	.ndo_start_xmit		= tun_net_xmit,
1243
	.ndo_fix_features	= tun_net_fix_features,
1244
	.ndo_set_rx_mode	= tun_net_mclist,
S
Stephen Hemminger 已提交
1245 1246
	.ndo_set_mac_address	= eth_mac_addr,
	.ndo_validate_addr	= eth_validate_addr,
J
Jason Wang 已提交
1247
	.ndo_select_queue	= tun_select_queue,
1248
	.ndo_features_check	= passthru_features_check,
1249
	.ndo_set_rx_headroom	= tun_set_headroom,
1250
	.ndo_get_stats64	= dev_get_tstats64,
1251
	.ndo_bpf		= tun_xdp,
J
Jason Wang 已提交
1252
	.ndo_xdp_xmit		= tun_xdp_xmit,
N
Nicolas Dichtel 已提交
1253
	.ndo_change_carrier	= tun_net_change_carrier,
S
Stephen Hemminger 已提交
1254 1255
};

1256
static void tun_flow_init(struct tun_struct *tun)
J
Jason Wang 已提交
1257 1258 1259 1260 1261 1262 1263
{
	int i;

	for (i = 0; i < TUN_NUM_FLOW_ENTRIES; i++)
		INIT_HLIST_HEAD(&tun->flows[i]);

	tun->ageing_time = TUN_FLOW_EXPIRE;
1264 1265 1266
	timer_setup(&tun->flow_gc_timer, tun_flow_cleanup, 0);
	mod_timer(&tun->flow_gc_timer,
		  round_jiffies_up(jiffies + tun->ageing_time));
J
Jason Wang 已提交
1267 1268 1269 1270 1271 1272 1273 1274
}

static void tun_flow_uninit(struct tun_struct *tun)
{
	del_timer_sync(&tun->flow_gc_timer);
	tun_flow_flush(tun);
}

1275 1276 1277
#define MIN_MTU 68
#define MAX_MTU 65535

L
Linus Torvalds 已提交
1278 1279 1280 1281
/* Initialize net device. */
static void tun_net_init(struct net_device *dev)
{
	struct tun_struct *tun = netdev_priv(dev);
1282

L
Linus Torvalds 已提交
1283
	switch (tun->flags & TUN_TYPE_MASK) {
M
Michael S. Tsirkin 已提交
1284
	case IFF_TUN:
S
Stephen Hemminger 已提交
1285
		dev->netdev_ops = &tun_netdev_ops;
1286
		dev->header_ops = &ip_tunnel_header_ops;
S
Stephen Hemminger 已提交
1287

L
Linus Torvalds 已提交
1288 1289 1290 1291 1292 1293
		/* Point-to-Point TUN Device */
		dev->hard_header_len = 0;
		dev->addr_len = 0;
		dev->mtu = 1500;

		/* Zero header length */
1294
		dev->type = ARPHRD_NONE;
L
Linus Torvalds 已提交
1295 1296 1297
		dev->flags = IFF_POINTOPOINT | IFF_NOARP | IFF_MULTICAST;
		break;

M
Michael S. Tsirkin 已提交
1298
	case IFF_TAP:
K
Kusanagi Kouichi 已提交
1299
		dev->netdev_ops = &tap_netdev_ops;
L
Linus Torvalds 已提交
1300 1301
		/* Ethernet TAP Device */
		ether_setup(dev);
1302
		dev->priv_flags &= ~IFF_TX_SKB_SHARING;
1303
		dev->priv_flags |= IFF_LIVE_ADDR_CHANGE;
1304

1305
		eth_hw_addr_random(dev);
1306

L
Linus Torvalds 已提交
1307 1308
		break;
	}
1309 1310 1311

	dev->min_mtu = MIN_MTU;
	dev->max_mtu = MAX_MTU - dev->hard_header_len;
L
Linus Torvalds 已提交
1312 1313
}

1314 1315 1316 1317 1318 1319 1320
static bool tun_sock_writeable(struct tun_struct *tun, struct tun_file *tfile)
{
	struct sock *sk = tfile->socket.sk;

	return (tun->dev->flags & IFF_UP) && sock_writeable(sk);
}

L
Linus Torvalds 已提交
1321 1322 1323
/* Character device part */

/* Poll */
1324
static __poll_t tun_chr_poll(struct file *file, poll_table *wait)
1325
{
1326
	struct tun_file *tfile = file->private_data;
1327
	struct tun_struct *tun = tun_get(tfile);
1328
	struct sock *sk;
1329
	__poll_t mask = 0;
L
Linus Torvalds 已提交
1330 1331

	if (!tun)
1332
		return EPOLLERR;
L
Linus Torvalds 已提交
1333

J
Jason Wang 已提交
1334
	sk = tfile->socket.sk;
1335

1336
	poll_wait(file, sk_sleep(sk), wait);
1337

1338
	if (!ptr_ring_empty(&tfile->tx_ring))
1339
		mask |= EPOLLIN | EPOLLRDNORM;
L
Linus Torvalds 已提交
1340

1341 1342 1343 1344 1345 1346 1347 1348
	/* Make sure SOCKWQ_ASYNC_NOSPACE is set if not writable to
	 * guarantee EPOLLOUT to be raised by either here or
	 * tun_sock_write_space(). Then process could get notification
	 * after it writes to a down device and meets -EIO.
	 */
	if (tun_sock_writeable(tun, tfile) ||
	    (!test_and_set_bit(SOCKWQ_ASYNC_NOSPACE, &sk->sk_socket->flags) &&
	     tun_sock_writeable(tun, tfile)))
1349
		mask |= EPOLLOUT | EPOLLWRNORM;
1350

1351
	if (tun->dev->reg_state != NETREG_REGISTERED)
1352
		mask = EPOLLERR;
1353

E
Eric W. Biederman 已提交
1354
	tun_put(tun);
L
Linus Torvalds 已提交
1355 1356 1357
	return mask;
}

1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386
static struct sk_buff *tun_napi_alloc_frags(struct tun_file *tfile,
					    size_t len,
					    const struct iov_iter *it)
{
	struct sk_buff *skb;
	size_t linear;
	int err;
	int i;

	if (it->nr_segs > MAX_SKB_FRAGS + 1)
		return ERR_PTR(-ENOMEM);

	local_bh_disable();
	skb = napi_get_frags(&tfile->napi);
	local_bh_enable();
	if (!skb)
		return ERR_PTR(-ENOMEM);

	linear = iov_iter_single_seg_count(it);
	err = __skb_grow(skb, linear);
	if (err)
		goto free;

	skb->len = len;
	skb->data_len = len - linear;
	skb->truesize += skb->data_len;

	for (i = 1; i < it->nr_segs; i++) {
		size_t fragsz = it->iov[i].iov_len;
1387 1388
		struct page *page;
		void *frag;
1389 1390 1391 1392 1393

		if (fragsz == 0 || fragsz > PAGE_SIZE) {
			err = -EINVAL;
			goto free;
		}
1394 1395
		frag = netdev_alloc_frag(fragsz);
		if (!frag) {
1396 1397 1398
			err = -ENOMEM;
			goto free;
		}
1399 1400 1401
		page = virt_to_head_page(frag);
		skb_fill_page_desc(skb, i - 1, page,
				   frag - page_address(page), fragsz);
1402 1403 1404 1405 1406 1407 1408 1409 1410
	}

	return skb;
free:
	/* frees skb and all frags allocated with napi_alloc_frag() */
	napi_free_frags(&tfile->napi);
	return ERR_PTR(err);
}

1411 1412
/* prepad is the amount to reserve at front.  len is length after that.
 * linear is a hint as to how much to copy (usually headers). */
J
Jason Wang 已提交
1413
static struct sk_buff *tun_alloc_skb(struct tun_file *tfile,
1414 1415
				     size_t prepad, size_t len,
				     size_t linear, int noblock)
1416
{
J
Jason Wang 已提交
1417
	struct sock *sk = tfile->socket.sk;
1418
	struct sk_buff *skb;
1419
	int err;
1420 1421

	/* Under a page?  Don't bother with paged skb. */
H
Herbert Xu 已提交
1422
	if (prepad + len < PAGE_SIZE || !linear)
1423
		linear = len;
1424

1425
	skb = sock_alloc_send_pskb(sk, prepad + linear, len - linear, noblock,
1426
				   &err, 0);
1427
	if (!skb)
1428
		return ERR_PTR(err);
1429 1430 1431

	skb_reserve(skb, prepad);
	skb_put(skb, linear);
1432 1433
	skb->data_len = len - linear;
	skb->len += len - linear;
1434 1435 1436 1437

	return skb;
}

J
Jason Wang 已提交
1438 1439 1440 1441 1442 1443 1444 1445 1446 1447
static void tun_rx_batched(struct tun_struct *tun, struct tun_file *tfile,
			   struct sk_buff *skb, int more)
{
	struct sk_buff_head *queue = &tfile->sk.sk_write_queue;
	struct sk_buff_head process_queue;
	u32 rx_batched = tun->rx_batched;
	bool rcv = false;

	if (!rx_batched || (!more && skb_queue_empty(queue))) {
		local_bh_disable();
M
Matthew Cover 已提交
1448
		skb_record_rx_queue(skb, tfile->queue_index);
J
Jason Wang 已提交
1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467
		netif_receive_skb(skb);
		local_bh_enable();
		return;
	}

	spin_lock(&queue->lock);
	if (!more || skb_queue_len(queue) == rx_batched) {
		__skb_queue_head_init(&process_queue);
		skb_queue_splice_tail_init(queue, &process_queue);
		rcv = true;
	} else {
		__skb_queue_tail(queue, skb);
	}
	spin_unlock(&queue->lock);

	if (rcv) {
		struct sk_buff *nskb;

		local_bh_disable();
M
Matthew Cover 已提交
1468 1469
		while ((nskb = __skb_dequeue(&process_queue))) {
			skb_record_rx_queue(nskb, tfile->queue_index);
J
Jason Wang 已提交
1470
			netif_receive_skb(nskb);
M
Matthew Cover 已提交
1471 1472
		}
		skb_record_rx_queue(skb, tfile->queue_index);
J
Jason Wang 已提交
1473 1474 1475 1476 1477
		netif_receive_skb(skb);
		local_bh_enable();
	}
}

1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499
static bool tun_can_build_skb(struct tun_struct *tun, struct tun_file *tfile,
			      int len, int noblock, bool zerocopy)
{
	if ((tun->flags & TUN_TYPE_MASK) != IFF_TAP)
		return false;

	if (tfile->socket.sk->sk_sndbuf != INT_MAX)
		return false;

	if (!noblock)
		return false;

	if (zerocopy)
		return false;

	if (SKB_DATA_ALIGN(len + TUN_RX_PAD) +
	    SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) > PAGE_SIZE)
		return false;

	return true;
}

1500 1501
static struct sk_buff *__tun_build_skb(struct tun_file *tfile,
				       struct page_frag *alloc_frag, char *buf,
J
Jason Wang 已提交
1502
				       int buflen, int len, int pad)
1503 1504 1505 1506 1507 1508
{
	struct sk_buff *skb = build_skb(buf, buflen);

	if (!skb)
		return ERR_PTR(-ENOMEM);

J
Jason Wang 已提交
1509
	skb_reserve(skb, pad);
1510
	skb_put(skb, len);
1511
	skb_set_owner_w(skb, tfile->socket.sk);
1512 1513 1514 1515 1516 1517 1518

	get_page(alloc_frag->page);
	alloc_frag->offset += buflen;

	return skb;
}

J
Jason Wang 已提交
1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538
static int tun_xdp_act(struct tun_struct *tun, struct bpf_prog *xdp_prog,
		       struct xdp_buff *xdp, u32 act)
{
	int err;

	switch (act) {
	case XDP_REDIRECT:
		err = xdp_do_redirect(tun->dev, xdp, xdp_prog);
		if (err)
			return err;
		break;
	case XDP_TX:
		err = tun_xdp_tx(tun->dev, xdp);
		if (err < 0)
			return err;
		break;
	case XDP_PASS:
		break;
	default:
		bpf_warn_invalid_xdp_action(act);
1539
		fallthrough;
J
Jason Wang 已提交
1540 1541
	case XDP_ABORTED:
		trace_xdp_exception(tun->dev, xdp_prog, act);
1542
		fallthrough;
J
Jason Wang 已提交
1543
	case XDP_DROP:
1544
		atomic_long_inc(&tun->dev->rx_dropped);
J
Jason Wang 已提交
1545 1546 1547 1548 1549 1550
		break;
	}

	return act;
}

J
Jason Wang 已提交
1551 1552
static struct sk_buff *tun_build_skb(struct tun_struct *tun,
				     struct tun_file *tfile,
1553
				     struct iov_iter *from,
J
Jason Wang 已提交
1554
				     struct virtio_net_hdr *hdr,
J
Jason Wang 已提交
1555
				     int len, int *skb_xdp)
1556
{
1557
	struct page_frag *alloc_frag = &current->task_frag;
J
Jason Wang 已提交
1558
	struct bpf_prog *xdp_prog;
1559
	int buflen = SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
1560 1561
	char *buf;
	size_t copied;
J
Jason Wang 已提交
1562 1563
	int pad = TUN_RX_PAD;
	int err = 0;
1564 1565 1566 1567

	rcu_read_lock();
	xdp_prog = rcu_dereference(tun->xdp_prog);
	if (xdp_prog)
1568
		pad += XDP_PACKET_HEADROOM;
1569 1570
	buflen += SKB_DATA_ALIGN(len + pad);
	rcu_read_unlock();
1571

1572
	alloc_frag->offset = ALIGN((u64)alloc_frag->offset, SMP_CACHE_BYTES);
1573 1574 1575 1576 1577
	if (unlikely(!skb_page_frag_refill(buflen, alloc_frag, GFP_KERNEL)))
		return ERR_PTR(-ENOMEM);

	buf = (char *)page_address(alloc_frag->page) + alloc_frag->offset;
	copied = copy_page_from_iter(alloc_frag->page,
1578
				     alloc_frag->offset + pad,
1579 1580 1581 1582
				     len, from);
	if (copied != len)
		return ERR_PTR(-EFAULT);

1583 1584 1585 1586
	/* There's a small window that XDP may be set after the check
	 * of xdp_prog above, this should be rare and for simplicity
	 * we do XDP on skb in case the headroom is not enough.
	 */
1587
	if (hdr->gso_type || !xdp_prog) {
J
Jason Wang 已提交
1588
		*skb_xdp = 1;
1589 1590
		return __tun_build_skb(tfile, alloc_frag, buf, buflen, len,
				       pad);
1591 1592 1593
	}

	*skb_xdp = 0;
J
Jason Wang 已提交
1594

1595
	local_bh_disable();
J
Jason Wang 已提交
1596 1597
	rcu_read_lock();
	xdp_prog = rcu_dereference(tun->xdp_prog);
J
Jason Wang 已提交
1598
	if (xdp_prog) {
J
Jason Wang 已提交
1599 1600 1601 1602
		struct xdp_buff xdp;
		u32 act;

		xdp.data_hard_start = buf;
1603
		xdp.data = buf + pad;
1604
		xdp_set_data_meta_invalid(&xdp);
J
Jason Wang 已提交
1605
		xdp.data_end = xdp.data + len;
J
Jesper Dangaard Brouer 已提交
1606
		xdp.rxq = &tfile->xdp_rxq;
J
Jesper Dangaard Brouer 已提交
1607
		xdp.frame_sz = buflen;
J
Jason Wang 已提交
1608

J
Jason Wang 已提交
1609 1610
		act = bpf_prog_run_xdp(xdp_prog, &xdp);
		if (act == XDP_REDIRECT || act == XDP_TX) {
J
Jason Wang 已提交
1611 1612
			get_page(alloc_frag->page);
			alloc_frag->offset += buflen;
J
Jason Wang 已提交
1613
		}
J
Jason Wang 已提交
1614
		err = tun_xdp_act(tun, xdp_prog, &xdp, act);
1615 1616 1617 1618 1619 1620
		if (err < 0) {
			if (act == XDP_REDIRECT || act == XDP_TX)
				put_page(alloc_frag->page);
			goto out;
		}

1621
		if (err == XDP_REDIRECT)
1622
			xdp_do_flush();
J
Jason Wang 已提交
1623 1624 1625 1626 1627
		if (err != XDP_PASS)
			goto out;

		pad = xdp.data - xdp.data_hard_start;
		len = xdp.data_end - xdp.data;
J
Jason Wang 已提交
1628
	}
1629 1630
	rcu_read_unlock();
	local_bh_enable();
J
Jason Wang 已提交
1631

1632
	return __tun_build_skb(tfile, alloc_frag, buf, buflen, len, pad);
J
Jason Wang 已提交
1633

1634
out:
J
Jason Wang 已提交
1635
	rcu_read_unlock();
1636
	local_bh_enable();
J
Jason Wang 已提交
1637
	return NULL;
1638 1639
}

L
Linus Torvalds 已提交
1640
/* Get packet from user space buffer */
J
Jason Wang 已提交
1641
static ssize_t tun_get_user(struct tun_struct *tun, struct tun_file *tfile,
1642
			    void *msg_control, struct iov_iter *from,
J
Jason Wang 已提交
1643
			    int noblock, bool more)
L
Linus Torvalds 已提交
1644
{
1645
	struct tun_pi pi = { 0, cpu_to_be16(ETH_P_IP) };
L
Linus Torvalds 已提交
1646
	struct sk_buff *skb;
1647
	size_t total_len = iov_iter_count(from);
1648
	size_t len = total_len, align = tun->align, linear;
1649
	struct virtio_net_hdr gso = { 0 };
1650
	int good_linear;
1651 1652 1653
	int copylen;
	bool zerocopy = false;
	int err;
1654
	u32 rxhash = 0;
J
Jason Wang 已提交
1655
	int skb_xdp = 1;
E
Eric Dumazet 已提交
1656
	bool frags = tun_napi_frags_enabled(tfile);
L
Linus Torvalds 已提交
1657

M
Michael S. Tsirkin 已提交
1658
	if (!(tun->flags & IFF_NO_PI)) {
1659
		if (len < sizeof(pi))
L
Linus Torvalds 已提交
1660
			return -EINVAL;
1661
		len -= sizeof(pi);
L
Linus Torvalds 已提交
1662

1663
		if (!copy_from_iter_full(&pi, sizeof(pi), from))
L
Linus Torvalds 已提交
1664 1665 1666
			return -EFAULT;
	}

M
Michael S. Tsirkin 已提交
1667
	if (tun->flags & IFF_VNET_HDR) {
W
Willem de Bruijn 已提交
1668 1669 1670
		int vnet_hdr_sz = READ_ONCE(tun->vnet_hdr_sz);

		if (len < vnet_hdr_sz)
1671
			return -EINVAL;
W
Willem de Bruijn 已提交
1672
		len -= vnet_hdr_sz;
1673

1674
		if (!copy_from_iter_full(&gso, sizeof(gso), from))
1675 1676
			return -EFAULT;

1677
		if ((gso.flags & VIRTIO_NET_HDR_F_NEEDS_CSUM) &&
1678 1679
		    tun16_to_cpu(tun, gso.csum_start) + tun16_to_cpu(tun, gso.csum_offset) + 2 > tun16_to_cpu(tun, gso.hdr_len))
			gso.hdr_len = cpu_to_tun16(tun, tun16_to_cpu(tun, gso.csum_start) + tun16_to_cpu(tun, gso.csum_offset) + 2);
1680

1681
		if (tun16_to_cpu(tun, gso.hdr_len) > len)
1682
			return -EINVAL;
W
Willem de Bruijn 已提交
1683
		iov_iter_advance(from, vnet_hdr_sz - sizeof(gso));
1684 1685
	}

M
Michael S. Tsirkin 已提交
1686
	if ((tun->flags & TUN_TYPE_MASK) == IFF_TAP) {
1687
		align += NET_IP_ALIGN;
H
Herbert Xu 已提交
1688
		if (unlikely(len < ETH_HLEN ||
1689
			     (gso.hdr_len && tun16_to_cpu(tun, gso.hdr_len) < ETH_HLEN)))
1690 1691
			return -EINVAL;
	}
1692

1693 1694
	good_linear = SKB_MAX_HEAD(align);

1695
	if (msg_control) {
1696 1697
		struct iov_iter i = *from;

1698 1699
		/* There are 256 bytes to be copied in skb, so there is
		 * enough room for skb expand head in case it is used.
1700 1701
		 * The rest of the buffer is mapped from userspace.
		 */
1702
		copylen = gso.hdr_len ? tun16_to_cpu(tun, gso.hdr_len) : GOODCOPY_LEN;
1703 1704
		if (copylen > good_linear)
			copylen = good_linear;
1705
		linear = copylen;
1706 1707
		iov_iter_advance(&i, copylen);
		if (iov_iter_npages(&i, INT_MAX) <= MAX_SKB_FRAGS)
1708 1709 1710
			zerocopy = true;
	}

1711
	if (!frags && tun_can_build_skb(tun, tfile, len, noblock, zerocopy)) {
J
Jason Wang 已提交
1712 1713 1714 1715 1716
		/* For the packet that is not easy to be processed
		 * (e.g gso or jumbo packet), we will do it at after
		 * skb was created with generic XDP routine.
		 */
		skb = tun_build_skb(tun, tfile, from, &gso, len, &skb_xdp);
1717
		if (IS_ERR(skb)) {
1718
			atomic_long_inc(&tun->dev->rx_dropped);
1719 1720
			return PTR_ERR(skb);
		}
J
Jason Wang 已提交
1721 1722
		if (!skb)
			return total_len;
1723 1724 1725 1726 1727 1728 1729 1730
	} else {
		if (!zerocopy) {
			copylen = len;
			if (tun16_to_cpu(tun, gso.hdr_len) > good_linear)
				linear = good_linear;
			else
				linear = tun16_to_cpu(tun, gso.hdr_len);
		}
L
Linus Torvalds 已提交
1731

1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744
		if (frags) {
			mutex_lock(&tfile->napi_mutex);
			skb = tun_napi_alloc_frags(tfile, copylen, from);
			/* tun_napi_alloc_frags() enforces a layout for the skb.
			 * If zerocopy is enabled, then this layout will be
			 * overwritten by zerocopy_sg_from_iter().
			 */
			zerocopy = false;
		} else {
			skb = tun_alloc_skb(tfile, align, copylen, linear,
					    noblock);
		}

1745 1746
		if (IS_ERR(skb)) {
			if (PTR_ERR(skb) != -EAGAIN)
1747
				atomic_long_inc(&tun->dev->rx_dropped);
1748 1749
			if (frags)
				mutex_unlock(&tfile->napi_mutex);
1750 1751
			return PTR_ERR(skb);
		}
1752

1753 1754 1755 1756 1757 1758
		if (zerocopy)
			err = zerocopy_sg_from_iter(skb, from);
		else
			err = skb_copy_datagram_from_iter(skb, 0, from, len);

		if (err) {
E
Eric Dumazet 已提交
1759 1760
			err = -EFAULT;
drop:
1761
			atomic_long_inc(&tun->dev->rx_dropped);
1762
			kfree_skb(skb);
1763 1764 1765 1766 1767
			if (frags) {
				tfile->napi.skb = NULL;
				mutex_unlock(&tfile->napi_mutex);
			}

E
Eric Dumazet 已提交
1768
			return err;
1769
		}
D
Dave Jones 已提交
1770
	}
L
Linus Torvalds 已提交
1771

1772
	if (virtio_net_hdr_to_skb(skb, &gso, tun_is_little_endian(tun))) {
1773
		atomic_long_inc(&tun->rx_frame_errors);
1774
		kfree_skb(skb);
1775 1776 1777 1778 1779
		if (frags) {
			tfile->napi.skb = NULL;
			mutex_unlock(&tfile->napi_mutex);
		}

1780 1781 1782
		return -EINVAL;
	}

L
Linus Torvalds 已提交
1783
	switch (tun->flags & TUN_TYPE_MASK) {
M
Michael S. Tsirkin 已提交
1784 1785
	case IFF_TUN:
		if (tun->flags & IFF_NO_PI) {
1786 1787 1788 1789
			u8 ip_version = skb->len ? (skb->data[0] >> 4) : 0;

			switch (ip_version) {
			case 4:
1790 1791
				pi.proto = htons(ETH_P_IP);
				break;
1792
			case 6:
1793 1794 1795
				pi.proto = htons(ETH_P_IPV6);
				break;
			default:
1796
				atomic_long_inc(&tun->dev->rx_dropped);
1797 1798 1799 1800 1801
				kfree_skb(skb);
				return -EINVAL;
			}
		}

1802
		skb_reset_mac_header(skb);
L
Linus Torvalds 已提交
1803
		skb->protocol = pi.proto;
1804
		skb->dev = tun->dev;
L
Linus Torvalds 已提交
1805
		break;
M
Michael S. Tsirkin 已提交
1806
	case IFF_TAP:
1807 1808 1809 1810 1811
		if (frags && !pskb_may_pull(skb, ETH_HLEN)) {
			err = -ENOMEM;
			goto drop;
		}
		skb->protocol = eth_type_trans(skb, tun->dev);
L
Linus Torvalds 已提交
1812
		break;
1813
	}
L
Linus Torvalds 已提交
1814

1815 1816 1817 1818
	/* copy skb_ubuf_info for callback when skb has no error */
	if (zerocopy) {
		skb_shinfo(skb)->destructor_arg = msg_control;
		skb_shinfo(skb)->tx_flags |= SKBTX_DEV_ZEROCOPY;
1819
		skb_shinfo(skb)->tx_flags |= SKBTX_SHARED_FRAG;
1820 1821 1822
	} else if (msg_control) {
		struct ubuf_info *uarg = msg_control;
		uarg->callback(uarg, false);
1823 1824
	}

1825
	skb_reset_network_header(skb);
1826
	skb_probe_transport_header(skb);
1827
	skb_record_rx_queue(skb, tfile->queue_index);
1828

J
Jason Wang 已提交
1829
	if (skb_xdp) {
J
Jason Wang 已提交
1830 1831 1832
		struct bpf_prog *xdp_prog;
		int ret;

1833
		local_bh_disable();
J
Jason Wang 已提交
1834 1835 1836 1837 1838 1839
		rcu_read_lock();
		xdp_prog = rcu_dereference(tun->xdp_prog);
		if (xdp_prog) {
			ret = do_xdp_generic(xdp_prog, skb);
			if (ret != XDP_PASS) {
				rcu_read_unlock();
1840
				local_bh_enable();
1841 1842 1843 1844
				if (frags) {
					tfile->napi.skb = NULL;
					mutex_unlock(&tfile->napi_mutex);
				}
J
Jason Wang 已提交
1845 1846 1847 1848
				return total_len;
			}
		}
		rcu_read_unlock();
1849
		local_bh_enable();
J
Jason Wang 已提交
1850 1851
	}

1852 1853 1854 1855 1856 1857
	/* Compute the costly rx hash only if needed for flow updates.
	 * We may get a very small possibility of OOO during switching, not
	 * worth to optimize.
	 */
	if (!rcu_access_pointer(tun->steering_prog) && tun->numqueues > 1 &&
	    !tfile->detached)
1858
		rxhash = __skb_get_hash_symmetric(skb);
1859

E
Eric Dumazet 已提交
1860 1861 1862
	rcu_read_lock();
	if (unlikely(!(tun->dev->flags & IFF_UP))) {
		err = -EIO;
1863
		rcu_read_unlock();
E
Eric Dumazet 已提交
1864 1865 1866
		goto drop;
	}

1867
	if (frags) {
1868 1869
		u32 headlen;

1870
		/* Exercise flow dissector code path. */
1871 1872 1873
		skb_push(skb, ETH_HLEN);
		headlen = eth_get_headlen(tun->dev, skb->data,
					  skb_headlen(skb));
1874

1875
		if (unlikely(headlen > skb_headlen(skb))) {
1876
			atomic_long_inc(&tun->dev->rx_dropped);
1877
			napi_free_frags(&tfile->napi);
E
Eric Dumazet 已提交
1878
			rcu_read_unlock();
1879 1880 1881 1882 1883 1884 1885 1886 1887
			mutex_unlock(&tfile->napi_mutex);
			WARN_ON(1);
			return -ENOMEM;
		}

		local_bh_disable();
		napi_gro_frags(&tfile->napi);
		local_bh_enable();
		mutex_unlock(&tfile->napi_mutex);
1888
	} else if (tfile->napi_enabled) {
1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905
		struct sk_buff_head *queue = &tfile->sk.sk_write_queue;
		int queue_len;

		spin_lock_bh(&queue->lock);
		__skb_queue_tail(queue, skb);
		queue_len = skb_queue_len(queue);
		spin_unlock(&queue->lock);

		if (!more || queue_len > NAPI_POLL_WEIGHT)
			napi_schedule(&tfile->napi);

		local_bh_enable();
	} else if (!IS_ENABLED(CONFIG_4KSTACKS)) {
		tun_rx_batched(tun, tfile, skb, more);
	} else {
		netif_rx_ni(skb);
	}
E
Eric Dumazet 已提交
1906
	rcu_read_unlock();
1907

1908 1909 1910
	preempt_disable();
	dev_sw_netstats_rx_add(tun->dev, len);
	preempt_enable();
L
Linus Torvalds 已提交
1911

1912 1913 1914
	if (rxhash)
		tun_flow_update(tun, rxhash, tfile);

1915
	return total_len;
1916
}
L
Linus Torvalds 已提交
1917

1918
static ssize_t tun_chr_write_iter(struct kiocb *iocb, struct iov_iter *from)
L
Linus Torvalds 已提交
1919
{
1920
	struct file *file = iocb->ki_filp;
J
Jason Wang 已提交
1921
	struct tun_file *tfile = file->private_data;
1922
	struct tun_struct *tun = tun_get(tfile);
E
Eric W. Biederman 已提交
1923
	ssize_t result;
L
Linus Torvalds 已提交
1924 1925 1926 1927

	if (!tun)
		return -EBADFD;

J
Jason Wang 已提交
1928 1929
	result = tun_get_user(tun, tfile, NULL, from,
			      file->f_flags & O_NONBLOCK, false);
E
Eric W. Biederman 已提交
1930 1931 1932

	tun_put(tun);
	return result;
L
Linus Torvalds 已提交
1933 1934
}

J
Jason Wang 已提交
1935 1936
static ssize_t tun_put_user_xdp(struct tun_struct *tun,
				struct tun_file *tfile,
1937
				struct xdp_frame *xdp_frame,
J
Jason Wang 已提交
1938 1939 1940
				struct iov_iter *iter)
{
	int vnet_hdr_sz = 0;
1941
	size_t size = xdp_frame->len;
J
Jason Wang 已提交
1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955
	size_t ret;

	if (tun->flags & IFF_VNET_HDR) {
		struct virtio_net_hdr gso = { 0 };

		vnet_hdr_sz = READ_ONCE(tun->vnet_hdr_sz);
		if (unlikely(iov_iter_count(iter) < vnet_hdr_sz))
			return -EINVAL;
		if (unlikely(copy_to_iter(&gso, sizeof(gso), iter) !=
			     sizeof(gso)))
			return -EFAULT;
		iov_iter_advance(iter, vnet_hdr_sz - sizeof(gso));
	}

1956
	ret = copy_to_iter(xdp_frame->data, size, iter) + vnet_hdr_sz;
J
Jason Wang 已提交
1957

1958 1959 1960
	preempt_disable();
	dev_sw_netstats_tx_add(tun->dev, 1, ret);
	preempt_enable();
J
Jason Wang 已提交
1961 1962 1963 1964

	return ret;
}

L
Linus Torvalds 已提交
1965
/* Put packet to the user space buffer */
1966
static ssize_t tun_put_user(struct tun_struct *tun,
J
Jason Wang 已提交
1967
			    struct tun_file *tfile,
1968
			    struct sk_buff *skb,
H
Herbert Xu 已提交
1969
			    struct iov_iter *iter)
L
Linus Torvalds 已提交
1970 1971
{
	struct tun_pi pi = { 0, skb->protocol };
H
Herbert Xu 已提交
1972
	ssize_t total;
1973
	int vlan_offset = 0;
1974
	int vlan_hlen = 0;
H
Herbert Xu 已提交
1975
	int vnet_hdr_sz = 0;
1976

1977
	if (skb_vlan_tag_present(skb))
1978
		vlan_hlen = VLAN_HLEN;
L
Linus Torvalds 已提交
1979

M
Michael S. Tsirkin 已提交
1980
	if (tun->flags & IFF_VNET_HDR)
W
Willem de Bruijn 已提交
1981
		vnet_hdr_sz = READ_ONCE(tun->vnet_hdr_sz);
L
Linus Torvalds 已提交
1982

H
Herbert Xu 已提交
1983 1984
	total = skb->len + vlan_hlen + vnet_hdr_sz;

M
Michael S. Tsirkin 已提交
1985
	if (!(tun->flags & IFF_NO_PI)) {
H
Herbert Xu 已提交
1986
		if (iov_iter_count(iter) < sizeof(pi))
L
Linus Torvalds 已提交
1987 1988
			return -EINVAL;

H
Herbert Xu 已提交
1989 1990
		total += sizeof(pi);
		if (iov_iter_count(iter) < total) {
L
Linus Torvalds 已提交
1991 1992 1993
			/* Packet will be striped */
			pi.flags |= TUN_PKT_STRIP;
		}
1994

H
Herbert Xu 已提交
1995
		if (copy_to_iter(&pi, sizeof(pi), iter) != sizeof(pi))
L
Linus Torvalds 已提交
1996
			return -EFAULT;
1997
	}
L
Linus Torvalds 已提交
1998

H
Herbert Xu 已提交
1999
	if (vnet_hdr_sz) {
2000
		struct virtio_net_hdr gso;
2001

H
Herbert Xu 已提交
2002
		if (iov_iter_count(iter) < vnet_hdr_sz)
2003 2004
			return -EINVAL;

2005
		if (virtio_net_hdr_from_skb(skb, &gso,
2006 2007
					    tun_is_little_endian(tun), true,
					    vlan_hlen)) {
2008
			struct skb_shared_info *sinfo = skb_shinfo(skb);
2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019
			pr_err("unexpected GSO type: "
			       "0x%x, gso_size %d, hdr_len %d\n",
			       sinfo->gso_type, tun16_to_cpu(tun, gso.gso_size),
			       tun16_to_cpu(tun, gso.hdr_len));
			print_hex_dump(KERN_ERR, "tun: ",
				       DUMP_PREFIX_NONE,
				       16, 1, skb->head,
				       min((int)tun16_to_cpu(tun, gso.hdr_len), 64), true);
			WARN_ON_ONCE(1);
			return -EINVAL;
		}
2020

H
Herbert Xu 已提交
2021
		if (copy_to_iter(&gso, sizeof(gso), iter) != sizeof(gso))
2022
			return -EFAULT;
2023 2024

		iov_iter_advance(iter, vnet_hdr_sz - sizeof(gso));
2025 2026
	}

2027
	if (vlan_hlen) {
H
Herbert Xu 已提交
2028
		int ret;
2029
		struct veth veth;
J
Jason Wang 已提交
2030 2031

		veth.h_vlan_proto = skb->vlan_proto;
2032
		veth.h_vlan_TCI = htons(skb_vlan_tag_get(skb));
J
Jason Wang 已提交
2033 2034 2035

		vlan_offset = offsetof(struct vlan_ethhdr, h_vlan_proto);

H
Herbert Xu 已提交
2036 2037
		ret = skb_copy_datagram_iter(skb, 0, iter, vlan_offset);
		if (ret || !iov_iter_count(iter))
J
Jason Wang 已提交
2038 2039
			goto done;

H
Herbert Xu 已提交
2040 2041
		ret = copy_to_iter(&veth, sizeof(veth), iter);
		if (ret != sizeof(veth) || !iov_iter_count(iter))
J
Jason Wang 已提交
2042 2043
			goto done;
	}
L
Linus Torvalds 已提交
2044

H
Herbert Xu 已提交
2045
	skb_copy_datagram_iter(skb, vlan_offset, iter, skb->len - vlan_offset);
L
Linus Torvalds 已提交
2046

J
Jason Wang 已提交
2047
done:
2048
	/* caller is in process context, */
2049 2050 2051
	preempt_disable();
	dev_sw_netstats_tx_add(tun->dev, 1, skb->len + vlan_hlen);
	preempt_enable();
L
Linus Torvalds 已提交
2052 2053 2054 2055

	return total;
}

J
Jason Wang 已提交
2056
static void *tun_ring_recv(struct tun_file *tfile, int noblock, int *err)
J
Jason Wang 已提交
2057 2058
{
	DECLARE_WAITQUEUE(wait, current);
J
Jason Wang 已提交
2059
	void *ptr = NULL;
J
Jason Wang 已提交
2060
	int error = 0;
J
Jason Wang 已提交
2061

J
Jason Wang 已提交
2062 2063
	ptr = ptr_ring_consume(&tfile->tx_ring);
	if (ptr)
J
Jason Wang 已提交
2064 2065
		goto out;
	if (noblock) {
J
Jason Wang 已提交
2066
		error = -EAGAIN;
J
Jason Wang 已提交
2067 2068 2069
		goto out;
	}

2070
	add_wait_queue(&tfile->socket.wq.wait, &wait);
J
Jason Wang 已提交
2071 2072

	while (1) {
T
Timur Celik 已提交
2073
		set_current_state(TASK_INTERRUPTIBLE);
J
Jason Wang 已提交
2074 2075
		ptr = ptr_ring_consume(&tfile->tx_ring);
		if (ptr)
J
Jason Wang 已提交
2076 2077
			break;
		if (signal_pending(current)) {
J
Jason Wang 已提交
2078
			error = -ERESTARTSYS;
J
Jason Wang 已提交
2079 2080 2081
			break;
		}
		if (tfile->socket.sk->sk_shutdown & RCV_SHUTDOWN) {
J
Jason Wang 已提交
2082
			error = -EFAULT;
J
Jason Wang 已提交
2083 2084 2085 2086 2087 2088
			break;
		}

		schedule();
	}

2089
	__set_current_state(TASK_RUNNING);
2090
	remove_wait_queue(&tfile->socket.wq.wait, &wait);
J
Jason Wang 已提交
2091 2092

out:
J
Jason Wang 已提交
2093
	*err = error;
J
Jason Wang 已提交
2094
	return ptr;
J
Jason Wang 已提交
2095 2096
}

J
Jason Wang 已提交
2097
static ssize_t tun_do_read(struct tun_struct *tun, struct tun_file *tfile,
2098
			   struct iov_iter *to,
J
Jason Wang 已提交
2099
			   int noblock, void *ptr)
L
Linus Torvalds 已提交
2100
{
2101
	ssize_t ret;
J
Jason Wang 已提交
2102
	int err;
L
Linus Torvalds 已提交
2103

W
Wei Xu 已提交
2104
	if (!iov_iter_count(to)) {
J
Jason Wang 已提交
2105
		tun_ptr_free(ptr);
2106
		return 0;
W
Wei Xu 已提交
2107
	}
L
Linus Torvalds 已提交
2108

J
Jason Wang 已提交
2109
	if (!ptr) {
2110
		/* Read frames from ring */
J
Jason Wang 已提交
2111 2112
		ptr = tun_ring_recv(tfile, noblock, &err);
		if (!ptr)
2113 2114
			return err;
	}
H
Herbert Xu 已提交
2115

2116 2117
	if (tun_is_xdp_frame(ptr)) {
		struct xdp_frame *xdpf = tun_ptr_to_xdp(ptr);
J
Jason Wang 已提交
2118

2119
		ret = tun_put_user_xdp(tun, tfile, xdpf, to);
2120
		xdp_return_frame(xdpf);
J
Jason Wang 已提交
2121 2122 2123 2124 2125 2126 2127 2128 2129
	} else {
		struct sk_buff *skb = ptr;

		ret = tun_put_user(tun, tfile, skb, to);
		if (unlikely(ret < 0))
			kfree_skb(skb);
		else
			consume_skb(skb);
	}
L
Linus Torvalds 已提交
2130

2131 2132 2133
	return ret;
}

2134
static ssize_t tun_chr_read_iter(struct kiocb *iocb, struct iov_iter *to)
2135 2136 2137
{
	struct file *file = iocb->ki_filp;
	struct tun_file *tfile = file->private_data;
2138
	struct tun_struct *tun = tun_get(tfile);
2139
	ssize_t len = iov_iter_count(to), ret;
2140 2141 2142

	if (!tun)
		return -EBADFD;
2143
	ret = tun_do_read(tun, tfile, to, file->f_flags & O_NONBLOCK, NULL);
2144
	ret = min_t(ssize_t, ret, len);
Z
Zhi Yong Wu 已提交
2145 2146
	if (ret > 0)
		iocb->ki_pos = ret;
E
Eric W. Biederman 已提交
2147
	tun_put(tun);
L
Linus Torvalds 已提交
2148 2149 2150
	return ret;
}

2151
static void tun_prog_free(struct rcu_head *rcu)
2152
{
2153
	struct tun_prog *prog = container_of(rcu, struct tun_prog, rcu);
2154 2155 2156 2157 2158

	bpf_prog_destroy(prog->prog);
	kfree(prog);
}

J
Jason Wang 已提交
2159 2160
static int __tun_set_ebpf(struct tun_struct *tun,
			  struct tun_prog __rcu **prog_p,
2161
			  struct bpf_prog *prog)
2162
{
2163
	struct tun_prog *old, *new = NULL;
2164 2165 2166 2167 2168 2169 2170 2171

	if (prog) {
		new = kmalloc(sizeof(*new), GFP_KERNEL);
		if (!new)
			return -ENOMEM;
		new->prog = prog;
	}

2172
	spin_lock_bh(&tun->lock);
2173
	old = rcu_dereference_protected(*prog_p,
2174
					lockdep_is_held(&tun->lock));
2175
	rcu_assign_pointer(*prog_p, new);
2176
	spin_unlock_bh(&tun->lock);
2177 2178

	if (old)
2179
		call_rcu(&old->rcu, tun_prog_free);
2180 2181 2182 2183

	return 0;
}

J
Jason Wang 已提交
2184 2185 2186 2187
static void tun_free_netdev(struct net_device *dev)
{
	struct tun_struct *tun = netdev_priv(dev);

J
Jason Wang 已提交
2188
	BUG_ON(!(list_empty(&tun->disabled)));
E
Eric Dumazet 已提交
2189

2190 2191
	free_percpu(dev->tstats);
	/* We clear tstats so that tun_set_iff() can tell if
E
Eric Dumazet 已提交
2192 2193
	 * tun_free_netdev() has been called from register_netdevice().
	 */
2194
	dev->tstats = NULL;
E
Eric Dumazet 已提交
2195

J
Jason Wang 已提交
2196
	tun_flow_uninit(tun);
2197
	security_tun_dev_free_security(tun->security);
2198
	__tun_set_ebpf(tun, &tun->steering_prog, NULL);
2199
	__tun_set_ebpf(tun, &tun->filter_prog, NULL);
J
Jason Wang 已提交
2200 2201
}

L
Linus Torvalds 已提交
2202 2203 2204 2205
static void tun_setup(struct net_device *dev)
{
	struct tun_struct *tun = netdev_priv(dev);

2206 2207
	tun->owner = INVALID_UID;
	tun->group = INVALID_GID;
2208
	tun_default_link_ksettings(dev, &tun->link_ksettings);
L
Linus Torvalds 已提交
2209 2210

	dev->ethtool_ops = &tun_ethtool_ops;
2211 2212
	dev->needs_free_netdev = true;
	dev->priv_destructor = tun_free_netdev;
J
Jason Wang 已提交
2213 2214
	/* We prefer our own queue length */
	dev->tx_queue_len = TUN_READQ_SIZE;
L
Linus Torvalds 已提交
2215 2216
}

2217 2218 2219
/* Trivial set of netlink ops to allow deleting tun or tap
 * device with netlink.
 */
2220 2221
static int tun_validate(struct nlattr *tb[], struct nlattr *data[],
			struct netlink_ext_ack *extack)
2222
{
2223 2224 2225
	NL_SET_ERR_MSG(extack,
		       "tun/tap creation via rtnetlink is not supported.");
	return -EOPNOTSUPP;
2226 2227
}

2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281
static size_t tun_get_size(const struct net_device *dev)
{
	BUILD_BUG_ON(sizeof(u32) != sizeof(uid_t));
	BUILD_BUG_ON(sizeof(u32) != sizeof(gid_t));

	return nla_total_size(sizeof(uid_t)) + /* OWNER */
	       nla_total_size(sizeof(gid_t)) + /* GROUP */
	       nla_total_size(sizeof(u8)) + /* TYPE */
	       nla_total_size(sizeof(u8)) + /* PI */
	       nla_total_size(sizeof(u8)) + /* VNET_HDR */
	       nla_total_size(sizeof(u8)) + /* PERSIST */
	       nla_total_size(sizeof(u8)) + /* MULTI_QUEUE */
	       nla_total_size(sizeof(u32)) + /* NUM_QUEUES */
	       nla_total_size(sizeof(u32)) + /* NUM_DISABLED_QUEUES */
	       0;
}

static int tun_fill_info(struct sk_buff *skb, const struct net_device *dev)
{
	struct tun_struct *tun = netdev_priv(dev);

	if (nla_put_u8(skb, IFLA_TUN_TYPE, tun->flags & TUN_TYPE_MASK))
		goto nla_put_failure;
	if (uid_valid(tun->owner) &&
	    nla_put_u32(skb, IFLA_TUN_OWNER,
			from_kuid_munged(current_user_ns(), tun->owner)))
		goto nla_put_failure;
	if (gid_valid(tun->group) &&
	    nla_put_u32(skb, IFLA_TUN_GROUP,
			from_kgid_munged(current_user_ns(), tun->group)))
		goto nla_put_failure;
	if (nla_put_u8(skb, IFLA_TUN_PI, !(tun->flags & IFF_NO_PI)))
		goto nla_put_failure;
	if (nla_put_u8(skb, IFLA_TUN_VNET_HDR, !!(tun->flags & IFF_VNET_HDR)))
		goto nla_put_failure;
	if (nla_put_u8(skb, IFLA_TUN_PERSIST, !!(tun->flags & IFF_PERSIST)))
		goto nla_put_failure;
	if (nla_put_u8(skb, IFLA_TUN_MULTI_QUEUE,
		       !!(tun->flags & IFF_MULTI_QUEUE)))
		goto nla_put_failure;
	if (tun->flags & IFF_MULTI_QUEUE) {
		if (nla_put_u32(skb, IFLA_TUN_NUM_QUEUES, tun->numqueues))
			goto nla_put_failure;
		if (nla_put_u32(skb, IFLA_TUN_NUM_DISABLED_QUEUES,
				tun->numdisabled))
			goto nla_put_failure;
	}

	return 0;

nla_put_failure:
	return -EMSGSIZE;
}

2282 2283 2284 2285 2286
static struct rtnl_link_ops tun_link_ops __read_mostly = {
	.kind		= DRV_NAME,
	.priv_size	= sizeof(struct tun_struct),
	.setup		= tun_setup,
	.validate	= tun_validate,
2287 2288
	.get_size       = tun_get_size,
	.fill_info      = tun_fill_info,
2289 2290
};

2291 2292
static void tun_sock_write_space(struct sock *sk)
{
J
Jason Wang 已提交
2293
	struct tun_file *tfile;
2294
	wait_queue_head_t *wqueue;
2295 2296 2297 2298

	if (!sock_writeable(sk))
		return;

2299
	if (!test_and_clear_bit(SOCKWQ_ASYNC_NOSPACE, &sk->sk_socket->flags))
2300 2301
		return;

2302 2303
	wqueue = sk_sleep(sk);
	if (wqueue && waitqueue_active(wqueue))
2304 2305
		wake_up_interruptible_sync_poll(wqueue, EPOLLOUT |
						EPOLLWRNORM | EPOLLWRBAND);
H
Herbert Xu 已提交
2306

J
Jason Wang 已提交
2307 2308
	tfile = container_of(sk, struct tun_file, sk);
	kill_fasync(&tfile->fasync, SIGIO, POLL_OUT);
2309 2310
}

2311 2312 2313 2314 2315 2316
static void tun_put_page(struct tun_page *tpage)
{
	if (tpage->page)
		__page_frag_cache_drain(tpage->page, tpage->count);
}

2317 2318
static int tun_xdp_one(struct tun_struct *tun,
		       struct tun_file *tfile,
2319 2320
		       struct xdp_buff *xdp, int *flush,
		       struct tun_page *tpage)
2321
{
2322
	unsigned int datasize = xdp->data_end - xdp->data;
2323 2324 2325 2326 2327 2328 2329 2330
	struct tun_xdp_hdr *hdr = xdp->data_hard_start;
	struct virtio_net_hdr *gso = &hdr->gso;
	struct bpf_prog *xdp_prog;
	struct sk_buff *skb = NULL;
	u32 rxhash = 0, act;
	int buflen = hdr->buflen;
	int err = 0;
	bool skb_xdp = false;
2331
	struct page *page;
2332 2333 2334 2335 2336 2337 2338 2339 2340

	xdp_prog = rcu_dereference(tun->xdp_prog);
	if (xdp_prog) {
		if (gso->gso_type) {
			skb_xdp = true;
			goto build;
		}
		xdp_set_data_meta_invalid(xdp);
		xdp->rxq = &tfile->xdp_rxq;
J
Jesper Dangaard Brouer 已提交
2341
		xdp->frame_sz = buflen;
2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352

		act = bpf_prog_run_xdp(xdp_prog, xdp);
		err = tun_xdp_act(tun, xdp_prog, xdp, act);
		if (err < 0) {
			put_page(virt_to_head_page(xdp->data));
			return err;
		}

		switch (err) {
		case XDP_REDIRECT:
			*flush = true;
2353
			fallthrough;
2354 2355 2356 2357 2358
		case XDP_TX:
			return 0;
		case XDP_PASS:
			break;
		default:
2359 2360 2361 2362 2363 2364 2365 2366
			page = virt_to_head_page(xdp->data);
			if (tpage->page == page) {
				++tpage->count;
			} else {
				tun_put_page(tpage);
				tpage->page = page;
				tpage->count = 1;
			}
2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381
			return 0;
		}
	}

build:
	skb = build_skb(xdp->data_hard_start, buflen);
	if (!skb) {
		err = -ENOMEM;
		goto out;
	}

	skb_reserve(skb, xdp->data - xdp->data_hard_start);
	skb_put(skb, xdp->data_end - xdp->data);

	if (virtio_net_hdr_to_skb(skb, gso, tun_is_little_endian(tun))) {
2382
		atomic_long_inc(&tun->rx_frame_errors);
2383 2384 2385 2386 2387 2388 2389
		kfree_skb(skb);
		err = -EINVAL;
		goto out;
	}

	skb->protocol = eth_type_trans(skb, tun->dev);
	skb_reset_network_header(skb);
2390
	skb_probe_transport_header(skb);
2391
	skb_record_rx_queue(skb, tfile->queue_index);
2392 2393 2394 2395 2396 2397 2398

	if (skb_xdp) {
		err = do_xdp_generic(xdp_prog, skb);
		if (err != XDP_PASS)
			goto out;
	}

2399 2400
	if (!rcu_dereference(tun->steering_prog) && tun->numqueues > 1 &&
	    !tfile->detached)
2401 2402 2403 2404
		rxhash = __skb_get_hash_symmetric(skb);

	netif_receive_skb(skb);

2405
	/* No need to disable preemption here since this function is
2406 2407
	 * always called with bh disabled
	 */
2408
	dev_sw_netstats_rx_add(tun->dev, datasize);
2409 2410 2411 2412 2413 2414 2415 2416

	if (rxhash)
		tun_flow_update(tun, rxhash, tfile);

out:
	return err;
}

2417
static int tun_sendmsg(struct socket *sock, struct msghdr *m, size_t total_len)
2418
{
2419
	int ret, i;
J
Jason Wang 已提交
2420
	struct tun_file *tfile = container_of(sock, struct tun_file, socket);
2421
	struct tun_struct *tun = tun_get(tfile);
2422
	struct tun_msg_ctl *ctl = m->msg_control;
2423
	struct xdp_buff *xdp;
J
Jason Wang 已提交
2424 2425 2426

	if (!tun)
		return -EBADFD;
2427

2428
	if (ctl && (ctl->type == TUN_MSG_PTR)) {
2429
		struct tun_page tpage;
2430 2431 2432
		int n = ctl->num;
		int flush = 0;

2433 2434
		memset(&tpage, 0, sizeof(tpage));

2435 2436 2437 2438 2439
		local_bh_disable();
		rcu_read_lock();

		for (i = 0; i < n; i++) {
			xdp = &((struct xdp_buff *)ctl->ptr)[i];
2440
			tun_xdp_one(tun, tfile, xdp, &flush, &tpage);
2441 2442 2443
		}

		if (flush)
2444
			xdp_do_flush();
2445 2446 2447 2448

		rcu_read_unlock();
		local_bh_enable();

2449 2450
		tun_put_page(&tpage);

2451 2452 2453
		ret = total_len;
		goto out;
	}
2454 2455

	ret = tun_get_user(tun, tfile, ctl ? ctl->ptr : NULL, &m->msg_iter,
J
Jason Wang 已提交
2456 2457
			   m->msg_flags & MSG_DONTWAIT,
			   m->msg_flags & MSG_MORE);
2458
out:
J
Jason Wang 已提交
2459 2460
	tun_put(tun);
	return ret;
2461 2462
}

2463
static int tun_recvmsg(struct socket *sock, struct msghdr *m, size_t total_len,
2464 2465
		       int flags)
{
J
Jason Wang 已提交
2466
	struct tun_file *tfile = container_of(sock, struct tun_file, socket);
2467
	struct tun_struct *tun = tun_get(tfile);
J
Jason Wang 已提交
2468
	void *ptr = m->msg_control;
2469
	int ret;
J
Jason Wang 已提交
2470

W
Wei Xu 已提交
2471 2472
	if (!tun) {
		ret = -EBADFD;
J
Jason Wang 已提交
2473
		goto out_free;
W
Wei Xu 已提交
2474
	}
J
Jason Wang 已提交
2475

2476
	if (flags & ~(MSG_DONTWAIT|MSG_TRUNC|MSG_ERRQUEUE)) {
2477
		ret = -EINVAL;
W
Wei Xu 已提交
2478
		goto out_put_tun;
2479
	}
2480 2481 2482 2483 2484
	if (flags & MSG_ERRQUEUE) {
		ret = sock_recv_errqueue(sock->sk, m, total_len,
					 SOL_PACKET, TUN_TX_TIMESTAMP);
		goto out;
	}
J
Jason Wang 已提交
2485
	ret = tun_do_read(tun, tfile, &m->msg_iter, flags & MSG_DONTWAIT, ptr);
2486
	if (ret > (ssize_t)total_len) {
2487 2488 2489
		m->msg_flags |= MSG_TRUNC;
		ret = flags & MSG_TRUNC ? ret : total_len;
	}
2490
out:
J
Jason Wang 已提交
2491
	tun_put(tun);
2492
	return ret;
W
Wei Xu 已提交
2493 2494 2495

out_put_tun:
	tun_put(tun);
J
Jason Wang 已提交
2496 2497
out_free:
	tun_ptr_free(ptr);
W
Wei Xu 已提交
2498
	return ret;
2499 2500
}

J
Jason Wang 已提交
2501 2502 2503
static int tun_ptr_peek_len(void *ptr)
{
	if (likely(ptr)) {
2504 2505
		if (tun_is_xdp_frame(ptr)) {
			struct xdp_frame *xdpf = tun_ptr_to_xdp(ptr);
J
Jason Wang 已提交
2506

2507
			return xdpf->len;
J
Jason Wang 已提交
2508 2509 2510 2511 2512 2513 2514
		}
		return __skb_array_len_with_tag(ptr);
	} else {
		return 0;
	}
}

J
Jason Wang 已提交
2515 2516 2517 2518 2519 2520
static int tun_peek_len(struct socket *sock)
{
	struct tun_file *tfile = container_of(sock, struct tun_file, socket);
	struct tun_struct *tun;
	int ret = 0;

2521
	tun = tun_get(tfile);
J
Jason Wang 已提交
2522 2523 2524
	if (!tun)
		return 0;

J
Jason Wang 已提交
2525
	ret = PTR_RING_PEEK_CALL(&tfile->tx_ring, tun_ptr_peek_len);
J
Jason Wang 已提交
2526 2527 2528 2529 2530
	tun_put(tun);

	return ret;
}

2531 2532
/* Ops structure to mimic raw sockets with tun */
static const struct proto_ops tun_socket_ops = {
J
Jason Wang 已提交
2533
	.peek_len = tun_peek_len,
2534 2535 2536 2537
	.sendmsg = tun_sendmsg,
	.recvmsg = tun_recvmsg,
};

2538 2539 2540
static struct proto tun_proto = {
	.name		= "tun",
	.owner		= THIS_MODULE,
J
Jason Wang 已提交
2541
	.obj_size	= sizeof(struct tun_file),
2542
};
2543

2544 2545
static int tun_flags(struct tun_struct *tun)
{
2546
	return tun->flags & (TUN_FEATURES | IFF_PERSIST | IFF_TUN | IFF_TAP);
2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559
}

static ssize_t tun_show_flags(struct device *dev, struct device_attribute *attr,
			      char *buf)
{
	struct tun_struct *tun = netdev_priv(to_net_dev(dev));
	return sprintf(buf, "0x%x\n", tun_flags(tun));
}

static ssize_t tun_show_owner(struct device *dev, struct device_attribute *attr,
			      char *buf)
{
	struct tun_struct *tun = netdev_priv(to_net_dev(dev));
2560 2561 2562 2563
	return uid_valid(tun->owner)?
		sprintf(buf, "%u\n",
			from_kuid_munged(current_user_ns(), tun->owner)):
		sprintf(buf, "-1\n");
2564 2565 2566 2567 2568 2569
}

static ssize_t tun_show_group(struct device *dev, struct device_attribute *attr,
			      char *buf)
{
	struct tun_struct *tun = netdev_priv(to_net_dev(dev));
2570 2571 2572 2573
	return gid_valid(tun->group) ?
		sprintf(buf, "%u\n",
			from_kgid_munged(current_user_ns(), tun->group)):
		sprintf(buf, "-1\n");
2574 2575 2576 2577 2578 2579
}

static DEVICE_ATTR(tun_flags, 0444, tun_show_flags, NULL);
static DEVICE_ATTR(owner, 0444, tun_show_owner, NULL);
static DEVICE_ATTR(group, 0444, tun_show_group, NULL);

2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590
static struct attribute *tun_dev_attrs[] = {
	&dev_attr_tun_flags.attr,
	&dev_attr_owner.attr,
	&dev_attr_group.attr,
	NULL
};

static const struct attribute_group tun_attr_group = {
	.attrs = tun_dev_attrs
};

2591
static int tun_set_iff(struct net *net, struct file *file, struct ifreq *ifr)
L
Linus Torvalds 已提交
2592 2593
{
	struct tun_struct *tun;
J
Jason Wang 已提交
2594
	struct tun_file *tfile = file->private_data;
L
Linus Torvalds 已提交
2595 2596 2597
	struct net_device *dev;
	int err;

2598 2599 2600
	if (tfile->detached)
		return -EINVAL;

2601 2602 2603 2604 2605 2606 2607 2608 2609
	if ((ifr->ifr_flags & IFF_NAPI_FRAGS)) {
		if (!capable(CAP_NET_ADMIN))
			return -EPERM;

		if (!(ifr->ifr_flags & IFF_NAPI) ||
		    (ifr->ifr_flags & TUN_TYPE_MASK) != IFF_TAP)
			return -EINVAL;
	}

2610 2611
	dev = __dev_get_by_name(net, ifr->ifr_name);
	if (dev) {
2612 2613
		if (ifr->ifr_flags & IFF_TUN_EXCL)
			return -EBUSY;
2614 2615 2616 2617 2618 2619 2620
		if ((ifr->ifr_flags & IFF_TUN) && dev->netdev_ops == &tun_netdev_ops)
			tun = netdev_priv(dev);
		else if ((ifr->ifr_flags & IFF_TAP) && dev->netdev_ops == &tap_netdev_ops)
			tun = netdev_priv(dev);
		else
			return -EINVAL;

2621
		if (!!(ifr->ifr_flags & IFF_MULTI_QUEUE) !=
M
Michael S. Tsirkin 已提交
2622
		    !!(tun->flags & IFF_MULTI_QUEUE))
2623 2624
			return -EINVAL;

2625
		if (tun_not_capable(tun))
P
Paul Moore 已提交
2626
			return -EPERM;
2627
		err = security_tun_dev_open(tun->security);
P
Paul Moore 已提交
2628 2629 2630
		if (err < 0)
			return err;

2631
		err = tun_attach(tun, file, ifr->ifr_flags & IFF_NOFILTER,
E
Eric Dumazet 已提交
2632
				 ifr->ifr_flags & IFF_NAPI,
2633
				 ifr->ifr_flags & IFF_NAPI_FRAGS, true);
2634 2635
		if (err < 0)
			return err;
J
Jason Wang 已提交
2636

M
Michael S. Tsirkin 已提交
2637
		if (tun->flags & IFF_MULTI_QUEUE &&
2638 2639 2640 2641
		    (tun->numqueues + tun->numdisabled > 1)) {
			/* One or more queue has already been attached, no need
			 * to initialize the device again.
			 */
2642
			netdev_state_change(dev);
2643 2644
			return 0;
		}
2645 2646 2647

		tun->flags = (tun->flags & ~TUN_FEATURES) |
			      (ifr->ifr_flags & TUN_FEATURES);
2648 2649 2650

		netdev_state_change(dev);
	} else {
L
Linus Torvalds 已提交
2651 2652
		char *name;
		unsigned long flags = 0;
2653 2654
		int queues = ifr->ifr_flags & IFF_MULTI_QUEUE ?
			     MAX_TAP_QUEUES : 1;
L
Linus Torvalds 已提交
2655

2656
		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
2657
			return -EPERM;
P
Paul Moore 已提交
2658 2659 2660
		err = security_tun_dev_create();
		if (err < 0)
			return err;
2661

L
Linus Torvalds 已提交
2662 2663 2664
		/* Set dev type */
		if (ifr->ifr_flags & IFF_TUN) {
			/* TUN device */
M
Michael S. Tsirkin 已提交
2665
			flags |= IFF_TUN;
L
Linus Torvalds 已提交
2666 2667 2668
			name = "tun%d";
		} else if (ifr->ifr_flags & IFF_TAP) {
			/* TAP device */
M
Michael S. Tsirkin 已提交
2669
			flags |= IFF_TAP;
L
Linus Torvalds 已提交
2670
			name = "tap%d";
2671
		} else
2672
			return -EINVAL;
2673

L
Linus Torvalds 已提交
2674 2675 2676
		if (*ifr->ifr_name)
			name = ifr->ifr_name;

J
Jason Wang 已提交
2677
		dev = alloc_netdev_mqs(sizeof(struct tun_struct), name,
2678 2679
				       NET_NAME_UNKNOWN, tun_setup, queues,
				       queues);
2680

L
Linus Torvalds 已提交
2681 2682 2683
		if (!dev)
			return -ENOMEM;

2684
		dev_net_set(dev, net);
2685
		dev->rtnl_link_ops = &tun_link_ops;
2686
		dev->ifindex = tfile->ifindex;
2687
		dev->sysfs_groups[0] = &tun_attr_group;
S
Stephen Hemminger 已提交
2688

L
Linus Torvalds 已提交
2689 2690 2691
		tun = netdev_priv(dev);
		tun->dev = dev;
		tun->flags = flags;
2692
		tun->txflt.count = 0;
2693
		tun->vnet_hdr_sz = sizeof(struct virtio_net_hdr);
2694

2695
		tun->align = NET_SKB_PAD;
J
Jason Wang 已提交
2696 2697
		tun->filter_attached = false;
		tun->sndbuf = tfile->socket.sk->sk_sndbuf;
J
Jason Wang 已提交
2698
		tun->rx_batched = 0;
2699
		RCU_INIT_POINTER(tun->steering_prog, NULL);
2700

2701 2702
		dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
		if (!dev->tstats) {
2703 2704 2705 2706
			err = -ENOMEM;
			goto err_free_dev;
		}

J
Jason Wang 已提交
2707 2708
		spin_lock_init(&tun->lock);

2709 2710
		err = security_tun_dev_alloc_security(&tun->security);
		if (err < 0)
2711
			goto err_free_stat;
P
Paul Moore 已提交
2712

L
Linus Torvalds 已提交
2713
		tun_net_init(dev);
2714
		tun_flow_init(tun);
J
Jason Wang 已提交
2715

2716
		dev->hw_features = NETIF_F_SG | NETIF_F_FRAGLIST |
J
Jason Wang 已提交
2717 2718
				   TUN_USER_FEATURES | NETIF_F_HW_VLAN_CTAG_TX |
				   NETIF_F_HW_VLAN_STAG_TX;
2719
		dev->features = dev->hw_features | NETIF_F_LLTX;
2720 2721 2722
		dev->vlan_features = dev->features &
				     ~(NETIF_F_HW_VLAN_CTAG_TX |
				       NETIF_F_HW_VLAN_STAG_TX);
2723

2724 2725 2726
		tun->flags = (tun->flags & ~TUN_FEATURES) |
			      (ifr->ifr_flags & TUN_FEATURES);

J
Jason Wang 已提交
2727
		INIT_LIST_HEAD(&tun->disabled);
E
Eric Dumazet 已提交
2728
		err = tun_attach(tun, file, false, ifr->ifr_flags & IFF_NAPI,
2729
				 ifr->ifr_flags & IFF_NAPI_FRAGS, false);
2730
		if (err < 0)
2731
			goto err_free_flow;
2732

L
Linus Torvalds 已提交
2733 2734
		err = register_netdevice(tun->dev);
		if (err < 0)
2735
			goto err_detach;
2736 2737 2738 2739
		/* free_netdev() won't check refcnt, to aovid race
		 * with dev_put() we need publish tun after registration.
		 */
		rcu_assign_pointer(tfile->tun, tun);
L
Linus Torvalds 已提交
2740 2741
	}

2742 2743
	netif_carrier_on(tun->dev);

2744 2745 2746 2747
	/* Make sure persistent devices do not get stuck in
	 * xoff state.
	 */
	if (netif_running(tun->dev))
J
Jason Wang 已提交
2748
		netif_tx_wake_all_queues(tun->dev);
2749

L
Linus Torvalds 已提交
2750 2751 2752
	strcpy(ifr->ifr_name, tun->dev->name);
	return 0;

2753 2754
err_detach:
	tun_detach_all(dev);
E
Eric Dumazet 已提交
2755 2756
	/* We are here because register_netdevice() has failed.
	 * If register_netdevice() already called tun_free_netdev()
2757
	 * while dealing with the error, dev->stats has been cleared.
E
Eric Dumazet 已提交
2758
	 */
2759
	if (!dev->tstats)
E
Eric Dumazet 已提交
2760
		goto err_free_dev;
2761

2762 2763 2764
err_free_flow:
	tun_flow_uninit(tun);
	security_tun_dev_free_security(tun->security);
2765
err_free_stat:
2766
	free_percpu(dev->tstats);
2767
err_free_dev:
L
Linus Torvalds 已提交
2768 2769 2770 2771
	free_netdev(dev);
	return err;
}

2772
static void tun_get_iff(struct tun_struct *tun, struct ifreq *ifr)
2773 2774 2775
{
	strcpy(ifr->ifr_name, tun->dev->name);

2776
	ifr->ifr_flags = tun_flags(tun);
2777 2778 2779

}

2780 2781
/* This is like a cut-down ethtool ops, except done via tun fd so no
 * privs required. */
2782
static int set_offload(struct tun_struct *tun, unsigned long arg)
2783
{
2784
	netdev_features_t features = 0;
2785 2786

	if (arg & TUN_F_CSUM) {
2787
		features |= NETIF_F_HW_CSUM;
2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800
		arg &= ~TUN_F_CSUM;

		if (arg & (TUN_F_TSO4|TUN_F_TSO6)) {
			if (arg & TUN_F_TSO_ECN) {
				features |= NETIF_F_TSO_ECN;
				arg &= ~TUN_F_TSO_ECN;
			}
			if (arg & TUN_F_TSO4)
				features |= NETIF_F_TSO;
			if (arg & TUN_F_TSO6)
				features |= NETIF_F_TSO6;
			arg &= ~(TUN_F_TSO4|TUN_F_TSO6);
		}
2801 2802

		arg &= ~TUN_F_UFO;
2803 2804 2805 2806 2807 2808 2809
	}

	/* This gives the user a way to test for new features in future by
	 * trying to set them. */
	if (arg)
		return -EINVAL;

2810
	tun->set_features = features;
2811 2812
	tun->dev->wanted_features &= ~TUN_USER_FEATURES;
	tun->dev->wanted_features |= features;
2813
	netdev_update_features(tun->dev);
2814 2815 2816 2817

	return 0;
}

J
Jason Wang 已提交
2818 2819 2820 2821 2822 2823
static void tun_detach_filter(struct tun_struct *tun, int n)
{
	int i;
	struct tun_file *tfile;

	for (i = 0; i < n; i++) {
2824
		tfile = rtnl_dereference(tun->tfiles[i]);
2825 2826 2827
		lock_sock(tfile->socket.sk);
		sk_detach_filter(tfile->socket.sk);
		release_sock(tfile->socket.sk);
J
Jason Wang 已提交
2828 2829 2830 2831 2832 2833 2834 2835 2836 2837 2838
	}

	tun->filter_attached = false;
}

static int tun_attach_filter(struct tun_struct *tun)
{
	int i, ret = 0;
	struct tun_file *tfile;

	for (i = 0; i < tun->numqueues; i++) {
2839
		tfile = rtnl_dereference(tun->tfiles[i]);
2840 2841 2842
		lock_sock(tfile->socket.sk);
		ret = sk_attach_filter(&tun->fprog, tfile->socket.sk);
		release_sock(tfile->socket.sk);
J
Jason Wang 已提交
2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858
		if (ret) {
			tun_detach_filter(tun, i);
			return ret;
		}
	}

	tun->filter_attached = true;
	return ret;
}

static void tun_set_sndbuf(struct tun_struct *tun)
{
	struct tun_file *tfile;
	int i;

	for (i = 0; i < tun->numqueues; i++) {
2859
		tfile = rtnl_dereference(tun->tfiles[i]);
J
Jason Wang 已提交
2860 2861 2862 2863
		tfile->socket.sk->sk_sndbuf = tun->sndbuf;
	}
}

2864 2865 2866 2867 2868 2869 2870 2871 2872
static int tun_set_queue(struct file *file, struct ifreq *ifr)
{
	struct tun_file *tfile = file->private_data;
	struct tun_struct *tun;
	int ret = 0;

	rtnl_lock();

	if (ifr->ifr_flags & IFF_ATTACH_QUEUE) {
J
Jason Wang 已提交
2873
		tun = tfile->detached;
2874
		if (!tun) {
2875
			ret = -EINVAL;
2876 2877 2878 2879 2880
			goto unlock;
		}
		ret = security_tun_dev_attach_queue(tun->security);
		if (ret < 0)
			goto unlock;
E
Eric Dumazet 已提交
2881
		ret = tun_attach(tun, file, false, tun->flags & IFF_NAPI,
2882
				 tun->flags & IFF_NAPI_FRAGS, true);
J
Jason Wang 已提交
2883
	} else if (ifr->ifr_flags & IFF_DETACH_QUEUE) {
2884
		tun = rtnl_dereference(tfile->tun);
M
Michael S. Tsirkin 已提交
2885
		if (!tun || !(tun->flags & IFF_MULTI_QUEUE) || tfile->detached)
J
Jason Wang 已提交
2886 2887 2888 2889
			ret = -EINVAL;
		else
			__tun_detach(tfile, false);
	} else
2890 2891
		ret = -EINVAL;

2892 2893 2894
	if (ret >= 0)
		netdev_state_change(tun->dev);

2895
unlock:
2896 2897 2898 2899
	rtnl_unlock();
	return ret;
}

2900
static int tun_set_ebpf(struct tun_struct *tun, struct tun_prog __rcu **prog_p,
2901
			void __user *data)
2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916
{
	struct bpf_prog *prog;
	int fd;

	if (copy_from_user(&fd, data, sizeof(fd)))
		return -EFAULT;

	if (fd == -1) {
		prog = NULL;
	} else {
		prog = bpf_prog_get_type(fd, BPF_PROG_TYPE_SOCKET_FILTER);
		if (IS_ERR(prog))
			return PTR_ERR(prog);
	}

2917
	return __tun_set_ebpf(tun, prog_p, prog);
2918 2919
}

2920 2921
static long __tun_chr_ioctl(struct file *file, unsigned int cmd,
			    unsigned long arg, int ifreq_len)
L
Linus Torvalds 已提交
2922
{
E
Eric W. Biederman 已提交
2923
	struct tun_file *tfile = file->private_data;
2924
	struct net *net = sock_net(&tfile->sk);
E
Eric W. Biederman 已提交
2925
	struct tun_struct *tun;
L
Linus Torvalds 已提交
2926
	void __user* argp = (void __user*)arg;
N
Nicolas Dichtel 已提交
2927
	unsigned int ifindex, carrier;
L
Linus Torvalds 已提交
2928
	struct ifreq ifr;
2929 2930
	kuid_t owner;
	kgid_t group;
2931
	int sndbuf;
2932
	int vnet_hdr_sz;
M
Michael S. Tsirkin 已提交
2933
	int le;
2934
	int ret;
2935
	bool do_notify = false;
L
Linus Torvalds 已提交
2936

2937 2938
	if (cmd == TUNSETIFF || cmd == TUNSETQUEUE ||
	    (_IOC_TYPE(cmd) == SOCK_IOC_TYPE && cmd != SIOCGSKNS)) {
2939
		if (copy_from_user(&ifr, argp, ifreq_len))
L
Linus Torvalds 已提交
2940
			return -EFAULT;
D
David S. Miller 已提交
2941
	} else {
2942
		memset(&ifr, 0, sizeof(ifr));
D
David S. Miller 已提交
2943
	}
E
Eric W. Biederman 已提交
2944 2945 2946
	if (cmd == TUNGETFEATURES) {
		/* Currently this just means: "what IFF flags are valid?".
		 * This is needed because we never checked for invalid flags on
2947 2948 2949
		 * TUNSETIFF.
		 */
		return put_user(IFF_TUN | IFF_TAP | TUN_FEATURES,
E
Eric W. Biederman 已提交
2950
				(unsigned int __user*)argp);
2951
	} else if (cmd == TUNSETQUEUE) {
2952
		return tun_set_queue(file, &ifr);
2953 2954 2955 2956 2957
	} else if (cmd == SIOCGSKNS) {
		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
			return -EPERM;
		return open_related_ns(&net->ns, get_net_ns);
	}
E
Eric W. Biederman 已提交
2958

J
Jason Wang 已提交
2959
	ret = 0;
2960 2961
	rtnl_lock();

2962
	tun = tun_get(tfile);
2963 2964 2965 2966 2967
	if (cmd == TUNSETIFF) {
		ret = -EEXIST;
		if (tun)
			goto unlock;

L
Linus Torvalds 已提交
2968 2969
		ifr.ifr_name[IFNAMSIZ-1] = '\0';

2970
		ret = tun_set_iff(net, file, &ifr);
L
Linus Torvalds 已提交
2971

2972 2973
		if (ret)
			goto unlock;
L
Linus Torvalds 已提交
2974

2975
		if (copy_to_user(argp, &ifr, ifreq_len))
2976 2977
			ret = -EFAULT;
		goto unlock;
L
Linus Torvalds 已提交
2978
	}
2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991
	if (cmd == TUNSETIFINDEX) {
		ret = -EPERM;
		if (tun)
			goto unlock;

		ret = -EFAULT;
		if (copy_from_user(&ifindex, argp, sizeof(ifindex)))
			goto unlock;

		ret = 0;
		tfile->ifindex = ifindex;
		goto unlock;
	}
L
Linus Torvalds 已提交
2992

2993
	ret = -EBADFD;
L
Linus Torvalds 已提交
2994
	if (!tun)
2995
		goto unlock;
L
Linus Torvalds 已提交
2996

2997
	netif_info(tun, drv, tun->dev, "tun_chr_ioctl cmd %u\n", cmd);
L
Linus Torvalds 已提交
2998

2999
	net = dev_net(tun->dev);
E
Eric W. Biederman 已提交
3000
	ret = 0;
L
Linus Torvalds 已提交
3001
	switch (cmd) {
3002
	case TUNGETIFF:
3003
		tun_get_iff(tun, &ifr);
3004

3005 3006
		if (tfile->detached)
			ifr.ifr_flags |= IFF_DETACH_QUEUE;
3007 3008
		if (!tfile->socket.sk->sk_filter)
			ifr.ifr_flags |= IFF_NOFILTER;
3009

3010
		if (copy_to_user(argp, &ifr, ifreq_len))
E
Eric W. Biederman 已提交
3011
			ret = -EFAULT;
3012 3013
		break;

L
Linus Torvalds 已提交
3014 3015 3016
	case TUNSETNOCSUM:
		/* Disable/Enable checksum */

3017
		/* [unimplemented] */
3018 3019
		netif_info(tun, drv, tun->dev, "ignored: set checksum %s\n",
			   arg ? "disabled" : "enabled");
L
Linus Torvalds 已提交
3020 3021 3022
		break;

	case TUNSETPERSIST:
J
Jason Wang 已提交
3023 3024 3025
		/* Disable/Enable persist mode. Keep an extra reference to the
		 * module to prevent the module being unprobed.
		 */
M
Michael S. Tsirkin 已提交
3026 3027
		if (arg && !(tun->flags & IFF_PERSIST)) {
			tun->flags |= IFF_PERSIST;
J
Jason Wang 已提交
3028
			__module_get(THIS_MODULE);
3029
			do_notify = true;
J
Jason Wang 已提交
3030
		}
M
Michael S. Tsirkin 已提交
3031 3032
		if (!arg && (tun->flags & IFF_PERSIST)) {
			tun->flags &= ~IFF_PERSIST;
J
Jason Wang 已提交
3033
			module_put(THIS_MODULE);
3034
			do_notify = true;
J
Jason Wang 已提交
3035
		}
L
Linus Torvalds 已提交
3036

3037 3038
		netif_info(tun, drv, tun->dev, "persist %s\n",
			   arg ? "enabled" : "disabled");
L
Linus Torvalds 已提交
3039 3040 3041 3042
		break;

	case TUNSETOWNER:
		/* Set owner of the device */
3043 3044 3045 3046 3047 3048
		owner = make_kuid(current_user_ns(), arg);
		if (!uid_valid(owner)) {
			ret = -EINVAL;
			break;
		}
		tun->owner = owner;
3049
		do_notify = true;
3050 3051
		netif_info(tun, drv, tun->dev, "owner set to %u\n",
			   from_kuid(&init_user_ns, tun->owner));
L
Linus Torvalds 已提交
3052 3053
		break;

3054 3055
	case TUNSETGROUP:
		/* Set group of the device */
3056 3057 3058 3059 3060 3061
		group = make_kgid(current_user_ns(), arg);
		if (!gid_valid(group)) {
			ret = -EINVAL;
			break;
		}
		tun->group = group;
3062
		do_notify = true;
3063 3064
		netif_info(tun, drv, tun->dev, "group set to %u\n",
			   from_kgid(&init_user_ns, tun->group));
3065 3066
		break;

3067 3068 3069
	case TUNSETLINK:
		/* Only allow setting the type when the interface is down */
		if (tun->dev->flags & IFF_UP) {
3070 3071
			netif_info(tun, drv, tun->dev,
				   "Linktype set failed because interface is up\n");
3072
			ret = -EBUSY;
3073
		} else {
3074 3075 3076 3077 3078 3079 3080 3081
			ret = call_netdevice_notifiers(NETDEV_PRE_TYPE_CHANGE,
						       tun->dev);
			ret = notifier_to_errno(ret);
			if (ret) {
				netif_info(tun, drv, tun->dev,
					   "Refused to change device type\n");
				break;
			}
3082
			tun->dev->type = (int) arg;
3083 3084
			netif_info(tun, drv, tun->dev, "linktype set to %d\n",
				   tun->dev->type);
3085 3086
			call_netdevice_notifiers(NETDEV_POST_TYPE_CHANGE,
						 tun->dev);
3087
		}
E
Eric W. Biederman 已提交
3088
		break;
3089

L
Linus Torvalds 已提交
3090
	case TUNSETDEBUG:
3091
		tun->msg_enable = (u32)arg;
L
Linus Torvalds 已提交
3092
		break;
3093

3094
	case TUNSETOFFLOAD:
3095
		ret = set_offload(tun, arg);
E
Eric W. Biederman 已提交
3096
		break;
3097

3098 3099
	case TUNSETTXFILTER:
		/* Can be set only for TAPs */
E
Eric W. Biederman 已提交
3100
		ret = -EINVAL;
M
Michael S. Tsirkin 已提交
3101
		if ((tun->flags & TUN_TYPE_MASK) != IFF_TAP)
E
Eric W. Biederman 已提交
3102
			break;
H
Harvey Harrison 已提交
3103
		ret = update_filter(&tun->txflt, (void __user *)arg);
E
Eric W. Biederman 已提交
3104
		break;
L
Linus Torvalds 已提交
3105 3106

	case SIOCGIFHWADDR:
3107
		/* Get hw address */
3108 3109
		memcpy(ifr.ifr_hwaddr.sa_data, tun->dev->dev_addr, ETH_ALEN);
		ifr.ifr_hwaddr.sa_family = tun->dev->type;
3110
		if (copy_to_user(argp, &ifr, ifreq_len))
E
Eric W. Biederman 已提交
3111 3112
			ret = -EFAULT;
		break;
L
Linus Torvalds 已提交
3113 3114

	case SIOCSIFHWADDR:
3115
		/* Set hw address */
3116
		ret = dev_set_mac_address(tun->dev, &ifr.ifr_hwaddr, NULL);
E
Eric W. Biederman 已提交
3117
		break;
3118 3119

	case TUNGETSNDBUF:
J
Jason Wang 已提交
3120
		sndbuf = tfile->socket.sk->sk_sndbuf;
3121 3122 3123 3124 3125 3126 3127 3128 3129
		if (copy_to_user(argp, &sndbuf, sizeof(sndbuf)))
			ret = -EFAULT;
		break;

	case TUNSETSNDBUF:
		if (copy_from_user(&sndbuf, argp, sizeof(sndbuf))) {
			ret = -EFAULT;
			break;
		}
3130 3131 3132 3133
		if (sndbuf <= 0) {
			ret = -EINVAL;
			break;
		}
3134

J
Jason Wang 已提交
3135 3136
		tun->sndbuf = sndbuf;
		tun_set_sndbuf(tun);
3137 3138
		break;

3139 3140 3141 3142 3143 3144 3145 3146 3147 3148 3149 3150 3151 3152 3153 3154 3155 3156 3157
	case TUNGETVNETHDRSZ:
		vnet_hdr_sz = tun->vnet_hdr_sz;
		if (copy_to_user(argp, &vnet_hdr_sz, sizeof(vnet_hdr_sz)))
			ret = -EFAULT;
		break;

	case TUNSETVNETHDRSZ:
		if (copy_from_user(&vnet_hdr_sz, argp, sizeof(vnet_hdr_sz))) {
			ret = -EFAULT;
			break;
		}
		if (vnet_hdr_sz < (int)sizeof(struct virtio_net_hdr)) {
			ret = -EINVAL;
			break;
		}

		tun->vnet_hdr_sz = vnet_hdr_sz;
		break;

M
Michael S. Tsirkin 已提交
3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170 3171 3172 3173 3174
	case TUNGETVNETLE:
		le = !!(tun->flags & TUN_VNET_LE);
		if (put_user(le, (int __user *)argp))
			ret = -EFAULT;
		break;

	case TUNSETVNETLE:
		if (get_user(le, (int __user *)argp)) {
			ret = -EFAULT;
			break;
		}
		if (le)
			tun->flags |= TUN_VNET_LE;
		else
			tun->flags &= ~TUN_VNET_LE;
		break;

3175 3176 3177 3178 3179 3180 3181 3182
	case TUNGETVNETBE:
		ret = tun_get_vnet_be(tun, argp);
		break;

	case TUNSETVNETBE:
		ret = tun_set_vnet_be(tun, argp);
		break;

M
Michael S. Tsirkin 已提交
3183 3184 3185
	case TUNATTACHFILTER:
		/* Can be set only for TAPs */
		ret = -EINVAL;
M
Michael S. Tsirkin 已提交
3186
		if ((tun->flags & TUN_TYPE_MASK) != IFF_TAP)
M
Michael S. Tsirkin 已提交
3187 3188
			break;
		ret = -EFAULT;
J
Jason Wang 已提交
3189
		if (copy_from_user(&tun->fprog, argp, sizeof(tun->fprog)))
M
Michael S. Tsirkin 已提交
3190 3191
			break;

J
Jason Wang 已提交
3192
		ret = tun_attach_filter(tun);
M
Michael S. Tsirkin 已提交
3193 3194 3195 3196 3197
		break;

	case TUNDETACHFILTER:
		/* Can be set only for TAPs */
		ret = -EINVAL;
M
Michael S. Tsirkin 已提交
3198
		if ((tun->flags & TUN_TYPE_MASK) != IFF_TAP)
M
Michael S. Tsirkin 已提交
3199
			break;
J
Jason Wang 已提交
3200 3201
		ret = 0;
		tun_detach_filter(tun, tun->numqueues);
M
Michael S. Tsirkin 已提交
3202 3203
		break;

P
Pavel Emelyanov 已提交
3204 3205
	case TUNGETFILTER:
		ret = -EINVAL;
M
Michael S. Tsirkin 已提交
3206
		if ((tun->flags & TUN_TYPE_MASK) != IFF_TAP)
P
Pavel Emelyanov 已提交
3207 3208 3209 3210 3211 3212 3213
			break;
		ret = -EFAULT;
		if (copy_to_user(argp, &tun->fprog, sizeof(tun->fprog)))
			break;
		ret = 0;
		break;

3214
	case TUNSETSTEERINGEBPF:
3215
		ret = tun_set_ebpf(tun, &tun->steering_prog, argp);
3216 3217
		break;

3218 3219 3220 3221
	case TUNSETFILTEREBPF:
		ret = tun_set_ebpf(tun, &tun->filter_prog, argp);
		break;

N
Nicolas Dichtel 已提交
3222 3223 3224 3225 3226 3227 3228 3229
	case TUNSETCARRIER:
		ret = -EFAULT;
		if (copy_from_user(&carrier, argp, sizeof(carrier)))
			goto unlock;

		ret = tun_net_change_carrier(tun->dev, (bool)carrier);
		break;

3230 3231 3232 3233 3234 3235 3236
	case TUNGETDEVNETNS:
		ret = -EPERM;
		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
			goto unlock;
		ret = open_related_ns(&net->ns, get_net_ns);
		break;

L
Linus Torvalds 已提交
3237
	default:
E
Eric W. Biederman 已提交
3238 3239
		ret = -EINVAL;
		break;
3240
	}
L
Linus Torvalds 已提交
3241

3242 3243 3244
	if (do_notify)
		netdev_state_change(tun->dev);

3245 3246 3247 3248
unlock:
	rtnl_unlock();
	if (tun)
		tun_put(tun);
E
Eric W. Biederman 已提交
3249
	return ret;
L
Linus Torvalds 已提交
3250 3251
}

3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286
static long tun_chr_ioctl(struct file *file,
			  unsigned int cmd, unsigned long arg)
{
	return __tun_chr_ioctl(file, cmd, arg, sizeof (struct ifreq));
}

#ifdef CONFIG_COMPAT
static long tun_chr_compat_ioctl(struct file *file,
			 unsigned int cmd, unsigned long arg)
{
	switch (cmd) {
	case TUNSETIFF:
	case TUNGETIFF:
	case TUNSETTXFILTER:
	case TUNGETSNDBUF:
	case TUNSETSNDBUF:
	case SIOCGIFHWADDR:
	case SIOCSIFHWADDR:
		arg = (unsigned long)compat_ptr(arg);
		break;
	default:
		arg = (compat_ulong_t)arg;
		break;
	}

	/*
	 * compat_ifreq is shorter than ifreq, so we must not access beyond
	 * the end of that structure. All fields that are used in this
	 * driver are compatible though, we don't need to convert the
	 * contents.
	 */
	return __tun_chr_ioctl(file, cmd, arg, sizeof(struct compat_ifreq));
}
#endif /* CONFIG_COMPAT */

L
Linus Torvalds 已提交
3287 3288
static int tun_chr_fasync(int fd, struct file *file, int on)
{
J
Jason Wang 已提交
3289
	struct tun_file *tfile = file->private_data;
L
Linus Torvalds 已提交
3290 3291
	int ret;

J
Jason Wang 已提交
3292
	if ((ret = fasync_helper(fd, file, on, &tfile->fasync)) < 0)
J
Jonathan Corbet 已提交
3293
		goto out;
3294

L
Linus Torvalds 已提交
3295
	if (on) {
3296
		__f_setown(file, task_pid(current), PIDTYPE_TGID, 0);
J
Jason Wang 已提交
3297
		tfile->flags |= TUN_FASYNC;
3298
	} else
J
Jason Wang 已提交
3299
		tfile->flags &= ~TUN_FASYNC;
J
Jonathan Corbet 已提交
3300 3301 3302
	ret = 0;
out:
	return ret;
L
Linus Torvalds 已提交
3303 3304 3305 3306
}

static int tun_chr_open(struct inode *inode, struct file * file)
{
3307
	struct net *net = current->nsproxy->net_ns;
E
Eric W. Biederman 已提交
3308
	struct tun_file *tfile;
T
Thomas Gleixner 已提交
3309

3310
	tfile = (struct tun_file *)sk_alloc(net, AF_UNSPEC, GFP_KERNEL,
3311
					    &tun_proto, 0);
E
Eric W. Biederman 已提交
3312 3313
	if (!tfile)
		return -ENOMEM;
3314 3315 3316 3317 3318
	if (ptr_ring_init(&tfile->tx_ring, 0, GFP_KERNEL)) {
		sk_free(&tfile->sk);
		return -ENOMEM;
	}

3319
	mutex_init(&tfile->napi_mutex);
3320
	RCU_INIT_POINTER(tfile->tun, NULL);
J
Jason Wang 已提交
3321
	tfile->flags = 0;
3322
	tfile->ifindex = 0;
J
Jason Wang 已提交
3323

3324
	init_waitqueue_head(&tfile->socket.wq.wait);
J
Jason Wang 已提交
3325 3326 3327 3328 3329 3330 3331 3332 3333

	tfile->socket.file = file;
	tfile->socket.ops = &tun_socket_ops;

	sock_init_data(&tfile->socket, &tfile->sk);

	tfile->sk.sk_write_space = tun_sock_write_space;
	tfile->sk.sk_sndbuf = INT_MAX;

E
Eric W. Biederman 已提交
3334
	file->private_data = tfile;
J
Jason Wang 已提交
3335
	INIT_LIST_HEAD(&tfile->next);
J
Jason Wang 已提交
3336

3337 3338
	sock_set_flag(&tfile->sk, SOCK_ZEROCOPY);

L
Linus Torvalds 已提交
3339 3340 3341 3342 3343
	return 0;
}

static int tun_chr_close(struct inode *inode, struct file *file)
{
E
Eric W. Biederman 已提交
3344
	struct tun_file *tfile = file->private_data;
L
Linus Torvalds 已提交
3345

J
Jason Wang 已提交
3346
	tun_detach(tfile, true);
L
Linus Torvalds 已提交
3347 3348 3349 3350

	return 0;
}

3351
#ifdef CONFIG_PROC_FS
3352
static void tun_chr_show_fdinfo(struct seq_file *m, struct file *file)
3353
{
3354
	struct tun_file *tfile = file->private_data;
3355 3356 3357 3358 3359 3360
	struct tun_struct *tun;
	struct ifreq ifr;

	memset(&ifr, 0, sizeof(ifr));

	rtnl_lock();
3361
	tun = tun_get(tfile);
3362
	if (tun)
3363
		tun_get_iff(tun, &ifr);
3364 3365 3366 3367 3368
	rtnl_unlock();

	if (tun)
		tun_put(tun);

3369
	seq_printf(m, "iff:\t%s\n", ifr.ifr_name);
3370 3371 3372
}
#endif

3373
static const struct file_operations tun_fops = {
3374
	.owner	= THIS_MODULE,
L
Linus Torvalds 已提交
3375
	.llseek = no_llseek,
3376
	.read_iter  = tun_chr_read_iter,
3377
	.write_iter = tun_chr_write_iter,
L
Linus Torvalds 已提交
3378
	.poll	= tun_chr_poll,
3379 3380 3381 3382
	.unlocked_ioctl	= tun_chr_ioctl,
#ifdef CONFIG_COMPAT
	.compat_ioctl = tun_chr_compat_ioctl,
#endif
L
Linus Torvalds 已提交
3383 3384
	.open	= tun_chr_open,
	.release = tun_chr_close,
3385 3386 3387 3388
	.fasync = tun_chr_fasync,
#ifdef CONFIG_PROC_FS
	.show_fdinfo = tun_chr_show_fdinfo,
#endif
L
Linus Torvalds 已提交
3389 3390 3391 3392 3393
};

static struct miscdevice tun_miscdev = {
	.minor = TUN_MINOR,
	.name = "tun",
3394
	.nodename = "net/tun",
L
Linus Torvalds 已提交
3395 3396 3397 3398 3399
	.fops = &tun_fops,
};

/* ethtool interface */

3400 3401
static void tun_default_link_ksettings(struct net_device *dev,
				       struct ethtool_link_ksettings *cmd)
3402 3403 3404 3405 3406 3407 3408 3409
{
	ethtool_link_ksettings_zero_link_mode(cmd, supported);
	ethtool_link_ksettings_zero_link_mode(cmd, advertising);
	cmd->base.speed		= SPEED_10;
	cmd->base.duplex	= DUPLEX_FULL;
	cmd->base.port		= PORT_TP;
	cmd->base.phy_address	= 0;
	cmd->base.autoneg	= AUTONEG_DISABLE;
3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425 3426
}

static int tun_get_link_ksettings(struct net_device *dev,
				  struct ethtool_link_ksettings *cmd)
{
	struct tun_struct *tun = netdev_priv(dev);

	memcpy(cmd, &tun->link_ksettings, sizeof(*cmd));
	return 0;
}

static int tun_set_link_ksettings(struct net_device *dev,
				  const struct ethtool_link_ksettings *cmd)
{
	struct tun_struct *tun = netdev_priv(dev);

	memcpy(&tun->link_ksettings, cmd, sizeof(*cmd));
L
Linus Torvalds 已提交
3427 3428 3429 3430 3431 3432 3433
	return 0;
}

static void tun_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
{
	struct tun_struct *tun = netdev_priv(dev);

3434 3435
	strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
	strlcpy(info->version, DRV_VERSION, sizeof(info->version));
L
Linus Torvalds 已提交
3436 3437

	switch (tun->flags & TUN_TYPE_MASK) {
M
Michael S. Tsirkin 已提交
3438
	case IFF_TUN:
3439
		strlcpy(info->bus_info, "tun", sizeof(info->bus_info));
L
Linus Torvalds 已提交
3440
		break;
M
Michael S. Tsirkin 已提交
3441
	case IFF_TAP:
3442
		strlcpy(info->bus_info, "tap", sizeof(info->bus_info));
L
Linus Torvalds 已提交
3443 3444 3445 3446 3447 3448 3449
		break;
	}
}

static u32 tun_get_msglevel(struct net_device *dev)
{
	struct tun_struct *tun = netdev_priv(dev);
3450 3451

	return tun->msg_enable;
L
Linus Torvalds 已提交
3452 3453 3454 3455 3456
}

static void tun_set_msglevel(struct net_device *dev, u32 value)
{
	struct tun_struct *tun = netdev_priv(dev);
3457 3458

	tun->msg_enable = value;
L
Linus Torvalds 已提交
3459 3460
}

J
Jason Wang 已提交
3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476 3477 3478 3479 3480 3481 3482 3483
static int tun_get_coalesce(struct net_device *dev,
			    struct ethtool_coalesce *ec)
{
	struct tun_struct *tun = netdev_priv(dev);

	ec->rx_max_coalesced_frames = tun->rx_batched;

	return 0;
}

static int tun_set_coalesce(struct net_device *dev,
			    struct ethtool_coalesce *ec)
{
	struct tun_struct *tun = netdev_priv(dev);

	if (ec->rx_max_coalesced_frames > NAPI_POLL_WEIGHT)
		tun->rx_batched = NAPI_POLL_WEIGHT;
	else
		tun->rx_batched = ec->rx_max_coalesced_frames;

	return 0;
}

3484
static const struct ethtool_ops tun_ethtool_ops = {
3485
	.supported_coalesce_params = ETHTOOL_COALESCE_RX_MAX_FRAMES,
L
Linus Torvalds 已提交
3486 3487 3488
	.get_drvinfo	= tun_get_drvinfo,
	.get_msglevel	= tun_get_msglevel,
	.set_msglevel	= tun_set_msglevel,
3489
	.get_link	= ethtool_op_get_link,
3490
	.get_ts_info	= ethtool_op_get_ts_info,
J
Jason Wang 已提交
3491 3492
	.get_coalesce   = tun_get_coalesce,
	.set_coalesce   = tun_set_coalesce,
3493
	.get_link_ksettings = tun_get_link_ksettings,
3494
	.set_link_ksettings = tun_set_link_ksettings,
L
Linus Torvalds 已提交
3495 3496
};

J
Jason Wang 已提交
3497 3498 3499 3500
static int tun_queue_resize(struct tun_struct *tun)
{
	struct net_device *dev = tun->dev;
	struct tun_file *tfile;
3501
	struct ptr_ring **rings;
J
Jason Wang 已提交
3502 3503 3504
	int n = tun->numqueues + tun->numdisabled;
	int ret, i;

3505 3506
	rings = kmalloc_array(n, sizeof(*rings), GFP_KERNEL);
	if (!rings)
J
Jason Wang 已提交
3507 3508 3509 3510
		return -ENOMEM;

	for (i = 0; i < tun->numqueues; i++) {
		tfile = rtnl_dereference(tun->tfiles[i]);
3511
		rings[i] = &tfile->tx_ring;
J
Jason Wang 已提交
3512 3513
	}
	list_for_each_entry(tfile, &tun->disabled, next)
3514
		rings[i++] = &tfile->tx_ring;
J
Jason Wang 已提交
3515

3516 3517
	ret = ptr_ring_resize_multiple(rings, n,
				       dev->tx_queue_len, GFP_KERNEL,
J
Jason Wang 已提交
3518
				       tun_ptr_free);
J
Jason Wang 已提交
3519

3520
	kfree(rings);
J
Jason Wang 已提交
3521 3522 3523 3524 3525 3526 3527 3528
	return ret;
}

static int tun_device_event(struct notifier_block *unused,
			    unsigned long event, void *ptr)
{
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
	struct tun_struct *tun = netdev_priv(dev);
3529
	int i;
J
Jason Wang 已提交
3530

3531 3532 3533
	if (dev->rtnl_link_ops != &tun_link_ops)
		return NOTIFY_DONE;

J
Jason Wang 已提交
3534 3535 3536 3537 3538
	switch (event) {
	case NETDEV_CHANGE_TX_QUEUE_LEN:
		if (tun_queue_resize(tun))
			return NOTIFY_BAD;
		break;
3539 3540 3541 3542 3543 3544 3545 3546
	case NETDEV_UP:
		for (i = 0; i < tun->numqueues; i++) {
			struct tun_file *tfile;

			tfile = rtnl_dereference(tun->tfiles[i]);
			tfile->socket.sk->sk_write_space(tfile->socket.sk);
		}
		break;
J
Jason Wang 已提交
3547 3548 3549 3550 3551 3552 3553 3554 3555 3556
	default:
		break;
	}

	return NOTIFY_DONE;
}

static struct notifier_block tun_notifier_block __read_mostly = {
	.notifier_call	= tun_device_event,
};
3557

L
Linus Torvalds 已提交
3558 3559 3560 3561
static int __init tun_init(void)
{
	int ret = 0;

3562
	pr_info("%s, %s\n", DRV_DESCRIPTION, DRV_VERSION);
L
Linus Torvalds 已提交
3563

3564
	ret = rtnl_link_register(&tun_link_ops);
3565
	if (ret) {
3566
		pr_err("Can't register link_ops\n");
3567
		goto err_linkops;
3568 3569
	}

L
Linus Torvalds 已提交
3570
	ret = misc_register(&tun_miscdev);
3571
	if (ret) {
3572
		pr_err("Can't register misc device %d\n", TUN_MINOR);
3573 3574
		goto err_misc;
	}
J
Jason Wang 已提交
3575

3576 3577 3578 3579 3580 3581
	ret = register_netdevice_notifier(&tun_notifier_block);
	if (ret) {
		pr_err("Can't register netdevice notifier\n");
		goto err_notifier;
	}

3582
	return  0;
3583 3584 3585

err_notifier:
	misc_deregister(&tun_miscdev);
3586
err_misc:
3587 3588
	rtnl_link_unregister(&tun_link_ops);
err_linkops:
L
Linus Torvalds 已提交
3589 3590 3591 3592 3593
	return ret;
}

static void tun_cleanup(void)
{
3594
	misc_deregister(&tun_miscdev);
3595
	rtnl_link_unregister(&tun_link_ops);
J
Jason Wang 已提交
3596
	unregister_netdevice_notifier(&tun_notifier_block);
L
Linus Torvalds 已提交
3597 3598
}

3599 3600 3601 3602 3603 3604
/* Get an underlying socket object from tun file.  Returns error unless file is
 * attached to a device.  The returned object works like a packet socket, it
 * can be used for sock_sendmsg/sock_recvmsg.  The caller is responsible for
 * holding a reference to the file for as long as the socket is in use. */
struct socket *tun_get_socket(struct file *file)
{
3605
	struct tun_file *tfile;
3606 3607
	if (file->f_op != &tun_fops)
		return ERR_PTR(-EINVAL);
3608 3609
	tfile = file->private_data;
	if (!tfile)
3610
		return ERR_PTR(-EBADFD);
J
Jason Wang 已提交
3611
	return &tfile->socket;
3612 3613 3614
}
EXPORT_SYMBOL_GPL(tun_get_socket);

3615
struct ptr_ring *tun_get_tx_ring(struct file *file)
J
Jason Wang 已提交
3616 3617 3618 3619 3620 3621 3622 3623
{
	struct tun_file *tfile;

	if (file->f_op != &tun_fops)
		return ERR_PTR(-EINVAL);
	tfile = file->private_data;
	if (!tfile)
		return ERR_PTR(-EBADFD);
3624
	return &tfile->tx_ring;
J
Jason Wang 已提交
3625
}
3626
EXPORT_SYMBOL_GPL(tun_get_tx_ring);
J
Jason Wang 已提交
3627

L
Linus Torvalds 已提交
3628 3629 3630 3631 3632 3633
module_init(tun_init);
module_exit(tun_cleanup);
MODULE_DESCRIPTION(DRV_DESCRIPTION);
MODULE_AUTHOR(DRV_COPYRIGHT);
MODULE_LICENSE("GPL");
MODULE_ALIAS_MISCDEV(TUN_MINOR);
3634
MODULE_ALIAS("devname:net/tun");