[mirror_ubuntu-artful-kernel.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;
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>
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
	17	static struct xfrm_tunnel *tunnel4_handlers;
c0d56408	18	static struct xfrm_tunnel *tunnel64_handlers;
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	}
	51
	52	EXPORT_SYMBOL(xfrm4_tunnel_register);
	53
c0d56408	54	int xfrm4_tunnel_deregister(struct xfrm_tunnel *handler, unsigned short family)
d2acc347 HX	55	{
	56	struct xfrm_tunnel **pprev;
	57	int ret = -ENOENT;
	58
	59	mutex_lock(&tunnel4_mutex);
	60
358352b8	61	for (pprev = fam_handlers(family); pprev; pprev = &(pprev)->next) {
d2acc347 HX	62	if (*pprev == handler) {
	63	*pprev = handler->next;
	64	ret = 0;
	65	break;
	66	}
	67	}
	68
	69	mutex_unlock(&tunnel4_mutex);
	70
	71	synchronize_net();
	72
	73	return ret;
	74	}
	75
	76	EXPORT_SYMBOL(xfrm4_tunnel_deregister);
	77
	78	static int tunnel4_rcv(struct sk_buff *skb)
	79	{
	80	struct xfrm_tunnel *handler;
	81
50fba2aa HX	82	if (!pskb_may_pull(skb, sizeof(struct iphdr)))
	83	goto drop;
	84
d2acc347 HX	85	for (handler = tunnel4_handlers; handler; handler = handler->next)
	86	if (!handler->handler(skb))
	87	return 0;
	88
50fba2aa HX	89	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
	90
	91	drop:
d2acc347 HX	92	kfree_skb(skb);
	93	return 0;
	94	}
	95
c0d56408 KM	96	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	97	static int tunnel64_rcv(struct sk_buff *skb)
	98	{
	99	struct xfrm_tunnel *handler;
	100
baa2bfb8	101	if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
c0d56408 KM	102	goto drop;
	103
	104	for (handler = tunnel64_handlers; handler; handler = handler->next)
	105	if (!handler->handler(skb))
	106	return 0;
	107
	108	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
	109
	110	drop:
	111	kfree_skb(skb);
	112	return 0;
	113	}
	114	#endif
	115
d2acc347 HX	116	static void tunnel4_err(struct sk_buff *skb, u32 info)
	117	{
	118	struct xfrm_tunnel *handler;
	119
	120	for (handler = tunnel4_handlers; handler; handler = handler->next)
	121	if (!handler->err_handler(skb, info))
	122	break;
	123	}
	124
99f93326 PE	125	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	126	static void tunnel64_err(struct sk_buff *skb, u32 info)
	127	{
	128	struct xfrm_tunnel *handler;
	129
	130	for (handler = tunnel64_handlers; handler; handler = handler->next)
	131	if (!handler->err_handler(skb, info))
	132	break;
	133	}
	134	#endif
	135
32613090	136	static const struct net_protocol tunnel4_protocol = {
d2acc347 HX	137	.handler = tunnel4_rcv,
	138	.err_handler = tunnel4_err,
	139	.no_policy = 1,
4597a0ce	140	.netns_ok = 1,
d2acc347 HX	141	};
d2acc347 HX	142
c0d56408	143	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
32613090	144	static const struct net_protocol tunnel64_protocol = {
c0d56408	145	.handler = tunnel64_rcv,
99f93326	146	.err_handler = tunnel64_err,
c0d56408	147	.no_policy = 1,
b0970c42	148	.netns_ok = 1,
c0d56408 KM	149	};
	150	#endif
	151
d2acc347 HX	152	static int __init tunnel4_init(void)
	153	{
	154	if (inet_add_protocol(&tunnel4_protocol, IPPROTO_IPIP)) {
	155	printk(KERN_ERR "tunnel4 init: can't add protocol\n");
	156	return -EAGAIN;
	157	}
c0d56408 KM	158	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	159	if (inet_add_protocol(&tunnel64_protocol, IPPROTO_IPV6)) {
	160	printk(KERN_ERR "tunnel64 init: can't add protocol\n");
	161	inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP);
	162	return -EAGAIN;
	163	}
	164	#endif
d2acc347 HX	165	return 0;
	166	}
	167
	168	static void __exit tunnel4_fini(void)
	169	{
c0d56408 KM	170	#if defined(CONFIG_IPV6) \|\| defined(CONFIG_IPV6_MODULE)
	171	if (inet_del_protocol(&tunnel64_protocol, IPPROTO_IPV6))
	172	printk(KERN_ERR "tunnel64 close: can't remove protocol\n");
	173	#endif
d2acc347 HX	174	if (inet_del_protocol(&tunnel4_protocol, IPPROTO_IPIP))
	175	printk(KERN_ERR "tunnel4 close: can't remove protocol\n");
	176	}
	177
	178	module_init(tunnel4_init);
	179	module_exit(tunnel4_fini);
	180	MODULE_LICENSE("GPL");