[net-next-2.6.git] / net / ipv4 / tunnel4.c

/* tunnel4.c: Generic IP tunnel transformer.
 *
 * Copyright (C) 2003 David S. Miller (davem@redhat.com)
 */

#include <linux/init.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/netdevice.h>
#include <linux/skbuff.h>
#include <linux/slab.h>
#include <net/icmp.h>
#include <net/ip.h>
#include <net/protocol.h>
#include <net/xfrm.h>

static struct xfrm_tunnel *tunnel4_handlers __read_mostly;
static struct xfrm_tunnel *tunnel64_handlers __read_mostly;
static DEFINE_MUTEX(tunnel4_mutex);

static inline struct xfrm_tunnel **fam_handlers(unsigned short family)
{
	return (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
}

int xfrm4_tunnel_register(struct xfrm_tunnel *handler, unsigned short family)
{
	struct xfrm_tunnel **pprev;
	int ret = -EEXIST;
	int priority = handler->priority;

	mutex_lock(&tunnel4_mutex);

	for (pprev = fam_handlers(family); *pprev; pprev = &(*pprev)->next) {
		if ((*pprev)->priority > priority)
			break;
		if ((*pprev)->priority == priority)
			goto err;
	}

	handler->next = *pprev;
	*pprev = handler;

	ret = 0;

err:
	mutex_unlock(&tunnel4_mutex);

	return ret;
}
EXPORT_SYMBOL(xfrm4_tunnel_register);

int xfrm4_tunnel_deregister(struct xfrm_tunnel *handler, unsigned short family)
{
	struct xfrm_tunnel **pprev;
	int ret = -ENOENT;

	mutex_lock(&tunnel4_mutex);

	for (pprev = fam_handlers(family); *pprev; pprev = &(*pprev)->next) {
		if (*pprev == handler) {
			*pprev = handler->next;
			ret = 0;
			break;
		}
	}

	mutex_unlock(&tunnel4_mutex);

	synchronize_net();

	return ret;
}
EXPORT_SYMBOL(xfrm4_tunnel_deregister);

static int tunnel4_rcv(struct sk_buff *skb)
{
	struct xfrm_tunnel *handler;

	if (!pskb_may_pull(skb, sizeof(struct iphdr)))
		goto drop;

	for (handler = tunnel4_handlers; handler; handler = handler->next)
		if (!handler->handler(skb))
			return 0;

	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);

drop:
	kfree_skb(skb);
	return 0;
}

#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
static int tunnel64_rcv(struct sk_buff *skb)
{
	struct xfrm_tunnel *handler;

	if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
		goto drop;

	for (handler = tunnel64_handlers; handler; handler = handler->next)
		if (!handler->handler(skb))
			return 0;

	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);

drop:
	kfree_skb(skb);
	return 0;
}
#endif

static void tunnel4_err(struct sk_buff *skb, u32 info)
{
	struct xfrm_tunnel *handler;

	for (handler = tunnel4_handlers; handler; handler = handler->next)
		if (!handler->err_handler(skb, info))
			break;
}

#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
static void tunnel64_err(struct sk_buff *skb, u32 info)
{
	struct xfrm_tunnel *handler;

	for (handler = tunnel64_handlers; handler; handler = handler->next)
		if (!handler->err_handler(skb, info))
			break;
}
#endif

static const struct net_protocol tunnel4_protocol = {
	.handler	=	tunnel4_rcv,
	.err_handler	=	tunnel4_err,
	.no_policy	=	1,
	.netns_ok	=	1,
};

#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
static const struct net_protocol tunnel64_protocol = {
	.handler	=	tunnel64_rcv,
	.err_handler	=	tunnel64_err,
	.no_policy	=	1,
	.netns_ok	=	1,
};
#endif

static int __init tunnel4_init(void)
{
	if (inet_add_protocol(&tunnel4_protocol, IPPROTO_IPIP)) {
		printk(KERN_ERR "tunnel4 init: can't add protocol\n");
		return -EAGAIN;
	}
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
	if (inet_add_protocol(&tunnel64_protocol, IPPROTO_IPV6)) {
		printk(KERN_ERR "tunnel64 init: can't add protocol\n");
		inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP);
		return -EAGAIN;
	}
#endif
	return 0;
}

static void __exit tunnel4_fini(void)
{
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
	if (inet_del_protocol(&tunnel64_protocol, IPPROTO_IPV6))
		printk(KERN_ERR "tunnel64 close: can't remove protocol\n");
#endif
	if (inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP))
		printk(KERN_ERR "tunnel4 close: can't remove protocol\n");
}

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