blob: 3959e0ca456a09ce2457e120e2244358629ee428 [file] [log] [blame]
Herbert Xud2acc342006-03-28 01:12:13 -08001/* tunnel4.c: Generic IP tunnel transformer.
2 *
3 * Copyright (C) 2003 David S. Miller (davem@redhat.com)
4 */
5
6#include <linux/init.h>
7#include <linux/module.h>
8#include <linux/mutex.h>
9#include <linux/netdevice.h>
10#include <linux/skbuff.h>
Herbert Xu50fba2a2006-04-04 13:50:45 -070011#include <net/icmp.h>
12#include <net/ip.h>
Herbert Xud2acc342006-03-28 01:12:13 -080013#include <net/protocol.h>
14#include <net/xfrm.h>
15
16static struct xfrm_tunnel *tunnel4_handlers;
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -080017static struct xfrm_tunnel *tunnel64_handlers;
Herbert Xud2acc342006-03-28 01:12:13 -080018static DEFINE_MUTEX(tunnel4_mutex);
19
Pavel Emelyanov358352b2007-11-10 21:48:54 -080020static inline struct xfrm_tunnel **fam_handlers(unsigned short family)
21{
22 return (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
23}
24
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -080025int xfrm4_tunnel_register(struct xfrm_tunnel *handler, unsigned short family)
Herbert Xud2acc342006-03-28 01:12:13 -080026{
27 struct xfrm_tunnel **pprev;
28 int ret = -EEXIST;
29 int priority = handler->priority;
30
31 mutex_lock(&tunnel4_mutex);
32
Pavel Emelyanov358352b2007-11-10 21:48:54 -080033 for (pprev = fam_handlers(family); *pprev; pprev = &(*pprev)->next) {
Herbert Xud2acc342006-03-28 01:12:13 -080034 if ((*pprev)->priority > priority)
35 break;
36 if ((*pprev)->priority == priority)
37 goto err;
38 }
39
40 handler->next = *pprev;
41 *pprev = handler;
42
43 ret = 0;
44
45err:
46 mutex_unlock(&tunnel4_mutex);
47
48 return ret;
49}
50
51EXPORT_SYMBOL(xfrm4_tunnel_register);
52
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -080053int xfrm4_tunnel_deregister(struct xfrm_tunnel *handler, unsigned short family)
Herbert Xud2acc342006-03-28 01:12:13 -080054{
55 struct xfrm_tunnel **pprev;
56 int ret = -ENOENT;
57
58 mutex_lock(&tunnel4_mutex);
59
Pavel Emelyanov358352b2007-11-10 21:48:54 -080060 for (pprev = fam_handlers(family); *pprev; pprev = &(*pprev)->next) {
Herbert Xud2acc342006-03-28 01:12:13 -080061 if (*pprev == handler) {
62 *pprev = handler->next;
63 ret = 0;
64 break;
65 }
66 }
67
68 mutex_unlock(&tunnel4_mutex);
69
70 synchronize_net();
71
72 return ret;
73}
74
75EXPORT_SYMBOL(xfrm4_tunnel_deregister);
76
77static int tunnel4_rcv(struct sk_buff *skb)
78{
79 struct xfrm_tunnel *handler;
80
Herbert Xu50fba2a2006-04-04 13:50:45 -070081 if (!pskb_may_pull(skb, sizeof(struct iphdr)))
82 goto drop;
83
Herbert Xud2acc342006-03-28 01:12:13 -080084 for (handler = tunnel4_handlers; handler; handler = handler->next)
85 if (!handler->handler(skb))
86 return 0;
87
Herbert Xu50fba2a2006-04-04 13:50:45 -070088 icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
89
90drop:
Herbert Xud2acc342006-03-28 01:12:13 -080091 kfree_skb(skb);
92 return 0;
93}
94
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -080095#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
96static int tunnel64_rcv(struct sk_buff *skb)
97{
98 struct xfrm_tunnel *handler;
99
YOSHIFUJI Hideakibaa2bfb2008-05-30 11:35:03 +0900100 if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -0800101 goto drop;
102
103 for (handler = tunnel64_handlers; handler; handler = handler->next)
104 if (!handler->handler(skb))
105 return 0;
106
107 icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
108
109drop:
110 kfree_skb(skb);
111 return 0;
112}
113#endif
114
Herbert Xud2acc342006-03-28 01:12:13 -0800115static void tunnel4_err(struct sk_buff *skb, u32 info)
116{
117 struct xfrm_tunnel *handler;
118
119 for (handler = tunnel4_handlers; handler; handler = handler->next)
120 if (!handler->err_handler(skb, info))
121 break;
122}
123
Pavel Emelyanov99f93322007-11-10 21:47:39 -0800124#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
125static void tunnel64_err(struct sk_buff *skb, u32 info)
126{
127 struct xfrm_tunnel *handler;
128
129 for (handler = tunnel64_handlers; handler; handler = handler->next)
130 if (!handler->err_handler(skb, info))
131 break;
132}
133#endif
134
Alexey Dobriyan32613092009-09-14 12:21:47 +0000135static const struct net_protocol tunnel4_protocol = {
Herbert Xud2acc342006-03-28 01:12:13 -0800136 .handler = tunnel4_rcv,
137 .err_handler = tunnel4_err,
138 .no_policy = 1,
Pavel Emelyanov4597a0c2008-04-16 01:06:56 -0700139 .netns_ok = 1,
Herbert Xud2acc342006-03-28 01:12:13 -0800140};
141
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -0800142#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
Alexey Dobriyan32613092009-09-14 12:21:47 +0000143static const struct net_protocol tunnel64_protocol = {
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -0800144 .handler = tunnel64_rcv,
Pavel Emelyanov99f93322007-11-10 21:47:39 -0800145 .err_handler = tunnel64_err,
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -0800146 .no_policy = 1,
Pavel Emelyanovb0970c42008-04-16 01:17:39 -0700147 .netns_ok = 1,
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -0800148};
149#endif
150
Herbert Xud2acc342006-03-28 01:12:13 -0800151static int __init tunnel4_init(void)
152{
153 if (inet_add_protocol(&tunnel4_protocol, IPPROTO_IPIP)) {
154 printk(KERN_ERR "tunnel4 init: can't add protocol\n");
155 return -EAGAIN;
156 }
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -0800157#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
158 if (inet_add_protocol(&tunnel64_protocol, IPPROTO_IPV6)) {
159 printk(KERN_ERR "tunnel64 init: can't add protocol\n");
160 inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP);
161 return -EAGAIN;
162 }
163#endif
Herbert Xud2acc342006-03-28 01:12:13 -0800164 return 0;
165}
166
167static void __exit tunnel4_fini(void)
168{
Kazunori MIYAZAWAc0d56402007-02-13 12:54:47 -0800169#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
170 if (inet_del_protocol(&tunnel64_protocol, IPPROTO_IPV6))
171 printk(KERN_ERR "tunnel64 close: can't remove protocol\n");
172#endif
Herbert Xud2acc342006-03-28 01:12:13 -0800173 if (inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP))
174 printk(KERN_ERR "tunnel4 close: can't remove protocol\n");
175}
176
177module_init(tunnel4_init);
178module_exit(tunnel4_fini);
179MODULE_LICENSE("GPL");