blob: 58e0dab06f19ec50180db5fd3b32739047293760 [file] [log] [blame]
Saurabh11814122012-07-17 09:44:54 +00001/*
2 * Linux NET3: IP/IP protocol decoder modified to support
3 * virtual tunnel interface
4 *
5 * Authors:
6 * Saurabh Mohan (saurabh.mohan@vyatta.com) 05/07/2012
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * as published by the Free Software Foundation; either version
11 * 2 of the License, or (at your option) any later version.
12 *
13 */
14
15/*
16 This version of net/ipv4/ip_vti.c is cloned of net/ipv4/ipip.c
17
18 For comments look at net/ipv4/ip_gre.c --ANK
19 */
20
21
22#include <linux/capability.h>
23#include <linux/module.h>
24#include <linux/types.h>
25#include <linux/kernel.h>
26#include <linux/uaccess.h>
27#include <linux/skbuff.h>
28#include <linux/netdevice.h>
29#include <linux/in.h>
30#include <linux/tcp.h>
31#include <linux/udp.h>
32#include <linux/if_arp.h>
Saurabh11814122012-07-17 09:44:54 +000033#include <linux/init.h>
34#include <linux/netfilter_ipv4.h>
35#include <linux/if_ether.h>
Steffen Klassert78a010c2014-02-21 08:41:10 +010036#include <linux/icmpv6.h>
Saurabh11814122012-07-17 09:44:54 +000037
38#include <net/sock.h>
39#include <net/ip.h>
40#include <net/icmp.h>
Pravin B Shelarc5441932013-03-25 14:49:35 +000041#include <net/ip_tunnels.h>
Saurabh11814122012-07-17 09:44:54 +000042#include <net/inet_ecn.h>
43#include <net/xfrm.h>
44#include <net/net_namespace.h>
45#include <net/netns/generic.h>
46
Saurabh11814122012-07-17 09:44:54 +000047static struct rtnl_link_ops vti_link_ops __read_mostly;
48
49static int vti_net_id __read_mostly;
Saurabh11814122012-07-17 09:44:54 +000050static int vti_tunnel_init(struct net_device *dev);
Saurabh11814122012-07-17 09:44:54 +000051
Steffen Klassertdf3893c2014-02-21 08:41:10 +010052static int vti_input(struct sk_buff *skb, int nexthdr, __be32 spi,
53 int encap_type)
Saurabh11814122012-07-17 09:44:54 +000054{
55 struct ip_tunnel *tunnel;
56 const struct iphdr *iph = ip_hdr(skb);
Amerigo Wangb9959fd2013-07-21 10:46:25 +080057 struct net *net = dev_net(skb->dev);
58 struct ip_tunnel_net *itn = net_generic(net, vti_net_id);
Saurabh11814122012-07-17 09:44:54 +000059
Amerigo Wangb9959fd2013-07-21 10:46:25 +080060 tunnel = ip_tunnel_lookup(itn, skb->dev->ifindex, TUNNEL_NO_KEY,
61 iph->saddr, iph->daddr, 0);
Ian Morris00db4122015-04-03 09:17:27 +010062 if (tunnel) {
Steffen Klassertdf3893c2014-02-21 08:41:10 +010063 if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb))
64 goto drop;
Saurabh11814122012-07-17 09:44:54 +000065
Steffen Klassertdf3893c2014-02-21 08:41:10 +010066 XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip4 = tunnel;
Christophe Gouault7263a512013-10-08 17:21:22 +020067
Steffen Klassertdf3893c2014-02-21 08:41:10 +010068 return xfrm_input(skb, nexthdr, spi, encap_type);
Saurabh11814122012-07-17 09:44:54 +000069 }
Saurabh11814122012-07-17 09:44:54 +000070
Steffen Klassertdf3893c2014-02-21 08:41:10 +010071 return -EINVAL;
72drop:
73 kfree_skb(skb);
74 return 0;
75}
76
Su Yanjund2a6df72019-01-06 21:31:20 -050077static int vti_input_ipip(struct sk_buff *skb, int nexthdr, __be32 spi,
78 int encap_type)
79{
80 struct ip_tunnel *tunnel;
81 const struct iphdr *iph = ip_hdr(skb);
82 struct net *net = dev_net(skb->dev);
83 struct ip_tunnel_net *itn = net_generic(net, vti_net_id);
84
85 tunnel = ip_tunnel_lookup(itn, skb->dev->ifindex, TUNNEL_NO_KEY,
86 iph->saddr, iph->daddr, 0);
87 if (tunnel) {
88 if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb))
89 goto drop;
90
91 XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip4 = tunnel;
92
93 skb->dev = tunnel->dev;
94
95 return xfrm_input(skb, nexthdr, spi, encap_type);
96 }
97
98 return -EINVAL;
99drop:
100 kfree_skb(skb);
101 return 0;
102}
103
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100104static int vti_rcv(struct sk_buff *skb)
105{
106 XFRM_SPI_SKB_CB(skb)->family = AF_INET;
107 XFRM_SPI_SKB_CB(skb)->daddroff = offsetof(struct iphdr, daddr);
108
109 return vti_input(skb, ip_hdr(skb)->protocol, 0, 0);
110}
111
Su Yanjund2a6df72019-01-06 21:31:20 -0500112static int vti_rcv_ipip(struct sk_buff *skb)
113{
114 XFRM_SPI_SKB_CB(skb)->family = AF_INET;
115 XFRM_SPI_SKB_CB(skb)->daddroff = offsetof(struct iphdr, daddr);
116
117 return vti_input_ipip(skb, ip_hdr(skb)->protocol, ip_hdr(skb)->saddr, 0);
118}
119
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100120static int vti_rcv_cb(struct sk_buff *skb, int err)
121{
122 unsigned short family;
123 struct net_device *dev;
124 struct pcpu_sw_netstats *tstats;
125 struct xfrm_state *x;
thomas.zeitlhofer+lkml@ze-it.at1fb81e02016-09-07 20:40:38 +0200126 struct xfrm_mode *inner_mode;
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100127 struct ip_tunnel *tunnel = XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip4;
Alexander Duyckd55c6702015-05-27 07:16:54 -0700128 u32 orig_mark = skb->mark;
129 int ret;
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100130
131 if (!tunnel)
132 return 1;
133
134 dev = tunnel->dev;
135
136 if (err) {
137 dev->stats.rx_errors++;
138 dev->stats.rx_dropped++;
139
140 return 0;
141 }
142
143 x = xfrm_input_state(skb);
thomas.zeitlhofer+lkml@ze-it.at1fb81e02016-09-07 20:40:38 +0200144
145 inner_mode = x->inner_mode;
146
147 if (x->sel.family == AF_UNSPEC) {
148 inner_mode = xfrm_ip2inner_mode(x, XFRM_MODE_SKB_CB(skb)->protocol);
149 if (inner_mode == NULL) {
150 XFRM_INC_STATS(dev_net(skb->dev),
151 LINUX_MIB_XFRMINSTATEMODEERROR);
152 return -EINVAL;
153 }
154 }
155
156 family = inner_mode->afinfo->family;
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100157
Alexander Duyckd55c6702015-05-27 07:16:54 -0700158 skb->mark = be32_to_cpu(tunnel->parms.i_key);
159 ret = xfrm_policy_check(NULL, XFRM_POLICY_IN, skb, family);
160 skb->mark = orig_mark;
161
162 if (!ret)
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100163 return -EPERM;
164
165 skb_scrub_packet(skb, !net_eq(tunnel->net, dev_net(skb->dev)));
166 skb->dev = dev;
167
168 tstats = this_cpu_ptr(dev->tstats);
169
170 u64_stats_update_begin(&tstats->syncp);
171 tstats->rx_packets++;
172 tstats->rx_bytes += skb->len;
173 u64_stats_update_end(&tstats->syncp);
174
175 return 0;
Saurabh11814122012-07-17 09:44:54 +0000176}
177
Steffen Klassert6e2de802014-02-21 08:41:11 +0100178static bool vti_state_check(const struct xfrm_state *x, __be32 dst, __be32 src)
179{
180 xfrm_address_t *daddr = (xfrm_address_t *)&dst;
181 xfrm_address_t *saddr = (xfrm_address_t *)&src;
182
183 /* if there is no transform then this tunnel is not functional.
184 * Or if the xfrm is not mode tunnel.
185 */
186 if (!x || x->props.mode != XFRM_MODE_TUNNEL ||
187 x->props.family != AF_INET)
188 return false;
189
190 if (!dst)
191 return xfrm_addr_equal(saddr, &x->props.saddr, AF_INET);
192
193 if (!xfrm_state_addr_check(x, daddr, saddr, AF_INET))
194 return false;
195
196 return true;
197}
198
Steffen Klassert78a010c2014-02-21 08:41:10 +0100199static netdev_tx_t vti_xmit(struct sk_buff *skb, struct net_device *dev,
200 struct flowi *fl)
Saurabh11814122012-07-17 09:44:54 +0000201{
202 struct ip_tunnel *tunnel = netdev_priv(dev);
Steffen Klassert6e2de802014-02-21 08:41:11 +0100203 struct ip_tunnel_parm *parms = &tunnel->parms;
Steffen Klasserta34cd4f2014-02-21 08:41:10 +0100204 struct dst_entry *dst = skb_dst(skb);
Saurabh11814122012-07-17 09:44:54 +0000205 struct net_device *tdev; /* Device to other host */
Alexey Kodanev6689f832017-09-26 15:14:29 +0300206 int pkt_len = skb->len;
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800207 int err;
Steffen Klassertd6af1a312016-03-16 10:17:37 +0100208 int mtu;
Saurabh11814122012-07-17 09:44:54 +0000209
Steffen Klasserta34cd4f2014-02-21 08:41:10 +0100210 if (!dst) {
Nicolas Dichtel0807f592020-02-04 17:00:27 +0100211 switch (skb->protocol) {
212 case htons(ETH_P_IP): {
213 struct rtable *rt;
Nicolas Dichtelbe914e02020-01-13 09:32:46 +0100214
Nicolas Dichtel0807f592020-02-04 17:00:27 +0100215 fl->u.ip4.flowi4_oif = dev->ifindex;
216 fl->u.ip4.flowi4_flags |= FLOWI_FLAG_ANYSRC;
217 rt = __ip_route_output_key(dev_net(dev), &fl->u.ip4);
218 if (IS_ERR(rt)) {
219 dev->stats.tx_carrier_errors++;
220 goto tx_error_icmp;
221 }
222 dst = &rt->dst;
223 skb_dst_set(skb, dst);
224 break;
225 }
226#if IS_ENABLED(CONFIG_IPV6)
227 case htons(ETH_P_IPV6):
228 fl->u.ip6.flowi6_oif = dev->ifindex;
229 fl->u.ip6.flowi6_flags |= FLOWI_FLAG_ANYSRC;
230 dst = ip6_route_output(dev_net(dev), NULL, &fl->u.ip6);
231 if (dst->error) {
232 dst_release(dst);
233 dst = NULL;
234 dev->stats.tx_carrier_errors++;
235 goto tx_error_icmp;
236 }
237 skb_dst_set(skb, dst);
238 break;
239#endif
240 default:
Nicolas Dichtelbe914e02020-01-13 09:32:46 +0100241 dev->stats.tx_carrier_errors++;
242 goto tx_error_icmp;
243 }
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100244 }
245
Steffen Klasserta34cd4f2014-02-21 08:41:10 +0100246 dst_hold(dst);
Steffen Klassert78a010c2014-02-21 08:41:10 +0100247 dst = xfrm_lookup(tunnel->net, dst, fl, NULL, 0);
Steffen Klasserta34cd4f2014-02-21 08:41:10 +0100248 if (IS_ERR(dst)) {
Saurabh11814122012-07-17 09:44:54 +0000249 dev->stats.tx_carrier_errors++;
250 goto tx_error_icmp;
251 }
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100252
Steffen Klassert6e2de802014-02-21 08:41:11 +0100253 if (!vti_state_check(dst->xfrm, parms->iph.daddr, parms->iph.saddr)) {
Saurabh11814122012-07-17 09:44:54 +0000254 dev->stats.tx_carrier_errors++;
Steffen Klasserta34cd4f2014-02-21 08:41:10 +0100255 dst_release(dst);
Saurabh11814122012-07-17 09:44:54 +0000256 goto tx_error_icmp;
257 }
Steffen Klassert6e2de802014-02-21 08:41:11 +0100258
Steffen Klasserta34cd4f2014-02-21 08:41:10 +0100259 tdev = dst->dev;
Saurabh11814122012-07-17 09:44:54 +0000260
261 if (tdev == dev) {
Steffen Klasserta34cd4f2014-02-21 08:41:10 +0100262 dst_release(dst);
Saurabh11814122012-07-17 09:44:54 +0000263 dev->stats.collisions++;
264 goto tx_error;
265 }
266
267 if (tunnel->err_count > 0) {
268 if (time_before(jiffies,
269 tunnel->err_time + IPTUNNEL_ERR_TIMEO)) {
270 tunnel->err_count--;
271 dst_link_failure(skb);
272 } else
273 tunnel->err_count = 0;
274 }
275
Steffen Klassertd6af1a312016-03-16 10:17:37 +0100276 mtu = dst_mtu(dst);
277 if (skb->len > mtu) {
278 skb_dst(skb)->ops->update_pmtu(skb_dst(skb), NULL, skb, mtu);
279 if (skb->protocol == htons(ETH_P_IP)) {
280 icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED,
281 htonl(mtu));
282 } else {
283 if (mtu < IPV6_MIN_MTU)
284 mtu = IPV6_MIN_MTU;
285
286 icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
287 }
288
289 dst_release(dst);
290 goto tx_error;
291 }
292
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100293 skb_scrub_packet(skb, !net_eq(tunnel->net, dev_net(dev)));
Steffen Klasserta34cd4f2014-02-21 08:41:10 +0100294 skb_dst_set(skb, dst);
Saurabh11814122012-07-17 09:44:54 +0000295 skb->dev = skb_dst(skb)->dev;
296
Eric W. Biederman13206b62015-10-07 16:48:35 -0500297 err = dst_output(tunnel->net, skb->sk, skb);
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800298 if (net_xmit_eval(err) == 0)
Alexey Kodanev6689f832017-09-26 15:14:29 +0300299 err = pkt_len;
Pravin B Shelar039f5062015-12-24 14:34:54 -0800300 iptunnel_xmit_stats(dev, err);
Saurabh11814122012-07-17 09:44:54 +0000301 return NETDEV_TX_OK;
302
303tx_error_icmp:
304 dst_link_failure(skb);
305tx_error:
306 dev->stats.tx_errors++;
Eric Dumazet3acfa1e2014-01-18 18:27:49 -0800307 kfree_skb(skb);
Saurabh11814122012-07-17 09:44:54 +0000308 return NETDEV_TX_OK;
309}
310
Steffen Klassert78a010c2014-02-21 08:41:10 +0100311/* This function assumes it is being called from dev_queue_xmit()
312 * and that skb is filled properly by that function.
313 */
314static netdev_tx_t vti_tunnel_xmit(struct sk_buff *skb, struct net_device *dev)
315{
316 struct ip_tunnel *tunnel = netdev_priv(dev);
317 struct flowi fl;
318
319 memset(&fl, 0, sizeof(fl));
320
Steffen Klassert78a010c2014-02-21 08:41:10 +0100321 switch (skb->protocol) {
322 case htons(ETH_P_IP):
323 xfrm_decode_session(skb, &fl, AF_INET);
324 memset(IPCB(skb), 0, sizeof(*IPCB(skb)));
325 break;
326 case htons(ETH_P_IPV6):
327 xfrm_decode_session(skb, &fl, AF_INET6);
328 memset(IP6CB(skb), 0, sizeof(*IP6CB(skb)));
329 break;
330 default:
331 dev->stats.tx_errors++;
332 dev_kfree_skb(skb);
333 return NETDEV_TX_OK;
334 }
335
Alexander Duyckcd5279c2015-05-27 07:16:43 -0700336 /* override mark with tunnel output key */
337 fl.flowi_mark = be32_to_cpu(tunnel->parms.o_key);
338
Steffen Klassert78a010c2014-02-21 08:41:10 +0100339 return vti_xmit(skb, dev, &fl);
340}
341
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100342static int vti4_err(struct sk_buff *skb, u32 info)
343{
344 __be32 spi;
Steffen Klassert6d004d62014-05-12 09:09:26 +0200345 __u32 mark;
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100346 struct xfrm_state *x;
347 struct ip_tunnel *tunnel;
348 struct ip_esp_hdr *esph;
349 struct ip_auth_hdr *ah ;
350 struct ip_comp_hdr *ipch;
351 struct net *net = dev_net(skb->dev);
352 const struct iphdr *iph = (const struct iphdr *)skb->data;
353 int protocol = iph->protocol;
354 struct ip_tunnel_net *itn = net_generic(net, vti_net_id);
355
356 tunnel = ip_tunnel_lookup(itn, skb->dev->ifindex, TUNNEL_NO_KEY,
357 iph->daddr, iph->saddr, 0);
358 if (!tunnel)
359 return -1;
360
Steffen Klassert6d004d62014-05-12 09:09:26 +0200361 mark = be32_to_cpu(tunnel->parms.o_key);
362
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100363 switch (protocol) {
364 case IPPROTO_ESP:
365 esph = (struct ip_esp_hdr *)(skb->data+(iph->ihl<<2));
366 spi = esph->spi;
367 break;
368 case IPPROTO_AH:
369 ah = (struct ip_auth_hdr *)(skb->data+(iph->ihl<<2));
370 spi = ah->spi;
371 break;
372 case IPPROTO_COMP:
373 ipch = (struct ip_comp_hdr *)(skb->data+(iph->ihl<<2));
374 spi = htonl(ntohs(ipch->cpi));
375 break;
376 default:
377 return 0;
378 }
379
380 switch (icmp_hdr(skb)->type) {
381 case ICMP_DEST_UNREACH:
382 if (icmp_hdr(skb)->code != ICMP_FRAG_NEEDED)
383 return 0;
384 case ICMP_REDIRECT:
385 break;
386 default:
387 return 0;
388 }
389
Steffen Klassert6d004d62014-05-12 09:09:26 +0200390 x = xfrm_state_lookup(net, mark, (const xfrm_address_t *)&iph->daddr,
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100391 spi, protocol, AF_INET);
392 if (!x)
393 return 0;
394
395 if (icmp_hdr(skb)->type == ICMP_DEST_UNREACH)
396 ipv4_update_pmtu(skb, net, info, 0, 0, protocol, 0);
397 else
398 ipv4_redirect(skb, net, 0, 0, protocol, 0);
399 xfrm_state_put(x);
400
401 return 0;
402}
403
Saurabh11814122012-07-17 09:44:54 +0000404static int
405vti_tunnel_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
406{
407 int err = 0;
408 struct ip_tunnel_parm p;
Saurabh11814122012-07-17 09:44:54 +0000409
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800410 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
411 return -EFAULT;
Saurabh11814122012-07-17 09:44:54 +0000412
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800413 if (cmd == SIOCADDTUNNEL || cmd == SIOCCHGTUNNEL) {
Saurabh11814122012-07-17 09:44:54 +0000414 if (p.iph.version != 4 || p.iph.protocol != IPPROTO_IPIP ||
415 p.iph.ihl != 5)
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800416 return -EINVAL;
Saurabh11814122012-07-17 09:44:54 +0000417 }
418
Dmitry Popov7c8e6b92014-06-08 02:06:25 +0400419 if (!(p.i_flags & GRE_KEY))
420 p.i_key = 0;
421 if (!(p.o_flags & GRE_KEY))
422 p.o_key = 0;
423
424 p.i_flags = VTI_ISVTI;
425
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800426 err = ip_tunnel_ioctl(dev, &p, cmd);
427 if (err)
428 return err;
Saurabh11814122012-07-17 09:44:54 +0000429
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800430 if (cmd != SIOCDELTUNNEL) {
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100431 p.i_flags |= GRE_KEY;
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800432 p.o_flags |= GRE_KEY;
433 }
434
435 if (copy_to_user(ifr->ifr_ifru.ifru_data, &p, sizeof(p)))
436 return -EFAULT;
Saurabh11814122012-07-17 09:44:54 +0000437 return 0;
438}
439
440static const struct net_device_ops vti_netdev_ops = {
441 .ndo_init = vti_tunnel_init,
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800442 .ndo_uninit = ip_tunnel_uninit,
Saurabh11814122012-07-17 09:44:54 +0000443 .ndo_start_xmit = vti_tunnel_xmit,
444 .ndo_do_ioctl = vti_tunnel_ioctl,
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800445 .ndo_change_mtu = ip_tunnel_change_mtu,
Pravin B Shelarf61dd382013-03-25 14:50:00 +0000446 .ndo_get_stats64 = ip_tunnel_get_stats64,
Nicolas Dichtel1e995842015-04-02 17:07:02 +0200447 .ndo_get_iflink = ip_tunnel_get_iflink,
Saurabh11814122012-07-17 09:44:54 +0000448};
449
Saurabh11814122012-07-17 09:44:54 +0000450static void vti_tunnel_setup(struct net_device *dev)
451{
452 dev->netdev_ops = &vti_netdev_ops;
Nicolas Dichtel8d89dcd2014-04-11 15:51:19 +0200453 dev->type = ARPHRD_TUNNEL;
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800454 ip_tunnel_setup(dev, vti_net_id);
455}
456
457static int vti_tunnel_init(struct net_device *dev)
458{
459 struct ip_tunnel *tunnel = netdev_priv(dev);
460 struct iphdr *iph = &tunnel->parms.iph;
461
462 memcpy(dev->dev_addr, &iph->saddr, 4);
463 memcpy(dev->broadcast, &iph->daddr, 4);
Saurabh11814122012-07-17 09:44:54 +0000464
Greg Kroah-Hartman98d69fb2018-05-30 20:44:08 +0200465 dev->mtu = ETH_DATA_LEN;
Saurabh11814122012-07-17 09:44:54 +0000466 dev->flags = IFF_NOARP;
Saurabh11814122012-07-17 09:44:54 +0000467 dev->addr_len = 4;
Saurabh11814122012-07-17 09:44:54 +0000468 dev->features |= NETIF_F_LLTX;
Eric Dumazet02875872014-10-05 18:38:35 -0700469 netif_keep_dst(dev);
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800470
471 return ip_tunnel_init(dev);
Saurabh11814122012-07-17 09:44:54 +0000472}
473
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800474static void __net_init vti_fb_tunnel_init(struct net_device *dev)
Saurabh11814122012-07-17 09:44:54 +0000475{
476 struct ip_tunnel *tunnel = netdev_priv(dev);
477 struct iphdr *iph = &tunnel->parms.iph;
Saurabh11814122012-07-17 09:44:54 +0000478
Saurabh11814122012-07-17 09:44:54 +0000479 iph->version = 4;
480 iph->protocol = IPPROTO_IPIP;
481 iph->ihl = 5;
Saurabh11814122012-07-17 09:44:54 +0000482}
483
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100484static struct xfrm4_protocol vti_esp4_protocol __read_mostly = {
Saurabh11814122012-07-17 09:44:54 +0000485 .handler = vti_rcv,
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100486 .input_handler = vti_input,
487 .cb_handler = vti_rcv_cb,
488 .err_handler = vti4_err,
489 .priority = 100,
490};
491
492static struct xfrm4_protocol vti_ah4_protocol __read_mostly = {
493 .handler = vti_rcv,
494 .input_handler = vti_input,
495 .cb_handler = vti_rcv_cb,
496 .err_handler = vti4_err,
497 .priority = 100,
498};
499
500static struct xfrm4_protocol vti_ipcomp4_protocol __read_mostly = {
501 .handler = vti_rcv,
502 .input_handler = vti_input,
503 .cb_handler = vti_rcv_cb,
504 .err_handler = vti4_err,
505 .priority = 100,
Saurabh11814122012-07-17 09:44:54 +0000506};
507
Su Yanjund2a6df72019-01-06 21:31:20 -0500508static struct xfrm_tunnel ipip_handler __read_mostly = {
509 .handler = vti_rcv_ipip,
510 .err_handler = vti4_err,
511 .priority = 0,
512};
513
Saurabh11814122012-07-17 09:44:54 +0000514static int __net_init vti_init_net(struct net *net)
515{
516 int err;
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800517 struct ip_tunnel_net *itn;
Saurabh11814122012-07-17 09:44:54 +0000518
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800519 err = ip_tunnel_init_net(net, vti_net_id, &vti_link_ops, "ip_vti0");
Saurabh11814122012-07-17 09:44:54 +0000520 if (err)
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800521 return err;
522 itn = net_generic(net, vti_net_id);
523 vti_fb_tunnel_init(itn->fb_tunnel_dev);
Saurabh11814122012-07-17 09:44:54 +0000524 return 0;
Saurabh11814122012-07-17 09:44:54 +0000525}
526
527static void __net_exit vti_exit_net(struct net *net)
528{
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800529 struct ip_tunnel_net *itn = net_generic(net, vti_net_id);
Nicolas Dichtel6c742e72013-08-13 17:51:11 +0200530 ip_tunnel_delete_net(itn, &vti_link_ops);
Saurabh11814122012-07-17 09:44:54 +0000531}
532
533static struct pernet_operations vti_net_ops = {
534 .init = vti_init_net,
535 .exit = vti_exit_net,
536 .id = &vti_net_id,
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800537 .size = sizeof(struct ip_tunnel_net),
Saurabh11814122012-07-17 09:44:54 +0000538};
539
540static int vti_tunnel_validate(struct nlattr *tb[], struct nlattr *data[])
541{
542 return 0;
543}
544
545static void vti_netlink_parms(struct nlattr *data[],
546 struct ip_tunnel_parm *parms)
547{
548 memset(parms, 0, sizeof(*parms));
549
550 parms->iph.protocol = IPPROTO_IPIP;
551
552 if (!data)
553 return;
554
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100555 parms->i_flags = VTI_ISVTI;
556
Saurabh11814122012-07-17 09:44:54 +0000557 if (data[IFLA_VTI_LINK])
558 parms->link = nla_get_u32(data[IFLA_VTI_LINK]);
559
560 if (data[IFLA_VTI_IKEY])
561 parms->i_key = nla_get_be32(data[IFLA_VTI_IKEY]);
562
563 if (data[IFLA_VTI_OKEY])
564 parms->o_key = nla_get_be32(data[IFLA_VTI_OKEY]);
565
566 if (data[IFLA_VTI_LOCAL])
Jiri Benc67b61f62015-03-29 16:59:26 +0200567 parms->iph.saddr = nla_get_in_addr(data[IFLA_VTI_LOCAL]);
Saurabh11814122012-07-17 09:44:54 +0000568
569 if (data[IFLA_VTI_REMOTE])
Jiri Benc67b61f62015-03-29 16:59:26 +0200570 parms->iph.daddr = nla_get_in_addr(data[IFLA_VTI_REMOTE]);
Saurabh11814122012-07-17 09:44:54 +0000571
572}
573
574static int vti_newlink(struct net *src_net, struct net_device *dev,
575 struct nlattr *tb[], struct nlattr *data[])
576{
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800577 struct ip_tunnel_parm parms;
Saurabh11814122012-07-17 09:44:54 +0000578
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800579 vti_netlink_parms(data, &parms);
580 return ip_tunnel_newlink(dev, tb, &parms);
Saurabh11814122012-07-17 09:44:54 +0000581}
582
583static int vti_changelink(struct net_device *dev, struct nlattr *tb[],
584 struct nlattr *data[])
585{
Saurabh11814122012-07-17 09:44:54 +0000586 struct ip_tunnel_parm p;
Saurabh11814122012-07-17 09:44:54 +0000587
Saurabh11814122012-07-17 09:44:54 +0000588 vti_netlink_parms(data, &p);
Amerigo Wangb9959fd2013-07-21 10:46:25 +0800589 return ip_tunnel_changelink(dev, tb, &p);
Saurabh11814122012-07-17 09:44:54 +0000590}
591
592static size_t vti_get_size(const struct net_device *dev)
593{
594 return
595 /* IFLA_VTI_LINK */
596 nla_total_size(4) +
597 /* IFLA_VTI_IKEY */
598 nla_total_size(4) +
599 /* IFLA_VTI_OKEY */
600 nla_total_size(4) +
601 /* IFLA_VTI_LOCAL */
602 nla_total_size(4) +
603 /* IFLA_VTI_REMOTE */
604 nla_total_size(4) +
605 0;
606}
607
608static int vti_fill_info(struct sk_buff *skb, const struct net_device *dev)
609{
610 struct ip_tunnel *t = netdev_priv(dev);
611 struct ip_tunnel_parm *p = &t->parms;
612
613 nla_put_u32(skb, IFLA_VTI_LINK, p->link);
614 nla_put_be32(skb, IFLA_VTI_IKEY, p->i_key);
615 nla_put_be32(skb, IFLA_VTI_OKEY, p->o_key);
Jiri Benc930345e2015-03-29 16:59:25 +0200616 nla_put_in_addr(skb, IFLA_VTI_LOCAL, p->iph.saddr);
617 nla_put_in_addr(skb, IFLA_VTI_REMOTE, p->iph.daddr);
Saurabh11814122012-07-17 09:44:54 +0000618
619 return 0;
620}
621
622static const struct nla_policy vti_policy[IFLA_VTI_MAX + 1] = {
623 [IFLA_VTI_LINK] = { .type = NLA_U32 },
624 [IFLA_VTI_IKEY] = { .type = NLA_U32 },
625 [IFLA_VTI_OKEY] = { .type = NLA_U32 },
626 [IFLA_VTI_LOCAL] = { .len = FIELD_SIZEOF(struct iphdr, saddr) },
627 [IFLA_VTI_REMOTE] = { .len = FIELD_SIZEOF(struct iphdr, daddr) },
628};
629
630static struct rtnl_link_ops vti_link_ops __read_mostly = {
631 .kind = "vti",
632 .maxtype = IFLA_VTI_MAX,
633 .policy = vti_policy,
634 .priv_size = sizeof(struct ip_tunnel),
635 .setup = vti_tunnel_setup,
636 .validate = vti_tunnel_validate,
637 .newlink = vti_newlink,
638 .changelink = vti_changelink,
lucien20ea60c2014-11-23 15:04:11 +0800639 .dellink = ip_tunnel_dellink,
Saurabh11814122012-07-17 09:44:54 +0000640 .get_size = vti_get_size,
641 .fill_info = vti_fill_info,
Nicolas Dichtel1728d4f2015-01-15 15:11:17 +0100642 .get_link_net = ip_tunnel_get_link_net,
Saurabh11814122012-07-17 09:44:54 +0000643};
644
Lance Richardsona5d0dc82016-08-09 15:29:42 -0400645static bool is_vti_tunnel(const struct net_device *dev)
646{
647 return dev->netdev_ops == &vti_netdev_ops;
648}
649
650static int vti_device_event(struct notifier_block *unused,
651 unsigned long event, void *ptr)
652{
653 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
654 struct ip_tunnel *tunnel = netdev_priv(dev);
655
656 if (!is_vti_tunnel(dev))
657 return NOTIFY_DONE;
658
659 switch (event) {
660 case NETDEV_DOWN:
661 if (!net_eq(tunnel->net, dev_net(dev)))
662 xfrm_garbage_collect(tunnel->net);
663 break;
664 }
665 return NOTIFY_DONE;
666}
667
668static struct notifier_block vti_notifier_block __read_mostly = {
669 .notifier_call = vti_device_event,
670};
671
Saurabh11814122012-07-17 09:44:54 +0000672static int __init vti_init(void)
673{
Mathias Krause1990e4f2014-05-09 23:43:42 +0200674 const char *msg;
Saurabh11814122012-07-17 09:44:54 +0000675 int err;
676
Mathias Krause1990e4f2014-05-09 23:43:42 +0200677 pr_info("IPv4 over IPsec tunneling driver\n");
Saurabh11814122012-07-17 09:44:54 +0000678
Lance Richardsona5d0dc82016-08-09 15:29:42 -0400679 register_netdevice_notifier(&vti_notifier_block);
680
Mathias Krause1990e4f2014-05-09 23:43:42 +0200681 msg = "tunnel device";
Saurabh11814122012-07-17 09:44:54 +0000682 err = register_pernet_device(&vti_net_ops);
683 if (err < 0)
Mathias Krause1990e4f2014-05-09 23:43:42 +0200684 goto pernet_dev_failed;
685
686 msg = "tunnel protocols";
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100687 err = xfrm4_protocol_register(&vti_esp4_protocol, IPPROTO_ESP);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200688 if (err < 0)
689 goto xfrm_proto_esp_failed;
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100690 err = xfrm4_protocol_register(&vti_ah4_protocol, IPPROTO_AH);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200691 if (err < 0)
692 goto xfrm_proto_ah_failed;
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100693 err = xfrm4_protocol_register(&vti_ipcomp4_protocol, IPPROTO_COMP);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200694 if (err < 0)
695 goto xfrm_proto_comp_failed;
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100696
Su Yanjund2a6df72019-01-06 21:31:20 -0500697 msg = "ipip tunnel";
698 err = xfrm4_tunnel_register(&ipip_handler, AF_INET);
699 if (err < 0) {
700 pr_info("%s: cant't register tunnel\n",__func__);
701 goto xfrm_tunnel_failed;
702 }
703
Mathias Krause1990e4f2014-05-09 23:43:42 +0200704 msg = "netlink interface";
Saurabh11814122012-07-17 09:44:54 +0000705 err = rtnl_link_register(&vti_link_ops);
706 if (err < 0)
707 goto rtnl_link_failed;
708
709 return err;
710
711rtnl_link_failed:
Su Yanjund2a6df72019-01-06 21:31:20 -0500712 xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
Jeremy Sowdeneb490b32019-03-19 15:39:20 +0000713xfrm_tunnel_failed:
714 xfrm4_protocol_deregister(&vti_ipcomp4_protocol, IPPROTO_COMP);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200715xfrm_proto_comp_failed:
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100716 xfrm4_protocol_deregister(&vti_ah4_protocol, IPPROTO_AH);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200717xfrm_proto_ah_failed:
Steffen Klassertdf3893c2014-02-21 08:41:10 +0100718 xfrm4_protocol_deregister(&vti_esp4_protocol, IPPROTO_ESP);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200719xfrm_proto_esp_failed:
Saurabh11814122012-07-17 09:44:54 +0000720 unregister_pernet_device(&vti_net_ops);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200721pernet_dev_failed:
Lance Richardsona5d0dc82016-08-09 15:29:42 -0400722 unregister_netdevice_notifier(&vti_notifier_block);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200723 pr_err("vti init: failed to register %s\n", msg);
Saurabh11814122012-07-17 09:44:54 +0000724 return err;
725}
726
727static void __exit vti_fini(void)
728{
729 rtnl_link_unregister(&vti_link_ops);
Jeremy Sowdeneb490b32019-03-19 15:39:20 +0000730 xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
Mathias Krause1990e4f2014-05-09 23:43:42 +0200731 xfrm4_protocol_deregister(&vti_ipcomp4_protocol, IPPROTO_COMP);
732 xfrm4_protocol_deregister(&vti_ah4_protocol, IPPROTO_AH);
733 xfrm4_protocol_deregister(&vti_esp4_protocol, IPPROTO_ESP);
Saurabh11814122012-07-17 09:44:54 +0000734 unregister_pernet_device(&vti_net_ops);
Lance Richardsona5d0dc82016-08-09 15:29:42 -0400735 unregister_netdevice_notifier(&vti_notifier_block);
Saurabh11814122012-07-17 09:44:54 +0000736}
737
738module_init(vti_init);
739module_exit(vti_fini);
740MODULE_LICENSE("GPL");
741MODULE_ALIAS_RTNL_LINK("vti");
742MODULE_ALIAS_NETDEV("ip_vti0");