OpenFlow: Have a function for each message type.

[tcpdump] / print-token.c

diff --git a/print-token.c b/print-token.c
index 4f8422b5ab1b096c0e9a4cc4eee5813936c590c3..38f56eae894c7553e3a71295bbd4d81c1ed23b13 100644 (file)
--- a/print-token.c
+++ b/print-token.c
@@ -23,31 +23,75 @@
  * Further tweaked to more closely resemble print-fddi.c
  *     Guy Harris <[email protected]>
  */
  * Further tweaked to more closely resemble print-fddi.c
  *     Guy Harris <[email protected]>
  */

-#ifndef lint
-static const char rcsid[] _U_ =
-    "@(#) $Header: /tcpdump/master/tcpdump/print-token.c,v 1.27 2005-11-13 12:12:43 guy Exp $";
-#endif
+
+/* \summary: Token Ring 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 <pcap.h>
-#include <stdio.h>

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

-#include "interface.h"
+#include "netdissect.h"

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

-#include "ethertype.h"

 
 

-#include "ether.h"
-#include "token.h"
+/*
+ * Copyright (c) 1998, Larry Lile
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice unmodified, this list of conditions, and the following
+ *    disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ */
+
+#define TOKEN_HDRLEN           14
+#define ROUTING_SEGMENT_MAX    16
+#define IS_SOURCE_ROUTED(trp)  ((trp)->token_shost[0] & 0x80)
+#define FRAME_TYPE(trp)                ((GET_U_1((trp)->token_fc) & 0xC0) >> 6)
+#define TOKEN_FC_LLC           1
+
+#define BROADCAST(trp)         ((GET_BE_U_2((trp)->token_rcf) & 0xE000) >> 13)
+#define RIF_LENGTH(trp)                ((GET_BE_U_2((trp)->token_rcf) & 0x1f00) >> 8)
+#define DIRECTION(trp)         ((GET_BE_U_2((trp)->token_rcf) & 0x0080) >> 7)
+#define LARGEST_FRAME(trp)     ((GET_BE_U_2((trp)->token_rcf) & 0x0070) >> 4)
+#define RING_NUMBER(trp, x)    ((GET_BE_U_2((trp)->token_rseg[x]) & 0xfff0) >> 4)
+#define BRIDGE_NUMBER(trp, x)  (GET_BE_U_2((trp)->token_rseg[x]) & 0x000f)
+#define SEGMENT_COUNT(trp)     ((int)((RIF_LENGTH(trp) - 2) / 2))
+
+struct token_header {
+       nd_uint8_t   token_ac;
+       nd_uint8_t   token_fc;
+       nd_mac_addr  token_dhost;
+       nd_mac_addr  token_shost;
+       nd_uint16_t  token_rcf;
+       nd_uint16_t  token_rseg[ROUTING_SEGMENT_MAX];
+};
+

 
 /* Extract src, dst addresses */
 
 /* Extract src, dst addresses */

-static inline void
+static void

 extract_token_addrs(const struct token_header *trp, char *fsrc, char *fdst)
 {
        memcpy(fdst, (const char *)trp->token_dhost, 6);
 extract_token_addrs(const struct token_header *trp, char *fsrc, char *fdst)
 {
        memcpy(fdst, (const char *)trp->token_dhost, 6);


@@ -57,23 +101,23 @@ extract_token_addrs(const struct token_header *trp, char *fsrc, char *fdst)
 /*
  * Print the TR MAC header
  */
 /*
  * Print the TR MAC header
  */

-static inline void
-token_hdr_print(register const struct token_header *trp, register u_int length,
-          register const u_char *fsrc, register const u_char *fdst)
+static void
+token_hdr_print(netdissect_options *ndo,
+                const struct token_header *trp, u_int length,
+                const u_char *fsrc, const u_char *fdst)

 {
        const char *srcname, *dstname;
 
 {
        const char *srcname, *dstname;
 

-       srcname = etheraddr_string(fsrc);
-       dstname = etheraddr_string(fdst);
-
-       if (vflag)
-               (void) printf("%02x %02x %s %s %d: ",
-                      trp->token_ac,
-                      trp->token_fc,
-                      srcname, dstname,
-                      length);
-       else
-               printf("%s %s %d: ", srcname, dstname, length);
+       srcname = etheraddr_string(ndo, fsrc);
+       dstname = etheraddr_string(ndo, fdst);
+
+       if (!ndo->ndo_qflag)
+               ND_PRINT("%02x %02x ",
+                      GET_U_1(trp->token_ac),
+                      GET_U_1(trp->token_fc));
+       ND_PRINT("%s > %s, length %u: ",
+              srcname, dstname,
+              length);

 }
 
 static const char *broadcast_indicator[] = {
 }
 
 static const char *broadcast_indicator[] = {


@@ -99,63 +143,71 @@ static const char *largest_frame[] = {
 };
 
 u_int
 };
 
 u_int

-token_print(const u_char *p, u_int length, u_int caplen)
+token_print(netdissect_options *ndo, const u_char *p, u_int length, u_int caplen)

 {
        const struct token_header *trp;
 {
        const struct token_header *trp;

-       u_short extracted_ethertype;
-       struct ether_header ehdr;
+       int llc_hdrlen;
+       nd_mac_addr srcmac, dstmac;
+       struct lladdr_info src, dst;

        u_int route_len = 0, hdr_len = TOKEN_HDRLEN;
        int seg;
 
        u_int route_len = 0, hdr_len = TOKEN_HDRLEN;
        int seg;
 

+       ndo->ndo_protocol = "token";

        trp = (const struct token_header *)p;
 
        if (caplen < TOKEN_HDRLEN) {
        trp = (const struct token_header *)p;
 
        if (caplen < TOKEN_HDRLEN) {

-               printf("[|token-ring]");
+               nd_print_trunc(ndo);

                return hdr_len;
        }
 
        /*
         * Get the TR addresses into a canonical form
         */
                return hdr_len;
        }
 
        /*
         * Get the TR addresses into a canonical form
         */

-       extract_token_addrs(trp, (char*)ESRC(&ehdr), (char*)EDST(&ehdr));
+       extract_token_addrs(trp, (char*)srcmac, (char*)dstmac);

 
        /* Adjust for source routing information in the MAC header */
        if (IS_SOURCE_ROUTED(trp)) {
                /* Clear source-routed bit */
 
        /* Adjust for source routing information in the MAC header */
        if (IS_SOURCE_ROUTED(trp)) {
                /* Clear source-routed bit */

-               *ESRC(&ehdr) &= 0x7f;
+               srcmac[0] &= 0x7f;

 
 

-               if (eflag)
-                       token_hdr_print(trp, length, ESRC(&ehdr), EDST(&ehdr));
+               if (ndo->ndo_eflag)
+                       token_hdr_print(ndo, trp, length, srcmac, dstmac);

 
                if (caplen < TOKEN_HDRLEN + 2) {
 
                if (caplen < TOKEN_HDRLEN + 2) {

-                       printf("[|token-ring]");
+                       nd_print_trunc(ndo);

                        return hdr_len;
                }
                route_len = RIF_LENGTH(trp);
                hdr_len += route_len;
                if (caplen < hdr_len) {
                        return hdr_len;
                }
                route_len = RIF_LENGTH(trp);
                hdr_len += route_len;
                if (caplen < hdr_len) {

-                       printf("[|token-ring]");
+                       nd_print_trunc(ndo);

                        return hdr_len;
                }
                        return hdr_len;
                }

-               if (vflag) {
-                       printf("%s ", broadcast_indicator[BROADCAST(trp)]);
-                       printf("%s", direction[DIRECTION(trp)]);
+               if (ndo->ndo_vflag) {
+                       ND_PRINT("%s ", broadcast_indicator[BROADCAST(trp)]);
+                       ND_PRINT("%s", direction[DIRECTION(trp)]);

 
                        for (seg = 0; seg < SEGMENT_COUNT(trp); seg++)
 
                        for (seg = 0; seg < SEGMENT_COUNT(trp); seg++)

-                               printf(" [%d:%d]", RING_NUMBER(trp, seg),
+                               ND_PRINT(" [%u:%u]", RING_NUMBER(trp, seg),

                                    BRIDGE_NUMBER(trp, seg));
                } else {
                                    BRIDGE_NUMBER(trp, seg));
                } else {

-                       printf("rt = %x", EXTRACT_16BITS(&trp->token_rcf));
+                       ND_PRINT("rt = %x", GET_BE_U_2(trp->token_rcf));

 
                        for (seg = 0; seg < SEGMENT_COUNT(trp); seg++)
 
                        for (seg = 0; seg < SEGMENT_COUNT(trp); seg++)

-                               printf(":%x", EXTRACT_16BITS(&trp->token_rseg[seg]));
+                               ND_PRINT(":%x",
+                                        GET_BE_U_2(trp->token_rseg[seg]));

                }
                }

-               printf(" (%s) ", largest_frame[LARGEST_FRAME(trp)]);
+               ND_PRINT(" (%s) ", largest_frame[LARGEST_FRAME(trp)]);

        } else {
        } else {

-               if (eflag)
-                       token_hdr_print(trp, length, ESRC(&ehdr), EDST(&ehdr));
+               if (ndo->ndo_eflag)
+                       token_hdr_print(ndo, trp, length, srcmac, dstmac);

        }
 
        }
 

+       src.addr = srcmac;
+       src.addr_string = etheraddr_string;
+       dst.addr = dstmac;
+       dst.addr_string = etheraddr_string;
+

        /* Skip over token ring MAC header and routing information */
        length -= hdr_len;
        p += hdr_len;
        /* Skip over token ring MAC header and routing information */
        length -= hdr_len;
        p += hdr_len;


@@ -164,28 +216,22 @@ token_print(const u_char *p, u_int length, u_int caplen)
        /* Frame Control field determines interpretation of packet */
        if (FRAME_TYPE(trp) == TOKEN_FC_LLC) {
                /* Try to print the LLC-layer header & higher layers */
        /* Frame Control field determines interpretation of packet */
        if (FRAME_TYPE(trp) == TOKEN_FC_LLC) {
                /* Try to print the LLC-layer header & higher layers */

-               if (llc_print(p, length, caplen, ESRC(&ehdr), EDST(&ehdr),
-                   &extracted_ethertype) == 0) {
-                       /* ether_type not known, print raw packet */
-                       if (!eflag)
-                               token_hdr_print(trp,
-                                   length + TOKEN_HDRLEN + route_len,
-                                   ESRC(&ehdr), EDST(&ehdr));
-                       if (extracted_ethertype) {
-                               printf("(LLC %s) ",
-                       etherproto_string(htons(extracted_ethertype)));
-                       }
-                       if (!suppress_default_print)
-                               default_print(p, caplen);
+               llc_hdrlen = llc_print(ndo, p, length, caplen, &src, &dst);
+               if (llc_hdrlen < 0) {
+                       /* packet type not known, print raw packet */
+                       if (!ndo->ndo_suppress_default_print)
+                               ND_DEFAULTPRINT(p, caplen);
+                       llc_hdrlen = -llc_hdrlen;

                }
                }

+               hdr_len += llc_hdrlen;

        } else {
                /* Some kinds of TR packet we cannot handle intelligently */
                /* XXX - dissect MAC packets if frame type is 0 */
        } else {
                /* Some kinds of TR packet we cannot handle intelligently */
                /* XXX - dissect MAC packets if frame type is 0 */

-               if (!eflag)
-                       token_hdr_print(trp, length + TOKEN_HDRLEN + route_len,
-                           ESRC(&ehdr), EDST(&ehdr));
-               if (!suppress_default_print)
-                       default_print(p, caplen);
+               if (!ndo->ndo_eflag)
+                       token_hdr_print(ndo, trp, length + TOKEN_HDRLEN + route_len,
+                           srcmac, dstmac);
+               if (!ndo->ndo_suppress_default_print)
+                       ND_DEFAULTPRINT(p, caplen);

        }
        return (hdr_len);
 }
        }
        return (hdr_len);
 }


@@ -196,8 +242,9 @@ token_print(const u_char *p, u_int length, u_int caplen)
  * 'h->len' is the length of the packet off the wire, and 'h->caplen'
  * is the number of bytes actually captured.
  */
  * 'h->len' is the length of the packet off the wire, and 'h->caplen'
  * is the number of bytes actually captured.
  */

-u_int
-token_if_print(const struct pcap_pkthdr *h, const u_char *p)
+void
+token_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)

 {
 {

-       return (token_print(p, h->len, h->caplen));
+       ndo->ndo_protocol = "token";
+       ndo->ndo_ll_hdr_len += token_print(ndo, p, h->len, h->caplen);

 }
 }