You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

103 lines
2.1 KiB

#include <stdio.h>
#if defined(__GLIBC__) && __GLIBC__ == 2
#include <net/ethernet.h>
#else
#include <linux/if_ether.h>
#endif
#include <xtables.h>
#include <linux/netfilter/xt_mac.h>
enum {
O_MAC = 0,
};
static void mac_help(void)
{
printf(
"mac match options:\n"
"[!] --mac-source XX:XX:XX:XX:XX:XX\n"
" Match source MAC address\n");
}
#define s struct xt_mac_info
static const struct xt_option_entry mac_opts[] = {
{.name = "mac-source", .id = O_MAC, .type = XTTYPE_ETHERMAC,
.flags = XTOPT_MAND | XTOPT_INVERT | XTOPT_PUT,
XTOPT_POINTER(s, srcaddr)},
XTOPT_TABLEEND,
};
#undef s
static void mac_parse(struct xt_option_call *cb)
{
struct xt_mac_info *macinfo = cb->data;
xtables_option_parse(cb);
if (cb->invert)
macinfo->invert = 1;
}
static void
mac_print(const void *ip, const struct xt_entry_match *match, int numeric)
{
const struct xt_mac_info *info = (void *)match->data;
printf(" MAC");
if (info->invert)
printf(" !");
xtables_print_mac(info->srcaddr);
}
static void mac_save(const void *ip, const struct xt_entry_match *match)
{
const struct xt_mac_info *info = (void *)match->data;
if (info->invert)
printf(" !");
printf(" --mac-source ");
xtables_print_mac(info->srcaddr);
}
static void print_mac_xlate(const unsigned char *macaddress,
struct xt_xlate *xl)
{
unsigned int i;
xt_xlate_add(xl, "%02x", macaddress[0]);
for (i = 1; i < ETH_ALEN; ++i)
xt_xlate_add(xl, ":%02x", macaddress[i]);
}
static int mac_xlate(struct xt_xlate *xl,
const struct xt_xlate_mt_params *params)
{
const struct xt_mac_info *info = (void *)params->match->data;
xt_xlate_add(xl, "ether saddr%s ", info->invert ? " !=" : "");
print_mac_xlate(info->srcaddr, xl);
return 1;
}
static struct xtables_match mac_match = {
.family = NFPROTO_UNSPEC,
.name = "mac",
.version = XTABLES_VERSION,
.size = XT_ALIGN(sizeof(struct xt_mac_info)),
.userspacesize = XT_ALIGN(sizeof(struct xt_mac_info)),
.help = mac_help,
.x6_parse = mac_parse,
.print = mac_print,
.save = mac_save,
.x6_options = mac_opts,
.xlate = mac_xlate,
};
void _init(void)
{
xtables_register_match(&mac_match);
}