Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2008 Patrick McHardy <kaber@trash.net> |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 3 | * Copyright (c) 2012 Pablo Neira Ayuso <pablo@netfilter.org> |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify |
| 6 | * it under the terms of the GNU General Public License version 2 as |
| 7 | * published by the Free Software Foundation. |
| 8 | * |
| 9 | * Development of this code funded by Astaro AG (http://www.astaro.com/) |
| 10 | */ |
| 11 | |
| 12 | #include <linux/module.h> |
| 13 | #include <linux/init.h> |
| 14 | #include <linux/list.h> |
| 15 | #include <linux/skbuff.h> |
| 16 | #include <linux/netlink.h> |
| 17 | #include <linux/netfilter.h> |
| 18 | #include <linux/netfilter_ipv6.h> |
| 19 | #include <linux/netfilter/nfnetlink.h> |
| 20 | #include <linux/netfilter/nf_tables.h> |
| 21 | #include <net/netfilter/nf_tables.h> |
Pablo Neira Ayuso | 0ca743a | 2013-10-14 00:06:06 +0200 | [diff] [blame] | 22 | #include <net/netfilter/nf_tables_ipv6.h> |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 23 | #include <net/route.h> |
| 24 | |
Eric W. Biederman | 06198b3 | 2015-09-18 14:33:06 -0500 | [diff] [blame] | 25 | static unsigned int nf_route_table_hook(void *priv, |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 26 | struct sk_buff *skb, |
David S. Miller | 238e54c | 2015-04-03 20:32:56 -0400 | [diff] [blame] | 27 | const struct nf_hook_state *state) |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 28 | { |
| 29 | unsigned int ret; |
Pablo Neira Ayuso | 0ca743a | 2013-10-14 00:06:06 +0200 | [diff] [blame] | 30 | struct nft_pktinfo pkt; |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 31 | struct in6_addr saddr, daddr; |
| 32 | u_int8_t hop_limit; |
| 33 | u32 mark, flowlabel; |
Liping Zhang | d1a6cba | 2016-09-06 22:31:02 +0800 | [diff] [blame] | 34 | int err; |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 35 | |
Pablo Neira Ayuso | 71212c9 | 2016-09-09 12:42:53 +0200 | [diff] [blame] | 36 | nft_set_pktinfo_ipv6(&pkt, skb, state); |
Pablo Neira Ayuso | 0ca743a | 2013-10-14 00:06:06 +0200 | [diff] [blame] | 37 | |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 38 | /* save source/dest address, mark, hoplimit, flowlabel, priority */ |
| 39 | memcpy(&saddr, &ipv6_hdr(skb)->saddr, sizeof(saddr)); |
| 40 | memcpy(&daddr, &ipv6_hdr(skb)->daddr, sizeof(daddr)); |
| 41 | mark = skb->mark; |
| 42 | hop_limit = ipv6_hdr(skb)->hop_limit; |
| 43 | |
| 44 | /* flowlabel and prio (includes version, which shouldn't change either */ |
| 45 | flowlabel = *((u32 *)ipv6_hdr(skb)); |
| 46 | |
Eric W. Biederman | 06198b3 | 2015-09-18 14:33:06 -0500 | [diff] [blame] | 47 | ret = nft_do_chain(&pkt, priv); |
Liping Zhang | d1a6cba | 2016-09-06 22:31:02 +0800 | [diff] [blame] | 48 | if (ret != NF_DROP && ret != NF_STOLEN && |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 49 | (memcmp(&ipv6_hdr(skb)->saddr, &saddr, sizeof(saddr)) || |
| 50 | memcmp(&ipv6_hdr(skb)->daddr, &daddr, sizeof(daddr)) || |
| 51 | skb->mark != mark || |
| 52 | ipv6_hdr(skb)->hop_limit != hop_limit || |
Liping Zhang | d1a6cba | 2016-09-06 22:31:02 +0800 | [diff] [blame] | 53 | flowlabel != *((u_int32_t *)ipv6_hdr(skb)))) { |
| 54 | err = ip6_route_me_harder(state->net, skb); |
| 55 | if (err < 0) |
| 56 | ret = NF_DROP_ERR(err); |
| 57 | } |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 58 | |
| 59 | return ret; |
| 60 | } |
| 61 | |
Patrick McHardy | 2a37d75 | 2014-01-09 18:42:37 +0000 | [diff] [blame] | 62 | static const struct nf_chain_type nft_chain_route_ipv6 = { |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 63 | .name = "route", |
| 64 | .type = NFT_CHAIN_T_ROUTE, |
Patrick McHardy | fa2c1de | 2014-01-09 18:42:38 +0000 | [diff] [blame] | 65 | .family = NFPROTO_IPV6, |
Ian Morris | 7695495 | 2015-10-11 17:32:16 +0100 | [diff] [blame] | 66 | .owner = THIS_MODULE, |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 67 | .hook_mask = (1 << NF_INET_LOCAL_OUT), |
Patrick McHardy | fa2c1de | 2014-01-09 18:42:38 +0000 | [diff] [blame] | 68 | .hooks = { |
Ian Morris | 7695495 | 2015-10-11 17:32:16 +0100 | [diff] [blame] | 69 | [NF_INET_LOCAL_OUT] = nf_route_table_hook, |
| 70 | }, |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 71 | }; |
| 72 | |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 73 | static int __init nft_chain_route_init(void) |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 74 | { |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 75 | return nft_register_chain_type(&nft_chain_route_ipv6); |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 76 | } |
| 77 | |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 78 | static void __exit nft_chain_route_exit(void) |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 79 | { |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 80 | nft_unregister_chain_type(&nft_chain_route_ipv6); |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 81 | } |
| 82 | |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 83 | module_init(nft_chain_route_init); |
| 84 | module_exit(nft_chain_route_exit); |
Patrick McHardy | 9651851 | 2013-10-14 11:00:02 +0200 | [diff] [blame] | 85 | |
| 86 | MODULE_LICENSE("GPL"); |
| 87 | MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>"); |
Pablo Neira Ayuso | 9370761 | 2013-10-10 23:21:26 +0200 | [diff] [blame] | 88 | MODULE_ALIAS_NFT_CHAIN(AF_INET6, "route"); |