[PATCH] ieee80211: add ieee80211_channel_to_freq
[linux-2.6] / net / sctp / tsnmap.c
1 /* SCTP kernel reference Implementation
2  * (C) Copyright IBM Corp. 2001, 2004
3  * Copyright (c) 1999-2000 Cisco, Inc.
4  * Copyright (c) 1999-2001 Motorola, Inc.
5  * Copyright (c) 2001 Intel Corp.
6  *
7  * This file is part of the SCTP kernel reference Implementation
8  *
9  * These functions manipulate sctp tsn mapping array.
10  *
11  * The SCTP reference implementation is free software;
12  * you can redistribute it and/or modify it under the terms of
13  * the GNU General Public License as published by
14  * the Free Software Foundation; either version 2, or (at your option)
15  * any later version.
16  *
17  * The SCTP reference implementation is distributed in the hope that it
18  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
19  *                 ************************
20  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
21  * See the GNU General Public License for more details.
22  *
23  * You should have received a copy of the GNU General Public License
24  * along with GNU CC; see the file COPYING.  If not, write to
25  * the Free Software Foundation, 59 Temple Place - Suite 330,
26  * Boston, MA 02111-1307, USA.
27  *
28  * Please send any bug reports or fixes you make to the
29  * email address(es):
30  *    lksctp developers <lksctp-developers@lists.sourceforge.net>
31  *
32  * Or submit a bug report through the following website:
33  *    http://www.sf.net/projects/lksctp
34  *
35  * Written or modified by:
36  *    La Monte H.P. Yarroll <piggy@acm.org>
37  *    Jon Grimm             <jgrimm@us.ibm.com>
38  *    Karl Knutson          <karl@athena.chicago.il.us>
39  *    Sridhar Samudrala     <sri@us.ibm.com>
40  *
41  * Any bugs reported given to us we will try to fix... any fixes shared will
42  * be incorporated into the next SCTP release.
43  */
44
45 #include <linux/types.h>
46 #include <net/sctp/sctp.h>
47 #include <net/sctp/sm.h>
48
49 static void sctp_tsnmap_update(struct sctp_tsnmap *map);
50 static void sctp_tsnmap_find_gap_ack(__u8 *map, __u16 off,
51                                      __u16 len, __u16 base,
52                                      int *started, __u16 *start,
53                                      int *ended, __u16 *end);
54
55 /* Initialize a block of memory as a tsnmap.  */
56 struct sctp_tsnmap *sctp_tsnmap_init(struct sctp_tsnmap *map, __u16 len,
57                                      __u32 initial_tsn)
58 {
59         map->tsn_map = map->raw_map;
60         map->overflow_map = map->tsn_map + len;
61         map->len = len;
62
63         /* Clear out a TSN ack status.  */
64         memset(map->tsn_map, 0x00, map->len + map->len);
65
66         /* Keep track of TSNs represented by tsn_map.  */
67         map->base_tsn = initial_tsn;
68         map->overflow_tsn = initial_tsn + map->len;
69         map->cumulative_tsn_ack_point = initial_tsn - 1;
70         map->max_tsn_seen = map->cumulative_tsn_ack_point;
71         map->malloced = 0;
72         map->num_dup_tsns = 0;
73
74         return map;
75 }
76
77 /* Test the tracking state of this TSN.
78  * Returns:
79  *   0 if the TSN has not yet been seen
80  *  >0 if the TSN has been seen (duplicate)
81  *  <0 if the TSN is invalid (too large to track)
82  */
83 int sctp_tsnmap_check(const struct sctp_tsnmap *map, __u32 tsn)
84 {
85         __s32 gap;
86         int dup;
87
88         /* Calculate the index into the mapping arrays.  */
89         gap = tsn - map->base_tsn;
90
91         /* Verify that we can hold this TSN.  */
92         if (gap >= (/* base */ map->len + /* overflow */ map->len)) {
93                 dup = -1;
94                 goto out;
95         }
96
97         /* Honk if we've already seen this TSN.
98          * We have three cases:
99          *      1. The TSN is ancient or belongs to a previous tsn_map.
100          *      2. The TSN is already marked in the tsn_map.
101          *      3. The TSN is already marked in the tsn_map_overflow.
102          */
103         if (gap < 0 ||
104             (gap < map->len && map->tsn_map[gap]) ||
105             (gap >= map->len && map->overflow_map[gap - map->len]))
106                 dup = 1;
107         else
108                 dup = 0;
109
110 out:
111         return dup;
112 }
113
114
115 /* Mark this TSN as seen.  */
116 void sctp_tsnmap_mark(struct sctp_tsnmap *map, __u32 tsn)
117 {
118         __s32 gap;
119
120         /* Vacuously mark any TSN which precedes the map base or
121          * exceeds the end of the map.
122          */
123         if (TSN_lt(tsn, map->base_tsn))
124                 return;
125         if (!TSN_lt(tsn, map->base_tsn + map->len + map->len))
126                 return;
127
128         /* Bump the max.  */
129         if (TSN_lt(map->max_tsn_seen, tsn))
130                 map->max_tsn_seen = tsn;
131
132         /* Assert: TSN is in range.  */
133         gap = tsn - map->base_tsn;
134
135         /* Mark the TSN as received.  */
136         if (gap < map->len)
137                 map->tsn_map[gap]++;
138         else
139                 map->overflow_map[gap - map->len]++;
140
141         /* Go fixup any internal TSN mapping variables including
142          * cumulative_tsn_ack_point.
143          */
144         sctp_tsnmap_update(map);
145 }
146
147
148 /* Initialize a Gap Ack Block iterator from memory being provided.  */
149 SCTP_STATIC void sctp_tsnmap_iter_init(const struct sctp_tsnmap *map,
150                                        struct sctp_tsnmap_iter *iter)
151 {
152         /* Only start looking one past the Cumulative TSN Ack Point.  */
153         iter->start = map->cumulative_tsn_ack_point + 1;
154 }
155
156 /* Get the next Gap Ack Blocks. Returns 0 if there was not another block
157  * to get.
158  */
159 SCTP_STATIC int sctp_tsnmap_next_gap_ack(const struct sctp_tsnmap *map,
160                                          struct sctp_tsnmap_iter *iter,
161                                          __u16 *start, __u16 *end)
162 {
163         int started, ended;
164         __u16 _start, _end, offset;
165
166         /* We haven't found a gap yet.  */
167         started = ended = 0;
168
169         /* If there are no more gap acks possible, get out fast.  */
170         if (TSN_lte(map->max_tsn_seen, iter->start))
171                 return 0;
172
173         /* Search the first mapping array.  */
174         if (iter->start - map->base_tsn < map->len) {
175
176                 offset = iter->start - map->base_tsn;
177                 sctp_tsnmap_find_gap_ack(map->tsn_map, offset, map->len, 0,
178                                          &started, &_start, &ended, &_end);
179         }
180
181         /* Do we need to check the overflow map? */
182         if (!ended) {
183                 /* Fix up where we'd like to start searching in the
184                  * overflow map.
185                  */
186                 if (iter->start - map->base_tsn < map->len)
187                         offset = 0;
188                 else
189                         offset = iter->start - map->base_tsn - map->len;
190
191                 /* Search the overflow map.  */
192                 sctp_tsnmap_find_gap_ack(map->overflow_map,
193                                          offset,
194                                          map->len,
195                                          map->len,
196                                          &started, &_start,
197                                          &ended, &_end);
198         }
199
200         /* The Gap Ack Block happens to end at the end of the
201          * overflow map.
202          */
203         if (started && !ended) {
204                 ended++;
205                 _end = map->len + map->len - 1;
206         }
207
208         /* If we found a Gap Ack Block, return the start and end and
209          * bump the iterator forward.
210          */
211         if (ended) {
212                 /* Fix up the start and end based on the
213                  * Cumulative TSN Ack offset into the map.
214                  */
215                 int gap = map->cumulative_tsn_ack_point -
216                         map->base_tsn;
217
218                 *start = _start - gap;
219                 *end = _end - gap;
220
221                 /* Move the iterator forward.  */
222                 iter->start = map->cumulative_tsn_ack_point + *end + 1;
223         }
224
225         return ended;
226 }
227
228 /* Mark this and any lower TSN as seen.  */
229 void sctp_tsnmap_skip(struct sctp_tsnmap *map, __u32 tsn)
230 {
231         __s32 gap;
232
233         /* Vacuously mark any TSN which precedes the map base or
234          * exceeds the end of the map.
235          */
236         if (TSN_lt(tsn, map->base_tsn))
237                 return;
238         if (!TSN_lt(tsn, map->base_tsn + map->len + map->len))
239                 return;
240
241         /* Bump the max.  */
242         if (TSN_lt(map->max_tsn_seen, tsn))
243                 map->max_tsn_seen = tsn;
244
245         /* Assert: TSN is in range.  */
246         gap = tsn - map->base_tsn + 1;
247
248         /* Mark the TSNs as received.  */
249         if (gap <= map->len)
250                 memset(map->tsn_map, 0x01, gap);
251         else {
252                 memset(map->tsn_map, 0x01, map->len);
253                 memset(map->overflow_map, 0x01, (gap - map->len));
254         }
255
256         /* Go fixup any internal TSN mapping variables including
257          * cumulative_tsn_ack_point.
258          */
259         sctp_tsnmap_update(map);
260 }
261
262 /********************************************************************
263  * 2nd Level Abstractions
264  ********************************************************************/
265
266 /* This private helper function updates the tsnmap buffers and
267  * the Cumulative TSN Ack Point.
268  */
269 static void sctp_tsnmap_update(struct sctp_tsnmap *map)
270 {
271         __u32 ctsn;
272
273         ctsn = map->cumulative_tsn_ack_point;
274         do {
275                 ctsn++;
276                 if (ctsn == map->overflow_tsn) {
277                         /* Now tsn_map must have been all '1's,
278                          * so we swap the map and check the overflow table
279                          */
280                         __u8 *tmp = map->tsn_map;
281                         memset(tmp, 0, map->len);
282                         map->tsn_map = map->overflow_map;
283                         map->overflow_map = tmp;
284
285                         /* Update the tsn_map boundaries.  */
286                         map->base_tsn += map->len;
287                         map->overflow_tsn += map->len;
288                 }
289         } while (map->tsn_map[ctsn - map->base_tsn]);
290
291         map->cumulative_tsn_ack_point = ctsn - 1; /* Back up one. */
292 }
293
294 /* How many data chunks  are we missing from our peer?
295  */
296 __u16 sctp_tsnmap_pending(struct sctp_tsnmap *map)
297 {
298         __u32 cum_tsn = map->cumulative_tsn_ack_point;
299         __u32 max_tsn = map->max_tsn_seen;
300         __u32 base_tsn = map->base_tsn;
301         __u16 pending_data;
302         __s32 gap, start, end, i;
303
304         pending_data = max_tsn - cum_tsn;
305         gap = max_tsn - base_tsn;
306
307         if (gap <= 0 || gap >= (map->len + map->len))
308                 goto out;
309
310         start = ((cum_tsn >= base_tsn) ? (cum_tsn - base_tsn + 1) : 0);
311         end = ((gap > map->len ) ? map->len : gap + 1);
312
313         for (i = start; i < end; i++) {
314                 if (map->tsn_map[i])
315                         pending_data--;
316         }
317
318         if (gap >= map->len) {
319                 start = 0;
320                 end = gap - map->len + 1;
321                 for (i = start; i < end; i++) {
322                         if (map->overflow_map[i])
323                                 pending_data--;
324                 }
325         }
326
327 out:
328         return pending_data;
329 }
330
331 /* This is a private helper for finding Gap Ack Blocks.  It searches a
332  * single array for the start and end of a Gap Ack Block.
333  *
334  * The flags "started" and "ended" tell is if we found the beginning
335  * or (respectively) the end of a Gap Ack Block.
336  */
337 static void sctp_tsnmap_find_gap_ack(__u8 *map, __u16 off,
338                                      __u16 len, __u16 base,
339                                      int *started, __u16 *start,
340                                      int *ended, __u16 *end)
341 {
342         int i = off;
343
344         /* Look through the entire array, but break out
345          * early if we have found the end of the Gap Ack Block.
346          */
347
348         /* Also, stop looking past the maximum TSN seen. */
349
350         /* Look for the start. */
351         if (!(*started)) {
352                 for (; i < len; i++) {
353                         if (map[i]) {
354                                 (*started)++;
355                                 *start = base + i;
356                                 break;
357                         }
358                 }
359         }
360
361         /* Look for the end.  */
362         if (*started) {
363                 /* We have found the start, let's find the
364                  * end.  If we find the end, break out.
365                  */
366                 for (; i < len; i++) {
367                         if (!map[i]) {
368                                 (*ended)++;
369                                 *end = base + i - 1;
370                                 break;
371                         }
372                 }
373         }
374 }
375
376 /* Renege that we have seen a TSN.  */
377 void sctp_tsnmap_renege(struct sctp_tsnmap *map, __u32 tsn)
378 {
379         __s32 gap;
380
381         if (TSN_lt(tsn, map->base_tsn))
382                 return;
383         if (!TSN_lt(tsn, map->base_tsn + map->len + map->len))
384                 return;
385
386         /* Assert: TSN is in range.  */
387         gap = tsn - map->base_tsn;
388
389         /* Pretend we never saw the TSN.  */
390         if (gap < map->len)
391                 map->tsn_map[gap] = 0;
392         else
393                 map->overflow_map[gap - map->len] = 0;
394 }
395
396 /* How many gap ack blocks do we have recorded? */
397 __u16 sctp_tsnmap_num_gabs(struct sctp_tsnmap *map)
398 {
399         struct sctp_tsnmap_iter iter;
400         int gabs = 0;
401
402         /* Refresh the gap ack information. */
403         if (sctp_tsnmap_has_gap(map)) {
404                 __u16 start, end;
405                 sctp_tsnmap_iter_init(map, &iter);
406                 while (sctp_tsnmap_next_gap_ack(map, &iter,
407                                                 &start,
408                                                 &end)) {
409
410                         map->gabs[gabs].start = htons(start);
411                         map->gabs[gabs].end = htons(end);
412                         gabs++;
413                         if (gabs >= SCTP_MAX_GABS)
414                                 break;
415                 }
416         }
417         return gabs;
418 }