aboutsummaryrefslogtreecommitdiffstats
path: root/epan/dissectors/packet-loratap.c
diff options
context:
space:
mode:
Diffstat (limited to 'epan/dissectors/packet-loratap.c')
-rw-r--r--epan/dissectors/packet-loratap.c266
1 files changed, 220 insertions, 46 deletions
diff --git a/epan/dissectors/packet-loratap.c b/epan/dissectors/packet-loratap.c
index daa9c866de..3e3e1315e0 100644
--- a/epan/dissectors/packet-loratap.c
+++ b/epan/dissectors/packet-loratap.c
@@ -3,6 +3,10 @@
* By Erik de Jong <erikdejong@gmail.com>
* Copyright 2017 Erik de Jong
*
+ * LoRaTap encapsulation, version 1
+ * By Ales Povalac <alpov@alpov.net>
+ * Copyright 2022 Ales Povalac
+ *
* Wireshark - Network traffic analyzer
* By Gerald Combs <gerald@wireshark.org>
* Copyright 1998 Gerald Combs
@@ -11,11 +15,11 @@
*/
#include "config.h"
-#include <wiretap/wtap.h>
#include <epan/packet.h>
#include <epan/capture_dissectors.h>
#include <epan/decode_as.h>
#include <epan/proto_data.h>
+#include <epan/to_str.h>
void proto_reg_handoff_loratap(void);
void proto_register_loratap(void);
@@ -24,54 +28,98 @@ static dissector_handle_t loratap_handle;
static dissector_table_t loratap_dissector_table;
-static int proto_loratap = -1;
-static int hf_loratap_header_version_type = -1;
-static int hf_loratap_header_length_type = -1;
-static int hf_loratap_header_padding = -1;
-static int hf_loratap_header_channel_type = -1;
-static int hf_loratap_header_channel_frequency_type = -1;
-static int hf_loratap_header_channel_bandwidth_type = -1;
-static int hf_loratap_header_channel_sf_type = -1;
-static int hf_loratap_header_rssi_type = -1;
-static int hf_loratap_header_rssi_packet_type = -1;
-static int hf_loratap_header_rssi_max_type = -1;
-static int hf_loratap_header_rssi_current_type = -1;
-static int hf_loratap_header_rssi_snr_type = -1;
-static int hf_loratap_header_syncword_type = -1;
+static int proto_loratap;
+static int hf_loratap_header_version_type;
+static int hf_loratap_header_length_type;
+static int hf_loratap_header_padding;
+static int hf_loratap_header_channel_type;
+static int hf_loratap_header_channel_frequency_type;
+static int hf_loratap_header_channel_bandwidth_type;
+static int hf_loratap_header_channel_sf_type;
+static int hf_loratap_header_rssi_type;
+static int hf_loratap_header_rssi_packet_type;
+static int hf_loratap_header_rssi_max_type;
+static int hf_loratap_header_rssi_current_type;
+static int hf_loratap_header_rssi_snr_type;
+static int hf_loratap_header_syncword_type;
+static int hf_loratap_header_tag_type;
+static int hf_loratap_header_payload_type;
+static int hf_loratap_header_source_gw_type;
+static int hf_loratap_header_timestamp_type;
+static int hf_loratap_header_datarate_type;
+static int hf_loratap_header_if_channel_type;
+static int hf_loratap_header_rf_chain_type;
+static int hf_loratap_header_cr_type;
+static int hf_loratap_header_flags_type;
+static int hf_loratap_header_flags_mod_fsk_type;
+static int hf_loratap_header_flags_iq_inverted_type;
+static int hf_loratap_header_flags_implicit_hdr_type;
+static int hf_loratap_header_flags_crc_type;
+static int hf_loratap_header_flags_padding_type;
-static gint ett_loratap = -1;
+static int * const hfx_loratap_header_flags[] = {
+ &hf_loratap_header_flags_mod_fsk_type,
+ &hf_loratap_header_flags_iq_inverted_type,
+ &hf_loratap_header_flags_implicit_hdr_type,
+ &hf_loratap_header_flags_crc_type,
+ &hf_loratap_header_flags_padding_type,
+ NULL
+};
+
+static gint ett_loratap;
+static gint ett_loratap_flags;
+static gint ett_loratap_channel;
+static gint ett_loratap_rssi;
static const value_string channel_bandwidth[] = {
- { 1, "125 KHz" },
- { 2, "250 KHz" },
- { 4, "500 KHz" },
+ { 1, "125 kHz" },
+ { 2, "250 kHz" },
+ { 4, "500 kHz" },
{ 0, NULL}
};
static const value_string syncwords[] = {
+ { 0x12, "Private LoRa" },
{ 0x34, "LoRaWAN" },
{ 0, NULL}
};
-static void
-rssi_base_custom(gchar *buffer, guint32 value) {
- g_snprintf(buffer, ITEM_LABEL_LENGTH, "%.0f dBm", -139 + (float)value);
-}
+static const value_string coding_rates[] = {
+ { 0, "none" },
+ { 5, "4/5" },
+ { 6, "4/6" },
+ { 7, "4/7" },
+ { 8, "4/8" },
+ { 0, NULL}
+};
+
+static const value_string crc_state[] = {
+ { 1, "CRC OK" },
+ { 2, "CRC Bad" },
+ { 4, "No CRC" },
+ { 0, NULL}
+};
static void
-snr_base_custom(gchar *buffer, guint32 value) {
- if( value & 0x80 ) {
- value = ( ( ~value + 1 ) & 0xFF ) >> 2;
+rssi_base_custom(gchar *buffer, guint32 value)
+{
+ if (value == 255) {
+ snprintf(buffer, ITEM_LABEL_LENGTH, "N/A");
} else {
- value = ( value & 0xFF ) >> 2;
+ snprintf(buffer, ITEM_LABEL_LENGTH, "%.0f dBm", -139. + (float)value);
}
- g_snprintf(buffer, ITEM_LABEL_LENGTH, "%d dB", value);
+}
+
+static void
+snr_base_custom(gchar *buffer, guint32 value)
+{
+ snprintf(buffer, ITEM_LABEL_LENGTH, "%.1f dB", ((gint8)value) / 4.);
}
static void
loratap_prompt(packet_info *pinfo, gchar* result)
{
- g_snprintf(result, MAX_DECODE_AS_PROMPT_LEN, "LoRaTap syncword 0x%02x as", GPOINTER_TO_UINT(p_get_proto_data(pinfo->pool, pinfo, proto_loratap, 0)));
+ snprintf(result, MAX_DECODE_AS_PROMPT_LEN, "LoRaTap syncword 0x%02x as", GPOINTER_TO_UINT(p_get_proto_data(pinfo->pool, pinfo, proto_loratap, 0)));
}
static gpointer
@@ -86,31 +134,61 @@ dissect_loratap(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree _U_, void *d
proto_item *ti, *channel_item, *rssi_item;
proto_tree *loratap_tree, *channel_tree, *rssi_tree;
gint32 current_offset = 0;
+ gint32 header_v1_offset = 15;
guint16 length;
+ guint32 lt_length, lt_version;
+ gboolean try_dissect;
guint32 syncword;
tvbuff_t *next_tvb;
col_set_str(pinfo->cinfo, COL_PROTOCOL, "LoRaTap");
- col_clear(pinfo->cinfo,COL_INFO);
+ col_clear(pinfo->cinfo, COL_INFO);
length = tvb_get_guint16(tvb, 2, ENC_BIG_ENDIAN);
+
ti = proto_tree_add_item(tree, proto_loratap, tvb, 0, length, ENC_NA);
loratap_tree = proto_item_add_subtree(ti, ett_loratap);
- proto_tree_add_item(loratap_tree, hf_loratap_header_version_type, tvb, current_offset, 1, ENC_NA);
+ proto_tree_add_item_ret_uint(loratap_tree, hf_loratap_header_version_type, tvb, current_offset, 1, ENC_NA, &lt_version);
current_offset++;
proto_tree_add_item(loratap_tree, hf_loratap_header_padding, tvb, current_offset, 1, ENC_NA);
current_offset++;
- proto_tree_add_item(loratap_tree, hf_loratap_header_length_type, tvb, current_offset, 2, ENC_NA);
+ proto_tree_add_item_ret_uint(loratap_tree, hf_loratap_header_length_type, tvb, current_offset, 2, ENC_NA, &lt_length);
current_offset += 2;
- channel_item = proto_tree_add_item(loratap_tree, hf_loratap_header_channel_type, tvb, current_offset, 6, ENC_NA);
- channel_tree = proto_item_add_subtree(channel_item, ett_loratap);
+ if (lt_version == 1) {
+ proto_tree_add_item(loratap_tree, hf_loratap_header_source_gw_type, tvb, header_v1_offset, 8, ENC_NA);
+ set_address_tvb(&pinfo->dl_src, AT_EUI64, 8, tvb, header_v1_offset);
+ copy_address_shallow(&pinfo->src, &pinfo->dl_src);
+ proto_item_append_text(ti, ", Src: %s", address_to_display(pinfo->pool, &pinfo->src));
+ header_v1_offset += 8;
+ proto_tree_add_item(loratap_tree, hf_loratap_header_timestamp_type, tvb, header_v1_offset, 4, ENC_NA);
+ header_v1_offset += 4;
+ proto_tree_add_bitmask(loratap_tree, tvb, header_v1_offset, hf_loratap_header_flags_type, ett_loratap_flags, hfx_loratap_header_flags, ENC_NA);
+ try_dissect = (tvb_get_guint8(tvb, header_v1_offset) & 0x28); /* Only try the next dissector for CRC OK and No CRC packets with v1 encapsulation */
+ header_v1_offset++;
+ } else {
+ try_dissect = true; /* Always try the next dissector for v0 encapsulation */
+ }
+
+ channel_item = proto_tree_add_item(loratap_tree, hf_loratap_header_channel_type, tvb, current_offset, 0, ENC_NA);
+ channel_tree = proto_item_add_subtree(channel_item, ett_loratap_channel);
proto_tree_add_item(channel_tree, hf_loratap_header_channel_frequency_type, tvb, current_offset, 4, ENC_NA);
current_offset += 4;
proto_tree_add_item(channel_tree, hf_loratap_header_channel_bandwidth_type, tvb, current_offset, 1, ENC_NA);
current_offset++;
proto_tree_add_item(channel_tree, hf_loratap_header_channel_sf_type, tvb, current_offset, 1, ENC_NA);
current_offset++;
- rssi_item = proto_tree_add_item(loratap_tree, hf_loratap_header_rssi_type, tvb, current_offset, 4, ENC_NA);
- rssi_tree = proto_item_add_subtree(rssi_item, ett_loratap);
+ if (lt_version == 1) {
+ proto_tree_add_item(channel_tree, hf_loratap_header_cr_type, tvb, header_v1_offset, 1, ENC_NA);
+ header_v1_offset++;
+ proto_tree_add_item(channel_tree, hf_loratap_header_datarate_type, tvb, header_v1_offset, 2, ENC_NA);
+ header_v1_offset += 2;
+ proto_tree_add_item(channel_tree, hf_loratap_header_if_channel_type, tvb, header_v1_offset, 1, ENC_NA);
+ header_v1_offset++;
+ proto_tree_add_item(channel_tree, hf_loratap_header_rf_chain_type, tvb, header_v1_offset, 1, ENC_NA);
+ header_v1_offset++;
+ }
+
+ rssi_item = proto_tree_add_item(loratap_tree, hf_loratap_header_rssi_type, tvb, current_offset, 0, ENC_NA);
+ rssi_tree = proto_item_add_subtree(rssi_item, ett_loratap_rssi);
proto_tree_add_item(rssi_tree, hf_loratap_header_rssi_packet_type, tvb, current_offset, 1, ENC_NA);
current_offset++;
proto_tree_add_item(rssi_tree, hf_loratap_header_rssi_max_type, tvb, current_offset, 1, ENC_NA);
@@ -121,10 +199,19 @@ dissect_loratap(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree _U_, void *d
current_offset++;
proto_tree_add_item_ret_uint(loratap_tree, hf_loratap_header_syncword_type, tvb, current_offset, 1, ENC_NA, &syncword);
current_offset++;
+ if (lt_version == 1) {
+ proto_tree_add_item(loratap_tree, hf_loratap_header_tag_type, tvb, header_v1_offset, 2, ENC_NA);
+ }
+
+ /* Seek to data - skip lt_length of header, this allows future extensions */
+ current_offset = lt_length;
+ length = tvb_reported_length_remaining(tvb, lt_length);
+ proto_tree_add_bytes_format_value(loratap_tree, hf_loratap_header_payload_type, tvb, current_offset, length, NULL, "%d bytes", length);
+
p_add_proto_data(pinfo->pool, pinfo, proto_loratap, 0, GUINT_TO_POINTER((guint)syncword));
- next_tvb = tvb_new_subset_length_caplen(tvb, current_offset, tvb_captured_length_remaining(tvb, current_offset), tvb_reported_length_remaining(tvb, current_offset));
+ next_tvb = tvb_new_subset_length(tvb, current_offset, length);
- if (!dissector_try_uint_new(loratap_dissector_table, syncword, next_tvb, pinfo, tree, TRUE, NULL)) {
+ if (!try_dissect || !dissector_try_uint_new(loratap_dissector_table, syncword, next_tvb, pinfo, tree, TRUE, NULL)) {
call_data_dissector(next_tvb, pinfo, tree);
}
@@ -150,12 +237,12 @@ proto_register_loratap(void)
},
{ &hf_loratap_header_length_type,
{ "Header Length", "loratap.header_length",
- FT_UINT16, BASE_DEC,
- NULL, 0x0,
+ FT_UINT16, BASE_DEC|BASE_UNIT_STRING,
+ &units_byte_bytes, 0x0,
NULL, HFILL }
},
{ &hf_loratap_header_padding,
- { "Padding", "loratap.padding",
+ { "Header Padding", "loratap.padding",
FT_BYTES, BASE_NONE,
NULL, 0x0,
NULL, HFILL }
@@ -185,25 +272,25 @@ proto_register_loratap(void)
NULL, HFILL }
},
{ &hf_loratap_header_rssi_type,
- { "RSSI", "loratap.rssi",
+ { "RSSI / SNR", "loratap.rssi",
FT_NONE, BASE_NONE,
NULL, 0x0,
NULL, HFILL }
},
{ &hf_loratap_header_rssi_packet_type,
- { "Packet", "loratap.rssi.packet",
+ { "Packet RSSI", "loratap.rssi.packet",
FT_UINT8, BASE_CUSTOM,
CF_FUNC(rssi_base_custom), 0x0,
NULL, HFILL }
},
{ &hf_loratap_header_rssi_max_type,
- { "Max", "loratap.rssi.max",
+ { "Max RSSI", "loratap.rssi.max",
FT_UINT8, BASE_CUSTOM,
CF_FUNC(rssi_base_custom), 0x0,
NULL, HFILL }
},
{ &hf_loratap_header_rssi_current_type,
- { "Current", "loratap.rssi.current",
+ { "Current RSSI", "loratap.rssi.current",
FT_UINT8, BASE_CUSTOM,
CF_FUNC(rssi_base_custom), 0x0,
NULL, HFILL }
@@ -220,6 +307,90 @@ proto_register_loratap(void)
VALS(syncwords), 0x0,
NULL, HFILL }
},
+ { &hf_loratap_header_tag_type,
+ { "Tag", "loratap.tag",
+ FT_UINT16, BASE_DEC,
+ NULL, 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_payload_type,
+ { "Payload", "loratap.payload",
+ FT_BYTES, BASE_NONE,
+ NULL, 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_source_gw_type,
+ { "Source", "loratap.srcgw",
+ FT_BYTES, BASE_NONE,
+ NULL, 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_timestamp_type,
+ { "Timestamp", "loratap.timestamp",
+ FT_UINT32, BASE_DEC,
+ NULL, 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_datarate_type,
+ { "FSK datarate", "loratap.channel.datarate",
+ FT_UINT16, BASE_DEC|BASE_UNIT_STRING,
+ &units_bit_sec, 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_if_channel_type,
+ { "IF channel", "loratap.channel.if_channel",
+ FT_UINT8, BASE_DEC,
+ NULL, 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_rf_chain_type,
+ { "RF chain", "loratap.channel.rf_chain",
+ FT_UINT8, BASE_DEC,
+ NULL, 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_cr_type,
+ { "Coding Rate", "loratap.channel.cr",
+ FT_UINT8, BASE_DEC,
+ VALS(coding_rates), 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_flags_type,
+ { "Flags", "loratap.flags",
+ FT_UINT8, BASE_HEX,
+ NULL, 0x0,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_flags_mod_fsk_type,
+ { "FSK Modulation", "loratap.flags.mod_fsk",
+ FT_BOOLEAN, 8,
+ TFS(&tfs_set_notset), 0x01,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_flags_iq_inverted_type,
+ { "IQ Inverted", "loratap.flags.iq_inverted",
+ FT_BOOLEAN, 8,
+ TFS(&tfs_set_notset), 0x02,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_flags_implicit_hdr_type,
+ { "Implicit Header", "loratap.flags.implicit_hdr",
+ FT_BOOLEAN, 8,
+ TFS(&tfs_set_notset), 0x04,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_flags_crc_type,
+ { "Checksum", "loratap.flags.crc",
+ FT_UINT8, BASE_HEX,
+ VALS(crc_state), 0x38,
+ NULL, HFILL }
+ },
+ { &hf_loratap_header_flags_padding_type,
+ { "Padding", "loratap.flags.padding",
+ FT_UINT8, BASE_DEC,
+ NULL, 0xC0,
+ NULL, HFILL }
+ },
};
/* Register for decode as */
@@ -229,7 +400,10 @@ proto_register_loratap(void)
/* Setup protocol subtree array */
static gint *ett[] = {
- &ett_loratap
+ &ett_loratap,
+ &ett_loratap_flags,
+ &ett_loratap_channel,
+ &ett_loratap_rssi
};
proto_loratap = proto_register_protocol (
generated by cgit v1.2.3 (git 2.25.1) at 2024-04-20 01:21:10 +0000