| 1 | // SPDX-License-Identifier: GPL-2.0-only |
| 2 | /* Copyright (C) 2014 Jozsef Kadlecsik <kadlec@netfilter.org> */ |
| 3 | |
| 4 | /* Kernel module implementing an IP set type: the hash:mac type */ |
| 5 | |
| 6 | #include <linux/jhash.h> |
| 7 | #include <linux/module.h> |
| 8 | #include <linux/etherdevice.h> |
| 9 | #include <linux/skbuff.h> |
| 10 | #include <linux/errno.h> |
| 11 | #include <linux/if_ether.h> |
| 12 | #include <net/netlink.h> |
| 13 | |
| 14 | #include <linux/netfilter.h> |
| 15 | #include <linux/netfilter/ipset/ip_set.h> |
| 16 | #include <linux/netfilter/ipset/ip_set_hash.h> |
| 17 | |
| 18 | #define IPSET_TYPE_REV_MIN 0 |
| 19 | #define IPSET_TYPE_REV_MAX 1 /* bucketsize, initval support */ |
| 20 | |
| 21 | MODULE_LICENSE("GPL" ); |
| 22 | MODULE_AUTHOR("Jozsef Kadlecsik <kadlec@netfilter.org>" ); |
| 23 | IP_SET_MODULE_DESC("hash:mac" , IPSET_TYPE_REV_MIN, IPSET_TYPE_REV_MAX); |
| 24 | MODULE_ALIAS("ip_set_hash:mac" ); |
| 25 | |
| 26 | /* Type specific function prefix */ |
| 27 | #define HTYPE hash_mac |
| 28 | |
| 29 | /* Member elements */ |
| 30 | struct hash_mac4_elem { |
| 31 | /* Zero valued IP addresses cannot be stored */ |
| 32 | union { |
| 33 | unsigned char ether[ETH_ALEN]; |
| 34 | __be32 foo[2]; |
| 35 | }; |
| 36 | }; |
| 37 | |
| 38 | /* Common functions */ |
| 39 | |
| 40 | static bool |
| 41 | hash_mac4_data_equal(const struct hash_mac4_elem *e1, |
| 42 | const struct hash_mac4_elem *e2, |
| 43 | u32 *multi) |
| 44 | { |
| 45 | return ether_addr_equal(addr1: e1->ether, addr2: e2->ether); |
| 46 | } |
| 47 | |
| 48 | static bool |
| 49 | hash_mac4_data_list(struct sk_buff *skb, const struct hash_mac4_elem *e) |
| 50 | { |
| 51 | if (nla_put(skb, attrtype: IPSET_ATTR_ETHER, ETH_ALEN, data: e->ether)) |
| 52 | goto nla_put_failure; |
| 53 | return false; |
| 54 | |
| 55 | nla_put_failure: |
| 56 | return true; |
| 57 | } |
| 58 | |
| 59 | static void |
| 60 | hash_mac4_data_next(struct hash_mac4_elem *next, |
| 61 | const struct hash_mac4_elem *e) |
| 62 | { |
| 63 | } |
| 64 | |
| 65 | #define MTYPE hash_mac4 |
| 66 | #define HOST_MASK 32 |
| 67 | #define IP_SET_EMIT_CREATE |
| 68 | #define IP_SET_PROTO_UNDEF |
| 69 | #include "ip_set_hash_gen.h" |
| 70 | |
| 71 | static int |
| 72 | hash_mac4_kadt(struct ip_set *set, const struct sk_buff *skb, |
| 73 | const struct xt_action_param *par, |
| 74 | enum ipset_adt adt, struct ip_set_adt_opt *opt) |
| 75 | { |
| 76 | ipset_adtfn adtfn = set->variant->adt[adt]; |
| 77 | struct hash_mac4_elem e = { { .foo[0] = 0, .foo[1] = 0 } }; |
| 78 | struct ip_set_ext ext = IP_SET_INIT_KEXT(skb, opt, set); |
| 79 | |
| 80 | if (skb_mac_header(skb) < skb->head || |
| 81 | (skb_mac_header(skb) + ETH_HLEN) > skb->data) |
| 82 | return -EINVAL; |
| 83 | |
| 84 | if (opt->flags & IPSET_DIM_ONE_SRC) |
| 85 | ether_addr_copy(dst: e.ether, src: eth_hdr(skb)->h_source); |
| 86 | else |
| 87 | ether_addr_copy(dst: e.ether, src: eth_hdr(skb)->h_dest); |
| 88 | |
| 89 | if (is_zero_ether_addr(addr: e.ether)) |
| 90 | return -EINVAL; |
| 91 | return adtfn(set, &e, &ext, &opt->ext, opt->cmdflags); |
| 92 | } |
| 93 | |
| 94 | static int |
| 95 | hash_mac4_uadt(struct ip_set *set, struct nlattr *tb[], |
| 96 | enum ipset_adt adt, u32 *lineno, u32 flags, bool retried) |
| 97 | { |
| 98 | ipset_adtfn adtfn = set->variant->adt[adt]; |
| 99 | struct hash_mac4_elem e = { { .foo[0] = 0, .foo[1] = 0 } }; |
| 100 | struct ip_set_ext ext = IP_SET_INIT_UEXT(set); |
| 101 | int ret; |
| 102 | |
| 103 | if (tb[IPSET_ATTR_LINENO]) |
| 104 | *lineno = nla_get_u32(nla: tb[IPSET_ATTR_LINENO]); |
| 105 | |
| 106 | if (unlikely(!tb[IPSET_ATTR_ETHER] || |
| 107 | nla_len(tb[IPSET_ATTR_ETHER]) != ETH_ALEN)) |
| 108 | return -IPSET_ERR_PROTOCOL; |
| 109 | |
| 110 | ret = ip_set_get_extensions(set, tb, ext: &ext); |
| 111 | if (ret) |
| 112 | return ret; |
| 113 | ether_addr_copy(dst: e.ether, src: nla_data(nla: tb[IPSET_ATTR_ETHER])); |
| 114 | if (is_zero_ether_addr(addr: e.ether)) |
| 115 | return -IPSET_ERR_HASH_ELEM; |
| 116 | |
| 117 | return adtfn(set, &e, &ext, &ext, flags); |
| 118 | } |
| 119 | |
| 120 | static struct ip_set_type hash_mac_type __read_mostly = { |
| 121 | .name = "hash:mac" , |
| 122 | .protocol = IPSET_PROTOCOL, |
| 123 | .features = IPSET_TYPE_MAC, |
| 124 | .dimension = IPSET_DIM_ONE, |
| 125 | .family = NFPROTO_UNSPEC, |
| 126 | .revision_min = IPSET_TYPE_REV_MIN, |
| 127 | .revision_max = IPSET_TYPE_REV_MAX, |
| 128 | .create_flags[IPSET_TYPE_REV_MAX] = IPSET_CREATE_FLAG_BUCKETSIZE, |
| 129 | .create = hash_mac_create, |
| 130 | .create_policy = { |
| 131 | [IPSET_ATTR_HASHSIZE] = { .type = NLA_U32 }, |
| 132 | [IPSET_ATTR_MAXELEM] = { .type = NLA_U32 }, |
| 133 | [IPSET_ATTR_INITVAL] = { .type = NLA_U32 }, |
| 134 | [IPSET_ATTR_BUCKETSIZE] = { .type = NLA_U8 }, |
| 135 | [IPSET_ATTR_RESIZE] = { .type = NLA_U8 }, |
| 136 | [IPSET_ATTR_TIMEOUT] = { .type = NLA_U32 }, |
| 137 | [IPSET_ATTR_CADT_FLAGS] = { .type = NLA_U32 }, |
| 138 | }, |
| 139 | .adt_policy = { |
| 140 | [IPSET_ATTR_ETHER] = { .type = NLA_BINARY, |
| 141 | .len = ETH_ALEN }, |
| 142 | [IPSET_ATTR_TIMEOUT] = { .type = NLA_U32 }, |
| 143 | [IPSET_ATTR_LINENO] = { .type = NLA_U32 }, |
| 144 | [IPSET_ATTR_BYTES] = { .type = NLA_U64 }, |
| 145 | [IPSET_ATTR_PACKETS] = { .type = NLA_U64 }, |
| 146 | [IPSET_ATTR_COMMENT] = { .type = NLA_NUL_STRING, |
| 147 | .len = IPSET_MAX_COMMENT_SIZE }, |
| 148 | [IPSET_ATTR_SKBMARK] = { .type = NLA_U64 }, |
| 149 | [IPSET_ATTR_SKBPRIO] = { .type = NLA_U32 }, |
| 150 | [IPSET_ATTR_SKBQUEUE] = { .type = NLA_U16 }, |
| 151 | }, |
| 152 | .me = THIS_MODULE, |
| 153 | }; |
| 154 | |
| 155 | static int __init |
| 156 | hash_mac_init(void) |
| 157 | { |
| 158 | return ip_set_type_register(set_type: &hash_mac_type); |
| 159 | } |
| 160 | |
| 161 | static void __exit |
| 162 | hash_mac_fini(void) |
| 163 | { |
| 164 | rcu_barrier(); |
| 165 | ip_set_type_unregister(set_type: &hash_mac_type); |
| 166 | } |
| 167 | |
| 168 | module_init(hash_mac_init); |
| 169 | module_exit(hash_mac_fini); |
| 170 | |