move avl and list library into src/common
[olsrd.git] / src / duplicate_set.c
1 /*
2  * The olsr.org Optimized Link-State Routing daemon(olsrd)
3  * Copyright (c) 2004, Andreas T√łnnesen(andreto@olsr.org)
4  * Copyright (c) 2008 Henning Rogge <rogge@fgan.de>
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 olsr.org, olsrd 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 
22  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 
23  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 
24  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 
25  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 
26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 
27  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 
28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER 
29  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 
30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 
31  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 
32  * POSSIBILITY OF SUCH DAMAGE.
33  *
34  * Visit http://www.olsr.org for more information.
35  *
36  * If you find this software useful feel free to make a donation
37  * to the project. For more information see the website or contact
38  * the copyright holders.
39  *
40  */
41
42 #include "duplicate_set.h"
43 #include "ipcalc.h"
44 #include "common/avl.h"
45 #include "olsr.h"
46 #include "mid_set.h"
47
48 struct avl_tree duplicate_set;
49
50 void olsr_init_duplicate_set(void) {
51   avl_init(&duplicate_set, olsr_cnf->ip_version == AF_INET ? &avl_comp_ipv4 : &avl_comp_ipv6);
52 }
53
54 struct duplicate_entry *olsr_create_duplicate_entry(void *ip, olsr_u16_t seqnr) {
55   struct duplicate_entry *entry;
56   entry = olsr_malloc(sizeof(struct duplicate_entry), "New duplicate entry");
57   if (entry != NULL) {
58     memcpy (&entry->ip, ip, olsr_cnf->ip_version == AF_INET ? sizeof(entry->ip.v4) : sizeof(entry->ip.v6)); 
59     entry->seqnr = seqnr;
60     entry->too_low_counter = 0;
61     entry->avl.key = &entry->ip;
62   }
63   return entry;
64 }
65
66 int olsr_shall_process_message(void *ip, olsr_u16_t seqnr) {
67   struct duplicate_entry *entry;
68   int diff;
69   void *mainIp;
70 #ifndef NODEBUG
71   struct ipaddr_str buf;
72 #endif  
73   // get main address
74   mainIp = mid_lookup_main_addr(ip);
75   if (mainIp == NULL) {
76     mainIp = ip;
77   }
78   
79   entry = (struct duplicate_entry *)avl_find(&duplicate_set, ip);
80   if (entry == NULL) {
81     entry = olsr_create_duplicate_entry(ip, seqnr);
82     if (entry != NULL) {
83       avl_insert(&duplicate_set, &entry->avl, 0);
84     }
85     return 1; // okay, we process this package
86   }
87
88   diff = (int)seqnr - (int)(entry->seqnr);
89   
90   // overflow ?
91   if (diff > (1<<15)) {
92     diff -= (1<<16);
93   }
94   
95   if (diff < -31) {
96     entry->too_low_counter ++;
97     
98     // client did restart with a lower number ?
99     if (entry->too_low_counter > 16) {
100       entry->too_low_counter = 0;
101       entry->seqnr = seqnr;
102       entry->array = 1;
103       return 1;
104     }
105     OLSR_PRINTF(9, "blocked %x from %s\n", seqnr, olsr_ip_to_string(&buf, mainIp));
106     return 0;
107   }
108   
109   entry->too_low_counter = 0;
110   if (diff <= 0) {
111     olsr_u32_t bitmask = 1 << ((olsr_u32_t) (-diff));
112     
113     if ((entry->array & bitmask) != 0) {
114       OLSR_PRINTF(9, "blocked %x (diff=%d,mask=%08x) from %s\n", seqnr, diff, entry->array, olsr_ip_to_string(&buf, mainIp));
115       return 0;
116     }
117     entry->array |= bitmask;
118     OLSR_PRINTF(9, "processed %x from %s\n", seqnr, olsr_ip_to_string(&buf, mainIp));
119     return 1;
120   }
121   else if (diff < 32) {
122     entry->array <<= (olsr_u32_t)diff;
123   }
124   else {
125     entry->array = 0;
126   }
127   entry->array |= 1;
128   entry->seqnr = seqnr;
129   OLSR_PRINTF(9, "processed %x from %s\n", seqnr, olsr_ip_to_string(&buf, mainIp));
130   return 1;
131 }
132
133 void olsr_print_duplicate_table(void) {
134   /* XXX FIXME */
135 }
136
137 /*
138  * Local Variables:
139  * c-basic-offset: 2
140  * End:
141  */