2005-08-10 10:39:00 +08:00
|
|
|
#include <linux/kernel.h>
|
2006-01-10 08:43:13 +08:00
|
|
|
#include <linux/init.h>
|
2005-08-10 10:39:00 +08:00
|
|
|
#include <linux/ipv6.h>
|
2005-08-10 10:42:34 +08:00
|
|
|
#include <linux/netfilter.h>
|
|
|
|
#include <linux/netfilter_ipv6.h>
|
2011-07-15 23:47:34 +08:00
|
|
|
#include <linux/export.h>
|
2005-08-10 10:39:00 +08:00
|
|
|
#include <net/dst.h>
|
|
|
|
#include <net/ipv6.h>
|
|
|
|
#include <net/ip6_route.h>
|
2006-01-07 15:04:54 +08:00
|
|
|
#include <net/xfrm.h>
|
2006-04-08 06:00:06 +08:00
|
|
|
#include <net/ip6_checksum.h>
|
2007-12-05 17:24:48 +08:00
|
|
|
#include <net/netfilter/nf_queue.h>
|
2005-08-10 10:39:00 +08:00
|
|
|
|
|
|
|
int ip6_route_me_harder(struct sk_buff *skb)
|
|
|
|
{
|
2009-06-02 13:19:30 +08:00
|
|
|
struct net *net = dev_net(skb_dst(skb)->dev);
|
2011-04-22 12:53:02 +08:00
|
|
|
const struct ipv6hdr *iph = ipv6_hdr(skb);
|
2012-08-27 01:14:08 +08:00
|
|
|
unsigned int hh_len;
|
2005-08-10 10:39:00 +08:00
|
|
|
struct dst_entry *dst;
|
2011-03-13 05:22:43 +08:00
|
|
|
struct flowi6 fl6 = {
|
|
|
|
.flowi6_oif = skb->sk ? skb->sk->sk_bound_dev_if : 0,
|
|
|
|
.flowi6_mark = skb->mark,
|
|
|
|
.daddr = iph->daddr,
|
|
|
|
.saddr = iph->saddr,
|
2005-08-10 10:39:00 +08:00
|
|
|
};
|
|
|
|
|
2011-03-13 05:22:43 +08:00
|
|
|
dst = ip6_route_output(net, skb->sk, &fl6);
|
2005-08-10 10:39:00 +08:00
|
|
|
if (dst->error) {
|
2008-10-15 13:55:21 +08:00
|
|
|
IP6_INC_STATS(net, ip6_dst_idev(dst), IPSTATS_MIB_OUTNOROUTES);
|
2005-08-10 11:50:53 +08:00
|
|
|
LIMIT_NETDEBUG(KERN_DEBUG "ip6_route_me_harder: No more route.\n");
|
2005-08-10 10:39:00 +08:00
|
|
|
dst_release(dst);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Drop old route. */
|
2009-06-02 13:19:30 +08:00
|
|
|
skb_dst_drop(skb);
|
2005-08-10 10:39:00 +08:00
|
|
|
|
2009-06-02 13:19:30 +08:00
|
|
|
skb_dst_set(skb, dst);
|
2010-04-15 18:37:18 +08:00
|
|
|
|
|
|
|
#ifdef CONFIG_XFRM
|
|
|
|
if (!(IP6CB(skb)->flags & IP6SKB_XFRM_TRANSFORMED) &&
|
2011-03-13 05:22:43 +08:00
|
|
|
xfrm_decode_session(skb, flowi6_to_flowi(&fl6), AF_INET6) == 0) {
|
2010-04-15 18:37:18 +08:00
|
|
|
skb_dst_set(skb, NULL);
|
2011-03-13 05:22:43 +08:00
|
|
|
dst = xfrm_lookup(net, dst, flowi6_to_flowi(&fl6), skb->sk, 0);
|
2011-03-03 05:27:41 +08:00
|
|
|
if (IS_ERR(dst))
|
2010-04-15 18:37:18 +08:00
|
|
|
return -1;
|
|
|
|
skb_dst_set(skb, dst);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2012-08-27 01:14:08 +08:00
|
|
|
/* Change in oif may mean change in hh_len. */
|
|
|
|
hh_len = skb_dst(skb)->dev->hard_header_len;
|
|
|
|
if (skb_headroom(skb) < hh_len &&
|
|
|
|
pskb_expand_head(skb, HH_DATA_ALIGN(hh_len - skb_headroom(skb)),
|
|
|
|
0, GFP_ATOMIC))
|
|
|
|
return -1;
|
|
|
|
|
2005-08-10 10:39:00 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(ip6_route_me_harder);
|
|
|
|
|
2005-08-10 10:42:34 +08:00
|
|
|
/*
|
|
|
|
* Extra routing may needed on local out, as the QUEUE target never
|
|
|
|
* returns control to the table.
|
|
|
|
*/
|
|
|
|
|
|
|
|
struct ip6_rt_info {
|
|
|
|
struct in6_addr daddr;
|
|
|
|
struct in6_addr saddr;
|
2008-11-25 19:18:11 +08:00
|
|
|
u_int32_t mark;
|
2005-08-10 10:42:34 +08:00
|
|
|
};
|
|
|
|
|
2007-12-05 17:26:33 +08:00
|
|
|
static void nf_ip6_saveroute(const struct sk_buff *skb,
|
|
|
|
struct nf_queue_entry *entry)
|
2005-08-10 10:42:34 +08:00
|
|
|
{
|
2007-12-05 17:26:33 +08:00
|
|
|
struct ip6_rt_info *rt_info = nf_queue_entry_reroute(entry);
|
2005-08-10 10:42:34 +08:00
|
|
|
|
2007-12-05 17:26:33 +08:00
|
|
|
if (entry->hook == NF_INET_LOCAL_OUT) {
|
2011-04-22 12:53:02 +08:00
|
|
|
const struct ipv6hdr *iph = ipv6_hdr(skb);
|
2005-08-10 10:42:34 +08:00
|
|
|
|
|
|
|
rt_info->daddr = iph->daddr;
|
|
|
|
rt_info->saddr = iph->saddr;
|
2008-11-25 19:18:11 +08:00
|
|
|
rt_info->mark = skb->mark;
|
2005-08-10 10:42:34 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2007-12-05 17:26:33 +08:00
|
|
|
static int nf_ip6_reroute(struct sk_buff *skb,
|
|
|
|
const struct nf_queue_entry *entry)
|
2005-08-10 10:42:34 +08:00
|
|
|
{
|
2007-12-05 17:26:33 +08:00
|
|
|
struct ip6_rt_info *rt_info = nf_queue_entry_reroute(entry);
|
2005-08-10 10:42:34 +08:00
|
|
|
|
2007-12-05 17:26:33 +08:00
|
|
|
if (entry->hook == NF_INET_LOCAL_OUT) {
|
2011-04-22 12:53:02 +08:00
|
|
|
const struct ipv6hdr *iph = ipv6_hdr(skb);
|
2005-08-10 10:42:34 +08:00
|
|
|
if (!ipv6_addr_equal(&iph->daddr, &rt_info->daddr) ||
|
2008-11-25 19:18:11 +08:00
|
|
|
!ipv6_addr_equal(&iph->saddr, &rt_info->saddr) ||
|
|
|
|
skb->mark != rt_info->mark)
|
2007-10-15 15:53:15 +08:00
|
|
|
return ip6_route_me_harder(skb);
|
2005-08-10 10:42:34 +08:00
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-04-04 22:56:29 +08:00
|
|
|
static int nf_ip6_route(struct net *net, struct dst_entry **dst,
|
2011-04-04 23:00:54 +08:00
|
|
|
struct flowi *fl, bool strict)
|
2007-12-05 17:22:05 +08:00
|
|
|
{
|
2011-04-04 23:00:54 +08:00
|
|
|
static const struct ipv6_pinfo fake_pinfo;
|
|
|
|
static const struct inet_sock fake_sk = {
|
|
|
|
/* makes ip6_route_output set RT6_LOOKUP_F_IFACE: */
|
|
|
|
.sk.sk_bound_dev_if = 1,
|
|
|
|
.pinet6 = (struct ipv6_pinfo *) &fake_pinfo,
|
|
|
|
};
|
|
|
|
const void *sk = strict ? &fake_sk : NULL;
|
2011-10-19 19:23:06 +08:00
|
|
|
struct dst_entry *result;
|
|
|
|
int err;
|
|
|
|
|
|
|
|
result = ip6_route_output(net, sk, &fl->u.ip6);
|
|
|
|
err = result->error;
|
|
|
|
if (err)
|
|
|
|
dst_release(result);
|
|
|
|
else
|
|
|
|
*dst = result;
|
|
|
|
return err;
|
2007-12-05 17:22:05 +08:00
|
|
|
}
|
|
|
|
|
2006-11-15 13:40:42 +08:00
|
|
|
__sum16 nf_ip6_checksum(struct sk_buff *skb, unsigned int hook,
|
2006-04-07 05:18:43 +08:00
|
|
|
unsigned int dataoff, u_int8_t protocol)
|
|
|
|
{
|
2011-04-22 12:53:02 +08:00
|
|
|
const struct ipv6hdr *ip6h = ipv6_hdr(skb);
|
2006-11-15 13:40:42 +08:00
|
|
|
__sum16 csum = 0;
|
2006-04-07 05:18:43 +08:00
|
|
|
|
|
|
|
switch (skb->ip_summed) {
|
2006-08-30 07:44:56 +08:00
|
|
|
case CHECKSUM_COMPLETE:
|
2007-11-20 10:53:30 +08:00
|
|
|
if (hook != NF_INET_PRE_ROUTING && hook != NF_INET_LOCAL_IN)
|
2006-04-07 05:18:43 +08:00
|
|
|
break;
|
|
|
|
if (!csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr,
|
2007-02-09 22:24:49 +08:00
|
|
|
skb->len - dataoff, protocol,
|
2006-04-07 05:18:43 +08:00
|
|
|
csum_sub(skb->csum,
|
|
|
|
skb_checksum(skb, 0,
|
|
|
|
dataoff, 0)))) {
|
|
|
|
skb->ip_summed = CHECKSUM_UNNECESSARY;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
/* fall through */
|
|
|
|
case CHECKSUM_NONE:
|
2006-11-15 13:35:48 +08:00
|
|
|
skb->csum = ~csum_unfold(
|
|
|
|
csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr,
|
2006-04-07 05:18:43 +08:00
|
|
|
skb->len - dataoff,
|
|
|
|
protocol,
|
|
|
|
csum_sub(0,
|
|
|
|
skb_checksum(skb, 0,
|
2007-02-09 22:24:49 +08:00
|
|
|
dataoff, 0))));
|
2006-04-07 05:18:43 +08:00
|
|
|
csum = __skb_checksum_complete(skb);
|
|
|
|
}
|
|
|
|
return csum;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(nf_ip6_checksum);
|
|
|
|
|
2008-03-20 22:15:53 +08:00
|
|
|
static __sum16 nf_ip6_checksum_partial(struct sk_buff *skb, unsigned int hook,
|
|
|
|
unsigned int dataoff, unsigned int len,
|
|
|
|
u_int8_t protocol)
|
|
|
|
{
|
2011-04-22 12:53:02 +08:00
|
|
|
const struct ipv6hdr *ip6h = ipv6_hdr(skb);
|
2008-03-20 22:15:53 +08:00
|
|
|
__wsum hsum;
|
|
|
|
__sum16 csum = 0;
|
|
|
|
|
|
|
|
switch (skb->ip_summed) {
|
|
|
|
case CHECKSUM_COMPLETE:
|
|
|
|
if (len == skb->len - dataoff)
|
|
|
|
return nf_ip6_checksum(skb, hook, dataoff, protocol);
|
|
|
|
/* fall through */
|
|
|
|
case CHECKSUM_NONE:
|
|
|
|
hsum = skb_checksum(skb, 0, dataoff, 0);
|
|
|
|
skb->csum = ~csum_unfold(csum_ipv6_magic(&ip6h->saddr,
|
|
|
|
&ip6h->daddr,
|
|
|
|
skb->len - dataoff,
|
|
|
|
protocol,
|
|
|
|
csum_sub(0, hsum)));
|
|
|
|
skb->ip_summed = CHECKSUM_NONE;
|
2010-06-14 22:20:02 +08:00
|
|
|
return __skb_checksum_complete_head(skb, dataoff + len);
|
2008-03-20 22:15:53 +08:00
|
|
|
}
|
|
|
|
return csum;
|
|
|
|
};
|
|
|
|
|
2007-12-18 14:42:27 +08:00
|
|
|
static const struct nf_afinfo nf_ip6_afinfo = {
|
2008-03-20 22:15:53 +08:00
|
|
|
.family = AF_INET6,
|
|
|
|
.checksum = nf_ip6_checksum,
|
|
|
|
.checksum_partial = nf_ip6_checksum_partial,
|
|
|
|
.route = nf_ip6_route,
|
|
|
|
.saveroute = nf_ip6_saveroute,
|
|
|
|
.reroute = nf_ip6_reroute,
|
|
|
|
.route_key_size = sizeof(struct ip6_rt_info),
|
2005-08-10 10:42:34 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
int __init ipv6_netfilter_init(void)
|
|
|
|
{
|
2006-04-07 05:18:09 +08:00
|
|
|
return nf_register_afinfo(&nf_ip6_afinfo);
|
2005-08-10 10:42:34 +08:00
|
|
|
}
|
|
|
|
|
2006-01-11 13:02:21 +08:00
|
|
|
/* This can be called from inet6_init() on errors, so it cannot
|
|
|
|
* be marked __exit. -DaveM
|
|
|
|
*/
|
|
|
|
void ipv6_netfilter_fini(void)
|
2005-08-10 10:42:34 +08:00
|
|
|
{
|
2006-04-07 05:18:09 +08:00
|
|
|
nf_unregister_afinfo(&nf_ip6_afinfo);
|
2005-08-10 10:42:34 +08:00
|
|
|
}
|