X-Git-Url: https://git.tcpdump.org/tcpdump/blobdiff_plain/8479745268acc59f0cda4fe0705d71a5739dc86a..d9a787e4995b4b5101e410ed1e93367907ab9fe2:/print-zep.c diff --git a/print-zep.c b/print-zep.c index 8954d7fd..ac4e017c 100644 --- a/print-zep.c +++ b/print-zep.c @@ -19,12 +19,13 @@ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. */ +/* \summary: ZigBee Encapsulation Protocol (ZEP) printer */ #ifdef HAVE_CONFIG_H -#include "config.h" +#include #endif -#include +#include "netdissect-stdinc.h" #include "netdissect.h" @@ -42,7 +43,6 @@ *********************************************************************** * * ZEP v1 Header will have the following format: - * * |Preamble|Version|Channel ID|Device ID|CRC/LQI Mode|LQI Val|Reserved|Length| * |2 bytes |1 byte | 1 byte | 2 bytes | 1 byte |1 byte |7 bytes |1 byte| * @@ -56,118 +56,121 @@ *------------------------------------------------------------ */ -#define FMAXINT (4294967296.0) /* floating point rep. of MAXINT */ #define JAN_1970 2208988800U /* Print timestamp */ static void zep_print_ts(netdissect_options *ndo, const u_char *p) { - int32_t i; - uint32_t uf; - uint32_t f; - float ff; - - i = EXTRACT_32BITS(p); - uf = EXTRACT_32BITS(p + 4); - ff = uf; - if (ff < 0.0) /* some compilers are buggy */ - ff += FMAXINT; - ff = ff / FMAXINT; /* shift radix point by 32 bits */ - f = ff * 1000000000.0; /* treat fraction as parts per billion */ - ND_PRINT((ndo, "%u.%09d", i, f)); + int32_t i; + uint32_t uf; + uint32_t f; + float ff; + + i = GET_BE_U_4(p); + uf = GET_BE_U_4(p + 4); + ff = (float) uf; + if (ff < 0.0) /* some compilers are buggy */ + ff += FMAXINT; + ff = (float) (ff / FMAXINT); /* shift radix point by 32 bits */ + f = (uint32_t) (ff * 1000000000.0); /* treat fraction as parts per + billion */ + ND_PRINT("%u.%09d", i, f); #ifdef HAVE_STRFTIME - /* - * print the time in human-readable format. - */ - if (i) { - time_t seconds = i - JAN_1970; - struct tm *tm; - char time_buf[128]; - - tm = localtime(&seconds); - strftime(time_buf, sizeof (time_buf), "%Y/%m/%d %H:%M:%S", tm); - ND_PRINT((ndo, " (%s)", time_buf)); - } + /* + * print the time in human-readable format. + */ + if (i) { + time_t seconds = i - JAN_1970; + struct tm *tm; + char time_buf[128]; + + tm = localtime(&seconds); + strftime(time_buf, sizeof (time_buf), "%Y/%m/%d %H:%M:%S", tm); + ND_PRINT(" (%s)", time_buf); + } #endif } /* * Main function to print packets. */ - + void zep_print(netdissect_options *ndo, const u_char *bp, u_int len) { - uint8_t version, inner_len; - uint32_t seq_no; - - ND_PRINT((ndo, "ZEP")); - - ND_TCHECK2(*bp, 8); - - if (*bp != 'E' || *(bp+1) != 'X') goto trunc; - - version = *(bp + 2); - ND_PRINT((ndo, "v%d ", version)); - - if (version == 1) { - /* ZEP v1 packet. */ - ND_TCHECK2(*bp, 16); - ND_PRINT((ndo, "Channel ID %d, Device ID 0x%04x, ", - *(bp + 3), EXTRACT_16BITS(bp + 4))); - if (*(bp + 6)) - ND_PRINT((ndo, "CRC, ")); - else - ND_PRINT((ndo, "LQI %d, ", *(bp + 7))); - inner_len = *(bp + 15); - ND_PRINT((ndo, "inner len = %d", inner_len)); - - bp += 16; - len -= 16; - } else { - /* ZEP v2 packet. */ - if (*(bp + 3) == 2) { - /* ZEP v2 ack. */ - seq_no = EXTRACT_32BITS(bp + 4); - ND_PRINT((ndo, "ACK, seq# = %d", seq_no)); - inner_len = 0; - bp += 8; - len -= 8; - } else { - /* ZEP v2 data, or some other. */ - ND_TCHECK2(*bp, 32); - - ND_PRINT((ndo, "Type %d, Channel ID %d, Device ID 0x%04x, ", - *(bp + 3), *(bp + 4), EXTRACT_16BITS(bp + 5))); - if (*(bp + 7)) - ND_PRINT((ndo, "CRC, ")); - else - ND_PRINT((ndo, "LQI %d, ", *(bp + 8))); - - zep_print_ts(ndo, bp + 9); - seq_no = EXTRACT_32BITS(bp + 17); - inner_len = *(bp + 31); - ND_PRINT((ndo, ", seq# = %d, inner len = %d", seq_no, inner_len)); - bp += 32; - len -= 32; - } - } - - if (inner_len != 0) { - /* Call 802.15.4 dissector. */ - ND_PRINT((ndo, "\n\t")); - if (ieee802_15_4_print(ndo, bp, inner_len)) { - bp += len; - len = 0; - } - } - - if (!ndo->ndo_suppress_default_print) - ND_DEFAULTPRINT(bp, len); - - return; - trunc: - ND_PRINT((ndo, " [|ZEP]")); + uint8_t version, inner_len; + uint32_t seq_no; + + ndo->ndo_protocol = "zep"; + + nd_print_protocol_caps(ndo); + + /* Preamble Code (must be "EX") */ + if (GET_U_1(bp) != 'E' || GET_U_1(bp + 1) != 'X') { + ND_PRINT(" [Preamble Code: "); + fn_print_char(ndo, GET_U_1(bp)); + fn_print_char(ndo, GET_U_1(bp + 1)); + ND_PRINT("]"); + nd_print_invalid(ndo); + return; + } + + version = GET_U_1(bp + 2); + ND_PRINT("v%u ", version); + + if (version == 1) { + /* ZEP v1 packet. */ + ND_PRINT("Channel ID %u, Device ID 0x%04x, ", + GET_U_1(bp + 3), GET_BE_U_2(bp + 4)); + if (GET_U_1(bp + 6)) + ND_PRINT("CRC, "); + else + ND_PRINT("LQI %u, ", GET_U_1(bp + 7)); + inner_len = GET_U_1(bp + 15); + ND_PRINT("inner len = %u", inner_len); + + bp += 16; + len -= 16; + } else { + /* ZEP v2 packet. */ + if (GET_U_1(bp + 3) == 2) { + /* ZEP v2 ack. */ + seq_no = GET_BE_U_4(bp + 4); + ND_PRINT("ACK, seq# = %u", seq_no); + inner_len = 0; + bp += 8; + len -= 8; + } else { + /* ZEP v2 data, or some other. */ + ND_PRINT("Type %u, Channel ID %u, Device ID 0x%04x, ", + GET_U_1(bp + 3), GET_U_1(bp + 4), + GET_BE_U_2(bp + 5)); + if (GET_U_1(bp + 7)) + ND_PRINT("CRC, "); + else + ND_PRINT("LQI %u, ", GET_U_1(bp + 8)); + + zep_print_ts(ndo, bp + 9); + seq_no = GET_BE_U_4(bp + 17); + inner_len = GET_U_1(bp + 31); + ND_PRINT(", seq# = %u, inner len = %u", + seq_no, inner_len); + bp += 32; + len -= 32; + } + } + + if (inner_len != 0) { + /* Call 802.15.4 dissector. */ + ND_PRINT("\n\t"); + if (ieee802_15_4_print(ndo, bp, inner_len)) { + bp += len; + len = 0; + } + } + + if (!ndo->ndo_suppress_default_print) + ND_DEFAULTPRINT(bp, len); }