Use more the EXTRACT_U_1() macro (55/n)

[tcpdump] / print-ip.c

diff --git a/print-ip.c b/print-ip.c
index 04de692e2b63b5bc0cd60e65754cc3b9c98c3d99..b9d39cf511dde65db4230b6596419e9091e9fe46 100644 (file)
--- a/print-ip.c
+++ b/print-ip.c
@@ -19,82 +19,185 @@
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 

-#ifndef lint
-static const char rcsid[] =
-    "@(#) $Header: /tcpdump/master/tcpdump/print-ip.c,v 1.94 2001-02-20 18:55:47 fenner Exp $ (LBL)";
-#endif
+/* \summary: IP printer */

 
 #ifdef HAVE_CONFIG_H
 #include "config.h"
 #endif
 
 
 #ifdef HAVE_CONFIG_H
 #include "config.h"
 #endif
 

-#include <sys/param.h>
-#include <sys/time.h>
-#include <sys/socket.h>
-
-#include <netinet/in.h>
+#include <netdissect-stdinc.h>

 
 

-#include <stdio.h>
-#include <stdlib.h>

 #include <string.h>
 #include <string.h>

-#include <unistd.h>

 
 

+#include "netdissect.h"

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

-#include "interface.h"
-#include "extract.h"                   /* must come after interface.h */
+#include "extract.h"

 
 #include "ip.h"
 
 #include "ip.h"

-
-/* Compatibility */
-#ifndef        IPPROTO_ND
-#define        IPPROTO_ND      77
-#endif
+#include "ipproto.h"
+
+static const char tstr[] = "[|ip]";
+
+static const struct tok ip_option_values[] = {
+    { IPOPT_EOL, "EOL" },
+    { IPOPT_NOP, "NOP" },
+    { IPOPT_TS, "timestamp" },
+    { IPOPT_SECURITY, "security" },
+    { IPOPT_RR, "RR" },
+    { IPOPT_SSRR, "SSRR" },
+    { IPOPT_LSRR, "LSRR" },
+    { IPOPT_RA, "RA" },
+    { IPOPT_RFC1393, "traceroute" },
+    { 0, NULL }
+};

 
 /*
  * print the recorded route in an IP RR, LSRR or SSRR option.
  */
 
 /*
  * print the recorded route in an IP RR, LSRR or SSRR option.
  */

-static void
-ip_printroute(const char *type, register const u_char *cp, u_int length)
+static int
+ip_printroute(netdissect_options *ndo,
+              register const u_char *cp, u_int length)

 {
 {

-       register u_int ptr = cp[2] - 1;
+       register u_int ptr;

        register u_int len;
 
        register u_int len;
 

-       printf(" %s{", type);
+       if (length < 3) {
+               ND_PRINT((ndo, " [bad length %u]", length));
+               return (0);
+       }

        if ((length + 1) & 3)
        if ((length + 1) & 3)

-               printf(" [bad length %d]", length);
+               ND_PRINT((ndo, " [bad length %u]", length));
+       ND_TCHECK_1(cp + 2);
+       ptr = EXTRACT_U_1(cp + 2) - 1;

        if (ptr < 3 || ((ptr + 1) & 3) || ptr > length + 1)
        if (ptr < 3 || ((ptr + 1) & 3) || ptr > length + 1)

-               printf(" [bad ptr %d]", cp[2]);
+               ND_PRINT((ndo, " [bad ptr %u]", EXTRACT_U_1(cp + 2)));

 
 

-       type = "";

        for (len = 3; len < length; len += 4) {
        for (len = 3; len < length; len += 4) {

-               if (ptr == len)
-                       type = "#";
-               printf("%s%s", type, ipaddr_string(&cp[len]));
-               type = " ";
+               ND_TCHECK_4(cp + len);
+               ND_PRINT((ndo, " %s", ipaddr_string(ndo, cp + len)));
+               if (ptr > len)
+                       ND_PRINT((ndo, ","));

        }
        }

-       printf("%s}", ptr == len? "#" : "");
+       return (0);
+
+trunc:
+       return (-1);

 }
 
 }
 

-static void
-ip_printts(register const u_char *cp, u_int length)
+/*
+ * If source-routing is present and valid, return the final destination.
+ * Otherwise, return IP destination.
+ *
+ * This is used for UDP and TCP pseudo-header in the checksum
+ * calculation.
+ */
+static uint32_t
+ip_finddst(netdissect_options *ndo,
+           const struct ip *ip)

 {
 {

-       register u_int ptr = cp[2] - 1;
-       register u_int len = 0;
+       int length;
+       int len;
+       const u_char *cp;
+       uint32_t retval;
+
+       cp = (const u_char *)(ip + 1);
+       length = (IP_HL(ip) << 2) - sizeof(struct ip);
+
+       for (; length > 0; cp += len, length -= len) {
+               int tt;
+
+               ND_TCHECK_1(cp);
+               tt = EXTRACT_U_1(cp);
+               if (tt == IPOPT_EOL)
+                       break;
+               else if (tt == IPOPT_NOP)
+                       len = 1;
+               else {
+                       ND_TCHECK_1(cp + 1);
+                       len = EXTRACT_U_1(cp + 1);
+                       if (len < 2)
+                               break;
+               }
+               ND_TCHECK2(*cp, len);
+               switch (tt) {
+
+               case IPOPT_SSRR:
+               case IPOPT_LSRR:
+                       if (len < 7)
+                               break;
+                       UNALIGNED_MEMCPY(&retval, cp + len - 4, 4);
+                       return retval;
+               }
+       }
+trunc:
+       UNALIGNED_MEMCPY(&retval, &ip->ip_dst, sizeof(uint32_t));
+       return retval;
+}
+
+/*
+ * Compute a V4-style checksum by building a pseudoheader.
+ */
+int
+nextproto4_cksum(netdissect_options *ndo,
+                 const struct ip *ip, const uint8_t *data,
+                 u_int len, u_int covlen, u_int next_proto)
+{
+       struct phdr {
+               uint32_t src;
+               uint32_t dst;
+               u_char mbz;
+               u_char proto;
+               uint16_t len;
+       } ph;
+       struct cksum_vec vec[2];
+
+       /* pseudo-header.. */
+       ph.len = htons((uint16_t)len);
+       ph.mbz = 0;
+       ph.proto = next_proto;
+       UNALIGNED_MEMCPY(&ph.src, &ip->ip_src, sizeof(uint32_t));
+       if (IP_HL(ip) == 5)
+               UNALIGNED_MEMCPY(&ph.dst, &ip->ip_dst, sizeof(uint32_t));
+       else
+               ph.dst = ip_finddst(ndo, ip);
+
+       vec[0].ptr = (const uint8_t *)(void *)&ph;
+       vec[0].len = sizeof(ph);
+       vec[1].ptr = data;
+       vec[1].len = covlen;
+       return (in_cksum(vec, 2));
+}
+
+static int
+ip_printts(netdissect_options *ndo,
+           register const u_char *cp, u_int length)
+{
+       register u_int ptr;
+       register u_int len;

        int hoplen;
        int hoplen;

-       char *type;
+       const char *type;

 
 

-       printf(" TS{");
-       hoplen = ((cp[3]&0xF) != IPOPT_TS_TSONLY) ? 8 : 4;
+       if (length < 4) {
+               ND_PRINT((ndo, "[bad length %u]", length));
+               return (0);
+       }
+       ND_PRINT((ndo, " TS{"));
+       ND_TCHECK_1(cp + 3);
+       hoplen = ((EXTRACT_U_1(cp + 3) & 0xF) != IPOPT_TS_TSONLY) ? 8 : 4;

        if ((length - 4) & (hoplen-1))
        if ((length - 4) & (hoplen-1))

-               printf("[bad length %d]", length);
+               ND_PRINT((ndo, "[bad length %u]", length));
+       ND_TCHECK_1(cp + 2);
+       ptr = EXTRACT_U_1(cp + 2) - 1;
+       len = 0;

        if (ptr < 4 || ((ptr - 4) & (hoplen-1)) || ptr > length + 1)
        if (ptr < 4 || ((ptr - 4) & (hoplen-1)) || ptr > length + 1)

-               printf("[bad ptr %d]", cp[2]);
-       switch (cp[3]&0xF) {
+               ND_PRINT((ndo, "[bad ptr %u]", EXTRACT_U_1(cp + 2)));
+       ND_TCHECK_1(cp + 3);
+       switch (EXTRACT_U_1(cp + 3)&0xF) {

        case IPOPT_TS_TSONLY:
        case IPOPT_TS_TSONLY:

-               printf("TSONLY");
+               ND_PRINT((ndo, "TSONLY"));

                break;
        case IPOPT_TS_TSANDADDR:
                break;
        case IPOPT_TS_TSANDADDR:

-               printf("TS+ADDR");
+               ND_PRINT((ndo, "TS+ADDR"));

                break;
        /*
         * prespecified should really be 3, but some ones might send 2
                break;
        /*
         * prespecified should really be 3, but some ones might send 2


@@ -103,13 +206,13 @@ ip_printts(register const u_char *cp, u_int length)
         */
 
        case 2:
         */
 
        case 2:

-               printf("PRESPEC2.0");
+               ND_PRINT((ndo, "PRESPEC2.0"));

                break;
        case 3:                 /* IPOPT_TS_PRESPEC */
                break;
        case 3:                 /* IPOPT_TS_PRESPEC */

-               printf("PRESPEC");
+               ND_PRINT((ndo, "PRESPEC"));

                break;
                break;

-       default:        
-               printf("[bad ts type %d]", cp[3]&0xF);
+       default:
+               ND_PRINT((ndo, "[bad ts type %d]", EXTRACT_U_1(cp + 3)&0xF));

                goto done;
        }
 
                goto done;
        }
 


@@ -117,490 +220,517 @@ ip_printts(register const u_char *cp, u_int length)
        for (len = 4; len < length; len += hoplen) {
                if (ptr == len)
                        type = " ^ ";
        for (len = 4; len < length; len += hoplen) {
                if (ptr == len)
                        type = " ^ ";

-               printf("%s%d@%s", type, EXTRACT_32BITS(&cp[len+hoplen-4]),
-                      hoplen!=8 ? "" : ipaddr_string(&cp[len]));
+               ND_TCHECK2(cp[len], hoplen);
+               ND_PRINT((ndo, "%s%d@%s", type, EXTRACT_BE_U_4(cp + len + hoplen - 4),
+                         hoplen!=8 ? "" : ipaddr_string(ndo, cp + len)));

                type = " ";
        }
 
 done:
                type = " ";
        }
 
 done:

-       printf("%s", ptr == len ? " ^ " : "");
+       ND_PRINT((ndo, "%s", ptr == len ? " ^ " : ""));

 
 

-       if (cp[3]>>4)
-               printf(" [%d hops not recorded]} ", cp[3]>>4);
+       if (EXTRACT_U_1(cp + 3) >> 4)
+               ND_PRINT((ndo, " [%d hops not recorded]} ", EXTRACT_U_1(cp + 3)>>4));

        else
        else

-               printf("}");
+               ND_PRINT((ndo, "}"));
+       return (0);
+
+trunc:
+       return (-1);

 }
 
 /*
  * print IP options.
  */
 static void
 }
 
 /*
  * print IP options.
  */
 static void

-ip_optprint(register const u_char *cp, u_int length)
+ip_optprint(netdissect_options *ndo,
+            register const u_char *cp, u_int length)

 {
 {

-       register u_int len;
+       register u_int option_len;
+       const char *sep = "";

 
 

-       for (; length > 0; cp += len, length -= len) {
-               int tt = *cp;
+       for (; length > 0; cp += option_len, length -= option_len) {
+               u_int option_code;
+
+               ND_PRINT((ndo, "%s", sep));
+               sep = ",";
+
+               ND_TCHECK_1(cp);
+               option_code = EXTRACT_U_1(cp);
+
+               ND_PRINT((ndo, "%s",
+                         tok2str(ip_option_values,"unknown %u",option_code)));
+
+               if (option_code == IPOPT_NOP ||
+                    option_code == IPOPT_EOL)
+                       option_len = 1;

 
 

-               if (tt == IPOPT_NOP || tt == IPOPT_EOL)
-                       len = 1;

                else {
                else {

-                       if (&cp[1] >= snapend) {
-                               printf("[|ip]");
+                       ND_TCHECK_1(cp + 1);
+                       option_len = EXTRACT_U_1(cp + 1);
+                       if (option_len < 2) {
+                               ND_PRINT((ndo, " [bad length %u]", option_len));

                                return;
                        }
                                return;
                        }

-                       len = cp[1];
-               }
-               if (len <= 0) {
-                       printf("[|ip op len %d]", len);
-                       return;

                }
                }

-               if (&cp[1] >= snapend || cp + len > snapend) {
-                       printf("[|ip]");
+
+               if (option_len > length) {
+                       ND_PRINT((ndo, " [bad length %u]", option_len));

                        return;
                }
                        return;
                }

-               switch (tt) {

 
 

+               ND_TCHECK2(*cp, option_len);
+
+               switch (option_code) {

                case IPOPT_EOL:
                case IPOPT_EOL:

-                       printf(" EOL");
-                       if (length > 1)
-                               printf("-%d", length - 1);

                        return;
 
                        return;
 

-               case IPOPT_NOP:
-                       printf(" NOP");
-                       break;
-

                case IPOPT_TS:
                case IPOPT_TS:

-                       ip_printts(cp, len);
-                       break;
-
-#ifndef IPOPT_SECURITY
-#define IPOPT_SECURITY 130
-#endif /* IPOPT_SECURITY */
-               case IPOPT_SECURITY:
-                       printf(" SECURITY{%d}", len);
-                       break;
-
-               case IPOPT_RR:
-                       ip_printroute("RR", cp, len);
+                       if (ip_printts(ndo, cp, option_len) == -1)
+                               goto trunc;

                        break;
 
                        break;
 

+               case IPOPT_RR:       /* fall through */

                case IPOPT_SSRR:
                case IPOPT_SSRR:

-                       ip_printroute("SSRR", cp, len);
-                       break;
-

                case IPOPT_LSRR:
                case IPOPT_LSRR:

-                       ip_printroute("LSRR", cp, len);
+                       if (ip_printroute(ndo, cp, option_len) == -1)
+                               goto trunc;

                        break;
 
                        break;
 

-#ifndef IPOPT_RA
-#define IPOPT_RA 148           /* router alert */
-#endif

                case IPOPT_RA:
                case IPOPT_RA:

-                       printf(" RA");
-                       if (len != 4)
-                               printf("{%d}", len);
-                       else if (cp[2] || cp[3])
-                               printf("%d.%d", cp[2], cp[3]);
+                       if (option_len < 4) {
+                               ND_PRINT((ndo, " [bad length %u]", option_len));
+                               break;
+                       }
+                       ND_TCHECK_1(cp + 3);
+                       if (EXTRACT_BE_U_2(cp + 2) != 0)
+                               ND_PRINT((ndo, " value %u", EXTRACT_BE_U_2(cp + 2)));

                        break;
 
                        break;
 

+               case IPOPT_NOP:       /* nothing to print - fall through */
+               case IPOPT_SECURITY:

                default:
                default:

-                       printf(" IPOPT-%d{%d}", cp[0], len);

                        break;
                }
        }
                        break;
                }
        }

+       return;
+
+trunc:
+       ND_PRINT((ndo, "%s", tstr));

 }
 
 }
 

-/*
- * compute an IP header checksum.
- * don't modifiy the packet.
- */
-u_short
-in_cksum(const u_short *addr, register int len, u_short csum)
-{
-       int nleft = len;
-       const u_short *w = addr;
-       u_short answer;
-       int sum = csum;
-
-       /*
-        *  Our algorithm is simple, using a 32 bit accumulator (sum),
-        *  we add sequential 16 bit words to it, and at the end, fold
-        *  back all the carry bits from the top 16 bits into the lower
-        *  16 bits.
-        */
-       while (nleft > 1)  {
-               sum += *w++;
-               nleft -= 2;
-       }
-       if (nleft == 1)
-               sum += htons(*(u_char *)w<<8);
+#define IP_RES 0x8000

 
 

-       /*
-        * add back carry outs from top 16 bits to low 16 bits
-        */
-       sum = (sum >> 16) + (sum & 0xffff);     /* add hi 16 to low 16 */
-       sum += (sum >> 16);                     /* add carry */
-       answer = ~sum;                          /* truncate to 16 bits */
-       return (answer);
-}
+static const struct tok ip_frag_values[] = {
+        { IP_MF,        "+" },
+        { IP_DF,        "DF" },
+       { IP_RES,       "rsvd" }, /* The RFC3514 evil ;-) bit */
+        { 0,            NULL }
+};

 
 

-/*
- * print an IP datagram.
- */
-void
-ip_print(register const u_char *bp, register u_int length)
+struct ip_print_demux_state {
+       const struct ip *ip;
+       const u_char *cp;
+       u_int   len, off;
+       u_char  nh;
+       int     advance;
+};
+
+static void
+ip_print_demux(netdissect_options *ndo,
+              struct ip_print_demux_state *ipds)

 {
 {

-       register const struct ip *ip;
-       register u_int hlen, len, len0, off;
-       register const u_char *cp;
-       u_char nh;
-       int advance;
-
-       ip = (const struct ip *)bp;
-#ifdef LBL_ALIGN
-       /*
-        * If the IP header is not aligned, copy into abuf.
-        * This will never happen with BPF.  It does happen raw packet
-        * dumps from -r.
-        */
-       if ((long)ip & 3) {
-               static u_char *abuf = NULL;
-               static int didwarn = 0;
-
-               if (abuf == NULL) {
-                       abuf = (u_char *)malloc(snaplen);
-                       if (abuf == NULL)
-                               error("ip_print: malloc");
-               }
-               memcpy((char *)abuf, (char *)ip, min(length, snaplen));
-               snapend += abuf - (u_char *)ip;
-               packetp = abuf;
-               ip = (struct ip *)abuf;
-               /* We really want libpcap to give us aligned packets */
-               if (!didwarn) {
-                       warning("compensating for unaligned libpcap packets");
-                       ++didwarn;
+       const char *p_name;
+
+again:
+       switch (ipds->nh) {
+
+       case IPPROTO_AH:
+               if (!ND_TTEST(*ipds->cp)) {
+                       ND_PRINT((ndo, "[|AH]"));
+                       break;

                }
                }

+               ipds->nh = EXTRACT_U_1(ipds->cp);
+               ipds->advance = ah_print(ndo, ipds->cp);
+               if (ipds->advance <= 0)
+                       break;
+               ipds->cp += ipds->advance;
+               ipds->len -= ipds->advance;
+               goto again;
+
+       case IPPROTO_ESP:
+       {
+               u_int enh, padlen;
+               ipds->advance = esp_print(ndo, ipds->cp, ipds->len,
+                                   (const u_char *)ipds->ip,
+                                   &enh, &padlen);
+               if (ipds->advance <= 0)
+                       break;
+               ipds->cp += ipds->advance;
+               ipds->len -= ipds->advance + padlen;
+               ipds->nh = enh & 0xff;
+               goto again;

        }
        }

-#endif
-       if ((u_char *)(ip + 1) > snapend) {
-               printf("[|ip]");
-               return;
-       }
-       if (length < sizeof (struct ip)) {
-               (void)printf("truncated-ip %d", length);
-               return;
-       }
-       hlen = IP_HL(ip) * 4;
-       if (hlen < sizeof (struct ip)) {
-               (void)printf("bad-hlen %d", hlen);
-               return;
+
+       case IPPROTO_IPCOMP:
+       {
+               ipcomp_print(ndo, ipds->cp);
+               /*
+                * Either this has decompressed the payload and
+                * printed it, in which case there's nothing more
+                * to do, or it hasn't, in which case there's
+                * nothing more to do.
+                */
+               break;

        }
 
        }
 

-       len = ntohs(ip->ip_len);
-       if (length < len)
-               (void)printf("truncated-ip - %d bytes missing! ",
-                       len - length);
-       len -= hlen;
-       len0 = len;
+       case IPPROTO_SCTP:
+               sctp_print(ndo, ipds->cp, (const u_char *)ipds->ip, ipds->len);
+               break;

 
 

-       /*
-        * If this is fragment zero, hand it to the next higher
-        * level protocol.
-        */
-       off = ntohs(ip->ip_off);
-       if ((off & 0x1fff) == 0) {
-               cp = (const u_char *)ip + hlen;
-               nh = ip->ip_p;
-
-               if (nh != IPPROTO_TCP && nh != IPPROTO_UDP) {
-                       (void)printf("%s > %s: ", ipaddr_string(&ip->ip_src),
-                               ipaddr_string(&ip->ip_dst));
-               }
-again:
-               switch (nh) {
+       case IPPROTO_DCCP:
+               dccp_print(ndo, ipds->cp, (const u_char *)ipds->ip, ipds->len);
+               break;

 
 

-#ifndef IPPROTO_AH
-#define IPPROTO_AH     51
-#endif
-               case IPPROTO_AH:
-                       nh = *cp;
-                       advance = ah_print(cp, (const u_char *)ip);
-                       cp += advance;
-                       len -= advance;
-                       goto again;
-
-#ifndef IPPROTO_ESP
-#define IPPROTO_ESP    50
-#endif
-               case IPPROTO_ESP:
-                   {
-                       int enh;
-                       advance = esp_print(cp, (const u_char *)ip, &enh);
-                       cp += advance;
-                       len -= advance;
-                       if (enh < 0)
-                               break;
-                       nh = enh & 0xff;
-                       goto again;
-                   }
+       case IPPROTO_TCP:
+               /* pass on the MF bit plus the offset to detect fragments */
+               tcp_print(ndo, ipds->cp, ipds->len, (const u_char *)ipds->ip,
+                         ipds->off & (IP_MF|IP_OFFMASK));
+               break;

 
 

-#ifndef IPPROTO_IPCOMP
-#define IPPROTO_IPCOMP 108
-#endif
-               case IPPROTO_IPCOMP:
-                   {
-                       int enh;
-                       advance = ipcomp_print(cp, (const u_char *)ip, &enh);
-                       cp += advance;
-                       len -= advance;
-                       if (enh < 0)
-                               break;
-                       nh = enh & 0xff;
-                       goto again;
-                   }
+       case IPPROTO_UDP:
+               /* pass on the MF bit plus the offset to detect fragments */
+               udp_print(ndo, ipds->cp, ipds->len, (const u_char *)ipds->ip,
+                         ipds->off & (IP_MF|IP_OFFMASK));
+               break;

 
 

-               case IPPROTO_TCP:
-                       tcp_print(cp, len, (const u_char *)ip, (off &~ 0x6000));
-                       break;
+       case IPPROTO_ICMP:
+               /* pass on the MF bit plus the offset to detect fragments */
+               icmp_print(ndo, ipds->cp, ipds->len, (const u_char *)ipds->ip,
+                          ipds->off & (IP_MF|IP_OFFMASK));
+               break;

 
 

-               case IPPROTO_UDP:
-                       udp_print(cp, len, (const u_char *)ip, (off &~ 0x6000));
-                       break;
+       case IPPROTO_PIGP:
+               /*
+                * XXX - the current IANA protocol number assignments
+                * page lists 9 as "any private interior gateway
+                * (used by Cisco for their IGRP)" and 88 as
+                * "EIGRP" from Cisco.
+                *
+                * Recent BSD <netinet/in.h> headers define
+                * IP_PROTO_PIGP as 9 and IP_PROTO_IGRP as 88.
+                * We define IP_PROTO_PIGP as 9 and
+                * IP_PROTO_EIGRP as 88; those names better
+                * match was the current protocol number
+                * assignments say.
+                */
+               igrp_print(ndo, ipds->cp, ipds->len);
+               break;

 
 

-               case IPPROTO_ICMP:
-                       icmp_print(cp, len, (const u_char *)ip);
-                       break;
+       case IPPROTO_EIGRP:
+               eigrp_print(ndo, ipds->cp, ipds->len);
+               break;

 
 

-#ifndef IPPROTO_IGRP
-#define IPPROTO_IGRP 9
-#endif
-               case IPPROTO_IGRP:
-                       igrp_print(cp, len, (const u_char *)ip);
-                       break;
+       case IPPROTO_ND:
+               ND_PRINT((ndo, " nd %d", ipds->len));
+               break;

 
 

-               case IPPROTO_ND:
-#if 0
-                       (void)printf("%s > %s:", ipaddr_string(&ip->ip_src),
-                               ipaddr_string(&ip->ip_dst));
-#endif
-                       (void)printf(" nd %d", len);
-                       break;
+       case IPPROTO_EGP:
+               egp_print(ndo, ipds->cp, ipds->len);
+               break;

 
 

-               case IPPROTO_EGP:
-                       egp_print(cp, len, (const u_char *)ip);
-                       break;
+       case IPPROTO_OSPF:
+               ospf_print(ndo, ipds->cp, ipds->len, (const u_char *)ipds->ip);
+               break;

 
 

-#ifndef IPPROTO_OSPF
-#define IPPROTO_OSPF 89
-#endif
-               case IPPROTO_OSPF:
-                       ospf_print(cp, len, (const u_char *)ip);
-                       break;
+       case IPPROTO_IGMP:
+               igmp_print(ndo, ipds->cp, ipds->len);
+               break;

 
 

-#ifndef IPPROTO_IGMP
-#define IPPROTO_IGMP 2
-#endif
-               case IPPROTO_IGMP:
-                       igmp_print(cp, len, (const u_char *)ip);
-                       break;
+       case IPPROTO_IPV4:
+               /* DVMRP multicast tunnel (ip-in-ip encapsulation) */
+               ip_print(ndo, ipds->cp, ipds->len);
+               if (! ndo->ndo_vflag) {
+                       ND_PRINT((ndo, " (ipip-proto-4)"));
+                       return;
+               }
+               break;

 
 

-               case 4:
-                       /* DVMRP multicast tunnel (ip-in-ip encapsulation) */
-#if 0
-                       if (vflag)
-                               (void)printf("%s > %s: ",
-                                            ipaddr_string(&ip->ip_src),
-                                            ipaddr_string(&ip->ip_dst));
-#endif
-                       ip_print(cp, len);
-                       if (! vflag) {
-                               printf(" (ipip)");
-                               return;
-                       }
-                       break;
+       case IPPROTO_IPV6:
+               /* ip6-in-ip encapsulation */
+               ip6_print(ndo, ipds->cp, ipds->len);
+               break;

 
 

-#ifdef INET6
-#ifndef IP6PROTO_ENCAP
-#define IP6PROTO_ENCAP 41
-#endif
-               case IP6PROTO_ENCAP:
-                       /* ip6-in-ip encapsulation */
-#if 0
-                       if (vflag)
-                               (void)printf("%s > %s: ",
-                                            ipaddr_string(&ip->ip_src),
-                                            ipaddr_string(&ip->ip_dst));
-#endif
-                       ip6_print(cp, len);
-                       if (! vflag) {
-                               printf(" (encap)");
-                               return;
-                       }
-                       break;
-#endif /*INET6*/
+       case IPPROTO_RSVP:
+               rsvp_print(ndo, ipds->cp, ipds->len);
+               break;

 
 

+       case IPPROTO_GRE:
+               /* do it */
+               gre_print(ndo, ipds->cp, ipds->len);
+               break;

 
 

-#ifndef IPPROTO_GRE
-#define IPPROTO_GRE 47
-#endif
-               case IPPROTO_GRE:
-                       if (vflag)
-                               (void)printf("gre %s > %s: ",
-                                            ipaddr_string(&ip->ip_src),
-                                            ipaddr_string(&ip->ip_dst));
-                       /* do it */
-                       gre_print(cp, len);
-                       if (! vflag) {
-                               printf(" (gre encap)");
-                               return;
-                       }
-                       break;
+       case IPPROTO_MOBILE:
+               mobile_print(ndo, ipds->cp, ipds->len);
+               break;

 
 

-#ifndef IPPROTO_MOBILE
-#define IPPROTO_MOBILE 55
-#endif
-               case IPPROTO_MOBILE:
-                       if (vflag)
-                               (void)printf("mobile %s > %s: ",
-                                            ipaddr_string(&ip->ip_src),
-                                            ipaddr_string(&ip->ip_dst));
-                       mobile_print(cp, len);
-                       if (! vflag) {
-                               printf(" (mobile encap)");
-                               return;
-                       }
-                       break;
+       case IPPROTO_PIM:
+               pim_print(ndo, ipds->cp, ipds->len, (const u_char *)ipds->ip);
+               break;

 
 

-#ifndef IPPROTO_PIM
-#define IPPROTO_PIM    103
-#endif
-               case IPPROTO_PIM:
-                       pim_print(cp, len);
-                       break;
+       case IPPROTO_VRRP:
+               if (ndo->ndo_packettype == PT_CARP) {
+                       if (ndo->ndo_vflag)
+                               ND_PRINT((ndo, "carp %s > %s: ",
+                                            ipaddr_string(ndo, &ipds->ip->ip_src),
+                                            ipaddr_string(ndo, &ipds->ip->ip_dst)));
+                       carp_print(ndo, ipds->cp, ipds->len, ipds->ip->ip_ttl);
+               } else {
+                       if (ndo->ndo_vflag)
+                               ND_PRINT((ndo, "vrrp %s > %s: ",
+                                            ipaddr_string(ndo, &ipds->ip->ip_src),
+                                            ipaddr_string(ndo, &ipds->ip->ip_dst)));
+                       vrrp_print(ndo, ipds->cp, ipds->len,
+                               (const u_char *)ipds->ip, ipds->ip->ip_ttl);
+               }
+               break;

 
 

-#ifndef IPPROTO_VRRP
-#define IPPROTO_VRRP   112
-#endif
-               case IPPROTO_VRRP:
-                       if (vflag)
-                               (void)printf("vrrp %s > %s: ",
-                                            ipaddr_string(&ip->ip_src),
-                                            ipaddr_string(&ip->ip_dst));
-                       vrrp_print(cp, len, ip->ip_ttl);
-                       break;
+       case IPPROTO_PGM:
+               pgm_print(ndo, ipds->cp, ipds->len, (const u_char *)ipds->ip);
+               break;

 
 

-               default:
-#if 0
-                       (void)printf("%s > %s:", ipaddr_string(&ip->ip_src),
-                               ipaddr_string(&ip->ip_dst));
-#endif
-                       (void)printf(" ip-proto-%d %d", nh, len);
-                       break;
-               }
+       default:
+               if (ndo->ndo_nflag==0 && (p_name = netdb_protoname(ipds->nh)) != NULL)
+                       ND_PRINT((ndo, " %s", p_name));
+               else
+                       ND_PRINT((ndo, " ip-proto-%d", ipds->nh));
+               ND_PRINT((ndo, " %d", ipds->len));
+               break;

        }
        }

+}

 
 

-       /* Ultra quiet now means that all this stuff should be suppressed */
-       /* res 3-Nov-98 */
-       if (qflag > 1) return;
+void
+ip_print_inner(netdissect_options *ndo,
+              const u_char *bp,
+              u_int length, u_int nh,
+              const u_char *bp2)
+{
+       struct ip_print_demux_state  ipd;

 
 

+       ipd.ip = (const struct ip *)bp2;
+       ipd.cp = bp;
+       ipd.len  = length;
+       ipd.off  = 0;
+       ipd.nh   = nh;
+       ipd.advance = 0;

 
 

-       /*
-        * for fragmented datagrams, print id:size@offset.  On all
-        * but the last stick a "+".  For unfragmented datagrams, note
-        * the don't fragment flag.
-        */
-       len = len0;     /* get the original length */
-       if (off & 0x3fff) {
-               /*
-                * if this isn't the first frag, we're missing the
-                * next level protocol header.  print the ip addr.
-                */
-               if (off & 0x1fff)
-                       (void)printf("%s > %s:", ipaddr_string(&ip->ip_src),
-                                     ipaddr_string(&ip->ip_dst));
-#ifndef IP_MF
-#define IP_MF 0x2000
-#endif /* IP_MF */
-#ifndef IP_DF
-#define IP_DF 0x4000
-#endif /* IP_DF */
-               (void)printf(" (frag %d:%u@%d%s)", ntohs(ip->ip_id), len,
-                       (off & 0x1fff) * 8,
-                       (off & IP_MF)? "+" : "");
-
-       } else if (off & IP_DF)
-               (void)printf(" (DF)");
-
-       if (ip->ip_tos) {
-               (void)printf(" [tos 0x%x", (int)ip->ip_tos);
-               /* ECN bits */
-               if (ip->ip_tos&0x02) {
-                       (void)printf(",ECT");
-                       if (ip->ip_tos&0x01)
-                               (void)printf(",CE");
-               }
-               (void)printf("] ");
+       ip_print_demux(ndo, &ipd);
+}
+
+
+/*
+ * print an IP datagram.
+ */
+void
+ip_print(netdissect_options *ndo,
+        const u_char *bp,
+        u_int length)
+{
+       struct ip_print_demux_state  ipd;
+       struct ip_print_demux_state *ipds=&ipd;
+       const u_char *ipend;
+       u_int hlen;
+       struct cksum_vec vec[1];
+       uint16_t sum, ip_sum;
+       const char *p_name;
+
+       ipds->ip = (const struct ip *)bp;
+       ND_TCHECK(ipds->ip->ip_vhl);
+       if (IP_V(ipds->ip) != 4) { /* print version and fail if != 4 */
+           if (IP_V(ipds->ip) == 6)
+             ND_PRINT((ndo, "IP6, wrong link-layer encapsulation "));
+           else
+             ND_PRINT((ndo, "IP%u ", IP_V(ipds->ip)));
+           return;

        }
        }

+       if (!ndo->ndo_eflag)
+               ND_PRINT((ndo, "IP "));

 
 

-       if (ip->ip_ttl <= 1)
-               (void)printf(" [ttl %d]", (int)ip->ip_ttl);
+       ND_TCHECK(*ipds->ip);
+       if (length < sizeof (struct ip)) {
+               ND_PRINT((ndo, "truncated-ip %u", length));
+               return;
+       }
+       hlen = IP_HL(ipds->ip) * 4;
+       if (hlen < sizeof (struct ip)) {
+               ND_PRINT((ndo, "bad-hlen %u", hlen));
+               return;
+       }

 
 

-       if (vflag) {
-               int sum;
-               char *sep = "";
+       ipds->len = EXTRACT_BE_U_2(&ipds->ip->ip_len);
+       if (length < ipds->len)
+               ND_PRINT((ndo, "truncated-ip - %u bytes missing! ",
+                       ipds->len - length));
+       if (ipds->len < hlen) {
+#ifdef GUESS_TSO
+            if (ipds->len) {
+                ND_PRINT((ndo, "bad-len %u", ipds->len));
+                return;
+            }
+            else {
+                /* we guess that it is a TSO send */
+                ipds->len = length;
+            }
+#else
+            ND_PRINT((ndo, "bad-len %u", ipds->len));
+            return;
+#endif /* GUESS_TSO */
+       }

 
 

-               printf(" (");
-               if (ip->ip_ttl > 1) {
-                       (void)printf("%sttl %d", sep, (int)ip->ip_ttl);
-                       sep = ", ";
-               }
-               if ((off & 0x3fff) == 0) {
-                       (void)printf("%sid %d", sep, (int)ntohs(ip->ip_id));
-                       sep = ", ";
-               }
-               (void)printf("%slen %d", sep, (int)ntohs(ip->ip_len));
-               sep = ", ";
-               if ((u_char *)ip + hlen <= snapend) {
-                       sum = in_cksum((const u_short *)ip, hlen, 0);
-                       if (sum != 0) {
-                               (void)printf("%sbad cksum %x!", sep,
-                                            ntohs(ip->ip_sum));
-                               sep = ", ";
-                       }
+       /*
+        * Cut off the snapshot length to the end of the IP payload.
+        */
+       ipend = bp + ipds->len;
+       if (ipend < ndo->ndo_snapend)
+               ndo->ndo_snapend = ipend;
+
+       ipds->len -= hlen;
+
+       ipds->off = EXTRACT_BE_U_2(&ipds->ip->ip_off);
+
+        if (ndo->ndo_vflag) {
+            ND_PRINT((ndo, "(tos 0x%x", ipds->ip->ip_tos));
+            /* ECN bits */
+            switch (ipds->ip->ip_tos & 0x03) {
+
+            case 0:
+                break;
+
+            case 1:
+                ND_PRINT((ndo, ",ECT(1)"));
+                break;
+
+            case 2:
+                ND_PRINT((ndo, ",ECT(0)"));
+                break;
+
+            case 3:
+                ND_PRINT((ndo, ",CE"));
+                break;
+            }
+
+            if (ipds->ip->ip_ttl >= 1)
+                ND_PRINT((ndo, ", ttl %u", ipds->ip->ip_ttl));
+
+           /*
+            * for the firewall guys, print id, offset.
+             * On all but the last stick a "+" in the flags portion.
+            * For unfragmented datagrams, note the don't fragment flag.
+            */
+
+           ND_PRINT((ndo, ", id %u, offset %u, flags [%s], proto %s (%u)",
+                         EXTRACT_BE_U_2(&ipds->ip->ip_id),
+                         (ipds->off & 0x1fff) * 8,
+                         bittok2str(ip_frag_values, "none", ipds->off&0xe000),
+                         tok2str(ipproto_values,"unknown",ipds->ip->ip_p),
+                         ipds->ip->ip_p));
+
+            ND_PRINT((ndo, ", length %u", EXTRACT_BE_U_2(&ipds->ip->ip_len)));
+
+            if ((hlen - sizeof(struct ip)) > 0) {
+                ND_PRINT((ndo, ", options ("));
+                ip_optprint(ndo, (const u_char *)(ipds->ip + 1), hlen - sizeof(struct ip));
+                ND_PRINT((ndo, ")"));
+            }
+
+           if (!ndo->ndo_Kflag && (const u_char *)ipds->ip + hlen <= ndo->ndo_snapend) {
+               vec[0].ptr = (const uint8_t *)(const void *)ipds->ip;
+               vec[0].len = hlen;
+               sum = in_cksum(vec, 1);
+               if (sum != 0) {
+                   ip_sum = EXTRACT_BE_U_2(&ipds->ip->ip_sum);
+                   ND_PRINT((ndo, ", bad cksum %x (->%x)!", ip_sum,
+                            in_cksum_shouldbe(ip_sum, sum)));

                }
                }

-               if ((hlen -= sizeof(struct ip)) > 0) {
-                       (void)printf("%soptlen=%d", sep, hlen);
-                       ip_optprint((u_char *)(ip + 1), hlen);
+           }
+
+               ND_PRINT((ndo, ")\n    "));
+       }
+
+       /*
+        * If this is fragment zero, hand it to the next higher
+        * level protocol.
+        */
+       if ((ipds->off & 0x1fff) == 0) {
+               ipds->cp = (const u_char *)ipds->ip + hlen;
+               ipds->nh = ipds->ip->ip_p;
+
+               if (ipds->nh != IPPROTO_TCP && ipds->nh != IPPROTO_UDP &&
+                   ipds->nh != IPPROTO_SCTP && ipds->nh != IPPROTO_DCCP) {
+                       ND_PRINT((ndo, "%s > %s: ",
+                                    ipaddr_string(ndo, &ipds->ip->ip_src),
+                                    ipaddr_string(ndo, &ipds->ip->ip_dst)));

                }
                }

-               printf(")");
+               ip_print_demux(ndo, ipds);
+       } else {
+               /*
+                * Ultra quiet now means that all this stuff should be
+                * suppressed.
+                */
+               if (ndo->ndo_qflag > 1)
+                       return;
+
+               /*
+                * This isn't the first frag, so we're missing the
+                * next level protocol header.  print the ip addr
+                * and the protocol.
+                */
+               ND_PRINT((ndo, "%s > %s:", ipaddr_string(ndo, &ipds->ip->ip_src),
+                         ipaddr_string(ndo, &ipds->ip->ip_dst)));
+               if (!ndo->ndo_nflag && (p_name = netdb_protoname(ipds->ip->ip_p)) != NULL)
+                       ND_PRINT((ndo, " %s", p_name));
+               else
+                       ND_PRINT((ndo, " ip-proto-%d", ipds->ip->ip_p));

        }
        }

+       return;
+
+trunc:
+       ND_PRINT((ndo, "%s", tstr));
+       return;

 }
 
 void
 }
 
 void

-ipN_print(register const u_char *bp, register u_int length)
+ipN_print(netdissect_options *ndo, register const u_char *bp, register u_int length)

 {
 {

-       struct ip *ip, hdr;
-
-       ip = (struct ip *)bp;
-       if (length < 4) {
-               (void)printf("truncated-ip %d", length);
+       if (length < 1) {
+               ND_PRINT((ndo, "truncated-ip %d", length));

                return;
        }
                return;
        }

-       memcpy (&hdr, (char *)ip, 4);
-       switch (IP_V(&hdr)) {
-       case 4:
-               ip_print (bp, length);
-               return;
-#ifdef INET6
-       case 6:
-               ip6_print (bp, length);
-               return;
-#endif
+
+       ND_TCHECK_1(bp);
+       switch (EXTRACT_U_1(bp) & 0xF0) {
+       case 0x40:
+               ip_print (ndo, bp, length);
+               break;
+       case 0x60:
+               ip6_print (ndo, bp, length);
+               break;

        default:
        default:

-               (void)printf("unknown ip %d", IP_V(&hdr));
-               return;
+               ND_PRINT((ndo, "unknown ip %d", (EXTRACT_U_1(bp) & 0xF0) >> 4));
+               break;

        }
        }

+       return;
+
+trunc:
+       ND_PRINT((ndo, "%s", tstr));
+       return;

 }
 }

+
+/*
+ * Local Variables:
+ * c-style: whitesmith
+ * c-basic-offset: 8
+ * End:
+ */
+
+