Userspace part of sets: ipset added (JK)

1 files changed, 387 insertions, 0 deletions

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 <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <sys/socket.h>
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <asm/bitops.h>
+#include <linux/if_ether.h>
+
+#include <linux/netfilter_ipv4/ip_set_macipmap.h>
+#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);
+
+}