b636d99d91
For now, printing of Sun RPC requests is disabled because we do not yet have the RPC header files. This should affect basically noone, as we do not have any RPC-based programs yet, for the same reason. Change-Id: Ie7818faaaacdc104d8b2c37a68866b4ce18247d6
280 lines
6.6 KiB
C
280 lines
6.6 KiB
C
/*
|
|
* 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)
|
|
*/
|
|
|
|
#define NETDISSECT_REWORKED
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include <tcpdump-stdinc.h>
|
|
|
|
#include "interface.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)
|
|
{
|
|
int version;
|
|
int msg_type;
|
|
const char *msg_type_str;
|
|
|
|
/* Assuming ItsDpuHeader */
|
|
version = bp[0];
|
|
msg_type = bp[1];
|
|
msg_type_str = tok2str(msg_type_values, "unknown (%u)", msg_type);
|
|
|
|
ND_PRINT((ndo, "; ItsPduHeader v:%d t:%d-%s", version, msg_type, msg_type_str));
|
|
}
|
|
|
|
static void
|
|
print_btp(netdissect_options *ndo,
|
|
const u_char *bp)
|
|
{
|
|
uint16_t dest = EXTRACT_16BITS(bp+0);
|
|
uint16_t src = EXTRACT_16BITS(bp+2);
|
|
ND_PRINT((ndo, "; BTP Dst:%u Src:%u", dest, src));
|
|
}
|
|
|
|
static int
|
|
print_long_pos_vector(netdissect_options *ndo,
|
|
const u_char *bp)
|
|
{
|
|
uint32_t lat, lon;
|
|
|
|
ND_PRINT((ndo, "GN_ADDR:%s ", linkaddr_string (ndo, bp, 0, GEONET_ADDR_LEN)));
|
|
|
|
if (!ND_TTEST2(*(bp+12), 8))
|
|
return (-1);
|
|
lat = EXTRACT_32BITS(bp+12);
|
|
ND_PRINT((ndo, "lat:%d ", lat));
|
|
lon = EXTRACT_32BITS(bp+16);
|
|
ND_PRINT((ndo, "lon:%d", lon));
|
|
return (0);
|
|
}
|
|
|
|
|
|
/*
|
|
* 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 *eth, const u_char *bp, u_int length)
|
|
{
|
|
int version;
|
|
int next_hdr;
|
|
int hdr_type;
|
|
int hdr_subtype;
|
|
uint16_t payload_length;
|
|
int hop_limit;
|
|
const char *next_hdr_txt = "Unknown";
|
|
const char *hdr_type_txt = "Unknown";
|
|
int hdr_size = -1;
|
|
|
|
ND_PRINT((ndo, "GeoNet src:%s; ", etheraddr_string(ndo, eth+6)));
|
|
|
|
/* Process Common Header */
|
|
if (length < 36)
|
|
goto malformed;
|
|
|
|
ND_TCHECK2(*bp, 7);
|
|
version = bp[0] >> 4;
|
|
next_hdr = bp[0] & 0x0f;
|
|
hdr_type = bp[1] >> 4;
|
|
hdr_subtype = bp[1] & 0x0f;
|
|
payload_length = EXTRACT_16BITS(bp+4);
|
|
hop_limit = 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((ndo, "v:%d ", version));
|
|
ND_PRINT((ndo, "NH:%d-%s ", next_hdr, next_hdr_txt));
|
|
ND_PRINT((ndo, "HT:%d-%d-%s ", hdr_type, hdr_subtype, hdr_type_txt));
|
|
ND_PRINT((ndo, "HopLim:%d ", hop_limit));
|
|
ND_PRINT((ndo, "Payload:%d ", payload_length));
|
|
if (print_long_pos_vector(ndo, bp + 8) == -1)
|
|
goto trunc;
|
|
|
|
/* Skip Common Header */
|
|
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)
|
|
goto malformed;
|
|
ND_TCHECK2(*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)
|
|
goto malformed;
|
|
ND_TCHECK2(*bp, 4);
|
|
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?
|
|
*/
|
|
ND_TCHECK2(*bp, 2);
|
|
print_btp_body(ndo, bp);
|
|
}
|
|
break;
|
|
case 3: /* IPv6 */
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* Print user data part */
|
|
if (ndo->ndo_vflag)
|
|
ND_DEFAULTPRINT(bp, length);
|
|
return;
|
|
|
|
malformed:
|
|
ND_PRINT((ndo, " Malformed (small) "));
|
|
/* XXX - print the remaining data as hex? */
|
|
return;
|
|
|
|
trunc:
|
|
ND_PRINT((ndo, "[|geonet]"));
|
|
}
|
|
|
|
|
|
/*
|
|
* Local Variables:
|
|
* c-style: whitesmith
|
|
* c-basic-offset: 8
|
|
* End:
|
|
*/
|