ip_gre.c 42.1 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
#include <linux/capability.h>
L
Linus Torvalds 已提交
14 15 16
#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
17
#include <linux/slab.h>
L
Linus Torvalds 已提交
18 19 20 21 22 23 24 25 26 27 28 29 30
#include <asm/uaccess.h>
#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>
#include <linux/mroute.h>
#include <linux/init.h>
#include <linux/in6.h>
#include <linux/inetdevice.h>
#include <linux/igmp.h>
#include <linux/netfilter_ipv4.h>
31
#include <linux/etherdevice.h>
32
#include <linux/if_ether.h>
L
Linus Torvalds 已提交
33 34 35 36 37 38 39 40 41 42 43

#include <net/sock.h>
#include <net/ip.h>
#include <net/icmp.h>
#include <net/protocol.h>
#include <net/ipip.h>
#include <net/arp.h>
#include <net/checksum.h>
#include <net/dsfield.h>
#include <net/inet_ecn.h>
#include <net/xfrm.h>
44 45
#include <net/net_namespace.h>
#include <net/netns/generic.h>
H
Herbert Xu 已提交
46
#include <net/rtnetlink.h>
47
#include <net/gre.h>
L
Linus Torvalds 已提交
48

49
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
L
Linus Torvalds 已提交
50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66
#include <net/ipv6.h>
#include <net/ip6_fib.h>
#include <net/ip6_route.h>
#endif

/*
   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 已提交
67
   and silently drop packet when it expires. It is a good
L
Linus Torvalds 已提交
68 69 70
   solution, but it supposes maintaing new variable in ALL
   skb, even if no tunneling is used.

E
Eric Dumazet 已提交
71 72 73
   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 已提交
74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120

   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,
   taking into account fragmentation. TO be short, tt is not solution at all.

   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
   fastly degrades to value <68, where looping stops.
   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. :-)



   3. Really, ipv4/ipip.c, ipv4/ip_gre.c and ipv6/sit.c contain
   practically identical code. It would be good to glue them
   together, but it is not very evident, how to make them modular.
   sit is integral part of IPv6, ipip and gre are naturally modular.
   We could extract common parts (hash table, ioctl etc)
   to a separate module (ip_tunnel.c).

   Alexey Kuznetsov.
 */

H
Herbert Xu 已提交
121
static struct rtnl_link_ops ipgre_link_ops __read_mostly;
L
Linus Torvalds 已提交
122 123
static int ipgre_tunnel_init(struct net_device *dev);
static void ipgre_tunnel_setup(struct net_device *dev);
124
static int ipgre_tunnel_bind_dev(struct net_device *dev);
L
Linus Torvalds 已提交
125 126 127

/* Fallback tunnel: no source, no destination, no key, no options */

128 129
#define HASH_SIZE  16

130
static int ipgre_net_id __read_mostly;
131
struct ipgre_net {
E
Eric Dumazet 已提交
132
	struct ip_tunnel __rcu *tunnels[4][HASH_SIZE];
133

134
	struct net_device *fb_tunnel_dev;
135 136
};

L
Linus Torvalds 已提交
137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154
/* Tunnel hash table */

/*
   4 hash tables:

   3: (remote,local)
   2: (remote,*)
   1: (*,local)
   0: (*,*)

   We require exact key match i.e. if a key is present in packet
   it will match only tunnel with the same key; if it is not present,
   it will match only keyless tunnel.

   All keysless packets, if not matched configured keyless tunnels
   will match fallback tunnel.
 */

A
Al Viro 已提交
155
#define HASH(addr) (((__force u32)addr^((__force u32)addr>>4))&0xF)
L
Linus Torvalds 已提交
156

157 158 159 160
#define tunnels_r_l	tunnels[3]
#define tunnels_r	tunnels[2]
#define tunnels_l	tunnels[1]
#define tunnels_wc	tunnels[0]
161
/*
E
Eric Dumazet 已提交
162
 * Locking : hash tables are protected by RCU and RTNL
163
 */
L
Linus Torvalds 已提交
164

165 166
#define for_each_ip_tunnel_rcu(start) \
	for (t = rcu_dereference(start); t; t = rcu_dereference(t->next))
L
Linus Torvalds 已提交
167

E
Eric Dumazet 已提交
168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195
/* often modified stats are per cpu, other are shared (netdev->stats) */
struct pcpu_tstats {
	unsigned long	rx_packets;
	unsigned long	rx_bytes;
	unsigned long	tx_packets;
	unsigned long	tx_bytes;
};

static struct net_device_stats *ipgre_get_stats(struct net_device *dev)
{
	struct pcpu_tstats sum = { 0 };
	int i;

	for_each_possible_cpu(i) {
		const struct pcpu_tstats *tstats = per_cpu_ptr(dev->tstats, i);

		sum.rx_packets += tstats->rx_packets;
		sum.rx_bytes   += tstats->rx_bytes;
		sum.tx_packets += tstats->tx_packets;
		sum.tx_bytes   += tstats->tx_bytes;
	}
	dev->stats.rx_packets = sum.rx_packets;
	dev->stats.rx_bytes   = sum.rx_bytes;
	dev->stats.tx_packets = sum.tx_packets;
	dev->stats.tx_bytes   = sum.tx_bytes;
	return &dev->stats;
}

L
Linus Torvalds 已提交
196 197
/* Given src, dst and key, find appropriate for input tunnel. */

T
Timo Teras 已提交
198
static struct ip_tunnel * ipgre_tunnel_lookup(struct net_device *dev,
199 200
					      __be32 remote, __be32 local,
					      __be32 key, __be16 gre_proto)
L
Linus Torvalds 已提交
201
{
T
Timo Teras 已提交
202 203
	struct net *net = dev_net(dev);
	int link = dev->ifindex;
E
Eric Dumazet 已提交
204 205
	unsigned int h0 = HASH(remote);
	unsigned int h1 = HASH(key);
T
Timo Teras 已提交
206
	struct ip_tunnel *t, *cand = NULL;
207
	struct ipgre_net *ign = net_generic(net, ipgre_net_id);
208 209
	int dev_type = (gre_proto == htons(ETH_P_TEB)) ?
		       ARPHRD_ETHER : ARPHRD_IPGRE;
T
Timo Teras 已提交
210
	int score, cand_score = 4;
L
Linus Torvalds 已提交
211

212
	for_each_ip_tunnel_rcu(ign->tunnels_r_l[h0 ^ h1]) {
T
Timo Teras 已提交
213 214 215 216 217 218 219 220 221 222
		if (local != t->parms.iph.saddr ||
		    remote != t->parms.iph.daddr ||
		    key != t->parms.i_key ||
		    !(t->dev->flags & IFF_UP))
			continue;

		if (t->dev->type != ARPHRD_IPGRE &&
		    t->dev->type != dev_type)
			continue;

T
Timo Teras 已提交
223
		score = 0;
T
Timo Teras 已提交
224
		if (t->parms.link != link)
T
Timo Teras 已提交
225
			score |= 1;
T
Timo Teras 已提交
226
		if (t->dev->type != dev_type)
T
Timo Teras 已提交
227 228
			score |= 2;
		if (score == 0)
T
Timo Teras 已提交
229
			return t;
T
Timo Teras 已提交
230 231 232 233 234

		if (score < cand_score) {
			cand = t;
			cand_score = score;
		}
L
Linus Torvalds 已提交
235
	}
236

237
	for_each_ip_tunnel_rcu(ign->tunnels_r[h0 ^ h1]) {
T
Timo Teras 已提交
238 239 240 241 242 243 244 245 246
		if (remote != t->parms.iph.daddr ||
		    key != t->parms.i_key ||
		    !(t->dev->flags & IFF_UP))
			continue;

		if (t->dev->type != ARPHRD_IPGRE &&
		    t->dev->type != dev_type)
			continue;

T
Timo Teras 已提交
247
		score = 0;
T
Timo Teras 已提交
248
		if (t->parms.link != link)
T
Timo Teras 已提交
249
			score |= 1;
T
Timo Teras 已提交
250
		if (t->dev->type != dev_type)
T
Timo Teras 已提交
251 252
			score |= 2;
		if (score == 0)
T
Timo Teras 已提交
253
			return t;
T
Timo Teras 已提交
254 255 256 257 258

		if (score < cand_score) {
			cand = t;
			cand_score = score;
		}
L
Linus Torvalds 已提交
259
	}
260

261
	for_each_ip_tunnel_rcu(ign->tunnels_l[h1]) {
T
Timo Teras 已提交
262 263 264 265 266 267 268 269 270 271 272
		if ((local != t->parms.iph.saddr &&
		     (local != t->parms.iph.daddr ||
		      !ipv4_is_multicast(local))) ||
		    key != t->parms.i_key ||
		    !(t->dev->flags & IFF_UP))
			continue;

		if (t->dev->type != ARPHRD_IPGRE &&
		    t->dev->type != dev_type)
			continue;

T
Timo Teras 已提交
273
		score = 0;
T
Timo Teras 已提交
274
		if (t->parms.link != link)
T
Timo Teras 已提交
275
			score |= 1;
T
Timo Teras 已提交
276
		if (t->dev->type != dev_type)
T
Timo Teras 已提交
277 278
			score |= 2;
		if (score == 0)
T
Timo Teras 已提交
279
			return t;
T
Timo Teras 已提交
280 281 282 283 284

		if (score < cand_score) {
			cand = t;
			cand_score = score;
		}
L
Linus Torvalds 已提交
285
	}
286

287
	for_each_ip_tunnel_rcu(ign->tunnels_wc[h1]) {
T
Timo Teras 已提交
288 289 290 291 292 293 294 295
		if (t->parms.i_key != key ||
		    !(t->dev->flags & IFF_UP))
			continue;

		if (t->dev->type != ARPHRD_IPGRE &&
		    t->dev->type != dev_type)
			continue;

T
Timo Teras 已提交
296
		score = 0;
T
Timo Teras 已提交
297
		if (t->parms.link != link)
T
Timo Teras 已提交
298
			score |= 1;
T
Timo Teras 已提交
299
		if (t->dev->type != dev_type)
T
Timo Teras 已提交
300 301
			score |= 2;
		if (score == 0)
T
Timo Teras 已提交
302
			return t;
T
Timo Teras 已提交
303 304 305 306 307

		if (score < cand_score) {
			cand = t;
			cand_score = score;
		}
L
Linus Torvalds 已提交
308 309
	}

T
Timo Teras 已提交
310 311
	if (cand != NULL)
		return cand;
312

313 314 315
	dev = ign->fb_tunnel_dev;
	if (dev->flags & IFF_UP)
		return netdev_priv(dev);
T
Timo Teras 已提交
316

L
Linus Torvalds 已提交
317 318 319
	return NULL;
}

E
Eric Dumazet 已提交
320
static struct ip_tunnel __rcu **__ipgre_bucket(struct ipgre_net *ign,
321
		struct ip_tunnel_parm *parms)
L
Linus Torvalds 已提交
322
{
323 324 325
	__be32 remote = parms->iph.daddr;
	__be32 local = parms->iph.saddr;
	__be32 key = parms->i_key;
E
Eric Dumazet 已提交
326
	unsigned int h = HASH(key);
L
Linus Torvalds 已提交
327 328 329 330
	int prio = 0;

	if (local)
		prio |= 1;
331
	if (remote && !ipv4_is_multicast(remote)) {
L
Linus Torvalds 已提交
332 333 334 335
		prio |= 2;
		h ^= HASH(remote);
	}

336
	return &ign->tunnels[prio][h];
L
Linus Torvalds 已提交
337 338
}

E
Eric Dumazet 已提交
339
static inline struct ip_tunnel __rcu **ipgre_bucket(struct ipgre_net *ign,
340
		struct ip_tunnel *t)
341
{
342
	return __ipgre_bucket(ign, &t->parms);
343 344
}

345
static void ipgre_tunnel_link(struct ipgre_net *ign, struct ip_tunnel *t)
L
Linus Torvalds 已提交
346
{
E
Eric Dumazet 已提交
347
	struct ip_tunnel __rcu **tp = ipgre_bucket(ign, t);
L
Linus Torvalds 已提交
348

E
Eric Dumazet 已提交
349
	rcu_assign_pointer(t->next, rtnl_dereference(*tp));
350
	rcu_assign_pointer(*tp, t);
L
Linus Torvalds 已提交
351 352
}

353
static void ipgre_tunnel_unlink(struct ipgre_net *ign, struct ip_tunnel *t)
L
Linus Torvalds 已提交
354
{
E
Eric Dumazet 已提交
355 356 357 358 359 360 361 362
	struct ip_tunnel __rcu **tp;
	struct ip_tunnel *iter;

	for (tp = ipgre_bucket(ign, t);
	     (iter = rtnl_dereference(*tp)) != NULL;
	     tp = &iter->next) {
		if (t == iter) {
			rcu_assign_pointer(*tp, t->next);
L
Linus Torvalds 已提交
363 364 365 366 367
			break;
		}
	}
}

368 369 370
static struct ip_tunnel *ipgre_tunnel_find(struct net *net,
					   struct ip_tunnel_parm *parms,
					   int type)
L
Linus Torvalds 已提交
371
{
A
Al Viro 已提交
372 373 374
	__be32 remote = parms->iph.daddr;
	__be32 local = parms->iph.saddr;
	__be32 key = parms->i_key;
T
Timo Teras 已提交
375
	int link = parms->link;
E
Eric Dumazet 已提交
376 377
	struct ip_tunnel *t;
	struct ip_tunnel __rcu **tp;
378 379
	struct ipgre_net *ign = net_generic(net, ipgre_net_id);

E
Eric Dumazet 已提交
380 381 382
	for (tp = __ipgre_bucket(ign, parms);
	     (t = rtnl_dereference(*tp)) != NULL;
	     tp = &t->next)
383 384 385
		if (local == t->parms.iph.saddr &&
		    remote == t->parms.iph.daddr &&
		    key == t->parms.i_key &&
T
Timo Teras 已提交
386
		    link == t->parms.link &&
387 388 389 390 391 392
		    type == t->dev->type)
			break;

	return t;
}

E
Eric Dumazet 已提交
393
static struct ip_tunnel *ipgre_tunnel_locate(struct net *net,
394 395 396
		struct ip_tunnel_parm *parms, int create)
{
	struct ip_tunnel *t, *nt;
L
Linus Torvalds 已提交
397 398
	struct net_device *dev;
	char name[IFNAMSIZ];
399
	struct ipgre_net *ign = net_generic(net, ipgre_net_id);
L
Linus Torvalds 已提交
400

401 402 403
	t = ipgre_tunnel_find(net, parms, ARPHRD_IPGRE);
	if (t || !create)
		return t;
L
Linus Torvalds 已提交
404 405 406

	if (parms->name[0])
		strlcpy(name, parms->name, IFNAMSIZ);
407
	else
S
stephen hemminger 已提交
408
		strcpy(name, "gre%d");
L
Linus Torvalds 已提交
409 410 411

	dev = alloc_netdev(sizeof(*t), name, ipgre_tunnel_setup);
	if (!dev)
S
stephen hemminger 已提交
412
		return NULL;
L
Linus Torvalds 已提交
413

414 415
	dev_net_set(dev, net);

416
	nt = netdev_priv(dev);
L
Linus Torvalds 已提交
417
	nt->parms = *parms;
H
Herbert Xu 已提交
418
	dev->rtnl_link_ops = &ipgre_link_ops;
L
Linus Torvalds 已提交
419

420 421
	dev->mtu = ipgre_tunnel_bind_dev(dev);

422 423
	if (register_netdevice(dev) < 0)
		goto failed_free;
L
Linus Torvalds 已提交
424 425

	dev_hold(dev);
426
	ipgre_tunnel_link(ign, nt);
L
Linus Torvalds 已提交
427 428
	return nt;

429 430
failed_free:
	free_netdev(dev);
L
Linus Torvalds 已提交
431 432 433 434 435
	return NULL;
}

static void ipgre_tunnel_uninit(struct net_device *dev)
{
436 437 438 439
	struct net *net = dev_net(dev);
	struct ipgre_net *ign = net_generic(net, ipgre_net_id);

	ipgre_tunnel_unlink(ign, netdev_priv(dev));
L
Linus Torvalds 已提交
440 441 442 443 444 445 446
	dev_put(dev);
}


static void ipgre_err(struct sk_buff *skb, u32 info)
{

447
/* All the routers (except for Linux) return only
L
Linus Torvalds 已提交
448 449 450 451 452 453 454 455 456 457 458 459
   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 standrads established
   by themself???
 */

460
	const struct iphdr *iph = (const struct iphdr *)skb->data;
A
Al Viro 已提交
461
	__be16	     *p = (__be16*)(skb->data+(iph->ihl<<2));
L
Linus Torvalds 已提交
462
	int grehlen = (iph->ihl<<2) + 4;
463 464
	const int type = icmp_hdr(skb)->type;
	const int code = icmp_hdr(skb)->code;
L
Linus Torvalds 已提交
465
	struct ip_tunnel *t;
A
Al Viro 已提交
466
	__be16 flags;
L
Linus Torvalds 已提交
467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510

	flags = p[0];
	if (flags&(GRE_CSUM|GRE_KEY|GRE_SEQ|GRE_ROUTING|GRE_VERSION)) {
		if (flags&(GRE_VERSION|GRE_ROUTING))
			return;
		if (flags&GRE_KEY) {
			grehlen += 4;
			if (flags&GRE_CSUM)
				grehlen += 4;
		}
	}

	/* If only 8 bytes returned, keyed message will be dropped here */
	if (skb_headlen(skb) < grehlen)
		return;

	switch (type) {
	default:
	case ICMP_PARAMETERPROB:
		return;

	case ICMP_DEST_UNREACH:
		switch (code) {
		case ICMP_SR_FAILED:
		case ICMP_PORT_UNREACH:
			/* Impossible event. */
			return;
		case ICMP_FRAG_NEEDED:
			/* Soft state for pmtu is maintained by IP core. */
			return;
		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;
	case ICMP_TIME_EXCEEDED:
		if (code != ICMP_EXC_TTL)
			return;
		break;
	}

511
	rcu_read_lock();
T
Timo Teras 已提交
512
	t = ipgre_tunnel_lookup(skb->dev, iph->daddr, iph->saddr,
513 514 515
				flags & GRE_KEY ?
				*(((__be32 *)p) + (grehlen / 4) - 1) : 0,
				p[1]);
516 517
	if (t == NULL || t->parms.iph.daddr == 0 ||
	    ipv4_is_multicast(t->parms.iph.daddr))
L
Linus Torvalds 已提交
518 519 520 521 522
		goto out;

	if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED)
		goto out;

523
	if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO))
L
Linus Torvalds 已提交
524 525 526 527 528
		t->err_count++;
	else
		t->err_count = 1;
	t->err_time = jiffies;
out:
529
	rcu_read_unlock();
L
Linus Torvalds 已提交
530 531
}

532
static inline void ipgre_ecn_decapsulate(const struct iphdr *iph, struct sk_buff *skb)
L
Linus Torvalds 已提交
533 534 535
{
	if (INET_ECN_is_ce(iph->tos)) {
		if (skb->protocol == htons(ETH_P_IP)) {
536
			IP_ECN_set_ce(ip_hdr(skb));
L
Linus Torvalds 已提交
537
		} else if (skb->protocol == htons(ETH_P_IPV6)) {
538
			IP6_ECN_set_ce(ipv6_hdr(skb));
L
Linus Torvalds 已提交
539 540 541 542 543
		}
	}
}

static inline u8
544
ipgre_ecn_encapsulate(u8 tos, const struct iphdr *old_iph, struct sk_buff *skb)
L
Linus Torvalds 已提交
545 546 547 548 549
{
	u8 inner = 0;
	if (skb->protocol == htons(ETH_P_IP))
		inner = old_iph->tos;
	else if (skb->protocol == htons(ETH_P_IPV6))
550
		inner = ipv6_get_dsfield((const struct ipv6hdr *)old_iph);
L
Linus Torvalds 已提交
551 552 553 554 555
	return INET_ECN_encapsulate(tos, inner);
}

static int ipgre_rcv(struct sk_buff *skb)
{
556
	const struct iphdr *iph;
L
Linus Torvalds 已提交
557
	u8     *h;
A
Al Viro 已提交
558
	__be16    flags;
559
	__sum16   csum = 0;
A
Al Viro 已提交
560
	__be32 key = 0;
L
Linus Torvalds 已提交
561 562 563
	u32    seqno = 0;
	struct ip_tunnel *tunnel;
	int    offset = 4;
564
	__be16 gre_proto;
L
Linus Torvalds 已提交
565 566 567 568

	if (!pskb_may_pull(skb, 16))
		goto drop_nolock;

569
	iph = ip_hdr(skb);
L
Linus Torvalds 已提交
570
	h = skb->data;
A
Al Viro 已提交
571
	flags = *(__be16*)h;
L
Linus Torvalds 已提交
572 573 574 575 576 577 578 579 580

	if (flags&(GRE_CSUM|GRE_KEY|GRE_ROUTING|GRE_SEQ|GRE_VERSION)) {
		/* - Version must be 0.
		   - We do not support routing headers.
		 */
		if (flags&(GRE_VERSION|GRE_ROUTING))
			goto drop_nolock;

		if (flags&GRE_CSUM) {
581
			switch (skb->ip_summed) {
582
			case CHECKSUM_COMPLETE:
583
				csum = csum_fold(skb->csum);
584 585 586 587 588 589
				if (!csum)
					break;
				/* fall through */
			case CHECKSUM_NONE:
				skb->csum = 0;
				csum = __skb_checksum_complete(skb);
590
				skb->ip_summed = CHECKSUM_COMPLETE;
L
Linus Torvalds 已提交
591 592 593 594
			}
			offset += 4;
		}
		if (flags&GRE_KEY) {
A
Al Viro 已提交
595
			key = *(__be32*)(h + offset);
L
Linus Torvalds 已提交
596 597 598
			offset += 4;
		}
		if (flags&GRE_SEQ) {
A
Al Viro 已提交
599
			seqno = ntohl(*(__be32*)(h + offset));
L
Linus Torvalds 已提交
600 601 602 603
			offset += 4;
		}
	}

604 605
	gre_proto = *(__be16 *)(h + 2);

606
	rcu_read_lock();
T
Timo Teras 已提交
607
	if ((tunnel = ipgre_tunnel_lookup(skb->dev,
608 609
					  iph->saddr, iph->daddr, key,
					  gre_proto))) {
E
Eric Dumazet 已提交
610
		struct pcpu_tstats *tstats;
611

L
Linus Torvalds 已提交
612 613
		secpath_reset(skb);

614
		skb->protocol = gre_proto;
L
Linus Torvalds 已提交
615 616 617 618
		/* WCCP version 1 and 2 protocol decoding.
		 * - Change protocol to IP
		 * - When dealing with WCCPv2, Skip extra 4 bytes in GRE header
		 */
619
		if (flags == 0 && gre_proto == htons(ETH_P_WCCP)) {
620
			skb->protocol = htons(ETH_P_IP);
621
			if ((*(h + offset) & 0xF0) != 0x40)
L
Linus Torvalds 已提交
622 623 624
				offset += 4;
		}

625
		skb->mac_header = skb->network_header;
626
		__pskb_pull(skb, offset);
627
		skb_postpull_rcsum(skb, skb_transport_header(skb), offset);
L
Linus Torvalds 已提交
628 629
		skb->pkt_type = PACKET_HOST;
#ifdef CONFIG_NET_IPGRE_BROADCAST
630
		if (ipv4_is_multicast(iph->daddr)) {
L
Linus Torvalds 已提交
631
			/* Looped back packet, drop it! */
632
			if (rt_is_output_route(skb_rtable(skb)))
L
Linus Torvalds 已提交
633
				goto drop;
E
Eric Dumazet 已提交
634
			tunnel->dev->stats.multicast++;
L
Linus Torvalds 已提交
635 636 637 638 639 640
			skb->pkt_type = PACKET_BROADCAST;
		}
#endif

		if (((flags&GRE_CSUM) && csum) ||
		    (!(flags&GRE_CSUM) && tunnel->parms.i_flags&GRE_CSUM)) {
E
Eric Dumazet 已提交
641 642
			tunnel->dev->stats.rx_crc_errors++;
			tunnel->dev->stats.rx_errors++;
L
Linus Torvalds 已提交
643 644 645 646 647
			goto drop;
		}
		if (tunnel->parms.i_flags&GRE_SEQ) {
			if (!(flags&GRE_SEQ) ||
			    (tunnel->i_seqno && (s32)(seqno - tunnel->i_seqno) < 0)) {
E
Eric Dumazet 已提交
648 649
				tunnel->dev->stats.rx_fifo_errors++;
				tunnel->dev->stats.rx_errors++;
L
Linus Torvalds 已提交
650 651 652 653
				goto drop;
			}
			tunnel->i_seqno = seqno + 1;
		}
654 655 656 657

		/* Warning: All skb pointers will be invalidated! */
		if (tunnel->dev->type == ARPHRD_ETHER) {
			if (!pskb_may_pull(skb, ETH_HLEN)) {
E
Eric Dumazet 已提交
658 659
				tunnel->dev->stats.rx_length_errors++;
				tunnel->dev->stats.rx_errors++;
660 661 662 663 664 665 666 667
				goto drop;
			}

			iph = ip_hdr(skb);
			skb->protocol = eth_type_trans(skb, tunnel->dev);
			skb_postpull_rcsum(skb, eth_hdr(skb), ETH_HLEN);
		}

E
Eric Dumazet 已提交
668 669 670 671 672
		tstats = this_cpu_ptr(tunnel->dev->tstats);
		tstats->rx_packets++;
		tstats->rx_bytes += skb->len;

		__skb_tunnel_rx(skb, tunnel->dev);
673 674

		skb_reset_network_header(skb);
L
Linus Torvalds 已提交
675
		ipgre_ecn_decapsulate(iph, skb);
676

677
		netif_rx(skb);
E
Eric Dumazet 已提交
678

679
		rcu_read_unlock();
E
Eric Dumazet 已提交
680
		return 0;
L
Linus Torvalds 已提交
681
	}
682
	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
L
Linus Torvalds 已提交
683 684

drop:
685
	rcu_read_unlock();
L
Linus Torvalds 已提交
686 687
drop_nolock:
	kfree_skb(skb);
E
Eric Dumazet 已提交
688
	return 0;
L
Linus Torvalds 已提交
689 690
}

691
static netdev_tx_t ipgre_tunnel_xmit(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
692
{
693
	struct ip_tunnel *tunnel = netdev_priv(dev);
E
Eric Dumazet 已提交
694
	struct pcpu_tstats *tstats;
695 696
	const struct iphdr  *old_iph = ip_hdr(skb);
	const struct iphdr  *tiph;
697
	struct flowi4 fl4;
L
Linus Torvalds 已提交
698
	u8     tos;
A
Al Viro 已提交
699
	__be16 df;
L
Linus Torvalds 已提交
700
	struct rtable *rt;     			/* Route to the other host */
E
Eric Dumazet 已提交
701
	struct net_device *tdev;		/* Device to other host */
L
Linus Torvalds 已提交
702
	struct iphdr  *iph;			/* Our new IP header */
703
	unsigned int max_headroom;		/* The extra header space needed */
L
Linus Torvalds 已提交
704
	int    gre_hlen;
A
Al Viro 已提交
705
	__be32 dst;
L
Linus Torvalds 已提交
706 707
	int    mtu;

708 709 710 711
	if (dev->type == ARPHRD_ETHER)
		IPCB(skb)->flags = 0;

	if (dev->header_ops && dev->type == ARPHRD_IPGRE) {
L
Linus Torvalds 已提交
712
		gre_hlen = 0;
713
		tiph = (const struct iphdr *)skb->data;
L
Linus Torvalds 已提交
714 715 716 717 718 719 720 721
	} else {
		gre_hlen = tunnel->hlen;
		tiph = &tunnel->parms.iph;
	}

	if ((dst = tiph->daddr) == 0) {
		/* NBMA tunnel */

E
Eric Dumazet 已提交
722
		if (skb_dst(skb) == NULL) {
E
Eric Dumazet 已提交
723
			dev->stats.tx_fifo_errors++;
L
Linus Torvalds 已提交
724 725 726 727
			goto tx_error;
		}

		if (skb->protocol == htons(ETH_P_IP)) {
E
Eric Dumazet 已提交
728
			rt = skb_rtable(skb);
L
Linus Torvalds 已提交
729 730 731
			if ((dst = rt->rt_gateway) == 0)
				goto tx_error_icmp;
		}
732
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
L
Linus Torvalds 已提交
733
		else if (skb->protocol == htons(ETH_P_IPV6)) {
734
			struct neighbour *neigh = dst_get_neighbour(skb_dst(skb));
735
			const struct in6_addr *addr6;
L
Linus Torvalds 已提交
736 737 738 739 740
			int addr_type;

			if (neigh == NULL)
				goto tx_error;

741
			addr6 = (const struct in6_addr *)&neigh->primary_key;
L
Linus Torvalds 已提交
742 743 744
			addr_type = ipv6_addr_type(addr6);

			if (addr_type == IPV6_ADDR_ANY) {
745
				addr6 = &ipv6_hdr(skb)->daddr;
L
Linus Torvalds 已提交
746 747 748 749 750 751 752 753 754 755 756 757 758 759
				addr_type = ipv6_addr_type(addr6);
			}

			if ((addr_type & IPV6_ADDR_COMPATv4) == 0)
				goto tx_error_icmp;

			dst = addr6->s6_addr32[3];
		}
#endif
		else
			goto tx_error;
	}

	tos = tiph->tos;
760 761
	if (tos == 1) {
		tos = 0;
L
Linus Torvalds 已提交
762 763
		if (skb->protocol == htons(ETH_P_IP))
			tos = old_iph->tos;
764
		else if (skb->protocol == htons(ETH_P_IPV6))
765
			tos = ipv6_get_dsfield((const struct ipv6hdr *)old_iph);
L
Linus Torvalds 已提交
766 767
	}

768
	rt = ip_route_output_gre(dev_net(dev), &fl4, dst, tiph->saddr,
769 770 771 772 773
				 tunnel->parms.o_key, RT_TOS(tos),
				 tunnel->parms.link);
	if (IS_ERR(rt)) {
		dev->stats.tx_carrier_errors++;
		goto tx_error;
L
Linus Torvalds 已提交
774
	}
775
	tdev = rt->dst.dev;
L
Linus Torvalds 已提交
776 777 778

	if (tdev == dev) {
		ip_rt_put(rt);
E
Eric Dumazet 已提交
779
		dev->stats.collisions++;
L
Linus Torvalds 已提交
780 781 782 783 784
		goto tx_error;
	}

	df = tiph->frag_off;
	if (df)
785
		mtu = dst_mtu(&rt->dst) - dev->hard_header_len - tunnel->hlen;
L
Linus Torvalds 已提交
786
	else
E
Eric Dumazet 已提交
787
		mtu = skb_dst(skb) ? dst_mtu(skb_dst(skb)) : dev->mtu;
L
Linus Torvalds 已提交
788

E
Eric Dumazet 已提交
789 790
	if (skb_dst(skb))
		skb_dst(skb)->ops->update_pmtu(skb_dst(skb), mtu);
L
Linus Torvalds 已提交
791 792 793 794 795 796 797 798 799 800 801

	if (skb->protocol == htons(ETH_P_IP)) {
		df |= (old_iph->frag_off&htons(IP_DF));

		if ((old_iph->frag_off&htons(IP_DF)) &&
		    mtu < ntohs(old_iph->tot_len)) {
			icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, htonl(mtu));
			ip_rt_put(rt);
			goto tx_error;
		}
	}
802
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
L
Linus Torvalds 已提交
803
	else if (skb->protocol == htons(ETH_P_IPV6)) {
E
Eric Dumazet 已提交
804
		struct rt6_info *rt6 = (struct rt6_info *)skb_dst(skb);
L
Linus Torvalds 已提交
805

E
Eric Dumazet 已提交
806
		if (rt6 && mtu < dst_mtu(skb_dst(skb)) && mtu >= IPV6_MIN_MTU) {
807 808
			if ((tunnel->parms.iph.daddr &&
			     !ipv4_is_multicast(tunnel->parms.iph.daddr)) ||
L
Linus Torvalds 已提交
809 810
			    rt6->rt6i_dst.plen == 128) {
				rt6->rt6i_flags |= RTF_MODIFIED;
811
				dst_metric_set(skb_dst(skb), RTAX_MTU, mtu);
L
Linus Torvalds 已提交
812 813 814 815
			}
		}

		if (mtu >= IPV6_MIN_MTU && mtu < skb->len - tunnel->hlen + gre_hlen) {
816
			icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
L
Linus Torvalds 已提交
817 818 819 820 821 822 823
			ip_rt_put(rt);
			goto tx_error;
		}
	}
#endif

	if (tunnel->err_count > 0) {
824 825
		if (time_before(jiffies,
				tunnel->err_time + IPTUNNEL_ERR_TIMEO)) {
L
Linus Torvalds 已提交
826 827 828 829 830 831 832
			tunnel->err_count--;

			dst_link_failure(skb);
		} else
			tunnel->err_count = 0;
	}

833
	max_headroom = LL_RESERVED_SPACE(tdev) + gre_hlen + rt->dst.header_len;
L
Linus Torvalds 已提交
834

835 836
	if (skb_headroom(skb) < max_headroom || skb_shared(skb)||
	    (skb_cloned(skb) && !skb_clone_writable(skb, 0))) {
L
Linus Torvalds 已提交
837 838 839
		struct sk_buff *new_skb = skb_realloc_headroom(skb, max_headroom);
		if (!new_skb) {
			ip_rt_put(rt);
E
Eric Dumazet 已提交
840
			dev->stats.tx_dropped++;
L
Linus Torvalds 已提交
841
			dev_kfree_skb(skb);
842
			return NETDEV_TX_OK;
L
Linus Torvalds 已提交
843 844 845 846 847
		}
		if (skb->sk)
			skb_set_owner_w(new_skb, skb->sk);
		dev_kfree_skb(skb);
		skb = new_skb;
848
		old_iph = ip_hdr(skb);
L
Linus Torvalds 已提交
849 850
	}

851
	skb_reset_transport_header(skb);
852 853
	skb_push(skb, gre_hlen);
	skb_reset_network_header(skb);
L
Linus Torvalds 已提交
854
	memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt));
855 856
	IPCB(skb)->flags &= ~(IPSKB_XFRM_TUNNEL_SIZE | IPSKB_XFRM_TRANSFORMED |
			      IPSKB_REROUTED);
E
Eric Dumazet 已提交
857
	skb_dst_drop(skb);
858
	skb_dst_set(skb, &rt->dst);
L
Linus Torvalds 已提交
859 860 861 862 863

	/*
	 *	Push down and install the IPIP header.
	 */

864
	iph 			=	ip_hdr(skb);
L
Linus Torvalds 已提交
865 866 867 868 869
	iph->version		=	4;
	iph->ihl		=	sizeof(struct iphdr) >> 2;
	iph->frag_off		=	df;
	iph->protocol		=	IPPROTO_GRE;
	iph->tos		=	ipgre_ecn_encapsulate(tos, old_iph, skb);
870 871
	iph->daddr		=	fl4.daddr;
	iph->saddr		=	fl4.saddr;
L
Linus Torvalds 已提交
872 873 874 875

	if ((iph->ttl = tiph->ttl) == 0) {
		if (skb->protocol == htons(ETH_P_IP))
			iph->ttl = old_iph->ttl;
876
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
L
Linus Torvalds 已提交
877
		else if (skb->protocol == htons(ETH_P_IPV6))
878
			iph->ttl = ((const struct ipv6hdr *)old_iph)->hop_limit;
L
Linus Torvalds 已提交
879 880
#endif
		else
881
			iph->ttl = ip4_dst_hoplimit(&rt->dst);
L
Linus Torvalds 已提交
882 883
	}

884 885 886
	((__be16 *)(iph + 1))[0] = tunnel->parms.o_flags;
	((__be16 *)(iph + 1))[1] = (dev->type == ARPHRD_ETHER) ?
				   htons(ETH_P_TEB) : skb->protocol;
L
Linus Torvalds 已提交
887 888

	if (tunnel->parms.o_flags&(GRE_KEY|GRE_CSUM|GRE_SEQ)) {
A
Al Viro 已提交
889
		__be32 *ptr = (__be32*)(((u8*)iph) + tunnel->hlen - 4);
L
Linus Torvalds 已提交
890 891 892 893 894 895 896 897 898 899 900 901

		if (tunnel->parms.o_flags&GRE_SEQ) {
			++tunnel->o_seqno;
			*ptr = htonl(tunnel->o_seqno);
			ptr--;
		}
		if (tunnel->parms.o_flags&GRE_KEY) {
			*ptr = tunnel->parms.o_key;
			ptr--;
		}
		if (tunnel->parms.o_flags&GRE_CSUM) {
			*ptr = 0;
902
			*(__sum16*)ptr = ip_compute_csum((void*)(iph+1), skb->len - sizeof(struct iphdr));
L
Linus Torvalds 已提交
903 904 905 906
		}
	}

	nf_reset(skb);
E
Eric Dumazet 已提交
907 908
	tstats = this_cpu_ptr(dev->tstats);
	__IPTUNNEL_XMIT(tstats, &dev->stats);
909
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
910 911 912 913 914

tx_error_icmp:
	dst_link_failure(skb);

tx_error:
E
Eric Dumazet 已提交
915
	dev->stats.tx_errors++;
L
Linus Torvalds 已提交
916
	dev_kfree_skb(skb);
917
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
918 919
}

920
static int ipgre_tunnel_bind_dev(struct net_device *dev)
921 922 923
{
	struct net_device *tdev = NULL;
	struct ip_tunnel *tunnel;
924
	const struct iphdr *iph;
925 926 927 928 929 930 931
	int hlen = LL_MAX_HEADER;
	int mtu = ETH_DATA_LEN;
	int addend = sizeof(struct iphdr) + 4;

	tunnel = netdev_priv(dev);
	iph = &tunnel->parms.iph;

H
Herbert Xu 已提交
932
	/* Guess output device to choose reasonable mtu and needed_headroom */
933 934

	if (iph->daddr) {
935 936 937 938 939 940 941 942
		struct flowi4 fl4;
		struct rtable *rt;

		rt = ip_route_output_gre(dev_net(dev), &fl4,
					 iph->daddr, iph->saddr,
					 tunnel->parms.o_key,
					 RT_TOS(iph->tos),
					 tunnel->parms.link);
943
		if (!IS_ERR(rt)) {
944
			tdev = rt->dst.dev;
945 946
			ip_rt_put(rt);
		}
947 948 949

		if (dev->type != ARPHRD_ETHER)
			dev->flags |= IFF_POINTOPOINT;
950 951 952
	}

	if (!tdev && tunnel->parms.link)
953
		tdev = __dev_get_by_index(dev_net(dev), tunnel->parms.link);
954 955

	if (tdev) {
H
Herbert Xu 已提交
956
		hlen = tdev->hard_header_len + tdev->needed_headroom;
957 958 959 960 961 962 963 964 965 966 967 968 969
		mtu = tdev->mtu;
	}
	dev->iflink = tunnel->parms.link;

	/* Precalculate GRE options length */
	if (tunnel->parms.o_flags&(GRE_CSUM|GRE_KEY|GRE_SEQ)) {
		if (tunnel->parms.o_flags&GRE_CSUM)
			addend += 4;
		if (tunnel->parms.o_flags&GRE_KEY)
			addend += 4;
		if (tunnel->parms.o_flags&GRE_SEQ)
			addend += 4;
	}
H
Herbert Xu 已提交
970
	dev->needed_headroom = addend + hlen;
971
	mtu -= dev->hard_header_len + addend;
972 973 974 975

	if (mtu < 68)
		mtu = 68;

976 977
	tunnel->hlen = addend;

978
	return mtu;
979 980
}

L
Linus Torvalds 已提交
981 982 983 984 985 986
static int
ipgre_tunnel_ioctl (struct net_device *dev, struct ifreq *ifr, int cmd)
{
	int err = 0;
	struct ip_tunnel_parm p;
	struct ip_tunnel *t;
987 988
	struct net *net = dev_net(dev);
	struct ipgre_net *ign = net_generic(net, ipgre_net_id);
L
Linus Torvalds 已提交
989 990 991 992

	switch (cmd) {
	case SIOCGETTUNNEL:
		t = NULL;
993
		if (dev == ign->fb_tunnel_dev) {
L
Linus Torvalds 已提交
994 995 996 997
			if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) {
				err = -EFAULT;
				break;
			}
998
			t = ipgre_tunnel_locate(net, &p, 0);
L
Linus Torvalds 已提交
999 1000
		}
		if (t == NULL)
1001
			t = netdev_priv(dev);
L
Linus Torvalds 已提交
1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029
		memcpy(&p, &t->parms, sizeof(p));
		if (copy_to_user(ifr->ifr_ifru.ifru_data, &p, sizeof(p)))
			err = -EFAULT;
		break;

	case SIOCADDTUNNEL:
	case SIOCCHGTUNNEL:
		err = -EPERM;
		if (!capable(CAP_NET_ADMIN))
			goto done;

		err = -EFAULT;
		if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
			goto done;

		err = -EINVAL;
		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)))
			goto done;
		if (p.iph.ttl)
			p.iph.frag_off |= htons(IP_DF);

		if (!(p.i_flags&GRE_KEY))
			p.i_key = 0;
		if (!(p.o_flags&GRE_KEY))
			p.o_key = 0;

1030
		t = ipgre_tunnel_locate(net, &p, cmd == SIOCADDTUNNEL);
L
Linus Torvalds 已提交
1031

1032
		if (dev != ign->fb_tunnel_dev && cmd == SIOCCHGTUNNEL) {
L
Linus Torvalds 已提交
1033 1034 1035 1036 1037 1038
			if (t != NULL) {
				if (t->dev != dev) {
					err = -EEXIST;
					break;
				}
			} else {
E
Eric Dumazet 已提交
1039
				unsigned int nflags = 0;
L
Linus Torvalds 已提交
1040

1041
				t = netdev_priv(dev);
L
Linus Torvalds 已提交
1042

1043
				if (ipv4_is_multicast(p.iph.daddr))
L
Linus Torvalds 已提交
1044 1045 1046 1047 1048 1049 1050 1051
					nflags = IFF_BROADCAST;
				else if (p.iph.daddr)
					nflags = IFF_POINTOPOINT;

				if ((dev->flags^nflags)&(IFF_POINTOPOINT|IFF_BROADCAST)) {
					err = -EINVAL;
					break;
				}
1052
				ipgre_tunnel_unlink(ign, t);
1053
				synchronize_net();
L
Linus Torvalds 已提交
1054 1055 1056 1057 1058 1059
				t->parms.iph.saddr = p.iph.saddr;
				t->parms.iph.daddr = p.iph.daddr;
				t->parms.i_key = p.i_key;
				t->parms.o_key = p.o_key;
				memcpy(dev->dev_addr, &p.iph.saddr, 4);
				memcpy(dev->broadcast, &p.iph.daddr, 4);
1060
				ipgre_tunnel_link(ign, t);
L
Linus Torvalds 已提交
1061 1062 1063 1064 1065 1066 1067 1068 1069 1070
				netdev_state_change(dev);
			}
		}

		if (t) {
			err = 0;
			if (cmd == SIOCCHGTUNNEL) {
				t->parms.iph.ttl = p.iph.ttl;
				t->parms.iph.tos = p.iph.tos;
				t->parms.iph.frag_off = p.iph.frag_off;
1071 1072
				if (t->parms.link != p.link) {
					t->parms.link = p.link;
1073
					dev->mtu = ipgre_tunnel_bind_dev(dev);
1074 1075
					netdev_state_change(dev);
				}
L
Linus Torvalds 已提交
1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087
			}
			if (copy_to_user(ifr->ifr_ifru.ifru_data, &t->parms, sizeof(p)))
				err = -EFAULT;
		} else
			err = (cmd == SIOCADDTUNNEL ? -ENOBUFS : -ENOENT);
		break;

	case SIOCDELTUNNEL:
		err = -EPERM;
		if (!capable(CAP_NET_ADMIN))
			goto done;

1088
		if (dev == ign->fb_tunnel_dev) {
L
Linus Torvalds 已提交
1089 1090 1091 1092
			err = -EFAULT;
			if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
				goto done;
			err = -ENOENT;
1093
			if ((t = ipgre_tunnel_locate(net, &p, 0)) == NULL)
L
Linus Torvalds 已提交
1094 1095
				goto done;
			err = -EPERM;
1096
			if (t == netdev_priv(ign->fb_tunnel_dev))
L
Linus Torvalds 已提交
1097 1098 1099
				goto done;
			dev = t->dev;
		}
1100 1101
		unregister_netdevice(dev);
		err = 0;
L
Linus Torvalds 已提交
1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113
		break;

	default:
		err = -EINVAL;
	}

done:
	return err;
}

static int ipgre_tunnel_change_mtu(struct net_device *dev, int new_mtu)
{
1114
	struct ip_tunnel *tunnel = netdev_priv(dev);
H
Herbert Xu 已提交
1115 1116
	if (new_mtu < 68 ||
	    new_mtu > 0xFFF8 - dev->hard_header_len - tunnel->hlen)
L
Linus Torvalds 已提交
1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130
		return -EINVAL;
	dev->mtu = new_mtu;
	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).
1131

L
Linus Torvalds 已提交
1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150
   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
   ...

 */

1151 1152
static int ipgre_header(struct sk_buff *skb, struct net_device *dev,
			unsigned short type,
E
Eric Dumazet 已提交
1153
			const void *daddr, const void *saddr, unsigned int len)
L
Linus Torvalds 已提交
1154
{
1155
	struct ip_tunnel *t = netdev_priv(dev);
L
Linus Torvalds 已提交
1156
	struct iphdr *iph = (struct iphdr *)skb_push(skb, t->hlen);
A
Al Viro 已提交
1157
	__be16 *p = (__be16*)(iph+1);
L
Linus Torvalds 已提交
1158 1159 1160 1161 1162 1163

	memcpy(iph, &t->parms.iph, sizeof(struct iphdr));
	p[0]		= t->parms.o_flags;
	p[1]		= htons(type);

	/*
1164
	 *	Set the source hardware address.
L
Linus Torvalds 已提交
1165
	 */
1166

L
Linus Torvalds 已提交
1167 1168
	if (saddr)
		memcpy(&iph->saddr, saddr, 4);
1169
	if (daddr)
L
Linus Torvalds 已提交
1170
		memcpy(&iph->daddr, daddr, 4);
1171
	if (iph->daddr)
L
Linus Torvalds 已提交
1172
		return t->hlen;
1173

L
Linus Torvalds 已提交
1174 1175 1176
	return -t->hlen;
}

1177 1178
static int ipgre_header_parse(const struct sk_buff *skb, unsigned char *haddr)
{
1179
	const struct iphdr *iph = (const struct iphdr *) skb_mac_header(skb);
1180 1181 1182 1183
	memcpy(haddr, &iph->saddr, 4);
	return 4;
}

1184 1185
static const struct header_ops ipgre_header_ops = {
	.create	= ipgre_header,
1186
	.parse	= ipgre_header_parse,
1187 1188
};

1189
#ifdef CONFIG_NET_IPGRE_BROADCAST
L
Linus Torvalds 已提交
1190 1191
static int ipgre_open(struct net_device *dev)
{
1192
	struct ip_tunnel *t = netdev_priv(dev);
L
Linus Torvalds 已提交
1193

1194
	if (ipv4_is_multicast(t->parms.iph.daddr)) {
1195 1196 1197 1198 1199 1200 1201 1202 1203
		struct flowi4 fl4;
		struct rtable *rt;

		rt = ip_route_output_gre(dev_net(dev), &fl4,
					 t->parms.iph.daddr,
					 t->parms.iph.saddr,
					 t->parms.o_key,
					 RT_TOS(t->parms.iph.tos),
					 t->parms.link);
1204
		if (IS_ERR(rt))
L
Linus Torvalds 已提交
1205
			return -EADDRNOTAVAIL;
1206
		dev = rt->dst.dev;
L
Linus Torvalds 已提交
1207
		ip_rt_put(rt);
1208
		if (__in_dev_get_rtnl(dev) == NULL)
L
Linus Torvalds 已提交
1209 1210
			return -EADDRNOTAVAIL;
		t->mlink = dev->ifindex;
1211
		ip_mc_inc_group(__in_dev_get_rtnl(dev), t->parms.iph.daddr);
L
Linus Torvalds 已提交
1212 1213 1214 1215 1216 1217
	}
	return 0;
}

static int ipgre_close(struct net_device *dev)
{
1218
	struct ip_tunnel *t = netdev_priv(dev);
1219

1220
	if (ipv4_is_multicast(t->parms.iph.daddr) && t->mlink) {
1221
		struct in_device *in_dev;
1222
		in_dev = inetdev_by_index(dev_net(dev), t->mlink);
1223
		if (in_dev)
L
Linus Torvalds 已提交
1224 1225 1226 1227 1228 1229 1230
			ip_mc_dec_group(in_dev, t->parms.iph.daddr);
	}
	return 0;
}

#endif

1231 1232 1233 1234 1235 1236 1237 1238 1239 1240
static const struct net_device_ops ipgre_netdev_ops = {
	.ndo_init		= ipgre_tunnel_init,
	.ndo_uninit		= ipgre_tunnel_uninit,
#ifdef CONFIG_NET_IPGRE_BROADCAST
	.ndo_open		= ipgre_open,
	.ndo_stop		= ipgre_close,
#endif
	.ndo_start_xmit		= ipgre_tunnel_xmit,
	.ndo_do_ioctl		= ipgre_tunnel_ioctl,
	.ndo_change_mtu		= ipgre_tunnel_change_mtu,
E
Eric Dumazet 已提交
1241
	.ndo_get_stats		= ipgre_get_stats,
1242 1243
};

E
Eric Dumazet 已提交
1244 1245 1246 1247 1248 1249
static void ipgre_dev_free(struct net_device *dev)
{
	free_percpu(dev->tstats);
	free_netdev(dev);
}

L
Linus Torvalds 已提交
1250 1251
static void ipgre_tunnel_setup(struct net_device *dev)
{
1252
	dev->netdev_ops		= &ipgre_netdev_ops;
E
Eric Dumazet 已提交
1253
	dev->destructor 	= ipgre_dev_free;
L
Linus Torvalds 已提交
1254 1255

	dev->type		= ARPHRD_IPGRE;
H
Herbert Xu 已提交
1256
	dev->needed_headroom 	= LL_MAX_HEADER + sizeof(struct iphdr) + 4;
1257
	dev->mtu		= ETH_DATA_LEN - sizeof(struct iphdr) - 4;
L
Linus Torvalds 已提交
1258 1259 1260
	dev->flags		= IFF_NOARP;
	dev->iflink		= 0;
	dev->addr_len		= 4;
1261
	dev->features		|= NETIF_F_NETNS_LOCAL;
1262
	dev->priv_flags		&= ~IFF_XMIT_DST_RELEASE;
L
Linus Torvalds 已提交
1263 1264 1265 1266 1267 1268 1269
}

static int ipgre_tunnel_init(struct net_device *dev)
{
	struct ip_tunnel *tunnel;
	struct iphdr *iph;

1270
	tunnel = netdev_priv(dev);
L
Linus Torvalds 已提交
1271 1272 1273 1274 1275 1276 1277 1278 1279 1280
	iph = &tunnel->parms.iph;

	tunnel->dev = dev;
	strcpy(tunnel->parms.name, dev->name);

	memcpy(dev->dev_addr, &tunnel->parms.iph.saddr, 4);
	memcpy(dev->broadcast, &tunnel->parms.iph.daddr, 4);

	if (iph->daddr) {
#ifdef CONFIG_NET_IPGRE_BROADCAST
1281
		if (ipv4_is_multicast(iph->daddr)) {
L
Linus Torvalds 已提交
1282 1283 1284
			if (!iph->saddr)
				return -EINVAL;
			dev->flags = IFF_BROADCAST;
1285
			dev->header_ops = &ipgre_header_ops;
L
Linus Torvalds 已提交
1286 1287
		}
#endif
1288
	} else
1289
		dev->header_ops = &ipgre_header_ops;
L
Linus Torvalds 已提交
1290

E
Eric Dumazet 已提交
1291 1292 1293 1294
	dev->tstats = alloc_percpu(struct pcpu_tstats);
	if (!dev->tstats)
		return -ENOMEM;

L
Linus Torvalds 已提交
1295 1296 1297
	return 0;
}

1298
static void ipgre_fb_tunnel_init(struct net_device *dev)
L
Linus Torvalds 已提交
1299
{
1300
	struct ip_tunnel *tunnel = netdev_priv(dev);
L
Linus Torvalds 已提交
1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314
	struct iphdr *iph = &tunnel->parms.iph;

	tunnel->dev = dev;
	strcpy(tunnel->parms.name, dev->name);

	iph->version		= 4;
	iph->protocol		= IPPROTO_GRE;
	iph->ihl		= 5;
	tunnel->hlen		= sizeof(struct iphdr) + 4;

	dev_hold(dev);
}


1315 1316 1317
static const struct gre_protocol ipgre_protocol = {
	.handler     = ipgre_rcv,
	.err_handler = ipgre_err,
L
Linus Torvalds 已提交
1318 1319
};

1320
static void ipgre_destroy_tunnels(struct ipgre_net *ign, struct list_head *head)
1321 1322 1323 1324 1325 1326
{
	int prio;

	for (prio = 0; prio < 4; prio++) {
		int h;
		for (h = 0; h < HASH_SIZE; h++) {
E
Eric Dumazet 已提交
1327 1328 1329
			struct ip_tunnel *t;

			t = rtnl_dereference(ign->tunnels[prio][h]);
1330 1331 1332

			while (t != NULL) {
				unregister_netdevice_queue(t->dev, head);
E
Eric Dumazet 已提交
1333
				t = rtnl_dereference(t->next);
1334
			}
1335 1336 1337 1338
		}
	}
}

1339
static int __net_init ipgre_init_net(struct net *net)
1340
{
1341
	struct ipgre_net *ign = net_generic(net, ipgre_net_id);
1342 1343
	int err;

1344 1345 1346 1347 1348 1349
	ign->fb_tunnel_dev = alloc_netdev(sizeof(struct ip_tunnel), "gre0",
					   ipgre_tunnel_setup);
	if (!ign->fb_tunnel_dev) {
		err = -ENOMEM;
		goto err_alloc_dev;
	}
1350
	dev_net_set(ign->fb_tunnel_dev, net);
1351

1352
	ipgre_fb_tunnel_init(ign->fb_tunnel_dev);
H
Herbert Xu 已提交
1353
	ign->fb_tunnel_dev->rtnl_link_ops = &ipgre_link_ops;
1354 1355 1356 1357

	if ((err = register_netdev(ign->fb_tunnel_dev)))
		goto err_reg_dev;

E
Eric Dumazet 已提交
1358 1359
	rcu_assign_pointer(ign->tunnels_wc[0],
			   netdev_priv(ign->fb_tunnel_dev));
1360 1361
	return 0;

1362
err_reg_dev:
E
Eric Dumazet 已提交
1363
	ipgre_dev_free(ign->fb_tunnel_dev);
1364
err_alloc_dev:
1365 1366 1367
	return err;
}

1368
static void __net_exit ipgre_exit_net(struct net *net)
1369 1370
{
	struct ipgre_net *ign;
1371
	LIST_HEAD(list);
1372 1373

	ign = net_generic(net, ipgre_net_id);
1374
	rtnl_lock();
1375 1376
	ipgre_destroy_tunnels(ign, &list);
	unregister_netdevice_many(&list);
1377
	rtnl_unlock();
1378 1379 1380 1381 1382
}

static struct pernet_operations ipgre_net_ops = {
	.init = ipgre_init_net,
	.exit = ipgre_exit_net,
1383 1384
	.id   = &ipgre_net_id,
	.size = sizeof(struct ipgre_net),
1385
};
L
Linus Torvalds 已提交
1386

H
Herbert Xu 已提交
1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404
static int ipgre_tunnel_validate(struct nlattr *tb[], struct nlattr *data[])
{
	__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;

	return 0;
}

1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428
static int ipgre_tap_validate(struct nlattr *tb[], struct nlattr *data[])
{
	__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:
	return ipgre_tunnel_validate(tb, data);
}

H
Herbert Xu 已提交
1429 1430 1431
static void ipgre_netlink_parms(struct nlattr *data[],
				struct ip_tunnel_parm *parms)
{
1432
	memset(parms, 0, sizeof(*parms));
H
Herbert Xu 已提交
1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454

	parms->iph.protocol = IPPROTO_GRE;

	if (!data)
		return;

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

	if (data[IFLA_GRE_IFLAGS])
		parms->i_flags = nla_get_be16(data[IFLA_GRE_IFLAGS]);

	if (data[IFLA_GRE_OFLAGS])
		parms->o_flags = nla_get_be16(data[IFLA_GRE_OFLAGS]);

	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])
1455
		parms->iph.saddr = nla_get_be32(data[IFLA_GRE_LOCAL]);
H
Herbert Xu 已提交
1456 1457

	if (data[IFLA_GRE_REMOTE])
1458
		parms->iph.daddr = nla_get_be32(data[IFLA_GRE_REMOTE]);
H
Herbert Xu 已提交
1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469

	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]);

	if (!data[IFLA_GRE_PMTUDISC] || nla_get_u8(data[IFLA_GRE_PMTUDISC]))
		parms->iph.frag_off = htons(IP_DF);
}

1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480
static int ipgre_tap_init(struct net_device *dev)
{
	struct ip_tunnel *tunnel;

	tunnel = netdev_priv(dev);

	tunnel->dev = dev;
	strcpy(tunnel->parms.name, dev->name);

	ipgre_tunnel_bind_dev(dev);

E
Eric Dumazet 已提交
1481 1482 1483 1484
	dev->tstats = alloc_percpu(struct pcpu_tstats);
	if (!dev->tstats)
		return -ENOMEM;

1485 1486 1487
	return 0;
}

1488 1489 1490 1491 1492 1493 1494
static const struct net_device_ops ipgre_tap_netdev_ops = {
	.ndo_init		= ipgre_tap_init,
	.ndo_uninit		= ipgre_tunnel_uninit,
	.ndo_start_xmit		= ipgre_tunnel_xmit,
	.ndo_set_mac_address 	= eth_mac_addr,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_change_mtu		= ipgre_tunnel_change_mtu,
E
Eric Dumazet 已提交
1495
	.ndo_get_stats		= ipgre_get_stats,
1496 1497
};

1498 1499 1500 1501 1502
static void ipgre_tap_setup(struct net_device *dev)
{

	ether_setup(dev);

1503
	dev->netdev_ops		= &ipgre_tap_netdev_ops;
E
Eric Dumazet 已提交
1504
	dev->destructor 	= ipgre_dev_free;
1505 1506 1507 1508 1509

	dev->iflink		= 0;
	dev->features		|= NETIF_F_NETNS_LOCAL;
}

1510
static int ipgre_newlink(struct net *src_net, struct net_device *dev, struct nlattr *tb[],
H
Herbert Xu 已提交
1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521
			 struct nlattr *data[])
{
	struct ip_tunnel *nt;
	struct net *net = dev_net(dev);
	struct ipgre_net *ign = net_generic(net, ipgre_net_id);
	int mtu;
	int err;

	nt = netdev_priv(dev);
	ipgre_netlink_parms(data, &nt->parms);

1522
	if (ipgre_tunnel_find(net, &nt->parms, dev->type))
H
Herbert Xu 已提交
1523 1524
		return -EEXIST;

1525 1526 1527
	if (dev->type == ARPHRD_ETHER && !tb[IFLA_ADDRESS])
		random_ether_addr(dev->dev_addr);

H
Herbert Xu 已提交
1528 1529 1530 1531
	mtu = ipgre_tunnel_bind_dev(dev);
	if (!tb[IFLA_MTU])
		dev->mtu = mtu;

E
Eric Dumazet 已提交
1532 1533 1534 1535
	/* Can use a lockless transmit, unless we generate output sequences */
	if (!(nt->parms.o_flags & GRE_SEQ))
		dev->features |= NETIF_F_LLTX;

H
Herbert Xu 已提交
1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569
	err = register_netdevice(dev);
	if (err)
		goto out;

	dev_hold(dev);
	ipgre_tunnel_link(ign, nt);

out:
	return err;
}

static int ipgre_changelink(struct net_device *dev, struct nlattr *tb[],
			    struct nlattr *data[])
{
	struct ip_tunnel *t, *nt;
	struct net *net = dev_net(dev);
	struct ipgre_net *ign = net_generic(net, ipgre_net_id);
	struct ip_tunnel_parm p;
	int mtu;

	if (dev == ign->fb_tunnel_dev)
		return -EINVAL;

	nt = netdev_priv(dev);
	ipgre_netlink_parms(data, &p);

	t = ipgre_tunnel_locate(net, &p, 0);

	if (t) {
		if (t->dev != dev)
			return -EEXIST;
	} else {
		t = nt;

1570
		if (dev->type != ARPHRD_ETHER) {
E
Eric Dumazet 已提交
1571
			unsigned int nflags = 0;
H
Herbert Xu 已提交
1572

1573 1574 1575 1576 1577 1578 1579 1580 1581
			if (ipv4_is_multicast(p.iph.daddr))
				nflags = IFF_BROADCAST;
			else if (p.iph.daddr)
				nflags = IFF_POINTOPOINT;

			if ((dev->flags ^ nflags) &
			    (IFF_POINTOPOINT | IFF_BROADCAST))
				return -EINVAL;
		}
H
Herbert Xu 已提交
1582 1583 1584 1585 1586

		ipgre_tunnel_unlink(ign, t);
		t->parms.iph.saddr = p.iph.saddr;
		t->parms.iph.daddr = p.iph.daddr;
		t->parms.i_key = p.i_key;
1587 1588 1589 1590
		if (dev->type != ARPHRD_ETHER) {
			memcpy(dev->dev_addr, &p.iph.saddr, 4);
			memcpy(dev->broadcast, &p.iph.daddr, 4);
		}
H
Herbert Xu 已提交
1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644
		ipgre_tunnel_link(ign, t);
		netdev_state_change(dev);
	}

	t->parms.o_key = p.o_key;
	t->parms.iph.ttl = p.iph.ttl;
	t->parms.iph.tos = p.iph.tos;
	t->parms.iph.frag_off = p.iph.frag_off;

	if (t->parms.link != p.link) {
		t->parms.link = p.link;
		mtu = ipgre_tunnel_bind_dev(dev);
		if (!tb[IFLA_MTU])
			dev->mtu = mtu;
		netdev_state_change(dev);
	}

	return 0;
}

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) +
		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;

	NLA_PUT_U32(skb, IFLA_GRE_LINK, p->link);
	NLA_PUT_BE16(skb, IFLA_GRE_IFLAGS, p->i_flags);
	NLA_PUT_BE16(skb, IFLA_GRE_OFLAGS, p->o_flags);
P
Patrick McHardy 已提交
1645 1646
	NLA_PUT_BE32(skb, IFLA_GRE_IKEY, p->i_key);
	NLA_PUT_BE32(skb, IFLA_GRE_OKEY, p->o_key);
1647 1648
	NLA_PUT_BE32(skb, IFLA_GRE_LOCAL, p->iph.saddr);
	NLA_PUT_BE32(skb, IFLA_GRE_REMOTE, p->iph.daddr);
H
Herbert Xu 已提交
1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664
	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, !!(p->iph.frag_off & htons(IP_DF)));

	return 0;

nla_put_failure:
	return -EMSGSIZE;
}

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 },
1665 1666
	[IFLA_GRE_LOCAL]	= { .len = FIELD_SIZEOF(struct iphdr, saddr) },
	[IFLA_GRE_REMOTE]	= { .len = FIELD_SIZEOF(struct iphdr, daddr) },
H
Herbert Xu 已提交
1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684
	[IFLA_GRE_TTL]		= { .type = NLA_U8 },
	[IFLA_GRE_TOS]		= { .type = NLA_U8 },
	[IFLA_GRE_PMTUDISC]	= { .type = NLA_U8 },
};

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,
	.get_size	= ipgre_get_size,
	.fill_info	= ipgre_fill_info,
};

1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697
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,
	.get_size	= ipgre_get_size,
	.fill_info	= ipgre_fill_info,
};

L
Linus Torvalds 已提交
1698 1699 1700 1701 1702 1703 1704 1705 1706 1707
/*
 *	And now the modules code and kernel interface.
 */

static int __init ipgre_init(void)
{
	int err;

	printk(KERN_INFO "GRE over IPv4 tunneling driver\n");

1708
	err = register_pernet_device(&ipgre_net_ops);
1709
	if (err < 0)
1710 1711
		return err;

1712
	err = gre_add_protocol(&ipgre_protocol, GREPROTO_CISCO);
1713 1714 1715 1716
	if (err < 0) {
		printk(KERN_INFO "ipgre init: can't add protocol\n");
		goto add_proto_failed;
	}
1717

H
Herbert Xu 已提交
1718 1719 1720 1721
	err = rtnl_link_register(&ipgre_link_ops);
	if (err < 0)
		goto rtnl_link_failed;

1722 1723 1724 1725
	err = rtnl_link_register(&ipgre_tap_ops);
	if (err < 0)
		goto tap_ops_failed;

H
Herbert Xu 已提交
1726
out:
L
Linus Torvalds 已提交
1727
	return err;
H
Herbert Xu 已提交
1728

1729 1730
tap_ops_failed:
	rtnl_link_unregister(&ipgre_link_ops);
H
Herbert Xu 已提交
1731
rtnl_link_failed:
1732
	gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO);
1733 1734
add_proto_failed:
	unregister_pernet_device(&ipgre_net_ops);
H
Herbert Xu 已提交
1735
	goto out;
L
Linus Torvalds 已提交
1736 1737
}

1738
static void __exit ipgre_fini(void)
L
Linus Torvalds 已提交
1739
{
1740
	rtnl_link_unregister(&ipgre_tap_ops);
H
Herbert Xu 已提交
1741
	rtnl_link_unregister(&ipgre_link_ops);
1742
	if (gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO) < 0)
L
Linus Torvalds 已提交
1743
		printk(KERN_INFO "ipgre close: can't remove protocol\n");
1744
	unregister_pernet_device(&ipgre_net_ops);
L
Linus Torvalds 已提交
1745 1746 1747 1748 1749
}

module_init(ipgre_init);
module_exit(ipgre_fini);
MODULE_LICENSE("GPL");
1750 1751
MODULE_ALIAS_RTNL_LINK("gre");
MODULE_ALIAS_RTNL_LINK("gretap");
1752
MODULE_ALIAS_NETDEV("gre0");