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@juniper.net> 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 uint8_t packet_len[2]; 67 uint8_t packet_seq[2]; 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 uint8_t msg_type; 93 uint8_t vtime; 94 uint8_t msg_len[2]; 95 uint8_t originator[4]; 96 uint8_t ttl; 97 uint8_t hopcount; 98 uint8_t msg_seq[2]; 99 }; 100 101 struct olsr_msg6 { 102 uint8_t msg_type; 103 uint8_t vtime; 104 uint8_t msg_len[2]; 105 uint8_t originator[16]; 106 uint8_t ttl; 107 uint8_t hopcount; 108 uint8_t msg_seq[2]; 109 }; 110 111 struct olsr_hello { 112 uint8_t res[2]; 113 uint8_t htime; 114 uint8_t will; 115 }; 116 117 struct olsr_hello_link { 118 uint8_t link_code; 119 uint8_t res; 120 uint8_t len[2]; 121 }; 122 123 struct olsr_tc { 124 uint8_t ans_seq[2]; 125 uint8_t res[2]; 126 }; 127 128 struct olsr_hna4 { 129 uint8_t network[4]; 130 uint8_t mask[4]; 131 }; 132 133 struct olsr_hna6 { 134 uint8_t network[16]; 135 uint8_t mask[16]; 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 uint8_t neighbor[4]; 179 uint8_t link_quality; 180 uint8_t neighbor_link_quality; 181 uint8_t res[2]; 182 }; 183 184 struct olsr_lq_neighbor6 { 185 uint8_t neighbor[16]; 186 uint8_t link_quality; 187 uint8_t neighbor_link_quality; 188 uint8_t 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 } 219 return speed; 220 } 221 222 /* 223 * macro to convert the 8-bit mantissa/exponent to a double float 224 * taken from olsr.org. 225 */ 226 #define VTIME_SCALE_FACTOR 0.0625 227 #define ME_TO_DOUBLE(me) \ 228 (double)(VTIME_SCALE_FACTOR*(1+(double)(me>>4)/16)*(double)(1<<(me&0x0F))) 229 230 /* 231 * print a neighbor list with LQ extensions. 232 */ 233 static int 234 olsr_print_lq_neighbor4(netdissect_options *ndo, 235 const u_char *msg_data, u_int hello_len) 236 { 237 const struct olsr_lq_neighbor4 *lq_neighbor; 238 239 while (hello_len >= sizeof(struct olsr_lq_neighbor4)) { 240 241 lq_neighbor = (const struct olsr_lq_neighbor4 *)msg_data; 242 if (!ND_TTEST(*lq_neighbor)) 243 return (-1); 244 245 ND_PRINT((ndo, "\n\t neighbor %s, link-quality %.2f%%" 246 ", neighbor-link-quality %.2f%%", 247 ipaddr_string(ndo, lq_neighbor->neighbor), 248 ((double)lq_neighbor->link_quality/2.55), 249 ((double)lq_neighbor->neighbor_link_quality/2.55))); 250 251 msg_data += sizeof(struct olsr_lq_neighbor4); 252 hello_len -= sizeof(struct olsr_lq_neighbor4); 253 } 254 return (0); 255 } 256 257 static int 258 olsr_print_lq_neighbor6(netdissect_options *ndo, 259 const u_char *msg_data, u_int hello_len) 260 { 261 const struct olsr_lq_neighbor6 *lq_neighbor; 262 263 while (hello_len >= sizeof(struct olsr_lq_neighbor6)) { 264 265 lq_neighbor = (const struct olsr_lq_neighbor6 *)msg_data; 266 if (!ND_TTEST(*lq_neighbor)) 267 return (-1); 268 269 ND_PRINT((ndo, "\n\t neighbor %s, link-quality %.2f%%" 270 ", neighbor-link-quality %.2f%%", 271 ip6addr_string(ndo, lq_neighbor->neighbor), 272 ((double)lq_neighbor->link_quality/2.55), 273 ((double)lq_neighbor->neighbor_link_quality/2.55))); 274 275 msg_data += sizeof(struct olsr_lq_neighbor6); 276 hello_len -= sizeof(struct olsr_lq_neighbor6); 277 } 278 return (0); 279 } 280 281 /* 282 * print a neighbor list. 283 */ 284 static int 285 olsr_print_neighbor(netdissect_options *ndo, 286 const u_char *msg_data, u_int hello_len) 287 { 288 int neighbor; 289 290 ND_PRINT((ndo, "\n\t neighbor\n\t\t")); 291 neighbor = 1; 292 293 while (hello_len >= sizeof(struct in_addr)) { 294 295 if (!ND_TTEST2(*msg_data, sizeof(struct in_addr))) 296 return (-1); 297 /* print 4 neighbors per line */ 298 299 ND_PRINT((ndo, "%s%s", ipaddr_string(ndo, msg_data), 300 neighbor % 4 == 0 ? "\n\t\t" : " ")); 301 302 msg_data += sizeof(struct in_addr); 303 hello_len -= sizeof(struct in_addr); 304 } 305 return (0); 306 } 307 308 309 void 310 olsr_print(netdissect_options *ndo, 311 const u_char *pptr, u_int length, int is_ipv6) 312 { 313 union { 314 const struct olsr_common *common; 315 const struct olsr_msg4 *msg4; 316 const struct olsr_msg6 *msg6; 317 const struct olsr_hello *hello; 318 const struct olsr_hello_link *hello_link; 319 const struct olsr_tc *tc; 320 const struct olsr_hna4 *hna; 321 } ptr; 322 323 u_int msg_type, msg_len, msg_tlen, hello_len; 324 uint16_t name_entry_type, name_entry_len; 325 u_int name_entry_padding; 326 uint8_t link_type, neighbor_type; 327 const u_char *tptr, *msg_data; 328 329 tptr = pptr; 330 331 if (length < sizeof(struct olsr_common)) { 332 goto trunc; 333 } 334 335 ND_TCHECK2(*tptr, sizeof(struct olsr_common)); 336 337 ptr.common = (const struct olsr_common *)tptr; 338 length = min(length, EXTRACT_16BITS(ptr.common->packet_len)); 339 340 ND_PRINT((ndo, "OLSRv%i, seq 0x%04x, length %u", 341 (is_ipv6 == 0) ? 4 : 6, 342 EXTRACT_16BITS(ptr.common->packet_seq), 343 length)); 344 345 tptr += sizeof(struct olsr_common); 346 347 /* 348 * In non-verbose mode, just print version. 349 */ 350 if (ndo->ndo_vflag < 1) { 351 return; 352 } 353 354 while (tptr < (pptr+length)) { 355 union 356 { 357 const struct olsr_msg4 *v4; 358 const struct olsr_msg6 *v6; 359 } msgptr; 360 int msg_len_valid = 0; 361 362 ND_TCHECK2(*tptr, sizeof(struct olsr_msg4)); 363 364 if (is_ipv6) 365 { 366 msgptr.v6 = (const struct olsr_msg6 *) tptr; 367 msg_type = msgptr.v6->msg_type; 368 msg_len = EXTRACT_16BITS(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((ndo, "\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 msgptr.v6->ttl, 383 msgptr.v6->hopcount, 384 ME_TO_DOUBLE(msgptr.v6->vtime), 385 EXTRACT_16BITS(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 msgptr.v4 = (const struct olsr_msg4 *) tptr; 397 msg_type = msgptr.v4->msg_type; 398 msg_len = EXTRACT_16BITS(msgptr.v4->msg_len); 399 if ((msg_len >= sizeof (struct olsr_msg4)) 400 && (msg_len <= length)) 401 msg_len_valid = 1; 402 403 /* infinite loop check */ 404 if (msg_type == 0 || msg_len == 0) { 405 return; 406 } 407 408 ND_PRINT((ndo, "\n\t%s Message (%#04x), originator %s, ttl %u, hop %u" 409 "\n\t vtime %.3fs, msg-seq 0x%04x, length %u%s", 410 tok2str(olsr_msg_values, "Unknown", msg_type), 411 msg_type, ipaddr_string(ndo, msgptr.v4->originator), 412 msgptr.v4->ttl, 413 msgptr.v4->hopcount, 414 ME_TO_DOUBLE(msgptr.v4->vtime), 415 EXTRACT_16BITS(msgptr.v4->msg_seq), 416 msg_len, (msg_len_valid == 0) ? " (invalid)" : "")); 417 if (!msg_len_valid) { 418 return; 419 } 420 421 msg_tlen = msg_len - sizeof(struct olsr_msg4); 422 msg_data = tptr + sizeof(struct olsr_msg4); 423 } 424 425 switch (msg_type) { 426 case OLSR_HELLO_MSG: 427 case OLSR_HELLO_LQ_MSG: 428 if (msg_tlen < sizeof(struct olsr_hello)) 429 goto trunc; 430 ND_TCHECK2(*msg_data, sizeof(struct olsr_hello)); 431 432 ptr.hello = (const struct olsr_hello *)msg_data; 433 ND_PRINT((ndo, "\n\t hello-time %.3fs, MPR willingness %u", 434 ME_TO_DOUBLE(ptr.hello->htime), ptr.hello->will)); 435 msg_data += sizeof(struct olsr_hello); 436 msg_tlen -= sizeof(struct olsr_hello); 437 438 while (msg_tlen >= sizeof(struct olsr_hello_link)) { 439 int hello_len_valid = 0; 440 441 /* 442 * link-type. 443 */ 444 ND_TCHECK2(*msg_data, sizeof(struct olsr_hello_link)); 445 446 ptr.hello_link = (const struct olsr_hello_link *)msg_data; 447 448 hello_len = EXTRACT_16BITS(ptr.hello_link->len); 449 link_type = OLSR_EXTRACT_LINK_TYPE(ptr.hello_link->link_code); 450 neighbor_type = OLSR_EXTRACT_NEIGHBOR_TYPE(ptr.hello_link->link_code); 451 452 if ((hello_len <= msg_tlen) 453 && (hello_len >= sizeof(struct olsr_hello_link))) 454 hello_len_valid = 1; 455 456 ND_PRINT((ndo, "\n\t link-type %s, neighbor-type %s, len %u%s", 457 tok2str(olsr_link_type_values, "Unknown", link_type), 458 tok2str(olsr_neighbor_type_values, "Unknown", neighbor_type), 459 hello_len, 460 (hello_len_valid == 0) ? " (invalid)" : "")); 461 462 if (hello_len_valid == 0) 463 break; 464 465 msg_data += sizeof(struct olsr_hello_link); 466 msg_tlen -= sizeof(struct olsr_hello_link); 467 hello_len -= sizeof(struct olsr_hello_link); 468 469 ND_TCHECK2(*msg_data, hello_len); 470 if (msg_type == OLSR_HELLO_MSG) { 471 if (olsr_print_neighbor(ndo, msg_data, hello_len) == -1) 472 goto trunc; 473 } else { 474 if (is_ipv6) { 475 if (olsr_print_lq_neighbor6(ndo, msg_data, hello_len) == -1) 476 goto trunc; 477 } else { 478 if (olsr_print_lq_neighbor4(ndo, msg_data, hello_len) == -1) 479 goto trunc; 480 } 481 } 482 483 msg_data += hello_len; 484 msg_tlen -= hello_len; 485 } 486 break; 487 488 case OLSR_TC_MSG: 489 case OLSR_TC_LQ_MSG: 490 if (msg_tlen < sizeof(struct olsr_tc)) 491 goto trunc; 492 ND_TCHECK2(*msg_data, sizeof(struct olsr_tc)); 493 494 ptr.tc = (const struct olsr_tc *)msg_data; 495 ND_PRINT((ndo, "\n\t advertised neighbor seq 0x%04x", 496 EXTRACT_16BITS(ptr.tc->ans_seq))); 497 msg_data += sizeof(struct olsr_tc); 498 msg_tlen -= sizeof(struct olsr_tc); 499 500 if (msg_type == OLSR_TC_MSG) { 501 if (olsr_print_neighbor(ndo, msg_data, msg_tlen) == -1) 502 goto trunc; 503 } else { 504 if (is_ipv6) { 505 if (olsr_print_lq_neighbor6(ndo, msg_data, msg_tlen) == -1) 506 goto trunc; 507 } else { 508 if (olsr_print_lq_neighbor4(ndo, msg_data, msg_tlen) == -1) 509 goto trunc; 510 } 511 } 512 break; 513 514 case OLSR_MID_MSG: 515 { 516 size_t addr_size = sizeof(struct in_addr); 517 518 if (is_ipv6) 519 addr_size = sizeof(struct in6_addr); 520 521 while (msg_tlen >= addr_size) { 522 ND_TCHECK2(*msg_data, addr_size); 523 ND_PRINT((ndo, "\n\t interface address %s", 524 is_ipv6 ? ip6addr_string(ndo, msg_data) : 525 ipaddr_string(ndo, msg_data))); 526 527 msg_data += addr_size; 528 msg_tlen -= addr_size; 529 } 530 break; 531 } 532 533 case OLSR_HNA_MSG: 534 if (is_ipv6) 535 { 536 int i = 0; 537 538 ND_PRINT((ndo, "\n\t Advertised networks (total %u)", 539 (unsigned int) (msg_tlen / sizeof(struct olsr_hna6)))); 540 541 while (msg_tlen >= sizeof(struct olsr_hna6)) { 542 const struct olsr_hna6 *hna6; 543 544 ND_TCHECK2(*msg_data, sizeof(struct olsr_hna6)); 545 546 hna6 = (const struct olsr_hna6 *)msg_data; 547 548 ND_PRINT((ndo, "\n\t #%i: %s/%u", 549 i, ip6addr_string(ndo, hna6->network), 550 mask62plen (hna6->mask))); 551 552 msg_data += sizeof(struct olsr_hna6); 553 msg_tlen -= sizeof(struct olsr_hna6); 554 } 555 } 556 else 557 { 558 int col = 0; 559 560 ND_PRINT((ndo, "\n\t Advertised networks (total %u)", 561 (unsigned int) (msg_tlen / sizeof(struct olsr_hna4)))); 562 563 while (msg_tlen >= sizeof(struct olsr_hna4)) { 564 ND_TCHECK2(*msg_data, sizeof(struct olsr_hna4)); 565 566 ptr.hna = (const struct olsr_hna4 *)msg_data; 567 568 /* print 4 prefixes per line */ 569 if (!ptr.hna->network[0] && !ptr.hna->network[1] && 570 !ptr.hna->network[2] && !ptr.hna->network[3] && 571 !ptr.hna->mask[GW_HNA_PAD] && 572 ptr.hna->mask[GW_HNA_FLAGS]) { 573 /* smart gateway */ 574 ND_PRINT((ndo, "%sSmart-Gateway:%s%s%s%s%s %u/%u", 575 col == 0 ? "\n\t " : ", ", /* indent */ 576 /* sgw */ 577 /* LINKSPEED */ 578 (ptr.hna->mask[GW_HNA_FLAGS] & 579 GW_HNA_FLAG_LINKSPEED) ? " LINKSPEED" : "", 580 /* IPV4 */ 581 (ptr.hna->mask[GW_HNA_FLAGS] & 582 GW_HNA_FLAG_IPV4) ? " IPV4" : "", 583 /* IPV4-NAT */ 584 (ptr.hna->mask[GW_HNA_FLAGS] & 585 GW_HNA_FLAG_IPV4_NAT) ? " IPV4-NAT" : "", 586 /* IPV6 */ 587 (ptr.hna->mask[GW_HNA_FLAGS] & 588 GW_HNA_FLAG_IPV6) ? " IPV6" : "", 589 /* IPv6PREFIX */ 590 (ptr.hna->mask[GW_HNA_FLAGS] & 591 GW_HNA_FLAG_IPV6PREFIX) ? " IPv6-PREFIX" : "", 592 /* uplink */ 593 (ptr.hna->mask[GW_HNA_FLAGS] & 594 GW_HNA_FLAG_LINKSPEED) ? 595 deserialize_gw_speed(ptr.hna->mask[GW_HNA_UPLINK]) : 0, 596 /* downlink */ 597 (ptr.hna->mask[GW_HNA_FLAGS] & 598 GW_HNA_FLAG_LINKSPEED) ? 599 deserialize_gw_speed(ptr.hna->mask[GW_HNA_DOWNLINK]) : 0 600 )); 601 } else { 602 /* normal route */ 603 ND_PRINT((ndo, "%s%s/%u", 604 col == 0 ? "\n\t " : ", ", 605 ipaddr_string(ndo, ptr.hna->network), 606 mask2plen(EXTRACT_32BITS(ptr.hna->mask)))); 607 } 608 609 msg_data += sizeof(struct olsr_hna4); 610 msg_tlen -= sizeof(struct olsr_hna4); 611 612 col = (col + 1) % 4; 613 } 614 } 615 break; 616 617 case OLSR_NAMESERVICE_MSG: 618 { 619 u_int name_entries = EXTRACT_16BITS(msg_data+2); 620 u_int addr_size = 4; 621 int name_entries_valid = 0; 622 u_int i; 623 624 if (is_ipv6) 625 addr_size = 16; 626 627 if ((name_entries > 0) 628 && ((name_entries * (4 + addr_size)) <= msg_tlen)) 629 name_entries_valid = 1; 630 631 if (msg_tlen < 4) 632 goto trunc; 633 ND_TCHECK2(*msg_data, 4); 634 635 ND_PRINT((ndo, "\n\t Version %u, Entries %u%s", 636 EXTRACT_16BITS(msg_data), 637 name_entries, (name_entries_valid == 0) ? " (invalid)" : "")); 638 639 if (name_entries_valid == 0) 640 break; 641 642 msg_data += 4; 643 msg_tlen -= 4; 644 645 for (i = 0; i < name_entries; i++) { 646 int name_entry_len_valid = 0; 647 648 if (msg_tlen < 4) 649 break; 650 ND_TCHECK2(*msg_data, 4); 651 652 name_entry_type = EXTRACT_16BITS(msg_data); 653 name_entry_len = EXTRACT_16BITS(msg_data+2); 654 655 msg_data += 4; 656 msg_tlen -= 4; 657 658 if ((name_entry_len > 0) && ((addr_size + name_entry_len) <= msg_tlen)) 659 name_entry_len_valid = 1; 660 661 ND_PRINT((ndo, "\n\t #%u: type %#06x, length %u%s", 662 (unsigned int) i, name_entry_type, 663 name_entry_len, (name_entry_len_valid == 0) ? " (invalid)" : "")); 664 665 if (name_entry_len_valid == 0) 666 break; 667 668 /* 32-bit alignment */ 669 name_entry_padding = 0; 670 if (name_entry_len%4 != 0) 671 name_entry_padding = 4-(name_entry_len%4); 672 673 if (msg_tlen < addr_size + name_entry_len + name_entry_padding) 674 goto trunc; 675 676 ND_TCHECK2(*msg_data, addr_size + name_entry_len + name_entry_padding); 677 678 if (is_ipv6) 679 ND_PRINT((ndo, ", address %s, name \"", 680 ip6addr_string(ndo, msg_data))); 681 else 682 ND_PRINT((ndo, ", address %s, name \"", 683 ipaddr_string(ndo, msg_data))); 684 (void)fn_printn(ndo, msg_data + addr_size, name_entry_len, NULL); 685 ND_PRINT((ndo, "\"")); 686 687 msg_data += addr_size + name_entry_len + name_entry_padding; 688 msg_tlen -= addr_size + name_entry_len + name_entry_padding; 689 } /* for (i = 0; i < name_entries; i++) */ 690 break; 691 } /* case OLSR_NAMESERVICE_MSG */ 692 693 /* 694 * FIXME those are the defined messages that lack a decoder 695 * you are welcome to contribute code ;-) 696 */ 697 case OLSR_POWERINFO_MSG: 698 default: 699 print_unknown_data(ndo, msg_data, "\n\t ", msg_tlen); 700 break; 701 } /* switch (msg_type) */ 702 tptr += msg_len; 703 } /* while (tptr < (pptr+length)) */ 704 705 return; 706 707 trunc: 708 ND_PRINT((ndo, "[|olsr]")); 709 } 710 711 /* 712 * Local Variables: 713 * c-style: whitesmith 714 * c-basic-offset: 4 715 * End: 716 */ 717