a90217501d5309162f48758df7e03532ab8b44ed
[olsrd.git] / lib / bmf / src / Address.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: Address.c,v 1.1 2006/05/03 08:59:04 kattemat Exp $ */
34
35 #include "Address.h"
36
37 /* System includes */
38 #include <assert.h> /* assert() */
39
40 /* OLSRD includes */
41 #include "defs.h" /* COMP_IP */
42
43 /* Plugin includes */
44 #include "Bmf.h" /* BMF_ENCAP_PORT */
45
46 int IsMulticast(union olsr_ip_addr* ipAddress)
47 {
48   assert(ipAddress != NULL);
49
50   return (ntohl(ipAddress->v4) & 0xF0000000) == 0xE0000000;
51 }
52
53 int IsLocalBroadcast(union olsr_ip_addr* destIp, struct interface* ifFrom)
54 {
55   struct sockaddr_in* sin;
56   
57   assert(destIp != NULL);
58
59   /* Protect ourselves against bogus input */
60   if (ifFrom == NULL) return 0;
61
62   /* Cast down to correct sockaddr subtype */
63   sin = (struct sockaddr_in*)&(ifFrom->int_broadaddr);
64
65   /* Just in case OLSR does not have int_broadaddr filled in for this
66    * interface. */
67   if (sin == NULL) return 0;
68
69   return COMP_IP(&(sin->sin_addr.s_addr), destIp);
70 }
71
72 int IsOlsrOrBmfPacket(unsigned char* buffer, ssize_t len)
73 {
74   u_int16_t port;
75
76   assert(buffer != NULL);
77
78   /* Consider OLSR and BMF packets not to be local broadcast
79    * OLSR packets are UDP - port 698
80    * BMF packets are UDP - port 50505 */
81
82   memcpy(&port, buffer + 0x24, 2);
83   port = ntohs(port);
84
85   if (len > 0x25 &&
86       buffer[0x17] == 0x11 && /* UDP */
87       (port == OLSRPORT || port == BMF_ENCAP_PORT))
88   {
89     return 1;
90   }
91   return 0;
92 }