* replaced the bmf plugin with the most recent 1.3 from sf.net with the
[olsrd.git] / lib / bmf / src / Packet.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       : Packet.c
35  * Description: BMF and IP packet processing functions
36  * Created    : 29 Jun 2006
37  *
38  * $Id: Packet.c,v 1.3 2007/02/10 17:05:56 bernd67 Exp $ 
39  * ------------------------------------------------------------------------- */
40
41 #include "Packet.h"
42
43 /* System includes */
44 #include <assert.h> /* assert() */
45 #include <sys/types.h> /* u_int32_t */
46 #include <netinet/in.h> /* ntohs(), htons() */
47 #include <netinet/ip.h> /* struct iphdr */
48
49 #include <stdio.h>
50 /* -------------------------------------------------------------------------
51  * Function   : GetIpPacketLength
52  * Description: Retrieve the IP packet length (in bytes) of the passed
53  *              ethernet-IP packet
54  * Input      : buffer - the ethernet-IP packet
55  * Output     : none
56  * Return     : IP packet length
57  * Data Used  : none
58  * ------------------------------------------------------------------------- */
59 int GetIpPacketLength(unsigned char* buffer)
60 {
61   struct iphdr* iph;
62
63   assert(buffer != NULL);
64
65   iph = (struct iphdr*) (buffer + IP_HDR_OFFSET);
66   return ntohs(iph->tot_len);
67 }
68
69 /* -------------------------------------------------------------------------
70  * Function   : GetIpHeaderLength
71  * Description: Retrieve the IP header length (in bytes) of the passed
72  *              ethernet-IP packet
73  * Input      : buffer - the ethernet-IP packet
74  * Output     : none
75  * Return     : IP header length
76  * Data Used  : none
77  * ------------------------------------------------------------------------- */
78 int GetIpHeaderLength(unsigned char* buffer)
79 {
80   struct iphdr* iph;
81
82   assert(buffer != NULL);
83
84   iph = (struct iphdr*) (buffer + IP_HDR_OFFSET);
85   return iph->ihl << 2;
86 }
87
88 /* -------------------------------------------------------------------------
89  * Function   : GetIpTtl
90  * Description: Retrieve the TTL (Time To Live) value from the IP header of
91  *              the passed ethernet-IP packet
92  * Input      : buffer - the ethernet-IP packet
93  * Output     : none
94  * Return     : TTL value
95  * Data Used  : none
96  * ------------------------------------------------------------------------- */
97 int GetIpTtl(unsigned char* buffer)
98 {
99   struct iphdr* iph;
100
101   assert(buffer != NULL);
102
103   iph = (struct iphdr*) (buffer + IP_HDR_OFFSET);
104   return iph->ttl;
105 }
106
107 /* -------------------------------------------------------------------------
108  * Function   : SaveTtlAndChecksum
109  * Description: Save the TTL (Time To Live) value and IP checksum as found in
110  *              the IP header of the passed ethernet-IP packet
111  * Input      : buffer - the ethernet-IP packet
112  * Output     : sttl - the TTL and checksum values
113  * Return     : none
114  * Data Used  : none
115  * ------------------------------------------------------------------------- */
116 void SaveTtlAndChecksum(unsigned char* buffer, struct TSaveTtl* sttl)
117 {
118   struct iphdr* iph;
119
120   assert(buffer != NULL && sttl != NULL);
121
122   iph = (struct iphdr*) (buffer + IP_HDR_OFFSET);
123   sttl->ttl = iph->ttl;
124   sttl->check = ntohs(iph->check);
125 }
126
127 /* -------------------------------------------------------------------------
128  * Function   : RestoreTtlAndChecksum
129  * Description: Restore the TTL (Time To Live) value and IP checksum in
130  *              the IP header of the passed ethernet-IP packet
131  * Input      : buffer - the ethernet-IP packet
132  *              sttl - the TTL and checksum values
133  * Output     : none
134  * Return     : none
135  * Data Used  : none
136  * ------------------------------------------------------------------------- */
137 void RestoreTtlAndChecksum(unsigned char* buffer, struct TSaveTtl* sttl)
138 {
139   struct iphdr* iph;
140
141   assert(buffer != NULL && sttl != NULL);
142
143   iph = (struct iphdr*) (buffer + IP_HDR_OFFSET);
144   iph->ttl = sttl->ttl;
145   iph->check = htons(sttl->check);
146 }
147
148 /* -------------------------------------------------------------------------
149  * Function   : DecreaseTtlAndUpdateHeaderChecksum
150  * Description: For an IP packet, decrement the TTL value and update the IP header
151  *              checksum accordingly.
152  * Input      : buffer - the ethernet-IP packet
153  * Output     : none
154  * Return     : none
155  * Data Used  : none
156  * Notes      : See also RFC1141
157  * ------------------------------------------------------------------------- */
158 void DecreaseTtlAndUpdateHeaderChecksum(unsigned char* buffer)
159 {
160   struct iphdr* iph;
161   u_int32_t sum;
162
163   assert(buffer != NULL);
164
165   iph = (struct iphdr*) (buffer + IP_HDR_OFFSET);
166
167   iph->ttl--; /* decrement ttl */
168   sum = ntohs(iph->check) + 0x100; /* increment checksum high byte */
169   iph->check = htons(sum + (sum>>16)); /* add carry */
170 }