* replaced the bmf plugin with the most recent 1.3 from sf.net with the
[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 /* -------------------------------------------------------------------------
34  * File       : DropList.c
35  * Description: List of MAC addresses of hosts from which received multicast
36  *              and local broadcast packets are dropped.
37  * Created    : 29 Jun 2006
38  *
39  * $Id: DropList.c,v 1.2 2007/02/10 17:05:55 bernd67 Exp $ 
40  * ------------------------------------------------------------------------- */
41
42
43 #include "DropList.h"
44
45 /* System includes */
46 #include <assert.h> /* assert() */
47 #include <stdio.h> /* NULL */
48 #include <stdlib.h> /* malloc */
49 #include <string.h> /* memcmp */
50
51 /* OLSRD includes */
52 #include "olsr.h" /* olsr_printf */
53
54 /* Plugin includes */
55 #include "Bmf.h" /* PLUGIN_NAME */
56 #include "Packet.h" /* IFHWADDRLEN */
57
58 static struct TMacAddress* DroppedMacAddresses = NULL;
59
60 /* -------------------------------------------------------------------------
61  * Function   : DropMac
62  * Description: Register a MAC address in the drop list
63  * Input      : macStr - MAC address as string
64  * Output     : none
65  * Return     : fail (0) or success (1)
66  * Data Used  : DroppedMacAddresses
67  * Notes      : The registered MAC address will be matched to the source MAC 
68  *              address of incoming multicast packets. If matched, the multicast 
69  *              packet will be dropped. 
70  *              The drop list is needed only in lab environments, where hidden
71  *              nodes are simulated by using iptables with the
72  *              -m mac helper and --mac-source option (as in: 
73  *              "iptables -A INPUT -m mac --mac-source 00:0C:29:EE:C9:D0 -j DROP") 
74  *              The drop list is needed because network interfaces in promiscuous 
75  *              mode will still capture packets even if they are specified to 
76  *              be dropped by iptables.
77  * ------------------------------------------------------------------------- */
78 int DropMac(const char* macStr)
79 {
80   unsigned int mac[6];
81   int n;
82   struct TMacAddress* newMacAddress;
83   int i;
84
85   assert(macStr != NULL);
86
87   n = sscanf(macStr, "%x:%x:%x:%x:%x:%x", &mac[0], &mac[1], &mac[2], &mac[3], &mac[4], &mac[5]);
88   if (n != 6)
89   {
90     olsr_printf(1, "%s: Invalid Ethernet address '%s'\n", PLUGIN_NAME, macStr);
91     return 0;
92   }
93
94   newMacAddress = malloc(sizeof(struct TMacAddress));
95   for (i = 0; i < 6; i++)
96   {
97     newMacAddress->addr[i] = (unsigned char) mac[i];
98   }
99   newMacAddress->next = DroppedMacAddresses;
100   DroppedMacAddresses = newMacAddress;
101
102   return 1;
103 }
104
105 /* -------------------------------------------------------------------------
106  * Function   : IsInDropList
107  * Description: Check if a MAC address is in the drop list
108  * Input      : macAddress
109  * Output     : none
110  * Return     : true (1) or false (0)
111  * Data Used  : DroppedMacAddresses
112  * ------------------------------------------------------------------------- */
113 int IsInDropList(const unsigned char* macAddress)
114 {
115   struct TMacAddress* ma = DroppedMacAddresses;
116
117   assert(macAddress != NULL);
118
119   while (ma != NULL)
120   {
121     if (memcmp(ma->addr, macAddress, IFHWADDRLEN) == 0) return 1;
122     ma = ma->next;
123   }
124   return 0;
125 }
126