1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11#include <linux/ip.h>
12#include <linux/skbuff.h>
13#include <linux/errno.h>
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>
22
23#define IPSET_TYPE_REV_MIN 0
24
25
26#define IPSET_TYPE_REV_MAX 3
27
28MODULE_LICENSE("GPL");
29MODULE_AUTHOR("Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>");
30IP_SET_MODULE_DESC("bitmap:port", IPSET_TYPE_REV_MIN, IPSET_TYPE_REV_MAX);
31MODULE_ALIAS("ip_set_bitmap:port");
32
33#define MTYPE bitmap_port
34
35
36struct bitmap_port {
37 void *members;
38 u16 first_port;
39 u16 last_port;
40 u32 elements;
41 size_t memsize;
42 struct timer_list gc;
43 unsigned char extensions[0]
44 __aligned(__alignof__(u64));
45};
46
47
48struct bitmap_port_adt_elem {
49 u16 id;
50};
51
52static inline u16
53port_to_id(const struct bitmap_port *m, u16 port)
54{
55 return port - m->first_port;
56}
57
58
59
60static inline int
61bitmap_port_do_test(const struct bitmap_port_adt_elem *e,
62 const struct bitmap_port *map, size_t dsize)
63{
64 return !!test_bit(e->id, map->members);
65}
66
67static inline int
68bitmap_port_gc_test(u16 id, const struct bitmap_port *map, size_t dsize)
69{
70 return !!test_bit(id, map->members);
71}
72
73static inline int
74bitmap_port_do_add(const struct bitmap_port_adt_elem *e,
75 struct bitmap_port *map, u32 flags, size_t dsize)
76{
77 return !!test_bit(e->id, map->members);
78}
79
80static inline int
81bitmap_port_do_del(const struct bitmap_port_adt_elem *e,
82 struct bitmap_port *map)
83{
84 return !test_and_clear_bit(e->id, map->members);
85}
86
87static inline int
88bitmap_port_do_list(struct sk_buff *skb, const struct bitmap_port *map, u32 id,
89 size_t dsize)
90{
91 return nla_put_net16(skb, IPSET_ATTR_PORT,
92 htons(map->first_port + id));
93}
94
95static inline int
96bitmap_port_do_head(struct sk_buff *skb, const struct bitmap_port *map)
97{
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));
100}
101
102static int
103bitmap_port_kadt(struct ip_set *set, const struct sk_buff *skb,
104 const struct xt_action_param *par,
105 enum ipset_adt adt, struct ip_set_adt_opt *opt)
106{
107 struct bitmap_port *map = set->data;
108 ipset_adtfn adtfn = set->variant->adt[adt];
109 struct bitmap_port_adt_elem e = { .id = 0 };
110 struct ip_set_ext ext = IP_SET_INIT_KEXT(skb, opt, set);
111 __be16 __port;
112 u16 port = 0;
113
114 if (!ip_set_get_ip_port(skb, opt->family,
115 opt->flags & IPSET_DIM_ONE_SRC, &__port))
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
123 e.id = port_to_id(map, port);
124
125 return adtfn(set, &e, &ext, &opt->ext, opt->cmdflags);
126}
127
128static int
129bitmap_port_uadt(struct ip_set *set, struct nlattr *tb[],
130 enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
131{
132 struct bitmap_port *map = set->data;
133 ipset_adtfn adtfn = set->variant->adt[adt];
134 struct bitmap_port_adt_elem e = { .id = 0 };
135 struct ip_set_ext ext = IP_SET_INIT_UEXT(set);
136 u32 port;
137 u16 port_to;
138 int ret = 0;
139
140 if (tb[IPSET_ATTR_LINENO])
141 *lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);
142
143 if (unlikely(!ip_set_attr_netorder(tb, IPSET_ATTR_PORT) ||
144 !ip_set_optattr_netorder(tb, IPSET_ATTR_PORT_TO)))
145 return -IPSET_ERR_PROTOCOL;
146
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;
150 ret = ip_set_get_extensions(set, tb, &ext);
151 if (ret)
152 return ret;
153
154 if (adt == IPSET_TEST) {
155 e.id = port_to_id(map, port);
156 return adtfn(set, &e, &ext, &ext, flags);
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 }
166 } else {
167 port_to = port;
168 }
169
170 if (port_to > map->last_port)
171 return -IPSET_ERR_BITMAP_RANGE;
172
173 for (; port <= port_to; port++) {
174 e.id = port_to_id(map, port);
175 ret = adtfn(set, &e, &ext, &ext, flags);
176
177 if (ret && !ip_set_eexist(ret, flags))
178 return ret;
179
180 ret = 0;
181 }
182 return ret;
183}
184
185static bool
186bitmap_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 &&
193 a->timeout == b->timeout &&
194 a->extensions == b->extensions;
195}
196
197
198
199struct bitmap_port_elem {
200};
201
202#include "ip_set_bitmap_gen.h"
203
204
205
206static bool
207init_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;
215 set->timeout = IPSET_NO_TIMEOUT;
216
217 set->data = map;
218 set->family = NFPROTO_UNSPEC;
219
220 return true;
221}
222
223static int
224bitmap_port_create(struct net *net, struct ip_set *set, struct nlattr *tb[],
225 u32 flags)
226{
227 struct bitmap_port *map;
228 u16 first_port, last_port;
229 u32 elements;
230
231 if (unlikely(!ip_set_attr_netorder(tb, IPSET_ATTR_PORT) ||
232 !ip_set_attr_netorder(tb, IPSET_ATTR_PORT_TO) ||
233 !ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT) ||
234 !ip_set_optattr_netorder(tb, IPSET_ATTR_CADT_FLAGS)))
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
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);
249 if (!map)
250 return -ENOMEM;
251
252 map->elements = elements;
253 map->memsize = bitmap_bytes(0, map->elements);
254 set->variant = &bitmap_port;
255 if (!init_map_port(set, map, first_port, last_port)) {
256 kfree(map);
257 return -ENOMEM;
258 }
259 if (tb[IPSET_ATTR_TIMEOUT]) {
260 set->timeout = ip_set_timeout_uget(tb[IPSET_ATTR_TIMEOUT]);
261 bitmap_port_gc_init(set, bitmap_port_gc);
262 }
263 return 0;
264}
265
266static 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,
271 .family = NFPROTO_UNSPEC,
272 .revision_min = IPSET_TYPE_REV_MIN,
273 .revision_max = IPSET_TYPE_REV_MAX,
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 },
279 [IPSET_ATTR_CADT_FLAGS] = { .type = NLA_U32 },
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 },
286 [IPSET_ATTR_BYTES] = { .type = NLA_U64 },
287 [IPSET_ATTR_PACKETS] = { .type = NLA_U64 },
288 [IPSET_ATTR_COMMENT] = { .type = NLA_NUL_STRING,
289 .len = IPSET_MAX_COMMENT_SIZE },
290 [IPSET_ATTR_SKBMARK] = { .type = NLA_U64 },
291 [IPSET_ATTR_SKBPRIO] = { .type = NLA_U32 },
292 [IPSET_ATTR_SKBQUEUE] = { .type = NLA_U16 },
293 },
294 .me = THIS_MODULE,
295};
296
297static int __init
298bitmap_port_init(void)
299{
300 return ip_set_type_register(&bitmap_port_type);
301}
302
303static void __exit
304bitmap_port_fini(void)
305{
306 rcu_barrier();
307 ip_set_type_unregister(&bitmap_port_type);
308}
309
310module_init(bitmap_port_init);
311module_exit(bitmap_port_fini);
312