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