Merge branch 'master' into next
[linux-2.6] / net / ipv4 / ipip.c
1 /*
2  *      Linux NET3:     IP/IP protocol decoder.
3  *
4  *      Authors:
5  *              Sam Lantinga (slouken@cs.ucdavis.edu)  02/01/95
6  *
7  *      Fixes:
8  *              Alan Cox        :       Merged and made usable non modular (its so tiny its silly as
9  *                                      a module taking up 2 pages).
10  *              Alan Cox        :       Fixed bug with 1.3.18 and IPIP not working (now needs to set skb->h.iph)
11  *                                      to keep ip_forward happy.
12  *              Alan Cox        :       More fixes for 1.3.21, and firewall fix. Maybe this will work soon 8).
13  *              Kai Schulte     :       Fixed #defines for IP_FIREWALL->FIREWALL
14  *              David Woodhouse :       Perform some basic ICMP handling.
15  *                                      IPIP Routing without decapsulation.
16  *              Carlos Picoto   :       GRE over IP support
17  *              Alexey Kuznetsov:       Reworked. Really, now it is truncated version of ipv4/ip_gre.c.
18  *                                      I do not want to merge them together.
19  *
20  *      This program is free software; you can redistribute it and/or
21  *      modify it under the terms of the GNU General Public License
22  *      as published by the Free Software Foundation; either version
23  *      2 of the License, or (at your option) any later version.
24  *
25  */
26
27 /* tunnel.c: an IP tunnel driver
28
29         The purpose of this driver is to provide an IP tunnel through
30         which you can tunnel network traffic transparently across subnets.
31
32         This was written by looking at Nick Holloway's dummy driver
33         Thanks for the great code!
34
35                 -Sam Lantinga   (slouken@cs.ucdavis.edu)  02/01/95
36
37         Minor tweaks:
38                 Cleaned up the code a little and added some pre-1.3.0 tweaks.
39                 dev->hard_header/hard_header_len changed to use no headers.
40                 Comments/bracketing tweaked.
41                 Made the tunnels use dev->name not tunnel: when error reporting.
42                 Added tx_dropped stat
43
44                 -Alan Cox       (alan@lxorguk.ukuu.org.uk) 21 March 95
45
46         Reworked:
47                 Changed to tunnel to destination gateway in addition to the
48                         tunnel's pointopoint address
49                 Almost completely rewritten
50                 Note:  There is currently no firewall or ICMP handling done.
51
52                 -Sam Lantinga   (slouken@cs.ucdavis.edu) 02/13/96
53
54 */
55
56 /* Things I wish I had known when writing the tunnel driver:
57
58         When the tunnel_xmit() function is called, the skb contains the
59         packet to be sent (plus a great deal of extra info), and dev
60         contains the tunnel device that _we_ are.
61
62         When we are passed a packet, we are expected to fill in the
63         source address with our source IP address.
64
65         What is the proper way to allocate, copy and free a buffer?
66         After you allocate it, it is a "0 length" chunk of memory
67         starting at zero.  If you want to add headers to the buffer
68         later, you'll have to call "skb_reserve(skb, amount)" with
69         the amount of memory you want reserved.  Then, you call
70         "skb_put(skb, amount)" with the amount of space you want in
71         the buffer.  skb_put() returns a pointer to the top (#0) of
72         that buffer.  skb->len is set to the amount of space you have
73         "allocated" with skb_put().  You can then write up to skb->len
74         bytes to that buffer.  If you need more, you can call skb_put()
75         again with the additional amount of space you need.  You can
76         find out how much more space you can allocate by calling
77         "skb_tailroom(skb)".
78         Now, to add header space, call "skb_push(skb, header_len)".
79         This creates space at the beginning of the buffer and returns
80         a pointer to this new space.  If later you need to strip a
81         header from a buffer, call "skb_pull(skb, header_len)".
82         skb_headroom() will return how much space is left at the top
83         of the buffer (before the main data).  Remember, this headroom
84         space must be reserved before the skb_put() function is called.
85         */
86
87 /*
88    This version of net/ipv4/ipip.c is cloned of net/ipv4/ip_gre.c
89
90    For comments look at net/ipv4/ip_gre.c --ANK
91  */
92
93
94 #include <linux/capability.h>
95 #include <linux/module.h>
96 #include <linux/types.h>
97 #include <linux/kernel.h>
98 #include <asm/uaccess.h>
99 #include <linux/skbuff.h>
100 #include <linux/netdevice.h>
101 #include <linux/in.h>
102 #include <linux/tcp.h>
103 #include <linux/udp.h>
104 #include <linux/if_arp.h>
105 #include <linux/mroute.h>
106 #include <linux/init.h>
107 #include <linux/netfilter_ipv4.h>
108 #include <linux/if_ether.h>
109
110 #include <net/sock.h>
111 #include <net/ip.h>
112 #include <net/icmp.h>
113 #include <net/ipip.h>
114 #include <net/inet_ecn.h>
115 #include <net/xfrm.h>
116 #include <net/net_namespace.h>
117 #include <net/netns/generic.h>
118
119 #define HASH_SIZE  16
120 #define HASH(addr) (((__force u32)addr^((__force u32)addr>>4))&0xF)
121
122 static int ipip_net_id;
123 struct ipip_net {
124         struct ip_tunnel *tunnels_r_l[HASH_SIZE];
125         struct ip_tunnel *tunnels_r[HASH_SIZE];
126         struct ip_tunnel *tunnels_l[HASH_SIZE];
127         struct ip_tunnel *tunnels_wc[1];
128         struct ip_tunnel **tunnels[4];
129
130         struct net_device *fb_tunnel_dev;
131 };
132
133 static void ipip_fb_tunnel_init(struct net_device *dev);
134 static void ipip_tunnel_init(struct net_device *dev);
135 static void ipip_tunnel_setup(struct net_device *dev);
136
137 static DEFINE_RWLOCK(ipip_lock);
138
139 static struct ip_tunnel * ipip_tunnel_lookup(struct net *net,
140                 __be32 remote, __be32 local)
141 {
142         unsigned h0 = HASH(remote);
143         unsigned h1 = HASH(local);
144         struct ip_tunnel *t;
145         struct ipip_net *ipn = net_generic(net, ipip_net_id);
146
147         for (t = ipn->tunnels_r_l[h0^h1]; t; t = t->next) {
148                 if (local == t->parms.iph.saddr &&
149                     remote == t->parms.iph.daddr && (t->dev->flags&IFF_UP))
150                         return t;
151         }
152         for (t = ipn->tunnels_r[h0]; t; t = t->next) {
153                 if (remote == t->parms.iph.daddr && (t->dev->flags&IFF_UP))
154                         return t;
155         }
156         for (t = ipn->tunnels_l[h1]; t; t = t->next) {
157                 if (local == t->parms.iph.saddr && (t->dev->flags&IFF_UP))
158                         return t;
159         }
160         if ((t = ipn->tunnels_wc[0]) != NULL && (t->dev->flags&IFF_UP))
161                 return t;
162         return NULL;
163 }
164
165 static struct ip_tunnel **__ipip_bucket(struct ipip_net *ipn,
166                 struct ip_tunnel_parm *parms)
167 {
168         __be32 remote = parms->iph.daddr;
169         __be32 local = parms->iph.saddr;
170         unsigned h = 0;
171         int prio = 0;
172
173         if (remote) {
174                 prio |= 2;
175                 h ^= HASH(remote);
176         }
177         if (local) {
178                 prio |= 1;
179                 h ^= HASH(local);
180         }
181         return &ipn->tunnels[prio][h];
182 }
183
184 static inline struct ip_tunnel **ipip_bucket(struct ipip_net *ipn,
185                 struct ip_tunnel *t)
186 {
187         return __ipip_bucket(ipn, &t->parms);
188 }
189
190 static void ipip_tunnel_unlink(struct ipip_net *ipn, struct ip_tunnel *t)
191 {
192         struct ip_tunnel **tp;
193
194         for (tp = ipip_bucket(ipn, t); *tp; tp = &(*tp)->next) {
195                 if (t == *tp) {
196                         write_lock_bh(&ipip_lock);
197                         *tp = t->next;
198                         write_unlock_bh(&ipip_lock);
199                         break;
200                 }
201         }
202 }
203
204 static void ipip_tunnel_link(struct ipip_net *ipn, struct ip_tunnel *t)
205 {
206         struct ip_tunnel **tp = ipip_bucket(ipn, t);
207
208         t->next = *tp;
209         write_lock_bh(&ipip_lock);
210         *tp = t;
211         write_unlock_bh(&ipip_lock);
212 }
213
214 static struct ip_tunnel * ipip_tunnel_locate(struct net *net,
215                 struct ip_tunnel_parm *parms, int create)
216 {
217         __be32 remote = parms->iph.daddr;
218         __be32 local = parms->iph.saddr;
219         struct ip_tunnel *t, **tp, *nt;
220         struct net_device *dev;
221         char name[IFNAMSIZ];
222         struct ipip_net *ipn = net_generic(net, ipip_net_id);
223
224         for (tp = __ipip_bucket(ipn, parms); (t = *tp) != NULL; tp = &t->next) {
225                 if (local == t->parms.iph.saddr && remote == t->parms.iph.daddr)
226                         return t;
227         }
228         if (!create)
229                 return NULL;
230
231         if (parms->name[0])
232                 strlcpy(name, parms->name, IFNAMSIZ);
233         else
234                 sprintf(name, "tunl%%d");
235
236         dev = alloc_netdev(sizeof(*t), name, ipip_tunnel_setup);
237         if (dev == NULL)
238                 return NULL;
239
240         dev_net_set(dev, net);
241
242         if (strchr(name, '%')) {
243                 if (dev_alloc_name(dev, name) < 0)
244                         goto failed_free;
245         }
246
247         nt = netdev_priv(dev);
248         nt->parms = *parms;
249
250         ipip_tunnel_init(dev);
251
252         if (register_netdevice(dev) < 0)
253                 goto failed_free;
254
255         dev_hold(dev);
256         ipip_tunnel_link(ipn, nt);
257         return nt;
258
259 failed_free:
260         free_netdev(dev);
261         return NULL;
262 }
263
264 static void ipip_tunnel_uninit(struct net_device *dev)
265 {
266         struct net *net = dev_net(dev);
267         struct ipip_net *ipn = net_generic(net, ipip_net_id);
268
269         if (dev == ipn->fb_tunnel_dev) {
270                 write_lock_bh(&ipip_lock);
271                 ipn->tunnels_wc[0] = NULL;
272                 write_unlock_bh(&ipip_lock);
273         } else
274                 ipip_tunnel_unlink(ipn, netdev_priv(dev));
275         dev_put(dev);
276 }
277
278 static int ipip_err(struct sk_buff *skb, u32 info)
279 {
280
281 /* All the routers (except for Linux) return only
282    8 bytes of packet payload. It means, that precise relaying of
283    ICMP in the real Internet is absolutely infeasible.
284  */
285         struct iphdr *iph = (struct iphdr *)skb->data;
286         const int type = icmp_hdr(skb)->type;
287         const int code = icmp_hdr(skb)->code;
288         struct ip_tunnel *t;
289         int err;
290
291         switch (type) {
292         default:
293         case ICMP_PARAMETERPROB:
294                 return 0;
295
296         case ICMP_DEST_UNREACH:
297                 switch (code) {
298                 case ICMP_SR_FAILED:
299                 case ICMP_PORT_UNREACH:
300                         /* Impossible event. */
301                         return 0;
302                 case ICMP_FRAG_NEEDED:
303                         /* Soft state for pmtu is maintained by IP core. */
304                         return 0;
305                 default:
306                         /* All others are translated to HOST_UNREACH.
307                            rfc2003 contains "deep thoughts" about NET_UNREACH,
308                            I believe they are just ether pollution. --ANK
309                          */
310                         break;
311                 }
312                 break;
313         case ICMP_TIME_EXCEEDED:
314                 if (code != ICMP_EXC_TTL)
315                         return 0;
316                 break;
317         }
318
319         err = -ENOENT;
320
321         read_lock(&ipip_lock);
322         t = ipip_tunnel_lookup(dev_net(skb->dev), iph->daddr, iph->saddr);
323         if (t == NULL || t->parms.iph.daddr == 0)
324                 goto out;
325
326         err = 0;
327         if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED)
328                 goto out;
329
330         if (jiffies - t->err_time < IPTUNNEL_ERR_TIMEO)
331                 t->err_count++;
332         else
333                 t->err_count = 1;
334         t->err_time = jiffies;
335 out:
336         read_unlock(&ipip_lock);
337         return err;
338 }
339
340 static inline void ipip_ecn_decapsulate(const struct iphdr *outer_iph,
341                                         struct sk_buff *skb)
342 {
343         struct iphdr *inner_iph = ip_hdr(skb);
344
345         if (INET_ECN_is_ce(outer_iph->tos))
346                 IP_ECN_set_ce(inner_iph);
347 }
348
349 static int ipip_rcv(struct sk_buff *skb)
350 {
351         struct ip_tunnel *tunnel;
352         const struct iphdr *iph = ip_hdr(skb);
353
354         read_lock(&ipip_lock);
355         if ((tunnel = ipip_tunnel_lookup(dev_net(skb->dev),
356                                         iph->saddr, iph->daddr)) != NULL) {
357                 if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb)) {
358                         read_unlock(&ipip_lock);
359                         kfree_skb(skb);
360                         return 0;
361                 }
362
363                 secpath_reset(skb);
364
365                 skb->mac_header = skb->network_header;
366                 skb_reset_network_header(skb);
367                 skb->protocol = htons(ETH_P_IP);
368                 skb->pkt_type = PACKET_HOST;
369
370                 tunnel->dev->stats.rx_packets++;
371                 tunnel->dev->stats.rx_bytes += skb->len;
372                 skb->dev = tunnel->dev;
373                 dst_release(skb->dst);
374                 skb->dst = NULL;
375                 nf_reset(skb);
376                 ipip_ecn_decapsulate(iph, skb);
377                 netif_rx(skb);
378                 read_unlock(&ipip_lock);
379                 return 0;
380         }
381         read_unlock(&ipip_lock);
382
383         return -1;
384 }
385
386 /*
387  *      This function assumes it is being called from dev_queue_xmit()
388  *      and that skb is filled properly by that function.
389  */
390
391 static int ipip_tunnel_xmit(struct sk_buff *skb, struct net_device *dev)
392 {
393         struct ip_tunnel *tunnel = netdev_priv(dev);
394         struct net_device_stats *stats = &tunnel->dev->stats;
395         struct iphdr  *tiph = &tunnel->parms.iph;
396         u8     tos = tunnel->parms.iph.tos;
397         __be16 df = tiph->frag_off;
398         struct rtable *rt;                      /* Route to the other host */
399         struct net_device *tdev;                        /* Device to other host */
400         struct iphdr  *old_iph = ip_hdr(skb);
401         struct iphdr  *iph;                     /* Our new IP header */
402         unsigned int max_headroom;              /* The extra header space needed */
403         __be32 dst = tiph->daddr;
404         int    mtu;
405
406         if (tunnel->recursion++) {
407                 stats->collisions++;
408                 goto tx_error;
409         }
410
411         if (skb->protocol != htons(ETH_P_IP))
412                 goto tx_error;
413
414         if (tos&1)
415                 tos = old_iph->tos;
416
417         if (!dst) {
418                 /* NBMA tunnel */
419                 if ((rt = skb->rtable) == NULL) {
420                         stats->tx_fifo_errors++;
421                         goto tx_error;
422                 }
423                 if ((dst = rt->rt_gateway) == 0)
424                         goto tx_error_icmp;
425         }
426
427         {
428                 struct flowi fl = { .oif = tunnel->parms.link,
429                                     .nl_u = { .ip4_u =
430                                               { .daddr = dst,
431                                                 .saddr = tiph->saddr,
432                                                 .tos = RT_TOS(tos) } },
433                                     .proto = IPPROTO_IPIP };
434                 if (ip_route_output_key(dev_net(dev), &rt, &fl)) {
435                         stats->tx_carrier_errors++;
436                         goto tx_error_icmp;
437                 }
438         }
439         tdev = rt->u.dst.dev;
440
441         if (tdev == dev) {
442                 ip_rt_put(rt);
443                 stats->collisions++;
444                 goto tx_error;
445         }
446
447         if (tiph->frag_off)
448                 mtu = dst_mtu(&rt->u.dst) - sizeof(struct iphdr);
449         else
450                 mtu = skb->dst ? dst_mtu(skb->dst) : dev->mtu;
451
452         if (mtu < 68) {
453                 stats->collisions++;
454                 ip_rt_put(rt);
455                 goto tx_error;
456         }
457         if (skb->dst)
458                 skb->dst->ops->update_pmtu(skb->dst, mtu);
459
460         df |= (old_iph->frag_off&htons(IP_DF));
461
462         if ((old_iph->frag_off&htons(IP_DF)) && mtu < ntohs(old_iph->tot_len)) {
463                 icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, htonl(mtu));
464                 ip_rt_put(rt);
465                 goto tx_error;
466         }
467
468         if (tunnel->err_count > 0) {
469                 if (jiffies - tunnel->err_time < IPTUNNEL_ERR_TIMEO) {
470                         tunnel->err_count--;
471                         dst_link_failure(skb);
472                 } else
473                         tunnel->err_count = 0;
474         }
475
476         /*
477          * Okay, now see if we can stuff it in the buffer as-is.
478          */
479         max_headroom = (LL_RESERVED_SPACE(tdev)+sizeof(struct iphdr));
480
481         if (skb_headroom(skb) < max_headroom || skb_shared(skb) ||
482             (skb_cloned(skb) && !skb_clone_writable(skb, 0))) {
483                 struct sk_buff *new_skb = skb_realloc_headroom(skb, max_headroom);
484                 if (!new_skb) {
485                         ip_rt_put(rt);
486                         stats->tx_dropped++;
487                         dev_kfree_skb(skb);
488                         tunnel->recursion--;
489                         return 0;
490                 }
491                 if (skb->sk)
492                         skb_set_owner_w(new_skb, skb->sk);
493                 dev_kfree_skb(skb);
494                 skb = new_skb;
495                 old_iph = ip_hdr(skb);
496         }
497
498         skb->transport_header = skb->network_header;
499         skb_push(skb, sizeof(struct iphdr));
500         skb_reset_network_header(skb);
501         memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt));
502         IPCB(skb)->flags &= ~(IPSKB_XFRM_TUNNEL_SIZE | IPSKB_XFRM_TRANSFORMED |
503                               IPSKB_REROUTED);
504         dst_release(skb->dst);
505         skb->dst = &rt->u.dst;
506
507         /*
508          *      Push down and install the IPIP header.
509          */
510
511         iph                     =       ip_hdr(skb);
512         iph->version            =       4;
513         iph->ihl                =       sizeof(struct iphdr)>>2;
514         iph->frag_off           =       df;
515         iph->protocol           =       IPPROTO_IPIP;
516         iph->tos                =       INET_ECN_encapsulate(tos, old_iph->tos);
517         iph->daddr              =       rt->rt_dst;
518         iph->saddr              =       rt->rt_src;
519
520         if ((iph->ttl = tiph->ttl) == 0)
521                 iph->ttl        =       old_iph->ttl;
522
523         nf_reset(skb);
524
525         IPTUNNEL_XMIT();
526         tunnel->recursion--;
527         return 0;
528
529 tx_error_icmp:
530         dst_link_failure(skb);
531 tx_error:
532         stats->tx_errors++;
533         dev_kfree_skb(skb);
534         tunnel->recursion--;
535         return 0;
536 }
537
538 static void ipip_tunnel_bind_dev(struct net_device *dev)
539 {
540         struct net_device *tdev = NULL;
541         struct ip_tunnel *tunnel;
542         struct iphdr *iph;
543
544         tunnel = netdev_priv(dev);
545         iph = &tunnel->parms.iph;
546
547         if (iph->daddr) {
548                 struct flowi fl = { .oif = tunnel->parms.link,
549                                     .nl_u = { .ip4_u =
550                                               { .daddr = iph->daddr,
551                                                 .saddr = iph->saddr,
552                                                 .tos = RT_TOS(iph->tos) } },
553                                     .proto = IPPROTO_IPIP };
554                 struct rtable *rt;
555                 if (!ip_route_output_key(dev_net(dev), &rt, &fl)) {
556                         tdev = rt->u.dst.dev;
557                         ip_rt_put(rt);
558                 }
559                 dev->flags |= IFF_POINTOPOINT;
560         }
561
562         if (!tdev && tunnel->parms.link)
563                 tdev = __dev_get_by_index(dev_net(dev), tunnel->parms.link);
564
565         if (tdev) {
566                 dev->hard_header_len = tdev->hard_header_len + sizeof(struct iphdr);
567                 dev->mtu = tdev->mtu - sizeof(struct iphdr);
568         }
569         dev->iflink = tunnel->parms.link;
570 }
571
572 static int
573 ipip_tunnel_ioctl (struct net_device *dev, struct ifreq *ifr, int cmd)
574 {
575         int err = 0;
576         struct ip_tunnel_parm p;
577         struct ip_tunnel *t;
578         struct net *net = dev_net(dev);
579         struct ipip_net *ipn = net_generic(net, ipip_net_id);
580
581         switch (cmd) {
582         case SIOCGETTUNNEL:
583                 t = NULL;
584                 if (dev == ipn->fb_tunnel_dev) {
585                         if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) {
586                                 err = -EFAULT;
587                                 break;
588                         }
589                         t = ipip_tunnel_locate(net, &p, 0);
590                 }
591                 if (t == NULL)
592                         t = netdev_priv(dev);
593                 memcpy(&p, &t->parms, sizeof(p));
594                 if (copy_to_user(ifr->ifr_ifru.ifru_data, &p, sizeof(p)))
595                         err = -EFAULT;
596                 break;
597
598         case SIOCADDTUNNEL:
599         case SIOCCHGTUNNEL:
600                 err = -EPERM;
601                 if (!capable(CAP_NET_ADMIN))
602                         goto done;
603
604                 err = -EFAULT;
605                 if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
606                         goto done;
607
608                 err = -EINVAL;
609                 if (p.iph.version != 4 || p.iph.protocol != IPPROTO_IPIP ||
610                     p.iph.ihl != 5 || (p.iph.frag_off&htons(~IP_DF)))
611                         goto done;
612                 if (p.iph.ttl)
613                         p.iph.frag_off |= htons(IP_DF);
614
615                 t = ipip_tunnel_locate(net, &p, cmd == SIOCADDTUNNEL);
616
617                 if (dev != ipn->fb_tunnel_dev && cmd == SIOCCHGTUNNEL) {
618                         if (t != NULL) {
619                                 if (t->dev != dev) {
620                                         err = -EEXIST;
621                                         break;
622                                 }
623                         } else {
624                                 if (((dev->flags&IFF_POINTOPOINT) && !p.iph.daddr) ||
625                                     (!(dev->flags&IFF_POINTOPOINT) && p.iph.daddr)) {
626                                         err = -EINVAL;
627                                         break;
628                                 }
629                                 t = netdev_priv(dev);
630                                 ipip_tunnel_unlink(ipn, t);
631                                 t->parms.iph.saddr = p.iph.saddr;
632                                 t->parms.iph.daddr = p.iph.daddr;
633                                 memcpy(dev->dev_addr, &p.iph.saddr, 4);
634                                 memcpy(dev->broadcast, &p.iph.daddr, 4);
635                                 ipip_tunnel_link(ipn, t);
636                                 netdev_state_change(dev);
637                         }
638                 }
639
640                 if (t) {
641                         err = 0;
642                         if (cmd == SIOCCHGTUNNEL) {
643                                 t->parms.iph.ttl = p.iph.ttl;
644                                 t->parms.iph.tos = p.iph.tos;
645                                 t->parms.iph.frag_off = p.iph.frag_off;
646                                 if (t->parms.link != p.link) {
647                                         t->parms.link = p.link;
648                                         ipip_tunnel_bind_dev(dev);
649                                         netdev_state_change(dev);
650                                 }
651                         }
652                         if (copy_to_user(ifr->ifr_ifru.ifru_data, &t->parms, sizeof(p)))
653                                 err = -EFAULT;
654                 } else
655                         err = (cmd == SIOCADDTUNNEL ? -ENOBUFS : -ENOENT);
656                 break;
657
658         case SIOCDELTUNNEL:
659                 err = -EPERM;
660                 if (!capable(CAP_NET_ADMIN))
661                         goto done;
662
663                 if (dev == ipn->fb_tunnel_dev) {
664                         err = -EFAULT;
665                         if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p)))
666                                 goto done;
667                         err = -ENOENT;
668                         if ((t = ipip_tunnel_locate(net, &p, 0)) == NULL)
669                                 goto done;
670                         err = -EPERM;
671                         if (t->dev == ipn->fb_tunnel_dev)
672                                 goto done;
673                         dev = t->dev;
674                 }
675                 unregister_netdevice(dev);
676                 err = 0;
677                 break;
678
679         default:
680                 err = -EINVAL;
681         }
682
683 done:
684         return err;
685 }
686
687 static int ipip_tunnel_change_mtu(struct net_device *dev, int new_mtu)
688 {
689         if (new_mtu < 68 || new_mtu > 0xFFF8 - sizeof(struct iphdr))
690                 return -EINVAL;
691         dev->mtu = new_mtu;
692         return 0;
693 }
694
695 static const struct net_device_ops ipip_netdev_ops = {
696         .ndo_uninit     = ipip_tunnel_uninit,
697         .ndo_start_xmit = ipip_tunnel_xmit,
698         .ndo_do_ioctl   = ipip_tunnel_ioctl,
699         .ndo_change_mtu = ipip_tunnel_change_mtu,
700
701 };
702
703 static void ipip_tunnel_setup(struct net_device *dev)
704 {
705         dev->netdev_ops         = &ipip_netdev_ops;
706         dev->destructor         = free_netdev;
707
708         dev->type               = ARPHRD_TUNNEL;
709         dev->hard_header_len    = LL_MAX_HEADER + sizeof(struct iphdr);
710         dev->mtu                = ETH_DATA_LEN - sizeof(struct iphdr);
711         dev->flags              = IFF_NOARP;
712         dev->iflink             = 0;
713         dev->addr_len           = 4;
714         dev->features           |= NETIF_F_NETNS_LOCAL;
715 }
716
717 static void ipip_tunnel_init(struct net_device *dev)
718 {
719         struct ip_tunnel *tunnel = netdev_priv(dev);
720
721         tunnel->dev = dev;
722         strcpy(tunnel->parms.name, dev->name);
723
724         memcpy(dev->dev_addr, &tunnel->parms.iph.saddr, 4);
725         memcpy(dev->broadcast, &tunnel->parms.iph.daddr, 4);
726
727         ipip_tunnel_bind_dev(dev);
728 }
729
730 static void ipip_fb_tunnel_init(struct net_device *dev)
731 {
732         struct ip_tunnel *tunnel = netdev_priv(dev);
733         struct iphdr *iph = &tunnel->parms.iph;
734         struct ipip_net *ipn = net_generic(dev_net(dev), ipip_net_id);
735
736         tunnel->dev = dev;
737         strcpy(tunnel->parms.name, dev->name);
738
739         iph->version            = 4;
740         iph->protocol           = IPPROTO_IPIP;
741         iph->ihl                = 5;
742
743         dev_hold(dev);
744         ipn->tunnels_wc[0]      = tunnel;
745 }
746
747 static struct xfrm_tunnel ipip_handler = {
748         .handler        =       ipip_rcv,
749         .err_handler    =       ipip_err,
750         .priority       =       1,
751 };
752
753 static char banner[] __initdata =
754         KERN_INFO "IPv4 over IPv4 tunneling driver\n";
755
756 static void ipip_destroy_tunnels(struct ipip_net *ipn)
757 {
758         int prio;
759
760         for (prio = 1; prio < 4; prio++) {
761                 int h;
762                 for (h = 0; h < HASH_SIZE; h++) {
763                         struct ip_tunnel *t;
764                         while ((t = ipn->tunnels[prio][h]) != NULL)
765                                 unregister_netdevice(t->dev);
766                 }
767         }
768 }
769
770 static int ipip_init_net(struct net *net)
771 {
772         int err;
773         struct ipip_net *ipn;
774
775         err = -ENOMEM;
776         ipn = kzalloc(sizeof(struct ipip_net), GFP_KERNEL);
777         if (ipn == NULL)
778                 goto err_alloc;
779
780         err = net_assign_generic(net, ipip_net_id, ipn);
781         if (err < 0)
782                 goto err_assign;
783
784         ipn->tunnels[0] = ipn->tunnels_wc;
785         ipn->tunnels[1] = ipn->tunnels_l;
786         ipn->tunnels[2] = ipn->tunnels_r;
787         ipn->tunnels[3] = ipn->tunnels_r_l;
788
789         ipn->fb_tunnel_dev = alloc_netdev(sizeof(struct ip_tunnel),
790                                            "tunl0",
791                                            ipip_tunnel_setup);
792         if (!ipn->fb_tunnel_dev) {
793                 err = -ENOMEM;
794                 goto err_alloc_dev;
795         }
796         dev_net_set(ipn->fb_tunnel_dev, net);
797
798         ipip_fb_tunnel_init(ipn->fb_tunnel_dev);
799
800         if ((err = register_netdev(ipn->fb_tunnel_dev)))
801                 goto err_reg_dev;
802
803         return 0;
804
805 err_reg_dev:
806         free_netdev(ipn->fb_tunnel_dev);
807 err_alloc_dev:
808         /* nothing */
809 err_assign:
810         kfree(ipn);
811 err_alloc:
812         return err;
813 }
814
815 static void ipip_exit_net(struct net *net)
816 {
817         struct ipip_net *ipn;
818
819         ipn = net_generic(net, ipip_net_id);
820         rtnl_lock();
821         ipip_destroy_tunnels(ipn);
822         unregister_netdevice(ipn->fb_tunnel_dev);
823         rtnl_unlock();
824         kfree(ipn);
825 }
826
827 static struct pernet_operations ipip_net_ops = {
828         .init = ipip_init_net,
829         .exit = ipip_exit_net,
830 };
831
832 static int __init ipip_init(void)
833 {
834         int err;
835
836         printk(banner);
837
838         if (xfrm4_tunnel_register(&ipip_handler, AF_INET)) {
839                 printk(KERN_INFO "ipip init: can't register tunnel\n");
840                 return -EAGAIN;
841         }
842
843         err = register_pernet_gen_device(&ipip_net_id, &ipip_net_ops);
844         if (err)
845                 xfrm4_tunnel_deregister(&ipip_handler, AF_INET);
846
847         return err;
848 }
849
850 static void __exit ipip_fini(void)
851 {
852         if (xfrm4_tunnel_deregister(&ipip_handler, AF_INET))
853                 printk(KERN_INFO "ipip close: can't deregister tunnel\n");
854
855         unregister_pernet_gen_device(ipip_net_id, &ipip_net_ops);
856 }
857
858 module_init(ipip_init);
859 module_exit(ipip_fini);
860 MODULE_LICENSE("GPL");