net/netfilter/ipset/ip_set_hash_ipport.c

   1 /* Copyright (C) 2003-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:ip,port 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 #include <net/tcp.h>
  20
  21 #include <linux/netfilter.h>
  22 #include <linux/netfilter/ipset/pfxlen.h>
  23 #include <linux/netfilter/ipset/ip_set.h>
  24 #include <linux/netfilter/ipset/ip_set_getport.h>
  25 #include <linux/netfilter/ipset/ip_set_hash.h>
  26
  27 #define IPSET_TYPE_REV_MIN      0
  28 /*                              1    SCTP and UDPLITE support added */
  29 /*                              2    Counters support added */
  30 #define IPSET_TYPE_REV_MAX      3 /* Comments support added */
  31
  32 MODULE_LICENSE("GPL");
  33 MODULE_AUTHOR("Jozsef Kadlecsik <kadlec@blackhole.kfki.hu>");
  34 IP_SET_MODULE_DESC("hash:ip,port", IPSET_TYPE_REV_MIN, IPSET_TYPE_REV_MAX);
  35 MODULE_ALIAS("ip_set_hash:ip,port");
  36
  37 /* Type specific function prefix */
  38 #define HTYPE           hash_ipport
  39
  40 /* IPv4 variant */
  41
  42 /* Member elements */
  43 struct hash_ipport4_elem {
  44         __be32 ip;
  45         __be16 port;
  46         u8 proto;
  47         u8 padding;
  48 };
  49
  50 /* Common functions */
  51
  52 static inline bool
  53 hash_ipport4_data_equal(const struct hash_ipport4_elem *ip1,
  54                         const struct hash_ipport4_elem *ip2,
  55                         u32 *multi)
  56 {
  57         return ip1->ip == ip2->ip &&
  58                ip1->port == ip2->port &&
  59                ip1->proto == ip2->proto;
  60 }
  61
  62 static bool
  63 hash_ipport4_data_list(struct sk_buff *skb,
  64                        const struct hash_ipport4_elem *data)
  65 {
  66         if (nla_put_ipaddr4(skb, IPSET_ATTR_IP, data->ip) ||
  67             nla_put_net16(skb, IPSET_ATTR_PORT, data->port) ||
  68             nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto))
  69                 goto nla_put_failure;
  70         return 0;
  71
  72 nla_put_failure:
  73         return 1;
  74 }
  75
  76 static inline void
  77 hash_ipport4_data_next(struct hash_ipport4_elem *next,
  78                        const struct hash_ipport4_elem *d)
  79 {
  80         next->ip = d->ip;
  81         next->port = d->port;
  82 }
  83
  84 #define MTYPE           hash_ipport4
  85 #define PF              4
  86 #define HOST_MASK       32
  87 #define HKEY_DATALEN    sizeof(struct hash_ipport4_elem)
  88 #include "ip_set_hash_gen.h"
  89
  90 static int
  91 hash_ipport4_kadt(struct ip_set *set, const struct sk_buff *skb,
  92                   const struct xt_action_param *par,
  93                   enum ipset_adt adt, struct ip_set_adt_opt *opt)
  94 {
  95         ipset_adtfn adtfn = set->variant->adt[adt];
  96         struct hash_ipport4_elem e = { };
  97         struct ip_set_ext ext = IP_SET_INIT_KEXT(skb, opt, set);
  98
  99         if (!ip_set_get_ip4_port(skb, opt->flags & IPSET_DIM_TWO_SRC,
 100                                  &e.port, &e.proto))
 101                 return -EINVAL;
 102
 103         ip4addrptr(skb, opt->flags & IPSET_DIM_ONE_SRC, &e.ip);
 104         return adtfn(set, &e, &ext, &opt->ext, opt->cmdflags);
 105 }
 106
 107 static int
 108 hash_ipport4_uadt(struct ip_set *set, struct nlattr *tb[],
 109                   enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
 110 {
 111         const struct hash_ipport *h = set->data;
 112         ipset_adtfn adtfn = set->variant->adt[adt];
 113         struct hash_ipport4_elem e = { };
 114         struct ip_set_ext ext = IP_SET_INIT_UEXT(set);
 115         u32 ip, ip_to = 0, p = 0, port, port_to;
 116         bool with_ports = false;
 117         int ret;
 118
 119         if (unlikely(!tb[IPSET_ATTR_IP] ||
 120                      !ip_set_attr_netorder(tb, IPSET_ATTR_PORT) ||
 121                      !ip_set_optattr_netorder(tb, IPSET_ATTR_PORT_TO) ||
 122                      !ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT) ||
 123                      !ip_set_optattr_netorder(tb, IPSET_ATTR_PACKETS) ||
 124                      !ip_set_optattr_netorder(tb, IPSET_ATTR_BYTES)))
 125                 return -IPSET_ERR_PROTOCOL;
 126
 127         if (tb[IPSET_ATTR_LINENO])
 128                 *lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);
 129
 130         ret = ip_set_get_ipaddr4(tb[IPSET_ATTR_IP], &e.ip) ||
 131               ip_set_get_extensions(set, tb, &ext);
 132         if (ret)
 133                 return ret;
 134
 135         if (tb[IPSET_ATTR_PORT])
 136                 e.port = nla_get_be16(tb[IPSET_ATTR_PORT]);
 137         else
 138                 return -IPSET_ERR_PROTOCOL;
 139
 140         if (tb[IPSET_ATTR_PROTO]) {
 141                 e.proto = nla_get_u8(tb[IPSET_ATTR_PROTO]);
 142                 with_ports = ip_set_proto_with_ports(e.proto);
 143
 144                 if (e.proto == 0)
 145                         return -IPSET_ERR_INVALID_PROTO;
 146         } else
 147                 return -IPSET_ERR_MISSING_PROTO;
 148
 149         if (!(with_ports || e.proto == IPPROTO_ICMP))
 150                 e.port = 0;
 151
 152         if (adt == IPSET_TEST ||
 153             !(tb[IPSET_ATTR_IP_TO] || tb[IPSET_ATTR_CIDR] ||
 154               tb[IPSET_ATTR_PORT_TO])) {
 155                 ret = adtfn(set, &e, &ext, &ext, flags);
 156                 return ip_set_eexist(ret, flags) ? 0 : ret;
 157         }
 158
 159         ip_to = ip = ntohl(e.ip);
 160         if (tb[IPSET_ATTR_IP_TO]) {
 161                 ret = ip_set_get_hostipaddr4(tb[IPSET_ATTR_IP_TO], &ip_to);
 162                 if (ret)
 163                         return ret;
 164                 if (ip > ip_to)
 165                         swap(ip, ip_to);
 166         } else if (tb[IPSET_ATTR_CIDR]) {
 167                 u8 cidr = nla_get_u8(tb[IPSET_ATTR_CIDR]);
 168
 169                 if (!cidr || cidr > 32)
 170                         return -IPSET_ERR_INVALID_CIDR;
 171                 ip_set_mask_from_to(ip, ip_to, cidr);
 172         }
 173
 174         port_to = port = ntohs(e.port);
 175         if (with_ports && tb[IPSET_ATTR_PORT_TO]) {
 176                 port_to = ip_set_get_h16(tb[IPSET_ATTR_PORT_TO]);
 177                 if (port > port_to)
 178                         swap(port, port_to);
 179         }
 180
 181         if (retried)
 182                 ip = ntohl(h->next.ip);
 183         for (; !before(ip_to, ip); ip++) {
 184                 p = retried && ip == ntohl(h->next.ip) ? ntohs(h->next.port)
 185                                                        : port;
 186                 for (; p <= port_to; p++) {
 187                         e.ip = htonl(ip);
 188                         e.port = htons(p);
 189                         ret = adtfn(set, &e, &ext, &ext, flags);
 190
 191                         if (ret && !ip_set_eexist(ret, flags))
 192                                 return ret;
 193                         else
 194                                 ret = 0;
 195                 }
 196         }
 197         return ret;
 198 }
 199
 200 /* IPv6 variant */
 201
 202 struct hash_ipport6_elem {
 203         union nf_inet_addr ip;
 204         __be16 port;
 205         u8 proto;
 206         u8 padding;
 207 };
 208
 209 /* Common functions */
 210
 211 static inline bool
 212 hash_ipport6_data_equal(const struct hash_ipport6_elem *ip1,
 213                         const struct hash_ipport6_elem *ip2,
 214                         u32 *multi)
 215 {
 216         return ipv6_addr_equal(&ip1->ip.in6, &ip2->ip.in6) &&
 217                ip1->port == ip2->port &&
 218                ip1->proto == ip2->proto;
 219 }
 220
 221 static bool
 222 hash_ipport6_data_list(struct sk_buff *skb,
 223                        const struct hash_ipport6_elem *data)
 224 {
 225         if (nla_put_ipaddr6(skb, IPSET_ATTR_IP, &data->ip.in6) ||
 226             nla_put_net16(skb, IPSET_ATTR_PORT, data->port) ||
 227             nla_put_u8(skb, IPSET_ATTR_PROTO, data->proto))
 228                 goto nla_put_failure;
 229         return 0;
 230
 231 nla_put_failure:
 232         return 1;
 233 }
 234
 235 static inline void
 236 hash_ipport6_data_next(struct hash_ipport4_elem *next,
 237                        const struct hash_ipport6_elem *d)
 238 {
 239         next->port = d->port;
 240 }
 241
 242 #undef MTYPE
 243 #undef PF
 244 #undef HOST_MASK
 245 #undef HKEY_DATALEN
 246
 247 #define MTYPE           hash_ipport6
 248 #define PF              6
 249 #define HOST_MASK       128
 250 #define HKEY_DATALEN    sizeof(struct hash_ipport6_elem)
 251 #define IP_SET_EMIT_CREATE
 252 #include "ip_set_hash_gen.h"
 253
 254 static int
 255 hash_ipport6_kadt(struct ip_set *set, const struct sk_buff *skb,
 256                   const struct xt_action_param *par,
 257                   enum ipset_adt adt, struct ip_set_adt_opt *opt)
 258 {
 259         ipset_adtfn adtfn = set->variant->adt[adt];
 260         struct hash_ipport6_elem e = { };
 261         struct ip_set_ext ext = IP_SET_INIT_KEXT(skb, opt, set);
 262
 263         if (!ip_set_get_ip6_port(skb, opt->flags & IPSET_DIM_TWO_SRC,
 264                                  &e.port, &e.proto))
 265                 return -EINVAL;
 266
 267         ip6addrptr(skb, opt->flags & IPSET_DIM_ONE_SRC, &e.ip.in6);
 268         return adtfn(set, &e, &ext, &opt->ext, opt->cmdflags);
 269 }
 270
 271 static int
 272 hash_ipport6_uadt(struct ip_set *set, struct nlattr *tb[],
 273                   enum ipset_adt adt, u32 *lineno, u32 flags, bool retried)
 274 {
 275         const struct hash_ipport *h = set->data;
 276         ipset_adtfn adtfn = set->variant->adt[adt];
 277         struct hash_ipport6_elem e = { };
 278         struct ip_set_ext ext = IP_SET_INIT_UEXT(set);
 279         u32 port, port_to;
 280         bool with_ports = false;
 281         int ret;
 282
 283         if (unlikely(!tb[IPSET_ATTR_IP] ||
 284                      !ip_set_attr_netorder(tb, IPSET_ATTR_PORT) ||
 285                      !ip_set_optattr_netorder(tb, IPSET_ATTR_PORT_TO) ||
 286                      !ip_set_optattr_netorder(tb, IPSET_ATTR_TIMEOUT) ||
 287                      !ip_set_optattr_netorder(tb, IPSET_ATTR_PACKETS) ||
 288                      !ip_set_optattr_netorder(tb, IPSET_ATTR_BYTES) ||
 289                      tb[IPSET_ATTR_IP_TO] ||
 290                      tb[IPSET_ATTR_CIDR]))
 291                 return -IPSET_ERR_PROTOCOL;
 292
 293         if (tb[IPSET_ATTR_LINENO])
 294                 *lineno = nla_get_u32(tb[IPSET_ATTR_LINENO]);
 295
 296         ret = ip_set_get_ipaddr6(tb[IPSET_ATTR_IP], &e.ip) ||
 297               ip_set_get_extensions(set, tb, &ext);
 298         if (ret)
 299                 return ret;
 300
 301         if (tb[IPSET_ATTR_PORT])
 302                 e.port = nla_get_be16(tb[IPSET_ATTR_PORT]);
 303         else
 304                 return -IPSET_ERR_PROTOCOL;
 305
 306         if (tb[IPSET_ATTR_PROTO]) {
 307                 e.proto = nla_get_u8(tb[IPSET_ATTR_PROTO]);
 308                 with_ports = ip_set_proto_with_ports(e.proto);
 309
 310                 if (e.proto == 0)
 311                         return -IPSET_ERR_INVALID_PROTO;
 312         } else
 313                 return -IPSET_ERR_MISSING_PROTO;
 314
 315         if (!(with_ports || e.proto == IPPROTO_ICMPV6))
 316                 e.port = 0;
 317
 318         if (adt == IPSET_TEST || !with_ports || !tb[IPSET_ATTR_PORT_TO]) {
 319                 ret = adtfn(set, &e, &ext, &ext, flags);
 320                 return ip_set_eexist(ret, flags) ? 0 : ret;
 321         }
 322
 323         port = ntohs(e.port);
 324         port_to = ip_set_get_h16(tb[IPSET_ATTR_PORT_TO]);
 325         if (port > port_to)
 326                 swap(port, port_to);
 327
 328         if (retried)
 329                 port = ntohs(h->next.port);
 330         for (; port <= port_to; port++) {
 331                 e.port = htons(port);
 332                 ret = adtfn(set, &e, &ext, &ext, flags);
 333
 334                 if (ret && !ip_set_eexist(ret, flags))
 335                         return ret;
 336                 else
 337                         ret = 0;
 338         }
 339         return ret;
 340 }
 341
 342 static struct ip_set_type hash_ipport_type __read_mostly = {
 343         .name           = "hash:ip,port",
 344         .protocol       = IPSET_PROTOCOL,
 345         .features       = IPSET_TYPE_IP | IPSET_TYPE_PORT,
 346         .dimension      = IPSET_DIM_TWO,
 347         .family         = NFPROTO_UNSPEC,
 348         .revision_min   = IPSET_TYPE_REV_MIN,
 349         .revision_max   = IPSET_TYPE_REV_MAX,
 350         .create         = hash_ipport_create,
 351         .create_policy  = {
 352                 [IPSET_ATTR_HASHSIZE]   = { .type = NLA_U32 },
 353                 [IPSET_ATTR_MAXELEM]    = { .type = NLA_U32 },
 354                 [IPSET_ATTR_PROBES]     = { .type = NLA_U8 },
 355                 [IPSET_ATTR_RESIZE]     = { .type = NLA_U8  },
 356                 [IPSET_ATTR_PROTO]      = { .type = NLA_U8 },
 357                 [IPSET_ATTR_TIMEOUT]    = { .type = NLA_U32 },
 358                 [IPSET_ATTR_CADT_FLAGS] = { .type = NLA_U32 },
 359         },
 360         .adt_policy     = {
 361                 [IPSET_ATTR_IP]         = { .type = NLA_NESTED },
 362                 [IPSET_ATTR_IP_TO]      = { .type = NLA_NESTED },
 363                 [IPSET_ATTR_PORT]       = { .type = NLA_U16 },
 364                 [IPSET_ATTR_PORT_TO]    = { .type = NLA_U16 },
 365                 [IPSET_ATTR_CIDR]       = { .type = NLA_U8 },
 366                 [IPSET_ATTR_PROTO]      = { .type = NLA_U8 },
 367                 [IPSET_ATTR_TIMEOUT]    = { .type = NLA_U32 },
 368                 [IPSET_ATTR_LINENO]     = { .type = NLA_U32 },
 369                 [IPSET_ATTR_BYTES]      = { .type = NLA_U64 },
 370                 [IPSET_ATTR_PACKETS]    = { .type = NLA_U64 },
 371                 [IPSET_ATTR_COMMENT]    = { .type = NLA_NUL_STRING },
 372         },
 373         .me             = THIS_MODULE,
 374 };
 375
 376 static int __init
 377 hash_ipport_init(void)
 378 {
 379         return ip_set_type_register(&hash_ipport_type);
 380 }
 381
 382 static void __exit
 383 hash_ipport_fini(void)
 384 {
 385         ip_set_type_unregister(&hash_ipport_type);
 386 }
 387
 388 module_init(hash_ipport_init);
 389 module_exit(hash_ipport_fini);