blob: 63ccd9f2dcccf972eebefa8f293fb47090feb8e1 [file] [log] [blame]
Thomas Gleixner2874c5f2019-05-27 08:55:01 +02001// SPDX-License-Identifier: GPL-2.0-or-later
Linus Torvalds1da177e2005-04-16 15:20:36 -07002/*
3 * IPv6 over IPv4 tunnel device - Simple Internet Transition (SIT)
4 * Linux INET6 implementation
5 *
6 * Authors:
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +09007 * Pedro Roque <roque@di.fc.ul.pt>
Linus Torvalds1da177e2005-04-16 15:20:36 -07008 * Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
9 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070010 * Changes:
11 * Roger Venning <r.venning@telstra.com>: 6to4 support
12 * Nate Thompson <nate@thebog.net>: 6to4 support
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -040013 * Fred Templin <fred.l.templin@boeing.com>: isatap support
Linus Torvalds1da177e2005-04-16 15:20:36 -070014 */
15
Joe Perchesf3213832012-05-15 14:11:53 +000016#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
17
Linus Torvalds1da177e2005-04-16 15:20:36 -070018#include <linux/module.h>
Randy Dunlap4fc268d2006-01-11 12:17:47 -080019#include <linux/capability.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070020#include <linux/errno.h>
21#include <linux/types.h>
22#include <linux/socket.h>
23#include <linux/sockios.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024#include <linux/net.h>
25#include <linux/in6.h>
26#include <linux/netdevice.h>
27#include <linux/if_arp.h>
28#include <linux/icmp.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090029#include <linux/slab.h>
Linus Torvalds7c0f6ba2016-12-24 11:46:01 -080030#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070031#include <linux/init.h>
32#include <linux/netfilter_ipv4.h>
Kris Katterjohn46f25df2006-01-05 16:35:42 -080033#include <linux/if_ether.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
35#include <net/sock.h>
36#include <net/snmp.h>
37
38#include <net/ipv6.h>
39#include <net/protocol.h>
40#include <net/transp_v6.h>
41#include <net/ip6_fib.h>
42#include <net/ip6_route.h>
43#include <net/ndisc.h>
44#include <net/addrconf.h>
45#include <net/ip.h>
46#include <net/udp.h>
47#include <net/icmp.h>
Pravin B Shelarc5441932013-03-25 14:49:35 +000048#include <net/ip_tunnels.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070049#include <net/inet_ecn.h>
50#include <net/xfrm.h>
51#include <net/dsfield.h>
Pavel Emelyanov8190d902008-04-16 01:15:17 -070052#include <net/net_namespace.h>
53#include <net/netns/generic.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070054
55/*
56 This version of net/ipv6/sit.c is cloned of net/ipv4/ip_gre.c
57
58 For comments look at net/ipv4/ip_gre.c --ANK
59 */
60
Jiri Kosinae87a8f22016-08-10 11:03:35 +020061#define IP6_SIT_HASH_SIZE 16
Al Viroe69a4ad2006-11-14 20:56:00 -080062#define HASH(addr) (((__force u32)addr^((__force u32)addr>>4))&0xF)
Linus Torvalds1da177e2005-04-16 15:20:36 -070063
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +000064static bool log_ecn_error = true;
65module_param(log_ecn_error, bool, 0644);
66MODULE_PARM_DESC(log_ecn_error, "Log packets received with corrupted ECN");
67
Eric Dumazet15fc1f72010-09-27 00:38:18 +000068static int ipip6_tunnel_init(struct net_device *dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070069static void ipip6_tunnel_setup(struct net_device *dev);
Eric Dumazet15fc1f72010-09-27 00:38:18 +000070static void ipip6_dev_free(struct net_device *dev);
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +000071static bool check_6rd(struct ip_tunnel *tunnel, const struct in6_addr *v6dst,
72 __be32 *v4dst);
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +000073static struct rtnl_link_ops sit_link_ops __read_mostly;
Linus Torvalds1da177e2005-04-16 15:20:36 -070074
Alexey Dobriyanc7d03a02016-11-17 04:58:21 +030075static unsigned int sit_net_id __read_mostly;
Pavel Emelyanov8190d902008-04-16 01:15:17 -070076struct sit_net {
Jiri Kosinae87a8f22016-08-10 11:03:35 +020077 struct ip_tunnel __rcu *tunnels_r_l[IP6_SIT_HASH_SIZE];
78 struct ip_tunnel __rcu *tunnels_r[IP6_SIT_HASH_SIZE];
79 struct ip_tunnel __rcu *tunnels_l[IP6_SIT_HASH_SIZE];
Eric Dumazet3a43be32010-09-15 11:35:10 +000080 struct ip_tunnel __rcu *tunnels_wc[1];
81 struct ip_tunnel __rcu **tunnels[4];
Pavel Emelyanov29182172008-04-16 01:16:38 -070082
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -070083 struct net_device *fb_tunnel_dev;
Pavel Emelyanov8190d902008-04-16 01:15:17 -070084};
85
Christoph Hellwigfd5d6872020-05-19 15:03:15 +020086static inline struct sit_net *dev_to_sit_net(struct net_device *dev)
87{
88 struct ip_tunnel *t = netdev_priv(dev);
89
90 return net_generic(t->net, sit_net_id);
91}
92
Eric Dumazet4543c102009-10-23 17:52:14 +000093/*
94 * Must be invoked with rcu_read_lock
95 */
Eldad Zack3e866702012-04-01 07:49:01 +000096static struct ip_tunnel *ipip6_tunnel_lookup(struct net *net,
David Ahern3051fbe2017-10-30 10:07:17 -070097 struct net_device *dev,
98 __be32 remote, __be32 local,
99 int sifindex)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100{
Eric Dumazet3a43be32010-09-15 11:35:10 +0000101 unsigned int h0 = HASH(remote);
102 unsigned int h1 = HASH(local);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 struct ip_tunnel *t;
Pavel Emelyanov29182172008-04-16 01:16:38 -0700104 struct sit_net *sitn = net_generic(net, sit_net_id);
David Ahern3051fbe2017-10-30 10:07:17 -0700105 int ifindex = dev ? dev->ifindex : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106
Amerigo Wange086cad2012-11-11 21:52:34 +0000107 for_each_ip_tunnel_rcu(t, sitn->tunnels_r_l[h0 ^ h1]) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108 if (local == t->parms.iph.saddr &&
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000109 remote == t->parms.iph.daddr &&
David Ahern3051fbe2017-10-30 10:07:17 -0700110 (!dev || !t->parms.link || ifindex == t->parms.link ||
111 sifindex == t->parms.link) &&
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000112 (t->dev->flags & IFF_UP))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113 return t;
114 }
Amerigo Wange086cad2012-11-11 21:52:34 +0000115 for_each_ip_tunnel_rcu(t, sitn->tunnels_r[h0]) {
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000116 if (remote == t->parms.iph.daddr &&
David Ahern3051fbe2017-10-30 10:07:17 -0700117 (!dev || !t->parms.link || ifindex == t->parms.link ||
118 sifindex == t->parms.link) &&
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000119 (t->dev->flags & IFF_UP))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120 return t;
121 }
Amerigo Wange086cad2012-11-11 21:52:34 +0000122 for_each_ip_tunnel_rcu(t, sitn->tunnels_l[h1]) {
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000123 if (local == t->parms.iph.saddr &&
David Ahern3051fbe2017-10-30 10:07:17 -0700124 (!dev || !t->parms.link || ifindex == t->parms.link ||
125 sifindex == t->parms.link) &&
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000126 (t->dev->flags & IFF_UP))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 return t;
128 }
Eric Dumazet4543c102009-10-23 17:52:14 +0000129 t = rcu_dereference(sitn->tunnels_wc[0]);
Ian Morris53b24b82015-03-29 14:00:05 +0100130 if (t && (t->dev->flags & IFF_UP))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131 return t;
132 return NULL;
133}
134
Eric Dumazet3a43be32010-09-15 11:35:10 +0000135static struct ip_tunnel __rcu **__ipip6_bucket(struct sit_net *sitn,
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700136 struct ip_tunnel_parm *parms)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137{
YOSHIFUJI Hideaki420fe232007-04-24 20:44:47 +0900138 __be32 remote = parms->iph.daddr;
139 __be32 local = parms->iph.saddr;
Eric Dumazet3a43be32010-09-15 11:35:10 +0000140 unsigned int h = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141 int prio = 0;
142
143 if (remote) {
144 prio |= 2;
145 h ^= HASH(remote);
146 }
147 if (local) {
148 prio |= 1;
149 h ^= HASH(local);
150 }
Pavel Emelyanov29182172008-04-16 01:16:38 -0700151 return &sitn->tunnels[prio][h];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152}
153
Eric Dumazet3a43be32010-09-15 11:35:10 +0000154static inline struct ip_tunnel __rcu **ipip6_bucket(struct sit_net *sitn,
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700155 struct ip_tunnel *t)
YOSHIFUJI Hideaki420fe232007-04-24 20:44:47 +0900156{
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700157 return __ipip6_bucket(sitn, &t->parms);
YOSHIFUJI Hideaki420fe232007-04-24 20:44:47 +0900158}
159
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700160static void ipip6_tunnel_unlink(struct sit_net *sitn, struct ip_tunnel *t)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161{
Eric Dumazet3a43be32010-09-15 11:35:10 +0000162 struct ip_tunnel __rcu **tp;
163 struct ip_tunnel *iter;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164
Eric Dumazet3a43be32010-09-15 11:35:10 +0000165 for (tp = ipip6_bucket(sitn, t);
166 (iter = rtnl_dereference(*tp)) != NULL;
167 tp = &iter->next) {
168 if (t == iter) {
Eric Dumazetcf778b02012-01-12 04:41:32 +0000169 rcu_assign_pointer(*tp, t->next);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170 break;
171 }
172 }
173}
174
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700175static void ipip6_tunnel_link(struct sit_net *sitn, struct ip_tunnel *t)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176{
Eric Dumazet3a43be32010-09-15 11:35:10 +0000177 struct ip_tunnel __rcu **tp = ipip6_bucket(sitn, t);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700178
Eric Dumazetcf778b02012-01-12 04:41:32 +0000179 rcu_assign_pointer(t->next, rtnl_dereference(*tp));
180 rcu_assign_pointer(*tp, t);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181}
182
YOSHIFUJI Hideaki / 吉藤英明e0c93942009-10-11 03:31:34 +0000183static void ipip6_tunnel_clone_6rd(struct net_device *dev, struct sit_net *sitn)
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000184{
185#ifdef CONFIG_IPV6_SIT_6RD
YOSHIFUJI Hideaki / 吉藤英明e0c93942009-10-11 03:31:34 +0000186 struct ip_tunnel *t = netdev_priv(dev);
187
Eric Dumazet79134e62018-03-08 12:51:41 -0800188 if (dev == sitn->fb_tunnel_dev || !sitn->fb_tunnel_dev) {
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000189 ipv6_addr_set(&t->ip6rd.prefix, htonl(0x20020000), 0, 0, 0);
190 t->ip6rd.relay_prefix = 0;
191 t->ip6rd.prefixlen = 16;
192 t->ip6rd.relay_prefixlen = 0;
193 } else {
194 struct ip_tunnel *t0 = netdev_priv(sitn->fb_tunnel_dev);
195 memcpy(&t->ip6rd, &t0->ip6rd, sizeof(t->ip6rd));
196 }
197#endif
198}
199
Nicolas Dichtelf37234162012-11-14 05:14:07 +0000200static int ipip6_tunnel_create(struct net_device *dev)
201{
202 struct ip_tunnel *t = netdev_priv(dev);
203 struct net *net = dev_net(dev);
204 struct sit_net *sitn = net_generic(net, sit_net_id);
205 int err;
206
Steffen Klassertebe084a2014-11-03 09:19:29 +0100207 memcpy(dev->dev_addr, &t->parms.iph.saddr, 4);
208 memcpy(dev->broadcast, &t->parms.iph.daddr, 4);
Nicolas Dichtelf37234162012-11-14 05:14:07 +0000209
Nicolas Dichteld440b722012-11-15 04:06:41 +0000210 if ((__force u16)t->parms.i_flags & SIT_ISATAP)
Nicolas Dichtelf37234162012-11-14 05:14:07 +0000211 dev->priv_flags |= IFF_ISATAP;
212
Thadeu Lima de Souza Cascardo87e57392016-01-25 11:29:19 -0200213 dev->rtnl_link_ops = &sit_link_ops;
214
Nicolas Dichtelf37234162012-11-14 05:14:07 +0000215 err = register_netdevice(dev);
216 if (err < 0)
217 goto out;
218
Steffen Klassertebe084a2014-11-03 09:19:29 +0100219 ipip6_tunnel_clone_6rd(dev, sitn);
220
Nicolas Dichtelf37234162012-11-14 05:14:07 +0000221 dev_hold(dev);
222
223 ipip6_tunnel_link(sitn, t);
224 return 0;
225
226out:
227 return err;
228}
229
Eric Dumazet3a43be32010-09-15 11:35:10 +0000230static struct ip_tunnel *ipip6_tunnel_locate(struct net *net,
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700231 struct ip_tunnel_parm *parms, int create)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232{
Al Viroe69a4ad2006-11-14 20:56:00 -0800233 __be32 remote = parms->iph.daddr;
234 __be32 local = parms->iph.saddr;
Eric Dumazet3a43be32010-09-15 11:35:10 +0000235 struct ip_tunnel *t, *nt;
236 struct ip_tunnel __rcu **tp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237 struct net_device *dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238 char name[IFNAMSIZ];
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700239 struct sit_net *sitn = net_generic(net, sit_net_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240
Eric Dumazet3a43be32010-09-15 11:35:10 +0000241 for (tp = __ipip6_bucket(sitn, parms);
242 (t = rtnl_dereference(*tp)) != NULL;
243 tp = &t->next) {
Sascha Hlusiak8db99e52009-05-19 12:56:48 +0000244 if (local == t->parms.iph.saddr &&
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000245 remote == t->parms.iph.daddr &&
246 parms->link == t->parms.link) {
Sascha Hlusiak8db99e52009-05-19 12:56:48 +0000247 if (create)
248 return NULL;
249 else
250 return t;
251 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 }
253 if (!create)
254 goto failed;
255
Eric Dumazetb95211e2018-04-05 06:39:28 -0700256 if (parms->name[0]) {
257 if (!dev_valid_name(parms->name))
258 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700259 strlcpy(name, parms->name, IFNAMSIZ);
Eric Dumazetb95211e2018-04-05 06:39:28 -0700260 } else {
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000261 strcpy(name, "sit%d");
Eric Dumazetb95211e2018-04-05 06:39:28 -0700262 }
Tom Gundersenc835a672014-07-14 16:37:24 +0200263 dev = alloc_netdev(sizeof(*t), name, NET_NAME_UNKNOWN,
264 ipip6_tunnel_setup);
Ian Morris63159f22015-03-29 14:00:04 +0100265 if (!dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700266 return NULL;
267
Pavel Emelyanov7a971462008-04-16 01:17:18 -0700268 dev_net_set(dev, net);
269
Patrick McHardy2941a482006-01-08 22:05:26 -0800270 nt = netdev_priv(dev);
Stephen Hemminger1326c3d2008-11-20 20:33:56 -0800271
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 nt->parms = *parms;
Nicolas Dichtelf37234162012-11-14 05:14:07 +0000273 if (ipip6_tunnel_create(dev) < 0)
Pavel Emelyanovb37d428b2008-02-26 23:51:04 -0800274 goto failed_free;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276 return nt;
277
Pavel Emelyanovb37d428b2008-02-26 23:51:04 -0800278failed_free:
David S. Millercf124db2017-05-08 12:52:56 -0400279 free_netdev(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280failed:
281 return NULL;
282}
283
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000284#define for_each_prl_rcu(start) \
285 for (prl = rcu_dereference(start); \
286 prl; \
287 prl = rcu_dereference(prl->next))
288
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400289static struct ip_tunnel_prl_entry *
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900290__ipip6_tunnel_locate_prl(struct ip_tunnel *t, __be32 addr)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400291{
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000292 struct ip_tunnel_prl_entry *prl;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400293
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000294 for_each_prl_rcu(t->prl)
295 if (prl->addr == addr)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400296 break;
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000297 return prl;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400298
299}
300
Christoph Hellwigfd5d6872020-05-19 15:03:15 +0200301static int ipip6_tunnel_get_prl(struct net_device *dev, struct ifreq *ifr)
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900302{
Christoph Hellwigfd5d6872020-05-19 15:03:15 +0200303 struct ip_tunnel_prl __user *a = ifr->ifr_ifru.ifru_data;
304 struct ip_tunnel *t = netdev_priv(dev);
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700305 struct ip_tunnel_prl kprl, *kp;
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900306 struct ip_tunnel_prl_entry *prl;
307 unsigned int cmax, c = 0, ca, len;
308 int ret = 0;
309
Christoph Hellwigfd5d6872020-05-19 15:03:15 +0200310 if (dev == dev_to_sit_net(dev)->fb_tunnel_dev)
311 return -EINVAL;
312
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700313 if (copy_from_user(&kprl, a, sizeof(kprl)))
314 return -EFAULT;
315 cmax = kprl.datalen / sizeof(kprl);
316 if (cmax > 1 && kprl.addr != htonl(INADDR_ANY))
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900317 cmax = 1;
318
319 /* For simple GET or for root users,
320 * we try harder to allocate.
321 */
322 kp = (cmax <= 1 || capable(CAP_NET_ADMIN)) ?
WANG Cong0ccc22f2017-06-22 15:29:33 -0700323 kcalloc(cmax, sizeof(*kp), GFP_KERNEL | __GFP_NOWARN) :
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900324 NULL;
325
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000326 rcu_read_lock();
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900327
328 ca = t->prl_count < cmax ? t->prl_count : cmax;
329
330 if (!kp) {
331 /* We don't try hard to allocate much memory for
332 * non-root users.
333 * For root users, retry allocating enough memory for
334 * the answer.
335 */
336 kp = kcalloc(ca, sizeof(*kp), GFP_ATOMIC);
337 if (!kp) {
338 ret = -ENOMEM;
339 goto out;
340 }
341 }
342
343 c = 0;
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000344 for_each_prl_rcu(t->prl) {
Sascha Hlusiak298bf122009-09-29 11:27:05 +0000345 if (c >= cmax)
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900346 break;
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700347 if (kprl.addr != htonl(INADDR_ANY) && prl->addr != kprl.addr)
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900348 continue;
349 kp[c].addr = prl->addr;
350 kp[c].flags = prl->flags;
351 c++;
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700352 if (kprl.addr != htonl(INADDR_ANY))
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900353 break;
354 }
355out:
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000356 rcu_read_unlock();
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900357
358 len = sizeof(*kp) * c;
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700359 ret = 0;
360 if ((len && copy_to_user(a + 1, kp, len)) || put_user(len, &a->datalen))
361 ret = -EFAULT;
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900362
363 kfree(kp);
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900364
YOSHIFUJI Hideaki2b4743b2008-06-16 16:48:20 -0700365 return ret;
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900366}
367
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400368static int
369ipip6_tunnel_add_prl(struct ip_tunnel *t, struct ip_tunnel_prl *a, int chg)
370{
371 struct ip_tunnel_prl_entry *p;
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900372 int err = 0;
373
YOSHIFUJI Hideaki0009ae12008-03-22 17:50:59 +0900374 if (a->addr == htonl(INADDR_ANY))
375 return -EINVAL;
376
Eric Dumazetaac4ddd2010-06-01 00:26:58 -0700377 ASSERT_RTNL();
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400378
Eric Dumazet3a43be32010-09-15 11:35:10 +0000379 for (p = rtnl_dereference(t->prl); p; p = rtnl_dereference(p->next)) {
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900380 if (p->addr == a->addr) {
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000381 if (chg) {
382 p->flags = a->flags;
383 goto out;
384 }
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900385 err = -EEXIST;
386 goto out;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400387 }
388 }
389
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900390 if (chg) {
391 err = -ENXIO;
392 goto out;
393 }
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400394
395 p = kzalloc(sizeof(struct ip_tunnel_prl_entry), GFP_KERNEL);
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900396 if (!p) {
397 err = -ENOBUFS;
398 goto out;
399 }
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400400
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400401 p->next = t->prl;
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900402 p->addr = a->addr;
403 p->flags = a->flags;
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000404 t->prl_count++;
Eric Dumazetcf778b02012-01-12 04:41:32 +0000405 rcu_assign_pointer(t->prl, p);
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900406out:
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900407 return err;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400408}
409
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000410static void prl_list_destroy_rcu(struct rcu_head *head)
411{
412 struct ip_tunnel_prl_entry *p, *n;
413
414 p = container_of(head, struct ip_tunnel_prl_entry, rcu_head);
415 do {
Eric Dumazet753ea8e2011-01-20 07:16:24 +0000416 n = rcu_dereference_protected(p->next, 1);
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000417 kfree(p);
418 p = n;
419 } while (p);
420}
421
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400422static int
423ipip6_tunnel_del_prl(struct ip_tunnel *t, struct ip_tunnel_prl *a)
424{
Eric Dumazet753ea8e2011-01-20 07:16:24 +0000425 struct ip_tunnel_prl_entry *x;
426 struct ip_tunnel_prl_entry __rcu **p;
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900427 int err = 0;
428
Eric Dumazetaac4ddd2010-06-01 00:26:58 -0700429 ASSERT_RTNL();
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400430
YOSHIFUJI Hideaki0009ae12008-03-22 17:50:59 +0900431 if (a && a->addr != htonl(INADDR_ANY)) {
Eric Dumazet753ea8e2011-01-20 07:16:24 +0000432 for (p = &t->prl;
433 (x = rtnl_dereference(*p)) != NULL;
434 p = &x->next) {
435 if (x->addr == a->addr) {
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400436 *p = x->next;
Paul E. McKenney11c476f32011-05-02 00:56:57 -0700437 kfree_rcu(x, rcu_head);
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900438 t->prl_count--;
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900439 goto out;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400440 }
441 }
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900442 err = -ENXIO;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400443 } else {
Eric Dumazet753ea8e2011-01-20 07:16:24 +0000444 x = rtnl_dereference(t->prl);
445 if (x) {
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000446 t->prl_count = 0;
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000447 call_rcu(&x->rcu_head, prl_list_destroy_rcu);
448 t->prl = NULL;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400449 }
450 }
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900451out:
Sascha Hlusiak4b27960172009-05-19 12:56:50 +0000452 return err;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400453}
454
Christoph Hellwigfd5d6872020-05-19 15:03:15 +0200455static int ipip6_tunnel_prl_ctl(struct net_device *dev, struct ifreq *ifr,
456 int cmd)
457{
458 struct ip_tunnel *t = netdev_priv(dev);
459 struct ip_tunnel_prl prl;
460 int err;
461
462 if (!ns_capable(t->net->user_ns, CAP_NET_ADMIN))
463 return -EPERM;
464 if (dev == dev_to_sit_net(dev)->fb_tunnel_dev)
465 return -EINVAL;
466
467 if (copy_from_user(&prl, ifr->ifr_ifru.ifru_data, sizeof(prl)))
468 return -EFAULT;
469
470 switch (cmd) {
471 case SIOCDELPRL:
472 err = ipip6_tunnel_del_prl(t, &prl);
473 break;
474 case SIOCADDPRL:
475 case SIOCCHGPRL:
476 err = ipip6_tunnel_add_prl(t, &prl, cmd == SIOCCHGPRL);
477 break;
478 }
479 dst_cache_reset(&t->dst_cache);
480 netdev_state_change(dev);
481 return err;
482}
483
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400484static int
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000485isatap_chksrc(struct sk_buff *skb, const struct iphdr *iph, struct ip_tunnel *t)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400486{
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900487 struct ip_tunnel_prl_entry *p;
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400488 int ok = 1;
489
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000490 rcu_read_lock();
YOSHIFUJI Hideaki3fcfa122008-03-22 17:42:57 +0900491 p = __ipip6_tunnel_locate_prl(t, iph->saddr);
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400492 if (p) {
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +0900493 if (p->flags & PRL_DEFAULT)
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400494 skb->ndisc_nodetype = NDISC_NODETYPE_DEFAULT;
495 else
496 skb->ndisc_nodetype = NDISC_NODETYPE_NODEFAULT;
497 } else {
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000498 const struct in6_addr *addr6 = &ipv6_hdr(skb)->saddr;
499
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400500 if (ipv6_addr_is_isatap(addr6) &&
501 (addr6->s6_addr32[3] == iph->saddr) &&
YOSHIFUJI Hideaki52eeeb82008-03-15 22:54:23 -0400502 ipv6_chk_prefix(addr6, t->dev))
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400503 skb->ndisc_nodetype = NDISC_NODETYPE_HOST;
504 else
505 ok = 0;
506 }
Eric Dumazetef9a9d12009-10-23 17:51:26 +0000507 rcu_read_unlock();
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -0400508 return ok;
509}
510
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511static void ipip6_tunnel_uninit(struct net_device *dev)
512{
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +0200513 struct ip_tunnel *tunnel = netdev_priv(dev);
514 struct sit_net *sitn = net_generic(tunnel->net, sit_net_id);
Pavel Emelyanovca8def12008-04-16 01:15:39 -0700515
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -0700516 if (dev == sitn->fb_tunnel_dev) {
Stephen Hemmingera9b3cd72011-08-01 16:19:00 +0000517 RCU_INIT_POINTER(sitn->tunnels_wc[0], NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 } else {
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +0200519 ipip6_tunnel_unlink(sitn, tunnel);
520 ipip6_tunnel_del_prl(tunnel, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 }
Paolo Abenie09acdd2016-02-12 15:43:55 +0100522 dst_cache_reset(&tunnel->dst_cache);
Eric Dumazet3a43be32010-09-15 11:35:10 +0000523 dev_put(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524}
525
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800526static int ipip6_err(struct sk_buff *skb, u32 info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527{
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000528 const struct iphdr *iph = (const struct iphdr *)skb->data;
Arnaldo Carvalho de Melo88c76642007-03-13 14:43:18 -0300529 const int type = icmp_hdr(skb)->type;
530 const int code = icmp_hdr(skb)->code;
Eric Dumazet20e19542016-06-18 21:52:06 -0700531 unsigned int data_len = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 struct ip_tunnel *t;
David Ahern3051fbe2017-10-30 10:07:17 -0700533 int sifindex;
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800534 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535
536 switch (type) {
537 default:
538 case ICMP_PARAMETERPROB:
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800539 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540
541 case ICMP_DEST_UNREACH:
542 switch (code) {
543 case ICMP_SR_FAILED:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700544 /* Impossible event. */
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800545 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546 default:
547 /* All others are translated to HOST_UNREACH.
548 rfc2003 contains "deep thoughts" about NET_UNREACH,
549 I believe they are just ether pollution. --ANK
550 */
551 break;
552 }
553 break;
554 case ICMP_TIME_EXCEEDED:
555 if (code != ICMP_EXC_TTL)
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800556 return 0;
Eric Dumazet20e19542016-06-18 21:52:06 -0700557 data_len = icmp_hdr(skb)->un.reserved[1] * 4; /* RFC 4884 4.1 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558 break;
David S. Millerec18d9a2012-07-12 00:25:15 -0700559 case ICMP_REDIRECT:
560 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561 }
562
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800563 err = -ENOENT;
564
David Ahern3051fbe2017-10-30 10:07:17 -0700565 sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
566 t = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
567 iph->daddr, iph->saddr, sifindex);
Ian Morris63159f22015-03-29 14:00:04 +0100568 if (!t)
David S. Miller36393392012-06-14 22:21:46 -0700569 goto out;
570
571 if (type == ICMP_DEST_UNREACH && code == ICMP_FRAG_NEEDED) {
572 ipv4_update_pmtu(skb, dev_net(skb->dev), info,
Maciej Żenczykowskid888f392018-09-25 20:56:26 -0700573 t->parms.link, iph->protocol);
David S. Miller36393392012-06-14 22:21:46 -0700574 err = 0;
575 goto out;
576 }
David S. Millerec18d9a2012-07-12 00:25:15 -0700577 if (type == ICMP_REDIRECT) {
Maciej Żenczykowski1042caa2018-09-25 20:56:27 -0700578 ipv4_redirect(skb, dev_net(skb->dev), t->parms.link,
579 iph->protocol);
David S. Millerec18d9a2012-07-12 00:25:15 -0700580 err = 0;
581 goto out;
582 }
David S. Miller36393392012-06-14 22:21:46 -0700583
Eric Dumazet2d7a3b22016-06-18 21:52:04 -0700584 err = 0;
Hangbin Liu173656a2019-02-07 18:36:11 +0800585 if (__in6_dev_get(skb->dev) &&
586 !ip6_err_gen_icmpv6_unreach(skb, iph->ihl * 4, type, data_len))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587 goto out;
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800588
Eric Dumazet2d7a3b22016-06-18 21:52:04 -0700589 if (t->parms.iph.daddr == 0)
Oussama Ghorbelca15a0782013-11-22 16:23:20 +0100590 goto out;
591
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592 if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED)
593 goto out;
594
Wei Yongjunbb800872009-02-24 23:37:19 -0800595 if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596 t->err_count++;
597 else
598 t->err_count = 1;
599 t->err_time = jiffies;
600out:
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -0800601 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602}
603
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000604static inline bool is_spoofed_6rd(struct ip_tunnel *tunnel, const __be32 v4addr,
605 const struct in6_addr *v6addr)
606{
607 __be32 v4embed = 0;
608 if (check_6rd(tunnel, v6addr, &v4embed) && v4addr != v4embed)
609 return true;
610 return false;
611}
612
Catalin\(ux\) M. BOIE7df37ff2013-09-23 23:04:19 +0300613/* Checks if an address matches an address on the tunnel interface.
614 * Used to detect the NAT of proto 41 packets and let them pass spoofing test.
615 * Long story:
616 * This function is called after we considered the packet as spoofed
617 * in is_spoofed_6rd.
618 * We may have a router that is doing NAT for proto 41 packets
619 * for an internal station. Destination a.a.a.a/PREFIX:bbbb:bbbb
620 * will be translated to n.n.n.n/PREFIX:bbbb:bbbb. And is_spoofed_6rd
621 * function will return true, dropping the packet.
622 * But, we can still check if is spoofed against the IP
623 * addresses associated with the interface.
624 */
625static bool only_dnatted(const struct ip_tunnel *tunnel,
626 const struct in6_addr *v6dst)
627{
628 int prefix_len;
629
630#ifdef CONFIG_IPV6_SIT_6RD
631 prefix_len = tunnel->ip6rd.prefixlen + 32
632 - tunnel->ip6rd.relay_prefixlen;
633#else
634 prefix_len = 48;
635#endif
636 return ipv6_chk_custom_prefix(v6dst, prefix_len, tunnel->dev);
637}
638
639/* Returns true if a packet is spoofed */
640static bool packet_is_spoofed(struct sk_buff *skb,
641 const struct iphdr *iph,
642 struct ip_tunnel *tunnel)
643{
644 const struct ipv6hdr *ipv6h;
645
646 if (tunnel->dev->priv_flags & IFF_ISATAP) {
647 if (!isatap_chksrc(skb, iph, tunnel))
648 return true;
649
650 return false;
651 }
652
653 if (tunnel->dev->flags & IFF_POINTOPOINT)
654 return false;
655
656 ipv6h = ipv6_hdr(skb);
657
658 if (unlikely(is_spoofed_6rd(tunnel, iph->saddr, &ipv6h->saddr))) {
659 net_warn_ratelimited("Src spoofed %pI4/%pI6c -> %pI4/%pI6c\n",
660 &iph->saddr, &ipv6h->saddr,
661 &iph->daddr, &ipv6h->daddr);
662 return true;
663 }
664
665 if (likely(!is_spoofed_6rd(tunnel, iph->daddr, &ipv6h->daddr)))
666 return false;
667
668 if (only_dnatted(tunnel, &ipv6h->daddr))
669 return false;
670
671 net_warn_ratelimited("Dst spoofed %pI4/%pI6c -> %pI4/%pI6c\n",
672 &iph->saddr, &ipv6h->saddr,
673 &iph->daddr, &ipv6h->daddr);
674 return true;
675}
676
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677static int ipip6_rcv(struct sk_buff *skb)
678{
Hannes Frederic Sowa1ad759d2013-01-18 09:18:17 +0000679 const struct iphdr *iph = ip_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700680 struct ip_tunnel *tunnel;
David Ahern3051fbe2017-10-30 10:07:17 -0700681 int sifindex;
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +0000682 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683
David Ahern3051fbe2017-10-30 10:07:17 -0700684 sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
Sascha Hlusiak4fddbf52009-05-19 12:56:49 +0000685 tunnel = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
David Ahern3051fbe2017-10-30 10:07:17 -0700686 iph->saddr, iph->daddr, sifindex);
Ian Morris53b24b82015-03-29 14:00:05 +0100687 if (tunnel) {
Li RongQing8f849852014-01-04 13:57:59 +0800688 struct pcpu_sw_netstats *tstats;
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000689
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000690 if (tunnel->parms.iph.protocol != IPPROTO_IPV6 &&
691 tunnel->parms.iph.protocol != 0)
692 goto out;
693
Arnaldo Carvalho de Melob0e380b12007-04-10 21:21:55 -0700694 skb->mac_header = skb->network_header;
Arnaldo Carvalho de Meloc1d2bbe2007-04-10 20:45:18 -0700695 skb_reset_network_header(skb);
Patrick McHardy8cdfab82006-01-06 23:04:01 -0800696 IPCB(skb)->flags = 0;
Jesse Grossa09a4c82016-03-19 09:32:02 -0700697 skb->dev = tunnel->dev;
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100698
Catalin\(ux\) M. BOIE7df37ff2013-09-23 23:04:19 +0300699 if (packet_is_spoofed(skb, iph, tunnel)) {
700 tunnel->dev->stats.rx_errors++;
701 goto out;
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +0000702 }
703
Jesse Grossa09a4c82016-03-19 09:32:02 -0700704 if (iptunnel_pull_header(skb, 0, htons(ETH_P_IPV6),
705 !net_eq(tunnel->net, dev_net(tunnel->dev))))
706 goto out;
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +0000707
Lorenzo Bianconibb9bd812019-04-04 16:37:53 +0200708 /* skb can be uncloned in iptunnel_pull_header, so
709 * old iph is no longer valid
710 */
711 iph = (const struct iphdr *)skb_mac_header(skb);
Nicolas Dichtelf4e0b4c2012-11-27 03:07:11 +0000712 err = IP_ECN_decapsulate(iph, skb);
713 if (unlikely(err)) {
714 if (log_ecn_error)
715 net_info_ratelimited("non-ECT from %pI4 with TOS=%#x\n",
716 &iph->saddr, iph->tos);
717 if (err > 1) {
718 ++tunnel->dev->stats.rx_frame_errors;
719 ++tunnel->dev->stats.rx_errors;
720 goto out;
721 }
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100722 }
Eric Dumazetd19d56d2010-05-17 22:36:55 -0700723
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000724 tstats = this_cpu_ptr(tunnel->dev->tstats);
Li RongQingc3ac17c2014-01-02 08:49:36 +0800725 u64_stats_update_begin(&tstats->syncp);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000726 tstats->rx_packets++;
727 tstats->rx_bytes += skb->len;
Li RongQingc3ac17c2014-01-02 08:49:36 +0800728 u64_stats_update_end(&tstats->syncp);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000729
Eric Dumazetcaf586e2010-09-30 21:06:55 +0000730 netif_rx(skb);
Eric Dumazet8990f462010-09-20 00:12:11 +0000731
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732 return 0;
733 }
734
David McCullough6dcdd1b32010-11-29 19:32:34 +0000735 /* no tunnel matched, let upstream know, ipsec may handle it */
David McCullough6dcdd1b32010-11-29 19:32:34 +0000736 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700737out:
David S. Miller36ca34c2008-05-08 23:40:26 -0700738 kfree_skb(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739 return 0;
740}
741
Simon Horman49dbe7a2016-07-07 07:56:13 +0200742static const struct tnl_ptk_info ipip_tpi = {
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000743 /* no tunnel info required for ipip. */
744 .proto = htons(ETH_P_IP),
745};
746
Simon Horman49dbe7a2016-07-07 07:56:13 +0200747#if IS_ENABLED(CONFIG_MPLS)
748static const struct tnl_ptk_info mplsip_tpi = {
749 /* no tunnel info required for mplsip. */
750 .proto = htons(ETH_P_MPLS_UC),
751};
752#endif
753
754static int sit_tunnel_rcv(struct sk_buff *skb, u8 ipproto)
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000755{
Pravin B Shelar3d7b46c2013-06-17 17:50:02 -0700756 const struct iphdr *iph;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000757 struct ip_tunnel *tunnel;
David Ahern3051fbe2017-10-30 10:07:17 -0700758 int sifindex;
759
760 sifindex = netif_is_l3_master(skb->dev) ? IPCB(skb)->iif : 0;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000761
Pravin B Shelar3d7b46c2013-06-17 17:50:02 -0700762 iph = ip_hdr(skb);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000763 tunnel = ipip6_tunnel_lookup(dev_net(skb->dev), skb->dev,
David Ahern3051fbe2017-10-30 10:07:17 -0700764 iph->saddr, iph->daddr, sifindex);
Ian Morris53b24b82015-03-29 14:00:05 +0100765 if (tunnel) {
Simon Horman49dbe7a2016-07-07 07:56:13 +0200766 const struct tnl_ptk_info *tpi;
767
768 if (tunnel->parms.iph.protocol != ipproto &&
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000769 tunnel->parms.iph.protocol != 0)
770 goto drop;
771
772 if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb))
773 goto drop;
Simon Horman49dbe7a2016-07-07 07:56:13 +0200774#if IS_ENABLED(CONFIG_MPLS)
775 if (ipproto == IPPROTO_MPLS)
776 tpi = &mplsip_tpi;
777 else
778#endif
779 tpi = &ipip_tpi;
780 if (iptunnel_pull_header(skb, 0, tpi->proto, false))
Li Hongjun737e8282013-08-28 11:54:50 +0200781 goto drop;
Simon Horman49dbe7a2016-07-07 07:56:13 +0200782 return ip_tunnel_rcv(tunnel, skb, tpi, NULL, log_ecn_error);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +0000783 }
784
785 return 1;
786
787drop:
788 kfree_skb(skb);
789 return 0;
790}
791
Simon Horman49dbe7a2016-07-07 07:56:13 +0200792static int ipip_rcv(struct sk_buff *skb)
793{
794 return sit_tunnel_rcv(skb, IPPROTO_IPIP);
795}
796
797#if IS_ENABLED(CONFIG_MPLS)
798static int mplsip_rcv(struct sk_buff *skb)
799{
800 return sit_tunnel_rcv(skb, IPPROTO_MPLS);
801}
802#endif
803
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000804/*
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000805 * If the IPv6 address comes from 6rd / 6to4 (RFC 3056) addr space this function
806 * stores the embedded IPv4 address in v4dst and returns true.
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000807 */
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000808static bool check_6rd(struct ip_tunnel *tunnel, const struct in6_addr *v6dst,
809 __be32 *v4dst)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810{
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000811#ifdef CONFIG_IPV6_SIT_6RD
812 if (ipv6_prefix_equal(v6dst, &tunnel->ip6rd.prefix,
813 tunnel->ip6rd.prefixlen)) {
Eric Dumazet3a43be32010-09-15 11:35:10 +0000814 unsigned int pbw0, pbi0;
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000815 int pbi1;
816 u32 d;
817
818 pbw0 = tunnel->ip6rd.prefixlen >> 5;
819 pbi0 = tunnel->ip6rd.prefixlen & 0x1f;
820
Miaohe Lina843dc42019-03-11 16:29:32 +0800821 d = tunnel->ip6rd.relay_prefixlen < 32 ?
822 (ntohl(v6dst->s6_addr32[pbw0]) << pbi0) >>
823 tunnel->ip6rd.relay_prefixlen : 0;
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000824
825 pbi1 = pbi0 - tunnel->ip6rd.relay_prefixlen;
826 if (pbi1 > 0)
YOSHIFUJI Hideaki / 吉藤英明e7db38c2009-10-11 03:44:45 +0000827 d |= ntohl(v6dst->s6_addr32[pbw0 + 1]) >>
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000828 (32 - pbi1);
829
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000830 *v4dst = tunnel->ip6rd.relay_prefix | htonl(d);
831 return true;
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000832 }
833#else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700834 if (v6dst->s6_addr16[0] == htons(0x2002)) {
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900835 /* 6to4 v6 addr has 16 bits prefix, 32 v4addr, 16 SLA, ... */
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000836 memcpy(v4dst, &v6dst->s6_addr16[1], 4);
837 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838 }
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +0000839#endif
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000840 return false;
841}
842
843static inline __be32 try_6rd(struct ip_tunnel *tunnel,
844 const struct in6_addr *v6dst)
845{
846 __be32 dst = 0;
847 check_6rd(tunnel, v6dst, &dst);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700848 return dst;
849}
850
851/*
852 * This function assumes it is being called from dev_queue_xmit()
853 * and that skb is filled properly by that function.
854 */
855
Stephen Hemminger6fef4c02009-08-31 19:50:41 +0000856static netdev_tx_t ipip6_tunnel_xmit(struct sk_buff *skb,
857 struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700858{
Patrick McHardy2941a482006-01-08 22:05:26 -0800859 struct ip_tunnel *tunnel = netdev_priv(dev);
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000860 const struct iphdr *tiph = &tunnel->parms.iph;
861 const struct ipv6hdr *iph6 = ipv6_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700862 u8 tos = tunnel->parms.iph.tos;
Herbert Xu292f4f32009-11-09 08:42:01 +0000863 __be16 df = tiph->frag_off;
Ian Morris67ba4152014-08-24 21:53:10 +0100864 struct rtable *rt; /* Route to the other host */
865 struct net_device *tdev; /* Device to other host */
866 unsigned int max_headroom; /* The extra header space needed */
Al Viroe69a4ad2006-11-14 20:56:00 -0800867 __be32 dst = tiph->daddr;
David S. Miller31e4543d2011-05-03 20:25:42 -0700868 struct flowi4 fl4;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700869 int mtu;
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000870 const struct in6_addr *addr6;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700871 int addr_type;
Pravin B Shelar0e6fbc52013-06-17 17:49:56 -0700872 u8 ttl;
Tom Herbert14909662014-09-17 12:25:59 -0700873 u8 protocol = IPPROTO_IPV6;
874 int t_hlen = tunnel->hlen + sizeof(struct iphdr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700875
Lionel Elie Mamanec2bceb32011-08-13 14:04:38 +0000876 if (tos == 1)
877 tos = ipv6_get_dsfield(iph6);
878
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100879 /* ISATAP (RFC4214) - must come before 6to4 */
880 if (dev->priv_flags & IFF_ISATAP) {
881 struct neighbour *neigh = NULL;
David S. Miller1e2927b2012-01-26 15:23:21 -0500882 bool do_tx_error = false;
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100883
Eric Dumazetadf30902009-06-02 05:19:30 +0000884 if (skb_dst(skb))
David S. Miller1e2927b2012-01-26 15:23:21 -0500885 neigh = dst_neigh_lookup(skb_dst(skb), &iph6->daddr);
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100886
Ian Morris63159f22015-03-29 14:00:04 +0100887 if (!neigh) {
Catalin\(ux\) M. BOIE7df37ff2013-09-23 23:04:19 +0300888 net_dbg_ratelimited("nexthop == NULL\n");
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100889 goto tx_error;
890 }
891
Eldad Zack3e866702012-04-01 07:49:01 +0000892 addr6 = (const struct in6_addr *)&neigh->primary_key;
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100893 addr_type = ipv6_addr_type(addr6);
894
895 if ((addr_type & IPV6_ADDR_UNICAST) &&
896 ipv6_addr_is_isatap(addr6))
897 dst = addr6->s6_addr32[3];
898 else
David S. Miller1e2927b2012-01-26 15:23:21 -0500899 do_tx_error = true;
900
901 neigh_release(neigh);
902 if (do_tx_error)
Fred L. Templinc7dc89c2007-11-29 22:11:40 +1100903 goto tx_error;
904 }
905
Linus Torvalds1da177e2005-04-16 15:20:36 -0700906 if (!dst)
Hannes Frederic Sowa218774d2013-01-29 08:24:25 +0000907 dst = try_6rd(tunnel, &iph6->daddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700908
909 if (!dst) {
910 struct neighbour *neigh = NULL;
David S. Miller1e2927b2012-01-26 15:23:21 -0500911 bool do_tx_error = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700912
Eric Dumazetadf30902009-06-02 05:19:30 +0000913 if (skb_dst(skb))
David S. Miller1e2927b2012-01-26 15:23:21 -0500914 neigh = dst_neigh_lookup(skb_dst(skb), &iph6->daddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915
Ian Morris63159f22015-03-29 14:00:04 +0100916 if (!neigh) {
Catalin\(ux\) M. BOIE7df37ff2013-09-23 23:04:19 +0300917 net_dbg_ratelimited("nexthop == NULL\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918 goto tx_error;
919 }
920
Eldad Zack3e866702012-04-01 07:49:01 +0000921 addr6 = (const struct in6_addr *)&neigh->primary_key;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700922 addr_type = ipv6_addr_type(addr6);
923
924 if (addr_type == IPV6_ADDR_ANY) {
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700925 addr6 = &ipv6_hdr(skb)->daddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926 addr_type = ipv6_addr_type(addr6);
927 }
928
David S. Miller1e2927b2012-01-26 15:23:21 -0500929 if ((addr_type & IPV6_ADDR_COMPATv4) != 0)
930 dst = addr6->s6_addr32[3];
931 else
932 do_tx_error = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700933
David S. Miller1e2927b2012-01-26 15:23:21 -0500934 neigh_release(neigh);
935 if (do_tx_error)
936 goto tx_error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 }
938
Craig Gallek9830ad42017-04-19 12:30:54 -0400939 flowi4_init_output(&fl4, tunnel->parms.link, tunnel->fwmark,
940 RT_TOS(tos), RT_SCOPE_UNIVERSE, IPPROTO_IPV6,
941 0, dst, tiph->saddr, 0, 0,
942 sock_net_uid(tunnel->net, NULL));
Craig Gallek9830ad42017-04-19 12:30:54 -0400943
Haishuang Yan6e3d1bb2019-07-14 21:31:22 +0800944 rt = dst_cache_get_ip4(&tunnel->dst_cache, &fl4.saddr);
945 if (!rt) {
946 rt = ip_route_output_flow(tunnel->net, &fl4, NULL);
947 if (IS_ERR(rt)) {
948 dev->stats.tx_carrier_errors++;
949 goto tx_error_icmp;
950 }
951 dst_cache_set_ip4(&tunnel->dst_cache, &rt->dst, fl4.saddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952 }
Haishuang Yan6e3d1bb2019-07-14 21:31:22 +0800953
Linus Torvalds1da177e2005-04-16 15:20:36 -0700954 if (rt->rt_type != RTN_UNICAST) {
955 ip_rt_put(rt);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000956 dev->stats.tx_carrier_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700957 goto tx_error_icmp;
958 }
Changli Gaod8d1f302010-06-10 23:31:35 -0700959 tdev = rt->dst.dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700960
961 if (tdev == dev) {
962 ip_rt_put(rt);
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000963 dev->stats.collisions++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700964 goto tx_error;
965 }
966
Tom Herbert7e133182016-05-18 09:06:10 -0700967 if (iptunnel_handle_offloads(skb, SKB_GSO_IPXIP4)) {
Tom Herbert14909662014-09-17 12:25:59 -0700968 ip_rt_put(rt);
Alexander Duyckaed069d2016-04-14 15:33:37 -0400969 goto tx_error;
Tom Herbert14909662014-09-17 12:25:59 -0700970 }
971
Herbert Xu292f4f32009-11-09 08:42:01 +0000972 if (df) {
Tom Herbert14909662014-09-17 12:25:59 -0700973 mtu = dst_mtu(&rt->dst) - t_hlen;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974
Herbert Xu292f4f32009-11-09 08:42:01 +0000975 if (mtu < 68) {
Eric Dumazet15fc1f72010-09-27 00:38:18 +0000976 dev->stats.collisions++;
Herbert Xu292f4f32009-11-09 08:42:01 +0000977 ip_rt_put(rt);
978 goto tx_error;
979 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700980
Herbert Xu292f4f32009-11-09 08:42:01 +0000981 if (mtu < IPV6_MIN_MTU) {
982 mtu = IPV6_MIN_MTU;
983 df = 0;
984 }
985
Nicolas Dichtelf15ca722018-01-25 19:03:03 +0100986 if (tunnel->parms.iph.daddr)
Hangbin Liu4d42df42019-12-22 10:51:15 +0800987 skb_dst_update_pmtu_no_confirm(skb, mtu);
Herbert Xu292f4f32009-11-09 08:42:01 +0000988
Eric Dumazet58a47822013-12-16 06:31:23 -0800989 if (skb->len > mtu && !skb_is_gso(skb)) {
Jason A. Donenfeld43723392021-02-27 01:40:19 +0100990 icmpv6_ndo_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
Herbert Xu292f4f32009-11-09 08:42:01 +0000991 ip_rt_put(rt);
992 goto tx_error;
993 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994 }
995
996 if (tunnel->err_count > 0) {
Wei Yongjunbb800872009-02-24 23:37:19 -0800997 if (time_before(jiffies,
998 tunnel->err_time + IPTUNNEL_ERR_TIMEO)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700999 tunnel->err_count--;
1000 dst_link_failure(skb);
1001 } else
1002 tunnel->err_count = 0;
1003 }
1004
1005 /*
1006 * Okay, now see if we can stuff it in the buffer as-is.
1007 */
Tom Herbert14909662014-09-17 12:25:59 -07001008 max_headroom = LL_RESERVED_SPACE(tdev) + t_hlen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001009
Patrick McHardycfbba492007-07-09 15:33:40 -07001010 if (skb_headroom(skb) < max_headroom || skb_shared(skb) ||
1011 (skb_cloned(skb) && !skb_clone_writable(skb, 0))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012 struct sk_buff *new_skb = skb_realloc_headroom(skb, max_headroom);
1013 if (!new_skb) {
1014 ip_rt_put(rt);
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001015 dev->stats.tx_dropped++;
Gao feng66028312013-11-25 17:21:24 +08001016 kfree_skb(skb);
Patrick McHardy6ed10652009-06-23 06:03:08 +00001017 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018 }
1019 if (skb->sk)
1020 skb_set_owner_w(new_skb, skb->sk);
1021 dev_kfree_skb(skb);
1022 skb = new_skb;
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -07001023 iph6 = ipv6_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024 }
Pravin B Shelar0e6fbc52013-06-17 17:49:56 -07001025 ttl = tiph->ttl;
1026 if (ttl == 0)
1027 ttl = iph6->hop_limit;
1028 tos = INET_ECN_encapsulate(tos, ipv6_get_dsfield(iph6));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001029
Tom Herbert14909662014-09-17 12:25:59 -07001030 if (ip_tunnel_encap(skb, tunnel, &protocol, &fl4) < 0) {
Li RongQing6a9eadc2013-12-20 17:20:12 +08001031 ip_rt_put(rt);
Tom Herbert14909662014-09-17 12:25:59 -07001032 goto tx_error;
Li RongQing6a9eadc2013-12-20 17:20:12 +08001033 }
Hannes Frederic Sowa3d483052013-08-18 13:46:52 +02001034
Tom Herbert469471c2014-09-29 20:22:30 -07001035 skb_set_inner_ipproto(skb, IPPROTO_IPV6);
1036
Pravin B Shelar039f5062015-12-24 14:34:54 -08001037 iptunnel_xmit(NULL, rt, skb, fl4.saddr, fl4.daddr, protocol, tos, ttl,
1038 df, !net_eq(tunnel->net, dev_net(dev)));
Patrick McHardy6ed10652009-06-23 06:03:08 +00001039 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001040
1041tx_error_icmp:
1042 dst_link_failure(skb);
1043tx_error:
Gao feng66028312013-11-25 17:21:24 +08001044 kfree_skb(skb);
Eric Dumazet61c1db72013-10-20 20:47:30 -07001045 dev->stats.tx_errors++;
Patrick McHardy6ed10652009-06-23 06:03:08 +00001046 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047}
1048
Simon Horman49dbe7a2016-07-07 07:56:13 +02001049static netdev_tx_t sit_tunnel_xmit__(struct sk_buff *skb,
1050 struct net_device *dev, u8 ipproto)
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001051{
1052 struct ip_tunnel *tunnel = netdev_priv(dev);
1053 const struct iphdr *tiph = &tunnel->parms.iph;
1054
Tom Herbert7e133182016-05-18 09:06:10 -07001055 if (iptunnel_handle_offloads(skb, SKB_GSO_IPXIP4))
Alexander Duyckaed069d2016-04-14 15:33:37 -04001056 goto tx_error;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001057
Simon Horman49dbe7a2016-07-07 07:56:13 +02001058 skb_set_inner_ipproto(skb, ipproto);
Tom Herbert469471c2014-09-29 20:22:30 -07001059
Simon Horman49dbe7a2016-07-07 07:56:13 +02001060 ip_tunnel_xmit(skb, dev, tiph, ipproto);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001061 return NETDEV_TX_OK;
Alexander Duyckaed069d2016-04-14 15:33:37 -04001062tx_error:
1063 kfree_skb(skb);
Eric Dumazet61c1db72013-10-20 20:47:30 -07001064 dev->stats.tx_errors++;
1065 return NETDEV_TX_OK;
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001066}
1067
1068static netdev_tx_t sit_tunnel_xmit(struct sk_buff *skb,
1069 struct net_device *dev)
1070{
Willem de Bruijncb9f1b72018-12-30 17:24:36 -05001071 if (!pskb_inet_may_pull(skb))
1072 goto tx_err;
1073
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001074 switch (skb->protocol) {
1075 case htons(ETH_P_IP):
Simon Horman49dbe7a2016-07-07 07:56:13 +02001076 sit_tunnel_xmit__(skb, dev, IPPROTO_IPIP);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001077 break;
1078 case htons(ETH_P_IPV6):
1079 ipip6_tunnel_xmit(skb, dev);
1080 break;
Simon Horman49dbe7a2016-07-07 07:56:13 +02001081#if IS_ENABLED(CONFIG_MPLS)
1082 case htons(ETH_P_MPLS_UC):
1083 sit_tunnel_xmit__(skb, dev, IPPROTO_MPLS);
1084 break;
1085#endif
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001086 default:
1087 goto tx_err;
1088 }
1089
1090 return NETDEV_TX_OK;
1091
1092tx_err:
1093 dev->stats.tx_errors++;
Gao feng66028312013-11-25 17:21:24 +08001094 kfree_skb(skb);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001095 return NETDEV_TX_OK;
1096
1097}
1098
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001099static void ipip6_tunnel_bind_dev(struct net_device *dev)
1100{
1101 struct net_device *tdev = NULL;
1102 struct ip_tunnel *tunnel;
Eric Dumazetb71d1d42011-04-22 04:53:02 +00001103 const struct iphdr *iph;
David S. Miller31e4543d2011-05-03 20:25:42 -07001104 struct flowi4 fl4;
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001105
1106 tunnel = netdev_priv(dev);
1107 iph = &tunnel->parms.iph;
1108
1109 if (iph->daddr) {
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001110 struct rtable *rt = ip_route_output_ports(tunnel->net, &fl4,
1111 NULL,
David S. Miller78fbfd82011-03-12 00:00:52 -05001112 iph->daddr, iph->saddr,
1113 0, 0,
1114 IPPROTO_IPV6,
1115 RT_TOS(iph->tos),
1116 tunnel->parms.link);
David S. Millerb23dd4f2011-03-02 14:31:35 -08001117
1118 if (!IS_ERR(rt)) {
Changli Gaod8d1f302010-06-10 23:31:35 -07001119 tdev = rt->dst.dev;
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001120 ip_rt_put(rt);
1121 }
1122 dev->flags |= IFF_POINTOPOINT;
1123 }
1124
1125 if (!tdev && tunnel->parms.link)
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001126 tdev = __dev_get_by_index(tunnel->net, tunnel->parms.link);
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001127
Stephen Suryaputraff6ab322019-05-06 15:00:01 -04001128 if (tdev && !netif_is_l3_master(tdev)) {
Tom Herbert14909662014-09-17 12:25:59 -07001129 int t_hlen = tunnel->hlen + sizeof(struct iphdr);
1130
Tom Herbert14909662014-09-17 12:25:59 -07001131 dev->mtu = tdev->mtu - t_hlen;
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001132 if (dev->mtu < IPV6_MIN_MTU)
1133 dev->mtu = IPV6_MIN_MTU;
1134 }
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001135}
1136
Craig Gallek9830ad42017-04-19 12:30:54 -04001137static void ipip6_tunnel_update(struct ip_tunnel *t, struct ip_tunnel_parm *p,
1138 __u32 fwmark)
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001139{
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001140 struct net *net = t->net;
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001141 struct sit_net *sitn = net_generic(net, sit_net_id);
1142
1143 ipip6_tunnel_unlink(sitn, t);
1144 synchronize_net();
1145 t->parms.iph.saddr = p->iph.saddr;
1146 t->parms.iph.daddr = p->iph.daddr;
1147 memcpy(t->dev->dev_addr, &p->iph.saddr, 4);
1148 memcpy(t->dev->broadcast, &p->iph.daddr, 4);
1149 ipip6_tunnel_link(sitn, t);
1150 t->parms.iph.ttl = p->iph.ttl;
1151 t->parms.iph.tos = p->iph.tos;
Hangbin Liuf859b4a2017-11-30 10:41:14 +08001152 t->parms.iph.frag_off = p->iph.frag_off;
Craig Gallek9830ad42017-04-19 12:30:54 -04001153 if (t->parms.link != p->link || t->fwmark != fwmark) {
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001154 t->parms.link = p->link;
Craig Gallek9830ad42017-04-19 12:30:54 -04001155 t->fwmark = fwmark;
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001156 ipip6_tunnel_bind_dev(t->dev);
1157 }
Paolo Abenie09acdd2016-02-12 15:43:55 +01001158 dst_cache_reset(&t->dst_cache);
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001159 netdev_state_change(t->dev);
1160}
1161
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001162#ifdef CONFIG_IPV6_SIT_6RD
1163static int ipip6_tunnel_update_6rd(struct ip_tunnel *t,
1164 struct ip_tunnel_6rd *ip6rd)
1165{
1166 struct in6_addr prefix;
1167 __be32 relay_prefix;
1168
1169 if (ip6rd->relay_prefixlen > 32 ||
1170 ip6rd->prefixlen + (32 - ip6rd->relay_prefixlen) > 64)
1171 return -EINVAL;
1172
1173 ipv6_addr_prefix(&prefix, &ip6rd->prefix, ip6rd->prefixlen);
1174 if (!ipv6_addr_equal(&prefix, &ip6rd->prefix))
1175 return -EINVAL;
1176 if (ip6rd->relay_prefixlen)
1177 relay_prefix = ip6rd->relay_prefix &
1178 htonl(0xffffffffUL <<
1179 (32 - ip6rd->relay_prefixlen));
1180 else
1181 relay_prefix = 0;
1182 if (relay_prefix != ip6rd->relay_prefix)
1183 return -EINVAL;
1184
1185 t->ip6rd.prefix = prefix;
1186 t->ip6rd.relay_prefix = relay_prefix;
1187 t->ip6rd.prefixlen = ip6rd->prefixlen;
1188 t->ip6rd.relay_prefixlen = ip6rd->relay_prefixlen;
Paolo Abenie09acdd2016-02-12 15:43:55 +01001189 dst_cache_reset(&t->dst_cache);
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001190 netdev_state_change(t->dev);
1191 return 0;
1192}
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001193
1194static int
1195ipip6_tunnel_get6rd(struct net_device *dev, struct ifreq *ifr)
1196{
1197 struct ip_tunnel *t = netdev_priv(dev);
1198 struct ip_tunnel_6rd ip6rd;
1199 struct ip_tunnel_parm p;
1200
1201 if (dev == dev_to_sit_net(dev)->fb_tunnel_dev) {
1202 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
1203 return -EFAULT;
1204 t = ipip6_tunnel_locate(t->net, &p, 0);
1205 }
1206 if (!t)
1207 t = netdev_priv(dev);
1208
1209 ip6rd.prefix = t->ip6rd.prefix;
1210 ip6rd.relay_prefix = t->ip6rd.relay_prefix;
1211 ip6rd.prefixlen = t->ip6rd.prefixlen;
1212 ip6rd.relay_prefixlen = t->ip6rd.relay_prefixlen;
1213 if (copy_to_user(ifr->ifr_ifru.ifru_data, &ip6rd, sizeof(ip6rd)))
1214 return -EFAULT;
1215 return 0;
1216}
1217
1218static int
1219ipip6_tunnel_6rdctl(struct net_device *dev, struct ifreq *ifr, int cmd)
1220{
1221 struct ip_tunnel *t = netdev_priv(dev);
1222 struct ip_tunnel_6rd ip6rd;
1223 int err;
1224
1225 if (!ns_capable(t->net->user_ns, CAP_NET_ADMIN))
1226 return -EPERM;
1227 if (copy_from_user(&ip6rd, ifr->ifr_ifru.ifru_data, sizeof(ip6rd)))
1228 return -EFAULT;
1229
1230 if (cmd != SIOCDEL6RD) {
1231 err = ipip6_tunnel_update_6rd(t, &ip6rd);
1232 if (err < 0)
1233 return err;
1234 } else
1235 ipip6_tunnel_clone_6rd(dev, dev_to_sit_net(dev));
1236 return 0;
1237}
1238
1239#endif /* CONFIG_IPV6_SIT_6RD */
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001240
Wei Yongjun03ff4972016-08-13 01:54:15 +00001241static bool ipip6_valid_ip_proto(u8 ipproto)
Simon Horman49dbe7a2016-07-07 07:56:13 +02001242{
1243 return ipproto == IPPROTO_IPV6 ||
1244 ipproto == IPPROTO_IPIP ||
1245#if IS_ENABLED(CONFIG_MPLS)
1246 ipproto == IPPROTO_MPLS ||
1247#endif
1248 ipproto == 0;
1249}
1250
Linus Torvalds1da177e2005-04-16 15:20:36 -07001251static int
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001252__ipip6_tunnel_ioctl_validate(struct net *net, struct ip_tunnel_parm *p)
1253{
1254 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
1255 return -EPERM;
1256
1257 if (!ipip6_valid_ip_proto(p->iph.protocol))
1258 return -EINVAL;
1259 if (p->iph.version != 4 ||
1260 p->iph.ihl != 5 || (p->iph.frag_off & htons(~IP_DF)))
1261 return -EINVAL;
1262
1263 if (p->iph.ttl)
1264 p->iph.frag_off |= htons(IP_DF);
1265 return 0;
1266}
1267
1268static int
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001269ipip6_tunnel_get(struct net_device *dev, struct ip_tunnel_parm *p)
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001270{
1271 struct ip_tunnel *t = netdev_priv(dev);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001272
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001273 if (dev == dev_to_sit_net(dev)->fb_tunnel_dev)
1274 t = ipip6_tunnel_locate(t->net, p, 0);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001275 if (!t)
1276 t = netdev_priv(dev);
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001277 memcpy(p, &t->parms, sizeof(*p));
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001278 return 0;
1279}
1280
1281static int
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001282ipip6_tunnel_add(struct net_device *dev, struct ip_tunnel_parm *p)
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001283{
1284 struct ip_tunnel *t = netdev_priv(dev);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001285 int err;
1286
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001287 err = __ipip6_tunnel_ioctl_validate(t->net, p);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001288 if (err)
1289 return err;
1290
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001291 t = ipip6_tunnel_locate(t->net, p, 1);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001292 if (!t)
1293 return -ENOBUFS;
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001294 return 0;
1295}
1296
1297static int
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001298ipip6_tunnel_change(struct net_device *dev, struct ip_tunnel_parm *p)
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001299{
1300 struct ip_tunnel *t = netdev_priv(dev);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001301 int err;
1302
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001303 err = __ipip6_tunnel_ioctl_validate(t->net, p);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001304 if (err)
1305 return err;
1306
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001307 t = ipip6_tunnel_locate(t->net, p, 0);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001308 if (dev == dev_to_sit_net(dev)->fb_tunnel_dev) {
1309 if (!t)
1310 return -ENOENT;
1311 } else {
1312 if (t) {
1313 if (t->dev != dev)
1314 return -EEXIST;
1315 } else {
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001316 if (((dev->flags & IFF_POINTOPOINT) && !p->iph.daddr) ||
1317 (!(dev->flags & IFF_POINTOPOINT) && p->iph.daddr))
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001318 return -EINVAL;
1319 t = netdev_priv(dev);
1320 }
1321
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001322 ipip6_tunnel_update(t, p, t->fwmark);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001323 }
1324
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001325 return 0;
1326}
1327
1328static int
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001329ipip6_tunnel_del(struct net_device *dev, struct ip_tunnel_parm *p)
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001330{
1331 struct ip_tunnel *t = netdev_priv(dev);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001332
1333 if (!ns_capable(t->net->user_ns, CAP_NET_ADMIN))
1334 return -EPERM;
1335
1336 if (dev == dev_to_sit_net(dev)->fb_tunnel_dev) {
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001337 t = ipip6_tunnel_locate(t->net, p, 0);
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001338 if (!t)
1339 return -ENOENT;
1340 if (t == netdev_priv(dev_to_sit_net(dev)->fb_tunnel_dev))
1341 return -EPERM;
1342 dev = t->dev;
1343 }
1344 unregister_netdevice(dev);
1345 return 0;
1346}
1347
1348static int
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001349ipip6_tunnel_ctl(struct net_device *dev, struct ip_tunnel_parm *p, int cmd)
1350{
1351 switch (cmd) {
1352 case SIOCGETTUNNEL:
1353 return ipip6_tunnel_get(dev, p);
1354 case SIOCADDTUNNEL:
1355 return ipip6_tunnel_add(dev, p);
1356 case SIOCCHGTUNNEL:
1357 return ipip6_tunnel_change(dev, p);
1358 case SIOCDELTUNNEL:
1359 return ipip6_tunnel_del(dev, p);
1360 default:
1361 return -EINVAL;
1362 }
1363}
1364
1365static int
Ian Morris67ba4152014-08-24 21:53:10 +01001366ipip6_tunnel_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001367{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001368 switch (cmd) {
1369 case SIOCGETTUNNEL:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001370 case SIOCADDTUNNEL:
1371 case SIOCCHGTUNNEL:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372 case SIOCDELTUNNEL:
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001373 return ip_tunnel_ioctl(dev, ifr, cmd);
YOSHIFUJI Hideaki300aaee2008-03-24 18:28:39 +09001374 case SIOCGETPRL:
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001375 return ipip6_tunnel_get_prl(dev, ifr);
Templin, Fred Lfadf6bf2008-03-11 18:35:59 -04001376 case SIOCADDPRL:
1377 case SIOCDELPRL:
1378 case SIOCCHGPRL:
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001379 return ipip6_tunnel_prl_ctl(dev, ifr, cmd);
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001380#ifdef CONFIG_IPV6_SIT_6RD
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001381 case SIOCGET6RD:
1382 return ipip6_tunnel_get6rd(dev, ifr);
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001383 case SIOCADD6RD:
1384 case SIOCCHG6RD:
1385 case SIOCDEL6RD:
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001386 return ipip6_tunnel_6rdctl(dev, ifr, cmd);
YOSHIFUJI Hideaki / 吉藤英明fa857af2009-09-22 23:43:14 +00001387#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001388 default:
Christoph Hellwigfd5d6872020-05-19 15:03:15 +02001389 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001390 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001391}
1392
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001393static const struct net_device_ops ipip6_netdev_ops = {
Steffen Klassertebe084a2014-11-03 09:19:29 +01001394 .ndo_init = ipip6_tunnel_init,
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001395 .ndo_uninit = ipip6_tunnel_uninit,
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001396 .ndo_start_xmit = sit_tunnel_xmit,
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001397 .ndo_do_ioctl = ipip6_tunnel_ioctl,
Heiner Kallweit98d7fc42020-11-07 21:54:33 +01001398 .ndo_get_stats64 = dev_get_tstats64,
Nicolas Dichtel1e995842015-04-02 17:07:02 +02001399 .ndo_get_iflink = ip_tunnel_get_iflink,
Christoph Hellwigf60fe2d2020-05-19 15:03:16 +02001400 .ndo_tunnel_ctl = ipip6_tunnel_ctl,
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001401};
1402
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001403static void ipip6_dev_free(struct net_device *dev)
1404{
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001405 struct ip_tunnel *tunnel = netdev_priv(dev);
1406
Paolo Abenie09acdd2016-02-12 15:43:55 +01001407 dst_cache_destroy(&tunnel->dst_cache);
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001408 free_percpu(dev->tstats);
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001409}
1410
Eric Dumazet61c1db72013-10-20 20:47:30 -07001411#define SIT_FEATURES (NETIF_F_SG | \
1412 NETIF_F_FRAGLIST | \
1413 NETIF_F_HIGHDMA | \
1414 NETIF_F_GSO_SOFTWARE | \
1415 NETIF_F_HW_CSUM)
1416
Linus Torvalds1da177e2005-04-16 15:20:36 -07001417static void ipip6_tunnel_setup(struct net_device *dev)
1418{
Tom Herbert14909662014-09-17 12:25:59 -07001419 struct ip_tunnel *tunnel = netdev_priv(dev);
1420 int t_hlen = tunnel->hlen + sizeof(struct iphdr);
1421
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001422 dev->netdev_ops = &ipip6_netdev_ops;
Jason A. Donenfeld75ea1f42020-06-29 19:06:24 -06001423 dev->header_ops = &ip_tunnel_header_ops;
David S. Millercf124db2017-05-08 12:52:56 -04001424 dev->needs_free_netdev = true;
1425 dev->priv_destructor = ipip6_dev_free;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001426
1427 dev->type = ARPHRD_SIT;
Tom Herbert14909662014-09-17 12:25:59 -07001428 dev->mtu = ETH_DATA_LEN - t_hlen;
Jarod Wilsonb96f9af2016-10-20 13:55:24 -04001429 dev->min_mtu = IPV6_MIN_MTU;
Nicolas Dichtelf7ff1fd2018-05-31 10:59:33 +02001430 dev->max_mtu = IP6_MAX_MTU - t_hlen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431 dev->flags = IFF_NOARP;
Eric Dumazet02875872014-10-05 18:38:35 -07001432 netif_keep_dst(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001433 dev->addr_len = 4;
Eric Dumazet8df40d12010-09-28 02:53:41 +00001434 dev->features |= NETIF_F_LLTX;
Eric Dumazet61c1db72013-10-20 20:47:30 -07001435 dev->features |= SIT_FEATURES;
1436 dev->hw_features |= SIT_FEATURES;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001437}
1438
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001439static int ipip6_tunnel_init(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001440{
Stephen Hemminger1326c3d2008-11-20 20:33:56 -08001441 struct ip_tunnel *tunnel = netdev_priv(dev);
Paolo Abenie09acdd2016-02-12 15:43:55 +01001442 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001443
1444 tunnel->dev = dev;
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001445 tunnel->net = dev_net(dev);
Steffen Klassertebe084a2014-11-03 09:19:29 +01001446 strcpy(tunnel->parms.name, dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447
Michal Schmidt8a4a50f2007-12-13 09:47:00 -08001448 ipip6_tunnel_bind_dev(dev);
WANG Cong1c213bd2014-02-13 11:46:28 -08001449 dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001450 if (!dev->tstats)
1451 return -ENOMEM;
1452
Paolo Abenie09acdd2016-02-12 15:43:55 +01001453 err = dst_cache_init(&tunnel->dst_cache, GFP_KERNEL);
1454 if (err) {
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001455 free_percpu(dev->tstats);
WANG Congd7426c62017-02-08 10:02:13 -08001456 dev->tstats = NULL;
Paolo Abenie09acdd2016-02-12 15:43:55 +01001457 return err;
Nicolas Dichtelcf71d2bc2014-02-20 10:19:31 +01001458 }
1459
Eric Dumazet15fc1f72010-09-27 00:38:18 +00001460 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461}
1462
Eric Dumazet4ece9002015-11-02 17:08:19 -08001463static void __net_init ipip6_fb_tunnel_init(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001464{
Patrick McHardy2941a482006-01-08 22:05:26 -08001465 struct ip_tunnel *tunnel = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001466 struct iphdr *iph = &tunnel->parms.iph;
Pavel Emelyanov29182172008-04-16 01:16:38 -07001467 struct net *net = dev_net(dev);
1468 struct sit_net *sitn = net_generic(net, sit_net_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001469
Linus Torvalds1da177e2005-04-16 15:20:36 -07001470 iph->version = 4;
1471 iph->protocol = IPPROTO_IPV6;
1472 iph->ihl = 5;
1473 iph->ttl = 64;
1474
1475 dev_hold(dev);
Eric Dumazetcf778b02012-01-12 04:41:32 +00001476 rcu_assign_pointer(sitn->tunnels_wc[0], tunnel);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001477}
1478
Matthias Schiffera8b8a8892017-06-25 23:56:01 +02001479static int ipip6_validate(struct nlattr *tb[], struct nlattr *data[],
1480 struct netlink_ext_ack *extack)
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001481{
1482 u8 proto;
1483
Nicolas Dichtelc2ff6822013-06-19 12:03:13 +02001484 if (!data || !data[IFLA_IPTUN_PROTO])
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001485 return 0;
1486
1487 proto = nla_get_u8(data[IFLA_IPTUN_PROTO]);
Simon Horman49dbe7a2016-07-07 07:56:13 +02001488 if (!ipip6_valid_ip_proto(proto))
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001489 return -EINVAL;
1490
1491 return 0;
1492}
1493
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001494static void ipip6_netlink_parms(struct nlattr *data[],
Craig Gallek9830ad42017-04-19 12:30:54 -04001495 struct ip_tunnel_parm *parms,
1496 __u32 *fwmark)
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001497{
1498 memset(parms, 0, sizeof(*parms));
1499
1500 parms->iph.version = 4;
1501 parms->iph.protocol = IPPROTO_IPV6;
1502 parms->iph.ihl = 5;
1503 parms->iph.ttl = 64;
1504
1505 if (!data)
1506 return;
1507
1508 if (data[IFLA_IPTUN_LINK])
1509 parms->link = nla_get_u32(data[IFLA_IPTUN_LINK]);
1510
1511 if (data[IFLA_IPTUN_LOCAL])
Nicolas Dichteld440b722012-11-15 04:06:41 +00001512 parms->iph.saddr = nla_get_be32(data[IFLA_IPTUN_LOCAL]);
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001513
1514 if (data[IFLA_IPTUN_REMOTE])
Nicolas Dichteld440b722012-11-15 04:06:41 +00001515 parms->iph.daddr = nla_get_be32(data[IFLA_IPTUN_REMOTE]);
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001516
1517 if (data[IFLA_IPTUN_TTL]) {
1518 parms->iph.ttl = nla_get_u8(data[IFLA_IPTUN_TTL]);
1519 if (parms->iph.ttl)
1520 parms->iph.frag_off = htons(IP_DF);
1521 }
1522
1523 if (data[IFLA_IPTUN_TOS])
1524 parms->iph.tos = nla_get_u8(data[IFLA_IPTUN_TOS]);
1525
1526 if (!data[IFLA_IPTUN_PMTUDISC] || nla_get_u8(data[IFLA_IPTUN_PMTUDISC]))
1527 parms->iph.frag_off = htons(IP_DF);
1528
1529 if (data[IFLA_IPTUN_FLAGS])
Nicolas Dichteld440b722012-11-15 04:06:41 +00001530 parms->i_flags = nla_get_be16(data[IFLA_IPTUN_FLAGS]);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001531
1532 if (data[IFLA_IPTUN_PROTO])
1533 parms->iph.protocol = nla_get_u8(data[IFLA_IPTUN_PROTO]);
1534
Craig Gallek9830ad42017-04-19 12:30:54 -04001535 if (data[IFLA_IPTUN_FWMARK])
1536 *fwmark = nla_get_u32(data[IFLA_IPTUN_FWMARK]);
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001537}
1538
Tom Herbert14909662014-09-17 12:25:59 -07001539/* This function returns true when ENCAP attributes are present in the nl msg */
1540static bool ipip6_netlink_encap_parms(struct nlattr *data[],
1541 struct ip_tunnel_encap *ipencap)
1542{
1543 bool ret = false;
1544
1545 memset(ipencap, 0, sizeof(*ipencap));
1546
1547 if (!data)
1548 return ret;
1549
1550 if (data[IFLA_IPTUN_ENCAP_TYPE]) {
1551 ret = true;
1552 ipencap->type = nla_get_u16(data[IFLA_IPTUN_ENCAP_TYPE]);
1553 }
1554
1555 if (data[IFLA_IPTUN_ENCAP_FLAGS]) {
1556 ret = true;
1557 ipencap->flags = nla_get_u16(data[IFLA_IPTUN_ENCAP_FLAGS]);
1558 }
1559
1560 if (data[IFLA_IPTUN_ENCAP_SPORT]) {
1561 ret = true;
Eric Dumazeta409cae2015-02-04 15:12:04 -08001562 ipencap->sport = nla_get_be16(data[IFLA_IPTUN_ENCAP_SPORT]);
Tom Herbert14909662014-09-17 12:25:59 -07001563 }
1564
1565 if (data[IFLA_IPTUN_ENCAP_DPORT]) {
1566 ret = true;
Eric Dumazeta409cae2015-02-04 15:12:04 -08001567 ipencap->dport = nla_get_be16(data[IFLA_IPTUN_ENCAP_DPORT]);
Tom Herbert14909662014-09-17 12:25:59 -07001568 }
1569
1570 return ret;
1571}
1572
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001573#ifdef CONFIG_IPV6_SIT_6RD
1574/* This function returns true when 6RD attributes are present in the nl msg */
1575static bool ipip6_netlink_6rd_parms(struct nlattr *data[],
1576 struct ip_tunnel_6rd *ip6rd)
1577{
1578 bool ret = false;
1579 memset(ip6rd, 0, sizeof(*ip6rd));
1580
1581 if (!data)
1582 return ret;
1583
1584 if (data[IFLA_IPTUN_6RD_PREFIX]) {
1585 ret = true;
Jiri Benc67b61f62015-03-29 16:59:26 +02001586 ip6rd->prefix = nla_get_in6_addr(data[IFLA_IPTUN_6RD_PREFIX]);
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001587 }
1588
1589 if (data[IFLA_IPTUN_6RD_RELAY_PREFIX]) {
1590 ret = true;
1591 ip6rd->relay_prefix =
1592 nla_get_be32(data[IFLA_IPTUN_6RD_RELAY_PREFIX]);
1593 }
1594
1595 if (data[IFLA_IPTUN_6RD_PREFIXLEN]) {
1596 ret = true;
1597 ip6rd->prefixlen = nla_get_u16(data[IFLA_IPTUN_6RD_PREFIXLEN]);
1598 }
1599
1600 if (data[IFLA_IPTUN_6RD_RELAY_PREFIXLEN]) {
1601 ret = true;
1602 ip6rd->relay_prefixlen =
1603 nla_get_u16(data[IFLA_IPTUN_6RD_RELAY_PREFIXLEN]);
1604 }
1605
1606 return ret;
1607}
1608#endif
1609
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001610static int ipip6_newlink(struct net *src_net, struct net_device *dev,
Matthias Schiffer7a3f4a12017-06-25 23:55:59 +02001611 struct nlattr *tb[], struct nlattr *data[],
1612 struct netlink_ext_ack *extack)
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001613{
1614 struct net *net = dev_net(dev);
1615 struct ip_tunnel *nt;
Tom Herbert14909662014-09-17 12:25:59 -07001616 struct ip_tunnel_encap ipencap;
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001617#ifdef CONFIG_IPV6_SIT_6RD
1618 struct ip_tunnel_6rd ip6rd;
1619#endif
1620 int err;
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001621
1622 nt = netdev_priv(dev);
Tom Herbert14909662014-09-17 12:25:59 -07001623
1624 if (ipip6_netlink_encap_parms(data, &ipencap)) {
1625 err = ip_tunnel_encap_setup(nt, &ipencap);
1626 if (err < 0)
1627 return err;
1628 }
1629
Craig Gallek9830ad42017-04-19 12:30:54 -04001630 ipip6_netlink_parms(data, &nt->parms, &nt->fwmark);
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001631
1632 if (ipip6_tunnel_locate(net, &nt->parms, 0))
1633 return -EEXIST;
1634
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001635 err = ipip6_tunnel_create(dev);
1636 if (err < 0)
1637 return err;
1638
Xin Long2b3957c2018-02-27 19:19:41 +08001639 if (tb[IFLA_MTU]) {
1640 u32 mtu = nla_get_u32(tb[IFLA_MTU]);
1641
Nicolas Dichtelf7ff1fd2018-05-31 10:59:33 +02001642 if (mtu >= IPV6_MIN_MTU &&
1643 mtu <= IP6_MAX_MTU - dev->hard_header_len)
Xin Long2b3957c2018-02-27 19:19:41 +08001644 dev->mtu = mtu;
1645 }
1646
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001647#ifdef CONFIG_IPV6_SIT_6RD
Jakub Kicinski47e4bb12021-01-13 17:29:47 -08001648 if (ipip6_netlink_6rd_parms(data, &ip6rd)) {
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001649 err = ipip6_tunnel_update_6rd(nt, &ip6rd);
Jakub Kicinski47e4bb12021-01-13 17:29:47 -08001650 if (err < 0)
1651 unregister_netdevice_queue(dev, NULL);
1652 }
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001653#endif
1654
1655 return err;
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001656}
1657
1658static int ipip6_changelink(struct net_device *dev, struct nlattr *tb[],
Matthias Schifferad744b22017-06-25 23:56:00 +02001659 struct nlattr *data[],
1660 struct netlink_ext_ack *extack)
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001661{
Nicolas Dichtel86bd68b2013-07-03 17:00:34 +02001662 struct ip_tunnel *t = netdev_priv(dev);
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001663 struct ip_tunnel_parm p;
Tom Herbert14909662014-09-17 12:25:59 -07001664 struct ip_tunnel_encap ipencap;
Nicolas Dichtel86bd68b2013-07-03 17:00:34 +02001665 struct net *net = t->net;
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001666 struct sit_net *sitn = net_generic(net, sit_net_id);
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001667#ifdef CONFIG_IPV6_SIT_6RD
1668 struct ip_tunnel_6rd ip6rd;
1669#endif
Craig Gallek9830ad42017-04-19 12:30:54 -04001670 __u32 fwmark = t->fwmark;
Tom Herbert14909662014-09-17 12:25:59 -07001671 int err;
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001672
1673 if (dev == sitn->fb_tunnel_dev)
1674 return -EINVAL;
1675
Tom Herbert14909662014-09-17 12:25:59 -07001676 if (ipip6_netlink_encap_parms(data, &ipencap)) {
1677 err = ip_tunnel_encap_setup(t, &ipencap);
1678 if (err < 0)
1679 return err;
1680 }
1681
Craig Gallek9830ad42017-04-19 12:30:54 -04001682 ipip6_netlink_parms(data, &p, &fwmark);
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001683
1684 if (((dev->flags & IFF_POINTOPOINT) && !p.iph.daddr) ||
1685 (!(dev->flags & IFF_POINTOPOINT) && p.iph.daddr))
1686 return -EINVAL;
1687
1688 t = ipip6_tunnel_locate(net, &p, 0);
1689
1690 if (t) {
1691 if (t->dev != dev)
1692 return -EEXIST;
1693 } else
1694 t = netdev_priv(dev);
1695
Craig Gallek9830ad42017-04-19 12:30:54 -04001696 ipip6_tunnel_update(t, &p, fwmark);
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001697
1698#ifdef CONFIG_IPV6_SIT_6RD
1699 if (ipip6_netlink_6rd_parms(data, &ip6rd))
1700 return ipip6_tunnel_update_6rd(t, &ip6rd);
1701#endif
1702
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001703 return 0;
1704}
1705
Nicolas Dichtele4c94a92012-11-14 05:14:06 +00001706static size_t ipip6_get_size(const struct net_device *dev)
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001707{
1708 return
1709 /* IFLA_IPTUN_LINK */
1710 nla_total_size(4) +
1711 /* IFLA_IPTUN_LOCAL */
1712 nla_total_size(4) +
1713 /* IFLA_IPTUN_REMOTE */
1714 nla_total_size(4) +
1715 /* IFLA_IPTUN_TTL */
1716 nla_total_size(1) +
1717 /* IFLA_IPTUN_TOS */
1718 nla_total_size(1) +
Nicolas Dichtela12c9a82012-11-14 05:14:05 +00001719 /* IFLA_IPTUN_PMTUDISC */
1720 nla_total_size(1) +
1721 /* IFLA_IPTUN_FLAGS */
1722 nla_total_size(2) +
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001723 /* IFLA_IPTUN_PROTO */
1724 nla_total_size(1) +
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001725#ifdef CONFIG_IPV6_SIT_6RD
1726 /* IFLA_IPTUN_6RD_PREFIX */
1727 nla_total_size(sizeof(struct in6_addr)) +
1728 /* IFLA_IPTUN_6RD_RELAY_PREFIX */
1729 nla_total_size(4) +
1730 /* IFLA_IPTUN_6RD_PREFIXLEN */
1731 nla_total_size(2) +
1732 /* IFLA_IPTUN_6RD_RELAY_PREFIXLEN */
1733 nla_total_size(2) +
1734#endif
Tom Herbert14909662014-09-17 12:25:59 -07001735 /* IFLA_IPTUN_ENCAP_TYPE */
1736 nla_total_size(2) +
1737 /* IFLA_IPTUN_ENCAP_FLAGS */
1738 nla_total_size(2) +
1739 /* IFLA_IPTUN_ENCAP_SPORT */
1740 nla_total_size(2) +
1741 /* IFLA_IPTUN_ENCAP_DPORT */
1742 nla_total_size(2) +
Craig Gallek9830ad42017-04-19 12:30:54 -04001743 /* IFLA_IPTUN_FWMARK */
1744 nla_total_size(4) +
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001745 0;
1746}
1747
Nicolas Dichtele4c94a92012-11-14 05:14:06 +00001748static int ipip6_fill_info(struct sk_buff *skb, const struct net_device *dev)
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001749{
1750 struct ip_tunnel *tunnel = netdev_priv(dev);
1751 struct ip_tunnel_parm *parm = &tunnel->parms;
1752
1753 if (nla_put_u32(skb, IFLA_IPTUN_LINK, parm->link) ||
Jiri Benc930345e2015-03-29 16:59:25 +02001754 nla_put_in_addr(skb, IFLA_IPTUN_LOCAL, parm->iph.saddr) ||
1755 nla_put_in_addr(skb, IFLA_IPTUN_REMOTE, parm->iph.daddr) ||
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001756 nla_put_u8(skb, IFLA_IPTUN_TTL, parm->iph.ttl) ||
Nicolas Dichtela12c9a82012-11-14 05:14:05 +00001757 nla_put_u8(skb, IFLA_IPTUN_TOS, parm->iph.tos) ||
1758 nla_put_u8(skb, IFLA_IPTUN_PMTUDISC,
1759 !!(parm->iph.frag_off & htons(IP_DF))) ||
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001760 nla_put_u8(skb, IFLA_IPTUN_PROTO, parm->iph.protocol) ||
Craig Gallek9830ad42017-04-19 12:30:54 -04001761 nla_put_be16(skb, IFLA_IPTUN_FLAGS, parm->i_flags) ||
1762 nla_put_u32(skb, IFLA_IPTUN_FWMARK, tunnel->fwmark))
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001763 goto nla_put_failure;
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001764
1765#ifdef CONFIG_IPV6_SIT_6RD
Jiri Benc930345e2015-03-29 16:59:25 +02001766 if (nla_put_in6_addr(skb, IFLA_IPTUN_6RD_PREFIX,
1767 &tunnel->ip6rd.prefix) ||
1768 nla_put_in_addr(skb, IFLA_IPTUN_6RD_RELAY_PREFIX,
1769 tunnel->ip6rd.relay_prefix) ||
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001770 nla_put_u16(skb, IFLA_IPTUN_6RD_PREFIXLEN,
1771 tunnel->ip6rd.prefixlen) ||
1772 nla_put_u16(skb, IFLA_IPTUN_6RD_RELAY_PREFIXLEN,
1773 tunnel->ip6rd.relay_prefixlen))
1774 goto nla_put_failure;
1775#endif
1776
Tom Herbert14909662014-09-17 12:25:59 -07001777 if (nla_put_u16(skb, IFLA_IPTUN_ENCAP_TYPE,
1778 tunnel->encap.type) ||
Eric Dumazeta409cae2015-02-04 15:12:04 -08001779 nla_put_be16(skb, IFLA_IPTUN_ENCAP_SPORT,
Tom Herbert14909662014-09-17 12:25:59 -07001780 tunnel->encap.sport) ||
Eric Dumazeta409cae2015-02-04 15:12:04 -08001781 nla_put_be16(skb, IFLA_IPTUN_ENCAP_DPORT,
Tom Herbert14909662014-09-17 12:25:59 -07001782 tunnel->encap.dport) ||
1783 nla_put_u16(skb, IFLA_IPTUN_ENCAP_FLAGS,
Tom Herberte1b2cb62014-11-05 16:49:38 -08001784 tunnel->encap.flags))
Tom Herbert14909662014-09-17 12:25:59 -07001785 goto nla_put_failure;
1786
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001787 return 0;
1788
1789nla_put_failure:
1790 return -EMSGSIZE;
1791}
1792
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001793static const struct nla_policy ipip6_policy[IFLA_IPTUN_MAX + 1] = {
1794 [IFLA_IPTUN_LINK] = { .type = NLA_U32 },
1795 [IFLA_IPTUN_LOCAL] = { .type = NLA_U32 },
1796 [IFLA_IPTUN_REMOTE] = { .type = NLA_U32 },
1797 [IFLA_IPTUN_TTL] = { .type = NLA_U8 },
1798 [IFLA_IPTUN_TOS] = { .type = NLA_U8 },
1799 [IFLA_IPTUN_PMTUDISC] = { .type = NLA_U8 },
1800 [IFLA_IPTUN_FLAGS] = { .type = NLA_U16 },
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001801 [IFLA_IPTUN_PROTO] = { .type = NLA_U8 },
Nicolas Dichtele2f1f072012-11-19 22:41:45 +00001802#ifdef CONFIG_IPV6_SIT_6RD
1803 [IFLA_IPTUN_6RD_PREFIX] = { .len = sizeof(struct in6_addr) },
1804 [IFLA_IPTUN_6RD_RELAY_PREFIX] = { .type = NLA_U32 },
1805 [IFLA_IPTUN_6RD_PREFIXLEN] = { .type = NLA_U16 },
1806 [IFLA_IPTUN_6RD_RELAY_PREFIXLEN] = { .type = NLA_U16 },
1807#endif
Tom Herbert14909662014-09-17 12:25:59 -07001808 [IFLA_IPTUN_ENCAP_TYPE] = { .type = NLA_U16 },
1809 [IFLA_IPTUN_ENCAP_FLAGS] = { .type = NLA_U16 },
1810 [IFLA_IPTUN_ENCAP_SPORT] = { .type = NLA_U16 },
1811 [IFLA_IPTUN_ENCAP_DPORT] = { .type = NLA_U16 },
Craig Gallek9830ad42017-04-19 12:30:54 -04001812 [IFLA_IPTUN_FWMARK] = { .type = NLA_U32 },
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001813};
1814
Willem de Bruijn94342662013-11-13 21:27:38 -05001815static void ipip6_dellink(struct net_device *dev, struct list_head *head)
1816{
1817 struct net *net = dev_net(dev);
1818 struct sit_net *sitn = net_generic(net, sit_net_id);
1819
1820 if (dev != sitn->fb_tunnel_dev)
1821 unregister_netdevice_queue(dev, head);
1822}
1823
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001824static struct rtnl_link_ops sit_link_ops __read_mostly = {
1825 .kind = "sit",
1826 .maxtype = IFLA_IPTUN_MAX,
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001827 .policy = ipip6_policy,
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001828 .priv_size = sizeof(struct ip_tunnel),
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001829 .setup = ipip6_tunnel_setup,
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001830 .validate = ipip6_validate,
Nicolas Dichtelf37234162012-11-14 05:14:07 +00001831 .newlink = ipip6_newlink,
1832 .changelink = ipip6_changelink,
Nicolas Dichtele4c94a92012-11-14 05:14:06 +00001833 .get_size = ipip6_get_size,
1834 .fill_info = ipip6_fill_info,
Willem de Bruijn94342662013-11-13 21:27:38 -05001835 .dellink = ipip6_dellink,
Nicolas Dichtel1728d4f2015-01-15 15:11:17 +01001836 .get_link_net = ip_tunnel_get_link_net,
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001837};
1838
Eric Dumazet6dcd8142010-08-30 07:04:14 +00001839static struct xfrm_tunnel sit_handler __read_mostly = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001840 .handler = ipip6_rcv,
1841 .err_handler = ipip6_err,
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -08001842 .priority = 1,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001843};
1844
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001845static struct xfrm_tunnel ipip_handler __read_mostly = {
1846 .handler = ipip_rcv,
1847 .err_handler = ipip6_err,
1848 .priority = 2,
1849};
1850
Simon Horman49dbe7a2016-07-07 07:56:13 +02001851#if IS_ENABLED(CONFIG_MPLS)
1852static struct xfrm_tunnel mplsip_handler __read_mostly = {
1853 .handler = mplsip_rcv,
1854 .err_handler = ipip6_err,
1855 .priority = 2,
1856};
1857#endif
1858
Willem de Bruijn94342662013-11-13 21:27:38 -05001859static void __net_exit sit_destroy_tunnels(struct net *net,
1860 struct list_head *head)
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001861{
Willem de Bruijn94342662013-11-13 21:27:38 -05001862 struct sit_net *sitn = net_generic(net, sit_net_id);
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001863 struct net_device *dev, *aux;
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001864 int prio;
1865
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001866 for_each_netdev_safe(net, dev, aux)
1867 if (dev->rtnl_link_ops == &sit_link_ops)
1868 unregister_netdevice_queue(dev, head);
1869
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001870 for (prio = 1; prio < 4; prio++) {
1871 int h;
Jiri Kosinae87a8f22016-08-10 11:03:35 +02001872 for (h = 0; h < IP6_SIT_HASH_SIZE; h++) {
Eric Dumazet753ea8e2011-01-20 07:16:24 +00001873 struct ip_tunnel *t;
Eric Dumazet62808f92009-10-28 04:37:43 +00001874
Eric Dumazet753ea8e2011-01-20 07:16:24 +00001875 t = rtnl_dereference(sitn->tunnels[prio][h]);
Ian Morris53b24b82015-03-29 14:00:05 +01001876 while (t) {
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001877 /* If dev is in the same netns, it has already
1878 * been added to the list by the previous loop.
1879 */
Nicolas Dichtelfc8f9992013-08-13 17:51:10 +02001880 if (!net_eq(dev_net(t->dev), net))
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001881 unregister_netdevice_queue(t->dev,
1882 head);
Eric Dumazet753ea8e2011-01-20 07:16:24 +00001883 t = rtnl_dereference(t->next);
Eric Dumazet62808f92009-10-28 04:37:43 +00001884 }
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001885 }
1886 }
1887}
1888
Alexey Dobriyan2c8c1e72010-01-17 03:35:32 +00001889static int __net_init sit_init_net(struct net *net)
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001890{
Eric W. Biederman67101172009-11-29 15:46:16 +00001891 struct sit_net *sitn = net_generic(net, sit_net_id);
Ted Feng72b36012011-12-08 00:46:21 +00001892 struct ip_tunnel *t;
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001893 int err;
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001894
Pavel Emelyanov29182172008-04-16 01:16:38 -07001895 sitn->tunnels[0] = sitn->tunnels_wc;
1896 sitn->tunnels[1] = sitn->tunnels_l;
1897 sitn->tunnels[2] = sitn->tunnels_r;
1898 sitn->tunnels[3] = sitn->tunnels_r_l;
1899
Eric Dumazet79134e62018-03-08 12:51:41 -08001900 if (!net_has_fallback_tunnels(net))
1901 return 0;
1902
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001903 sitn->fb_tunnel_dev = alloc_netdev(sizeof(struct ip_tunnel), "sit0",
Tom Gundersenc835a672014-07-14 16:37:24 +02001904 NET_NAME_UNKNOWN,
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001905 ipip6_tunnel_setup);
1906 if (!sitn->fb_tunnel_dev) {
1907 err = -ENOMEM;
1908 goto err_alloc_dev;
1909 }
Alexey Dobriyanbe77e592008-11-23 17:26:26 -08001910 dev_net_set(sitn->fb_tunnel_dev, net);
Nicolas Dichtel205983c2013-10-01 18:04:59 +02001911 sitn->fb_tunnel_dev->rtnl_link_ops = &sit_link_ops;
Nicolas Dichtel5e6700b2013-06-26 16:11:28 +02001912 /* FB netdevice is special: we have one, and only one per netns.
1913 * Allowing to move it to another netns is clearly unsafe.
1914 */
1915 sitn->fb_tunnel_dev->features |= NETIF_F_NETNS_LOCAL;
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001916
Ian Morrise5d08d72014-11-23 21:28:43 +00001917 err = register_netdev(sitn->fb_tunnel_dev);
1918 if (err)
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001919 goto err_reg_dev;
1920
Eric Dumazet4ece9002015-11-02 17:08:19 -08001921 ipip6_tunnel_clone_6rd(sitn->fb_tunnel_dev, sitn);
1922 ipip6_fb_tunnel_init(sitn->fb_tunnel_dev);
1923
Ted Feng72b36012011-12-08 00:46:21 +00001924 t = netdev_priv(sitn->fb_tunnel_dev);
1925
1926 strcpy(t->parms.name, sitn->fb_tunnel_dev->name);
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001927 return 0;
1928
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001929err_reg_dev:
Eric Dumazetdd4080e2010-09-28 02:17:58 +00001930 ipip6_dev_free(sitn->fb_tunnel_dev);
Mao Wenan07f12b22019-03-01 23:06:40 +08001931 free_netdev(sitn->fb_tunnel_dev);
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001932err_alloc_dev:
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001933 return err;
1934}
1935
Eric Dumazetbb401ca2017-09-19 16:27:08 -07001936static void __net_exit sit_exit_batch_net(struct list_head *net_list)
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001937{
Eric Dumazet62808f92009-10-28 04:37:43 +00001938 LIST_HEAD(list);
Eric Dumazetbb401ca2017-09-19 16:27:08 -07001939 struct net *net;
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001940
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001941 rtnl_lock();
Eric Dumazetbb401ca2017-09-19 16:27:08 -07001942 list_for_each_entry(net, net_list, exit_list)
1943 sit_destroy_tunnels(net, &list);
1944
Eric Dumazet62808f92009-10-28 04:37:43 +00001945 unregister_netdevice_many(&list);
Pavel Emelyanovcd3dbc12008-04-16 01:16:18 -07001946 rtnl_unlock();
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001947}
1948
1949static struct pernet_operations sit_net_ops = {
1950 .init = sit_init_net,
Eric Dumazetbb401ca2017-09-19 16:27:08 -07001951 .exit_batch = sit_exit_batch_net,
Eric W. Biederman67101172009-11-29 15:46:16 +00001952 .id = &sit_net_id,
1953 .size = sizeof(struct sit_net),
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001954};
1955
Adrian Bunk89c89452006-11-20 16:56:48 -08001956static void __exit sit_cleanup(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001957{
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001958 rtnl_link_unregister(&sit_link_ops);
Kazunori MIYAZAWAc73cb5a2007-02-13 12:55:25 -08001959 xfrm4_tunnel_deregister(&sit_handler, AF_INET6);
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001960 xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
Simon Horman49dbe7a2016-07-07 07:56:13 +02001961#if IS_ENABLED(CONFIG_MPLS)
1962 xfrm4_tunnel_deregister(&mplsip_handler, AF_MPLS);
1963#endif
Alexey Kuznetsovdb445752005-07-30 17:46:44 -07001964
Eric W. Biederman67101172009-11-29 15:46:16 +00001965 unregister_pernet_device(&sit_net_ops);
Eric Dumazetef9a9d12009-10-23 17:51:26 +00001966 rcu_barrier(); /* Wait for completion of call_rcu()'s */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001967}
1968
Adrian Bunk89c89452006-11-20 16:56:48 -08001969static int __init sit_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001970{
1971 int err;
1972
Simon Horman49dbe7a2016-07-07 07:56:13 +02001973 pr_info("IPv6, IPv4 and MPLS over IPv4 tunneling driver\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001974
Eric W. Biederman67101172009-11-29 15:46:16 +00001975 err = register_pernet_device(&sit_net_ops);
Pavel Emelyanov8190d902008-04-16 01:15:17 -07001976 if (err < 0)
Alexey Dobriyand5aa4072010-02-16 09:05:04 +00001977 return err;
1978 err = xfrm4_tunnel_register(&sit_handler, AF_INET6);
1979 if (err < 0) {
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001980 pr_info("%s: can't register ip6ip4\n", __func__);
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001981 goto xfrm_tunnel_failed;
Alexey Dobriyand5aa4072010-02-16 09:05:04 +00001982 }
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00001983 err = xfrm4_tunnel_register(&ipip_handler, AF_INET);
1984 if (err < 0) {
1985 pr_info("%s: can't register ip4ip4\n", __func__);
1986 goto xfrm_tunnel4_failed;
1987 }
Simon Horman49dbe7a2016-07-07 07:56:13 +02001988#if IS_ENABLED(CONFIG_MPLS)
1989 err = xfrm4_tunnel_register(&mplsip_handler, AF_MPLS);
1990 if (err < 0) {
1991 pr_info("%s: can't register mplsip\n", __func__);
1992 goto xfrm_tunnel_mpls_failed;
1993 }
1994#endif
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00001995 err = rtnl_link_register(&sit_link_ops);
1996 if (err < 0)
1997 goto rtnl_link_failed;
1998
1999out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002000 return err;
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00002001
2002rtnl_link_failed:
Simon Horman49dbe7a2016-07-07 07:56:13 +02002003#if IS_ENABLED(CONFIG_MPLS)
2004 xfrm4_tunnel_deregister(&mplsip_handler, AF_MPLS);
2005xfrm_tunnel_mpls_failed:
2006#endif
Nicolas Dichtel32b8a8e2013-05-27 23:48:16 +00002007 xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
2008xfrm_tunnel4_failed:
Nicolas Dichtelba3e3f52012-11-09 06:10:00 +00002009 xfrm4_tunnel_deregister(&sit_handler, AF_INET6);
2010xfrm_tunnel_failed:
2011 unregister_pernet_device(&sit_net_ops);
2012 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002013}
Joerg Roedel989e5b92006-10-10 14:47:44 -07002014
2015module_init(sit_init);
2016module_exit(sit_cleanup);
Jan Dittmer39c85082006-10-13 15:05:53 -07002017MODULE_LICENSE("GPL");
Tom Gundersenf98f89a2014-05-15 23:21:30 +02002018MODULE_ALIAS_RTNL_LINK("sit");
Vasiliy Kulikov8909c9a2011-03-02 00:33:13 +03002019MODULE_ALIAS_NETDEV("sit0");