mirror of
				https://github.com/torvalds/linux.git
				synced 2025-11-04 02:30:34 +02:00 
			
		
		
		
	gre: Allow multiple protocol listener for gre protocol.
Currently there is only one user is allowed to register for gre protocol. Following patch adds de-multiplexer. So that multiple modules can listen on gre protocol e.g. kernel gre devices and ovs. Signed-off-by: Pravin B Shelar <pshelar@nicira.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
		
							parent
							
								
									20fd4d1f04
								
							
						
					
					
						commit
						bda7bb4634
					
				
					 3 changed files with 267 additions and 151 deletions
				
			
		| 
						 | 
				
			
			@ -7,6 +7,7 @@
 | 
			
		|||
#define GREPROTO_CISCO		0
 | 
			
		||||
#define GREPROTO_PPTP		1
 | 
			
		||||
#define GREPROTO_MAX		2
 | 
			
		||||
#define GRE_IP_PROTO_MAX	2
 | 
			
		||||
 | 
			
		||||
struct gre_protocol {
 | 
			
		||||
	int  (*handler)(struct sk_buff *skb);
 | 
			
		||||
| 
						 | 
				
			
			@ -22,6 +23,29 @@ struct gre_base_hdr {
 | 
			
		|||
int gre_add_protocol(const struct gre_protocol *proto, u8 version);
 | 
			
		||||
int gre_del_protocol(const struct gre_protocol *proto, u8 version);
 | 
			
		||||
 | 
			
		||||
struct gre_cisco_protocol {
 | 
			
		||||
	int (*handler)(struct sk_buff *skb, const struct tnl_ptk_info *tpi);
 | 
			
		||||
	int (*err_handler)(struct sk_buff *skb, u32 info,
 | 
			
		||||
			   const struct tnl_ptk_info *tpi);
 | 
			
		||||
	u8 priority;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
int gre_cisco_register(struct gre_cisco_protocol *proto);
 | 
			
		||||
int gre_cisco_unregister(struct gre_cisco_protocol *proto);
 | 
			
		||||
 | 
			
		||||
static inline int ip_gre_calc_hlen(__be16 o_flags)
 | 
			
		||||
{
 | 
			
		||||
	int addend = 4;
 | 
			
		||||
 | 
			
		||||
	if (o_flags&TUNNEL_CSUM)
 | 
			
		||||
		addend += 4;
 | 
			
		||||
	if (o_flags&TUNNEL_KEY)
 | 
			
		||||
		addend += 4;
 | 
			
		||||
	if (o_flags&TUNNEL_SEQ)
 | 
			
		||||
		addend += 4;
 | 
			
		||||
	return addend;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __be16 gre_flags_to_tnl_flags(__be16 flags)
 | 
			
		||||
{
 | 
			
		||||
	__be16 tflags = 0;
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										221
									
								
								net/ipv4/gre.c
									
									
									
									
									
								
							
							
						
						
									
										221
									
								
								net/ipv4/gre.c
									
									
									
									
									
								
							| 
						 | 
				
			
			@ -13,6 +13,8 @@
 | 
			
		|||
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 | 
			
		||||
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/if.h>
 | 
			
		||||
#include <linux/icmp.h>
 | 
			
		||||
#include <linux/kernel.h>
 | 
			
		||||
#include <linux/kmod.h>
 | 
			
		||||
#include <linux/skbuff.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -24,8 +26,12 @@
 | 
			
		|||
#include <net/protocol.h>
 | 
			
		||||
#include <net/gre.h>
 | 
			
		||||
 | 
			
		||||
#include <net/icmp.h>
 | 
			
		||||
#include <net/route.h>
 | 
			
		||||
#include <net/xfrm.h>
 | 
			
		||||
 | 
			
		||||
static const struct gre_protocol __rcu *gre_proto[GREPROTO_MAX] __read_mostly;
 | 
			
		||||
static struct gre_cisco_protocol __rcu *gre_cisco_proto_list[GRE_IP_PROTO_MAX];
 | 
			
		||||
 | 
			
		||||
int gre_add_protocol(const struct gre_protocol *proto, u8 version)
 | 
			
		||||
{
 | 
			
		||||
| 
						 | 
				
			
			@ -55,6 +61,173 @@ int gre_del_protocol(const struct gre_protocol *proto, u8 version)
 | 
			
		|||
}
 | 
			
		||||
EXPORT_SYMBOL_GPL(gre_del_protocol);
 | 
			
		||||
 | 
			
		||||
static __sum16 check_checksum(struct sk_buff *skb)
 | 
			
		||||
{
 | 
			
		||||
	__sum16 csum = 0;
 | 
			
		||||
 | 
			
		||||
	switch (skb->ip_summed) {
 | 
			
		||||
	case CHECKSUM_COMPLETE:
 | 
			
		||||
		csum = csum_fold(skb->csum);
 | 
			
		||||
 | 
			
		||||
		if (!csum)
 | 
			
		||||
			break;
 | 
			
		||||
		/* Fall through. */
 | 
			
		||||
 | 
			
		||||
	case CHECKSUM_NONE:
 | 
			
		||||
		skb->csum = 0;
 | 
			
		||||
		csum = __skb_checksum_complete(skb);
 | 
			
		||||
		skb->ip_summed = CHECKSUM_COMPLETE;
 | 
			
		||||
		break;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return csum;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int parse_gre_header(struct sk_buff *skb, struct tnl_ptk_info *tpi,
 | 
			
		||||
			    bool *csum_err)
 | 
			
		||||
{
 | 
			
		||||
	unsigned int ip_hlen = ip_hdrlen(skb);
 | 
			
		||||
	const struct gre_base_hdr *greh;
 | 
			
		||||
	__be32 *options;
 | 
			
		||||
	int hdr_len;
 | 
			
		||||
 | 
			
		||||
	if (unlikely(!pskb_may_pull(skb, sizeof(struct gre_base_hdr))))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	greh = (struct gre_base_hdr *)(skb_network_header(skb) + ip_hlen);
 | 
			
		||||
	if (unlikely(greh->flags & (GRE_VERSION | GRE_ROUTING)))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	tpi->flags = gre_flags_to_tnl_flags(greh->flags);
 | 
			
		||||
	hdr_len = ip_gre_calc_hlen(tpi->flags);
 | 
			
		||||
 | 
			
		||||
	if (!pskb_may_pull(skb, hdr_len))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	greh = (struct gre_base_hdr *)(skb_network_header(skb) + ip_hlen);
 | 
			
		||||
	tpi->proto = greh->protocol;
 | 
			
		||||
 | 
			
		||||
	options = (__be32 *)(greh + 1);
 | 
			
		||||
	if (greh->flags & GRE_CSUM) {
 | 
			
		||||
		if (check_checksum(skb)) {
 | 
			
		||||
			*csum_err = true;
 | 
			
		||||
			return -EINVAL;
 | 
			
		||||
		}
 | 
			
		||||
		options++;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (greh->flags & GRE_KEY) {
 | 
			
		||||
		tpi->key = *options;
 | 
			
		||||
		options++;
 | 
			
		||||
	} else
 | 
			
		||||
		tpi->key = 0;
 | 
			
		||||
 | 
			
		||||
	if (unlikely(greh->flags & GRE_SEQ)) {
 | 
			
		||||
		tpi->seq = *options;
 | 
			
		||||
		options++;
 | 
			
		||||
	} else
 | 
			
		||||
		tpi->seq = 0;
 | 
			
		||||
 | 
			
		||||
	/* WCCP version 1 and 2 protocol decoding.
 | 
			
		||||
	 * - Change protocol to IP
 | 
			
		||||
	 * - When dealing with WCCPv2, Skip extra 4 bytes in GRE header
 | 
			
		||||
	 */
 | 
			
		||||
	if (greh->flags == 0 && tpi->proto == htons(ETH_P_WCCP)) {
 | 
			
		||||
		tpi->proto = htons(ETH_P_IP);
 | 
			
		||||
		if ((*(u8 *)options & 0xF0) != 0x40) {
 | 
			
		||||
			hdr_len += 4;
 | 
			
		||||
			if (!pskb_may_pull(skb, hdr_len))
 | 
			
		||||
				return -EINVAL;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int gre_cisco_rcv(struct sk_buff *skb)
 | 
			
		||||
{
 | 
			
		||||
	struct tnl_ptk_info tpi;
 | 
			
		||||
	int i;
 | 
			
		||||
	bool csum_err = false;
 | 
			
		||||
 | 
			
		||||
	if (parse_gre_header(skb, &tpi, &csum_err) < 0)
 | 
			
		||||
		goto drop;
 | 
			
		||||
 | 
			
		||||
	rcu_read_lock();
 | 
			
		||||
	for (i = 0; i < GRE_IP_PROTO_MAX; i++) {
 | 
			
		||||
		struct gre_cisco_protocol *proto;
 | 
			
		||||
		int ret;
 | 
			
		||||
 | 
			
		||||
		proto = rcu_dereference(gre_cisco_proto_list[i]);
 | 
			
		||||
		if (!proto)
 | 
			
		||||
			continue;
 | 
			
		||||
		ret = proto->handler(skb, &tpi);
 | 
			
		||||
		if (ret == PACKET_RCVD) {
 | 
			
		||||
			rcu_read_unlock();
 | 
			
		||||
			return 0;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	rcu_read_unlock();
 | 
			
		||||
 | 
			
		||||
	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
 | 
			
		||||
drop:
 | 
			
		||||
	kfree_skb(skb);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void gre_cisco_err(struct sk_buff *skb, u32 info)
 | 
			
		||||
{
 | 
			
		||||
	/* All the routers (except for Linux) return only
 | 
			
		||||
	 * 8 bytes of packet payload. It means, that precise relaying of
 | 
			
		||||
	 * ICMP in the real Internet is absolutely infeasible.
 | 
			
		||||
	 *
 | 
			
		||||
	 * Moreover, Cisco "wise men" put GRE key to the third word
 | 
			
		||||
	 * in GRE header. It makes impossible maintaining even soft
 | 
			
		||||
	 * state for keyed
 | 
			
		||||
	 * GRE tunnels with enabled checksum. Tell them "thank you".
 | 
			
		||||
	 *
 | 
			
		||||
	 * Well, I wonder, rfc1812 was written by Cisco employee,
 | 
			
		||||
	 * what the hell these idiots break standards established
 | 
			
		||||
	 * by themselves???
 | 
			
		||||
	 */
 | 
			
		||||
 | 
			
		||||
	const int type = icmp_hdr(skb)->type;
 | 
			
		||||
	const int code = icmp_hdr(skb)->code;
 | 
			
		||||
	struct tnl_ptk_info tpi;
 | 
			
		||||
	bool csum_err = false;
 | 
			
		||||
	int i;
 | 
			
		||||
 | 
			
		||||
	if (parse_gre_header(skb, &tpi, &csum_err)) {
 | 
			
		||||
		if (!csum_err)		/* ignore csum errors. */
 | 
			
		||||
			return;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (type == ICMP_DEST_UNREACH && code == ICMP_FRAG_NEEDED) {
 | 
			
		||||
		ipv4_update_pmtu(skb, dev_net(skb->dev), info,
 | 
			
		||||
				skb->dev->ifindex, 0, IPPROTO_GRE, 0);
 | 
			
		||||
		return;
 | 
			
		||||
	}
 | 
			
		||||
	if (type == ICMP_REDIRECT) {
 | 
			
		||||
		ipv4_redirect(skb, dev_net(skb->dev), skb->dev->ifindex, 0,
 | 
			
		||||
				IPPROTO_GRE, 0);
 | 
			
		||||
		return;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	rcu_read_lock();
 | 
			
		||||
	for (i = 0; i < GRE_IP_PROTO_MAX; i++) {
 | 
			
		||||
		struct gre_cisco_protocol *proto;
 | 
			
		||||
 | 
			
		||||
		proto = rcu_dereference(gre_cisco_proto_list[i]);
 | 
			
		||||
		if (!proto)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		if (proto->err_handler(skb, info, &tpi) == PACKET_RCVD)
 | 
			
		||||
			goto out;
 | 
			
		||||
 | 
			
		||||
	}
 | 
			
		||||
out:
 | 
			
		||||
	rcu_read_unlock();
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int gre_rcv(struct sk_buff *skb)
 | 
			
		||||
{
 | 
			
		||||
	const struct gre_protocol *proto;
 | 
			
		||||
| 
						 | 
				
			
			@ -206,27 +379,68 @@ static const struct net_offload gre_offload = {
 | 
			
		|||
	},
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static const struct gre_protocol ipgre_protocol = {
 | 
			
		||||
	.handler     = gre_cisco_rcv,
 | 
			
		||||
	.err_handler = gre_cisco_err,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
int gre_cisco_register(struct gre_cisco_protocol *newp)
 | 
			
		||||
{
 | 
			
		||||
	struct gre_cisco_protocol **proto = (struct gre_cisco_protocol **)
 | 
			
		||||
					    &gre_cisco_proto_list[newp->priority];
 | 
			
		||||
 | 
			
		||||
	return (cmpxchg(proto, NULL, newp) == NULL) ? 0 : -EBUSY;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL_GPL(gre_cisco_register);
 | 
			
		||||
 | 
			
		||||
int gre_cisco_unregister(struct gre_cisco_protocol *del_proto)
 | 
			
		||||
{
 | 
			
		||||
	struct gre_cisco_protocol **proto = (struct gre_cisco_protocol **)
 | 
			
		||||
					    &gre_cisco_proto_list[del_proto->priority];
 | 
			
		||||
	int ret;
 | 
			
		||||
 | 
			
		||||
	ret = (cmpxchg(proto, del_proto, NULL) == del_proto) ? 0 : -EINVAL;
 | 
			
		||||
 | 
			
		||||
	if (ret)
 | 
			
		||||
		return ret;
 | 
			
		||||
 | 
			
		||||
	synchronize_net();
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL_GPL(gre_cisco_unregister);
 | 
			
		||||
 | 
			
		||||
static int __init gre_init(void)
 | 
			
		||||
{
 | 
			
		||||
	pr_info("GRE over IPv4 demultiplexor driver\n");
 | 
			
		||||
 | 
			
		||||
	if (inet_add_protocol(&net_gre_protocol, IPPROTO_GRE) < 0) {
 | 
			
		||||
		pr_err("can't add protocol\n");
 | 
			
		||||
		return -EAGAIN;
 | 
			
		||||
		goto err;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (gre_add_protocol(&ipgre_protocol, GREPROTO_CISCO) < 0) {
 | 
			
		||||
		pr_info("%s: can't add ipgre handler\n", __func__);
 | 
			
		||||
		goto err_gre;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (inet_add_offload(&gre_offload, IPPROTO_GRE)) {
 | 
			
		||||
		pr_err("can't add protocol offload\n");
 | 
			
		||||
		inet_del_protocol(&net_gre_protocol, IPPROTO_GRE);
 | 
			
		||||
		return -EAGAIN;
 | 
			
		||||
		goto err_gso;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
err_gso:
 | 
			
		||||
	gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO);
 | 
			
		||||
err_gre:
 | 
			
		||||
	inet_del_protocol(&net_gre_protocol, IPPROTO_GRE);
 | 
			
		||||
err:
 | 
			
		||||
	return -EAGAIN;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void __exit gre_exit(void)
 | 
			
		||||
{
 | 
			
		||||
	inet_del_offload(&gre_offload, IPPROTO_GRE);
 | 
			
		||||
	gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO);
 | 
			
		||||
	inet_del_protocol(&net_gre_protocol, IPPROTO_GRE);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -236,4 +450,3 @@ module_exit(gre_exit);
 | 
			
		|||
MODULE_DESCRIPTION("GRE over IPv4 demultiplexer driver");
 | 
			
		||||
MODULE_AUTHOR("D. Kozlov (xeb@mail.ru)");
 | 
			
		||||
MODULE_LICENSE("GPL");
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -121,103 +121,8 @@ static int ipgre_tunnel_init(struct net_device *dev);
 | 
			
		|||
static int ipgre_net_id __read_mostly;
 | 
			
		||||
static int gre_tap_net_id __read_mostly;
 | 
			
		||||
 | 
			
		||||
static __sum16 check_checksum(struct sk_buff *skb)
 | 
			
		||||
{
 | 
			
		||||
	__sum16 csum = 0;
 | 
			
		||||
 | 
			
		||||
	switch (skb->ip_summed) {
 | 
			
		||||
	case CHECKSUM_COMPLETE:
 | 
			
		||||
		csum = csum_fold(skb->csum);
 | 
			
		||||
 | 
			
		||||
		if (!csum)
 | 
			
		||||
			break;
 | 
			
		||||
		/* Fall through. */
 | 
			
		||||
 | 
			
		||||
	case CHECKSUM_NONE:
 | 
			
		||||
		skb->csum = 0;
 | 
			
		||||
		csum = __skb_checksum_complete(skb);
 | 
			
		||||
		skb->ip_summed = CHECKSUM_COMPLETE;
 | 
			
		||||
		break;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return csum;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int ip_gre_calc_hlen(__be16 o_flags)
 | 
			
		||||
{
 | 
			
		||||
	int addend = 4;
 | 
			
		||||
 | 
			
		||||
	if (o_flags&TUNNEL_CSUM)
 | 
			
		||||
		addend += 4;
 | 
			
		||||
	if (o_flags&TUNNEL_KEY)
 | 
			
		||||
		addend += 4;
 | 
			
		||||
	if (o_flags&TUNNEL_SEQ)
 | 
			
		||||
		addend += 4;
 | 
			
		||||
	return addend;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int parse_gre_header(struct sk_buff *skb, struct tnl_ptk_info *tpi,
 | 
			
		||||
			    bool *csum_err, int *hdr_len)
 | 
			
		||||
{
 | 
			
		||||
	unsigned int ip_hlen = ip_hdrlen(skb);
 | 
			
		||||
	const struct gre_base_hdr *greh;
 | 
			
		||||
	__be32 *options;
 | 
			
		||||
 | 
			
		||||
	if (unlikely(!pskb_may_pull(skb, sizeof(struct gre_base_hdr))))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	greh = (struct gre_base_hdr *)(skb_network_header(skb) + ip_hlen);
 | 
			
		||||
	if (unlikely(greh->flags & (GRE_VERSION | GRE_ROUTING)))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	tpi->flags = gre_flags_to_tnl_flags(greh->flags);
 | 
			
		||||
	*hdr_len = ip_gre_calc_hlen(tpi->flags);
 | 
			
		||||
 | 
			
		||||
	if (!pskb_may_pull(skb, *hdr_len))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	greh = (struct gre_base_hdr *)(skb_network_header(skb) + ip_hlen);
 | 
			
		||||
 | 
			
		||||
	tpi->proto = greh->protocol;
 | 
			
		||||
 | 
			
		||||
	options = (__be32 *)(greh + 1);
 | 
			
		||||
	if (greh->flags & GRE_CSUM) {
 | 
			
		||||
		if (check_checksum(skb)) {
 | 
			
		||||
			*csum_err = true;
 | 
			
		||||
			return -EINVAL;
 | 
			
		||||
		}
 | 
			
		||||
		options++;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (greh->flags & GRE_KEY) {
 | 
			
		||||
		tpi->key = *options;
 | 
			
		||||
		options++;
 | 
			
		||||
	} else
 | 
			
		||||
		tpi->key = 0;
 | 
			
		||||
 | 
			
		||||
	if (unlikely(greh->flags & GRE_SEQ)) {
 | 
			
		||||
		tpi->seq = *options;
 | 
			
		||||
		options++;
 | 
			
		||||
	} else
 | 
			
		||||
		tpi->seq = 0;
 | 
			
		||||
 | 
			
		||||
	/* WCCP version 1 and 2 protocol decoding.
 | 
			
		||||
	 * - Change protocol to IP
 | 
			
		||||
	 * - When dealing with WCCPv2, Skip extra 4 bytes in GRE header
 | 
			
		||||
	 */
 | 
			
		||||
	if (greh->flags == 0 && tpi->proto == htons(ETH_P_WCCP)) {
 | 
			
		||||
		tpi->proto = htons(ETH_P_IP);
 | 
			
		||||
		if ((*(u8 *)options & 0xF0) != 0x40) {
 | 
			
		||||
			*hdr_len += 4;
 | 
			
		||||
			if (!pskb_may_pull(skb, *hdr_len))
 | 
			
		||||
				return -EINVAL;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void ipgre_err(struct sk_buff *skb, u32 info)
 | 
			
		||||
static int ipgre_err(struct sk_buff *skb, u32 info,
 | 
			
		||||
		     const struct tnl_ptk_info *tpi)
 | 
			
		||||
{
 | 
			
		||||
 | 
			
		||||
	/* All the routers (except for Linux) return only
 | 
			
		||||
| 
						 | 
				
			
			@ -239,26 +144,18 @@ static void ipgre_err(struct sk_buff *skb, u32 info)
 | 
			
		|||
	const int type = icmp_hdr(skb)->type;
 | 
			
		||||
	const int code = icmp_hdr(skb)->code;
 | 
			
		||||
	struct ip_tunnel *t;
 | 
			
		||||
	struct tnl_ptk_info tpi;
 | 
			
		||||
	int hdr_len;
 | 
			
		||||
	bool csum_err = false;
 | 
			
		||||
 | 
			
		||||
	if (parse_gre_header(skb, &tpi, &csum_err, &hdr_len)) {
 | 
			
		||||
		if (!csum_err)          /* ignore csum errors. */
 | 
			
		||||
			return;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	switch (type) {
 | 
			
		||||
	default:
 | 
			
		||||
	case ICMP_PARAMETERPROB:
 | 
			
		||||
		return;
 | 
			
		||||
		return PACKET_RCVD;
 | 
			
		||||
 | 
			
		||||
	case ICMP_DEST_UNREACH:
 | 
			
		||||
		switch (code) {
 | 
			
		||||
		case ICMP_SR_FAILED:
 | 
			
		||||
		case ICMP_PORT_UNREACH:
 | 
			
		||||
			/* Impossible event. */
 | 
			
		||||
			return;
 | 
			
		||||
			return PACKET_RCVD;
 | 
			
		||||
		default:
 | 
			
		||||
			/* All others are translated to HOST_UNREACH.
 | 
			
		||||
			   rfc2003 contains "deep thoughts" about NET_UNREACH,
 | 
			
		||||
| 
						 | 
				
			
			@ -269,79 +166,61 @@ static void ipgre_err(struct sk_buff *skb, u32 info)
 | 
			
		|||
		break;
 | 
			
		||||
	case ICMP_TIME_EXCEEDED:
 | 
			
		||||
		if (code != ICMP_EXC_TTL)
 | 
			
		||||
			return;
 | 
			
		||||
			return PACKET_RCVD;
 | 
			
		||||
		break;
 | 
			
		||||
 | 
			
		||||
	case ICMP_REDIRECT:
 | 
			
		||||
		break;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (tpi.proto == htons(ETH_P_TEB))
 | 
			
		||||
	if (tpi->proto == htons(ETH_P_TEB))
 | 
			
		||||
		itn = net_generic(net, gre_tap_net_id);
 | 
			
		||||
	else
 | 
			
		||||
		itn = net_generic(net, ipgre_net_id);
 | 
			
		||||
 | 
			
		||||
	iph = (const struct iphdr *)skb->data;
 | 
			
		||||
	t = ip_tunnel_lookup(itn, skb->dev->ifindex, tpi.flags,
 | 
			
		||||
			     iph->daddr, iph->saddr, tpi.key);
 | 
			
		||||
	t = ip_tunnel_lookup(itn, skb->dev->ifindex, tpi->flags,
 | 
			
		||||
			     iph->daddr, iph->saddr, tpi->key);
 | 
			
		||||
 | 
			
		||||
	if (t == NULL)
 | 
			
		||||
		return;
 | 
			
		||||
		return PACKET_REJECT;
 | 
			
		||||
 | 
			
		||||
	if (type == ICMP_DEST_UNREACH && code == ICMP_FRAG_NEEDED) {
 | 
			
		||||
		ipv4_update_pmtu(skb, dev_net(skb->dev), info,
 | 
			
		||||
				 t->parms.link, 0, IPPROTO_GRE, 0);
 | 
			
		||||
		return;
 | 
			
		||||
	}
 | 
			
		||||
	if (type == ICMP_REDIRECT) {
 | 
			
		||||
		ipv4_redirect(skb, dev_net(skb->dev), t->parms.link, 0,
 | 
			
		||||
			      IPPROTO_GRE, 0);
 | 
			
		||||
		return;
 | 
			
		||||
	}
 | 
			
		||||
	if (t->parms.iph.daddr == 0 ||
 | 
			
		||||
	    ipv4_is_multicast(t->parms.iph.daddr))
 | 
			
		||||
		return;
 | 
			
		||||
		return PACKET_RCVD;
 | 
			
		||||
 | 
			
		||||
	if (t->parms.iph.ttl == 0 && type == ICMP_TIME_EXCEEDED)
 | 
			
		||||
		return;
 | 
			
		||||
		return PACKET_RCVD;
 | 
			
		||||
 | 
			
		||||
	if (time_before(jiffies, t->err_time + IPTUNNEL_ERR_TIMEO))
 | 
			
		||||
		t->err_count++;
 | 
			
		||||
	else
 | 
			
		||||
		t->err_count = 1;
 | 
			
		||||
	t->err_time = jiffies;
 | 
			
		||||
	return PACKET_RCVD;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int ipgre_rcv(struct sk_buff *skb)
 | 
			
		||||
static int ipgre_rcv(struct sk_buff *skb, const struct tnl_ptk_info *tpi)
 | 
			
		||||
{
 | 
			
		||||
	struct net *net = dev_net(skb->dev);
 | 
			
		||||
	struct ip_tunnel_net *itn;
 | 
			
		||||
	const struct iphdr *iph;
 | 
			
		||||
	struct ip_tunnel *tunnel;
 | 
			
		||||
	struct tnl_ptk_info tpi;
 | 
			
		||||
	int hdr_len;
 | 
			
		||||
	bool csum_err = false;
 | 
			
		||||
 | 
			
		||||
	if (parse_gre_header(skb, &tpi, &csum_err, &hdr_len) < 0)
 | 
			
		||||
		goto drop;
 | 
			
		||||
 | 
			
		||||
	if (tpi.proto == htons(ETH_P_TEB))
 | 
			
		||||
	if (tpi->proto == htons(ETH_P_TEB))
 | 
			
		||||
		itn = net_generic(net, gre_tap_net_id);
 | 
			
		||||
	else
 | 
			
		||||
		itn = net_generic(net, ipgre_net_id);
 | 
			
		||||
 | 
			
		||||
	iph = ip_hdr(skb);
 | 
			
		||||
	tunnel = ip_tunnel_lookup(itn, skb->dev->ifindex, tpi.flags,
 | 
			
		||||
				  iph->saddr, iph->daddr, tpi.key);
 | 
			
		||||
	tunnel = ip_tunnel_lookup(itn, skb->dev->ifindex, tpi->flags,
 | 
			
		||||
				  iph->saddr, iph->daddr, tpi->key);
 | 
			
		||||
 | 
			
		||||
	if (tunnel) {
 | 
			
		||||
		ip_tunnel_rcv(tunnel, skb, &tpi, log_ecn_error);
 | 
			
		||||
		return 0;
 | 
			
		||||
		ip_tunnel_rcv(tunnel, skb, tpi, log_ecn_error);
 | 
			
		||||
		return PACKET_RCVD;
 | 
			
		||||
	}
 | 
			
		||||
	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
 | 
			
		||||
drop:
 | 
			
		||||
	kfree_skb(skb);
 | 
			
		||||
	return 0;
 | 
			
		||||
	return PACKET_REJECT;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static struct sk_buff *handle_offloads(struct ip_tunnel *tunnel, struct sk_buff *skb)
 | 
			
		||||
| 
						 | 
				
			
			@ -708,9 +587,10 @@ static int ipgre_tunnel_init(struct net_device *dev)
 | 
			
		|||
	return ip_tunnel_init(dev);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static const struct gre_protocol ipgre_protocol = {
 | 
			
		||||
	.handler     = ipgre_rcv,
 | 
			
		||||
	.err_handler = ipgre_err,
 | 
			
		||||
static struct gre_cisco_protocol ipgre_protocol = {
 | 
			
		||||
	.handler        = ipgre_rcv,
 | 
			
		||||
	.err_handler    = ipgre_err,
 | 
			
		||||
	.priority       = 0,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static int __net_init ipgre_init_net(struct net *net)
 | 
			
		||||
| 
						 | 
				
			
			@ -978,7 +858,7 @@ static int __init ipgre_init(void)
 | 
			
		|||
	if (err < 0)
 | 
			
		||||
		goto pnet_tap_faied;
 | 
			
		||||
 | 
			
		||||
	err = gre_add_protocol(&ipgre_protocol, GREPROTO_CISCO);
 | 
			
		||||
	err = gre_cisco_register(&ipgre_protocol);
 | 
			
		||||
	if (err < 0) {
 | 
			
		||||
		pr_info("%s: can't add protocol\n", __func__);
 | 
			
		||||
		goto add_proto_failed;
 | 
			
		||||
| 
						 | 
				
			
			@ -997,7 +877,7 @@ static int __init ipgre_init(void)
 | 
			
		|||
tap_ops_failed:
 | 
			
		||||
	rtnl_link_unregister(&ipgre_link_ops);
 | 
			
		||||
rtnl_link_failed:
 | 
			
		||||
	gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO);
 | 
			
		||||
	gre_cisco_unregister(&ipgre_protocol);
 | 
			
		||||
add_proto_failed:
 | 
			
		||||
	unregister_pernet_device(&ipgre_tap_net_ops);
 | 
			
		||||
pnet_tap_faied:
 | 
			
		||||
| 
						 | 
				
			
			@ -1009,8 +889,7 @@ static void __exit ipgre_fini(void)
 | 
			
		|||
{
 | 
			
		||||
	rtnl_link_unregister(&ipgre_tap_ops);
 | 
			
		||||
	rtnl_link_unregister(&ipgre_link_ops);
 | 
			
		||||
	if (gre_del_protocol(&ipgre_protocol, GREPROTO_CISCO) < 0)
 | 
			
		||||
		pr_info("%s: can't remove protocol\n", __func__);
 | 
			
		||||
	gre_cisco_unregister(&ipgre_protocol);
 | 
			
		||||
	unregister_pernet_device(&ipgre_tap_net_ops);
 | 
			
		||||
	unregister_pernet_device(&ipgre_net_ops);
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
		Reference in a new issue