| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * xfrm6_output.c - Common IPsec encapsulation code for IPv6. | 
					
						
							|  |  |  |  * Copyright (C) 2002 USAGI/WIDE Project | 
					
						
							|  |  |  |  * Copyright (c) 2004 Herbert Xu <herbert@gondor.apana.org.au> | 
					
						
							| 
									
										
										
										
											2007-02-09 23:24:49 +09:00
										 |  |  |  * | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  * This program is free software; you can redistribute it and/or | 
					
						
							|  |  |  |  * modify it under the terms of the GNU General Public License | 
					
						
							|  |  |  |  * as published by the Free Software Foundation; either version | 
					
						
							|  |  |  |  * 2 of the License, or (at your option) any later version. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-08 17:16:30 -07:00
										 |  |  | #include <linux/if_ether.h>
 | 
					
						
							| 
									
										
										
										
											2007-11-13 21:40:52 -08:00
										 |  |  | #include <linux/kernel.h>
 | 
					
						
							|  |  |  | #include <linux/module.h>
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #include <linux/skbuff.h>
 | 
					
						
							|  |  |  | #include <linux/icmpv6.h>
 | 
					
						
							| 
									
										
										
										
											2006-01-06 23:01:48 -08:00
										 |  |  | #include <linux/netfilter_ipv6.h>
 | 
					
						
							| 
									
										
										
										
											2007-11-13 21:40:52 -08:00
										 |  |  | #include <net/dst.h>
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #include <net/ipv6.h>
 | 
					
						
							| 
									
										
										
										
											2010-12-17 11:42:42 +00:00
										 |  |  | #include <net/ip6_route.h>
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #include <net/xfrm.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-08-23 17:57:28 -07:00
										 |  |  | int xfrm6_find_1stfragopt(struct xfrm_state *x, struct sk_buff *skb, | 
					
						
							|  |  |  | 			  u8 **prevhdr) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	return ip6_find_1stfragopt(skb, prevhdr); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-02-22 22:05:40 +09:00
										 |  |  | EXPORT_SYMBOL(xfrm6_find_1stfragopt); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | static int xfrm6_local_dontfrag(struct sk_buff *skb) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int proto; | 
					
						
							|  |  |  | 	struct sock *sk = skb->sk; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (sk) { | 
					
						
							| 
									
										
										
										
											2013-08-14 13:05:23 +02:00
										 |  |  | 		if (sk->sk_family != AF_INET6) | 
					
						
							|  |  |  | 			return 0; | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-08-14 13:05:23 +02:00
										 |  |  | 		proto = sk->sk_protocol; | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 		if (proto == IPPROTO_UDP || proto == IPPROTO_RAW) | 
					
						
							|  |  |  | 			return inet6_sk(sk)->dontfrag; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void xfrm6_local_rxpmtu(struct sk_buff *skb, u32 mtu) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct flowi6 fl6; | 
					
						
							|  |  |  | 	struct sock *sk = skb->sk; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	fl6.flowi6_oif = sk->sk_bound_dev_if; | 
					
						
							| 
									
										
										
										
											2011-11-21 03:39:03 +00:00
										 |  |  | 	fl6.daddr = ipv6_hdr(skb)->daddr; | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	ipv6_local_rxpmtu(sk, &fl6, mtu); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-08-14 13:05:23 +02:00
										 |  |  | void xfrm6_local_error(struct sk_buff *skb, u32 mtu) | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct flowi6 fl6; | 
					
						
							| 
									
										
										
										
											2013-08-18 13:46:57 +02:00
										 |  |  | 	const struct ipv6hdr *hdr; | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 	struct sock *sk = skb->sk; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-08-18 13:46:57 +02:00
										 |  |  | 	hdr = skb->encapsulation ? inner_ipv6_hdr(skb) : ipv6_hdr(skb); | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 	fl6.fl6_dport = inet_sk(sk)->inet_dport; | 
					
						
							| 
									
										
										
										
											2013-08-18 13:46:57 +02:00
										 |  |  | 	fl6.daddr = hdr->daddr; | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	ipv6_local_error(sk, EMSGSIZE, &fl6, mtu); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | static int xfrm6_tunnel_check_size(struct sk_buff *skb) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int mtu, ret = 0; | 
					
						
							| 
									
										
										
										
											2009-06-02 05:19:30 +00:00
										 |  |  | 	struct dst_entry *dst = skb_dst(skb); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	mtu = dst_mtu(dst); | 
					
						
							|  |  |  | 	if (mtu < IPV6_MIN_MTU) | 
					
						
							|  |  |  | 		mtu = IPV6_MIN_MTU; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-02-12 18:07:27 -08:00
										 |  |  | 	if (!skb->local_df && skb->len > mtu) { | 
					
						
							| 
									
										
										
										
											2005-05-23 13:11:07 -07:00
										 |  |  | 		skb->dev = dst->dev; | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		if (xfrm6_local_dontfrag(skb)) | 
					
						
							|  |  |  | 			xfrm6_local_rxpmtu(skb, mtu); | 
					
						
							|  |  |  | 		else if (skb->sk) | 
					
						
							| 
									
										
										
										
											2013-08-14 13:05:23 +02:00
										 |  |  | 			xfrm_local_error(skb, mtu); | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 		else | 
					
						
							|  |  |  | 			icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu); | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		ret = -EMSGSIZE; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-11-13 21:40:52 -08:00
										 |  |  | int xfrm6_extract_output(struct xfrm_state *x, struct sk_buff *skb) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int err; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	err = xfrm6_tunnel_check_size(skb); | 
					
						
							|  |  |  | 	if (err) | 
					
						
							|  |  |  | 		return err; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-11-19 18:47:58 -08:00
										 |  |  | 	XFRM_MODE_SKB_CB(skb)->protocol = ipv6_hdr(skb)->nexthdr; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-11-13 21:40:52 -08:00
										 |  |  | 	return xfrm6_extract_header(skb); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | int xfrm6_prepare_output(struct xfrm_state *x, struct sk_buff *skb) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int err; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-03-24 14:51:51 -07:00
										 |  |  | 	err = xfrm_inner_extract_output(x, skb); | 
					
						
							| 
									
										
										
										
											2007-11-13 21:40:52 -08:00
										 |  |  | 	if (err) | 
					
						
							|  |  |  | 		return err; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	memset(IP6CB(skb), 0, sizeof(*IP6CB(skb))); | 
					
						
							| 
									
										
										
										
											2007-11-13 21:43:11 -08:00
										 |  |  | #ifdef CONFIG_NETFILTER
 | 
					
						
							|  |  |  | 	IP6CB(skb)->flags |= IP6SKB_XFRM_TRANSFORMED; | 
					
						
							|  |  |  | #endif
 | 
					
						
							| 
									
										
										
										
											2007-11-13 21:40:52 -08:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	skb->protocol = htons(ETH_P_IPV6); | 
					
						
							| 
									
										
										
										
											2009-04-06 03:58:50 +00:00
										 |  |  | 	skb->local_df = 1; | 
					
						
							| 
									
										
										
										
											2007-11-13 21:40:52 -08:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return x->outer_mode->output2(x, skb); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | EXPORT_SYMBOL(xfrm6_prepare_output); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-05-09 19:36:38 +00:00
										 |  |  | int xfrm6_output_finish(struct sk_buff *skb) | 
					
						
							| 
									
										
										
										
											2006-06-22 03:08:03 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2007-11-13 21:43:11 -08:00
										 |  |  | #ifdef CONFIG_NETFILTER
 | 
					
						
							|  |  |  | 	IP6CB(skb)->flags |= IP6SKB_XFRM_TRANSFORMED; | 
					
						
							|  |  |  | #endif
 | 
					
						
							| 
									
										
										
										
											2006-06-22 03:08:03 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-07-30 20:19:11 -07:00
										 |  |  | 	skb->protocol = htons(ETH_P_IPV6); | 
					
						
							| 
									
										
										
										
											2007-11-13 21:43:11 -08:00
										 |  |  | 	return xfrm_output(skb); | 
					
						
							| 
									
										
										
										
											2006-06-22 03:08:03 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-12-17 11:42:42 +00:00
										 |  |  | static int __xfrm6_output(struct sk_buff *skb) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct dst_entry *dst = skb_dst(skb); | 
					
						
							|  |  |  | 	struct xfrm_state *x = dst->xfrm; | 
					
						
							| 
									
										
										
										
											2013-08-26 12:31:19 +02:00
										 |  |  | 	int mtu; | 
					
						
							| 
									
										
										
										
											2013-08-13 04:35:58 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-08-26 12:31:19 +02:00
										 |  |  | 	if (skb->protocol == htons(ETH_P_IPV6)) | 
					
						
							|  |  |  | 		mtu = ip6_skb_dst_mtu(skb); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		mtu = dst_mtu(skb_dst(skb)); | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	if (skb->len > mtu && xfrm6_local_dontfrag(skb)) { | 
					
						
							|  |  |  | 		xfrm6_local_rxpmtu(skb, mtu); | 
					
						
							|  |  |  | 		return -EMSGSIZE; | 
					
						
							|  |  |  | 	} else if (!skb->local_df && skb->len > mtu && skb->sk) { | 
					
						
							| 
									
										
										
										
											2013-08-14 13:05:23 +02:00
										 |  |  | 		xfrm_local_error(skb, mtu); | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 		return -EMSGSIZE; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2010-12-17 11:42:42 +00:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-01-31 21:45:26 +00:00
										 |  |  | 	if (x->props.mode == XFRM_MODE_TUNNEL && | 
					
						
							| 
									
										
										
										
											2011-10-11 01:44:30 +00:00
										 |  |  | 	    ((skb->len > mtu && !skb_is_gso(skb)) || | 
					
						
							| 
									
										
										
										
											2010-12-17 11:42:42 +00:00
										 |  |  | 		dst_allfrag(skb_dst(skb)))) { | 
					
						
							| 
									
										
										
										
											2011-05-09 19:36:38 +00:00
										 |  |  | 			return ip6_fragment(skb, x->outer_mode->afinfo->output_finish); | 
					
						
							| 
									
										
										
										
											2010-12-17 11:42:42 +00:00
										 |  |  | 	} | 
					
						
							| 
									
										
										
										
											2011-05-09 19:36:38 +00:00
										 |  |  | 	return x->outer_mode->afinfo->output_finish(skb); | 
					
						
							| 
									
										
										
										
											2010-12-17 11:42:42 +00:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-01-06 23:01:48 -08:00
										 |  |  | int xfrm6_output(struct sk_buff *skb) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2010-03-23 04:09:07 +01:00
										 |  |  | 	return NF_HOOK(NFPROTO_IPV6, NF_INET_POST_ROUTING, skb, NULL, | 
					
						
							| 
									
										
										
										
											2010-12-17 11:42:42 +00:00
										 |  |  | 		       skb_dst(skb)->dev, __xfrm6_output); | 
					
						
							| 
									
										
										
										
											2006-01-06 23:01:48 -08:00
										 |  |  | } |