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

[tcpdump] / print-sll.c

diff --git a/print-sll.c b/print-sll.c
index 878bb79637aa9ff6117c7b795f17f6227b4d83cd..58a1649ee740125e2eee1652beae995e1153e658 100644 (file)
--- a/print-sll.c
+++ b/print-sll.c
@@ -19,13 +19,15 @@
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 
+/* \summary: Linux cooked sockets capture printer */
+
 #ifdef HAVE_CONFIG_H
 #include "config.h"
 #endif
 
-#include <tcpdump-stdinc.h>
+#include <netdissect-stdinc.h>
 
-#include "interface.h"
+#include "netdissect.h"
 #include "addrtoname.h"
 #include "ethertype.h"
 #include "extract.h"
@@ -77,11 +79,11 @@
 #define SLL_ADDRLEN    8               /* length of address field */
 
 struct sll_header {
-       u_int16_t       sll_pkttype;    /* packet type */
-       u_int16_t       sll_hatype;     /* link-layer address type */
-       u_int16_t       sll_halen;      /* link-layer address length */
-       u_int8_t        sll_addr[SLL_ADDRLEN];  /* link-layer address */
-       u_int16_t       sll_protocol;   /* protocol */
+       uint16_t        sll_pkttype;    /* packet type */
+       uint16_t        sll_hatype;     /* link-layer address type */
+       uint16_t        sll_halen;      /* link-layer address length */
+       uint8_t         sll_addr[SLL_ADDRLEN];  /* link-layer address */
+       uint16_t        sll_protocol;   /* protocol */
 };
 
 /*
@@ -134,18 +136,18 @@ sll_print(netdissect_options *ndo, register const struct sll_header *sllp, u_int
 {
        u_short ether_type;
 
-        ND_PRINT((ndo, "%3s ",tok2str(sll_pkttype_values,"?",EXTRACT_16BITS(&sllp->sll_pkttype))));
+        ND_PRINT((ndo, "%3s ",tok2str(sll_pkttype_values,"?",EXTRACT_BE_U_2(&sllp->sll_pkttype))));
 
        /*
         * XXX - check the link-layer address type value?
         * For now, we just assume 6 means Ethernet.
         * XXX - print others as strings of hex?
         */
-       if (EXTRACT_16BITS(&sllp->sll_halen) == 6)
-               ND_PRINT((ndo, "%s ", etheraddr_string(sllp->sll_addr)));
+       if (EXTRACT_BE_U_2(&sllp->sll_halen) == 6)
+               ND_PRINT((ndo, "%s ", etheraddr_string(ndo, sllp->sll_addr)));
 
        if (!ndo->ndo_qflag) {
-               ether_type = EXTRACT_16BITS(&sllp->sll_protocol);
+               ether_type = EXTRACT_BE_U_2(&sllp->sll_protocol);
 
                if (ether_type <= ETHERMTU) {
                        /*
@@ -197,7 +199,8 @@ sll_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char
        u_int length = h->len;
        register const struct sll_header *sllp;
        u_short ether_type;
-       u_short extracted_ethertype;
+       int llc_hdrlen;
+       u_int hdrlen;
 
        if (caplen < SLL_HDR_LEN) {
                /*
@@ -220,8 +223,9 @@ sll_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char
        length -= SLL_HDR_LEN;
        caplen -= SLL_HDR_LEN;
        p += SLL_HDR_LEN;
+       hdrlen = SLL_HDR_LEN;
 
-       ether_type = EXTRACT_16BITS(&sllp->sll_protocol);
+       ether_type = EXTRACT_BE_U_2(&sllp->sll_protocol);
 
 recurse:
        /*
@@ -246,25 +250,19 @@ recurse:
                         * 802.2.
                         * Try to print the LLC-layer header & higher layers.
                         */
-                       if (llc_print(p, length, caplen, NULL, NULL,
-                           &extracted_ethertype) == 0)
+                       llc_hdrlen = llc_print(ndo, p, length, caplen, NULL, NULL);
+                       if (llc_hdrlen < 0)
                                goto unknown;   /* unknown LLC type */
+                       hdrlen += llc_hdrlen;
                        break;
 
                default:
-                       extracted_ethertype = 0;
                        /*FALLTHROUGH*/
 
                unknown:
-                       /* ether_type not known, print raw packet */
-                       if (!ndo->ndo_eflag)
-                               sll_print(ndo, sllp, length + SLL_HDR_LEN);
-                       if (extracted_ethertype) {
-                               ND_PRINT((ndo, "(LLC %s) ",
-                              etherproto_string(htons(extracted_ethertype))));
-                       }
+                       /* packet type not known, print raw packet */
                        if (!ndo->ndo_suppress_default_print)
-                               ndo->ndo_default_print(ndo, p, caplen);
+                               ND_DEFAULTPRINT(p, caplen);
                        break;
                }
        } else if (ether_type == ETHERTYPE_8021Q) {
@@ -272,20 +270,21 @@ recurse:
                 * Print VLAN information, and then go back and process
                 * the enclosed type field.
                 */
-               if (caplen < 4 || length < 4) {
+               if (caplen < 4) {
+                       ND_PRINT((ndo, "[|vlan]"));
+                       return (hdrlen + caplen);
+               }
+               if (length < 4) {
                        ND_PRINT((ndo, "[|vlan]"));
-                       return (SLL_HDR_LEN);
+                       return (hdrlen + length);
                }
                if (ndo->ndo_eflag) {
-                       u_int16_t tag = EXTRACT_16BITS(p);
+                       uint16_t tag = EXTRACT_BE_U_2(p);
 
-                       ND_PRINT((ndo, "vlan %u, p %u%s, ",
-                           tag & 0xfff,
-                           tag >> 13,
-                           (tag & 0x1000) ? ", CFI" : ""));
+                       ND_PRINT((ndo, "%s, ", ieee8021q_tci_string(tag)));
                }
 
-               ether_type = EXTRACT_16BITS(p + 2);
+               ether_type = EXTRACT_BE_U_2(p + 2);
                if (ether_type <= ETHERMTU)
                        ether_type = LINUX_SLL_P_802_2;
                if (!ndo->ndo_qflag) {
@@ -295,16 +294,17 @@ recurse:
                p += 4;
                length -= 4;
                caplen -= 4;
+               hdrlen += 4;
                goto recurse;
        } else {
-               if (ethertype_print(ndo, ether_type, p, length, caplen) == 0) {
+               if (ethertype_print(ndo, ether_type, p, length, caplen, NULL, NULL) == 0) {
                        /* ether_type not known, print raw packet */
                        if (!ndo->ndo_eflag)
                                sll_print(ndo, sllp, length + SLL_HDR_LEN);
                        if (!ndo->ndo_suppress_default_print)
-                               ndo->ndo_default_print(ndo, p, caplen);
+                               ND_DEFAULTPRINT(p, caplen);
                }
        }
 
-       return (SLL_HDR_LEN);
+       return (hdrlen);
 }