ip_gre.c 39.5 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2
 *	Linux NET3:	GRE over IP protocol decoder.
L
Linus Torvalds 已提交
3 4 5 6 7 8 9 10 11 12
 *
 *	Authors: Alexey Kuznetsov (kuznet@ms2.inr.ac.ru)
 *
 *	This program is free software; you can redistribute it and/or
 *	modify it under the terms of the GNU General Public License
 *	as published by the Free Software Foundation; either version
 *	2 of the License, or (at your option) any later version.
 *
 */

13 14
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

15
#include <linux/capability.h>
L
Linus Torvalds 已提交
16 17 18
#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
19
#include <linux/slab.h>
20
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
21 22 23 24 25 26
#include <linux/skbuff.h>
#include <linux/netdevice.h>
#include <linux/in.h>
#include <linux/tcp.h>
#include <linux/udp.h>
#include <linux/if_arp.h>
27
#include <linux/if_vlan.h>
L
Linus Torvalds 已提交
28 29 30 31 32
#include <linux/init.h>
#include <linux/in6.h>
#include <linux/inetdevice.h>
#include <linux/igmp.h>
#include <linux/netfilter_ipv4.h>
33
#include <linux/etherdevice.h>
34
#include <linux/if_ether.h>
L
Linus Torvalds 已提交
35 36 37 38 39

#include <net/sock.h>
#include <net/ip.h>
#include <net/icmp.h>
#include <net/protocol.h>
40
#include <net/ip_tunnels.h>
L
Linus Torvalds 已提交
41 42 43 44 45
#include <net/arp.h>
#include <net/checksum.h>
#include <net/dsfield.h>
#include <net/inet_ecn.h>
#include <net/xfrm.h>
46 47
#include <net/net_namespace.h>
#include <net/netns/generic.h>
H
Herbert Xu 已提交
48
#include <net/rtnetlink.h>
49
#include <net/gre.h>
50
#include <net/dst_metadata.h>
51
#include <net/erspan.h>
L
Linus Torvalds 已提交
52 53 54 55 56 57 58 59 60 61 62 63 64

/*
   Problems & solutions
   --------------------

   1. The most important issue is detecting local dead loops.
   They would cause complete host lockup in transmit, which
   would be "resolved" by stack overflow or, if queueing is enabled,
   with infinite looping in net_bh.

   We cannot track such dead loops during route installation,
   it is infeasible task. The most general solutions would be
   to keep skb->encapsulation counter (sort of local ttl),
E
Eric Dumazet 已提交
65
   and silently drop packet when it expires. It is a good
66
   solution, but it supposes maintaining new variable in ALL
L
Linus Torvalds 已提交
67 68
   skb, even if no tunneling is used.

E
Eric Dumazet 已提交
69 70 71
   Current solution: xmit_recursion breaks dead loops. This is a percpu
   counter, since when we enter the first ndo_xmit(), cpu migration is
   forbidden. We force an exit if this counter reaches RECURSION_LIMIT
L
Linus Torvalds 已提交
72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91

   2. Networking dead loops would not kill routers, but would really
   kill network. IP hop limit plays role of "t->recursion" in this case,
   if we copy it from packet being encapsulated to upper header.
   It is very good solution, but it introduces two problems:

   - Routing protocols, using packets with ttl=1 (OSPF, RIP2),
     do not work over tunnels.
   - traceroute does not work. I planned to relay ICMP from tunnel,
     so that this problem would be solved and traceroute output
     would even more informative. This idea appeared to be wrong:
     only Linux complies to rfc1812 now (yes, guys, Linux is the only
     true router now :-)), all routers (at least, in neighbourhood of mine)
     return only 8 bytes of payload. It is the end.

   Hence, if we want that OSPF worked or traceroute said something reasonable,
   we should search for another solution.

   One of them is to parse packet trying to detect inner encapsulation
   made by our node. It is difficult or even impossible, especially,
92
   taking into account fragmentation. TO be short, ttl is not solution at all.
L
Linus Torvalds 已提交
93 94 95 96 97 98

   Current solution: The solution was UNEXPECTEDLY SIMPLE.
   We force DF flag on tunnels with preconfigured hop limit,
   that is ALL. :-) Well, it does not remove the problem completely,
   but exponential growth of network traffic is changed to linear
   (branches, that exceed pmtu are pruned) and tunnel mtu
99
   rapidly degrades to value <68, where looping stops.
L
Linus Torvalds 已提交
100 101 102 103 104 105 106 107 108 109
   Yes, it is not good if there exists a router in the loop,
   which does not force DF, even when encapsulating packets have DF set.
   But it is not our problem! Nobody could accuse us, we made
   all that we could make. Even if it is your gated who injected
   fatal route to network, even if it were you who configured
   fatal static route: you are innocent. :-)

   Alexey Kuznetsov.
 */

110 111 112 113
static bool log_ecn_error = true;
module_param(log_ecn_error, bool, 0644);
MODULE_PARM_DESC(log_ecn_error, "Log packets received with corrupted ECN");

H
Herbert Xu 已提交
114
static struct rtnl_link_ops ipgre_link_ops __read_mostly;
L
Linus Torvalds 已提交
115
static int ipgre_tunnel_init(struct net_device *dev);
116

117 118
static unsigned int ipgre_net_id __read_mostly;
static unsigned int gre_tap_net_id __read_mostly;
119
static unsigned int erspan_net_id __read_mostly;
L
Linus Torvalds 已提交
120

121 122
static void ipgre_err(struct sk_buff *skb, u32 info,
		      const struct tnl_ptk_info *tpi)
L
Linus Torvalds 已提交
123 124
{

125 126 127
	/* All the routers (except for Linux) return only
	   8 bytes of packet payload. It means, that precise relaying of
	   ICMP in the real Internet is absolutely infeasible.
L
Linus Torvalds 已提交
128

129 130 131 132
	   Moreover, Cisco "wise men" put GRE key to the third word
	   in GRE header. It makes impossible maintaining even soft
	   state for keyed GRE tunnels with enabled checksum. Tell
	   them "thank you".
L
Linus Torvalds 已提交
133

134 135 136 137 138 139
	   Well, I wonder, rfc1812 was written by Cisco employee,
	   what the hell these idiots break standards established
	   by themselves???
	   */
	struct net *net = dev_net(skb->dev);
	struct ip_tunnel_net *itn;
140
	const struct iphdr *iph;
141 142
	const int type = icmp_hdr(skb)->type;
	const int code = icmp_hdr(skb)->code;
143
	unsigned int data_len = 0;
L
Linus Torvalds 已提交
144 145 146 147 148
	struct ip_tunnel *t;

	switch (type) {
	default:
	case ICMP_PARAMETERPROB:
149
		return;
L
Linus Torvalds 已提交
150 151 152 153 154 155

	case ICMP_DEST_UNREACH:
		switch (code) {
		case ICMP_SR_FAILED:
		case ICMP_PORT_UNREACH:
			/* Impossible event. */
156
			return;
L
Linus Torvalds 已提交
157 158 159 160 161 162 163 164
		default:
			/* All others are translated to HOST_UNREACH.
			   rfc2003 contains "deep thoughts" about NET_UNREACH,
			   I believe they are just ether pollution. --ANK
			 */
			break;
		}
		break;
165

L
Linus Torvalds 已提交
166 167
	case ICMP_TIME_EXCEEDED:
		if (code != ICMP_EXC_TTL)
168
			return;
169
		data_len = icmp_hdr(skb)->un.reserved[1] * 4; /* RFC 4884 4.1 */
L
Linus Torvalds 已提交
170
		break;
171 172 173

	case ICMP_REDIRECT:
		break;
L
Linus Torvalds 已提交
174 175
	}

176
	if (tpi->proto == htons(ETH_P_TEB))
177 178 179 180
		itn = net_generic(net, gre_tap_net_id);
	else
		itn = net_generic(net, ipgre_net_id);

181
	iph = (const struct iphdr *)(icmp_hdr(skb) + 1);
182 183
	t = ip_tunnel_lookup(itn, skb->dev->ifindex, tpi->flags,
			     iph->daddr, iph->saddr, tpi->key);
S
stephen hemminger 已提交
184

185
	if (!t)
186
		return;
187

188 189
#if IS_ENABLED(CONFIG_IPV6)
       if (tpi->proto == htons(ETH_P_IPV6) &&
190 191
           !ip6_err_gen_icmpv6_unreach(skb, iph->ihl * 4 + tpi->hdr_len,
				       type, data_len))
192 193 194
               return;
#endif

195
	if (t->parms.iph.daddr == 0 ||
196
	    ipv4_is_multicast(t->parms.iph.daddr))
197
		return;
L
Linus Torvalds 已提交
198 199

	if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED)
200
		return;
L
Linus Torvalds 已提交
201

202
	if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO))
L
Linus Torvalds 已提交
203 204 205 206
		t->err_count++;
	else
		t->err_count = 1;
	t->err_time = jiffies;
207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224
}

static void gre_err(struct sk_buff *skb, u32 info)
{
	/* All the routers (except for Linux) return only
	 * 8 bytes of packet payload. It means, that precise relaying of
	 * ICMP in the real Internet is absolutely infeasible.
	 *
	 * Moreover, Cisco "wise men" put GRE key to the third word
	 * in GRE header. It makes impossible maintaining even soft
	 * state for keyed
	 * GRE tunnels with enabled checksum. Tell them "thank you".
	 *
	 * Well, I wonder, rfc1812 was written by Cisco employee,
	 * what the hell these idiots break standards established
	 * by themselves???
	 */

E
Eric Dumazet 已提交
225
	const struct iphdr *iph = (struct iphdr *)skb->data;
226 227 228 229 230
	const int type = icmp_hdr(skb)->type;
	const int code = icmp_hdr(skb)->code;
	struct tnl_ptk_info tpi;
	bool csum_err = false;

E
Eric Dumazet 已提交
231 232
	if (gre_parse_header(skb, &tpi, &csum_err, htons(ETH_P_IP),
			     iph->ihl * 4) < 0) {
233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248
		if (!csum_err)		/* ignore csum errors. */
			return;
	}

	if (type == ICMP_DEST_UNREACH && code == ICMP_FRAG_NEEDED) {
		ipv4_update_pmtu(skb, dev_net(skb->dev), info,
				 skb->dev->ifindex, 0, IPPROTO_GRE, 0);
		return;
	}
	if (type == ICMP_REDIRECT) {
		ipv4_redirect(skb, dev_net(skb->dev), skb->dev->ifindex, 0,
			      IPPROTO_GRE, 0);
		return;
	}

	ipgre_err(skb, info, &tpi);
L
Linus Torvalds 已提交
249 250
}

251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299
static int erspan_rcv(struct sk_buff *skb, struct tnl_ptk_info *tpi,
		      int gre_hdr_len)
{
	struct net *net = dev_net(skb->dev);
	struct metadata_dst *tun_dst = NULL;
	struct ip_tunnel_net *itn;
	struct ip_tunnel *tunnel;
	struct erspanhdr *ershdr;
	const struct iphdr *iph;
	__be32 session_id;
	__be32 index;
	int len;

	itn = net_generic(net, erspan_net_id);
	len = gre_hdr_len + sizeof(*ershdr);

	if (unlikely(!pskb_may_pull(skb, len)))
		return -ENOMEM;

	iph = ip_hdr(skb);
	ershdr = (struct erspanhdr *)(skb->data + gre_hdr_len);

	/* The original GRE header does not have key field,
	 * Use ERSPAN 10-bit session ID as key.
	 */
	session_id = cpu_to_be32(ntohs(ershdr->session_id));
	tpi->key = session_id;
	index = ershdr->md.index;
	tunnel = ip_tunnel_lookup(itn, skb->dev->ifindex,
				  tpi->flags | TUNNEL_KEY,
				  iph->saddr, iph->daddr, tpi->key);

	if (tunnel) {
		if (__iptunnel_pull_header(skb,
					   gre_hdr_len + sizeof(*ershdr),
					   htons(ETH_P_TEB),
					   false, false) < 0)
			goto drop;

		tunnel->index = ntohl(index);
		skb_reset_mac_header(skb);
		ip_tunnel_rcv(tunnel, skb, tpi, tun_dst, log_ecn_error);
		return PACKET_RCVD;
	}
drop:
	kfree_skb(skb);
	return PACKET_RCVD;
}

300 301
static int __ipgre_rcv(struct sk_buff *skb, const struct tnl_ptk_info *tpi,
		       struct ip_tunnel_net *itn, int hdr_len, bool raw_proto)
L
Linus Torvalds 已提交
302
{
303
	struct metadata_dst *tun_dst = NULL;
304
	const struct iphdr *iph;
L
Linus Torvalds 已提交
305 306
	struct ip_tunnel *tunnel;

307
	iph = ip_hdr(skb);
308 309
	tunnel = ip_tunnel_lookup(itn, skb->dev->ifindex, tpi->flags,
				  iph->saddr, iph->daddr, tpi->key);
310

S
stephen hemminger 已提交
311
	if (tunnel) {
312 313
		if (__iptunnel_pull_header(skb, hdr_len, tpi->proto,
					   raw_proto, false) < 0)
314 315
			goto drop;

316 317 318 319
		if (tunnel->dev->type != ARPHRD_NONE)
			skb_pop_mac_header(skb);
		else
			skb_reset_mac_header(skb);
320
		if (tunnel->collect_md) {
321 322
			__be16 flags;
			__be64 tun_id;
323

324
			flags = tpi->flags & (TUNNEL_CSUM | TUNNEL_KEY);
325
			tun_id = key32_to_tunnel_id(tpi->key);
326
			tun_dst = ip_tun_rx_dst(skb, flags, tun_id, 0);
327 328 329 330 331
			if (!tun_dst)
				return PACKET_REJECT;
		}

		ip_tunnel_rcv(tunnel, skb, tpi, tun_dst, log_ecn_error);
332
		return PACKET_RCVD;
L
Linus Torvalds 已提交
333
	}
334
	return PACKET_NEXT;
335 336 337 338

drop:
	kfree_skb(skb);
	return PACKET_RCVD;
L
Linus Torvalds 已提交
339 340
}

341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363
static int ipgre_rcv(struct sk_buff *skb, const struct tnl_ptk_info *tpi,
		     int hdr_len)
{
	struct net *net = dev_net(skb->dev);
	struct ip_tunnel_net *itn;
	int res;

	if (tpi->proto == htons(ETH_P_TEB))
		itn = net_generic(net, gre_tap_net_id);
	else
		itn = net_generic(net, ipgre_net_id);

	res = __ipgre_rcv(skb, tpi, itn, hdr_len, false);
	if (res == PACKET_NEXT && tpi->proto == htons(ETH_P_TEB)) {
		/* ipgre tunnels in collect metadata mode should receive
		 * also ETH_P_TEB traffic.
		 */
		itn = net_generic(net, ipgre_net_id);
		res = __ipgre_rcv(skb, tpi, itn, hdr_len, true);
	}
	return res;
}

364 365 366 367
static int gre_rcv(struct sk_buff *skb)
{
	struct tnl_ptk_info tpi;
	bool csum_err = false;
368
	int hdr_len;
369 370 371 372 373 374 375 376 377

#ifdef CONFIG_NET_IPGRE_BROADCAST
	if (ipv4_is_multicast(ip_hdr(skb)->daddr)) {
		/* Looped back packet, drop it! */
		if (rt_is_output_route(skb_rtable(skb)))
			goto drop;
	}
#endif

E
Eric Dumazet 已提交
378
	hdr_len = gre_parse_header(skb, &tpi, &csum_err, htons(ETH_P_IP), 0);
379
	if (hdr_len < 0)
380 381
		goto drop;

382 383 384 385 386
	if (unlikely(tpi.proto == htons(ETH_P_ERSPAN))) {
		if (erspan_rcv(skb, &tpi, hdr_len) == PACKET_RCVD)
			return 0;
	}

387
	if (ipgre_rcv(skb, &tpi, hdr_len) == PACKET_RCVD)
388 389 390 391 392 393 394 395
		return 0;

	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
drop:
	kfree_skb(skb);
	return 0;
}

396 397 398 399 400
static void __gre_xmit(struct sk_buff *skb, struct net_device *dev,
		       const struct iphdr *tnl_params,
		       __be16 proto)
{
	struct ip_tunnel *tunnel = netdev_priv(dev);
L
Linus Torvalds 已提交
401

402 403
	if (tunnel->parms.o_flags & TUNNEL_SEQ)
		tunnel->o_seqno++;
L
Linus Torvalds 已提交
404

405
	/* Push GRE header. */
406 407 408
	gre_build_header(skb, tunnel->tun_hlen,
			 tunnel->parms.o_flags, proto, tunnel->parms.o_key,
			 htonl(tunnel->o_seqno));
409

410
	ip_tunnel_xmit(skb, dev, tnl_params, tnl_params->protocol);
411
}
L
Linus Torvalds 已提交
412

413
static int gre_handle_offloads(struct sk_buff *skb, bool csum)
414
{
415
	return iptunnel_handle_offloads(skb, csum ? SKB_GSO_GRE_CSUM : SKB_GSO_GRE);
416 417
}

418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434
static struct rtable *gre_get_rt(struct sk_buff *skb,
				 struct net_device *dev,
				 struct flowi4 *fl,
				 const struct ip_tunnel_key *key)
{
	struct net *net = dev_net(dev);

	memset(fl, 0, sizeof(*fl));
	fl->daddr = key->u.ipv4.dst;
	fl->saddr = key->u.ipv4.src;
	fl->flowi4_tos = RT_TOS(key->tos);
	fl->flowi4_mark = skb->mark;
	fl->flowi4_proto = IPPROTO_GRE;

	return ip_route_output_key(net, fl);
}

435 436
static void gre_fb_xmit(struct sk_buff *skb, struct net_device *dev,
			__be16 proto)
437 438 439
{
	struct ip_tunnel_info *tun_info;
	const struct ip_tunnel_key *key;
440
	struct rtable *rt = NULL;
441 442 443 444
	struct flowi4 fl;
	int min_headroom;
	int tunnel_hlen;
	__be16 df, flags;
445
	bool use_cache;
446 447
	int err;

448
	tun_info = skb_tunnel_info(skb);
449 450
	if (unlikely(!tun_info || !(tun_info->mode & IP_TUNNEL_INFO_TX) ||
		     ip_tunnel_info_af(tun_info) != AF_INET))
451 452 453
		goto err_free_skb;

	key = &tun_info->key;
454 455 456
	use_cache = ip_tunnel_dst_cache_usable(skb, tun_info);
	if (use_cache)
		rt = dst_cache_get_ip4(&tun_info->dst_cache, &fl.saddr);
457 458 459 460
	if (!rt) {
		rt = gre_get_rt(skb, dev, &fl, key);
		if (IS_ERR(rt))
				goto err_free_skb;
461
		if (use_cache)
462 463 464
			dst_cache_set_ip4(&tun_info->dst_cache, &rt->dst,
					  fl.saddr);
	}
465

466
	tunnel_hlen = gre_calc_hlen(key->tun_flags);
467 468 469 470 471 472 473 474 475 476 477 478 479 480

	min_headroom = LL_RESERVED_SPACE(rt->dst.dev) + rt->dst.header_len
			+ tunnel_hlen + sizeof(struct iphdr);
	if (skb_headroom(skb) < min_headroom || skb_header_cloned(skb)) {
		int head_delta = SKB_DATA_ALIGN(min_headroom -
						skb_headroom(skb) +
						16);
		err = pskb_expand_head(skb, max_t(int, head_delta, 0),
				       0, GFP_ATOMIC);
		if (unlikely(err))
			goto err_free_rt;
	}

	/* Push Tunnel header. */
481
	if (gre_handle_offloads(skb, !!(tun_info->key.tun_flags & TUNNEL_CSUM)))
482 483 484
		goto err_free_rt;

	flags = tun_info->key.tun_flags & (TUNNEL_CSUM | TUNNEL_KEY);
485
	gre_build_header(skb, tunnel_hlen, flags, proto,
486
			 tunnel_id_to_key32(tun_info->key.tun_id), 0);
487 488

	df = key->tun_flags & TUNNEL_DONT_FRAGMENT ?  htons(IP_DF) : 0;
489 490 491

	iptunnel_xmit(skb->sk, rt, skb, fl.saddr, key->u.ipv4.dst, IPPROTO_GRE,
		      key->tos, key->ttl, df, false);
492 493 494 495 496 497 498 499 500
	return;

err_free_rt:
	ip_rt_put(rt);
err_free_skb:
	kfree_skb(skb);
	dev->stats.tx_dropped++;
}

501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518
static int gre_fill_metadata_dst(struct net_device *dev, struct sk_buff *skb)
{
	struct ip_tunnel_info *info = skb_tunnel_info(skb);
	struct rtable *rt;
	struct flowi4 fl4;

	if (ip_tunnel_info_af(info) != AF_INET)
		return -EINVAL;

	rt = gre_get_rt(skb, dev, &fl4, &info->key);
	if (IS_ERR(rt))
		return PTR_ERR(rt);

	ip_rt_put(rt);
	info->key.u.ipv4.src = fl4.saddr;
	return 0;
}

519 520 521 522 523
static netdev_tx_t ipgre_xmit(struct sk_buff *skb,
			      struct net_device *dev)
{
	struct ip_tunnel *tunnel = netdev_priv(dev);
	const struct iphdr *tnl_params;
L
Linus Torvalds 已提交
524

525
	if (tunnel->collect_md) {
526
		gre_fb_xmit(skb, dev, skb->protocol);
527 528 529
		return NETDEV_TX_OK;
	}

530 531 532
	if (dev->header_ops) {
		/* Need space for new headers */
		if (skb_cow_head(skb, dev->needed_headroom -
533
				      (tunnel->hlen + sizeof(struct iphdr))))
534
			goto free_skb;
L
Linus Torvalds 已提交
535

536
		tnl_params = (const struct iphdr *)skb->data;
L
Linus Torvalds 已提交
537

538 539 540 541
		/* Pull skb since ip_tunnel_xmit() needs skb->data pointing
		 * to gre header.
		 */
		skb_pull(skb, tunnel->hlen + sizeof(struct iphdr));
542
		skb_reset_mac_header(skb);
543 544 545
	} else {
		if (skb_cow_head(skb, dev->needed_headroom))
			goto free_skb;
L
Linus Torvalds 已提交
546

547
		tnl_params = &tunnel->parms.iph;
L
Linus Torvalds 已提交
548 549
	}

550 551
	if (gre_handle_offloads(skb, !!(tunnel->parms.o_flags & TUNNEL_CSUM)))
		goto free_skb;
552

553
	__gre_xmit(skb, dev, tnl_params, skb->protocol);
554
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
555

556
free_skb:
E
Eric Dumazet 已提交
557
	kfree_skb(skb);
558
	dev->stats.tx_dropped++;
559
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
560 561
}

562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636
static inline u8 tos_to_cos(u8 tos)
{
	u8 dscp, cos;

	dscp = tos >> 2;
	cos = dscp >> 3;
	return cos;
}

static void erspan_build_header(struct sk_buff *skb,
				__be32 id, u32 index, bool truncate)
{
	struct iphdr *iphdr = ip_hdr(skb);
	struct ethhdr *eth = eth_hdr(skb);
	enum erspan_encap_type enc_type;
	struct erspanhdr *ershdr;
	struct qtag_prefix {
		__be16 eth_type;
		__be16 tci;
	} *qp;
	u16 vlan_tci = 0;

	enc_type = ERSPAN_ENCAP_NOVLAN;

	/* If mirrored packet has vlan tag, extract tci and
	 *  perserve vlan header in the mirrored frame.
	 */
	if (eth->h_proto == htons(ETH_P_8021Q)) {
		qp = (struct qtag_prefix *)(skb->data + 2 * ETH_ALEN);
		vlan_tci = ntohs(qp->tci);
		enc_type = ERSPAN_ENCAP_INFRAME;
	}

	skb_push(skb, sizeof(*ershdr));
	ershdr = (struct erspanhdr *)skb->data;
	memset(ershdr, 0, sizeof(*ershdr));

	ershdr->ver_vlan = htons((vlan_tci & VLAN_MASK) |
				 (ERSPAN_VERSION << VER_OFFSET));
	ershdr->session_id = htons((u16)(ntohl(id) & ID_MASK) |
			   ((tos_to_cos(iphdr->tos) << COS_OFFSET) & COS_MASK) |
			   (enc_type << EN_OFFSET & EN_MASK) |
			   ((truncate << T_OFFSET) & T_MASK));
	ershdr->md.index = htonl(index & INDEX_MASK);
}

static netdev_tx_t erspan_xmit(struct sk_buff *skb,
			       struct net_device *dev)
{
	struct ip_tunnel *tunnel = netdev_priv(dev);
	bool truncate = false;

	if (gre_handle_offloads(skb, false))
		goto free_skb;

	if (skb_cow_head(skb, dev->needed_headroom))
		goto free_skb;

	if (skb->len > dev->mtu) {
		pskb_trim(skb, dev->mtu);
		truncate = true;
	}

	/* Push ERSPAN header */
	erspan_build_header(skb, tunnel->parms.o_key, tunnel->index, truncate);
	tunnel->parms.o_flags &= ~TUNNEL_KEY;
	__gre_xmit(skb, dev, &tunnel->parms.iph, htons(ETH_P_ERSPAN));
	return NETDEV_TX_OK;

free_skb:
	kfree_skb(skb);
	dev->stats.tx_dropped++;
	return NETDEV_TX_OK;
}

637 638
static netdev_tx_t gre_tap_xmit(struct sk_buff *skb,
				struct net_device *dev)
639
{
640
	struct ip_tunnel *tunnel = netdev_priv(dev);
641

642
	if (tunnel->collect_md) {
643
		gre_fb_xmit(skb, dev, htons(ETH_P_TEB));
644 645 646
		return NETDEV_TX_OK;
	}

647 648
	if (gre_handle_offloads(skb, !!(tunnel->parms.o_flags & TUNNEL_CSUM)))
		goto free_skb;
649

650 651
	if (skb_cow_head(skb, dev->needed_headroom))
		goto free_skb;
652

653 654
	__gre_xmit(skb, dev, &tunnel->parms.iph, htons(ETH_P_TEB));
	return NETDEV_TX_OK;
655

656
free_skb:
E
Eric Dumazet 已提交
657
	kfree_skb(skb);
658 659
	dev->stats.tx_dropped++;
	return NETDEV_TX_OK;
660 661
}

662 663
static int ipgre_tunnel_ioctl(struct net_device *dev,
			      struct ifreq *ifr, int cmd)
L
Linus Torvalds 已提交
664
{
665
	int err;
L
Linus Torvalds 已提交
666 667
	struct ip_tunnel_parm p;

668 669
	if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
		return -EFAULT;
C
Cong Wang 已提交
670 671 672 673 674
	if (cmd == SIOCADDTUNNEL || cmd == SIOCCHGTUNNEL) {
		if (p.iph.version != 4 || p.iph.protocol != IPPROTO_GRE ||
		    p.iph.ihl != 5 || (p.iph.frag_off&htons(~IP_DF)) ||
		    ((p.i_flags|p.o_flags)&(GRE_VERSION|GRE_ROUTING)))
			return -EINVAL;
L
Linus Torvalds 已提交
675
	}
676 677
	p.i_flags = gre_flags_to_tnl_flags(p.i_flags);
	p.o_flags = gre_flags_to_tnl_flags(p.o_flags);
L
Linus Torvalds 已提交
678

679 680 681
	err = ip_tunnel_ioctl(dev, &p, cmd);
	if (err)
		return err;
L
Linus Torvalds 已提交
682

683 684
	p.i_flags = gre_tnl_flags_to_gre_flags(p.i_flags);
	p.o_flags = gre_tnl_flags_to_gre_flags(p.o_flags);
685 686 687

	if (copy_to_user(ifr->ifr_ifru.ifru_data, &p, sizeof(p)))
		return -EFAULT;
L
Linus Torvalds 已提交
688 689 690 691 692 693 694 695 696 697 698 699
	return 0;
}

/* Nice toy. Unfortunately, useless in real life :-)
   It allows to construct virtual multiprotocol broadcast "LAN"
   over the Internet, provided multicast routing is tuned.


   I have no idea was this bicycle invented before me,
   so that I had to set ARPHRD_IPGRE to a random value.
   I have an impression, that Cisco could make something similar,
   but this feature is apparently missing in IOS<=11.2(8).
700

L
Linus Torvalds 已提交
701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717
   I set up 10.66.66/24 and fec0:6666:6666::0/96 as virtual networks
   with broadcast 224.66.66.66. If you have access to mbone, play with me :-)

   ping -t 255 224.66.66.66

   If nobody answers, mbone does not work.

   ip tunnel add Universe mode gre remote 224.66.66.66 local <Your_real_addr> ttl 255
   ip addr add 10.66.66.<somewhat>/24 dev Universe
   ifconfig Universe up
   ifconfig Universe add fe80::<Your_real_addr>/10
   ifconfig Universe add fec0:6666:6666::<Your_real_addr>/96
   ftp 10.66.66.66
   ...
   ftp fec0:6666:6666::193.233.7.65
   ...
 */
718 719
static int ipgre_header(struct sk_buff *skb, struct net_device *dev,
			unsigned short type,
E
Eric Dumazet 已提交
720
			const void *daddr, const void *saddr, unsigned int len)
L
Linus Torvalds 已提交
721
{
722
	struct ip_tunnel *t = netdev_priv(dev);
723 724
	struct iphdr *iph;
	struct gre_base_hdr *greh;
L
Linus Torvalds 已提交
725

726
	iph = skb_push(skb, t->hlen + sizeof(*iph));
727
	greh = (struct gre_base_hdr *)(iph+1);
728
	greh->flags = gre_tnl_flags_to_gre_flags(t->parms.o_flags);
729
	greh->protocol = htons(type);
L
Linus Torvalds 已提交
730

731
	memcpy(iph, &t->parms.iph, sizeof(struct iphdr));
732

733
	/* Set the source hardware address. */
L
Linus Torvalds 已提交
734 735
	if (saddr)
		memcpy(&iph->saddr, saddr, 4);
736
	if (daddr)
L
Linus Torvalds 已提交
737
		memcpy(&iph->daddr, daddr, 4);
738
	if (iph->daddr)
739
		return t->hlen + sizeof(*iph);
740

741
	return -(t->hlen + sizeof(*iph));
L
Linus Torvalds 已提交
742 743
}

744 745
static int ipgre_header_parse(const struct sk_buff *skb, unsigned char *haddr)
{
746
	const struct iphdr *iph = (const struct iphdr *) skb_mac_header(skb);
747 748 749 750
	memcpy(haddr, &iph->saddr, 4);
	return 4;
}

751 752
static const struct header_ops ipgre_header_ops = {
	.create	= ipgre_header,
753
	.parse	= ipgre_header_parse,
754 755
};

756
#ifdef CONFIG_NET_IPGRE_BROADCAST
L
Linus Torvalds 已提交
757 758
static int ipgre_open(struct net_device *dev)
{
759
	struct ip_tunnel *t = netdev_priv(dev);
L
Linus Torvalds 已提交
760

761
	if (ipv4_is_multicast(t->parms.iph.daddr)) {
762 763 764
		struct flowi4 fl4;
		struct rtable *rt;

N
Nicolas Dichtel 已提交
765
		rt = ip_route_output_gre(t->net, &fl4,
766 767 768 769 770
					 t->parms.iph.daddr,
					 t->parms.iph.saddr,
					 t->parms.o_key,
					 RT_TOS(t->parms.iph.tos),
					 t->parms.link);
771
		if (IS_ERR(rt))
L
Linus Torvalds 已提交
772
			return -EADDRNOTAVAIL;
773
		dev = rt->dst.dev;
L
Linus Torvalds 已提交
774
		ip_rt_put(rt);
775
		if (!__in_dev_get_rtnl(dev))
L
Linus Torvalds 已提交
776 777
			return -EADDRNOTAVAIL;
		t->mlink = dev->ifindex;
778
		ip_mc_inc_group(__in_dev_get_rtnl(dev), t->parms.iph.daddr);
L
Linus Torvalds 已提交
779 780 781 782 783 784
	}
	return 0;
}

static int ipgre_close(struct net_device *dev)
{
785
	struct ip_tunnel *t = netdev_priv(dev);
786

787
	if (ipv4_is_multicast(t->parms.iph.daddr) && t->mlink) {
788
		struct in_device *in_dev;
N
Nicolas Dichtel 已提交
789
		in_dev = inetdev_by_index(t->net, t->mlink);
790
		if (in_dev)
L
Linus Torvalds 已提交
791 792 793 794 795 796
			ip_mc_dec_group(in_dev, t->parms.iph.daddr);
	}
	return 0;
}
#endif

797 798
static const struct net_device_ops ipgre_netdev_ops = {
	.ndo_init		= ipgre_tunnel_init,
799
	.ndo_uninit		= ip_tunnel_uninit,
800 801 802 803
#ifdef CONFIG_NET_IPGRE_BROADCAST
	.ndo_open		= ipgre_open,
	.ndo_stop		= ipgre_close,
#endif
804
	.ndo_start_xmit		= ipgre_xmit,
805
	.ndo_do_ioctl		= ipgre_tunnel_ioctl,
806 807
	.ndo_change_mtu		= ip_tunnel_change_mtu,
	.ndo_get_stats64	= ip_tunnel_get_stats64,
808
	.ndo_get_iflink		= ip_tunnel_get_iflink,
809 810
};

E
Eric Dumazet 已提交
811 812 813 814 815
#define GRE_FEATURES (NETIF_F_SG |		\
		      NETIF_F_FRAGLIST |	\
		      NETIF_F_HIGHDMA |		\
		      NETIF_F_HW_CSUM)

L
Linus Torvalds 已提交
816 817
static void ipgre_tunnel_setup(struct net_device *dev)
{
818
	dev->netdev_ops		= &ipgre_netdev_ops;
819
	dev->type		= ARPHRD_IPGRE;
820 821
	ip_tunnel_setup(dev, ipgre_net_id);
}
L
Linus Torvalds 已提交
822

823 824 825
static void __gre_tunnel_init(struct net_device *dev)
{
	struct ip_tunnel *tunnel;
826
	int t_hlen;
827 828

	tunnel = netdev_priv(dev);
829
	tunnel->tun_hlen = gre_calc_hlen(tunnel->parms.o_flags);
830 831
	tunnel->parms.iph.protocol = IPPROTO_GRE;

832 833 834 835 836 837
	tunnel->hlen = tunnel->tun_hlen + tunnel->encap_hlen;

	t_hlen = tunnel->hlen + sizeof(struct iphdr);

	dev->needed_headroom	= LL_MAX_HEADER + t_hlen + 4;
	dev->mtu		= ETH_DATA_LEN - t_hlen - 4;
E
Eric Dumazet 已提交
838

N
Nicolas Dichtel 已提交
839
	dev->features		|= GRE_FEATURES;
E
Eric Dumazet 已提交
840
	dev->hw_features	|= GRE_FEATURES;
841 842

	if (!(tunnel->parms.o_flags & TUNNEL_SEQ)) {
843 844 845 846 847 848 849 850 851 852
		/* TCP offload with GRE SEQ is not supported, nor
		 * can we support 2 levels of outer headers requiring
		 * an update.
		 */
		if (!(tunnel->parms.o_flags & TUNNEL_CSUM) ||
		    (tunnel->encap.type == TUNNEL_ENCAP_NONE)) {
			dev->features    |= NETIF_F_GSO_SOFTWARE;
			dev->hw_features |= NETIF_F_GSO_SOFTWARE;
		}

853 854 855 856 857
		/* Can use a lockless transmit, unless we generate
		 * output sequences
		 */
		dev->features |= NETIF_F_LLTX;
	}
L
Linus Torvalds 已提交
858 859 860 861
}

static int ipgre_tunnel_init(struct net_device *dev)
{
862 863
	struct ip_tunnel *tunnel = netdev_priv(dev);
	struct iphdr *iph = &tunnel->parms.iph;
L
Linus Torvalds 已提交
864

865
	__gre_tunnel_init(dev);
L
Linus Torvalds 已提交
866

867 868
	memcpy(dev->dev_addr, &iph->saddr, 4);
	memcpy(dev->broadcast, &iph->daddr, 4);
L
Linus Torvalds 已提交
869

870
	dev->flags		= IFF_NOARP;
871
	netif_keep_dst(dev);
872
	dev->addr_len		= 4;
L
Linus Torvalds 已提交
873

874
	if (iph->daddr && !tunnel->collect_md) {
L
Linus Torvalds 已提交
875
#ifdef CONFIG_NET_IPGRE_BROADCAST
876
		if (ipv4_is_multicast(iph->daddr)) {
L
Linus Torvalds 已提交
877 878 879
			if (!iph->saddr)
				return -EINVAL;
			dev->flags = IFF_BROADCAST;
880
			dev->header_ops = &ipgre_header_ops;
L
Linus Torvalds 已提交
881 882
		}
#endif
883
	} else if (!tunnel->collect_md) {
884
		dev->header_ops = &ipgre_header_ops;
885
	}
L
Linus Torvalds 已提交
886

887
	return ip_tunnel_init(dev);
L
Linus Torvalds 已提交
888 889
}

890 891 892
static const struct gre_protocol ipgre_protocol = {
	.handler     = gre_rcv,
	.err_handler = gre_err,
L
Linus Torvalds 已提交
893 894
};

895
static int __net_init ipgre_init_net(struct net *net)
896
{
897
	return ip_tunnel_init_net(net, ipgre_net_id, &ipgre_link_ops, NULL);
898 899
}

900
static void __net_exit ipgre_exit_net(struct net *net)
901
{
902
	struct ip_tunnel_net *itn = net_generic(net, ipgre_net_id);
N
Nicolas Dichtel 已提交
903
	ip_tunnel_delete_net(itn, &ipgre_link_ops);
904 905 906 907 908
}

static struct pernet_operations ipgre_net_ops = {
	.init = ipgre_init_net,
	.exit = ipgre_exit_net,
909
	.id   = &ipgre_net_id,
910
	.size = sizeof(struct ip_tunnel_net),
911
};
L
Linus Torvalds 已提交
912

913 914
static int ipgre_tunnel_validate(struct nlattr *tb[], struct nlattr *data[],
				 struct netlink_ext_ack *extack)
H
Herbert Xu 已提交
915 916 917 918 919 920 921 922 923 924 925 926 927 928
{
	__be16 flags;

	if (!data)
		return 0;

	flags = 0;
	if (data[IFLA_GRE_IFLAGS])
		flags |= nla_get_be16(data[IFLA_GRE_IFLAGS]);
	if (data[IFLA_GRE_OFLAGS])
		flags |= nla_get_be16(data[IFLA_GRE_OFLAGS]);
	if (flags & (GRE_VERSION|GRE_ROUTING))
		return -EINVAL;

929 930 931 932 933
	if (data[IFLA_GRE_COLLECT_METADATA] &&
	    data[IFLA_GRE_ENCAP_TYPE] &&
	    nla_get_u16(data[IFLA_GRE_ENCAP_TYPE]) != TUNNEL_ENCAP_NONE)
		return -EINVAL;

H
Herbert Xu 已提交
934 935 936
	return 0;
}

937 938
static int ipgre_tap_validate(struct nlattr *tb[], struct nlattr *data[],
			      struct netlink_ext_ack *extack)
939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958
{
	__be32 daddr;

	if (tb[IFLA_ADDRESS]) {
		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
			return -EINVAL;
		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
			return -EADDRNOTAVAIL;
	}

	if (!data)
		goto out;

	if (data[IFLA_GRE_REMOTE]) {
		memcpy(&daddr, nla_data(data[IFLA_GRE_REMOTE]), 4);
		if (!daddr)
			return -EINVAL;
	}

out:
959
	return ipgre_tunnel_validate(tb, data, extack);
960 961
}

962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994
static int erspan_validate(struct nlattr *tb[], struct nlattr *data[],
			   struct netlink_ext_ack *extack)
{
	__be16 flags = 0;
	int ret;

	if (!data)
		return 0;

	ret = ipgre_tap_validate(tb, data, extack);
	if (ret)
		return ret;

	/* ERSPAN should only have GRE sequence and key flag */
	flags |= nla_get_be16(data[IFLA_GRE_OFLAGS]);
	flags |= nla_get_be16(data[IFLA_GRE_IFLAGS]);
	if (flags != (GRE_SEQ | GRE_KEY))
		return -EINVAL;

	/* ERSPAN Session ID only has 10-bit. Since we reuse
	 * 32-bit key field as ID, check it's range.
	 */
	if (data[IFLA_GRE_IKEY] &&
	    (ntohl(nla_get_be32(data[IFLA_GRE_IKEY])) & ~ID_MASK))
		return -EINVAL;

	if (data[IFLA_GRE_OKEY] &&
	    (ntohl(nla_get_be32(data[IFLA_GRE_OKEY])) & ~ID_MASK))
		return -EINVAL;

	return 0;
}

995
static int ipgre_netlink_parms(struct net_device *dev,
996 997
				struct nlattr *data[],
				struct nlattr *tb[],
998 999
				struct ip_tunnel_parm *parms,
				__u32 *fwmark)
H
Herbert Xu 已提交
1000
{
1001 1002
	struct ip_tunnel *t = netdev_priv(dev);

1003
	memset(parms, 0, sizeof(*parms));
H
Herbert Xu 已提交
1004 1005 1006 1007

	parms->iph.protocol = IPPROTO_GRE;

	if (!data)
1008
		return 0;
H
Herbert Xu 已提交
1009 1010 1011 1012 1013

	if (data[IFLA_GRE_LINK])
		parms->link = nla_get_u32(data[IFLA_GRE_LINK]);

	if (data[IFLA_GRE_IFLAGS])
1014
		parms->i_flags = gre_flags_to_tnl_flags(nla_get_be16(data[IFLA_GRE_IFLAGS]));
H
Herbert Xu 已提交
1015 1016

	if (data[IFLA_GRE_OFLAGS])
1017
		parms->o_flags = gre_flags_to_tnl_flags(nla_get_be16(data[IFLA_GRE_OFLAGS]));
H
Herbert Xu 已提交
1018 1019 1020 1021 1022 1023 1024 1025

	if (data[IFLA_GRE_IKEY])
		parms->i_key = nla_get_be32(data[IFLA_GRE_IKEY]);

	if (data[IFLA_GRE_OKEY])
		parms->o_key = nla_get_be32(data[IFLA_GRE_OKEY]);

	if (data[IFLA_GRE_LOCAL])
1026
		parms->iph.saddr = nla_get_in_addr(data[IFLA_GRE_LOCAL]);
H
Herbert Xu 已提交
1027 1028

	if (data[IFLA_GRE_REMOTE])
1029
		parms->iph.daddr = nla_get_in_addr(data[IFLA_GRE_REMOTE]);
H
Herbert Xu 已提交
1030 1031 1032 1033 1034 1035 1036

	if (data[IFLA_GRE_TTL])
		parms->iph.ttl = nla_get_u8(data[IFLA_GRE_TTL]);

	if (data[IFLA_GRE_TOS])
		parms->iph.tos = nla_get_u8(data[IFLA_GRE_TOS]);

1037 1038 1039
	if (!data[IFLA_GRE_PMTUDISC] || nla_get_u8(data[IFLA_GRE_PMTUDISC])) {
		if (t->ignore_df)
			return -EINVAL;
H
Herbert Xu 已提交
1040
		parms->iph.frag_off = htons(IP_DF);
1041
	}
1042 1043 1044

	if (data[IFLA_GRE_COLLECT_METADATA]) {
		t->collect_md = true;
1045 1046
		if (dev->type == ARPHRD_IPGRE)
			dev->type = ARPHRD_NONE;
1047
	}
1048 1049 1050 1051 1052 1053 1054 1055

	if (data[IFLA_GRE_IGNORE_DF]) {
		if (nla_get_u8(data[IFLA_GRE_IGNORE_DF])
		  && (parms->iph.frag_off & htons(IP_DF)))
			return -EINVAL;
		t->ignore_df = !!nla_get_u8(data[IFLA_GRE_IGNORE_DF]);
	}

1056 1057 1058
	if (data[IFLA_GRE_FWMARK])
		*fwmark = nla_get_u32(data[IFLA_GRE_FWMARK]);

1059 1060 1061 1062 1063 1064 1065
	if (data[IFLA_GRE_ERSPAN_INDEX]) {
		t->index = nla_get_u32(data[IFLA_GRE_ERSPAN_INDEX]);

		if (t->index & ~INDEX_MASK)
			return -EINVAL;
	}

1066
	return 0;
H
Herbert Xu 已提交
1067 1068
}

1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091
/* This function returns true when ENCAP attributes are present in the nl msg */
static bool ipgre_netlink_encap_parms(struct nlattr *data[],
				      struct ip_tunnel_encap *ipencap)
{
	bool ret = false;

	memset(ipencap, 0, sizeof(*ipencap));

	if (!data)
		return ret;

	if (data[IFLA_GRE_ENCAP_TYPE]) {
		ret = true;
		ipencap->type = nla_get_u16(data[IFLA_GRE_ENCAP_TYPE]);
	}

	if (data[IFLA_GRE_ENCAP_FLAGS]) {
		ret = true;
		ipencap->flags = nla_get_u16(data[IFLA_GRE_ENCAP_FLAGS]);
	}

	if (data[IFLA_GRE_ENCAP_SPORT]) {
		ret = true;
1092
		ipencap->sport = nla_get_be16(data[IFLA_GRE_ENCAP_SPORT]);
1093 1094 1095 1096
	}

	if (data[IFLA_GRE_ENCAP_DPORT]) {
		ret = true;
1097
		ipencap->dport = nla_get_be16(data[IFLA_GRE_ENCAP_DPORT]);
1098 1099 1100 1101 1102
	}

	return ret;
}

1103
static int gre_tap_init(struct net_device *dev)
1104
{
1105
	__gre_tunnel_init(dev);
S
stephen hemminger 已提交
1106
	dev->priv_flags |= IFF_LIVE_ADDR_CHANGE;
1107

1108
	return ip_tunnel_init(dev);
1109 1110
}

1111 1112 1113 1114
static const struct net_device_ops gre_tap_netdev_ops = {
	.ndo_init		= gre_tap_init,
	.ndo_uninit		= ip_tunnel_uninit,
	.ndo_start_xmit		= gre_tap_xmit,
1115 1116
	.ndo_set_mac_address 	= eth_mac_addr,
	.ndo_validate_addr	= eth_validate_addr,
1117 1118
	.ndo_change_mtu		= ip_tunnel_change_mtu,
	.ndo_get_stats64	= ip_tunnel_get_stats64,
1119
	.ndo_get_iflink		= ip_tunnel_get_iflink,
1120
	.ndo_fill_metadata_dst	= gre_fill_metadata_dst,
1121 1122
};

1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152
static int erspan_tunnel_init(struct net_device *dev)
{
	struct ip_tunnel *tunnel = netdev_priv(dev);
	int t_hlen;

	tunnel->tun_hlen = 8;
	tunnel->parms.iph.protocol = IPPROTO_GRE;
	t_hlen = tunnel->hlen + sizeof(struct iphdr) + sizeof(struct erspanhdr);

	dev->needed_headroom = LL_MAX_HEADER + t_hlen + 4;
	dev->mtu = ETH_DATA_LEN - t_hlen - 4;
	dev->features		|= GRE_FEATURES;
	dev->hw_features	|= GRE_FEATURES;
	dev->priv_flags		|= IFF_LIVE_ADDR_CHANGE;

	return ip_tunnel_init(dev);
}

static const struct net_device_ops erspan_netdev_ops = {
	.ndo_init		= erspan_tunnel_init,
	.ndo_uninit		= ip_tunnel_uninit,
	.ndo_start_xmit		= erspan_xmit,
	.ndo_set_mac_address	= eth_mac_addr,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_change_mtu		= ip_tunnel_change_mtu,
	.ndo_get_stats64	= ip_tunnel_get_stats64,
	.ndo_get_iflink		= ip_tunnel_get_iflink,
	.ndo_fill_metadata_dst	= gre_fill_metadata_dst,
};

1153 1154 1155
static void ipgre_tap_setup(struct net_device *dev)
{
	ether_setup(dev);
J
Jiri Benc 已提交
1156 1157 1158
	dev->netdev_ops	= &gre_tap_netdev_ops;
	dev->priv_flags &= ~IFF_TX_SKB_SHARING;
	dev->priv_flags	|= IFF_LIVE_ADDR_CHANGE;
1159
	ip_tunnel_setup(dev, gre_tap_net_id);
1160 1161
}

1162
static int ipgre_newlink(struct net *src_net, struct net_device *dev,
1163 1164
			 struct nlattr *tb[], struct nlattr *data[],
			 struct netlink_ext_ack *extack)
H
Herbert Xu 已提交
1165
{
1166
	struct ip_tunnel_parm p;
1167
	struct ip_tunnel_encap ipencap;
1168
	__u32 fwmark = 0;
1169
	int err;
1170 1171 1172

	if (ipgre_netlink_encap_parms(data, &ipencap)) {
		struct ip_tunnel *t = netdev_priv(dev);
1173
		err = ip_tunnel_encap_setup(t, &ipencap);
1174 1175 1176 1177

		if (err < 0)
			return err;
	}
H
Herbert Xu 已提交
1178

1179
	err = ipgre_netlink_parms(dev, data, tb, &p, &fwmark);
1180 1181
	if (err < 0)
		return err;
1182
	return ip_tunnel_newlink(dev, tb, &p, fwmark);
H
Herbert Xu 已提交
1183 1184 1185
}

static int ipgre_changelink(struct net_device *dev, struct nlattr *tb[],
1186 1187
			    struct nlattr *data[],
			    struct netlink_ext_ack *extack)
H
Herbert Xu 已提交
1188
{
1189
	struct ip_tunnel *t = netdev_priv(dev);
H
Herbert Xu 已提交
1190
	struct ip_tunnel_parm p;
1191
	struct ip_tunnel_encap ipencap;
1192
	__u32 fwmark = t->fwmark;
1193
	int err;
1194 1195

	if (ipgre_netlink_encap_parms(data, &ipencap)) {
1196
		err = ip_tunnel_encap_setup(t, &ipencap);
1197 1198 1199 1200

		if (err < 0)
			return err;
	}
H
Herbert Xu 已提交
1201

1202
	err = ipgre_netlink_parms(dev, data, tb, &p, &fwmark);
1203 1204
	if (err < 0)
		return err;
1205
	return ip_tunnel_changelink(dev, tb, &p, fwmark);
H
Herbert Xu 已提交
1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230
}

static size_t ipgre_get_size(const struct net_device *dev)
{
	return
		/* IFLA_GRE_LINK */
		nla_total_size(4) +
		/* IFLA_GRE_IFLAGS */
		nla_total_size(2) +
		/* IFLA_GRE_OFLAGS */
		nla_total_size(2) +
		/* IFLA_GRE_IKEY */
		nla_total_size(4) +
		/* IFLA_GRE_OKEY */
		nla_total_size(4) +
		/* IFLA_GRE_LOCAL */
		nla_total_size(4) +
		/* IFLA_GRE_REMOTE */
		nla_total_size(4) +
		/* IFLA_GRE_TTL */
		nla_total_size(1) +
		/* IFLA_GRE_TOS */
		nla_total_size(1) +
		/* IFLA_GRE_PMTUDISC */
		nla_total_size(1) +
1231 1232 1233 1234 1235 1236 1237 1238
		/* IFLA_GRE_ENCAP_TYPE */
		nla_total_size(2) +
		/* IFLA_GRE_ENCAP_FLAGS */
		nla_total_size(2) +
		/* IFLA_GRE_ENCAP_SPORT */
		nla_total_size(2) +
		/* IFLA_GRE_ENCAP_DPORT */
		nla_total_size(2) +
1239 1240
		/* IFLA_GRE_COLLECT_METADATA */
		nla_total_size(0) +
1241 1242
		/* IFLA_GRE_IGNORE_DF */
		nla_total_size(1) +
1243 1244
		/* IFLA_GRE_FWMARK */
		nla_total_size(4) +
1245 1246
		/* IFLA_GRE_ERSPAN_INDEX */
		nla_total_size(4) +
H
Herbert Xu 已提交
1247 1248 1249 1250 1251 1252 1253 1254
		0;
}

static int ipgre_fill_info(struct sk_buff *skb, const struct net_device *dev)
{
	struct ip_tunnel *t = netdev_priv(dev);
	struct ip_tunnel_parm *p = &t->parms;

D
David S. Miller 已提交
1255
	if (nla_put_u32(skb, IFLA_GRE_LINK, p->link) ||
1256 1257 1258 1259
	    nla_put_be16(skb, IFLA_GRE_IFLAGS,
			 gre_tnl_flags_to_gre_flags(p->i_flags)) ||
	    nla_put_be16(skb, IFLA_GRE_OFLAGS,
			 gre_tnl_flags_to_gre_flags(p->o_flags)) ||
D
David S. Miller 已提交
1260 1261
	    nla_put_be32(skb, IFLA_GRE_IKEY, p->i_key) ||
	    nla_put_be32(skb, IFLA_GRE_OKEY, p->o_key) ||
1262 1263
	    nla_put_in_addr(skb, IFLA_GRE_LOCAL, p->iph.saddr) ||
	    nla_put_in_addr(skb, IFLA_GRE_REMOTE, p->iph.daddr) ||
D
David S. Miller 已提交
1264 1265 1266
	    nla_put_u8(skb, IFLA_GRE_TTL, p->iph.ttl) ||
	    nla_put_u8(skb, IFLA_GRE_TOS, p->iph.tos) ||
	    nla_put_u8(skb, IFLA_GRE_PMTUDISC,
1267 1268
		       !!(p->iph.frag_off & htons(IP_DF))) ||
	    nla_put_u32(skb, IFLA_GRE_FWMARK, t->fwmark))
D
David S. Miller 已提交
1269
		goto nla_put_failure;
1270 1271 1272

	if (nla_put_u16(skb, IFLA_GRE_ENCAP_TYPE,
			t->encap.type) ||
1273 1274 1275 1276
	    nla_put_be16(skb, IFLA_GRE_ENCAP_SPORT,
			 t->encap.sport) ||
	    nla_put_be16(skb, IFLA_GRE_ENCAP_DPORT,
			 t->encap.dport) ||
1277
	    nla_put_u16(skb, IFLA_GRE_ENCAP_FLAGS,
1278
			t->encap.flags))
1279 1280
		goto nla_put_failure;

1281 1282 1283
	if (nla_put_u8(skb, IFLA_GRE_IGNORE_DF, t->ignore_df))
		goto nla_put_failure;

1284 1285 1286 1287 1288
	if (t->collect_md) {
		if (nla_put_flag(skb, IFLA_GRE_COLLECT_METADATA))
			goto nla_put_failure;
	}

1289 1290 1291 1292
	if (t->index)
		if (nla_put_u32(skb, IFLA_GRE_ERSPAN_INDEX, t->index))
			goto nla_put_failure;

H
Herbert Xu 已提交
1293 1294 1295 1296 1297 1298
	return 0;

nla_put_failure:
	return -EMSGSIZE;
}

1299 1300 1301 1302 1303 1304 1305 1306 1307
static void erspan_setup(struct net_device *dev)
{
	ether_setup(dev);
	dev->netdev_ops = &erspan_netdev_ops;
	dev->priv_flags &= ~IFF_TX_SKB_SHARING;
	dev->priv_flags |= IFF_LIVE_ADDR_CHANGE;
	ip_tunnel_setup(dev, erspan_net_id);
}

H
Herbert Xu 已提交
1308 1309 1310 1311 1312 1313
static const struct nla_policy ipgre_policy[IFLA_GRE_MAX + 1] = {
	[IFLA_GRE_LINK]		= { .type = NLA_U32 },
	[IFLA_GRE_IFLAGS]	= { .type = NLA_U16 },
	[IFLA_GRE_OFLAGS]	= { .type = NLA_U16 },
	[IFLA_GRE_IKEY]		= { .type = NLA_U32 },
	[IFLA_GRE_OKEY]		= { .type = NLA_U32 },
1314 1315
	[IFLA_GRE_LOCAL]	= { .len = FIELD_SIZEOF(struct iphdr, saddr) },
	[IFLA_GRE_REMOTE]	= { .len = FIELD_SIZEOF(struct iphdr, daddr) },
H
Herbert Xu 已提交
1316 1317 1318
	[IFLA_GRE_TTL]		= { .type = NLA_U8 },
	[IFLA_GRE_TOS]		= { .type = NLA_U8 },
	[IFLA_GRE_PMTUDISC]	= { .type = NLA_U8 },
1319 1320 1321 1322
	[IFLA_GRE_ENCAP_TYPE]	= { .type = NLA_U16 },
	[IFLA_GRE_ENCAP_FLAGS]	= { .type = NLA_U16 },
	[IFLA_GRE_ENCAP_SPORT]	= { .type = NLA_U16 },
	[IFLA_GRE_ENCAP_DPORT]	= { .type = NLA_U16 },
1323
	[IFLA_GRE_COLLECT_METADATA]	= { .type = NLA_FLAG },
1324
	[IFLA_GRE_IGNORE_DF]	= { .type = NLA_U8 },
1325
	[IFLA_GRE_FWMARK]	= { .type = NLA_U32 },
1326
	[IFLA_GRE_ERSPAN_INDEX]	= { .type = NLA_U32 },
H
Herbert Xu 已提交
1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337
};

static struct rtnl_link_ops ipgre_link_ops __read_mostly = {
	.kind		= "gre",
	.maxtype	= IFLA_GRE_MAX,
	.policy		= ipgre_policy,
	.priv_size	= sizeof(struct ip_tunnel),
	.setup		= ipgre_tunnel_setup,
	.validate	= ipgre_tunnel_validate,
	.newlink	= ipgre_newlink,
	.changelink	= ipgre_changelink,
1338
	.dellink	= ip_tunnel_dellink,
H
Herbert Xu 已提交
1339 1340
	.get_size	= ipgre_get_size,
	.fill_info	= ipgre_fill_info,
1341
	.get_link_net	= ip_tunnel_get_link_net,
H
Herbert Xu 已提交
1342 1343
};

1344 1345 1346 1347 1348 1349 1350 1351 1352
static struct rtnl_link_ops ipgre_tap_ops __read_mostly = {
	.kind		= "gretap",
	.maxtype	= IFLA_GRE_MAX,
	.policy		= ipgre_policy,
	.priv_size	= sizeof(struct ip_tunnel),
	.setup		= ipgre_tap_setup,
	.validate	= ipgre_tap_validate,
	.newlink	= ipgre_newlink,
	.changelink	= ipgre_changelink,
1353
	.dellink	= ip_tunnel_dellink,
1354 1355
	.get_size	= ipgre_get_size,
	.fill_info	= ipgre_fill_info,
1356
	.get_link_net	= ip_tunnel_get_link_net,
1357 1358
};

1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373
static struct rtnl_link_ops erspan_link_ops __read_mostly = {
	.kind		= "erspan",
	.maxtype	= IFLA_GRE_MAX,
	.policy		= ipgre_policy,
	.priv_size	= sizeof(struct ip_tunnel),
	.setup		= erspan_setup,
	.validate	= erspan_validate,
	.newlink	= ipgre_newlink,
	.changelink	= ipgre_changelink,
	.dellink	= ip_tunnel_dellink,
	.get_size	= ipgre_get_size,
	.fill_info	= ipgre_fill_info,
	.get_link_net	= ip_tunnel_get_link_net,
};

1374 1375 1376 1377 1378
struct net_device *gretap_fb_dev_create(struct net *net, const char *name,
					u8 name_assign_type)
{
	struct nlattr *tb[IFLA_MAX + 1];
	struct net_device *dev;
1379
	LIST_HEAD(list_kill);
1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393
	struct ip_tunnel *t;
	int err;

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

	dev = rtnl_create_link(net, name, name_assign_type,
			       &ipgre_tap_ops, tb);
	if (IS_ERR(dev))
		return dev;

	/* Configure flow based GRE device. */
	t = netdev_priv(dev);
	t->collect_md = true;

1394
	err = ipgre_newlink(net, dev, tb, NULL, NULL);
1395 1396 1397 1398
	if (err < 0) {
		free_netdev(dev);
		return ERR_PTR(err);
	}
1399 1400 1401 1402 1403 1404 1405 1406

	/* openvswitch users expect packet sizes to be unrestricted,
	 * so set the largest MTU we can.
	 */
	err = __ip_tunnel_change_mtu(dev, IP_MAX_MTU, false);
	if (err)
		goto out;

1407 1408 1409 1410
	err = rtnl_configure_link(dev, NULL);
	if (err < 0)
		goto out;

1411 1412
	return dev;
out:
1413 1414
	ip_tunnel_dellink(dev, &list_kill);
	unregister_netdevice_many(&list_kill);
1415 1416 1417 1418
	return ERR_PTR(err);
}
EXPORT_SYMBOL_GPL(gretap_fb_dev_create);

1419 1420
static int __net_init ipgre_tap_init_net(struct net *net)
{
1421
	return ip_tunnel_init_net(net, gre_tap_net_id, &ipgre_tap_ops, "gretap0");
1422 1423 1424 1425 1426
}

static void __net_exit ipgre_tap_exit_net(struct net *net)
{
	struct ip_tunnel_net *itn = net_generic(net, gre_tap_net_id);
N
Nicolas Dichtel 已提交
1427
	ip_tunnel_delete_net(itn, &ipgre_tap_ops);
1428 1429 1430 1431 1432 1433 1434 1435
}

static struct pernet_operations ipgre_tap_net_ops = {
	.init = ipgre_tap_init_net,
	.exit = ipgre_tap_exit_net,
	.id   = &gre_tap_net_id,
	.size = sizeof(struct ip_tunnel_net),
};
L
Linus Torvalds 已提交
1436

1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456
static int __net_init erspan_init_net(struct net *net)
{
	return ip_tunnel_init_net(net, erspan_net_id,
				  &erspan_link_ops, "erspan0");
}

static void __net_exit erspan_exit_net(struct net *net)
{
	struct ip_tunnel_net *itn = net_generic(net, erspan_net_id);

	ip_tunnel_delete_net(itn, &erspan_link_ops);
}

static struct pernet_operations erspan_net_ops = {
	.init = erspan_init_net,
	.exit = erspan_exit_net,
	.id   = &erspan_net_id,
	.size = sizeof(struct ip_tunnel_net),
};

L
Linus Torvalds 已提交
1457 1458 1459 1460
static int __init ipgre_init(void)
{
	int err;

J
Joe Perches 已提交
1461
	pr_info("GRE over IPv4 tunneling driver\n");
L
Linus Torvalds 已提交
1462

1463
	err = register_pernet_device(&ipgre_net_ops);
1464
	if (err < 0)
1465 1466
		return err;

1467 1468
	err = register_pernet_device(&ipgre_tap_net_ops);
	if (err < 0)
W
William Tu 已提交
1469
		goto pnet_tap_failed;
1470

1471 1472 1473 1474
	err = register_pernet_device(&erspan_net_ops);
	if (err < 0)
		goto pnet_erspan_failed;

1475
	err = gre_add_protocol(&ipgre_protocol, GREPROTO_CISCO);
1476
	if (err < 0) {
J
Joe Perches 已提交
1477
		pr_info("%s: can't add protocol\n", __func__);
1478 1479
		goto add_proto_failed;
	}
1480

H
Herbert Xu 已提交
1481 1482 1483 1484
	err = rtnl_link_register(&ipgre_link_ops);
	if (err < 0)
		goto rtnl_link_failed;

1485 1486 1487 1488
	err = rtnl_link_register(&ipgre_tap_ops);
	if (err < 0)
		goto tap_ops_failed;

1489 1490 1491 1492
	err = rtnl_link_register(&erspan_link_ops);
	if (err < 0)
		goto erspan_link_failed;

1493
	return 0;
H
Herbert Xu 已提交
1494

1495 1496
erspan_link_failed:
	rtnl_link_unregister(&ipgre_tap_ops);
1497 1498
tap_ops_failed:
	rtnl_link_unregister(&ipgre_link_ops);
H
Herbert Xu 已提交
1499
rtnl_link_failed:
1500
	gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO);
1501
add_proto_failed:
1502 1503
	unregister_pernet_device(&erspan_net_ops);
pnet_erspan_failed:
1504
	unregister_pernet_device(&ipgre_tap_net_ops);
W
William Tu 已提交
1505
pnet_tap_failed:
1506
	unregister_pernet_device(&ipgre_net_ops);
1507
	return err;
L
Linus Torvalds 已提交
1508 1509
}

1510
static void __exit ipgre_fini(void)
L
Linus Torvalds 已提交
1511
{
1512
	rtnl_link_unregister(&ipgre_tap_ops);
H
Herbert Xu 已提交
1513
	rtnl_link_unregister(&ipgre_link_ops);
1514
	rtnl_link_unregister(&erspan_link_ops);
1515
	gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO);
1516
	unregister_pernet_device(&ipgre_tap_net_ops);
1517
	unregister_pernet_device(&ipgre_net_ops);
1518
	unregister_pernet_device(&erspan_net_ops);
L
Linus Torvalds 已提交
1519 1520 1521 1522 1523
}

module_init(ipgre_init);
module_exit(ipgre_fini);
MODULE_LICENSE("GPL");
1524 1525
MODULE_ALIAS_RTNL_LINK("gre");
MODULE_ALIAS_RTNL_LINK("gretap");
1526
MODULE_ALIAS_RTNL_LINK("erspan");
1527
MODULE_ALIAS_NETDEV("gre0");
1528
MODULE_ALIAS_NETDEV("gretap0");
1529
MODULE_ALIAS_NETDEV("erspan0");