[linux-block.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);

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>
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
358352b8 PE	20	static inline struct xfrm_tunnel **fam_handlers(unsigned short family)
	21	{
	22	return (family == AF_INET) ? &tunnel4_handlers : &tunnel64_handlers;
	23	}
	24
c0d56408	25	int xfrm4_tunnel_register(struct xfrm_tunnel *handler, unsigned short family)
d2acc347 HX	26	{
	27	struct xfrm_tunnel **pprev;
	28	int ret = -EEXIST;
	29	int priority = handler->priority;
	30
	31	mutex_lock(&tunnel4_mutex);
	32
358352b8	33	for (pprev = fam_handlers(family); pprev; pprev = &(pprev)->next) {
d2acc347 HX	34	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
	45	err:
	46	mutex_unlock(&tunnel4_mutex);
	47
	48	return ret;
	49	}
	50
	51	EXPORT_SYMBOL(xfrm4_tunnel_register);
	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	}
	74
	75	EXPORT_SYMBOL(xfrm4_tunnel_deregister);
	76
	77	static int tunnel4_rcv(struct sk_buff *skb)
	78	{
	79	struct xfrm_tunnel *handler;
	80
50fba2aa HX	81	if (!pskb_may_pull(skb, sizeof(struct iphdr)))
	82	goto drop;
	83
d2acc347 HX	84	for (handler = tunnel4_handlers; handler; handler = handler->next)
	85	if (!handler->handler(skb))
	86	return 0;
	87
50fba2aa HX	88	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
	89
	90	drop:
d2acc347 HX	91	kfree_skb(skb);
	92	return 0;
	93	}
	94
c0d56408 KM	95	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	96	static int tunnel64_rcv(struct sk_buff *skb)
	97	{
	98	struct xfrm_tunnel *handler;
	99
baa2bfb8	100	if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
c0d56408 KM	101	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
	109	drop:
	110	kfree_skb(skb);
	111	return 0;
	112	}
	113	#endif
	114
d2acc347 HX	115	static 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
99f93326 PE	124	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	125	static 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
32613090	135	static const struct net_protocol tunnel4_protocol = {
d2acc347 HX	136	.handler = tunnel4_rcv,
	137	.err_handler = tunnel4_err,
	138	.no_policy = 1,
4597a0ce	139	.netns_ok = 1,
d2acc347 HX	140	};
d2acc347 HX	141
c0d56408	142	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
32613090	143	static const struct net_protocol tunnel64_protocol = {
c0d56408	144	.handler = tunnel64_rcv,
99f93326	145	.err_handler = tunnel64_err,
c0d56408	146	.no_policy = 1,
b0970c42	147	.netns_ok = 1,
c0d56408 KM	148	};
	149	#endif
	150
d2acc347 HX	151	static 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	}
c0d56408 KM	157	#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
d2acc347 HX	164	return 0;
	165	}
	166
	167	static void __exit tunnel4_fini(void)
	168	{
c0d56408 KM	169	#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
d2acc347 HX	173	if (inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP))
	174	printk(KERN_ERR "tunnel4 close: can't remove protocol\n");
	175	}
	176
	177	module_init(tunnel4_init);
	178	module_exit(tunnel4_fini);
	179	MODULE_LICENSE("GPL");