Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 1 | #include <linux/kernel.h> |
Patrick McHardy | bb94aa1 | 2006-01-09 16:43:13 -0800 | [diff] [blame] | 2 | #include <linux/init.h> |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 3 | #include <linux/ipv6.h> |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 4 | #include <linux/netfilter.h> |
| 5 | #include <linux/netfilter_ipv6.h> |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 6 | #include <net/dst.h> |
| 7 | #include <net/ipv6.h> |
| 8 | #include <net/ip6_route.h> |
Patrick McHardy | 3e3850e | 2006-01-06 23:04:54 -0800 | [diff] [blame] | 9 | #include <net/xfrm.h> |
Brian Haley | 503e4fa | 2006-04-07 15:00:06 -0700 | [diff] [blame] | 10 | #include <net/ip6_checksum.h> |
Patrick McHardy | c01cd42 | 2007-12-05 01:24:48 -0800 | [diff] [blame] | 11 | #include <net/netfilter/nf_queue.h> |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 12 | |
| 13 | int ip6_route_me_harder(struct sk_buff *skb) |
| 14 | { |
Eric Dumazet | adf3090 | 2009-06-02 05:19:30 +0000 | [diff] [blame] | 15 | struct net *net = dev_net(skb_dst(skb)->dev); |
Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 16 | const struct ipv6hdr *iph = ipv6_hdr(skb); |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 17 | struct dst_entry *dst; |
David S. Miller | 4c9483b | 2011-03-12 16:22:43 -0500 | [diff] [blame] | 18 | struct flowi6 fl6 = { |
| 19 | .flowi6_oif = skb->sk ? skb->sk->sk_bound_dev_if : 0, |
| 20 | .flowi6_mark = skb->mark, |
| 21 | .daddr = iph->daddr, |
| 22 | .saddr = iph->saddr, |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 23 | }; |
| 24 | |
David S. Miller | 4c9483b | 2011-03-12 16:22:43 -0500 | [diff] [blame] | 25 | dst = ip6_route_output(net, skb->sk, &fl6); |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 26 | if (dst->error) { |
Alexey Dobriyan | eef9d90 | 2008-10-14 22:55:21 -0700 | [diff] [blame] | 27 | IP6_INC_STATS(net, ip6_dst_idev(dst), IPSTATS_MIB_OUTNOROUTES); |
Patrick McHardy | 64ce207 | 2005-08-09 20:50:53 -0700 | [diff] [blame] | 28 | LIMIT_NETDEBUG(KERN_DEBUG "ip6_route_me_harder: No more route.\n"); |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 29 | dst_release(dst); |
| 30 | return -EINVAL; |
| 31 | } |
| 32 | |
| 33 | /* Drop old route. */ |
Eric Dumazet | adf3090 | 2009-06-02 05:19:30 +0000 | [diff] [blame] | 34 | skb_dst_drop(skb); |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 35 | |
Eric Dumazet | adf3090 | 2009-06-02 05:19:30 +0000 | [diff] [blame] | 36 | skb_dst_set(skb, dst); |
Ulrich Weber | 90348e0 | 2010-04-15 12:37:18 +0200 | [diff] [blame] | 37 | |
| 38 | #ifdef CONFIG_XFRM |
| 39 | if (!(IP6CB(skb)->flags & IP6SKB_XFRM_TRANSFORMED) && |
David S. Miller | 4c9483b | 2011-03-12 16:22:43 -0500 | [diff] [blame] | 40 | xfrm_decode_session(skb, flowi6_to_flowi(&fl6), AF_INET6) == 0) { |
Ulrich Weber | 90348e0 | 2010-04-15 12:37:18 +0200 | [diff] [blame] | 41 | skb_dst_set(skb, NULL); |
David S. Miller | 4c9483b | 2011-03-12 16:22:43 -0500 | [diff] [blame] | 42 | dst = xfrm_lookup(net, dst, flowi6_to_flowi(&fl6), skb->sk, 0); |
David S. Miller | 452edd5 | 2011-03-02 13:27:41 -0800 | [diff] [blame] | 43 | if (IS_ERR(dst)) |
Ulrich Weber | 90348e0 | 2010-04-15 12:37:18 +0200 | [diff] [blame] | 44 | return -1; |
| 45 | skb_dst_set(skb, dst); |
| 46 | } |
| 47 | #endif |
| 48 | |
Harald Welte | 020b4c1 | 2005-08-09 19:39:00 -0700 | [diff] [blame] | 49 | return 0; |
| 50 | } |
| 51 | EXPORT_SYMBOL(ip6_route_me_harder); |
| 52 | |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 53 | /* |
| 54 | * Extra routing may needed on local out, as the QUEUE target never |
| 55 | * returns control to the table. |
| 56 | */ |
| 57 | |
| 58 | struct ip6_rt_info { |
| 59 | struct in6_addr daddr; |
| 60 | struct in6_addr saddr; |
Eric Leblond | 9f40ac7 | 2008-11-25 12:18:11 +0100 | [diff] [blame] | 61 | u_int32_t mark; |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 62 | }; |
| 63 | |
Patrick McHardy | 02f014d | 2007-12-05 01:26:33 -0800 | [diff] [blame] | 64 | static void nf_ip6_saveroute(const struct sk_buff *skb, |
| 65 | struct nf_queue_entry *entry) |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 66 | { |
Patrick McHardy | 02f014d | 2007-12-05 01:26:33 -0800 | [diff] [blame] | 67 | struct ip6_rt_info *rt_info = nf_queue_entry_reroute(entry); |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 68 | |
Patrick McHardy | 02f014d | 2007-12-05 01:26:33 -0800 | [diff] [blame] | 69 | if (entry->hook == NF_INET_LOCAL_OUT) { |
Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 70 | const struct ipv6hdr *iph = ipv6_hdr(skb); |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 71 | |
| 72 | rt_info->daddr = iph->daddr; |
| 73 | rt_info->saddr = iph->saddr; |
Eric Leblond | 9f40ac7 | 2008-11-25 12:18:11 +0100 | [diff] [blame] | 74 | rt_info->mark = skb->mark; |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 75 | } |
| 76 | } |
| 77 | |
Patrick McHardy | 02f014d | 2007-12-05 01:26:33 -0800 | [diff] [blame] | 78 | static int nf_ip6_reroute(struct sk_buff *skb, |
| 79 | const struct nf_queue_entry *entry) |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 80 | { |
Patrick McHardy | 02f014d | 2007-12-05 01:26:33 -0800 | [diff] [blame] | 81 | struct ip6_rt_info *rt_info = nf_queue_entry_reroute(entry); |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 82 | |
Patrick McHardy | 02f014d | 2007-12-05 01:26:33 -0800 | [diff] [blame] | 83 | if (entry->hook == NF_INET_LOCAL_OUT) { |
Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 84 | const struct ipv6hdr *iph = ipv6_hdr(skb); |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 85 | if (!ipv6_addr_equal(&iph->daddr, &rt_info->daddr) || |
Eric Leblond | 9f40ac7 | 2008-11-25 12:18:11 +0100 | [diff] [blame] | 86 | !ipv6_addr_equal(&iph->saddr, &rt_info->saddr) || |
| 87 | skb->mark != rt_info->mark) |
Herbert Xu | 3db05fea | 2007-10-15 00:53:15 -0700 | [diff] [blame] | 88 | return ip6_route_me_harder(skb); |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 89 | } |
| 90 | return 0; |
| 91 | } |
| 92 | |
Florian Westphal | 31ad3dd | 2011-04-04 16:56:29 +0200 | [diff] [blame] | 93 | static int nf_ip6_route(struct net *net, struct dst_entry **dst, |
Florian Westphal | 0fae2e7 | 2011-04-04 17:00:54 +0200 | [diff] [blame] | 94 | struct flowi *fl, bool strict) |
Patrick McHardy | 1841a4c | 2007-12-05 01:22:05 -0800 | [diff] [blame] | 95 | { |
Florian Westphal | 0fae2e7 | 2011-04-04 17:00:54 +0200 | [diff] [blame] | 96 | static const struct ipv6_pinfo fake_pinfo; |
| 97 | static const struct inet_sock fake_sk = { |
| 98 | /* makes ip6_route_output set RT6_LOOKUP_F_IFACE: */ |
| 99 | .sk.sk_bound_dev_if = 1, |
| 100 | .pinet6 = (struct ipv6_pinfo *) &fake_pinfo, |
| 101 | }; |
| 102 | const void *sk = strict ? &fake_sk : NULL; |
| 103 | |
| 104 | *dst = ip6_route_output(net, sk, &fl->u.ip6); |
Patrick McHardy | 1841a4c | 2007-12-05 01:22:05 -0800 | [diff] [blame] | 105 | return (*dst)->error; |
| 106 | } |
| 107 | |
Al Viro | b51655b | 2006-11-14 21:40:42 -0800 | [diff] [blame] | 108 | __sum16 nf_ip6_checksum(struct sk_buff *skb, unsigned int hook, |
Patrick McHardy | 422c346 | 2006-04-06 14:18:43 -0700 | [diff] [blame] | 109 | unsigned int dataoff, u_int8_t protocol) |
| 110 | { |
Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 111 | const struct ipv6hdr *ip6h = ipv6_hdr(skb); |
Al Viro | b51655b | 2006-11-14 21:40:42 -0800 | [diff] [blame] | 112 | __sum16 csum = 0; |
Patrick McHardy | 422c346 | 2006-04-06 14:18:43 -0700 | [diff] [blame] | 113 | |
| 114 | switch (skb->ip_summed) { |
Patrick McHardy | 84fa793 | 2006-08-29 16:44:56 -0700 | [diff] [blame] | 115 | case CHECKSUM_COMPLETE: |
Patrick McHardy | 6e23ae2 | 2007-11-19 18:53:30 -0800 | [diff] [blame] | 116 | if (hook != NF_INET_PRE_ROUTING && hook != NF_INET_LOCAL_IN) |
Patrick McHardy | 422c346 | 2006-04-06 14:18:43 -0700 | [diff] [blame] | 117 | break; |
| 118 | if (!csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, |
YOSHIFUJI Hideaki | 1ab1457 | 2007-02-09 23:24:49 +0900 | [diff] [blame] | 119 | skb->len - dataoff, protocol, |
Patrick McHardy | 422c346 | 2006-04-06 14:18:43 -0700 | [diff] [blame] | 120 | csum_sub(skb->csum, |
| 121 | skb_checksum(skb, 0, |
| 122 | dataoff, 0)))) { |
| 123 | skb->ip_summed = CHECKSUM_UNNECESSARY; |
| 124 | break; |
| 125 | } |
| 126 | /* fall through */ |
| 127 | case CHECKSUM_NONE: |
Al Viro | 868c86b | 2006-11-14 21:35:48 -0800 | [diff] [blame] | 128 | skb->csum = ~csum_unfold( |
| 129 | csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, |
Patrick McHardy | 422c346 | 2006-04-06 14:18:43 -0700 | [diff] [blame] | 130 | skb->len - dataoff, |
| 131 | protocol, |
| 132 | csum_sub(0, |
| 133 | skb_checksum(skb, 0, |
YOSHIFUJI Hideaki | 1ab1457 | 2007-02-09 23:24:49 +0900 | [diff] [blame] | 134 | dataoff, 0)))); |
Patrick McHardy | 422c346 | 2006-04-06 14:18:43 -0700 | [diff] [blame] | 135 | csum = __skb_checksum_complete(skb); |
| 136 | } |
| 137 | return csum; |
| 138 | } |
Patrick McHardy | 422c346 | 2006-04-06 14:18:43 -0700 | [diff] [blame] | 139 | EXPORT_SYMBOL(nf_ip6_checksum); |
| 140 | |
Patrick McHardy | d63a650 | 2008-03-20 15:15:53 +0100 | [diff] [blame] | 141 | static __sum16 nf_ip6_checksum_partial(struct sk_buff *skb, unsigned int hook, |
| 142 | unsigned int dataoff, unsigned int len, |
| 143 | u_int8_t protocol) |
| 144 | { |
Eric Dumazet | b71d1d4 | 2011-04-22 04:53:02 +0000 | [diff] [blame] | 145 | const struct ipv6hdr *ip6h = ipv6_hdr(skb); |
Patrick McHardy | d63a650 | 2008-03-20 15:15:53 +0100 | [diff] [blame] | 146 | __wsum hsum; |
| 147 | __sum16 csum = 0; |
| 148 | |
| 149 | switch (skb->ip_summed) { |
| 150 | case CHECKSUM_COMPLETE: |
| 151 | if (len == skb->len - dataoff) |
| 152 | return nf_ip6_checksum(skb, hook, dataoff, protocol); |
| 153 | /* fall through */ |
| 154 | case CHECKSUM_NONE: |
| 155 | hsum = skb_checksum(skb, 0, dataoff, 0); |
| 156 | skb->csum = ~csum_unfold(csum_ipv6_magic(&ip6h->saddr, |
| 157 | &ip6h->daddr, |
| 158 | skb->len - dataoff, |
| 159 | protocol, |
| 160 | csum_sub(0, hsum))); |
| 161 | skb->ip_summed = CHECKSUM_NONE; |
Shan Wei | c86ee67 | 2010-06-14 16:20:02 +0200 | [diff] [blame] | 162 | return __skb_checksum_complete_head(skb, dataoff + len); |
Patrick McHardy | d63a650 | 2008-03-20 15:15:53 +0100 | [diff] [blame] | 163 | } |
| 164 | return csum; |
| 165 | }; |
| 166 | |
Patrick McHardy | 1e796fd | 2007-12-17 22:42:27 -0800 | [diff] [blame] | 167 | static const struct nf_afinfo nf_ip6_afinfo = { |
Patrick McHardy | d63a650 | 2008-03-20 15:15:53 +0100 | [diff] [blame] | 168 | .family = AF_INET6, |
| 169 | .checksum = nf_ip6_checksum, |
| 170 | .checksum_partial = nf_ip6_checksum_partial, |
| 171 | .route = nf_ip6_route, |
| 172 | .saveroute = nf_ip6_saveroute, |
| 173 | .reroute = nf_ip6_reroute, |
| 174 | .route_key_size = sizeof(struct ip6_rt_info), |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 175 | }; |
| 176 | |
| 177 | int __init ipv6_netfilter_init(void) |
| 178 | { |
Patrick McHardy | bce8032 | 2006-04-06 14:18:09 -0700 | [diff] [blame] | 179 | return nf_register_afinfo(&nf_ip6_afinfo); |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 180 | } |
| 181 | |
David S. Miller | 5bf887f | 2006-01-10 21:02:21 -0800 | [diff] [blame] | 182 | /* This can be called from inet6_init() on errors, so it cannot |
| 183 | * be marked __exit. -DaveM |
| 184 | */ |
| 185 | void ipv6_netfilter_fini(void) |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 186 | { |
Patrick McHardy | bce8032 | 2006-04-06 14:18:09 -0700 | [diff] [blame] | 187 | nf_unregister_afinfo(&nf_ip6_afinfo); |
Harald Welte | 2cc7d57 | 2005-08-09 19:42:34 -0700 | [diff] [blame] | 188 | } |