57beafe57a31998d52406d672743ff66823ac351
[olsrd.git] / lib / bmf / src / DropList.c
1 /*
2  * OLSR Basic Multicast Forwarding (BMF) plugin.
3  * Copyright (c) 2005, 2006, Thales Communications, Huizen, The Netherlands.
4  * Written by Erik Tromp.
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without 
8  * modification, are permitted provided that the following conditions 
9  * are met:
10  *
11  * * Redistributions of source code must retain the above copyright 
12  *   notice, this list of conditions and the following disclaimer.
13  * * Redistributions in binary form must reproduce the above copyright 
14  *   notice, this list of conditions and the following disclaimer in 
15  *   the documentation and/or other materials provided with the 
16  *   distribution.
17  * * Neither the name of Thales, BMF nor the names of its 
18  *   contributors may be used to endorse or promote products derived 
19  *   from this software without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND 
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 
23  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 
24  * IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, 
25  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 
26  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 
27  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY 
28  * OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE 
29  * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED 
30  * OF THE POSSIBILITY OF SUCH DAMAGE.
31  */
32
33 /* $Id: DropList.c,v 1.1 2006/05/03 08:59:04 kattemat Exp $ */
34
35
36 #include "DropList.h"
37
38 /* System includes */
39 #include <assert.h> /* assert() */
40 #include <stdio.h> /* NULL */
41 #include <stdlib.h> /* malloc */
42 #include <string.h> /* memcmp */
43
44 /* OLSRD includes */
45 #include "olsr.h" /* olsr_printf */
46
47 /* Plugin includes */
48 #include "Bmf.h" /* PLUGIN_NAME */
49 #include "Packet.h" /* IFHWADDRLEN */
50
51 static struct TMacAddress* DroppedMacAddresses = NULL;
52
53 /* Register a MAC address in the drop list. The registered MAC address will be matched
54  * to the source MAC address of incoming multicast packets. If matched, the multicast
55  * packet will be silently dropped.
56  * The drop list is needed only in lab environments, where hidden nodes are simulated
57  * by using iptables with the -m mac --mac-source option (as in:
58  * "iptables -A INPUT -m mac --mac-source 00:0C:29:EE:C9:D0 -j DROP")
59  * The drop list is needed because network interfaces in promiscuous mode will still
60  * capture packets even if they are specified to be dropped by iptables.
61  */
62 int DropMac(const char* macStr)
63 {
64   unsigned int mac[6];
65   int n;
66   struct TMacAddress* newMacAddress;
67   int i;
68
69   assert(macStr != NULL);
70
71   n = sscanf(macStr, "%x:%x:%x:%x:%x:%x", &mac[0], &mac[1], &mac[2], &mac[3], &mac[4], &mac[5]);
72   if (n != 6)
73   {
74     olsr_printf(1, "%s: Invalid Ethernet address '%s'\n", PLUGIN_NAME, macStr);
75     return 0;
76   }
77
78   newMacAddress = malloc(sizeof(struct TMacAddress));
79   for (i = 0; i < 6; i++)
80   {
81     newMacAddress->addr[i] = (unsigned char) mac[i];
82   }
83   newMacAddress->next = DroppedMacAddresses;
84   DroppedMacAddresses = newMacAddress;
85
86   return 1;
87 }
88
89 /* Return 1 if macAddress is in the drop list, else 0 */
90 int IsInDropList(const unsigned char* macAddress)
91 {
92   struct TMacAddress* ma = DroppedMacAddresses;
93
94   assert(macAddress != NULL);
95
96   while (ma != NULL)
97   {
98     if (memcmp(ma->addr, macAddress, IFHWADDRLEN) == 0) return 1;
99     ma = ma->next;
100   }
101   return 0;
102 }
103