[INET]: Add missed tunnel64_err handler
[linux-2.6.git] / net / ipv4 / tunnel4.c
1 /* 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>
11 #include <net/icmp.h>
12 #include <net/ip.h>
13 #include <net/protocol.h>
14 #include <net/xfrm.h>
15
16 static struct xfrm_tunnel *tunnel4_handlers;
17 static struct xfrm_tunnel *tunnel64_handlers;
18 static DEFINE_MUTEX(tunnel4_mutex);
19
20 int xfrm4_tunnel_register(struct xfrm_tunnel *handler, unsigned short family)
21 {
22         struct xfrm_tunnel **pprev;
23         int ret = -EEXIST;
24         int priority = handler->priority;
25
26         mutex_lock(&tunnel4_mutex);
27
28         for (pprev = (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
29              *pprev; pprev = &(*pprev)->next) {
30                 if ((*pprev)->priority > priority)
31                         break;
32                 if ((*pprev)->priority == priority)
33                         goto err;
34         }
35
36         handler->next = *pprev;
37         *pprev = handler;
38
39         ret = 0;
40
41 err:
42         mutex_unlock(&tunnel4_mutex);
43
44         return ret;
45 }
46
47 EXPORT_SYMBOL(xfrm4_tunnel_register);
48
49 int xfrm4_tunnel_deregister(struct xfrm_tunnel *handler, unsigned short family)
50 {
51         struct xfrm_tunnel **pprev;
52         int ret = -ENOENT;
53
54         mutex_lock(&tunnel4_mutex);
55
56         for (pprev = (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
57              *pprev; pprev = &(*pprev)->next) {
58                 if (*pprev == handler) {
59                         *pprev = handler->next;
60                         ret = 0;
61                         break;
62                 }
63         }
64
65         mutex_unlock(&tunnel4_mutex);
66
67         synchronize_net();
68
69         return ret;
70 }
71
72 EXPORT_SYMBOL(xfrm4_tunnel_deregister);
73
74 static int tunnel4_rcv(struct sk_buff *skb)
75 {
76         struct xfrm_tunnel *handler;
77
78         if (!pskb_may_pull(skb, sizeof(struct iphdr)))
79                 goto drop;
80
81         for (handler = tunnel4_handlers; handler; handler = handler->next)
82                 if (!handler->handler(skb))
83                         return 0;
84
85         icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
86
87 drop:
88         kfree_skb(skb);
89         return 0;
90 }
91
92 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
93 static int tunnel64_rcv(struct sk_buff *skb)
94 {
95         struct xfrm_tunnel *handler;
96
97         if (!pskb_may_pull(skb, sizeof(struct iphdr)))
98                 goto drop;
99
100         for (handler = tunnel64_handlers; handler; handler = handler->next)
101                 if (!handler->handler(skb))
102                         return 0;
103
104         icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
105
106 drop:
107         kfree_skb(skb);
108         return 0;
109 }
110 #endif
111
112 static void tunnel4_err(struct sk_buff *skb, u32 info)
113 {
114         struct xfrm_tunnel *handler;
115
116         for (handler = tunnel4_handlers; handler; handler = handler->next)
117                 if (!handler->err_handler(skb, info))
118                         break;
119 }
120
121 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
122 static void tunnel64_err(struct sk_buff *skb, u32 info)
123 {
124         struct xfrm_tunnel *handler;
125
126         for (handler = tunnel64_handlers; handler; handler = handler->next)
127                 if (!handler->err_handler(skb, info))
128                         break;
129 }
130 #endif
131
132 static struct net_protocol tunnel4_protocol = {
133         .handler        =       tunnel4_rcv,
134         .err_handler    =       tunnel4_err,
135         .no_policy      =       1,
136 };
137
138 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
139 static struct net_protocol tunnel64_protocol = {
140         .handler        =       tunnel64_rcv,
141         .err_handler    =       tunnel64_err,
142         .no_policy      =       1,
143 };
144 #endif
145
146 static int __init tunnel4_init(void)
147 {
148         if (inet_add_protocol(&tunnel4_protocol, IPPROTO_IPIP)) {
149                 printk(KERN_ERR "tunnel4 init: can't add protocol\n");
150                 return -EAGAIN;
151         }
152 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
153         if (inet_add_protocol(&tunnel64_protocol, IPPROTO_IPV6)) {
154                 printk(KERN_ERR "tunnel64 init: can't add protocol\n");
155                 inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP);
156                 return -EAGAIN;
157         }
158 #endif
159         return 0;
160 }
161
162 static void __exit tunnel4_fini(void)
163 {
164 #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
165         if (inet_del_protocol(&tunnel64_protocol, IPPROTO_IPV6))
166                 printk(KERN_ERR "tunnel64 close: can't remove protocol\n");
167 #endif
168         if (inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP))
169                 printk(KERN_ERR "tunnel4 close: can't remove protocol\n");
170 }
171
172 module_init(tunnel4_init);
173 module_exit(tunnel4_fini);
174 MODULE_LICENSE("GPL");