Linux Audio

Check our new training course

Embedded Linux training

Mar 10-20, 2025, special US time zones
Register
Loading...
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 *	IPv6 over IPv4 tunnel device - Simple Internet Transition (SIT)
   4 *	Linux INET6 implementation
   5 *
   6 *	Authors:
   7 *	Pedro Roque		<roque@di.fc.ul.pt>
   8 *	Alexey Kuznetsov	<kuznet@ms2.inr.ac.ru>
   9 *
  10 *	Changes:
  11 * Roger Venning <r.venning@telstra.com>:	6to4 support
  12 * Nate Thompson <nate@thebog.net>:		6to4 support
  13 * Fred Templin <fred.l.templin@boeing.com>:	isatap support
  14 */
  15
  16#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  17
  18#include <linux/module.h>
  19#include <linux/capability.h>
  20#include <linux/errno.h>
  21#include <linux/types.h>
  22#include <linux/socket.h>
  23#include <linux/sockios.h>
  24#include <linux/net.h>
  25#include <linux/in6.h>
  26#include <linux/netdevice.h>
  27#include <linux/if_arp.h>
  28#include <linux/icmp.h>
  29#include <linux/slab.h>
  30#include <linux/uaccess.h>
  31#include <linux/init.h>
  32#include <linux/netfilter_ipv4.h>
  33#include <linux/if_ether.h>
  34
  35#include <net/sock.h>
  36#include <net/snmp.h>
  37
  38#include <net/ipv6.h>
  39#include <net/protocol.h>
  40#include <net/transp_v6.h>
  41#include <net/ip6_fib.h>
  42#include <net/ip6_route.h>
  43#include <net/ndisc.h>
  44#include <net/addrconf.h>
  45#include <net/ip.h>
  46#include <net/udp.h>
  47#include <net/icmp.h>
  48#include <net/ip_tunnels.h>
  49#include <net/inet_ecn.h>
  50#include <net/xfrm.h>
  51#include <net/dsfield.h>
  52#include <net/net_namespace.h>
  53#include <net/netns/generic.h>
  54#include <net/inet_dscp.h>
  55
  56/*
  57   This version of net/ipv6/sit.c is cloned of net/ipv4/ip_gre.c
  58
  59   For comments look at net/ipv4/ip_gre.c --ANK
  60 */
  61
  62#define IP6_SIT_HASH_SIZE  16
  63#define HASH(addr) (((__force u32)addr^((__force u32)addr>>4))&0xF)
  64
  65static bool log_ecn_error = true;
  66module_param(log_ecn_error, bool, 0644);
  67MODULE_PARM_DESC(log_ecn_error, "Log packets received with corrupted ECN");
  68
  69static int ipip6_tunnel_init(struct net_device *dev);
  70static void ipip6_tunnel_setup(struct net_device *dev);
  71static void ipip6_dev_free(struct net_device *dev);
  72static bool check_6rd(struct ip_tunnel *tunnel, const struct in6_addr *v6dst,
  73		      __be32 *v4dst);
  74static struct rtnl_link_ops sit_link_ops __read_mostly;
  75
  76static unsigned int sit_net_id __read_mostly;
  77struct sit_net {
  78	struct ip_tunnel __rcu *tunnels_r_l[IP6_SIT_HASH_SIZE];
  79	struct ip_tunnel __rcu *tunnels_r[IP6_SIT_HASH_SIZE];
  80	struct ip_tunnel __rcu *tunnels_l[IP6_SIT_HASH_SIZE];
  81	struct ip_tunnel __rcu *tunnels_wc[1];
  82	struct ip_tunnel __rcu **tunnels[4];
  83
  84	struct net_device *fb_tunnel_dev;
  85};
  86
  87static inline struct sit_net *dev_to_sit_net(struct net_device *dev)
  88{
  89	struct ip_tunnel *t = netdev_priv(dev);
  90
  91	return net_generic(t->net, sit_net_id);
  92}
  93
  94/*
  95 * Must be invoked with rcu_read_lock
  96 */
  97static struct ip_tunnel *ipip6_tunnel_lookup(struct net *net,
  98					     struct net_device *dev,
  99					     __be32 remote, __be32 local,
 100					     int sifindex)
 101{
 102	unsigned int h0 = HASH(remote);
 103	unsigned int h1 = HASH(local);
 104	struct ip_tunnel *t;
 105	struct sit_net *sitn = net_generic(net, sit_net_id);
 106	int ifindex = dev ? dev->ifindex : 0;
 107
 108	for_each_ip_tunnel_rcu(t, sitn->tunnels_r_l[h0 ^ h1]) {
 109		if (local == t->parms.iph.saddr &&
 110		    remote == t->parms.iph.daddr &&
 111		    (!dev || !t->parms.link || ifindex == t->parms.link ||
 112		     sifindex == t->parms.link) &&
 113		    (t->dev->flags & IFF_UP))
 114			return t;
 115	}
 116	for_each_ip_tunnel_rcu(t, sitn->tunnels_r[h0]) {
 117		if (remote == t->parms.iph.daddr &&
 118		    (!dev || !t->parms.link || ifindex == t->parms.link ||
 119		     sifindex == t->parms.link) &&
 120		    (t->dev->flags & IFF_UP))
 121			return t;
 122	}
 123	for_each_ip_tunnel_rcu(t, sitn->tunnels_l[h1]) {
 124		if (local == t->parms.iph.saddr &&
 125		    (!dev || !t->parms.link || ifindex == t->parms.link ||
 126		     sifindex == t->parms.link) &&
 127		    (t->dev->flags & IFF_UP))
 128			return t;
 129	}
 130	t = rcu_dereference(sitn->tunnels_wc[0]);
 131	if (t && (t->dev->flags & IFF_UP))
 132		return t;
 133	return NULL;
 134}
 135
 136static struct ip_tunnel __rcu **
 137__ipip6_bucket(struct sit_net *sitn, struct ip_tunnel_parm_kern *parms)
 138{
 139	__be32 remote = parms->iph.daddr;
 140	__be32 local = parms->iph.saddr;
 141	unsigned int h = 0;
 142	int prio = 0;
 143
 144	if (remote) {
 145		prio |= 2;
 146		h ^= HASH(remote);
 147	}
 148	if (local) {
 149		prio |= 1;
 150		h ^= HASH(local);
 151	}
 152	return &sitn->tunnels[prio][h];
 153}
 154
 155static inline struct ip_tunnel __rcu **ipip6_bucket(struct sit_net *sitn,
 156		struct ip_tunnel *t)
 157{
 158	return __ipip6_bucket(sitn, &t->parms);
 159}
 160
 161static void ipip6_tunnel_unlink(struct sit_net *sitn, struct ip_tunnel *t)
 162{
 163	struct ip_tunnel __rcu **tp;
 164	struct ip_tunnel *iter;
 165
 166	for (tp = ipip6_bucket(sitn, t);
 167	     (iter = rtnl_dereference(*tp)) != NULL;
 168	     tp = &iter->next) {
 169		if (t == iter) {
 170			rcu_assign_pointer(*tp, t->next);
 171			break;
 172		}
 173	}
 174}
 175
 176static void ipip6_tunnel_link(struct sit_net *sitn, struct ip_tunnel *t)
 177{
 178	struct ip_tunnel __rcu **tp = ipip6_bucket(sitn, t);
 179
 180	rcu_assign_pointer(t->next, rtnl_dereference(*tp));
 181	rcu_assign_pointer(*tp, t);
 182}
 183
 184static void ipip6_tunnel_clone_6rd(struct net_device *dev, struct sit_net *sitn)
 185{
 186#ifdef CONFIG_IPV6_SIT_6RD
 187	struct ip_tunnel *t = netdev_priv(dev);
 188
 189	if (dev == sitn->fb_tunnel_dev || !sitn->fb_tunnel_dev) {
 190		ipv6_addr_set(&t->ip6rd.prefix, htonl(0x20020000), 0, 0, 0);
 191		t->ip6rd.relay_prefix = 0;
 192		t->ip6rd.prefixlen = 16;
 193		t->ip6rd.relay_prefixlen = 0;
 194	} else {
 195		struct ip_tunnel *t0 = netdev_priv(sitn->fb_tunnel_dev);
 196		memcpy(&t->ip6rd, &t0->ip6rd, sizeof(t->ip6rd));
 197	}
 198#endif
 199}
 200
 201static int ipip6_tunnel_create(struct net_device *dev)
 202{
 203	struct ip_tunnel *t = netdev_priv(dev);
 204	struct net *net = dev_net(dev);
 205	struct sit_net *sitn = net_generic(net, sit_net_id);
 206	int err;
 207
 208	__dev_addr_set(dev, &t->parms.iph.saddr, 4);
 209	memcpy(dev->broadcast, &t->parms.iph.daddr, 4);
 210
 211	if (test_bit(IP_TUNNEL_SIT_ISATAP_BIT, t->parms.i_flags))
 212		dev->priv_flags |= IFF_ISATAP;
 213
 214	dev->rtnl_link_ops = &sit_link_ops;
 215
 216	err = register_netdevice(dev);
 217	if (err < 0)
 218		goto out;
 219
 220	ipip6_tunnel_clone_6rd(dev, sitn);
 221
 
 
 222	ipip6_tunnel_link(sitn, t);
 223	return 0;
 224
 225out:
 226	return err;
 227}
 228
 229static struct ip_tunnel *ipip6_tunnel_locate(struct net *net,
 230					     struct ip_tunnel_parm_kern *parms,
 231					     int create)
 232{
 233	__be32 remote = parms->iph.daddr;
 234	__be32 local = parms->iph.saddr;
 235	struct ip_tunnel *t, *nt;
 236	struct ip_tunnel __rcu **tp;
 237	struct net_device *dev;
 238	char name[IFNAMSIZ];
 239	struct sit_net *sitn = net_generic(net, sit_net_id);
 240
 241	for (tp = __ipip6_bucket(sitn, parms);
 242	    (t = rtnl_dereference(*tp)) != NULL;
 243	     tp = &t->next) {
 244		if (local == t->parms.iph.saddr &&
 245		    remote == t->parms.iph.daddr &&
 246		    parms->link == t->parms.link) {
 247			if (create)
 248				return NULL;
 249			else
 250				return t;
 251		}
 252	}
 253	if (!create)
 254		goto failed;
 255
 256	if (parms->name[0]) {
 257		if (!dev_valid_name(parms->name))
 258			goto failed;
 259		strscpy(name, parms->name, IFNAMSIZ);
 260	} else {
 261		strcpy(name, "sit%d");
 262	}
 263	dev = alloc_netdev(sizeof(*t), name, NET_NAME_UNKNOWN,
 264			   ipip6_tunnel_setup);
 265	if (!dev)
 266		return NULL;
 267
 268	dev_net_set(dev, net);
 269
 270	nt = netdev_priv(dev);
 271
 272	nt->parms = *parms;
 273	if (ipip6_tunnel_create(dev) < 0)
 274		goto failed_free;
 275
 276	if (!parms->name[0])
 277		strcpy(parms->name, dev->name);
 278
 279	return nt;
 280
 281failed_free:
 282	free_netdev(dev);
 283failed:
 284	return NULL;
 285}
 286
 287#define for_each_prl_rcu(start)			\
 288	for (prl = rcu_dereference(start);	\
 289	     prl;				\
 290	     prl = rcu_dereference(prl->next))
 291
 292static struct ip_tunnel_prl_entry *
 293__ipip6_tunnel_locate_prl(struct ip_tunnel *t, __be32 addr)
 294{
 295	struct ip_tunnel_prl_entry *prl;
 296
 297	for_each_prl_rcu(t->prl)
 298		if (prl->addr == addr)
 299			break;
 300	return prl;
 301
 302}
 303
 304static int ipip6_tunnel_get_prl(struct net_device *dev, struct ip_tunnel_prl __user *a)
 
 305{
 306	struct ip_tunnel *t = netdev_priv(dev);
 307	struct ip_tunnel_prl kprl, *kp;
 308	struct ip_tunnel_prl_entry *prl;
 309	unsigned int cmax, c = 0, ca, len;
 310	int ret = 0;
 311
 312	if (dev == dev_to_sit_net(dev)->fb_tunnel_dev)
 313		return -EINVAL;
 314
 315	if (copy_from_user(&kprl, a, sizeof(kprl)))
 316		return -EFAULT;
 317	cmax = kprl.datalen / sizeof(kprl);
 318	if (cmax > 1 && kprl.addr != htonl(INADDR_ANY))
 319		cmax = 1;
 320
 321	/* For simple GET or for root users,
 322	 * we try harder to allocate.
 323	 */
 324	kp = (cmax <= 1 || capable(CAP_NET_ADMIN)) ?
 325		kcalloc(cmax, sizeof(*kp), GFP_KERNEL_ACCOUNT | __GFP_NOWARN) :
 326		NULL;
 327
 328	ca = min(t->prl_count, cmax);
 
 
 329
 330	if (!kp) {
 331		/* We don't try hard to allocate much memory for
 332		 * non-root users.
 333		 * For root users, retry allocating enough memory for
 334		 * the answer.
 335		 */
 336		kp = kcalloc(ca, sizeof(*kp), GFP_ATOMIC | __GFP_ACCOUNT |
 337					      __GFP_NOWARN);
 338		if (!kp) {
 339			ret = -ENOMEM;
 340			goto out;
 341		}
 342	}
 343
 344	rcu_read_lock();
 345	for_each_prl_rcu(t->prl) {
 346		if (c >= cmax)
 347			break;
 348		if (kprl.addr != htonl(INADDR_ANY) && prl->addr != kprl.addr)
 349			continue;
 350		kp[c].addr = prl->addr;
 351		kp[c].flags = prl->flags;
 352		c++;
 353		if (kprl.addr != htonl(INADDR_ANY))
 354			break;
 355	}
 356
 357	rcu_read_unlock();
 358
 359	len = sizeof(*kp) * c;
 360	ret = 0;
 361	if ((len && copy_to_user(a + 1, kp, len)) || put_user(len, &a->datalen))
 362		ret = -EFAULT;
 363
 364	kfree(kp);
 365out:
 366	return ret;
 367}
 368
 369static int
 370ipip6_tunnel_add_prl(struct ip_tunnel *t, struct ip_tunnel_prl *a, int chg)
 371{
 372	struct ip_tunnel_prl_entry *p;
 373	int err = 0;
 374
 375	if (a->addr == htonl(INADDR_ANY))
 376		return -EINVAL;
 377
 378	ASSERT_RTNL();
 379
 380	for (p = rtnl_dereference(t->prl); p; p = rtnl_dereference(p->next)) {
 381		if (p->addr == a->addr) {
 382			if (chg) {
 383				p->flags = a->flags;
 384				goto out;
 385			}
 386			err = -EEXIST;
 387			goto out;
 388		}
 389	}
 390
 391	if (chg) {
 392		err = -ENXIO;
 393		goto out;
 394	}
 395
 396	p = kzalloc(sizeof(struct ip_tunnel_prl_entry), GFP_KERNEL);
 397	if (!p) {
 398		err = -ENOBUFS;
 399		goto out;
 400	}
 401
 402	p->next = t->prl;
 403	p->addr = a->addr;
 404	p->flags = a->flags;
 405	t->prl_count++;
 406	rcu_assign_pointer(t->prl, p);
 407out:
 408	return err;
 409}
 410
 411static void prl_list_destroy_rcu(struct rcu_head *head)
 412{
 413	struct ip_tunnel_prl_entry *p, *n;
 414
 415	p = container_of(head, struct ip_tunnel_prl_entry, rcu_head);
 416	do {
 417		n = rcu_dereference_protected(p->next, 1);
 418		kfree(p);
 419		p = n;
 420	} while (p);
 421}
 422
 423static int
 424ipip6_tunnel_del_prl(struct ip_tunnel *t, struct ip_tunnel_prl *a)
 425{
 426	struct ip_tunnel_prl_entry *x;
 427	struct ip_tunnel_prl_entry __rcu **p;
 428	int err = 0;
 429
 430	ASSERT_RTNL();
 431
 432	if (a && a->addr != htonl(INADDR_ANY)) {
 433		for (p = &t->prl;
 434		     (x = rtnl_dereference(*p)) != NULL;
 435		     p = &x->next) {
 436			if (x->addr == a->addr) {
 437				*p = x->next;
 438				kfree_rcu(x, rcu_head);
 439				t->prl_count--;
 440				goto out;
 441			}
 442		}
 443		err = -ENXIO;
 444	} else {
 445		x = rtnl_dereference(t->prl);
 446		if (x) {
 447			t->prl_count = 0;
 448			call_rcu(&x->rcu_head, prl_list_destroy_rcu);
 449			t->prl = NULL;
 450		}
 451	}
 452out:
 453	return err;
 454}
 455
 456static int ipip6_tunnel_prl_ctl(struct net_device *dev,
 457				struct ip_tunnel_prl __user *data, int cmd)
 458{
 459	struct ip_tunnel *t = netdev_priv(dev);
 460	struct ip_tunnel_prl prl;
 461	int err;
 462
 463	if (!ns_capable(t->net->user_ns, CAP_NET_ADMIN))
 464		return -EPERM;
 465	if (dev == dev_to_sit_net(dev)->fb_tunnel_dev)
 466		return -EINVAL;
 467
 468	if (copy_from_user(&prl, data, sizeof(prl)))
 469		return -EFAULT;
 470
 471	switch (cmd) {
 472	case SIOCDELPRL:
 473		err = ipip6_tunnel_del_prl(t, &prl);
 474		break;
 475	case SIOCADDPRL:
 476	case SIOCCHGPRL:
 477		err = ipip6_tunnel_add_prl(t, &prl, cmd == SIOCCHGPRL);
 478		break;
 479	}
 480	dst_cache_reset(&t->dst_cache);
 481	netdev_state_change(dev);
 482	return err;
 483}
 484
 485static int
 486isatap_chksrc(struct sk_buff *skb, const struct iphdr *iph, struct ip_tunnel *t)
 487{
 488	struct ip_tunnel_prl_entry *p;
 489	int ok = 1;
 490
 491	rcu_read_lock();
 492	p = __ipip6_tunnel_locate_prl(t, iph->saddr);
 493	if (p) {
 494		if (p->flags & PRL_DEFAULT)
 495			skb->ndisc_nodetype = NDISC_NODETYPE_DEFAULT;
 496		else
 497			skb->ndisc_nodetype = NDISC_NODETYPE_NODEFAULT;
 498	} else {
 499		const struct in6_addr *addr6 = &ipv6_hdr(skb)->saddr;
 500
 501		if (ipv6_addr_is_isatap(addr6) &&
 502		    (addr6->s6_addr32[3] == iph->saddr) &&
 503		    ipv6_chk_prefix(addr6, t->dev))
 504			skb->ndisc_nodetype = NDISC_NODETYPE_HOST;
 505		else
 506			ok = 0;
 507	}
 508	rcu_read_unlock();
 509	return ok;
 510}
 511
 512static void ipip6_tunnel_uninit(struct net_device *dev)
 513{
 514	struct ip_tunnel *tunnel = netdev_priv(dev);
 515	struct sit_net *sitn = net_generic(tunnel->net, sit_net_id);
 516
 517	if (dev == sitn->fb_tunnel_dev) {
 518		RCU_INIT_POINTER(sitn->tunnels_wc[0], NULL);
 519	} else {
 520		ipip6_tunnel_unlink(sitn, tunnel);
 521		ipip6_tunnel_del_prl(tunnel, NULL);
 522	}
 523	dst_cache_reset(&tunnel->dst_cache);
 524	netdev_put(dev, &tunnel->dev_tracker);
 525}
 526
 527static int ipip6_err(struct sk_buff *skb, u32 info)
 528{
 529	const struct iphdr *iph = (const struct iphdr *)skb->data;
 530	const int type = icmp_hdr(skb)->type;
 531	const int code = icmp_hdr(skb)->code;
 532	unsigned int data_len = 0;
 533	struct ip_tunnel *t;
 534	int sifindex;
 535	int err;
 536
 537	switch (type) {
 538	default:
 539	case ICMP_PARAMETERPROB:
 540		return 0;
 541
 542	case ICMP_DEST_UNREACH:
 543		switch (code) {
 544		case ICMP_SR_FAILED:
 545			/* Impossible event. */
 546			return 0;
 547		default:
 548			/* All others are translated to HOST_UNREACH.
 549			   rfc2003 contains "deep thoughts" about NET_UNREACH,
 550			   I believe they are just ether pollution. --ANK
 551			 */
 552			break;
 553		}
 554		break;
 555	case ICMP_TIME_EXCEEDED:
 556		if (code != ICMP_EXC_TTL)
 557			return 0;
 558		data_len = icmp_hdr(skb)->un.reserved[1] * 4; /* RFC 4884 4.1 */
 559		break;
 560	case ICMP_REDIRECT:
 561		break;
 562	}
 563
 564	err = -ENOENT;
 565
 566	sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
 567	t = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
 568				iph->daddr, iph->saddr, sifindex);
 569	if (!t)
 570		goto out;
 571
 572	if (type == ICMP_DEST_UNREACH && code == ICMP_FRAG_NEEDED) {
 573		ipv4_update_pmtu(skb, dev_net(skb->dev), info,
 574				 t->parms.link, iph->protocol);
 575		err = 0;
 576		goto out;
 577	}
 578	if (type == ICMP_REDIRECT) {
 579		ipv4_redirect(skb, dev_net(skb->dev), t->parms.link,
 580			      iph->protocol);
 581		err = 0;
 582		goto out;
 583	}
 584
 585	err = 0;
 586	if (__in6_dev_get(skb->dev) &&
 587	    !ip6_err_gen_icmpv6_unreach(skb, iph->ihl * 4, type, data_len))
 588		goto out;
 589
 590	if (t->parms.iph.daddr == 0)
 591		goto out;
 592
 593	if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED)
 594		goto out;
 595
 596	if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO))
 597		t->err_count++;
 598	else
 599		t->err_count = 1;
 600	t->err_time = jiffies;
 601out:
 602	return err;
 603}
 604
 605static inline bool is_spoofed_6rd(struct ip_tunnel *tunnel, const __be32 v4addr,
 606				  const struct in6_addr *v6addr)
 607{
 608	__be32 v4embed = 0;
 609	if (check_6rd(tunnel, v6addr, &v4embed) && v4addr != v4embed)
 610		return true;
 611	return false;
 612}
 613
 614/* Checks if an address matches an address on the tunnel interface.
 615 * Used to detect the NAT of proto 41 packets and let them pass spoofing test.
 616 * Long story:
 617 * This function is called after we considered the packet as spoofed
 618 * in is_spoofed_6rd.
 619 * We may have a router that is doing NAT for proto 41 packets
 620 * for an internal station. Destination a.a.a.a/PREFIX:bbbb:bbbb
 621 * will be translated to n.n.n.n/PREFIX:bbbb:bbbb. And is_spoofed_6rd
 622 * function will return true, dropping the packet.
 623 * But, we can still check if is spoofed against the IP
 624 * addresses associated with the interface.
 625 */
 626static bool only_dnatted(const struct ip_tunnel *tunnel,
 627	const struct in6_addr *v6dst)
 628{
 629	int prefix_len;
 630
 631#ifdef CONFIG_IPV6_SIT_6RD
 632	prefix_len = tunnel->ip6rd.prefixlen + 32
 633		- tunnel->ip6rd.relay_prefixlen;
 634#else
 635	prefix_len = 48;
 636#endif
 637	return ipv6_chk_custom_prefix(v6dst, prefix_len, tunnel->dev);
 638}
 639
 640/* Returns true if a packet is spoofed */
 641static bool packet_is_spoofed(struct sk_buff *skb,
 642			      const struct iphdr *iph,
 643			      struct ip_tunnel *tunnel)
 644{
 645	const struct ipv6hdr *ipv6h;
 646
 647	if (tunnel->dev->priv_flags & IFF_ISATAP) {
 648		if (!isatap_chksrc(skb, iph, tunnel))
 649			return true;
 650
 651		return false;
 652	}
 653
 654	if (tunnel->dev->flags & IFF_POINTOPOINT)
 655		return false;
 656
 657	ipv6h = ipv6_hdr(skb);
 658
 659	if (unlikely(is_spoofed_6rd(tunnel, iph->saddr, &ipv6h->saddr))) {
 660		net_warn_ratelimited("Src spoofed %pI4/%pI6c -> %pI4/%pI6c\n",
 661				     &iph->saddr, &ipv6h->saddr,
 662				     &iph->daddr, &ipv6h->daddr);
 663		return true;
 664	}
 665
 666	if (likely(!is_spoofed_6rd(tunnel, iph->daddr, &ipv6h->daddr)))
 667		return false;
 668
 669	if (only_dnatted(tunnel, &ipv6h->daddr))
 670		return false;
 671
 672	net_warn_ratelimited("Dst spoofed %pI4/%pI6c -> %pI4/%pI6c\n",
 673			     &iph->saddr, &ipv6h->saddr,
 674			     &iph->daddr, &ipv6h->daddr);
 675	return true;
 676}
 677
 678static int ipip6_rcv(struct sk_buff *skb)
 679{
 680	const struct iphdr *iph = ip_hdr(skb);
 681	struct ip_tunnel *tunnel;
 682	int sifindex;
 683	int err;
 684
 685	sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
 686	tunnel = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
 687				     iph->saddr, iph->daddr, sifindex);
 688	if (tunnel) {
 
 
 689		if (tunnel->parms.iph.protocol != IPPROTO_IPV6 &&
 690		    tunnel->parms.iph.protocol != 0)
 691			goto out;
 692
 693		skb->mac_header = skb->network_header;
 694		skb_reset_network_header(skb);
 695		IPCB(skb)->flags = 0;
 696		skb->dev = tunnel->dev;
 697
 698		if (packet_is_spoofed(skb, iph, tunnel)) {
 699			DEV_STATS_INC(tunnel->dev, rx_errors);
 700			goto out;
 701		}
 702
 703		if (iptunnel_pull_header(skb, 0, htons(ETH_P_IPV6),
 704		    !net_eq(tunnel->net, dev_net(tunnel->dev))))
 705			goto out;
 706
 707		/* skb can be uncloned in iptunnel_pull_header, so
 708		 * old iph is no longer valid
 709		 */
 710		iph = (const struct iphdr *)skb_mac_header(skb);
 711		skb_reset_mac_header(skb);
 712
 713		err = IP_ECN_decapsulate(iph, skb);
 714		if (unlikely(err)) {
 715			if (log_ecn_error)
 716				net_info_ratelimited("non-ECT from %pI4 with TOS=%#x\n",
 717						     &iph->saddr, iph->tos);
 718			if (err > 1) {
 719				DEV_STATS_INC(tunnel->dev, rx_frame_errors);
 720				DEV_STATS_INC(tunnel->dev, rx_errors);
 721				goto out;
 722			}
 723		}
 724
 725		dev_sw_netstats_rx_add(tunnel->dev, skb->len);
 
 
 
 
 726
 727		netif_rx(skb);
 728
 729		return 0;
 730	}
 731
 732	/* no tunnel matched,  let upstream know, ipsec may handle it */
 733	return 1;
 734out:
 735	kfree_skb(skb);
 736	return 0;
 737}
 738
 739static const struct tnl_ptk_info ipip_tpi = {
 740	/* no tunnel info required for ipip. */
 741	.proto = htons(ETH_P_IP),
 742};
 743
 744#if IS_ENABLED(CONFIG_MPLS)
 745static const struct tnl_ptk_info mplsip_tpi = {
 746	/* no tunnel info required for mplsip. */
 747	.proto = htons(ETH_P_MPLS_UC),
 748};
 749#endif
 750
 751static int sit_tunnel_rcv(struct sk_buff *skb, u8 ipproto)
 752{
 753	const struct iphdr *iph;
 754	struct ip_tunnel *tunnel;
 755	int sifindex;
 756
 757	sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
 758
 759	iph = ip_hdr(skb);
 760	tunnel = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
 761				     iph->saddr, iph->daddr, sifindex);
 762	if (tunnel) {
 763		const struct tnl_ptk_info *tpi;
 764
 765		if (tunnel->parms.iph.protocol != ipproto &&
 766		    tunnel->parms.iph.protocol != 0)
 767			goto drop;
 768
 769		if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb))
 770			goto drop;
 771#if IS_ENABLED(CONFIG_MPLS)
 772		if (ipproto == IPPROTO_MPLS)
 773			tpi = &mplsip_tpi;
 774		else
 775#endif
 776			tpi = &ipip_tpi;
 777		if (iptunnel_pull_header(skb, 0, tpi->proto, false))
 778			goto drop;
 779		skb_reset_mac_header(skb);
 780
 781		return ip_tunnel_rcv(tunnel, skb, tpi, NULL, log_ecn_error);
 782	}
 783
 784	return 1;
 785
 786drop:
 787	kfree_skb(skb);
 788	return 0;
 789}
 790
 791static int ipip_rcv(struct sk_buff *skb)
 792{
 793	return sit_tunnel_rcv(skb, IPPROTO_IPIP);
 794}
 795
 796#if IS_ENABLED(CONFIG_MPLS)
 797static int mplsip_rcv(struct sk_buff *skb)
 798{
 799	return sit_tunnel_rcv(skb, IPPROTO_MPLS);
 800}
 801#endif
 802
 803/*
 804 * If the IPv6 address comes from 6rd / 6to4 (RFC 3056) addr space this function
 805 * stores the embedded IPv4 address in v4dst and returns true.
 806 */
 807static bool check_6rd(struct ip_tunnel *tunnel, const struct in6_addr *v6dst,
 808		      __be32 *v4dst)
 809{
 810#ifdef CONFIG_IPV6_SIT_6RD
 811	if (ipv6_prefix_equal(v6dst, &tunnel->ip6rd.prefix,
 812			      tunnel->ip6rd.prefixlen)) {
 813		unsigned int pbw0, pbi0;
 814		int pbi1;
 815		u32 d;
 816
 817		pbw0 = tunnel->ip6rd.prefixlen >> 5;
 818		pbi0 = tunnel->ip6rd.prefixlen & 0x1f;
 819
 820		d = tunnel->ip6rd.relay_prefixlen < 32 ?
 821			(ntohl(v6dst->s6_addr32[pbw0]) << pbi0) >>
 822		    tunnel->ip6rd.relay_prefixlen : 0;
 823
 824		pbi1 = pbi0 - tunnel->ip6rd.relay_prefixlen;
 825		if (pbi1 > 0)
 826			d |= ntohl(v6dst->s6_addr32[pbw0 + 1]) >>
 827			     (32 - pbi1);
 828
 829		*v4dst = tunnel->ip6rd.relay_prefix | htonl(d);
 830		return true;
 831	}
 832#else
 833	if (v6dst->s6_addr16[0] == htons(0x2002)) {
 834		/* 6to4 v6 addr has 16 bits prefix, 32 v4addr, 16 SLA, ... */
 835		memcpy(v4dst, &v6dst->s6_addr16[1], 4);
 836		return true;
 837	}
 838#endif
 839	return false;
 840}
 841
 842static inline __be32 try_6rd(struct ip_tunnel *tunnel,
 843			     const struct in6_addr *v6dst)
 844{
 845	__be32 dst = 0;
 846	check_6rd(tunnel, v6dst, &dst);
 847	return dst;
 848}
 849
 850/*
 851 *	This function assumes it is being called from dev_queue_xmit()
 852 *	and that skb is filled properly by that function.
 853 */
 854
 855static netdev_tx_t ipip6_tunnel_xmit(struct sk_buff *skb,
 856				     struct net_device *dev)
 857{
 858	struct ip_tunnel *tunnel = netdev_priv(dev);
 859	const struct iphdr  *tiph = &tunnel->parms.iph;
 860	const struct ipv6hdr *iph6 = ipv6_hdr(skb);
 861	u8     tos = tunnel->parms.iph.tos;
 862	__be16 df = tiph->frag_off;
 863	struct rtable *rt;		/* Route to the other host */
 864	struct net_device *tdev;	/* Device to other host */
 865	unsigned int max_headroom;	/* The extra header space needed */
 866	__be32 dst = tiph->daddr;
 867	struct flowi4 fl4;
 868	int    mtu;
 869	const struct in6_addr *addr6;
 870	int addr_type;
 871	u8 ttl;
 872	u8 protocol = IPPROTO_IPV6;
 873	int t_hlen = tunnel->hlen + sizeof(struct iphdr);
 874
 875	if (tos == 1)
 876		tos = ipv6_get_dsfield(iph6);
 877
 878	/* ISATAP (RFC4214) - must come before 6to4 */
 879	if (dev->priv_flags & IFF_ISATAP) {
 880		struct neighbour *neigh = NULL;
 881		bool do_tx_error = false;
 882
 883		if (skb_dst(skb))
 884			neigh = dst_neigh_lookup(skb_dst(skb), &iph6->daddr);
 885
 886		if (!neigh) {
 887			net_dbg_ratelimited("nexthop == NULL\n");
 888			goto tx_error;
 889		}
 890
 891		addr6 = (const struct in6_addr *)&neigh->primary_key;
 892		addr_type = ipv6_addr_type(addr6);
 893
 894		if ((addr_type & IPV6_ADDR_UNICAST) &&
 895		     ipv6_addr_is_isatap(addr6))
 896			dst = addr6->s6_addr32[3];
 897		else
 898			do_tx_error = true;
 899
 900		neigh_release(neigh);
 901		if (do_tx_error)
 902			goto tx_error;
 903	}
 904
 905	if (!dst)
 906		dst = try_6rd(tunnel, &iph6->daddr);
 907
 908	if (!dst) {
 909		struct neighbour *neigh = NULL;
 910		bool do_tx_error = false;
 911
 912		if (skb_dst(skb))
 913			neigh = dst_neigh_lookup(skb_dst(skb), &iph6->daddr);
 914
 915		if (!neigh) {
 916			net_dbg_ratelimited("nexthop == NULL\n");
 917			goto tx_error;
 918		}
 919
 920		addr6 = (const struct in6_addr *)&neigh->primary_key;
 921		addr_type = ipv6_addr_type(addr6);
 922
 923		if (addr_type == IPV6_ADDR_ANY) {
 924			addr6 = &ipv6_hdr(skb)->daddr;
 925			addr_type = ipv6_addr_type(addr6);
 926		}
 927
 928		if ((addr_type & IPV6_ADDR_COMPATv4) != 0)
 929			dst = addr6->s6_addr32[3];
 930		else
 931			do_tx_error = true;
 932
 933		neigh_release(neigh);
 934		if (do_tx_error)
 935			goto tx_error;
 936	}
 937
 938	flowi4_init_output(&fl4, tunnel->parms.link, tunnel->fwmark,
 939			   tos & INET_DSCP_MASK, RT_SCOPE_UNIVERSE,
 940			   IPPROTO_IPV6, 0, dst, tiph->saddr, 0, 0,
 941			   sock_net_uid(tunnel->net, NULL));
 942
 943	rt = dst_cache_get_ip4(&tunnel->dst_cache, &fl4.saddr);
 944	if (!rt) {
 945		rt = ip_route_output_flow(tunnel->net, &fl4, NULL);
 946		if (IS_ERR(rt)) {
 947			DEV_STATS_INC(dev, tx_carrier_errors);
 948			goto tx_error_icmp;
 949		}
 950		dst_cache_set_ip4(&tunnel->dst_cache, &rt->dst, fl4.saddr);
 951	}
 952
 953	if (rt->rt_type != RTN_UNICAST && rt->rt_type != RTN_LOCAL) {
 954		ip_rt_put(rt);
 955		DEV_STATS_INC(dev, tx_carrier_errors);
 956		goto tx_error_icmp;
 957	}
 958	tdev = rt->dst.dev;
 959
 960	if (tdev == dev) {
 961		ip_rt_put(rt);
 962		DEV_STATS_INC(dev, collisions);
 963		goto tx_error;
 964	}
 965
 966	if (iptunnel_handle_offloads(skb, SKB_GSO_IPXIP4)) {
 967		ip_rt_put(rt);
 968		goto tx_error;
 969	}
 970
 971	if (df) {
 972		mtu = dst_mtu(&rt->dst) - t_hlen;
 973
 974		if (mtu < IPV4_MIN_MTU) {
 975			DEV_STATS_INC(dev, collisions);
 976			ip_rt_put(rt);
 977			goto tx_error;
 978		}
 979
 980		if (mtu < IPV6_MIN_MTU) {
 981			mtu = IPV6_MIN_MTU;
 982			df = 0;
 983		}
 984
 985		if (tunnel->parms.iph.daddr)
 986			skb_dst_update_pmtu_no_confirm(skb, mtu);
 987
 988		if (skb->len > mtu && !skb_is_gso(skb)) {
 989			icmpv6_ndo_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
 990			ip_rt_put(rt);
 991			goto tx_error;
 992		}
 993	}
 994
 995	if (tunnel->err_count > 0) {
 996		if (time_before(jiffies,
 997				tunnel->err_time + IPTUNNEL_ERR_TIMEO)) {
 998			tunnel->err_count--;
 999			dst_link_failure(skb);
1000		} else
1001			tunnel->err_count = 0;
1002	}
1003
1004	/*
1005	 * Okay, now see if we can stuff it in the buffer as-is.
1006	 */
1007	max_headroom = LL_RESERVED_SPACE(tdev) + t_hlen;
1008
1009	if (skb_headroom(skb) < max_headroom || skb_shared(skb) ||
1010	    (skb_cloned(skb) && !skb_clone_writable(skb, 0))) {
1011		struct sk_buff *new_skb = skb_realloc_headroom(skb, max_headroom);
1012		if (!new_skb) {
1013			ip_rt_put(rt);
1014			DEV_STATS_INC(dev, tx_dropped);
1015			kfree_skb(skb);
1016			return NETDEV_TX_OK;
1017		}
1018		if (skb->sk)
1019			skb_set_owner_w(new_skb, skb->sk);
1020		dev_kfree_skb(skb);
1021		skb = new_skb;
1022		iph6 = ipv6_hdr(skb);
1023	}
1024	ttl = tiph->ttl;
1025	if (ttl == 0)
1026		ttl = iph6->hop_limit;
1027	tos = INET_ECN_encapsulate(tos, ipv6_get_dsfield(iph6));
1028
1029	if (ip_tunnel_encap(skb, &tunnel->encap, &protocol, &fl4) < 0) {
1030		ip_rt_put(rt);
1031		goto tx_error;
1032	}
1033
1034	skb_set_inner_ipproto(skb, IPPROTO_IPV6);
1035
1036	iptunnel_xmit(NULL, rt, skb, fl4.saddr, fl4.daddr, protocol, tos, ttl,
1037		      df, !net_eq(tunnel->net, dev_net(dev)));
1038	return NETDEV_TX_OK;
1039
1040tx_error_icmp:
1041	dst_link_failure(skb);
1042tx_error:
1043	kfree_skb(skb);
1044	DEV_STATS_INC(dev, tx_errors);
1045	return NETDEV_TX_OK;
1046}
1047
1048static netdev_tx_t sit_tunnel_xmit__(struct sk_buff *skb,
1049				     struct net_device *dev, u8 ipproto)
1050{
1051	struct ip_tunnel *tunnel = netdev_priv(dev);
1052	const struct iphdr  *tiph = &tunnel->parms.iph;
1053
1054	if (iptunnel_handle_offloads(skb, SKB_GSO_IPXIP4))
1055		goto tx_error;
1056
1057	skb_set_inner_ipproto(skb, ipproto);
1058
1059	ip_tunnel_xmit(skb, dev, tiph, ipproto);
1060	return NETDEV_TX_OK;
1061tx_error:
1062	kfree_skb(skb);
1063	DEV_STATS_INC(dev, tx_errors);
1064	return NETDEV_TX_OK;
1065}
1066
1067static netdev_tx_t sit_tunnel_xmit(struct sk_buff *skb,
1068				   struct net_device *dev)
1069{
1070	if (!pskb_inet_may_pull(skb))
1071		goto tx_err;
1072
1073	switch (skb->protocol) {
1074	case htons(ETH_P_IP):
1075		sit_tunnel_xmit__(skb, dev, IPPROTO_IPIP);
1076		break;
1077	case htons(ETH_P_IPV6):
1078		ipip6_tunnel_xmit(skb, dev);
1079		break;
1080#if IS_ENABLED(CONFIG_MPLS)
1081	case htons(ETH_P_MPLS_UC):
1082		sit_tunnel_xmit__(skb, dev, IPPROTO_MPLS);
1083		break;
1084#endif
1085	default:
1086		goto tx_err;
1087	}
1088
1089	return NETDEV_TX_OK;
1090
1091tx_err:
1092	DEV_STATS_INC(dev, tx_errors);
1093	kfree_skb(skb);
1094	return NETDEV_TX_OK;
1095
1096}
1097
1098static void ipip6_tunnel_bind_dev(struct net_device *dev)
1099{
1100	struct ip_tunnel *tunnel = netdev_priv(dev);
1101	int t_hlen = tunnel->hlen + sizeof(struct iphdr);
1102	struct net_device *tdev = NULL;
1103	int hlen = LL_MAX_HEADER;
1104	const struct iphdr *iph;
1105	struct flowi4 fl4;
1106
 
1107	iph = &tunnel->parms.iph;
1108
1109	if (iph->daddr) {
1110		struct rtable *rt = ip_route_output_ports(tunnel->net, &fl4,
1111							  NULL,
1112							  iph->daddr, iph->saddr,
1113							  0, 0,
1114							  IPPROTO_IPV6,
1115							  iph->tos & INET_DSCP_MASK,
1116							  tunnel->parms.link);
1117
1118		if (!IS_ERR(rt)) {
1119			tdev = rt->dst.dev;
1120			ip_rt_put(rt);
1121		}
1122		dev->flags |= IFF_POINTOPOINT;
1123	}
1124
1125	if (!tdev && tunnel->parms.link)
1126		tdev = __dev_get_by_index(tunnel->net, tunnel->parms.link);
1127
1128	if (tdev && !netif_is_l3_master(tdev)) {
1129		int mtu;
1130
1131		mtu = tdev->mtu - t_hlen;
1132		if (mtu < IPV6_MIN_MTU)
1133			mtu = IPV6_MIN_MTU;
1134		WRITE_ONCE(dev->mtu, mtu);
1135		hlen = tdev->hard_header_len + tdev->needed_headroom;
1136	}
1137	dev->needed_headroom = t_hlen + hlen;
1138}
1139
1140static void ipip6_tunnel_update(struct ip_tunnel *t,
1141				struct ip_tunnel_parm_kern *p,
1142				__u32 fwmark)
1143{
1144	struct net *net = t->net;
1145	struct sit_net *sitn = net_generic(net, sit_net_id);
1146
1147	ipip6_tunnel_unlink(sitn, t);
1148	synchronize_net();
1149	t->parms.iph.saddr = p->iph.saddr;
1150	t->parms.iph.daddr = p->iph.daddr;
1151	__dev_addr_set(t->dev, &p->iph.saddr, 4);
1152	memcpy(t->dev->broadcast, &p->iph.daddr, 4);
1153	ipip6_tunnel_link(sitn, t);
1154	t->parms.iph.ttl = p->iph.ttl;
1155	t->parms.iph.tos = p->iph.tos;
1156	t->parms.iph.frag_off = p->iph.frag_off;
1157	if (t->parms.link != p->link || t->fwmark != fwmark) {
1158		t->parms.link = p->link;
1159		t->fwmark = fwmark;
1160		ipip6_tunnel_bind_dev(t->dev);
1161	}
1162	dst_cache_reset(&t->dst_cache);
1163	netdev_state_change(t->dev);
1164}
1165
1166#ifdef CONFIG_IPV6_SIT_6RD
1167static int ipip6_tunnel_update_6rd(struct ip_tunnel *t,
1168				   struct ip_tunnel_6rd *ip6rd)
1169{
1170	struct in6_addr prefix;
1171	__be32 relay_prefix;
1172
1173	if (ip6rd->relay_prefixlen > 32 ||
1174	    ip6rd->prefixlen + (32 - ip6rd->relay_prefixlen) > 64)
1175		return -EINVAL;
1176
1177	ipv6_addr_prefix(&prefix, &ip6rd->prefix, ip6rd->prefixlen);
1178	if (!ipv6_addr_equal(&prefix, &ip6rd->prefix))
1179		return -EINVAL;
1180	if (ip6rd->relay_prefixlen)
1181		relay_prefix = ip6rd->relay_prefix &
1182			       htonl(0xffffffffUL <<
1183				     (32 - ip6rd->relay_prefixlen));
1184	else
1185		relay_prefix = 0;
1186	if (relay_prefix != ip6rd->relay_prefix)
1187		return -EINVAL;
1188
1189	t->ip6rd.prefix = prefix;
1190	t->ip6rd.relay_prefix = relay_prefix;
1191	t->ip6rd.prefixlen = ip6rd->prefixlen;
1192	t->ip6rd.relay_prefixlen = ip6rd->relay_prefixlen;
1193	dst_cache_reset(&t->dst_cache);
1194	netdev_state_change(t->dev);
1195	return 0;
1196}
1197
1198static int
1199ipip6_tunnel_get6rd(struct net_device *dev, struct ip_tunnel_parm __user *data)
1200{
1201	struct ip_tunnel *t = netdev_priv(dev);
1202	struct ip_tunnel_parm_kern p;
1203	struct ip_tunnel_6rd ip6rd;
1204
1205	if (dev == dev_to_sit_net(dev)->fb_tunnel_dev) {
1206		if (!ip_tunnel_parm_from_user(&p, data))
1207			return -EFAULT;
1208		t = ipip6_tunnel_locate(t->net, &p, 0);
1209	}
1210	if (!t)
1211		t = netdev_priv(dev);
1212
1213	ip6rd.prefix = t->ip6rd.prefix;
1214	ip6rd.relay_prefix = t->ip6rd.relay_prefix;
1215	ip6rd.prefixlen = t->ip6rd.prefixlen;
1216	ip6rd.relay_prefixlen = t->ip6rd.relay_prefixlen;
1217	if (copy_to_user(data, &ip6rd, sizeof(ip6rd)))
1218		return -EFAULT;
1219	return 0;
1220}
1221
1222static int
1223ipip6_tunnel_6rdctl(struct net_device *dev, struct ip_tunnel_6rd __user *data,
1224		    int cmd)
1225{
1226	struct ip_tunnel *t = netdev_priv(dev);
1227	struct ip_tunnel_6rd ip6rd;
1228	int err;
1229
1230	if (!ns_capable(t->net->user_ns, CAP_NET_ADMIN))
1231		return -EPERM;
1232	if (copy_from_user(&ip6rd, data, sizeof(ip6rd)))
1233		return -EFAULT;
1234
1235	if (cmd != SIOCDEL6RD) {
1236		err = ipip6_tunnel_update_6rd(t, &ip6rd);
1237		if (err < 0)
1238			return err;
1239	} else
1240		ipip6_tunnel_clone_6rd(dev, dev_to_sit_net(dev));
1241	return 0;
1242}
1243
1244#endif /* CONFIG_IPV6_SIT_6RD */
1245
1246static bool ipip6_valid_ip_proto(u8 ipproto)
1247{
1248	return ipproto == IPPROTO_IPV6 ||
1249		ipproto == IPPROTO_IPIP ||
1250#if IS_ENABLED(CONFIG_MPLS)
1251		ipproto == IPPROTO_MPLS ||
1252#endif
1253		ipproto == 0;
1254}
1255
1256static int
1257__ipip6_tunnel_ioctl_validate(struct net *net, struct ip_tunnel_parm_kern *p)
1258{
1259	if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
1260		return -EPERM;
1261
1262	if (!ipip6_valid_ip_proto(p->iph.protocol))
1263		return -EINVAL;
1264	if (p->iph.version != 4 ||
1265	    p->iph.ihl != 5 || (p->iph.frag_off & htons(~IP_DF)))
1266		return -EINVAL;
1267
1268	if (p->iph.ttl)
1269		p->iph.frag_off |= htons(IP_DF);
1270	return 0;
1271}
1272
1273static int
1274ipip6_tunnel_get(struct net_device *dev, struct ip_tunnel_parm_kern *p)
1275{
1276	struct ip_tunnel *t = netdev_priv(dev);
1277
1278	if (dev == dev_to_sit_net(dev)->fb_tunnel_dev)
1279		t = ipip6_tunnel_locate(t->net, p, 0);
1280	if (!t)
1281		t = netdev_priv(dev);
1282	memcpy(p, &t->parms, sizeof(*p));
1283	return 0;
1284}
1285
1286static int
1287ipip6_tunnel_add(struct net_device *dev, struct ip_tunnel_parm_kern *p)
1288{
1289	struct ip_tunnel *t = netdev_priv(dev);
1290	int err;
1291
1292	err = __ipip6_tunnel_ioctl_validate(t->net, p);
1293	if (err)
1294		return err;
1295
1296	t = ipip6_tunnel_locate(t->net, p, 1);
1297	if (!t)
1298		return -ENOBUFS;
1299	return 0;
1300}
1301
1302static int
1303ipip6_tunnel_change(struct net_device *dev, struct ip_tunnel_parm_kern *p)
1304{
 
 
 
1305	struct ip_tunnel *t = netdev_priv(dev);
1306	int err;
 
 
 
 
1307
1308	err = __ipip6_tunnel_ioctl_validate(t->net, p);
1309	if (err)
1310		return err;
 
 
 
 
 
 
 
 
 
 
 
1311
1312	t = ipip6_tunnel_locate(t->net, p, 0);
1313	if (dev == dev_to_sit_net(dev)->fb_tunnel_dev) {
1314		if (!t)
1315			return -ENOENT;
1316	} else {
1317		if (t) {
1318			if (t->dev != dev)
1319				return -EEXIST;
1320		} else {
1321			if (((dev->flags & IFF_POINTOPOINT) && !p->iph.daddr) ||
1322			    (!(dev->flags & IFF_POINTOPOINT) && p->iph.daddr))
1323				return -EINVAL;
1324			t = netdev_priv(dev);
 
 
 
 
1325		}
 
 
1326
1327		ipip6_tunnel_update(t, p, t->fwmark);
1328	}
1329
1330	return 0;
1331}
1332
1333static int
1334ipip6_tunnel_del(struct net_device *dev, struct ip_tunnel_parm_kern *p)
1335{
1336	struct ip_tunnel *t = netdev_priv(dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1337
1338	if (!ns_capable(t->net->user_ns, CAP_NET_ADMIN))
1339		return -EPERM;
1340
1341	if (dev == dev_to_sit_net(dev)->fb_tunnel_dev) {
1342		t = ipip6_tunnel_locate(t->net, p, 0);
1343		if (!t)
1344			return -ENOENT;
1345		if (t == netdev_priv(dev_to_sit_net(dev)->fb_tunnel_dev))
1346			return -EPERM;
1347		dev = t->dev;
1348	}
1349	unregister_netdevice(dev);
1350	return 0;
1351}
1352
1353static int
1354ipip6_tunnel_ctl(struct net_device *dev, struct ip_tunnel_parm_kern *p,
1355		 int cmd)
1356{
1357	switch (cmd) {
1358	case SIOCGETTUNNEL:
1359		return ipip6_tunnel_get(dev, p);
1360	case SIOCADDTUNNEL:
1361		return ipip6_tunnel_add(dev, p);
1362	case SIOCCHGTUNNEL:
1363		return ipip6_tunnel_change(dev, p);
1364	case SIOCDELTUNNEL:
1365		return ipip6_tunnel_del(dev, p);
1366	default:
1367		return -EINVAL;
1368	}
1369}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1370
1371static int
1372ipip6_tunnel_siocdevprivate(struct net_device *dev, struct ifreq *ifr,
1373			    void __user *data, int cmd)
1374{
1375	switch (cmd) {
1376	case SIOCGETTUNNEL:
1377	case SIOCADDTUNNEL:
1378	case SIOCCHGTUNNEL:
1379	case SIOCDELTUNNEL:
1380		return ip_tunnel_siocdevprivate(dev, ifr, data, cmd);
1381	case SIOCGETPRL:
1382		return ipip6_tunnel_get_prl(dev, data);
 
 
 
 
 
1383	case SIOCADDPRL:
1384	case SIOCDELPRL:
1385	case SIOCCHGPRL:
1386		return ipip6_tunnel_prl_ctl(dev, data, cmd);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1387#ifdef CONFIG_IPV6_SIT_6RD
1388	case SIOCGET6RD:
1389		return ipip6_tunnel_get6rd(dev, data);
1390	case SIOCADD6RD:
1391	case SIOCCHG6RD:
1392	case SIOCDEL6RD:
1393		return ipip6_tunnel_6rdctl(dev, data, cmd);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1394#endif
 
1395	default:
1396		return -EINVAL;
1397	}
 
 
 
1398}
1399
1400static const struct net_device_ops ipip6_netdev_ops = {
1401	.ndo_init	= ipip6_tunnel_init,
1402	.ndo_uninit	= ipip6_tunnel_uninit,
1403	.ndo_start_xmit	= sit_tunnel_xmit,
1404	.ndo_siocdevprivate = ipip6_tunnel_siocdevprivate,
 
1405	.ndo_get_iflink = ip_tunnel_get_iflink,
1406	.ndo_tunnel_ctl = ipip6_tunnel_ctl,
1407};
1408
1409static void ipip6_dev_free(struct net_device *dev)
1410{
1411	struct ip_tunnel *tunnel = netdev_priv(dev);
1412
1413	dst_cache_destroy(&tunnel->dst_cache);
 
1414}
1415
1416#define SIT_FEATURES (NETIF_F_SG	   | \
1417		      NETIF_F_FRAGLIST	   | \
1418		      NETIF_F_HIGHDMA	   | \
1419		      NETIF_F_GSO_SOFTWARE | \
1420		      NETIF_F_HW_CSUM)
1421
1422static void ipip6_tunnel_setup(struct net_device *dev)
1423{
1424	struct ip_tunnel *tunnel = netdev_priv(dev);
1425	int t_hlen = tunnel->hlen + sizeof(struct iphdr);
1426
1427	dev->netdev_ops		= &ipip6_netdev_ops;
1428	dev->header_ops		= &ip_tunnel_header_ops;
1429	dev->needs_free_netdev	= true;
1430	dev->priv_destructor	= ipip6_dev_free;
1431
1432	dev->type		= ARPHRD_SIT;
 
1433	dev->mtu		= ETH_DATA_LEN - t_hlen;
1434	dev->min_mtu		= IPV6_MIN_MTU;
1435	dev->max_mtu		= IP6_MAX_MTU - t_hlen;
1436	dev->flags		= IFF_NOARP;
1437	netif_keep_dst(dev);
1438	dev->addr_len		= 4;
1439	dev->lltx		= true;
1440	dev->features		|= SIT_FEATURES;
1441	dev->hw_features	|= SIT_FEATURES;
1442	dev->pcpu_stat_type	= NETDEV_PCPU_STAT_TSTATS;
1443
1444}
1445
1446static int ipip6_tunnel_init(struct net_device *dev)
1447{
1448	struct ip_tunnel *tunnel = netdev_priv(dev);
1449	int err;
1450
1451	tunnel->dev = dev;
1452	tunnel->net = dev_net(dev);
1453	strcpy(tunnel->parms.name, dev->name);
1454
1455	ipip6_tunnel_bind_dev(dev);
 
 
 
1456
1457	err = dst_cache_init(&tunnel->dst_cache, GFP_KERNEL);
1458	if (err)
 
 
1459		return err;
 
1460
1461	netdev_hold(dev, &tunnel->dev_tracker, GFP_KERNEL);
1462	netdev_lockdep_set_classes(dev);
1463	return 0;
1464}
1465
1466static void __net_init ipip6_fb_tunnel_init(struct net_device *dev)
1467{
1468	struct ip_tunnel *tunnel = netdev_priv(dev);
1469	struct iphdr *iph = &tunnel->parms.iph;
1470	struct net *net = dev_net(dev);
1471	struct sit_net *sitn = net_generic(net, sit_net_id);
1472
1473	iph->version		= 4;
1474	iph->protocol		= IPPROTO_IPV6;
1475	iph->ihl		= 5;
1476	iph->ttl		= 64;
1477
 
1478	rcu_assign_pointer(sitn->tunnels_wc[0], tunnel);
1479}
1480
1481static int ipip6_validate(struct nlattr *tb[], struct nlattr *data[],
1482			  struct netlink_ext_ack *extack)
1483{
1484	u8 proto;
1485
1486	if (!data || !data[IFLA_IPTUN_PROTO])
1487		return 0;
1488
1489	proto = nla_get_u8(data[IFLA_IPTUN_PROTO]);
1490	if (!ipip6_valid_ip_proto(proto))
1491		return -EINVAL;
1492
1493	return 0;
1494}
1495
1496static void ipip6_netlink_parms(struct nlattr *data[],
1497				struct ip_tunnel_parm_kern *parms,
1498				__u32 *fwmark)
1499{
1500	memset(parms, 0, sizeof(*parms));
1501
1502	parms->iph.version = 4;
1503	parms->iph.protocol = IPPROTO_IPV6;
1504	parms->iph.ihl = 5;
1505	parms->iph.ttl = 64;
1506
1507	if (!data)
1508		return;
1509
1510	ip_tunnel_netlink_parms(data, parms);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1511
1512	if (data[IFLA_IPTUN_FWMARK])
1513		*fwmark = nla_get_u32(data[IFLA_IPTUN_FWMARK]);
1514}
1515
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1516#ifdef CONFIG_IPV6_SIT_6RD
1517/* This function returns true when 6RD attributes are present in the nl msg */
1518static bool ipip6_netlink_6rd_parms(struct nlattr *data[],
1519				    struct ip_tunnel_6rd *ip6rd)
1520{
1521	bool ret = false;
1522	memset(ip6rd, 0, sizeof(*ip6rd));
1523
1524	if (!data)
1525		return ret;
1526
1527	if (data[IFLA_IPTUN_6RD_PREFIX]) {
1528		ret = true;
1529		ip6rd->prefix = nla_get_in6_addr(data[IFLA_IPTUN_6RD_PREFIX]);
1530	}
1531
1532	if (data[IFLA_IPTUN_6RD_RELAY_PREFIX]) {
1533		ret = true;
1534		ip6rd->relay_prefix =
1535			nla_get_be32(data[IFLA_IPTUN_6RD_RELAY_PREFIX]);
1536	}
1537
1538	if (data[IFLA_IPTUN_6RD_PREFIXLEN]) {
1539		ret = true;
1540		ip6rd->prefixlen = nla_get_u16(data[IFLA_IPTUN_6RD_PREFIXLEN]);
1541	}
1542
1543	if (data[IFLA_IPTUN_6RD_RELAY_PREFIXLEN]) {
1544		ret = true;
1545		ip6rd->relay_prefixlen =
1546			nla_get_u16(data[IFLA_IPTUN_6RD_RELAY_PREFIXLEN]);
1547	}
1548
1549	return ret;
1550}
1551#endif
1552
1553static int ipip6_newlink(struct net *src_net, struct net_device *dev,
1554			 struct nlattr *tb[], struct nlattr *data[],
1555			 struct netlink_ext_ack *extack)
1556{
1557	struct net *net = dev_net(dev);
1558	struct ip_tunnel *nt;
1559	struct ip_tunnel_encap ipencap;
1560#ifdef CONFIG_IPV6_SIT_6RD
1561	struct ip_tunnel_6rd ip6rd;
1562#endif
1563	int err;
1564
1565	nt = netdev_priv(dev);
1566
1567	if (ip_tunnel_netlink_encap_parms(data, &ipencap)) {
1568		err = ip_tunnel_encap_setup(nt, &ipencap);
1569		if (err < 0)
1570			return err;
1571	}
1572
1573	ipip6_netlink_parms(data, &nt->parms, &nt->fwmark);
1574
1575	if (ipip6_tunnel_locate(net, &nt->parms, 0))
1576		return -EEXIST;
1577
1578	err = ipip6_tunnel_create(dev);
1579	if (err < 0)
1580		return err;
1581
1582	if (tb[IFLA_MTU]) {
1583		u32 mtu = nla_get_u32(tb[IFLA_MTU]);
1584
1585		if (mtu >= IPV6_MIN_MTU &&
1586		    mtu <= IP6_MAX_MTU - dev->hard_header_len)
1587			dev->mtu = mtu;
1588	}
1589
1590#ifdef CONFIG_IPV6_SIT_6RD
1591	if (ipip6_netlink_6rd_parms(data, &ip6rd)) {
1592		err = ipip6_tunnel_update_6rd(nt, &ip6rd);
1593		if (err < 0)
1594			unregister_netdevice_queue(dev, NULL);
1595	}
1596#endif
1597
1598	return err;
1599}
1600
1601static int ipip6_changelink(struct net_device *dev, struct nlattr *tb[],
1602			    struct nlattr *data[],
1603			    struct netlink_ext_ack *extack)
1604{
1605	struct ip_tunnel *t = netdev_priv(dev);
 
1606	struct ip_tunnel_encap ipencap;
1607	struct ip_tunnel_parm_kern p;
1608	struct net *net = t->net;
1609	struct sit_net *sitn = net_generic(net, sit_net_id);
1610#ifdef CONFIG_IPV6_SIT_6RD
1611	struct ip_tunnel_6rd ip6rd;
1612#endif
1613	__u32 fwmark = t->fwmark;
1614	int err;
1615
1616	if (dev == sitn->fb_tunnel_dev)
1617		return -EINVAL;
1618
1619	if (ip_tunnel_netlink_encap_parms(data, &ipencap)) {
1620		err = ip_tunnel_encap_setup(t, &ipencap);
1621		if (err < 0)
1622			return err;
1623	}
1624
1625	ipip6_netlink_parms(data, &p, &fwmark);
1626
1627	if (((dev->flags & IFF_POINTOPOINT) && !p.iph.daddr) ||
1628	    (!(dev->flags & IFF_POINTOPOINT) && p.iph.daddr))
1629		return -EINVAL;
1630
1631	t = ipip6_tunnel_locate(net, &p, 0);
1632
1633	if (t) {
1634		if (t->dev != dev)
1635			return -EEXIST;
1636	} else
1637		t = netdev_priv(dev);
1638
1639	ipip6_tunnel_update(t, &p, fwmark);
1640
1641#ifdef CONFIG_IPV6_SIT_6RD
1642	if (ipip6_netlink_6rd_parms(data, &ip6rd))
1643		return ipip6_tunnel_update_6rd(t, &ip6rd);
1644#endif
1645
1646	return 0;
1647}
1648
1649static size_t ipip6_get_size(const struct net_device *dev)
1650{
1651	return
1652		/* IFLA_IPTUN_LINK */
1653		nla_total_size(4) +
1654		/* IFLA_IPTUN_LOCAL */
1655		nla_total_size(4) +
1656		/* IFLA_IPTUN_REMOTE */
1657		nla_total_size(4) +
1658		/* IFLA_IPTUN_TTL */
1659		nla_total_size(1) +
1660		/* IFLA_IPTUN_TOS */
1661		nla_total_size(1) +
1662		/* IFLA_IPTUN_PMTUDISC */
1663		nla_total_size(1) +
1664		/* IFLA_IPTUN_FLAGS */
1665		nla_total_size(2) +
1666		/* IFLA_IPTUN_PROTO */
1667		nla_total_size(1) +
1668#ifdef CONFIG_IPV6_SIT_6RD
1669		/* IFLA_IPTUN_6RD_PREFIX */
1670		nla_total_size(sizeof(struct in6_addr)) +
1671		/* IFLA_IPTUN_6RD_RELAY_PREFIX */
1672		nla_total_size(4) +
1673		/* IFLA_IPTUN_6RD_PREFIXLEN */
1674		nla_total_size(2) +
1675		/* IFLA_IPTUN_6RD_RELAY_PREFIXLEN */
1676		nla_total_size(2) +
1677#endif
1678		/* IFLA_IPTUN_ENCAP_TYPE */
1679		nla_total_size(2) +
1680		/* IFLA_IPTUN_ENCAP_FLAGS */
1681		nla_total_size(2) +
1682		/* IFLA_IPTUN_ENCAP_SPORT */
1683		nla_total_size(2) +
1684		/* IFLA_IPTUN_ENCAP_DPORT */
1685		nla_total_size(2) +
1686		/* IFLA_IPTUN_FWMARK */
1687		nla_total_size(4) +
1688		0;
1689}
1690
1691static int ipip6_fill_info(struct sk_buff *skb, const struct net_device *dev)
1692{
1693	struct ip_tunnel *tunnel = netdev_priv(dev);
1694	struct ip_tunnel_parm_kern *parm = &tunnel->parms;
1695
1696	if (nla_put_u32(skb, IFLA_IPTUN_LINK, parm->link) ||
1697	    nla_put_in_addr(skb, IFLA_IPTUN_LOCAL, parm->iph.saddr) ||
1698	    nla_put_in_addr(skb, IFLA_IPTUN_REMOTE, parm->iph.daddr) ||
1699	    nla_put_u8(skb, IFLA_IPTUN_TTL, parm->iph.ttl) ||
1700	    nla_put_u8(skb, IFLA_IPTUN_TOS, parm->iph.tos) ||
1701	    nla_put_u8(skb, IFLA_IPTUN_PMTUDISC,
1702		       !!(parm->iph.frag_off & htons(IP_DF))) ||
1703	    nla_put_u8(skb, IFLA_IPTUN_PROTO, parm->iph.protocol) ||
1704	    nla_put_be16(skb, IFLA_IPTUN_FLAGS,
1705			 ip_tunnel_flags_to_be16(parm->i_flags)) ||
1706	    nla_put_u32(skb, IFLA_IPTUN_FWMARK, tunnel->fwmark))
1707		goto nla_put_failure;
1708
1709#ifdef CONFIG_IPV6_SIT_6RD
1710	if (nla_put_in6_addr(skb, IFLA_IPTUN_6RD_PREFIX,
1711			     &tunnel->ip6rd.prefix) ||
1712	    nla_put_in_addr(skb, IFLA_IPTUN_6RD_RELAY_PREFIX,
1713			    tunnel->ip6rd.relay_prefix) ||
1714	    nla_put_u16(skb, IFLA_IPTUN_6RD_PREFIXLEN,
1715			tunnel->ip6rd.prefixlen) ||
1716	    nla_put_u16(skb, IFLA_IPTUN_6RD_RELAY_PREFIXLEN,
1717			tunnel->ip6rd.relay_prefixlen))
1718		goto nla_put_failure;
1719#endif
1720
1721	if (nla_put_u16(skb, IFLA_IPTUN_ENCAP_TYPE,
1722			tunnel->encap.type) ||
1723	    nla_put_be16(skb, IFLA_IPTUN_ENCAP_SPORT,
1724			tunnel->encap.sport) ||
1725	    nla_put_be16(skb, IFLA_IPTUN_ENCAP_DPORT,
1726			tunnel->encap.dport) ||
1727	    nla_put_u16(skb, IFLA_IPTUN_ENCAP_FLAGS,
1728			tunnel->encap.flags))
1729		goto nla_put_failure;
1730
1731	return 0;
1732
1733nla_put_failure:
1734	return -EMSGSIZE;
1735}
1736
1737static const struct nla_policy ipip6_policy[IFLA_IPTUN_MAX + 1] = {
1738	[IFLA_IPTUN_LINK]		= { .type = NLA_U32 },
1739	[IFLA_IPTUN_LOCAL]		= { .type = NLA_U32 },
1740	[IFLA_IPTUN_REMOTE]		= { .type = NLA_U32 },
1741	[IFLA_IPTUN_TTL]		= { .type = NLA_U8 },
1742	[IFLA_IPTUN_TOS]		= { .type = NLA_U8 },
1743	[IFLA_IPTUN_PMTUDISC]		= { .type = NLA_U8 },
1744	[IFLA_IPTUN_FLAGS]		= { .type = NLA_U16 },
1745	[IFLA_IPTUN_PROTO]		= { .type = NLA_U8 },
1746#ifdef CONFIG_IPV6_SIT_6RD
1747	[IFLA_IPTUN_6RD_PREFIX]		= { .len = sizeof(struct in6_addr) },
1748	[IFLA_IPTUN_6RD_RELAY_PREFIX]	= { .type = NLA_U32 },
1749	[IFLA_IPTUN_6RD_PREFIXLEN]	= { .type = NLA_U16 },
1750	[IFLA_IPTUN_6RD_RELAY_PREFIXLEN] = { .type = NLA_U16 },
1751#endif
1752	[IFLA_IPTUN_ENCAP_TYPE]		= { .type = NLA_U16 },
1753	[IFLA_IPTUN_ENCAP_FLAGS]	= { .type = NLA_U16 },
1754	[IFLA_IPTUN_ENCAP_SPORT]	= { .type = NLA_U16 },
1755	[IFLA_IPTUN_ENCAP_DPORT]	= { .type = NLA_U16 },
1756	[IFLA_IPTUN_FWMARK]		= { .type = NLA_U32 },
1757};
1758
1759static void ipip6_dellink(struct net_device *dev, struct list_head *head)
1760{
1761	struct net *net = dev_net(dev);
1762	struct sit_net *sitn = net_generic(net, sit_net_id);
1763
1764	if (dev != sitn->fb_tunnel_dev)
1765		unregister_netdevice_queue(dev, head);
1766}
1767
1768static struct rtnl_link_ops sit_link_ops __read_mostly = {
1769	.kind		= "sit",
1770	.maxtype	= IFLA_IPTUN_MAX,
1771	.policy		= ipip6_policy,
1772	.priv_size	= sizeof(struct ip_tunnel),
1773	.setup		= ipip6_tunnel_setup,
1774	.validate	= ipip6_validate,
1775	.newlink	= ipip6_newlink,
1776	.changelink	= ipip6_changelink,
1777	.get_size	= ipip6_get_size,
1778	.fill_info	= ipip6_fill_info,
1779	.dellink	= ipip6_dellink,
1780	.get_link_net	= ip_tunnel_get_link_net,
1781};
1782
1783static struct xfrm_tunnel sit_handler __read_mostly = {
1784	.handler	=	ipip6_rcv,
1785	.err_handler	=	ipip6_err,
1786	.priority	=	1,
1787};
1788
1789static struct xfrm_tunnel ipip_handler __read_mostly = {
1790	.handler	=	ipip_rcv,
1791	.err_handler	=	ipip6_err,
1792	.priority	=	2,
1793};
1794
1795#if IS_ENABLED(CONFIG_MPLS)
1796static struct xfrm_tunnel mplsip_handler __read_mostly = {
1797	.handler	=	mplsip_rcv,
1798	.err_handler	=	ipip6_err,
1799	.priority	=	2,
1800};
1801#endif
1802
1803static void __net_exit sit_destroy_tunnels(struct net *net,
1804					   struct list_head *head)
1805{
1806	struct sit_net *sitn = net_generic(net, sit_net_id);
1807	struct net_device *dev, *aux;
1808	int prio;
1809
1810	for_each_netdev_safe(net, dev, aux)
1811		if (dev->rtnl_link_ops == &sit_link_ops)
1812			unregister_netdevice_queue(dev, head);
1813
1814	for (prio = 0; prio < 4; prio++) {
1815		int h;
1816		for (h = 0; h < (prio ? IP6_SIT_HASH_SIZE : 1); h++) {
1817			struct ip_tunnel *t;
1818
1819			t = rtnl_dereference(sitn->tunnels[prio][h]);
1820			while (t) {
1821				/* If dev is in the same netns, it has already
1822				 * been added to the list by the previous loop.
1823				 */
1824				if (!net_eq(dev_net(t->dev), net))
1825					unregister_netdevice_queue(t->dev,
1826								   head);
1827				t = rtnl_dereference(t->next);
1828			}
1829		}
1830	}
1831}
1832
1833static int __net_init sit_init_net(struct net *net)
1834{
1835	struct sit_net *sitn = net_generic(net, sit_net_id);
1836	struct ip_tunnel *t;
1837	int err;
1838
1839	sitn->tunnels[0] = sitn->tunnels_wc;
1840	sitn->tunnels[1] = sitn->tunnels_l;
1841	sitn->tunnels[2] = sitn->tunnels_r;
1842	sitn->tunnels[3] = sitn->tunnels_r_l;
1843
1844	if (!net_has_fallback_tunnels(net))
1845		return 0;
1846
1847	sitn->fb_tunnel_dev = alloc_netdev(sizeof(struct ip_tunnel), "sit0",
1848					   NET_NAME_UNKNOWN,
1849					   ipip6_tunnel_setup);
1850	if (!sitn->fb_tunnel_dev) {
1851		err = -ENOMEM;
1852		goto err_alloc_dev;
1853	}
1854	dev_net_set(sitn->fb_tunnel_dev, net);
1855	sitn->fb_tunnel_dev->rtnl_link_ops = &sit_link_ops;
1856	/* FB netdevice is special: we have one, and only one per netns.
1857	 * Allowing to move it to another netns is clearly unsafe.
1858	 */
1859	sitn->fb_tunnel_dev->netns_local = true;
1860
1861	err = register_netdev(sitn->fb_tunnel_dev);
1862	if (err)
1863		goto err_reg_dev;
1864
1865	ipip6_tunnel_clone_6rd(sitn->fb_tunnel_dev, sitn);
1866	ipip6_fb_tunnel_init(sitn->fb_tunnel_dev);
1867
1868	t = netdev_priv(sitn->fb_tunnel_dev);
1869
1870	strcpy(t->parms.name, sitn->fb_tunnel_dev->name);
1871	return 0;
1872
1873err_reg_dev:
 
1874	free_netdev(sitn->fb_tunnel_dev);
1875err_alloc_dev:
1876	return err;
1877}
1878
1879static void __net_exit sit_exit_batch_rtnl(struct list_head *net_list,
1880					   struct list_head *dev_to_kill)
1881{
 
1882	struct net *net;
1883
1884	ASSERT_RTNL();
1885	list_for_each_entry(net, net_list, exit_list)
1886		sit_destroy_tunnels(net, dev_to_kill);
 
 
 
1887}
1888
1889static struct pernet_operations sit_net_ops = {
1890	.init = sit_init_net,
1891	.exit_batch_rtnl = sit_exit_batch_rtnl,
1892	.id   = &sit_net_id,
1893	.size = sizeof(struct sit_net),
1894};
1895
1896static void __exit sit_cleanup(void)
1897{
1898	rtnl_link_unregister(&sit_link_ops);
1899	xfrm4_tunnel_deregister(&sit_handler, AF_INET6);
1900	xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
1901#if IS_ENABLED(CONFIG_MPLS)
1902	xfrm4_tunnel_deregister(&mplsip_handler, AF_MPLS);
1903#endif
1904
1905	unregister_pernet_device(&sit_net_ops);
1906	rcu_barrier(); /* Wait for completion of call_rcu()'s */
1907}
1908
1909static int __init sit_init(void)
1910{
1911	int err;
1912
1913	pr_info("IPv6, IPv4 and MPLS over IPv4 tunneling driver\n");
1914
1915	err = register_pernet_device(&sit_net_ops);
1916	if (err < 0)
1917		return err;
1918	err = xfrm4_tunnel_register(&sit_handler, AF_INET6);
1919	if (err < 0) {
1920		pr_info("%s: can't register ip6ip4\n", __func__);
1921		goto xfrm_tunnel_failed;
1922	}
1923	err = xfrm4_tunnel_register(&ipip_handler, AF_INET);
1924	if (err < 0) {
1925		pr_info("%s: can't register ip4ip4\n", __func__);
1926		goto xfrm_tunnel4_failed;
1927	}
1928#if IS_ENABLED(CONFIG_MPLS)
1929	err = xfrm4_tunnel_register(&mplsip_handler, AF_MPLS);
1930	if (err < 0) {
1931		pr_info("%s: can't register mplsip\n", __func__);
1932		goto xfrm_tunnel_mpls_failed;
1933	}
1934#endif
1935	err = rtnl_link_register(&sit_link_ops);
1936	if (err < 0)
1937		goto rtnl_link_failed;
1938
1939out:
1940	return err;
1941
1942rtnl_link_failed:
1943#if IS_ENABLED(CONFIG_MPLS)
1944	xfrm4_tunnel_deregister(&mplsip_handler, AF_MPLS);
1945xfrm_tunnel_mpls_failed:
1946#endif
1947	xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
1948xfrm_tunnel4_failed:
1949	xfrm4_tunnel_deregister(&sit_handler, AF_INET6);
1950xfrm_tunnel_failed:
1951	unregister_pernet_device(&sit_net_ops);
1952	goto out;
1953}
1954
1955module_init(sit_init);
1956module_exit(sit_cleanup);
1957MODULE_DESCRIPTION("IPv6-in-IPv4 tunnel SIT driver");
1958MODULE_LICENSE("GPL");
1959MODULE_ALIAS_RTNL_LINK("sit");
1960MODULE_ALIAS_NETDEV("sit0");
v5.4
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 *	IPv6 over IPv4 tunnel device - Simple Internet Transition (SIT)
   4 *	Linux INET6 implementation
   5 *
   6 *	Authors:
   7 *	Pedro Roque		<roque@di.fc.ul.pt>
   8 *	Alexey Kuznetsov	<kuznet@ms2.inr.ac.ru>
   9 *
  10 *	Changes:
  11 * Roger Venning <r.venning@telstra.com>:	6to4 support
  12 * Nate Thompson <nate@thebog.net>:		6to4 support
  13 * Fred Templin <fred.l.templin@boeing.com>:	isatap support
  14 */
  15
  16#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  17
  18#include <linux/module.h>
  19#include <linux/capability.h>
  20#include <linux/errno.h>
  21#include <linux/types.h>
  22#include <linux/socket.h>
  23#include <linux/sockios.h>
  24#include <linux/net.h>
  25#include <linux/in6.h>
  26#include <linux/netdevice.h>
  27#include <linux/if_arp.h>
  28#include <linux/icmp.h>
  29#include <linux/slab.h>
  30#include <linux/uaccess.h>
  31#include <linux/init.h>
  32#include <linux/netfilter_ipv4.h>
  33#include <linux/if_ether.h>
  34
  35#include <net/sock.h>
  36#include <net/snmp.h>
  37
  38#include <net/ipv6.h>
  39#include <net/protocol.h>
  40#include <net/transp_v6.h>
  41#include <net/ip6_fib.h>
  42#include <net/ip6_route.h>
  43#include <net/ndisc.h>
  44#include <net/addrconf.h>
  45#include <net/ip.h>
  46#include <net/udp.h>
  47#include <net/icmp.h>
  48#include <net/ip_tunnels.h>
  49#include <net/inet_ecn.h>
  50#include <net/xfrm.h>
  51#include <net/dsfield.h>
  52#include <net/net_namespace.h>
  53#include <net/netns/generic.h>
 
  54
  55/*
  56   This version of net/ipv6/sit.c is cloned of net/ipv4/ip_gre.c
  57
  58   For comments look at net/ipv4/ip_gre.c --ANK
  59 */
  60
  61#define IP6_SIT_HASH_SIZE  16
  62#define HASH(addr) (((__force u32)addr^((__force u32)addr>>4))&0xF)
  63
  64static bool log_ecn_error = true;
  65module_param(log_ecn_error, bool, 0644);
  66MODULE_PARM_DESC(log_ecn_error, "Log packets received with corrupted ECN");
  67
  68static int ipip6_tunnel_init(struct net_device *dev);
  69static void ipip6_tunnel_setup(struct net_device *dev);
  70static void ipip6_dev_free(struct net_device *dev);
  71static bool check_6rd(struct ip_tunnel *tunnel, const struct in6_addr *v6dst,
  72		      __be32 *v4dst);
  73static struct rtnl_link_ops sit_link_ops __read_mostly;
  74
  75static unsigned int sit_net_id __read_mostly;
  76struct sit_net {
  77	struct ip_tunnel __rcu *tunnels_r_l[IP6_SIT_HASH_SIZE];
  78	struct ip_tunnel __rcu *tunnels_r[IP6_SIT_HASH_SIZE];
  79	struct ip_tunnel __rcu *tunnels_l[IP6_SIT_HASH_SIZE];
  80	struct ip_tunnel __rcu *tunnels_wc[1];
  81	struct ip_tunnel __rcu **tunnels[4];
  82
  83	struct net_device *fb_tunnel_dev;
  84};
  85
 
 
 
 
 
 
 
  86/*
  87 * Must be invoked with rcu_read_lock
  88 */
  89static struct ip_tunnel *ipip6_tunnel_lookup(struct net *net,
  90					     struct net_device *dev,
  91					     __be32 remote, __be32 local,
  92					     int sifindex)
  93{
  94	unsigned int h0 = HASH(remote);
  95	unsigned int h1 = HASH(local);
  96	struct ip_tunnel *t;
  97	struct sit_net *sitn = net_generic(net, sit_net_id);
  98	int ifindex = dev ? dev->ifindex : 0;
  99
 100	for_each_ip_tunnel_rcu(t, sitn->tunnels_r_l[h0 ^ h1]) {
 101		if (local == t->parms.iph.saddr &&
 102		    remote == t->parms.iph.daddr &&
 103		    (!dev || !t->parms.link || ifindex == t->parms.link ||
 104		     sifindex == t->parms.link) &&
 105		    (t->dev->flags & IFF_UP))
 106			return t;
 107	}
 108	for_each_ip_tunnel_rcu(t, sitn->tunnels_r[h0]) {
 109		if (remote == t->parms.iph.daddr &&
 110		    (!dev || !t->parms.link || ifindex == t->parms.link ||
 111		     sifindex == t->parms.link) &&
 112		    (t->dev->flags & IFF_UP))
 113			return t;
 114	}
 115	for_each_ip_tunnel_rcu(t, sitn->tunnels_l[h1]) {
 116		if (local == t->parms.iph.saddr &&
 117		    (!dev || !t->parms.link || ifindex == t->parms.link ||
 118		     sifindex == t->parms.link) &&
 119		    (t->dev->flags & IFF_UP))
 120			return t;
 121	}
 122	t = rcu_dereference(sitn->tunnels_wc[0]);
 123	if (t && (t->dev->flags & IFF_UP))
 124		return t;
 125	return NULL;
 126}
 127
 128static struct ip_tunnel __rcu **__ipip6_bucket(struct sit_net *sitn,
 129		struct ip_tunnel_parm *parms)
 130{
 131	__be32 remote = parms->iph.daddr;
 132	__be32 local = parms->iph.saddr;
 133	unsigned int h = 0;
 134	int prio = 0;
 135
 136	if (remote) {
 137		prio |= 2;
 138		h ^= HASH(remote);
 139	}
 140	if (local) {
 141		prio |= 1;
 142		h ^= HASH(local);
 143	}
 144	return &sitn->tunnels[prio][h];
 145}
 146
 147static inline struct ip_tunnel __rcu **ipip6_bucket(struct sit_net *sitn,
 148		struct ip_tunnel *t)
 149{
 150	return __ipip6_bucket(sitn, &t->parms);
 151}
 152
 153static void ipip6_tunnel_unlink(struct sit_net *sitn, struct ip_tunnel *t)
 154{
 155	struct ip_tunnel __rcu **tp;
 156	struct ip_tunnel *iter;
 157
 158	for (tp = ipip6_bucket(sitn, t);
 159	     (iter = rtnl_dereference(*tp)) != NULL;
 160	     tp = &iter->next) {
 161		if (t == iter) {
 162			rcu_assign_pointer(*tp, t->next);
 163			break;
 164		}
 165	}
 166}
 167
 168static void ipip6_tunnel_link(struct sit_net *sitn, struct ip_tunnel *t)
 169{
 170	struct ip_tunnel __rcu **tp = ipip6_bucket(sitn, t);
 171
 172	rcu_assign_pointer(t->next, rtnl_dereference(*tp));
 173	rcu_assign_pointer(*tp, t);
 174}
 175
 176static void ipip6_tunnel_clone_6rd(struct net_device *dev, struct sit_net *sitn)
 177{
 178#ifdef CONFIG_IPV6_SIT_6RD
 179	struct ip_tunnel *t = netdev_priv(dev);
 180
 181	if (dev == sitn->fb_tunnel_dev || !sitn->fb_tunnel_dev) {
 182		ipv6_addr_set(&t->ip6rd.prefix, htonl(0x20020000), 0, 0, 0);
 183		t->ip6rd.relay_prefix = 0;
 184		t->ip6rd.prefixlen = 16;
 185		t->ip6rd.relay_prefixlen = 0;
 186	} else {
 187		struct ip_tunnel *t0 = netdev_priv(sitn->fb_tunnel_dev);
 188		memcpy(&t->ip6rd, &t0->ip6rd, sizeof(t->ip6rd));
 189	}
 190#endif
 191}
 192
 193static int ipip6_tunnel_create(struct net_device *dev)
 194{
 195	struct ip_tunnel *t = netdev_priv(dev);
 196	struct net *net = dev_net(dev);
 197	struct sit_net *sitn = net_generic(net, sit_net_id);
 198	int err;
 199
 200	memcpy(dev->dev_addr, &t->parms.iph.saddr, 4);
 201	memcpy(dev->broadcast, &t->parms.iph.daddr, 4);
 202
 203	if ((__force u16)t->parms.i_flags & SIT_ISATAP)
 204		dev->priv_flags |= IFF_ISATAP;
 205
 206	dev->rtnl_link_ops = &sit_link_ops;
 207
 208	err = register_netdevice(dev);
 209	if (err < 0)
 210		goto out;
 211
 212	ipip6_tunnel_clone_6rd(dev, sitn);
 213
 214	dev_hold(dev);
 215
 216	ipip6_tunnel_link(sitn, t);
 217	return 0;
 218
 219out:
 220	return err;
 221}
 222
 223static struct ip_tunnel *ipip6_tunnel_locate(struct net *net,
 224		struct ip_tunnel_parm *parms, int create)
 
 225{
 226	__be32 remote = parms->iph.daddr;
 227	__be32 local = parms->iph.saddr;
 228	struct ip_tunnel *t, *nt;
 229	struct ip_tunnel __rcu **tp;
 230	struct net_device *dev;
 231	char name[IFNAMSIZ];
 232	struct sit_net *sitn = net_generic(net, sit_net_id);
 233
 234	for (tp = __ipip6_bucket(sitn, parms);
 235	    (t = rtnl_dereference(*tp)) != NULL;
 236	     tp = &t->next) {
 237		if (local == t->parms.iph.saddr &&
 238		    remote == t->parms.iph.daddr &&
 239		    parms->link == t->parms.link) {
 240			if (create)
 241				return NULL;
 242			else
 243				return t;
 244		}
 245	}
 246	if (!create)
 247		goto failed;
 248
 249	if (parms->name[0]) {
 250		if (!dev_valid_name(parms->name))
 251			goto failed;
 252		strlcpy(name, parms->name, IFNAMSIZ);
 253	} else {
 254		strcpy(name, "sit%d");
 255	}
 256	dev = alloc_netdev(sizeof(*t), name, NET_NAME_UNKNOWN,
 257			   ipip6_tunnel_setup);
 258	if (!dev)
 259		return NULL;
 260
 261	dev_net_set(dev, net);
 262
 263	nt = netdev_priv(dev);
 264
 265	nt->parms = *parms;
 266	if (ipip6_tunnel_create(dev) < 0)
 267		goto failed_free;
 268
 
 
 
 269	return nt;
 270
 271failed_free:
 272	free_netdev(dev);
 273failed:
 274	return NULL;
 275}
 276
 277#define for_each_prl_rcu(start)			\
 278	for (prl = rcu_dereference(start);	\
 279	     prl;				\
 280	     prl = rcu_dereference(prl->next))
 281
 282static struct ip_tunnel_prl_entry *
 283__ipip6_tunnel_locate_prl(struct ip_tunnel *t, __be32 addr)
 284{
 285	struct ip_tunnel_prl_entry *prl;
 286
 287	for_each_prl_rcu(t->prl)
 288		if (prl->addr == addr)
 289			break;
 290	return prl;
 291
 292}
 293
 294static int ipip6_tunnel_get_prl(struct ip_tunnel *t,
 295				struct ip_tunnel_prl __user *a)
 296{
 
 297	struct ip_tunnel_prl kprl, *kp;
 298	struct ip_tunnel_prl_entry *prl;
 299	unsigned int cmax, c = 0, ca, len;
 300	int ret = 0;
 301
 
 
 
 302	if (copy_from_user(&kprl, a, sizeof(kprl)))
 303		return -EFAULT;
 304	cmax = kprl.datalen / sizeof(kprl);
 305	if (cmax > 1 && kprl.addr != htonl(INADDR_ANY))
 306		cmax = 1;
 307
 308	/* For simple GET or for root users,
 309	 * we try harder to allocate.
 310	 */
 311	kp = (cmax <= 1 || capable(CAP_NET_ADMIN)) ?
 312		kcalloc(cmax, sizeof(*kp), GFP_KERNEL | __GFP_NOWARN) :
 313		NULL;
 314
 315	rcu_read_lock();
 316
 317	ca = t->prl_count < cmax ? t->prl_count : cmax;
 318
 319	if (!kp) {
 320		/* We don't try hard to allocate much memory for
 321		 * non-root users.
 322		 * For root users, retry allocating enough memory for
 323		 * the answer.
 324		 */
 325		kp = kcalloc(ca, sizeof(*kp), GFP_ATOMIC);
 
 326		if (!kp) {
 327			ret = -ENOMEM;
 328			goto out;
 329		}
 330	}
 331
 332	c = 0;
 333	for_each_prl_rcu(t->prl) {
 334		if (c >= cmax)
 335			break;
 336		if (kprl.addr != htonl(INADDR_ANY) && prl->addr != kprl.addr)
 337			continue;
 338		kp[c].addr = prl->addr;
 339		kp[c].flags = prl->flags;
 340		c++;
 341		if (kprl.addr != htonl(INADDR_ANY))
 342			break;
 343	}
 344out:
 345	rcu_read_unlock();
 346
 347	len = sizeof(*kp) * c;
 348	ret = 0;
 349	if ((len && copy_to_user(a + 1, kp, len)) || put_user(len, &a->datalen))
 350		ret = -EFAULT;
 351
 352	kfree(kp);
 353
 354	return ret;
 355}
 356
 357static int
 358ipip6_tunnel_add_prl(struct ip_tunnel *t, struct ip_tunnel_prl *a, int chg)
 359{
 360	struct ip_tunnel_prl_entry *p;
 361	int err = 0;
 362
 363	if (a->addr == htonl(INADDR_ANY))
 364		return -EINVAL;
 365
 366	ASSERT_RTNL();
 367
 368	for (p = rtnl_dereference(t->prl); p; p = rtnl_dereference(p->next)) {
 369		if (p->addr == a->addr) {
 370			if (chg) {
 371				p->flags = a->flags;
 372				goto out;
 373			}
 374			err = -EEXIST;
 375			goto out;
 376		}
 377	}
 378
 379	if (chg) {
 380		err = -ENXIO;
 381		goto out;
 382	}
 383
 384	p = kzalloc(sizeof(struct ip_tunnel_prl_entry), GFP_KERNEL);
 385	if (!p) {
 386		err = -ENOBUFS;
 387		goto out;
 388	}
 389
 390	p->next = t->prl;
 391	p->addr = a->addr;
 392	p->flags = a->flags;
 393	t->prl_count++;
 394	rcu_assign_pointer(t->prl, p);
 395out:
 396	return err;
 397}
 398
 399static void prl_list_destroy_rcu(struct rcu_head *head)
 400{
 401	struct ip_tunnel_prl_entry *p, *n;
 402
 403	p = container_of(head, struct ip_tunnel_prl_entry, rcu_head);
 404	do {
 405		n = rcu_dereference_protected(p->next, 1);
 406		kfree(p);
 407		p = n;
 408	} while (p);
 409}
 410
 411static int
 412ipip6_tunnel_del_prl(struct ip_tunnel *t, struct ip_tunnel_prl *a)
 413{
 414	struct ip_tunnel_prl_entry *x;
 415	struct ip_tunnel_prl_entry __rcu **p;
 416	int err = 0;
 417
 418	ASSERT_RTNL();
 419
 420	if (a && a->addr != htonl(INADDR_ANY)) {
 421		for (p = &t->prl;
 422		     (x = rtnl_dereference(*p)) != NULL;
 423		     p = &x->next) {
 424			if (x->addr == a->addr) {
 425				*p = x->next;
 426				kfree_rcu(x, rcu_head);
 427				t->prl_count--;
 428				goto out;
 429			}
 430		}
 431		err = -ENXIO;
 432	} else {
 433		x = rtnl_dereference(t->prl);
 434		if (x) {
 435			t->prl_count = 0;
 436			call_rcu(&x->rcu_head, prl_list_destroy_rcu);
 437			t->prl = NULL;
 438		}
 439	}
 440out:
 441	return err;
 442}
 443
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 444static int
 445isatap_chksrc(struct sk_buff *skb, const struct iphdr *iph, struct ip_tunnel *t)
 446{
 447	struct ip_tunnel_prl_entry *p;
 448	int ok = 1;
 449
 450	rcu_read_lock();
 451	p = __ipip6_tunnel_locate_prl(t, iph->saddr);
 452	if (p) {
 453		if (p->flags & PRL_DEFAULT)
 454			skb->ndisc_nodetype = NDISC_NODETYPE_DEFAULT;
 455		else
 456			skb->ndisc_nodetype = NDISC_NODETYPE_NODEFAULT;
 457	} else {
 458		const struct in6_addr *addr6 = &ipv6_hdr(skb)->saddr;
 459
 460		if (ipv6_addr_is_isatap(addr6) &&
 461		    (addr6->s6_addr32[3] == iph->saddr) &&
 462		    ipv6_chk_prefix(addr6, t->dev))
 463			skb->ndisc_nodetype = NDISC_NODETYPE_HOST;
 464		else
 465			ok = 0;
 466	}
 467	rcu_read_unlock();
 468	return ok;
 469}
 470
 471static void ipip6_tunnel_uninit(struct net_device *dev)
 472{
 473	struct ip_tunnel *tunnel = netdev_priv(dev);
 474	struct sit_net *sitn = net_generic(tunnel->net, sit_net_id);
 475
 476	if (dev == sitn->fb_tunnel_dev) {
 477		RCU_INIT_POINTER(sitn->tunnels_wc[0], NULL);
 478	} else {
 479		ipip6_tunnel_unlink(sitn, tunnel);
 480		ipip6_tunnel_del_prl(tunnel, NULL);
 481	}
 482	dst_cache_reset(&tunnel->dst_cache);
 483	dev_put(dev);
 484}
 485
 486static int ipip6_err(struct sk_buff *skb, u32 info)
 487{
 488	const struct iphdr *iph = (const struct iphdr *)skb->data;
 489	const int type = icmp_hdr(skb)->type;
 490	const int code = icmp_hdr(skb)->code;
 491	unsigned int data_len = 0;
 492	struct ip_tunnel *t;
 493	int sifindex;
 494	int err;
 495
 496	switch (type) {
 497	default:
 498	case ICMP_PARAMETERPROB:
 499		return 0;
 500
 501	case ICMP_DEST_UNREACH:
 502		switch (code) {
 503		case ICMP_SR_FAILED:
 504			/* Impossible event. */
 505			return 0;
 506		default:
 507			/* All others are translated to HOST_UNREACH.
 508			   rfc2003 contains "deep thoughts" about NET_UNREACH,
 509			   I believe they are just ether pollution. --ANK
 510			 */
 511			break;
 512		}
 513		break;
 514	case ICMP_TIME_EXCEEDED:
 515		if (code != ICMP_EXC_TTL)
 516			return 0;
 517		data_len = icmp_hdr(skb)->un.reserved[1] * 4; /* RFC 4884 4.1 */
 518		break;
 519	case ICMP_REDIRECT:
 520		break;
 521	}
 522
 523	err = -ENOENT;
 524
 525	sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
 526	t = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
 527				iph->daddr, iph->saddr, sifindex);
 528	if (!t)
 529		goto out;
 530
 531	if (type == ICMP_DEST_UNREACH && code == ICMP_FRAG_NEEDED) {
 532		ipv4_update_pmtu(skb, dev_net(skb->dev), info,
 533				 t->parms.link, iph->protocol);
 534		err = 0;
 535		goto out;
 536	}
 537	if (type == ICMP_REDIRECT) {
 538		ipv4_redirect(skb, dev_net(skb->dev), t->parms.link,
 539			      iph->protocol);
 540		err = 0;
 541		goto out;
 542	}
 543
 544	err = 0;
 545	if (__in6_dev_get(skb->dev) &&
 546	    !ip6_err_gen_icmpv6_unreach(skb, iph->ihl * 4, type, data_len))
 547		goto out;
 548
 549	if (t->parms.iph.daddr == 0)
 550		goto out;
 551
 552	if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED)
 553		goto out;
 554
 555	if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO))
 556		t->err_count++;
 557	else
 558		t->err_count = 1;
 559	t->err_time = jiffies;
 560out:
 561	return err;
 562}
 563
 564static inline bool is_spoofed_6rd(struct ip_tunnel *tunnel, const __be32 v4addr,
 565				  const struct in6_addr *v6addr)
 566{
 567	__be32 v4embed = 0;
 568	if (check_6rd(tunnel, v6addr, &v4embed) && v4addr != v4embed)
 569		return true;
 570	return false;
 571}
 572
 573/* Checks if an address matches an address on the tunnel interface.
 574 * Used to detect the NAT of proto 41 packets and let them pass spoofing test.
 575 * Long story:
 576 * This function is called after we considered the packet as spoofed
 577 * in is_spoofed_6rd.
 578 * We may have a router that is doing NAT for proto 41 packets
 579 * for an internal station. Destination a.a.a.a/PREFIX:bbbb:bbbb
 580 * will be translated to n.n.n.n/PREFIX:bbbb:bbbb. And is_spoofed_6rd
 581 * function will return true, dropping the packet.
 582 * But, we can still check if is spoofed against the IP
 583 * addresses associated with the interface.
 584 */
 585static bool only_dnatted(const struct ip_tunnel *tunnel,
 586	const struct in6_addr *v6dst)
 587{
 588	int prefix_len;
 589
 590#ifdef CONFIG_IPV6_SIT_6RD
 591	prefix_len = tunnel->ip6rd.prefixlen + 32
 592		- tunnel->ip6rd.relay_prefixlen;
 593#else
 594	prefix_len = 48;
 595#endif
 596	return ipv6_chk_custom_prefix(v6dst, prefix_len, tunnel->dev);
 597}
 598
 599/* Returns true if a packet is spoofed */
 600static bool packet_is_spoofed(struct sk_buff *skb,
 601			      const struct iphdr *iph,
 602			      struct ip_tunnel *tunnel)
 603{
 604	const struct ipv6hdr *ipv6h;
 605
 606	if (tunnel->dev->priv_flags & IFF_ISATAP) {
 607		if (!isatap_chksrc(skb, iph, tunnel))
 608			return true;
 609
 610		return false;
 611	}
 612
 613	if (tunnel->dev->flags & IFF_POINTOPOINT)
 614		return false;
 615
 616	ipv6h = ipv6_hdr(skb);
 617
 618	if (unlikely(is_spoofed_6rd(tunnel, iph->saddr, &ipv6h->saddr))) {
 619		net_warn_ratelimited("Src spoofed %pI4/%pI6c -> %pI4/%pI6c\n",
 620				     &iph->saddr, &ipv6h->saddr,
 621				     &iph->daddr, &ipv6h->daddr);
 622		return true;
 623	}
 624
 625	if (likely(!is_spoofed_6rd(tunnel, iph->daddr, &ipv6h->daddr)))
 626		return false;
 627
 628	if (only_dnatted(tunnel, &ipv6h->daddr))
 629		return false;
 630
 631	net_warn_ratelimited("Dst spoofed %pI4/%pI6c -> %pI4/%pI6c\n",
 632			     &iph->saddr, &ipv6h->saddr,
 633			     &iph->daddr, &ipv6h->daddr);
 634	return true;
 635}
 636
 637static int ipip6_rcv(struct sk_buff *skb)
 638{
 639	const struct iphdr *iph = ip_hdr(skb);
 640	struct ip_tunnel *tunnel;
 641	int sifindex;
 642	int err;
 643
 644	sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
 645	tunnel = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
 646				     iph->saddr, iph->daddr, sifindex);
 647	if (tunnel) {
 648		struct pcpu_sw_netstats *tstats;
 649
 650		if (tunnel->parms.iph.protocol != IPPROTO_IPV6 &&
 651		    tunnel->parms.iph.protocol != 0)
 652			goto out;
 653
 654		skb->mac_header = skb->network_header;
 655		skb_reset_network_header(skb);
 656		IPCB(skb)->flags = 0;
 657		skb->dev = tunnel->dev;
 658
 659		if (packet_is_spoofed(skb, iph, tunnel)) {
 660			tunnel->dev->stats.rx_errors++;
 661			goto out;
 662		}
 663
 664		if (iptunnel_pull_header(skb, 0, htons(ETH_P_IPV6),
 665		    !net_eq(tunnel->net, dev_net(tunnel->dev))))
 666			goto out;
 667
 668		/* skb can be uncloned in iptunnel_pull_header, so
 669		 * old iph is no longer valid
 670		 */
 671		iph = (const struct iphdr *)skb_mac_header(skb);
 
 
 672		err = IP_ECN_decapsulate(iph, skb);
 673		if (unlikely(err)) {
 674			if (log_ecn_error)
 675				net_info_ratelimited("non-ECT from %pI4 with TOS=%#x\n",
 676						     &iph->saddr, iph->tos);
 677			if (err > 1) {
 678				++tunnel->dev->stats.rx_frame_errors;
 679				++tunnel->dev->stats.rx_errors;
 680				goto out;
 681			}
 682		}
 683
 684		tstats = this_cpu_ptr(tunnel->dev->tstats);
 685		u64_stats_update_begin(&tstats->syncp);
 686		tstats->rx_packets++;
 687		tstats->rx_bytes += skb->len;
 688		u64_stats_update_end(&tstats->syncp);
 689
 690		netif_rx(skb);
 691
 692		return 0;
 693	}
 694
 695	/* no tunnel matched,  let upstream know, ipsec may handle it */
 696	return 1;
 697out:
 698	kfree_skb(skb);
 699	return 0;
 700}
 701
 702static const struct tnl_ptk_info ipip_tpi = {
 703	/* no tunnel info required for ipip. */
 704	.proto = htons(ETH_P_IP),
 705};
 706
 707#if IS_ENABLED(CONFIG_MPLS)
 708static const struct tnl_ptk_info mplsip_tpi = {
 709	/* no tunnel info required for mplsip. */
 710	.proto = htons(ETH_P_MPLS_UC),
 711};
 712#endif
 713
 714static int sit_tunnel_rcv(struct sk_buff *skb, u8 ipproto)
 715{
 716	const struct iphdr *iph;
 717	struct ip_tunnel *tunnel;
 718	int sifindex;
 719
 720	sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
 721
 722	iph = ip_hdr(skb);
 723	tunnel = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
 724				     iph->saddr, iph->daddr, sifindex);
 725	if (tunnel) {
 726		const struct tnl_ptk_info *tpi;
 727
 728		if (tunnel->parms.iph.protocol != ipproto &&
 729		    tunnel->parms.iph.protocol != 0)
 730			goto drop;
 731
 732		if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb))
 733			goto drop;
 734#if IS_ENABLED(CONFIG_MPLS)
 735		if (ipproto == IPPROTO_MPLS)
 736			tpi = &mplsip_tpi;
 737		else
 738#endif
 739			tpi = &ipip_tpi;
 740		if (iptunnel_pull_header(skb, 0, tpi->proto, false))
 741			goto drop;
 
 
 742		return ip_tunnel_rcv(tunnel, skb, tpi, NULL, log_ecn_error);
 743	}
 744
 745	return 1;
 746
 747drop:
 748	kfree_skb(skb);
 749	return 0;
 750}
 751
 752static int ipip_rcv(struct sk_buff *skb)
 753{
 754	return sit_tunnel_rcv(skb, IPPROTO_IPIP);
 755}
 756
 757#if IS_ENABLED(CONFIG_MPLS)
 758static int mplsip_rcv(struct sk_buff *skb)
 759{
 760	return sit_tunnel_rcv(skb, IPPROTO_MPLS);
 761}
 762#endif
 763
 764/*
 765 * If the IPv6 address comes from 6rd / 6to4 (RFC 3056) addr space this function
 766 * stores the embedded IPv4 address in v4dst and returns true.
 767 */
 768static bool check_6rd(struct ip_tunnel *tunnel, const struct in6_addr *v6dst,
 769		      __be32 *v4dst)
 770{
 771#ifdef CONFIG_IPV6_SIT_6RD
 772	if (ipv6_prefix_equal(v6dst, &tunnel->ip6rd.prefix,
 773			      tunnel->ip6rd.prefixlen)) {
 774		unsigned int pbw0, pbi0;
 775		int pbi1;
 776		u32 d;
 777
 778		pbw0 = tunnel->ip6rd.prefixlen >> 5;
 779		pbi0 = tunnel->ip6rd.prefixlen & 0x1f;
 780
 781		d = tunnel->ip6rd.relay_prefixlen < 32 ?
 782			(ntohl(v6dst->s6_addr32[pbw0]) << pbi0) >>
 783		    tunnel->ip6rd.relay_prefixlen : 0;
 784
 785		pbi1 = pbi0 - tunnel->ip6rd.relay_prefixlen;
 786		if (pbi1 > 0)
 787			d |= ntohl(v6dst->s6_addr32[pbw0 + 1]) >>
 788			     (32 - pbi1);
 789
 790		*v4dst = tunnel->ip6rd.relay_prefix | htonl(d);
 791		return true;
 792	}
 793#else
 794	if (v6dst->s6_addr16[0] == htons(0x2002)) {
 795		/* 6to4 v6 addr has 16 bits prefix, 32 v4addr, 16 SLA, ... */
 796		memcpy(v4dst, &v6dst->s6_addr16[1], 4);
 797		return true;
 798	}
 799#endif
 800	return false;
 801}
 802
 803static inline __be32 try_6rd(struct ip_tunnel *tunnel,
 804			     const struct in6_addr *v6dst)
 805{
 806	__be32 dst = 0;
 807	check_6rd(tunnel, v6dst, &dst);
 808	return dst;
 809}
 810
 811/*
 812 *	This function assumes it is being called from dev_queue_xmit()
 813 *	and that skb is filled properly by that function.
 814 */
 815
 816static netdev_tx_t ipip6_tunnel_xmit(struct sk_buff *skb,
 817				     struct net_device *dev)
 818{
 819	struct ip_tunnel *tunnel = netdev_priv(dev);
 820	const struct iphdr  *tiph = &tunnel->parms.iph;
 821	const struct ipv6hdr *iph6 = ipv6_hdr(skb);
 822	u8     tos = tunnel->parms.iph.tos;
 823	__be16 df = tiph->frag_off;
 824	struct rtable *rt;		/* Route to the other host */
 825	struct net_device *tdev;	/* Device to other host */
 826	unsigned int max_headroom;	/* The extra header space needed */
 827	__be32 dst = tiph->daddr;
 828	struct flowi4 fl4;
 829	int    mtu;
 830	const struct in6_addr *addr6;
 831	int addr_type;
 832	u8 ttl;
 833	u8 protocol = IPPROTO_IPV6;
 834	int t_hlen = tunnel->hlen + sizeof(struct iphdr);
 835
 836	if (tos == 1)
 837		tos = ipv6_get_dsfield(iph6);
 838
 839	/* ISATAP (RFC4214) - must come before 6to4 */
 840	if (dev->priv_flags & IFF_ISATAP) {
 841		struct neighbour *neigh = NULL;
 842		bool do_tx_error = false;
 843
 844		if (skb_dst(skb))
 845			neigh = dst_neigh_lookup(skb_dst(skb), &iph6->daddr);
 846
 847		if (!neigh) {
 848			net_dbg_ratelimited("nexthop == NULL\n");
 849			goto tx_error;
 850		}
 851
 852		addr6 = (const struct in6_addr *)&neigh->primary_key;
 853		addr_type = ipv6_addr_type(addr6);
 854
 855		if ((addr_type & IPV6_ADDR_UNICAST) &&
 856		     ipv6_addr_is_isatap(addr6))
 857			dst = addr6->s6_addr32[3];
 858		else
 859			do_tx_error = true;
 860
 861		neigh_release(neigh);
 862		if (do_tx_error)
 863			goto tx_error;
 864	}
 865
 866	if (!dst)
 867		dst = try_6rd(tunnel, &iph6->daddr);
 868
 869	if (!dst) {
 870		struct neighbour *neigh = NULL;
 871		bool do_tx_error = false;
 872
 873		if (skb_dst(skb))
 874			neigh = dst_neigh_lookup(skb_dst(skb), &iph6->daddr);
 875
 876		if (!neigh) {
 877			net_dbg_ratelimited("nexthop == NULL\n");
 878			goto tx_error;
 879		}
 880
 881		addr6 = (const struct in6_addr *)&neigh->primary_key;
 882		addr_type = ipv6_addr_type(addr6);
 883
 884		if (addr_type == IPV6_ADDR_ANY) {
 885			addr6 = &ipv6_hdr(skb)->daddr;
 886			addr_type = ipv6_addr_type(addr6);
 887		}
 888
 889		if ((addr_type & IPV6_ADDR_COMPATv4) != 0)
 890			dst = addr6->s6_addr32[3];
 891		else
 892			do_tx_error = true;
 893
 894		neigh_release(neigh);
 895		if (do_tx_error)
 896			goto tx_error;
 897	}
 898
 899	flowi4_init_output(&fl4, tunnel->parms.link, tunnel->fwmark,
 900			   RT_TOS(tos), RT_SCOPE_UNIVERSE, IPPROTO_IPV6,
 901			   0, dst, tiph->saddr, 0, 0,
 902			   sock_net_uid(tunnel->net, NULL));
 903
 904	rt = dst_cache_get_ip4(&tunnel->dst_cache, &fl4.saddr);
 905	if (!rt) {
 906		rt = ip_route_output_flow(tunnel->net, &fl4, NULL);
 907		if (IS_ERR(rt)) {
 908			dev->stats.tx_carrier_errors++;
 909			goto tx_error_icmp;
 910		}
 911		dst_cache_set_ip4(&tunnel->dst_cache, &rt->dst, fl4.saddr);
 912	}
 913
 914	if (rt->rt_type != RTN_UNICAST) {
 915		ip_rt_put(rt);
 916		dev->stats.tx_carrier_errors++;
 917		goto tx_error_icmp;
 918	}
 919	tdev = rt->dst.dev;
 920
 921	if (tdev == dev) {
 922		ip_rt_put(rt);
 923		dev->stats.collisions++;
 924		goto tx_error;
 925	}
 926
 927	if (iptunnel_handle_offloads(skb, SKB_GSO_IPXIP4)) {
 928		ip_rt_put(rt);
 929		goto tx_error;
 930	}
 931
 932	if (df) {
 933		mtu = dst_mtu(&rt->dst) - t_hlen;
 934
 935		if (mtu < 68) {
 936			dev->stats.collisions++;
 937			ip_rt_put(rt);
 938			goto tx_error;
 939		}
 940
 941		if (mtu < IPV6_MIN_MTU) {
 942			mtu = IPV6_MIN_MTU;
 943			df = 0;
 944		}
 945
 946		if (tunnel->parms.iph.daddr)
 947			skb_dst_update_pmtu(skb, mtu);
 948
 949		if (skb->len > mtu && !skb_is_gso(skb)) {
 950			icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
 951			ip_rt_put(rt);
 952			goto tx_error;
 953		}
 954	}
 955
 956	if (tunnel->err_count > 0) {
 957		if (time_before(jiffies,
 958				tunnel->err_time + IPTUNNEL_ERR_TIMEO)) {
 959			tunnel->err_count--;
 960			dst_link_failure(skb);
 961		} else
 962			tunnel->err_count = 0;
 963	}
 964
 965	/*
 966	 * Okay, now see if we can stuff it in the buffer as-is.
 967	 */
 968	max_headroom = LL_RESERVED_SPACE(tdev) + t_hlen;
 969
 970	if (skb_headroom(skb) < max_headroom || skb_shared(skb) ||
 971	    (skb_cloned(skb) && !skb_clone_writable(skb, 0))) {
 972		struct sk_buff *new_skb = skb_realloc_headroom(skb, max_headroom);
 973		if (!new_skb) {
 974			ip_rt_put(rt);
 975			dev->stats.tx_dropped++;
 976			kfree_skb(skb);
 977			return NETDEV_TX_OK;
 978		}
 979		if (skb->sk)
 980			skb_set_owner_w(new_skb, skb->sk);
 981		dev_kfree_skb(skb);
 982		skb = new_skb;
 983		iph6 = ipv6_hdr(skb);
 984	}
 985	ttl = tiph->ttl;
 986	if (ttl == 0)
 987		ttl = iph6->hop_limit;
 988	tos = INET_ECN_encapsulate(tos, ipv6_get_dsfield(iph6));
 989
 990	if (ip_tunnel_encap(skb, tunnel, &protocol, &fl4) < 0) {
 991		ip_rt_put(rt);
 992		goto tx_error;
 993	}
 994
 995	skb_set_inner_ipproto(skb, IPPROTO_IPV6);
 996
 997	iptunnel_xmit(NULL, rt, skb, fl4.saddr, fl4.daddr, protocol, tos, ttl,
 998		      df, !net_eq(tunnel->net, dev_net(dev)));
 999	return NETDEV_TX_OK;
1000
1001tx_error_icmp:
1002	dst_link_failure(skb);
1003tx_error:
1004	kfree_skb(skb);
1005	dev->stats.tx_errors++;
1006	return NETDEV_TX_OK;
1007}
1008
1009static netdev_tx_t sit_tunnel_xmit__(struct sk_buff *skb,
1010				     struct net_device *dev, u8 ipproto)
1011{
1012	struct ip_tunnel *tunnel = netdev_priv(dev);
1013	const struct iphdr  *tiph = &tunnel->parms.iph;
1014
1015	if (iptunnel_handle_offloads(skb, SKB_GSO_IPXIP4))
1016		goto tx_error;
1017
1018	skb_set_inner_ipproto(skb, ipproto);
1019
1020	ip_tunnel_xmit(skb, dev, tiph, ipproto);
1021	return NETDEV_TX_OK;
1022tx_error:
1023	kfree_skb(skb);
1024	dev->stats.tx_errors++;
1025	return NETDEV_TX_OK;
1026}
1027
1028static netdev_tx_t sit_tunnel_xmit(struct sk_buff *skb,
1029				   struct net_device *dev)
1030{
1031	if (!pskb_inet_may_pull(skb))
1032		goto tx_err;
1033
1034	switch (skb->protocol) {
1035	case htons(ETH_P_IP):
1036		sit_tunnel_xmit__(skb, dev, IPPROTO_IPIP);
1037		break;
1038	case htons(ETH_P_IPV6):
1039		ipip6_tunnel_xmit(skb, dev);
1040		break;
1041#if IS_ENABLED(CONFIG_MPLS)
1042	case htons(ETH_P_MPLS_UC):
1043		sit_tunnel_xmit__(skb, dev, IPPROTO_MPLS);
1044		break;
1045#endif
1046	default:
1047		goto tx_err;
1048	}
1049
1050	return NETDEV_TX_OK;
1051
1052tx_err:
1053	dev->stats.tx_errors++;
1054	kfree_skb(skb);
1055	return NETDEV_TX_OK;
1056
1057}
1058
1059static void ipip6_tunnel_bind_dev(struct net_device *dev)
1060{
 
 
1061	struct net_device *tdev = NULL;
1062	struct ip_tunnel *tunnel;
1063	const struct iphdr *iph;
1064	struct flowi4 fl4;
1065
1066	tunnel = netdev_priv(dev);
1067	iph = &tunnel->parms.iph;
1068
1069	if (iph->daddr) {
1070		struct rtable *rt = ip_route_output_ports(tunnel->net, &fl4,
1071							  NULL,
1072							  iph->daddr, iph->saddr,
1073							  0, 0,
1074							  IPPROTO_IPV6,
1075							  RT_TOS(iph->tos),
1076							  tunnel->parms.link);
1077
1078		if (!IS_ERR(rt)) {
1079			tdev = rt->dst.dev;
1080			ip_rt_put(rt);
1081		}
1082		dev->flags |= IFF_POINTOPOINT;
1083	}
1084
1085	if (!tdev && tunnel->parms.link)
1086		tdev = __dev_get_by_index(tunnel->net, tunnel->parms.link);
1087
1088	if (tdev && !netif_is_l3_master(tdev)) {
1089		int t_hlen = tunnel->hlen + sizeof(struct iphdr);
1090
1091		dev->hard_header_len = tdev->hard_header_len + sizeof(struct iphdr);
1092		dev->mtu = tdev->mtu - t_hlen;
1093		if (dev->mtu < IPV6_MIN_MTU)
1094			dev->mtu = IPV6_MIN_MTU;
 
1095	}
 
1096}
1097
1098static void ipip6_tunnel_update(struct ip_tunnel *t, struct ip_tunnel_parm *p,
 
1099				__u32 fwmark)
1100{
1101	struct net *net = t->net;
1102	struct sit_net *sitn = net_generic(net, sit_net_id);
1103
1104	ipip6_tunnel_unlink(sitn, t);
1105	synchronize_net();
1106	t->parms.iph.saddr = p->iph.saddr;
1107	t->parms.iph.daddr = p->iph.daddr;
1108	memcpy(t->dev->dev_addr, &p->iph.saddr, 4);
1109	memcpy(t->dev->broadcast, &p->iph.daddr, 4);
1110	ipip6_tunnel_link(sitn, t);
1111	t->parms.iph.ttl = p->iph.ttl;
1112	t->parms.iph.tos = p->iph.tos;
1113	t->parms.iph.frag_off = p->iph.frag_off;
1114	if (t->parms.link != p->link || t->fwmark != fwmark) {
1115		t->parms.link = p->link;
1116		t->fwmark = fwmark;
1117		ipip6_tunnel_bind_dev(t->dev);
1118	}
1119	dst_cache_reset(&t->dst_cache);
1120	netdev_state_change(t->dev);
1121}
1122
1123#ifdef CONFIG_IPV6_SIT_6RD
1124static int ipip6_tunnel_update_6rd(struct ip_tunnel *t,
1125				   struct ip_tunnel_6rd *ip6rd)
1126{
1127	struct in6_addr prefix;
1128	__be32 relay_prefix;
1129
1130	if (ip6rd->relay_prefixlen > 32 ||
1131	    ip6rd->prefixlen + (32 - ip6rd->relay_prefixlen) > 64)
1132		return -EINVAL;
1133
1134	ipv6_addr_prefix(&prefix, &ip6rd->prefix, ip6rd->prefixlen);
1135	if (!ipv6_addr_equal(&prefix, &ip6rd->prefix))
1136		return -EINVAL;
1137	if (ip6rd->relay_prefixlen)
1138		relay_prefix = ip6rd->relay_prefix &
1139			       htonl(0xffffffffUL <<
1140				     (32 - ip6rd->relay_prefixlen));
1141	else
1142		relay_prefix = 0;
1143	if (relay_prefix != ip6rd->relay_prefix)
1144		return -EINVAL;
1145
1146	t->ip6rd.prefix = prefix;
1147	t->ip6rd.relay_prefix = relay_prefix;
1148	t->ip6rd.prefixlen = ip6rd->prefixlen;
1149	t->ip6rd.relay_prefixlen = ip6rd->relay_prefixlen;
1150	dst_cache_reset(&t->dst_cache);
1151	netdev_state_change(t->dev);
1152	return 0;
1153}
1154#endif
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1155
1156static bool ipip6_valid_ip_proto(u8 ipproto)
1157{
1158	return ipproto == IPPROTO_IPV6 ||
1159		ipproto == IPPROTO_IPIP ||
1160#if IS_ENABLED(CONFIG_MPLS)
1161		ipproto == IPPROTO_MPLS ||
1162#endif
1163		ipproto == 0;
1164}
1165
1166static int
1167ipip6_tunnel_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1168{
1169	int err = 0;
1170	struct ip_tunnel_parm p;
1171	struct ip_tunnel_prl prl;
1172	struct ip_tunnel *t = netdev_priv(dev);
1173	struct net *net = t->net;
1174	struct sit_net *sitn = net_generic(net, sit_net_id);
1175#ifdef CONFIG_IPV6_SIT_6RD
1176	struct ip_tunnel_6rd ip6rd;
1177#endif
1178
1179	switch (cmd) {
1180	case SIOCGETTUNNEL:
1181#ifdef CONFIG_IPV6_SIT_6RD
1182	case SIOCGET6RD:
1183#endif
1184		if (dev == sitn->fb_tunnel_dev) {
1185			if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) {
1186				err = -EFAULT;
1187				break;
1188			}
1189			t = ipip6_tunnel_locate(net, &p, 0);
1190			if (!t)
1191				t = netdev_priv(dev);
1192		}
1193
1194		err = -EFAULT;
1195		if (cmd == SIOCGETTUNNEL) {
1196			memcpy(&p, &t->parms, sizeof(p));
1197			if (copy_to_user(ifr->ifr_ifru.ifru_data, &p,
1198					 sizeof(p)))
1199				goto done;
1200#ifdef CONFIG_IPV6_SIT_6RD
 
1201		} else {
1202			ip6rd.prefix = t->ip6rd.prefix;
1203			ip6rd.relay_prefix = t->ip6rd.relay_prefix;
1204			ip6rd.prefixlen = t->ip6rd.prefixlen;
1205			ip6rd.relay_prefixlen = t->ip6rd.relay_prefixlen;
1206			if (copy_to_user(ifr->ifr_ifru.ifru_data, &ip6rd,
1207					 sizeof(ip6rd)))
1208				goto done;
1209#endif
1210		}
1211		err = 0;
1212		break;
1213
1214	case SIOCADDTUNNEL:
1215	case SIOCCHGTUNNEL:
1216		err = -EPERM;
1217		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
1218			goto done;
1219
1220		err = -EFAULT;
1221		if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
1222			goto done;
1223
1224		err = -EINVAL;
1225		if (!ipip6_valid_ip_proto(p.iph.protocol))
1226			goto done;
1227		if (p.iph.version != 4 ||
1228		    p.iph.ihl != 5 || (p.iph.frag_off&htons(~IP_DF)))
1229			goto done;
1230		if (p.iph.ttl)
1231			p.iph.frag_off |= htons(IP_DF);
1232
1233		t = ipip6_tunnel_locate(net, &p, cmd == SIOCADDTUNNEL);
1234
1235		if (dev != sitn->fb_tunnel_dev && cmd == SIOCCHGTUNNEL) {
1236			if (t) {
1237				if (t->dev != dev) {
1238					err = -EEXIST;
1239					break;
1240				}
1241			} else {
1242				if (((dev->flags&IFF_POINTOPOINT) && !p.iph.daddr) ||
1243				    (!(dev->flags&IFF_POINTOPOINT) && p.iph.daddr)) {
1244					err = -EINVAL;
1245					break;
1246				}
1247				t = netdev_priv(dev);
1248			}
1249
1250			ipip6_tunnel_update(t, &p, t->fwmark);
1251		}
1252
1253		if (t) {
1254			err = 0;
1255			if (copy_to_user(ifr->ifr_ifru.ifru_data, &t->parms, sizeof(p)))
1256				err = -EFAULT;
1257		} else
1258			err = (cmd == SIOCADDTUNNEL ? -ENOBUFS : -ENOENT);
1259		break;
 
 
 
 
1260
 
 
 
 
 
 
 
 
 
 
 
1261	case SIOCDELTUNNEL:
1262		err = -EPERM;
1263		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
1264			goto done;
1265
1266		if (dev == sitn->fb_tunnel_dev) {
1267			err = -EFAULT;
1268			if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
1269				goto done;
1270			err = -ENOENT;
1271			t = ipip6_tunnel_locate(net, &p, 0);
1272			if (!t)
1273				goto done;
1274			err = -EPERM;
1275			if (t == netdev_priv(sitn->fb_tunnel_dev))
1276				goto done;
1277			dev = t->dev;
1278		}
1279		unregister_netdevice(dev);
1280		err = 0;
1281		break;
1282
 
 
 
 
 
 
 
 
 
 
1283	case SIOCGETPRL:
1284		err = -EINVAL;
1285		if (dev == sitn->fb_tunnel_dev)
1286			goto done;
1287		err = ipip6_tunnel_get_prl(t, ifr->ifr_ifru.ifru_data);
1288		break;
1289
1290	case SIOCADDPRL:
1291	case SIOCDELPRL:
1292	case SIOCCHGPRL:
1293		err = -EPERM;
1294		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
1295			goto done;
1296		err = -EINVAL;
1297		if (dev == sitn->fb_tunnel_dev)
1298			goto done;
1299		err = -EFAULT;
1300		if (copy_from_user(&prl, ifr->ifr_ifru.ifru_data, sizeof(prl)))
1301			goto done;
1302
1303		switch (cmd) {
1304		case SIOCDELPRL:
1305			err = ipip6_tunnel_del_prl(t, &prl);
1306			break;
1307		case SIOCADDPRL:
1308		case SIOCCHGPRL:
1309			err = ipip6_tunnel_add_prl(t, &prl, cmd == SIOCCHGPRL);
1310			break;
1311		}
1312		dst_cache_reset(&t->dst_cache);
1313		netdev_state_change(dev);
1314		break;
1315
1316#ifdef CONFIG_IPV6_SIT_6RD
 
 
1317	case SIOCADD6RD:
1318	case SIOCCHG6RD:
1319	case SIOCDEL6RD:
1320		err = -EPERM;
1321		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
1322			goto done;
1323
1324		err = -EFAULT;
1325		if (copy_from_user(&ip6rd, ifr->ifr_ifru.ifru_data,
1326				   sizeof(ip6rd)))
1327			goto done;
1328
1329		if (cmd != SIOCDEL6RD) {
1330			err = ipip6_tunnel_update_6rd(t, &ip6rd);
1331			if (err < 0)
1332				goto done;
1333		} else
1334			ipip6_tunnel_clone_6rd(dev, sitn);
1335
1336		err = 0;
1337		break;
1338#endif
1339
1340	default:
1341		err = -EINVAL;
1342	}
1343
1344done:
1345	return err;
1346}
1347
1348static const struct net_device_ops ipip6_netdev_ops = {
1349	.ndo_init	= ipip6_tunnel_init,
1350	.ndo_uninit	= ipip6_tunnel_uninit,
1351	.ndo_start_xmit	= sit_tunnel_xmit,
1352	.ndo_do_ioctl	= ipip6_tunnel_ioctl,
1353	.ndo_get_stats64 = ip_tunnel_get_stats64,
1354	.ndo_get_iflink = ip_tunnel_get_iflink,
 
1355};
1356
1357static void ipip6_dev_free(struct net_device *dev)
1358{
1359	struct ip_tunnel *tunnel = netdev_priv(dev);
1360
1361	dst_cache_destroy(&tunnel->dst_cache);
1362	free_percpu(dev->tstats);
1363}
1364
1365#define SIT_FEATURES (NETIF_F_SG	   | \
1366		      NETIF_F_FRAGLIST	   | \
1367		      NETIF_F_HIGHDMA	   | \
1368		      NETIF_F_GSO_SOFTWARE | \
1369		      NETIF_F_HW_CSUM)
1370
1371static void ipip6_tunnel_setup(struct net_device *dev)
1372{
1373	struct ip_tunnel *tunnel = netdev_priv(dev);
1374	int t_hlen = tunnel->hlen + sizeof(struct iphdr);
1375
1376	dev->netdev_ops		= &ipip6_netdev_ops;
 
1377	dev->needs_free_netdev	= true;
1378	dev->priv_destructor	= ipip6_dev_free;
1379
1380	dev->type		= ARPHRD_SIT;
1381	dev->hard_header_len	= LL_MAX_HEADER + t_hlen;
1382	dev->mtu		= ETH_DATA_LEN - t_hlen;
1383	dev->min_mtu		= IPV6_MIN_MTU;
1384	dev->max_mtu		= IP6_MAX_MTU - t_hlen;
1385	dev->flags		= IFF_NOARP;
1386	netif_keep_dst(dev);
1387	dev->addr_len		= 4;
1388	dev->features		|= NETIF_F_LLTX;
1389	dev->features		|= SIT_FEATURES;
1390	dev->hw_features	|= SIT_FEATURES;
 
 
1391}
1392
1393static int ipip6_tunnel_init(struct net_device *dev)
1394{
1395	struct ip_tunnel *tunnel = netdev_priv(dev);
1396	int err;
1397
1398	tunnel->dev = dev;
1399	tunnel->net = dev_net(dev);
1400	strcpy(tunnel->parms.name, dev->name);
1401
1402	ipip6_tunnel_bind_dev(dev);
1403	dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
1404	if (!dev->tstats)
1405		return -ENOMEM;
1406
1407	err = dst_cache_init(&tunnel->dst_cache, GFP_KERNEL);
1408	if (err) {
1409		free_percpu(dev->tstats);
1410		dev->tstats = NULL;
1411		return err;
1412	}
1413
 
 
1414	return 0;
1415}
1416
1417static void __net_init ipip6_fb_tunnel_init(struct net_device *dev)
1418{
1419	struct ip_tunnel *tunnel = netdev_priv(dev);
1420	struct iphdr *iph = &tunnel->parms.iph;
1421	struct net *net = dev_net(dev);
1422	struct sit_net *sitn = net_generic(net, sit_net_id);
1423
1424	iph->version		= 4;
1425	iph->protocol		= IPPROTO_IPV6;
1426	iph->ihl		= 5;
1427	iph->ttl		= 64;
1428
1429	dev_hold(dev);
1430	rcu_assign_pointer(sitn->tunnels_wc[0], tunnel);
1431}
1432
1433static int ipip6_validate(struct nlattr *tb[], struct nlattr *data[],
1434			  struct netlink_ext_ack *extack)
1435{
1436	u8 proto;
1437
1438	if (!data || !data[IFLA_IPTUN_PROTO])
1439		return 0;
1440
1441	proto = nla_get_u8(data[IFLA_IPTUN_PROTO]);
1442	if (!ipip6_valid_ip_proto(proto))
1443		return -EINVAL;
1444
1445	return 0;
1446}
1447
1448static void ipip6_netlink_parms(struct nlattr *data[],
1449				struct ip_tunnel_parm *parms,
1450				__u32 *fwmark)
1451{
1452	memset(parms, 0, sizeof(*parms));
1453
1454	parms->iph.version = 4;
1455	parms->iph.protocol = IPPROTO_IPV6;
1456	parms->iph.ihl = 5;
1457	parms->iph.ttl = 64;
1458
1459	if (!data)
1460		return;
1461
1462	if (data[IFLA_IPTUN_LINK])
1463		parms->link = nla_get_u32(data[IFLA_IPTUN_LINK]);
1464
1465	if (data[IFLA_IPTUN_LOCAL])
1466		parms->iph.saddr = nla_get_be32(data[IFLA_IPTUN_LOCAL]);
1467
1468	if (data[IFLA_IPTUN_REMOTE])
1469		parms->iph.daddr = nla_get_be32(data[IFLA_IPTUN_REMOTE]);
1470
1471	if (data[IFLA_IPTUN_TTL]) {
1472		parms->iph.ttl = nla_get_u8(data[IFLA_IPTUN_TTL]);
1473		if (parms->iph.ttl)
1474			parms->iph.frag_off = htons(IP_DF);
1475	}
1476
1477	if (data[IFLA_IPTUN_TOS])
1478		parms->iph.tos = nla_get_u8(data[IFLA_IPTUN_TOS]);
1479
1480	if (!data[IFLA_IPTUN_PMTUDISC] || nla_get_u8(data[IFLA_IPTUN_PMTUDISC]))
1481		parms->iph.frag_off = htons(IP_DF);
1482
1483	if (data[IFLA_IPTUN_FLAGS])
1484		parms->i_flags = nla_get_be16(data[IFLA_IPTUN_FLAGS]);
1485
1486	if (data[IFLA_IPTUN_PROTO])
1487		parms->iph.protocol = nla_get_u8(data[IFLA_IPTUN_PROTO]);
1488
1489	if (data[IFLA_IPTUN_FWMARK])
1490		*fwmark = nla_get_u32(data[IFLA_IPTUN_FWMARK]);
1491}
1492
1493/* This function returns true when ENCAP attributes are present in the nl msg */
1494static bool ipip6_netlink_encap_parms(struct nlattr *data[],
1495				      struct ip_tunnel_encap *ipencap)
1496{
1497	bool ret = false;
1498
1499	memset(ipencap, 0, sizeof(*ipencap));
1500
1501	if (!data)
1502		return ret;
1503
1504	if (data[IFLA_IPTUN_ENCAP_TYPE]) {
1505		ret = true;
1506		ipencap->type = nla_get_u16(data[IFLA_IPTUN_ENCAP_TYPE]);
1507	}
1508
1509	if (data[IFLA_IPTUN_ENCAP_FLAGS]) {
1510		ret = true;
1511		ipencap->flags = nla_get_u16(data[IFLA_IPTUN_ENCAP_FLAGS]);
1512	}
1513
1514	if (data[IFLA_IPTUN_ENCAP_SPORT]) {
1515		ret = true;
1516		ipencap->sport = nla_get_be16(data[IFLA_IPTUN_ENCAP_SPORT]);
1517	}
1518
1519	if (data[IFLA_IPTUN_ENCAP_DPORT]) {
1520		ret = true;
1521		ipencap->dport = nla_get_be16(data[IFLA_IPTUN_ENCAP_DPORT]);
1522	}
1523
1524	return ret;
1525}
1526
1527#ifdef CONFIG_IPV6_SIT_6RD
1528/* This function returns true when 6RD attributes are present in the nl msg */
1529static bool ipip6_netlink_6rd_parms(struct nlattr *data[],
1530				    struct ip_tunnel_6rd *ip6rd)
1531{
1532	bool ret = false;
1533	memset(ip6rd, 0, sizeof(*ip6rd));
1534
1535	if (!data)
1536		return ret;
1537
1538	if (data[IFLA_IPTUN_6RD_PREFIX]) {
1539		ret = true;
1540		ip6rd->prefix = nla_get_in6_addr(data[IFLA_IPTUN_6RD_PREFIX]);
1541	}
1542
1543	if (data[IFLA_IPTUN_6RD_RELAY_PREFIX]) {
1544		ret = true;
1545		ip6rd->relay_prefix =
1546			nla_get_be32(data[IFLA_IPTUN_6RD_RELAY_PREFIX]);
1547	}
1548
1549	if (data[IFLA_IPTUN_6RD_PREFIXLEN]) {
1550		ret = true;
1551		ip6rd->prefixlen = nla_get_u16(data[IFLA_IPTUN_6RD_PREFIXLEN]);
1552	}
1553
1554	if (data[IFLA_IPTUN_6RD_RELAY_PREFIXLEN]) {
1555		ret = true;
1556		ip6rd->relay_prefixlen =
1557			nla_get_u16(data[IFLA_IPTUN_6RD_RELAY_PREFIXLEN]);
1558	}
1559
1560	return ret;
1561}
1562#endif
1563
1564static int ipip6_newlink(struct net *src_net, struct net_device *dev,
1565			 struct nlattr *tb[], struct nlattr *data[],
1566			 struct netlink_ext_ack *extack)
1567{
1568	struct net *net = dev_net(dev);
1569	struct ip_tunnel *nt;
1570	struct ip_tunnel_encap ipencap;
1571#ifdef CONFIG_IPV6_SIT_6RD
1572	struct ip_tunnel_6rd ip6rd;
1573#endif
1574	int err;
1575
1576	nt = netdev_priv(dev);
1577
1578	if (ipip6_netlink_encap_parms(data, &ipencap)) {
1579		err = ip_tunnel_encap_setup(nt, &ipencap);
1580		if (err < 0)
1581			return err;
1582	}
1583
1584	ipip6_netlink_parms(data, &nt->parms, &nt->fwmark);
1585
1586	if (ipip6_tunnel_locate(net, &nt->parms, 0))
1587		return -EEXIST;
1588
1589	err = ipip6_tunnel_create(dev);
1590	if (err < 0)
1591		return err;
1592
1593	if (tb[IFLA_MTU]) {
1594		u32 mtu = nla_get_u32(tb[IFLA_MTU]);
1595
1596		if (mtu >= IPV6_MIN_MTU &&
1597		    mtu <= IP6_MAX_MTU - dev->hard_header_len)
1598			dev->mtu = mtu;
1599	}
1600
1601#ifdef CONFIG_IPV6_SIT_6RD
1602	if (ipip6_netlink_6rd_parms(data, &ip6rd))
1603		err = ipip6_tunnel_update_6rd(nt, &ip6rd);
 
 
 
1604#endif
1605
1606	return err;
1607}
1608
1609static int ipip6_changelink(struct net_device *dev, struct nlattr *tb[],
1610			    struct nlattr *data[],
1611			    struct netlink_ext_ack *extack)
1612{
1613	struct ip_tunnel *t = netdev_priv(dev);
1614	struct ip_tunnel_parm p;
1615	struct ip_tunnel_encap ipencap;
 
1616	struct net *net = t->net;
1617	struct sit_net *sitn = net_generic(net, sit_net_id);
1618#ifdef CONFIG_IPV6_SIT_6RD
1619	struct ip_tunnel_6rd ip6rd;
1620#endif
1621	__u32 fwmark = t->fwmark;
1622	int err;
1623
1624	if (dev == sitn->fb_tunnel_dev)
1625		return -EINVAL;
1626
1627	if (ipip6_netlink_encap_parms(data, &ipencap)) {
1628		err = ip_tunnel_encap_setup(t, &ipencap);
1629		if (err < 0)
1630			return err;
1631	}
1632
1633	ipip6_netlink_parms(data, &p, &fwmark);
1634
1635	if (((dev->flags & IFF_POINTOPOINT) && !p.iph.daddr) ||
1636	    (!(dev->flags & IFF_POINTOPOINT) && p.iph.daddr))
1637		return -EINVAL;
1638
1639	t = ipip6_tunnel_locate(net, &p, 0);
1640
1641	if (t) {
1642		if (t->dev != dev)
1643			return -EEXIST;
1644	} else
1645		t = netdev_priv(dev);
1646
1647	ipip6_tunnel_update(t, &p, fwmark);
1648
1649#ifdef CONFIG_IPV6_SIT_6RD
1650	if (ipip6_netlink_6rd_parms(data, &ip6rd))
1651		return ipip6_tunnel_update_6rd(t, &ip6rd);
1652#endif
1653
1654	return 0;
1655}
1656
1657static size_t ipip6_get_size(const struct net_device *dev)
1658{
1659	return
1660		/* IFLA_IPTUN_LINK */
1661		nla_total_size(4) +
1662		/* IFLA_IPTUN_LOCAL */
1663		nla_total_size(4) +
1664		/* IFLA_IPTUN_REMOTE */
1665		nla_total_size(4) +
1666		/* IFLA_IPTUN_TTL */
1667		nla_total_size(1) +
1668		/* IFLA_IPTUN_TOS */
1669		nla_total_size(1) +
1670		/* IFLA_IPTUN_PMTUDISC */
1671		nla_total_size(1) +
1672		/* IFLA_IPTUN_FLAGS */
1673		nla_total_size(2) +
1674		/* IFLA_IPTUN_PROTO */
1675		nla_total_size(1) +
1676#ifdef CONFIG_IPV6_SIT_6RD
1677		/* IFLA_IPTUN_6RD_PREFIX */
1678		nla_total_size(sizeof(struct in6_addr)) +
1679		/* IFLA_IPTUN_6RD_RELAY_PREFIX */
1680		nla_total_size(4) +
1681		/* IFLA_IPTUN_6RD_PREFIXLEN */
1682		nla_total_size(2) +
1683		/* IFLA_IPTUN_6RD_RELAY_PREFIXLEN */
1684		nla_total_size(2) +
1685#endif
1686		/* IFLA_IPTUN_ENCAP_TYPE */
1687		nla_total_size(2) +
1688		/* IFLA_IPTUN_ENCAP_FLAGS */
1689		nla_total_size(2) +
1690		/* IFLA_IPTUN_ENCAP_SPORT */
1691		nla_total_size(2) +
1692		/* IFLA_IPTUN_ENCAP_DPORT */
1693		nla_total_size(2) +
1694		/* IFLA_IPTUN_FWMARK */
1695		nla_total_size(4) +
1696		0;
1697}
1698
1699static int ipip6_fill_info(struct sk_buff *skb, const struct net_device *dev)
1700{
1701	struct ip_tunnel *tunnel = netdev_priv(dev);
1702	struct ip_tunnel_parm *parm = &tunnel->parms;
1703
1704	if (nla_put_u32(skb, IFLA_IPTUN_LINK, parm->link) ||
1705	    nla_put_in_addr(skb, IFLA_IPTUN_LOCAL, parm->iph.saddr) ||
1706	    nla_put_in_addr(skb, IFLA_IPTUN_REMOTE, parm->iph.daddr) ||
1707	    nla_put_u8(skb, IFLA_IPTUN_TTL, parm->iph.ttl) ||
1708	    nla_put_u8(skb, IFLA_IPTUN_TOS, parm->iph.tos) ||
1709	    nla_put_u8(skb, IFLA_IPTUN_PMTUDISC,
1710		       !!(parm->iph.frag_off & htons(IP_DF))) ||
1711	    nla_put_u8(skb, IFLA_IPTUN_PROTO, parm->iph.protocol) ||
1712	    nla_put_be16(skb, IFLA_IPTUN_FLAGS, parm->i_flags) ||
 
1713	    nla_put_u32(skb, IFLA_IPTUN_FWMARK, tunnel->fwmark))
1714		goto nla_put_failure;
1715
1716#ifdef CONFIG_IPV6_SIT_6RD
1717	if (nla_put_in6_addr(skb, IFLA_IPTUN_6RD_PREFIX,
1718			     &tunnel->ip6rd.prefix) ||
1719	    nla_put_in_addr(skb, IFLA_IPTUN_6RD_RELAY_PREFIX,
1720			    tunnel->ip6rd.relay_prefix) ||
1721	    nla_put_u16(skb, IFLA_IPTUN_6RD_PREFIXLEN,
1722			tunnel->ip6rd.prefixlen) ||
1723	    nla_put_u16(skb, IFLA_IPTUN_6RD_RELAY_PREFIXLEN,
1724			tunnel->ip6rd.relay_prefixlen))
1725		goto nla_put_failure;
1726#endif
1727
1728	if (nla_put_u16(skb, IFLA_IPTUN_ENCAP_TYPE,
1729			tunnel->encap.type) ||
1730	    nla_put_be16(skb, IFLA_IPTUN_ENCAP_SPORT,
1731			tunnel->encap.sport) ||
1732	    nla_put_be16(skb, IFLA_IPTUN_ENCAP_DPORT,
1733			tunnel->encap.dport) ||
1734	    nla_put_u16(skb, IFLA_IPTUN_ENCAP_FLAGS,
1735			tunnel->encap.flags))
1736		goto nla_put_failure;
1737
1738	return 0;
1739
1740nla_put_failure:
1741	return -EMSGSIZE;
1742}
1743
1744static const struct nla_policy ipip6_policy[IFLA_IPTUN_MAX + 1] = {
1745	[IFLA_IPTUN_LINK]		= { .type = NLA_U32 },
1746	[IFLA_IPTUN_LOCAL]		= { .type = NLA_U32 },
1747	[IFLA_IPTUN_REMOTE]		= { .type = NLA_U32 },
1748	[IFLA_IPTUN_TTL]		= { .type = NLA_U8 },
1749	[IFLA_IPTUN_TOS]		= { .type = NLA_U8 },
1750	[IFLA_IPTUN_PMTUDISC]		= { .type = NLA_U8 },
1751	[IFLA_IPTUN_FLAGS]		= { .type = NLA_U16 },
1752	[IFLA_IPTUN_PROTO]		= { .type = NLA_U8 },
1753#ifdef CONFIG_IPV6_SIT_6RD
1754	[IFLA_IPTUN_6RD_PREFIX]		= { .len = sizeof(struct in6_addr) },
1755	[IFLA_IPTUN_6RD_RELAY_PREFIX]	= { .type = NLA_U32 },
1756	[IFLA_IPTUN_6RD_PREFIXLEN]	= { .type = NLA_U16 },
1757	[IFLA_IPTUN_6RD_RELAY_PREFIXLEN] = { .type = NLA_U16 },
1758#endif
1759	[IFLA_IPTUN_ENCAP_TYPE]		= { .type = NLA_U16 },
1760	[IFLA_IPTUN_ENCAP_FLAGS]	= { .type = NLA_U16 },
1761	[IFLA_IPTUN_ENCAP_SPORT]	= { .type = NLA_U16 },
1762	[IFLA_IPTUN_ENCAP_DPORT]	= { .type = NLA_U16 },
1763	[IFLA_IPTUN_FWMARK]		= { .type = NLA_U32 },
1764};
1765
1766static void ipip6_dellink(struct net_device *dev, struct list_head *head)
1767{
1768	struct net *net = dev_net(dev);
1769	struct sit_net *sitn = net_generic(net, sit_net_id);
1770
1771	if (dev != sitn->fb_tunnel_dev)
1772		unregister_netdevice_queue(dev, head);
1773}
1774
1775static struct rtnl_link_ops sit_link_ops __read_mostly = {
1776	.kind		= "sit",
1777	.maxtype	= IFLA_IPTUN_MAX,
1778	.policy		= ipip6_policy,
1779	.priv_size	= sizeof(struct ip_tunnel),
1780	.setup		= ipip6_tunnel_setup,
1781	.validate	= ipip6_validate,
1782	.newlink	= ipip6_newlink,
1783	.changelink	= ipip6_changelink,
1784	.get_size	= ipip6_get_size,
1785	.fill_info	= ipip6_fill_info,
1786	.dellink	= ipip6_dellink,
1787	.get_link_net	= ip_tunnel_get_link_net,
1788};
1789
1790static struct xfrm_tunnel sit_handler __read_mostly = {
1791	.handler	=	ipip6_rcv,
1792	.err_handler	=	ipip6_err,
1793	.priority	=	1,
1794};
1795
1796static struct xfrm_tunnel ipip_handler __read_mostly = {
1797	.handler	=	ipip_rcv,
1798	.err_handler	=	ipip6_err,
1799	.priority	=	2,
1800};
1801
1802#if IS_ENABLED(CONFIG_MPLS)
1803static struct xfrm_tunnel mplsip_handler __read_mostly = {
1804	.handler	=	mplsip_rcv,
1805	.err_handler	=	ipip6_err,
1806	.priority	=	2,
1807};
1808#endif
1809
1810static void __net_exit sit_destroy_tunnels(struct net *net,
1811					   struct list_head *head)
1812{
1813	struct sit_net *sitn = net_generic(net, sit_net_id);
1814	struct net_device *dev, *aux;
1815	int prio;
1816
1817	for_each_netdev_safe(net, dev, aux)
1818		if (dev->rtnl_link_ops == &sit_link_ops)
1819			unregister_netdevice_queue(dev, head);
1820
1821	for (prio = 1; prio < 4; prio++) {
1822		int h;
1823		for (h = 0; h < IP6_SIT_HASH_SIZE; h++) {
1824			struct ip_tunnel *t;
1825
1826			t = rtnl_dereference(sitn->tunnels[prio][h]);
1827			while (t) {
1828				/* If dev is in the same netns, it has already
1829				 * been added to the list by the previous loop.
1830				 */
1831				if (!net_eq(dev_net(t->dev), net))
1832					unregister_netdevice_queue(t->dev,
1833								   head);
1834				t = rtnl_dereference(t->next);
1835			}
1836		}
1837	}
1838}
1839
1840static int __net_init sit_init_net(struct net *net)
1841{
1842	struct sit_net *sitn = net_generic(net, sit_net_id);
1843	struct ip_tunnel *t;
1844	int err;
1845
1846	sitn->tunnels[0] = sitn->tunnels_wc;
1847	sitn->tunnels[1] = sitn->tunnels_l;
1848	sitn->tunnels[2] = sitn->tunnels_r;
1849	sitn->tunnels[3] = sitn->tunnels_r_l;
1850
1851	if (!net_has_fallback_tunnels(net))
1852		return 0;
1853
1854	sitn->fb_tunnel_dev = alloc_netdev(sizeof(struct ip_tunnel), "sit0",
1855					   NET_NAME_UNKNOWN,
1856					   ipip6_tunnel_setup);
1857	if (!sitn->fb_tunnel_dev) {
1858		err = -ENOMEM;
1859		goto err_alloc_dev;
1860	}
1861	dev_net_set(sitn->fb_tunnel_dev, net);
1862	sitn->fb_tunnel_dev->rtnl_link_ops = &sit_link_ops;
1863	/* FB netdevice is special: we have one, and only one per netns.
1864	 * Allowing to move it to another netns is clearly unsafe.
1865	 */
1866	sitn->fb_tunnel_dev->features |= NETIF_F_NETNS_LOCAL;
1867
1868	err = register_netdev(sitn->fb_tunnel_dev);
1869	if (err)
1870		goto err_reg_dev;
1871
1872	ipip6_tunnel_clone_6rd(sitn->fb_tunnel_dev, sitn);
1873	ipip6_fb_tunnel_init(sitn->fb_tunnel_dev);
1874
1875	t = netdev_priv(sitn->fb_tunnel_dev);
1876
1877	strcpy(t->parms.name, sitn->fb_tunnel_dev->name);
1878	return 0;
1879
1880err_reg_dev:
1881	ipip6_dev_free(sitn->fb_tunnel_dev);
1882	free_netdev(sitn->fb_tunnel_dev);
1883err_alloc_dev:
1884	return err;
1885}
1886
1887static void __net_exit sit_exit_batch_net(struct list_head *net_list)
 
1888{
1889	LIST_HEAD(list);
1890	struct net *net;
1891
1892	rtnl_lock();
1893	list_for_each_entry(net, net_list, exit_list)
1894		sit_destroy_tunnels(net, &list);
1895
1896	unregister_netdevice_many(&list);
1897	rtnl_unlock();
1898}
1899
1900static struct pernet_operations sit_net_ops = {
1901	.init = sit_init_net,
1902	.exit_batch = sit_exit_batch_net,
1903	.id   = &sit_net_id,
1904	.size = sizeof(struct sit_net),
1905};
1906
1907static void __exit sit_cleanup(void)
1908{
1909	rtnl_link_unregister(&sit_link_ops);
1910	xfrm4_tunnel_deregister(&sit_handler, AF_INET6);
1911	xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
1912#if IS_ENABLED(CONFIG_MPLS)
1913	xfrm4_tunnel_deregister(&mplsip_handler, AF_MPLS);
1914#endif
1915
1916	unregister_pernet_device(&sit_net_ops);
1917	rcu_barrier(); /* Wait for completion of call_rcu()'s */
1918}
1919
1920static int __init sit_init(void)
1921{
1922	int err;
1923
1924	pr_info("IPv6, IPv4 and MPLS over IPv4 tunneling driver\n");
1925
1926	err = register_pernet_device(&sit_net_ops);
1927	if (err < 0)
1928		return err;
1929	err = xfrm4_tunnel_register(&sit_handler, AF_INET6);
1930	if (err < 0) {
1931		pr_info("%s: can't register ip6ip4\n", __func__);
1932		goto xfrm_tunnel_failed;
1933	}
1934	err = xfrm4_tunnel_register(&ipip_handler, AF_INET);
1935	if (err < 0) {
1936		pr_info("%s: can't register ip4ip4\n", __func__);
1937		goto xfrm_tunnel4_failed;
1938	}
1939#if IS_ENABLED(CONFIG_MPLS)
1940	err = xfrm4_tunnel_register(&mplsip_handler, AF_MPLS);
1941	if (err < 0) {
1942		pr_info("%s: can't register mplsip\n", __func__);
1943		goto xfrm_tunnel_mpls_failed;
1944	}
1945#endif
1946	err = rtnl_link_register(&sit_link_ops);
1947	if (err < 0)
1948		goto rtnl_link_failed;
1949
1950out:
1951	return err;
1952
1953rtnl_link_failed:
1954#if IS_ENABLED(CONFIG_MPLS)
1955	xfrm4_tunnel_deregister(&mplsip_handler, AF_MPLS);
1956xfrm_tunnel_mpls_failed:
1957#endif
1958	xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
1959xfrm_tunnel4_failed:
1960	xfrm4_tunnel_deregister(&sit_handler, AF_INET6);
1961xfrm_tunnel_failed:
1962	unregister_pernet_device(&sit_net_ops);
1963	goto out;
1964}
1965
1966module_init(sit_init);
1967module_exit(sit_cleanup);
 
1968MODULE_LICENSE("GPL");
1969MODULE_ALIAS_RTNL_LINK("sit");
1970MODULE_ALIAS_NETDEV("sit0");