X-Git-Url: https://git.tcpdump.org/tcpdump/blobdiff_plain/64677b0d78ff168d98c3035e894c4910c021136e..5ef0bcb5edd748de9d9af13c40da0395dfdd94e8:/print-geonet.c diff --git a/print-geonet.c b/print-geonet.c index ae0a9776..bd2fa056 100644 --- a/print-geonet.c +++ b/print-geonet.c @@ -18,10 +18,10 @@ /* \summary: ISO CALM FAST and ETSI GeoNetworking printer */ #ifdef HAVE_CONFIG_H -#include "config.h" +#include #endif -#include +#include "netdissect-stdinc.h" #include "netdissect.h" #include "extract.h" @@ -57,15 +57,16 @@ static const struct tok msg_type_values[] = { static void print_btp_body(netdissect_options *ndo, - const u_char *bp) + const u_char *bp) { u_int version; u_int msg_type; const char *msg_type_str; /* Assuming ItsDpuHeader */ - version = EXTRACT_U_1(bp); - msg_type = EXTRACT_U_1(bp + 1); + /* 2 bytes ND_TCHECKed in geonet_print() */ + version = GET_U_1(bp); + msg_type = GET_U_1(bp + 1); msg_type_str = tok2str(msg_type_values, "unknown (%u)", msg_type); ND_PRINT("; ItsPduHeader v:%u t:%u-%s", version, msg_type, msg_type_str); @@ -73,28 +74,25 @@ print_btp_body(netdissect_options *ndo, static void print_btp(netdissect_options *ndo, - const u_char *bp) + const u_char *bp) { - uint16_t dest = EXTRACT_BE_U_2(bp + 0); - uint16_t src = EXTRACT_BE_U_2(bp + 2); + /* 4 bytes ND_TCHECKed in geonet_print() */ + uint16_t dest = GET_BE_U_2(bp + 0); + uint16_t src = GET_BE_U_2(bp + 2); ND_PRINT("; BTP Dst:%u Src:%u", dest, src); } static int print_long_pos_vector(netdissect_options *ndo, - const u_char *bp) + const u_char *bp) { uint32_t lat, lon; - if (!ND_TTEST_LEN(bp, GEONET_ADDR_LEN)) - return (-1); - ND_PRINT("GN_ADDR:%s ", linkaddr_string (ndo, bp, 0, GEONET_ADDR_LEN)); + ND_PRINT("GN_ADDR:%s ", GET_LINKADDR_STRING(bp, LINKADDR_OTHER, GEONET_ADDR_LEN)); - if (!ND_TTEST_8(bp + 12)) - return (-1); - lat = EXTRACT_BE_U_4(bp + 12); + lat = GET_BE_U_4(bp + 12); ND_PRINT("lat:%u ", lat); - lon = EXTRACT_BE_U_4(bp + 16); + lon = GET_BE_U_4(bp + 16); ND_PRINT("lon:%u", lon); return (0); } @@ -118,6 +116,7 @@ geonet_print(netdissect_options *ndo, const u_char *bp, u_int length, const char *hdr_type_txt = "Unknown"; int hdr_size = -1; + ndo->ndo_protocol = "geonet"; ND_PRINT("GeoNet "); if (src != NULL) ND_PRINT("src:%s", (src->addr_string)(ndo, src->addr)); @@ -128,12 +127,12 @@ geonet_print(netdissect_options *ndo, const u_char *bp, u_int length, goto invalid; ND_TCHECK_8(bp); - version = EXTRACT_U_1(bp) >> 4; - next_hdr = EXTRACT_U_1(bp) & 0x0f; - hdr_type = EXTRACT_U_1(bp + 1) >> 4; - hdr_subtype = EXTRACT_U_1(bp + 1) & 0x0f; - payload_length = EXTRACT_BE_U_2(bp + 4); - hop_limit = EXTRACT_U_1(bp + 7); + version = GET_U_1(bp) >> 4; + next_hdr = GET_U_1(bp) & 0x0f; + hdr_type = GET_U_1(bp + 1) >> 4; + hdr_subtype = GET_U_1(bp + 1) & 0x0f; + payload_length = GET_BE_U_2(bp + 4); + hop_limit = GET_U_1(bp + 7); switch (next_hdr) { case 0: next_hdr_txt = "Any"; break; @@ -274,13 +273,5 @@ invalid: return; trunc: - ND_PRINT("[|geonet]"); + nd_print_trunc(ndo); } - - -/* - * Local Variables: - * c-style: whitesmith - * c-basic-offset: 8 - * End: - */