Add printing support for vsockmon devices.

[tcpdump] / print-sl.c

diff --git a/print-sl.c b/print-sl.c
index cdf9945594446ad560c4a9588d4dc37b56e00ed9..14f9bc1b607736bbaa6647d494cf16f6ac138771 100644 (file)
--- a/print-sl.c
+++ b/print-sl.c
@@ -19,14 +19,16 @@
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 

+/* \summary: Compressed Serial Line Internet Protocol printer */
+

 #ifdef HAVE_CONFIG_H
 #ifdef HAVE_CONFIG_H

-#include "config.h"
+#include <config.h>

 #endif
 
 #endif
 

-#include <tcpdump-stdinc.h>
+#include "netdissect-stdinc.h"

 
 

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

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


@@ -45,43 +47,52 @@
 #define SLIPDIR_IN 0
 #define SLIPDIR_OUT 1
 
 #define SLIPDIR_IN 0
 #define SLIPDIR_OUT 1
 

-static const char tstr[] = "[|slip]";

 
 static u_int lastlen[2][256];
 static u_int lastconn = 255;
 
 
 static u_int lastlen[2][256];
 static u_int lastconn = 255;
 

-static void sliplink_print(netdissect_options *, const u_char *, const struct ip *, u_int);
-static void compressed_sl_print(netdissect_options *, const u_char *, const struct ip *, u_int, int);
+static int sliplink_print(netdissect_options *, const u_char *, const struct ip *, u_int);
+static int compressed_sl_print(netdissect_options *, const u_char *, const struct ip *, u_int, int);

 
 u_int
 sl_if_print(netdissect_options *ndo,
             const struct pcap_pkthdr *h, const u_char *p)
 {
 
 u_int
 sl_if_print(netdissect_options *ndo,
             const struct pcap_pkthdr *h, const u_char *p)
 {

-       register u_int caplen = h->caplen;
-       register u_int length = h->len;
-       register const struct ip *ip;
+       u_int caplen = h->caplen;
+       u_int length = h->len;
+       const struct ip *ip;

 
 

-       if (caplen < SLIP_HDRLEN || length < SLIP_HDRLEN) {
-               ND_PRINT((ndo, "%s", tstr));
+       ndo->ndo_protocol = "sl_if";
+       if (caplen < SLIP_HDRLEN) {
+               nd_print_trunc(ndo);

                return (caplen);
        }
 
                return (caplen);
        }
 

+       caplen -= SLIP_HDRLEN;

        length -= SLIP_HDRLEN;
 
        length -= SLIP_HDRLEN;
 

-       ip = (struct ip *)(p + SLIP_HDRLEN);
+       ip = (const struct ip *)(p + SLIP_HDRLEN);

 
        if (ndo->ndo_eflag)
 
        if (ndo->ndo_eflag)

-               sliplink_print(ndo, p, ip, length);
+               if (sliplink_print(ndo, p, ip, length) == -1) {
+                       nd_print_trunc(ndo);
+                       return (caplen + SLIP_HDRLEN);
+               }
+
+       if (caplen < 1) {
+               nd_print_trunc(ndo);
+               return (caplen + SLIP_HDRLEN);
+       }

 
        switch (IP_V(ip)) {
        case 4:
 
        switch (IP_V(ip)) {
        case 4:

-               ip_print(ndo, (u_char *)ip, length);
+               ip_print(ndo, (const u_char *)ip, length);

                break;
        case 6:
                break;
        case 6:

-               ip6_print(ndo, (u_char *)ip, length);
+               ip6_print(ndo, (const u_char *)ip, length);

                break;
        default:
                break;
        default:

-               ND_PRINT((ndo, "ip v%d", IP_V(ip)));
+               ND_PRINT("ip v%u", IP_V(ip));

        }
 
        return (SLIP_HDRLEN);
        }
 
        return (SLIP_HDRLEN);


@@ -91,53 +102,58 @@ u_int
 sl_bsdos_if_print(netdissect_options *ndo,
                   const struct pcap_pkthdr *h, const u_char *p)
 {
 sl_bsdos_if_print(netdissect_options *ndo,
                   const struct pcap_pkthdr *h, const u_char *p)
 {

-       register u_int caplen = h->caplen;
-       register u_int length = h->len;
-       register const struct ip *ip;
+       u_int caplen = h->caplen;
+       u_int length = h->len;
+       const struct ip *ip;

 
 

+       ndo->ndo_protocol = "sl_bsdos_if";

        if (caplen < SLIP_HDRLEN) {
        if (caplen < SLIP_HDRLEN) {

-               ND_PRINT((ndo, "%s", tstr));
+               nd_print_trunc(ndo);

                return (caplen);
        }
 
        length -= SLIP_HDRLEN;
 
                return (caplen);
        }
 
        length -= SLIP_HDRLEN;
 

-       ip = (struct ip *)(p + SLIP_HDRLEN);
+       ip = (const struct ip *)(p + SLIP_HDRLEN);

 
 #ifdef notdef
        if (ndo->ndo_eflag)
                sliplink_print(ndo, p, ip, length);
 #endif
 
 
 #ifdef notdef
        if (ndo->ndo_eflag)
                sliplink_print(ndo, p, ip, length);
 #endif
 

-       ip_print(ndo, (u_char *)ip, length);
+       ip_print(ndo, (const u_char *)ip, length);

 
        return (SLIP_HDRLEN);
 }
 
 
        return (SLIP_HDRLEN);
 }
 

-static void
+static int

 sliplink_print(netdissect_options *ndo,
 sliplink_print(netdissect_options *ndo,

-               register const u_char *p, register const struct ip *ip,
-               register u_int length)
+               const u_char *p, const struct ip *ip,
+               u_int length)

 {
        int dir;
        u_int hlen;
 
 {
        int dir;
        u_int hlen;
 

-       dir = p[SLX_DIR];
-       ND_PRINT((ndo, dir == SLIPDIR_IN ? "I " : "O "));
+       dir = GET_U_1(p + SLX_DIR);
+       switch (dir) {

 
 

-       if (ndo->ndo_nflag) {
-               /* XXX just dump the header */
-               register int i;
+       case SLIPDIR_IN:
+               ND_PRINT("I ");
+               break;

 
 

-               for (i = SLX_CHDR; i < SLX_CHDR + CHDR_LEN - 1; ++i)
-                       ND_PRINT((ndo, "%02x.", p[i]));
-               ND_PRINT((ndo, "%02x: ", p[SLX_CHDR + CHDR_LEN - 1]));
-               return;
+       case SLIPDIR_OUT:
+               ND_PRINT("O ");
+               break;
+
+       default:
+               ND_PRINT("Invalid direction %d ", dir);
+               dir = -1;
+               break;

        }
        }

-       switch (p[SLX_CHDR] & 0xf0) {
+       switch (GET_U_1(p + SLX_CHDR) & 0xf0) {

 
        case TYPE_IP:
 
        case TYPE_IP:

-               ND_PRINT((ndo, "ip %d: ", length + SLIP_HDRLEN));
+               ND_PRINT("ip %u: ", length + SLIP_HDRLEN);

                break;
 
        case TYPE_UNCOMPRESSED_TCP:
                break;
 
        case TYPE_UNCOMPRESSED_TCP:


@@ -146,79 +162,97 @@ sliplink_print(netdissect_options *ndo,
                 * Get it from the link layer since sl_uncompress_tcp()
                 * has restored the IP header copy to IPPROTO_TCP.
                 */
                 * Get it from the link layer since sl_uncompress_tcp()
                 * has restored the IP header copy to IPPROTO_TCP.
                 */

-               lastconn = ((struct ip *)&p[SLX_CHDR])->ip_p;
+               lastconn = GET_U_1(((const struct ip *)(p + SLX_CHDR))->ip_p);
+               ND_PRINT("utcp %u: ", lastconn);
+               if (dir == -1) {
+                       /* Direction is bogus, don't use it */
+                       return 0;
+               }
+               ND_TCHECK_SIZE(ip);

                hlen = IP_HL(ip);
                hlen = IP_HL(ip);

-               hlen += TH_OFF((struct tcphdr *)&((int *)ip)[hlen]);
+               ND_TCHECK_SIZE((const struct tcphdr *)&((const int *)ip)[hlen]);
+               hlen += TH_OFF((const struct tcphdr *)&((const int *)ip)[hlen]);

                lastlen[dir][lastconn] = length - (hlen << 2);
                lastlen[dir][lastconn] = length - (hlen << 2);

-               ND_PRINT((ndo, "utcp %d: ", lastconn));

                break;
 
        default:
                break;
 
        default:

-               if (p[SLX_CHDR] & TYPE_COMPRESSED_TCP) {
-                       compressed_sl_print(ndo, &p[SLX_CHDR], ip,
-                           length, dir);
-                       ND_PRINT((ndo, ": "));
+               if (dir == -1) {
+                       /* Direction is bogus, don't use it */
+                       return 0;
+               }
+               if (GET_U_1(p + SLX_CHDR) & TYPE_COMPRESSED_TCP) {
+                       if (compressed_sl_print(ndo, p + SLX_CHDR, ip,
+                                               length, dir) == -1)
+                               goto trunc;
+                       ND_PRINT(": ");

                } else
                } else

-                       ND_PRINT((ndo, "slip-%d!: ", p[SLX_CHDR]));
+                       ND_PRINT("slip-%u!: ", GET_U_1(p + SLX_CHDR));

        }
        }

+       return 0;
+trunc:
+       return -1;

 }
 
 static const u_char *
 print_sl_change(netdissect_options *ndo,
 }
 
 static const u_char *
 print_sl_change(netdissect_options *ndo,

-                const char *str, register const u_char *cp)
+                const char *str, const u_char *cp)

 {
 {

-       register u_int i;
+       u_int i;

 
 

-       if ((i = *cp++) == 0) {
-               i = EXTRACT_16BITS(cp);
+       if ((i = GET_U_1(cp)) == 0) {
+               cp++;
+               i = GET_BE_U_2(cp);

                cp += 2;
        }
                cp += 2;
        }

-       ND_PRINT((ndo, " %s%d", str, i));
+       ND_PRINT(" %s%u", str, i);

        return (cp);
 }
 
 static const u_char *
 print_sl_winchange(netdissect_options *ndo,
        return (cp);
 }
 
 static const u_char *
 print_sl_winchange(netdissect_options *ndo,

-                   register const u_char *cp)
+                   const u_char *cp)

 {
 {

-       register short i;
+       int16_t i;

 
 

-       if ((i = *cp++) == 0) {
-               i = EXTRACT_16BITS(cp);
+       if ((i = GET_U_1(cp)) == 0) {
+               cp++;
+               i = GET_BE_S_2(cp);

                cp += 2;
        }
        if (i >= 0)
                cp += 2;
        }
        if (i >= 0)

-               ND_PRINT((ndo, " W+%d", i));
+               ND_PRINT(" W+%d", i);

        else
        else

-               ND_PRINT((ndo, " W%d", i));
+               ND_PRINT(" W%d", i);

        return (cp);
 }
 
        return (cp);
 }
 

-static void
+static int

 compressed_sl_print(netdissect_options *ndo,
                     const u_char *chdr, const struct ip *ip,
                     u_int length, int dir)
 {
 compressed_sl_print(netdissect_options *ndo,
                     const u_char *chdr, const struct ip *ip,
                     u_int length, int dir)
 {

-       register const u_char *cp = chdr;
-       register u_int flags, hlen;
+       const u_char *cp = chdr;
+       u_int flags, hlen;

 
 

-       flags = *cp++;
+       flags = GET_U_1(cp);
+       cp++;

        if (flags & NEW_C) {
        if (flags & NEW_C) {

-               lastconn = *cp++;
-               ND_PRINT((ndo, "ctcp %d", lastconn));
+               lastconn = GET_U_1(cp);
+               cp++;
+               ND_PRINT("ctcp %u", lastconn);

        } else
        } else

-               ND_PRINT((ndo, "ctcp *"));
+               ND_PRINT("ctcp *");

 
        /* skip tcp checksum */
        cp += 2;
 
        switch (flags & SPECIALS_MASK) {
        case SPECIAL_I:
 
        /* skip tcp checksum */
        cp += 2;
 
        switch (flags & SPECIALS_MASK) {
        case SPECIAL_I:

-               ND_PRINT((ndo, " *SA+%d", lastlen[dir][lastconn]));
+               ND_PRINT(" *SA+%u", lastlen[dir][lastconn]);

                break;
 
        case SPECIAL_D:
                break;
 
        case SPECIAL_D:

-               ND_PRINT((ndo, " *S+%d", lastlen[dir][lastconn]));
+               ND_PRINT(" *S+%u", lastlen[dir][lastconn]);

                break;
 
        default:
                break;
 
        default:


@@ -240,8 +274,13 @@ compressed_sl_print(netdissect_options *ndo,
         * 'cp - chdr' is the length of the compressed header.
         * 'length - hlen' is the amount of data in the packet.
         */
         * 'cp - chdr' is the length of the compressed header.
         * 'length - hlen' is the amount of data in the packet.
         */

+       ND_TCHECK_SIZE(ip);

        hlen = IP_HL(ip);
        hlen = IP_HL(ip);

-       hlen += TH_OFF((struct tcphdr *)&((int32_t *)ip)[hlen]);
+       ND_TCHECK_SIZE((const struct tcphdr *)&((const int32_t *)ip)[hlen]);
+       hlen += TH_OFF((const struct tcphdr *)&((const int32_t *)ip)[hlen]);

        lastlen[dir][lastconn] = length - (hlen << 2);
        lastlen[dir][lastconn] = length - (hlen << 2);

-       ND_PRINT((ndo, " %d (%ld)", lastlen[dir][lastconn], (long)(cp - chdr)));
+       ND_PRINT(" %u (%ld)", lastlen[dir][lastconn], (long)(cp - chdr));
+       return 0;
+trunc:
+       return -1;

 }
 }