Merge branch 'PolynomialDivision-feature/add_workflow'
[olsrd.git] / lib / bmf / src / Address.c
1 /*
2  * The olsr.org Optimized Link-State Routing daemon (olsrd)
3  *
4  * (c) by the OLSR project
5  *
6  * See our Git repository to find out who worked on this file
7  * and thus is a copyright holder on it.
8  *
9  * All rights reserved.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  *
15  * * Redistributions of source code must retain the above copyright
16  *   notice, this list of conditions and the following disclaimer.
17  * * Redistributions in binary form must reproduce the above copyright
18  *   notice, this list of conditions and the following disclaimer in
19  *   the documentation and/or other materials provided with the
20  *   distribution.
21  * * Neither the name of olsr.org, olsrd nor the names of its
22  *   contributors may be used to endorse or promote products derived
23  *   from this software without specific prior written permission.
24  *
25  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
26  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
27  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
28  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
29  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
30  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
31  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
32  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
33  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
34  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
35  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36  * POSSIBILITY OF SUCH DAMAGE.
37  *
38  * Visit http://www.olsr.org for more information.
39  *
40  * If you find this software useful feel free to make a donation
41  * to the project. For more information see the website or contact
42  * the copyright holders.
43  *
44  */
45  
46 /* -------------------------------------------------------------------------
47  * File       : Address.c
48  * Description: IP packet characterization functions
49  * Created    : 29 Jun 2006
50  *
51  * ------------------------------------------------------------------------- */
52  
53 #include "Address.h"
54
55 /* System includes */
56 #include <stddef.h> /* NULL */
57 #include <assert.h> /* assert() */
58 #include <netinet/ip.h> /* struct ip */
59 #include <netinet/udp.h> /* struct udphdr */
60
61 /* OLSRD includes */
62 #include "defs.h" /* ipequal */
63
64 /* Plugin includes */
65 #include "Bmf.h" /* BMF_ENCAP_PORT */
66 #include "NetworkInterfaces.h" /* TBmfInterface */
67
68 /* Whether or not to flood local broadcast packets (e.g. packets with IP
69  * destination 192.168.1.255). May be overruled by setting the plugin
70  * parameter "DoLocalBroadcast" to "no" */
71 int EnableLocalBroadcast = 1;
72
73 /* -------------------------------------------------------------------------
74  * Function   : DoLocalBroadcast
75  * Description: Overrule the default setting, enabling or disabling the
76  *              flooding of local broadcast packets
77  * Input      : enable - either "yes" or "no"
78  *              data - not used
79  *              addon - not used
80  * Output     : none
81  * Return     : success (0) or fail (1)
82  * Data Used  : none
83  * ------------------------------------------------------------------------- */
84 int DoLocalBroadcast(
85   const char* enable,
86   void* data __attribute__((unused)),
87   set_plugin_parameter_addon addon __attribute__((unused)))
88 {
89   if (strcmp(enable, "yes") == 0)
90   {
91     EnableLocalBroadcast = 1;
92     return 0;
93   }
94   else if (strcmp(enable, "no") == 0)
95   {
96     EnableLocalBroadcast = 0;
97     return 0;
98   }
99
100   /* Value not recognized */
101   return 1;
102 }
103
104 /* -------------------------------------------------------------------------
105  * Function   : IsMulticast
106  * Description: Check if an IP address is a multicast address
107  * Input      : ipAddress
108  * Output     : none
109  * Return     : true (1) or false (0)
110  * Data Used  : none
111  * ------------------------------------------------------------------------- */
112 int IsMulticast(union olsr_ip_addr* ipAddress)
113 {
114   assert(ipAddress != NULL);
115
116   return IN_MULTICAST(ntohl(ipAddress->v4.s_addr));
117 }
118
119 /* -------------------------------------------------------------------------
120  * Function   : IsOlsrOrBmfPacket
121  * Description: Check if an IP packet is either an OLSR packet or a BMF packet
122  * Input      : ipPacket
123  * Output     : none
124  * Return     : true (1) or false (0)
125  * Data Used  : none
126  * ------------------------------------------------------------------------- */
127 int IsOlsrOrBmfPacket(unsigned char* ipPacket)
128 {
129   struct ip* ipHeader;
130   unsigned int ipHeaderLen;
131   struct udphdr* udpHeader;
132   u_int16_t destPort;
133
134   assert(ipPacket != NULL);
135
136   /* OLSR packets are UDP - port 698
137    * OLSR-BMF packets are UDP - port 50698
138    * OLSR-Autodetect probe packets are UDP - port 51698 */
139
140   /* Check if UDP */
141   ipHeader = (struct ip*) ARM_NOWARN_ALIGN(ipPacket);
142   if (ipHeader->ip_p != SOL_UDP)
143   {
144     /* Not UDP */
145     return 0;
146   }
147
148   /* The total length must be at least large enough to store the UDP header */
149   ipHeaderLen = GetIpHeaderLength(ipPacket);
150   if (GetIpTotalLength(ipPacket) < ipHeaderLen + sizeof(struct udphdr))
151   {
152     /* Not long enough */
153     return 0;
154   }
155
156   /* Go into the UDP header and check port number */
157   udpHeader = (struct udphdr*) ARM_NOWARN_ALIGN((ipPacket + ipHeaderLen));
158 #if defined(__GLIBC__) || defined(__BIONIC__)
159   destPort = ntohs(udpHeader->dest);
160 #else
161   destPort = ntohs(udpHeader->uh_dport);
162 #endif
163
164   if (destPort == olsr_cnf->olsrport || destPort == BMF_ENCAP_PORT || destPort == 51698)
165       /* TODO: #define for 51698 */
166   {
167     return 1;
168   }
169
170   return 0;
171 }