wireshark/epan/dissectors/packet-lisp-data.c

297 lines
11 KiB
C

/* packet-lisp-data.c
* Routines for LISP Data Message dissection
* Copyright 2010, Lorand Jakab <lj@lispmon.net>
*
* Wireshark - Network traffic analyzer
* By Gerald Combs <gerald@wireshark.org>
* Copyright 1998 Gerald Combs
*
* SPDX-License-Identifier: GPL-2.0-or-later
*/
#include "config.h"
#include <epan/packet.h>
#include <epan/expert.h>
void proto_register_lisp_data(void);
void proto_reg_handoff_lisp_data(void);
/* See RFC 6830 "Locator/ID Separation Protocol (LISP)" */
/* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* |N|L|E|V|I|flags| Nonce/Map-Version |
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* | Instance ID/Locator Status Bits |
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
*/
#define LISP_CONTROL_PORT 4342
#define LISP_DATA_PORT 4341
#define LISP_DATA_HEADER_LEN 8 /* Number of bytes in LISP data header */
#define LISP_DATA_FLAGS_WIDTH 8 /* Width (in bits) of the flags field */
#define LISP_DATA_FLAG_N 0x80 /* Nonce present */
#define LISP_DATA_FLAG_L 0x40 /* Locator-Status-Bits field enabled */
#define LISP_DATA_FLAG_E 0x20 /* Echo-Nonce-Request */
#define LISP_DATA_FLAG_V 0x10 /* Map-Version present */
#define LISP_DATA_FLAG_I 0x08 /* Instance ID present */
#define LISP_DATA_FLAG_RES 0x07 /* Reserved */
/* Initialize the protocol and registered fields */
static int proto_lisp_data = -1;
static int hf_lisp_data_flags = -1;
static int hf_lisp_data_flags_nonce = -1;
static int hf_lisp_data_flags_lsb = -1;
static int hf_lisp_data_flags_enr = -1;
static int hf_lisp_data_flags_mv = -1;
static int hf_lisp_data_flags_iid = -1;
static int hf_lisp_data_flags_res = -1;
static int hf_lisp_data_nonce = -1;
static int hf_lisp_data_mapver = -1;
static int hf_lisp_data_srcmapver = -1;
static int hf_lisp_data_dstmapver = -1;
static int hf_lisp_data_iid = -1;
static int hf_lisp_data_lsb = -1;
static int hf_lisp_data_lsb8 = -1;
/* Initialize the subtree pointers */
static gint ett_lisp_data = -1;
static gint ett_lisp_data_flags = -1;
static gint ett_lisp_data_mapver = -1;
static expert_field ei_lisp_data_flags_en_invalid = EI_INIT;
static expert_field ei_lisp_data_flags_nv_invalid = EI_INIT;
static dissector_handle_t ipv4_handle;
static dissector_handle_t ipv6_handle;
static dissector_handle_t lisp_handle;
/* Code to actually dissect the packets */
static int
dissect_lisp_data(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_)
{
gint offset = 0;
guint8 flags;
guint8 ip_ver;
tvbuff_t *next_tvb;
proto_item *ti;
proto_item *tif;
proto_tree *lisp_data_tree;
proto_tree *lisp_data_flags_tree;
/* Check if we have a LISP control packet */
if (pinfo->destport == LISP_CONTROL_PORT)
return call_dissector(lisp_handle, tvb, pinfo, tree);
/* Check that there's enough data */
if (tvb_reported_length(tvb) < LISP_DATA_HEADER_LEN)
return 0;
/* Make entries in Protocol column and Info column on summary display */
col_set_str(pinfo->cinfo, COL_PROTOCOL, "LISP");
col_set_str(pinfo->cinfo, COL_INFO, "LISP Encapsulation Header");
/* create display subtree for the protocol */
ti = proto_tree_add_item(tree, proto_lisp_data, tvb, 0,
LISP_DATA_HEADER_LEN, ENC_NA);
lisp_data_tree = proto_item_add_subtree(ti, ett_lisp_data);
tif = proto_tree_add_item(lisp_data_tree,
hf_lisp_data_flags, tvb, offset, 1, ENC_BIG_ENDIAN);
lisp_data_flags_tree = proto_item_add_subtree(tif, ett_lisp_data_flags);
proto_tree_add_item(lisp_data_flags_tree,
hf_lisp_data_flags_nonce, tvb, offset, 1, ENC_BIG_ENDIAN);
proto_tree_add_item(lisp_data_flags_tree,
hf_lisp_data_flags_lsb, tvb, offset, 1, ENC_BIG_ENDIAN);
proto_tree_add_item(lisp_data_flags_tree,
hf_lisp_data_flags_enr, tvb, offset, 1, ENC_BIG_ENDIAN);
proto_tree_add_item(lisp_data_flags_tree,
hf_lisp_data_flags_mv, tvb, offset, 1, ENC_BIG_ENDIAN);
proto_tree_add_item(lisp_data_flags_tree,
hf_lisp_data_flags_iid, tvb, offset, 1, ENC_BIG_ENDIAN);
proto_tree_add_item(lisp_data_flags_tree,
hf_lisp_data_flags_res, tvb, offset, 1, ENC_BIG_ENDIAN);
flags = tvb_get_guint8(tvb, offset);
offset += 1;
if (flags&LISP_DATA_FLAG_E && !(flags&LISP_DATA_FLAG_N)) {
expert_add_info(pinfo, tif, &ei_lisp_data_flags_en_invalid);
}
if (flags&LISP_DATA_FLAG_N) {
if (flags&LISP_DATA_FLAG_V) {
expert_add_info(pinfo, tif, &ei_lisp_data_flags_nv_invalid);
}
proto_tree_add_item(lisp_data_tree,
hf_lisp_data_nonce, tvb, offset, 3, ENC_BIG_ENDIAN);
} else {
if (flags&LISP_DATA_FLAG_V) {
proto_item *tiv;
proto_tree *lisp_data_mapver_tree;
tiv = proto_tree_add_item(lisp_data_tree,
hf_lisp_data_mapver, tvb, offset, 3, ENC_BIG_ENDIAN);
lisp_data_mapver_tree = proto_item_add_subtree(tiv, ett_lisp_data_mapver);
proto_tree_add_item(lisp_data_mapver_tree,
hf_lisp_data_srcmapver, tvb, offset, 3, ENC_BIG_ENDIAN);
proto_tree_add_item(lisp_data_mapver_tree,
hf_lisp_data_dstmapver, tvb, offset, 3, ENC_BIG_ENDIAN);
}
}
offset += 3;
if (flags&LISP_DATA_FLAG_I) {
proto_tree_add_item(lisp_data_tree,
hf_lisp_data_iid, tvb, offset, 3, ENC_BIG_ENDIAN);
offset += 3;
if (flags&LISP_DATA_FLAG_L) {
proto_tree_add_item(lisp_data_tree,
hf_lisp_data_lsb8, tvb, offset, 1, ENC_BIG_ENDIAN);
}
/*offset +=1;*/
} else {
if (flags&LISP_DATA_FLAG_L) {
proto_tree_add_item(lisp_data_tree,
hf_lisp_data_lsb, tvb, offset, 4, ENC_BIG_ENDIAN);
/*offset += 4;*/
}
}
/* Check if there is stuff left in the buffer, and return if not */
/* Determine if encapsulated packet is IPv4 or IPv6, and call dissector */
next_tvb = tvb_new_subset_remaining(tvb, LISP_DATA_HEADER_LEN);
ip_ver = tvb_get_bits8(next_tvb, 0, 4);
switch (ip_ver) {
case 4:
call_dissector(ipv4_handle, next_tvb, pinfo, tree);
return tvb_reported_length(tvb);
case 6:
call_dissector(ipv6_handle, next_tvb, pinfo, tree);
return tvb_reported_length(tvb);
}
/* Return the amount of data this dissector was able to dissect */
return LISP_DATA_HEADER_LEN;
}
/* Register the protocol with Wireshark */
void
proto_register_lisp_data(void)
{
/* Setup list of header fields */
static hf_register_info hf[] = {
{ &hf_lisp_data_flags,
{ "Flags", "lisp-data.flags",
FT_UINT8, BASE_HEX, NULL, 0x0, "LISP Data Header Flags", HFILL }},
{ &hf_lisp_data_flags_nonce,
{ "N bit (Nonce present)", "lisp-data.flags.nonce",
FT_BOOLEAN, LISP_DATA_FLAGS_WIDTH, TFS(&tfs_set_notset),
LISP_DATA_FLAG_N, NULL, HFILL }},
{ &hf_lisp_data_flags_lsb,
{ "L bit (Locator-Status-Bits field enabled)", "lisp-data.flags.lsb",
FT_BOOLEAN, LISP_DATA_FLAGS_WIDTH, TFS(&tfs_set_notset),
LISP_DATA_FLAG_L, NULL, HFILL }},
{ &hf_lisp_data_flags_enr,
{ "E bit (Echo-Nonce-Request)", "lisp-data.flags.enr",
FT_BOOLEAN, LISP_DATA_FLAGS_WIDTH, TFS(&tfs_set_notset),
LISP_DATA_FLAG_E, NULL, HFILL }},
{ &hf_lisp_data_flags_mv,
{ "V bit (Map-Version present)", "lisp-data.flags.mv",
FT_BOOLEAN, LISP_DATA_FLAGS_WIDTH, TFS(&tfs_set_notset),
LISP_DATA_FLAG_V, NULL, HFILL }},
{ &hf_lisp_data_flags_iid,
{ "I bit (Instance ID present)", "lisp-data.flags.iid",
FT_BOOLEAN, LISP_DATA_FLAGS_WIDTH, TFS(&tfs_set_notset),
LISP_DATA_FLAG_I, NULL, HFILL }},
{ &hf_lisp_data_flags_res,
{ "Reserved", "lisp-data.flags.res",
FT_UINT8, BASE_HEX, NULL,
LISP_DATA_FLAG_RES, "Must be zero", HFILL }},
{ &hf_lisp_data_nonce,
{ "Nonce", "lisp-data.nonce",
FT_UINT24, BASE_DEC_HEX, NULL, 0x0, NULL, HFILL }},
{ &hf_lisp_data_mapver,
{ "Map-Version", "lisp-data.mapver",
FT_UINT24, BASE_HEX, NULL, 0x0, NULL, HFILL }},
{ &hf_lisp_data_srcmapver,
{ "Source Map-Version", "lisp-data.srcmapver",
FT_UINT24, BASE_DEC, NULL, 0xFFF000, NULL, HFILL }},
{ &hf_lisp_data_dstmapver,
{ "Destination Map-Version", "lisp-data.dstmapver",
FT_UINT24, BASE_DEC, NULL, 0x000FFF, NULL, HFILL }},
{ &hf_lisp_data_iid,
{ "Instance ID", "lisp-data.iid",
FT_UINT24, BASE_DEC, NULL, 0x0, NULL, HFILL }},
{ &hf_lisp_data_lsb,
{ "Locator-Status-Bits", "lisp-data.lsb",
FT_UINT32, BASE_HEX, NULL, 0xFFFFFFFF, NULL, HFILL }},
{ &hf_lisp_data_lsb8,
{ "Locator-Status-Bits", "lisp-data.lsb8",
FT_UINT8, BASE_HEX, NULL, 0xFF, NULL, HFILL }}
};
/* Setup protocol subtree array */
static gint *ett[] = {
&ett_lisp_data,
&ett_lisp_data_flags,
&ett_lisp_data_mapver
};
static ei_register_info ei[] = {
{ &ei_lisp_data_flags_en_invalid, { "lisp-data.flags.en_invalid", PI_PROTOCOL, PI_WARN, "Invalid flag combination: if E is set, N MUST be set", EXPFILL }},
{ &ei_lisp_data_flags_nv_invalid, { "lisp-data.flags.nv_invalid", PI_PROTOCOL, PI_WARN, "Invalid flag combination: N and V can't be set both", EXPFILL }},
};
expert_module_t* expert_lisp_data;
/* Register the protocol name and description */
proto_lisp_data = proto_register_protocol("Locator/ID Separation Protocol (Data)",
"LISP Data", "lisp-data");
/* Required function calls to register the header fields and subtrees used */
proto_register_field_array(proto_lisp_data, hf, array_length(hf));
proto_register_subtree_array(ett, array_length(ett));
expert_lisp_data = expert_register_protocol(proto_lisp_data);
expert_register_field_array(expert_lisp_data, ei, array_length(ei));
}
/* Simple form of proto_reg_handoff_lisp_data which can be used if there are
no prefs-dependent registration function calls.
*/
void
proto_reg_handoff_lisp_data(void)
{
dissector_handle_t lisp_data_handle;
lisp_data_handle = create_dissector_handle(dissect_lisp_data,
proto_lisp_data);
dissector_add_uint_with_preference("udp.port", LISP_DATA_PORT, lisp_data_handle);
ipv4_handle = find_dissector_add_dependency("ip", proto_lisp_data);
ipv6_handle = find_dissector_add_dependency("ipv6", proto_lisp_data);
lisp_handle = find_dissector_add_dependency("lisp", proto_lisp_data);
}
/*
* Editor modelines - https://www.wireshark.org/tools/modelines.html
*
* Local variables:
* c-basic-offset: 4
* tab-width: 8
* indent-tabs-mode: nil
* End:
*
* vi: set shiftwidth=4 tabstop=8 expandtab:
* :indentSize=4:tabSize=8:noTabs=true:
*/