1 /* Copyright (C) 2011-2013 Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>
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 hash:net,iface type */
9
10 #include <linux/jhash.h>
11 #include <linux/module.h>
12 #include <linux/ip.h>
13 #include <linux/skbuff.h>
14 #include <linux/errno.h>
15 #include <linux/random.h>
16 #include <net/ip.h>
17 #include <net/ipv6.h>
18 #include <net/netlink.h>
19
20 #include <linux/netfilter.h>
21 #include <linux/netfilter_bridge.h>
22 #include <linux/netfilter/ipset/pfxlen.h>
23 #include <linux/netfilter/ipset/ip_set.h>
24 #include <linux/netfilter/ipset/ip_set_hash.h>
25
26 #define IPSET_TYPE_REV_MIN 0
27 /* 1 nomatch flag support added */
28 /* 2 /0 support added */
29 /* 3 Counters support added */
30 /* 4 Comments support added */
31 /* 5 Forceadd support added */
32 #define IPSET_TYPE_REV_MAX 6 /* skbinfo support added */
33
34 MODULE_LICENSE("GPL");
35 MODULE_AUTHOR("Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>");
36 IP_SET_MODULE_DESC("hash:net,iface", IPSET_TYPE_REV_MIN, IPSET_TYPE_REV_MAX);
37 MODULE_ALIAS("ip_set_hash:net,iface");
38
39 /* Type specific function prefix */
40 #define HTYPE hash_netiface
41 #define IP_SET_HASH_WITH_NETS
42 #define IP_SET_HASH_WITH_MULTI
43 #define IP_SET_HASH_WITH_NET0
44
45 #define STRLCPY(a, b) strlcpy(a, b, IFNAMSIZ)
46
47 /* IPv4 variant */
48
49 struct hash_netiface4_elem_hashed {
50 __be32 ip;
51 u8 physdev;
52 u8 cidr;
53 u8 nomatch;
54 u8 elem;
55 };
56
57 /* Member elements */
58 struct hash_netiface4_elem {
59 __be32 ip;
60 u8 physdev;
61 u8 cidr;
62 u8 nomatch;
63 u8 elem;
64 char iface[IFNAMSIZ];
65 };
66
67 /* Common functions */
68
69 static inline bool
hash_netiface4_data_equal(const struct hash_netiface4_elem * ip1,const struct hash_netiface4_elem * ip2,u32 * multi)70 hash_netiface4_data_equal(const struct hash_netiface4_elem *ip1,
71 const struct hash_netiface4_elem *ip2,
72 u32 *multi)
73 {
74 return ip1->ip == ip2->ip &&
75 ip1->cidr == ip2->cidr &&
76 (++*multi) &&
77 ip1->physdev == ip2->physdev &&
78 strcmp(ip1->iface, ip2->iface) == 0;
79 }
80
81 static inline int
hash_netiface4_do_data_match(const struct hash_netiface4_elem * elem)82 hash_netiface4_do_data_match(const struct hash_netiface4_elem *elem)
83 {
84 return elem->nomatch ? -ENOTEMPTY : 1;
85 }
86
87 static inline void
hash_netiface4_data_set_flags(struct hash_netiface4_elem * elem,u32 flags)88 hash_netiface4_data_set_flags(struct hash_netiface4_elem *elem, u32 flags)
89 {
90 elem->nomatch = (flags >> 16) & IPSET_FLAG_NOMATCH;
91 }
92
93 static inline void
hash_netiface4_data_reset_flags(struct hash_netiface4_elem * elem,u8 * flags)94 hash_netiface4_data_reset_flags(struct hash_netiface4_elem *elem, u8 *flags)
95 {
96 swap(*flags, elem->nomatch);
97 }
98
99 static inline void
hash_netiface4_data_netmask(struct hash_netiface4_elem * elem,u8 cidr)100 hash_netiface4_data_netmask(struct hash_netiface4_elem *elem, u8 cidr)
101 {
102 elem->ip &= ip_set_netmask(cidr);
103 elem->cidr = cidr;
104 }
105
106 static bool
hash_netiface4_data_list(struct sk_buff * skb,const struct hash_netiface4_elem * data)107 hash_netiface4_data_list(struct sk_buff *skb,
108 const struct hash_netiface4_elem *data)
109 {
110 u32 flags = data->physdev ? IPSET_FLAG_PHYSDEV : 0;
111
112 if (data->nomatch)
113 flags |= IPSET_FLAG_NOMATCH;
114 if (nla_put_ipaddr4(skb, IPSET_ATTR_IP, data->ip) ||
115 nla_put_u8(skb, IPSET_ATTR_CIDR, data->cidr) ||
116 nla_put_string(skb, IPSET_ATTR_IFACE, data->iface) ||
117 (flags &&
118 nla_put_net32(skb, IPSET_ATTR_CADT_FLAGS, htonl(flags))))
119 goto nla_put_failure;
120 return false;
121
122 nla_put_failure:
123 return true;
124 }
125
126 static inline void
hash_netiface4_data_next(struct hash_netiface4_elem * next,const struct hash_netiface4_elem * d)127 hash_netiface4_data_next(struct hash_netiface4_elem *next,
128 const struct hash_netiface4_elem *d)
129 {
130 next->ip = d->ip;
131 }
132
133 #define MTYPE hash_netiface4
134 #define HOST_MASK 32
135 #define HKEY_DATALEN sizeof(struct hash_netiface4_elem_hashed)
136 #include "ip_set_hash_gen.h"
137
138 #if IS_ENABLED(CONFIG_BRIDGE_NETFILTER)
get_physindev_name(const struct sk_buff * skb)139 static const char *get_physindev_name(const struct sk_buff *skb)
140 {
141 struct net_device *dev = nf_bridge_get_physindev(skb);
142
143 return dev ? dev->name : NULL;
144 }
145
get_physoutdev_name(const struct sk_buff * skb)146 static const char *get_physoutdev_name(const struct sk_buff *skb)
147 {
148 struct net_device *dev = nf_bridge_get_physoutdev(skb);
149
150 return dev ? dev->name : NULL;
151 }
152 #endif
153
154 static int
hash_netiface4_kadt(struct ip_set * set,const struct sk_buff * skb,const struct xt_action_param * par,enum ipset_adt adt,struct ip_set_adt_opt * opt)155 hash_netiface4_kadt(struct ip_set *set, const struct sk_buff *skb,
156 const struct xt_action_param *par,
157 enum ipset_adt adt, struct ip_set_adt_opt *opt)
158 {
159 struct hash_netiface *h = set->data;
160 ipset_adtfn adtfn = set->variant->adt[adt];
161 struct hash_netiface4_elem e = {
162 .cidr = INIT_CIDR(h->nets[0].cidr[0], HOST_MASK),
163 .elem = 1,
164 };
165 struct ip_set_ext ext = IP_SET_INIT_KEXT(skb, opt, set);
166
167 if (e.cidr == 0)
168 return -EINVAL;
169 if (adt == IPSET_TEST)
170 e.cidr = HOST_MASK;
171
172 ip4addrptr(skb, opt->flags & IPSET_DIM_ONE_SRC, &e.ip);
173 e.ip &= ip_set_netmask(e.cidr);
174
175 #define IFACE(dir) (par->dir ? par->dir->name : "")
176 #define SRCDIR (opt->flags & IPSET_DIM_TWO_SRC)
177
178 if (opt->cmdflags & IPSET_FLAG_PHYSDEV) {
179 #if IS_ENABLED(CONFIG_BRIDGE_NETFILTER)
180 const char *eiface = SRCDIR ? get_physindev_name(skb) :
181 get_physoutdev_name(skb);
182
183 if (!eiface)
184 return -EINVAL;
185 STRLCPY(e.iface, eiface);
186 e.physdev = 1;
187 #endif
188 } else {
189 STRLCPY(e.iface, SRCDIR ? IFACE(in) : IFACE(out));
190 }
191
192 if (strlen(e.iface) == 0)
193 return -EINVAL;
194 return adtfn(set, &e, &ext, &opt->ext, opt->cmdflags);
195 }
196
197 static int
hash_netiface4_uadt(struct ip_set * set,struct nlattr * tb[],enum ipset_adt adt,u32 * lineno,u32 flags,bool retried)198 hash_netiface4_uadt(struct ip_set *set, struct nlattr *tb[],
199 enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
200 {
201 struct hash_netiface *h = set->data;
202 ipset_adtfn adtfn = set->variant->adt[adt];
203 struct hash_netiface4_elem e = { .cidr = HOST_MASK, .elem = 1 };
204 struct ip_set_ext ext = IP_SET_INIT_UEXT(set);
205 u32 ip = 0, ip_to = 0, last;
206 int ret;
207
208 if (tb[IPSET_ATTR_LINENO])
209 *lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);
210
211 if (unlikely(!tb[IPSET_ATTR_IP] ||
212 !tb[IPSET_ATTR_IFACE] ||
213 !ip_set_optattr_netorder(tb, IPSET_ATTR_CADT_FLAGS)))
214 return -IPSET_ERR_PROTOCOL;
215
216 ret = ip_set_get_hostipaddr4(tb[IPSET_ATTR_IP], &ip);
217 if (ret)
218 return ret;
219
220 ret = ip_set_get_extensions(set, tb, &ext);
221 if (ret)
222 return ret;
223
224 if (tb[IPSET_ATTR_CIDR]) {
225 e.cidr = nla_get_u8(tb[IPSET_ATTR_CIDR]);
226 if (e.cidr > HOST_MASK)
227 return -IPSET_ERR_INVALID_CIDR;
228 }
229 nla_strlcpy(e.iface, tb[IPSET_ATTR_IFACE], IFNAMSIZ);
230
231 if (tb[IPSET_ATTR_CADT_FLAGS]) {
232 u32 cadt_flags = ip_set_get_h32(tb[IPSET_ATTR_CADT_FLAGS]);
233
234 if (cadt_flags & IPSET_FLAG_PHYSDEV)
235 e.physdev = 1;
236 if (cadt_flags & IPSET_FLAG_NOMATCH)
237 flags |= (IPSET_FLAG_NOMATCH << 16);
238 }
239 if (adt == IPSET_TEST || !tb[IPSET_ATTR_IP_TO]) {
240 e.ip = htonl(ip & ip_set_hostmask(e.cidr));
241 ret = adtfn(set, &e, &ext, &ext, flags);
242 return ip_set_enomatch(ret, flags, adt, set) ? -ret :
243 ip_set_eexist(ret, flags) ? 0 : ret;
244 }
245
246 if (tb[IPSET_ATTR_IP_TO]) {
247 ret = ip_set_get_hostipaddr4(tb[IPSET_ATTR_IP_TO], &ip_to);
248 if (ret)
249 return ret;
250 if (ip_to < ip)
251 swap(ip, ip_to);
252 if (ip + UINT_MAX == ip_to)
253 return -IPSET_ERR_HASH_RANGE;
254 } else {
255 ip_set_mask_from_to(ip, ip_to, e.cidr);
256 }
257
258 if (retried)
259 ip = ntohl(h->next.ip);
260 while (!after(ip, ip_to)) {
261 e.ip = htonl(ip);
262 last = ip_set_range_to_cidr(ip, ip_to, &e.cidr);
263 ret = adtfn(set, &e, &ext, &ext, flags);
264
265 if (ret && !ip_set_eexist(ret, flags))
266 return ret;
267
268 ret = 0;
269 ip = last + 1;
270 }
271 return ret;
272 }
273
274 /* IPv6 variant */
275
276 struct hash_netiface6_elem_hashed {
277 union nf_inet_addr ip;
278 u8 physdev;
279 u8 cidr;
280 u8 nomatch;
281 u8 elem;
282 };
283
284 struct hash_netiface6_elem {
285 union nf_inet_addr ip;
286 u8 physdev;
287 u8 cidr;
288 u8 nomatch;
289 u8 elem;
290 char iface[IFNAMSIZ];
291 };
292
293 /* Common functions */
294
295 static inline bool
hash_netiface6_data_equal(const struct hash_netiface6_elem * ip1,const struct hash_netiface6_elem * ip2,u32 * multi)296 hash_netiface6_data_equal(const struct hash_netiface6_elem *ip1,
297 const struct hash_netiface6_elem *ip2,
298 u32 *multi)
299 {
300 return ipv6_addr_equal(&ip1->ip.in6, &ip2->ip.in6) &&
301 ip1->cidr == ip2->cidr &&
302 (++*multi) &&
303 ip1->physdev == ip2->physdev &&
304 strcmp(ip1->iface, ip2->iface) == 0;
305 }
306
307 static inline int
hash_netiface6_do_data_match(const struct hash_netiface6_elem * elem)308 hash_netiface6_do_data_match(const struct hash_netiface6_elem *elem)
309 {
310 return elem->nomatch ? -ENOTEMPTY : 1;
311 }
312
313 static inline void
hash_netiface6_data_set_flags(struct hash_netiface6_elem * elem,u32 flags)314 hash_netiface6_data_set_flags(struct hash_netiface6_elem *elem, u32 flags)
315 {
316 elem->nomatch = (flags >> 16) & IPSET_FLAG_NOMATCH;
317 }
318
319 static inline void
hash_netiface6_data_reset_flags(struct hash_netiface6_elem * elem,u8 * flags)320 hash_netiface6_data_reset_flags(struct hash_netiface6_elem *elem, u8 *flags)
321 {
322 swap(*flags, elem->nomatch);
323 }
324
325 static inline void
hash_netiface6_data_netmask(struct hash_netiface6_elem * elem,u8 cidr)326 hash_netiface6_data_netmask(struct hash_netiface6_elem *elem, u8 cidr)
327 {
328 ip6_netmask(&elem->ip, cidr);
329 elem->cidr = cidr;
330 }
331
332 static bool
hash_netiface6_data_list(struct sk_buff * skb,const struct hash_netiface6_elem * data)333 hash_netiface6_data_list(struct sk_buff *skb,
334 const struct hash_netiface6_elem *data)
335 {
336 u32 flags = data->physdev ? IPSET_FLAG_PHYSDEV : 0;
337
338 if (data->nomatch)
339 flags |= IPSET_FLAG_NOMATCH;
340 if (nla_put_ipaddr6(skb, IPSET_ATTR_IP, &data->ip.in6) ||
341 nla_put_u8(skb, IPSET_ATTR_CIDR, data->cidr) ||
342 nla_put_string(skb, IPSET_ATTR_IFACE, data->iface) ||
343 (flags &&
344 nla_put_net32(skb, IPSET_ATTR_CADT_FLAGS, htonl(flags))))
345 goto nla_put_failure;
346 return false;
347
348 nla_put_failure:
349 return true;
350 }
351
352 static inline void
hash_netiface6_data_next(struct hash_netiface4_elem * next,const struct hash_netiface6_elem * d)353 hash_netiface6_data_next(struct hash_netiface4_elem *next,
354 const struct hash_netiface6_elem *d)
355 {
356 }
357
358 #undef MTYPE
359 #undef HOST_MASK
360
361 #define MTYPE hash_netiface6
362 #define HOST_MASK 128
363 #define HKEY_DATALEN sizeof(struct hash_netiface6_elem_hashed)
364 #define IP_SET_EMIT_CREATE
365 #include "ip_set_hash_gen.h"
366
367 static int
hash_netiface6_kadt(struct ip_set * set,const struct sk_buff * skb,const struct xt_action_param * par,enum ipset_adt adt,struct ip_set_adt_opt * opt)368 hash_netiface6_kadt(struct ip_set *set, const struct sk_buff *skb,
369 const struct xt_action_param *par,
370 enum ipset_adt adt, struct ip_set_adt_opt *opt)
371 {
372 struct hash_netiface *h = set->data;
373 ipset_adtfn adtfn = set->variant->adt[adt];
374 struct hash_netiface6_elem e = {
375 .cidr = INIT_CIDR(h->nets[0].cidr[0], HOST_MASK),
376 .elem = 1,
377 };
378 struct ip_set_ext ext = IP_SET_INIT_KEXT(skb, opt, set);
379
380 if (e.cidr == 0)
381 return -EINVAL;
382 if (adt == IPSET_TEST)
383 e.cidr = HOST_MASK;
384
385 ip6addrptr(skb, opt->flags & IPSET_DIM_ONE_SRC, &e.ip.in6);
386 ip6_netmask(&e.ip, e.cidr);
387
388 if (opt->cmdflags & IPSET_FLAG_PHYSDEV) {
389 #if IS_ENABLED(CONFIG_BRIDGE_NETFILTER)
390 const char *eiface = SRCDIR ? get_physindev_name(skb) :
391 get_physoutdev_name(skb);
392
393 if (!eiface)
394 return -EINVAL;
395 STRLCPY(e.iface, eiface);
396 e.physdev = 1;
397 #endif
398 } else {
399 STRLCPY(e.iface, SRCDIR ? IFACE(in) : IFACE(out));
400 }
401
402 if (strlen(e.iface) == 0)
403 return -EINVAL;
404
405 return adtfn(set, &e, &ext, &opt->ext, opt->cmdflags);
406 }
407
408 static int
hash_netiface6_uadt(struct ip_set * set,struct nlattr * tb[],enum ipset_adt adt,u32 * lineno,u32 flags,bool retried)409 hash_netiface6_uadt(struct ip_set *set, struct nlattr *tb[],
410 enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
411 {
412 ipset_adtfn adtfn = set->variant->adt[adt];
413 struct hash_netiface6_elem e = { .cidr = HOST_MASK, .elem = 1 };
414 struct ip_set_ext ext = IP_SET_INIT_UEXT(set);
415 int ret;
416
417 if (tb[IPSET_ATTR_LINENO])
418 *lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);
419
420 if (unlikely(!tb[IPSET_ATTR_IP] ||
421 !tb[IPSET_ATTR_IFACE] ||
422 !ip_set_optattr_netorder(tb, IPSET_ATTR_CADT_FLAGS)))
423 return -IPSET_ERR_PROTOCOL;
424 if (unlikely(tb[IPSET_ATTR_IP_TO]))
425 return -IPSET_ERR_HASH_RANGE_UNSUPPORTED;
426
427 ret = ip_set_get_ipaddr6(tb[IPSET_ATTR_IP], &e.ip);
428 if (ret)
429 return ret;
430
431 ret = ip_set_get_extensions(set, tb, &ext);
432 if (ret)
433 return ret;
434
435 if (tb[IPSET_ATTR_CIDR]) {
436 e.cidr = nla_get_u8(tb[IPSET_ATTR_CIDR]);
437 if (e.cidr > HOST_MASK)
438 return -IPSET_ERR_INVALID_CIDR;
439 }
440
441 ip6_netmask(&e.ip, e.cidr);
442
443 nla_strlcpy(e.iface, tb[IPSET_ATTR_IFACE], IFNAMSIZ);
444
445 if (tb[IPSET_ATTR_CADT_FLAGS]) {
446 u32 cadt_flags = ip_set_get_h32(tb[IPSET_ATTR_CADT_FLAGS]);
447
448 if (cadt_flags & IPSET_FLAG_PHYSDEV)
449 e.physdev = 1;
450 if (cadt_flags & IPSET_FLAG_NOMATCH)
451 flags |= (IPSET_FLAG_NOMATCH << 16);
452 }
453
454 ret = adtfn(set, &e, &ext, &ext, flags);
455
456 return ip_set_enomatch(ret, flags, adt, set) ? -ret :
457 ip_set_eexist(ret, flags) ? 0 : ret;
458 }
459
460 static struct ip_set_type hash_netiface_type __read_mostly = {
461 .name = "hash:net,iface",
462 .protocol = IPSET_PROTOCOL,
463 .features = IPSET_TYPE_IP | IPSET_TYPE_IFACE |
464 IPSET_TYPE_NOMATCH,
465 .dimension = IPSET_DIM_TWO,
466 .family = NFPROTO_UNSPEC,
467 .revision_min = IPSET_TYPE_REV_MIN,
468 .revision_max = IPSET_TYPE_REV_MAX,
469 .create = hash_netiface_create,
470 .create_policy = {
471 [IPSET_ATTR_HASHSIZE] = { .type = NLA_U32 },
472 [IPSET_ATTR_MAXELEM] = { .type = NLA_U32 },
473 [IPSET_ATTR_PROBES] = { .type = NLA_U8 },
474 [IPSET_ATTR_RESIZE] = { .type = NLA_U8 },
475 [IPSET_ATTR_PROTO] = { .type = NLA_U8 },
476 [IPSET_ATTR_TIMEOUT] = { .type = NLA_U32 },
477 [IPSET_ATTR_CADT_FLAGS] = { .type = NLA_U32 },
478 },
479 .adt_policy = {
480 [IPSET_ATTR_IP] = { .type = NLA_NESTED },
481 [IPSET_ATTR_IP_TO] = { .type = NLA_NESTED },
482 [IPSET_ATTR_IFACE] = { .type = NLA_NUL_STRING,
483 .len = IFNAMSIZ - 1 },
484 [IPSET_ATTR_CADT_FLAGS] = { .type = NLA_U32 },
485 [IPSET_ATTR_CIDR] = { .type = NLA_U8 },
486 [IPSET_ATTR_TIMEOUT] = { .type = NLA_U32 },
487 [IPSET_ATTR_LINENO] = { .type = NLA_U32 },
488 [IPSET_ATTR_BYTES] = { .type = NLA_U64 },
489 [IPSET_ATTR_PACKETS] = { .type = NLA_U64 },
490 [IPSET_ATTR_COMMENT] = { .type = NLA_NUL_STRING,
491 .len = IPSET_MAX_COMMENT_SIZE },
492 [IPSET_ATTR_SKBMARK] = { .type = NLA_U64 },
493 [IPSET_ATTR_SKBPRIO] = { .type = NLA_U32 },
494 [IPSET_ATTR_SKBQUEUE] = { .type = NLA_U16 },
495 },
496 .me = THIS_MODULE,
497 };
498
499 static int __init
hash_netiface_init(void)500 hash_netiface_init(void)
501 {
502 return ip_set_type_register(&hash_netiface_type);
503 }
504
505 static void __exit
hash_netiface_fini(void)506 hash_netiface_fini(void)
507 {
508 rcu_barrier();
509 ip_set_type_unregister(&hash_netiface_type);
510 }
511
512 module_init(hash_netiface_init);
513 module_exit(hash_netiface_fini);
514