| 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> | 
|  | 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> | 
| Kris Katterjohn | 46f25df | 2006-01-05 16:35:42 -0800 | [diff] [blame] | 108 | #include <linux/if_ether.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 |  | 
|  | 110 | #include <net/sock.h> | 
|  | 111 | #include <net/ip.h> | 
|  | 112 | #include <net/icmp.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | #include <net/ipip.h> | 
|  | 114 | #include <net/inet_ecn.h> | 
|  | 115 | #include <net/xfrm.h> | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 116 | #include <net/net_namespace.h> | 
|  | 117 | #include <net/netns/generic.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 |  | 
|  | 119 | #define HASH_SIZE  16 | 
| Al Viro | d5a0a1e | 2006-11-08 00:23:14 -0800 | [diff] [blame] | 120 | #define HASH(addr) (((__force u32)addr^((__force u32)addr>>4))&0xF) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 121 |  | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 122 | static int ipip_net_id; | 
|  | 123 | struct ipip_net { | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 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 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 130 | struct net_device *fb_tunnel_dev; | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 131 | }; | 
|  | 132 |  | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 133 | static void ipip_fb_tunnel_init(struct net_device *dev); | 
|  | 134 | static void 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); | 
|  | 136 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 137 | static DEFINE_RWLOCK(ipip_lock); | 
|  | 138 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 139 | static struct ip_tunnel * ipip_tunnel_lookup(struct net *net, | 
|  | 140 | __be32 remote, __be32 local) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | { | 
|  | 142 | unsigned h0 = HASH(remote); | 
|  | 143 | unsigned h1 = HASH(local); | 
|  | 144 | struct ip_tunnel *t; | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 145 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 146 |  | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 147 | for (t = ipn->tunnels_r_l[h0^h1]; t; t = t->next) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | if (local == t->parms.iph.saddr && | 
|  | 149 | remote == t->parms.iph.daddr && (t->dev->flags&IFF_UP)) | 
|  | 150 | return t; | 
|  | 151 | } | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 152 | for (t = ipn->tunnels_r[h0]; t; t = t->next) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | if (remote == t->parms.iph.daddr && (t->dev->flags&IFF_UP)) | 
|  | 154 | return t; | 
|  | 155 | } | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 156 | for (t = ipn->tunnels_l[h1]; t; t = t->next) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 | if (local == t->parms.iph.saddr && (t->dev->flags&IFF_UP)) | 
|  | 158 | return t; | 
|  | 159 | } | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 160 | if ((t = ipn->tunnels_wc[0]) != NULL && (t->dev->flags&IFF_UP)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 161 | return t; | 
|  | 162 | return NULL; | 
|  | 163 | } | 
|  | 164 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 165 | static struct ip_tunnel **__ipip_bucket(struct ipip_net *ipn, | 
|  | 166 | struct ip_tunnel_parm *parms) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 167 | { | 
| YOSHIFUJI Hideaki | 87d1a16 | 2007-04-24 20:44:47 +0900 | [diff] [blame] | 168 | __be32 remote = parms->iph.daddr; | 
|  | 169 | __be32 local = parms->iph.saddr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | } | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 181 | return &ipn->tunnels[prio][h]; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 182 | } | 
|  | 183 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 184 | static inline struct ip_tunnel **ipip_bucket(struct ipip_net *ipn, | 
|  | 185 | struct ip_tunnel *t) | 
| YOSHIFUJI Hideaki | 87d1a16 | 2007-04-24 20:44:47 +0900 | [diff] [blame] | 186 | { | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 187 | return __ipip_bucket(ipn, &t->parms); | 
| YOSHIFUJI Hideaki | 87d1a16 | 2007-04-24 20:44:47 +0900 | [diff] [blame] | 188 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 190 | 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] | 191 | { | 
|  | 192 | struct ip_tunnel **tp; | 
|  | 193 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 194 | for (tp = ipip_bucket(ipn, t); *tp; tp = &(*tp)->next) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 204 | 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] | 205 | { | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 206 | struct ip_tunnel **tp = ipip_bucket(ipn, t); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 207 |  | 
|  | 208 | t->next = *tp; | 
|  | 209 | write_lock_bh(&ipip_lock); | 
|  | 210 | *tp = t; | 
|  | 211 | write_unlock_bh(&ipip_lock); | 
|  | 212 | } | 
|  | 213 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 214 | static struct ip_tunnel * ipip_tunnel_locate(struct net *net, | 
|  | 215 | struct ip_tunnel_parm *parms, int create) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 216 | { | 
| Al Viro | d5a0a1e | 2006-11-08 00:23:14 -0800 | [diff] [blame] | 217 | __be32 remote = parms->iph.daddr; | 
|  | 218 | __be32 local = parms->iph.saddr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 219 | struct ip_tunnel *t, **tp, *nt; | 
|  | 220 | struct net_device *dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | char name[IFNAMSIZ]; | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 222 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 223 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 224 | for (tp = __ipip_bucket(ipn, parms); (t = *tp) != NULL; tp = &t->next) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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); | 
| Pavel Emelyanov | 34cc7ba | 2008-02-23 20:19:20 -0800 | [diff] [blame] | 233 | else | 
|  | 234 | sprintf(name, "tunl%%d"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 |  | 
|  | 236 | dev = alloc_netdev(sizeof(*t), name, ipip_tunnel_setup); | 
|  | 237 | if (dev == NULL) | 
|  | 238 | return NULL; | 
|  | 239 |  | 
| Pavel Emelyanov | 0a82640 | 2008-04-16 01:06:18 -0700 | [diff] [blame] | 240 | dev_net_set(dev, net); | 
|  | 241 |  | 
| Pavel Emelyanov | b37d428 | 2008-02-26 23:51:04 -0800 | [diff] [blame] | 242 | if (strchr(name, '%')) { | 
|  | 243 | if (dev_alloc_name(dev, name) < 0) | 
|  | 244 | goto failed_free; | 
|  | 245 | } | 
|  | 246 |  | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 247 | nt = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 248 | nt->parms = *parms; | 
|  | 249 |  | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 250 | ipip_tunnel_init(dev); | 
|  | 251 |  | 
| Pavel Emelyanov | b37d428 | 2008-02-26 23:51:04 -0800 | [diff] [blame] | 252 | if (register_netdevice(dev) < 0) | 
|  | 253 | goto failed_free; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 254 |  | 
|  | 255 | dev_hold(dev); | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 256 | ipip_tunnel_link(ipn, nt); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 257 | return nt; | 
|  | 258 |  | 
| Pavel Emelyanov | b37d428 | 2008-02-26 23:51:04 -0800 | [diff] [blame] | 259 | failed_free: | 
|  | 260 | free_netdev(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 261 | return NULL; | 
|  | 262 | } | 
|  | 263 |  | 
|  | 264 | static void ipip_tunnel_uninit(struct net_device *dev) | 
|  | 265 | { | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 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) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 270 | write_lock_bh(&ipip_lock); | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 271 | ipn->tunnels_wc[0] = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 272 | write_unlock_bh(&ipip_lock); | 
|  | 273 | } else | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 274 | ipip_tunnel_unlink(ipn, netdev_priv(dev)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 275 | dev_put(dev); | 
|  | 276 | } | 
|  | 277 |  | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 278 | static int ipip_err(struct sk_buff *skb, u32 info) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 279 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 280 |  | 
| Rami Rosen | 071f92d | 2008-05-21 17:47:54 -0700 | [diff] [blame] | 281 | /* All the routers (except for Linux) return only | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 282 | 8 bytes of packet payload. It means, that precise relaying of | 
|  | 283 | ICMP in the real Internet is absolutely infeasible. | 
|  | 284 | */ | 
| Jianjun Kong | 5a5f3a8 | 2008-11-03 00:24:34 -0800 | [diff] [blame] | 285 | struct iphdr *iph = (struct iphdr *)skb->data; | 
| Arnaldo Carvalho de Melo | 88c7664 | 2007-03-13 14:43:18 -0300 | [diff] [blame] | 286 | const int type = icmp_hdr(skb)->type; | 
|  | 287 | const int code = icmp_hdr(skb)->code; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | struct ip_tunnel *t; | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 289 | int err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 290 |  | 
|  | 291 | switch (type) { | 
|  | 292 | default: | 
|  | 293 | case ICMP_PARAMETERPROB: | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 294 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 295 |  | 
|  | 296 | case ICMP_DEST_UNREACH: | 
|  | 297 | switch (code) { | 
|  | 298 | case ICMP_SR_FAILED: | 
|  | 299 | case ICMP_PORT_UNREACH: | 
|  | 300 | /* Impossible event. */ | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 301 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 302 | case ICMP_FRAG_NEEDED: | 
|  | 303 | /* Soft state for pmtu is maintained by IP core. */ | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 304 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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) | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 315 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | break; | 
|  | 317 | } | 
|  | 318 |  | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 319 | err = -ENOENT; | 
|  | 320 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | read_lock(&ipip_lock); | 
| Pavel Emelyanov | cec3ffa | 2008-04-16 01:05:03 -0700 | [diff] [blame] | 322 | t = ipip_tunnel_lookup(dev_net(skb->dev), iph->daddr, iph->saddr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 323 | if (t == NULL || t->parms.iph.daddr == 0) | 
|  | 324 | goto out; | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 325 |  | 
|  | 326 | err = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 327 | if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED) | 
|  | 328 | goto out; | 
|  | 329 |  | 
| Wei Yongjun | 26d94b4 | 2009-02-24 23:36:47 -0800 | [diff] [blame] | 330 | if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 331 | t->err_count++; | 
|  | 332 | else | 
|  | 333 | t->err_count = 1; | 
|  | 334 | t->err_time = jiffies; | 
|  | 335 | out: | 
|  | 336 | read_unlock(&ipip_lock); | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 337 | return err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 338 | } | 
|  | 339 |  | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 340 | static inline void ipip_ecn_decapsulate(const struct iphdr *outer_iph, | 
|  | 341 | struct sk_buff *skb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 | { | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 343 | struct iphdr *inner_iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 351 | struct ip_tunnel *tunnel; | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 352 | const struct iphdr *iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 353 |  | 
|  | 354 | read_lock(&ipip_lock); | 
| Pavel Emelyanov | cec3ffa | 2008-04-16 01:05:03 -0700 | [diff] [blame] | 355 | if ((tunnel = ipip_tunnel_lookup(dev_net(skb->dev), | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 356 | iph->saddr, iph->daddr)) != NULL) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |  | 
| Arnaldo Carvalho de Melo | b0e380b | 2007-04-10 21:21:55 -0700 | [diff] [blame] | 365 | skb->mac_header = skb->network_header; | 
| Arnaldo Carvalho de Melo | c1d2bbe | 2007-04-10 20:45:18 -0700 | [diff] [blame] | 366 | skb_reset_network_header(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 367 | skb->protocol = htons(ETH_P_IP); | 
|  | 368 | skb->pkt_type = PACKET_HOST; | 
|  | 369 |  | 
| Pavel Emelyanov | 50f59ce | 2008-05-21 14:15:16 -0700 | [diff] [blame] | 370 | tunnel->dev->stats.rx_packets++; | 
|  | 371 | tunnel->dev->stats.rx_bytes += skb->len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | { | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 393 | struct ip_tunnel *tunnel = netdev_priv(dev); | 
| Pavel Emelyanov | 50f59ce | 2008-05-21 14:15:16 -0700 | [diff] [blame] | 394 | struct net_device_stats *stats = &tunnel->dev->stats; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 395 | struct iphdr  *tiph = &tunnel->parms.iph; | 
|  | 396 | u8     tos = tunnel->parms.iph.tos; | 
| Al Viro | d5a0a1e | 2006-11-08 00:23:14 -0800 | [diff] [blame] | 397 | __be16 df = tiph->frag_off; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 398 | struct rtable *rt;     			/* Route to the other host */ | 
|  | 399 | struct net_device *tdev;			/* Device to other host */ | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 400 | struct iphdr  *old_iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 401 | struct iphdr  *iph;			/* Our new IP header */ | 
| Chuck Lever | c2636b4 | 2007-10-23 21:07:32 -0700 | [diff] [blame] | 402 | unsigned int max_headroom;		/* The extra header space needed */ | 
| Al Viro | d5a0a1e | 2006-11-08 00:23:14 -0800 | [diff] [blame] | 403 | __be32 dst = tiph->daddr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 404 | int    mtu; | 
|  | 405 |  | 
|  | 406 | if (tunnel->recursion++) { | 
| Pavel Emelyanov | 50f59ce | 2008-05-21 14:15:16 -0700 | [diff] [blame] | 407 | stats->collisions++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 */ | 
| Eric Dumazet | ee6b967 | 2008-03-05 18:30:47 -0800 | [diff] [blame] | 419 | if ((rt = skb->rtable) == NULL) { | 
| Pavel Emelyanov | 50f59ce | 2008-05-21 14:15:16 -0700 | [diff] [blame] | 420 | stats->tx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 }; | 
| Pavel Emelyanov | b99f015 | 2008-04-16 01:05:57 -0700 | [diff] [blame] | 434 | if (ip_route_output_key(dev_net(dev), &rt, &fl)) { | 
| Pavel Emelyanov | 50f59ce | 2008-05-21 14:15:16 -0700 | [diff] [blame] | 435 | stats->tx_carrier_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 436 | goto tx_error_icmp; | 
|  | 437 | } | 
|  | 438 | } | 
|  | 439 | tdev = rt->u.dst.dev; | 
|  | 440 |  | 
|  | 441 | if (tdev == dev) { | 
|  | 442 | ip_rt_put(rt); | 
| Pavel Emelyanov | 50f59ce | 2008-05-21 14:15:16 -0700 | [diff] [blame] | 443 | stats->collisions++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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) { | 
| Pavel Emelyanov | 50f59ce | 2008-05-21 14:15:16 -0700 | [diff] [blame] | 453 | stats->collisions++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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) { | 
| Wei Yongjun | 26d94b4 | 2009-02-24 23:36:47 -0800 | [diff] [blame] | 469 | if (time_before(jiffies, | 
|  | 470 | tunnel->err_time + IPTUNNEL_ERR_TIMEO)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 471 | tunnel->err_count--; | 
|  | 472 | dst_link_failure(skb); | 
|  | 473 | } else | 
|  | 474 | tunnel->err_count = 0; | 
|  | 475 | } | 
|  | 476 |  | 
|  | 477 | /* | 
|  | 478 | * Okay, now see if we can stuff it in the buffer as-is. | 
|  | 479 | */ | 
|  | 480 | max_headroom = (LL_RESERVED_SPACE(tdev)+sizeof(struct iphdr)); | 
|  | 481 |  | 
| Patrick McHardy | cfbba49 | 2007-07-09 15:33:40 -0700 | [diff] [blame] | 482 | if (skb_headroom(skb) < max_headroom || skb_shared(skb) || | 
|  | 483 | (skb_cloned(skb) && !skb_clone_writable(skb, 0))) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 484 | struct sk_buff *new_skb = skb_realloc_headroom(skb, max_headroom); | 
|  | 485 | if (!new_skb) { | 
|  | 486 | ip_rt_put(rt); | 
| YOSHIFUJI Hideaki | e905a9e | 2007-02-09 23:24:47 +0900 | [diff] [blame] | 487 | stats->tx_dropped++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 488 | dev_kfree_skb(skb); | 
|  | 489 | tunnel->recursion--; | 
|  | 490 | return 0; | 
|  | 491 | } | 
|  | 492 | if (skb->sk) | 
|  | 493 | skb_set_owner_w(new_skb, skb->sk); | 
|  | 494 | dev_kfree_skb(skb); | 
|  | 495 | skb = new_skb; | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 496 | old_iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 497 | } | 
|  | 498 |  | 
| Arnaldo Carvalho de Melo | b0e380b | 2007-04-10 21:21:55 -0700 | [diff] [blame] | 499 | skb->transport_header = skb->network_header; | 
| Arnaldo Carvalho de Melo | e2d1bca | 2007-04-10 20:46:21 -0700 | [diff] [blame] | 500 | skb_push(skb, sizeof(struct iphdr)); | 
|  | 501 | skb_reset_network_header(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 502 | memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt)); | 
| Patrick McHardy | 48d5cad | 2006-02-15 15:10:22 -0800 | [diff] [blame] | 503 | IPCB(skb)->flags &= ~(IPSKB_XFRM_TUNNEL_SIZE | IPSKB_XFRM_TRANSFORMED | | 
|  | 504 | IPSKB_REROUTED); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 505 | dst_release(skb->dst); | 
|  | 506 | skb->dst = &rt->u.dst; | 
|  | 507 |  | 
|  | 508 | /* | 
|  | 509 | *	Push down and install the IPIP header. | 
|  | 510 | */ | 
|  | 511 |  | 
| Arnaldo Carvalho de Melo | eddc9ec | 2007-04-20 22:47:35 -0700 | [diff] [blame] | 512 | iph 			=	ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 513 | iph->version		=	4; | 
|  | 514 | iph->ihl		=	sizeof(struct iphdr)>>2; | 
|  | 515 | iph->frag_off		=	df; | 
|  | 516 | iph->protocol		=	IPPROTO_IPIP; | 
|  | 517 | iph->tos		=	INET_ECN_encapsulate(tos, old_iph->tos); | 
|  | 518 | iph->daddr		=	rt->rt_dst; | 
|  | 519 | iph->saddr		=	rt->rt_src; | 
|  | 520 |  | 
|  | 521 | if ((iph->ttl = tiph->ttl) == 0) | 
|  | 522 | iph->ttl	=	old_iph->ttl; | 
|  | 523 |  | 
|  | 524 | nf_reset(skb); | 
|  | 525 |  | 
|  | 526 | IPTUNNEL_XMIT(); | 
|  | 527 | tunnel->recursion--; | 
|  | 528 | return 0; | 
|  | 529 |  | 
|  | 530 | tx_error_icmp: | 
|  | 531 | dst_link_failure(skb); | 
|  | 532 | tx_error: | 
|  | 533 | stats->tx_errors++; | 
|  | 534 | dev_kfree_skb(skb); | 
|  | 535 | tunnel->recursion--; | 
|  | 536 | return 0; | 
|  | 537 | } | 
|  | 538 |  | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 539 | static void ipip_tunnel_bind_dev(struct net_device *dev) | 
|  | 540 | { | 
|  | 541 | struct net_device *tdev = NULL; | 
|  | 542 | struct ip_tunnel *tunnel; | 
|  | 543 | struct iphdr *iph; | 
|  | 544 |  | 
|  | 545 | tunnel = netdev_priv(dev); | 
|  | 546 | iph = &tunnel->parms.iph; | 
|  | 547 |  | 
|  | 548 | if (iph->daddr) { | 
|  | 549 | struct flowi fl = { .oif = tunnel->parms.link, | 
|  | 550 | .nl_u = { .ip4_u = | 
|  | 551 | { .daddr = iph->daddr, | 
|  | 552 | .saddr = iph->saddr, | 
|  | 553 | .tos = RT_TOS(iph->tos) } }, | 
|  | 554 | .proto = IPPROTO_IPIP }; | 
|  | 555 | struct rtable *rt; | 
| Pavel Emelyanov | b99f015 | 2008-04-16 01:05:57 -0700 | [diff] [blame] | 556 | if (!ip_route_output_key(dev_net(dev), &rt, &fl)) { | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 557 | tdev = rt->u.dst.dev; | 
|  | 558 | ip_rt_put(rt); | 
|  | 559 | } | 
|  | 560 | dev->flags |= IFF_POINTOPOINT; | 
|  | 561 | } | 
|  | 562 |  | 
|  | 563 | if (!tdev && tunnel->parms.link) | 
| Pavel Emelyanov | b99f015 | 2008-04-16 01:05:57 -0700 | [diff] [blame] | 564 | tdev = __dev_get_by_index(dev_net(dev), tunnel->parms.link); | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 565 |  | 
|  | 566 | if (tdev) { | 
|  | 567 | dev->hard_header_len = tdev->hard_header_len + sizeof(struct iphdr); | 
|  | 568 | dev->mtu = tdev->mtu - sizeof(struct iphdr); | 
|  | 569 | } | 
|  | 570 | dev->iflink = tunnel->parms.link; | 
|  | 571 | } | 
|  | 572 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 573 | static int | 
|  | 574 | ipip_tunnel_ioctl (struct net_device *dev, struct ifreq *ifr, int cmd) | 
|  | 575 | { | 
|  | 576 | int err = 0; | 
|  | 577 | struct ip_tunnel_parm p; | 
|  | 578 | struct ip_tunnel *t; | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 579 | struct net *net = dev_net(dev); | 
|  | 580 | struct ipip_net *ipn = net_generic(net, ipip_net_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 581 |  | 
|  | 582 | switch (cmd) { | 
|  | 583 | case SIOCGETTUNNEL: | 
|  | 584 | t = NULL; | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 585 | if (dev == ipn->fb_tunnel_dev) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 586 | if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) { | 
|  | 587 | err = -EFAULT; | 
|  | 588 | break; | 
|  | 589 | } | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 590 | t = ipip_tunnel_locate(net, &p, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 591 | } | 
|  | 592 | if (t == NULL) | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 593 | t = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 594 | memcpy(&p, &t->parms, sizeof(p)); | 
|  | 595 | if (copy_to_user(ifr->ifr_ifru.ifru_data, &p, sizeof(p))) | 
|  | 596 | err = -EFAULT; | 
|  | 597 | break; | 
|  | 598 |  | 
|  | 599 | case SIOCADDTUNNEL: | 
|  | 600 | case SIOCCHGTUNNEL: | 
|  | 601 | err = -EPERM; | 
|  | 602 | if (!capable(CAP_NET_ADMIN)) | 
|  | 603 | goto done; | 
|  | 604 |  | 
|  | 605 | err = -EFAULT; | 
|  | 606 | if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) | 
|  | 607 | goto done; | 
|  | 608 |  | 
|  | 609 | err = -EINVAL; | 
|  | 610 | if (p.iph.version != 4 || p.iph.protocol != IPPROTO_IPIP || | 
|  | 611 | p.iph.ihl != 5 || (p.iph.frag_off&htons(~IP_DF))) | 
|  | 612 | goto done; | 
|  | 613 | if (p.iph.ttl) | 
|  | 614 | p.iph.frag_off |= htons(IP_DF); | 
|  | 615 |  | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 616 | t = ipip_tunnel_locate(net, &p, cmd == SIOCADDTUNNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 617 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 618 | if (dev != ipn->fb_tunnel_dev && cmd == SIOCCHGTUNNEL) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 619 | if (t != NULL) { | 
|  | 620 | if (t->dev != dev) { | 
|  | 621 | err = -EEXIST; | 
|  | 622 | break; | 
|  | 623 | } | 
|  | 624 | } else { | 
|  | 625 | if (((dev->flags&IFF_POINTOPOINT) && !p.iph.daddr) || | 
|  | 626 | (!(dev->flags&IFF_POINTOPOINT) && p.iph.daddr)) { | 
|  | 627 | err = -EINVAL; | 
|  | 628 | break; | 
|  | 629 | } | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 630 | t = netdev_priv(dev); | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 631 | ipip_tunnel_unlink(ipn, t); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 632 | t->parms.iph.saddr = p.iph.saddr; | 
|  | 633 | t->parms.iph.daddr = p.iph.daddr; | 
|  | 634 | memcpy(dev->dev_addr, &p.iph.saddr, 4); | 
|  | 635 | memcpy(dev->broadcast, &p.iph.daddr, 4); | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 636 | ipip_tunnel_link(ipn, t); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 637 | netdev_state_change(dev); | 
|  | 638 | } | 
|  | 639 | } | 
|  | 640 |  | 
|  | 641 | if (t) { | 
|  | 642 | err = 0; | 
|  | 643 | if (cmd == SIOCCHGTUNNEL) { | 
|  | 644 | t->parms.iph.ttl = p.iph.ttl; | 
|  | 645 | t->parms.iph.tos = p.iph.tos; | 
|  | 646 | t->parms.iph.frag_off = p.iph.frag_off; | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 647 | if (t->parms.link != p.link) { | 
|  | 648 | t->parms.link = p.link; | 
|  | 649 | ipip_tunnel_bind_dev(dev); | 
|  | 650 | netdev_state_change(dev); | 
|  | 651 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 652 | } | 
|  | 653 | if (copy_to_user(ifr->ifr_ifru.ifru_data, &t->parms, sizeof(p))) | 
|  | 654 | err = -EFAULT; | 
|  | 655 | } else | 
|  | 656 | err = (cmd == SIOCADDTUNNEL ? -ENOBUFS : -ENOENT); | 
|  | 657 | break; | 
|  | 658 |  | 
|  | 659 | case SIOCDELTUNNEL: | 
|  | 660 | err = -EPERM; | 
|  | 661 | if (!capable(CAP_NET_ADMIN)) | 
|  | 662 | goto done; | 
|  | 663 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 664 | if (dev == ipn->fb_tunnel_dev) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 665 | err = -EFAULT; | 
|  | 666 | if (copy_from_user(&p, ifr->ifr_ifru.ifru_data, sizeof(p))) | 
|  | 667 | goto done; | 
|  | 668 | err = -ENOENT; | 
| Pavel Emelyanov | b9fae5c | 2008-04-16 01:04:35 -0700 | [diff] [blame] | 669 | if ((t = ipip_tunnel_locate(net, &p, 0)) == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 670 | goto done; | 
|  | 671 | err = -EPERM; | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 672 | if (t->dev == ipn->fb_tunnel_dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 673 | goto done; | 
|  | 674 | dev = t->dev; | 
|  | 675 | } | 
| Stephen Hemminger | 22f8cde | 2007-02-07 00:09:58 -0800 | [diff] [blame] | 676 | unregister_netdevice(dev); | 
|  | 677 | err = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 | break; | 
|  | 679 |  | 
|  | 680 | default: | 
|  | 681 | err = -EINVAL; | 
|  | 682 | } | 
|  | 683 |  | 
|  | 684 | done: | 
|  | 685 | return err; | 
|  | 686 | } | 
|  | 687 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 688 | static int ipip_tunnel_change_mtu(struct net_device *dev, int new_mtu) | 
|  | 689 | { | 
|  | 690 | if (new_mtu < 68 || new_mtu > 0xFFF8 - sizeof(struct iphdr)) | 
|  | 691 | return -EINVAL; | 
|  | 692 | dev->mtu = new_mtu; | 
|  | 693 | return 0; | 
|  | 694 | } | 
|  | 695 |  | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 696 | static const struct net_device_ops ipip_netdev_ops = { | 
|  | 697 | .ndo_uninit	= ipip_tunnel_uninit, | 
|  | 698 | .ndo_start_xmit	= ipip_tunnel_xmit, | 
|  | 699 | .ndo_do_ioctl	= ipip_tunnel_ioctl, | 
|  | 700 | .ndo_change_mtu	= ipip_tunnel_change_mtu, | 
|  | 701 |  | 
|  | 702 | }; | 
|  | 703 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 704 | static void ipip_tunnel_setup(struct net_device *dev) | 
|  | 705 | { | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 706 | dev->netdev_ops		= &ipip_netdev_ops; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 707 | dev->destructor		= free_netdev; | 
|  | 708 |  | 
|  | 709 | dev->type		= ARPHRD_TUNNEL; | 
|  | 710 | dev->hard_header_len 	= LL_MAX_HEADER + sizeof(struct iphdr); | 
| Kris Katterjohn | 46f25df | 2006-01-05 16:35:42 -0800 | [diff] [blame] | 711 | dev->mtu		= ETH_DATA_LEN - sizeof(struct iphdr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 712 | dev->flags		= IFF_NOARP; | 
|  | 713 | dev->iflink		= 0; | 
|  | 714 | dev->addr_len		= 4; | 
| Pavel Emelyanov | 0a82640 | 2008-04-16 01:06:18 -0700 | [diff] [blame] | 715 | dev->features		|= NETIF_F_NETNS_LOCAL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 716 | } | 
|  | 717 |  | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 718 | static void ipip_tunnel_init(struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 719 | { | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 720 | struct ip_tunnel *tunnel = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 721 |  | 
|  | 722 | tunnel->dev = dev; | 
|  | 723 | strcpy(tunnel->parms.name, dev->name); | 
|  | 724 |  | 
|  | 725 | memcpy(dev->dev_addr, &tunnel->parms.iph.saddr, 4); | 
|  | 726 | memcpy(dev->broadcast, &tunnel->parms.iph.daddr, 4); | 
|  | 727 |  | 
| Michal Schmidt | 5533995 | 2007-12-12 11:01:43 -0800 | [diff] [blame] | 728 | ipip_tunnel_bind_dev(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 729 | } | 
|  | 730 |  | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 731 | static void ipip_fb_tunnel_init(struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 732 | { | 
| Patrick McHardy | 2941a48 | 2006-01-08 22:05:26 -0800 | [diff] [blame] | 733 | struct ip_tunnel *tunnel = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 734 | struct iphdr *iph = &tunnel->parms.iph; | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 735 | struct ipip_net *ipn = net_generic(dev_net(dev), ipip_net_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 736 |  | 
|  | 737 | tunnel->dev = dev; | 
|  | 738 | strcpy(tunnel->parms.name, dev->name); | 
|  | 739 |  | 
|  | 740 | iph->version		= 4; | 
|  | 741 | iph->protocol		= IPPROTO_IPIP; | 
|  | 742 | iph->ihl		= 5; | 
|  | 743 |  | 
|  | 744 | dev_hold(dev); | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 745 | ipn->tunnels_wc[0]	= tunnel; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 746 | } | 
|  | 747 |  | 
|  | 748 | static struct xfrm_tunnel ipip_handler = { | 
|  | 749 | .handler	=	ipip_rcv, | 
|  | 750 | .err_handler	=	ipip_err, | 
| Herbert Xu | d2acc34 | 2006-03-28 01:12:13 -0800 | [diff] [blame] | 751 | .priority	=	1, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 752 | }; | 
|  | 753 |  | 
| Stephen Hemminger | 5747a1a | 2009-02-22 00:02:08 -0800 | [diff] [blame] | 754 | static const char banner[] __initconst = | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 755 | KERN_INFO "IPv4 over IPv4 tunneling driver\n"; | 
|  | 756 |  | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 757 | static void ipip_destroy_tunnels(struct ipip_net *ipn) | 
|  | 758 | { | 
|  | 759 | int prio; | 
|  | 760 |  | 
|  | 761 | for (prio = 1; prio < 4; prio++) { | 
|  | 762 | int h; | 
|  | 763 | for (h = 0; h < HASH_SIZE; h++) { | 
|  | 764 | struct ip_tunnel *t; | 
|  | 765 | while ((t = ipn->tunnels[prio][h]) != NULL) | 
|  | 766 | unregister_netdevice(t->dev); | 
|  | 767 | } | 
|  | 768 | } | 
|  | 769 | } | 
|  | 770 |  | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 771 | static int ipip_init_net(struct net *net) | 
|  | 772 | { | 
|  | 773 | int err; | 
|  | 774 | struct ipip_net *ipn; | 
|  | 775 |  | 
|  | 776 | err = -ENOMEM; | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 777 | ipn = kzalloc(sizeof(struct ipip_net), GFP_KERNEL); | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 778 | if (ipn == NULL) | 
|  | 779 | goto err_alloc; | 
|  | 780 |  | 
|  | 781 | err = net_assign_generic(net, ipip_net_id, ipn); | 
|  | 782 | if (err < 0) | 
|  | 783 | goto err_assign; | 
|  | 784 |  | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 785 | ipn->tunnels[0] = ipn->tunnels_wc; | 
|  | 786 | ipn->tunnels[1] = ipn->tunnels_l; | 
|  | 787 | ipn->tunnels[2] = ipn->tunnels_r; | 
|  | 788 | ipn->tunnels[3] = ipn->tunnels_r_l; | 
|  | 789 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 790 | ipn->fb_tunnel_dev = alloc_netdev(sizeof(struct ip_tunnel), | 
|  | 791 | "tunl0", | 
|  | 792 | ipip_tunnel_setup); | 
|  | 793 | if (!ipn->fb_tunnel_dev) { | 
|  | 794 | err = -ENOMEM; | 
|  | 795 | goto err_alloc_dev; | 
|  | 796 | } | 
| Alexey Dobriyan | be77e59 | 2008-11-23 17:26:26 -0800 | [diff] [blame] | 797 | dev_net_set(ipn->fb_tunnel_dev, net); | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 798 |  | 
| Stephen Hemminger | 23a12b1 | 2008-11-20 20:33:21 -0800 | [diff] [blame] | 799 | ipip_fb_tunnel_init(ipn->fb_tunnel_dev); | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 800 |  | 
|  | 801 | if ((err = register_netdev(ipn->fb_tunnel_dev))) | 
|  | 802 | goto err_reg_dev; | 
|  | 803 |  | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 804 | return 0; | 
|  | 805 |  | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 806 | err_reg_dev: | 
|  | 807 | free_netdev(ipn->fb_tunnel_dev); | 
|  | 808 | err_alloc_dev: | 
|  | 809 | /* nothing */ | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 810 | err_assign: | 
|  | 811 | kfree(ipn); | 
|  | 812 | err_alloc: | 
|  | 813 | return err; | 
|  | 814 | } | 
|  | 815 |  | 
|  | 816 | static void ipip_exit_net(struct net *net) | 
|  | 817 | { | 
|  | 818 | struct ipip_net *ipn; | 
|  | 819 |  | 
|  | 820 | ipn = net_generic(net, ipip_net_id); | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 821 | rtnl_lock(); | 
| Pavel Emelyanov | 44d3c29 | 2008-04-16 01:05:32 -0700 | [diff] [blame] | 822 | ipip_destroy_tunnels(ipn); | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 823 | unregister_netdevice(ipn->fb_tunnel_dev); | 
|  | 824 | rtnl_unlock(); | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 825 | kfree(ipn); | 
|  | 826 | } | 
|  | 827 |  | 
|  | 828 | static struct pernet_operations ipip_net_ops = { | 
|  | 829 | .init = ipip_init_net, | 
|  | 830 | .exit = ipip_exit_net, | 
|  | 831 | }; | 
|  | 832 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 833 | static int __init ipip_init(void) | 
|  | 834 | { | 
|  | 835 | int err; | 
|  | 836 |  | 
|  | 837 | printk(banner); | 
|  | 838 |  | 
| Kazunori MIYAZAWA | c0d5640 | 2007-02-13 12:54:47 -0800 | [diff] [blame] | 839 | if (xfrm4_tunnel_register(&ipip_handler, AF_INET)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 840 | printk(KERN_INFO "ipip init: can't register tunnel\n"); | 
|  | 841 | return -EAGAIN; | 
|  | 842 | } | 
|  | 843 |  | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 844 | err = register_pernet_gen_device(&ipip_net_id, &ipip_net_ops); | 
|  | 845 | if (err) | 
| Pavel Emelyanov | b9855c5 | 2008-04-16 01:04:13 -0700 | [diff] [blame] | 846 | xfrm4_tunnel_deregister(&ipip_handler, AF_INET); | 
|  | 847 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 848 | return err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 849 | } | 
|  | 850 |  | 
|  | 851 | static void __exit ipip_fini(void) | 
|  | 852 | { | 
| Kazunori MIYAZAWA | c0d5640 | 2007-02-13 12:54:47 -0800 | [diff] [blame] | 853 | if (xfrm4_tunnel_deregister(&ipip_handler, AF_INET)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 854 | printk(KERN_INFO "ipip close: can't deregister tunnel\n"); | 
|  | 855 |  | 
| Pavel Emelyanov | 10dc4c7 | 2008-04-16 01:03:13 -0700 | [diff] [blame] | 856 | unregister_pernet_gen_device(ipip_net_id, &ipip_net_ops); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 857 | } | 
|  | 858 |  | 
|  | 859 | module_init(ipip_init); | 
|  | 860 | module_exit(ipip_fini); | 
|  | 861 | MODULE_LICENSE("GPL"); |