| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
| YOSHIFUJI Hideaki | e905a9e | 2007-02-09 23:24:47 +0900 | [diff] [blame] | 2 | *	Linux NET3:	IP/IP protocol decoder. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 | * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | 
| YOSHIFUJI Hideaki | e905a9e | 2007-02-09 23:24:47 +0900 | [diff] [blame] | 36 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | 
| YOSHIFUJI Hideaki | e905a9e | 2007-02-09 23:24:47 +0900 | [diff] [blame] | 43 |  | 
| Alan Cox | 113aa83 | 2008-10-13 19:01:08 -0700 | [diff] [blame] | 44 | -Alan Cox	(alan@lxorguk.ukuu.org.uk) 21 March 95 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | 
| YOSHIFUJI Hideaki | e905a9e | 2007-02-09 23:24:47 +0900 | [diff] [blame] | 53 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | 
| YOSHIFUJI Hideaki | e905a9e | 2007-02-09 23:24:47 +0900 | [diff] [blame] | 76 | find out how much more space you can allocate by calling | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |  | 
| YOSHIFUJI Hideaki | e905a9e | 2007-02-09 23:24:47 +0900 | [diff] [blame] | 93 |  | 
| Randy Dunlap | 4fc268d | 2006-01-11 12:17:47 -0800 | [diff] [blame] | 94 | #include <linux/capability.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 95 | #include <linux/module.h> | 
|  | 96 | #include <linux/types.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | #include <linux/kernel.h> | 
| Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 98 | #include <linux/slab.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 99 | #include <asm/uaccess.h> | 
|  | 100 | #include <linux/skbuff.h> | 
|  | 101 | #include <linux/netdevice.h> | 
|  | 102 | #include <linux/in.h> | 
|  | 103 | #include <linux/tcp.h> | 
|  | 104 | #include <linux/udp.h> | 
|  | 105 | #include <linux/if_arp.h> | 
|  | 106 | #include <linux/mroute.h> | 
|  | 107 | #include <linux/init.h> | 
|  | 108 | #include <linux/netfilter_ipv4.h> | 
| Kris Katterjohn | 46f25df | 2006-01-05 16:35:42 -0800 | [diff] [blame] | 109 | #include <linux/if_ether.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 110 |  | 
|  | 111 | #include <net/sock.h> | 
|  | 112 | #include <net/ip.h> | 
|  | 113 | #include <net/icmp.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | #include <net/ipip.h> | 
|  | 115 | #include <net/inet_ecn.h> | 
|  | 116 | #include <net/xfrm.h> | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 117 | #include <net/net_namespace.h> | 
|  | 118 | #include <net/netns/generic.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 |  | 
|  | 120 | #define HASH_SIZE  16 | 
| Al Viro | d5a0a1e | 2006-11-08 00:23:14 -0800 | [diff] [blame] | 121 | #define HASH(addr) (((__force u32)addr^((__force u32)addr>>4))&0xF) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 |  | 
| Eric Dumazet | f99189b | 2009-11-17 10:42:49 +0000 | [diff] [blame] | 123 | static int ipip_net_id __read_mostly; | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 124 | struct ipip_net { | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 125 | struct ip_tunnel __rcu *tunnels_r_l[HASH_SIZE]; | 
|  | 126 | struct ip_tunnel __rcu *tunnels_r[HASH_SIZE]; | 
|  | 127 | struct ip_tunnel __rcu *tunnels_l[HASH_SIZE]; | 
|  | 128 | struct ip_tunnel __rcu *tunnels_wc[1]; | 
|  | 129 | struct ip_tunnel __rcu **tunnels[4]; | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 130 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 131 | struct net_device *fb_tunnel_dev; | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 132 | }; | 
|  | 133 |  | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 134 | static int ipip_tunnel_init(struct net_device *dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 135 | static void ipip_tunnel_setup(struct net_device *dev); | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 136 | static void ipip_dev_free(struct net_device *dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 137 |  | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 138 | /* | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 139 | * Locking : hash tables are protected by RCU and RTNL | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 140 | */ | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 141 |  | 
|  | 142 | #define for_each_ip_tunnel_rcu(start) \ | 
|  | 143 | for (t = rcu_dereference(start); t; t = rcu_dereference(t->next)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 |  | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 145 | /* often modified stats are per cpu, other are shared (netdev->stats) */ | 
|  | 146 | struct pcpu_tstats { | 
|  | 147 | unsigned long	rx_packets; | 
|  | 148 | unsigned long	rx_bytes; | 
|  | 149 | unsigned long	tx_packets; | 
|  | 150 | unsigned long	tx_bytes; | 
| Eric Dumazet | 8ce120f | 2011-11-04 23:19:28 +0000 | [diff] [blame] | 151 | } __attribute__((aligned(4*sizeof(unsigned long)))); | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 152 |  | 
|  | 153 | static struct net_device_stats *ipip_get_stats(struct net_device *dev) | 
|  | 154 | { | 
|  | 155 | struct pcpu_tstats sum = { 0 }; | 
|  | 156 | int i; | 
|  | 157 |  | 
|  | 158 | for_each_possible_cpu(i) { | 
|  | 159 | const struct pcpu_tstats *tstats = per_cpu_ptr(dev->tstats, i); | 
|  | 160 |  | 
|  | 161 | sum.rx_packets += tstats->rx_packets; | 
|  | 162 | sum.rx_bytes   += tstats->rx_bytes; | 
|  | 163 | sum.tx_packets += tstats->tx_packets; | 
|  | 164 | sum.tx_bytes   += tstats->tx_bytes; | 
|  | 165 | } | 
|  | 166 | dev->stats.rx_packets = sum.rx_packets; | 
|  | 167 | dev->stats.rx_bytes   = sum.rx_bytes; | 
|  | 168 | dev->stats.tx_packets = sum.tx_packets; | 
|  | 169 | dev->stats.tx_bytes   = sum.tx_bytes; | 
|  | 170 | return &dev->stats; | 
|  | 171 | } | 
|  | 172 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 173 | static struct ip_tunnel * ipip_tunnel_lookup(struct net *net, | 
|  | 174 | __be32 remote, __be32 local) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 175 | { | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 176 | unsigned int h0 = HASH(remote); | 
|  | 177 | unsigned int h1 = HASH(local); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 178 | struct ip_tunnel *t; | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 179 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 180 |  | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 181 | for_each_ip_tunnel_rcu(ipn->tunnels_r_l[h0 ^ h1]) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 182 | if (local == t->parms.iph.saddr && | 
|  | 183 | remote == t->parms.iph.daddr && (t->dev->flags&IFF_UP)) | 
|  | 184 | return t; | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 185 |  | 
|  | 186 | for_each_ip_tunnel_rcu(ipn->tunnels_r[h0]) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 187 | if (remote == t->parms.iph.daddr && (t->dev->flags&IFF_UP)) | 
|  | 188 | return t; | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 189 |  | 
|  | 190 | for_each_ip_tunnel_rcu(ipn->tunnels_l[h1]) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 191 | if (local == t->parms.iph.saddr && (t->dev->flags&IFF_UP)) | 
|  | 192 | return t; | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 193 |  | 
|  | 194 | t = rcu_dereference(ipn->tunnels_wc[0]); | 
|  | 195 | if (t && (t->dev->flags&IFF_UP)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 196 | return t; | 
|  | 197 | return NULL; | 
|  | 198 | } | 
|  | 199 |  | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 200 | static struct ip_tunnel __rcu **__ipip_bucket(struct ipip_net *ipn, | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 201 | struct ip_tunnel_parm *parms) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 | { | 
| YOSHIFUJI Hideaki | 87d1a16 | 2007-04-24 20:44:47 +0900 | [diff] [blame] | 203 | __be32 remote = parms->iph.daddr; | 
|  | 204 | __be32 local = parms->iph.saddr; | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 205 | unsigned int h = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 206 | int prio = 0; | 
|  | 207 |  | 
|  | 208 | if (remote) { | 
|  | 209 | prio |= 2; | 
|  | 210 | h ^= HASH(remote); | 
|  | 211 | } | 
|  | 212 | if (local) { | 
|  | 213 | prio |= 1; | 
|  | 214 | h ^= HASH(local); | 
|  | 215 | } | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 216 | return &ipn->tunnels[prio][h]; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 217 | } | 
|  | 218 |  | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 219 | static inline struct ip_tunnel __rcu **ipip_bucket(struct ipip_net *ipn, | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 220 | struct ip_tunnel *t) | 
| YOSHIFUJI Hideaki | 87d1a16 | 2007-04-24 20:44:47 +0900 | [diff] [blame] | 221 | { | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 222 | return __ipip_bucket(ipn, &t->parms); | 
| YOSHIFUJI Hideaki | 87d1a16 | 2007-04-24 20:44:47 +0900 | [diff] [blame] | 223 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 224 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 225 | static void ipip_tunnel_unlink(struct ipip_net *ipn, struct ip_tunnel *t) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 226 | { | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 227 | struct ip_tunnel __rcu **tp; | 
|  | 228 | struct ip_tunnel *iter; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 229 |  | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 230 | for (tp = ipip_bucket(ipn, t); | 
|  | 231 | (iter = rtnl_dereference(*tp)) != NULL; | 
|  | 232 | tp = &iter->next) { | 
|  | 233 | if (t == iter) { | 
| Eric Dumazet | cf778b0 | 2012-01-12 04:41:32 +0000 | [diff] [blame] | 234 | rcu_assign_pointer(*tp, t->next); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 | break; | 
|  | 236 | } | 
|  | 237 | } | 
|  | 238 | } | 
|  | 239 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 240 | static void ipip_tunnel_link(struct ipip_net *ipn, struct ip_tunnel *t) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | { | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 242 | struct ip_tunnel __rcu **tp = ipip_bucket(ipn, t); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 243 |  | 
| Eric Dumazet | cf778b0 | 2012-01-12 04:41:32 +0000 | [diff] [blame] | 244 | rcu_assign_pointer(t->next, rtnl_dereference(*tp)); | 
|  | 245 | rcu_assign_pointer(*tp, t); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 246 | } | 
|  | 247 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 248 | static struct ip_tunnel * ipip_tunnel_locate(struct net *net, | 
|  | 249 | struct ip_tunnel_parm *parms, int create) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 250 | { | 
| Al Viro | d5a0a1e | 2006-11-08 00:23:14 -0800 | [diff] [blame] | 251 | __be32 remote = parms->iph.daddr; | 
|  | 252 | __be32 local = parms->iph.saddr; | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 253 | struct ip_tunnel *t, *nt; | 
|  | 254 | struct ip_tunnel __rcu **tp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 255 | struct net_device *dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 256 | char name[IFNAMSIZ]; | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 257 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 258 |  | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 259 | for (tp = __ipip_bucket(ipn, parms); | 
|  | 260 | (t = rtnl_dereference(*tp)) != NULL; | 
|  | 261 | tp = &t->next) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | if (local == t->parms.iph.saddr && remote == t->parms.iph.daddr) | 
|  | 263 | return t; | 
|  | 264 | } | 
|  | 265 | if (!create) | 
|  | 266 | return NULL; | 
|  | 267 |  | 
|  | 268 | if (parms->name[0]) | 
|  | 269 | strlcpy(name, parms->name, IFNAMSIZ); | 
| Pavel Emelyanov | 34cc7ba | 2008-02-23 20:19:20 -0800 | [diff] [blame] | 270 | else | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 271 | strcpy(name, "tunl%d"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 272 |  | 
|  | 273 | dev = alloc_netdev(sizeof(*t), name, ipip_tunnel_setup); | 
|  | 274 | if (dev == NULL) | 
|  | 275 | return NULL; | 
|  | 276 |  | 
| Pavel Emelyanov | 0a82640 | 2008-04-16 01:06:18 -0700 | [diff] [blame] | 277 | dev_net_set(dev, net); | 
|  | 278 |  | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 279 | nt = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 280 | nt->parms = *parms; | 
|  | 281 |  | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 282 | if (ipip_tunnel_init(dev) < 0) | 
|  | 283 | goto failed_free; | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 284 |  | 
| Pavel Emelyanov | b37d428 | 2008-02-26 23:51:04 -0800 | [diff] [blame] | 285 | if (register_netdevice(dev) < 0) | 
|  | 286 | goto failed_free; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 287 |  | 
| Ted Feng | 72b3601 | 2011-12-08 00:46:21 +0000 | [diff] [blame] | 288 | strcpy(nt->parms.name, dev->name); | 
|  | 289 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 290 | dev_hold(dev); | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 291 | ipip_tunnel_link(ipn, nt); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 292 | return nt; | 
|  | 293 |  | 
| Pavel Emelyanov | b37d428 | 2008-02-26 23:51:04 -0800 | [diff] [blame] | 294 | failed_free: | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 295 | ipip_dev_free(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 296 | return NULL; | 
|  | 297 | } | 
|  | 298 |  | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 299 | /* called with RTNL */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | static void ipip_tunnel_uninit(struct net_device *dev) | 
|  | 301 | { | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 302 | struct net *net = dev_net(dev); | 
|  | 303 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
|  | 304 |  | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 305 | if (dev == ipn->fb_tunnel_dev) | 
| Stephen Hemminger | a9b3cd7 | 2011-08-01 16:19:00 +0000 | [diff] [blame] | 306 | RCU_INIT_POINTER(ipn->tunnels_wc[0], NULL); | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 307 | else | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 308 | ipip_tunnel_unlink(ipn, netdev_priv(dev)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 309 | dev_put(dev); | 
|  | 310 | } | 
|  | 311 |  | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 312 | static int ipip_err(struct sk_buff *skb, u32 info) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 313 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 314 |  | 
| Rami Rosen | 071f92d | 2008-05-21 17:47:54 -0700 | [diff] [blame] | 315 | /* All the routers (except for Linux) return only | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | 8 bytes of packet payload. It means, that precise relaying of | 
|  | 317 | ICMP in the real Internet is absolutely infeasible. | 
|  | 318 | */ | 
| Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 319 | const struct iphdr *iph = (const struct iphdr *)skb->data; | 
| Arnaldo Carvalho de Melo | 88c7664 | 2007-03-13 14:43:18 -0300 | [diff] [blame] | 320 | const int type = icmp_hdr(skb)->type; | 
|  | 321 | const int code = icmp_hdr(skb)->code; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 322 | struct ip_tunnel *t; | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 323 | int err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 324 |  | 
|  | 325 | switch (type) { | 
|  | 326 | default: | 
|  | 327 | case ICMP_PARAMETERPROB: | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 328 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 329 |  | 
|  | 330 | case ICMP_DEST_UNREACH: | 
|  | 331 | switch (code) { | 
|  | 332 | case ICMP_SR_FAILED: | 
|  | 333 | case ICMP_PORT_UNREACH: | 
|  | 334 | /* Impossible event. */ | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 335 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 336 | case ICMP_FRAG_NEEDED: | 
|  | 337 | /* Soft state for pmtu is maintained by IP core. */ | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 338 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 339 | default: | 
|  | 340 | /* All others are translated to HOST_UNREACH. | 
|  | 341 | rfc2003 contains "deep thoughts" about NET_UNREACH, | 
|  | 342 | I believe they are just ether pollution. --ANK | 
|  | 343 | */ | 
|  | 344 | break; | 
|  | 345 | } | 
|  | 346 | break; | 
|  | 347 | case ICMP_TIME_EXCEEDED: | 
|  | 348 | if (code != ICMP_EXC_TTL) | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 349 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 350 | break; | 
|  | 351 | } | 
|  | 352 |  | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 353 | err = -ENOENT; | 
|  | 354 |  | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 355 | rcu_read_lock(); | 
| Pavel Emelyanov | cec3ffa | 2008-04-16 01:05:03 -0700 | [diff] [blame] | 356 | t = ipip_tunnel_lookup(dev_net(skb->dev), iph->daddr, iph->saddr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 357 | if (t == NULL || t->parms.iph.daddr == 0) | 
|  | 358 | goto out; | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 359 |  | 
|  | 360 | err = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 361 | if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED) | 
|  | 362 | goto out; | 
|  | 363 |  | 
| Wei Yongjun | 26d94b4 | 2009-02-24 23:36:47 -0800 | [diff] [blame] | 364 | if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 365 | t->err_count++; | 
|  | 366 | else | 
|  | 367 | t->err_count = 1; | 
|  | 368 | t->err_time = jiffies; | 
|  | 369 | out: | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 370 | rcu_read_unlock(); | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 371 | return err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 372 | } | 
|  | 373 |  | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 374 | static inline void ipip_ecn_decapsulate(const struct iphdr *outer_iph, | 
|  | 375 | struct sk_buff *skb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 376 | { | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 377 | struct iphdr *inner_iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 378 |  | 
|  | 379 | if (INET_ECN_is_ce(outer_iph->tos)) | 
|  | 380 | IP_ECN_set_ce(inner_iph); | 
|  | 381 | } | 
|  | 382 |  | 
|  | 383 | static int ipip_rcv(struct sk_buff *skb) | 
|  | 384 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 385 | struct ip_tunnel *tunnel; | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 386 | const struct iphdr *iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 387 |  | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 388 | rcu_read_lock(); | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 389 | tunnel = ipip_tunnel_lookup(dev_net(skb->dev), iph->saddr, iph->daddr); | 
|  | 390 | if (tunnel != NULL) { | 
|  | 391 | struct pcpu_tstats *tstats; | 
|  | 392 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 393 | if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb)) { | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 394 | rcu_read_unlock(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 395 | kfree_skb(skb); | 
|  | 396 | return 0; | 
|  | 397 | } | 
|  | 398 |  | 
|  | 399 | secpath_reset(skb); | 
|  | 400 |  | 
| Arnaldo Carvalho de Melo | b0e380b | 2007-04-10 21:21:55 -0700 | [diff] [blame] | 401 | skb->mac_header = skb->network_header; | 
| Arnaldo Carvalho de Melo | c1d2bbe | 2007-04-10 20:45:18 -0700 | [diff] [blame] | 402 | skb_reset_network_header(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 403 | skb->protocol = htons(ETH_P_IP); | 
|  | 404 | skb->pkt_type = PACKET_HOST; | 
|  | 405 |  | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 406 | tstats = this_cpu_ptr(tunnel->dev->tstats); | 
|  | 407 | tstats->rx_packets++; | 
|  | 408 | tstats->rx_bytes += skb->len; | 
|  | 409 |  | 
|  | 410 | __skb_tunnel_rx(skb, tunnel->dev); | 
| Eric Dumazet | d19d56d | 2010-05-17 22:36:55 -0700 | [diff] [blame] | 411 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 412 | ipip_ecn_decapsulate(iph, skb); | 
| Eric Dumazet | 8990f46 | 2010-09-20 00:12:11 +0000 | [diff] [blame] | 413 |  | 
| Eric Dumazet | caf586e | 2010-09-30 21:06:55 +0000 | [diff] [blame] | 414 | netif_rx(skb); | 
| Eric Dumazet | 8990f46 | 2010-09-20 00:12:11 +0000 | [diff] [blame] | 415 |  | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 416 | rcu_read_unlock(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 417 | return 0; | 
|  | 418 | } | 
| Eric Dumazet | 8f95dd6 | 2009-10-23 05:42:02 +0000 | [diff] [blame] | 419 | rcu_read_unlock(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 420 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 421 | return -1; | 
|  | 422 | } | 
|  | 423 |  | 
|  | 424 | /* | 
|  | 425 | *	This function assumes it is being called from dev_queue_xmit() | 
|  | 426 | *	and that skb is filled properly by that function. | 
|  | 427 | */ | 
|  | 428 |  | 
| Stephen Hemminger | 6fef4c0 | 2009-08-31 19:50:41 +0000 | [diff] [blame] | 429 | static netdev_tx_t ipip_tunnel_xmit(struct sk_buff *skb, struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 430 | { | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 431 | struct ip_tunnel *tunnel = netdev_priv(dev); | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 432 | struct pcpu_tstats *tstats; | 
| Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 433 | const struct iphdr  *tiph = &tunnel->parms.iph; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 434 | u8     tos = tunnel->parms.iph.tos; | 
| Al Viro | d5a0a1e | 2006-11-08 00:23:14 -0800 | [diff] [blame] | 435 | __be16 df = tiph->frag_off; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 436 | struct rtable *rt;     			/* Route to the other host */ | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 437 | struct net_device *tdev;		/* Device to other host */ | 
| Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 438 | const struct iphdr  *old_iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 439 | struct iphdr  *iph;			/* Our new IP header */ | 
| Chuck Lever | c2636b4 | 2007-10-23 21:07:32 -0700 | [diff] [blame] | 440 | unsigned int max_headroom;		/* The extra header space needed */ | 
| Al Viro | d5a0a1e | 2006-11-08 00:23:14 -0800 | [diff] [blame] | 441 | __be32 dst = tiph->daddr; | 
| David S. Miller | 31e4543 | 2011-05-03 20:25:42 -0700 | [diff] [blame] | 442 | struct flowi4 fl4; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 443 | int    mtu; | 
|  | 444 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 445 | if (skb->protocol != htons(ETH_P_IP)) | 
|  | 446 | goto tx_error; | 
|  | 447 |  | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 448 | if (tos & 1) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 449 | tos = old_iph->tos; | 
|  | 450 |  | 
| Eric Dumazet | 3c353df | 2013-05-24 05:49:58 +0000 | [diff] [blame] | 451 | memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 452 | if (!dst) { | 
|  | 453 | /* NBMA tunnel */ | 
| Eric Dumazet | 511c3f9 | 2009-06-02 05:14:27 +0000 | [diff] [blame] | 454 | if ((rt = skb_rtable(skb)) == NULL) { | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 455 | dev->stats.tx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 | goto tx_error; | 
|  | 457 | } | 
| David S. Miller | 658c8d9 | 2012-01-24 18:18:05 -0500 | [diff] [blame] | 458 | dst = rt->rt_gateway; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 459 | } | 
|  | 460 |  | 
| David S. Miller | 31e4543 | 2011-05-03 20:25:42 -0700 | [diff] [blame] | 461 | rt = ip_route_output_ports(dev_net(dev), &fl4, NULL, | 
| David S. Miller | 78fbfd8 | 2011-03-12 00:00:52 -0500 | [diff] [blame] | 462 | dst, tiph->saddr, | 
|  | 463 | 0, 0, | 
|  | 464 | IPPROTO_IPIP, RT_TOS(tos), | 
|  | 465 | tunnel->parms.link); | 
|  | 466 | if (IS_ERR(rt)) { | 
|  | 467 | dev->stats.tx_carrier_errors++; | 
|  | 468 | goto tx_error_icmp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 469 | } | 
| Changli Gao | d8d1f30 | 2010-06-10 23:31:35 -0700 | [diff] [blame] | 470 | tdev = rt->dst.dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 471 |  | 
|  | 472 | if (tdev == dev) { | 
|  | 473 | ip_rt_put(rt); | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 474 | dev->stats.collisions++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 475 | goto tx_error; | 
|  | 476 | } | 
|  | 477 |  | 
| Herbert Xu | 23ca0c9 | 2009-11-06 10:37:41 +0000 | [diff] [blame] | 478 | df |= old_iph->frag_off & htons(IP_DF); | 
|  | 479 |  | 
|  | 480 | if (df) { | 
| Changli Gao | d8d1f30 | 2010-06-10 23:31:35 -0700 | [diff] [blame] | 481 | mtu = dst_mtu(&rt->dst) - sizeof(struct iphdr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 482 |  | 
| Herbert Xu | 23ca0c9 | 2009-11-06 10:37:41 +0000 | [diff] [blame] | 483 | if (mtu < 68) { | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 484 | dev->stats.collisions++; | 
| Herbert Xu | 23ca0c9 | 2009-11-06 10:37:41 +0000 | [diff] [blame] | 485 | ip_rt_put(rt); | 
|  | 486 | goto tx_error; | 
|  | 487 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 488 |  | 
| Herbert Xu | 23ca0c9 | 2009-11-06 10:37:41 +0000 | [diff] [blame] | 489 | if (skb_dst(skb)) | 
|  | 490 | skb_dst(skb)->ops->update_pmtu(skb_dst(skb), mtu); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 491 |  | 
| Herbert Xu | 23ca0c9 | 2009-11-06 10:37:41 +0000 | [diff] [blame] | 492 | if ((old_iph->frag_off & htons(IP_DF)) && | 
|  | 493 | mtu < ntohs(old_iph->tot_len)) { | 
|  | 494 | icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, | 
|  | 495 | htonl(mtu)); | 
|  | 496 | ip_rt_put(rt); | 
|  | 497 | goto tx_error; | 
|  | 498 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 499 | } | 
|  | 500 |  | 
|  | 501 | if (tunnel->err_count > 0) { | 
| Wei Yongjun | 26d94b4 | 2009-02-24 23:36:47 -0800 | [diff] [blame] | 502 | if (time_before(jiffies, | 
|  | 503 | tunnel->err_time + IPTUNNEL_ERR_TIMEO)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 504 | tunnel->err_count--; | 
|  | 505 | dst_link_failure(skb); | 
|  | 506 | } else | 
|  | 507 | tunnel->err_count = 0; | 
|  | 508 | } | 
|  | 509 |  | 
|  | 510 | /* | 
|  | 511 | * Okay, now see if we can stuff it in the buffer as-is. | 
|  | 512 | */ | 
|  | 513 | max_headroom = (LL_RESERVED_SPACE(tdev)+sizeof(struct iphdr)); | 
|  | 514 |  | 
| Patrick McHardy | cfbba49 | 2007-07-09 15:33:40 -0700 | [diff] [blame] | 515 | if (skb_headroom(skb) < max_headroom || skb_shared(skb) || | 
|  | 516 | (skb_cloned(skb) && !skb_clone_writable(skb, 0))) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 517 | struct sk_buff *new_skb = skb_realloc_headroom(skb, max_headroom); | 
|  | 518 | if (!new_skb) { | 
|  | 519 | ip_rt_put(rt); | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 520 | dev->stats.tx_dropped++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 521 | dev_kfree_skb(skb); | 
| Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 522 | return NETDEV_TX_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 523 | } | 
|  | 524 | if (skb->sk) | 
|  | 525 | skb_set_owner_w(new_skb, skb->sk); | 
|  | 526 | dev_kfree_skb(skb); | 
|  | 527 | skb = new_skb; | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 528 | old_iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 529 | } | 
|  | 530 |  | 
| Arnaldo Carvalho de Melo | b0e380b | 2007-04-10 21:21:55 -0700 | [diff] [blame] | 531 | skb->transport_header = skb->network_header; | 
| Arnaldo Carvalho de Melo | e2d1bca | 2007-04-10 20:46:21 -0700 | [diff] [blame] | 532 | skb_push(skb, sizeof(struct iphdr)); | 
|  | 533 | skb_reset_network_header(skb); | 
| Patrick McHardy | 48d5cad | 2006-02-15 15:10:22 -0800 | [diff] [blame] | 534 | IPCB(skb)->flags &= ~(IPSKB_XFRM_TUNNEL_SIZE | IPSKB_XFRM_TRANSFORMED | | 
|  | 535 | IPSKB_REROUTED); | 
| Eric Dumazet | adf3090 | 2009-06-02 05:19:30 +0000 | [diff] [blame] | 536 | skb_dst_drop(skb); | 
| Changli Gao | d8d1f30 | 2010-06-10 23:31:35 -0700 | [diff] [blame] | 537 | skb_dst_set(skb, &rt->dst); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 538 |  | 
|  | 539 | /* | 
|  | 540 | *	Push down and install the IPIP header. | 
|  | 541 | */ | 
|  | 542 |  | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 543 | iph 			=	ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 544 | iph->version		=	4; | 
|  | 545 | iph->ihl		=	sizeof(struct iphdr)>>2; | 
|  | 546 | iph->frag_off		=	df; | 
|  | 547 | iph->protocol		=	IPPROTO_IPIP; | 
|  | 548 | iph->tos		=	INET_ECN_encapsulate(tos, old_iph->tos); | 
| David S. Miller | 69458cb | 2011-05-04 11:10:28 -0700 | [diff] [blame] | 549 | iph->daddr		=	fl4.daddr; | 
|  | 550 | iph->saddr		=	fl4.saddr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 551 |  | 
|  | 552 | if ((iph->ttl = tiph->ttl) == 0) | 
|  | 553 | iph->ttl	=	old_iph->ttl; | 
|  | 554 |  | 
|  | 555 | nf_reset(skb); | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 556 | tstats = this_cpu_ptr(dev->tstats); | 
|  | 557 | __IPTUNNEL_XMIT(tstats, &dev->stats); | 
| Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 558 | return NETDEV_TX_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 559 |  | 
|  | 560 | tx_error_icmp: | 
|  | 561 | dst_link_failure(skb); | 
|  | 562 | tx_error: | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 563 | dev->stats.tx_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 564 | dev_kfree_skb(skb); | 
| Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 565 | return NETDEV_TX_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 566 | } | 
|  | 567 |  | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 568 | static void ipip_tunnel_bind_dev(struct net_device *dev) | 
|  | 569 | { | 
|  | 570 | struct net_device *tdev = NULL; | 
|  | 571 | struct ip_tunnel *tunnel; | 
| Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 572 | const struct iphdr *iph; | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 573 |  | 
|  | 574 | tunnel = netdev_priv(dev); | 
|  | 575 | iph = &tunnel->parms.iph; | 
|  | 576 |  | 
|  | 577 | if (iph->daddr) { | 
| David S. Miller | 31e4543 | 2011-05-03 20:25:42 -0700 | [diff] [blame] | 578 | struct rtable *rt; | 
|  | 579 | struct flowi4 fl4; | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 580 |  | 
| David S. Miller | 31e4543 | 2011-05-03 20:25:42 -0700 | [diff] [blame] | 581 | rt = ip_route_output_ports(dev_net(dev), &fl4, NULL, | 
|  | 582 | iph->daddr, iph->saddr, | 
|  | 583 | 0, 0, | 
|  | 584 | IPPROTO_IPIP, | 
|  | 585 | RT_TOS(iph->tos), | 
|  | 586 | tunnel->parms.link); | 
| David S. Miller | b23dd4f | 2011-03-02 14:31:35 -0800 | [diff] [blame] | 587 | if (!IS_ERR(rt)) { | 
| Changli Gao | d8d1f30 | 2010-06-10 23:31:35 -0700 | [diff] [blame] | 588 | tdev = rt->dst.dev; | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 589 | ip_rt_put(rt); | 
|  | 590 | } | 
|  | 591 | dev->flags |= IFF_POINTOPOINT; | 
|  | 592 | } | 
|  | 593 |  | 
|  | 594 | if (!tdev && tunnel->parms.link) | 
| Pavel Emelyanov | b99f015 | 2008-04-16 01:05:57 -0700 | [diff] [blame] | 595 | tdev = __dev_get_by_index(dev_net(dev), tunnel->parms.link); | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 596 |  | 
|  | 597 | if (tdev) { | 
|  | 598 | dev->hard_header_len = tdev->hard_header_len + sizeof(struct iphdr); | 
|  | 599 | dev->mtu = tdev->mtu - sizeof(struct iphdr); | 
|  | 600 | } | 
|  | 601 | dev->iflink = tunnel->parms.link; | 
|  | 602 | } | 
|  | 603 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 604 | static int | 
|  | 605 | ipip_tunnel_ioctl (struct net_device *dev, struct ifreq *ifr, int cmd) | 
|  | 606 | { | 
|  | 607 | int err = 0; | 
|  | 608 | struct ip_tunnel_parm p; | 
|  | 609 | struct ip_tunnel *t; | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 610 | struct net *net = dev_net(dev); | 
|  | 611 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 612 |  | 
|  | 613 | switch (cmd) { | 
|  | 614 | case SIOCGETTUNNEL: | 
|  | 615 | t = NULL; | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 616 | if (dev == ipn->fb_tunnel_dev) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 617 | if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) { | 
|  | 618 | err = -EFAULT; | 
|  | 619 | break; | 
|  | 620 | } | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 621 | t = ipip_tunnel_locate(net, &p, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 622 | } | 
|  | 623 | if (t == NULL) | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 624 | t = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 625 | memcpy(&p, &t->parms, sizeof(p)); | 
|  | 626 | if (copy_to_user(ifr->ifr_ifru.ifru_data, &p, sizeof(p))) | 
|  | 627 | err = -EFAULT; | 
|  | 628 | break; | 
|  | 629 |  | 
|  | 630 | case SIOCADDTUNNEL: | 
|  | 631 | case SIOCCHGTUNNEL: | 
|  | 632 | err = -EPERM; | 
|  | 633 | if (!capable(CAP_NET_ADMIN)) | 
|  | 634 | goto done; | 
|  | 635 |  | 
|  | 636 | err = -EFAULT; | 
|  | 637 | if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) | 
|  | 638 | goto done; | 
|  | 639 |  | 
|  | 640 | err = -EINVAL; | 
|  | 641 | if (p.iph.version != 4 || p.iph.protocol != IPPROTO_IPIP || | 
|  | 642 | p.iph.ihl != 5 || (p.iph.frag_off&htons(~IP_DF))) | 
|  | 643 | goto done; | 
|  | 644 | if (p.iph.ttl) | 
|  | 645 | p.iph.frag_off |= htons(IP_DF); | 
|  | 646 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 647 | t = ipip_tunnel_locate(net, &p, cmd == SIOCADDTUNNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 648 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 649 | if (dev != ipn->fb_tunnel_dev && cmd == SIOCCHGTUNNEL) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 650 | if (t != NULL) { | 
|  | 651 | if (t->dev != dev) { | 
|  | 652 | err = -EEXIST; | 
|  | 653 | break; | 
|  | 654 | } | 
|  | 655 | } else { | 
|  | 656 | if (((dev->flags&IFF_POINTOPOINT) && !p.iph.daddr) || | 
|  | 657 | (!(dev->flags&IFF_POINTOPOINT) && p.iph.daddr)) { | 
|  | 658 | err = -EINVAL; | 
|  | 659 | break; | 
|  | 660 | } | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 661 | t = netdev_priv(dev); | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 662 | ipip_tunnel_unlink(ipn, t); | 
| Pavel Emelyanov | 74b0b85 | 2010-10-27 05:43:53 +0000 | [diff] [blame] | 663 | synchronize_net(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 664 | t->parms.iph.saddr = p.iph.saddr; | 
|  | 665 | t->parms.iph.daddr = p.iph.daddr; | 
|  | 666 | memcpy(dev->dev_addr, &p.iph.saddr, 4); | 
|  | 667 | memcpy(dev->broadcast, &p.iph.daddr, 4); | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 668 | ipip_tunnel_link(ipn, t); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 669 | netdev_state_change(dev); | 
|  | 670 | } | 
|  | 671 | } | 
|  | 672 |  | 
|  | 673 | if (t) { | 
|  | 674 | err = 0; | 
|  | 675 | if (cmd == SIOCCHGTUNNEL) { | 
|  | 676 | t->parms.iph.ttl = p.iph.ttl; | 
|  | 677 | t->parms.iph.tos = p.iph.tos; | 
|  | 678 | t->parms.iph.frag_off = p.iph.frag_off; | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 679 | if (t->parms.link != p.link) { | 
|  | 680 | t->parms.link = p.link; | 
|  | 681 | ipip_tunnel_bind_dev(dev); | 
|  | 682 | netdev_state_change(dev); | 
|  | 683 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 684 | } | 
|  | 685 | if (copy_to_user(ifr->ifr_ifru.ifru_data, &t->parms, sizeof(p))) | 
|  | 686 | err = -EFAULT; | 
|  | 687 | } else | 
|  | 688 | err = (cmd == SIOCADDTUNNEL ? -ENOBUFS : -ENOENT); | 
|  | 689 | break; | 
|  | 690 |  | 
|  | 691 | case SIOCDELTUNNEL: | 
|  | 692 | err = -EPERM; | 
|  | 693 | if (!capable(CAP_NET_ADMIN)) | 
|  | 694 | goto done; | 
|  | 695 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 696 | if (dev == ipn->fb_tunnel_dev) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 697 | err = -EFAULT; | 
|  | 698 | if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) | 
|  | 699 | goto done; | 
|  | 700 | err = -ENOENT; | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 701 | if ((t = ipip_tunnel_locate(net, &p, 0)) == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 702 | goto done; | 
|  | 703 | err = -EPERM; | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 704 | if (t->dev == ipn->fb_tunnel_dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 705 | goto done; | 
|  | 706 | dev = t->dev; | 
|  | 707 | } | 
| Stephen Hemminger | 22f8cde | 2007-02-07 00:09:58 -0800 | [diff] [blame] | 708 | unregister_netdevice(dev); | 
|  | 709 | err = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 710 | break; | 
|  | 711 |  | 
|  | 712 | default: | 
|  | 713 | err = -EINVAL; | 
|  | 714 | } | 
|  | 715 |  | 
|  | 716 | done: | 
|  | 717 | return err; | 
|  | 718 | } | 
|  | 719 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 720 | static int ipip_tunnel_change_mtu(struct net_device *dev, int new_mtu) | 
|  | 721 | { | 
|  | 722 | if (new_mtu < 68 || new_mtu > 0xFFF8 - sizeof(struct iphdr)) | 
|  | 723 | return -EINVAL; | 
|  | 724 | dev->mtu = new_mtu; | 
|  | 725 | return 0; | 
|  | 726 | } | 
|  | 727 |  | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 728 | static const struct net_device_ops ipip_netdev_ops = { | 
|  | 729 | .ndo_uninit	= ipip_tunnel_uninit, | 
|  | 730 | .ndo_start_xmit	= ipip_tunnel_xmit, | 
|  | 731 | .ndo_do_ioctl	= ipip_tunnel_ioctl, | 
|  | 732 | .ndo_change_mtu	= ipip_tunnel_change_mtu, | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 733 | .ndo_get_stats  = ipip_get_stats, | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 734 | }; | 
|  | 735 |  | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 736 | static void ipip_dev_free(struct net_device *dev) | 
|  | 737 | { | 
|  | 738 | free_percpu(dev->tstats); | 
|  | 739 | free_netdev(dev); | 
|  | 740 | } | 
|  | 741 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 742 | static void ipip_tunnel_setup(struct net_device *dev) | 
|  | 743 | { | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 744 | dev->netdev_ops		= &ipip_netdev_ops; | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 745 | dev->destructor		= ipip_dev_free; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 746 |  | 
|  | 747 | dev->type		= ARPHRD_TUNNEL; | 
|  | 748 | dev->hard_header_len 	= LL_MAX_HEADER + sizeof(struct iphdr); | 
| Kris Katterjohn | 46f25df | 2006-01-05 16:35:42 -0800 | [diff] [blame] | 749 | dev->mtu		= ETH_DATA_LEN - sizeof(struct iphdr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 750 | dev->flags		= IFF_NOARP; | 
|  | 751 | dev->iflink		= 0; | 
|  | 752 | dev->addr_len		= 4; | 
| Pavel Emelyanov | 0a82640 | 2008-04-16 01:06:18 -0700 | [diff] [blame] | 753 | dev->features		|= NETIF_F_NETNS_LOCAL; | 
| Eric Dumazet | 153f094 | 2010-09-28 00:17:17 +0000 | [diff] [blame] | 754 | dev->features		|= NETIF_F_LLTX; | 
| Eric Dumazet | 28e7221 | 2009-05-28 10:44:30 +0000 | [diff] [blame] | 755 | dev->priv_flags		&= ~IFF_XMIT_DST_RELEASE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 756 | } | 
|  | 757 |  | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 758 | static int ipip_tunnel_init(struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 759 | { | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 760 | struct ip_tunnel *tunnel = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 761 |  | 
|  | 762 | tunnel->dev = dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 763 |  | 
|  | 764 | memcpy(dev->dev_addr, &tunnel->parms.iph.saddr, 4); | 
|  | 765 | memcpy(dev->broadcast, &tunnel->parms.iph.daddr, 4); | 
|  | 766 |  | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 767 | ipip_tunnel_bind_dev(dev); | 
| Eric Dumazet | 3c97af9 | 2010-09-27 00:35:50 +0000 | [diff] [blame] | 768 |  | 
|  | 769 | dev->tstats = alloc_percpu(struct pcpu_tstats); | 
|  | 770 | if (!dev->tstats) | 
|  | 771 | return -ENOMEM; | 
|  | 772 |  | 
|  | 773 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 774 | } | 
|  | 775 |  | 
| Eric Dumazet | fada563 | 2010-09-27 23:56:46 +0000 | [diff] [blame] | 776 | static int __net_init ipip_fb_tunnel_init(struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 777 | { | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 778 | struct ip_tunnel *tunnel = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 779 | struct iphdr *iph = &tunnel->parms.iph; | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 780 | struct ipip_net *ipn = net_generic(dev_net(dev), ipip_net_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 781 |  | 
|  | 782 | tunnel->dev = dev; | 
|  | 783 | strcpy(tunnel->parms.name, dev->name); | 
|  | 784 |  | 
|  | 785 | iph->version		= 4; | 
|  | 786 | iph->protocol		= IPPROTO_IPIP; | 
|  | 787 | iph->ihl		= 5; | 
|  | 788 |  | 
| Eric Dumazet | fada563 | 2010-09-27 23:56:46 +0000 | [diff] [blame] | 789 | dev->tstats = alloc_percpu(struct pcpu_tstats); | 
|  | 790 | if (!dev->tstats) | 
|  | 791 | return -ENOMEM; | 
|  | 792 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 793 | dev_hold(dev); | 
| Eric Dumazet | cf778b0 | 2012-01-12 04:41:32 +0000 | [diff] [blame] | 794 | rcu_assign_pointer(ipn->tunnels_wc[0], tunnel); | 
| Eric Dumazet | fada563 | 2010-09-27 23:56:46 +0000 | [diff] [blame] | 795 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 796 | } | 
|  | 797 |  | 
| Eric Dumazet | 6dcd814 | 2010-08-30 07:04:14 +0000 | [diff] [blame] | 798 | static struct xfrm_tunnel ipip_handler __read_mostly = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 799 | .handler	=	ipip_rcv, | 
|  | 800 | .err_handler	=	ipip_err, | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 801 | .priority	=	1, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 802 | }; | 
|  | 803 |  | 
| Stephen Hemminger | 5747a1a | 2009-02-22 00:02:08 -0800 | [diff] [blame] | 804 | static const char banner[] __initconst = | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 805 | KERN_INFO "IPv4 over IPv4 tunneling driver\n"; | 
|  | 806 |  | 
| Eric Dumazet | 0694c4c | 2009-10-27 07:06:59 +0000 | [diff] [blame] | 807 | static void ipip_destroy_tunnels(struct ipip_net *ipn, struct list_head *head) | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 808 | { | 
|  | 809 | int prio; | 
|  | 810 |  | 
|  | 811 | for (prio = 1; prio < 4; prio++) { | 
|  | 812 | int h; | 
|  | 813 | for (h = 0; h < HASH_SIZE; h++) { | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 814 | struct ip_tunnel *t; | 
| Eric Dumazet | 0694c4c | 2009-10-27 07:06:59 +0000 | [diff] [blame] | 815 |  | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 816 | t = rtnl_dereference(ipn->tunnels[prio][h]); | 
| Eric Dumazet | 0694c4c | 2009-10-27 07:06:59 +0000 | [diff] [blame] | 817 | while (t != NULL) { | 
|  | 818 | unregister_netdevice_queue(t->dev, head); | 
| Eric Dumazet | b7285b7 | 2010-09-15 11:07:24 +0000 | [diff] [blame] | 819 | t = rtnl_dereference(t->next); | 
| Eric Dumazet | 0694c4c | 2009-10-27 07:06:59 +0000 | [diff] [blame] | 820 | } | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 821 | } | 
|  | 822 | } | 
|  | 823 | } | 
|  | 824 |  | 
| Alexey Dobriyan | 2c8c1e7 | 2010-01-17 03:35:32 +0000 | [diff] [blame] | 825 | static int __net_init ipip_init_net(struct net *net) | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 826 | { | 
| Eric W. Biederman | 86de8a6 | 2009-11-29 15:46:14 +0000 | [diff] [blame] | 827 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
| Ted Feng | 72b3601 | 2011-12-08 00:46:21 +0000 | [diff] [blame] | 828 | struct ip_tunnel *t; | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 829 | int err; | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 830 |  | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 831 | ipn->tunnels[0] = ipn->tunnels_wc; | 
|  | 832 | ipn->tunnels[1] = ipn->tunnels_l; | 
|  | 833 | ipn->tunnels[2] = ipn->tunnels_r; | 
|  | 834 | ipn->tunnels[3] = ipn->tunnels_r_l; | 
|  | 835 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 836 | ipn->fb_tunnel_dev = alloc_netdev(sizeof(struct ip_tunnel), | 
|  | 837 | "tunl0", | 
|  | 838 | ipip_tunnel_setup); | 
|  | 839 | if (!ipn->fb_tunnel_dev) { | 
|  | 840 | err = -ENOMEM; | 
|  | 841 | goto err_alloc_dev; | 
|  | 842 | } | 
| Alexey Dobriyan | be77e59 | 2008-11-23 17:26:26 -0800 | [diff] [blame] | 843 | dev_net_set(ipn->fb_tunnel_dev, net); | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 844 |  | 
| Eric Dumazet | fada563 | 2010-09-27 23:56:46 +0000 | [diff] [blame] | 845 | err = ipip_fb_tunnel_init(ipn->fb_tunnel_dev); | 
|  | 846 | if (err) | 
|  | 847 | goto err_reg_dev; | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 848 |  | 
|  | 849 | if ((err = register_netdev(ipn->fb_tunnel_dev))) | 
|  | 850 | goto err_reg_dev; | 
|  | 851 |  | 
| Ted Feng | 72b3601 | 2011-12-08 00:46:21 +0000 | [diff] [blame] | 852 | t = netdev_priv(ipn->fb_tunnel_dev); | 
|  | 853 |  | 
|  | 854 | strcpy(t->parms.name, ipn->fb_tunnel_dev->name); | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 855 | return 0; | 
|  | 856 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 857 | err_reg_dev: | 
| Eric Dumazet | fada563 | 2010-09-27 23:56:46 +0000 | [diff] [blame] | 858 | ipip_dev_free(ipn->fb_tunnel_dev); | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 859 | err_alloc_dev: | 
|  | 860 | /* nothing */ | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 861 | return err; | 
|  | 862 | } | 
|  | 863 |  | 
| Alexey Dobriyan | 2c8c1e7 | 2010-01-17 03:35:32 +0000 | [diff] [blame] | 864 | static void __net_exit ipip_exit_net(struct net *net) | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 865 | { | 
| Eric W. Biederman | 86de8a6 | 2009-11-29 15:46:14 +0000 | [diff] [blame] | 866 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
| Eric Dumazet | 0694c4c | 2009-10-27 07:06:59 +0000 | [diff] [blame] | 867 | LIST_HEAD(list); | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 868 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 869 | rtnl_lock(); | 
| Eric Dumazet | 0694c4c | 2009-10-27 07:06:59 +0000 | [diff] [blame] | 870 | ipip_destroy_tunnels(ipn, &list); | 
|  | 871 | unregister_netdevice_queue(ipn->fb_tunnel_dev, &list); | 
|  | 872 | unregister_netdevice_many(&list); | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 873 | rtnl_unlock(); | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 874 | } | 
|  | 875 |  | 
|  | 876 | static struct pernet_operations ipip_net_ops = { | 
|  | 877 | .init = ipip_init_net, | 
|  | 878 | .exit = ipip_exit_net, | 
| Eric W. Biederman | 86de8a6 | 2009-11-29 15:46:14 +0000 | [diff] [blame] | 879 | .id   = &ipip_net_id, | 
|  | 880 | .size = sizeof(struct ipip_net), | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 881 | }; | 
|  | 882 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 883 | static int __init ipip_init(void) | 
|  | 884 | { | 
|  | 885 | int err; | 
|  | 886 |  | 
|  | 887 | printk(banner); | 
|  | 888 |  | 
| Eric W. Biederman | 86de8a6 | 2009-11-29 15:46:14 +0000 | [diff] [blame] | 889 | err = register_pernet_device(&ipip_net_ops); | 
| Alexey Dobriyan | d5aa407 | 2010-02-16 09:05:04 +0000 | [diff] [blame] | 890 | if (err < 0) | 
|  | 891 | return err; | 
|  | 892 | err = xfrm4_tunnel_register(&ipip_handler, AF_INET); | 
|  | 893 | if (err < 0) { | 
|  | 894 | unregister_pernet_device(&ipip_net_ops); | 
| Joe Perches | 058bd4d | 2012-03-11 18:36:11 +0000 | [diff] [blame] | 895 | pr_info("%s: can't register tunnel\n", __func__); | 
| Alexey Dobriyan | d5aa407 | 2010-02-16 09:05:04 +0000 | [diff] [blame] | 896 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 897 | return err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 898 | } | 
|  | 899 |  | 
|  | 900 | static void __exit ipip_fini(void) | 
|  | 901 | { | 
| Kazunori MIYAZAWA | c0d5640 | 2007-02-13 12:54:47 -0800 | [diff] [blame] | 902 | if (xfrm4_tunnel_deregister(&ipip_handler, AF_INET)) | 
| Joe Perches | 058bd4d | 2012-03-11 18:36:11 +0000 | [diff] [blame] | 903 | pr_info("%s: can't deregister tunnel\n", __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 904 |  | 
| Eric W. Biederman | 86de8a6 | 2009-11-29 15:46:14 +0000 | [diff] [blame] | 905 | unregister_pernet_device(&ipip_net_ops); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 906 | } | 
|  | 907 |  | 
|  | 908 | module_init(ipip_init); | 
|  | 909 | module_exit(ipip_fini); | 
|  | 910 | MODULE_LICENSE("GPL"); | 
| Vasiliy Kulikov | 8909c9a | 2011-03-02 00:33:13 +0300 | [diff] [blame] | 911 | MODULE_ALIAS_NETDEV("tunl0"); |