]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - net/ipv6/ip6_tunnel.c
net-next: remove useless union keyword
[mirror_ubuntu-zesty-kernel.git] / net / ipv6 / ip6_tunnel.c
CommitLineData
1da177e4 1/*
c4d3efaf 2 * IPv6 tunneling device
1da177e4
LT
3 * Linux INET6 implementation
4 *
5 * Authors:
1ab1457c 6 * Ville Nuorvala <vnuorval@tcs.hut.fi>
c4d3efaf 7 * Yasuyuki Kozakai <kozakai@linux-ipv6.org>
1da177e4 8 *
1da177e4 9 * Based on:
c4d3efaf 10 * linux/net/ipv6/sit.c and linux/net/ipv4/ipip.c
1da177e4
LT
11 *
12 * RFC 2473
13 *
14 * This program is free software; you can redistribute it and/or
15 * modify it under the terms of the GNU General Public License
16 * as published by the Free Software Foundation; either version
17 * 2 of the License, or (at your option) any later version.
18 *
19 */
20
1da177e4 21#include <linux/module.h>
4fc268d2 22#include <linux/capability.h>
1da177e4
LT
23#include <linux/errno.h>
24#include <linux/types.h>
25#include <linux/sockios.h>
c4d3efaf 26#include <linux/icmp.h>
1da177e4
LT
27#include <linux/if.h>
28#include <linux/in.h>
29#include <linux/ip.h>
30#include <linux/if_tunnel.h>
31#include <linux/net.h>
32#include <linux/in6.h>
33#include <linux/netdevice.h>
34#include <linux/if_arp.h>
35#include <linux/icmpv6.h>
36#include <linux/init.h>
37#include <linux/route.h>
38#include <linux/rtnetlink.h>
39#include <linux/netfilter_ipv6.h>
5a0e3ad6 40#include <linux/slab.h>
1da177e4
LT
41
42#include <asm/uaccess.h>
43#include <asm/atomic.h>
44
c4d3efaf 45#include <net/icmp.h>
1da177e4
LT
46#include <net/ip.h>
47#include <net/ipv6.h>
1da177e4
LT
48#include <net/ip6_route.h>
49#include <net/addrconf.h>
50#include <net/ip6_tunnel.h>
51#include <net/xfrm.h>
52#include <net/dsfield.h>
53#include <net/inet_ecn.h>
13eeb8e9
PE
54#include <net/net_namespace.h>
55#include <net/netns/generic.h>
1da177e4
LT
56
57MODULE_AUTHOR("Ville Nuorvala");
c4d3efaf 58MODULE_DESCRIPTION("IPv6 tunneling device");
1da177e4
LT
59MODULE_LICENSE("GPL");
60
61#define IPV6_TLV_TEL_DST_SIZE 8
62
63#ifdef IP6_TNL_DEBUG
0dc47877 64#define IP6_TNL_TRACE(x...) printk(KERN_DEBUG "%s:" x "\n", __func__)
1da177e4
LT
65#else
66#define IP6_TNL_TRACE(x...) do {;} while(0)
67#endif
68
69#define IPV6_TCLASS_MASK (IPV6_FLOWINFO_MASK & ~IPV6_FLOWLABEL_MASK)
c4d3efaf 70#define IPV6_TCLASS_SHIFT 20
1da177e4
LT
71
72#define HASH_SIZE 32
73
e69a4adc 74#define HASH(addr) ((__force u32)((addr)->s6_addr32[0] ^ (addr)->s6_addr32[1] ^ \
1ab1457c
YH
75 (addr)->s6_addr32[2] ^ (addr)->s6_addr32[3]) & \
76 (HASH_SIZE - 1))
1da177e4 77
1326c3d5 78static void ip6_tnl_dev_init(struct net_device *dev);
3144581c 79static void ip6_tnl_dev_setup(struct net_device *dev);
1da177e4 80
f99189b1 81static int ip6_tnl_net_id __read_mostly;
13eeb8e9 82struct ip6_tnl_net {
15820e12
PE
83 /* the IPv6 tunnel fallback device */
84 struct net_device *fb_tnl_dev;
3e6c9fb5
PE
85 /* lists for storing tunnels in use */
86 struct ip6_tnl *tnls_r_l[HASH_SIZE];
87 struct ip6_tnl *tnls_wc[1];
88 struct ip6_tnl **tnls[2];
13eeb8e9
PE
89};
90
2922bc8a
ED
91/*
92 * Locking : hash tables are protected by RCU and a spinlock
93 */
94static DEFINE_SPINLOCK(ip6_tnl_lock);
1da177e4
LT
95
96static inline struct dst_entry *ip6_tnl_dst_check(struct ip6_tnl *t)
97{
98 struct dst_entry *dst = t->dst_cache;
99
1ab1457c 100 if (dst && dst->obsolete &&
1da177e4
LT
101 dst->ops->check(dst, t->dst_cookie) == NULL) {
102 t->dst_cache = NULL;
103 dst_release(dst);
104 return NULL;
105 }
106
107 return dst;
108}
109
110static inline void ip6_tnl_dst_reset(struct ip6_tnl *t)
111{
112 dst_release(t->dst_cache);
113 t->dst_cache = NULL;
114}
115
116static inline void ip6_tnl_dst_store(struct ip6_tnl *t, struct dst_entry *dst)
117{
118 struct rt6_info *rt = (struct rt6_info *) dst;
119 t->dst_cookie = rt->rt6i_node ? rt->rt6i_node->fn_sernum : 0;
120 dst_release(t->dst_cache);
121 t->dst_cache = dst;
122}
123
124/**
3144581c 125 * ip6_tnl_lookup - fetch tunnel matching the end-point addresses
1ab1457c
YH
126 * @remote: the address of the tunnel exit-point
127 * @local: the address of the tunnel entry-point
1da177e4 128 *
1ab1457c 129 * Return:
1da177e4 130 * tunnel matching given end-points if found,
1ab1457c 131 * else fallback tunnel if its device is up,
1da177e4
LT
132 * else %NULL
133 **/
134
2922bc8a
ED
135#define for_each_ip6_tunnel_rcu(start) \
136 for (t = rcu_dereference(start); t; t = rcu_dereference(t->next))
137
1da177e4 138static struct ip6_tnl *
2dd02c89 139ip6_tnl_lookup(struct net *net, struct in6_addr *remote, struct in6_addr *local)
1da177e4
LT
140{
141 unsigned h0 = HASH(remote);
142 unsigned h1 = HASH(local);
143 struct ip6_tnl *t;
3e6c9fb5 144 struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
1da177e4 145
2922bc8a 146 for_each_ip6_tunnel_rcu(ip6n->tnls_r_l[h0 ^ h1]) {
1da177e4
LT
147 if (ipv6_addr_equal(local, &t->parms.laddr) &&
148 ipv6_addr_equal(remote, &t->parms.raddr) &&
149 (t->dev->flags & IFF_UP))
150 return t;
151 }
2922bc8a
ED
152 t = rcu_dereference(ip6n->tnls_wc[0]);
153 if (t && (t->dev->flags & IFF_UP))
1da177e4
LT
154 return t;
155
156 return NULL;
157}
158
159/**
3144581c 160 * ip6_tnl_bucket - get head of list matching given tunnel parameters
1ab1457c 161 * @p: parameters containing tunnel end-points
1da177e4
LT
162 *
163 * Description:
3144581c 164 * ip6_tnl_bucket() returns the head of the list matching the
1da177e4
LT
165 * &struct in6_addr entries laddr and raddr in @p.
166 *
1ab1457c 167 * Return: head of IPv6 tunnel list
1da177e4
LT
168 **/
169
170static struct ip6_tnl **
2dd02c89 171ip6_tnl_bucket(struct ip6_tnl_net *ip6n, struct ip6_tnl_parm *p)
1da177e4
LT
172{
173 struct in6_addr *remote = &p->raddr;
174 struct in6_addr *local = &p->laddr;
175 unsigned h = 0;
176 int prio = 0;
177
178 if (!ipv6_addr_any(remote) || !ipv6_addr_any(local)) {
179 prio = 1;
180 h = HASH(remote) ^ HASH(local);
181 }
3e6c9fb5 182 return &ip6n->tnls[prio][h];
1da177e4
LT
183}
184
185/**
3144581c 186 * ip6_tnl_link - add tunnel to hash table
1da177e4
LT
187 * @t: tunnel to be added
188 **/
189
190static void
2dd02c89 191ip6_tnl_link(struct ip6_tnl_net *ip6n, struct ip6_tnl *t)
1da177e4 192{
2dd02c89 193 struct ip6_tnl **tp = ip6_tnl_bucket(ip6n, &t->parms);
1da177e4 194
2922bc8a 195 spin_lock_bh(&ip6_tnl_lock);
1da177e4 196 t->next = *tp;
2922bc8a
ED
197 rcu_assign_pointer(*tp, t);
198 spin_unlock_bh(&ip6_tnl_lock);
1da177e4
LT
199}
200
201/**
3144581c 202 * ip6_tnl_unlink - remove tunnel from hash table
1da177e4
LT
203 * @t: tunnel to be removed
204 **/
205
206static void
2dd02c89 207ip6_tnl_unlink(struct ip6_tnl_net *ip6n, struct ip6_tnl *t)
1da177e4
LT
208{
209 struct ip6_tnl **tp;
210
2dd02c89 211 for (tp = ip6_tnl_bucket(ip6n, &t->parms); *tp; tp = &(*tp)->next) {
1da177e4 212 if (t == *tp) {
2922bc8a 213 spin_lock_bh(&ip6_tnl_lock);
1da177e4 214 *tp = t->next;
2922bc8a 215 spin_unlock_bh(&ip6_tnl_lock);
1da177e4
LT
216 break;
217 }
218 }
219}
220
221/**
222 * ip6_tnl_create() - create a new tunnel
223 * @p: tunnel parameters
224 * @pt: pointer to new tunnel
225 *
226 * Description:
227 * Create tunnel matching given parameters.
1ab1457c
YH
228 *
229 * Return:
567131a7 230 * created tunnel or NULL
1da177e4
LT
231 **/
232
2dd02c89 233static struct ip6_tnl *ip6_tnl_create(struct net *net, struct ip6_tnl_parm *p)
1da177e4
LT
234{
235 struct net_device *dev;
236 struct ip6_tnl *t;
237 char name[IFNAMSIZ];
238 int err;
2dd02c89 239 struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
1da177e4 240
34cc7ba6 241 if (p->name[0])
1da177e4 242 strlcpy(name, p->name, IFNAMSIZ);
34cc7ba6
PE
243 else
244 sprintf(name, "ip6tnl%%d");
245
3144581c 246 dev = alloc_netdev(sizeof (*t), name, ip6_tnl_dev_setup);
1da177e4 247 if (dev == NULL)
567131a7 248 goto failed;
1da177e4 249
554eb277
PE
250 dev_net_set(dev, net);
251
b37d428b
PE
252 if (strchr(name, '%')) {
253 if (dev_alloc_name(dev, name) < 0)
254 goto failed_free;
255 }
256
2941a486 257 t = netdev_priv(dev);
1da177e4 258 t->parms = *p;
20461c17 259 ip6_tnl_dev_init(dev);
1da177e4 260
b37d428b
PE
261 if ((err = register_netdevice(dev)) < 0)
262 goto failed_free;
263
1da177e4 264 dev_hold(dev);
2dd02c89 265 ip6_tnl_link(ip6n, t);
567131a7 266 return t;
b37d428b
PE
267
268failed_free:
269 free_netdev(dev);
567131a7
VN
270failed:
271 return NULL;
1da177e4
LT
272}
273
274/**
3144581c 275 * ip6_tnl_locate - find or create tunnel matching given parameters
1ab1457c 276 * @p: tunnel parameters
1da177e4
LT
277 * @create: != 0 if allowed to create new tunnel if no match found
278 *
279 * Description:
3144581c 280 * ip6_tnl_locate() first tries to locate an existing tunnel
1da177e4
LT
281 * based on @parms. If this is unsuccessful, but @create is set a new
282 * tunnel device is created and registered for use.
283 *
284 * Return:
567131a7 285 * matching tunnel or NULL
1da177e4
LT
286 **/
287
2dd02c89
PE
288static struct ip6_tnl *ip6_tnl_locate(struct net *net,
289 struct ip6_tnl_parm *p, int create)
1da177e4
LT
290{
291 struct in6_addr *remote = &p->raddr;
292 struct in6_addr *local = &p->laddr;
293 struct ip6_tnl *t;
2dd02c89 294 struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
1da177e4 295
2dd02c89 296 for (t = *ip6_tnl_bucket(ip6n, p); t; t = t->next) {
1da177e4 297 if (ipv6_addr_equal(local, &t->parms.laddr) &&
567131a7
VN
298 ipv6_addr_equal(remote, &t->parms.raddr))
299 return t;
1da177e4
LT
300 }
301 if (!create)
567131a7 302 return NULL;
2dd02c89 303 return ip6_tnl_create(net, p);
1da177e4
LT
304}
305
306/**
3144581c 307 * ip6_tnl_dev_uninit - tunnel device uninitializer
1da177e4 308 * @dev: the device to be destroyed
1ab1457c 309 *
1da177e4 310 * Description:
3144581c 311 * ip6_tnl_dev_uninit() removes tunnel from its list
1da177e4
LT
312 **/
313
314static void
3144581c 315ip6_tnl_dev_uninit(struct net_device *dev)
1da177e4 316{
2941a486 317 struct ip6_tnl *t = netdev_priv(dev);
2dd02c89
PE
318 struct net *net = dev_net(dev);
319 struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
1da177e4 320
15820e12 321 if (dev == ip6n->fb_tnl_dev) {
2922bc8a 322 spin_lock_bh(&ip6_tnl_lock);
3e6c9fb5 323 ip6n->tnls_wc[0] = NULL;
2922bc8a 324 spin_unlock_bh(&ip6_tnl_lock);
1da177e4 325 } else {
2dd02c89 326 ip6_tnl_unlink(ip6n, t);
1da177e4
LT
327 }
328 ip6_tnl_dst_reset(t);
329 dev_put(dev);
330}
331
332/**
333 * parse_tvl_tnl_enc_lim - handle encapsulation limit option
334 * @skb: received socket buffer
335 *
1ab1457c
YH
336 * Return:
337 * 0 if none was found,
1da177e4
LT
338 * else index to encapsulation limit
339 **/
340
341static __u16
342parse_tlv_tnl_enc_lim(struct sk_buff *skb, __u8 * raw)
343{
344 struct ipv6hdr *ipv6h = (struct ipv6hdr *) raw;
345 __u8 nexthdr = ipv6h->nexthdr;
346 __u16 off = sizeof (*ipv6h);
347
348 while (ipv6_ext_hdr(nexthdr) && nexthdr != NEXTHDR_NONE) {
349 __u16 optlen = 0;
350 struct ipv6_opt_hdr *hdr;
351 if (raw + off + sizeof (*hdr) > skb->data &&
352 !pskb_may_pull(skb, raw - skb->data + off + sizeof (*hdr)))
353 break;
354
355 hdr = (struct ipv6_opt_hdr *) (raw + off);
356 if (nexthdr == NEXTHDR_FRAGMENT) {
357 struct frag_hdr *frag_hdr = (struct frag_hdr *) hdr;
358 if (frag_hdr->frag_off)
359 break;
360 optlen = 8;
361 } else if (nexthdr == NEXTHDR_AUTH) {
362 optlen = (hdr->hdrlen + 2) << 2;
363 } else {
364 optlen = ipv6_optlen(hdr);
365 }
366 if (nexthdr == NEXTHDR_DEST) {
367 __u16 i = off + 2;
368 while (1) {
369 struct ipv6_tlv_tnl_enc_lim *tel;
370
371 /* No more room for encapsulation limit */
372 if (i + sizeof (*tel) > off + optlen)
373 break;
374
375 tel = (struct ipv6_tlv_tnl_enc_lim *) &raw[i];
376 /* return index of option if found and valid */
377 if (tel->type == IPV6_TLV_TNL_ENCAP_LIMIT &&
378 tel->length == 1)
379 return i;
380 /* else jump to next option */
381 if (tel->type)
382 i += tel->length + 2;
383 else
384 i++;
385 }
386 }
387 nexthdr = hdr->nexthdr;
388 off += optlen;
389 }
390 return 0;
391}
392
393/**
e490d1d8 394 * ip6_tnl_err - tunnel error handler
1da177e4
LT
395 *
396 * Description:
e490d1d8 397 * ip6_tnl_err() should handle errors in the tunnel according
1da177e4
LT
398 * to the specifications in RFC 2473.
399 **/
400
d2acc347 401static int
502b0935 402ip6_tnl_err(struct sk_buff *skb, __u8 ipproto, struct inet6_skb_parm *opt,
d5fdd6ba 403 u8 *type, u8 *code, int *msg, __u32 *info, int offset)
1da177e4
LT
404{
405 struct ipv6hdr *ipv6h = (struct ipv6hdr *) skb->data;
406 struct ip6_tnl *t;
407 int rel_msg = 0;
d5fdd6ba
BH
408 u8 rel_type = ICMPV6_DEST_UNREACH;
409 u8 rel_code = ICMPV6_ADDR_UNREACH;
1da177e4
LT
410 __u32 rel_info = 0;
411 __u16 len;
d2acc347 412 int err = -ENOENT;
1da177e4 413
1ab1457c
YH
414 /* If the packet doesn't contain the original IPv6 header we are
415 in trouble since we might need the source address for further
1da177e4
LT
416 processing of the error. */
417
2922bc8a 418 rcu_read_lock();
8704ca7e 419 if ((t = ip6_tnl_lookup(dev_net(skb->dev), &ipv6h->daddr,
2dd02c89 420 &ipv6h->saddr)) == NULL)
1da177e4
LT
421 goto out;
422
502b0935
YK
423 if (t->parms.proto != ipproto && t->parms.proto != 0)
424 goto out;
425
d2acc347
HX
426 err = 0;
427
e490d1d8 428 switch (*type) {
1da177e4
LT
429 __u32 teli;
430 struct ipv6_tlv_tnl_enc_lim *tel;
431 __u32 mtu;
432 case ICMPV6_DEST_UNREACH:
433 if (net_ratelimit())
434 printk(KERN_WARNING
435 "%s: Path to destination invalid "
436 "or inactive!\n", t->parms.name);
437 rel_msg = 1;
438 break;
439 case ICMPV6_TIME_EXCEED:
e490d1d8 440 if ((*code) == ICMPV6_EXC_HOPLIMIT) {
1da177e4
LT
441 if (net_ratelimit())
442 printk(KERN_WARNING
443 "%s: Too small hop limit or "
1ab1457c 444 "routing loop in tunnel!\n",
1da177e4
LT
445 t->parms.name);
446 rel_msg = 1;
447 }
448 break;
449 case ICMPV6_PARAMPROB:
107a5fe6 450 teli = 0;
e490d1d8 451 if ((*code) == ICMPV6_HDR_FIELD)
107a5fe6 452 teli = parse_tlv_tnl_enc_lim(skb, skb->data);
1da177e4 453
704eae1f 454 if (teli && teli == *info - 2) {
1da177e4
LT
455 tel = (struct ipv6_tlv_tnl_enc_lim *) &skb->data[teli];
456 if (tel->encap_limit == 0) {
457 if (net_ratelimit())
458 printk(KERN_WARNING
459 "%s: Too small encapsulation "
460 "limit or routing loop in "
461 "tunnel!\n", t->parms.name);
462 rel_msg = 1;
463 }
107a5fe6
VN
464 } else if (net_ratelimit()) {
465 printk(KERN_WARNING
466 "%s: Recipient unable to parse tunneled "
467 "packet!\n ", t->parms.name);
1da177e4
LT
468 }
469 break;
470 case ICMPV6_PKT_TOOBIG:
704eae1f 471 mtu = *info - offset;
1da177e4
LT
472 if (mtu < IPV6_MIN_MTU)
473 mtu = IPV6_MIN_MTU;
474 t->dev->mtu = mtu;
475
cc6cdac0 476 if ((len = sizeof (*ipv6h) + ntohs(ipv6h->payload_len)) > mtu) {
1da177e4
LT
477 rel_type = ICMPV6_PKT_TOOBIG;
478 rel_code = 0;
479 rel_info = mtu;
480 rel_msg = 1;
481 }
482 break;
483 }
e490d1d8
YK
484
485 *type = rel_type;
486 *code = rel_code;
487 *info = rel_info;
488 *msg = rel_msg;
489
490out:
2922bc8a 491 rcu_read_unlock();
e490d1d8
YK
492 return err;
493}
494
c4d3efaf
YK
495static int
496ip4ip6_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
d5fdd6ba 497 u8 type, u8 code, int offset, __be32 info)
c4d3efaf
YK
498{
499 int rel_msg = 0;
d5fdd6ba
BH
500 u8 rel_type = type;
501 u8 rel_code = code;
704eae1f 502 __u32 rel_info = ntohl(info);
c4d3efaf
YK
503 int err;
504 struct sk_buff *skb2;
505 struct iphdr *eiph;
506 struct flowi fl;
507 struct rtable *rt;
508
502b0935
YK
509 err = ip6_tnl_err(skb, IPPROTO_IPIP, opt, &rel_type, &rel_code,
510 &rel_msg, &rel_info, offset);
c4d3efaf
YK
511 if (err < 0)
512 return err;
513
514 if (rel_msg == 0)
515 return 0;
516
517 switch (rel_type) {
518 case ICMPV6_DEST_UNREACH:
519 if (rel_code != ICMPV6_ADDR_UNREACH)
520 return 0;
521 rel_type = ICMP_DEST_UNREACH;
522 rel_code = ICMP_HOST_UNREACH;
523 break;
524 case ICMPV6_PKT_TOOBIG:
525 if (rel_code != 0)
526 return 0;
527 rel_type = ICMP_DEST_UNREACH;
528 rel_code = ICMP_FRAG_NEEDED;
529 break;
530 default:
531 return 0;
532 }
533
534 if (!pskb_may_pull(skb, offset + sizeof(struct iphdr)))
535 return 0;
536
537 skb2 = skb_clone(skb, GFP_ATOMIC);
538 if (!skb2)
539 return 0;
540
adf30907
ED
541 skb_dst_drop(skb2);
542
c4d3efaf 543 skb_pull(skb2, offset);
c1d2bbe1 544 skb_reset_network_header(skb2);
eddc9ec5 545 eiph = ip_hdr(skb2);
c4d3efaf
YK
546
547 /* Try to guess incoming interface */
548 memset(&fl, 0, sizeof(fl));
549 fl.fl4_dst = eiph->saddr;
550 fl.fl4_tos = RT_TOS(eiph->tos);
551 fl.proto = IPPROTO_IPIP;
2f7f54b7 552 if (ip_route_output_key(dev_net(skb->dev), &rt, &fl))
c4d3efaf
YK
553 goto out;
554
d8d1f30b 555 skb2->dev = rt->dst.dev;
c4d3efaf
YK
556
557 /* route "incoming" packet */
558 if (rt->rt_flags & RTCF_LOCAL) {
559 ip_rt_put(rt);
560 rt = NULL;
561 fl.fl4_dst = eiph->daddr;
562 fl.fl4_src = eiph->saddr;
563 fl.fl4_tos = eiph->tos;
2f7f54b7 564 if (ip_route_output_key(dev_net(skb->dev), &rt, &fl) ||
d8d1f30b 565 rt->dst.dev->type != ARPHRD_TUNNEL) {
c4d3efaf
YK
566 ip_rt_put(rt);
567 goto out;
568 }
adf30907 569 skb_dst_set(skb2, (struct dst_entry *)rt);
c4d3efaf
YK
570 } else {
571 ip_rt_put(rt);
572 if (ip_route_input(skb2, eiph->daddr, eiph->saddr, eiph->tos,
573 skb2->dev) ||
adf30907 574 skb_dst(skb2)->dev->type != ARPHRD_TUNNEL)
c4d3efaf
YK
575 goto out;
576 }
577
578 /* change mtu on this route */
579 if (rel_type == ICMP_DEST_UNREACH && rel_code == ICMP_FRAG_NEEDED) {
adf30907 580 if (rel_info > dst_mtu(skb_dst(skb2)))
c4d3efaf
YK
581 goto out;
582
adf30907 583 skb_dst(skb2)->ops->update_pmtu(skb_dst(skb2), rel_info);
c4d3efaf
YK
584 }
585
704eae1f 586 icmp_send(skb2, rel_type, rel_code, htonl(rel_info));
c4d3efaf
YK
587
588out:
589 kfree_skb(skb2);
590 return 0;
591}
592
e490d1d8
YK
593static int
594ip6ip6_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
d5fdd6ba 595 u8 type, u8 code, int offset, __be32 info)
e490d1d8
YK
596{
597 int rel_msg = 0;
d5fdd6ba
BH
598 u8 rel_type = type;
599 u8 rel_code = code;
704eae1f 600 __u32 rel_info = ntohl(info);
e490d1d8
YK
601 int err;
602
502b0935
YK
603 err = ip6_tnl_err(skb, IPPROTO_IPV6, opt, &rel_type, &rel_code,
604 &rel_msg, &rel_info, offset);
e490d1d8
YK
605 if (err < 0)
606 return err;
607
608 if (rel_msg && pskb_may_pull(skb, offset + sizeof(struct ipv6hdr))) {
1da177e4
LT
609 struct rt6_info *rt;
610 struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
305d4b3c 611
1da177e4 612 if (!skb2)
e490d1d8 613 return 0;
1da177e4 614
adf30907 615 skb_dst_drop(skb2);
1da177e4 616 skb_pull(skb2, offset);
c1d2bbe1 617 skb_reset_network_header(skb2);
1da177e4
LT
618
619 /* Try to guess incoming interface */
2f7f54b7
PE
620 rt = rt6_lookup(dev_net(skb->dev), &ipv6_hdr(skb2)->saddr,
621 NULL, 0, 0);
1da177e4
LT
622
623 if (rt && rt->rt6i_dev)
624 skb2->dev = rt->rt6i_dev;
625
3ffe533c 626 icmpv6_send(skb2, rel_type, rel_code, rel_info);
1da177e4
LT
627
628 if (rt)
d8d1f30b 629 dst_release(&rt->dst);
1da177e4
LT
630
631 kfree_skb(skb2);
632 }
e490d1d8
YK
633
634 return 0;
1da177e4
LT
635}
636
c4d3efaf
YK
637static void ip4ip6_dscp_ecn_decapsulate(struct ip6_tnl *t,
638 struct ipv6hdr *ipv6h,
639 struct sk_buff *skb)
640{
641 __u8 dsfield = ipv6_get_dsfield(ipv6h) & ~INET_ECN_MASK;
642
643 if (t->parms.flags & IP6_TNL_F_RCV_DSCP_COPY)
eddc9ec5 644 ipv4_change_dsfield(ip_hdr(skb), INET_ECN_MASK, dsfield);
c4d3efaf
YK
645
646 if (INET_ECN_is_ce(dsfield))
eddc9ec5 647 IP_ECN_set_ce(ip_hdr(skb));
c4d3efaf
YK
648}
649
8359925b
YK
650static void ip6ip6_dscp_ecn_decapsulate(struct ip6_tnl *t,
651 struct ipv6hdr *ipv6h,
652 struct sk_buff *skb)
1da177e4 653{
8359925b 654 if (t->parms.flags & IP6_TNL_F_RCV_DSCP_COPY)
29bb43b4 655 ipv6_copy_dscp(ipv6_get_dsfield(ipv6h), ipv6_hdr(skb));
1da177e4 656
8359925b 657 if (INET_ECN_is_ce(ipv6_get_dsfield(ipv6h)))
0660e03f 658 IP6_ECN_set_ce(ipv6_hdr(skb));
1da177e4 659}
8359925b 660
f1a28eab 661/* called with rcu_read_lock() */
09c6bbf0
VN
662static inline int ip6_tnl_rcv_ctl(struct ip6_tnl *t)
663{
664 struct ip6_tnl_parm *p = &t->parms;
665 int ret = 0;
2f7f54b7 666 struct net *net = dev_net(t->dev);
09c6bbf0
VN
667
668 if (p->flags & IP6_TNL_F_CAP_RCV) {
1ab1457c 669 struct net_device *ldev = NULL;
09c6bbf0
VN
670
671 if (p->link)
f1a28eab 672 ldev = dev_get_by_index_rcu(net, p->link);
09c6bbf0
VN
673
674 if ((ipv6_addr_is_multicast(&p->laddr) ||
2f7f54b7
PE
675 likely(ipv6_chk_addr(net, &p->laddr, ldev, 0))) &&
676 likely(!ipv6_chk_addr(net, &p->raddr, NULL, 0)))
09c6bbf0
VN
677 ret = 1;
678
09c6bbf0
VN
679 }
680 return ret;
681}
1da177e4
LT
682
683/**
3144581c 684 * ip6_tnl_rcv - decapsulate IPv6 packet and retransmit it locally
1da177e4 685 * @skb: received socket buffer
8359925b
YK
686 * @protocol: ethernet protocol ID
687 * @dscp_ecn_decapsulate: the function to decapsulate DSCP code and ECN
1da177e4
LT
688 *
689 * Return: 0
690 **/
691
8359925b 692static int ip6_tnl_rcv(struct sk_buff *skb, __u16 protocol,
502b0935 693 __u8 ipproto,
8359925b
YK
694 void (*dscp_ecn_decapsulate)(struct ip6_tnl *t,
695 struct ipv6hdr *ipv6h,
696 struct sk_buff *skb))
1da177e4 697{
1da177e4 698 struct ip6_tnl *t;
0660e03f 699 struct ipv6hdr *ipv6h = ipv6_hdr(skb);
1da177e4 700
2922bc8a 701 rcu_read_lock();
1da177e4 702
8704ca7e 703 if ((t = ip6_tnl_lookup(dev_net(skb->dev), &ipv6h->saddr,
2dd02c89 704 &ipv6h->daddr)) != NULL) {
502b0935 705 if (t->parms.proto != ipproto && t->parms.proto != 0) {
2922bc8a 706 rcu_read_unlock();
502b0935
YK
707 goto discard;
708 }
709
1da177e4 710 if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb)) {
2922bc8a 711 rcu_read_unlock();
50fba2aa 712 goto discard;
1da177e4
LT
713 }
714
09c6bbf0 715 if (!ip6_tnl_rcv_ctl(t)) {
3dca02af 716 t->dev->stats.rx_dropped++;
2922bc8a 717 rcu_read_unlock();
1da177e4
LT
718 goto discard;
719 }
720 secpath_reset(skb);
b0e380b1 721 skb->mac_header = skb->network_header;
c1d2bbe1 722 skb_reset_network_header(skb);
8359925b 723 skb->protocol = htons(protocol);
1da177e4
LT
724 skb->pkt_type = PACKET_HOST;
725 memset(skb->cb, 0, sizeof(struct inet6_skb_parm));
8359925b 726
d19d56dd 727 skb_tunnel_rx(skb, t->dev);
8359925b 728
d19d56dd 729 dscp_ecn_decapsulate(t, ipv6h, skb);
1da177e4 730 netif_rx(skb);
2922bc8a 731 rcu_read_unlock();
1da177e4
LT
732 return 0;
733 }
2922bc8a 734 rcu_read_unlock();
1da177e4 735 return 1;
50fba2aa
HX
736
737discard:
738 kfree_skb(skb);
739 return 0;
1da177e4
LT
740}
741
c4d3efaf
YK
742static int ip4ip6_rcv(struct sk_buff *skb)
743{
502b0935
YK
744 return ip6_tnl_rcv(skb, ETH_P_IP, IPPROTO_IPIP,
745 ip4ip6_dscp_ecn_decapsulate);
c4d3efaf
YK
746}
747
8359925b
YK
748static int ip6ip6_rcv(struct sk_buff *skb)
749{
502b0935
YK
750 return ip6_tnl_rcv(skb, ETH_P_IPV6, IPPROTO_IPV6,
751 ip6ip6_dscp_ecn_decapsulate);
8359925b
YK
752}
753
6fb32dde
VN
754struct ipv6_tel_txoption {
755 struct ipv6_txoptions ops;
756 __u8 dst_opt[8];
757};
1da177e4 758
6fb32dde
VN
759static void init_tel_txopt(struct ipv6_tel_txoption *opt, __u8 encap_limit)
760{
761 memset(opt, 0, sizeof(struct ipv6_tel_txoption));
1da177e4 762
6fb32dde
VN
763 opt->dst_opt[2] = IPV6_TLV_TNL_ENCAP_LIMIT;
764 opt->dst_opt[3] = 1;
765 opt->dst_opt[4] = encap_limit;
766 opt->dst_opt[5] = IPV6_TLV_PADN;
767 opt->dst_opt[6] = 1;
1da177e4 768
6fb32dde
VN
769 opt->ops.dst0opt = (struct ipv6_opt_hdr *) opt->dst_opt;
770 opt->ops.opt_nflen = 8;
1da177e4
LT
771}
772
773/**
3144581c 774 * ip6_tnl_addr_conflict - compare packet addresses to tunnel's own
1da177e4 775 * @t: the outgoing tunnel device
1ab1457c 776 * @hdr: IPv6 header from the incoming packet
1da177e4
LT
777 *
778 * Description:
1ab1457c 779 * Avoid trivial tunneling loop by checking that tunnel exit-point
1da177e4
LT
780 * doesn't match source of incoming packet.
781 *
1ab1457c 782 * Return:
1da177e4
LT
783 * 1 if conflict,
784 * 0 else
785 **/
786
787static inline int
3144581c 788ip6_tnl_addr_conflict(struct ip6_tnl *t, struct ipv6hdr *hdr)
1da177e4
LT
789{
790 return ipv6_addr_equal(&t->parms.raddr, &hdr->saddr);
791}
792
09c6bbf0
VN
793static inline int ip6_tnl_xmit_ctl(struct ip6_tnl *t)
794{
795 struct ip6_tnl_parm *p = &t->parms;
796 int ret = 0;
2f7f54b7 797 struct net *net = dev_net(t->dev);
09c6bbf0 798
1ab1457c 799 if (p->flags & IP6_TNL_F_CAP_XMIT) {
09c6bbf0
VN
800 struct net_device *ldev = NULL;
801
f1a28eab 802 rcu_read_lock();
09c6bbf0 803 if (p->link)
f1a28eab 804 ldev = dev_get_by_index_rcu(net, p->link);
09c6bbf0 805
2f7f54b7 806 if (unlikely(!ipv6_chk_addr(net, &p->laddr, ldev, 0)))
09c6bbf0
VN
807 printk(KERN_WARNING
808 "%s xmit: Local address not yet configured!\n",
809 p->name);
810 else if (!ipv6_addr_is_multicast(&p->raddr) &&
2f7f54b7 811 unlikely(ipv6_chk_addr(net, &p->raddr, NULL, 0)))
09c6bbf0
VN
812 printk(KERN_WARNING
813 "%s xmit: Routing loop! "
814 "Remote address found on this node!\n",
815 p->name);
816 else
817 ret = 1;
f1a28eab 818 rcu_read_unlock();
09c6bbf0
VN
819 }
820 return ret;
821}
1da177e4 822/**
61ec2aec 823 * ip6_tnl_xmit2 - encapsulate packet and send
1da177e4 824 * @skb: the outgoing socket buffer
1ab1457c 825 * @dev: the outgoing tunnel device
61ec2aec
YK
826 * @dsfield: dscp code for outer header
827 * @fl: flow of tunneled packet
828 * @encap_limit: encapsulation limit
829 * @pmtu: Path MTU is stored if packet is too big
1da177e4
LT
830 *
831 * Description:
832 * Build new header and do some sanity checks on the packet before sending
833 * it.
834 *
1ab1457c 835 * Return:
c4d3efaf 836 * 0 on success
61ec2aec
YK
837 * -1 fail
838 * %-EMSGSIZE message too big. return mtu in this case.
1da177e4
LT
839 **/
840
61ec2aec
YK
841static int ip6_tnl_xmit2(struct sk_buff *skb,
842 struct net_device *dev,
843 __u8 dsfield,
844 struct flowi *fl,
845 int encap_limit,
846 __u32 *pmtu)
1da177e4 847{
52479b62 848 struct net *net = dev_net(dev);
2941a486 849 struct ip6_tnl *t = netdev_priv(dev);
3dca02af 850 struct net_device_stats *stats = &t->dev->stats;
0660e03f 851 struct ipv6hdr *ipv6h = ipv6_hdr(skb);
6fb32dde 852 struct ipv6_tel_txoption opt;
1da177e4
LT
853 struct dst_entry *dst;
854 struct net_device *tdev;
855 int mtu;
c2636b4d 856 unsigned int max_headroom = sizeof(struct ipv6hdr);
1da177e4 857 u8 proto;
61ec2aec 858 int err = -1;
1da177e4 859 int pkt_len;
1da177e4 860
1da177e4
LT
861 if ((dst = ip6_tnl_dst_check(t)) != NULL)
862 dst_hold(dst);
a57ebc90 863 else {
52479b62 864 dst = ip6_route_output(net, NULL, fl);
1da177e4 865
52479b62 866 if (dst->error || xfrm_lookup(net, &dst, fl, NULL, 0) < 0)
a57ebc90
PM
867 goto tx_err_link_failure;
868 }
1da177e4
LT
869
870 tdev = dst->dev;
871
872 if (tdev == dev) {
873 stats->collisions++;
874 if (net_ratelimit())
1ab1457c 875 printk(KERN_WARNING
1da177e4
LT
876 "%s: Local routing loop detected!\n",
877 t->parms.name);
878 goto tx_err_dst_release;
879 }
880 mtu = dst_mtu(dst) - sizeof (*ipv6h);
6fb32dde 881 if (encap_limit >= 0) {
1da177e4
LT
882 max_headroom += 8;
883 mtu -= 8;
884 }
885 if (mtu < IPV6_MIN_MTU)
886 mtu = IPV6_MIN_MTU;
adf30907
ED
887 if (skb_dst(skb))
888 skb_dst(skb)->ops->update_pmtu(skb_dst(skb), mtu);
1da177e4 889 if (skb->len > mtu) {
61ec2aec
YK
890 *pmtu = mtu;
891 err = -EMSGSIZE;
1da177e4
LT
892 goto tx_err_dst_release;
893 }
894
895 /*
896 * Okay, now see if we can stuff it in the buffer as-is.
897 */
898 max_headroom += LL_RESERVED_SPACE(tdev);
1ab1457c 899
cfbba49d
PM
900 if (skb_headroom(skb) < max_headroom || skb_shared(skb) ||
901 (skb_cloned(skb) && !skb_clone_writable(skb, 0))) {
1da177e4 902 struct sk_buff *new_skb;
1ab1457c 903
1da177e4
LT
904 if (!(new_skb = skb_realloc_headroom(skb, max_headroom)))
905 goto tx_err_dst_release;
906
907 if (skb->sk)
908 skb_set_owner_w(new_skb, skb->sk);
909 kfree_skb(skb);
910 skb = new_skb;
911 }
adf30907
ED
912 skb_dst_drop(skb);
913 skb_dst_set(skb, dst_clone(dst));
1da177e4 914
b0e380b1 915 skb->transport_header = skb->network_header;
1da177e4 916
61ec2aec 917 proto = fl->proto;
6fb32dde
VN
918 if (encap_limit >= 0) {
919 init_tel_txopt(&opt, encap_limit);
920 ipv6_push_nfrag_opts(skb, &opt.ops, &proto, NULL);
921 }
e2d1bca7
ACM
922 skb_push(skb, sizeof(struct ipv6hdr));
923 skb_reset_network_header(skb);
0660e03f 924 ipv6h = ipv6_hdr(skb);
61ec2aec 925 *(__be32*)ipv6h = fl->fl6_flowlabel | htonl(0x60000000);
1da177e4
LT
926 dsfield = INET_ECN_encapsulate(0, dsfield);
927 ipv6_change_dsfield(ipv6h, ~INET_ECN_MASK, dsfield);
1da177e4
LT
928 ipv6h->hop_limit = t->parms.hop_limit;
929 ipv6h->nexthdr = proto;
61ec2aec
YK
930 ipv6_addr_copy(&ipv6h->saddr, &fl->fl6_src);
931 ipv6_addr_copy(&ipv6h->daddr, &fl->fl6_dst);
1da177e4
LT
932 nf_reset(skb);
933 pkt_len = skb->len;
ef76bc23 934 err = ip6_local_out(skb);
1da177e4 935
b9df3cb8 936 if (net_xmit_eval(err) == 0) {
1da177e4
LT
937 stats->tx_bytes += pkt_len;
938 stats->tx_packets++;
939 } else {
940 stats->tx_errors++;
941 stats->tx_aborted_errors++;
942 }
943 ip6_tnl_dst_store(t, dst);
1da177e4
LT
944 return 0;
945tx_err_link_failure:
946 stats->tx_carrier_errors++;
947 dst_link_failure(skb);
948tx_err_dst_release:
949 dst_release(dst);
61ec2aec
YK
950 return err;
951}
952
c4d3efaf
YK
953static inline int
954ip4ip6_tnl_xmit(struct sk_buff *skb, struct net_device *dev)
955{
956 struct ip6_tnl *t = netdev_priv(dev);
eddc9ec5 957 struct iphdr *iph = ip_hdr(skb);
c4d3efaf
YK
958 int encap_limit = -1;
959 struct flowi fl;
960 __u8 dsfield;
961 __u32 mtu;
962 int err;
963
502b0935
YK
964 if ((t->parms.proto != IPPROTO_IPIP && t->parms.proto != 0) ||
965 !ip6_tnl_xmit_ctl(t))
c4d3efaf
YK
966 return -1;
967
968 if (!(t->parms.flags & IP6_TNL_F_IGN_ENCAP_LIMIT))
969 encap_limit = t->parms.encap_limit;
970
971 memcpy(&fl, &t->fl, sizeof (fl));
972 fl.proto = IPPROTO_IPIP;
973
974 dsfield = ipv4_get_dsfield(iph);
975
976 if ((t->parms.flags & IP6_TNL_F_USE_ORIG_TCLASS))
b77f2fa6
AV
977 fl.fl6_flowlabel |= htonl((__u32)iph->tos << IPV6_TCLASS_SHIFT)
978 & IPV6_TCLASS_MASK;
c4d3efaf
YK
979
980 err = ip6_tnl_xmit2(skb, dev, dsfield, &fl, encap_limit, &mtu);
981 if (err != 0) {
982 /* XXX: send ICMP error even if DF is not set. */
983 if (err == -EMSGSIZE)
984 icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED,
985 htonl(mtu));
986 return -1;
987 }
988
989 return 0;
990}
991
61ec2aec
YK
992static inline int
993ip6ip6_tnl_xmit(struct sk_buff *skb, struct net_device *dev)
994{
995 struct ip6_tnl *t = netdev_priv(dev);
0660e03f 996 struct ipv6hdr *ipv6h = ipv6_hdr(skb);
61ec2aec
YK
997 int encap_limit = -1;
998 __u16 offset;
999 struct flowi fl;
1000 __u8 dsfield;
1001 __u32 mtu;
1002 int err;
1003
502b0935
YK
1004 if ((t->parms.proto != IPPROTO_IPV6 && t->parms.proto != 0) ||
1005 !ip6_tnl_xmit_ctl(t) || ip6_tnl_addr_conflict(t, ipv6h))
61ec2aec
YK
1006 return -1;
1007
d56f90a7
ACM
1008 offset = parse_tlv_tnl_enc_lim(skb, skb_network_header(skb));
1009 if (offset > 0) {
61ec2aec 1010 struct ipv6_tlv_tnl_enc_lim *tel;
d56f90a7 1011 tel = (struct ipv6_tlv_tnl_enc_lim *)&skb_network_header(skb)[offset];
61ec2aec
YK
1012 if (tel->encap_limit == 0) {
1013 icmpv6_send(skb, ICMPV6_PARAMPROB,
3ffe533c 1014 ICMPV6_HDR_FIELD, offset + 2);
61ec2aec
YK
1015 return -1;
1016 }
1017 encap_limit = tel->encap_limit - 1;
1018 } else if (!(t->parms.flags & IP6_TNL_F_IGN_ENCAP_LIMIT))
1019 encap_limit = t->parms.encap_limit;
1020
1021 memcpy(&fl, &t->fl, sizeof (fl));
1022 fl.proto = IPPROTO_IPV6;
1023
1024 dsfield = ipv6_get_dsfield(ipv6h);
1025 if ((t->parms.flags & IP6_TNL_F_USE_ORIG_TCLASS))
1026 fl.fl6_flowlabel |= (*(__be32 *) ipv6h & IPV6_TCLASS_MASK);
1027 if ((t->parms.flags & IP6_TNL_F_USE_ORIG_FLOWLABEL))
1028 fl.fl6_flowlabel |= (*(__be32 *) ipv6h & IPV6_FLOWLABEL_MASK);
1029
1030 err = ip6_tnl_xmit2(skb, dev, dsfield, &fl, encap_limit, &mtu);
1031 if (err != 0) {
1032 if (err == -EMSGSIZE)
3ffe533c 1033 icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
61ec2aec
YK
1034 return -1;
1035 }
1036
1037 return 0;
1038}
1039
6fef4c0c 1040static netdev_tx_t
61ec2aec
YK
1041ip6_tnl_xmit(struct sk_buff *skb, struct net_device *dev)
1042{
1043 struct ip6_tnl *t = netdev_priv(dev);
3dca02af 1044 struct net_device_stats *stats = &t->dev->stats;
61ec2aec
YK
1045 int ret;
1046
61ec2aec 1047 switch (skb->protocol) {
60678040 1048 case htons(ETH_P_IP):
c4d3efaf
YK
1049 ret = ip4ip6_tnl_xmit(skb, dev);
1050 break;
60678040 1051 case htons(ETH_P_IPV6):
61ec2aec
YK
1052 ret = ip6ip6_tnl_xmit(skb, dev);
1053 break;
1054 default:
1055 goto tx_err;
1056 }
1057
1058 if (ret < 0)
1059 goto tx_err;
1060
6ed10654 1061 return NETDEV_TX_OK;
61ec2aec 1062
1da177e4
LT
1063tx_err:
1064 stats->tx_errors++;
1065 stats->tx_dropped++;
1066 kfree_skb(skb);
6ed10654 1067 return NETDEV_TX_OK;
1da177e4
LT
1068}
1069
1070static void ip6_tnl_set_cap(struct ip6_tnl *t)
1071{
1072 struct ip6_tnl_parm *p = &t->parms;
09c6bbf0
VN
1073 int ltype = ipv6_addr_type(&p->laddr);
1074 int rtype = ipv6_addr_type(&p->raddr);
1da177e4
LT
1075
1076 p->flags &= ~(IP6_TNL_F_CAP_XMIT|IP6_TNL_F_CAP_RCV);
1077
09c6bbf0
VN
1078 if (ltype & (IPV6_ADDR_UNICAST|IPV6_ADDR_MULTICAST) &&
1079 rtype & (IPV6_ADDR_UNICAST|IPV6_ADDR_MULTICAST) &&
1080 !((ltype|rtype) & IPV6_ADDR_LOOPBACK) &&
305d4b3c 1081 (!((ltype|rtype) & IPV6_ADDR_LINKLOCAL) || p->link)) {
09c6bbf0
VN
1082 if (ltype&IPV6_ADDR_UNICAST)
1083 p->flags |= IP6_TNL_F_CAP_XMIT;
1084 if (rtype&IPV6_ADDR_UNICAST)
1085 p->flags |= IP6_TNL_F_CAP_RCV;
1da177e4
LT
1086 }
1087}
1088
3144581c 1089static void ip6_tnl_link_config(struct ip6_tnl *t)
1da177e4
LT
1090{
1091 struct net_device *dev = t->dev;
1092 struct ip6_tnl_parm *p = &t->parms;
1093 struct flowi *fl = &t->fl;
1094
3a6d54c5
JP
1095 memcpy(dev->dev_addr, &p->laddr, sizeof(struct in6_addr));
1096 memcpy(dev->broadcast, &p->raddr, sizeof(struct in6_addr));
1da177e4
LT
1097
1098 /* Set up flowi template */
1099 ipv6_addr_copy(&fl->fl6_src, &p->laddr);
1100 ipv6_addr_copy(&fl->fl6_dst, &p->raddr);
1101 fl->oif = p->link;
1102 fl->fl6_flowlabel = 0;
1103
1104 if (!(p->flags&IP6_TNL_F_USE_ORIG_TCLASS))
1105 fl->fl6_flowlabel |= IPV6_TCLASS_MASK & p->flowinfo;
1106 if (!(p->flags&IP6_TNL_F_USE_ORIG_FLOWLABEL))
1107 fl->fl6_flowlabel |= IPV6_FLOWLABEL_MASK & p->flowinfo;
1108
1109 ip6_tnl_set_cap(t);
1110
1111 if (p->flags&IP6_TNL_F_CAP_XMIT && p->flags&IP6_TNL_F_CAP_RCV)
1112 dev->flags |= IFF_POINTOPOINT;
1113 else
1114 dev->flags &= ~IFF_POINTOPOINT;
1115
1116 dev->iflink = p->link;
1117
1118 if (p->flags & IP6_TNL_F_CAP_XMIT) {
305d4b3c
VN
1119 int strict = (ipv6_addr_type(&p->raddr) &
1120 (IPV6_ADDR_MULTICAST|IPV6_ADDR_LINKLOCAL));
1121
2f7f54b7
PE
1122 struct rt6_info *rt = rt6_lookup(dev_net(dev),
1123 &p->raddr, &p->laddr,
305d4b3c 1124 p->link, strict);
1da177e4
LT
1125
1126 if (rt == NULL)
1127 return;
1128
1129 if (rt->rt6i_dev) {
1130 dev->hard_header_len = rt->rt6i_dev->hard_header_len +
1131 sizeof (struct ipv6hdr);
1132
1133 dev->mtu = rt->rt6i_dev->mtu - sizeof (struct ipv6hdr);
1134
1135 if (dev->mtu < IPV6_MIN_MTU)
1136 dev->mtu = IPV6_MIN_MTU;
1137 }
d8d1f30b 1138 dst_release(&rt->dst);
1da177e4
LT
1139 }
1140}
1141
1142/**
3144581c 1143 * ip6_tnl_change - update the tunnel parameters
1da177e4
LT
1144 * @t: tunnel to be changed
1145 * @p: tunnel configuration parameters
1da177e4
LT
1146 *
1147 * Description:
3144581c 1148 * ip6_tnl_change() updates the tunnel parameters
1da177e4
LT
1149 **/
1150
1151static int
3144581c 1152ip6_tnl_change(struct ip6_tnl *t, struct ip6_tnl_parm *p)
1da177e4
LT
1153{
1154 ipv6_addr_copy(&t->parms.laddr, &p->laddr);
1155 ipv6_addr_copy(&t->parms.raddr, &p->raddr);
1156 t->parms.flags = p->flags;
1157 t->parms.hop_limit = p->hop_limit;
1158 t->parms.encap_limit = p->encap_limit;
1159 t->parms.flowinfo = p->flowinfo;
8181b8c1 1160 t->parms.link = p->link;
502b0935 1161 t->parms.proto = p->proto;
0c088890 1162 ip6_tnl_dst_reset(t);
3144581c 1163 ip6_tnl_link_config(t);
1da177e4
LT
1164 return 0;
1165}
1166
1167/**
3144581c 1168 * ip6_tnl_ioctl - configure ipv6 tunnels from userspace
1da177e4
LT
1169 * @dev: virtual device associated with tunnel
1170 * @ifr: parameters passed from userspace
1171 * @cmd: command to be performed
1172 *
1173 * Description:
3144581c 1174 * ip6_tnl_ioctl() is used for managing IPv6 tunnels
1ab1457c 1175 * from userspace.
1da177e4
LT
1176 *
1177 * The possible commands are the following:
1178 * %SIOCGETTUNNEL: get tunnel parameters for device
1179 * %SIOCADDTUNNEL: add tunnel matching given tunnel parameters
1180 * %SIOCCHGTUNNEL: change tunnel parameters to those given
1181 * %SIOCDELTUNNEL: delete tunnel
1182 *
1ab1457c 1183 * The fallback device "ip6tnl0", created during module
1da177e4
LT
1184 * initialization, can be used for creating other tunnel devices.
1185 *
1186 * Return:
1187 * 0 on success,
1188 * %-EFAULT if unable to copy data to or from userspace,
1189 * %-EPERM if current process hasn't %CAP_NET_ADMIN set
1190 * %-EINVAL if passed tunnel parameters are invalid,
1191 * %-EEXIST if changing a tunnel's parameters would cause a conflict
1192 * %-ENODEV if attempting to change or delete a nonexisting device
1193 **/
1194
1195static int
3144581c 1196ip6_tnl_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
1da177e4
LT
1197{
1198 int err = 0;
1da177e4
LT
1199 struct ip6_tnl_parm p;
1200 struct ip6_tnl *t = NULL;
2dd02c89
PE
1201 struct net *net = dev_net(dev);
1202 struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
1da177e4
LT
1203
1204 switch (cmd) {
1205 case SIOCGETTUNNEL:
15820e12 1206 if (dev == ip6n->fb_tnl_dev) {
567131a7 1207 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof (p))) {
1da177e4
LT
1208 err = -EFAULT;
1209 break;
1210 }
2dd02c89 1211 t = ip6_tnl_locate(net, &p, 0);
567131a7
VN
1212 }
1213 if (t == NULL)
2941a486 1214 t = netdev_priv(dev);
1da177e4
LT
1215 memcpy(&p, &t->parms, sizeof (p));
1216 if (copy_to_user(ifr->ifr_ifru.ifru_data, &p, sizeof (p))) {
1217 err = -EFAULT;
1218 }
1219 break;
1220 case SIOCADDTUNNEL:
1221 case SIOCCHGTUNNEL:
1222 err = -EPERM;
1da177e4
LT
1223 if (!capable(CAP_NET_ADMIN))
1224 break;
567131a7
VN
1225 err = -EFAULT;
1226 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof (p)))
1da177e4 1227 break;
567131a7 1228 err = -EINVAL;
502b0935
YK
1229 if (p.proto != IPPROTO_IPV6 && p.proto != IPPROTO_IPIP &&
1230 p.proto != 0)
1da177e4 1231 break;
2dd02c89 1232 t = ip6_tnl_locate(net, &p, cmd == SIOCADDTUNNEL);
15820e12 1233 if (dev != ip6n->fb_tnl_dev && cmd == SIOCCHGTUNNEL) {
567131a7
VN
1234 if (t != NULL) {
1235 if (t->dev != dev) {
1236 err = -EEXIST;
1237 break;
1238 }
1239 } else
1240 t = netdev_priv(dev);
1241
2dd02c89 1242 ip6_tnl_unlink(ip6n, t);
3144581c 1243 err = ip6_tnl_change(t, &p);
2dd02c89 1244 ip6_tnl_link(ip6n, t);
1da177e4
LT
1245 netdev_state_change(dev);
1246 }
567131a7 1247 if (t) {
1da177e4 1248 err = 0;
567131a7
VN
1249 if (copy_to_user(ifr->ifr_ifru.ifru_data, &t->parms, sizeof (p)))
1250 err = -EFAULT;
1251
1252 } else
1253 err = (cmd == SIOCADDTUNNEL ? -ENOBUFS : -ENOENT);
1da177e4
LT
1254 break;
1255 case SIOCDELTUNNEL:
1256 err = -EPERM;
1257 if (!capable(CAP_NET_ADMIN))
1258 break;
1259
15820e12 1260 if (dev == ip6n->fb_tnl_dev) {
567131a7
VN
1261 err = -EFAULT;
1262 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof (p)))
1da177e4 1263 break;
567131a7 1264 err = -ENOENT;
2dd02c89 1265 if ((t = ip6_tnl_locate(net, &p, 0)) == NULL)
1da177e4 1266 break;
567131a7 1267 err = -EPERM;
15820e12 1268 if (t->dev == ip6n->fb_tnl_dev)
1da177e4 1269 break;
567131a7 1270 dev = t->dev;
1da177e4 1271 }
22f8cde5
SH
1272 err = 0;
1273 unregister_netdevice(dev);
1da177e4
LT
1274 break;
1275 default:
1276 err = -EINVAL;
1277 }
1278 return err;
1279}
1280
1da177e4 1281/**
3144581c 1282 * ip6_tnl_change_mtu - change mtu manually for tunnel device
1da177e4
LT
1283 * @dev: virtual device associated with tunnel
1284 * @new_mtu: the new mtu
1285 *
1286 * Return:
1287 * 0 on success,
1288 * %-EINVAL if mtu too small
1289 **/
1290
1291static int
3144581c 1292ip6_tnl_change_mtu(struct net_device *dev, int new_mtu)
1da177e4
LT
1293{
1294 if (new_mtu < IPV6_MIN_MTU) {
1295 return -EINVAL;
1296 }
1297 dev->mtu = new_mtu;
1298 return 0;
1299}
1300
1326c3d5
SH
1301
1302static const struct net_device_ops ip6_tnl_netdev_ops = {
1303 .ndo_uninit = ip6_tnl_dev_uninit,
1304 .ndo_start_xmit = ip6_tnl_xmit,
1305 .ndo_do_ioctl = ip6_tnl_ioctl,
1306 .ndo_change_mtu = ip6_tnl_change_mtu,
1307};
1308
1da177e4 1309/**
3144581c 1310 * ip6_tnl_dev_setup - setup virtual tunnel device
1da177e4
LT
1311 * @dev: virtual device associated with tunnel
1312 *
1313 * Description:
1314 * Initialize function pointers and device parameters
1315 **/
1316
3144581c 1317static void ip6_tnl_dev_setup(struct net_device *dev)
1da177e4 1318{
1326c3d5 1319 dev->netdev_ops = &ip6_tnl_netdev_ops;
1da177e4 1320 dev->destructor = free_netdev;
1da177e4
LT
1321
1322 dev->type = ARPHRD_TUNNEL6;
1323 dev->hard_header_len = LL_MAX_HEADER + sizeof (struct ipv6hdr);
1324 dev->mtu = ETH_DATA_LEN - sizeof (struct ipv6hdr);
1325 dev->flags |= IFF_NOARP;
1326 dev->addr_len = sizeof(struct in6_addr);
554eb277 1327 dev->features |= NETIF_F_NETNS_LOCAL;
1da177e4
LT
1328}
1329
1330
1331/**
3144581c 1332 * ip6_tnl_dev_init_gen - general initializer for all tunnel devices
1da177e4
LT
1333 * @dev: virtual device associated with tunnel
1334 **/
1335
1336static inline void
3144581c 1337ip6_tnl_dev_init_gen(struct net_device *dev)
1da177e4 1338{
2941a486 1339 struct ip6_tnl *t = netdev_priv(dev);
1da177e4
LT
1340 t->dev = dev;
1341 strcpy(t->parms.name, dev->name);
1342}
1343
1344/**
3144581c 1345 * ip6_tnl_dev_init - initializer for all non fallback tunnel devices
1da177e4
LT
1346 * @dev: virtual device associated with tunnel
1347 **/
1348
1326c3d5 1349static void ip6_tnl_dev_init(struct net_device *dev)
1da177e4 1350{
2941a486 1351 struct ip6_tnl *t = netdev_priv(dev);
3144581c
YK
1352 ip6_tnl_dev_init_gen(dev);
1353 ip6_tnl_link_config(t);
1da177e4
LT
1354}
1355
1356/**
3144581c 1357 * ip6_fb_tnl_dev_init - initializer for fallback tunnel device
1da177e4
LT
1358 * @dev: fallback device
1359 *
1360 * Return: 0
1361 **/
1362
2c8c1e72 1363static void __net_init ip6_fb_tnl_dev_init(struct net_device *dev)
1da177e4 1364{
2941a486 1365 struct ip6_tnl *t = netdev_priv(dev);
3e6c9fb5
PE
1366 struct net *net = dev_net(dev);
1367 struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
1368
3144581c 1369 ip6_tnl_dev_init_gen(dev);
502b0935 1370 t->parms.proto = IPPROTO_IPV6;
1da177e4 1371 dev_hold(dev);
3e6c9fb5 1372 ip6n->tnls_wc[0] = t;
1da177e4
LT
1373}
1374
c4d3efaf
YK
1375static struct xfrm6_tunnel ip4ip6_handler = {
1376 .handler = ip4ip6_rcv,
1377 .err_handler = ip4ip6_err,
1378 .priority = 1,
1379};
1380
1da177e4 1381static struct xfrm6_tunnel ip6ip6_handler = {
0303770d
PM
1382 .handler = ip6ip6_rcv,
1383 .err_handler = ip6ip6_err,
d2acc347 1384 .priority = 1,
1da177e4
LT
1385};
1386
2c8c1e72 1387static void __net_exit ip6_tnl_destroy_tunnels(struct ip6_tnl_net *ip6n)
3e6c9fb5
PE
1388{
1389 int h;
1390 struct ip6_tnl *t;
cf4432f5 1391 LIST_HEAD(list);
3e6c9fb5
PE
1392
1393 for (h = 0; h < HASH_SIZE; h++) {
cf4432f5
ED
1394 t = ip6n->tnls_r_l[h];
1395 while (t != NULL) {
1396 unregister_netdevice_queue(t->dev, &list);
1397 t = t->next;
1398 }
3e6c9fb5
PE
1399 }
1400
1401 t = ip6n->tnls_wc[0];
cf4432f5
ED
1402 unregister_netdevice_queue(t->dev, &list);
1403 unregister_netdevice_many(&list);
3e6c9fb5
PE
1404}
1405
2c8c1e72 1406static int __net_init ip6_tnl_init_net(struct net *net)
13eeb8e9 1407{
ac31cd3c 1408 struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
13eeb8e9 1409 int err;
13eeb8e9 1410
3e6c9fb5
PE
1411 ip6n->tnls[0] = ip6n->tnls_wc;
1412 ip6n->tnls[1] = ip6n->tnls_r_l;
1413
15820e12
PE
1414 err = -ENOMEM;
1415 ip6n->fb_tnl_dev = alloc_netdev(sizeof(struct ip6_tnl), "ip6tnl0",
1416 ip6_tnl_dev_setup);
1417
1418 if (!ip6n->fb_tnl_dev)
1419 goto err_alloc_dev;
be77e593 1420 dev_net_set(ip6n->fb_tnl_dev, net);
15820e12 1421
1326c3d5 1422 ip6_fb_tnl_dev_init(ip6n->fb_tnl_dev);
15820e12
PE
1423
1424 err = register_netdev(ip6n->fb_tnl_dev);
1425 if (err < 0)
1426 goto err_register;
13eeb8e9
PE
1427 return 0;
1428
15820e12
PE
1429err_register:
1430 free_netdev(ip6n->fb_tnl_dev);
1431err_alloc_dev:
13eeb8e9
PE
1432 return err;
1433}
1434
2c8c1e72 1435static void __net_exit ip6_tnl_exit_net(struct net *net)
13eeb8e9 1436{
ac31cd3c 1437 struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
13eeb8e9 1438
3e6c9fb5
PE
1439 rtnl_lock();
1440 ip6_tnl_destroy_tunnels(ip6n);
1441 rtnl_unlock();
13eeb8e9
PE
1442}
1443
1444static struct pernet_operations ip6_tnl_net_ops = {
1445 .init = ip6_tnl_init_net,
1446 .exit = ip6_tnl_exit_net,
ac31cd3c
EB
1447 .id = &ip6_tnl_net_id,
1448 .size = sizeof(struct ip6_tnl_net),
13eeb8e9
PE
1449};
1450
1da177e4
LT
1451/**
1452 * ip6_tunnel_init - register protocol and reserve needed resources
1453 *
1454 * Return: 0 on success
1455 **/
1456
1457static int __init ip6_tunnel_init(void)
1458{
1459 int err;
1460
d5aa407f
AD
1461 err = register_pernet_device(&ip6_tnl_net_ops);
1462 if (err < 0)
1463 goto out_pernet;
1464
1465 err = xfrm6_tunnel_register(&ip4ip6_handler, AF_INET);
1466 if (err < 0) {
3144581c 1467 printk(KERN_ERR "ip6_tunnel init: can't register ip4ip6\n");
d5aa407f 1468 goto out_ip4ip6;
c4d3efaf
YK
1469 }
1470
d5aa407f
AD
1471 err = xfrm6_tunnel_register(&ip6ip6_handler, AF_INET6);
1472 if (err < 0) {
3144581c 1473 printk(KERN_ERR "ip6_tunnel init: can't register ip6ip6\n");
d5aa407f 1474 goto out_ip6ip6;
1da177e4 1475 }
13eeb8e9 1476
1da177e4 1477 return 0;
d5aa407f
AD
1478
1479out_ip6ip6:
c4d3efaf 1480 xfrm6_tunnel_deregister(&ip4ip6_handler, AF_INET);
d5aa407f
AD
1481out_ip4ip6:
1482 unregister_pernet_device(&ip6_tnl_net_ops);
1483out_pernet:
1da177e4
LT
1484 return err;
1485}
1486
1487/**
1488 * ip6_tunnel_cleanup - free resources and unregister protocol
1489 **/
1490
1491static void __exit ip6_tunnel_cleanup(void)
1492{
c4d3efaf 1493 if (xfrm6_tunnel_deregister(&ip4ip6_handler, AF_INET))
3144581c 1494 printk(KERN_INFO "ip6_tunnel close: can't deregister ip4ip6\n");
c4d3efaf 1495
73d605d1 1496 if (xfrm6_tunnel_deregister(&ip6ip6_handler, AF_INET6))
3144581c 1497 printk(KERN_INFO "ip6_tunnel close: can't deregister ip6ip6\n");
1da177e4 1498
ac31cd3c 1499 unregister_pernet_device(&ip6_tnl_net_ops);
1da177e4
LT
1500}
1501
1502module_init(ip6_tunnel_init);
1503module_exit(ip6_tunnel_cleanup);