gre: add support for MikroTik Ethernet-over-IP hack.

[tcpdump] / print-ip6opts.c

diff --git a/print-ip6opts.c b/print-ip6opts.c
index e087af3fc8e318e1baedf956629c35c865207f17..a78c76daa27def5e848179534e9ba0b4bb883bea 100644 (file)
--- a/print-ip6opts.c
+++ b/print-ip6opts.c
@@ -1,7 +1,7 @@
 /*
  * Copyright (C) 1998 WIDE Project.
  * All rights reserved.
 /*
  * Copyright (C) 1998 WIDE Project.
  * All rights reserved.

- * 
+ *

  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
  * are met:
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
  * are met:


@@ -13,7 +13,7 @@
  * 3. Neither the name of the project nor the names of its contributors
  *    may be used to endorse or promote products derived from this software
  *    without specific prior written permission.
  * 3. Neither the name of the project nor the names of its contributors
  *    may be used to endorse or promote products derived from this software
  *    without specific prior written permission.

- * 
+ *

  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE


@@ -27,157 +27,239 @@
  * SUCH DAMAGE.
  */
 
  * SUCH DAMAGE.
  */
 

-#ifdef HAVE_CONFIG_H
-#include "config.h"
-#endif
+/* \summary: IPv6 header option printer */

 
 

-#ifndef lint
-static const char rcsid[] =
-     "@(#) $Header: /tcpdump/master/tcpdump/print-ip6opts.c,v 1.5 2000-04-28 11:14:48 itojun Exp $";
+#ifdef HAVE_CONFIG_H
+#include <config.h>

 #endif
 
 #endif
 

-#ifdef INET6
-#include <sys/param.h>
-#include <sys/time.h>
-#include <sys/types.h>
-#include <sys/socket.h>
-
-#include <netinet/in.h>
-#include <netinet/ip6.h>
+#include "netdissect-stdinc.h"

 
 

-#include <stdio.h>
-
-#include "interface.h"
+#include "netdissect.h"

 #include "addrtoname.h"
 #include "addrtoname.h"

+#include "extract.h"
+
+#include "ip6.h"

 
 

-void
-ip6_opt_print(const u_char *bp, int len)
+static int
+ip6_sopt_print(netdissect_options *ndo, const u_char *bp, int len)

 {
     int i;
     int optlen;
 
     for (i = 0; i < len; i += optlen) {
 {
     int i;
     int optlen;
 
     for (i = 0; i < len; i += optlen) {

-       switch (bp[i]) {
-#ifndef IP6OPT_PAD1
-#define IP6OPT_PAD1    0x00
-#endif
+       if (GET_U_1(bp + i) == IP6OPT_PAD1)
+           optlen = 1;
+       else {
+           if (i + 1 < len)
+               optlen = GET_U_1(bp + i + 1) + 2;
+           else
+               goto trunc;
+       }
+       if (i + optlen > len)
+           goto trunc;
+
+       switch (GET_U_1(bp + i)) {

        case IP6OPT_PAD1:
        case IP6OPT_PAD1:

+            ND_PRINT(", pad1");
+           break;
+       case IP6OPT_PADN:
+           if (len - i < IP6OPT_MINLEN) {
+               ND_PRINT(", padn: trunc");
+               goto trunc;
+           }
+            ND_PRINT(", padn");
+           break;
+       default:
+           if (len - i < IP6OPT_MINLEN) {
+               ND_PRINT(", sopt_type %u: trunc)", GET_U_1(bp + i));
+               goto trunc;
+           }
+           ND_PRINT(", sopt_type 0x%02x: len=%u", GET_U_1(bp + i),
+                     GET_U_1(bp + i + 1));
+           break;
+       }
+    }
+    return 0;
+
+trunc:
+    return -1;
+}
+
+static int
+ip6_opt_process(netdissect_options *ndo, const u_char *bp, int len,
+               int *found_jumbop, uint32_t *payload_len)
+{
+    int i;
+    int optlen = 0;
+    int found_jumbo = 0;
+    uint32_t jumbolen = 0;
+
+    if (len == 0)
+        return 0;
+    for (i = 0; i < len; i += optlen) {
+       if (GET_U_1(bp + i) == IP6OPT_PAD1)

            optlen = 1;
            optlen = 1;

+       else {
+           if (i + 1 < len)
+               optlen = GET_U_1(bp + i + 1) + 2;
+           else
+               goto trunc;
+       }
+       if (i + optlen > len)
+           goto trunc;
+
+       switch (GET_U_1(bp + i)) {
+       case IP6OPT_PAD1:
+           if (ndo->ndo_vflag)
+                ND_PRINT("(pad1)");

            break;
            break;

-#ifndef IP6OPT_PADN
-#define IP6OPT_PADN    0x01
-#endif

        case IP6OPT_PADN:
        case IP6OPT_PADN:

-#ifndef IP6OPT_MINLEN
-#define IP6OPT_MINLEN  2
-#endif

            if (len - i < IP6OPT_MINLEN) {
            if (len - i < IP6OPT_MINLEN) {

-               printf("(padn: trunc)");
+               ND_PRINT("(padn: trunc)");

                goto trunc;
            }
                goto trunc;
            }

-           optlen = bp[i + 1] + 2;
+           if (ndo->ndo_vflag)
+                ND_PRINT("(padn)");

            break;
            break;

-#ifndef IP6OPT_RTALERT
-#define IP6OPT_RTALERT 0x05
-#endif
-       case IP6OPT_RTALERT:
-#ifndef IP6OPT_RTALERT_LEN
-#define IP6OPT_RTALERT_LEN     4
-#endif
+       case IP6OPT_ROUTER_ALERT:

            if (len - i < IP6OPT_RTALERT_LEN) {
            if (len - i < IP6OPT_RTALERT_LEN) {

-               printf("(rtalert: trunc)");
+               ND_PRINT("(rtalert: trunc)");

                goto trunc;
            }
                goto trunc;
            }

-           if (bp[i + 1] != IP6OPT_RTALERT_LEN - 2) {
-               printf("(rtalert: invalid len %d)", bp[i + 1]);
+           if (GET_U_1(bp + i + 1) != IP6OPT_RTALERT_LEN - 2) {
+               ND_PRINT("(rtalert: invalid len %u)", GET_U_1(bp + i + 1));

                goto trunc;
            }
                goto trunc;
            }

-           printf("(rtalert: 0x%04x) ", ntohs(*(u_int16_t *)&bp[i + 2]));
-           optlen = IP6OPT_RTALERT_LEN;
+           if (ndo->ndo_vflag)
+               ND_PRINT("(rtalert: 0x%04x) ", GET_BE_U_2(bp + i + 2));

            break;
            break;

-#ifndef IP6OPT_JUMBO
-#define IP6OPT_JUMBO   0xC2
-#endif

        case IP6OPT_JUMBO:
        case IP6OPT_JUMBO:

-#ifndef IP6OPT_JUMBO_LEN
-#define IP6OPT_JUMBO_LEN       6
-#endif

            if (len - i < IP6OPT_JUMBO_LEN) {
            if (len - i < IP6OPT_JUMBO_LEN) {

-               printf("(jumbo: trunc)");
+               ND_PRINT("(jumbo: trunc)");

                goto trunc;
            }
                goto trunc;
            }

-           if (bp[i + 1] != IP6OPT_JUMBO_LEN - 2) {
-               printf("(jumbo: invalid len %d)", bp[i + 1]);
+           if (GET_U_1(bp + i + 1) != IP6OPT_JUMBO_LEN - 2) {
+               ND_PRINT("(jumbo: invalid len %u)", GET_U_1(bp + i + 1));

                goto trunc;
            }
                goto trunc;
            }

-           printf("(jumbo: %u) ", (u_int32_t)ntohl(*(u_int32_t *)&bp[i + 2]));
-           optlen = IP6OPT_JUMBO_LEN;
+           jumbolen = GET_BE_U_4(bp + i + 2);
+           if (found_jumbo) {
+               /* More than one Jumbo Payload option */
+               if (ndo->ndo_vflag)
+                   ND_PRINT("(jumbo: %u - already seen) ", jumbolen);
+           } else {
+               found_jumbo = 1;
+               if (payload_len == NULL) {
+                   /* Not a hop-by-hop option - not valid */
+                   if (ndo->ndo_vflag)
+                       ND_PRINT("(jumbo: %u - not a hop-by-hop option) ", jumbolen);
+               } else if (*payload_len != 0) {
+                   /* Payload length was non-zero - not valid */
+                   if (ndo->ndo_vflag)
+                       ND_PRINT("(jumbo: %u - payload len != 0) ", jumbolen);
+               } else {
+                   /*
+                    * This is a hop-by-hop option, and Payload length
+                    * was zero in the IPv6 header.
+                    */
+                   if (jumbolen < 65536) {
+                       /* Too short */
+                       if (ndo->ndo_vflag)
+                           ND_PRINT("(jumbo: %u - < 65536) ", jumbolen);
+                   } else {
+                       /* OK, this is valid */
+                       *found_jumbop = 1;
+                       *payload_len = jumbolen;
+                       if (ndo->ndo_vflag)
+                           ND_PRINT("(jumbo: %u) ", jumbolen);
+                   }
+               }
+           }
+           break;
+        case IP6OPT_HOME_ADDRESS:
+           if (len - i < IP6OPT_HOMEADDR_MINLEN) {
+               ND_PRINT("(homeaddr: trunc)");
+               goto trunc;
+           }
+           if (GET_U_1(bp + i + 1) < IP6OPT_HOMEADDR_MINLEN - 2) {
+               ND_PRINT("(homeaddr: invalid len %u)", GET_U_1(bp + i + 1));
+               goto trunc;
+           }
+           if (ndo->ndo_vflag) {
+               ND_PRINT("(homeaddr: %s", GET_IP6ADDR_STRING(bp + i + 2));
+               if (GET_U_1(bp + i + 1) > IP6OPT_HOMEADDR_MINLEN - 2) {
+                   if (ip6_sopt_print(ndo, bp + i + IP6OPT_HOMEADDR_MINLEN,
+                                      (optlen - IP6OPT_HOMEADDR_MINLEN)) == -1)
+                       goto trunc;
+               }
+               ND_PRINT(")");
+           }

            break;
        default:
            if (len - i < IP6OPT_MINLEN) {
            break;
        default:
            if (len - i < IP6OPT_MINLEN) {

-               printf("(type %d: trunc)", bp[i]);
+               ND_PRINT("(type %u: trunc)", GET_U_1(bp + i));

                goto trunc;
            }
                goto trunc;
            }

-           printf("(type 0x%02x: len=%d) ", bp[i], bp[i + 1]);
-           optlen = bp[i + 1] + 2;
+           if (ndo->ndo_vflag)
+               ND_PRINT("(opt_type 0x%02x: len=%u)", GET_U_1(bp + i),
+                        GET_U_1(bp + i + 1));

            break;
        }
     }
            break;
        }
     }

-
-#if 0
-end:
-#endif
-    return;
+    if (ndo->ndo_vflag)
+        ND_PRINT(" ");
+    return 0;

 
 trunc:
 
 trunc:

-    printf("[trunc] ");
+    return -1;

 }
 
 int
 }
 
 int

-hbhopt_print(register const u_char *bp)
+hbhopt_process(netdissect_options *ndo, const u_char *bp, int *found_jumbo,
+              uint32_t *jumbolen)

 {
 {

-    const struct ip6_hbh *dp = (struct ip6_hbh *)bp;
-    register const u_char *ep;
-    int hbhlen = 0;
-
-    /* 'ep' points to the end of avaible data. */
-    ep = snapend;
-    TCHECK(dp->ip6h_len);
-    hbhlen = (int)((dp->ip6h_len + 1) << 3);
-    TCHECK2(dp, hbhlen);
-    printf("HBH ");
-    if (vflag)
-       ip6_opt_print((const u_char *)dp + sizeof(*dp), hbhlen - sizeof(*dp));
-
-    return(hbhlen);
-
-  trunc:
-    fputs("[|HBH]", stdout);
-    return(hbhlen);
+    const struct ip6_hbh *dp = (const struct ip6_hbh *)bp;
+    u_int hbhlen = 0;
+
+    ndo->ndo_protocol = "hbhopt";
+    hbhlen = (GET_U_1(dp->ip6h_len) + 1) << 3;
+    ND_TCHECK_LEN(dp, hbhlen);
+    ND_PRINT("HBH ");
+    if (ip6_opt_process(ndo, (const u_char *)dp + sizeof(*dp),
+                       hbhlen - sizeof(*dp), found_jumbo, jumbolen) == -1)
+       goto trunc;
+    return hbhlen;
+
+trunc:
+    nd_print_trunc(ndo);
+    return -1;

 }
 
 int
 }
 
 int

-dstopt_print(register const u_char *bp)
+dstopt_process(netdissect_options *ndo, const u_char *bp)

 {
 {

-    const struct ip6_dest *dp = (struct ip6_dest *)bp;
-    register const u_char *ep;
-    int dstoptlen = 0;
-
-    /* 'ep' points to the end of avaible data. */
-    ep = snapend;
-    TCHECK(dp->ip6d_len);
-    dstoptlen = (int)((dp->ip6d_len + 1) << 3);
-    TCHECK2(dp, dstoptlen);
-    printf("DSTOPT ");
-    if (vflag) {
-       ip6_opt_print((const u_char *)dp + sizeof(*dp),
-           dstoptlen - sizeof(*dp));
+    const struct ip6_dest *dp = (const struct ip6_dest *)bp;
+    u_int dstoptlen = 0;
+
+    ndo->ndo_protocol = "dstopt";
+    dstoptlen = (GET_U_1(dp->ip6d_len) + 1) << 3;
+    ND_TCHECK_LEN(dp, dstoptlen);
+    ND_PRINT("DSTOPT ");
+    if (ndo->ndo_vflag) {
+       /*
+        * The Jumbo Payload option is a hop-by-hop option; we don't
+        * honor Jumbo Payload destination options, reporting them
+        * as invalid.
+        */
+       if (ip6_opt_process(ndo, (const u_char *)dp + sizeof(*dp),
+                           dstoptlen - sizeof(*dp), NULL, NULL) == -1)
+           goto trunc;

     }
 
     }
 

-    return(dstoptlen);
+    return dstoptlen;

 
 

-  trunc:
-    fputs("[|DSTOPT]", stdout);
-    return(dstoptlen);
+trunc:
+    nd_print_trunc(ndo);
+    return -1;

 }
 }

-#endif /* INET6 */