From f7b5fc832288fae3f5a0f3d24b96782252aabbaf Mon Sep 17 00:00:00 2001 From: Daniel Baumann Date: Sun, 5 May 2024 19:41:34 +0200 Subject: Adding upstream version 4.99.3. Signed-off-by: Daniel Baumann --- print-geonet.c | 267 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 267 insertions(+) create mode 100644 print-geonet.c (limited to 'print-geonet.c') diff --git a/print-geonet.c b/print-geonet.c new file mode 100644 index 0000000..2f8046e --- /dev/null +++ b/print-geonet.c @@ -0,0 +1,267 @@ +/* + * Copyright (c) 2013 The TCPDUMP project + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that: (1) source code + * distributions retain the above copyright notice and this paragraph + * in its entirety, and (2) distributions including binary code include + * the above copyright notice and this paragraph in its entirety in + * the documentation or other materials provided with the distribution. + * THIS SOFTWARE IS PROVIDED ``AS IS'' AND + * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT + * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS + * FOR A PARTICULAR PURPOSE. + * + * Original code by Ola Martin Lykkja (ola.lykkja@q-free.com) + */ + +/* \summary: ISO CALM FAST and ETSI GeoNetworking printer */ + +#ifdef HAVE_CONFIG_H +#include +#endif + +#include "netdissect-stdinc.h" + +#define ND_LONGJMP_FROM_TCHECK +#include "netdissect.h" +#include "extract.h" +#include "addrtoname.h" + + +/* + ETSI TS 102 636-5-1 V1.1.1 (2011-02) + Intelligent Transport Systems (ITS); Vehicular Communications; GeoNetworking; + Part 5: Transport Protocols; Sub-part 1: Basic Transport Protocol + + ETSI TS 102 636-4-1 V1.1.1 (2011-06) + Intelligent Transport Systems (ITS); Vehicular communications; GeoNetworking; + Part 4: Geographical addressing and forwarding for point-to-point and point-to-multipoint communications; + Sub-part 1: Media-Independent Functionality +*/ + +#define GEONET_ADDR_LEN 8 + +static const struct tok msg_type_values[] = { + { 0, "CAM" }, + { 1, "DENM" }, + { 101, "TPEGM" }, + { 102, "TSPDM" }, + { 103, "VPM" }, + { 104, "SRM" }, + { 105, "SLAM" }, + { 106, "ecoCAM" }, + { 107, "ITM" }, + { 150, "SA" }, + { 0, NULL } +}; + +static void +print_btp_body(netdissect_options *ndo, + const u_char *bp) +{ + u_int msg_type; + + /* Assuming ItsPduHeader */ + ND_PRINT("; ItsPduHeader v:%u", GET_U_1(bp)); + + msg_type = GET_U_1(bp + 1); + ND_PRINT(" t:%u-%s", msg_type, + tok2str(msg_type_values, "unknown (%u)", msg_type)); +} + +/* EN 302 636-5-1 V2.2.1 Section 7.2: BTP-A header */ +static void +print_btp(netdissect_options *ndo, + const u_char *bp) +{ + ND_PRINT("; BTP Dst:%u", GET_BE_U_2(bp + 0)); + ND_PRINT(" Src:%u", GET_BE_U_2(bp + 2)); +} + +static void +print_long_pos_vector(netdissect_options *ndo, + const u_char *bp) +{ + ND_PRINT("GN_ADDR:%s ", GET_LINKADDR_STRING(bp, LINKADDR_OTHER, GEONET_ADDR_LEN)); + ND_PRINT("lat:%u ", GET_BE_U_4(bp + 12)); + ND_PRINT("lon:%u", GET_BE_U_4(bp + 16)); +} + + +/* + * This is the top level routine of the printer. 'p' points + * to the geonet header of the packet. + */ +void +geonet_print(netdissect_options *ndo, const u_char *bp, u_int length, + const struct lladdr_info *src) +{ + u_int version; + u_int next_hdr; + u_int hdr_type; + u_int hdr_subtype; + uint16_t payload_length; + u_int hop_limit; + const char *next_hdr_txt = "Unknown"; + 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)); + ND_PRINT("; "); + + /* Process Common Header */ + if (length < 36) { + ND_PRINT(" (common header length %u < 36)", length); + goto invalid; + } + + 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; + case 1: next_hdr_txt = "BTP-A"; break; + case 2: next_hdr_txt = "BTP-B"; break; + case 3: next_hdr_txt = "IPv6"; break; + } + + switch (hdr_type) { + case 0: hdr_type_txt = "Any"; break; + case 1: hdr_type_txt = "Beacon"; break; + case 2: hdr_type_txt = "GeoUnicast"; break; + case 3: switch (hdr_subtype) { + case 0: hdr_type_txt = "GeoAnycastCircle"; break; + case 1: hdr_type_txt = "GeoAnycastRect"; break; + case 2: hdr_type_txt = "GeoAnycastElipse"; break; + } + break; + case 4: switch (hdr_subtype) { + case 0: hdr_type_txt = "GeoBroadcastCircle"; break; + case 1: hdr_type_txt = "GeoBroadcastRect"; break; + case 2: hdr_type_txt = "GeoBroadcastElipse"; break; + } + break; + case 5: switch (hdr_subtype) { + case 0: hdr_type_txt = "TopoScopeBcast-SH"; break; + case 1: hdr_type_txt = "TopoScopeBcast-MH"; break; + } + break; + case 6: switch (hdr_subtype) { + case 0: hdr_type_txt = "LocService-Request"; break; + case 1: hdr_type_txt = "LocService-Reply"; break; + } + break; + } + + ND_PRINT("v:%u ", version); + ND_PRINT("NH:%u-%s ", next_hdr, next_hdr_txt); + ND_PRINT("HT:%u-%u-%s ", hdr_type, hdr_subtype, hdr_type_txt); + ND_PRINT("HopLim:%u ", hop_limit); + ND_PRINT("Payload:%u ", payload_length); + print_long_pos_vector(ndo, bp + 8); + + /* Skip Common Header */ + ND_TCHECK_LEN(bp, 36); + length -= 36; + bp += 36; + + /* Process Extended Headers */ + switch (hdr_type) { + case 0: /* Any */ + hdr_size = 0; + break; + case 1: /* Beacon */ + hdr_size = 0; + break; + case 2: /* GeoUnicast */ + break; + case 3: switch (hdr_subtype) { + case 0: /* GeoAnycastCircle */ + break; + case 1: /* GeoAnycastRect */ + break; + case 2: /* GeoAnycastElipse */ + break; + } + break; + case 4: switch (hdr_subtype) { + case 0: /* GeoBroadcastCircle */ + break; + case 1: /* GeoBroadcastRect */ + break; + case 2: /* GeoBroadcastElipse */ + break; + } + break; + case 5: switch (hdr_subtype) { + case 0: /* TopoScopeBcast-SH */ + hdr_size = 0; + break; + case 1: /* TopoScopeBcast-MH */ + hdr_size = 68 - 36; + break; + } + break; + case 6: switch (hdr_subtype) { + case 0: /* LocService-Request */ + break; + case 1: /* LocService-Reply */ + break; + } + break; + } + + /* Skip Extended headers */ + if (hdr_size >= 0) { + if (length < (u_int)hdr_size) { + ND_PRINT(" (header size %d > %u)", hdr_size, length); + goto invalid; + } + ND_TCHECK_LEN(bp, hdr_size); + length -= hdr_size; + bp += hdr_size; + switch (next_hdr) { + case 0: /* Any */ + break; + case 1: + case 2: /* BTP A/B */ + if (length < 4) { + ND_PRINT(" (BTP length %u < 4)", length); + goto invalid; + } + print_btp(ndo, bp); + length -= 4; + bp += 4; + if (length >= 2) { + /* + * XXX - did print_btp_body() + * return if length < 2 + * because this is optional, + * or was that just not + * reporting genuine errors? + */ + print_btp_body(ndo, bp); + } + break; + case 3: /* IPv6 */ + break; + } + } + + /* Print user data part */ + if (ndo->ndo_vflag) + ND_DEFAULTPRINT(bp, length); + return; + +invalid: + nd_print_invalid(ndo); + /* XXX - print the remaining data as hex? */ +} -- cgit v1.2.3