* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
*/
+/* \summary: IEEE 802.15.4 printer */
+
#ifdef HAVE_CONFIG_H
-#include "config.h"
+#include <config.h>
#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
-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);
}
projects / tcpdump / blobdiff