add NSH ethertype

[tcpdump] / print-ether.c

diff --git a/print-ether.c b/print-ether.c
index ddf6a5305260056fd8416fb76a43c114652e6ac8..57c07ce935182931692fc98f62a40386159c0b37 100644 (file)
--- a/print-ether.c
+++ b/print-ether.c
@@ -19,13 +19,15 @@
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 

+/* \summary: Ethernet printer */
+

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

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

 
 

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

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


@@ -70,6 +72,7 @@ const struct tok ethertype_values[] = {
     { ETHERTYPE_RRCP,           "RRCP" },
     { ETHERTYPE_MS_NLB_HB,      "MS NLB heartbeat" },
     { ETHERTYPE_JUMBO,          "Jumbo" },
     { ETHERTYPE_RRCP,           "RRCP" },
     { ETHERTYPE_MS_NLB_HB,      "MS NLB heartbeat" },
     { ETHERTYPE_JUMBO,          "Jumbo" },

+    { ETHERTYPE_NSH,            "NSH" },

     { ETHERTYPE_LOOPBACK,       "Loopback" },
     { ETHERTYPE_ISO,            "OSI" },
     { ETHERTYPE_GRE_ISO,        "GRE-OSI" },
     { ETHERTYPE_LOOPBACK,       "Loopback" },
     { ETHERTYPE_ISO,            "OSI" },
     { ETHERTYPE_GRE_ISO,        "GRE-OSI" },


@@ -91,7 +94,7 @@ ether_hdr_print(netdissect_options *ndo,
                 const u_char *bp, u_int length)
 {
        register const struct ether_header *ep;
                 const u_char *bp, u_int length)
 {
        register const struct ether_header *ep;

-       uint16_t ether_type;
+       uint16_t length_type;

 
        ep = (const struct ether_header *)bp;
 
 
        ep = (const struct ether_header *)bp;
 


@@ -99,19 +102,21 @@ ether_hdr_print(netdissect_options *ndo,
                     etheraddr_string(ndo, ESRC(ep)),
                     etheraddr_string(ndo, EDST(ep))));
 
                     etheraddr_string(ndo, ESRC(ep)),
                     etheraddr_string(ndo, EDST(ep))));
 

-       ether_type = EXTRACT_16BITS(&ep->ether_type);
+       length_type = EXTRACT_16BITS(&ep->ether_length_type);

        if (!ndo->ndo_qflag) {
        if (!ndo->ndo_qflag) {

-               if (ether_type <= ETHERMTU)
-                         ND_PRINT((ndo, ", 802.3"));
-                else
-                         ND_PRINT((ndo, ", ethertype %s (0x%04x)",
-                                      tok2str(ethertype_values,"Unknown", ether_type),
-                                       ether_type));
+               if (length_type <= ETHERMTU) {
+                       ND_PRINT((ndo, ", 802.3"));
+                       length = length_type;
+               } else
+                       ND_PRINT((ndo, ", ethertype %s (0x%04x)",
+                                      tok2str(ethertype_values,"Unknown", length_type),
+                                       length_type));

         } else {
         } else {

-                if (ether_type <= ETHERMTU)
-                          ND_PRINT((ndo, ", 802.3"));
-                else
-                          ND_PRINT((ndo, ", %s", tok2str(ethertype_values,"Unknown Ethertype (0x%04x)", ether_type)));
+                if (length_type <= ETHERMTU) {
+                        ND_PRINT((ndo, ", 802.3"));
+                       length = length_type;
+               } else
+                        ND_PRINT((ndo, ", %s", tok2str(ethertype_values,"Unknown Ethertype (0x%04x)", length_type)));

         }
 
        ND_PRINT((ndo, ", length %u: ", length));
         }
 
        ND_PRINT((ndo, ", length %u: ", length));


@@ -122,6 +127,8 @@ ether_hdr_print(netdissect_options *ndo,
  * This might be encapsulated within another frame; we might be passed
  * a pointer to a function that can print header information for that
  * frame's protocol, and an argument to pass to that function.
  * This might be encapsulated within another frame; we might be passed
  * a pointer to a function that can print header information for that
  * frame's protocol, and an argument to pass to that function.

+ *
+ * FIXME: caplen can and should be derived from ndo->ndo_snapend and p.

  */
 u_int
 ether_print(netdissect_options *ndo,
  */
 u_int
 ether_print(netdissect_options *ndo,


@@ -130,9 +137,10 @@ ether_print(netdissect_options *ndo,
 {
        const struct ether_header *ep;
        u_int orig_length;
 {
        const struct ether_header *ep;
        u_int orig_length;

-       u_short ether_type;
+       u_short length_type;

        u_int hdrlen;
        int llc_hdrlen;
        u_int hdrlen;
        int llc_hdrlen;

+       struct lladdr_info src, dst;

 
        if (caplen < ETHER_HDRLEN) {
                ND_PRINT((ndo, "[|ether]"));
 
        if (caplen < ETHER_HDRLEN) {
                ND_PRINT((ndo, "[|ether]"));


@@ -156,15 +164,19 @@ ether_print(netdissect_options *ndo,
        p += ETHER_HDRLEN;
        hdrlen = ETHER_HDRLEN;
 
        p += ETHER_HDRLEN;
        hdrlen = ETHER_HDRLEN;
 

-       ether_type = EXTRACT_16BITS(&ep->ether_type);
+       src.addr = ESRC(ep);
+       src.addr_string = etheraddr_string;
+       dst.addr = EDST(ep);
+       dst.addr_string = etheraddr_string;
+       length_type = EXTRACT_16BITS(&ep->ether_length_type);

 
 recurse:
        /*
         * Is it (gag) an 802.3 encapsulation?
         */
 
 recurse:
        /*
         * Is it (gag) an 802.3 encapsulation?
         */

-       if (ether_type <= ETHERMTU) {
+       if (length_type <= ETHERMTU) {

                /* Try to print the LLC-layer header & higher layers */
                /* Try to print the LLC-layer header & higher layers */

-               llc_hdrlen = llc_print(ndo, p, length, caplen, ESRC(ep), EDST(ep));
+               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)
                if (llc_hdrlen < 0) {
                        /* packet type not known, print raw packet */
                        if (!ndo->ndo_suppress_default_print)


@@ -172,10 +184,10 @@ recurse:
                        llc_hdrlen = -llc_hdrlen;
                }
                hdrlen += llc_hdrlen;
                        llc_hdrlen = -llc_hdrlen;
                }
                hdrlen += llc_hdrlen;

-       } else if (ether_type == ETHERTYPE_8021Q  ||
-                ether_type == ETHERTYPE_8021Q9100 ||
-                ether_type == ETHERTYPE_8021Q9200 ||
-                ether_type == ETHERTYPE_8021QinQ) {
+       } else if (length_type == ETHERTYPE_8021Q  ||
+                length_type == ETHERTYPE_8021Q9100 ||
+                length_type == ETHERTYPE_8021Q9200 ||
+                length_type == ETHERTYPE_8021QinQ) {

                /*
                 * Print VLAN information, and then go back and process
                 * the enclosed type field.
                /*
                 * Print VLAN information, and then go back and process
                 * the enclosed type field.


@@ -189,20 +201,20 @@ recurse:
                        return (hdrlen + length);
                }
                if (ndo->ndo_eflag) {
                        return (hdrlen + length);
                }
                if (ndo->ndo_eflag) {

-                       uint16_t tag = EXTRACT_16BITS(p);
+                       uint16_t tag = EXTRACT_16BITS(p);

 
                        ND_PRINT((ndo, "%s, ", ieee8021q_tci_string(tag)));
                }
 
 
                        ND_PRINT((ndo, "%s, ", ieee8021q_tci_string(tag)));
                }
 

-               ether_type = EXTRACT_16BITS(p + 2);
-               if (ndo->ndo_eflag && ether_type > ETHERMTU)
-                       ND_PRINT((ndo, "ethertype %s, ", tok2str(ethertype_values,"0x%04x", ether_type)));
+               length_type = EXTRACT_16BITS(p + 2);
+               if (ndo->ndo_eflag && length_type > ETHERMTU)
+                       ND_PRINT((ndo, "ethertype %s, ", tok2str(ethertype_values,"0x%04x", length_type)));

                p += 4;
                length -= 4;
                caplen -= 4;
                hdrlen += 4;
                goto recurse;
                p += 4;
                length -= 4;
                caplen -= 4;
                hdrlen += 4;
                goto recurse;

-       } else if (ether_type == ETHERTYPE_JUMBO) {
+       } else if (length_type == ETHERTYPE_JUMBO) {

                /*
                 * Alteon jumbo frames.
                 * See
                /*
                 * Alteon jumbo frames.
                 * See


@@ -213,7 +225,7 @@ recurse:
                 * there's an LLC header and payload.
                 */
                /* Try to print the LLC-layer header & higher layers */
                 * there's an LLC header and payload.
                 */
                /* Try to print the LLC-layer header & higher layers */

-               llc_hdrlen = llc_print(ndo, p, length, caplen, ESRC(ep), EDST(ep));
+               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)
                if (llc_hdrlen < 0) {
                        /* packet type not known, print raw packet */
                        if (!ndo->ndo_suppress_default_print)


@@ -222,8 +234,8 @@ recurse:
                }
                hdrlen += llc_hdrlen;
        } else {
                }
                hdrlen += llc_hdrlen;
        } else {

-               if (ethertype_print(ndo, ether_type, p, length, caplen) == 0) {
-                       /* ether_type not known, print raw packet */
+               if (ethertype_print(ndo, length_type, p, length, caplen, &src, &dst) == 0) {
+                       /* type not known, print raw packet */

                        if (!ndo->ndo_eflag) {
                                if (print_encap_header != NULL)
                                        (*print_encap_header)(ndo, encap_header_arg);
                        if (!ndo->ndo_eflag) {
                                if (print_encap_header != NULL)
                                        (*print_encap_header)(ndo, encap_header_arg);


@@ -239,9 +251,9 @@ recurse:
 
 /*
  * This is the top level routine of the printer.  'p' points
 
 /*
  * This is the top level routine of the printer.  'p' points

- * to the ether header of the packet, 'h->ts' is the timestamp,
- * 'h->len' is the length of the packet off the wire, and 'h->caplen'
- * is the number of bytes actually captured.
+ * to the ether header of the packet, 'h->len' is the length
+ * of the packet off the wire, and 'h->caplen' is the number
+ * of bytes actually captured.

  */
 u_int
 ether_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h,
  */
 u_int
 ether_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h,


@@ -252,9 +264,9 @@ ether_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h,
 
 /*
  * This is the top level routine of the printer.  'p' points
 
 /*
  * This is the top level routine of the printer.  'p' points

- * to the ether header of the packet, 'h->ts' is the timestamp,
- * 'h->len' is the length of the packet off the wire, and 'h->caplen'
- * is the number of bytes actually captured.
+ * to the ether header of the packet, 'h->len' is the length
+ * of the packet off the wire, and 'h->caplen' is the number
+ * of bytes actually captured.

  *
  * This is for DLT_NETANALYZER, which has a 4-byte pseudo-header
  * before the Ethernet header.
  *
  * This is for DLT_NETANALYZER, which has a 4-byte pseudo-header
  * before the Ethernet header.


@@ -277,9 +289,9 @@ netanalyzer_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h,
 
 /*
  * This is the top level routine of the printer.  'p' points
 
 /*
  * This is the top level routine of the printer.  'p' points

- * to the ether header of the packet, 'h->ts' is the timestamp,
- * 'h->len' is the length of the packet off the wire, and 'h->caplen'
- * is the number of bytes actually captured.
+ * to the ether header of the packet, 'h->len' is the length
+ * of the packet off the wire, and 'h->caplen' is the number
+ * of bytes actually captured.

  *
  * This is for DLT_NETANALYZER_TRANSPARENT, which has a 4-byte
  * pseudo-header, a 7-byte Ethernet preamble, and a 1-byte Ethernet SOF
  *
  * This is for DLT_NETANALYZER_TRANSPARENT, which has a 4-byte
  * pseudo-header, a 7-byte Ethernet preamble, and a 1-byte Ethernet SOF


@@ -313,7 +325,8 @@ netanalyzer_transparent_if_print(netdissect_options *ndo,
 int
 ethertype_print(netdissect_options *ndo,
                 u_short ether_type, const u_char *p,
 int
 ethertype_print(netdissect_options *ndo,
                 u_short ether_type, const u_char *p,

-                u_int length, u_int caplen)
+                u_int length, u_int caplen,
+                const struct lladdr_info *src, const struct lladdr_info *dst)

 {
        switch (ether_type) {
 
 {
        switch (ether_type) {
 


@@ -327,7 +340,7 @@ ethertype_print(netdissect_options *ndo,
 
        case ETHERTYPE_ARP:
        case ETHERTYPE_REVARP:
 
        case ETHERTYPE_ARP:
        case ETHERTYPE_REVARP:

-               arp_print(ndo, p, length, caplen);
+               arp_print(ndo, p, length, caplen);

                return (1);
 
        case ETHERTYPE_DN:
                return (1);
 
        case ETHERTYPE_DN:


@@ -350,7 +363,11 @@ ethertype_print(netdissect_options *ndo,
                return (1);
 
        case ETHERTYPE_ISO:
                return (1);
 
        case ETHERTYPE_ISO:

-               isoclns_print(ndo, p + 1, length - 1, length - 1);
+               if (length == 0 || caplen == 0) {
+                       ND_PRINT((ndo, " [|osi]"));
+                       return (1);
+               }
+               isoclns_print(ndo, p + 1, length - 1, caplen - 1);

                return(1);
 
        case ETHERTYPE_PPPOED:
                return(1);
 
        case ETHERTYPE_PPPOED:


@@ -365,7 +382,7 @@ ethertype_print(netdissect_options *ndo,
                return (1);
 
        case ETHERTYPE_RRCP:
                return (1);
 
        case ETHERTYPE_RRCP:

-               rrcp_print(ndo, p - 14 , length + 14);
+               rrcp_print(ndo, p, length, src, dst);

                return (1);
 
        case ETHERTYPE_PPP:
                return (1);
 
        case ETHERTYPE_PPP:


@@ -392,6 +409,10 @@ ethertype_print(netdissect_options *ndo,
                lldp_print(ndo, p, length);
                return (1);
 
                lldp_print(ndo, p, length);
                return (1);
 

+        case ETHERTYPE_NSH:
+                nsh_print(ndo, p, length);
+                return (1);
+

         case ETHERTYPE_LOOPBACK:
                loopback_print(ndo, p, length);
                 return (1);
         case ETHERTYPE_LOOPBACK:
                loopback_print(ndo, p, length);
                 return (1);


@@ -411,11 +432,11 @@ ethertype_print(netdissect_options *ndo,
 
         case ETHERTYPE_GEONET_OLD:
         case ETHERTYPE_GEONET:
 
         case ETHERTYPE_GEONET_OLD:
         case ETHERTYPE_GEONET:

-                geonet_print(ndo, p-14, p, length);
+                geonet_print(ndo, p, length, src);

                 return (1);
 
         case ETHERTYPE_CALM_FAST:
                 return (1);
 
         case ETHERTYPE_CALM_FAST:

-                calm_fast_print(ndo, p-14, p, length);
+                calm_fast_print(ndo, p, length, src);

                 return (1);
 
        case ETHERTYPE_AOE:
                 return (1);
 
        case ETHERTYPE_AOE:


@@ -423,7 +444,7 @@ ethertype_print(netdissect_options *ndo,
                return (1);
 
        case ETHERTYPE_MEDSA:
                return (1);
 
        case ETHERTYPE_MEDSA:

-               medsa_print(ndo, p, length, caplen);
+               medsa_print(ndo, p, length, caplen, src, dst);

                return (1);
 
        case ETHERTYPE_LAT:
                return (1);
 
        case ETHERTYPE_LAT: