From 2c3e49def40b41677182fc9243128f11c5e148e9 Mon Sep 17 00:00:00 2001 From: kadlec Date: Mon, 9 Feb 2004 13:47:01 +0000 Subject: Userspace part of sets: ipset added (JK) --- ipset_macipmap.c | 387 +++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 387 insertions(+) create mode 100644 ipset_macipmap.c (limited to 'ipset_macipmap.c') diff --git a/ipset_macipmap.c b/ipset_macipmap.c new file mode 100644 index 0000000..eff42ce --- /dev/null +++ b/ipset_macipmap.c @@ -0,0 +1,387 @@ +/* Copyright 2000, 2001, 2002 Joakim Axelsson (gozem@linux.nu) + * Patrick Schaaf (bof@bof.de) + * Martin Josefsson (gandalf@wlug.westbo.se) + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ + + +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include "ipset.h" + +#define BUFLEN 30; + +#define OPT_CREATE_FROM 0x01U +#define OPT_CREATE_TO 0x02U +#define OPT_CREATE_NETWORK 0x04U +#define OPT_CREATE_MATCHUNSET 0x08U + +#define OPT_ADDDEL_IP 0x01U +#define OPT_ADDDEL_MAC 0x02U + +/* Initialize the create. */ +void create_init(void *data) +{ + DP("create INIT"); + /* Nothing */ +} + +/* Function which parses command options; returns true if it ate an option */ +int create_parse(int c, char *argv[], void *data, unsigned *flags) +{ + struct ip_set_req_macipmap_create *mydata = + (struct ip_set_req_macipmap_create *) data; + + DP("create_parse"); + + switch (c) { + case '1': + parse_ip(optarg, &mydata->from); + + *flags |= OPT_CREATE_FROM; + + DP("--from %x (%s)", mydata->from, + ip_tostring(mydata->from, 0)); + + break; + + case '2': + parse_ip(optarg, &mydata->to); + + *flags |= OPT_CREATE_TO; + + DP("--to %x (%s)", mydata->to, ip_tostring(mydata->to, 0)); + + break; + + case '3': + parse_ipandmask(optarg, &mydata->from, &mydata->to); + + /* Make to the last of from + mask */ + mydata->to = mydata->from | (~mydata->to); + + *flags |= OPT_CREATE_NETWORK; + + DP("--network from %x (%s)", mydata->from, + ip_tostring(mydata->from, 0)); + DP("--network to %x (%s)", mydata->to, + ip_tostring(mydata->to, 0)); + + break; + + case '4': + mydata->flags |= IPSET_MACIP_MATCHUNSET; + + *flags |= OPT_CREATE_MATCHUNSET; + + DP("--matchunset"); + + break; + + default: + return 0; + } + + return 1; +} + +/* Final check; exit if not ok. */ +void create_final(void *data, unsigned int flags) +{ + struct ip_set_req_macipmap_create *mydata = + (struct ip_set_req_macipmap_create *) data; + + if (flags == 0) + exit_error(PARAMETER_PROBLEM, + "Need to specify --from and --to, or --network\n"); + + if (flags & OPT_CREATE_NETWORK) { + /* --network */ + if ((flags & OPT_CREATE_FROM) || (flags & OPT_CREATE_TO)) + exit_error(PARAMETER_PROBLEM, + "Can't specify --from or --to with --network\n"); + } else { + /* --from --to */ + if ((flags & OPT_CREATE_FROM) == 0 + || (flags & OPT_CREATE_TO) == 0) + exit_error(PARAMETER_PROBLEM, + "Need to specify both --from and --to\n"); + } + + + DP("from : %x to: %x diff: %d match unset: %d", mydata->from, + mydata->to, mydata->to - mydata->from, + flags & OPT_CREATE_MATCHUNSET); + + if (mydata->from > mydata->to) + exit_error(PARAMETER_PROBLEM, + "From can't be lower than to.\n", MAX_RANGE); + + if (mydata->to - mydata->from > MAX_RANGE) + exit_error(PARAMETER_PROBLEM, + "Range to large. Max is %d IPs in range\n", + MAX_RANGE); +} + +/* Create commandline options */ +static struct option create_opts[] = { + {"from", 1, 0, '1'}, + {"to", 1, 0, '2'}, + {"network", 1, 0, '3'}, + {"matchunset", 0, 0, '4'}, + {0} +}; + +static void parse_mac(const char *mac, unsigned char *ethernet) +{ + unsigned int i = 0; + + if (strlen(mac) != ETH_ALEN * 3 - 1) + exit_error(PARAMETER_PROBLEM, "Bad mac address `%s'", mac); + + for (i = 0; i < ETH_ALEN; i++) { + long number; + char *end; + + number = strtol(mac + i * 3, &end, 16); + + if (end == mac + i * 3 + 2 && number >= 0 && number <= 255) + ethernet[i] = number; + else + exit_error(PARAMETER_PROBLEM, + "Bad mac address `%s'", mac); + } +} + +/* Add, del, test parser */ +ip_set_ip_t adt_parser(int cmd, const char *optarg, + void *data, const void *setdata) +{ + struct ip_set_req_macipmap *mydata = + (struct ip_set_req_macipmap *) data; + struct ip_set_macipmap *mysetdata = + (struct ip_set_macipmap *) setdata; + char *saved = strdup(optarg); + char *ptr, *tmp = saved; + + DP("macipmap: %p %p", data, setdata); + + ptr = strsep(&tmp, "%"); + parse_ip(ptr, &mydata->ip); + + if (cmd == ADT_ADD && !tmp) + exit_error(PARAMETER_PROBLEM, + "Need to specify ip[mac]\n"); + + if (tmp) + parse_mac(tmp, mydata->ethernet); + else + memset(mydata->ethernet, 0, ETH_ALEN); + + DP("from %s", ip_tostring(mysetdata->first_ip, 0)); + DP("to %s", ip_tostring(mysetdata->last_ip, 0)); + DP("ip %s", ip_tostring(mydata->ip, 0)); + + if (mydata->ip < mysetdata->first_ip || + mydata->ip > mysetdata->last_ip) + exit_error(PARAMETER_PROBLEM, "IP '%s' is out of range\n", + ip_tostring(mydata->ip, 0)); + + free(saved); + + return mydata->ip; +} + +ip_set_ip_t getipbyid(const void *setdata, ip_set_ip_t id) +{ + struct ip_set_macipmap *mysetdata = + (struct ip_set_macipmap *) setdata; + + return (mysetdata->first_ip + id); +} + +ip_set_ip_t sizeid(const void *setdata) +{ + struct ip_set_macipmap *mysetdata = + (struct ip_set_macipmap *) setdata; + + return (mysetdata->last_ip - mysetdata->first_ip + 1); +} + +void initheader(void **setdata, void *data, size_t len) +{ + struct ip_set_req_macipmap_create *header = + (struct ip_set_req_macipmap_create *) data; + + DP("macipmap: initheader() 1"); + + if (len != sizeof(struct ip_set_req_macipmap_create)) + exit_error(OTHER_PROBLEM, + "Macipmap: incorrect size of header. " + "Got %d, wanted %d.", len, + sizeof(struct ip_set_req_macipmap_create)); + + *setdata = ipset_malloc(sizeof(struct ip_set_macipmap)); + + DP("bitmap: initheader() 2"); + + ((struct ip_set_macipmap *) *setdata)->first_ip = header->from; + ((struct ip_set_macipmap *) *setdata)->last_ip = header->to; + ((struct ip_set_macipmap *) *setdata)->flags = header->flags; +} + +void initmembers(void *setdata, void *data, size_t len) +{ + struct ip_set_macipmap *mysetdata = + (struct ip_set_macipmap *) setdata; + size_t size; + + DP("macipmap: initmembers()"); + + /* Check so we get the right amount of memberdata */ + size = (mysetdata->last_ip - mysetdata->first_ip) + * sizeof(struct ip_set_macip); + + if (len != size) + exit_error(OTHER_PROBLEM, + "Macipmap: incorrect size of members. " + "Got %d, wanted %d.", len, size); + + mysetdata->members = data; +} + +void killmembers(void **setdata) +{ + struct ip_set_macipmap *mysetdata = + (struct ip_set_macipmap *) *setdata; + + DP("macipmap: killmembers()"); + + if (mysetdata->members != NULL) + ipset_free(&mysetdata->members); + + ipset_free(setdata); +} + +void printheader(const void *setdata, unsigned options) +{ + struct ip_set_macipmap *mysetdata = + (struct ip_set_macipmap *) setdata; + + printf(" from: %s", ip_tostring(mysetdata->first_ip, options)); + printf(" to: %s", ip_tostring(mysetdata->last_ip, options)); + + if (mysetdata->flags & IPSET_MACIP_MATCHUNSET) + printf(" matchunset"); + printf("\n"); +} + +static void print_mac(unsigned char macaddress[ETH_ALEN]) +{ + unsigned int i; + + printf("%02X", macaddress[0]); + for (i = 1; i < ETH_ALEN; i++) + printf(":%02X", macaddress[i]); +} + +void printips_sorted(const void *setdata, unsigned options) +{ + struct ip_set_macipmap *mysetdata = + (struct ip_set_macipmap *) setdata; + struct ip_set_macip *table = + (struct ip_set_macip *) mysetdata->members; + u_int32_t addr = mysetdata->first_ip; + + while (addr <= mysetdata->last_ip) { + if (test_bit(IPSET_MACIP_ISSET, + &table[addr - mysetdata->first_ip].flags)) { + printf("%s%s", ip_tostring(addr, options), "%"); + print_mac(table[addr - mysetdata->first_ip]. + ethernet); + printf("\n"); + } + addr++; + } +} + +void saveheader(const void *setdata) +{ + return; +} + +/* Print save for an IP */ +void saveips(const void *setdata) +{ + return; +} + +void usage(void) +{ + printf + ("-N set macipmap --from IP --to IP [--matchunset]\n" + "-N set macipmap --network IP/mask [--matchunset]\n" + "-A set IP%%MAC\n" + "-D set IP[%%MAC]\n" + "-T set IP[%%MAC]\n"); +} + +static struct settype settype_macipmap = { + .typename = SETTYPE_NAME, + .typecode = IPSET_TYPE_IP, + .protocol_version = IP_SET_PROTOCOL_VERSION, + + /* Create */ + .create_size = sizeof(struct ip_set_req_macipmap_create), + .create_init = &create_init, + .create_parse = &create_parse, + .create_final = &create_final, + .create_opts = create_opts, + + /* Add/del/test */ + .req_size = sizeof(struct ip_set_req_macipmap), + .adt_parser = &adt_parser, + + /* Get an IP address by id */ + .getipbyid = &getipbyid, + .sizeid = &sizeid, + + /* Printing */ + .initheader = &initheader, + .initmembers = &initmembers, + .killmembers = &killmembers, + .printheader = &printheader, + .printips = &printips_sorted, /* We only have sorted version */ + .printips_sorted = &printips_sorted, + .saveheader = &saveheader, + .saveips = &saveips, + .usage = &usage, + .hint = NULL, +}; + +void _init(void) +{ + settype_register(&settype_macipmap); + +} -- cgit v1.2.3