[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 <net/icmp.h>
#include <net/ip.h>
#include <net/protocol.h>
#include <net/xfrm.h>

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

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 = (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
	     *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 = (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
	     *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 iphdr)))
		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;
}

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

#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
static struct net_protocol tunnel64_protocol = {
	.handler	=	tunnel64_rcv,
	.err_handler	=	tunnel4_err,
	.no_policy	=	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>
50fba2aa HX	11	#include <net/icmp.h>
50fba2aa HX	12	#include <net/ip.h>
d2acc347 HX	13	#include <net/protocol.h>
	14	#include <net/xfrm.h>
	15
	16	static struct xfrm_tunnel *tunnel4_handlers;
c0d56408	17	static struct xfrm_tunnel *tunnel64_handlers;
d2acc347 HX	18	static DEFINE_MUTEX(tunnel4_mutex);
d2acc347 HX	19
c0d56408	20	int xfrm4_tunnel_register(struct xfrm_tunnel *handler, unsigned short family)
d2acc347 HX	21	{
	22	struct xfrm_tunnel **pprev;
	23	int ret = -EEXIST;
	24	int priority = handler->priority;
	25
	26	mutex_lock(&tunnel4_mutex);
	27
c0d56408 KM	28	for (pprev = (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
c0d56408 KM	29	pprev; pprev = &(pprev)->next) {
d2acc347 HX	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
c0d56408	49	int xfrm4_tunnel_deregister(struct xfrm_tunnel *handler, unsigned short family)
d2acc347 HX	50	{
	51	struct xfrm_tunnel **pprev;
	52	int ret = -ENOENT;
	53
	54	mutex_lock(&tunnel4_mutex);
	55
c0d56408 KM	56	for (pprev = (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
c0d56408 KM	57	pprev; pprev = &(pprev)->next) {
d2acc347 HX	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
50fba2aa HX	78	if (!pskb_may_pull(skb, sizeof(struct iphdr)))
	79	goto drop;
	80
d2acc347 HX	81	for (handler = tunnel4_handlers; handler; handler = handler->next)
	82	if (!handler->handler(skb))
	83	return 0;
	84
50fba2aa HX	85	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
	86
	87	drop:
d2acc347 HX	88	kfree_skb(skb);
	89	return 0;
	90	}
	91
c0d56408 KM	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
d2acc347 HX	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	static struct net_protocol tunnel4_protocol = {
	122	.handler = tunnel4_rcv,
	123	.err_handler = tunnel4_err,
	124	.no_policy = 1,
	125	};
	126
c0d56408 KM	127	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	128	static struct net_protocol tunnel64_protocol = {
	129	.handler = tunnel64_rcv,
	130	.err_handler = tunnel4_err,
	131	.no_policy = 1,
	132	};
	133	#endif
	134
d2acc347 HX	135	static int __init tunnel4_init(void)
	136	{
	137	if (inet_add_protocol(&tunnel4_protocol, IPPROTO_IPIP)) {
	138	printk(KERN_ERR "tunnel4 init: can't add protocol\n");
	139	return -EAGAIN;
	140	}
c0d56408 KM	141	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	142	if (inet_add_protocol(&tunnel64_protocol, IPPROTO_IPV6)) {
	143	printk(KERN_ERR "tunnel64 init: can't add protocol\n");
	144	inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP);
	145	return -EAGAIN;
	146	}
	147	#endif
d2acc347 HX	148	return 0;
	149	}
	150
	151	static void __exit tunnel4_fini(void)
	152	{
c0d56408 KM	153	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	154	if (inet_del_protocol(&tunnel64_protocol, IPPROTO_IPV6))
	155	printk(KERN_ERR "tunnel64 close: can't remove protocol\n");
	156	#endif
d2acc347 HX	157	if (inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP))
	158	printk(KERN_ERR "tunnel4 close: can't remove protocol\n");
	159	}
	160
	161	module_init(tunnel4_init);
	162	module_exit(tunnel4_fini);
	163	MODULE_LICENSE("GPL");