#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 print_mac(const unsigned char *macaddress)
|
{
|
unsigned int i;
|
|
printf(" %02X", macaddress[0]);
|
for (i = 1; i < ETH_ALEN; ++i)
|
printf(":%02X", macaddress[i]);
|
}
|
|
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(" !");
|
|
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");
|
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);
|
}
|
