Commit | Line | Data |
---|---|---|
b0da3905 | 1 | /* Copyright (C) 2003-2013 Jozsef Kadlecsik <kadlec@blackhole.kfki.hu> |
54326190 JK |
2 | * |
3 | * This program is free software; you can redistribute it and/or modify | |
4 | * it under the terms of the GNU General Public License version 2 as | |
5 | * published by the Free Software Foundation. | |
6 | */ | |
7 | ||
8 | /* Kernel module implementing an IP set type: the bitmap:port type */ | |
9 | ||
10 | #include <linux/module.h> | |
11 | #include <linux/ip.h> | |
54326190 JK |
12 | #include <linux/skbuff.h> |
13 | #include <linux/errno.h> | |
54326190 JK |
14 | #include <linux/netlink.h> |
15 | #include <linux/jiffies.h> | |
16 | #include <linux/timer.h> | |
17 | #include <net/netlink.h> | |
18 | ||
19 | #include <linux/netfilter/ipset/ip_set.h> | |
20 | #include <linux/netfilter/ipset/ip_set_bitmap.h> | |
21 | #include <linux/netfilter/ipset/ip_set_getport.h> | |
54326190 | 22 | |
35b8dcf8 | 23 | #define IPSET_TYPE_REV_MIN 0 |
b90cb8ba | 24 | /* 1 Counter support added */ |
39d1ecf1 AD |
25 | /* 2 Comment support added */ |
26 | #define IPSET_TYPE_REV_MAX 3 /* skbinfo support added */ | |
10111a6e | 27 | |
54326190 JK |
28 | MODULE_LICENSE("GPL"); |
29 | MODULE_AUTHOR("Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>"); | |
35b8dcf8 | 30 | IP_SET_MODULE_DESC("bitmap:port", IPSET_TYPE_REV_MIN, IPSET_TYPE_REV_MAX); |
54326190 JK |
31 | MODULE_ALIAS("ip_set_bitmap:port"); |
32 | ||
b0da3905 JK |
33 | #define MTYPE bitmap_port |
34 | ||
54326190 JK |
35 | /* Type structure */ |
36 | struct bitmap_port { | |
37 | void *members; /* the set members */ | |
38 | u16 first_port; /* host byte order, included in range */ | |
39 | u16 last_port; /* host byte order, included in range */ | |
b0da3905 | 40 | u32 elements; /* number of max elements in the set */ |
54326190 | 41 | size_t memsize; /* members size */ |
54326190 | 42 | struct timer_list gc; /* garbage collection */ |
95ad1f4a JK |
43 | unsigned char extensions[0] /* data extensions */ |
44 | __aligned(__alignof__(u64)); | |
54326190 JK |
45 | }; |
46 | ||
b0da3905 JK |
47 | /* ADT structure for generic function args */ |
48 | struct bitmap_port_adt_elem { | |
49 | u16 id; | |
50 | }; | |
54326190 | 51 | |
b0da3905 JK |
52 | static inline u16 |
53 | port_to_id(const struct bitmap_port *m, u16 port) | |
54326190 | 54 | { |
b0da3905 | 55 | return port - m->first_port; |
54326190 JK |
56 | } |
57 | ||
b0da3905 | 58 | /* Common functions */ |
54326190 | 59 | |
b0da3905 JK |
60 | static inline int |
61 | bitmap_port_do_test(const struct bitmap_port_adt_elem *e, | |
ca134ce8 | 62 | const struct bitmap_port *map, size_t dsize) |
54326190 | 63 | { |
b0da3905 | 64 | return !!test_bit(e->id, map->members); |
54326190 JK |
65 | } |
66 | ||
b0da3905 | 67 | static inline int |
ca134ce8 | 68 | bitmap_port_gc_test(u16 id, const struct bitmap_port *map, size_t dsize) |
54326190 | 69 | { |
b0da3905 | 70 | return !!test_bit(id, map->members); |
54326190 JK |
71 | } |
72 | ||
b0da3905 JK |
73 | static inline int |
74 | bitmap_port_do_add(const struct bitmap_port_adt_elem *e, | |
ca134ce8 | 75 | struct bitmap_port *map, u32 flags, size_t dsize) |
54326190 | 76 | { |
96f51428 | 77 | return !!test_bit(e->id, map->members); |
54326190 JK |
78 | } |
79 | ||
b0da3905 JK |
80 | static inline int |
81 | bitmap_port_do_del(const struct bitmap_port_adt_elem *e, | |
82 | struct bitmap_port *map) | |
54326190 | 83 | { |
b0da3905 | 84 | return !test_and_clear_bit(e->id, map->members); |
54326190 JK |
85 | } |
86 | ||
b0da3905 | 87 | static inline int |
ca134ce8 JK |
88 | bitmap_port_do_list(struct sk_buff *skb, const struct bitmap_port *map, u32 id, |
89 | size_t dsize) | |
54326190 | 90 | { |
b0da3905 JK |
91 | return nla_put_net16(skb, IPSET_ATTR_PORT, |
92 | htons(map->first_port + id)); | |
54326190 JK |
93 | } |
94 | ||
b0da3905 JK |
95 | static inline int |
96 | bitmap_port_do_head(struct sk_buff *skb, const struct bitmap_port *map) | |
54326190 | 97 | { |
b0da3905 JK |
98 | return nla_put_net16(skb, IPSET_ATTR_PORT, htons(map->first_port)) || |
99 | nla_put_net16(skb, IPSET_ATTR_PORT_TO, htons(map->last_port)); | |
54326190 JK |
100 | } |
101 | ||
102 | static int | |
103 | bitmap_port_kadt(struct ip_set *set, const struct sk_buff *skb, | |
b66554cf | 104 | const struct xt_action_param *par, |
b0da3905 | 105 | enum ipset_adt adt, struct ip_set_adt_opt *opt) |
54326190 JK |
106 | { |
107 | struct bitmap_port *map = set->data; | |
108 | ipset_adtfn adtfn = set->variant->adt[adt]; | |
94729f8a | 109 | struct bitmap_port_adt_elem e = { .id = 0 }; |
ca134ce8 | 110 | struct ip_set_ext ext = IP_SET_INIT_KEXT(skb, opt, set); |
54326190 JK |
111 | __be16 __port; |
112 | u16 port = 0; | |
113 | ||
ac8cc925 JK |
114 | if (!ip_set_get_ip_port(skb, opt->family, |
115 | opt->flags & IPSET_DIM_ONE_SRC, &__port)) | |
54326190 JK |
116 | return -EINVAL; |
117 | ||
118 | port = ntohs(__port); | |
119 | ||
120 | if (port < map->first_port || port > map->last_port) | |
121 | return -IPSET_ERR_BITMAP_RANGE; | |
122 | ||
b0da3905 | 123 | e.id = port_to_id(map, port); |
54326190 | 124 | |
b0da3905 | 125 | return adtfn(set, &e, &ext, &opt->ext, opt->cmdflags); |
54326190 JK |
126 | } |
127 | ||
128 | static int | |
129 | bitmap_port_uadt(struct ip_set *set, struct nlattr *tb[], | |
3d14b171 | 130 | enum ipset_adt adt, u32 *lineno, u32 flags, bool retried) |
54326190 JK |
131 | { |
132 | struct bitmap_port *map = set->data; | |
133 | ipset_adtfn adtfn = set->variant->adt[adt]; | |
94729f8a | 134 | struct bitmap_port_adt_elem e = { .id = 0 }; |
ca134ce8 | 135 | struct ip_set_ext ext = IP_SET_INIT_UEXT(set); |
54326190 | 136 | u32 port; /* wraparound */ |
b0da3905 | 137 | u16 port_to; |
54326190 JK |
138 | int ret = 0; |
139 | ||
a212e08e SP |
140 | if (tb[IPSET_ATTR_LINENO]) |
141 | *lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]); | |
142 | ||
54326190 | 143 | if (unlikely(!ip_set_attr_netorder(tb, IPSET_ATTR_PORT) || |
7dd37bc8 | 144 | !ip_set_optattr_netorder(tb, IPSET_ATTR_PORT_TO))) |
54326190 JK |
145 | return -IPSET_ERR_PROTOCOL; |
146 | ||
54326190 JK |
147 | port = ip_set_get_h16(tb[IPSET_ATTR_PORT]); |
148 | if (port < map->first_port || port > map->last_port) | |
149 | return -IPSET_ERR_BITMAP_RANGE; | |
b0da3905 JK |
150 | ret = ip_set_get_extensions(set, tb, &ext); |
151 | if (ret) | |
152 | return ret; | |
54326190 JK |
153 | |
154 | if (adt == IPSET_TEST) { | |
b0da3905 JK |
155 | e.id = port_to_id(map, port); |
156 | return adtfn(set, &e, &ext, &ext, flags); | |
54326190 JK |
157 | } |
158 | ||
159 | if (tb[IPSET_ATTR_PORT_TO]) { | |
160 | port_to = ip_set_get_h16(tb[IPSET_ATTR_PORT_TO]); | |
161 | if (port > port_to) { | |
162 | swap(port, port_to); | |
163 | if (port < map->first_port) | |
164 | return -IPSET_ERR_BITMAP_RANGE; | |
165 | } | |
ca0f6a5c | 166 | } else { |
54326190 | 167 | port_to = port; |
ca0f6a5c | 168 | } |
54326190 JK |
169 | |
170 | if (port_to > map->last_port) | |
171 | return -IPSET_ERR_BITMAP_RANGE; | |
172 | ||
173 | for (; port <= port_to; port++) { | |
b0da3905 JK |
174 | e.id = port_to_id(map, port); |
175 | ret = adtfn(set, &e, &ext, &ext, flags); | |
54326190 JK |
176 | |
177 | if (ret && !ip_set_eexist(ret, flags)) | |
178 | return ret; | |
ca0f6a5c JK |
179 | |
180 | ret = 0; | |
54326190 JK |
181 | } |
182 | return ret; | |
183 | } | |
184 | ||
54326190 JK |
185 | static bool |
186 | bitmap_port_same_set(const struct ip_set *a, const struct ip_set *b) | |
187 | { | |
188 | const struct bitmap_port *x = a->data; | |
189 | const struct bitmap_port *y = b->data; | |
190 | ||
191 | return x->first_port == y->first_port && | |
192 | x->last_port == y->last_port && | |
ca134ce8 | 193 | a->timeout == b->timeout && |
b0da3905 | 194 | a->extensions == b->extensions; |
54326190 JK |
195 | } |
196 | ||
b0da3905 | 197 | /* Plain variant */ |
54326190 | 198 | |
b0da3905 | 199 | struct bitmap_port_elem { |
54326190 JK |
200 | }; |
201 | ||
b0da3905 | 202 | #include "ip_set_bitmap_gen.h" |
54326190 JK |
203 | |
204 | /* Create bitmap:ip type of sets */ | |
205 | ||
206 | static bool | |
207 | init_map_port(struct ip_set *set, struct bitmap_port *map, | |
208 | u16 first_port, u16 last_port) | |
209 | { | |
210 | map->members = ip_set_alloc(map->memsize); | |
211 | if (!map->members) | |
212 | return false; | |
213 | map->first_port = first_port; | |
214 | map->last_port = last_port; | |
ca134ce8 | 215 | set->timeout = IPSET_NO_TIMEOUT; |
54326190 JK |
216 | |
217 | set->data = map; | |
c15f1c83 | 218 | set->family = NFPROTO_UNSPEC; |
54326190 JK |
219 | |
220 | return true; | |
221 | } | |
222 | ||
223 | static int | |
1785e8f4 VL |
224 | bitmap_port_create(struct net *net, struct ip_set *set, struct nlattr *tb[], |
225 | u32 flags) | |
54326190 JK |
226 | { |
227 | struct bitmap_port *map; | |
228 | u16 first_port, last_port; | |
95ad1f4a | 229 | u32 elements; |
54326190 JK |
230 | |
231 | if (unlikely(!ip_set_attr_netorder(tb, IPSET_ATTR_PORT) || | |
232 | !ip_set_attr_netorder(tb, IPSET_ATTR_PORT_TO) || | |
f48d19db JK |
233 | !ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT) || |
234 | !ip_set_optattr_netorder(tb, IPSET_ATTR_CADT_FLAGS))) | |
54326190 JK |
235 | return -IPSET_ERR_PROTOCOL; |
236 | ||
237 | first_port = ip_set_get_h16(tb[IPSET_ATTR_PORT]); | |
238 | last_port = ip_set_get_h16(tb[IPSET_ATTR_PORT_TO]); | |
239 | if (first_port > last_port) { | |
240 | u16 tmp = first_port; | |
241 | ||
242 | first_port = last_port; | |
243 | last_port = tmp; | |
244 | } | |
245 | ||
95ad1f4a JK |
246 | elements = last_port - first_port + 1; |
247 | set->dsize = ip_set_elem_len(set, tb, 0, 0); | |
248 | map = ip_set_alloc(sizeof(*map) + elements * set->dsize); | |
54326190 JK |
249 | if (!map) |
250 | return -ENOMEM; | |
251 | ||
95ad1f4a | 252 | map->elements = elements; |
dc476e7c | 253 | map->memsize = bitmap_bytes(0, map->elements); |
b0da3905 | 254 | set->variant = &bitmap_port; |
03c8b234 JK |
255 | if (!init_map_port(set, map, first_port, last_port)) { |
256 | kfree(map); | |
257 | return -ENOMEM; | |
258 | } | |
259 | if (tb[IPSET_ATTR_TIMEOUT]) { | |
ca134ce8 | 260 | set->timeout = ip_set_timeout_uget(tb[IPSET_ATTR_TIMEOUT]); |
b0da3905 | 261 | bitmap_port_gc_init(set, bitmap_port_gc); |
54326190 JK |
262 | } |
263 | return 0; | |
264 | } | |
265 | ||
266 | static struct ip_set_type bitmap_port_type = { | |
267 | .name = "bitmap:port", | |
268 | .protocol = IPSET_PROTOCOL, | |
269 | .features = IPSET_TYPE_PORT, | |
270 | .dimension = IPSET_DIM_ONE, | |
c15f1c83 | 271 | .family = NFPROTO_UNSPEC, |
35b8dcf8 JK |
272 | .revision_min = IPSET_TYPE_REV_MIN, |
273 | .revision_max = IPSET_TYPE_REV_MAX, | |
54326190 JK |
274 | .create = bitmap_port_create, |
275 | .create_policy = { | |
276 | [IPSET_ATTR_PORT] = { .type = NLA_U16 }, | |
277 | [IPSET_ATTR_PORT_TO] = { .type = NLA_U16 }, | |
278 | [IPSET_ATTR_TIMEOUT] = { .type = NLA_U32 }, | |
f48d19db | 279 | [IPSET_ATTR_CADT_FLAGS] = { .type = NLA_U32 }, |
54326190 JK |
280 | }, |
281 | .adt_policy = { | |
282 | [IPSET_ATTR_PORT] = { .type = NLA_U16 }, | |
283 | [IPSET_ATTR_PORT_TO] = { .type = NLA_U16 }, | |
284 | [IPSET_ATTR_TIMEOUT] = { .type = NLA_U32 }, | |
285 | [IPSET_ATTR_LINENO] = { .type = NLA_U32 }, | |
f48d19db JK |
286 | [IPSET_ATTR_BYTES] = { .type = NLA_U64 }, |
287 | [IPSET_ATTR_PACKETS] = { .type = NLA_U64 }, | |
03726186 SP |
288 | [IPSET_ATTR_COMMENT] = { .type = NLA_NUL_STRING, |
289 | .len = IPSET_MAX_COMMENT_SIZE }, | |
39d1ecf1 AD |
290 | [IPSET_ATTR_SKBMARK] = { .type = NLA_U64 }, |
291 | [IPSET_ATTR_SKBPRIO] = { .type = NLA_U32 }, | |
292 | [IPSET_ATTR_SKBQUEUE] = { .type = NLA_U16 }, | |
54326190 JK |
293 | }, |
294 | .me = THIS_MODULE, | |
295 | }; | |
296 | ||
297 | static int __init | |
298 | bitmap_port_init(void) | |
299 | { | |
300 | return ip_set_type_register(&bitmap_port_type); | |
301 | } | |
302 | ||
303 | static void __exit | |
304 | bitmap_port_fini(void) | |
305 | { | |
96f51428 | 306 | rcu_barrier(); |
54326190 JK |
307 | ip_set_type_unregister(&bitmap_port_type); |
308 | } | |
309 | ||
310 | module_init(bitmap_port_init); | |
311 | module_exit(bitmap_port_fini); |