Add '-Wunreachable-code-return' warning option in devel mode for cmake

[tcpdump] / print-802_15_4.c

diff --git a/print-802_15_4.c b/print-802_15_4.c
index 57bc7cfebedb84530b872effc91cdbc7902a6fe6..f9f05d2f3f5d20055042f2b5bc142b2d5dca34e4 100644 (file)
--- a/print-802_15_4.c
+++ b/print-802_15_4.c
@@ -20,19 +20,213 @@
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  */
 

+/* \summary: IEEE 802.15.4 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 "netdissect.h"
+#include "addrtoname.h"
+
+#include "extract.h"
+
+static const char *ftypes[] = {
+       "Beacon",                       /* 0 */
+       "Data",                         /* 1 */
+       "ACK",                          /* 2 */
+       "Command",                      /* 3 */
+       "Reserved (0x4)",               /* 4 */
+       "Reserved (0x5)",               /* 5 */
+       "Reserved (0x6)",               /* 6 */
+       "Reserved (0x7)",               /* 7 */
+};
+
+/*
+ * Frame Control subfields.
+ */
+#define FC_FRAME_TYPE(fc)              ((fc) & 0x7)
+#define FC_SECURITY_ENABLED            0x0008
+#define FC_FRAME_PENDING               0x0010
+#define FC_ACK_REQUEST                 0x0020
+#define FC_PAN_ID_COMPRESSION          0x0040
+#define FC_DEST_ADDRESSING_MODE(fc)    (((fc) >> 10) & 0x3)
+#define FC_FRAME_VERSION(fc)           (((fc) >> 12) & 0x3)
+#define FC_SRC_ADDRESSING_MODE(fc)     (((fc) >> 14) & 0x3)
+
+#define FC_ADDRESSING_MODE_NONE                0x00
+#define FC_ADDRESSING_MODE_RESERVED    0x01
+#define FC_ADDRESSING_MODE_SHORT       0x02
+#define FC_ADDRESSING_MODE_LONG                0x03
+
+static u_int
+ieee802_15_4_print(netdissect_options *ndo,
+                   const u_char *p, u_int caplen)
+{
+       u_int hdrlen;
+       uint16_t fc;
+       uint8_t seq;
+       uint16_t panid = 0;
+
+       ndo->ndo_protocol = "802.15.4";
+       if (caplen < 3) {
+               nd_print_trunc(ndo);
+               return caplen;
+       }
+       hdrlen = 3;
+
+       fc = EXTRACT_LE_U_2(p);
+       seq = EXTRACT_U_1(p + 2);
+
+       p += 3;
+       caplen -= 3;
+
+       ND_PRINT("IEEE 802.15.4 %s packet ", ftypes[FC_FRAME_TYPE(fc)]);
+       if (ndo->ndo_vflag)
+               ND_PRINT("seq %02x ", seq);

 
 

-#include <stdio.h>
-#include <pcap.h>
-#include <string.h>
+       /*
+        * Destination address and PAN ID, if present.
+        */
+       switch (FC_DEST_ADDRESSING_MODE(fc)) {
+       case FC_ADDRESSING_MODE_NONE:
+               if (fc & FC_PAN_ID_COMPRESSION) {
+                       /*
+                        * PAN ID compression; this requires that both
+                        * the source and destination addresses be present,
+                        * but the destination address is missing.
+                        */
+                       nd_print_trunc(ndo);
+                       return hdrlen;
+               }
+               if (ndo->ndo_vflag)
+                       ND_PRINT("none ");
+               break;
+       case FC_ADDRESSING_MODE_RESERVED:
+               if (ndo->ndo_vflag)
+                       ND_PRINT("reserved destination addressing mode");
+               return hdrlen;
+       case FC_ADDRESSING_MODE_SHORT:
+               if (caplen < 2) {
+                       nd_print_trunc(ndo);
+                       return hdrlen;
+               }
+               panid = EXTRACT_LE_U_2(p);
+               p += 2;
+               caplen -= 2;
+               hdrlen += 2;
+               if (caplen < 2) {
+                       nd_print_trunc(ndo);
+                       return hdrlen;
+               }
+               if (ndo->ndo_vflag)
+                       ND_PRINT("%04x:%04x ", panid, EXTRACT_LE_U_2(p));
+               p += 2;
+               caplen -= 2;
+               hdrlen += 2;
+               break;
+       case FC_ADDRESSING_MODE_LONG:
+               if (caplen < 2) {
+                       nd_print_trunc(ndo);
+                       return hdrlen;
+               }
+               panid = EXTRACT_LE_U_2(p);
+               p += 2;
+               caplen -= 2;
+               hdrlen += 2;
+               if (caplen < 8) {
+                       nd_print_trunc(ndo);
+                       return hdrlen;
+               }
+               if (ndo->ndo_vflag)
+                       ND_PRINT("%04x:%s ", panid, le64addr_string(ndo, p));
+               p += 8;
+               caplen -= 8;
+               hdrlen += 8;
+               break;
+       }
+       if (ndo->ndo_vflag)
+               ND_PRINT("< ");
+
+       /*
+        * Source address and PAN ID, if present.
+        */
+       switch (FC_SRC_ADDRESSING_MODE(fc)) {
+       case FC_ADDRESSING_MODE_NONE:
+               if (ndo->ndo_vflag)
+                       ND_PRINT("none ");
+               break;
+       case FC_ADDRESSING_MODE_RESERVED:
+               if (ndo->ndo_vflag)
+                       ND_PRINT("reserved source addressing mode");
+               return 0;
+       case FC_ADDRESSING_MODE_SHORT:
+               if (!(fc & FC_PAN_ID_COMPRESSION)) {
+                       /*
+                        * The source PAN ID is not compressed out, so
+                        * fetch it.  (Otherwise, we'll use the destination
+                        * PAN ID, fetched above.)
+                        */
+                       if (caplen < 2) {
+                               nd_print_trunc(ndo);
+                               return hdrlen;
+                       }
+                       panid = EXTRACT_LE_U_2(p);
+                       p += 2;
+                       caplen -= 2;
+                       hdrlen += 2;
+               }
+               if (caplen < 2) {
+                       nd_print_trunc(ndo);
+                       return hdrlen;
+               }
+               if (ndo->ndo_vflag)
+                       ND_PRINT("%04x:%04x ", panid, EXTRACT_LE_U_2(p));
+               p += 2;
+               caplen -= 2;
+               hdrlen += 2;
+               break;
+       case FC_ADDRESSING_MODE_LONG:
+               if (!(fc & FC_PAN_ID_COMPRESSION)) {
+                       /*
+                        * The source PAN ID is not compressed out, so
+                        * fetch it.  (Otherwise, we'll use the destination
+                        * PAN ID, fetched above.)
+                        */
+                       if (caplen < 2) {
+                               nd_print_trunc(ndo);
+                               return hdrlen;
+                       }
+                       panid = EXTRACT_LE_U_2(p);
+                       p += 2;
+                       caplen -= 2;
+                       hdrlen += 2;
+               }
+               if (caplen < 8) {
+                       nd_print_trunc(ndo);
+                       return hdrlen;
+               }
+               if (ndo->ndo_vflag)
+                       ND_PRINT("%04x:%s ", panid, le64addr_string(ndo, p));
+               p += 8;
+               caplen -= 8;
+               hdrlen += 8;
+               break;
+       }
+
+       if (!ndo->ndo_suppress_default_print)
+               ND_DEFAULTPRINT(p, caplen);
+
+       return hdrlen;
+}

 
 

+/* For DLT_IEEE802_15_4 and DLT_IEEE802_15_4_NOFCS */

 u_int
 u_int

-ieee802_15_4_if_print(const struct pcap_pkthdr *h, const u_char *p)
+ieee802_15_4_if_print(netdissect_options *ndo,
+                      const struct pcap_pkthdr *h, const u_char *p)

 {
 {

-       printf("IEEE 802.15.4 packet");
-       return 0;
+       ndo->ndo_protocol = "802.15.4_if";
+       return ieee802_15_4_print(ndo, p, h->caplen);

 }
 }