]> The Tcpdump Group git mirrors - tcpdump/blob - print-olsr.c
projects / tcpdump / blob
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
Don't decrement an unsigned value past zero.
[tcpdump] / print-olsr.c
1 /*
2 * Copyright (c) 1998-2007 The TCPDUMP project
3 * Copyright (c) 2009 Florian Forster
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that: (1) source code
7 * distributions retain the above copyright notice and this paragraph
8 * in its entirety, and (2) distributions including binary code include
9 * the above copyright notice and this paragraph in its entirety in
10 * the documentation or other materials provided with the distribution.
11 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
12 * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
13 * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
14 * FOR A PARTICULAR PURPOSE.
15 *
16 * Original code by Hannes Gredler <hannes@gredler.at>
17 * IPv6 additions by Florian Forster <octo at verplant.org>
18 */
19
20 /* \summary: Optimized Link State Routing Protocol (OLSR) printer */
21
22 /* specification: RFC 3626 */
23
24 #ifdef HAVE_CONFIG_H
25 #include <config.h>
26 #endif
27
28 #include "netdissect-stdinc.h"
29
30 #include "netdissect.h"
31 #include "addrtoname.h"
32 #include "extract.h"
33
34 /*
35 * RFC 3626 common header
36 *
37 * 0 1 2 3
38 * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
39 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
40 * | Packet Length | Packet Sequence Number |
41 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
42 * | Message Type | Vtime | Message Size |
43 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
44 * | Originator Address |
45 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
46 * | Time To Live | Hop Count | Message Sequence Number |
47 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
48 * | |
49 * : MESSAGE :
50 * | |
51 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
52 * | Message Type | Vtime | Message Size |
53 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
54 * | Originator Address |
55 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
56 * | Time To Live | Hop Count | Message Sequence Number |
57 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
58 * | |
59 * : MESSAGE :
60 * | |
61 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
62 * : :
63 */
64
65 struct olsr_common {
66 nd_uint16_t packet_len;
67 nd_uint16_t packet_seq;
68 };
69
70 #define OLSR_HELLO_MSG 1 /* rfc3626 */
71 #define OLSR_TC_MSG 2 /* rfc3626 */
72 #define OLSR_MID_MSG 3 /* rfc3626 */
73 #define OLSR_HNA_MSG 4 /* rfc3626 */
74 #define OLSR_POWERINFO_MSG 128
75 #define OLSR_NAMESERVICE_MSG 130
76 #define OLSR_HELLO_LQ_MSG 201 /* LQ extensions olsr.org */
77 #define OLSR_TC_LQ_MSG 202 /* LQ extensions olsr.org */
78
79 static const struct tok olsr_msg_values[] = {
80 { OLSR_HELLO_MSG, "Hello" },
81 { OLSR_TC_MSG, "TC" },
82 { OLSR_MID_MSG, "MID" },
83 { OLSR_HNA_MSG, "HNA" },
84 { OLSR_POWERINFO_MSG, "Powerinfo" },
85 { OLSR_NAMESERVICE_MSG, "Nameservice" },
86 { OLSR_HELLO_LQ_MSG, "Hello-LQ" },
87 { OLSR_TC_LQ_MSG, "TC-LQ" },
88 { 0, NULL}
89 };
90
91 struct olsr_msg4 {
92 nd_uint8_t msg_type;
93 nd_uint8_t vtime;
94 nd_uint16_t msg_len;
95 nd_ipv4 originator;
96 nd_uint8_t ttl;
97 nd_uint8_t hopcount;
98 nd_uint16_t msg_seq;
99 };
100
101 struct olsr_msg6 {
102 nd_uint8_t msg_type;
103 nd_uint8_t vtime;
104 nd_uint16_t msg_len;
105 nd_ipv6 originator;
106 nd_uint8_t ttl;
107 nd_uint8_t hopcount;
108 nd_uint16_t msg_seq;
109 };
110
111 struct olsr_hello {
112 nd_byte res[2];
113 nd_uint8_t htime;
114 nd_uint8_t will;
115 };
116
117 struct olsr_hello_link {
118 nd_uint8_t link_code;
119 nd_byte res;
120 nd_uint16_t len;
121 };
122
123 struct olsr_tc {
124 nd_uint16_t ans_seq;
125 nd_byte res[2];
126 };
127
128 struct olsr_hna4 {
129 nd_ipv4 network;
130 nd_ipv4 mask;
131 };
132
133 struct olsr_hna6 {
134 nd_ipv6 network;
135 nd_ipv6 mask;
136 };
137
138
139 /** gateway HNA flags */
140 enum gateway_hna_flags {
141 GW_HNA_FLAG_LINKSPEED = 1 << 0,
142 GW_HNA_FLAG_IPV4 = 1 << 1,
143 GW_HNA_FLAG_IPV4_NAT = 1 << 2,
144 GW_HNA_FLAG_IPV6 = 1 << 3,
145 GW_HNA_FLAG_IPV6PREFIX = 1 << 4
146 };
147
148 /** gateway HNA field byte offsets in the netmask field of the HNA */
149 enum gateway_hna_fields {
150 GW_HNA_PAD = 0,
151 GW_HNA_FLAGS = 1,
152 GW_HNA_UPLINK = 2,
153 GW_HNA_DOWNLINK = 3,
154 GW_HNA_V6PREFIXLEN = 4,
155 GW_HNA_V6PREFIX = 5
156 };
157
158
159 #define OLSR_EXTRACT_LINK_TYPE(link_code) (link_code & 0x3)
160 #define OLSR_EXTRACT_NEIGHBOR_TYPE(link_code) (link_code >> 2)
161
162 static const struct tok olsr_link_type_values[] = {
163 { 0, "Unspecified" },
164 { 1, "Asymmetric" },
165 { 2, "Symmetric" },
166 { 3, "Lost" },
167 { 0, NULL}
168 };
169
170 static const struct tok olsr_neighbor_type_values[] = {
171 { 0, "Not-Neighbor" },
172 { 1, "Symmetric" },
173 { 2, "Symmetric-MPR" },
174 { 0, NULL}
175 };
176
177 struct olsr_lq_neighbor4 {
178 nd_ipv4 neighbor;
179 nd_uint8_t link_quality;
180 nd_uint8_t neighbor_link_quality;
181 nd_byte res[2];
182 };
183
184 struct olsr_lq_neighbor6 {
185 nd_ipv6 neighbor;
186 nd_uint8_t link_quality;
187 nd_uint8_t neighbor_link_quality;
188 nd_byte res[2];
189 };
190
191 #define MAX_SMARTGW_SPEED 320000000
192
193 /**
194 * Convert an encoded 1 byte transport value (5 bits mantissa, 3 bits exponent)
195 * to an uplink/downlink speed value
196 *
197 * @param value the encoded 1 byte transport value
198 * @return the uplink/downlink speed value (in kbit/s)
199 */
200 static uint32_t deserialize_gw_speed(uint8_t value) {
201 uint32_t speed;
202 uint32_t exp;
203
204 if (!value) {
205 return 0;
206 }
207
208 if (value == UINT8_MAX) {
209 /* maximum value: also return maximum value */
210 return MAX_SMARTGW_SPEED;
211 }
212
213 speed = (value >> 3) + 1;
214 exp = value & 7;
215
216 while (exp != 0) {
217 speed *= 10;
218 exp--;
219 }
220 return speed;
221 }
222
223 /*
224 * macro to convert the 8-bit mantissa/exponent to a double float
225 * taken from olsr.org.
226 */
227 #define VTIME_SCALE_FACTOR 0.0625
228 #define ME_TO_DOUBLE(me) \
229 (double)(VTIME_SCALE_FACTOR*(1+(double)(me>>4)/16)*(double)(1<<(me&0x0F)))
230
231 /*
232 * print a neighbor list with LQ extensions.
233 */
234 static int
235 olsr_print_lq_neighbor4(netdissect_options *ndo,
236 const u_char *msg_data, u_int hello_len)
237 {
238 const struct olsr_lq_neighbor4 *lq_neighbor;
239
240 while (hello_len >= sizeof(struct olsr_lq_neighbor4)) {
241
242 lq_neighbor = (const struct olsr_lq_neighbor4 *)msg_data;
243 if (!ND_TTEST_SIZE(lq_neighbor))
244 return (-1);
245
246 ND_PRINT("\n\t neighbor %s, link-quality %.2f%%"
247 ", neighbor-link-quality %.2f%%",
248 ipaddr_string(ndo, lq_neighbor->neighbor),
249 ((double)EXTRACT_U_1(lq_neighbor->link_quality)/2.55),
250 ((double)EXTRACT_U_1(lq_neighbor->neighbor_link_quality)/2.55));
251
252 msg_data += sizeof(struct olsr_lq_neighbor4);
253 hello_len -= sizeof(struct olsr_lq_neighbor4);
254 }
255 return (0);
256 }
257
258 static int
259 olsr_print_lq_neighbor6(netdissect_options *ndo,
260 const u_char *msg_data, u_int hello_len)
261 {
262 const struct olsr_lq_neighbor6 *lq_neighbor;
263
264 while (hello_len >= sizeof(struct olsr_lq_neighbor6)) {
265
266 lq_neighbor = (const struct olsr_lq_neighbor6 *)msg_data;
267 if (!ND_TTEST_SIZE(lq_neighbor))
268 return (-1);
269
270 ND_PRINT("\n\t neighbor %s, link-quality %.2f%%"
271 ", neighbor-link-quality %.2f%%",
272 ip6addr_string(ndo, lq_neighbor->neighbor),
273 ((double)EXTRACT_U_1(lq_neighbor->link_quality)/2.55),
274 ((double)EXTRACT_U_1(lq_neighbor->neighbor_link_quality)/2.55));
275
276 msg_data += sizeof(struct olsr_lq_neighbor6);
277 hello_len -= sizeof(struct olsr_lq_neighbor6);
278 }
279 return (0);
280 }
281
282 /*
283 * print a neighbor list.
284 */
285 static int
286 olsr_print_neighbor(netdissect_options *ndo,
287 const u_char *msg_data, u_int hello_len)
288 {
289 int neighbor;
290
291 ND_PRINT("\n\t neighbor\n\t\t");
292 neighbor = 1;
293
294 while (hello_len >= sizeof(nd_ipv4)) {
295
296 if (!ND_TTEST_LEN(msg_data, sizeof(nd_ipv4)))
297 return (-1);
298 /* print 4 neighbors per line */
299
300 ND_PRINT("%s%s", ipaddr_string(ndo, msg_data),
301 neighbor % 4 == 0 ? "\n\t\t" : " ");
302
303 msg_data += sizeof(nd_ipv4);
304 hello_len -= sizeof(nd_ipv4);
305 }
306 return (0);
307 }
308
309
310 void
311 olsr_print(netdissect_options *ndo,
312 const u_char *pptr, u_int length, int is_ipv6)
313 {
314 union {
315 const struct olsr_common *common;
316 const struct olsr_msg4 *msg4;
317 const struct olsr_msg6 *msg6;
318 const struct olsr_hello *hello;
319 const struct olsr_hello_link *hello_link;
320 const struct olsr_tc *tc;
321 const struct olsr_hna4 *hna;
322 } ptr;
323
324 u_int msg_type, msg_len, msg_tlen, hello_len;
325 uint16_t name_entry_type, name_entry_len;
326 u_int name_entry_padding;
327 uint8_t link_type, neighbor_type;
328 const u_char *tptr, *msg_data;
329
330 tptr = pptr;
331
332 if (length < sizeof(struct olsr_common)) {
333 goto trunc;
334 }
335
336 ND_TCHECK_LEN(tptr, sizeof(struct olsr_common));
337
338 ptr.common = (const struct olsr_common *)tptr;
339 length = min(length, EXTRACT_BE_U_2(ptr.common->packet_len));
340
341 ND_PRINT("OLSRv%i, seq 0x%04x, length %u",
342 (is_ipv6 == 0) ? 4 : 6,
343 EXTRACT_BE_U_2(ptr.common->packet_seq),
344 length);
345
346 tptr += sizeof(struct olsr_common);
347
348 /*
349 * In non-verbose mode, just print version.
350 */
351 if (ndo->ndo_vflag < 1) {
352 return;
353 }
354
355 while (tptr < (pptr+length)) {
356 union
357 {
358 const struct olsr_msg4 *v4;
359 const struct olsr_msg6 *v6;
360 } msgptr;
361 int msg_len_valid = 0;
362
363 if (is_ipv6)
364 {
365 ND_TCHECK_LEN(tptr, sizeof(struct olsr_msg6));
366 msgptr.v6 = (const struct olsr_msg6 *) tptr;
367 msg_type = EXTRACT_U_1(msgptr.v6->msg_type);
368 msg_len = EXTRACT_BE_U_2(msgptr.v6->msg_len);
369 if ((msg_len >= sizeof (struct olsr_msg6))
370 && (msg_len <= length))
371 msg_len_valid = 1;
372
373 /* infinite loop check */
374 if (msg_type == 0 || msg_len == 0) {
375 return;
376 }
377
378 ND_PRINT("\n\t%s Message (%#04x), originator %s, ttl %u, hop %u"
379 "\n\t vtime %.3fs, msg-seq 0x%04x, length %u%s",
380 tok2str(olsr_msg_values, "Unknown", msg_type),
381 msg_type, ip6addr_string(ndo, msgptr.v6->originator),
382 EXTRACT_U_1(msgptr.v6->ttl),
383 EXTRACT_U_1(msgptr.v6->hopcount),
384 ME_TO_DOUBLE(EXTRACT_U_1(msgptr.v6->vtime)),
385 EXTRACT_BE_U_2(msgptr.v6->msg_seq),
386 msg_len, (msg_len_valid == 0) ? " (invalid)" : "");
387 if (!msg_len_valid) {
388 return;
389 }
390
391 msg_tlen = msg_len - sizeof(struct olsr_msg6);
392 msg_data = tptr + sizeof(struct olsr_msg6);
393 }
394 else /* (!is_ipv6) */
395 {
396 ND_TCHECK_LEN(tptr, sizeof(struct olsr_msg4));
397 msgptr.v4 = (const struct olsr_msg4 *) tptr;
398 msg_type = EXTRACT_U_1(msgptr.v4->msg_type);
399 msg_len = EXTRACT_BE_U_2(msgptr.v4->msg_len);
400 if ((msg_len >= sizeof (struct olsr_msg4))
401 && (msg_len <= length))
402 msg_len_valid = 1;
403
404 /* infinite loop check */
405 if (msg_type == 0 || msg_len == 0) {
406 return;
407 }
408
409 ND_PRINT("\n\t%s Message (%#04x), originator %s, ttl %u, hop %u"
410 "\n\t vtime %.3fs, msg-seq 0x%04x, length %u%s",
411 tok2str(olsr_msg_values, "Unknown", msg_type),
412 msg_type, ipaddr_string(ndo, msgptr.v4->originator),
413 EXTRACT_U_1(msgptr.v4->ttl),
414 EXTRACT_U_1(msgptr.v4->hopcount),
415 ME_TO_DOUBLE(EXTRACT_U_1(msgptr.v4->vtime)),
416 EXTRACT_BE_U_2(msgptr.v4->msg_seq),
417 msg_len, (msg_len_valid == 0) ? " (invalid)" : "");
418 if (!msg_len_valid) {
419 return;
420 }
421
422 msg_tlen = msg_len - sizeof(struct olsr_msg4);
423 msg_data = tptr + sizeof(struct olsr_msg4);
424 }
425
426 switch (msg_type) {
427 case OLSR_HELLO_MSG:
428 case OLSR_HELLO_LQ_MSG:
429 if (msg_tlen < sizeof(struct olsr_hello))
430 goto trunc;
431 ND_TCHECK_LEN(msg_data, sizeof(struct olsr_hello));
432
433 ptr.hello = (const struct olsr_hello *)msg_data;
434 ND_PRINT("\n\t hello-time %.3fs, MPR willingness %u",
435 ME_TO_DOUBLE(EXTRACT_U_1(ptr.hello->htime)),
436 EXTRACT_U_1(ptr.hello->will));
437 msg_data += sizeof(struct olsr_hello);
438 msg_tlen -= sizeof(struct olsr_hello);
439
440 while (msg_tlen >= sizeof(struct olsr_hello_link)) {
441 int hello_len_valid = 0;
442
443 /*
444 * link-type.
445 */
446 ND_TCHECK_LEN(msg_data, sizeof(struct olsr_hello_link));
447
448 ptr.hello_link = (const struct olsr_hello_link *)msg_data;
449
450 hello_len = EXTRACT_BE_U_2(ptr.hello_link->len);
451 link_type = OLSR_EXTRACT_LINK_TYPE(EXTRACT_U_1(ptr.hello_link->link_code));
452 neighbor_type = OLSR_EXTRACT_NEIGHBOR_TYPE(EXTRACT_U_1(ptr.hello_link->link_code));
453
454 if ((hello_len <= msg_tlen)
455 && (hello_len >= sizeof(struct olsr_hello_link)))
456 hello_len_valid = 1;
457
458 ND_PRINT("\n\t link-type %s, neighbor-type %s, len %u%s",
459 tok2str(olsr_link_type_values, "Unknown", link_type),
460 tok2str(olsr_neighbor_type_values, "Unknown", neighbor_type),
461 hello_len,
462 (hello_len_valid == 0) ? " (invalid)" : "");
463
464 if (hello_len_valid == 0)
465 break;
466
467 msg_data += sizeof(struct olsr_hello_link);
468 msg_tlen -= sizeof(struct olsr_hello_link);
469 hello_len -= sizeof(struct olsr_hello_link);
470
471 ND_TCHECK_LEN(msg_data, hello_len);
472 if (msg_type == OLSR_HELLO_MSG) {
473 if (olsr_print_neighbor(ndo, msg_data, hello_len) == -1)
474 goto trunc;
475 } else {
476 if (is_ipv6) {
477 if (olsr_print_lq_neighbor6(ndo, msg_data, hello_len) == -1)
478 goto trunc;
479 } else {
480 if (olsr_print_lq_neighbor4(ndo, msg_data, hello_len) == -1)
481 goto trunc;
482 }
483 }
484
485 msg_data += hello_len;
486 msg_tlen -= hello_len;
487 }
488 break;
489
490 case OLSR_TC_MSG:
491 case OLSR_TC_LQ_MSG:
492 if (msg_tlen < sizeof(struct olsr_tc))
493 goto trunc;
494 ND_TCHECK_LEN(msg_data, sizeof(struct olsr_tc));
495
496 ptr.tc = (const struct olsr_tc *)msg_data;
497 ND_PRINT("\n\t advertised neighbor seq 0x%04x",
498 EXTRACT_BE_U_2(ptr.tc->ans_seq));
499 msg_data += sizeof(struct olsr_tc);
500 msg_tlen -= sizeof(struct olsr_tc);
501
502 if (msg_type == OLSR_TC_MSG) {
503 if (olsr_print_neighbor(ndo, msg_data, msg_tlen) == -1)
504 goto trunc;
505 } else {
506 if (is_ipv6) {
507 if (olsr_print_lq_neighbor6(ndo, msg_data, msg_tlen) == -1)
508 goto trunc;
509 } else {
510 if (olsr_print_lq_neighbor4(ndo, msg_data, msg_tlen) == -1)
511 goto trunc;
512 }
513 }
514 break;
515
516 case OLSR_MID_MSG:
517 {
518 size_t addr_size = sizeof(nd_ipv4);
519
520 if (is_ipv6)
521 addr_size = sizeof(nd_ipv6);
522
523 while (msg_tlen >= addr_size) {
524 ND_TCHECK_LEN(msg_data, addr_size);
525 ND_PRINT("\n\t interface address %s",
526 is_ipv6 ? ip6addr_string(ndo, msg_data) :
527 ipaddr_string(ndo, msg_data));
528
529 msg_data += addr_size;
530 msg_tlen -= addr_size;
531 }
532 break;
533 }
534
535 case OLSR_HNA_MSG:
536 if (is_ipv6)
537 {
538 int i = 0;
539
540 ND_PRINT("\n\t Advertised networks (total %u)",
541 (unsigned int) (msg_tlen / sizeof(struct olsr_hna6)));
542
543 while (msg_tlen >= sizeof(struct olsr_hna6)) {
544 const struct olsr_hna6 *hna6;
545
546 ND_TCHECK_LEN(msg_data, sizeof(struct olsr_hna6));
547
548 hna6 = (const struct olsr_hna6 *)msg_data;
549
550 ND_PRINT("\n\t #%i: %s/%u",
551 i, ip6addr_string(ndo, hna6->network),
552 mask62plen (hna6->mask));
553
554 msg_data += sizeof(struct olsr_hna6);
555 msg_tlen -= sizeof(struct olsr_hna6);
556 }
557 }
558 else
559 {
560 int col = 0;
561
562 ND_PRINT("\n\t Advertised networks (total %u)",
563 (unsigned int) (msg_tlen / sizeof(struct olsr_hna4)));
564
565 while (msg_tlen >= sizeof(struct olsr_hna4)) {
566 ND_TCHECK_LEN(msg_data, sizeof(struct olsr_hna4));
567
568 ptr.hna = (const struct olsr_hna4 *)msg_data;
569
570 /* print 4 prefixes per line */
571 if (!ptr.hna->network[0] && !ptr.hna->network[1] &&
572 !ptr.hna->network[2] && !ptr.hna->network[3] &&
573 !ptr.hna->mask[GW_HNA_PAD] &&
574 ptr.hna->mask[GW_HNA_FLAGS]) {
575 /* smart gateway */
576 ND_PRINT("%sSmart-Gateway:%s%s%s%s%s %u/%u",
577 col == 0 ? "\n\t " : ", ", /* indent */
578 /* sgw */
579 /* LINKSPEED */
580 (ptr.hna->mask[GW_HNA_FLAGS] &
581 GW_HNA_FLAG_LINKSPEED) ? " LINKSPEED" : "",
582 /* IPV4 */
583 (ptr.hna->mask[GW_HNA_FLAGS] &
584 GW_HNA_FLAG_IPV4) ? " IPV4" : "",
585 /* IPV4-NAT */
586 (ptr.hna->mask[GW_HNA_FLAGS] &
587 GW_HNA_FLAG_IPV4_NAT) ? " IPV4-NAT" : "",
588 /* IPV6 */
589 (ptr.hna->mask[GW_HNA_FLAGS] &
590 GW_HNA_FLAG_IPV6) ? " IPV6" : "",
591 /* IPv6PREFIX */
592 (ptr.hna->mask[GW_HNA_FLAGS] &
593 GW_HNA_FLAG_IPV6PREFIX) ? " IPv6-PREFIX" : "",
594 /* uplink */
595 (ptr.hna->mask[GW_HNA_FLAGS] &
596 GW_HNA_FLAG_LINKSPEED) ?
597 deserialize_gw_speed(ptr.hna->mask[GW_HNA_UPLINK]) : 0,
598 /* downlink */
599 (ptr.hna->mask[GW_HNA_FLAGS] &
600 GW_HNA_FLAG_LINKSPEED) ?
601 deserialize_gw_speed(ptr.hna->mask[GW_HNA_DOWNLINK]) : 0
602 );
603 } else {
604 /* normal route */
605 ND_PRINT("%s%s/%u",
606 col == 0 ? "\n\t " : ", ",
607 ipaddr_string(ndo, ptr.hna->network),
608 mask2plen(EXTRACT_BE_U_4(ptr.hna->mask)));
609 }
610
611 msg_data += sizeof(struct olsr_hna4);
612 msg_tlen -= sizeof(struct olsr_hna4);
613
614 col = (col + 1) % 4;
615 }
616 }
617 break;
618
619 case OLSR_NAMESERVICE_MSG:
620 {
621 u_int name_entries;
622 u_int addr_size;
623 int name_entries_valid;
624 u_int i;
625
626 if (msg_tlen < 4)
627 goto trunc;
628 ND_TCHECK_4(msg_data);
629
630 name_entries = EXTRACT_BE_U_2(msg_data + 2);
631 addr_size = 4;
632 if (is_ipv6)
633 addr_size = 16;
634
635 name_entries_valid = 0;
636 if ((name_entries > 0)
637 && ((name_entries * (4 + addr_size)) <= msg_tlen))
638 name_entries_valid = 1;
639
640 ND_PRINT("\n\t Version %u, Entries %u%s",
641 EXTRACT_BE_U_2(msg_data),
642 name_entries, (name_entries_valid == 0) ? " (invalid)" : "");
643
644 if (name_entries_valid == 0)
645 break;
646
647 msg_data += 4;
648 msg_tlen -= 4;
649
650 for (i = 0; i < name_entries; i++) {
651 int name_entry_len_valid = 0;
652
653 if (msg_tlen < 4)
654 break;
655 ND_TCHECK_4(msg_data);
656
657 name_entry_type = EXTRACT_BE_U_2(msg_data);
658 name_entry_len = EXTRACT_BE_U_2(msg_data + 2);
659
660 msg_data += 4;
661 msg_tlen -= 4;
662
663 if ((name_entry_len > 0) && ((addr_size + name_entry_len) <= msg_tlen))
664 name_entry_len_valid = 1;
665
666 ND_PRINT("\n\t #%u: type %#06x, length %u%s",
667 (unsigned int) i, name_entry_type,
668 name_entry_len, (name_entry_len_valid == 0) ? " (invalid)" : "");
669
670 if (name_entry_len_valid == 0)
671 break;
672
673 /* 32-bit alignment */
674 name_entry_padding = 0;
675 if (name_entry_len%4 != 0)
676 name_entry_padding = 4-(name_entry_len%4);
677
678 if (msg_tlen < addr_size + name_entry_len + name_entry_padding)
679 goto trunc;
680
681 ND_TCHECK_LEN(msg_data,
682 addr_size + name_entry_len + name_entry_padding);
683
684 if (is_ipv6)
685 ND_PRINT(", address %s, name \"",
686 ip6addr_string(ndo, msg_data));
687 else
688 ND_PRINT(", address %s, name \"",
689 ipaddr_string(ndo, msg_data));
690 (void)fn_printn(ndo, msg_data + addr_size, name_entry_len, NULL);
691 ND_PRINT("\"");
692
693 msg_data += addr_size + name_entry_len + name_entry_padding;
694 msg_tlen -= addr_size + name_entry_len + name_entry_padding;
695 } /* for (i = 0; i < name_entries; i++) */
696 break;
697 } /* case OLSR_NAMESERVICE_MSG */
698
699 /*
700 * FIXME those are the defined messages that lack a decoder
701 * you are welcome to contribute code ;-)
702 */
703 case OLSR_POWERINFO_MSG:
704 default:
705 print_unknown_data(ndo, msg_data, "\n\t ", msg_tlen);
706 break;
707 } /* switch (msg_type) */
708 tptr += msg_len;
709 } /* while (tptr < (pptr+length)) */
710
711 return;
712
713 trunc:
714 ND_PRINT("[|olsr]");
715 }
716
717 /*
718 * Local Variables:
719 * c-style: whitesmith
720 * c-basic-offset: 4
721 * End:
722 */
[mirror] the TCPdump network dissector