blob: e5a453ca302e1e55e4d8e6ca7069f97fbb2b6347 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * IPv6 over IPv4 tunnel device - Simple Internet Transition (SIT)
3 * Linux INET6 implementation
4 *
5 * Authors:
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +09006 * Pedro Roque <roque@di.fc.ul.pt>
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 * Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
8 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License
11 * as published by the Free Software Foundation; either version
12 * 2 of the License, or (at your option) any later version.
13 *
14 * Changes:
15 * Roger Venning <r.venning@telstra.com>: 6to4 support
16 * Nate Thompson <nate@thebog.net>: 6to4 support
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -040017 * Fred Templin <fred.l.templin@boeing.com>: isatap support
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 */
19
Joe Perchesf3213832012-05-15 14:11:53 +000020#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
21
Linus Torvalds1da177e2005-04-16 15:20:36 -070022#include <linux/module.h>
Randy Dunlap4fc268d2006-01-11 12:17:47 -080023#include <linux/capability.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024#include <linux/errno.h>
25#include <linux/types.h>
26#include <linux/socket.h>
27#include <linux/sockios.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070028#include <linux/net.h>
29#include <linux/in6.h>
30#include <linux/netdevice.h>
31#include <linux/if_arp.h>
32#include <linux/icmp.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090033#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034#include <asm/uaccess.h>
35#include <linux/init.h>
36#include <linux/netfilter_ipv4.h>
Kris Katterjohn46f25df2006-01-05 16:35:42 -080037#include <linux/if_ether.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070038
39#include <net/sock.h>
40#include <net/snmp.h>
41
42#include <net/ipv6.h>
43#include <net/protocol.h>
44#include <net/transp_v6.h>
45#include <net/ip6_fib.h>
46#include <net/ip6_route.h>
47#include <net/ndisc.h>
48#include <net/addrconf.h>
49#include <net/ip.h>
50#include <net/udp.h>
51#include <net/icmp.h>
Pravin B Shelarc5441932013-03-25 14:49:35 +000052#include <net/ip_tunnels.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070053#include <net/inet_ecn.h>
54#include <net/xfrm.h>
55#include <net/dsfield.h>
Pavel Emelyanov8190d902008-04-16 01:15:17 -070056#include <net/net_namespace.h>
57#include <net/netns/generic.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070058
59/*
60 This version of net/ipv6/sit.c is cloned of net/ipv4/ip_gre.c
61
62 For comments look at net/ipv4/ip_gre.c --ANK
63 */
64
65#define HASH_SIZE 16
Al Viroe69a4adc2006-11-14 20:56:00 -080066#define HASH(addr) (((__force u32)addr^((__force u32)addr>>4))&0xF)
Linus Torvalds1da177e2005-04-16 15:20:36 -070067
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +000068static bool log_ecn_error = true;
69module_param(log_ecn_error, bool, 0644);
70MODULE_PARM_DESC(log_ecn_error, "Log packets received with corrupted ECN");
71
Eric Dumazet15fc1f72010-09-27 00:38:18 +000072static int ipip6_tunnel_init(struct net_device *dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070073static void ipip6_tunnel_setup(struct net_device *dev);
Eric Dumazet15fc1f72010-09-27 00:38:18 +000074static void ipip6_dev_free(struct net_device *dev);
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +000075static bool check_6rd(struct ip_tunnel *tunnel, const struct in6_addr *v6dst,
76 __be32 *v4dst);
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +000077static struct rtnl_link_ops sit_link_ops __read_mostly;
Linus Torvalds1da177e2005-04-16 15:20:36 -070078
Eric Dumazetf99189b2009-11-17 10:42:49 +000079static int sit_net_id __read_mostly;
Pavel Emelyanov8190d902008-04-16 01:15:17 -070080struct sit_net {
Eric Dumazet3a43be32010-09-15 11:35:10 +000081 struct ip_tunnel __rcu *tunnels_r_l[HASH_SIZE];
82 struct ip_tunnel __rcu *tunnels_r[HASH_SIZE];
83 struct ip_tunnel __rcu *tunnels_l[HASH_SIZE];
84 struct ip_tunnel __rcu *tunnels_wc[1];
85 struct ip_tunnel __rcu **tunnels[4];
Pavel Emelyanov29182172008-04-16 01:16:38 -070086
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -070087 struct net_device *fb_tunnel_dev;
Pavel Emelyanov8190d902008-04-16 01:15:17 -070088};
89
Eric Dumazet4543c102009-10-23 17:52:14 +000090/*
91 * Must be invoked with rcu_read_lock
92 */
Eldad Zack3e866702012-04-01 07:49:01 +000093static struct ip_tunnel *ipip6_tunnel_lookup(struct net *net,
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +000094 struct net_device *dev, __be32 remote, __be32 local)
Linus Torvalds1da177e2005-04-16 15:20:36 -070095{
Eric Dumazet3a43be32010-09-15 11:35:10 +000096 unsigned int h0 = HASH(remote);
97 unsigned int h1 = HASH(local);
Linus Torvalds1da177e2005-04-16 15:20:36 -070098 struct ip_tunnel *t;
Pavel Emelyanov29182172008-04-16 01:16:38 -070099 struct sit_net *sitn = net_generic(net, sit_net_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Amerigo Wange086cad2012-11-11 21:52:34 +0000101 for_each_ip_tunnel_rcu(t, sitn->tunnels_r_l[h0 ^ h1]) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 if (local == t->parms.iph.saddr &&
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000103 remote == t->parms.iph.daddr &&
104 (!dev || !t->parms.link || dev->iflink == t->parms.link) &&
105 (t->dev->flags & IFF_UP))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106 return t;
107 }
Amerigo Wange086cad2012-11-11 21:52:34 +0000108 for_each_ip_tunnel_rcu(t, sitn->tunnels_r[h0]) {
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000109 if (remote == t->parms.iph.daddr &&
110 (!dev || !t->parms.link || dev->iflink == t->parms.link) &&
111 (t->dev->flags & IFF_UP))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112 return t;
113 }
Amerigo Wange086cad2012-11-11 21:52:34 +0000114 for_each_ip_tunnel_rcu(t, sitn->tunnels_l[h1]) {
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000115 if (local == t->parms.iph.saddr &&
116 (!dev || !t->parms.link || dev->iflink == t->parms.link) &&
117 (t->dev->flags & IFF_UP))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118 return t;
119 }
Eric Dumazet4543c102009-10-23 17:52:14 +0000120 t = rcu_dereference(sitn->tunnels_wc[0]);
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000121 if ((t != NULL) && (t->dev->flags & IFF_UP))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122 return t;
123 return NULL;
124}
125
Eric Dumazet3a43be32010-09-15 11:35:10 +0000126static struct ip_tunnel __rcu **__ipip6_bucket(struct sit_net *sitn,
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700127 struct ip_tunnel_parm *parms)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128{
YOSHIFUJI Hideaki420fe232007-04-24 20:44:47 +0900129 __be32 remote = parms->iph.daddr;
130 __be32 local = parms->iph.saddr;
Eric Dumazet3a43be32010-09-15 11:35:10 +0000131 unsigned int h = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132 int prio = 0;
133
134 if (remote) {
135 prio |= 2;
136 h ^= HASH(remote);
137 }
138 if (local) {
139 prio |= 1;
140 h ^= HASH(local);
141 }
Pavel Emelyanov29182172008-04-16 01:16:38 -0700142 return &sitn->tunnels[prio][h];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143}
144
Eric Dumazet3a43be32010-09-15 11:35:10 +0000145static inline struct ip_tunnel __rcu **ipip6_bucket(struct sit_net *sitn,
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700146 struct ip_tunnel *t)
YOSHIFUJI Hideaki420fe232007-04-24 20:44:47 +0900147{
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700148 return __ipip6_bucket(sitn, &t->parms);
YOSHIFUJI Hideaki420fe232007-04-24 20:44:47 +0900149}
150
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700151static void ipip6_tunnel_unlink(struct sit_net *sitn, struct ip_tunnel *t)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152{
Eric Dumazet3a43be32010-09-15 11:35:10 +0000153 struct ip_tunnel __rcu **tp;
154 struct ip_tunnel *iter;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155
Eric Dumazet3a43be32010-09-15 11:35:10 +0000156 for (tp = ipip6_bucket(sitn, t);
157 (iter = rtnl_dereference(*tp)) != NULL;
158 tp = &iter->next) {
159 if (t == iter) {
Eric Dumazetcf778b02012-01-12 04:41:32 +0000160 rcu_assign_pointer(*tp, t->next);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161 break;
162 }
163 }
164}
165
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700166static void ipip6_tunnel_link(struct sit_net *sitn, struct ip_tunnel *t)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167{
Eric Dumazet3a43be32010-09-15 11:35:10 +0000168 struct ip_tunnel __rcu **tp = ipip6_bucket(sitn, t);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169
Eric Dumazetcf778b02012-01-12 04:41:32 +0000170 rcu_assign_pointer(t->next, rtnl_dereference(*tp));
171 rcu_assign_pointer(*tp, t);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172}
173
YOSHIFUJI Hideaki / 吉藤英明e0c93942009-10-11 03:31:34 +0000174static void ipip6_tunnel_clone_6rd(struct net_device *dev, struct sit_net *sitn)
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000175{
176#ifdef CONFIG_IPV6_SIT_6RD
YOSHIFUJI Hideaki / 吉藤英明e0c93942009-10-11 03:31:34 +0000177 struct ip_tunnel *t = netdev_priv(dev);
178
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000179 if (t->dev == sitn->fb_tunnel_dev) {
180 ipv6_addr_set(&t->ip6rd.prefix, htonl(0x20020000), 0, 0, 0);
181 t->ip6rd.relay_prefix = 0;
182 t->ip6rd.prefixlen = 16;
183 t->ip6rd.relay_prefixlen = 0;
184 } else {
185 struct ip_tunnel *t0 = netdev_priv(sitn->fb_tunnel_dev);
186 memcpy(&t->ip6rd, &t0->ip6rd, sizeof(t->ip6rd));
187 }
188#endif
189}
190
Nicolas Dichtelf3723412012-11-14 05:14:07 +0000191static int ipip6_tunnel_create(struct net_device *dev)
192{
193 struct ip_tunnel *t = netdev_priv(dev);
194 struct net *net = dev_net(dev);
195 struct sit_net *sitn = net_generic(net, sit_net_id);
196 int err;
197
198 err = ipip6_tunnel_init(dev);
199 if (err < 0)
200 goto out;
201 ipip6_tunnel_clone_6rd(dev, sitn);
202
Nicolas Dichteld440b722012-11-15 04:06:41 +0000203 if ((__force u16)t->parms.i_flags & SIT_ISATAP)
Nicolas Dichtelf3723412012-11-14 05:14:07 +0000204 dev->priv_flags |= IFF_ISATAP;
205
206 err = register_netdevice(dev);
207 if (err < 0)
208 goto out;
209
210 strcpy(t->parms.name, dev->name);
211 dev->rtnl_link_ops = &sit_link_ops;
212
213 dev_hold(dev);
214
215 ipip6_tunnel_link(sitn, t);
216 return 0;
217
218out:
219 return err;
220}
221
Eric Dumazet3a43be32010-09-15 11:35:10 +0000222static struct ip_tunnel *ipip6_tunnel_locate(struct net *net,
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700223 struct ip_tunnel_parm *parms, int create)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224{
Al Viroe69a4adc2006-11-14 20:56:00 -0800225 __be32 remote = parms->iph.daddr;
226 __be32 local = parms->iph.saddr;
Eric Dumazet3a43be32010-09-15 11:35:10 +0000227 struct ip_tunnel *t, *nt;
228 struct ip_tunnel __rcu **tp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229 struct net_device *dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230 char name[IFNAMSIZ];
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700231 struct sit_net *sitn = net_generic(net, sit_net_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232
Eric Dumazet3a43be32010-09-15 11:35:10 +0000233 for (tp = __ipip6_bucket(sitn, parms);
234 (t = rtnl_dereference(*tp)) != NULL;
235 tp = &t->next) {
Sascha Hlusiak8db99e52009-05-19 12:56:48 +0000236 if (local == t->parms.iph.saddr &&
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000237 remote == t->parms.iph.daddr &&
238 parms->link == t->parms.link) {
Sascha Hlusiak8db99e52009-05-19 12:56:48 +0000239 if (create)
240 return NULL;
241 else
242 return t;
243 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700244 }
245 if (!create)
246 goto failed;
247
248 if (parms->name[0])
249 strlcpy(name, parms->name, IFNAMSIZ);
Pavel Emelyanov34cc7ba2008-02-23 20:19:20 -0800250 else
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000251 strcpy(name, "sit%d");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252
253 dev = alloc_netdev(sizeof(*t), name, ipip6_tunnel_setup);
254 if (dev == NULL)
255 return NULL;
256
Pavel Emelyanov7a971462008-04-16 01:17:18 -0700257 dev_net_set(dev, net);
258
Patrick McHardy2941a482006-01-08 22:05:26 -0800259 nt = netdev_priv(dev);
Stephen Hemminger1326c3d2008-11-20 20:33:56 -0800260
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261 nt->parms = *parms;
Nicolas Dichtelf3723412012-11-14 05:14:07 +0000262 if (ipip6_tunnel_create(dev) < 0)
Pavel Emelyanovb37d428b2008-02-26 23:51:04 -0800263 goto failed_free;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265 return nt;
266
Pavel Emelyanovb37d428b2008-02-26 23:51:04 -0800267failed_free:
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000268 ipip6_dev_free(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269failed:
270 return NULL;
271}
272
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000273#define for_each_prl_rcu(start) \
274 for (prl = rcu_dereference(start); \
275 prl; \
276 prl = rcu_dereference(prl->next))
277
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400278static struct ip_tunnel_prl_entry *
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900279__ipip6_tunnel_locate_prl(struct ip_tunnel *t, __be32 addr)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400280{
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000281 struct ip_tunnel_prl_entry *prl;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400282
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000283 for_each_prl_rcu(t->prl)
284 if (prl->addr == addr)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400285 break;
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000286 return prl;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400287
288}
289
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700290static int ipip6_tunnel_get_prl(struct ip_tunnel *t,
291 struct ip_tunnel_prl __user *a)
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900292{
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700293 struct ip_tunnel_prl kprl, *kp;
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900294 struct ip_tunnel_prl_entry *prl;
295 unsigned int cmax, c = 0, ca, len;
296 int ret = 0;
297
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700298 if (copy_from_user(&kprl, a, sizeof(kprl)))
299 return -EFAULT;
300 cmax = kprl.datalen / sizeof(kprl);
301 if (cmax > 1 && kprl.addr != htonl(INADDR_ANY))
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900302 cmax = 1;
303
304 /* For simple GET or for root users,
305 * we try harder to allocate.
306 */
307 kp = (cmax <= 1 || capable(CAP_NET_ADMIN)) ?
308 kcalloc(cmax, sizeof(*kp), GFP_KERNEL) :
309 NULL;
310
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000311 rcu_read_lock();
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900312
313 ca = t->prl_count < cmax ? t->prl_count : cmax;
314
315 if (!kp) {
316 /* We don't try hard to allocate much memory for
317 * non-root users.
318 * For root users, retry allocating enough memory for
319 * the answer.
320 */
321 kp = kcalloc(ca, sizeof(*kp), GFP_ATOMIC);
322 if (!kp) {
323 ret = -ENOMEM;
324 goto out;
325 }
326 }
327
328 c = 0;
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000329 for_each_prl_rcu(t->prl) {
Sascha Hlusiak298bf122009-09-29 11:27:05 +0000330 if (c >= cmax)
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900331 break;
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700332 if (kprl.addr != htonl(INADDR_ANY) && prl->addr != kprl.addr)
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900333 continue;
334 kp[c].addr = prl->addr;
335 kp[c].flags = prl->flags;
336 c++;
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700337 if (kprl.addr != htonl(INADDR_ANY))
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900338 break;
339 }
340out:
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000341 rcu_read_unlock();
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900342
343 len = sizeof(*kp) * c;
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700344 ret = 0;
345 if ((len && copy_to_user(a + 1, kp, len)) || put_user(len, &a->datalen))
346 ret = -EFAULT;
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900347
348 kfree(kp);
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900349
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700350 return ret;
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900351}
352
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400353static int
354ipip6_tunnel_add_prl(struct ip_tunnel *t, struct ip_tunnel_prl *a, int chg)
355{
356 struct ip_tunnel_prl_entry *p;
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900357 int err = 0;
358
YOSHIFUJI Hideaki0009ae12008-03-22 17:50:59 +0900359 if (a->addr == htonl(INADDR_ANY))
360 return -EINVAL;
361
Eric Dumazetaac4ddd2010-06-01 00:26:58 -0700362 ASSERT_RTNL();
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400363
Eric Dumazet3a43be32010-09-15 11:35:10 +0000364 for (p = rtnl_dereference(t->prl); p; p = rtnl_dereference(p->next)) {
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900365 if (p->addr == a->addr) {
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000366 if (chg) {
367 p->flags = a->flags;
368 goto out;
369 }
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900370 err = -EEXIST;
371 goto out;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400372 }
373 }
374
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900375 if (chg) {
376 err = -ENXIO;
377 goto out;
378 }
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400379
380 p = kzalloc(sizeof(struct ip_tunnel_prl_entry), GFP_KERNEL);
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900381 if (!p) {
382 err = -ENOBUFS;
383 goto out;
384 }
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400385
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400386 p->next = t->prl;
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900387 p->addr = a->addr;
388 p->flags = a->flags;
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000389 t->prl_count++;
Eric Dumazetcf778b02012-01-12 04:41:32 +0000390 rcu_assign_pointer(t->prl, p);
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900391out:
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900392 return err;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400393}
394
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000395static void prl_list_destroy_rcu(struct rcu_head *head)
396{
397 struct ip_tunnel_prl_entry *p, *n;
398
399 p = container_of(head, struct ip_tunnel_prl_entry, rcu_head);
400 do {
Eric Dumazet753ea8e2011-01-20 07:16:24 +0000401 n = rcu_dereference_protected(p->next, 1);
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000402 kfree(p);
403 p = n;
404 } while (p);
405}
406
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400407static int
408ipip6_tunnel_del_prl(struct ip_tunnel *t, struct ip_tunnel_prl *a)
409{
Eric Dumazet753ea8e2011-01-20 07:16:24 +0000410 struct ip_tunnel_prl_entry *x;
411 struct ip_tunnel_prl_entry __rcu **p;
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900412 int err = 0;
413
Eric Dumazetaac4ddd2010-06-01 00:26:58 -0700414 ASSERT_RTNL();
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400415
YOSHIFUJI Hideaki0009ae12008-03-22 17:50:59 +0900416 if (a && a->addr != htonl(INADDR_ANY)) {
Eric Dumazet753ea8e2011-01-20 07:16:24 +0000417 for (p = &t->prl;
418 (x = rtnl_dereference(*p)) != NULL;
419 p = &x->next) {
420 if (x->addr == a->addr) {
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400421 *p = x->next;
Paul E. McKenney11c476f2011-05-02 00:56:57 -0700422 kfree_rcu(x, rcu_head);
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900423 t->prl_count--;
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900424 goto out;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400425 }
426 }
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900427 err = -ENXIO;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400428 } else {
Eric Dumazet753ea8e2011-01-20 07:16:24 +0000429 x = rtnl_dereference(t->prl);
430 if (x) {
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000431 t->prl_count = 0;
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000432 call_rcu(&x->rcu_head, prl_list_destroy_rcu);
433 t->prl = NULL;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400434 }
435 }
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900436out:
Sascha Hlusiak4b27960172009-05-19 12:56:50 +0000437 return err;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400438}
439
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400440static int
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000441isatap_chksrc(struct sk_buff *skb, const struct iphdr *iph, struct ip_tunnel *t)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400442{
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900443 struct ip_tunnel_prl_entry *p;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400444 int ok = 1;
445
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000446 rcu_read_lock();
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900447 p = __ipip6_tunnel_locate_prl(t, iph->saddr);
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400448 if (p) {
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900449 if (p->flags & PRL_DEFAULT)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400450 skb->ndisc_nodetype = NDISC_NODETYPE_DEFAULT;
451 else
452 skb->ndisc_nodetype = NDISC_NODETYPE_NODEFAULT;
453 } else {
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000454 const struct in6_addr *addr6 = &ipv6_hdr(skb)->saddr;
455
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400456 if (ipv6_addr_is_isatap(addr6) &&
457 (addr6->s6_addr32[3] == iph->saddr) &&
YOSHIFUJI Hideaki52eeeb82008-03-15 22:54:23 -0400458 ipv6_chk_prefix(addr6, t->dev))
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400459 skb->ndisc_nodetype = NDISC_NODETYPE_HOST;
460 else
461 ok = 0;
462 }
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000463 rcu_read_unlock();
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400464 return ok;
465}
466
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467static void ipip6_tunnel_uninit(struct net_device *dev)
468{
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +0200469 struct ip_tunnel *tunnel = netdev_priv(dev);
470 struct sit_net *sitn = net_generic(tunnel->net, sit_net_id);
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700471
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -0700472 if (dev == sitn->fb_tunnel_dev) {
Stephen Hemmingera9b3cd72011-08-01 16:19:00 +0000473 RCU_INIT_POINTER(sitn->tunnels_wc[0], NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 } else {
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +0200475 ipip6_tunnel_unlink(sitn, tunnel);
476 ipip6_tunnel_del_prl(tunnel, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700477 }
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +0100478 ip_tunnel_dst_reset_all(tunnel);
Eric Dumazet3a43be32010-09-15 11:35:10 +0000479 dev_put(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480}
481
Oussama Ghorbelca15a072013-11-22 16:23:20 +0100482/* Generate icmpv6 with type/code ICMPV6_DEST_UNREACH/ICMPV6_ADDR_UNREACH
483 * if sufficient data bytes are available
484 */
485static int ipip6_err_gen_icmpv6_unreach(struct sk_buff *skb)
486{
487 const struct iphdr *iph = (const struct iphdr *) skb->data;
488 struct rt6_info *rt;
489 struct sk_buff *skb2;
490
491 if (!pskb_may_pull(skb, iph->ihl * 4 + sizeof(struct ipv6hdr) + 8))
492 return 1;
493
494 skb2 = skb_clone(skb, GFP_ATOMIC);
495
496 if (!skb2)
497 return 1;
498
499 skb_dst_drop(skb2);
500 skb_pull(skb2, iph->ihl * 4);
501 skb_reset_network_header(skb2);
502
503 rt = rt6_lookup(dev_net(skb->dev), &ipv6_hdr(skb2)->saddr, NULL, 0, 0);
504
505 if (rt && rt->dst.dev)
506 skb2->dev = rt->dst.dev;
507
508 icmpv6_send(skb2, ICMPV6_DEST_UNREACH, ICMPV6_ADDR_UNREACH, 0);
509
510 if (rt)
511 ip6_rt_put(rt);
512
513 kfree_skb(skb2);
514
515 return 0;
516}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800518static int ipip6_err(struct sk_buff *skb, u32 info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700519{
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000520 const struct iphdr *iph = (const struct iphdr *)skb->data;
Arnaldo Carvalho de Melo88c76642007-03-13 14:43:18 -0300521 const int type = icmp_hdr(skb)->type;
522 const int code = icmp_hdr(skb)->code;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523 struct ip_tunnel *t;
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800524 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700525
526 switch (type) {
527 default:
528 case ICMP_PARAMETERPROB:
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800529 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530
531 case ICMP_DEST_UNREACH:
532 switch (code) {
533 case ICMP_SR_FAILED:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534 /* Impossible event. */
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800535 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 default:
537 /* All others are translated to HOST_UNREACH.
538 rfc2003 contains "deep thoughts" about NET_UNREACH,
539 I believe they are just ether pollution. --ANK
540 */
541 break;
542 }
543 break;
544 case ICMP_TIME_EXCEEDED:
545 if (code != ICMP_EXC_TTL)
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800546 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547 break;
David S. Millerec18d9a2012-07-12 00:25:15 -0700548 case ICMP_REDIRECT:
549 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550 }
551
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800552 err = -ENOENT;
553
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000554 t = ipip6_tunnel_lookup(dev_net(skb->dev),
555 skb->dev,
556 iph->daddr,
557 iph->saddr);
David S. Miller36393392012-06-14 22:21:46 -0700558 if (t == NULL)
559 goto out;
560
561 if (type == ICMP_DEST_UNREACH && code == ICMP_FRAG_NEEDED) {
562 ipv4_update_pmtu(skb, dev_net(skb->dev), info,
563 t->dev->ifindex, 0, IPPROTO_IPV6, 0);
564 err = 0;
565 goto out;
566 }
David S. Millerec18d9a2012-07-12 00:25:15 -0700567 if (type == ICMP_REDIRECT) {
568 ipv4_redirect(skb, dev_net(skb->dev), t->dev->ifindex, 0,
569 IPPROTO_IPV6, 0);
570 err = 0;
571 goto out;
572 }
David S. Miller36393392012-06-14 22:21:46 -0700573
574 if (t->parms.iph.daddr == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575 goto out;
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800576
577 err = 0;
Oussama Ghorbelca15a072013-11-22 16:23:20 +0100578 if (!ipip6_err_gen_icmpv6_unreach(skb))
579 goto out;
580
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED)
582 goto out;
583
Wei Yongjunbb800872009-02-24 23:37:19 -0800584 if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585 t->err_count++;
586 else
587 t->err_count = 1;
588 t->err_time = jiffies;
589out:
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800590 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591}
592
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000593static inline bool is_spoofed_6rd(struct ip_tunnel *tunnel, const __be32 v4addr,
594 const struct in6_addr *v6addr)
595{
596 __be32 v4embed = 0;
597 if (check_6rd(tunnel, v6addr, &v4embed) && v4addr != v4embed)
598 return true;
599 return false;
600}
601
Catalin\(ux\) M. BOIE7df37ff2013-09-23 23:04:19 +0300602/* Checks if an address matches an address on the tunnel interface.
603 * Used to detect the NAT of proto 41 packets and let them pass spoofing test.
604 * Long story:
605 * This function is called after we considered the packet as spoofed
606 * in is_spoofed_6rd.
607 * We may have a router that is doing NAT for proto 41 packets
608 * for an internal station. Destination a.a.a.a/PREFIX:bbbb:bbbb
609 * will be translated to n.n.n.n/PREFIX:bbbb:bbbb. And is_spoofed_6rd
610 * function will return true, dropping the packet.
611 * But, we can still check if is spoofed against the IP
612 * addresses associated with the interface.
613 */
614static bool only_dnatted(const struct ip_tunnel *tunnel,
615 const struct in6_addr *v6dst)
616{
617 int prefix_len;
618
619#ifdef CONFIG_IPV6_SIT_6RD
620 prefix_len = tunnel->ip6rd.prefixlen + 32
621 - tunnel->ip6rd.relay_prefixlen;
622#else
623 prefix_len = 48;
624#endif
625 return ipv6_chk_custom_prefix(v6dst, prefix_len, tunnel->dev);
626}
627
628/* Returns true if a packet is spoofed */
629static bool packet_is_spoofed(struct sk_buff *skb,
630 const struct iphdr *iph,
631 struct ip_tunnel *tunnel)
632{
633 const struct ipv6hdr *ipv6h;
634
635 if (tunnel->dev->priv_flags & IFF_ISATAP) {
636 if (!isatap_chksrc(skb, iph, tunnel))
637 return true;
638
639 return false;
640 }
641
642 if (tunnel->dev->flags & IFF_POINTOPOINT)
643 return false;
644
645 ipv6h = ipv6_hdr(skb);
646
647 if (unlikely(is_spoofed_6rd(tunnel, iph->saddr, &ipv6h->saddr))) {
648 net_warn_ratelimited("Src spoofed %pI4/%pI6c -> %pI4/%pI6c\n",
649 &iph->saddr, &ipv6h->saddr,
650 &iph->daddr, &ipv6h->daddr);
651 return true;
652 }
653
654 if (likely(!is_spoofed_6rd(tunnel, iph->daddr, &ipv6h->daddr)))
655 return false;
656
657 if (only_dnatted(tunnel, &ipv6h->daddr))
658 return false;
659
660 net_warn_ratelimited("Dst spoofed %pI4/%pI6c -> %pI4/%pI6c\n",
661 &iph->saddr, &ipv6h->saddr,
662 &iph->daddr, &ipv6h->daddr);
663 return true;
664}
665
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666static int ipip6_rcv(struct sk_buff *skb)
667{
Hannes Frederic Sowa1ad759d2013-01-18 09:18:17 +0000668 const struct iphdr *iph = ip_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700669 struct ip_tunnel *tunnel;
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +0000670 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700671
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000672 tunnel = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
673 iph->saddr, iph->daddr);
674 if (tunnel != NULL) {
Li RongQing8f849852014-01-04 13:57:59 +0800675 struct pcpu_sw_netstats *tstats;
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000676
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000677 if (tunnel->parms.iph.protocol != IPPROTO_IPV6 &&
678 tunnel->parms.iph.protocol != 0)
679 goto out;
680
Arnaldo Carvalho de Melob0e380b2007-04-10 21:21:55 -0700681 skb->mac_header = skb->network_header;
Arnaldo Carvalho de Meloc1d2bbe2007-04-10 20:45:18 -0700682 skb_reset_network_header(skb);
Patrick McHardy8cdfab82006-01-06 23:04:01 -0800683 IPCB(skb)->flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684 skb->protocol = htons(ETH_P_IPV6);
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100685
Catalin\(ux\) M. BOIE7df37ff2013-09-23 23:04:19 +0300686 if (packet_is_spoofed(skb, iph, tunnel)) {
687 tunnel->dev->stats.rx_errors++;
688 goto out;
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +0000689 }
690
Nicolas Dichtelea231922013-09-02 15:34:58 +0200691 __skb_tunnel_rx(skb, tunnel->dev, tunnel->net);
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +0000692
693 err = IP_ECN_decapsulate(iph, skb);
694 if (unlikely(err)) {
695 if (log_ecn_error)
696 net_info_ratelimited("non-ECT from %pI4 with TOS=%#x\n",
697 &iph->saddr, iph->tos);
698 if (err > 1) {
699 ++tunnel->dev->stats.rx_frame_errors;
700 ++tunnel->dev->stats.rx_errors;
701 goto out;
702 }
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100703 }
Eric Dumazetd19d56d2010-05-17 22:36:55 -0700704
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000705 tstats = this_cpu_ptr(tunnel->dev->tstats);
Li RongQingc3ac17c2014-01-02 08:49:36 +0800706 u64_stats_update_begin(&tstats->syncp);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000707 tstats->rx_packets++;
708 tstats->rx_bytes += skb->len;
Li RongQingc3ac17c2014-01-02 08:49:36 +0800709 u64_stats_update_end(&tstats->syncp);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000710
Eric Dumazetcaf586e2010-09-30 21:06:55 +0000711 netif_rx(skb);
Eric Dumazet8990f462010-09-20 00:12:11 +0000712
Linus Torvalds1da177e2005-04-16 15:20:36 -0700713 return 0;
714 }
715
David McCullough6dcdd1b2010-11-29 19:32:34 +0000716 /* no tunnel matched, let upstream know, ipsec may handle it */
David McCullough6dcdd1b2010-11-29 19:32:34 +0000717 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700718out:
David S. Miller36ca34c2008-05-08 23:40:26 -0700719 kfree_skb(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700720 return 0;
721}
722
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000723static const struct tnl_ptk_info tpi = {
724 /* no tunnel info required for ipip. */
725 .proto = htons(ETH_P_IP),
726};
727
728static int ipip_rcv(struct sk_buff *skb)
729{
Pravin B Shelar3d7b46c2013-06-17 17:50:02 -0700730 const struct iphdr *iph;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000731 struct ip_tunnel *tunnel;
732
Pravin B Shelar3d7b46c2013-06-17 17:50:02 -0700733 iph = ip_hdr(skb);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000734 tunnel = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
735 iph->saddr, iph->daddr);
736 if (tunnel != NULL) {
737 if (tunnel->parms.iph.protocol != IPPROTO_IPIP &&
738 tunnel->parms.iph.protocol != 0)
739 goto drop;
740
741 if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb))
742 goto drop;
Li Hongjun737e8282013-08-28 11:54:50 +0200743 if (iptunnel_pull_header(skb, 0, tpi.proto))
744 goto drop;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000745 return ip_tunnel_rcv(tunnel, skb, &tpi, log_ecn_error);
746 }
747
748 return 1;
749
750drop:
751 kfree_skb(skb);
752 return 0;
753}
754
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000755/*
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000756 * If the IPv6 address comes from 6rd / 6to4 (RFC 3056) addr space this function
757 * stores the embedded IPv4 address in v4dst and returns true.
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000758 */
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000759static bool check_6rd(struct ip_tunnel *tunnel, const struct in6_addr *v6dst,
760 __be32 *v4dst)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761{
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000762#ifdef CONFIG_IPV6_SIT_6RD
763 if (ipv6_prefix_equal(v6dst, &tunnel->ip6rd.prefix,
764 tunnel->ip6rd.prefixlen)) {
Eric Dumazet3a43be32010-09-15 11:35:10 +0000765 unsigned int pbw0, pbi0;
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000766 int pbi1;
767 u32 d;
768
769 pbw0 = tunnel->ip6rd.prefixlen >> 5;
770 pbi0 = tunnel->ip6rd.prefixlen & 0x1f;
771
YOSHIFUJI Hideaki / 吉藤英明e7db38c2009-10-11 03:44:45 +0000772 d = (ntohl(v6dst->s6_addr32[pbw0]) << pbi0) >>
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000773 tunnel->ip6rd.relay_prefixlen;
774
775 pbi1 = pbi0 - tunnel->ip6rd.relay_prefixlen;
776 if (pbi1 > 0)
YOSHIFUJI Hideaki / 吉藤英明e7db38c2009-10-11 03:44:45 +0000777 d |= ntohl(v6dst->s6_addr32[pbw0 + 1]) >>
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000778 (32 - pbi1);
779
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000780 *v4dst = tunnel->ip6rd.relay_prefix | htonl(d);
781 return true;
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000782 }
783#else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700784 if (v6dst->s6_addr16[0] == htons(0x2002)) {
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900785 /* 6to4 v6 addr has 16 bits prefix, 32 v4addr, 16 SLA, ... */
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000786 memcpy(v4dst, &v6dst->s6_addr16[1], 4);
787 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788 }
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000789#endif
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000790 return false;
791}
792
793static inline __be32 try_6rd(struct ip_tunnel *tunnel,
794 const struct in6_addr *v6dst)
795{
796 __be32 dst = 0;
797 check_6rd(tunnel, v6dst, &dst);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700798 return dst;
799}
800
801/*
802 * This function assumes it is being called from dev_queue_xmit()
803 * and that skb is filled properly by that function.
804 */
805
Stephen Hemminger6fef4c02009-08-31 19:50:41 +0000806static netdev_tx_t ipip6_tunnel_xmit(struct sk_buff *skb,
807 struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700808{
Patrick McHardy2941a482006-01-08 22:05:26 -0800809 struct ip_tunnel *tunnel = netdev_priv(dev);
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000810 const struct iphdr *tiph = &tunnel->parms.iph;
811 const struct ipv6hdr *iph6 = ipv6_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700812 u8 tos = tunnel->parms.iph.tos;
Herbert Xu292f4f32009-11-09 08:42:01 +0000813 __be16 df = tiph->frag_off;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700814 struct rtable *rt; /* Route to the other host */
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000815 struct net_device *tdev; /* Device to other host */
Chuck Leverc2636b42007-10-23 21:07:32 -0700816 unsigned int max_headroom; /* The extra header space needed */
Al Viroe69a4adc2006-11-14 20:56:00 -0800817 __be32 dst = tiph->daddr;
David S. Miller31e45432011-05-03 20:25:42 -0700818 struct flowi4 fl4;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700819 int mtu;
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000820 const struct in6_addr *addr6;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821 int addr_type;
Pravin B Shelar0e6fbc52013-06-17 17:49:56 -0700822 u8 ttl;
823 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825 if (skb->protocol != htons(ETH_P_IPV6))
826 goto tx_error;
827
Lionel Elie Mamanec2bceb32011-08-13 14:04:38 +0000828 if (tos == 1)
829 tos = ipv6_get_dsfield(iph6);
830
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100831 /* ISATAP (RFC4214) - must come before 6to4 */
832 if (dev->priv_flags & IFF_ISATAP) {
833 struct neighbour *neigh = NULL;
David S. Miller1e2927b2012-01-26 15:23:21 -0500834 bool do_tx_error = false;
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100835
Eric Dumazetadf30902009-06-02 05:19:30 +0000836 if (skb_dst(skb))
David S. Miller1e2927b2012-01-26 15:23:21 -0500837 neigh = dst_neigh_lookup(skb_dst(skb), &iph6->daddr);
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100838
839 if (neigh == NULL) {
Catalin\(ux\) M. BOIE7df37ff2013-09-23 23:04:19 +0300840 net_dbg_ratelimited("nexthop == NULL\n");
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100841 goto tx_error;
842 }
843
Eldad Zack3e866702012-04-01 07:49:01 +0000844 addr6 = (const struct in6_addr *)&neigh->primary_key;
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100845 addr_type = ipv6_addr_type(addr6);
846
847 if ((addr_type & IPV6_ADDR_UNICAST) &&
848 ipv6_addr_is_isatap(addr6))
849 dst = addr6->s6_addr32[3];
850 else
David S. Miller1e2927b2012-01-26 15:23:21 -0500851 do_tx_error = true;
852
853 neigh_release(neigh);
854 if (do_tx_error)
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100855 goto tx_error;
856 }
857
Linus Torvalds1da177e2005-04-16 15:20:36 -0700858 if (!dst)
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000859 dst = try_6rd(tunnel, &iph6->daddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860
861 if (!dst) {
862 struct neighbour *neigh = NULL;
David S. Miller1e2927b2012-01-26 15:23:21 -0500863 bool do_tx_error = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700864
Eric Dumazetadf30902009-06-02 05:19:30 +0000865 if (skb_dst(skb))
David S. Miller1e2927b2012-01-26 15:23:21 -0500866 neigh = dst_neigh_lookup(skb_dst(skb), &iph6->daddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700867
868 if (neigh == NULL) {
Catalin\(ux\) M. BOIE7df37ff2013-09-23 23:04:19 +0300869 net_dbg_ratelimited("nexthop == NULL\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700870 goto tx_error;
871 }
872
Eldad Zack3e866702012-04-01 07:49:01 +0000873 addr6 = (const struct in6_addr *)&neigh->primary_key;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874 addr_type = ipv6_addr_type(addr6);
875
876 if (addr_type == IPV6_ADDR_ANY) {
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700877 addr6 = &ipv6_hdr(skb)->daddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700878 addr_type = ipv6_addr_type(addr6);
879 }
880
David S. Miller1e2927b2012-01-26 15:23:21 -0500881 if ((addr_type & IPV6_ADDR_COMPATv4) != 0)
882 dst = addr6->s6_addr32[3];
883 else
884 do_tx_error = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885
David S. Miller1e2927b2012-01-26 15:23:21 -0500886 neigh_release(neigh);
887 if (do_tx_error)
888 goto tx_error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700889 }
890
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +0200891 rt = ip_route_output_ports(tunnel->net, &fl4, NULL,
David S. Miller78fbfd82011-03-12 00:00:52 -0500892 dst, tiph->saddr,
893 0, 0,
894 IPPROTO_IPV6, RT_TOS(tos),
895 tunnel->parms.link);
896 if (IS_ERR(rt)) {
897 dev->stats.tx_carrier_errors++;
898 goto tx_error_icmp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700899 }
900 if (rt->rt_type != RTN_UNICAST) {
901 ip_rt_put(rt);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000902 dev->stats.tx_carrier_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700903 goto tx_error_icmp;
904 }
Changli Gaod8d1f302010-06-10 23:31:35 -0700905 tdev = rt->dst.dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700906
907 if (tdev == dev) {
908 ip_rt_put(rt);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000909 dev->stats.collisions++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910 goto tx_error;
911 }
912
Herbert Xu292f4f32009-11-09 08:42:01 +0000913 if (df) {
Changli Gaod8d1f302010-06-10 23:31:35 -0700914 mtu = dst_mtu(&rt->dst) - sizeof(struct iphdr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915
Herbert Xu292f4f32009-11-09 08:42:01 +0000916 if (mtu < 68) {
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000917 dev->stats.collisions++;
Herbert Xu292f4f32009-11-09 08:42:01 +0000918 ip_rt_put(rt);
919 goto tx_error;
920 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700921
Herbert Xu292f4f32009-11-09 08:42:01 +0000922 if (mtu < IPV6_MIN_MTU) {
923 mtu = IPV6_MIN_MTU;
924 df = 0;
925 }
926
927 if (tunnel->parms.iph.daddr && skb_dst(skb))
David S. Miller6700c272012-07-17 03:29:28 -0700928 skb_dst(skb)->ops->update_pmtu(skb_dst(skb), NULL, skb, mtu);
Herbert Xu292f4f32009-11-09 08:42:01 +0000929
Eric Dumazet58a47822013-12-16 06:31:23 -0800930 if (skb->len > mtu && !skb_is_gso(skb)) {
Alexey Dobriyan3ffe5332010-02-18 08:25:24 +0000931 icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
Herbert Xu292f4f32009-11-09 08:42:01 +0000932 ip_rt_put(rt);
933 goto tx_error;
934 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700935 }
936
937 if (tunnel->err_count > 0) {
Wei Yongjunbb800872009-02-24 23:37:19 -0800938 if (time_before(jiffies,
939 tunnel->err_time + IPTUNNEL_ERR_TIMEO)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940 tunnel->err_count--;
941 dst_link_failure(skb);
942 } else
943 tunnel->err_count = 0;
944 }
945
946 /*
947 * Okay, now see if we can stuff it in the buffer as-is.
948 */
949 max_headroom = LL_RESERVED_SPACE(tdev)+sizeof(struct iphdr);
950
Patrick McHardycfbba492007-07-09 15:33:40 -0700951 if (skb_headroom(skb) < max_headroom || skb_shared(skb) ||
952 (skb_cloned(skb) && !skb_clone_writable(skb, 0))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700953 struct sk_buff *new_skb = skb_realloc_headroom(skb, max_headroom);
954 if (!new_skb) {
955 ip_rt_put(rt);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000956 dev->stats.tx_dropped++;
Gao feng66028312013-11-25 17:21:24 +0800957 kfree_skb(skb);
Patrick McHardy6ed10652009-06-23 06:03:08 +0000958 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959 }
960 if (skb->sk)
961 skb_set_owner_w(new_skb, skb->sk);
962 dev_kfree_skb(skb);
963 skb = new_skb;
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700964 iph6 = ipv6_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965 }
Pravin B Shelar0e6fbc52013-06-17 17:49:56 -0700966 ttl = tiph->ttl;
967 if (ttl == 0)
968 ttl = iph6->hop_limit;
969 tos = INET_ECN_encapsulate(tos, ipv6_get_dsfield(iph6));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700970
Eric Dumazet61c1db72013-10-20 20:47:30 -0700971 skb = iptunnel_handle_offloads(skb, false, SKB_GSO_SIT);
Li RongQing6a9eadc2013-12-20 17:20:12 +0800972 if (IS_ERR(skb)) {
973 ip_rt_put(rt);
Eric Dumazet61c1db72013-10-20 20:47:30 -0700974 goto out;
Li RongQing6a9eadc2013-12-20 17:20:12 +0800975 }
Hannes Frederic Sowa3d483052013-08-18 13:46:52 +0200976
Eric Dumazetaad88722014-04-15 13:47:15 -0400977 err = iptunnel_xmit(skb->sk, rt, skb, fl4.saddr, fl4.daddr,
978 IPPROTO_IPV6, tos, ttl, df,
979 !net_eq(tunnel->net, dev_net(dev)));
Pravin B Shelar0e6fbc52013-06-17 17:49:56 -0700980 iptunnel_xmit_stats(err, &dev->stats, dev->tstats);
Patrick McHardy6ed10652009-06-23 06:03:08 +0000981 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700982
983tx_error_icmp:
984 dst_link_failure(skb);
985tx_error:
Gao feng66028312013-11-25 17:21:24 +0800986 kfree_skb(skb);
Eric Dumazet61c1db72013-10-20 20:47:30 -0700987out:
988 dev->stats.tx_errors++;
Patrick McHardy6ed10652009-06-23 06:03:08 +0000989 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700990}
991
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000992static netdev_tx_t ipip_tunnel_xmit(struct sk_buff *skb, struct net_device *dev)
993{
994 struct ip_tunnel *tunnel = netdev_priv(dev);
995 const struct iphdr *tiph = &tunnel->parms.iph;
996
Eric Dumazet61c1db72013-10-20 20:47:30 -0700997 skb = iptunnel_handle_offloads(skb, false, SKB_GSO_IPIP);
998 if (IS_ERR(skb))
999 goto out;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001000
1001 ip_tunnel_xmit(skb, dev, tiph, IPPROTO_IPIP);
1002 return NETDEV_TX_OK;
Eric Dumazet61c1db72013-10-20 20:47:30 -07001003out:
1004 dev->stats.tx_errors++;
1005 return NETDEV_TX_OK;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001006}
1007
1008static netdev_tx_t sit_tunnel_xmit(struct sk_buff *skb,
1009 struct net_device *dev)
1010{
1011 switch (skb->protocol) {
1012 case htons(ETH_P_IP):
1013 ipip_tunnel_xmit(skb, dev);
1014 break;
1015 case htons(ETH_P_IPV6):
1016 ipip6_tunnel_xmit(skb, dev);
1017 break;
1018 default:
1019 goto tx_err;
1020 }
1021
1022 return NETDEV_TX_OK;
1023
1024tx_err:
1025 dev->stats.tx_errors++;
Gao feng66028312013-11-25 17:21:24 +08001026 kfree_skb(skb);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001027 return NETDEV_TX_OK;
1028
1029}
1030
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001031static void ipip6_tunnel_bind_dev(struct net_device *dev)
1032{
1033 struct net_device *tdev = NULL;
1034 struct ip_tunnel *tunnel;
Eric Dumazetb71d1d42011-04-22 04:53:02 +00001035 const struct iphdr *iph;
David S. Miller31e45432011-05-03 20:25:42 -07001036 struct flowi4 fl4;
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001037
1038 tunnel = netdev_priv(dev);
1039 iph = &tunnel->parms.iph;
1040
1041 if (iph->daddr) {
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001042 struct rtable *rt = ip_route_output_ports(tunnel->net, &fl4,
1043 NULL,
David S. Miller78fbfd82011-03-12 00:00:52 -05001044 iph->daddr, iph->saddr,
1045 0, 0,
1046 IPPROTO_IPV6,
1047 RT_TOS(iph->tos),
1048 tunnel->parms.link);
David S. Millerb23dd4f2011-03-02 14:31:35 -08001049
1050 if (!IS_ERR(rt)) {
Changli Gaod8d1f302010-06-10 23:31:35 -07001051 tdev = rt->dst.dev;
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001052 ip_rt_put(rt);
1053 }
1054 dev->flags |= IFF_POINTOPOINT;
1055 }
1056
1057 if (!tdev && tunnel->parms.link)
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001058 tdev = __dev_get_by_index(tunnel->net, tunnel->parms.link);
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001059
1060 if (tdev) {
1061 dev->hard_header_len = tdev->hard_header_len + sizeof(struct iphdr);
1062 dev->mtu = tdev->mtu - sizeof(struct iphdr);
1063 if (dev->mtu < IPV6_MIN_MTU)
1064 dev->mtu = IPV6_MIN_MTU;
1065 }
1066 dev->iflink = tunnel->parms.link;
1067}
1068
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001069static void ipip6_tunnel_update(struct ip_tunnel *t, struct ip_tunnel_parm *p)
1070{
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001071 struct net *net = t->net;
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001072 struct sit_net *sitn = net_generic(net, sit_net_id);
1073
1074 ipip6_tunnel_unlink(sitn, t);
1075 synchronize_net();
1076 t->parms.iph.saddr = p->iph.saddr;
1077 t->parms.iph.daddr = p->iph.daddr;
1078 memcpy(t->dev->dev_addr, &p->iph.saddr, 4);
1079 memcpy(t->dev->broadcast, &p->iph.daddr, 4);
1080 ipip6_tunnel_link(sitn, t);
1081 t->parms.iph.ttl = p->iph.ttl;
1082 t->parms.iph.tos = p->iph.tos;
1083 if (t->parms.link != p->link) {
1084 t->parms.link = p->link;
1085 ipip6_tunnel_bind_dev(t->dev);
1086 }
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001087 ip_tunnel_dst_reset_all(t);
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001088 netdev_state_change(t->dev);
1089}
1090
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001091#ifdef CONFIG_IPV6_SIT_6RD
1092static int ipip6_tunnel_update_6rd(struct ip_tunnel *t,
1093 struct ip_tunnel_6rd *ip6rd)
1094{
1095 struct in6_addr prefix;
1096 __be32 relay_prefix;
1097
1098 if (ip6rd->relay_prefixlen > 32 ||
1099 ip6rd->prefixlen + (32 - ip6rd->relay_prefixlen) > 64)
1100 return -EINVAL;
1101
1102 ipv6_addr_prefix(&prefix, &ip6rd->prefix, ip6rd->prefixlen);
1103 if (!ipv6_addr_equal(&prefix, &ip6rd->prefix))
1104 return -EINVAL;
1105 if (ip6rd->relay_prefixlen)
1106 relay_prefix = ip6rd->relay_prefix &
1107 htonl(0xffffffffUL <<
1108 (32 - ip6rd->relay_prefixlen));
1109 else
1110 relay_prefix = 0;
1111 if (relay_prefix != ip6rd->relay_prefix)
1112 return -EINVAL;
1113
1114 t->ip6rd.prefix = prefix;
1115 t->ip6rd.relay_prefix = relay_prefix;
1116 t->ip6rd.prefixlen = ip6rd->prefixlen;
1117 t->ip6rd.relay_prefixlen = ip6rd->relay_prefixlen;
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001118 ip_tunnel_dst_reset_all(t);
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001119 netdev_state_change(t->dev);
1120 return 0;
1121}
1122#endif
1123
Linus Torvalds1da177e2005-04-16 15:20:36 -07001124static int
1125ipip6_tunnel_ioctl (struct net_device *dev, struct ifreq *ifr, int cmd)
1126{
1127 int err = 0;
1128 struct ip_tunnel_parm p;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001129 struct ip_tunnel_prl prl;
Nicolas Dichtel9aad77c2014-04-16 11:19:33 +02001130 struct ip_tunnel *t = netdev_priv(dev);
1131 struct net *net = t->net;
Pavel Emelyanovca8def12008-04-16 01:15:39 -07001132 struct sit_net *sitn = net_generic(net, sit_net_id);
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001133#ifdef CONFIG_IPV6_SIT_6RD
1134 struct ip_tunnel_6rd ip6rd;
1135#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001136
1137 switch (cmd) {
1138 case SIOCGETTUNNEL:
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001139#ifdef CONFIG_IPV6_SIT_6RD
1140 case SIOCGET6RD:
1141#endif
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001142 if (dev == sitn->fb_tunnel_dev) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001143 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) {
1144 err = -EFAULT;
1145 break;
1146 }
Pavel Emelyanovca8def12008-04-16 01:15:39 -07001147 t = ipip6_tunnel_locate(net, &p, 0);
Nicolas Dichtel9aad77c2014-04-16 11:19:33 +02001148 if (t == NULL)
1149 t = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001150 }
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001151
1152 err = -EFAULT;
1153 if (cmd == SIOCGETTUNNEL) {
1154 memcpy(&p, &t->parms, sizeof(p));
1155 if (copy_to_user(ifr->ifr_ifru.ifru_data, &p,
1156 sizeof(p)))
1157 goto done;
1158#ifdef CONFIG_IPV6_SIT_6RD
1159 } else {
Alexey Dobriyan4e3fd7a2011-11-21 03:39:03 +00001160 ip6rd.prefix = t->ip6rd.prefix;
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001161 ip6rd.relay_prefix = t->ip6rd.relay_prefix;
1162 ip6rd.prefixlen = t->ip6rd.prefixlen;
1163 ip6rd.relay_prefixlen = t->ip6rd.relay_prefixlen;
1164 if (copy_to_user(ifr->ifr_ifru.ifru_data, &ip6rd,
1165 sizeof(ip6rd)))
1166 goto done;
1167#endif
1168 }
1169 err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001170 break;
1171
1172 case SIOCADDTUNNEL:
1173 case SIOCCHGTUNNEL:
1174 err = -EPERM;
Eric W. Biedermanaf31f412012-11-16 03:03:06 +00001175 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001176 goto done;
1177
1178 err = -EFAULT;
1179 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
1180 goto done;
1181
1182 err = -EINVAL;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001183 if (p.iph.protocol != IPPROTO_IPV6 &&
1184 p.iph.protocol != IPPROTO_IPIP &&
1185 p.iph.protocol != 0)
1186 goto done;
1187 if (p.iph.version != 4 ||
Linus Torvalds1da177e2005-04-16 15:20:36 -07001188 p.iph.ihl != 5 || (p.iph.frag_off&htons(~IP_DF)))
1189 goto done;
1190 if (p.iph.ttl)
1191 p.iph.frag_off |= htons(IP_DF);
1192
Pavel Emelyanovca8def12008-04-16 01:15:39 -07001193 t = ipip6_tunnel_locate(net, &p, cmd == SIOCADDTUNNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001194
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001195 if (dev != sitn->fb_tunnel_dev && cmd == SIOCCHGTUNNEL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001196 if (t != NULL) {
1197 if (t->dev != dev) {
1198 err = -EEXIST;
1199 break;
1200 }
1201 } else {
1202 if (((dev->flags&IFF_POINTOPOINT) && !p.iph.daddr) ||
1203 (!(dev->flags&IFF_POINTOPOINT) && p.iph.daddr)) {
1204 err = -EINVAL;
1205 break;
1206 }
Patrick McHardy2941a482006-01-08 22:05:26 -08001207 t = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001208 }
Nicolas Dichtelf9cd5a52012-11-14 05:14:04 +00001209
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001210 ipip6_tunnel_update(t, &p);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001211 }
1212
1213 if (t) {
1214 err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001215 if (copy_to_user(ifr->ifr_ifru.ifru_data, &t->parms, sizeof(p)))
1216 err = -EFAULT;
1217 } else
1218 err = (cmd == SIOCADDTUNNEL ? -ENOBUFS : -ENOENT);
1219 break;
1220
1221 case SIOCDELTUNNEL:
1222 err = -EPERM;
Eric W. Biedermanaf31f412012-11-16 03:03:06 +00001223 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001224 goto done;
1225
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001226 if (dev == sitn->fb_tunnel_dev) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001227 err = -EFAULT;
1228 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
1229 goto done;
1230 err = -ENOENT;
Pavel Emelyanovca8def12008-04-16 01:15:39 -07001231 if ((t = ipip6_tunnel_locate(net, &p, 0)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001232 goto done;
1233 err = -EPERM;
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001234 if (t == netdev_priv(sitn->fb_tunnel_dev))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001235 goto done;
1236 dev = t->dev;
1237 }
Stephen Hemminger22f8cde2007-02-07 00:09:58 -08001238 unregister_netdevice(dev);
1239 err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240 break;
1241
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +09001242 case SIOCGETPRL:
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -07001243 err = -EINVAL;
1244 if (dev == sitn->fb_tunnel_dev)
1245 goto done;
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -07001246 err = ipip6_tunnel_get_prl(t, ifr->ifr_ifru.ifru_data);
1247 break;
1248
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001249 case SIOCADDPRL:
1250 case SIOCDELPRL:
1251 case SIOCCHGPRL:
1252 err = -EPERM;
Eric W. Biedermanaf31f412012-11-16 03:03:06 +00001253 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001254 goto done;
1255 err = -EINVAL;
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001256 if (dev == sitn->fb_tunnel_dev)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001257 goto done;
1258 err = -EFAULT;
1259 if (copy_from_user(&prl, ifr->ifr_ifru.ifru_data, sizeof(prl)))
1260 goto done;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001261
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +09001262 switch (cmd) {
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +09001263 case SIOCDELPRL:
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001264 err = ipip6_tunnel_del_prl(t, &prl);
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +09001265 break;
1266 case SIOCADDPRL:
1267 case SIOCCHGPRL:
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001268 err = ipip6_tunnel_add_prl(t, &prl, cmd == SIOCCHGPRL);
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +09001269 break;
1270 }
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001271 ip_tunnel_dst_reset_all(t);
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -07001272 netdev_state_change(dev);
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001273 break;
1274
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001275#ifdef CONFIG_IPV6_SIT_6RD
1276 case SIOCADD6RD:
1277 case SIOCCHG6RD:
1278 case SIOCDEL6RD:
1279 err = -EPERM;
Eric W. Biedermanaf31f412012-11-16 03:03:06 +00001280 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001281 goto done;
1282
1283 err = -EFAULT;
1284 if (copy_from_user(&ip6rd, ifr->ifr_ifru.ifru_data,
1285 sizeof(ip6rd)))
1286 goto done;
1287
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001288 if (cmd != SIOCDEL6RD) {
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001289 err = ipip6_tunnel_update_6rd(t, &ip6rd);
1290 if (err < 0)
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001291 goto done;
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001292 } else
YOSHIFUJI Hideaki / 吉藤英明e0c93942009-10-11 03:31:34 +00001293 ipip6_tunnel_clone_6rd(dev, sitn);
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001294
1295 err = 0;
1296 break;
1297#endif
1298
Linus Torvalds1da177e2005-04-16 15:20:36 -07001299 default:
1300 err = -EINVAL;
1301 }
1302
1303done:
1304 return err;
1305}
1306
Linus Torvalds1da177e2005-04-16 15:20:36 -07001307static int ipip6_tunnel_change_mtu(struct net_device *dev, int new_mtu)
1308{
1309 if (new_mtu < IPV6_MIN_MTU || new_mtu > 0xFFF8 - sizeof(struct iphdr))
1310 return -EINVAL;
1311 dev->mtu = new_mtu;
1312 return 0;
1313}
1314
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001315static const struct net_device_ops ipip6_netdev_ops = {
1316 .ndo_uninit = ipip6_tunnel_uninit,
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001317 .ndo_start_xmit = sit_tunnel_xmit,
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001318 .ndo_do_ioctl = ipip6_tunnel_ioctl,
1319 .ndo_change_mtu = ipip6_tunnel_change_mtu,
Pravin B Shelarf61dd382013-03-25 14:50:00 +00001320 .ndo_get_stats64 = ip_tunnel_get_stats64,
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001321};
1322
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001323static void ipip6_dev_free(struct net_device *dev)
1324{
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001325 struct ip_tunnel *tunnel = netdev_priv(dev);
1326
1327 free_percpu(tunnel->dst_cache);
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001328 free_percpu(dev->tstats);
1329 free_netdev(dev);
1330}
1331
Eric Dumazet61c1db72013-10-20 20:47:30 -07001332#define SIT_FEATURES (NETIF_F_SG | \
1333 NETIF_F_FRAGLIST | \
1334 NETIF_F_HIGHDMA | \
1335 NETIF_F_GSO_SOFTWARE | \
1336 NETIF_F_HW_CSUM)
1337
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338static void ipip6_tunnel_setup(struct net_device *dev)
1339{
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001340 dev->netdev_ops = &ipip6_netdev_ops;
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001341 dev->destructor = ipip6_dev_free;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001342
1343 dev->type = ARPHRD_SIT;
1344 dev->hard_header_len = LL_MAX_HEADER + sizeof(struct iphdr);
Kris Katterjohn46f25df2006-01-05 16:35:42 -08001345 dev->mtu = ETH_DATA_LEN - sizeof(struct iphdr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001346 dev->flags = IFF_NOARP;
Sascha Hlusiakf2ba0252009-07-11 20:30:52 -07001347 dev->priv_flags &= ~IFF_XMIT_DST_RELEASE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001348 dev->iflink = 0;
1349 dev->addr_len = 4;
Eric Dumazet8df40d12010-09-28 02:53:41 +00001350 dev->features |= NETIF_F_LLTX;
Eric Dumazet61c1db72013-10-20 20:47:30 -07001351 dev->features |= SIT_FEATURES;
1352 dev->hw_features |= SIT_FEATURES;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001353}
1354
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001355static int ipip6_tunnel_init(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001356{
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001357 struct ip_tunnel *tunnel = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358
1359 tunnel->dev = dev;
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001360 tunnel->net = dev_net(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001361
1362 memcpy(dev->dev_addr, &tunnel->parms.iph.saddr, 4);
1363 memcpy(dev->broadcast, &tunnel->parms.iph.daddr, 4);
1364
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001365 ipip6_tunnel_bind_dev(dev);
WANG Cong1c213bd2014-02-13 11:46:28 -08001366 dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001367 if (!dev->tstats)
1368 return -ENOMEM;
1369
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001370 tunnel->dst_cache = alloc_percpu(struct ip_tunnel_dst);
1371 if (!tunnel->dst_cache) {
1372 free_percpu(dev->tstats);
1373 return -ENOMEM;
1374 }
1375
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001376 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001377}
1378
Eric Dumazetdd4080e2010-09-28 02:17:58 +00001379static int __net_init ipip6_fb_tunnel_init(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001380{
Patrick McHardy2941a482006-01-08 22:05:26 -08001381 struct ip_tunnel *tunnel = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001382 struct iphdr *iph = &tunnel->parms.iph;
Pavel Emelyanov29182172008-04-16 01:16:38 -07001383 struct net *net = dev_net(dev);
1384 struct sit_net *sitn = net_generic(net, sit_net_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001385
1386 tunnel->dev = dev;
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001387 tunnel->net = dev_net(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001388 strcpy(tunnel->parms.name, dev->name);
1389
1390 iph->version = 4;
1391 iph->protocol = IPPROTO_IPV6;
1392 iph->ihl = 5;
1393 iph->ttl = 64;
1394
WANG Cong1c213bd2014-02-13 11:46:28 -08001395 dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
Eric Dumazetdd4080e2010-09-28 02:17:58 +00001396 if (!dev->tstats)
1397 return -ENOMEM;
John Stultz827da442013-10-07 15:51:58 -07001398
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001399 tunnel->dst_cache = alloc_percpu(struct ip_tunnel_dst);
1400 if (!tunnel->dst_cache) {
1401 free_percpu(dev->tstats);
1402 return -ENOMEM;
1403 }
1404
Linus Torvalds1da177e2005-04-16 15:20:36 -07001405 dev_hold(dev);
Eric Dumazetcf778b02012-01-12 04:41:32 +00001406 rcu_assign_pointer(sitn->tunnels_wc[0], tunnel);
Eric Dumazetdd4080e2010-09-28 02:17:58 +00001407 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001408}
1409
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001410static int ipip6_validate(struct nlattr *tb[], struct nlattr *data[])
1411{
1412 u8 proto;
1413
Nicolas Dichtelc2ff6822013-06-19 12:03:13 +02001414 if (!data || !data[IFLA_IPTUN_PROTO])
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001415 return 0;
1416
1417 proto = nla_get_u8(data[IFLA_IPTUN_PROTO]);
1418 if (proto != IPPROTO_IPV6 &&
1419 proto != IPPROTO_IPIP &&
1420 proto != 0)
1421 return -EINVAL;
1422
1423 return 0;
1424}
1425
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001426static void ipip6_netlink_parms(struct nlattr *data[],
1427 struct ip_tunnel_parm *parms)
1428{
1429 memset(parms, 0, sizeof(*parms));
1430
1431 parms->iph.version = 4;
1432 parms->iph.protocol = IPPROTO_IPV6;
1433 parms->iph.ihl = 5;
1434 parms->iph.ttl = 64;
1435
1436 if (!data)
1437 return;
1438
1439 if (data[IFLA_IPTUN_LINK])
1440 parms->link = nla_get_u32(data[IFLA_IPTUN_LINK]);
1441
1442 if (data[IFLA_IPTUN_LOCAL])
Nicolas Dichteld440b722012-11-15 04:06:41 +00001443 parms->iph.saddr = nla_get_be32(data[IFLA_IPTUN_LOCAL]);
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001444
1445 if (data[IFLA_IPTUN_REMOTE])
Nicolas Dichteld440b722012-11-15 04:06:41 +00001446 parms->iph.daddr = nla_get_be32(data[IFLA_IPTUN_REMOTE]);
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001447
1448 if (data[IFLA_IPTUN_TTL]) {
1449 parms->iph.ttl = nla_get_u8(data[IFLA_IPTUN_TTL]);
1450 if (parms->iph.ttl)
1451 parms->iph.frag_off = htons(IP_DF);
1452 }
1453
1454 if (data[IFLA_IPTUN_TOS])
1455 parms->iph.tos = nla_get_u8(data[IFLA_IPTUN_TOS]);
1456
1457 if (!data[IFLA_IPTUN_PMTUDISC] || nla_get_u8(data[IFLA_IPTUN_PMTUDISC]))
1458 parms->iph.frag_off = htons(IP_DF);
1459
1460 if (data[IFLA_IPTUN_FLAGS])
Nicolas Dichteld440b722012-11-15 04:06:41 +00001461 parms->i_flags = nla_get_be16(data[IFLA_IPTUN_FLAGS]);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001462
1463 if (data[IFLA_IPTUN_PROTO])
1464 parms->iph.protocol = nla_get_u8(data[IFLA_IPTUN_PROTO]);
1465
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001466}
1467
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001468#ifdef CONFIG_IPV6_SIT_6RD
1469/* This function returns true when 6RD attributes are present in the nl msg */
1470static bool ipip6_netlink_6rd_parms(struct nlattr *data[],
1471 struct ip_tunnel_6rd *ip6rd)
1472{
1473 bool ret = false;
1474 memset(ip6rd, 0, sizeof(*ip6rd));
1475
1476 if (!data)
1477 return ret;
1478
1479 if (data[IFLA_IPTUN_6RD_PREFIX]) {
1480 ret = true;
1481 nla_memcpy(&ip6rd->prefix, data[IFLA_IPTUN_6RD_PREFIX],
1482 sizeof(struct in6_addr));
1483 }
1484
1485 if (data[IFLA_IPTUN_6RD_RELAY_PREFIX]) {
1486 ret = true;
1487 ip6rd->relay_prefix =
1488 nla_get_be32(data[IFLA_IPTUN_6RD_RELAY_PREFIX]);
1489 }
1490
1491 if (data[IFLA_IPTUN_6RD_PREFIXLEN]) {
1492 ret = true;
1493 ip6rd->prefixlen = nla_get_u16(data[IFLA_IPTUN_6RD_PREFIXLEN]);
1494 }
1495
1496 if (data[IFLA_IPTUN_6RD_RELAY_PREFIXLEN]) {
1497 ret = true;
1498 ip6rd->relay_prefixlen =
1499 nla_get_u16(data[IFLA_IPTUN_6RD_RELAY_PREFIXLEN]);
1500 }
1501
1502 return ret;
1503}
1504#endif
1505
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001506static int ipip6_newlink(struct net *src_net, struct net_device *dev,
1507 struct nlattr *tb[], struct nlattr *data[])
1508{
1509 struct net *net = dev_net(dev);
1510 struct ip_tunnel *nt;
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001511#ifdef CONFIG_IPV6_SIT_6RD
1512 struct ip_tunnel_6rd ip6rd;
1513#endif
1514 int err;
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001515
1516 nt = netdev_priv(dev);
1517 ipip6_netlink_parms(data, &nt->parms);
1518
1519 if (ipip6_tunnel_locate(net, &nt->parms, 0))
1520 return -EEXIST;
1521
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001522 err = ipip6_tunnel_create(dev);
1523 if (err < 0)
1524 return err;
1525
1526#ifdef CONFIG_IPV6_SIT_6RD
1527 if (ipip6_netlink_6rd_parms(data, &ip6rd))
1528 err = ipip6_tunnel_update_6rd(nt, &ip6rd);
1529#endif
1530
1531 return err;
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001532}
1533
1534static int ipip6_changelink(struct net_device *dev, struct nlattr *tb[],
1535 struct nlattr *data[])
1536{
Nicolas Dichtel86bd68b2013-07-03 17:00:34 +02001537 struct ip_tunnel *t = netdev_priv(dev);
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001538 struct ip_tunnel_parm p;
Nicolas Dichtel86bd68b2013-07-03 17:00:34 +02001539 struct net *net = t->net;
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001540 struct sit_net *sitn = net_generic(net, sit_net_id);
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001541#ifdef CONFIG_IPV6_SIT_6RD
1542 struct ip_tunnel_6rd ip6rd;
1543#endif
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001544
1545 if (dev == sitn->fb_tunnel_dev)
1546 return -EINVAL;
1547
1548 ipip6_netlink_parms(data, &p);
1549
1550 if (((dev->flags & IFF_POINTOPOINT) && !p.iph.daddr) ||
1551 (!(dev->flags & IFF_POINTOPOINT) && p.iph.daddr))
1552 return -EINVAL;
1553
1554 t = ipip6_tunnel_locate(net, &p, 0);
1555
1556 if (t) {
1557 if (t->dev != dev)
1558 return -EEXIST;
1559 } else
1560 t = netdev_priv(dev);
1561
1562 ipip6_tunnel_update(t, &p);
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001563
1564#ifdef CONFIG_IPV6_SIT_6RD
1565 if (ipip6_netlink_6rd_parms(data, &ip6rd))
1566 return ipip6_tunnel_update_6rd(t, &ip6rd);
1567#endif
1568
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001569 return 0;
1570}
1571
Nicolas Dichtele4c94a92012-11-14 05:14:06 +00001572static size_t ipip6_get_size(const struct net_device *dev)
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001573{
1574 return
1575 /* IFLA_IPTUN_LINK */
1576 nla_total_size(4) +
1577 /* IFLA_IPTUN_LOCAL */
1578 nla_total_size(4) +
1579 /* IFLA_IPTUN_REMOTE */
1580 nla_total_size(4) +
1581 /* IFLA_IPTUN_TTL */
1582 nla_total_size(1) +
1583 /* IFLA_IPTUN_TOS */
1584 nla_total_size(1) +
Nicolas Dichtela12c9a82012-11-14 05:14:05 +00001585 /* IFLA_IPTUN_PMTUDISC */
1586 nla_total_size(1) +
1587 /* IFLA_IPTUN_FLAGS */
1588 nla_total_size(2) +
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001589 /* IFLA_IPTUN_PROTO */
1590 nla_total_size(1) +
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001591#ifdef CONFIG_IPV6_SIT_6RD
1592 /* IFLA_IPTUN_6RD_PREFIX */
1593 nla_total_size(sizeof(struct in6_addr)) +
1594 /* IFLA_IPTUN_6RD_RELAY_PREFIX */
1595 nla_total_size(4) +
1596 /* IFLA_IPTUN_6RD_PREFIXLEN */
1597 nla_total_size(2) +
1598 /* IFLA_IPTUN_6RD_RELAY_PREFIXLEN */
1599 nla_total_size(2) +
1600#endif
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001601 0;
1602}
1603
Nicolas Dichtele4c94a92012-11-14 05:14:06 +00001604static int ipip6_fill_info(struct sk_buff *skb, const struct net_device *dev)
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001605{
1606 struct ip_tunnel *tunnel = netdev_priv(dev);
1607 struct ip_tunnel_parm *parm = &tunnel->parms;
1608
1609 if (nla_put_u32(skb, IFLA_IPTUN_LINK, parm->link) ||
1610 nla_put_be32(skb, IFLA_IPTUN_LOCAL, parm->iph.saddr) ||
1611 nla_put_be32(skb, IFLA_IPTUN_REMOTE, parm->iph.daddr) ||
1612 nla_put_u8(skb, IFLA_IPTUN_TTL, parm->iph.ttl) ||
Nicolas Dichtela12c9a82012-11-14 05:14:05 +00001613 nla_put_u8(skb, IFLA_IPTUN_TOS, parm->iph.tos) ||
1614 nla_put_u8(skb, IFLA_IPTUN_PMTUDISC,
1615 !!(parm->iph.frag_off & htons(IP_DF))) ||
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001616 nla_put_u8(skb, IFLA_IPTUN_PROTO, parm->iph.protocol) ||
Nicolas Dichteld440b722012-11-15 04:06:41 +00001617 nla_put_be16(skb, IFLA_IPTUN_FLAGS, parm->i_flags))
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001618 goto nla_put_failure;
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001619
1620#ifdef CONFIG_IPV6_SIT_6RD
1621 if (nla_put(skb, IFLA_IPTUN_6RD_PREFIX, sizeof(struct in6_addr),
1622 &tunnel->ip6rd.prefix) ||
1623 nla_put_be32(skb, IFLA_IPTUN_6RD_RELAY_PREFIX,
1624 tunnel->ip6rd.relay_prefix) ||
1625 nla_put_u16(skb, IFLA_IPTUN_6RD_PREFIXLEN,
1626 tunnel->ip6rd.prefixlen) ||
1627 nla_put_u16(skb, IFLA_IPTUN_6RD_RELAY_PREFIXLEN,
1628 tunnel->ip6rd.relay_prefixlen))
1629 goto nla_put_failure;
1630#endif
1631
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001632 return 0;
1633
1634nla_put_failure:
1635 return -EMSGSIZE;
1636}
1637
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001638static const struct nla_policy ipip6_policy[IFLA_IPTUN_MAX + 1] = {
1639 [IFLA_IPTUN_LINK] = { .type = NLA_U32 },
1640 [IFLA_IPTUN_LOCAL] = { .type = NLA_U32 },
1641 [IFLA_IPTUN_REMOTE] = { .type = NLA_U32 },
1642 [IFLA_IPTUN_TTL] = { .type = NLA_U8 },
1643 [IFLA_IPTUN_TOS] = { .type = NLA_U8 },
1644 [IFLA_IPTUN_PMTUDISC] = { .type = NLA_U8 },
1645 [IFLA_IPTUN_FLAGS] = { .type = NLA_U16 },
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001646 [IFLA_IPTUN_PROTO] = { .type = NLA_U8 },
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001647#ifdef CONFIG_IPV6_SIT_6RD
1648 [IFLA_IPTUN_6RD_PREFIX] = { .len = sizeof(struct in6_addr) },
1649 [IFLA_IPTUN_6RD_RELAY_PREFIX] = { .type = NLA_U32 },
1650 [IFLA_IPTUN_6RD_PREFIXLEN] = { .type = NLA_U16 },
1651 [IFLA_IPTUN_6RD_RELAY_PREFIXLEN] = { .type = NLA_U16 },
1652#endif
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001653};
1654
Willem de Bruijn94342662013-11-13 21:27:38 -05001655static void ipip6_dellink(struct net_device *dev, struct list_head *head)
1656{
1657 struct net *net = dev_net(dev);
1658 struct sit_net *sitn = net_generic(net, sit_net_id);
1659
1660 if (dev != sitn->fb_tunnel_dev)
1661 unregister_netdevice_queue(dev, head);
1662}
1663
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001664static struct rtnl_link_ops sit_link_ops __read_mostly = {
1665 .kind = "sit",
1666 .maxtype = IFLA_IPTUN_MAX,
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001667 .policy = ipip6_policy,
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001668 .priv_size = sizeof(struct ip_tunnel),
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001669 .setup = ipip6_tunnel_setup,
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001670 .validate = ipip6_validate,
Nicolas Dichtelf3723412012-11-14 05:14:07 +00001671 .newlink = ipip6_newlink,
1672 .changelink = ipip6_changelink,
Nicolas Dichtele4c94a92012-11-14 05:14:06 +00001673 .get_size = ipip6_get_size,
1674 .fill_info = ipip6_fill_info,
Willem de Bruijn94342662013-11-13 21:27:38 -05001675 .dellink = ipip6_dellink,
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001676};
1677
Eric Dumazet6dcd8142010-08-30 07:04:14 +00001678static struct xfrm_tunnel sit_handler __read_mostly = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001679 .handler = ipip6_rcv,
1680 .err_handler = ipip6_err,
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -08001681 .priority = 1,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001682};
1683
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001684static struct xfrm_tunnel ipip_handler __read_mostly = {
1685 .handler = ipip_rcv,
1686 .err_handler = ipip6_err,
1687 .priority = 2,
1688};
1689
Willem de Bruijn94342662013-11-13 21:27:38 -05001690static void __net_exit sit_destroy_tunnels(struct net *net,
1691 struct list_head *head)
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001692{
Willem de Bruijn94342662013-11-13 21:27:38 -05001693 struct sit_net *sitn = net_generic(net, sit_net_id);
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001694 struct net_device *dev, *aux;
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001695 int prio;
1696
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001697 for_each_netdev_safe(net, dev, aux)
1698 if (dev->rtnl_link_ops == &sit_link_ops)
1699 unregister_netdevice_queue(dev, head);
1700
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001701 for (prio = 1; prio < 4; prio++) {
1702 int h;
1703 for (h = 0; h < HASH_SIZE; h++) {
Eric Dumazet753ea8e2011-01-20 07:16:24 +00001704 struct ip_tunnel *t;
Eric Dumazet62808f92009-10-28 04:37:43 +00001705
Eric Dumazet753ea8e2011-01-20 07:16:24 +00001706 t = rtnl_dereference(sitn->tunnels[prio][h]);
Eric Dumazet62808f92009-10-28 04:37:43 +00001707 while (t != NULL) {
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001708 /* If dev is in the same netns, it has already
1709 * been added to the list by the previous loop.
1710 */
Nicolas Dichtelfc8f9992013-08-13 17:51:10 +02001711 if (!net_eq(dev_net(t->dev), net))
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001712 unregister_netdevice_queue(t->dev,
1713 head);
Eric Dumazet753ea8e2011-01-20 07:16:24 +00001714 t = rtnl_dereference(t->next);
Eric Dumazet62808f92009-10-28 04:37:43 +00001715 }
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001716 }
1717 }
1718}
1719
Alexey Dobriyan2c8c1e72010-01-17 03:35:32 +00001720static int __net_init sit_init_net(struct net *net)
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001721{
Eric W. Biederman67101172009-11-29 15:46:16 +00001722 struct sit_net *sitn = net_generic(net, sit_net_id);
Ted Feng72b36012011-12-08 00:46:21 +00001723 struct ip_tunnel *t;
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001724 int err;
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001725
Pavel Emelyanov29182172008-04-16 01:16:38 -07001726 sitn->tunnels[0] = sitn->tunnels_wc;
1727 sitn->tunnels[1] = sitn->tunnels_l;
1728 sitn->tunnels[2] = sitn->tunnels_r;
1729 sitn->tunnels[3] = sitn->tunnels_r_l;
1730
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001731 sitn->fb_tunnel_dev = alloc_netdev(sizeof(struct ip_tunnel), "sit0",
1732 ipip6_tunnel_setup);
1733 if (!sitn->fb_tunnel_dev) {
1734 err = -ENOMEM;
1735 goto err_alloc_dev;
1736 }
Alexey Dobriyanbe77e592008-11-23 17:26:26 -08001737 dev_net_set(sitn->fb_tunnel_dev, net);
Nicolas Dichtel205983c2013-10-01 18:04:59 +02001738 sitn->fb_tunnel_dev->rtnl_link_ops = &sit_link_ops;
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001739 /* FB netdevice is special: we have one, and only one per netns.
1740 * Allowing to move it to another netns is clearly unsafe.
1741 */
1742 sitn->fb_tunnel_dev->features |= NETIF_F_NETNS_LOCAL;
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001743
Eric Dumazetdd4080e2010-09-28 02:17:58 +00001744 err = ipip6_fb_tunnel_init(sitn->fb_tunnel_dev);
1745 if (err)
1746 goto err_dev_free;
1747
YOSHIFUJI Hideaki / 吉藤英明e0c93942009-10-11 03:31:34 +00001748 ipip6_tunnel_clone_6rd(sitn->fb_tunnel_dev, sitn);
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001749
1750 if ((err = register_netdev(sitn->fb_tunnel_dev)))
1751 goto err_reg_dev;
1752
Ted Feng72b36012011-12-08 00:46:21 +00001753 t = netdev_priv(sitn->fb_tunnel_dev);
1754
1755 strcpy(t->parms.name, sitn->fb_tunnel_dev->name);
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001756 return 0;
1757
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001758err_reg_dev:
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001759 dev_put(sitn->fb_tunnel_dev);
Eric Dumazetdd4080e2010-09-28 02:17:58 +00001760err_dev_free:
1761 ipip6_dev_free(sitn->fb_tunnel_dev);
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001762err_alloc_dev:
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001763 return err;
1764}
1765
Alexey Dobriyan2c8c1e72010-01-17 03:35:32 +00001766static void __net_exit sit_exit_net(struct net *net)
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001767{
Eric Dumazet62808f92009-10-28 04:37:43 +00001768 LIST_HEAD(list);
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001769
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001770 rtnl_lock();
Willem de Bruijn94342662013-11-13 21:27:38 -05001771 sit_destroy_tunnels(net, &list);
Eric Dumazet62808f92009-10-28 04:37:43 +00001772 unregister_netdevice_many(&list);
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001773 rtnl_unlock();
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001774}
1775
1776static struct pernet_operations sit_net_ops = {
1777 .init = sit_init_net,
1778 .exit = sit_exit_net,
Eric W. Biederman67101172009-11-29 15:46:16 +00001779 .id = &sit_net_id,
1780 .size = sizeof(struct sit_net),
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001781};
1782
Adrian Bunk89c89452006-11-20 16:56:48 -08001783static void __exit sit_cleanup(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001784{
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001785 rtnl_link_unregister(&sit_link_ops);
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -08001786 xfrm4_tunnel_deregister(&sit_handler, AF_INET6);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001787 xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001788
Eric W. Biederman67101172009-11-29 15:46:16 +00001789 unregister_pernet_device(&sit_net_ops);
Eric Dumazetef9a9d12009-10-23 17:51:26 +00001790 rcu_barrier(); /* Wait for completion of call_rcu()'s */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001791}
1792
Adrian Bunk89c89452006-11-20 16:56:48 -08001793static int __init sit_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001794{
1795 int err;
1796
Joe Perchesf3213832012-05-15 14:11:53 +00001797 pr_info("IPv6 over IPv4 tunneling driver\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001798
Eric W. Biederman67101172009-11-29 15:46:16 +00001799 err = register_pernet_device(&sit_net_ops);
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001800 if (err < 0)
Alexey Dobriyand5aa4072010-02-16 09:05:04 +00001801 return err;
1802 err = xfrm4_tunnel_register(&sit_handler, AF_INET6);
1803 if (err < 0) {
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001804 pr_info("%s: can't register ip6ip4\n", __func__);
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001805 goto xfrm_tunnel_failed;
Alexey Dobriyand5aa4072010-02-16 09:05:04 +00001806 }
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001807 err = xfrm4_tunnel_register(&ipip_handler, AF_INET);
1808 if (err < 0) {
1809 pr_info("%s: can't register ip4ip4\n", __func__);
1810 goto xfrm_tunnel4_failed;
1811 }
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001812 err = rtnl_link_register(&sit_link_ops);
1813 if (err < 0)
1814 goto rtnl_link_failed;
1815
1816out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001817 return err;
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001818
1819rtnl_link_failed:
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001820 xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
1821xfrm_tunnel4_failed:
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001822 xfrm4_tunnel_deregister(&sit_handler, AF_INET6);
1823xfrm_tunnel_failed:
1824 unregister_pernet_device(&sit_net_ops);
1825 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001826}
Joerg Roedel989e5b92006-10-10 14:47:44 -07001827
1828module_init(sit_init);
1829module_exit(sit_cleanup);
Jan Dittmer39c85082006-10-13 15:05:53 -07001830MODULE_LICENSE("GPL");
Vasiliy Kulikov8909c9a2011-03-02 00:33:13 +03001831MODULE_ALIAS_NETDEV("sit0");