Commit | Line | Data |
---|---|---|
2e4e6a17 HW |
1 | /* iptables module for using new netfilter netlink queue |
2 | * | |
3 | * (C) 2005 by Harald Welte <laforge@netfilter.org> | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify | |
601e68e1 | 6 | * it under the terms of the GNU General Public License version 2 as |
2e4e6a17 | 7 | * published by the Free Software Foundation. |
601e68e1 | 8 | * |
2e4e6a17 HW |
9 | */ |
10 | ||
11 | #include <linux/module.h> | |
12 | #include <linux/skbuff.h> | |
13 | ||
10662aa3 FW |
14 | #include <linux/ip.h> |
15 | #include <linux/ipv6.h> | |
16 | #include <linux/jhash.h> | |
17 | ||
2e4e6a17 HW |
18 | #include <linux/netfilter.h> |
19 | #include <linux/netfilter_arp.h> | |
20 | #include <linux/netfilter/x_tables.h> | |
21 | #include <linux/netfilter/xt_NFQUEUE.h> | |
22 | ||
23 | MODULE_AUTHOR("Harald Welte <laforge@netfilter.org>"); | |
2ae15b64 | 24 | MODULE_DESCRIPTION("Xtables: packet forwarding to netlink"); |
2e4e6a17 HW |
25 | MODULE_LICENSE("GPL"); |
26 | MODULE_ALIAS("ipt_NFQUEUE"); | |
27 | MODULE_ALIAS("ip6t_NFQUEUE"); | |
28 | MODULE_ALIAS("arpt_NFQUEUE"); | |
29 | ||
10662aa3 | 30 | static u32 jhash_initval __read_mostly; |
5191d501 | 31 | static bool rnd_inited __read_mostly; |
10662aa3 | 32 | |
2e4e6a17 | 33 | static unsigned int |
4b560b44 | 34 | nfqueue_tg(struct sk_buff *skb, const struct xt_action_param *par) |
2e4e6a17 | 35 | { |
7eb35586 | 36 | const struct xt_NFQ_info *tinfo = par->targinfo; |
2e4e6a17 HW |
37 | |
38 | return NF_QUEUE_NR(tinfo->queuenum); | |
39 | } | |
40 | ||
10662aa3 FW |
41 | static u32 hash_v4(const struct sk_buff *skb) |
42 | { | |
43 | const struct iphdr *iph = ip_hdr(skb); | |
f9ffc312 | 44 | __be32 ipaddr; |
10662aa3 FW |
45 | |
46 | /* packets in either direction go into same queue */ | |
47 | ipaddr = iph->saddr ^ iph->daddr; | |
48 | ||
f9ffc312 | 49 | return jhash_2words((__force u32)ipaddr, iph->protocol, jhash_initval); |
10662aa3 FW |
50 | } |
51 | ||
10662aa3 FW |
52 | #if defined(CONFIG_IP6_NF_IPTABLES) || defined(CONFIG_IP6_NF_IPTABLES_MODULE) |
53 | static u32 hash_v6(const struct sk_buff *skb) | |
54 | { | |
55 | const struct ipv6hdr *ip6h = ipv6_hdr(skb); | |
f9ffc312 | 56 | __be32 addr[4]; |
10662aa3 FW |
57 | |
58 | addr[0] = ip6h->saddr.s6_addr32[0] ^ ip6h->daddr.s6_addr32[0]; | |
59 | addr[1] = ip6h->saddr.s6_addr32[1] ^ ip6h->daddr.s6_addr32[1]; | |
60 | addr[2] = ip6h->saddr.s6_addr32[2] ^ ip6h->daddr.s6_addr32[2]; | |
61 | addr[3] = ip6h->saddr.s6_addr32[3] ^ ip6h->daddr.s6_addr32[3]; | |
62 | ||
f9ffc312 | 63 | return jhash2((__force u32 *)addr, ARRAY_SIZE(addr), jhash_initval); |
10662aa3 | 64 | } |
f76a47c8 | 65 | #endif |
10662aa3 FW |
66 | |
67 | static unsigned int | |
4b560b44 | 68 | nfqueue_tg_v1(struct sk_buff *skb, const struct xt_action_param *par) |
10662aa3 FW |
69 | { |
70 | const struct xt_NFQ_info_v1 *info = par->targinfo; | |
71 | u32 queue = info->queuenum; | |
72 | ||
f76a47c8 | 73 | if (info->queues_total > 1) { |
0d345455 | 74 | if (par->family == NFPROTO_IPV4) |
ca361810 CG |
75 | queue = (((u64) hash_v4(skb) * info->queues_total) >> |
76 | 32) + queue; | |
f76a47c8 | 77 | #if defined(CONFIG_IP6_NF_IPTABLES) || defined(CONFIG_IP6_NF_IPTABLES_MODULE) |
0d345455 | 78 | else if (par->family == NFPROTO_IPV6) |
ca361810 CG |
79 | queue = (((u64) hash_v6(skb) * info->queues_total) >> |
80 | 32) + queue; | |
f76a47c8 JE |
81 | #endif |
82 | } | |
10662aa3 FW |
83 | return NF_QUEUE_NR(queue); |
84 | } | |
10662aa3 | 85 | |
94b27cc3 FW |
86 | static unsigned int |
87 | nfqueue_tg_v2(struct sk_buff *skb, const struct xt_action_param *par) | |
10662aa3 | 88 | { |
94b27cc3 FW |
89 | const struct xt_NFQ_info_v2 *info = par->targinfo; |
90 | unsigned int ret = nfqueue_tg_v1(skb, par); | |
91 | ||
92 | if (info->bypass) | |
93 | ret |= NF_VERDICT_FLAG_QUEUE_BYPASS; | |
94 | return ret; | |
95 | } | |
96 | ||
97 | static int nfqueue_tg_check(const struct xt_tgchk_param *par) | |
98 | { | |
99 | const struct xt_NFQ_info_v2 *info = par->targinfo; | |
10662aa3 FW |
100 | u32 maxid; |
101 | ||
5191d501 JE |
102 | if (unlikely(!rnd_inited)) { |
103 | get_random_bytes(&jhash_initval, sizeof(jhash_initval)); | |
104 | rnd_inited = true; | |
105 | } | |
10662aa3 FW |
106 | if (info->queues_total == 0) { |
107 | pr_err("NFQUEUE: number of total queues is 0\n"); | |
d6b00a53 | 108 | return -EINVAL; |
10662aa3 FW |
109 | } |
110 | maxid = info->queues_total - 1 + info->queuenum; | |
111 | if (maxid > 0xffff) { | |
112 | pr_err("NFQUEUE: number of queues (%u) out of range (got %u)\n", | |
113 | info->queues_total, maxid); | |
4a5a5c73 | 114 | return -ERANGE; |
10662aa3 | 115 | } |
94b27cc3 FW |
116 | if (par->target->revision == 2 && info->bypass > 1) |
117 | return -EINVAL; | |
d6b00a53 | 118 | return 0; |
10662aa3 FW |
119 | } |
120 | ||
d3c5ee6d | 121 | static struct xt_target nfqueue_tg_reg[] __read_mostly = { |
4470bbc7 PM |
122 | { |
123 | .name = "NFQUEUE", | |
61f5abca | 124 | .family = NFPROTO_UNSPEC, |
d3c5ee6d | 125 | .target = nfqueue_tg, |
4470bbc7 PM |
126 | .targetsize = sizeof(struct xt_NFQ_info), |
127 | .me = THIS_MODULE, | |
128 | }, | |
10662aa3 FW |
129 | { |
130 | .name = "NFQUEUE", | |
131 | .revision = 1, | |
f76a47c8 | 132 | .family = NFPROTO_UNSPEC, |
94b27cc3 | 133 | .checkentry = nfqueue_tg_check, |
f76a47c8 | 134 | .target = nfqueue_tg_v1, |
10662aa3 FW |
135 | .targetsize = sizeof(struct xt_NFQ_info_v1), |
136 | .me = THIS_MODULE, | |
137 | }, | |
94b27cc3 FW |
138 | { |
139 | .name = "NFQUEUE", | |
140 | .revision = 2, | |
141 | .family = NFPROTO_UNSPEC, | |
142 | .checkentry = nfqueue_tg_check, | |
143 | .target = nfqueue_tg_v2, | |
144 | .targetsize = sizeof(struct xt_NFQ_info_v2), | |
145 | .me = THIS_MODULE, | |
146 | }, | |
2e4e6a17 HW |
147 | }; |
148 | ||
d3c5ee6d | 149 | static int __init nfqueue_tg_init(void) |
2e4e6a17 | 150 | { |
d3c5ee6d | 151 | return xt_register_targets(nfqueue_tg_reg, ARRAY_SIZE(nfqueue_tg_reg)); |
2e4e6a17 HW |
152 | } |
153 | ||
d3c5ee6d | 154 | static void __exit nfqueue_tg_exit(void) |
2e4e6a17 | 155 | { |
d3c5ee6d | 156 | xt_unregister_targets(nfqueue_tg_reg, ARRAY_SIZE(nfqueue_tg_reg)); |
2e4e6a17 HW |
157 | } |
158 | ||
d3c5ee6d JE |
159 | module_init(nfqueue_tg_init); |
160 | module_exit(nfqueue_tg_exit); |