summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorMichael Mann <mmann78@netscape.net>2013-04-04 12:22:04 +0000
committerMichael Mann <mmann78@netscape.net>2013-04-04 12:22:04 +0000
commit4e7e06ca3af407e583f7690dbb606b6f1ab4cbad (patch)
tree4cd74e357e1997daca9743c57db92bcbc168dd48
parent595a893406b9852d3447cf0ead19ce27fd16436e (diff)
downloadwireshark-4e7e06ca3af407e583f7690dbb606b6f1ab4cbad.tar.gz
RTPS Cleanup, Part 3 (final)
Merged packet-rtps.c and packet-rtps2.c into a single dissector. It appears packet-rtps2.[ch] "API" needs to be externally available, otherwise I would have rolled (the newly merged) packet-rtps.h into packet-rtps.c as well. Converted many of the remaining proto_tree_add_text to proto_tree_add_item/expert_info and cleaned up the manual string manipulation so checkAPIs.pl is happy. Added a "cooked" capture file to the SampleCaptures page on the wiki for future fuzztesting/regression. svn path=/trunk/; revision=48727
Diffstat
-rw-r--r--epan/CMakeLists.txt3
-rw-r--r--epan/dissectors/Makefile.common2
-rw-r--r--epan/dissectors/packet-rtps.c6053
-rw-r--r--epan/dissectors/packet-rtps.h112
-rw-r--r--epan/dissectors/packet-rtps2.c7682
-rw-r--r--epan/dissectors/packet-rtps2.h268
6 files changed, 4344 insertions, 9776 deletions
diff --git a/epan/CMakeLists.txt b/epan/CMakeLists.txt
index 78be11874d..ea7c97c394 100644
--- a/epan/CMakeLists.txt
+++ b/epan/CMakeLists.txt
@@ -1082,7 +1082,6 @@ set(DISSECTOR_SRC
dissectors/packet-rtp-midi.c
dissectors/packet-rtp.c
dissectors/packet-rtps.c
- dissectors/packet-rtps2.c
dissectors/packet-rtsp.c
dissectors/packet-rudp.c
dissectors/packet-rwall.c
@@ -1589,7 +1588,7 @@ file(COPY ${WMEM_HEADERS} DESTINATION abi-check-headers/wmem)
add_custom_command(OUTPUT libwireshark.abi.tar.gz
COMMAND cp ../config.h abi-check-headers
COMMAND rm abi-check-headers/dissectors/x11-extension-implementation.h
- abi-check-headers/dissectors/packet-rtps2.h
+ abi-check-headers/dissectors/packet-rtps.h
abi-check-headers/dissectors/x11-glx-render-enum.h
abi-check-headers/dissectors/x11-register-info.h
abi-check-headers/dissectors/packet-idmp.h
diff --git a/epan/dissectors/Makefile.common b/epan/dissectors/Makefile.common
index 830bd53961..132ef25d33 100644
--- a/epan/dissectors/Makefile.common
+++ b/epan/dissectors/Makefile.common
@@ -1003,7 +1003,6 @@ DISSECTOR_SRC = \
packet-rtp-midi.c \
packet-rtp.c \
packet-rtps.c \
- packet-rtps2.c \
packet-rtsp.c \
packet-rudp.c \
packet-rwall.c \
@@ -1495,7 +1494,6 @@ DISSECTOR_INCLUDES = \
packet-rtcp.h \
packet-rtp.h \
packet-rtps.h \
- packet-rtps2.h \
packet-rtp-events.h \
packet-rtse.h \
packet-rtsp.h \
diff --git a/epan/dissectors/packet-rtps.c b/epan/dissectors/packet-rtps.c
index 16bc0690a6..7cff03a6db 100644
--- a/epan/dissectors/packet-rtps.c
+++ b/epan/dissectors/packet-rtps.c
@@ -55,33 +55,11 @@
#include <glib.h>
#include <epan/packet.h>
#include <epan/expert.h>
+#include <epan/prefs.h>
#include <epan/addr_resolv.h>
#include "packet-rtps.h"
-/* Size of the temp buffers used to format various part of the protocol.
- * Note: Some of those values are bigger than expected. The reason is
- * because the string buffer can also contains decoded values.
- * I.e. port size is an integer, but for value 0x0000, it is interpreted
- * as a string "PORT_INVALID (0x00000000)"
- */
-#define MAX_FLAG_SIZE (20)
-#define MAX_GUID_PREFIX_SIZE (128)
-#define MAX_GUID_SIZE (160)
-#define MAX_VENDOR_ID_SIZE (128)
-#define MAX_NTP_TIME_SIZE (128)
-#define MAX_PORT_SIZE (32)
-#define MAX_PARAM_SIZE (256)
-#define MAX_LOCATOR_SIZE (200)
-#define MAX_IPV6_SIZE (100)
-#define MAX_BITMAP_SIZE (200)
-#define MAX_LABEL_SIZE (64)
-#define MAX_IPV4_ADDRESS_SIZE (64)
-
-/* Max octects printed on the parameter root for a sequence of octects */
-#define MAX_SEQ_OCTETS_PRINTED (20)
-
-
static const char * const SM_EXTRA_RPLUS = "(r+)";
static const char * const SM_EXTRA_RMINUS = "(r-)";
static const char * const SM_EXTRA_WPLUS = "(w+)";
@@ -110,6 +88,7 @@ static int hf_rtps_app_id_instance_id = -1;
static int hf_rtps_app_id_app_kind = -1;
static int hf_rtps_sm_id = -1;
+static int hf_rtps_sm_idv2 = -1;
static int hf_rtps_sm_flags = -1;
static int hf_rtps_sm_octets_to_next_header = -1;
static int hf_rtps_sm_guid_prefix = -1;
@@ -117,6 +96,7 @@ static int hf_rtps_sm_host_id = -1;
static int hf_rtps_sm_app_id = -1;
static int hf_rtps_sm_instance_id = -1;
static int hf_rtps_sm_app_kind = -1;
+static int hf_rtps_sm_counter = -1;
static int hf_rtps_sm_entity_id = -1;
static int hf_rtps_sm_entity_id_key = -1;
static int hf_rtps_sm_entity_id_kind = -1;
@@ -132,6 +112,7 @@ static int hf_rtps_info_src_ip = -1;
static int hf_rtps_info_src_unused = -1;
static int hf_rtps_parameter_id = -1;
+static int hf_rtps_parameter_id_v2 = -1;
static int hf_rtps_parameter_length = -1;
static int hf_rtps_param_topic_name = -1;
static int hf_rtps_param_strength = -1;
@@ -188,6 +169,61 @@ static int hf_rtps_ownership = -1;
static int hf_rtps_presentation_access_scope = -1;
static int hf_rtps_destination_order = -1;
static int hf_rtps_history_kind = -1;
+static int hf_rtps_data_status_info = -1;
+static int hf_rtps_param_serialize_encap_kind = -1;
+static int hf_rtps_param_serialize_encap_len = -1;
+static int hf_rtps_param_status_info = -1;
+static int hf_rtps_param_transport_priority = -1;
+static int hf_rtps_param_type_max_size_serialized = -1;
+static int hf_rtps_param_entity_name = -1;
+static int hf_rtps_disable_positive_ack = -1;
+static int hf_rtps_participant_guid = -1;
+static int hf_rtps_group_guid = -1;
+static int hf_rtps_endpoint_guid = -1;
+static int hf_rtps_param_host_id = -1;
+static int hf_rtps_param_app_id = -1;
+static int hf_rtps_param_instance_id = -1;
+static int hf_rtps_param_app_kind = -1;
+static int hf_rtps_param_entity = -1;
+static int hf_rtps_param_entity_key = -1;
+static int hf_rtps_param_hf_entity_kind = -1;
+static int hf_rtps_param_counter = -1;
+static int hf_rtps_data_frag_number = -1;
+static int hf_rtps_data_frag_num_fragments = -1;
+static int hf_rtps_data_frag_size = -1;
+static int hf_rtps_data_frag_sample_size = -1;
+static int hf_rtps_nokey_data_frag_number = -1;
+static int hf_rtps_nokey_data_frag_num_fragments= -1;
+static int hf_rtps_nokey_data_frag_size = -1;
+static int hf_rtps_nack_frag_count = -1;
+static int hf_rtps_heartbeat_frag_number = -1;
+static int hf_rtps_heartbeat_frag_count = -1;
+static int hf_rtps_heartbeat_batch_count = -1;
+static int hf_rtps_data_serialize_data = -1;
+static int hf_rtps_data_batch_timestamp = -1;
+static int hf_rtps_data_batch_offset_to_last_sample_sn = -1;
+static int hf_rtps_data_batch_sample_count = -1;
+static int hf_rtps_data_batch_offset_sn = -1;
+static int hf_rtps_data_batch_octets_to_sl_encap_id = -1;
+static int hf_rtps_data_batch_serialized_data_length = -1;
+static int hf_rtps_data_batch_octets_to_inline_qos = -1;
+static int hf_rtps_fragment_number_base64 = -1;
+static int hf_rtps_fragment_number_base = -1;
+static int hf_rtps_fragment_number_num_bits = -1;
+static int hf_rtps_bitmap_num_bits = -1;
+static int hf_rtps_param_partition_num = -1;
+static int hf_rtps_param_partition = -1;
+static int hf_rtps_param_filter_expression = -1;
+static int hf_rtps_param_filter_parameters_num = -1;
+static int hf_rtps_param_filter_parameters = -1;
+static int hf_rtps_locator_filter_list_num_channels = -1;
+static int hf_rtps_locator_filter_list_filter_name = -1;
+static int hf_rtps_locator_filter_list_filter_exp = -1;
+static int hf_rtps_extra_flags = -1;
+static int hf_rtps_param_builtin_endpoint_set = -1;
+static int hf_rtps_param_plugin_promiscuity_kind = -1;
+static int hf_rtps_param_service_kind = -1;
+
/* Subtree identifiers */
static gint ett_rtps = -1;
@@ -198,6 +234,7 @@ static gint ett_rtps_parameter_sequence = -1;
static gint ett_rtps_parameter = -1;
static gint ett_rtps_flags = -1;
static gint ett_rtps_entity = -1;
+static gint ett_rtps_generic_guid = -1;
static gint ett_rtps_rdentity = -1;
static gint ett_rtps_wrentity = -1;
static gint ett_rtps_guid_prefix = -1;
@@ -213,6 +250,17 @@ static gint ett_rtps_resource_limit = -1;
static gint ett_rtps_durability_service = -1;
static gint ett_rtps_liveliness = -1;
static gint ett_rtps_manager_key = -1;
+static gint ett_rtps_serialized_data = -1;
+static gint ett_rtps_locator_filter_channel = -1;
+static gint ett_rtps_part_message_data = -1;
+static gint ett_rtps_sample_info_list = -1;
+static gint ett_rtps_sample_info = -1;
+static gint ett_rtps_sample_batch_list = -1;
+
+/***************************************************************************/
+/* Preferences */
+/***************************************************************************/
+static guint rtps_max_batch_samples_dissected = 16;
/***************************************************************************/
/* Value-to-String Tables */
@@ -289,20 +337,49 @@ static const value_string rtps_locator_kind_vals[] = {
};
static const value_string submessage_id_vals[] = {
- { PAD, "PAD" },
- { DATA, "DATA" },
- { NOKEY_DATA, "NOKEY_DATA" },
- { ACKNACK, "ACKNACK" },
- { HEARTBEAT, "HEARTBEAT" },
- { GAP, "GAP" },
- { INFO_TS, "INFO_TS" },
- { INFO_SRC, "INFO_SRC" },
- { INFO_REPLY_IP4, "INFO_REPLY_IP4" },
- { INFO_DST, "INFO_DST" },
- { INFO_REPLY, "INFO_REPLY" },
+ { SUBMESSAGE_PAD, "PAD" },
+ { SUBMESSAGE_DATA, "DATA" },
+ { SUBMESSAGE_NOKEY_DATA, "NOKEY_DATA" },
+ { SUBMESSAGE_ACKNACK, "ACKNACK" },
+ { SUBMESSAGE_HEARTBEAT, "HEARTBEAT" },
+ { SUBMESSAGE_GAP, "GAP" },
+ { SUBMESSAGE_INFO_TS, "INFO_TS" },
+ { SUBMESSAGE_INFO_SRC, "INFO_SRC" },
+ { SUBMESSAGE_INFO_REPLY_IP4, "INFO_REPLY_IP4" },
+ { SUBMESSAGE_INFO_DST, "INFO_DST" },
+ { SUBMESSAGE_INFO_REPLY, "INFO_REPLY" },
+ { 0, NULL }
+};
+
+static const value_string submessage_id_valsv2[] = {
+ { SUBMESSAGE_PAD, "PAD" },
+ { SUBMESSAGE_RTPS_DATA, "DATA" },
+ { SUBMESSAGE_RTPS_DATA_FRAG, "DATA_FRAG" },
+ { SUBMESSAGE_RTPS_DATA_BATCH, "DATA_BATCH" },
+ { SUBMESSAGE_ACKNACK, "ACKNACK" },
+ { SUBMESSAGE_HEARTBEAT, "HEARTBEAT" },
+ { SUBMESSAGE_GAP, "GAP" },
+ { SUBMESSAGE_INFO_TS, "INFO_TS" },
+ { SUBMESSAGE_INFO_SRC, "INFO_SRC" },
+ { SUBMESSAGE_INFO_REPLY_IP4, "INFO_REPLY_IP4" },
+ { SUBMESSAGE_INFO_DST, "INFO_DST" },
+ { SUBMESSAGE_INFO_REPLY, "INFO_REPLY" },
+ { SUBMESSAGE_NACK_FRAG, "NACK_FRAG" },
+ { SUBMESSAGE_HEARTBEAT_FRAG, "HEARTBEAT_FRAG" },
+ { SUBMESSAGE_ACKNACK_BATCH, "ACKNACK_BATCH" },
+ { SUBMESSAGE_HEARTBEAT_BATCH, "HEARTBEAT_BATCH" },
+ { SUBMESSAGE_ACKNACK_SESSION, "ACKNACK_SESSION" },
+ { SUBMESSAGE_HEARTBEAT_SESSION, "HEARTBEAT_SESSION" },
+ { SUBMESSAGE_RTPS_DATA_SESSION, "DATA_SESSION" },
+ /* Deprecated submessages */
+ { SUBMESSAGE_DATA, "DATA_deprecated" },
+ { SUBMESSAGE_NOKEY_DATA, "NOKEY_DATA_deprecated" },
+ { SUBMESSAGE_DATA_FRAG, "DATA_FRAG_deprecated" },
+ { SUBMESSAGE_NOKEY_DATA_FRAG, "NOKEY_DATA_FRAG_deprecated" },
{ 0, NULL }
};
+
static const value_string typecode_kind_vals[] = {
{ RTI_CDR_TK_NULL, "(unknown)" },
{ RTI_CDR_TK_SHORT, "short" },
@@ -401,6 +478,99 @@ static const value_string parameter_id_vals[] = {
{ 0, NULL }
};
+static const value_string parameter_id_v2_vals[] = {
+ { PID_PAD, "PID_PAD" },
+ { PID_SENTINEL, "PID_SENTINEL" },
+ { PID_PARTICIPANT_LEASE_DURATION, "PID_PARTICIPANT_LEASE_DURATION" },
+ { PID_TIME_BASED_FILTER, "PID_TIME_BASED_FILTER" },
+ { PID_TOPIC_NAME, "PID_TOPIC_NAME" },
+ { PID_OWNERSHIP_STRENGTH, "PID_OWNERSHIP_STRENGTH" },
+ { PID_TYPE_NAME, "PID_TYPE_NAME" },
+ { PID_METATRAFFIC_MULTICAST_IPADDRESS,"PID_METATRAFFIC_MULTICAST_IPADDRESS"},
+ { PID_DEFAULT_UNICAST_IPADDRESS, "PID_DEFAULT_UNICAST_IPADDRESS" },
+ { PID_METATRAFFIC_UNICAST_PORT, "PID_METATRAFFIC_UNICAST_PORT" },
+ { PID_DEFAULT_UNICAST_PORT, "PID_DEFAULT_UNICAST_PORT" },
+ { PID_MULTICAST_IPADDRESS, "PID_MULTICAST_IPADDRESS" },
+ { PID_PROTOCOL_VERSION, "PID_PROTOCOL_VERSION" },
+ { PID_VENDOR_ID, "PID_VENDOR_ID" },
+ { PID_RELIABILITY, "PID_RELIABILITY" },
+ { PID_LIVELINESS, "PID_LIVELINESS" },
+ { PID_DURABILITY, "PID_DURABILITY" },
+ { PID_DURABILITY_SERVICE, "PID_DURABILITY_SERVICE" },
+ { PID_OWNERSHIP, "PID_OWNERSHIP" },
+ { PID_PRESENTATION, "PID_PRESENTATION" },
+ { PID_DEADLINE, "PID_DEADLINE" },
+ { PID_DESTINATION_ORDER, "PID_DESTINATION_ORDER" },
+ { PID_LATENCY_BUDGET, "PID_LATENCY_BUDGET" },
+ { PID_PARTITION, "PID_PARTITION" },
+ { PID_LIFESPAN, "PID_LIFESPAN" },
+ { PID_USER_DATA, "PID_USER_DATA" },
+ { PID_GROUP_DATA, "PID_GROUP_DATA" },
+ { PID_TOPIC_DATA, "PID_TOPIC_DATA" },
+ { PID_UNICAST_LOCATOR, "PID_UNICAST_LOCATOR" },
+ { PID_MULTICAST_LOCATOR, "PID_MULTICAST_LOCATOR" },
+ { PID_DEFAULT_UNICAST_LOCATOR, "PID_DEFAULT_UNICAST_LOCATOR" },
+ { PID_METATRAFFIC_UNICAST_LOCATOR, "PID_METATRAFFIC_UNICAST_LOCATOR " },
+ { PID_METATRAFFIC_MULTICAST_LOCATOR, "PID_METATRAFFIC_MULTICAST_LOCATOR" },
+ { PID_PARTICIPANT_MANUAL_LIVELINESS_COUNT, "PID_PARTICIPANT_MANUAL_LIVELINESS_COUNT" },
+ { PID_CONTENT_FILTER_PROPERTY, "PID_CONTENT_FILTER_PROPERTY" },
+ { PID_PROPERTY_LIST, "PID_PROPERTY_LIST" },
+ { PID_HISTORY, "PID_HISTORY" },
+ { PID_RESOURCE_LIMIT, "PID_RESOURCE_LIMIT" },
+ { PID_EXPECTS_INLINE_QOS, "PID_EXPECTS_INLINE_QOS" },
+ { PID_PARTICIPANT_BUILTIN_ENDPOINTS, "PID_PARTICIPANT_BUILTIN_ENDPOINTS" },
+ { PID_METATRAFFIC_UNICAST_IPADDRESS, "PID_METATRAFFIC_UNICAST_IPADDRESS" },
+ { PID_METATRAFFIC_MULTICAST_PORT, "PID_METATRAFFIC_MULTICAST_PORT" },
+ { PID_DEFAULT_MULTICAST_LOCATOR, "PID_DEFAULT_MULTICAST_LOCATOR" },
+ { PID_TRANSPORT_PRIORITY, "PID_TRANSPORT_PRIORITY" },
+ { PID_PARTICIPANT_GUID, "PID_PARTICIPANT_GUID" },
+ { PID_PARTICIPANT_ENTITY_ID, "PID_PARTICIPANT_ENTITY_ID" },
+ { PID_GROUP_GUID, "PID_GROUP_GUID" },
+ { PID_GROUP_ENTITY_ID, "PID_GROUP_ENTITY_ID" },
+ { PID_CONTENT_FILTER_INFO, "PID_CONTENT_FILTER_INFO" },
+ { PID_COHERENT_SET, "PID_COHERENT_SET" },
+ { PID_DIRECTED_WRITE, "PID_DIRECTED_WRITE" },
+ { PID_BUILTIN_ENDPOINT_SET, "PID_BUILTIN_ENDPOINT_SET" },
+ { PID_PROPERTY_LIST_OLD, "PID_PROPERTY_LIST" },
+ { PID_ENDPOINT_GUID, "PID_ENDPOINT_GUID" },
+ { PID_TYPE_MAX_SIZE_SERIALIZED, "PID_TYPE_MAX_SIZE_SERIALIZED" },
+ { PID_ORIGINAL_WRITER_INFO, "PID_ORIGINAL_WRITER_INFO" },
+ { PID_ENTITY_NAME, "PID_ENTITY_NAME" },
+ { PID_KEY_HASH, "PID_KEY_HASH" },
+ { PID_STATUS_INFO, "PID_STATUS_INFO" },
+
+ /* Vendor specific: RTI */
+ { PID_PRODUCT_VERSION, "PID_PRODUCT_VERSION" },
+ { PID_PLUGIN_PROMISCUITY_KIND, "PID_PLUGIN_PROMISCUITY_KIND" },
+ { PID_ENTITY_VIRTUAL_GUID, "PID_ENTITY_VIRTUAL_GUID" },
+ { PID_SERVICE_KIND, "PID_SERVICE_KIND" },
+ { PID_TYPECODE_RTPS2, "PID_TYPECODE" },
+ { PID_DISABLE_POSITIVE_ACKS, "PID_DISABLE_POSITIVE_ACKS" },
+ { PID_LOCATOR_FILTER_LIST, "PID_LOCATOR_FILTER_LIST" },
+
+ /* The following PID are deprecated */
+ { PID_DEADLINE_OFFERED, "PID_DEADLINE_OFFERED [deprecated]" },
+ { PID_PERSISTENCE, "PID_PERSISTENCE [deprecated]" },
+ { PID_TYPE_CHECKSUM, "PID_TYPE_CHECKSUM [deprecated]" },
+ { PID_TYPE2_NAME, "PID_TYPE2_NAME [deprecated]" },
+ { PID_TYPE2_CHECKSUM, "PID_TYPE2_CHECKSUM [deprecated]" },
+ { PID_IS_RELIABLE, "PID_IS_RELIABLE [deprecated]" },
+ { PID_EXPECTS_ACK, "PID_EXPECTS_ACK [deprecated]" },
+ { PID_MANAGER_KEY, "PID_MANAGER_KEY [deprecated]" },
+ { PID_SEND_QUEUE_SIZE, "PID_SEND_QUEUE_SIZE [deprecated]" },
+ { PID_RELIABILITY_ENABLED, "PID_RELIABILITY_ENABLED [deprecated]" },
+ { PID_VARGAPPS_SEQUENCE_NUMBER_LAST, "PID_VARGAPPS_SEQUENCE_NUMBER_LAST [deprecated]" },
+ { PID_RECV_QUEUE_SIZE, "PID_RECV_QUEUE_SIZE [deprecated]" },
+ { PID_RELIABILITY_OFFERED, "PID_RELIABILITY_OFFERED [deprecated]" },
+ { PID_LIVELINESS_OFFERED, "PID_LIVELINESS_OFFERED [deprecated]" },
+ { PID_PRESENTATION_OFFERED, "PID_PRESENTATION_OFFERED [deprecated]" },
+ { PID_OWNERSHIP_OFFERED, "PID_OWNERSHIP_OFFERED [deprecated]" },
+ { PID_DESTINATION_ORDER_OFFERED, "PID_DESTINATION_ORDER_OFFERED [deprecated]" },
+ { PID_LATENCY_BUDGET_OFFERED, "PID_LATENCY_BUDGET_OFFERED [deprecated]" },
+ { PID_PARTITION_OFFERED, "PID_PARTITION_OFFERED [deprecated]" },
+ { 0, NULL }
+};
+
static const value_string liveliness_qos_vals[] = {
{ LIVELINESS_AUTOMATIC, "AUTOMATIC_LIVELINESS_QOS" },
{ LIVELINESS_BY_PARTICIPANT, "MANUAL_BY_PARTICIPANT_LIVELINESS_QOS" },
@@ -447,6 +617,32 @@ static const value_string destination_order_qos_vals[] = {
{ 0, NULL }
};
+static const value_string encapsulation_id_vals[] = {
+ { ENCAPSULATION_CDR_BE, "CDR_BE" },
+ { ENCAPSULATION_CDR_LE, "CDR_LE" },
+ { ENCAPSULATION_PL_CDR_BE, "PL_CDR_BE" },
+ { ENCAPSULATION_PL_CDR_LE, "PL_CDR_LE" },
+ { 0, NULL }
+};
+
+static const value_string plugin_promiscuity_kind_vals[] = {
+ { 0x0001, "MATCHING_REMOTE_ENTITIES_PROMISCUITY" },
+ { 0xffff, "ALL_REMOTE_ENTITIES_PROMISCUITY" },
+ { 0, NULL }
+};
+
+static const value_string service_kind_vals[] = {
+ { 0x00000000, "NO_SERVICE_QOS" },
+ { 0x00000001, "PERSISTENCE_SERVICE_QOS" },
+ { 0, NULL }
+};
+
+static const value_string participant_message_data_kind [] = {
+ { PARTICIPANT_MESSAGE_DATA_KIND_UNKNOWN, "PARTICIPANT_MESSAGE_DATA_KIND_UNKNOWN" },
+ { PARTICIPANT_MESSAGE_DATA_KIND_AUTOMATIC_LIVELINESS_UPDATE, "PARTICIPANT_MESSAGE_DATA_KIND_AUTOMATIC_LIVELINESS_UPDATE" },
+ { PARTICIPANT_MESSAGE_DATA_KIND_MANUAL_LIVELINESS_UPDATE, "PARTICIPANT_MESSAGE_DATA_KIND_MANUAL_LIVELINESS_UPDATE" },
+ { 0, NULL }
+};
/* Flag Decoding defintions ***********************************************/
struct Flag_definition {
@@ -468,7 +664,7 @@ static const struct Flag_definition PAD_FLAGS[] = {
{ 'E', "Endianness bit" } /* Bit 0 */
};
-static const struct Flag_definition DATA_FLAGS[] = {
+static const struct Flag_definition DATA_FLAGSv1[] = {
{ RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
{ RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
{ 'U', "Unregister flag" }, /* Bit 5 */
@@ -479,6 +675,28 @@ static const struct Flag_definition DATA_FLAGS[] = {
{ 'E', "Endianness bit" } /* Bit 0 */
};
+static const struct Flag_definition DATA_FLAGSv2[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
+ { 'I', "Status info flag" }, /* Bit 4 */
+ { 'H', "Hash key flag" }, /* Bit 3 */
+ { 'D', "Data present" }, /* Bit 2 */
+ { 'Q', "Inline QoS" }, /* Bit 1 */
+ { 'E', "Endianness bit" } /* Bit 0 */
+};
+
+static const struct Flag_definition NOKEY_DATA_FRAG_FLAGS[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
+ { 'Q', "Inline QoS" }, /* Bit 1 */
+ { 'E', "Endianness bit" } /* Bit 0 */
+};
+
static const struct Flag_definition NOKEY_DATA_FLAGS[] = {
{ RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
{ RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
@@ -501,6 +719,17 @@ static const struct Flag_definition ACKNACK_FLAGS[] = {
{ 'E', "Endianness bit" } /* Bit 0 */
};
+static const struct Flag_definition NACK_FRAG_FLAGS[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 1 */
+ { 'E', "Endianness bit" } /* Bit 0 */
+};
+
static const struct Flag_definition GAP_FLAGS[] = {
{ RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
{ RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
@@ -523,6 +752,80 @@ static const struct Flag_definition HEARTBEAT_FLAGS[] = {
{ 'E', "Endianness bit" } /* Bit 0 */
};
+static const struct Flag_definition HEARTBEAT_BATCH_FLAGS[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
+ { 'L', "Liveliness flag" }, /* Bit 2 */
+ { 'F', "Final flag" }, /* Bit 1 */
+ { 'E', "Endianness bit" } /* Bit 0 */
+};
+
+static const struct Flag_definition HEARTBEAT_FRAG_FLAGS[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 1 */
+ { 'E', "Endianness bit" } /* Bit 0 */
+};
+
+static const struct Flag_definition RTPS_DATA_FLAGS[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
+ { 'K', "Serialized Key" }, /* Bit 3 */
+ { 'D', "Data present" }, /* Bit 2 */
+ { 'Q', "Inline QoS" }, /* Bit 1 */
+ { 'E', "Endianness bit" } /* Bit 0 */
+};
+
+static const struct Flag_definition RTPS_DATA_FRAG_FLAGS[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
+ { 'K', "Serialized Key" }, /* Bit 2 */
+ { 'Q', "Inline QoS" }, /* Bit 1 */
+ { 'E', "Endianness bit" } /* Bit 0 */
+};
+
+static const struct Flag_definition RTPS_DATA_BATCH_FLAGS[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
+ { 'Q', "Inline QoS" }, /* Bit 1 */
+ { 'E', "Endianness bit" } /* Bit 0 */
+};
+
+static const struct Flag_definition RTPS_SAMPLE_INFO_FLAGS16[] = {
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 15 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 14 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 13 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 12 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 11 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 10 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 9 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 8 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
+ { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
+ { 'K', "Serialized Key" }, /* Bit 5 */
+ { 'I', "Invalid sample" }, /* Bit 4 */
+ { 'D', "Data present" }, /* Bit 3 */
+ { 'O', "OffsetSN present" }, /* Bit 2 */
+ { 'Q', "Inline QoS" }, /* Bit 1 */
+ { 'T', "Timestamp present" } /* Bit 0 */
+};
+
static const struct Flag_definition INFO_TS_FLAGS[] = {
{ RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
{ RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
@@ -580,28 +883,6 @@ static const struct Flag_definition INFO_REPLY_FLAGS[] = {
/***************************************************************************/
-
-
-
-
-
-/***************************************************************************
- * Function prototypes
- * ~~~~~~~~~~~~~~~~~~~
- */
-
-/* Utility to add elements to the protocol tree */
-static void rtps_util_add_guid_prefix(proto_tree *, tvbuff_t *,
- gint, int, int, int, int, int, const guint8 *);
-static void rtps_util_add_generic_guid(proto_tree *, tvbuff_t *,
- gint, const char *, guint8 *, gint);
-static int rtps_util_add_bitmap(proto_tree *, tvbuff_t *,
- gint, int, const char *);
-static void rtps_util_decode_flags(proto_tree *, tvbuff_t *,
- gint, guint8, const struct Flag_definition *);
-
-
-/***************************************************************************/
/* Inline macros */
#define NEXT_guint16(tvb, offset, le) \
@@ -612,6 +893,79 @@ static void rtps_util_decode_flags(proto_tree *, tvbuff_t *,
/* *********************************************************************** */
+/* Appends extra formatting for those submessages that have a status info
+ */
+static void info_summary_append_ex(packet_info *pinfo,
+ guint32 writer_id,
+ guint32 status_info) {
+
+ /* Defines the extra information associated to the writer involved in
+ * this communication
+ *
+ * Format: [?Ptwrpm]\(u?d?\)
+ *
+ * First letter table:
+ *
+ * writerEntityId value | Letter
+ * ---------------------------------------------------+--------------
+ * ENTITYID_UNKNOWN | ?
+ * ENTITYID_PARTICIPANT | P
+ * ENTITYID_SEDP_BUILTIN_TOPIC_WRITER | t
+ * ENTITYID_SEDP_BUILTIN_PUBLICATIONS_WRITER | w
+ * ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_WRITER | r
+ * ENTITYID_SPDP_BUILTIN_PARTICIPANT_WRITER | p
+ * ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER | m
+ *
+ * The letter is followed by:
+ * status_info &1 | status_info & 2 | Text
+ * ---------------+-----------------------+--------------
+ * status_info not defined in inlineQos | [?]
+ * 0 | 0 | [__]
+ * 0 | 1 | [u_]
+ * 1 | 0 | [_d]
+ * 1 | 1 | [ud]
+ */
+ /* 0123456 */
+ char buffer[10] = "(?[??])";
+
+ switch(writer_id)
+ {
+ case ENTITYID_PARTICIPANT:
+ buffer[1] = 'P';
+ break;
+ case ENTITYID_BUILTIN_TOPIC_WRITER:
+ buffer[1] = 't';
+ break;
+ case ENTITYID_BUILTIN_PUBLICATIONS_WRITER:
+ buffer[1] = 'w';
+ break;
+ case ENTITYID_BUILTIN_SUBSCRIPTIONS_WRITER:
+ buffer[1] = 'r';
+ break;
+ case ENTITYID_BUILTIN_SDP_PARTICIPANT_WRITER:
+ buffer[1] = 'p';
+ break;
+ case ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER:
+ buffer[1] = 'm';
+ break;
+ default:
+ /* Unknown writer ID, don't format anything */
+ return;
+ }
+
+ switch(status_info) {
+ case 0: buffer[3] = '_'; buffer[4] = '_'; break;
+ case 1: buffer[3] = '_'; buffer[4] = 'D'; break;
+ case 2: buffer[3] = 'U'; buffer[4] = '_'; break;
+ case 3: buffer[3] = 'U'; buffer[4] = 'D'; break;
+ default: /* Unknown status info, omit it */
+ buffer[2] = ')';
+ buffer[3] = '\0';
+ }
+ col_append_str(pinfo->cinfo, COL_INFO, buffer);
+}
+
+/* *********************************************************************** */
guint16 rtps_util_add_protocol_version(proto_tree *tree, /* Can NOT be NULL */
tvbuff_t * tvb,
gint offset) {
@@ -637,7 +991,7 @@ guint16 rtps_util_add_protocol_version(proto_tree *tree, /* Can NOT be NULL */
/* Interpret the next bytes as vendor ID. If proto_tree and field ID is
* provided, it can also set.
*/
-void rtps_util_add_vendor_id(proto_tree *tree,
+guint16 rtps_util_add_vendor_id(proto_tree *tree,
tvbuff_t * tvb,
gint offset) {
guint8 major, minor;
@@ -650,6 +1004,8 @@ void rtps_util_add_vendor_id(proto_tree *tree,
proto_tree_add_uint_format_value(tree, hf_rtps_vendor_id, tvb, offset, 2, vendor_id,
"%02d.%02d (%s)", major, minor,
val_to_str_const(vendor_id, vendor_vals, "Unknown"));
+
+ return vendor_id;
}
@@ -709,13 +1065,8 @@ int rtps_util_add_locator_list(proto_tree *tree, packet_info *pinfo, tvbuff_t *
num_locators = NEXT_guint32(tvb, offset, little_endian);
if (tree) {
- ti = proto_tree_add_text(tree,
- tvb,
- offset,
- 4,
- "%s: %d Locators",
- label,
- num_locators);
+ ti = proto_tree_add_text(tree, tvb, offset, 4,
+ "%s: %d Locators", label, num_locators);
} else {
return offset + 4 + ((num_locators > 0) ? (24 * num_locators) : 0);
}
@@ -728,12 +1079,8 @@ int rtps_util_add_locator_list(proto_tree *tree, packet_info *pinfo, tvbuff_t *
for (i = 0; i < num_locators; ++i) {
g_snprintf(temp_buff, 20, "Locator[%d]", i);
- rtps_util_add_locator_t(locator_tree,
- pinfo,
- tvb,
- offset,
- little_endian,
- temp_buff);
+ rtps_util_add_locator_t(locator_tree, pinfo, tvb, offset,
+ little_endian, temp_buff);
offset += 24;
}
}
@@ -797,19 +1144,10 @@ void rtps_util_add_locator_udp_v4(proto_tree *tree, packet_info *pinfo, tvbuff_t
* - hf_rtps_app_id
* - hf_rtps_app_id_instance_id
* - hf_rtps_app_id_app_kind
- *
- * If buffer is specified, it returns in it a string representation of the
- * data read.
*/
-static void rtps_util_add_guid_prefix(proto_tree *tree, /* Can be NULL */
- tvbuff_t * tvb,
- gint offset,
- int hf_prefix, /* Cannot be 0 if tree != NULL */
- int hf_host_id,
- int hf_app_id,
- int hf_app_id_instance_id,
- int hf_app_id_app_kind,
- const guint8 * label) {
+static void rtps_util_add_guid_prefix_v1(proto_tree *tree, tvbuff_t *tvb, gint offset,
+ int hf_prefix, int hf_host_id, int hf_app_id, int hf_app_id_instance_id,
+ int hf_app_id_app_kind, const guint8 * label) {
guint64 prefix;
guint32 host_id, app_id, instance_id;
guint8 app_kind;
@@ -847,7 +1185,51 @@ static void rtps_util_add_guid_prefix(proto_tree *tree, /* Can be NULL */
}
}
+/* ------------------------------------------------------------------------- */
+/* Insert in the protocol tree the next 12 bytes interpreted as GuidPrefix
+ * If tree is specified, it fills up the protocol tree item:
+ * - hf_rtps_guid_prefix
+ * - hf_rtps_host_id
+ * - hf_rtps_app_id
+ * - hf_rtps_counter
+ */
+static void rtps_util_add_guid_prefix_v2(proto_tree *tree, tvbuff_t *tvb, gint offset,
+ int hf_prefix, int hf_host_id, int hf_app_id,
+ int hf_counter, const guint8 * label) {
+ guint32 host_id;
+ guint32 app_id;
+ guint32 counter;
+ const guint8 * safe_label;
+
+ safe_label = (label == NULL) ? (const guint8 *)"guidPrefix" : label;
+
+ /* Read values from TVB */
+ host_id = tvb_get_ntohl(tvb, offset);
+ app_id = tvb_get_ntohl(tvb, offset + 4);
+ counter = tvb_get_ntohl(tvb, offset + 8);
+
+ if (tree) {
+ proto_item * ti, *hidden_item;
+ proto_tree * guid_tree;
+
+ /* The text node (root of the guid prefix sub-tree) */
+ ti = proto_tree_add_text(tree, tvb, offset, 12, "%s", safe_label);
+ guid_tree = proto_item_add_subtree(ti, ett_rtps_guid_prefix);
+
+ /* The numeric value (used for searches) */
+ hidden_item = proto_tree_add_item(guid_tree, hf_prefix, tvb, offset, 8, ENC_NA);
+ PROTO_ITEM_SET_HIDDEN(hidden_item);
+
+ /* Host Id */
+ proto_tree_add_item(guid_tree, hf_host_id, tvb, offset, 4, ENC_BIG_ENDIAN);
+
+ /* App Id */
+ proto_tree_add_item(guid_tree, hf_app_id, tvb, offset+4, 4, ENC_BIG_ENDIAN);
+ /* Counter */
+ proto_tree_add_item(guid_tree, hf_counter, tvb, offset+8, 4, ENC_BIG_ENDIAN);
+ }
+}
/* ------------------------------------------------------------------------- */
/* Insert the entityId from the next 4 bytes. Since there are more than
@@ -907,50 +1289,34 @@ int rtps_util_add_entity_id(proto_tree *tree, tvbuff_t * tvb, gint offset,
* to any protocol field). It simply insert the content as a simple text entry
* and returns in the passed buffer only the value (without the label).
*/
-void rtps_util_add_generic_entity_id(proto_tree *tree,
- tvbuff_t * tvb,
- gint offset,
- const char *label,
- guint8 * buffer, /* Can be NULL */
- gint buffer_size) {
+void rtps_util_add_generic_entity_id(proto_tree *tree, tvbuff_t * tvb, gint offset, const char* label,
+ int hf_item, int hf_item_entity_key, int hf_item_entity_kind,
+ int subtree_entity_id) {
guint32 entity_id = tvb_get_ntohl(tvb, offset);
guint32 entity_key = (entity_id >> 8);
guint8 entity_kind = (entity_id & 0xff);
const char *str_predef = try_val_to_str(entity_id, entity_id_vals);
- guint8 temp_buffer[MAX_GUID_SIZE];
+ proto_item *ti;
+ proto_tree *entity_tree;
if (str_predef == NULL) {
/* entityId is not a predefined value, format it */
- g_snprintf(temp_buffer, MAX_GUID_SIZE,
- "0x%08x (%s: 0x%06x)",
- entity_id,
- val_to_str(entity_kind, entity_kind_vals,
- "unknown kind (%02x)"),
+ ti = proto_tree_add_uint_format(tree, hf_item, tvb, offset, 4, entity_id,
+ "%s: 0x%08x (%s: 0x%06x)", label, entity_id,
+ val_to_str(entity_kind, entity_kind_vals, "unknown kind (%02x)"),
entity_key);
} else {
/* entityId is a predefined value */
- g_snprintf(temp_buffer, MAX_GUID_SIZE,
- "%s (0x%08x)",
- str_predef,
- entity_id);
- }
-
- if (tree != NULL) {
- proto_tree_add_text(tree,
- tvb,
- offset,
- 4,
- "%s: %s",
- label,
- temp_buffer);
+ ti = proto_tree_add_uint_format_value(tree, hf_item, tvb, offset, 4, entity_id,
+ "%s: %s (0x%08x)", label, str_predef, entity_id);
}
- if (buffer != NULL) {
- g_strlcpy(buffer, temp_buffer, buffer_size);
- }
-}
+ entity_tree = proto_item_add_subtree(ti, subtree_entity_id);
+ proto_tree_add_item(entity_tree, hf_item_entity_key, tvb, offset, 3, ENC_BIG_ENDIAN);
+ proto_tree_add_item(entity_tree, hf_item_entity_kind, tvb, offset+3, 1, ENC_BIG_ENDIAN);
+}
/* ------------------------------------------------------------------------- */
/* Interpret the next 12 octets as a generic GUID and insert it in the protocol
@@ -958,61 +1324,96 @@ void rtps_util_add_generic_entity_id(proto_tree *tree,
* It is mostly used in situation where is not required to perform search for
* this kind of GUID (i.e. like in some DATA parameter lists).
*/
-static void rtps_util_add_generic_guid(proto_tree *tree, /* Cannot be NULL */
- tvbuff_t * tvb, /* Cannot be NULL */
- gint offset,
- const char *label, /* Cannot be NULL */
- guint8 * buffer, /* Can be NULL */
- gint buffer_size) {
-
- guint32 host_id;
- guint32 app_id;
- guint8 app_kind;
- guint32 instance_id;
- guint32 entity_id;
- guint32 entity_key;
- guint8 entity_kind;
- guint8 guid_raw[12];
- const char * str_entity_kind;
- const char * str_app_kind;
- guint8 temp_buff[MAX_GUID_SIZE];
- int i;
+static void rtps_util_add_generic_guid_v1(proto_tree *tree, tvbuff_t * tvb, gint offset,
+ int hf_guid, int hf_host_id, int hf_app_id, int hf_app_id_instance_id,
+ int hf_app_id_app_kind, int hf_entity, int hf_entity_key,
+ int hf_entity_kind) {
+
+ guint64 prefix;
+ guint32 host_id, app_id, entity_id;
+ proto_item* ti;
+ proto_tree *guid_tree, *appid_tree, *entity_tree;
/* Read typed data */
+ prefix = tvb_get_ntoh64(tvb, offset);
host_id = tvb_get_ntohl(tvb, offset);
app_id = tvb_get_ntohl(tvb, offset + 4);
entity_id = tvb_get_ntohl(tvb, offset + 8);
- /* Re-Read raw data */
- for (i = 0; i < 12; ++i) {
- guid_raw[i] = tvb_get_guint8(tvb, offset+i);
- }
+ ti = proto_tree_add_uint64_format_value(tree, hf_guid, tvb, offset, 8, prefix, "%08x %08x %08x",
+ host_id, app_id, entity_id);
- /* Split components from typed data */
- instance_id = (app_id >> 8);
- app_kind = (app_id & 0xff);
- entity_key = (entity_id >> 8);
- entity_kind = (entity_id & 0xff);
-
- /* Lookup for predefined app kind and entity kind */
- str_entity_kind = val_to_str(entity_kind, entity_kind_vals, "%02x");
- str_app_kind = val_to_str(app_kind, app_kind_vals, "%02x");
-
- /* Compose output buffer for raw guid */
- g_snprintf(temp_buff, MAX_GUID_SIZE,
- "%s=%02x%02x%02x%02x %02x%02x%02x%02x %02x%02x%02x%02x: "
- "{ hostId=%08x, appId=%08x (%s: %06x), entityId=%08x (%s: %06x) }",
- label,
- guid_raw[0], guid_raw[1], guid_raw[2], guid_raw[3],
- guid_raw[4], guid_raw[5], guid_raw[6], guid_raw[7],
- guid_raw[8], guid_raw[9], guid_raw[10], guid_raw[11],
- host_id,
- app_id, str_app_kind, instance_id,
- entity_id, str_entity_kind, entity_key);
- proto_tree_add_text(tree, tvb, offset, 12, "%s", temp_buff);
- if (buffer != NULL) {
- g_strlcpy(buffer, temp_buff, buffer_size);
- }
+ guid_tree = proto_item_add_subtree(ti, ett_rtps_generic_guid);
+
+ /* Host Id */
+ proto_tree_add_item(guid_tree, hf_host_id, tvb, offset, 4, ENC_BIG_ENDIAN);
+
+ /* AppId (root of the app_id sub-tree) */
+ ti = proto_tree_add_item(guid_tree, hf_app_id, tvb, offset+4, 4, ENC_BIG_ENDIAN);
+ appid_tree = proto_item_add_subtree(ti, ett_rtps_app_id);
+
+ /* InstanceId */
+ proto_tree_add_item(appid_tree, hf_app_id_instance_id, tvb, offset+4, 3, ENC_BIG_ENDIAN);
+ /* AppKind */
+ proto_tree_add_item(appid_tree, hf_app_id_app_kind, tvb, offset+7, 1, ENC_BIG_ENDIAN);
+
+ /* Entity (root of the app_id sub-tree) */
+ ti = proto_tree_add_item(guid_tree, hf_entity, tvb, offset+8, 4, ENC_BIG_ENDIAN);
+ entity_tree = proto_item_add_subtree(ti, ett_rtps_entity);
+
+ proto_tree_add_item(entity_tree, hf_entity_key, tvb, offset+8, 3, ENC_BIG_ENDIAN);
+ proto_tree_add_item(entity_tree, hf_entity_kind, tvb, offset+11, 1, ENC_BIG_ENDIAN);
+}
+
+/* ------------------------------------------------------------------------- */
+ /* Interpret the next 16 octets as a generic GUID and insert it in the protocol
+ * tree as simple text (no reference fields are set).
+ * It is mostly used in situation where is not required to perform search for
+ * this kind of GUID (i.e. like in some DATA parameter lists).
+ */
+static void rtps_util_add_generic_guid_v2(proto_tree *tree, tvbuff_t * tvb, gint offset,
+ int hf_guid, int hf_host_id, int hf_app_id, int hf_app_id_instance_id,
+ int hf_app_id_app_kind, int hf_counter,
+ int hf_entity, int hf_entity_key, int hf_entity_kind) {
+
+ guint64 prefix;
+ guint32 host_id, app_id, entity_id, counter;
+ proto_item *ti;
+ proto_tree *guid_tree, *appid_tree, *entity_tree;
+
+ /* Read typed data */
+ prefix = tvb_get_ntoh64(tvb, offset);
+ host_id = tvb_get_ntohl(tvb, offset);
+ app_id = tvb_get_ntohl(tvb, offset + 4);
+ counter = tvb_get_ntohl(tvb, offset + 8);
+ entity_id = tvb_get_ntohl(tvb, offset + 12);
+
+ ti = proto_tree_add_uint64_format_value(tree, hf_guid, tvb, offset, 8, prefix, "%08x %08x %08x %08x",
+ host_id, app_id, counter, entity_id);
+
+ guid_tree = proto_item_add_subtree(ti, ett_rtps_generic_guid);
+
+ /* Host Id */
+ proto_tree_add_item(guid_tree, hf_host_id, tvb, offset, 4, ENC_BIG_ENDIAN);
+
+ /* AppId (root of the app_id sub-tree) */
+ ti = proto_tree_add_item(guid_tree, hf_app_id, tvb, offset+4, 4, ENC_BIG_ENDIAN);
+ appid_tree = proto_item_add_subtree(ti, ett_rtps_app_id);
+
+ /* InstanceId */
+ proto_tree_add_item(appid_tree, hf_app_id_instance_id, tvb, offset+4, 3, ENC_BIG_ENDIAN);
+ /* AppKind */
+ proto_tree_add_item(appid_tree, hf_app_id_app_kind, tvb, offset+7, 1, ENC_BIG_ENDIAN);
+
+ /* Counter */
+ proto_tree_add_item(guid_tree, hf_counter, tvb, offset+8, 4, ENC_BIG_ENDIAN);
+
+ /* Entity (root of the app_id sub-tree) */
+ ti = proto_tree_add_item(guid_tree, hf_entity, tvb, offset+12, 4, ENC_BIG_ENDIAN);
+ entity_tree = proto_item_add_subtree(ti, ett_rtps_entity);
+
+ proto_tree_add_item(entity_tree, hf_entity_key, tvb, offset+12, 3, ENC_BIG_ENDIAN);
+ proto_tree_add_item(entity_tree, hf_entity_kind, tvb, offset+15, 1, ENC_BIG_ENDIAN);
}
@@ -1054,14 +1455,8 @@ void rtps_util_add_ntp_time(proto_tree *tree,
/* Insert in the protocol tree the next data interpreted as a String
* Returns the new offset (after reading the string)
*/
-gint rtps_util_add_string(proto_tree *tree, /* Can be NULL */
- tvbuff_t * tvb,
- gint offset,
- int hf_item, /* Can be -1 (if label!=NULL) */
- gboolean little_endian,
- const guint8 * label, /* Can be NULL (if hf_item!=-1) */
- guint8 * buffer, /* Can be NULL */
- size_t buffer_size) {
+gint rtps_util_add_string(proto_tree *tree, tvbuff_t* tvb, gint offset,
+ int hf_item, gboolean little_endian) {
guint8 * retVal = NULL;
guint32 size = NEXT_guint32(tvb, offset, little_endian);
@@ -1069,32 +1464,8 @@ gint rtps_util_add_string(proto_tree *tree, /* Can be NULL */
retVal = tvb_get_ephemeral_string(tvb, offset+4, size);
}
- if (tree != NULL) {
- if (hf_item != -1) {
- proto_item * hidden_item;
- hidden_item = proto_tree_add_string(tree,
- hf_item,
- tvb,
- offset,
- size+4,
+ proto_tree_add_string(tree, hf_item, tvb, offset, size+4,
(size == 0) ? (guint8 *)"" : retVal);
- PROTO_ITEM_SET_HIDDEN(hidden_item);
- }
- proto_tree_add_text(tree,
- tvb,
- offset,
- size+4,
- "%s: \"%s\"",
- ((label != NULL) ? label : (const guint8 *)"value") ,
- (size == 0) ? (guint8 *)"" : retVal);
- }
- if (buffer != NULL) {
- if (size == 0) {
- buffer[0] = '\0';
- } else {
- g_snprintf(buffer, (gulong) buffer_size, "%s", retVal);
- }
- }
/* NDDS align strings at 4-bytes word. So:
* string_length: 4 -> buffer_length = 4;
@@ -1172,60 +1543,37 @@ void rtps_util_add_liveliness_qos(proto_tree *tree, tvbuff_t * tvb, gint offset,
* The formatted buffer is: "string1", "string2", "string3", ...
* Returns the new updated offset
*/
-gint rtps_util_add_seq_string(proto_tree *tree, /* Can NOT be NULL */
- tvbuff_t * tvb,
- gint offset,
- gboolean little_endian,
- int param_length,
- const char *label,
- guint8 * buffer, /* Can NOT be NULL */
- gint buffer_size) {
- guint32 num_strings;
- guint32 i;
+gint rtps_util_add_seq_string(proto_tree *tree, tvbuff_t* tvb, gint offset,
+ gboolean little_endian, int param_length, int hf_numstring,
+ int hf_string, const char *label) {
+ guint32 i, num_strings, size;
+ guint8 * retVal;
proto_tree *string_tree;
proto_item *ti;
- char temp_buff[MAX_LABEL_SIZE];
- guint8 overview_buffer[MAX_LABEL_SIZE];
num_strings = NEXT_guint32(tvb, offset, little_endian);
- proto_tree_add_text(tree,
- tvb,
- offset,
- 4,
- "size: %d", num_strings);
+ proto_tree_add_int(tree, hf_numstring, tvb, offset, 4, num_strings);
offset += 4;
/* Create the string node with a fake string, the replace it later */
- ti = proto_tree_add_text(tree,
- tvb,
- offset,
- param_length-8,
- "Strings");
+ ti = proto_tree_add_text(tree, tvb, offset, param_length-8, "%s", label);
string_tree = proto_item_add_subtree(ti, ett_rtps_seq_string);
- overview_buffer[0] = '\0';
-
for (i = 0; i < num_strings; ++i) {
- g_snprintf(temp_buff, MAX_LABEL_SIZE,
- "%s[%d]",
- label,
- i);
- offset = rtps_util_add_string(string_tree,
- tvb,
- offset,
- -1,
- little_endian,
- temp_buff,
- overview_buffer+strlen(overview_buffer),
- MAX_LABEL_SIZE-strlen(overview_buffer));
- }
- proto_item_set_text(ti,
- "%s: %s",
- label,
- overview_buffer);
- if (buffer != NULL) {
- g_strlcpy(buffer, overview_buffer, buffer_size);
+ size = NEXT_guint32(tvb, offset, little_endian);
+
+ if (size > 0) {
+ retVal = tvb_get_ephemeral_string(tvb, offset+4, size);
+ } else {
+ retVal = (guint8 *)"";
+ }
+
+ proto_tree_add_string_format(string_tree, hf_string, tvb, offset, size+4, retVal,
+ "%s[%d]: %s", label, i, retVal);
+
+ offset += (4 + ((size + 3) & 0xfffffffc));
}
+
return offset;
}
@@ -1300,19 +1648,12 @@ static const char * rtps_util_typecode_id_to_string(guint32 typecode_id) {
/* Insert in the protocol tree the next bytes interpreted as typecode info
* Returns the number of bytes parsed
*/
-static gint rtps_util_add_typecode(proto_tree *tree,
- tvbuff_t * tvb,
- gint offset,
- gboolean little_endian,
- int indent_level,
- int is_pointer,
- guint16 bitfield,
- int is_key,
- const gint offset_begin,
- char * name,
- int seq_max_len, /* -1 = not a sequence field */
- guint32 * arr_dimension, /* if !NULL: array of 10 int */
- int ndds_40_hack) {
+static gint rtps_util_add_typecode(proto_tree *tree, tvbuff_t * tvb, gint offset, gboolean little_endian,
+ int indent_level, int is_pointer, guint16 bitfield, int is_key, const gint offset_begin,
+ char* name,
+ int seq_max_len, /* -1 = not a sequence field */
+ guint32* arr_dimension, /* if !NULL: array of 10 int */
+ int ndds_40_hack) {
const gint original_offset = offset;
guint32 tk_id;
guint16 tk_size;
@@ -1410,17 +1751,12 @@ static gint rtps_util_add_typecode(proto_tree *tree,
/*guint32 defaultIdx;*/ /* Currently is ignored */
guint32 disc_id; /* Used temporarily to populate 'discriminator_name' */
guint16 disc_size; /* Currently is ignored */
- guint32 disc_offset_begin;
- guint32 num_members;
+ guint32 disc_offset_begin, num_members, member_name_len;
guint16 member_length;
- guint32 member_name_len;
guint8 *member_name = NULL;
guint8 member_is_pointer;
- guint32 next_offset;
- guint32 field_offset_begin;
- guint32 member_label_count;
+ guint32 next_offset, field_offset_begin, member_label_count, discriminator_enum_name_length;
gint32 member_label;
- guint32 discriminator_enum_name_length;
guint j;
/* - - - - - - - Union name - - - - - - - */
@@ -1474,14 +1810,9 @@ static gint rtps_util_add_typecode(proto_tree *tree,
#endif
/* Add the entry of the union in the tree */
- proto_tree_add_text(tree,
- tvb,
- original_offset,
- retVal,
+ proto_tree_add_text(tree, tvb, original_offset, retVal,
"%sunion %s (%s%s%s) {",
- indent_string,
- struct_name,
- discriminator_name,
+ indent_string, struct_name, discriminator_name,
(discriminator_enum_name ? " " : ""),
(discriminator_enum_name ? discriminator_enum_name : ""));
@@ -1535,29 +1866,13 @@ static gint rtps_util_add_typecode(proto_tree *tree,
offset += 4;
/* Add the entry of the union in the tree */
- proto_tree_add_text(tree,
- tvb,
- field_offset_begin,
- retVal,
- "%s case %d:",
- indent_string,
- member_label);
+ proto_tree_add_text(tree, tvb, field_offset_begin, retVal,
+ "%s case %d:", indent_string, member_label);
}
- offset += rtps_util_add_typecode(
- tree,
- tvb,
- offset,
- little_endian,
- indent_level+2,
- member_is_pointer,
- 0,
- 0,
- field_offset_begin,
- member_name,
- -1,
- NULL,
- ndds_40_hack);
+ offset += rtps_util_add_typecode(tree, tvb, offset, little_endian,
+ indent_level+2, member_is_pointer, 0, 0, field_offset_begin,
+ member_name, -1, NULL, ndds_40_hack);
}
/* Finally prints the name of the struct (if provided) */
g_strlcpy(type_name, "}", 40);
@@ -1614,18 +1929,12 @@ static gint rtps_util_add_typecode(proto_tree *tree,
* -> A4 = 4 bytes alignment, A2 = 2 bytes alignment <-
* -> ----------------------------------------------------- <-
*/
- guint32 struct_name_len;
gint8 * struct_name;
- guint32 num_members;
- guint16 member_length;
- guint8 member_is_pointer;
- guint16 member_bitfield;
- guint8 member_is_key;
- guint32 member_name_len;
+ guint16 member_length, member_bitfield;
+ guint8 member_is_pointer, member_is_key;
+ guint32 struct_name_len, num_members, member_name_len,
+ next_offset, field_offset_begin, ordinal_number;
guint8 *member_name = NULL;
- guint32 next_offset;
- guint32 field_offset_begin;
- guint32 ordinal_number;
const char * typecode_name;
/* Pad-align */
@@ -1652,14 +1961,8 @@ static gint rtps_util_add_typecode(proto_tree *tree,
break;
}
/* Prints it */
- proto_tree_add_text(tree,
- tvb,
- original_offset,
- retVal,
- "%s%s %s {",
- indent_string,
- typecode_name,
- struct_name);
+ proto_tree_add_text(tree, tvb, original_offset, retVal, "%s%s %s {",
+ indent_string, typecode_name, struct_name);
/* PAD align */
LONG_ALIGN(offset);
@@ -1695,14 +1998,8 @@ static gint rtps_util_add_typecode(proto_tree *tree,
ordinal_number = NEXT_guint32(tvb, offset, little_endian);
offset += 4;
- proto_tree_add_text(tree,
- tvb,
- field_offset_begin,
- (offset-field_offset_begin),
- "%s %s = %d;",
- indent_string,
- member_name,
- ordinal_number);
+ proto_tree_add_text(tree, tvb, field_offset_begin, (offset-field_offset_begin),
+ "%s %s = %d;", indent_string, member_name, ordinal_number);
} else {
/* Structs */
@@ -1719,20 +2016,9 @@ static gint rtps_util_add_typecode(proto_tree *tree,
member_is_key = tvb_get_guint8(tvb, offset);
offset++;
- offset += rtps_util_add_typecode(
- tree,
- tvb,
- offset,
- little_endian,
- indent_level+1,
- member_is_pointer,
- member_bitfield,
- member_is_key,
- field_offset_begin,
- member_name,
- -1,
- NULL,
- ndds_40_hack);
+ offset += rtps_util_add_typecode(tree, tvb, offset, little_endian,
+ indent_level+1, member_is_pointer, member_bitfield, member_is_key,
+ field_offset_begin, member_name, -1, NULL, ndds_40_hack);
}
}
/* Finally prints the name of the struct (if provided) */
@@ -1771,20 +2057,9 @@ static gint rtps_util_add_typecode(proto_tree *tree,
offset += 4;
/* Recursive decode seq typecode */
- /*offset += */rtps_util_add_typecode(
- tree,
- tvb,
- offset,
- little_endian,
- indent_level,
- is_pointer,
- bitfield,
- is_key,
- offset_begin,
- name,
- seq_max_len2,
- NULL,
- ndds_40_hack);
+ /*offset += */rtps_util_add_typecode(tree, tvb, offset, little_endian, indent_level,
+ is_pointer, bitfield, is_key, offset_begin, name,
+ seq_max_len2, NULL, ndds_40_hack);
/* Differently from the other typecodes, the line has been already printed */
return retVal;
}
@@ -1812,20 +2087,9 @@ static gint rtps_util_add_typecode(proto_tree *tree,
}
/* Recursive decode seq typecode */
- /*offset += */rtps_util_add_typecode(
- tree,
- tvb,
- offset,
- little_endian,
- indent_level,
- is_pointer,
- bitfield,
- is_key,
- offset_begin,
- name,
- -1,
- size,
- ndds_40_hack);
+ /*offset += */rtps_util_add_typecode(tree, tvb, offset, little_endian,
+ indent_level, is_pointer, bitfield, is_key, offset_begin,
+ name, -1, size, ndds_40_hack);
/* Differently from the other typecodes, the line has been already printed */
return retVal;
}
@@ -1882,14 +2146,9 @@ static gint rtps_util_add_typecode(proto_tree *tree,
/* Sequence print */
if (seq_max_len != -1) {
- proto_tree_add_text(tree,
- tvb,
- offset_begin,
- (offset-offset_begin),
+ proto_tree_add_text(tree, tvb, offset_begin, (offset-offset_begin),
"%ssequence<%s, %d> %s%s;%s",
- indent_string,
- type_name,
- seq_max_len,
+ indent_string, type_name, seq_max_len,
is_pointer ? "*" : "",
name ? name : "",
is_key ? KEY_COMMENT : "");
@@ -1907,42 +2166,25 @@ static gint rtps_util_add_typecode(proto_tree *tree,
break;
}
}
- proto_tree_add_text(tree,
- tvb,
- offset_begin,
- (offset-offset_begin),
+ proto_tree_add_text(tree, tvb, offset_begin, (offset-offset_begin),
"%s%s %s%s;%s",
- indent_string,
- type_name,
- name ? name : "",
- dim_str->str,
- is_key ? KEY_COMMENT : "");
+ indent_string, type_name, name ? name : "",
+ dim_str->str, is_key ? KEY_COMMENT : "");
return retVal;
}
/* Bitfield print */
if (bitfield != 0xffff && name != NULL && is_pointer == 0) {
- proto_tree_add_text(tree,
- tvb,
- offset_begin,
- (offset-offset_begin),
+ proto_tree_add_text(tree, tvb, offset_begin, (offset-offset_begin),
"%s%s %s:%d;%s",
- indent_string,
- type_name,
- name ? name : "",
- bitfield,
- is_key ? KEY_COMMENT : "");
+ indent_string, type_name, name ? name : "",
+ bitfield, is_key ? KEY_COMMENT : "");
return retVal;
}
/* Everything else */
- proto_tree_add_text(tree,
- tvb,
- offset_begin,
- (offset-offset_begin),
- "%s%s%s%s%s;%s",
- indent_string,
- type_name,
+ proto_tree_add_text(tree, tvb, offset_begin, (offset-offset_begin),
+ "%s%s%s%s%s;%s", indent_string, type_name,
name ? " " : "",
is_pointer ? "*" : "",
name ? name : "",
@@ -1950,7 +2192,6 @@ static gint rtps_util_add_typecode(proto_tree *tree,
return retVal;
}
-
/* ------------------------------------------------------------------------- */
/* Insert in the protocol tree the next bytes interpreted as Sequence of
* Octects.
@@ -1978,8 +2219,6 @@ void rtps_util_add_seq_octets(proto_tree *tree, packet_info *pinfo, tvbuff_t* tv
}
-
-
/* ------------------------------------------------------------------------- */
/* Insert in the protocol tree the next bytes interpreted as a Bitmap
* struct {
@@ -1997,116 +2236,178 @@ static int rtps_util_add_bitmap(proto_tree *tree,
guint64 seq_base;
gint32 num_bits;
guint32 data;
- char temp_buff[MAX_BITMAP_SIZE];
+ emem_strbuf_t *temp_buff = ep_strbuf_new_label(NULL);
int i, j, idx;
+ gchar *last_one;
proto_item * ti;
proto_tree * bitmap_tree;
const gint original_offset = offset;
guint32 datamask;
+ ti = proto_tree_add_text(tree, tvb, original_offset, offset-original_offset, "%s", label);
+ bitmap_tree = proto_item_add_subtree(ti, ett_rtps_bitmap);
+
/* Bitmap base sequence number */
- seq_base = rtps_util_add_seq_number(NULL,
- tvb,
- offset,
- little_endian,
- NULL);
+ seq_base = rtps_util_add_seq_number(bitmap_tree, tvb, offset, little_endian, "bitmapBase");
offset += 8;
/* Reads the bitmap size */
num_bits = NEXT_guint32(tvb, offset, little_endian);
-
+ proto_tree_add_uint(bitmap_tree, hf_rtps_bitmap_num_bits, tvb, offset, 4, num_bits);
offset += 4;
/* Reads the bits (and format the print buffer) */
idx = 0;
- for (i = 0; (i < num_bits) && (idx <= num_bits) && (idx < MAX_BITMAP_SIZE-1); i += 32) {
+ for (i = 0; i < num_bits; i += 32) {
data = NEXT_guint32(tvb, offset, little_endian);
offset += 4;
for (j = 0; j < 32; ++j) {
datamask = (1 << (31-j));
- temp_buff[idx] = ((data & datamask) == datamask) ? '1':'0';
+ ep_strbuf_append_c(temp_buff, ((data & datamask) == datamask) ? '1':'0');
++idx;
- if (idx > num_bits) {
- break;
- }
- if (idx >= MAX_BITMAP_SIZE-1) {
+ if (idx >= num_bits || temp_buff->len >= ITEM_LABEL_LENGTH - 1) {
break;
}
}
}
- temp_buff[idx] = '\0';
/* removes all the ending '0' */
- for (i = (int) strlen(temp_buff) - 1; (i>0 && temp_buff[i] == '0'); --i) {
- temp_buff[i] = '\0';
+ last_one = strrchr(temp_buff->str, '1');
+ if (last_one) {
+ ep_strbuf_truncate(temp_buff, (gsize) (last_one - temp_buff->str));
}
- ti = proto_tree_add_text(tree,
- tvb,
- original_offset,
- offset-original_offset,
- "%s: %" G_GINT64_MODIFIER "u/%d:%s",
- label,
- seq_base,
- num_bits,
- temp_buff);
- bitmap_tree = proto_item_add_subtree(ti, ett_rtps_bitmap);
- proto_tree_add_text(bitmap_tree,
- tvb,
- original_offset,
- 8,
- "bitmapBase: %" G_GINT64_MODIFIER "u",
- seq_base);
- proto_tree_add_text(bitmap_tree,
- tvb,
- original_offset + 8,
- 4,
- "numBits: %u",
- num_bits);
- if (temp_buff[0] != '\0') {
+ if (temp_buff->len > 0) {
proto_tree_add_text(bitmap_tree,
tvb,
original_offset + 12,
offset - original_offset - 12,
"bitmap: %s",
- temp_buff);
+ temp_buff->str);
}
+
+ proto_item_set_len(ti, offset-original_offset);
return offset;
}
+/* ------------------------------------------------------------------------- */
+/* Insert in the protocol tree the next bytes interpreted as a FragmentNumberSet
+ * typedef unsigned long FragmentNumber_t;
+ * struct {
+ * FragmentNumber_t bitmapBase;
+ * sequence<FragmentNumber_t> bitmap;
+ * } FragmentNumberSet;
+ *
+ * Returns the new offset after reading the bitmap.
+ */
+static int rtps_util_add_fragment_number_set(proto_tree *tree, packet_info *pinfo, tvbuff_t * tvb,
+ gint offset, gboolean little_endian, const char *label, gint section_size) {
+ guint64 base;
+ gint32 num_bits;
+ guint32 data;
+ emem_strbuf_t *temp_buff = ep_strbuf_new_label(NULL);
+ gchar *last_one;
+ int i, j, idx;
+ proto_item * ti;
+ proto_tree * bitmap_tree;
+ const gint original_offset = offset;
+ guint32 datamask;
+ gint expected_size;
+ gint base_size;
+
+ ti = proto_tree_add_text(tree, tvb, original_offset, offset-original_offset, "%s", label);
+
+ /* RTI DDS 4.2d was sending the FragmentNumber_t as a 64-bit long integer
+ * instead of 32-bit long.
+ * Attempt to decode this section as 32-bit, then check if the size of the
+ * message match what is here. If not re-decode it as 64-bit.
+ */
+ num_bits = NEXT_guint32(tvb, offset+4, little_endian);
+ expected_size = (((num_bits / 8) + 3) / 4) * 4 + 8;
+ if (expected_size == section_size) {
+ base = (guint64)NEXT_guint32(tvb, offset, little_endian);
+ base_size = 4;
+ offset += 8;
+ } else {
+ /* Attempt to use 64-bit for base */
+ num_bits = NEXT_guint32(tvb, offset+8, little_endian);
+ /* num_bits/8 must be aligned to the 4-byte word */
+ expected_size = (((num_bits / 8) + 3) / 4) * 4 + 12;
+ if (expected_size == section_size) {
+ guint64 hi = (guint64)NEXT_guint32(tvb, offset, little_endian);
+ guint64 lo = (guint64)NEXT_guint32(tvb, offset+4, little_endian);
+ base = (hi << 32) | lo;
+ base_size = 8;
+ offset += 12;
+ } else {
+ /* size don't match, packet error */
+ expert_add_info_format(pinfo, ti, PI_MALFORMED, PI_WARN, "Illegal size for fragment number set");
+ return -1;
+ }
+ }
+
+ /* Reads the bits (and format the print buffer) */
+ idx = 0;
+ for (i = 0; i < num_bits; i += 32) {
+ data = NEXT_guint32(tvb, offset, little_endian);
+ offset += 4;
+ for (j = 0; j < 32; ++j) {
+ datamask = (1 << (31-j));
+ ep_strbuf_append_c(temp_buff, ((data & datamask) == datamask) ? '1':'0');
+ ++idx;
+ if (idx >= num_bits || temp_buff->len >= ITEM_LABEL_LENGTH - 1) {
+ break;
+ }
+ }
+ }
+
+ /* removes all the ending '0' */
+ last_one = strrchr(temp_buff->str, '1');
+ if (last_one) {
+ ep_strbuf_truncate(temp_buff, (gsize) (last_one - temp_buff->str));
+ }
+
+ bitmap_tree = proto_item_add_subtree(ti, ett_rtps_bitmap);
+
+ if (base_size == 8) {
+ proto_tree_add_uint64(bitmap_tree, hf_rtps_fragment_number_base64, tvb, original_offset, 8,
+ base);
+ } else {
+ proto_tree_add_item(bitmap_tree, hf_rtps_fragment_number_base, tvb, original_offset, base_size,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ }
+ proto_tree_add_uint(bitmap_tree, hf_rtps_fragment_number_num_bits, tvb, original_offset + base_size, 4, num_bits);
+
+ if (temp_buff->len > 0) {
+ proto_tree_add_text(bitmap_tree, tvb,
+ original_offset + base_size + 4,
+ offset - original_offset - base_size - 4,
+ "bitmap: %s", temp_buff->str);
+ }
+
+ proto_item_set_len(ti, offset-original_offset);
+ return offset;
+}
/* ------------------------------------------------------------------------- */
/* Decode the submessage flags
*/
-static void rtps_util_decode_flags(proto_tree * tree,
- tvbuff_t *tvb,
- gint offset,
- guint8 flags,
- const struct Flag_definition * flag_def) {
+static void rtps_util_decode_flags(proto_tree * tree, tvbuff_t *tvb, gint offset,
+ guint8 flags, const struct Flag_definition * flag_def) {
proto_item * ti;
proto_tree * flags_tree;
int i, j;
- char flags_str[MAX_FLAG_SIZE];
+ char flags_str[20];
- flags_str[0] = '\0';
+ ti = proto_tree_add_uint(tree, hf_rtps_sm_flags, tvb, offset, 1, flags);
+ proto_item_append_text(ti, " ( ");
for (i = 0; i < 8; ++i) {
- g_snprintf(flags_str + (2 * i), MAX_FLAG_SIZE - (2 * i), "%c ",
- ((flags & (1<<(7-i))) ? flag_def[i].letter : RESERVEDFLAG_CHAR));
+ proto_item_append_text(ti, "%c ", ((flags & (1<<(7-i))) ? flag_def[i].letter : RESERVEDFLAG_CHAR));
}
+ proto_item_append_text(ti, ")");
- ti = proto_tree_add_uint_format(tree,
- hf_rtps_sm_flags,
- tvb,
- offset,
- 1,
- flags,
- "Flags: 0x%02x (%s)",
- flags,
- flags_str);
-
- flags_tree = proto_item_add_subtree(ti,
- ett_rtps_flags);
+ flags_tree = proto_item_add_subtree(ti, ett_rtps_flags);
for (i = 0; i < 8; ++i) {
int is_set = (flags & (1 << (7-i)));
@@ -2116,22 +2417,44 @@ static void rtps_util_decode_flags(proto_tree * tree,
}
flags_str[8] = '\0';
- proto_tree_add_text(flags_tree,
- tvb,
- offset,
- 1,
- "%s = %s: %s",
- flags_str,
- flag_def[i].description,
+ proto_tree_add_text(flags_tree, tvb, offset, 1, "%s = %s: %s",
+ flags_str, flag_def[i].description,
is_set ? "Set" : "Not set");
}
}
+static void rtps_util_decode_flags_16bit(proto_tree * tree, tvbuff_t *tvb, gint offset,
+ guint16 flags, const struct Flag_definition * flag_def) {
+
+ proto_item * ti;
+ proto_tree * flags_tree;
+ int i, j;
+ char flags_str[20];
+ ti = proto_tree_add_uint(tree, hf_rtps_sm_flags, tvb, offset, 2, flags);
+ proto_item_append_text(ti, " ( ");
+ for (i = 0; i < 16; ++i) {
+ proto_item_append_text(ti, "%c ", ((flags & (1<<(15-i))) ? flag_def[i].letter : RESERVEDFLAG_CHAR));
+ }
+ proto_item_append_text(ti, ")");
+ flags_tree = proto_item_add_subtree(ti, ett_rtps_flags);
+ for (i = 0; i < 16; ++i) {
+ int is_set = (flags & (1 << (15-i)));
+ for (j = 0; j < 16; ++j) {
+ flags_str[j] = (i == j) ? (is_set ? '1' : '0') : '.';
+ }
+ flags_str[16] = '\0';
+
+ proto_tree_add_text(flags_tree, tvb, offset, 2, "%s = %s: %s",
+ flags_str,
+ flag_def[i].description,
+ is_set ? "Set" : "Not set");
+ }
+}
/* *********************************************************************** */
/* * Parameter Sequence dissector * */
@@ -2152,915 +2475,1283 @@ static void rtps_util_decode_flags(proto_tree * tree,
break; \
}
-static gint dissect_parameter_sequence(proto_tree *tree,
- packet_info *pinfo,
- tvbuff_t *tvb,
- gint offset,
- gboolean little_endian,
- int octects_to_next_header,
- const char * label) {
- proto_item *ti, *param_item, *param_len_item = NULL;
- proto_tree *rtps_parameter_sequence_tree, *rtps_parameter_tree, *subtree;
- guint16 parameter, param_length;
- guint8 buffer[MAX_PARAM_SIZE];
- gint max_param_section = offset + octects_to_next_header;
-
- buffer[0] = '\0';
+static gboolean dissect_parameter_sequence_v1(proto_tree *rtps_parameter_tree, packet_info *pinfo, tvbuff_t *tvb,
+ proto_item* parameter_item, proto_item* param_len_item, gint offset,
+ gboolean little_endian, int size, int param_length, const char * label,
+ guint16 parameter, guint16 version) {
+ proto_item *ti;
+ proto_tree *subtree;
- ti = proto_tree_add_text(tree, tvb, offset, -1, "%s:", label);
- rtps_parameter_sequence_tree = proto_item_add_subtree(ti, ett_rtps_parameter_sequence);
+ switch(parameter) {
- /* Loop through all the parameters defined until PID_SENTINEL is found */
- do {
- if (max_param_section-offset < 4) {
- expert_add_info_format(pinfo, (param_len_item == NULL) ? ti : param_len_item,
- PI_PROTOCOL, PI_WARN, "ERROR: not enough bytes to read the next parameter");
- return 0;
- }
-
- /* Reads parameter and create the sub tree. At this point we don't know
- * the final string that will identify the node or its length. It will
- * be set later...
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PARTICIPANT_LEASE_DURATION| 0x0008 |
+ * +---------------+---------------+---------------+---------------+
+ * | long NtpTime.seconds |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long NtpTime.fraction |
+ * +---------------+---------------+---------------+---------------+
*/
- parameter = NEXT_guint16(tvb, offset, little_endian);
- param_item = proto_tree_add_text(rtps_parameter_sequence_tree, tvb, offset, -1,
- "%s", val_to_str(parameter, parameter_id_vals, "Unknown (0x%04x)"));
- rtps_parameter_tree = proto_item_add_subtree(param_item, ett_rtps_parameter);
+ case PID_PARTICIPANT_LEASE_DURATION:
+ ENSURE_LENGTH(8);
+ rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset, little_endian,
+ hf_rtps_participant_lease_duration);
+ break;
+
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TIME_BASED_FILTER | 0x0008 |
+ * +---------------+---------------+---------------+---------------+
+ * | long NtpTime.seconds |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long NtpTime.fraction |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TIME_BASED_FILTER:
+ ENSURE_LENGTH(8);
+ rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset, little_endian,
+ hf_rtps_time_based_filter_minimum_separation);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TOPIC_NAME | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long String.length |
+ * +---------------+---------------+---------------+---------------+
+ * | str[0] | str[1] | str[2] | str[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TOPIC_NAME:
+ rtps_util_add_string(rtps_parameter_tree, tvb, offset, hf_rtps_param_topic_name, little_endian);
+ break;
- proto_tree_add_uint(rtps_parameter_tree, hf_rtps_parameter_id,
- tvb, offset, 2, parameter);
- offset += 2;
- /* parameter length */
- param_length = NEXT_guint16(tvb, offset, little_endian);
- param_len_item = proto_tree_add_item(rtps_parameter_tree,
- hf_rtps_parameter_length,
- tvb,
- offset,
- 2,
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_OWNERSHIP_STRENGTH | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | long strength |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_OWNERSHIP_STRENGTH:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_strength, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TYPE_NAME | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long String.length |
+ * +---------------+---------------+---------------+---------------+
+ * | str[0] | str[1] | str[2] | str[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TYPE_NAME:
+ rtps_util_add_string(rtps_parameter_tree, tvb, offset, hf_rtps_param_type_name, little_endian);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_XXXXXXXXXXX | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | long port |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_METATRAFFIC_MULTICAST_PORT:
+ case PID_METATRAFFIC_UNICAST_PORT:
+ case PID_DEFAULT_UNICAST_PORT:
+ ENSURE_LENGTH(4);
+ rtps_util_add_port(rtps_parameter_tree, pinfo, tvb, offset, little_endian, hf_rtps_param_port);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_EXPECTS_INLINE_QOS | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | boolean | N O T U S E D |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_EXPECTS_INLINE_QOS:
+ ENSURE_LENGTH(1);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_expects_inline_qos, tvb, offset, 1, ENC_NA );
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_XXXXXXXXXXX | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long ip_address |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_METATRAFFIC_MULTICAST_IPADDRESS:
+ case PID_DEFAULT_UNICAST_IPADDRESS:
+ case PID_MULTICAST_IPADDRESS:
+ case PID_METATRAFFIC_UNICAST_IPADDRESS:
+ rtps_util_add_ipv4_address_t(rtps_parameter_tree, pinfo, tvb, offset,
+ little_endian, hf_param_ip_address);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PROTOCOL_VERSION | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | uint8 major | uint8 minor | N O T U S E D |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_PROTOCOL_VERSION:
+ ENSURE_LENGTH(2);
+ rtps_util_add_protocol_version(rtps_parameter_tree, tvb, offset);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_VENDOR_ID | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | uint8 major | uint8 minor | N O T U S E D |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_VENDOR_ID:
+ ENSURE_LENGTH(2);
+ rtps_util_add_vendor_id(NULL, tvb, offset);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_RELIABILITY | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long kind |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_RELIABILITY_OFFERED: /* Deprecated */
+ case PID_RELIABILITY:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_reliability_kind, tvb, offset, 4,
little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- offset += 2;
-
- /* Make sure we have enough bytes for the param value */
- if ((max_param_section-offset < param_length) &&
- (parameter != PID_SENTINEL)) {
- expert_add_info_format(pinfo, param_len_item, PI_PROTOCOL, PI_WARN, "Not enough bytes to read the parameter value");
- return 0;
- }
-
- /* Sets the end of this item (now we know it!) */
- proto_item_set_len(param_item, param_length+4);
-
- switch(parameter) {
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTICIPANT_LEASE_DURATION| 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
+ /* Older version of the protocol (and for PID_RELIABILITY_OFFERED)
+ * this parameter was carrying also a NtpTime called
+ * 'maxBlockingTime'.
*/
- case PID_PARTICIPANT_LEASE_DURATION:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset,
- little_endian, hf_rtps_participant_lease_duration);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TIME_BASED_FILTER | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TIME_BASED_FILTER:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset,
- little_endian, hf_rtps_time_based_filter_minimum_separation);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TOPIC_NAME | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String.length |
- * +---------------+---------------+---------------+---------------+
- * | str[0] | str[1] | str[2] | str[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TOPIC_NAME:
- rtps_util_add_string(rtps_parameter_tree,
- tvb,
- offset,
- hf_rtps_param_topic_name,
- little_endian,
- NULL, /* No label, use hf param */
- buffer,
- MAX_PARAM_SIZE);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_OWNERSHIP_STRENGTH | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long strength |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_OWNERSHIP_STRENGTH:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_strength, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TYPE_NAME | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String.length |
- * +---------------+---------------+---------------+---------------+
- * | str[0] | str[1] | str[2] | str[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TYPE_NAME:
- rtps_util_add_string(rtps_parameter_tree,
- tvb,
- offset,
- hf_rtps_param_type_name,
- little_endian,
- NULL, /* No label, use hf param */
- buffer,
- MAX_PARAM_SIZE);
- break;
-
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_XXXXXXXXXXX | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_METATRAFFIC_MULTICAST_PORT:
- case PID_METATRAFFIC_UNICAST_PORT:
- case PID_DEFAULT_UNICAST_PORT:
- ENSURE_LENGTH(4);
- rtps_util_add_port(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, hf_rtps_param_port);
- break;
-
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_EXPECTS_INLINE_QOS | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | boolean | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_EXPECTS_INLINE_QOS:
- ENSURE_LENGTH(1);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_expects_inline_qos, tvb, offset, 1, ENC_NA );
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_XXXXXXXXXXX | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long ip_address |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_METATRAFFIC_MULTICAST_IPADDRESS:
- case PID_DEFAULT_UNICAST_IPADDRESS:
- case PID_MULTICAST_IPADDRESS:
- case PID_METATRAFFIC_UNICAST_IPADDRESS:
- rtps_util_add_ipv4_address_t(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, hf_param_ip_address);
- break;
-
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PROTOCOL_VERSION | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | uint8 major | uint8 minor | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PROTOCOL_VERSION: {
- ENSURE_LENGTH(2);
- rtps_util_add_protocol_version(rtps_parameter_tree, tvb, offset);
- break;
+ if (size == 12) {
+ rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset + 4,
+ little_endian, hf_rtps_reliability_max_blocking_time);
}
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_LIVELINESS | 0x000c |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | long NtpTime.seconds |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long NtpTime.fraction |
+ * +---------------+---------------+---------------+---------------+
+ * NDDS 3.1 sends only 'kind' on the wire.
+ *
+ */
+ case PID_LIVELINESS_OFFERED: /* Deprecated */
+ case PID_LIVELINESS:
+ ENSURE_LENGTH(12);
+ rtps_util_add_liveliness_qos(rtps_parameter_tree, tvb, offset, little_endian);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_DURABILITY | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long kind |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_DURABILITY:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_durability, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_DURABILITY_SERVICE | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | long NtpTime.seconds |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long NtpTime.fraction |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | long history_depth |
+ * +---------------+---------------+---------------+---------------+
+ * | long max_samples |
+ * +---------------+---------------+---------------+---------------+
+ * | long max_instances |
+ * +---------------+---------------+---------------+---------------+
+ * | long max_samples_per_instance |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_DURABILITY_SERVICE:
+ ENSURE_LENGTH(28);
+ rtps_util_add_durability_service_qos(rtps_parameter_tree, tvb, offset, little_endian);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_OWNERSHIP | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long kind |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_OWNERSHIP_OFFERED: /* Deprecated */
+ case PID_OWNERSHIP:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_ownership, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PRESENTATION | 0x0008 |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | boolean | boolean | N O T U S E D |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_PRESENTATION_OFFERED: /* Deprecated */
+ case PID_PRESENTATION:
+ ENSURE_LENGTH(6);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_access_scope, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_coherent_access, tvb, offset+4, 1, ENC_NA );
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_ordered_access, tvb, offset+5, 1, ENC_NA );
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_DEADLINE | 0x0008 |
+ * +---------------+---------------+---------------+---------------+
+ * | long NtpTime.seconds |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long NtpTime.fraction |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_DEADLINE_OFFERED: /* Deprecated */
+ case PID_DEADLINE:
+ ENSURE_LENGTH(8);
+ rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset, little_endian, hf_rtps_deadline_period);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_DESTINATION_ORDER | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long kind |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_DESTINATION_ORDER_OFFERED: /* Deprecated */
+ case PID_DESTINATION_ORDER:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_destination_order, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_LATENCY_BUDGET | 0x0008 |
+ * +---------------+---------------+---------------+---------------+
+ * | long NtpTime.seconds |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long NtpTime.fraction |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_LATENCY_BUDGET_OFFERED:
+ case PID_LATENCY_BUDGET:
+ ENSURE_LENGTH(8);
+ rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset,
+ little_endian, hf_rtps_latency_budget_duration);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PARTITION | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long sequence_size |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long string[0].size |
+ * +---------------+---------------+---------------+---------------+
+ * | string[0][0] | string[0][1] | string[0][2] | string[0][3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ * The value is a sequence of strings.
+ */
+ case PID_PARTITION_OFFERED: /* Deprecated */
+ case PID_PARTITION:
+ ENSURE_LENGTH(4);
+ rtps_util_add_seq_string(rtps_parameter_tree, tvb, offset, little_endian,
+ param_length, hf_rtps_param_partition_num, hf_rtps_param_partition, "name");
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_LIFESPAN | 0x0008 |
+ * +---------------+---------------+---------------+---------------+
+ * | long NtpTime.seconds |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long NtpTime.fraction |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_LIFESPAN:
+ ENSURE_LENGTH(8);
+ rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset, little_endian,
+ hf_rtps_lifespan_duration);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_USER_DATA | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long sequence_size |
+ * +---------------+---------------+---------------+---------------+
+ * | octect[0] | octet[1] | octect[2] | octet[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_USER_DATA:
+ ENSURE_LENGTH(4);
+ rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
+ little_endian, param_length, hf_rtps_param_user_data);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_GROUP_DATA | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long sequence_size |
+ * +---------------+---------------+---------------+---------------+
+ * | octect[0] | octet[1] | octect[2] | octet[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_GROUP_DATA:
+ ENSURE_LENGTH(4);
+ rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
+ little_endian, param_length, hf_rtps_param_group_data);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TOPIC_DATA | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long sequence_size |
+ * +---------------+---------------+---------------+---------------+
+ * | octect[0] | octet[1] | octect[2] | octet[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TOPIC_DATA:
+ ENSURE_LENGTH(4);
+ rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
+ little_endian, param_length, hf_rtps_param_topic_data);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_UNICAST_LOCATOR | 0x0018 |
+ * +---------------+---------------+---------------+---------------+
+ * | long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | long port |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_UNICAST_LOCATOR:
+ ENSURE_LENGTH(24);
+ rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb,
+ offset, little_endian, "locator");
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_MULTICAST_LOCATOR | 0x0018 |
+ * +---------------+---------------+---------------+---------------+
+ * | long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | long port |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_MULTICAST_LOCATOR:
+ ENSURE_LENGTH(24);
+ rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb,
+ offset, little_endian, "locator");
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_DEFAULT_UNICAST_LOCATOR | 0x0018 |
+ * +---------------+---------------+---------------+---------------+
+ * | long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | long port |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_DEFAULT_UNICAST_LOCATOR:
+ ENSURE_LENGTH(24);
+ rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb, offset,
+ little_endian, "locator");
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_METATRAFFIC_UNICAST_LOC...| 0x0018 |
+ * +---------------+---------------+---------------+---------------+
+ * | long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | long port |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_METATRAFFIC_UNICAST_LOCATOR:
+ ENSURE_LENGTH(24);
+ rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb, offset,
+ little_endian, "locator");
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_METATRAFFIC_MULTICAST_L...| 0x0018 |
+ * +---------------+---------------+---------------+---------------+
+ * | long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | long port |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
+ * +---------------+---------------+---------------+---------------+
+ * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_METATRAFFIC_MULTICAST_LOCATOR:
+ ENSURE_LENGTH(24);
+ rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb,
+ offset, little_endian, "locator");
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PARTICIPANT_MANUAL_LIVE...| 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | long livelinessEpoch |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_PARTICIPANT_BUILTIN_ENDPOINTS:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_participant_builtin_endpoints, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_VENDOR_ID | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | uint8 major | uint8 minor | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_VENDOR_ID:
- ENSURE_LENGTH(2);
- rtps_util_add_vendor_id(NULL, tvb, offset);
- break;
-
+ case PID_PARTICIPANT_MANUAL_LIVELINESS_COUNT:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_participant_manual_liveliness_count, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_HISTORY | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | long kind |
+ * +---------------+---------------+---------------+---------------+
+ * | long depth |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_HISTORY:
+ ENSURE_LENGTH(8);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_history_kind, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_history_depth, tvb, offset+4, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_RESOURCE_LIMIT | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | long max_samples |
+ * +---------------+---------------+---------------+---------------+
+ * | long max_instances |
+ * +---------------+---------------+---------------+---------------+
+ * | long max_samples_per_instances |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_RESOURCE_LIMIT:
+ ENSURE_LENGTH(12);
+ ti = proto_tree_add_text(rtps_parameter_tree, tvb, offset, 12, "Resource Limit");
+ subtree = proto_item_add_subtree(ti, ett_rtps_resource_limit);
+ proto_tree_add_item(subtree, hf_rtps_resource_limit_max_samples, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ proto_tree_add_item(subtree, hf_rtps_resource_limit_max_instances, tvb, offset+4, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ proto_tree_add_item(subtree, hf_rtps_resource_limit_max_samples_per_instances, tvb, offset+8, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_CONTENT_FILTER_PROPERTY | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long String1.length |
+ * +---------------+---------------+---------------+---------------+
+ * | str1[0] | str1[1] | str1[2] | str1[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long String2.length |
+ * +---------------+---------------+---------------+---------------+
+ * | str2[0] | str2[1] | str2[2] | str2[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long String3.length |
+ * +---------------+---------------+---------------+---------------+
+ * | str3[0] | str3[1] | str3[2] | str3[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long String4.length |
+ * +---------------+---------------+---------------+---------------+
+ * | str4[0] | str4[1] | str4[2] | str4[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * | Filter Parameters |
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ *
+ * String1: ContentFilterName
+ * String2: RelatedTopicName
+ * String3: FilterName
+ * String4: FilterExpression
+ * FilterParameters: sequence of Strings
+ *
+ * Note: those strings starts all to a word-aligned (4 bytes) offset
+ */
+ case PID_CONTENT_FILTER_PROPERTY: {
+ guint32 temp_offset = offset;
+ ENSURE_LENGTH(20);
+ temp_offset = rtps_util_add_string(rtps_parameter_tree, tvb, temp_offset,
+ hf_rtps_param_content_filter_name, little_endian);
+ temp_offset = rtps_util_add_string(rtps_parameter_tree, tvb, temp_offset,
+ hf_rtps_param_related_topic_name, little_endian);
+ temp_offset = rtps_util_add_string(rtps_parameter_tree, tvb, temp_offset,
+ hf_rtps_param_filter_name, little_endian);
+ temp_offset = rtps_util_add_string(rtps_parameter_tree, tvb, temp_offset,
+ hf_rtps_param_filter_expression, little_endian);
+ /*temp_offset = */rtps_util_add_seq_string(rtps_parameter_tree, tvb, temp_offset,
+ little_endian, param_length, hf_rtps_param_filter_parameters_num,
+ hf_rtps_param_filter_parameters, "filterParameters");
+ break;
+ }
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_RELIABILITY | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_RELIABILITY_OFFERED: /* Deprecated */
- case PID_RELIABILITY:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_reliability_kind, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PROPERTY_LIST | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long Seq.Length |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * | Property 1 |
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * | Property 2 |
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * | Property n |
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ *
+ * IDL:
+ * struct PROPERTY {
+ * String Name;
+ * String Value;
+ * };
+ *
+ * struct PROPERTY_LIST {
+ * Sequence<PROPERTY> PropertyList;
+ * };
+ *
+ */
+ case PID_PROPERTY_LIST:
+ case PID_PROPERTY_LIST_OLD:
+ ENSURE_LENGTH(4);
+ {
+ guint32 prev_offset, temp_offset, prop_size;
+ guint8 *propName, *propValue;
+ guint32 seq_size = NEXT_guint32(tvb, offset, little_endian);
+ proto_item_append_text( parameter_item, " (%d properties)", seq_size );
+ if (seq_size > 0) {
+ proto_tree_add_text(rtps_parameter_tree, tvb, offset, 0,
+ /* 123456789012345678901234567890|123456789012345678901234567890 */
+ " Property Name | Property Value");
+
+ proto_tree_add_text(rtps_parameter_tree, tvb, offset, 0,
+ /* 123456789012345678901234567890|123456789012345678901234567890 */
+ "------------------------------|------------------------------");
+
+ temp_offset = offset+4;
+ while(seq_size-- > 0) {
+ prev_offset = temp_offset;
+ prop_size = NEXT_guint32(tvb, temp_offset, little_endian);
+ if (prop_size > 0) {
+ propName = tvb_get_ephemeral_string(tvb, temp_offset+4, prop_size);
+ } else {
+ propName = "";
+ }
+ /* NDDS align strings at 4-bytes word. */
+ temp_offset += (4 + ((prop_size + 3) & 0xfffffffc));
+
+ prop_size = NEXT_guint32(tvb, temp_offset, little_endian);
+ if (prop_size > 0) {
+ propValue = tvb_get_ephemeral_string(tvb, temp_offset+4, prop_size);
+ } else {
+ propValue = "";
+ }
+ /* NDDS align strings at 4-bytes word. */
+ temp_offset += (4 + ((prop_size + 3) & 0xfffffffc));
- /* Older version of the protocol (and for PID_RELIABILITY_OFFERED)
- * this parameter was carrying also a NtpTime called
- * 'maxBlockingTime'.
- */
- if (octects_to_next_header == 12) {
- rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset + 4,
- little_endian, hf_rtps_reliability_max_blocking_time);
+ proto_tree_add_text(rtps_parameter_tree, tvb, prev_offset,
+ temp_offset - prev_offset, "%-29s | %-29s",
+ propName,
+ propValue);
+ }
}
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_LIVELINESS | 0x000c |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- * NDDS 3.1 sends only 'kind' on the wire.
- *
- */
- case PID_LIVELINESS_OFFERED: /* Deprecated */
- case PID_LIVELINESS:
- ENSURE_LENGTH(12);
- rtps_util_add_liveliness_qos(rtps_parameter_tree, tvb, offset, little_endian);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DURABILITY | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DURABILITY:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_durability, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DURABILITY_SERVICE | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- * | long history_depth |
- * +---------------+---------------+---------------+---------------+
- * | long max_samples |
- * +---------------+---------------+---------------+---------------+
- * | long max_instances |
- * +---------------+---------------+---------------+---------------+
- * | long max_samples_per_instance |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DURABILITY_SERVICE:
- ENSURE_LENGTH(28);
- rtps_util_add_durability_service_qos(rtps_parameter_tree, tvb, offset, little_endian);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_OWNERSHIP | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_OWNERSHIP_OFFERED: /* Deprecated */
- case PID_OWNERSHIP:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_ownership, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PRESENTATION | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- * | boolean | boolean | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PRESENTATION_OFFERED: /* Deprecated */
- case PID_PRESENTATION:
- ENSURE_LENGTH(6);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_access_scope, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_coherent_access, tvb, offset+4, 1, ENC_NA );
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_ordered_access, tvb, offset+5, 1, ENC_NA );
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DEADLINE | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DEADLINE_OFFERED: /* Deprecated */
- case PID_DEADLINE:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset,
- little_endian, hf_rtps_deadline_period);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DESTINATION_ORDER | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DESTINATION_ORDER_OFFERED: /* Deprecated */
- case PID_DESTINATION_ORDER:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_destination_order, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
+ }
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_FILTER_SIGNATURE | length |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ *
+ * IDL:
+ * struct CONTENT_FILTER_SIGNATURE {
+ * sequence<long> filterBitmap;
+ * sequence<FILTER_SIGNATURE, 4> filterSignature;
+ * }
+ *
+ * where:
+ * struct FILTER_SIGNATURE {
+ * long filterSignature[4];
+ * }
+ */
+ case PID_FILTER_SIGNATURE: {
+ guint32 temp_offset = offset;
+ guint32 prev_offset;
+ guint32 fs_elem;
+ guint32 fs[4];
+ ENSURE_LENGTH(8);
+
+ /* Dissect filter bitmap */
+ temp_offset = rtps_util_add_seq_ulong(rtps_parameter_tree, tvb, offset,
+ hf_rtps_filter_bitmap, little_endian, param_length, "filterBitmap");
+ /* Dissect sequence of FILTER_SIGNATURE */
+ fs_elem = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ while (fs_elem-- > 0) {
+ prev_offset = temp_offset;
+ /* Dissect the next FILTER_SIGNATURE object */
+ fs[0] = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ fs[1] = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ fs[2] = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ fs[3] = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ proto_tree_add_text(rtps_parameter_tree, tvb, prev_offset,
+ temp_offset - prev_offset,
+ "filterSignature: %08x %08x %08x %08x",
+ fs[0], fs[1], fs[2], fs[3]);
+ }
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_LATENCY_BUDGET | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_LATENCY_BUDGET_OFFERED:
- case PID_LATENCY_BUDGET:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset,
- little_endian, hf_rtps_latency_budget_duration);
- break;
+ break;
+ }
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTITION | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sequence_size |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long string[0].size |
- * +---------------+---------------+---------------+---------------+
- * | string[0][0] | string[0][1] | string[0][2] | string[0][3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * The value is a sequence of strings.
- */
- case PID_PARTITION_OFFERED: /* Deprecated */
- case PID_PARTITION:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_string(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- param_length,
- "name",
- buffer,
- MAX_PARAM_SIZE);
- break;
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_COHERENT_SET | length |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber seqNumber +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_COHERENT_SET:
+ ENSURE_LENGTH(8);
+ rtps_util_add_seq_number(rtps_parameter_tree, tvb, offset,
+ little_endian, "sequenceNumber");
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TYPECODE | length |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + Type code description +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TYPECODE:
+ rtps_util_add_typecode(rtps_parameter_tree, tvb, offset, little_endian,
+ 0, /* indent level */
+ 0, /* isPointer */
+ -1, /* bitfield */
+ 0, /* isKey */
+ offset,
+ NULL, /* name */
+ -1, /* not a seq field */
+ NULL, /* not an array */
+ 0); /* ndds 4.0 hack: init to false */
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PARTICIPANT_GUID | 0x000c |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[0] | guid[1] | guid[2] | guid[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[4] | guid[5] | guid[6] | guid[7] |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[8] | guid[9] | guid[10] | guid[11] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_PARTICIPANT_GUID:
+ if (version < 0x0200) {
+ ENSURE_LENGTH(12);
+ rtps_util_add_generic_guid_v1(rtps_parameter_tree, tvb, offset,
+ hf_rtps_participant_guid, hf_rtps_param_host_id, hf_rtps_param_app_id,
+ hf_rtps_param_instance_id, hf_rtps_param_app_kind,
+ hf_rtps_param_entity, hf_rtps_param_entity_key, hf_rtps_param_hf_entity_kind);
+ } else {
+ ENSURE_LENGTH(16);
+ rtps_util_add_generic_guid_v2(rtps_parameter_tree, tvb, offset,
+ hf_rtps_participant_guid, hf_rtps_param_host_id, hf_rtps_param_app_id,
+ hf_rtps_param_instance_id, hf_rtps_param_app_kind, hf_rtps_param_counter,
+ hf_rtps_param_entity, hf_rtps_param_entity_key, hf_rtps_param_hf_entity_kind);
+ }
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PARTICIPANT_ENTITY_ID | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | entity[0] | entity[1] | entity[2] | entity[3] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_PARTICIPANT_ENTITY_ID:
+ ENSURE_LENGTH(4);
+ rtps_util_add_generic_entity_id(rtps_parameter_tree, tvb, offset, "Participant entity ID",
+ hf_rtps_param_entity, hf_rtps_param_entity_key,
+ hf_rtps_param_hf_entity_kind, ett_rtps_entity);
+
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_GROUP_GUID | 0x000c |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[0] | guid[1] | guid[2] | guid[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[4] | guid[5] | guid[6] | guid[7] |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[8] | guid[9] | guid[10] | guid[11] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_GROUP_GUID:
+ if (version < 0x0200) {
+ ENSURE_LENGTH(12);
+ rtps_util_add_generic_guid_v1(rtps_parameter_tree, tvb, offset,
+ hf_rtps_group_guid, hf_rtps_param_host_id, hf_rtps_param_app_id,
+ hf_rtps_param_instance_id, hf_rtps_param_app_kind,
+ hf_rtps_param_entity, hf_rtps_param_entity_key, hf_rtps_param_hf_entity_kind);
+ } else {
+ ENSURE_LENGTH(16);
+ rtps_util_add_generic_guid_v2(rtps_parameter_tree, tvb, offset,
+ hf_rtps_group_guid, hf_rtps_param_host_id, hf_rtps_param_app_id,
+ hf_rtps_param_instance_id, hf_rtps_param_app_kind, hf_rtps_param_counter,
+ hf_rtps_param_entity, hf_rtps_param_entity_key, hf_rtps_param_hf_entity_kind);
+ }
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_GROUP_ENTITY_ID | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | entity[0] | entity[1] | entity[2] | entity[3] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_GROUP_ENTITY_ID:
+ ENSURE_LENGTH(4);
+ rtps_util_add_generic_entity_id(rtps_parameter_tree, tvb, offset, "Group entity ID",
+ hf_rtps_param_entity, hf_rtps_param_entity_key,
+ hf_rtps_param_hf_entity_kind, ett_rtps_entity);
+ break;
+
+ /* ==================================================================
+ * Here are all the deprecated items.
+ */
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_LIFESPAN | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_LIFESPAN:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset,
- little_endian, hf_rtps_lifespan_duration);
- break;
+ case PID_PERSISTENCE:
+ ENSURE_LENGTH(8);
+ rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset, little_endian,
+ hf_rtps_persistence);
+ break;
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_USER_DATA | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sequence_size |
- * +---------------+---------------+---------------+---------------+
- * | octect[0] | octet[1] | octect[2] | octet[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_USER_DATA:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, param_length, hf_rtps_param_user_data);
- break;
+ case PID_TYPE_CHECKSUM:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_type_checksum, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_GROUP_DATA | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sequence_size |
- * +---------------+---------------+---------------+---------------+
- * | octect[0] | octet[1] | octect[2] | octet[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_GROUP_DATA:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, param_length, hf_rtps_param_group_data);
- break;
+ case PID_EXPECTS_ACK:
+ ENSURE_LENGTH(1);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_expects_ack, tvb, offset, 1, ENC_NA );
+ break;
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TOPIC_DATA | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sequence_size |
- * +---------------+---------------+---------------+---------------+
- * | octect[0] | octet[1] | octect[2] | octet[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TOPIC_DATA:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, param_length, hf_rtps_param_topic_data);
- break;
+ case PID_MANAGER_KEY: {
+ int i = 0;
+ guint32 manager_key;
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_UNICAST_LOCATOR | 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_UNICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb,
- offset, little_endian, "locator");
- break;
+ ti = proto_tree_add_text(rtps_parameter_tree, tvb, offset, param_length, "Manager Keys");
+ subtree = proto_item_add_subtree(ti, ett_rtps_manager_key);
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_MULTICAST_LOCATOR | 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_MULTICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb,
- offset, little_endian, "locator");
- break;
+ while (param_length >= 4) {
+ manager_key = NEXT_guint32(tvb, offset, little_endian);
+ proto_tree_add_uint_format(subtree, hf_rtps_manager_key, tvb, offset, 4,
+ manager_key, "Key[%d]: 0x%X", i, manager_key);
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DEFAULT_UNICAST_LOCATOR | 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DEFAULT_UNICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb,
- offset, little_endian, "locator");
- break;
+ ++i;
+ offset +=4;
+ param_length -= 4; /* decrement count */
+ }
+ offset += param_length;
+ break;
+ }
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_METATRAFFIC_UNICAST_LOC...| 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_METATRAFFIC_UNICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb,
- offset, little_endian, "locator");
- break;
+ case PID_RECV_QUEUE_SIZE:
+ case PID_SEND_QUEUE_SIZE:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_queue_size, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_METATRAFFIC_MULTICAST_L...| 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_METATRAFFIC_MULTICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb,
- offset, little_endian, "locator");
- break;
+ case PID_VARGAPPS_SEQUENCE_NUMBER_LAST:
+ ENSURE_LENGTH(4);
+ rtps_util_add_seq_number(rtps_parameter_tree, tvb, offset, little_endian, "sequenceNumberLast");
+ break;
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTICIPANT_MANUAL_LIVE...| 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long livelinessEpoch |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PARTICIPANT_BUILTIN_ENDPOINTS:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_participant_builtin_endpoints, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
+ case PID_SENTINEL:
+ /* PID_SENTINEL should ignore any value of parameter length */
+ break;
- case PID_PARTICIPANT_MANUAL_LIVELINESS_COUNT:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_participant_manual_liveliness_count, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
+ /* This is the default branch when we don't have enough information
+ * on how to decode the parameter. It can be used also for known
+ * parameters.
+ */
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | <pid_id> | 0x0000 |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_IS_RELIABLE:
+ case PID_TYPE2_NAME:
+ case PID_TYPE2_CHECKSUM:
+ case PID_RELIABILITY_ENABLED:
+ expert_add_info_format(pinfo, parameter_item, PI_PROTOCOL, PI_WARN, "[DEPRECATED] - Parameter not decoded");
+
+ case PID_PAD:
+ if (param_length > 0) {
+ proto_tree_add_text(rtps_parameter_tree, tvb, offset, param_length, "parameterData");
+ }
+ break;
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_HISTORY | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long depth |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_HISTORY:
- ENSURE_LENGTH(8);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_history_kind, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_history_depth, tvb, offset+4, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
+ default:
+ return FALSE;
+ }
+ return TRUE;
+}
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_RESOURCE_LIMIT | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long max_samples |
- * +---------------+---------------+---------------+---------------+
- * | long max_instances |
- * +---------------+---------------+---------------+---------------+
- * | long max_samples_per_instances |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_RESOURCE_LIMIT:
- ENSURE_LENGTH(12);
- ti = proto_tree_add_text(rtps_parameter_tree, tvb, offset, 12, "Resource Limit");
- subtree = proto_item_add_subtree(ti, ett_rtps_resource_limit);
- proto_tree_add_item(subtree, hf_rtps_resource_limit_max_samples, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- proto_tree_add_item(subtree, hf_rtps_resource_limit_max_instances, tvb, offset+4, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- proto_tree_add_item(subtree, hf_rtps_resource_limit_max_samples_per_instances, tvb, offset+8, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
+static gboolean dissect_parameter_sequence_v2(proto_tree *rtps_parameter_tree, packet_info *pinfo, tvbuff_t *tvb,
+ proto_item* parameter_item, proto_item* param_len_item, gint offset,
+ gboolean little_endian, int size, int param_length, const char * label,
+ guint16 parameter, guint32 *pStatusInfo, guint16 vendor_id) {
+ proto_item *ti;
+ switch(parameter) {
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_STATUS_INFO | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | long statusInfo |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_STATUS_INFO:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_status_info, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_CONTENT_FILTER_PROPERTY | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String1.length |
- * +---------------+---------------+---------------+---------------+
- * | str1[0] | str1[1] | str1[2] | str1[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String2.length |
- * +---------------+---------------+---------------+---------------+
- * | str2[0] | str2[1] | str2[2] | str2[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String3.length |
- * +---------------+---------------+---------------+---------------+
- * | str3[0] | str3[1] | str3[2] | str3[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String4.length |
- * +---------------+---------------+---------------+---------------+
- * | str4[0] | str4[1] | str4[2] | str4[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * | Filter Parameters |
- * | ... |
- * +---------------+---------------+---------------+---------------+
- *
- * String1: ContentFilterName
- * String2: RelatedTopicName
- * String3: FilterName
- * String4: FilterExpression
- * FilterParameters: sequence of Strings
- *
- * Note: those strings starts all to a word-aligned (4 bytes) offset
- */
- case PID_CONTENT_FILTER_PROPERTY: {
- guint32 temp_offset = offset;
- ENSURE_LENGTH(20);
- temp_offset = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- hf_rtps_param_content_filter_name,
- little_endian,
- NULL, /* No label, use hf param */
- buffer,
- MAX_PARAM_SIZE);
- temp_offset = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- hf_rtps_param_related_topic_name,
- little_endian,
- NULL,
- NULL,
- 0);
- temp_offset = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- hf_rtps_param_filter_name,
- little_endian,
- NULL,
- NULL,
- 0);
- temp_offset = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- -1,
- little_endian,
- "filterExpression",
- NULL,
- 0);
- /*temp_offset = */rtps_util_add_seq_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- little_endian,
- param_length,
- "filterParameters",
- NULL,
- 0);
- break;
+ if (pStatusInfo != NULL) {
+ *pStatusInfo = NEXT_guint32(tvb, offset, little_endian);
}
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_DIRECTED_WRITE | 0x0010 |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * +- -+
+ * | octet[12] guidPrefix |
+ * +- -+
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | octet[4] entityId |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_DIRECTED_WRITE: {
+ ENSURE_LENGTH(16);
+ rtps_util_add_guid_prefix_v2(rtps_parameter_tree, tvb, offset, hf_rtps_sm_guid_prefix,
+ hf_rtps_sm_host_id, hf_rtps_sm_app_id, hf_rtps_sm_counter, "guidPrefix");
+ rtps_util_add_entity_id(rtps_parameter_tree, tvb, offset+12, hf_rtps_sm_entity_id,
+ hf_rtps_sm_entity_id_key, hf_rtps_sm_entity_id_kind, ett_rtps_entity,
+ "guidSuffix", NULL);
+ break;
+ }
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PROPERTY_LIST | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long Seq.Length |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * | Property 1 |
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * | Property 2 |
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * | Property n |
- * | ... |
- * +---------------+---------------+---------------+---------------+
- *
- * IDL:
- * struct PROPERTY {
- * String Name;
- * String Value;
- * };
- *
- * struct PROPERTY_LIST {
- * Sequence<PROPERTY> PropertyList;
- * };
- *
- */
- case PID_PROPERTY_LIST_OLD:
- ENSURE_LENGTH(4);
- {
- guint32 prev_offset;
- guint32 temp_offset;
- guint8 tempName[MAX_PARAM_SIZE];
- guint8 tempValue[MAX_PARAM_SIZE];
- guint32 seq_size = NEXT_guint32(tvb, offset, little_endian);
- g_snprintf(buffer, MAX_PARAM_SIZE, "%d properties", seq_size);
- if (seq_size > 0) {
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- 0,
- /* 123456789012345678901234567890|123456789012345678901234567890 */
- " Property Name | Property Value");
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- 0,
- /* 123456789012345678901234567890|123456789012345678901234567890 */
- "------------------------------|------------------------------");
-
- temp_offset = offset+4;
- while(seq_size-- > 0) {
- prev_offset = temp_offset;
- temp_offset = rtps_util_add_string(NULL,
- tvb,
- temp_offset,
- -1,
- little_endian,
- NULL,
- tempName,
- MAX_PARAM_SIZE);
- temp_offset = rtps_util_add_string(NULL,
- tvb,
- temp_offset,
- -1,
- little_endian,
- NULL,
- tempValue,
- MAX_PARAM_SIZE);
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- prev_offset,
- temp_offset - prev_offset,
- "%-29s | %-29s",
- tempName,
- tempValue);
- }
- }
- }
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_FILTER_SIGNATURE | length |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- *
- * IDL:
- * struct CONTENT_FILTER_SIGNATURE {
- * sequence<long> filterBitmap;
- * sequence<FILTER_SIGNATURE, 4> filterSignature;
- * }
- *
- * where:
- * struct FILTER_SIGNATURE {
- * long filterSignature[4];
- * }
- */
- case PID_FILTER_SIGNATURE: {
- guint32 temp_offset = offset;
- guint32 prev_offset;
- guint32 fs_elem;
- guint32 fs[4];
- ENSURE_LENGTH(8);
-
- /* Dissect filter bitmap */
- temp_offset = rtps_util_add_seq_ulong(rtps_parameter_tree, tvb, offset,
- hf_rtps_filter_bitmap, little_endian, param_length, "filterBitmap");
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_KEY_HASH | xxxx |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * +- -+
+ * | octet[xxxx] guid |
+ * +- -+
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * Differently from the other GUID, the KEY_HASH parameter may have
+ * variable length in the future.
+ * As consequence, no interpretation is performed here (and no check
+ * for size).
+ */
+ case PID_KEY_HASH: {
+ guint8 guidPart;
+ int i;
+ ti = proto_tree_add_text(rtps_parameter_tree, tvb, offset, param_length, "guid: ");
+ for (i = 0; i < param_length; ++i) {
+ guidPart = tvb_get_guint8(tvb, offset+i);
+ proto_item_append_text(ti, "%02x", guidPart);
+ if (( ((i+1) % 4) == 0 ) && (i != param_length-1) )
+ proto_item_append_text(ti, ":");
+ }
+ break;
+ }
- /* Dissect sequence of FILTER_SIGNATURE */
- fs_elem = NEXT_guint32(tvb, temp_offset, little_endian);
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TRANSPORT_PRIORITY | 0x0004 |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long value |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TRANSPORT_PRIORITY:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_transport_priority, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_CONTENT_FILTER_INFO | length |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ *
+ * IDL:
+ * struct CONTENT_FILTER_SIGNATURE {
+ * sequence<long> filterBitmap;
+ * sequence<FILTER_SIGNATURE, 4> filterSignature;
+ * }
+ *
+ * where:
+ * struct FILTER_SIGNATURE {
+ * long filterSignature[4];
+ * }
+ */
+ case PID_CONTENT_FILTER_INFO: {
+ guint32 temp_offset = offset;
+ guint32 prev_offset;
+ guint32 fs_elem;
+ guint32 fs[4];
+ ENSURE_LENGTH(8);
+
+ /* Dissect filter bitmap */
+ temp_offset = rtps_util_add_seq_ulong(rtps_parameter_tree, tvb, offset,
+ hf_rtps_filter_bitmap, little_endian, param_length, "filterBitmap");
+
+ /* Dissect sequence of FILTER_SIGNATURE */
+ fs_elem = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ while (fs_elem-- > 0) {
+ prev_offset = temp_offset;
+ /* Dissect the next FILTER_SIGNATURE object */
+ fs[0] = NEXT_guint32(tvb, temp_offset, little_endian);
temp_offset += 4;
- while (fs_elem-- > 0) {
- prev_offset = temp_offset;
- /* Dissect the next FILTER_SIGNATURE object */
- fs[0] = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- fs[1] = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- fs[2] = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- fs[3] = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- prev_offset,
- temp_offset - prev_offset,
- "filterSignature: %08x %08x %08x %08x",
- fs[0], fs[1], fs[2], fs[3]);
- }
-
- break;
+ fs[1] = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ fs[2] = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ fs[3] = NEXT_guint32(tvb, temp_offset, little_endian);
+ temp_offset += 4;
+ proto_tree_add_text(rtps_parameter_tree,
+ tvb,
+ prev_offset,
+ temp_offset - prev_offset,
+ "filterSignature: %08x %08x %08x %08x",
+ fs[0], fs[1], fs[2], fs[3]);
}
+ break;
+ }
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_COHERENT_SET | length |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber seqNumber +
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_COHERENT_SET:
- ENSURE_LENGTH(8);
- rtps_util_add_seq_number(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- "sequenceNumber");
- break;
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_BUILTIN_ENDPOINT_SET | length |
+ * +---------------+---------------+---------------+---------------+
+ * | long value |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_BUILTIN_ENDPOINT_SET:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_builtin_endpoint_set, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TYPE_MAX_SIZE_SERIALIZED | length |
+ * +---------------+---------------+---------------+---------------+
+ * | long value |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TYPE_MAX_SIZE_SERIALIZED:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_type_max_size_serialized, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_ORIGINAL_WRITER_INFO | length |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * +- -+
+ * | octet[12] guidPrefix |
+ * +- -+
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | octet[4] entityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_ORIGINAL_WRITER_INFO:
+ ENSURE_LENGTH(16);
+ rtps_util_add_guid_prefix_v2(rtps_parameter_tree, tvb, offset, hf_rtps_sm_guid_prefix,
+ hf_rtps_sm_host_id, hf_rtps_sm_app_id, hf_rtps_sm_counter, "virtualGUIDPrefix");
+ rtps_util_add_entity_id(rtps_parameter_tree, tvb, offset+12, hf_rtps_sm_entity_id,
+ hf_rtps_sm_entity_id_key, hf_rtps_sm_entity_id_kind, ett_rtps_entity,
+ "virtualGUIDSuffix", NULL);
+
+ /* Sequence number */
+ rtps_util_add_seq_number(rtps_parameter_tree, tvb, offset+16,
+ little_endian, "virtualSeqNumber");
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_ENTITY_NAME | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long String.length |
+ * +---------------+---------------+---------------+---------------+
+ * | str[0] | str[1] | str[2] | str[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | ... |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_ENTITY_NAME:
+ rtps_util_add_string(rtps_parameter_tree, tvb, offset, hf_rtps_param_entity_name, little_endian);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_ENDPOINT_GUID | 0x0010 |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[0] | guid[1] | guid[2] | guid[3] |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[4] | guid[5] | guid[6] | guid[7] |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[8] | guid[9] | guid[10] | guid[11] |
+ * +---------------+---------------+---------------+---------------+
+ * | guid[12] | guid[13] | guid[14] | guid[15] |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_ENDPOINT_GUID:
+ ENSURE_LENGTH(16);
+ rtps_util_add_generic_guid_v2(rtps_parameter_tree, tvb, offset,
+ hf_rtps_endpoint_guid, hf_rtps_param_host_id, hf_rtps_param_app_id,
+ hf_rtps_param_instance_id, hf_rtps_param_app_kind, hf_rtps_param_counter,
+ hf_rtps_param_entity, hf_rtps_param_entity_key, hf_rtps_param_hf_entity_kind);
+ break;
+
+ default:
+ /* The following PIDS are vendor-specific */
+ if (vendor_id == RTPS_VENDOR_RTI) {
+ switch(parameter) {
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PRODUCT_VERSION | length |
+ * +---------------+---------------+---------------+---------------+
+ * | uint8 major | uint8 minor | N O T U S E D |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_PRODUCT_VERSION: {
+ guint8 major, minor, release, revision;
+
+ ENSURE_LENGTH(4);
+ major = tvb_get_guint8(tvb, offset);
+ minor = tvb_get_guint8(tvb, offset+1);
+ release = tvb_get_guint8(tvb, offset+2);
+ revision = tvb_get_guint8(tvb, offset+3);
+ proto_tree_add_text(rtps_parameter_tree, tvb, offset, param_length,
+ "productVersion: %d.%d%c rev%d",
+ major, minor, release, revision);
+ break;
+ }
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TYPECODE | length |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + Type code description +
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TYPECODE:
- rtps_util_add_typecode(rtps_parameter_tree,
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_PLUGIN_PROMISCUITY_KIND | length |
+ * +---------------+---------------+---------------+---------------+
+ * | short value | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_PLUGIN_PROMISCUITY_KIND:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_plugin_promiscuity_kind, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_ENTITY_VIRTUAL_GUID | length |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * +- -+
+ * | octet[12] guidPrefix |
+ * +- -+
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | octet[4] entityId |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_ENTITY_VIRTUAL_GUID:
+ ENSURE_LENGTH(16);
+ rtps_util_add_guid_prefix_v2(rtps_parameter_tree, tvb, offset,
+ hf_rtps_sm_guid_prefix, hf_rtps_sm_host_id, hf_rtps_sm_app_id,
+ hf_rtps_sm_counter, "virtualGUIDPrefix");
+ rtps_util_add_entity_id(rtps_parameter_tree, tvb, offset+12,
+ hf_rtps_sm_entity_id, hf_rtps_sm_entity_id_key, hf_rtps_sm_entity_id_kind,
+ ett_rtps_entity, "virtualGUIDSuffix", NULL);
+ break;
+
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_SERVICE_KIND | length |
+ * +---------------+---------------+---------------+---------------+
+ * | long value |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_SERVICE_KIND:
+ ENSURE_LENGTH(4);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_service_kind, tvb, offset, 4,
+ little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TYPECODE_RTPS2 | length |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + Type code description +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TYPECODE_RTPS2:
+ rtps_util_add_typecode(rtps_parameter_tree,
tvb,
offset,
little_endian,
@@ -3070,193 +3761,201 @@ static gint dissect_parameter_sequence(proto_tree *tree,
0, /* isKey */
offset,
NULL, /* name */
- -1, /* not a seq field */
+ 0, /* not a seq field */
NULL, /* not an array */
0); /* ndds 4.0 hack: init to false */
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTICIPANT_GUID | 0x000c |
- * +---------------+---------------+---------------+---------------+
- * | guid[0] | guid[1] | guid[2] | guid[3] |
- * +---------------+---------------+---------------+---------------+
- * | guid[4] | guid[5] | guid[6] | guid[7] |
- * +---------------+---------------+---------------+---------------+
- * | guid[8] | guid[9] | guid[10] | guid[11] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PARTICIPANT_GUID:
- ENSURE_LENGTH(12);
- rtps_util_add_generic_guid(rtps_parameter_tree,
- tvb,
- offset,
- "Participant GUID",
- buffer,
- MAX_PARAM_SIZE);
-
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTICIPANT_ENTITY_ID | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | entity[0] | entity[1] | entity[2] | entity[3] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PARTICIPANT_ENTITY_ID:
- ENSURE_LENGTH(4);
- rtps_util_add_generic_entity_id(rtps_parameter_tree,
- tvb,
- offset,
- "Participant entity ID",
- buffer,
- MAX_PARAM_SIZE);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_GROUP_GUID | 0x000c |
- * +---------------+---------------+---------------+---------------+
- * | guid[0] | guid[1] | guid[2] | guid[3] |
- * +---------------+---------------+---------------+---------------+
- * | guid[4] | guid[5] | guid[6] | guid[7] |
- * +---------------+---------------+---------------+---------------+
- * | guid[8] | guid[9] | guid[10] | guid[11] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_GROUP_GUID:
- ENSURE_LENGTH(12);
- rtps_util_add_generic_guid(rtps_parameter_tree,
- tvb,
- offset,
- "Group GUID",
- buffer,
- MAX_PARAM_SIZE);
-
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_GROUP_ENTITY_ID | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | entity[0] | entity[1] | entity[2] | entity[3] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_GROUP_ENTITY_ID:
- ENSURE_LENGTH(4);
-
- rtps_util_add_generic_entity_id(rtps_parameter_tree,
- tvb,
- offset,
- "Group entity ID",
- buffer,
- MAX_PARAM_SIZE);
-
- break;
-
-
- /* ==================================================================
- * Here are all the deprecated items.
- */
-
- case PID_PERSISTENCE:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- hf_rtps_persistence);
- break;
-
- case PID_TYPE_CHECKSUM:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_type_checksum, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_DISABLE_POSITIVE_ACKS | length |
+ * +---------------+---------------+---------------+---------------+
+ * | boolean value | = = = = = = = = u n u s e d = = = = = = = = |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_DISABLE_POSITIVE_ACKS:
+ ENSURE_LENGTH(1);
+ proto_tree_add_item(rtps_parameter_tree, hf_rtps_disable_positive_ack, tvb, offset, 1, ENC_NA );
+ break;
+
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_LOCATOR_FILTER_LIST | length |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long number_of_channels |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ String filter_name ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ LocatorList ~ <----------+
+ * | | Repeat |
+ * +---------------+---------------+---------------+---------------+ For each|
+ * | | Channel |
+ * ~ String filter_expression ~ |
+ * | | |
+ * +---------------+---------------+---------------+---------------+ <----------+
+ */
+ case PID_LOCATOR_FILTER_LIST: {
+ guint32 number_of_channels, ch;
+ proto_tree *channel_tree;
+ proto_item *ti_channel;
+ char temp_buff[20];
+ gint old_offset;
+ guint32 off = offset;
+
+ ENSURE_LENGTH(4);
+ number_of_channels = NEXT_guint32(tvb, off, little_endian);
+ proto_item_append_text( parameter_item, " (%d channels)", number_of_channels );
+ proto_tree_add_int(rtps_parameter_tree, hf_rtps_locator_filter_list_num_channels, tvb, off, 4, number_of_channels );
+ off += 4;
+
+ if (number_of_channels == 0) {
+ /* Do not dissect the rest */
+ break;
+ }
+
+ /* filter name */
+ off = rtps_util_add_string(rtps_parameter_tree, tvb, off, hf_rtps_locator_filter_list_filter_name, little_endian);
+
+ /* Foreach channel... */
+ for (ch = 0; ch < number_of_channels; ++ch) {
+ g_snprintf(temp_buff, 20, "Channel[%u]", ch);
+ old_offset = off;
+ ti_channel = proto_tree_add_text(rtps_parameter_tree, tvb, off, 0, "Channel[%u]", ch);
+ channel_tree = proto_item_add_subtree(ti_channel, ett_rtps_locator_filter_channel);
+
+ off = rtps_util_add_locator_list(channel_tree, pinfo, tvb, off, temp_buff, little_endian);
+ /* Filter expression */
+ off = rtps_util_add_string(rtps_parameter_tree, tvb, off, hf_rtps_locator_filter_list_filter_exp, little_endian);
+
+ /* Now we know the length of the channel data, set the length */
+ proto_item_set_len(ti_channel, (off - old_offset));
+ } /* End of for each channel */
+ break;
+ } /* End of case PID_LOCATOR_FILTER_LIST */
+
+ } /* End of switch for parameters for vendor RTI */
+ } /* End of branch vendor RTI */
+ else if (vendor_id == RTPS_VENDOR_TOC) {
+ switch(parameter) {
+ /* 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | PID_TYPECODE_RTPS2 | length |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + Type code description +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ case PID_TYPECODE_RTPS2:
+ rtps_util_add_typecode(rtps_parameter_tree,
+ tvb,
+ offset,
+ little_endian,
+ 0, /* indent level */
+ 0, /* isPointer */
+ -1, /* bitfield */
+ 0, /* isKey */
+ offset,
+ NULL, /* name */
+ 0, /* not a seq field */
+ NULL, /* not an array */
+ 0); /* ndds 4.0 hack: init to false */
+ break;
+ default:
+ break;
+ } /* End of switch for parameters for vendor TOC */
+ } else { /* End of branch vendor TOC */
+ return FALSE;
+ }
+ break;
+ }
- case PID_EXPECTS_ACK:
- ENSURE_LENGTH(1);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_expects_ack, tvb, offset, 1, ENC_NA );
- break;
+ return TRUE;
+}
+#undef ENSURE_LENGTH
- case PID_MANAGER_KEY: {
- int i = 0;
- guint32 manager_key;
+static gint dissect_parameter_sequence(proto_tree *tree, packet_info *pinfo, tvbuff_t *tvb,
+ gint offset, gboolean little_endian, int size, const char * label,
+ guint16 version, guint32 *pStatusInfo, guint16 vendor_id) {
+ proto_item *ti, *param_item, *param_len_item;
+ proto_tree *rtps_parameter_sequence_tree, *rtps_parameter_tree;
+ guint16 parameter, param_length;
+ gint original_offset = offset;
- ti = proto_tree_add_text(rtps_parameter_tree, tvb, offset, param_length, "Manager Keys");
- subtree = proto_item_add_subtree(ti, ett_rtps_manager_key);
+ ti = proto_tree_add_text(tree, tvb, offset, -1, "%s:", label);
+ rtps_parameter_sequence_tree = proto_item_add_subtree(ti, ett_rtps_parameter_sequence);
- while (param_length >= 4) {
- manager_key = NEXT_guint32(tvb, offset, little_endian);
- proto_tree_add_uint_format(subtree, hf_rtps_manager_key, tvb, offset, 4,
- manager_key, "Key[%d]: 0x%X", i, manager_key);
+ /* Loop through all the parameters defined until PID_SENTINEL is found */
+ for (;;) {
+ size -= offset - original_offset;
+ if (size < 4) {
+ expert_add_info_format(pinfo, (param_len_item == NULL) ? ti : param_len_item,
+ PI_PROTOCOL, PI_WARN, "ERROR: not enough bytes to read the next parameter");
+ return 0;
+ }
+ original_offset = offset;
- ++i;
- offset +=4;
- param_length -= 4; /* decrement count */
- }
- offset += param_length;
- break;
- }
+ /* Reads parameter and create the sub tree. At this point we don't know
+ * the final string that will identify the node or its length. It will
+ * be set later...
+ */
+ parameter = NEXT_guint16(tvb, offset, little_endian);
+ if (version < 0x0200) {
+ param_item = proto_tree_add_text(rtps_parameter_sequence_tree, tvb, offset, -1,
+ "%s", val_to_str(parameter, parameter_id_vals, "Unknown (0x%04x)"));
+ rtps_parameter_tree = proto_item_add_subtree(param_item, ett_rtps_parameter);
+ proto_tree_add_uint(rtps_parameter_tree, hf_rtps_parameter_id, tvb, offset, 2, parameter);
+ } else {
+ param_item = proto_tree_add_text(rtps_parameter_sequence_tree, tvb, offset, -1,
+ "%s", val_to_str(parameter, parameter_id_v2_vals, "Unknown (0x%04x)"));
+ rtps_parameter_tree = proto_item_add_subtree(param_item, ett_rtps_parameter);
- case PID_RECV_QUEUE_SIZE:
- case PID_SEND_QUEUE_SIZE:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_queue_size, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
+ proto_tree_add_uint(rtps_parameter_tree, hf_rtps_parameter_id_v2, tvb, offset, 2, parameter);
+ }
+ offset += 2;
+ if (parameter == PID_SENTINEL) {
+ /* PID_SENTINEL closes the parameter list, (length is ignored) */
+ return offset +2;
+ }
- case PID_VARGAPPS_SEQUENCE_NUMBER_LAST:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_number(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- "sequenceNumberLast");
- break;
+ /* parameter length */
+ param_length = NEXT_guint16(tvb, offset, little_endian);
+ param_len_item = proto_tree_add_item(rtps_parameter_tree, hf_rtps_parameter_length,
+ tvb, offset, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 2;
- case PID_SENTINEL:
- /* PID_SENTINEL should ignore any value of parameter length */
- break;
+ /* Make sure we have enough bytes for the param value */
+ if ((size-4 < param_length) &&
+ (parameter != PID_SENTINEL)) {
+ expert_add_info_format(pinfo, param_len_item, PI_PROTOCOL, PI_WARN, "Not enough bytes to read the parameter value");
+ return 0;
+ }
+ /* Sets the end of this item (now we know it!) */
+ proto_item_set_len(param_item, param_length+4);
- /* This is the default branch when we don't have enough information
- * on how to decode the parameter. It can be used also for known
- * parameters.
- */
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | <pid_id> | 0x0000 |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_IS_RELIABLE:
- case PID_TYPE2_NAME:
- case PID_TYPE2_CHECKSUM:
- g_strlcpy(buffer, "[DEPRECATED] - Parameter not decoded", MAX_PARAM_SIZE);
-
- case PID_PAD:
- case PID_RELIABILITY_ENABLED:
- default:
+ if (!dissect_parameter_sequence_v1(rtps_parameter_tree, pinfo, tvb, param_item, param_len_item,
+ offset, little_endian, size, param_length, label, parameter, version)) {
+ if ((version < 0x0200) ||
+ !dissect_parameter_sequence_v2(rtps_parameter_tree, pinfo, tvb, param_item, param_len_item,
+ offset, little_endian, size, param_length, label, parameter,
+ pStatusInfo, vendor_id)) {
if (param_length > 0) {
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- param_length,
+ proto_tree_add_text(rtps_parameter_tree, tvb, offset, param_length,
"parameterData");
}
- } /* End switch */
-
- if (buffer[0]) {
- proto_item_append_text(param_item, ": %s", buffer);
- buffer[0] = '\0';
+ }
}
- offset += param_length;
- } while(parameter != PID_SENTINEL); /* for all the parameters */
+ offset += param_length;
+ }
return offset;
}
-#undef ENSURE_LENGTH
gboolean rtps_is_ping(tvbuff_t *tvb, packet_info *pinfo, gint offset)
@@ -3273,6 +3972,59 @@ gboolean rtps_is_ping(tvbuff_t *tvb, packet_info *pinfo, gint offset)
}
/* *********************************************************************** */
+/* * Serialized data dissector * */
+/* *********************************************************************** */
+/* Note: the encapsulation header is ALWAYS big endian, then the encapsulation
+ * type specified the type of endianess of the payload.
+ */
+static void dissect_serialized_data(proto_tree *tree, packet_info *pinfo, tvbuff_t *tvb, gint offset,
+ int size, const char * label, guint16 vendor_id) {
+ proto_item * ti;
+ proto_tree * rtps_parameter_sequence_tree;
+ guint16 encapsulation_id;
+ gboolean encapsulation_little_endian = FALSE;
+
+ /* Creates the sub-tree */
+ ti = proto_tree_add_text(tree, tvb, offset, -1, "%s", label);
+ rtps_parameter_sequence_tree = proto_item_add_subtree(ti, ett_rtps_serialized_data);
+
+ /* Encapsulation ID */
+ encapsulation_id = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
+ proto_tree_add_uint(rtps_parameter_sequence_tree, hf_rtps_param_serialize_encap_kind, tvb, offset, 2, encapsulation_id);
+ offset += 2;
+
+ /* Sets the correct values for encapsulation_le */
+ if (encapsulation_id == ENCAPSULATION_CDR_LE ||
+ encapsulation_id == ENCAPSULATION_PL_CDR_LE) {
+ encapsulation_little_endian = TRUE;
+ }
+
+ /* Encapsulation length (or option) */
+ proto_tree_add_item(rtps_parameter_sequence_tree, hf_rtps_param_serialize_encap_len, tvb, offset, 2, ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* The payload */
+ size -= 4;
+ switch (encapsulation_id) {
+ case ENCAPSULATION_CDR_LE:
+ case ENCAPSULATION_CDR_BE:
+ proto_tree_add_item(rtps_parameter_sequence_tree, hf_rtps_issue_data, tvb,
+ offset, size, encapsulation_little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ break;
+
+ case ENCAPSULATION_PL_CDR_LE:
+ case ENCAPSULATION_PL_CDR_BE:
+ dissect_parameter_sequence(rtps_parameter_sequence_tree, pinfo, tvb, offset,
+ encapsulation_little_endian, size, label, 0x0200, NULL, vendor_id);
+ break;
+
+ default:
+ proto_tree_add_text(rtps_parameter_sequence_tree, tvb, offset,
+ size, "%s", label);
+ }
+}
+
+/* *********************************************************************** */
/* * P A D * */
/* *********************************************************************** */
void dissect_PAD(tvbuff_t *tvb,
@@ -3280,7 +4032,7 @@ void dissect_PAD(tvbuff_t *tvb,
gint offset,
guint8 flags,
gboolean little_endian,
- int octects_to_next_header,
+ int octets_to_next_header,
proto_tree *tree) {
/* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -3297,7 +4049,7 @@ void dissect_PAD(tvbuff_t *tvb,
offset + 2,
2,
little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- if (octects_to_next_header != 0) {
+ if (octets_to_next_header != 0) {
expert_add_info_format(pinfo, item, PI_PROTOCOL, PI_WARN, "Should be ZERO");
}
}
@@ -3309,13 +4061,8 @@ void dissect_PAD(tvbuff_t *tvb,
/* *********************************************************************** */
/* * D A T A * */
/* *********************************************************************** */
-static void dissect_DATA(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) { /* May be set to some known values */
+static void dissect_DATA_v1(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree) {
/* RTPS 1.0/1.1:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -3378,14 +4125,10 @@ static void dissect_DATA(tvbuff_t *tvb,
guint32 wid; /* Writer EntityID */
proto_item* octet_item;
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, DATA_FLAGS);
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, DATA_FLAGSv1);
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
/* Calculates the minimum length for this submessage */
min_len = 20;
@@ -3447,7 +4190,7 @@ static void dissect_DATA(tvbuff_t *tvb,
/* If flag H is defined, read the HostId and AppId fields */
if ((flags & FLAG_DATA_H) != 0) {
- rtps_util_add_guid_prefix(tree, tvb, offset,
+ rtps_util_add_guid_prefix_v1(tree, tvb, offset,
hf_rtps_sm_guid_prefix, hf_rtps_sm_host_id, hf_rtps_sm_app_id,
hf_rtps_sm_instance_id, hf_rtps_sm_app_kind,
"keyHashPrefix");
@@ -3458,57 +4201,303 @@ static void dissect_DATA(tvbuff_t *tvb,
}
/* Complete the GUID by reading the Object ID */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_entity_id,
- hf_rtps_sm_entity_id_key,
- hf_rtps_sm_entity_id_kind,
- ett_rtps_entity,
- "keyHashSuffix",
- NULL);
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_entity_id, hf_rtps_sm_entity_id_key,
+ hf_rtps_sm_entity_id_kind, ett_rtps_entity, "keyHashSuffix", NULL);
offset += 4;
/* Sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSeqNumber");
offset += 8;
/* InlineQos */
if ((flags & FLAG_DATA_Q) != 0) {
offset = dissect_parameter_sequence(tree, pinfo, tvb, offset,
- little_endian, octets_to_next_header, "inlineQos");
+ little_endian, octets_to_next_header, "inlineQos",
+ 0x0102, NULL, 0);
}
/* SerializedData */
if ((flags & FLAG_DATA_D) != 0) {
if (is_builtin_entity) {
- /*offset =*/ dissect_parameter_sequence(tree, pinfo, tvb, offset,
- little_endian, octets_to_next_header, "serializedData");
+ offset = dissect_parameter_sequence(tree, pinfo, tvb, offset,
+ little_endian, octets_to_next_header, "serializedData",
+ 0x0102, NULL, 0);
} else {
- proto_tree_add_item(tree,
- hf_rtps_issue_data,
- tvb,
- offset,
+ proto_tree_add_item(tree, hf_rtps_issue_data, tvb, offset,
octets_to_next_header - (offset - old_offset) + 4,
little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
}
}
}
+static void dissect_DATA_v2(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree,
+ guint16 vendor_id) {
+ /*
+ *
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | DATA |X|X|X|I|H|D|Q|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + +
+ * | KeyHashPrefix keyHashPrefix [only if H==1] |
+ * + +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | KeyHashSuffix keyHashSuffix |
+ * +---------------+---------------+---------------+---------------+
+ * | StatusInfo statusInfo [only if I==1] |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList inlineQos [only if Q==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SerializedData serializedData [only if D==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ int min_len;
+ gint old_offset = offset;
+ guint32 wid; /* Writer EntityID */
+ guint32 status_info = 0xffffffff;
+ proto_item* octet_item;
+
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, DATA_FLAGSv2);
+
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ /* Calculates the minimum length for this submessage */
+ min_len = 20;
+ if ((flags & FLAG_DATA_Q_v2) != 0) min_len += 4;
+ if ((flags & FLAG_DATA_D_v2) != 0) min_len += 4;
+ if ((flags & FLAG_DATA_H) != 0) min_len += 12;
+
+ if (octets_to_next_header < min_len) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL)
+ * Note that we still need to decode the statusInfo and the writer ID
+ */
+ if (tree == NULL) {
+ offset += 8; /* Skip to writer entity ID */
+ wid = NEXT_guint32(tvb, offset, little_endian);
+ offset += 12; /* Skip to keyHashPrefix */
+ if ((flags & FLAG_DATA_H) != 0) {
+ offset += 12;
+ }
+ offset += 4; /* GUID Entity ID */
+ if ((flags & FLAG_DATA_I) != 0) {
+ status_info = NEXT_guint32(tvb, offset, little_endian);
+ }
+ info_summary_append_ex(pinfo, wid, status_info);
+ return;
+ }
+
+ offset += 4;
+
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", &wid);
+ offset += 4;
+
+
+ /* Sequence number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSeqNumber");
+ offset += 8;
+
+ /* If flag H is defined, read the GUID Prefix */
+ if ((flags & FLAG_DATA_H) != 0) {
+ rtps_util_add_guid_prefix_v2(tree, tvb, offset, hf_rtps_sm_guid_prefix, hf_rtps_sm_host_id,
+ hf_rtps_sm_app_id, hf_rtps_sm_counter, "keyHashPrefix");
+
+ offset += 12;
+ } else {
+ /* Flag H not set, use hostId, appId from the packet header */
+ }
+
+ /* Complete the GUID by reading the Object ID */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_entity_id, hf_rtps_sm_entity_id_key,
+ hf_rtps_sm_entity_id_kind, ett_rtps_entity, "keyHashSuffix", NULL);
+ offset += 4;
+
+ if ((flags & FLAG_DATA_I) != 0) {
+ octet_item = proto_tree_add_item(tree, hf_rtps_data_status_info, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+ }
+
+ /* InlineQos */
+ if ((flags & FLAG_DATA_Q_v2) != 0) {
+ offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "inlineQos", 0x0200, NULL, vendor_id);
+ }
+
+ /* SerializedData */
+ if ((flags & FLAG_DATA_D_v2) != 0) {
+ dissect_serialized_data(tree, pinfo, tvb, offset,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "serializedData", vendor_id);
+ }
+ info_summary_append_ex(pinfo, wid, status_info);
+}
+
+static void dissect_DATA_FRAG(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree, guint16 vendor_id) {
+ /*
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | DATA_FRAG |X|X|X|X|X|H|Q|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + +
+ * | KeyHashPrefix keyHashPrefix [only if H==1] |
+ * + +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | KeyHashSuffix keyHashSuffix |
+ * +---------------+---------------+---------------+---------------+
+ * | FragmentNumber fragmentStartingNum |
+ * +---------------+---------------+---------------+---------------+
+ * | ushort fragmentsInSubmessage | ushort fragmentSize |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long sampleSize |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList inlineQos [only if Q==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SerializedData serializedData ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+
+ int min_len;
+ gint old_offset = offset;
+ proto_item* octet_item;
+
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, NOKEY_DATA_FRAG_FLAGS);
+
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ /* Calculates the minimum length for this submessage */
+ min_len = 32;
+ if ((flags & FLAG_DATA_FRAG_Q) != 0) min_len += 4;
+ if ((flags & FLAG_DATA_FRAG_H) != 0) min_len += 12;
+
+ if (octets_to_next_header < min_len) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL)
+ */
+ if (tree == NULL) {
+ return;
+ }
+
+ offset += 4;
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", NULL);
+ offset += 4;
+
+ /* Sequence number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSeqNumber");
+ offset += 8;
+
+ /* If flag H is defined, read the GUID Prefix */
+ if ((flags & FLAG_DATA_H) != 0) {
+ rtps_util_add_guid_prefix_v2(tree, tvb, offset, hf_rtps_sm_guid_prefix,
+ hf_rtps_sm_host_id, hf_rtps_sm_app_id, hf_rtps_sm_counter, "keyHashPrefix");
+ offset += 12;
+ } else {
+ /* Flag H not set, use hostId, appId from the packet header */
+ }
+
+ /* Complete the GUID by reading the Object ID */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_entity_id, hf_rtps_sm_entity_id_key,
+ hf_rtps_sm_entity_id_kind, ett_rtps_entity, "keyHashSuffix", NULL);
+ offset += 4;
+
+
+ /* Fragment number */
+ proto_tree_add_item(tree, hf_rtps_data_frag_number, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+
+ /* Fragments in submessage */
+ proto_tree_add_item(tree, hf_rtps_data_frag_num_fragments, tvb,
+ offset, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* Fragment size */
+ proto_tree_add_item(tree, hf_rtps_data_frag_size, tvb,
+ offset, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* sampleSize */
+ proto_tree_add_item(tree, hf_rtps_data_frag_sample_size, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+
+ /* InlineQos */
+ if ((flags & FLAG_DATA_Q_v2) != 0) {
+ offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "inlineQos", 0x0200, NULL, vendor_id);
+ }
+
+ /* SerializedData */
+ if ((flags & FLAG_DATA_D_v2) != 0) {
+ dissect_serialized_data(tree, pinfo, tvb, offset,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "serializedData", vendor_id);
+ }
+}
+
+
/* *********************************************************************** */
/* * N O K E Y _ D A T A * */
/* *********************************************************************** */
-static void dissect_NOKEY_DATA(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
+static void dissect_NOKEY_DATA(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree,
+ guint16 version, guint16 vendor_id) {
/* RTPS 1.0/1.1:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -3552,6 +4541,28 @@ static void dissect_NOKEY_DATA(tvbuff_t *tvb,
* ~ SerializedData serializedData [only if D==0] ~
* | |
* +---------------+---------------+---------------+---------------+
+ *
+ * RTPS 2.0:
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | NOKEY_DATA |X|X|X|X|X|D|Q|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList inlineQos [only if Q==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SerializedData serializedData [only if D==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
* Notes:
* - inlineQos is equivalent to the old 'parameters'
* - serializedData is equivalent to the old 'issueData'
@@ -3563,12 +4574,8 @@ static void dissect_NOKEY_DATA(tvbuff_t *tvb,
rtps_util_decode_flags(tree, tvb, offset + 1, flags, NOKEY_DATA_FLAGS);
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
/* Calculates the minimum length for this submessage */
min_len = 16;
@@ -3582,67 +4589,151 @@ static void dissect_NOKEY_DATA(tvbuff_t *tvb,
offset += 4;
/* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
offset += 4;
/* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", NULL);
offset += 4;
/* Sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSeqNumber");
offset += 8;
/* Parameters */
if ((flags & FLAG_NOKEY_DATA_Q) != 0) {
offset = dissect_parameter_sequence(tree, pinfo, tvb, offset,
- little_endian, octets_to_next_header, "inlineQos");
+ little_endian, octets_to_next_header, "inlineQos",
+ version, NULL, vendor_id);
}
/* Issue Data */
- if ((flags & FLAG_NOKEY_DATA_D) == 0) {
- proto_tree_add_item(tree,
- hf_rtps_issue_data,
- tvb,
- offset,
- octets_to_next_header - (offset - old_offset) + 4,
+ if ((version < 0x0200) && (flags & FLAG_NOKEY_DATA_D) == 0) {
+ proto_tree_add_item(tree, hf_rtps_issue_data, tvb, offset,
+ octets_to_next_header - (offset - old_offset) + 4,
little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
}
+
+ if ((version >= 0x0200) && (flags & FLAG_DATA_D_v2) != 0) {
+ dissect_serialized_data(tree, pinfo, tvb, offset,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "serializedData", vendor_id);
+ }
+
+}
+
+/* *********************************************************************** */
+/* * N O K E Y _ D A T A _ F R A G * */
+/* *********************************************************************** */
+static void dissect_NOKEY_DATA_FRAG(tvbuff_t *tvb, packet_info *pinfo, gint offset,
+ guint8 flags, gboolean little_endian, int octets_to_next_header, proto_tree *tree,
+ guint16 vendor_id) {
+ /*
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |NOKEY_DATA_FRAG|X|X|X|X|X|X|Q|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | FragmentNumber fragmentStartingNum |
+ * +---------------+---------------+---------------+---------------+
+ * | ushort fragmentsInSubmessage | ushort fragmentSize |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long sampleSize |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList inlineQos [only if Q==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SerializedData serializedData ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+
+ int min_len;
+ gint old_offset = offset;
+ proto_item* octet_item;
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, NOKEY_DATA_FRAG_FLAGS);
+
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ /* Calculates the minimum length for this submessage */
+ min_len = 28;
+ if ((flags & FLAG_NOKEY_DATA_Q) != 0) min_len += 4;
+
+ if (octets_to_next_header < min_len) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL) */
+ if (tree == NULL) {
+ return;
+ }
+
+ offset += 4;
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", NULL);
+ offset += 4;
+
+ /* Sequence number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSeqNumber");
+ offset += 8;
+
+ /* Fragment number */
+ proto_tree_add_item(tree, hf_rtps_nokey_data_frag_number, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+
+ /* Fragments in submessage */
+ proto_tree_add_item(tree, hf_rtps_nokey_data_frag_num_fragments, tvb,
+ offset, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* Fragment size */
+ proto_tree_add_item(tree, hf_rtps_nokey_data_frag_size, tvb,
+ offset, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* InlineQos */
+ if ((flags & FLAG_DATA_Q_v2) != 0) {
+ offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "inlineQos", 0x0200, NULL, vendor_id);
+ }
+
+ /* SerializedData */
+ if ((flags & FLAG_DATA_D_v2) != 0) {
+ dissect_serialized_data(tree, pinfo, tvb,offset,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "serializedData", vendor_id);
+ }
}
/* *********************************************************************** */
/* * A C K N A C K * */
/* *********************************************************************** */
-static void dissect_ACKNACK(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree,
- proto_item *item) {
+static void dissect_ACKNACK(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree, proto_item *item) {
/* RTPS 1.0/1.1:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -3659,7 +4750,7 @@ static void dissect_ACKNACK(tvbuff_t *tvb,
* | Counter count |
* +---------------+---------------+---------------+---------------+
*
- * RTPS 1.2:
+ * RTPS 1.2/2.0:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* | ACKNACK |X|X|X|X|X|X|F|E| octetsToNextHeader |
@@ -3750,18 +4841,83 @@ static void dissect_ACKNACK(tvbuff_t *tvb,
}
+/* *********************************************************************** */
+/* * N A C K _ F R A G * */
+/* *********************************************************************** */
+static void dissect_NACK_FRAG(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree) {
+ /*
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | NACK_FRAG |X|X|X|X|X|X|X|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumberSet writerSN +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ FragmentNumberSet fragmentNumberState +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | Counter count |
+ * +---------------+---------------+---------------+---------------+
+ */
+ proto_item* octet_item;
+
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, NACK_FRAG_FLAGS);
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ if (octets_to_next_header < 24) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 24)");
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL)
+ * Note that we still need to decode the statusInfo and the writer ID
+ */
+ if (tree == NULL) {
+ return;
+ }
+
+ offset += 4;
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", NULL);
+ offset += 4;
+
+ /* Writer sequence number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSN");
+ offset += 8;
+
+ /* FragmentNumberSet */
+ offset = rtps_util_add_fragment_number_set(tree, pinfo, tvb, offset, little_endian,
+ "fragmentNumberState", octets_to_next_header - 20);
+
+ if (offset == -1) {
+ return;
+ }
+ /* Count */
+ proto_tree_add_item(tree, hf_rtps_nack_frag_count, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+}
/* *********************************************************************** */
/* * H E A R T B E A T * */
/* *********************************************************************** */
-static void dissect_HEARTBEAT(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
+static void dissect_HEARTBEAT(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree, guint16 version) {
/* RTPS 1.0/1.1:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -3786,7 +4942,7 @@ static void dissect_HEARTBEAT(tvbuff_t *tvb,
* - on RTPS 1.0, counter is not present
* - on RTPS 1.0, L flag is not present
*
- * RTPS 1.2:
+ * RTPS 1.2/2.0:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* | HEARTBEAT |X|X|X|X|X|X|F|E| octetsToNextHeader |
@@ -3818,65 +4974,871 @@ static void dissect_HEARTBEAT(tvbuff_t *tvb,
2,
little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- if (octets_to_next_header < 24) {
+ if ((octets_to_next_header < 24) && (version <= 0x0101)) {
expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 24)");
return;
}
+ else if (octets_to_next_header < 28) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 28)");
+ return;
+ }
offset += 4;
/* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
offset += 4;
/* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", NULL);
offset += 4;
/* First available Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "firstAvailableSeqNumber");
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "firstAvailableSeqNumber");
offset += 8;
/* Last Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "lastSeqNumber");
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "lastSeqNumber");
offset += 8;
/* Counter: it was not present in RTPS 1.0 */
- if (octets_to_next_header == 0x28) {
+ if (version >= 0x0101) {
counter = NEXT_guint32(tvb, offset, little_endian);
- proto_tree_add_text(tree,
- tvb,
- offset,
- 4,
- "count: %u",
- counter);
+ proto_tree_add_text(tree, tvb, offset, 4, "count: %u", counter);
+ }
+}
+
+/* *********************************************************************** */
+/* * H E A R T B E A T _ B A T C H * */
+/* *********************************************************************** */
+static void dissect_HEARTBEAT_BATCH(tvbuff_t *tvb, packet_info *pinfo, gint offset,
+ guint8 flags, gboolean little_endian, int octets_to_next_header, proto_tree *tree) {
+ /*
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |HEARTBEAT_BATCH|X|X|X|X|X|L|F|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber firstBatchSN +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber lastBatchSN +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber firstSN +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber lastSN +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | Count count |
+ * +---------------+---------------+---------------+---------------+
+ */
+ proto_item* octet_item;
+
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, HEARTBEAT_BATCH_FLAGS);
+
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ if (octets_to_next_header < 36) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 36)");
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL) */
+ if (tree == NULL) {
+ return;
+ }
+
+ offset += 4;
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", NULL);
+ offset += 4;
+
+ /* First available Batch Sequence Number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "firstBatchSN");
+ offset += 8;
+
+ /* Last Batch Sequence Number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "lastBatchSN");
+ offset += 8;
+
+ /* First available Sequence Number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "firstSeqNumber");
+ offset += 8;
+
+ /* Last Sequence Number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "lastSeqNumber");
+ offset += 8;
+
+ /* Counter */
+ proto_tree_add_item(tree, hf_rtps_heartbeat_batch_count, tvb, offset,
+ 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+}
+
+/* *********************************************************************** */
+/* * H E A R T B E A T _ F R A G * */
+/* *********************************************************************** */
+static void dissect_HEARTBEAT_FRAG(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree) {
+ /*
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |HEARTBEAT_FRAG |X|X|X|X|X|X|X|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSeqNumber +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | FragmentNumber lastFragmentNum |
+ * +---------------+---------------+---------------+---------------+
+ * | Counter count |
+ * +---------------+---------------+---------------+---------------+
+ */
+ proto_item* octet_item;
+
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, HEARTBEAT_FRAG_FLAGS);
+
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ if (octets_to_next_header < 24) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 24)");
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL) */
+ if (tree == NULL) {
+ return;
+ }
+
+ offset += 4;
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", NULL);
+ offset += 4;
+
+ /* First available Sequence Number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSeqNumber");
+ offset += 8;
+
+ /* Fragment number */
+ proto_tree_add_item(tree, hf_rtps_heartbeat_frag_number, tvb, offset,
+ 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+
+ /* Counter */
+ proto_tree_add_item(tree, hf_rtps_heartbeat_frag_count, tvb, offset,
+ 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+}
+
+/* *********************************************************************** */
+/* * R T P S _ D A T A * */
+/* * A N D * */
+/* * R T P S _ D A T A _ S E S S I O N * */
+/* *********************************************************************** */
+static void dissect_RTPS_DATA(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree,
+ guint16 vendor_id, gboolean is_session) {
+ /*
+ *
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * | RTPS_DATA |X|X|X|X|K|D|Q|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | Flags extraFlags | octetsToInlineQos |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList inlineQos [only if Q==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SerializedData serializedData [only if D==1 || K==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ *
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |RTPS_DATA_SESSI|X|X|X|X|K|D|Q|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | Flags extraFlags | octetsToInlineQos |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSessionSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerVirtualSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList inlineQos [only if Q==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SerializedData serializedData [only if D==1 || K==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ int min_len;
+ gint old_offset = offset;
+ guint32 wid; /* Writer EntityID */
+ guint32 status_info = 0xffffffff;
+ proto_item* octet_item;
+
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, RTPS_DATA_FLAGS);
+
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ /* Calculates the minimum length for this submessage */
+ min_len = 24;
+ if (is_session) {
+ min_len += 8;
+ }
+ if ((flags & FLAG_RTPS_DATA_Q) != 0) min_len += 4;
+ if ((flags & FLAG_RTPS_DATA_D) != 0) min_len += 4;
+ if ((flags & FLAG_RTPS_DATA_K) != 0) min_len += 4;
+
+ if (octets_to_next_header < min_len) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL)
+ * Note that we still need to decode the statusInfo and the writer ID
+ */
+ if (tree == NULL) {
+ offset += 12;
+ /* writerEntityId */
+ wid = NEXT_guint32(tvb, offset, little_endian);
+
+ offset += 12;
+ if ((flags & FLAG_RTPS_DATA_Q) != 0) {
+ /*offset = */dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "inlineQos", 0x0200, &status_info, vendor_id);
+ }
+ info_summary_append_ex(pinfo, wid, status_info);
+ return;
+ }
+
+ offset += 4;
+
+ /* extraFlags */
+ proto_tree_add_item(tree, hf_rtps_extra_flags, tvb, offset, 2, ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* octetsToInlineQos */
+ proto_tree_add_text(tree, tvb, offset, 2, "Octets to inline QoS: %d",
+ NEXT_guint16(tvb, offset, little_endian));
+ offset += 2;
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", &wid);
+ offset += 4;
+
+ /* Sequence number */
+ if (is_session) {
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSessionSeqNumber");
+ offset += 8;
+
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerVirtualSeqNumber");
+ offset += 8;
+ } else {
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSeqNumber");
+ offset += 8;
+ }
+
+ /* InlineQos */
+ if ((flags & FLAG_RTPS_DATA_Q) != 0) {
+ offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "inlineQos", 0x0200, &status_info, vendor_id);
+ }
+
+ /* SerializedData */
+ if (((flags & FLAG_RTPS_DATA_D) != 0) || ((flags & FLAG_RTPS_DATA_K) != 0)) {
+ if (wid == ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER) {
+ /* Dissect the serialized data as ParticipantMessageData:
+ * struct ParticipantMessageData {
+ * KeyHashPrefix_t participantGuidPrefix;
+ * KeyHashSuffix_t kind;
+ * sequence<octet> data;
+ * }
+ */
+ proto_tree * rtps_pm_tree;
+ proto_tree * guid_tree;
+ guint32 kind;
+ guint16 encapsulation_id;
+ guint16 encapsulation_len;
+ /*int encapsulation_little_endian = 0;*/
+ proto_item * ti = proto_tree_add_text(tree, tvb, offset,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "ParticipantMessageData");
+
+ rtps_pm_tree = proto_item_add_subtree(ti, ett_rtps_part_message_data);
+ /* Encapsulation ID */
+ encapsulation_id = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
+
+ proto_tree_add_text(rtps_pm_tree, tvb, offset, 2, "encapsulation kind: %s",
+ val_to_str(encapsulation_id, encapsulation_id_vals, "unknown (%02x)"));
+ offset += 2;
+
+#if 0 /* XXX: encapsulation_little_endian not actually used anywhere ?? */
+ /* Sets the correct values for encapsulation_le */
+ if (encapsulation_id == ENCAPSULATION_CDR_LE ||
+ encapsulation_id == ENCAPSULATION_PL_CDR_LE) {
+ encapsulation_little_endian = 1;
+ }
+#endif
+
+ /* Encapsulation length (or option) */
+ encapsulation_len = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
+ proto_tree_add_text(rtps_pm_tree, tvb, offset, 2,
+ "encapsulation options: %04x", encapsulation_len);
+ offset += 2;
+
+ guid_tree = proto_item_add_subtree(ti, ett_rtps_part_message_data);
+
+ rtps_util_add_guid_prefix_v2(guid_tree, tvb, offset, hf_rtps_sm_guid_prefix, hf_rtps_sm_host_id,
+ hf_rtps_sm_app_id, hf_rtps_sm_counter, "participantGuidPrefix");
+ offset += 12;
+
+ /* Kind */
+ kind = NEXT_guint32(tvb, offset, FALSE); /* Always big endian */
+ proto_tree_add_text(guid_tree, tvb, offset, 4, "kind: %s",
+ val_to_str(kind, participant_message_data_kind, "unknown (%04x)"));
+ offset += 4;
+
+ rtps_util_add_seq_octets(rtps_pm_tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset), hf_rtps_data_serialize_data);
+
+ } else {
+ const char *label;
+ if (((flags & FLAG_RTPS_DATA_D) != 0) || ((flags & FLAG_RTPS_DATA_K) == 0)) {
+ label = "serializedData";
+ } else if (((flags & FLAG_RTPS_DATA_D) == 0) || ((flags & FLAG_RTPS_DATA_K) != 0)) {
+ label = "serializedKey";
+ } else {
+ /* D==1 && K==1 */
+ label = "<invalid or unknown data type>";
+ }
+
+ /* At the end still dissect the rest of the bytes as raw data */
+ dissect_serialized_data(tree, pinfo, tvb, offset,
+ octets_to_next_header - (offset - old_offset) + 4,
+ label, vendor_id);
+ }
+ }
+
+ info_summary_append_ex(pinfo, wid, status_info);
+}
+
+/* *********************************************************************** */
+/* * R T P S _ D A T A _ F R A G * */
+/* *********************************************************************** */
+static void dissect_RTPS_DATA_FRAG(tvbuff_t *tvb,
+ packet_info *pinfo,
+ gint offset,
+ guint8 flags,
+ gboolean little_endian,
+ int octets_to_next_header,
+ proto_tree *tree,
+ guint16 vendor_id) {
+ /*
+ *
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |RTPS_DATA_FRAG |X|X|X|X|X|K|Q|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | Flags extraFlags | octetsToInlineQos |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerEntityId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber writerSeqNum +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | FragmentNumber fragmentStartingNum |
+ * +---------------+---------------+---------------+---------------+
+ * | ushort fragmentsInSubmessage | ushort fragmentSize |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long sampleSize |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList inlineQos [only if Q==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SerializedData serializedData ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ */
+ int min_len;
+ gint old_offset = offset;
+ guint32 wid; /* Writer EntityID */
+ guint32 status_info = 0xffffffff;
+ proto_item* octet_item;
+
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, RTPS_DATA_FRAG_FLAGS);
+
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ /* Calculates the minimum length for this submessage */
+ min_len = 36;
+ if ((flags & FLAG_RTPS_DATA_FRAG_Q) != 0) min_len += 4;
+
+ if (octets_to_next_header < min_len) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL)
+ * Note that we still need to decode the statusInfo and the writer ID
+ */
+ if (tree == NULL) {
+ offset += 12;
+ /* writerEntityId */
+ wid = NEXT_guint32(tvb, offset, little_endian);
+
+ offset += 24;
+ if ((flags & FLAG_RTPS_DATA_FRAG_Q) != 0) {
+ /*offset = */dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "inlineQos", 0x0200, &status_info, vendor_id);
+ }
+ info_summary_append_ex(pinfo, wid, status_info);
+ return;
}
+
+ offset += 4;
+
+ /* extraFlags */
+ proto_tree_add_item(tree, hf_rtps_extra_flags, tvb, offset, 2, ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* octetsToInlineQos */
+ proto_tree_add_text(tree, tvb, offset, 2, "Octets to inline QoS: %d",
+ NEXT_guint16(tvb, offset, little_endian));
+ offset += 2;
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", &wid);
+ offset += 4;
+
+
+ /* Sequence number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "writerSeqNumber");
+ offset += 8;
+
+ /* Fragment number */
+ proto_tree_add_item(tree, hf_rtps_data_frag_number, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+
+ /* Fragments in submessage */
+ proto_tree_add_item(tree, hf_rtps_data_frag_num_fragments, tvb,
+ offset, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* Fragment size */
+ proto_tree_add_item(tree, hf_rtps_data_frag_size, tvb,
+ offset, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* sampleSize */
+ proto_tree_add_item(tree, hf_rtps_data_frag_sample_size, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+
+ /* InlineQos */
+ if ((flags & FLAG_RTPS_DATA_FRAG_Q) != 0) {
+ offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "inlineQos", 0x0200, &status_info, vendor_id);
+ }
+
+ /* SerializedData */
+ {
+ const char *label = "serializedData";
+ if ((flags & FLAG_RTPS_DATA_FRAG_K) != 0) {
+ label = "serializedKey";
+ }
+ dissect_serialized_data(tree, pinfo, tvb, offset,
+ octets_to_next_header - (offset - old_offset) + 4,
+ label, vendor_id);
+ }
+ info_summary_append_ex(pinfo, wid, status_info);
}
+/* *********************************************************************** */
+/* * R T P S _ D A T A _ B A T C H * */
+/* *********************************************************************** */
+static void dissect_RTPS_DATA_BATCH(tvbuff_t *tvb, packet_info *pinfo, gint offset,
+ guint8 flags, gboolean little_endian, int octets_to_next_header,
+ proto_tree *tree, guint16 vendor_id) {
+ /*
+ *
+ * 0...2...........7...............15.............23...............31
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |RTPS_DATA_BATCH|X|X|X|X|X|X|Q|E| octetsToNextHeader |
+ * +---------------+---------------+---------------+---------------+
+ * | Flags extraFlags | octetsToInlineQos |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId readerId |
+ * +---------------+---------------+---------------+---------------+
+ * | EntityId writerId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber batchSN +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + SequenceNumber firstSampleSN +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | SequenceNumberOffset offsetToLastSampleSN |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long batchSampleCount |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList batchInlineQos [only if Q==1] ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long octetsToSLEncapsulationId |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SampleInfoList sampleInfoList ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | SampleListEncapsulationId | |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SampleList sampleList ~
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ *
+ *
+ * SampleInfo:
+ * 0...............8..............16..............24..............32
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |X|X|X|X|X|X|X|X|X|X|K|I|D|O|Q|T| octetsToInlineQoS |
+ * +---------------+---------------+---------------+---------------+
+ * | unsigned long serializedDataLength |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * + Timestamp timestamp [only if T==1] +
+ * | |
+ * +---------------+---------------+---------------+---------------+
+ * | SequenceNumberOffset offsetSN [only if O==1] |
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ ParameterList sampleInlineQos [only if Q==1] ~
+ * | |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *
+ *
+ * Sample:
+ * 0...............8..............16..............24..............32
+ * +---------------+---------------+---------------+---------------+
+ * | |
+ * ~ SerializedData serializedData [sampleInfo D==1 || K==1] ~
+ * | |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ */
+
+ int min_len;
+ gint old_offset = offset;
+ guint32 wid; /* Writer EntityID */
+ guint32 status_info = 0xffffffff;
+ gint32 octectsToSLEncapsulationId;
+ gint32 sampleListOffset;
+ guint16 encapsulation_id;
+ guint16 *sample_info_flags = NULL;
+ guint32 *sample_info_length = NULL;
+ gint32 sample_info_count = 0,
+ sample_info_max = rtps_max_batch_samples_dissected;
+ proto_item* octet_item;
+
+ rtps_util_decode_flags(tree, tvb, offset + 1, flags, RTPS_DATA_BATCH_FLAGS);
+
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+
+ /* Calculates the minimum length for this submessage */
+ min_len = 44;
+ if ((flags & FLAG_RTPS_DATA_BATCH_Q) != 0) min_len += 4;
+
+ if (octets_to_next_header < min_len) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
+ return;
+ }
+
+ /* Skip decoding the entire packet if (tree == NULL)
+ * Note that we still need to decode the statusInfo and the writer ID
+ */
+ if (tree == NULL) {
+ offset += 12;
+ /* writerEntityId */
+ wid = NEXT_guint32(tvb, offset, little_endian);
+
+ offset += 24;
+ if ((flags & FLAG_DATA_Q_v2) != 0) {
+ /*offset = */dissect_parameter_sequence(tree, pinfo, tvb, offset,
+ little_endian, octets_to_next_header - (offset - old_offset) + 4,
+ "inlineQos", 0x0200, &status_info, vendor_id);
+ }
+ info_summary_append_ex(pinfo, wid, status_info);
+ return;
+ }
+
+ offset += 4;
+
+ /* extraFlags */
+ proto_tree_add_item(tree, hf_rtps_extra_flags, tvb, offset, 2, ENC_BIG_ENDIAN);
+ offset += 2;
+
+ /* octetsToInlineQos */
+ proto_tree_add_text(tree, tvb, offset, 2, "Octets to inline QoS: %d",
+ NEXT_guint16(tvb, offset, little_endian));
+ offset += 2;
+
+
+ /* readerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_rdentity_id, hf_rtps_sm_rdentity_id_key,
+ hf_rtps_sm_rdentity_id_kind, ett_rtps_rdentity, "readerEntityId", NULL);
+ offset += 4;
+
+ /* writerEntityId */
+ rtps_util_add_entity_id(tree, tvb, offset, hf_rtps_sm_wrentity_id, hf_rtps_sm_wrentity_id_key,
+ hf_rtps_sm_wrentity_id_kind, ett_rtps_wrentity, "writerEntityId", &wid);
+ offset += 4;
+
+
+ /* Batch sequence number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "batchSeqNumber");
+ offset += 8;
+
+ /* First stample sequence number */
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "firstSampleSeqNumber");
+ offset += 8;
+
+ /* offsetToLastSampleSN */
+ proto_tree_add_item(tree, hf_rtps_data_batch_offset_to_last_sample_sn, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+
+ /* batchSampleCount */
+ proto_tree_add_item(tree, hf_rtps_data_batch_sample_count, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+
+ /* Parameter list (if Q==1) */
+ /* InlineQos */
+ if ((flags & FLAG_RTPS_DATA_BATCH_Q) != 0) {
+ offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "batchInlineQos", 0x0200, &status_info, vendor_id);
+ }
+
+ /* octetsToSLEncapsulationId */
+ octectsToSLEncapsulationId = NEXT_guint32(tvb, offset, little_endian);
+ proto_tree_add_item(tree, hf_rtps_data_batch_octets_to_sl_encap_id, tvb,
+ offset, 4, octectsToSLEncapsulationId);
+ offset += 4;
+ sampleListOffset = offset + octectsToSLEncapsulationId;
+
+
+ /* Sample info list */
+ {
+ proto_item *ti, *list_item;
+ proto_tree *sil_tree;
+ sample_info_count = 0;
+
+ list_item = proto_tree_add_text(tree, tvb, offset, -1, "Sample Info List");
+ sil_tree = proto_item_add_subtree(list_item, ett_rtps_sample_info_list);
+
+ /* Allocate sample_info_flags and sample_info_length
+ * to store a copy of the flags for each sample info */
+ if (rtps_max_batch_samples_dissected == 0) {
+ sample_info_max = 1024; /* Max size of sampleInfo shown */
+ }
+ sample_info_flags = (guint16 *)ep_alloc(sizeof(guint16) * sample_info_max);
+ sample_info_length = (guint32 *)ep_alloc(sizeof(guint32) * sample_info_max);
+
+ /* Sample Info List: start decoding the sample info list until the offset
+ * is greater or equal than 'sampleListOffset' */
+ while (offset < sampleListOffset) {
+ guint16 flags2;
+ /*guint16 octetsToInlineQos;*/
+ gint min_length;
+ proto_tree * si_tree;
+ gint offset_begin_sampleinfo = offset;
+
+ if (rtps_max_batch_samples_dissected > 0 && (guint)sample_info_count >= rtps_max_batch_samples_dissected) {
+ expert_add_info_format(pinfo, list_item, PI_PROTOCOL, PI_NOTE,
+ "more samples available. Configure this limit from preferences dialog");
+ offset = sampleListOffset;
+ break;
+ }
+
+ ti = proto_tree_add_text(sil_tree, tvb, offset, -1, "sampleInfo[%d]", sample_info_count);
+ si_tree = proto_item_add_subtree(ti, ett_rtps_sample_info);
+
+ flags2 = NEXT_guint16(tvb, offset, FALSE); /* Flags are always big endian */
+ sample_info_flags[sample_info_count] = flags2;
+ rtps_util_decode_flags_16bit(si_tree, tvb, offset, flags2, RTPS_SAMPLE_INFO_FLAGS16);
+ offset += 2;
+ proto_tree_add_item(tree, hf_rtps_data_batch_octets_to_inline_qos, tvb,
+ offset, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 2;
+
+ min_length = 4;
+ if ((flags2 & FLAG_SAMPLE_INFO_T) != 0) min_len += 8;
+ if ((flags2 & FLAG_SAMPLE_INFO_Q) != 0) min_len += 4;
+ if ((flags2 & FLAG_SAMPLE_INFO_O) != 0) min_len += 4;
+
+ /* Ensure there are enough bytes to decode */
+ if (sampleListOffset - offset < min_length) {
+ expert_add_info_format(pinfo, ti, PI_PROTOCOL, PI_WARN,
+ "Error: not enough bytes to dissect sample info");
+ return;
+ }
+
+ /* Serialized data length */
+ sample_info_length[sample_info_count] = NEXT_guint32(tvb, offset, little_endian);
+ proto_tree_add_item(tree, hf_rtps_data_batch_serialized_data_length, tvb,
+ offset, 4, sample_info_length[sample_info_count]);
+ offset += 4;
+
+ /* Timestamp [only if T==1] */
+ if ((flags2 & FLAG_SAMPLE_INFO_T) != 0) {
+ rtps_util_add_ntp_time(si_tree, tvb, offset, little_endian, hf_rtps_data_batch_timestamp);
+ offset += 8;
+ }
+
+ /* Offset SN [only if O==1] */
+ if ((flags2 & FLAG_SAMPLE_INFO_O) != 0) {
+ proto_tree_add_item(tree, hf_rtps_data_batch_offset_sn, tvb,
+ offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ offset += 4;
+ }
+
+ /* Parameter list [only if Q==1] */
+ if ((flags2 & FLAG_SAMPLE_INFO_Q) != 0) {
+ offset = dissect_parameter_sequence(si_tree, pinfo, tvb, offset, little_endian,
+ octets_to_next_header - (offset - old_offset) + 4,
+ "sampleInlineQos", 0x0200, &status_info, vendor_id);
+ }
+ proto_item_set_len(ti, offset - offset_begin_sampleinfo);
+ sample_info_count++;
+ } /* while (offset < sampleListOffset) */
+ }
+
+ /* Encapsulation ID for the entire data sequence */
+ encapsulation_id = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
+ proto_tree_add_text(tree, tvb, offset, 2,
+ "encapsulation kind: %s",
+ val_to_str(encapsulation_id, encapsulation_id_vals, "unknown (%02x)"));
+ offset += 2;
+
+ /* The next two bytes are ignored */
+ offset += 2;
+
+ /* Now the list of serialized data:
+ * Serialized data is allocated one after another one.
+ * We need to use the data previously stored in the sampleInfo to detect the
+ * kind and size.
+ * - sample_info_flags -> Array of guint16 holding the flags for this sample info
+ * - sample_info_length -> Array of guint32 with the size of this sample info
+ * - sample_info_count -> size of the above arrays
+ * This section will NEVER dissect more than 'sample_info_count'.
+ * Note, if there are not enough bytes in the buffer, don't dissect it (this
+ * can happen for example when a DISPOSE message is sent, there are sample
+ * info records, but the payload size is zero for all of them)
+ */
+ if (octets_to_next_header - (offset - old_offset) > 0) {
+ proto_item * ti;
+ proto_tree * sil_tree;
+ gint count = 0;
+ const char * label;
+
+ ti = proto_tree_add_text(tree, tvb, offset, -1, "Serialized Sample List");
+ sil_tree = proto_item_add_subtree(ti, ett_rtps_sample_batch_list);
+ for (count = 0; count < sample_info_count; ++count) {
+ /* Ensure there are enough bytes in the buffer to dissect the next sample */
+ if (octets_to_next_header - (offset - old_offset) + 4 < (gint)sample_info_length[count]) {
+ expert_add_info_format(pinfo, ti, PI_PROTOCOL, PI_WARN,
+ "Error: not enough bytes to dissect sample");
+ return;
+ }
+
+ if ((sample_info_flags[count] & FLAG_SAMPLE_INFO_K) != 0) {
+ label = "serializedKey[%d]";
+ } else {
+ label = "serializedData[%d]";
+ }
+ proto_tree_add_text(sil_tree, tvb, offset, sample_info_length[count], label, count);
+ offset += sample_info_length[count];
+ }
+ }
+ info_summary_append_ex(pinfo, wid, status_info);
+}
/* *********************************************************************** */
/* * G A P * */
@@ -3906,6 +5868,7 @@ static void dissect_GAP(tvbuff_t *tvb,
* | |
* +---------------+---------------+---------------+---------------+
*
+ * RTPS 1.2/2.0
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* | GAP |X|X|X|X|X|X|F|E| octetsToNextHeader |
@@ -3927,12 +5890,8 @@ static void dissect_GAP(tvbuff_t *tvb,
rtps_util_decode_flags(tree, tvb, offset + 1, flags, GAP_FLAGS);
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
if (octets_to_next_header < 24) {
expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 24)");
@@ -3955,32 +5914,19 @@ static void dissect_GAP(tvbuff_t *tvb,
/* First Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "gapStart");
+ rtps_util_add_seq_number(tree, tvb, offset, little_endian, "gapStart");
offset += 8;
/* Bitmap */
- rtps_util_add_bitmap(tree,
- tvb,
- offset,
- little_endian,
- "gapList");
+ rtps_util_add_bitmap(tree, tvb, offset, little_endian, "gapList");
}
/* *********************************************************************** */
/* * I N F O _ T S * */
/* *********************************************************************** */
-void dissect_INFO_TS(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
+void dissect_INFO_TS(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree) {
/* RTPS 1.0/1.1:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -3991,7 +5937,7 @@ void dissect_INFO_TS(tvbuff_t *tvb,
* | |
* +---------------+---------------+---------------+---------------+
*
- * RTPS 1.2:
+ * RTPS 1.2/2.0:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* | INFO_TS |X|X|X|X|X|X|T|E| octetsToNextHeader |
@@ -4037,13 +5983,8 @@ void dissect_INFO_TS(tvbuff_t *tvb,
/* *********************************************************************** */
/* * I N F O _ S R C * */
/* *********************************************************************** */
-void dissect_INFO_SRC(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
+void dissect_INFO_SRC(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree, guint16 rtps_version) {
/* RTPS 1.0/1.1:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -4058,7 +5999,7 @@ void dissect_INFO_SRC(tvbuff_t *tvb,
* | AppId appId |
* +---------------+---------------+---------------+---------------+
*
- * RTPS 1.2:
+ * RTPS 1.2/2.0:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* | INFO_SRC |X|X|X|X|X|X|X|E| octetsToNextHeader |
@@ -4078,12 +6019,8 @@ void dissect_INFO_SRC(tvbuff_t *tvb,
rtps_util_decode_flags(tree, tvb, offset + 1, flags, INFO_SRC_FLAGS);
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
if (octets_to_next_header != 16) {
expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be == 16)");
@@ -4111,23 +6048,23 @@ void dissect_INFO_SRC(tvbuff_t *tvb,
rtps_util_add_vendor_id(NULL, tvb, offset);
offset += 2;
- rtps_util_add_guid_prefix(tree, tvb, offset,
+ if (rtps_version < 0x0200) {
+ rtps_util_add_guid_prefix_v1(tree, tvb, offset,
hf_rtps_sm_guid_prefix, hf_rtps_sm_host_id, hf_rtps_sm_app_id,
hf_rtps_sm_instance_id, hf_rtps_sm_app_kind,
NULL); /* Use default 'guidPrefix' */
+ } else {
+ rtps_util_add_guid_prefix_v2(tree, tvb, offset, hf_rtps_guid_prefix,
+ hf_rtps_host_id, hf_rtps_app_id, hf_rtps_sm_counter, NULL);
+ }
}
/* *********************************************************************** */
/* * I N F O _ R E P L Y _ I P 4 * */
/* *********************************************************************** */
-static void dissect_INFO_REPLY_IP4(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
+static void dissect_INFO_REPLY_IP4(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree) {
/* RTPS 1.0/1.1:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -4142,7 +6079,7 @@ static void dissect_INFO_REPLY_IP4(tvbuff_t *tvb,
* | Port multicastReplyPort [ only if M==1 ] |
* +---------------+---------------+---------------+---------------+
*
- * RTPS 1.2:
+ * RTPS 1.2/2.0:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* |INFO_REPLY_IP4 |X|X|X|X|X|X|M|E| octetsToNextHeader |
@@ -4196,13 +6133,8 @@ static void dissect_INFO_REPLY_IP4(tvbuff_t *tvb,
/* *********************************************************************** */
/* * I N F O _ D S T * */
/* *********************************************************************** */
-static void dissect_INFO_DST(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
+static void dissect_INFO_DST(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree, guint16 version) {
/* RTPS 1.0/1.1:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
@@ -4213,7 +6145,7 @@ static void dissect_INFO_DST(tvbuff_t *tvb,
* | AppId appId |
* +---------------+---------------+---------------+---------------+
*
- * RTPS 1.2:
+ * RTPS 1.2/2.0:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* | INFO_DST |X|X|X|X|X|X|X|E| octetsToNextHeader |
@@ -4227,12 +6159,8 @@ static void dissect_INFO_DST(tvbuff_t *tvb,
rtps_util_decode_flags(tree, tvb, offset + 1, flags, INFO_DST_FLAGS);
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
+ octet_item = proto_tree_add_item(tree, hf_rtps_sm_octets_to_next_header, tvb,
+ offset + 2, 2, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
if (octets_to_next_header != 8) {
expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be == 8)");
@@ -4241,10 +6169,15 @@ static void dissect_INFO_DST(tvbuff_t *tvb,
offset += 4;
- rtps_util_add_guid_prefix(tree, tvb, offset,
+ if (version < 0x0200) {
+ rtps_util_add_guid_prefix_v1(tree, tvb, offset,
hf_rtps_sm_guid_prefix, hf_rtps_sm_host_id, hf_rtps_sm_app_id,
hf_rtps_sm_instance_id, hf_rtps_sm_app_kind,
NULL);
+ } else {
+ rtps_util_add_guid_prefix_v2(tree, tvb, offset, hf_rtps_guid_prefix,
+ hf_rtps_host_id, hf_rtps_app_id, hf_rtps_sm_counter, NULL);
+ }
}
@@ -4262,7 +6195,7 @@ static void dissect_INFO_REPLY(tvbuff_t *tvb,
/* RTPS 1.0/1.1:
* INFO_REPLY is *NOT* the same thing as the old INFO_REPLY.
*
- * RTPS 1.2:
+ * RTPS 1.2/2.0:
* 0...2...........7...............15.............23...............31
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
* | INFO_REPLY |X|X|X|X|X|X|M|E| octetsToNextHeader |
@@ -4289,45 +6222,156 @@ static void dissect_INFO_REPLY(tvbuff_t *tvb,
2,
little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- min_len = 8;
- if ((flags & FLAG_INFO_REPLY_M) != 0) min_len += 8;
+ min_len = 4;
+ if ((flags & FLAG_INFO_REPLY_M) != 0) min_len += 4;
- if (octets_to_next_header != min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be == %u)", min_len);
+ if (octets_to_next_header < min_len) {
+ expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
return;
}
offset += 4;
/* unicastReplyLocatorList */
- rtps_util_add_locator_list(tree, pinfo, tvb, offset, "unicastReplyLocatorList", little_endian);
- offset += 8;
+ offset = rtps_util_add_locator_list(tree, pinfo, tvb, offset, "unicastReplyLocatorList", little_endian);
/* multicastReplyLocatorList */
if ((flags & FLAG_INFO_REPLY_M) != 0) {
- rtps_util_add_locator_list(tree, pinfo, tvb, offset, "multicastReplyLocatorList", little_endian);
- /*offset += 8;*/
+ /*offset = */rtps_util_add_locator_list(tree, pinfo, tvb, offset, "multicastReplyLocatorList", little_endian);
}
}
+static gboolean dissect_rtps_submessage_v2(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
+ gboolean little_endian, guint8 submessageId, guint16 vendor_id, gint octets_to_next_header,
+ proto_tree* rtps_submessage_tree, proto_item* submessage_item)
+{
+ switch (submessageId)
+ {
+ case SUBMESSAGE_DATA_FRAG:
+ dissect_DATA_FRAG(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree, vendor_id);
+ break;
+
+ case SUBMESSAGE_NOKEY_DATA_FRAG:
+ dissect_NOKEY_DATA_FRAG(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree, vendor_id);
+ break;
+
+ case SUBMESSAGE_NACK_FRAG:
+ dissect_NACK_FRAG(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ break;
+
+ case SUBMESSAGE_ACKNACK_SESSION:
+ case SUBMESSAGE_ACKNACK_BATCH:
+ dissect_ACKNACK(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree, submessage_item);
+ break;
+
+ case SUBMESSAGE_HEARTBEAT_SESSION:
+ case SUBMESSAGE_HEARTBEAT_BATCH:
+ dissect_HEARTBEAT_BATCH(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ break;
+
+ case SUBMESSAGE_HEARTBEAT_FRAG:
+ dissect_HEARTBEAT_FRAG(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ break;
+
+ case SUBMESSAGE_RTPS_DATA_SESSION:
+ case SUBMESSAGE_RTPS_DATA:
+ dissect_RTPS_DATA(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree,
+ vendor_id, (submessageId == SUBMESSAGE_RTPS_DATA_SESSION));
+ break;
+
+ case SUBMESSAGE_RTPS_DATA_FRAG:
+ dissect_RTPS_DATA_FRAG(tvb, pinfo, offset, flags, little_endian, octets_to_next_header,
+ rtps_submessage_tree, vendor_id);
+ break;
+
+ case SUBMESSAGE_RTPS_DATA_BATCH:
+ dissect_RTPS_DATA_BATCH(tvb, pinfo, offset, flags, little_endian, octets_to_next_header,
+ rtps_submessage_tree, vendor_id);
+ break;
+
+ default:
+ return FALSE;
+ }
+
+ return TRUE;
+}
+
+static gboolean dissect_rtps_submessage_v1(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags, gboolean little_endian,
+ guint8 submessageId, guint16 version, guint16 vendor_id, gint octets_to_next_header,
+ proto_tree* rtps_submessage_tree, proto_item* submessage_item)
+{
+ switch (submessageId)
+ {
+ case SUBMESSAGE_PAD:
+ dissect_PAD(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ break;
+
+ case SUBMESSAGE_DATA:
+ if (version < 0x0200) {
+ dissect_DATA_v1(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ } else {
+ dissect_DATA_v2(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree, vendor_id);
+ }
+ break;
+
+ case SUBMESSAGE_NOKEY_DATA:
+ dissect_NOKEY_DATA(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree,
+ version, vendor_id);
+ break;
+
+ case SUBMESSAGE_ACKNACK:
+ dissect_ACKNACK(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree, submessage_item);
+ break;
+
+ case SUBMESSAGE_HEARTBEAT:
+ dissect_HEARTBEAT(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree, version);
+ break;
+
+ case SUBMESSAGE_GAP:
+ dissect_GAP(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ break;
+
+ case SUBMESSAGE_INFO_TS:
+ dissect_INFO_TS(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ break;
+ case SUBMESSAGE_INFO_SRC:
+ dissect_INFO_SRC(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree, version);
+ break;
-#define RTPS_MAGIC_NUMBER 0x52545053 /* RTPS */
+ case SUBMESSAGE_INFO_REPLY_IP4:
+ dissect_INFO_REPLY_IP4(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ break;
+
+ case SUBMESSAGE_INFO_DST:
+ dissect_INFO_DST(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree, version);
+ break;
+
+ case SUBMESSAGE_INFO_REPLY:
+ dissect_INFO_REPLY(tvb, pinfo, offset, flags, little_endian, octets_to_next_header, rtps_submessage_tree);
+ break;
+
+ default:
+ return FALSE;
+ }
+
+ return TRUE;
+}
/***************************************************************************/
/* The main packet dissector function
*/
-static gboolean dissect_rtps(tvbuff_t *tvb,
- packet_info *pinfo,
- proto_tree *tree,
- void *data _U_)
+static gboolean dissect_rtps(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_)
{
- proto_item *ti;
- proto_tree *rtps_tree, *rtps_submessage_tree;
- gint offset = 0;
- guint8 submessageId, flags;
- gboolean little_endian, is_ping;
- gint next_submsg, octects_to_next_header;
+ proto_item *ti;
+ proto_tree *rtps_tree, *rtps_submessage_tree;
+ gint offset = 0;
+ guint8 submessageId, flags, majorRev;
+ guint16 version, vendor_id;
+ gboolean little_endian, is_ping;
+ gint next_submsg, octets_to_next_header;
+ int sub_hf;
+ const value_string* sub_vals;
const gboolean is_tcp = (pinfo->ptype == PT_TCP);
if (is_tcp) {
@@ -4341,10 +6385,14 @@ static gboolean dissect_rtps(tvbuff_t *tvb,
/* Check 'RTPS' signature:
* A header is invalid if it has less than 16 octets
*/
- if (!tvb_bytes_exist(tvb, offset, 16)) return FALSE;
- if (tvb_get_ntohl(tvb, offset) != RTPS_MAGIC_NUMBER) return FALSE;
+ if (!tvb_bytes_exist(tvb, offset, 16))
+ return FALSE;
+ if (tvb_get_ntohl(tvb, offset) != RTPS_MAGIC_NUMBER)
+ return FALSE;
/* Distinguish between RTPS 1.x and 2.x here */
- if (tvb_get_guint8(tvb,offset+4) != 1) return FALSE;
+ majorRev = tvb_get_guint8(tvb,offset+4);
+ if ((majorRev != 1) && (majorRev != 2))
+ return FALSE;
col_set_str(pinfo->cinfo, COL_PROTOCOL, "RTPS");
col_clear(pinfo->cinfo, COL_INFO);
@@ -4354,65 +6402,139 @@ static gboolean dissect_rtps(tvbuff_t *tvb,
rtps_tree = proto_item_add_subtree(ti, ett_rtps);
/* Protocol Version */
- rtps_util_add_protocol_version(rtps_tree, tvb, offset+4);
+ version = rtps_util_add_protocol_version(rtps_tree, tvb, offset+4);
/* Vendor Id */
- rtps_util_add_vendor_id(rtps_tree, tvb, offset+6);
+ vendor_id = rtps_util_add_vendor_id(rtps_tree, tvb, offset+6);
is_ping = rtps_is_ping(tvb, pinfo, offset+8);
- if (!is_ping)
- rtps_util_add_guid_prefix(rtps_tree, tvb, offset+8,
+ if (!is_ping) {
+ if (version < 0x0200)
+ rtps_util_add_guid_prefix_v1(rtps_tree, tvb, offset+8,
hf_rtps_guid_prefix, hf_rtps_host_id, hf_rtps_app_id,
hf_rtps_app_id_instance_id, hf_rtps_app_id_app_kind, NULL);
+ else
+ rtps_util_add_guid_prefix_v2(rtps_tree, tvb, offset+8, hf_rtps_guid_prefix,
+ hf_rtps_host_id, hf_rtps_app_id, hf_rtps_sm_counter, NULL);
+
+#ifdef RTI_BUILD
+ pinfo->guid_prefix_host = tvb_get_ntohl(tvb, offset + 8);
+ pinfo->guid_prefix_app = tvb_get_ntohl(tvb, offset + 12);
+ pinfo->guid_prefix_count = tvb_get_ntohl(tvb, offset + 16);
+ pinfo->guid_rtps2 = 1;
+#endif
+ }
/* Extract the domain id and participant index */
{
- int domain_id, participant_idx, nature;
+ int domain_id, doffset, participant_idx, nature;
proto_tree *mapping_tree;
+ /* For a complete description of these rules, see RTPS documentation
+
+ RTPS 1.2 mapping:
+ domain_id = ((pinfo->destport - PORT_BASE)/10) % 100;
+ participant_idx = (pinfo->destport - PORT_BASE) / 1000;
+ nature = (pinfo->destport % 10);
+
+ For Unicast, the port mapping formula is:
+ metatraffic_unicast_port = port_base +
+ (domain_id_gain * domain_id) +
+ (participant_id_gain * participant_id) +
+ builtin_unicast_port_offset
+ For Multicast, the port mapping is:
+ metatraffic_multicast_port = port_base +
+ (domain_id_gain * domain_id) +
+ builtin_multicast_port_offset
+
+ Where the constants are:
+ port_base = 7400
+ domain_id_gain = 250
+ participant_id_gain = 2
+ builtin_multicast_port_offset = 0
+ builtin_unicast_port_offset = 10
+ user_multicast_port_offset = 1
+ user_unicast_port_offset = 11
+
+
+ To obtain the individual components from the port number, the reverse formulas are:
+ domain_id = (port - port_base) / 250 (valid both multicast / unicast)
+ Doffset = (port - port_Base - (domain_id * 250));
+ participant_idx = (Doffset - 10) / 2;
+
+ */
+ if (version < 0x0200) {
+ domain_id = ((pinfo->destport - PORT_BASE)/10) % 100;
+ participant_idx = (pinfo->destport - PORT_BASE) / 1000;
+ nature = (pinfo->destport % 10);
+ } else {
+ domain_id = (pinfo->destport - PORT_BASE) / 250;
+ doffset = (pinfo->destport - PORT_BASE - domain_id * 250);
+ if (doffset == 0) {
+ nature = PORT_METATRAFFIC_MULTICAST;
+ } else if (doffset == 1) {
+ nature = PORT_USERTRAFFIC_MULTICAST;
+ } else {
+ participant_idx = (doffset - 10) / 2;
+ if ( (doffset - 10) % 2 == 0) {
+ nature = PORT_METATRAFFIC_UNICAST;
+ } else {
+ nature = PORT_USERTRAFFIC_UNICAST;
+ }
+ }
+ }
- domain_id = ((pinfo->destport - PORT_BASE)/10) % 100;
- participant_idx = (pinfo->destport - PORT_BASE) / 1000;
- nature = (pinfo->destport % 10);
-
- ti = proto_tree_add_text(rtps_tree, tvb, 0, 0,
+ if ((nature == PORT_METATRAFFIC_UNICAST) || (nature == PORT_USERTRAFFIC_UNICAST) ||
+ (version < 0x0200)) {
+ ti = proto_tree_add_text(rtps_tree, tvb, 0, 0,
"Default port mapping: domainId=%d, "
"participantIdx=%d, nature=%s",
domain_id,
participant_idx,
val_to_str(nature, nature_type_vals, "%02x"));
+ } else {
+ ti = proto_tree_add_text(rtps_tree, tvb, 0, 0,
+ "Default port mapping: %s, domainId=%d",
+ val_to_str(nature, nature_type_vals, "%02x"),
+ domain_id);
+ }
mapping_tree = proto_item_add_subtree(ti, ett_rtps_default_mapping);
ti = proto_tree_add_uint(mapping_tree, hf_rtps_domain_id, tvb, 0, 0, domain_id);
PROTO_ITEM_SET_GENERATED(ti);
- ti = proto_tree_add_uint(mapping_tree, hf_rtps_participant_idx, tvb, 0, 0, participant_idx);
- PROTO_ITEM_SET_GENERATED(ti);
+ if ((nature == PORT_METATRAFFIC_UNICAST) || (nature == PORT_USERTRAFFIC_UNICAST) ||
+ (version < 0x0200)) {
+ ti = proto_tree_add_uint(mapping_tree, hf_rtps_participant_idx, tvb, 0, 0, participant_idx);
+ PROTO_ITEM_SET_GENERATED(ti);
+ }
ti = proto_tree_add_uint(mapping_tree, hf_rtps_nature_type, tvb, 0, 0, nature);
PROTO_ITEM_SET_GENERATED(ti);
}
/* offset behind RTPS's Header (need to be set in case tree=NULL)*/
- offset=16;
+ offset = (version < 0x0200) ? 16 : 20;
+ if (is_tcp)
+ offset += 4;
while (tvb_reported_length_remaining(tvb, offset) > 0) {
submessageId = tvb_get_guint8(tvb, offset);
- col_append_sep_str(pinfo->cinfo, COL_INFO, ", ",
- val_to_str(submessageId, submessage_id_vals, "Unknown[%02x]"));
+ if (version < 0x0200) {
+ sub_hf = hf_rtps_sm_id;
+ sub_vals = submessage_id_vals;
+ } else {
+ sub_hf = hf_rtps_sm_idv2;
+ sub_vals = submessage_id_valsv2;
+ }
+
+ col_append_sep_str(pinfo->cinfo, COL_INFO, ", ", val_to_str(submessageId, sub_vals, "Unknown[%02x]"));
/* Creates the subtree 'Submessage: XXXX' */
if (submessageId & 0x80) {
- ti = proto_tree_add_uint_format_value(rtps_tree,
- hf_rtps_sm_id,
- tvb,
- offset,
- 1,
- submessageId,
- "Vendor-specific (0x%02x)",
- submessageId);
+ ti = proto_tree_add_uint_format_value(rtps_tree, sub_hf, tvb, offset, 1,
+ submessageId, "Vendor-specific (0x%02x)", submessageId);
} else {
- ti = proto_tree_add_uint(rtps_tree, hf_rtps_sm_id,
- tvb, offset, 1, submessageId);
+ ti = proto_tree_add_uint(rtps_tree, sub_hf, tvb, offset, 1, submessageId);
}
rtps_submessage_tree = proto_item_add_subtree(ti, ett_rtps_submessage);
@@ -4424,75 +6546,31 @@ static gboolean dissect_rtps(tvbuff_t *tvb,
little_endian = ((flags & FLAG_E) != 0);
/* Octect-to-next-header */
- octects_to_next_header = NEXT_guint16(tvb, offset + 2, little_endian);
- next_submsg = offset + octects_to_next_header + 4;
+ octets_to_next_header = NEXT_guint16(tvb, offset + 2, little_endian);
+ if ((octets_to_next_header == 0) && (version >= 0x0200))
+ octets_to_next_header = tvb_reported_length_remaining(tvb, offset + 4);
+ next_submsg = offset + octets_to_next_header + 4;
/* Set length of this item */
- proto_item_set_len(ti, octects_to_next_header + 4);
+ proto_item_set_len(ti, octets_to_next_header + 4);
- /* Now decode each single submessage */
- /* Note: if tree==NULL, we don't care about the details, so each
- * sub-message dissector is not invoked. We still need to go
- * through this switch to count the number of each submessage IDs
+ /* Now decode each single submessage
* The offset passed to the dissectors points to the start of the
* submessage (at the ID byte).
*/
- switch (submessageId)
- {
- case PAD:
- dissect_PAD(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case DATA:
- dissect_DATA(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case NOKEY_DATA:
- dissect_NOKEY_DATA(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case ACKNACK:
- dissect_ACKNACK(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree, ti);
- break;
-
- case HEARTBEAT:
- dissect_HEARTBEAT(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case GAP:
- dissect_GAP(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case INFO_TS:
- dissect_INFO_TS(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case INFO_SRC:
- dissect_INFO_SRC(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case INFO_REPLY_IP4:
- dissect_INFO_REPLY_IP4(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case INFO_DST:
- dissect_INFO_DST(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- case INFO_REPLY:
- dissect_INFO_REPLY(tvb, pinfo, offset, flags, little_endian, octects_to_next_header, rtps_submessage_tree);
- break;
-
- default:
- if (tree) {
- proto_tree_add_uint(rtps_submessage_tree, hf_rtps_sm_flags,
+ if (!dissect_rtps_submessage_v1(tvb, pinfo, offset, flags, little_endian,
+ submessageId, version, vendor_id,
+ octets_to_next_header, rtps_submessage_tree, ti)) {
+ if ((version < 0x0200) ||
+ !dissect_rtps_submessage_v2(tvb, pinfo, offset, flags, little_endian, submessageId,
+ vendor_id, octets_to_next_header, rtps_submessage_tree, ti)) {
+ proto_tree_add_uint(rtps_submessage_tree, hf_rtps_sm_flags,
tvb, offset + 1, 1, flags);
- proto_tree_add_uint(rtps_submessage_tree,
+ proto_tree_add_uint(rtps_submessage_tree,
hf_rtps_sm_octets_to_next_header,
tvb, offset + 2, 2, next_submsg);
- }
- break;
- }
+ }
+ }
/* next submessage's offset */
offset = next_submsg;
@@ -4656,9 +6734,20 @@ void proto_register_rtps(void) {
HFILL }
},
+ { &hf_rtps_sm_idv2, {
+ "submessageId",
+ "rtps.sm.id",
+ FT_UINT8,
+ BASE_HEX,
+ VALS(submessage_id_valsv2),
+ 0,
+ "defines the type of submessage",
+ HFILL }
+ },
+
/* Submessage flags ---------------------------------------------------- */
{ &hf_rtps_sm_flags, {
- "flags",
+ "Flags",
"rtps.sm.flags",
FT_UINT8,
BASE_HEX,
@@ -4733,7 +6822,16 @@ void proto_register_rtps(void) {
"appKind component of the AppId of the rtps.sm.guidPrefix",
HFILL }
},
-
+ { &hf_rtps_sm_counter, {
+ "counter",
+ "rtps.sm.guidPrefix.counter",
+ FT_UINT32,
+ BASE_HEX,
+ NULL,
+ 0,
+ "The counter component of the rtps.sm.guidPrefix",
+ HFILL }
+ },
/* Entity ID (composed as entityKey, entityKind) ----------------------- */
{ &hf_rtps_sm_entity_id, {
@@ -4877,6 +6975,17 @@ void proto_register_rtps(void) {
HFILL }
},
+ { &hf_rtps_parameter_id_v2, {
+ "parameterId",
+ "rtps.param.id",
+ FT_UINT16,
+ BASE_HEX,
+ VALS(parameter_id_v2_vals),
+ 0,
+ "Parameter Id",
+ HFILL }
+ },
+
/* Parameter Length ---------------------------------------------------- */
{ &hf_rtps_parameter_length, {
"parameterLength",
@@ -5240,30 +7349,356 @@ void proto_register_rtps(void) {
NULL, HFILL }
},
- { &hf_rtps_ownership,
+ { &hf_rtps_ownership,
{ "Kind", "rtps.ownership",
FT_UINT32, BASE_HEX, VALS(ownership_qos_vals), 0,
NULL, HFILL }
},
- { &hf_rtps_presentation_access_scope,
+ { &hf_rtps_presentation_access_scope,
{ "Access Scope", "rtps.presentation.access_scope",
FT_UINT32, BASE_HEX, VALS(presentation_qos_vals), 0,
NULL, HFILL }
},
- { &hf_rtps_destination_order,
+ { &hf_rtps_destination_order,
{ "Kind", "rtps.destination_order",
FT_UINT32, BASE_HEX, VALS(destination_order_qos_vals), 0,
NULL, HFILL }
},
- { &hf_rtps_history_kind,
+ { &hf_rtps_history_kind,
{ "Kind", "rtps.history.kind",
FT_UINT32, BASE_HEX, VALS(history_qos_vals), 0,
NULL, HFILL }
},
+ { &hf_rtps_data_status_info,
+ { "statusInfo", "rtps.data.status_info",
+ FT_UINT32, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_serialize_encap_kind,
+ { "encapsulation kind", "rtps.param.serialize.encap_kind",
+ FT_UINT16, BASE_HEX, VALS(encapsulation_id_vals), 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_serialize_encap_len,
+ { "encapsulation options", "rtps.param.serialize.encap_len",
+ FT_UINT16, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_status_info,
+ { "statusInfo", "rtps.param.statusInfo",
+ FT_UINT32, BASE_HEX, NULL, 0,
+ "State information of the data object to which the message apply (i.e. lifecycle)",
+ HFILL }
+ },
+
+ { &hf_rtps_param_transport_priority,
+ { "Value", "rtps.param.transport_priority",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_type_max_size_serialized,
+ { "Value", "rtps.param.type_max_size_serialized",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_entity_name,
+ { "entity", "rtps.param.entityName",
+ FT_STRINGZ, BASE_NONE, NULL, 0,
+ "String representing the name of the entity addressed by the submessage",
+ HFILL }
+ },
+
+ { &hf_rtps_disable_positive_ack,
+ { "disablePositiveAcks", "rtps.disable_positive_ack",
+ FT_BOOLEAN, 8, TFS(&tfs_true_false), 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_participant_guid,
+ { "Participant GUID", "rtps.param.participant_guid",
+ FT_UINT64, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_group_guid,
+ { "Group GUID", "rtps.param.group_guid",
+ FT_UINT64, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_endpoint_guid,
+ { "Endpoint GUID", "rtps.param.endpoint_guid",
+ FT_UINT64, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_host_id,
+ { "host_id", "rtps.param.guid.hostId",
+ FT_UINT32, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_app_id,
+ { "appId", "rtps.param.guid.appId",
+ FT_UINT32, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_instance_id,
+ { "instanceId", "rtps.param.guid.instanceId",
+ FT_UINT24, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_app_kind,
+ { "instanceId", "rtps.param.guid.appKind",
+ FT_UINT8, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_entity,
+ { "entityId", "rtps.param.guid.entityId",
+ FT_UINT32, BASE_HEX, VALS(entity_id_vals), 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_entity_key,
+ { "entityKey", "rtps.param.guid.entityKey",
+ FT_UINT24, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_hf_entity_kind,
+ { "entityKind", "rtps.param.guid.entityKind",
+ FT_UINT8, BASE_HEX, VALS(entity_kind_vals), 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_counter,
+ { "Counter", "rtps.param.guid.counter",
+ FT_UINT32, BASE_HEX, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_frag_number,
+ { "fragmentStartingNum", "rtps.data_frag.number",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_frag_sample_size,
+ { "sampleSize", "rtps.data_frag.sample_size",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_frag_num_fragments,
+ { "fragmentsInSubmessage", "rtps.data_frag.num_fragments",
+ FT_UINT16, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_frag_size,
+ { "fragmentSize", "rtps.data_frag.size",
+ FT_UINT16, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_nokey_data_frag_number,
+ { "fragmentStartingNum", "rtps.nokey_data_frag.number",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_nokey_data_frag_num_fragments,
+ { "fragmentsInSubmessage", "rtps.nokey_data_frag.num_fragments",
+ FT_UINT16, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_nokey_data_frag_size,
+ { "fragmentSize", "rtps.nokey_data_frag.size",
+ FT_UINT16, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_nack_frag_count,
+ { "Count", "rtps.nack_frag.count",
+ FT_INT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_heartbeat_frag_number,
+ { "lastFragmentNum", "rtps.heartbeat_frag.number",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_heartbeat_frag_count,
+ { "Count", "rtps.heartbeat_frag.count",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_heartbeat_batch_count,
+ { "Count", "rtps.heartbeat_batch.count",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_serialize_data, {
+ "serializedData", "rtps.data.serialize_data",
+ FT_BYTES, BASE_NONE, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_batch_timestamp,
+ { "Timestamp", "rtps.data_batch.timestamp",
+ FT_ABSOLUTE_TIME, ABSOLUTE_TIME_UTC, NULL, 0,
+ "Time using the NTP standard format", HFILL }
+ },
+
+ { &hf_rtps_data_batch_offset_to_last_sample_sn,
+ { "offsetToLastSampleSN", "rtps.data_batch.offset_to_last_sample_sn",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_batch_sample_count,
+ { "batchSampleCount", "rtps.data_batch.sample_count",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_batch_offset_sn,
+ { "offsetSN", "rtps.data_batch.offset_sn",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_batch_octets_to_sl_encap_id,
+ { "octetsToSLEncapsulationId", "rtps.data_batch.octets_to_sl_encap_id",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_batch_serialized_data_length,
+ { "serializedDataLength", "rtps.data_batch.serialized_data_length",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_data_batch_octets_to_inline_qos,
+ { "octetsToInlineQos", "rtps.data_batch.octets_to_inline_qos",
+ FT_UINT16, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_fragment_number_base64,
+ { "bitmapBase", "rtps.fragment_number.base",
+ FT_UINT64, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_fragment_number_base,
+ { "bitmapBase", "rtps.fragment_number.base",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_fragment_number_num_bits,
+ { "numBits", "rtps.fragment_number.num_bits",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_bitmap_num_bits,
+ { "numBits", "rtps.bitmap.num_bits",
+ FT_UINT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_partition_num,
+ { "Size", "rtps.param.partition_num",
+ FT_INT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_filter_parameters_num,
+ { "Size", "rtps.param.filter_parameters_num",
+ FT_INT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_partition,
+ { "name", "rtps.param.partition",
+ FT_STRING, BASE_NONE, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_filter_expression,
+ { "filterExpression", "rtps.param.filter_expression",
+ FT_STRING, BASE_NONE, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_filter_parameters,
+ { "filterParameters", "rtps.param.filter_parameters",
+ FT_STRING, BASE_NONE, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_locator_filter_list_num_channels,
+ { "numberOfChannels", "rtps.param.locator_filter_list.num_channels",
+ FT_INT32, BASE_DEC, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_locator_filter_list_filter_name,
+ { "filterName", "rtps.param.locator_filter_list.filter_name",
+ FT_STRING, BASE_NONE, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_locator_filter_list_filter_exp,
+ { "filterExpression", "rtps.param.locator_filter_list.filter_exp",
+ FT_STRING, BASE_NONE, NULL, 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_extra_flags,
+ { "Extra flags", "rtps.extra_flags",
+ FT_UINT16, BASE_HEX, NULL, 0xFFFF,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_builtin_endpoint_set,
+ { "Builtin endpoint set", "rtps.param.builtin_endpoint_set",
+ FT_UINT32, BASE_HEX, NULL, 0xFFFFFFFF,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_plugin_promiscuity_kind,
+ { "promiscuityKind", "rtps.param.plugin_promiscuity_kind",
+ FT_UINT32, BASE_HEX, VALS(plugin_promiscuity_kind_vals), 0,
+ NULL, HFILL }
+ },
+
+ { &hf_rtps_param_service_kind,
+ { "serviceKind", "rtps.param.service_kind",
+ FT_UINT32, BASE_HEX, VALS(service_kind_vals), 0,
+ NULL, HFILL }
+ },
+
/* Finally the raw issue data ------------------------------------------ */
{ &hf_rtps_issue_data, {
"serializedData",
@@ -5286,6 +7721,7 @@ void proto_register_rtps(void) {
&ett_rtps_parameter,
&ett_rtps_flags,
&ett_rtps_entity,
+ &ett_rtps_generic_guid,
&ett_rtps_rdentity,
&ett_rtps_wrentity,
&ett_rtps_guid_prefix,
@@ -5300,15 +7736,32 @@ void proto_register_rtps(void) {
&ett_rtps_resource_limit,
&ett_rtps_durability_service,
&ett_rtps_liveliness,
- &ett_rtps_manager_key
+ &ett_rtps_manager_key,
+ &ett_rtps_serialized_data,
+ &ett_rtps_locator_filter_channel,
+ &ett_rtps_part_message_data,
+ &ett_rtps_sample_info_list,
+ &ett_rtps_sample_info,
+ &ett_rtps_sample_batch_list
};
+ module_t *rtps_module;
+
proto_rtps = proto_register_protocol(
"Real-Time Publish-Subscribe Wire Protocol",
"RTPS",
"rtps");
proto_register_field_array(proto_rtps, hf, array_length(hf));
proto_register_subtree_array(ett, array_length(ett));
+
+ /* Registers the control in the preference panel */
+ rtps_module = prefs_register_protocol(proto_rtps, NULL);
+ prefs_register_uint_preference(rtps_module, "max_batch_samples_dissected",
+ "Max samples dissected for DATA_BATCH",
+ "Specifies the maximum number of samples dissected in "
+ "a DATA_BATCH submessage. Increasing this value may affect "
+ "performances if the trace has a lot of big batched samples.",
+ 10, &rtps_max_batch_samples_dissected);
}
diff --git a/epan/dissectors/packet-rtps.h b/epan/dissectors/packet-rtps.h
index 864d209133..86f6c1449a 100644
--- a/epan/dissectors/packet-rtps.h
+++ b/epan/dissectors/packet-rtps.h
@@ -85,6 +85,7 @@ typedef enum {
RTI_CDR_TK_VALUE_PARARM
} RTICdrTCKind;
+#define RTPS_MAGIC_NUMBER 0x52545053 /* RTPS */
/* Traffic type */
#define PORT_BASE (7400)
@@ -96,9 +97,14 @@ typedef enum {
/* Flags defined in the 'flag' bitmask of a submessage */
#define FLAG_E (0x01) /* Common to all the submessages */
#define FLAG_DATA_D (0x02)
+#define FLAG_DATA_D_v2 (0x04)
#define FLAG_DATA_A (0x04)
#define FLAG_DATA_H (0x08)
#define FLAG_DATA_Q (0x10)
+#define FLAG_DATA_Q_v2 (0x02)
+#define FLAG_DATA_FRAG_Q (0x02)
+#define FLAG_DATA_FRAG_H (0x04)
+#define FLAG_DATA_I (0x10)
#define FLAG_DATA_U (0x20)
#define FLAG_NOKEY_DATA_Q (0x02)
#define FLAG_NOKEY_DATA_D (0x04)
@@ -108,7 +114,18 @@ typedef enum {
#define FLAG_INFO_TS_T (0x02)
#define FLAG_INFO_REPLY_IP4_M (0x02)
#define FLAG_INFO_REPLY_M (0x02)
-
+#define FLAG_RTPS_DATA_Q (0x02)
+#define FLAG_RTPS_DATA_D (0x04)
+#define FLAG_RTPS_DATA_K (0x08)
+#define FLAG_RTPS_DATA_FRAG_Q (0x02)
+#define FLAG_RTPS_DATA_FRAG_K (0x04)
+#define FLAG_RTPS_DATA_BATCH_Q (0x02)
+#define FLAG_SAMPLE_INFO_T (0x01)
+#define FLAG_SAMPLE_INFO_Q (0x02)
+#define FLAG_SAMPLE_INFO_O (0x04)
+#define FLAG_SAMPLE_INFO_D (0x08)
+#define FLAG_SAMPLE_INFO_I (0x10)
+#define FLAG_SAMPLE_INFO_K (0x20)
/* The following PIDs are defined since RTPS 1.0 */
@@ -183,6 +200,29 @@ typedef enum {
#define PID_LATENCY_BUDGET_OFFERED (0x28)
#define PID_PARTITION_OFFERED (0x2a)
+/* The following PIDs are defined since RTPS 2.0 */
+#define PID_DEFAULT_MULTICAST_LOCATOR (0x0048)
+#define PID_TRANSPORT_PRIORITY (0x0049)
+#define PID_CONTENT_FILTER_INFO (0x0055)
+#define PID_DIRECTED_WRITE (0x0057)
+#define PID_BUILTIN_ENDPOINT_SET (0x0058)
+#define PID_PROPERTY_LIST (0x0059) /* RTI DDS 4.2e and newer */
+#define PID_ENDPOINT_GUID (0x005a)
+#define PID_TYPE_MAX_SIZE_SERIALIZED (0x0060)
+#define PID_ORIGINAL_WRITER_INFO (0x0061)
+#define PID_ENTITY_NAME (0x0062)
+#define PID_KEY_HASH (0x0070)
+#define PID_STATUS_INFO (0x0071)
+
+/* Vendor-specific: RTI */
+#define PID_PRODUCT_VERSION (0x8000)
+#define PID_PLUGIN_PROMISCUITY_KIND (0x8001)
+#define PID_ENTITY_VIRTUAL_GUID (0x8002)
+#define PID_SERVICE_KIND (0x8003)
+#define PID_TYPECODE_RTPS2 (0x8004) /* Was: 0x47 in RTPS 1.2 */
+#define PID_DISABLE_POSITIVE_ACKS (0x8005)
+#define PID_LOCATOR_FILTER_LIST (0x8006)
+
/* appId.appKind possible values */
#define APPKIND_UNKNOWN (0x00)
#define APPKIND_MANAGED_APPLICATION (0x01)
@@ -192,6 +232,7 @@ typedef enum {
/* Predefined EntityId */
#define ENTITYID_UNKNOWN (0x00000000)
+#define ENTITYID_PARTICIPANT (0x000001c1)
#define ENTITYID_BUILTIN_TOPIC_WRITER (0x000002c2)
#define ENTITYID_BUILTIN_TOPIC_READER (0x000002c7)
#define ENTITYID_BUILTIN_PUBLICATIONS_WRITER (0x000003c2)
@@ -200,6 +241,8 @@ typedef enum {
#define ENTITYID_BUILTIN_SUBSCRIPTIONS_READER (0x000004c7)
#define ENTITYID_BUILTIN_SDP_PARTICIPANT_WRITER (0x000100c2)
#define ENTITYID_BUILTIN_SDP_PARTICIPANT_READER (0x000100c7)
+#define ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER (0x000200c2)
+#define ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_READER (0x000200c7)
/* Deprecated EntityId */
#define ENTITYID_APPLICATIONS_WRITER (0x000001c2)
@@ -229,18 +272,31 @@ typedef enum {
/* Submessage Type */
-#define PAD (0x01)
-#define DATA (0x02)
-#define NOKEY_DATA (0x03)
-#define ACKNACK (0x06)
-#define HEARTBEAT (0x07)
-#define GAP (0x08)
-#define INFO_TS (0x09)
-#define INFO_SRC (0x0c)
-#define INFO_REPLY_IP4 (0x0d)
-#define INFO_DST (0x0e)
-#define INFO_REPLY (0x0f)
-
+#define SUBMESSAGE_PAD (0x01)
+#define SUBMESSAGE_DATA (0x02)
+#define SUBMESSAGE_NOKEY_DATA (0x03)
+#define SUBMESSAGE_ACKNACK (0x06)
+#define SUBMESSAGE_HEARTBEAT (0x07)
+#define SUBMESSAGE_GAP (0x08)
+#define SUBMESSAGE_INFO_TS (0x09)
+#define SUBMESSAGE_INFO_SRC (0x0c)
+#define SUBMESSAGE_INFO_REPLY_IP4 (0x0d)
+#define SUBMESSAGE_INFO_DST (0x0e)
+#define SUBMESSAGE_INFO_REPLY (0x0f)
+
+#define SUBMESSAGE_DATA_FRAG (0x10) /* RTPS 2.0 Only */
+#define SUBMESSAGE_NOKEY_DATA_FRAG (0x11) /* RTPS 2.0 Only */
+#define SUBMESSAGE_NACK_FRAG (0x12) /* RTPS 2.0 Only */
+#define SUBMESSAGE_HEARTBEAT_FRAG (0x13) /* RTPS 2.0 Only */
+
+#define SUBMESSAGE_RTPS_DATA_SESSION (0x14) /* RTPS 2.1 only */
+#define SUBMESSAGE_RTPS_DATA (0x15) /* RTPS 2.1 only */
+#define SUBMESSAGE_RTPS_DATA_FRAG (0x16) /* RTPS 2.1 only */
+#define SUBMESSAGE_ACKNACK_BATCH (0x17) /* RTPS 2.1 only */
+#define SUBMESSAGE_RTPS_DATA_BATCH (0x18) /* RTPS 2.1 Only */
+#define SUBMESSAGE_HEARTBEAT_BATCH (0x19) /* RTPS 2.1 only */
+#define SUBMESSAGE_ACKNACK_SESSION (0x1a) /* RTPS 2.1 only */
+#define SUBMESSAGE_HEARTBEAT_SESSION (0x1b) /* RTPS 2.1 only */
/* An invalid IP Address:
@@ -264,6 +320,12 @@ typedef enum {
#define RTPS_VENDOR_TOC_STRING "Twin Oaks Computing, Inc."
+/* Data encapsulation */
+#define ENCAPSULATION_CDR_BE (0x0000)
+#define ENCAPSULATION_CDR_LE (0x0001)
+#define ENCAPSULATION_PL_CDR_BE (0x0002)
+#define ENCAPSULATION_PL_CDR_LE (0x0003)
+
/* Parameter Liveliness */
#define LIVELINESS_AUTOMATIC (0)
#define LIVELINESS_BY_PARTICIPANT (1)
@@ -302,9 +364,14 @@ typedef enum {
#define BY_RECEPTION_TIMESTAMP (0)
#define BY_SOURCE_TIMESTAMP (1)
+/* Participant message data kind */
+#define PARTICIPANT_MESSAGE_DATA_KIND_UNKNOWN (0x00000000)
+#define PARTICIPANT_MESSAGE_DATA_KIND_AUTOMATIC_LIVELINESS_UPDATE (0x00000001)
+#define PARTICIPANT_MESSAGE_DATA_KIND_MANUAL_LIVELINESS_UPDATE (0x00000002)
+
/* Utilities to add elements to the protocol tree for packet-rtps.h and packet-rtps2.h */
extern guint16 rtps_util_add_protocol_version(proto_tree *tree, tvbuff_t* tvb, gint offset);
-extern void rtps_util_add_vendor_id(proto_tree *tree, tvbuff_t * tvb, gint offset);
+extern guint16 rtps_util_add_vendor_id(proto_tree *tree, tvbuff_t * tvb, gint offset);
extern void rtps_util_add_locator_t(proto_tree *tree, packet_info *pinfo, tvbuff_t * tvb, gint offset,
gboolean little_endian, const guint8 * label);
extern int rtps_util_add_locator_list(proto_tree *tree, packet_info *pinfo, tvbuff_t * tvb,
@@ -316,23 +383,24 @@ extern void rtps_util_add_locator_udp_v4(proto_tree *tree, packet_info *pinfo, t
extern int rtps_util_add_entity_id(proto_tree *tree, tvbuff_t * tvb, gint offset,
int hf_item, int hf_item_entity_key, int hf_item_entity_kind,
int subtree_entity_id, const char *label, guint32* entity_id_out);
-extern void rtps_util_add_generic_entity_id(proto_tree *, tvbuff_t *,
- gint, const char *,
- guint8 *, gint);
+extern void rtps_util_add_generic_entity_id(proto_tree *tree, tvbuff_t * tvb, gint offset, const char* label,
+ int hf_item, int hf_item_entity_key, int hf_item_entity_kind,
+ int subtree_entity_id);
extern guint64 rtps_util_add_seq_number(proto_tree *, tvbuff_t *,
gint, int, const char *);
extern void rtps_util_add_ntp_time(proto_tree *tree, tvbuff_t * tvb, gint offset,
gboolean little_endian, int hf_time);
-extern gint rtps_util_add_string(proto_tree *, tvbuff_t *,
- gint, int, int, const guint8 *, guint8 *, size_t);
+extern gint rtps_util_add_string(proto_tree *tree, tvbuff_t* tvb, gint offset,
+ int hf_item, gboolean little_endian);
extern void rtps_util_add_port(proto_tree *tree, packet_info *pinfo, tvbuff_t * tvb,
gint offset, gboolean little_endian, int hf_item);
extern void rtps_util_add_durability_service_qos(proto_tree *tree, tvbuff_t * tvb,
gint offset, gboolean little_endian);
extern void rtps_util_add_liveliness_qos(proto_tree *tree, tvbuff_t * tvb, gint offset,
gboolean little_endian);
-extern gint rtps_util_add_seq_string(proto_tree *, tvbuff_t *,
- gint, int, int, const char *, guint8 *, gint);
+extern gint rtps_util_add_seq_string(proto_tree *tree, tvbuff_t* tvb, gint offset,
+ gboolean little_endian, int param_length, int hf_numstring,
+ int hf_string, const char *label);
extern void rtps_util_add_seq_octets(proto_tree *tree, packet_info *pinfo, tvbuff_t* tvb,
gint offset, gboolean little_endian, int param_length, int hf_id);
extern gint rtps_util_add_seq_ulong(proto_tree *tree, tvbuff_t * tvb, gint offset, int hf_item,
@@ -344,7 +412,7 @@ extern gboolean rtps_is_ping(tvbuff_t *tvb, packet_info *pinfo, gint offset);
extern void dissect_PAD(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
gboolean little_endian, int octects_to_next_header, proto_tree *tree);
extern void dissect_INFO_SRC(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
- gboolean little_endian, int octets_to_next_header, proto_tree *tree);
+ gboolean little_endian, int octets_to_next_header, proto_tree *tree, guint16 rtps_version);
extern void dissect_INFO_TS(tvbuff_t *tvb, packet_info *pinfo, gint offset, guint8 flags,
gboolean little_endian, int octets_to_next_header, proto_tree *tree);
diff --git a/epan/dissectors/packet-rtps2.c b/epan/dissectors/packet-rtps2.c
deleted file mode 100644
index d384437a3e..0000000000
--- a/epan/dissectors/packet-rtps2.c
+++ /dev/null
@@ -1,7682 +0,0 @@
-/* packet-rtps2.c
- * ~~~~~~~~~~~~~~
- *
- * Routines for Real-Time Publish-Subscribe Protocol (RTPS) dissection
- *
- * Copyright 2005, Fabrizio Bertocci <fabrizio@rti.com>
- * Real-Time Innovations, Inc.
- * 385 Moffett Park Drive
- * Sunnyvale, CA 94089
- *
- * Version 2.1 bug fixes to RTPS_DATA provided by
- * Twin Oaks Computing, Inc. <contact@twinoakscomputing.com>
- * 755 Maleta Ln, Ste 203
- * Castle Rock, CO 80108
- *
- * $Id$
- *
- * Wireshark - Network traffic analyzer
- * By Gerald Combs <gerald@wireshark.org>
- * Copyright 1998 Gerald Combs
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
- *
- * -------------------------------------
- *
- * This is the RTPS packet dissector for RTPS version 2.x
- *
- * RTPS protocol was initially developed by Real-Time Innovations, Inc. as wire
- * protocol for Data Distribution System, and then adopted as a standard by
- * the Object Management Group (as version 2.0).
- *
- * Additional information at:
- * The Real-time Publish-Subscribe Wire Protocol DDS Interoperability Wire Protocol (DDSI):
- * http://www.omg.org/spec/DDSI/
- * Full OMG DDS Standard Specification:
- * http://www.omg.org/cgi-bin/doc?ptc/2003-07-07
- *
- * RTI DDS and RTPS information: http://www.rti.com/resources.html
- *
- */
-
-
-#include "config.h"
-
-#include <string.h>
-#include <glib.h>
-#include <epan/packet.h>
-#include <epan/addr_resolv.h>
-#include <epan/expert.h>
-#include <epan/prefs.h>
-
-
-#include "packet-rtps2.h"
-#include "packet-rtps.h"
-
-/* Size of the temp buffers used to format various part of the protocol.
- * Note: Some of those values are bigger than expected. The reason is
- * because the string buffer can also contains decoded values.
- * I.e. port size is an integer, but for value 0x0000, it is interpreted
- * as a string "PORT_INVALID (0x00000000)"
- */
-#define MAX_FLAG_SIZE (40)
-#define MAX_GUID_PREFIX_SIZE (128)
-#define MAX_GUID_SIZE (160)
-#define MAX_VENDOR_ID_SIZE (128)
-#define MAX_NTP_TIME_SIZE (128)
-#define MAX_PORT_SIZE (32)
-#define MAX_PARAM_SIZE (256)
-#define MAX_LOCATOR_SIZE (200)
-#define MAX_IPV6_SIZE (100)
-#define MAX_BITMAP_SIZE (256)
-#define MAX_LABEL_SIZE (64)
-#define MAX_IPV4_ADDRESS_SIZE (64)
-
-/* Max octets printed on the parameter root for a sequence of octets */
-#define MAX_SEQ_OCTETS_PRINTED (20)
-
-
-/***************************************************************************/
-/* Protocol Fields Identifiers */
-static int proto_rtps = -1;
-
-static int hf_rtps_domain_id = -1;
-static int hf_rtps_participant_idx = -1;
-static int hf_rtps_nature_type = -1;
-
-static int hf_rtps_guid_prefix = -1;
-static int hf_rtps_host_id = -1;
-static int hf_rtps_app_id = -1;
-/* static int hf_rtps_counter = -1; */
-
-static int hf_rtps_sm_id = -1;
-static int hf_rtps_sm_flags = -1;
-static int hf_rtps_sm_octets_to_next_header = -1;
-static int hf_rtps_sm_guid_prefix = -1;
-static int hf_rtps_sm_host_id = -1;
-static int hf_rtps_sm_app_id = -1;
-/* static int hf_rtps_sm_instance_id = -1; */
-/* static int hf_rtps_sm_app_kind = -1; */
-static int hf_rtps_sm_counter = -1;
-static int hf_rtps_sm_entity_id = -1;
-static int hf_rtps_sm_entity_id_key = -1;
-static int hf_rtps_sm_entity_id_kind = -1;
-static int hf_rtps_sm_rdentity_id = -1;
-static int hf_rtps_sm_rdentity_id_key = -1;
-static int hf_rtps_sm_rdentity_id_kind = -1;
-static int hf_rtps_sm_wrentity_id = -1;
-static int hf_rtps_sm_wrentity_id_key = -1;
-static int hf_rtps_sm_wrentity_id_kind = -1;
-
-static int hf_rtps_parameter_id = -1;
-static int hf_rtps_parameter_length = -1;
-static int hf_rtps_param_topic_name = -1;
-static int hf_rtps_param_entity_name = -1;
-static int hf_rtps_param_strength = -1;
-static int hf_rtps_param_type_name = -1;
-static int hf_rtps_param_user_data = -1;
-static int hf_rtps_param_group_data = -1;
-static int hf_rtps_param_topic_data = -1;
-static int hf_rtps_param_content_filter_name = -1;
-static int hf_rtps_param_related_topic_name = -1;
-static int hf_rtps_param_filter_name = -1;
-static int hf_rtps_issue_data = -1;
-static int hf_rtps_param_status_info = -1;
-
-static int hf_rtps_participant_lease_duration = -1;
-static int hf_rtps_time_based_filter_minimum_separation = -1;
-static int hf_rtps_deadline_period = -1;
-static int hf_rtps_latency_budget_duration = -1;
-static int hf_rtps_lifespan_duration = -1;
-static int hf_rtps_persistence = -1;
-static int hf_rtps_data_batch_timestamp = -1;
-static int hf_rtps_participant_builtin_endpoints= -1;
-static int hf_rtps_participant_manual_liveliness_count = -1;
-static int hf_rtps_history_depth = -1;
-static int hf_rtps_resource_limit_max_samples = -1;
-static int hf_rtps_resource_limit_max_instances = -1;
-static int hf_rtps_resource_limit_max_samples_per_instances = -1;
-static int hf_rtps_filter_bitmap = -1;
-static int hf_rtps_type_checksum = -1;
-static int hf_rtps_queue_size = -1;
-static int hf_param_ip_address = -1;
-static int hf_rtps_param_port = -1;
-static int hf_rtps_expects_inline_qos = -1;
-static int hf_rtps_presentation_coherent_access = -1;
-static int hf_rtps_presentation_ordered_access = -1;
-static int hf_rtps_expects_ack = -1;
-static int hf_rtps_disable_positive_ack = -1;
-static int hf_rtps_reliability_kind = -1;
-static int hf_rtps_durability = -1;
-static int hf_rtps_ownership = -1;
-static int hf_rtps_presentation_access_scope = -1;
-static int hf_rtps_destination_order = -1;
-static int hf_rtps_history_kind = -1;
-
-
-/* Subtree identifiers */
-static gint ett_rtps = -1;
-static gint ett_rtps_default_mapping = -1;
-static gint ett_rtps_proto_version = -1;
-static gint ett_rtps_submessage = -1;
-static gint ett_rtps_parameter_sequence = -1;
-static gint ett_rtps_parameter = -1;
-static gint ett_rtps_flags = -1;
-static gint ett_rtps_entity = -1;
-static gint ett_rtps_rdentity = -1;
-static gint ett_rtps_wrentity = -1;
-static gint ett_rtps_guid_prefix = -1;
-static gint ett_rtps_part_message_data = -1;
-static gint ett_rtps_part_message_guid = -1;
-static gint ett_rtps_locator_udp_v4 = -1;
-static gint ett_rtps_locator = -1;
-static gint ett_rtps_locator_list = -1;
-static gint ett_rtps_ntp_time = -1;
-static gint ett_rtps_bitmap = -1;
-static gint ett_rtps_seq_string = -1;
-static gint ett_rtps_seq_ulong = -1;
-static gint ett_rtps_serialized_data = -1;
-static gint ett_rtps_sample_info_list = -1;
-static gint ett_rtps_sample_info = -1;
-static gint ett_rtps_sample_batch_list = -1;
-static gint ett_rtps_locator_filter_channel = -1;
-static gint ett_rtps_locator_filter_locator = -1;
-static gint ett_rtps_resource_limit = -1;
-
-/***************************************************************************/
-/* Value-to-String Tables */
-static const value_string entity_id_vals[] = {
- { ENTITYID_UNKNOWN, "ENTITYID_UNKNOWN" },
- { ENTITYID_PARTICIPANT, "ENTITYID_PARTICIPANT" },
- { ENTITYID_SEDP_BUILTIN_TOPIC_WRITER, "ENTITYID_SEDP_BUILTIN_TOPIC_WRITER" },
- { ENTITYID_SEDP_BUILTIN_TOPIC_READER, "ENTITYID_SEDP_BUILTIN_TOPIC_READER" },
- { ENTITYID_SEDP_BUILTIN_PUBLICATIONS_WRITER, "ENTITYID_SEDP_BUILTIN_PUBLICATIONS_WRITER" },
- { ENTITYID_SEDP_BUILTIN_PUBLICATIONS_READER, "ENTITYID_SEDP_BUILTIN_PUBLICATIONS_READER" },
- { ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_WRITER, "ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_WRITER" },
- { ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_READER, "ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_READER" },
- { ENTITYID_SPDP_BUILTIN_PARTICIPANT_WRITER, "ENTITYID_SPDP_BUILTIN_PARTICIPANT_WRITER" },
- { ENTITYID_SPDP_BUILTIN_PARTICIPANT_READER, "ENTITYID_SPDP_BUILTIN_PARTICIPANT_READER" },
- { ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER, "ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER" },
- { ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_READER, "ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_READER" },
-
- /* Deprecated Items */
- { ENTITYID_APPLICATIONS_WRITER, "writerApplications [DEPRECATED]" },
- { ENTITYID_APPLICATIONS_READER, "readerApplications [DEPRECATED]" },
- { ENTITYID_CLIENTS_WRITER, "writerClients [DEPRECATED]" },
- { ENTITYID_CLIENTS_READER, "readerClients [DEPRECATED]" },
- { ENTITYID_SERVICES_WRITER, "writerServices [DEPRECATED]" },
- { ENTITYID_SERVICES_READER, "readerServices [DEPRECATED]" },
- { ENTITYID_MANAGERS_WRITER, "writerManagers [DEPRECATED]" },
- { ENTITYID_MANAGERS_READER, "readerManagers [DEPRECATED]" },
- { ENTITYID_APPLICATION_SELF, "applicationSelf [DEPRECATED]" },
- { ENTITYID_APPLICATION_SELF_WRITER, "writerApplicationSelf [DEPRECATED]" },
- { ENTITYID_APPLICATION_SELF_READER, "readerApplicationSelf [DEPRECATED]" },
- { 0, NULL }
-};
-
-static const value_string entity_kind_vals [] = {
- { ENTITYKIND_APPDEF_UNKNOWN, "Application-defined unknown kind" },
- { ENTITYKIND_APPDEF_PARTICIPANT, "Application-defined participant" },
- { ENTITYKIND_APPDEF_WRITER_WITH_KEY, "Application-defined writer (with key)" },
- { ENTITYKIND_APPDEF_WRITER_NO_KEY, "Application-defined writer (no key)" },
- { ENTITYKIND_APPDEF_READER_WITH_KEY, "Application-defined reader (with key)" },
- { ENTITYKIND_APPDEF_READER_NO_KEY, "Application-defined reader (no key)" },
- { ENTITYKIND_BUILTIN_PARTICIPANT, "Built-in participant" },
- { ENTITYKIND_BUILTIN_WRITER_WITH_KEY, "Built-in writer (with key)" },
- { ENTITYKIND_BUILTIN_WRITER_NO_KEY, "Built-in writer (no key)" },
- { ENTITYKIND_BUILTIN_READER_WITH_KEY, "Built-in reader (with key)" },
- { ENTITYKIND_BUILTIN_READER_NO_KEY, "Built-in reader (no key)" },
- { 0, NULL }
-};
-
-
-static const value_string nature_type_vals[] = {
- { PORT_METATRAFFIC_UNICAST, "UNICAST_METATRAFFIC"},
- { PORT_METATRAFFIC_MULTICAST, "MULTICAST_METATRAFFIC"},
- { PORT_USERTRAFFIC_UNICAST, "UNICAST_USERTRAFFIC"},
- { PORT_USERTRAFFIC_MULTICAST, "MULTICAST_USERTRAFFIC"},
- { 0, NULL }
-};
-
-
-static const value_string app_kind_vals[] = {
- { APPKIND_UNKNOWN, "APPKIND_UNKNOWN" },
- { APPKIND_MANAGED_APPLICATION, "ManagedApplication" },
- { APPKIND_MANAGER, "Manager" },
- { 0, NULL }
-};
-
-
-static const value_string submessage_id_vals[] = {
- { SUBMESSAGE_PAD, "PAD" },
- { SUBMESSAGE_RTPS_DATA, "DATA" },
- { SUBMESSAGE_RTPS_DATA_FRAG, "DATA_FRAG" },
- { SUBMESSAGE_RTPS_DATA_BATCH, "DATA_BATCH" },
- { SUBMESSAGE_ACKNACK, "ACKNACK" },
- { SUBMESSAGE_HEARTBEAT, "HEARTBEAT" },
- { SUBMESSAGE_GAP, "GAP" },
- { SUBMESSAGE_INFO_TS, "INFO_TS" },
- { SUBMESSAGE_INFO_SRC, "INFO_SRC" },
- { SUBMESSAGE_INFO_REPLY_IP4, "INFO_REPLY_IP4" },
- { SUBMESSAGE_INFO_DST, "INFO_DST" },
- { SUBMESSAGE_INFO_REPLY, "INFO_REPLY" },
- { SUBMESSAGE_NACK_FRAG, "NACK_FRAG" },
- { SUBMESSAGE_HEARTBEAT_FRAG, "HEARTBEAT_FRAG" },
- { SUBMESSAGE_ACKNACK_BATCH, "ACKNACK_BATCH" },
- { SUBMESSAGE_HEARTBEAT_BATCH, "HEARTBEAT_BATCH" },
- { SUBMESSAGE_ACKNACK_SESSION, "ACKNACK_SESSION" },
- { SUBMESSAGE_HEARTBEAT_SESSION, "HEARTBEAT_SESSION" },
- { SUBMESSAGE_RTPS_DATA_SESSION, "DATA_SESSION" },
- /* Deprecated submessages */
- { SUBMESSAGE_DATA, "DATA_deprecated" },
- { SUBMESSAGE_NOKEY_DATA, "NOKEY_DATA_deprecated" },
- { SUBMESSAGE_DATA_FRAG, "DATA_FRAG_deprecated" },
- { SUBMESSAGE_NOKEY_DATA_FRAG, "NOKEY_DATA_FRAG_deprecated" },
- { 0, NULL }
-};
-
-static const value_string typecode_kind_vals[] = {
- { RTI_CDR_TK_NULL, "(unknown)" },
- { RTI_CDR_TK_SHORT, "short" },
- { RTI_CDR_TK_LONG, "long" },
- { RTI_CDR_TK_USHORT, "unsigned short" },
- { RTI_CDR_TK_ULONG, "unsigned long" },
- { RTI_CDR_TK_FLOAT, "float" },
- { RTI_CDR_TK_DOUBLE, "double" },
- { RTI_CDR_TK_BOOLEAN, "boolean" },
- { RTI_CDR_TK_CHAR, "char" },
- { RTI_CDR_TK_OCTET, "octet" },
- { RTI_CDR_TK_STRUCT, "struct" },
- { RTI_CDR_TK_UNION, "union" },
- { RTI_CDR_TK_ENUM, "enum" },
- { RTI_CDR_TK_STRING, "string" },
- { RTI_CDR_TK_SEQUENCE, "sequence" },
- { RTI_CDR_TK_ARRAY, "array" },
- { RTI_CDR_TK_ALIAS, "alias" },
- { RTI_CDR_TK_LONGLONG, "long long" },
- { RTI_CDR_TK_ULONGLONG, "unsigned long long" },
- { RTI_CDR_TK_LONGDOUBLE, "long double" },
- { RTI_CDR_TK_WCHAR, "wchar" },
- { RTI_CDR_TK_WSTRING, "wstring" },
- { 0, NULL }
-};
-
-static const value_string parameter_id_vals[] = {
- { PID_PAD, "PID_PAD" },
- { PID_SENTINEL, "PID_SENTINEL" },
- { PID_PARTICIPANT_LEASE_DURATION, "PID_PARTICIPANT_LEASE_DURATION" },
- { PID_TIME_BASED_FILTER, "PID_TIME_BASED_FILTER" },
- { PID_TOPIC_NAME, "PID_TOPIC_NAME" },
- { PID_OWNERSHIP_STRENGTH, "PID_OWNERSHIP_STRENGTH" },
- { PID_TYPE_NAME, "PID_TYPE_NAME" },
- { PID_METATRAFFIC_MULTICAST_IPADDRESS,"PID_METATRAFFIC_MULTICAST_IPADDRESS"},
- { PID_DEFAULT_UNICAST_IPADDRESS, "PID_DEFAULT_UNICAST_IPADDRESS" },
- { PID_METATRAFFIC_UNICAST_PORT, "PID_METATRAFFIC_UNICAST_PORT" },
- { PID_DEFAULT_UNICAST_PORT, "PID_DEFAULT_UNICAST_PORT" },
- { PID_MULTICAST_IPADDRESS, "PID_MULTICAST_IPADDRESS" },
- { PID_PROTOCOL_VERSION, "PID_PROTOCOL_VERSION" },
- { PID_VENDOR_ID, "PID_VENDOR_ID" },
- { PID_RELIABILITY, "PID_RELIABILITY" },
- { PID_LIVELINESS, "PID_LIVELINESS" },
- { PID_DURABILITY, "PID_DURABILITY" },
- { PID_DURABILITY_SERVICE, "PID_DURABILITY_SERVICE" },
- { PID_OWNERSHIP, "PID_OWNERSHIP" },
- { PID_PRESENTATION, "PID_PRESENTATION" },
- { PID_DEADLINE, "PID_DEADLINE" },
- { PID_DESTINATION_ORDER, "PID_DESTINATION_ORDER" },
- { PID_LATENCY_BUDGET, "PID_LATENCY_BUDGET" },
- { PID_PARTITION, "PID_PARTITION" },
- { PID_LIFESPAN, "PID_LIFESPAN" },
- { PID_USER_DATA, "PID_USER_DATA" },
- { PID_GROUP_DATA, "PID_GROUP_DATA" },
- { PID_TOPIC_DATA, "PID_TOPIC_DATA" },
- { PID_UNICAST_LOCATOR, "PID_UNICAST_LOCATOR" },
- { PID_MULTICAST_LOCATOR, "PID_MULTICAST_LOCATOR" },
- { PID_DEFAULT_UNICAST_LOCATOR, "PID_DEFAULT_UNICAST_LOCATOR" },
- { PID_METATRAFFIC_UNICAST_LOCATOR, "PID_METATRAFFIC_UNICAST_LOCATOR " },
- { PID_METATRAFFIC_MULTICAST_LOCATOR, "PID_METATRAFFIC_MULTICAST_LOCATOR" },
- { PID_PARTICIPANT_MANUAL_LIVELINESS_COUNT, "PID_PARTICIPANT_MANUAL_LIVELINESS_COUNT" },
- { PID_CONTENT_FILTER_PROPERTY, "PID_CONTENT_FILTER_PROPERTY" },
- { PID_PROPERTY_LIST, "PID_PROPERTY_LIST" },
- { PID_HISTORY, "PID_HISTORY" },
- { PID_RESOURCE_LIMIT, "PID_RESOURCE_LIMIT" },
- { PID_EXPECTS_INLINE_QOS, "PID_EXPECTS_INLINE_QOS" },
- { PID_PARTICIPANT_BUILTIN_ENDPOINTS, "PID_PARTICIPANT_BUILTIN_ENDPOINTS" },
- { PID_METATRAFFIC_UNICAST_IPADDRESS, "PID_METATRAFFIC_UNICAST_IPADDRESS" },
- { PID_METATRAFFIC_MULTICAST_PORT, "PID_METATRAFFIC_MULTICAST_PORT" },
- { PID_DEFAULT_MULTICAST_LOCATOR, "PID_DEFAULT_MULTICAST_LOCATOR" },
- { PID_TRANSPORT_PRIORITY, "PID_TRANSPORT_PRIORITY" },
- { PID_PARTICIPANT_GUID, "PID_PARTICIPANT_GUID" },
- { PID_PARTICIPANT_ENTITY_ID, "PID_PARTICIPANT_ENTITY_ID" },
- { PID_GROUP_GUID, "PID_GROUP_GUID" },
- { PID_GROUP_ENTITY_ID, "PID_GROUP_ENTITY_ID" },
- { PID_CONTENT_FILTER_INFO, "PID_CONTENT_FILTER_INFO" },
- { PID_COHERENT_SET, "PID_COHERENT_SET" },
- { PID_DIRECTED_WRITE, "PID_DIRECTED_WRITE" },
- { PID_BUILTIN_ENDPOINT_SET, "PID_BUILTIN_ENDPOINT_SET" },
- { PID_PROPERTY_LIST_OLD, "PID_PROPERTY_LIST" },
- { PID_ENDPOINT_GUID, "PID_ENDPOINT_GUID" },
- { PID_TYPE_MAX_SIZE_SERIALIZED, "PID_TYPE_MAX_SIZE_SERIALIZED" },
- { PID_ORIGINAL_WRITER_INFO, "PID_ORIGINAL_WRITER_INFO" },
- { PID_ENTITY_NAME, "PID_ENTITY_NAME" },
- { PID_KEY_HASH, "PID_KEY_HASH" },
- { PID_STATUS_INFO, "PID_STATUS_INFO" },
-
- /* Vendor specific: RTI */
- { PID_PRODUCT_VERSION, "PID_PRODUCT_VERSION" },
- { PID_PLUGIN_PROMISCUITY_KIND, "PID_PLUGIN_PROMISCUITY_KIND" },
- { PID_ENTITY_VIRTUAL_GUID, "PID_ENTITY_VIRTUAL_GUID" },
- { PID_SERVICE_KIND, "PID_SERVICE_KIND" },
- { PID_TYPECODE_RTPS2, "PID_TYPECODE" },
- { PID_DISABLE_POSITIVE_ACKS, "PID_DISABLE_POSITIVE_ACKS" },
- { PID_LOCATOR_FILTER_LIST, "PID_LOCATOR_FILTER_LIST" },
-
- /* The following PID are deprecated */
- { PID_DEADLINE_OFFERED, "PID_DEADLINE_OFFERED [deprecated]" },
- { PID_PERSISTENCE, "PID_PERSISTENCE [deprecated]" },
- { PID_TYPE_CHECKSUM, "PID_TYPE_CHECKSUM [deprecated]" },
- { PID_TYPE2_NAME, "PID_TYPE2_NAME [deprecated]" },
- { PID_TYPE2_CHECKSUM, "PID_TYPE2_CHECKSUM [deprecated]" },
- { PID_IS_RELIABLE, "PID_IS_RELIABLE [deprecated]" },
- { PID_EXPECTS_ACK, "PID_EXPECTS_ACK [deprecated]" },
- { PID_MANAGER_KEY, "PID_MANAGER_KEY [deprecated]" },
- { PID_SEND_QUEUE_SIZE, "PID_SEND_QUEUE_SIZE [deprecated]" },
- { PID_RELIABILITY_ENABLED, "PID_RELIABILITY_ENABLED [deprecated]" },
- { PID_VARGAPPS_SEQUENCE_NUMBER_LAST, "PID_VARGAPPS_SEQUENCE_NUMBER_LAST [deprecated]" },
- { PID_RECV_QUEUE_SIZE, "PID_RECV_QUEUE_SIZE [deprecated]" },
- { PID_RELIABILITY_OFFERED, "PID_RELIABILITY_OFFERED [deprecated]" },
- { PID_LIVELINESS_OFFERED, "PID_LIVELINESS_OFFERED [deprecated]" },
- { PID_PRESENTATION_OFFERED, "PID_PRESENTATION_OFFERED [deprecated]" },
- { PID_OWNERSHIP_OFFERED, "PID_OWNERSHIP_OFFERED [deprecated]" },
- { PID_DESTINATION_ORDER_OFFERED, "PID_DESTINATION_ORDER_OFFERED [deprecated]" },
- { PID_LATENCY_BUDGET_OFFERED, "PID_LATENCY_BUDGET_OFFERED [deprecated]" },
- { PID_PARTITION_OFFERED, "PID_PARTITION_OFFERED [deprecated]" },
- { 0, NULL }
-};
-
-static const value_string liveliness_qos_vals[] = {
- { LIVELINESS_AUTOMATIC, "AUTOMATIC_LIVELINESS_QOS" },
- { LIVELINESS_BY_PARTICIPANT, "MANUAL_BY_PARTICIPANT_LIVELINESS_QOS" },
- { LIVELINESS_BY_TOPIC, "MANUAL_BY_TOPIC_LIVELINESS_QOS" },
- { 0, NULL }
-};
-
-static const value_string durability_qos_vals[] = {
- { DURABILITY_VOLATILE, "VOLATILE_DURABILITY_QOS" },
- { DURABILITY_TRANSIENT_LOCAL, "TRANSIENT_LOCAL_DURABILITY_QOS" },
- { DURABILITY_TRANSIENT, "TRANSIENT_DURABILITY_QOS" },
- { DURABILITY_PERSISTENT, "PERSISTENT_DURABILITY_QOS" },
- { 0, NULL }
-};
-
-static const value_string ownership_qos_vals[] = {
- { OWNERSHIP_SHARED, "SHARED_OWNERSHIP_QOS" },
- { OWNERSHIP_EXCLUSIVE, "EXCLUSIVE_OWNERSHIP_QOS" },
- { 0, NULL }
-};
-
-static const value_string presentation_qos_vals[] = {
- { PRESENTATION_INSTANCE, "INSTANCE_PRESENTATION_QOS" },
- { PRESENTATION_TOPIC, "TOPIC_PRESENTATION_QOS" },
- { PRESENTATION_GROUP, "GROUP_PRESENTATION_QOS" },
- { 0, NULL }
-};
-
-static const value_string history_qos_vals[] = {
- { HISTORY_KIND_KEEP_LAST, "KEEP_LAST_HISTORY_QOS" },
- { HISTORY_KIND_KEEP_ALL, "KEEP_ALL_HISTORY_QOS" },
- { 0, NULL }
-};
-
-static const value_string reliability_qos_vals[] = {
- { RELIABILITY_BEST_EFFORT, "BEST_EFFORT_RELIABILITY_QOS" },
- { RELIABILITY_RELIABLE, "RELIABLE_RELIABILITY_QOS" },
- { 0, NULL }
-};
-
-static const value_string destination_order_qos_vals[] = {
- { BY_RECEPTION_TIMESTAMP, "BY_RECEPTION_TIMESTAMP_DESTINATIONORDER_QOS" },
- { BY_SOURCE_TIMESTAMP, "BY_SOURCE_TIMESTAMP_DESTINATIONORDER_QOS" },
- { 0, NULL }
-};
-
-
-static const value_string encapsulation_id_vals[] = {
- { ENCAPSULATION_CDR_BE, "CDR_BE" },
- { ENCAPSULATION_CDR_LE, "CDR_LE" },
- { ENCAPSULATION_PL_CDR_BE, "PL_CDR_BE" },
- { ENCAPSULATION_PL_CDR_LE, "PL_CDR_LE" },
- { 0, NULL }
-};
-
-static const value_string plugin_promiscuity_kind_vals[] = {
- { 0x0001, "MATCHING_REMOTE_ENTITIES_PROMISCUITY" },
- { 0xffff, "ALL_REMOTE_ENTITIES_PROMISCUITY" },
- { 0, NULL }
-};
-
-static const value_string service_kind_vals[] = {
- { 0x00000000, "NO_SERVICE_QOS" },
- { 0x00000001, "PERSISTENCE_SERVICE_QOS" },
- { 0, NULL }
-};
-
-static const value_string participant_message_data_kind [] = {
- { PARTICIPANT_MESSAGE_DATA_KIND_UNKNOWN, "PARTICIPANT_MESSAGE_DATA_KIND_UNKNOWN" },
- { PARTICIPANT_MESSAGE_DATA_KIND_AUTOMATIC_LIVELINESS_UPDATE, "PARTICIPANT_MESSAGE_DATA_KIND_AUTOMATIC_LIVELINESS_UPDATE" },
- { PARTICIPANT_MESSAGE_DATA_KIND_MANUAL_LIVELINESS_UPDATE, "PARTICIPANT_MESSAGE_DATA_KIND_MANUAL_LIVELINESS_UPDATE" },
- { 0, NULL }
-};
-
-
-
-/* Flag Decoding defintions ***********************************************/
-struct Flag_definition {
- const char letter;
- const char *description;
-};
-
-#define RESERVEDFLAG_CHAR ('_')
-#define RESERVEDFLAG_STRING ("reserved bit")
-
-static const struct Flag_definition DATA_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { 'I', "Status info flag" }, /* Bit 4 */
- { 'H', "Hash key flag" }, /* Bit 3 */
- { 'D', "Data present" }, /* Bit 2 */
- { 'Q', "Inline QoS" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition NOKEY_DATA_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { 'H', "Key Hash" }, /* Bit 2 */
- { 'Q', "Inline QoS" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition ACKNACK_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { 'F', "Final flag" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition GAP_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition HEARTBEAT_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { 'L', "Liveliness flag" }, /* Bit 2 */
- { 'F', "Final flag" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition HEARTBEAT_BATCH_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { 'L', "Liveliness flag" }, /* Bit 2 */
- { 'F', "Final flag" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition INFO_TS_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { 'I', "Invalidate flag" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition INFO_SRC_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition INFO_REPLY_IP4_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { 'M', "Multicast flag" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition INFO_DST_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition INFO_REPLY_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { 'M', "Multicast flag" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition NOKEY_DATA_FRAG_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { 'Q', "Inline QoS" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition HEARTBEAT_FRAG_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition NACK_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { 'F', "Final flag" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition DATA_FRAG_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { 'H', "Hash key flag" }, /* Bit 2 */
- { 'Q', "Inline QoS" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition NACK_FRAG_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition RTPS_DATA_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { 'K', "Serialized Key" }, /* Bit 3 */
- { 'D', "Data present" }, /* Bit 2 */
- { 'Q', "Inline QoS" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition RTPS_DATA_FRAG_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { 'K', "Serialized Key" }, /* Bit 2 */
- { 'Q', "Inline QoS" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition RTPS_DATA_BATCH_FLAGS[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 5 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 4 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 3 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 2 */
- { 'Q', "Inline QoS" }, /* Bit 1 */
- { 'E', "Endianness bit" } /* Bit 0 */
-};
-
-static const struct Flag_definition RTPS_SAMPLE_INFO_FLAGS16[] = {
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 15 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 14 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 13 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 12 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 11 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 10 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 9 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 8 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 7 */
- { RESERVEDFLAG_CHAR, RESERVEDFLAG_STRING }, /* Bit 6 */
- { 'K', "Serialized Key" }, /* Bit 5 */
- { 'I', "Invalid sample" }, /* Bit 4 */
- { 'D', "Data present" }, /* Bit 3 */
- { 'O', "OffsetSN present" }, /* Bit 2 */
- { 'Q', "Inline QoS" }, /* Bit 1 */
- { 'T', "Timestamp present" } /* Bit 0 */
-};
-
-
-/***************************************************************************/
-
-
-
-
-
-/***************************************************************************
- * Function prototypes
- * ~~~~~~~~~~~~~~~~~~~
- */
-
-/* Utility to add elements to the protocol tree */
-static void rtps_util_add_guid_prefix(proto_tree *, tvbuff_t *,
- gint, int, int, int, int, const guint8 *,
- guint8 *, gint);
-static void rtps_util_add_generic_guid(proto_tree *, tvbuff_t *,
- gint, const char *, guint8 *, gint);
-static guint16 rtps_util_add_short(proto_tree *, tvbuff_t *,
- gint, int, int, gboolean, gboolean, const char *,
- guint8 *, gint);
-static int rtps_util_add_bitmap(proto_tree *, tvbuff_t *,
- gint, int, const char *);
-static int rtps_util_add_fragment_number_set(proto_tree *, tvbuff_t *,
- gint, int, const char *, gint);
-static void rtps_util_add_extra_flags(proto_tree *, tvbuff_t *,
- gint, const char *);
-
-/* The data (payload) dissector */
-static void dissect_octet_seq(proto_tree *, tvbuff_t *,
- gint, const char *);
-
-/* The data (payload) dissector for parameter sequences */
-static gint dissect_parameter_sequence(proto_tree *, packet_info *pinfo, tvbuff_t *,
- gint, int, int, const char *, guint32 *, guint16 vendor_id);
-
-
-/***************************************************************************/
-/* Inline macros */
-/***************************************************************************/
-#define NEXT_guint16(tvb, offset, le) \
- (le ? tvb_get_letohs(tvb, offset) : tvb_get_ntohs(tvb, offset))
-
-#define NEXT_guint32(tvb, offset, le) \
- (le ? tvb_get_letohl(tvb, offset) : tvb_get_ntohl(tvb, offset))
-
-
-/***************************************************************************/
-/* Global variables controlled by Wireshark preference panel */
-/***************************************************************************/
-static guint rtps_max_batch_samples_dissected = 16;
-
-/* *********************************************************************** */
-/* Appends extra formatting for those submessages that have a status info
- */
-static void info_summary_append_ex(packet_info *pinfo,
- guint32 writer_id,
- guint32 status_info) {
-
- /* Defines the extra information associated to the writer involved in
- * this communication
- *
- * Format: [?Ptwrpm]\(u?d?\)
- *
- * First letter table:
- *
- * writerEntityId value | Letter
- * ---------------------------------------------------+--------------
- * ENTITYID_UNKNOWN | ?
- * ENTITYID_PARTICIPANT | P
- * ENTITYID_SEDP_BUILTIN_TOPIC_WRITER | t
- * ENTITYID_SEDP_BUILTIN_PUBLICATIONS_WRITER | w
- * ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_WRITER | r
- * ENTITYID_SPDP_BUILTIN_PARTICIPANT_WRITER | p
- * ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER | m
- *
- * The letter is followed by:
- * status_info &1 | status_info & 2 | Text
- * ---------------+-----------------------+--------------
- * status_info not defined in inlineQos | [?]
- * 0 | 0 | [__]
- * 0 | 1 | [u_]
- * 1 | 0 | [_d]
- * 1 | 1 | [ud]
- */
- /* 0123456 */
- char buffer[10] = "(?[??])";
-
- switch(writer_id)
- {
- case ENTITYID_PARTICIPANT:
- buffer[1] = 'P';
- break;
- case ENTITYID_SEDP_BUILTIN_TOPIC_WRITER:
- buffer[1] = 't';
- break;
- case ENTITYID_SEDP_BUILTIN_PUBLICATIONS_WRITER:
- buffer[1] = 'w';
- break;
- case ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_WRITER:
- buffer[1] = 'r';
- break;
- case ENTITYID_SPDP_BUILTIN_PARTICIPANT_WRITER:
- buffer[1] = 'p';
- break;
- case ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER:
- buffer[1] = 'm';
- break;
- default:
- /* Unknown writer ID, don't format anything */
- return;
- }
-
- switch(status_info) {
- case 0: buffer[3] = '_'; buffer[4] = '_'; break;
- case 1: buffer[3] = '_'; buffer[4] = 'D'; break;
- case 2: buffer[3] = 'U'; buffer[4] = '_'; break;
- case 3: buffer[3] = 'U'; buffer[4] = 'D'; break;
- default: /* Unknown status info, omit it */
- buffer[2] = ')';
- buffer[3] = '\0';
- }
- col_append_str(pinfo->cinfo, COL_INFO, buffer);
-}
-
-
-
-
-/* !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
- * NOTE:
- * In general those utility functions (they all starts with 'rtps_util')
- * are used to dissect some part of a submessage.
- * They take as first parameter the proto_tree.
- * Now, the proto_tree can be NULL if the dissector is invoked without
- * a packet tree.
- * Sometimes those functions they also return some value (as result of
- * the dissecting).
- * At the price of optimizing the code, each function MUST tollerate
- * a NULl tree.
- * !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
- */
-
-
-
-/* *********************************************************************** */
-static void rtps_util_add_extra_flags(proto_tree *tree,
- tvbuff_t *tvb,
- gint offset,
- const char *label) {
- if (tree) {
- guint16 flags = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
- emem_strbuf_t *temp_buffer = ep_strbuf_new_label(NULL);
- int i;
- for (i = 0; i < 16; ++i) {
- ep_strbuf_append_c(temp_buffer, ((flags & (1 << (15-i))) != 0) ? '1' : '0');
- }
-
- proto_tree_add_text(tree,
- tvb,
- offset,
- 2,
- "%s: %s",
- label,
- temp_buffer->str);
- }
-}
-
-
-/* ------------------------------------------------------------------------- */
-/* Insert in the protocol tree the next 12 bytes interpreted as GuidPrefix
- * If tree is specified, it fills up the protocol tree item:
- * - hf_rtps_guid_prefix
- * - hf_rtps_host_id
- * - hf_rtps_app_id
- * - hf_rtps_counter
- *
- * If buffer is specified, it returns in it a string representation of the
- * data read.
- */
-static void rtps_util_add_guid_prefix(proto_tree *tree,
- tvbuff_t * tvb,
- gint offset,
- int hf_prefix, /* Cannot be 0 if tree != NULL */
- int hf_host_id,
- int hf_app_id,
- int hf_counter,
- const guint8 * label, /* Can be NULL */
- guint8 * buffer, /* Can be NULL */
- gint buffer_size) {
- guint32 host_id;
- guint32 app_id;
- guint32 counter;
- guint8 * temp_buff;
- guint8 guid_prefix[12];
- const guint8 * safe_label;
- int i;
-
- safe_label = (label == NULL) ? (const guint8 *)"guidPrefix" : label;
-
- /* Read values from TVB */
- host_id = tvb_get_ntohl(tvb, offset);
- app_id = tvb_get_ntohl(tvb, offset + 4);
- counter = tvb_get_ntohl(tvb, offset + 8);
- for (i = 0; i < 12; ++i) {
- guid_prefix[i] = tvb_get_guint8(tvb, offset+i);
- }
-
- /* Format the string */
- temp_buff = (guint8 *) ep_alloc(MAX_GUID_PREFIX_SIZE);
- g_snprintf(temp_buff, MAX_GUID_PREFIX_SIZE,
- "%s=%02x%02x%02x%02x:%02x%02x%02x%02x:%02x%02x%02x%02x"
- " { hostId=%08x, appId=%08x, counter=%08x }",
- safe_label,
- guid_prefix[0],
- guid_prefix[1],
- guid_prefix[2],
- guid_prefix[3],
- guid_prefix[4],
- guid_prefix[5],
- guid_prefix[6],
- guid_prefix[7],
- guid_prefix[8],
- guid_prefix[9],
- guid_prefix[10],
- guid_prefix[11],
- host_id,
- app_id,
- counter);
-
- if (tree) {
- proto_item * ti, *hidden_item;
- proto_tree * guid_tree;
-
- /* The numeric value (used for searches) */
- hidden_item = proto_tree_add_item(tree,
- hf_prefix,
- tvb,
- offset,
- 12,
- ENC_NA);
- PROTO_ITEM_SET_HIDDEN(hidden_item);
-
- /* The text node (root of the guid prefix sub-tree) */
- ti = proto_tree_add_text(tree,
- tvb,
- offset,
- 12,
- "%s",
- temp_buff);
-
- guid_tree = proto_item_add_subtree(ti,
- ett_rtps_guid_prefix);
-
- /* Host Id */
- proto_tree_add_item(guid_tree,
- hf_host_id,
- tvb,
- offset,
- 4,
- ENC_BIG_ENDIAN);
-
- /* App Id */
- proto_tree_add_item(guid_tree,
- hf_app_id,
- tvb,
- offset+4,
- 4,
- ENC_BIG_ENDIAN);
-
- /* Counter */
- proto_tree_add_item(guid_tree,
- hf_counter,
- tvb,
- offset+8,
- 4,
- ENC_BIG_ENDIAN);
- }
-
- if (buffer != NULL) {
- g_strlcpy(buffer, temp_buff, buffer_size);
- }
-}
-
-/* ------------------------------------------------------------------------- */
- /* Interpret the next 16 octets as a generic GUID and insert it in the protocol
- * tree as simple text (no reference fields are set).
- * It is mostly used in situation where is not required to perform search for
- * this kind of GUID (i.e. like in some DATA parameter lists).
- */
-static void rtps_util_add_generic_guid(proto_tree *tree,
- tvbuff_t * tvb, /* Cannot be NULL */
- gint offset,
- const char *label, /* Cannot be NULL */
- guint8 * buffer, /* Can be NULL */
- gint buffer_size) {
-
- guint32 host_id;
- guint32 app_id;
- guint32 entity_id;
- guint32 entity_key;
- guint32 counter;
- guint8 entity_kind;
- guint8 guid_raw[16];
- const char * str_entity_kind;
- guint8 temp_buff[MAX_GUID_SIZE];
- int i;
-
- /* Read typed data */
- host_id = tvb_get_ntohl(tvb, offset);
- app_id = tvb_get_ntohl(tvb, offset + 4);
- counter = tvb_get_ntohl(tvb, offset + 8);
- entity_id = tvb_get_ntohl(tvb, offset + 12);
-
- /* Re-Read raw data */
- for (i = 0; i < 16; ++i) {
- guid_raw[i] = tvb_get_guint8(tvb, offset+i);
- }
-
- /* Split components from typed data */
- entity_key = (entity_id >> 8);
- entity_kind = (entity_id & 0xff);
-
- /* Lookup for predefined app kind and entity kind */
- str_entity_kind = val_to_str(entity_kind, entity_kind_vals, "%02x");
-
- /* Compose output buffer for raw guid */
- g_snprintf(temp_buff, MAX_GUID_SIZE,
- "%s=%02x%02x%02x%02x %02x%02x%02x%02x %02x%02x%02x%02x %02x%02x%02x%02x: "
- "{ hostId=%08x, appId=%08x, counter=%08x, entityId=%08x (%s: %06x) }",
- label,
- guid_raw[0], guid_raw[1], guid_raw[2], guid_raw[3],
- guid_raw[4], guid_raw[5], guid_raw[6], guid_raw[7],
- guid_raw[8], guid_raw[9], guid_raw[10], guid_raw[11],
- guid_raw[12], guid_raw[13], guid_raw[14], guid_raw[15],
- host_id,
- app_id,
- counter,
- entity_id, str_entity_kind, entity_key);
- if (tree) {
- proto_tree_add_text(tree, tvb, offset, 16, "%s", temp_buff);
- }
- if (buffer != NULL) {
- g_strlcpy(buffer, temp_buff, buffer_size);
- }
-}
-
-
-/* ------------------------------------------------------------------------- */
-/* Insert in the protocol tree the next data interpreted as a 16-bit short
- */
-static guint16 rtps_util_add_short(proto_tree *tree,
- tvbuff_t * tvb,
- gint offset,
- int hf_item, /* Can be -1 */
- gboolean little_endian,
- gboolean is_hex, /* Format as 0x... */
- gboolean is_signed, /* Signed/Unsigned */
- const char *label, /* Can be NULL */
- guint8 * buffer,
- gint buffer_size) {
-
- char temp_buff[16];
- guint16 retVal = NEXT_guint16(tvb, offset, little_endian);
- g_snprintf(temp_buff, 16,
- (is_hex ? "0x%04x" : (is_signed ? "%d" : "%u")),
- retVal);
- if (tree != NULL) {
- if (hf_item != -1) {
- proto_tree_add_item(tree,
- hf_item,
- tvb,
- offset,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- } else if (label != NULL) {
- proto_tree_add_text(tree,
- tvb,
- offset,
- 2,
- "%s: %s",
- label,
- temp_buff);
- }
- }
- if (buffer != NULL) {
- g_strlcpy(buffer, temp_buff, buffer_size);
- }
- return retVal;
-}
-
-/* ------------------------------------------------------------------------- */
-/* Insert in the protocol tree the next data interpreted as a signed long.
- */
-static guint32 rtps_util_add_long(proto_tree *tree, /* Can be NULL */
- tvbuff_t * tvb,
- gint offset,
- int hf_item, /* Can be -1 */
- gboolean little_endian,
- gboolean is_hex, /* Format as 0x... */
- gboolean is_signed, /* Signed/Unsigned */
- const char *label, /* Can be NULL */
- guint8 * buffer,
- size_t buffer_size) {
-
- char temp_buff[16];
- guint32 retVal = NEXT_guint32(tvb, offset, little_endian);
-
- g_snprintf(temp_buff, 16,
- (is_hex ? "0x%08x" : (is_signed ? "%d" : "%u")), retVal);
-
- if (tree != NULL) {
- if (hf_item != -1) {
- proto_tree_add_item(tree,
- hf_item,
- tvb,
- offset,
- 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- } else if (label != NULL) {
- proto_tree_add_text(tree,
- tvb,
- offset,
- 4,
- "%s: %s",
- label,
- temp_buff);
- }
- }
- if (buffer != NULL) {
- g_strlcpy(buffer, temp_buff, (gulong) buffer_size);
- }
-
- return retVal;
-}
-
-
-#define LONG_ALIGN(x) (x = (x+3)&0xfffffffc)
-#define SHORT_ALIGN(x) (x = (x+1)&0xfffffffe)
-#define MAX_ARRAY_DIMENSION 10
-#define KEY_COMMENT (" //@key")
-
-/* ------------------------------------------------------------------------- */
-static const char * rtps_util_typecode_id_to_string(guint32 typecode_id) {
- switch(typecode_id) {
- case RTI_CDR_TK_ENUM: return "enum";
- case RTI_CDR_TK_UNION: return "union";
- case RTI_CDR_TK_STRUCT: return "struct";
- case RTI_CDR_TK_LONG: return "long";
- case RTI_CDR_TK_SHORT: return "short";
- case RTI_CDR_TK_USHORT: return "unsigned short";
- case RTI_CDR_TK_ULONG: return "unsigned long";
- case RTI_CDR_TK_FLOAT: return "float";
- case RTI_CDR_TK_DOUBLE: return "double";
- case RTI_CDR_TK_BOOLEAN:return "boolean";
- case RTI_CDR_TK_CHAR: return "char";
- case RTI_CDR_TK_OCTET: return "octet";
- case RTI_CDR_TK_LONGLONG:return "longlong";
- case RTI_CDR_TK_ULONGLONG: return "unsigned long long";
- case RTI_CDR_TK_LONGDOUBLE: return "long double";
- case RTI_CDR_TK_WCHAR: return "wchar";
- case RTI_CDR_TK_WSTRING:return "wstring";
- case RTI_CDR_TK_STRING: return "string";
- case RTI_CDR_TK_SEQUENCE: return "sequence";
- case RTI_CDR_TK_ARRAY: return "array";
- case RTI_CDR_TK_ALIAS: return "alias";
- case RTI_CDR_TK_VALUE: return "valuetype";
-
- case RTI_CDR_TK_NULL:
- default:
- return "<unknown type>";
- }
-}
-
-/* ------------------------------------------------------------------------- */
-/* Insert in the protocol tree the next bytes interpreted as typecode info
- * Returns the number of bytes parsed
- */
-static gint rtps_util_add_typecode(proto_tree *tree,
- tvbuff_t * tvb,
- gint offset,
- gboolean little_endian,
- int indent_level,
- int is_pointer,
- guint16 bitfield,
- int is_key,
- const gint offset_begin,
- char * name,
- int seq_max_len, /* 0 = not a sequence field (-1 = unbounded seq) */
- guint32 * arr_dimension, /* if !NULL: array of 10 int */
- int ndds_40_hack) {
- const gint original_offset = offset;
- guint32 tk_id;
- guint16 tk_size;
- unsigned int i;
- char* indent_string;
- gint retVal;
- char type_name[40];
-
- /* Structure of the typecode data:
- * Offset | Size | Field | Notes
- * ----------|-------|------------------------------|---------------------
- * ? | ? | pad? |
- * 0 | 4 | RTI_CDR_TK_XXXXX | 4 bytes aligned
- * 4 | 2 | length the struct |
- */
-
- /* Calc indent string */
- indent_string = (char *)ep_alloc((indent_level*2)+1);
- memset(indent_string, ' ', indent_level*2);
- indent_string[indent_level*2] = '\0';
-
- /* Gets TK ID */
- LONG_ALIGN(offset);
- tk_id = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- /* Gets TK size */
- tk_size = NEXT_guint16(tvb, offset, little_endian);
- offset += 2;
-
- retVal = tk_size + 6; /* 6 = 4 (typecode ID) + 2 (size) */
-
- /* The first bit of typecode is set to 1, clear it */
- tk_id &= 0x7fffffff;
-
- /* HACK: NDDS 4.0 and NDDS 4.1 has different typecode ID list.
- * The ID listed in the RTI_CDR_TK_XXXXX are the one from NDDS 4.1
- * In order to correctly dissect NDDS 4.0 packets containing typecode
- * information, we check if the ID of the element at level zero is a
- * struct or union. If not, it means we are dissecting a ndds 4.0 packet
- * (and we can decrement the ID to match the correct values).
- */
- if (indent_level == 0) {
- if (tk_id == RTI_CDR_TK_OCTET) {
- ndds_40_hack = 1;
- }
- }
- if (ndds_40_hack) {
- ++tk_id;
- }
-
- g_strlcpy(type_name, rtps_util_typecode_id_to_string(tk_id), 40);
-
- /* Structure of the typecode data:
- *
- * <type_code_header> ::=
- * <kind>
- * <type_code_length>
- *
- * <kind> ::= long (0=TK_NULL, 1=TK_SHORT...)
- * <type_code_length> ::= unsugned short
- *
- */
- switch(tk_id) {
-
- /* Structure of the typecode data:
- *
- * <union_type_code> ::=
- * <type_code_header>
- * <name>
- * <default_index>
- * <discriminator_type_code>
- * <member_count>
- * <union_member>+
- * <union_member> ::= <member_length><name><union_member_detail>
- * <member_length> ::= unsigned short
- * <name> ::= <string>
- * <string> ::= <length>char+<eol>
- * <length> ::= unsigned long
- * <eol> ::= (char)0
- *
- * <union_member_detail> ::= <is_pointer>
- * <labels_count>
- * <label>+
- * <type_code>
- * <labels_count> ::= unsigned long
- * <label> ::= long
- *
- */
- case RTI_CDR_TK_UNION: {
- guint32 struct_name_len;
- gint8 * struct_name;
- const char * discriminator_name = "<unknown>"; /* for unions */
- char * discriminator_enum_name = NULL; /* for unions with enum discriminator */
- /*guint32 defaultIdx;*/ /* Currently is ignored */
- guint32 disc_id; /* Used temporarily to populate 'discriminator_name' */
- guint16 disc_size; /* Currently is ignored */
- guint32 disc_offset_begin;
- guint32 num_members;
- guint16 member_length;
- guint32 member_name_len;
- guint8 *member_name = NULL;
- guint8 member_is_pointer;
- guint32 next_offset;
- guint32 field_offset_begin;
- guint32 member_label_count;
- gint32 member_label;
- guint32 discriminator_enum_name_length;
- guint j;
-
- /* - - - - - - - Union name - - - - - - - */
- /* Pad-align */
- LONG_ALIGN(offset);
-
- /* Get structure name length */
- struct_name_len = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
- struct_name = tvb_get_ephemeral_string(tvb, offset, struct_name_len);
- offset += struct_name_len;
-
- /* - - - - - - - Default index - - - - - - - */
- LONG_ALIGN(offset);
- /*defaultIdx = NEXT_guint32(tvb, offset, little_endian);*/
- offset += 4;
-
- /* - - - - - - - Discriminator type code - - - - - - - */
- /* We don't recursively dissect everything, instead we just read the type */
- disc_id = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- disc_size = NEXT_guint16(tvb, offset, little_endian);
- offset += 2;
- disc_offset_begin = offset;
- disc_id &= 0x7fffffff;
- discriminator_name = rtps_util_typecode_id_to_string(disc_id);
- if (disc_id == RTI_CDR_TK_ENUM) {
- /* Enums has also a name that we should print */
- LONG_ALIGN(offset);
- discriminator_enum_name_length = NEXT_guint32(tvb, offset, little_endian);
- discriminator_enum_name = tvb_get_ephemeral_string(tvb, offset+4, discriminator_enum_name_length);
- }
- offset = disc_offset_begin + disc_size;
-/*
- field_offset_begin = offset;
- offset += rtps_util_add_typecode(
- tree,
- tvb, next_offset = offset;
-
- offset,
- little_endian,
- indent_level+1,
- 0,
- 0,
- 0,
- field_offset_begin,
- member_name,
- 0,
- NULL,
- ndds_40_hack);
-*/
-
-
- /* Add the entry of the union in the tree */
- proto_tree_add_text(tree,
- tvb,
- original_offset,
- retVal,
- "%sunion %s (%s%s%s) {",
- indent_string,
- struct_name,
- discriminator_name,
- (discriminator_enum_name ? " " : ""),
- (discriminator_enum_name ? discriminator_enum_name : ""));
-
- if (seq_max_len != 0) {
- /* We're dissecting a sequence of struct, bypass the seq definition */
- g_snprintf(type_name, 40, "%s", struct_name);
- break;
- }
-
- /* - - - - - - - Number of members - - - - - - - */
- LONG_ALIGN(offset);
- num_members = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- /* - - - - - - - <union_member>+ - - - - - - - */
- next_offset = offset;
-
- for (i = 0; i < num_members; ++i) {
- /* Safety: this theoretically should be the same already */
- field_offset_begin = offset = next_offset;
-
- SHORT_ALIGN(offset);
-
- /* member's length */
- member_length = NEXT_guint16(tvb, offset, little_endian);
- offset += 2;
- next_offset = offset + member_length;
-
- /* Name length */
- LONG_ALIGN(offset);
- member_name_len = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- /* Name */
- member_name = tvb_get_ephemeral_string(tvb, offset, member_name_len);
- offset += member_name_len;
-
- /* is Pointer ? */
- member_is_pointer = tvb_get_guint8(tvb, offset);
- offset++;
-
- /* Label count */
- LONG_ALIGN(offset);
- member_label_count = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- for (j = 0; j < member_label_count; ++j) {
- /* Label count */
- LONG_ALIGN(offset);
- member_label = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- /* Add the entry of the union in the tree */
- proto_tree_add_text(tree,
- tvb,
- field_offset_begin,
- retVal,
- "%s case %d:",
- indent_string,
- member_label);
- }
-
- offset += rtps_util_add_typecode(
- tree,
- tvb,
- offset,
- little_endian,
- indent_level+2,
- member_is_pointer,
- 0,
- 0,
- field_offset_begin,
- member_name,
- 0,
- NULL,
- ndds_40_hack);
- }
- /* Finally prints the name of the struct (if provided) */
- g_strlcpy(type_name, "}", 40);
- break;
-
- } /* end of case UNION */
-
-
- case RTI_CDR_TK_ENUM:
- case RTI_CDR_TK_STRUCT: {
- /* Structure of the typecode data:
- *
- * <union_type_code> ::=
- * <type_code_header>
- * <name>
- * <default_index>
- * <discriminator_type_code>
- * <member_count>
- * <member>+
- *
- * <struct_type_code> ::=
- * <type_code_header>
- * <name>
- * <member_count>
- * <member>+
- *
- * <name> ::= <string>
- * <string> ::= <length>char+<eol>
- * <length> ::= unsigned long
- * <eol> ::= (char)0
- * <member_count> ::= unsigned long
- *
- * STRUCT / UNION:
- * Foreach member {
- * - A2: 2: member length
- * - A4: 4: member name length
- * - n: member name
- * - 1: isPointer?
- * - A2 2: bitfield bits (-1=none)
- * - 1: isKey?
- * - A4 4: Typecode ID
- * - A2 2: length
- * }
- *
- * ENUM:
- * Foreach member {
- * - A2: 2: member length
- * - A4: 4: member name length
- * - n: member name
- * - A4: 4: ordinal number
- *
- * -> ----------------------------------------------------- <-
- * -> The alignment pad bytes belong to the FOLLOWING field <-
- * -> A4 = 4 bytes alignment, A2 = 2 bytes alignment <-
- * -> ----------------------------------------------------- <-
- */
- guint32 struct_name_len;
- gint8 * struct_name;
- guint32 num_members;
- guint16 member_length;
- guint8 member_is_pointer;
- guint16 member_bitfield;
- guint8 member_is_key;
- guint32 member_name_len;
- guint8 *member_name = NULL;
- guint32 next_offset;
- guint32 field_offset_begin;
- guint32 ordinal_number;
- const char * typecode_name;
-
- /* Pad-align */
- LONG_ALIGN(offset);
-
- /* Get structure name length */
- struct_name_len = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- /* struct name */
- struct_name = tvb_get_ephemeral_string(tvb, offset, struct_name_len);
- offset += struct_name_len;
-
-
- if (tk_id == RTI_CDR_TK_ENUM) {
- typecode_name = "enum";
- } else if (tk_id == RTI_CDR_TK_VALUE_PARARM) {
- /*guint16 type_modifier;*/
- /*guint32 baseTypeCodeKind;*/
- guint32 baseTypeCodeLength;
- /* Need to read the type modifier and the base type code */
- typecode_name = "<sparse type>";
- SHORT_ALIGN(offset);
- /*type_modifier = NEXT_guint16(tvb, offset, little_endian);*/
- offset += 2;
- LONG_ALIGN(offset);
- /*baseTypeCodeKind = NEXT_guint32(tvb, offset, little_endian);*/
- offset += 4;
- baseTypeCodeLength = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
- offset += baseTypeCodeLength;
- } else {
- typecode_name = "struct";
- }
-
- if (seq_max_len != 0) {
- /* We're dissecting a sequence of struct, bypass the seq definition */
- g_snprintf(type_name, 40, "%s", struct_name);
- break;
- }
- /* Prints the typecode header */
- proto_tree_add_text(tree,
- tvb,
- original_offset,
- retVal,
- "%s%s %s {",
- indent_string,
- typecode_name,
- struct_name);
-
- /* PAD align */
- LONG_ALIGN(offset);
-
- /* number of members */
- num_members = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- next_offset = offset;
- for (i = 0; i < num_members; ++i) {
- /* Safety: this theoretically should be the same already */
- field_offset_begin = offset = next_offset;
-
- SHORT_ALIGN(offset);
-
- /* member's length */
- member_length = NEXT_guint16(tvb, offset, little_endian);
- offset += 2;
- next_offset = offset + member_length;
-
- /* Name length */
- LONG_ALIGN(offset);
- member_name_len = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- /* Name */
- member_name = tvb_get_ephemeral_string(tvb, offset, member_name_len);
- offset += member_name_len;
-
- if (tk_id == RTI_CDR_TK_ENUM) {
- /* ordinal number */
- LONG_ALIGN(offset);
- ordinal_number = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- proto_tree_add_text(tree,
- tvb,
- field_offset_begin,
- (offset-field_offset_begin),
- "%s %s = %d;",
- indent_string,
- member_name,
- ordinal_number);
- } else {
- /* Structs */
-
- /* is Pointer ? */
- member_is_pointer = tvb_get_guint8(tvb, offset);
- offset++;
-
- /* Bitfield */
- SHORT_ALIGN(offset);
- member_bitfield = NEXT_guint16(tvb, offset, little_endian);
- offset += 2; /* pad will be added by typecode dissector */
-
- /* is Key ? */
- member_is_key = tvb_get_guint8(tvb, offset);
- offset++;
-
- offset += rtps_util_add_typecode(
- tree,
- tvb,
- offset,
- little_endian,
- indent_level+1,
- member_is_pointer,
- member_bitfield,
- member_is_key,
- field_offset_begin,
- member_name,
- 0,
- NULL,
- ndds_40_hack);
- }
- }
- /* Finally prints the name of the struct (if provided) */
- g_strlcpy(type_name, "}", 40);
- break;
- }
-
- case RTI_CDR_TK_WSTRING:
- case RTI_CDR_TK_STRING: {
- /* Structure of the typecode data:
- * Offset | Size | Field | Notes
- * ----------|-------|------------------------------|---------------------
- * 6 | 2 | pad |
- * 8 | 4 | String length | 4-bytes aligned
- */
- guint32 string_length;
-
- LONG_ALIGN(offset);
- string_length = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
- g_snprintf(type_name, 40, "%s<%d>",
- (tk_id == RTI_CDR_TK_STRING) ? "string" : "wstring",
- string_length);
- break;
- }
-
- case RTI_CDR_TK_SEQUENCE: {
- /* Structure of the typecode data:
- *
- * - A4: 4: Sequence max length
- * - the sequence typecode
- */
- guint32 seq_max_len2;
- LONG_ALIGN(offset);
- seq_max_len2 = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- /* Recursive decode seq typecode */
- /*offset += */rtps_util_add_typecode(
- tree,
- tvb,
- offset,
- little_endian,
- indent_level,
- is_pointer,
- bitfield,
- is_key,
- offset_begin,
- name,
- seq_max_len2,
- NULL,
- ndds_40_hack);
- /* Differently from the other typecodes, the line has been already printed */
- return retVal;
- }
-
- case RTI_CDR_TK_ARRAY: {
- /* Structure of the typecode data:
- *
- * - A4: 4: number of dimensions
- * - A4: 4: dim1
- * - <A4: 4: dim2>
- * - ...
- * - the array typecode
- */
- guint32 size[MAX_ARRAY_DIMENSION]; /* Max dimensions */
- guint32 dim_max;
-
- LONG_ALIGN(offset);
- dim_max = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- for (i = 0; i < MAX_ARRAY_DIMENSION; ++i) size[i] = 0;
- for (i = 0; i < dim_max; ++i) {
- size[i] = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
- }
-
- /* Recursive decode seq typecode */
- /*offset += */rtps_util_add_typecode(
- tree,
- tvb,
- offset,
- little_endian,
- indent_level,
- is_pointer,
- bitfield,
- is_key,
- offset_begin,
- name,
- 0,
- size,
- ndds_40_hack);
- /* Differently from the other typecodes, the line has been already printed */
- return retVal;
- }
-
- case RTI_CDR_TK_ALIAS: {
- /* Structure of the typecode data:
- *
- * - A4: 4: alias name size
- * - A4: 4: alias name
- * - A4: 4: the alias typecode
- */
- guint32 alias_name_length;
- guint8 *alias_name;
-
- LONG_ALIGN(offset);
- alias_name_length = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
- alias_name = tvb_get_ephemeral_string(tvb, offset, alias_name_length);
- offset += alias_name_length;
- g_strlcpy(type_name, alias_name, 40);
- break;
- }
-
-
- /*
- * VALUETYPES:
- * - A4: 4: name length
- * - n: name
- * - A2: type modifier
- * - A4: base type code
- * - A4: number of members
- * Foreach member: (it's just like a struct)
- *
- */
- case RTI_CDR_TK_VALUE_PARARM:
- case RTI_CDR_TK_VALUE: {
- /* Not fully dissected for now */
- /* Pad-align */
- guint32 value_name_len;
- gint8 * value_name;
- const char * type_id_name = "valuetype";
- LONG_ALIGN(offset);
-
- /* Get structure name length */
- value_name_len = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
-
- /* value name */
- value_name = tvb_get_ephemeral_string(tvb, offset, value_name_len);
- offset += value_name_len;
-
- if (tk_id == RTI_CDR_TK_VALUE_PARARM) {
- type_id_name = "valueparam";
- }
- g_snprintf(type_name, 40, "%s '%s'", type_id_name, value_name);
- break;
- }
- } /* switch(tk_id) */
-
- /* Sequence print */
- if (seq_max_len != 0) {
- proto_tree_add_text(tree,
- tvb,
- offset_begin,
- (offset-offset_begin),
- "%ssequence<%s, %d> %s%s;%s",
- indent_string,
- type_name,
- seq_max_len,
- is_pointer ? "*" : "",
- name ? name : "",
- is_key ? KEY_COMMENT : "");
- return retVal;
- }
-
- /* Array print */
- if (arr_dimension != NULL) {
- /* Printing an array */
- emem_strbuf_t *dim_str = ep_strbuf_new_label("");
- for (i = 0; i < MAX_ARRAY_DIMENSION; ++i) {
- if (arr_dimension[i] != 0) {
- ep_strbuf_append_printf(dim_str, "[%d]", arr_dimension[i]);
- } else {
- break;
- }
- }
- proto_tree_add_text(tree,
- tvb,
- offset_begin,
- (offset-offset_begin),
- "%s%s %s%s;%s",
- indent_string,
- type_name,
- name ? name : "",
- dim_str->str,
- is_key ? KEY_COMMENT : "");
- return retVal;
- }
-
- /* Bitfield print */
- if (bitfield != 0xffff && name != NULL && is_pointer == 0) {
- proto_tree_add_text(tree,
- tvb,
- offset_begin,
- (offset-offset_begin),
- "%s%s %s:%d;%s",
- indent_string,
- type_name,
- name ? name : "",
- bitfield,
- is_key ? KEY_COMMENT : "");
- return retVal;
- }
-
- /* Everything else */
- proto_tree_add_text(tree,
- tvb,
- offset_begin,
- (offset-offset_begin),
- "%s%s%s%s%s;%s",
- indent_string,
- type_name,
- name ? " " : "",
- is_pointer ? "*" : "",
- name ? name : "",
- is_key ? KEY_COMMENT : "");
- return retVal;
-}
-
-/* ------------------------------------------------------------------------- */
-/* Insert in the protocol tree the next bytes interpreted as a Bitmap
- * struct {
- * SequenceNumber_t bitmapBase;
- * sequence<long, 8> bitmap;
- * } SequenceNumberSet;
- *
- * Returns the new offset after reading the bitmap.
- */
-static int rtps_util_add_bitmap(proto_tree *tree,
- tvbuff_t * tvb,
- gint offset,
- gboolean little_endian,
- const char *label _U_) {
- guint64 seq_base;
- gint32 num_bits;
- guint32 data;
- emem_strbuf_t *temp_buff = ep_strbuf_new_label(NULL);
- gchar *last_one;
- int i, j, idx;
- proto_item * ti;
- proto_tree * bitmap_tree;
- const gint original_offset = offset;
- guint32 datamask;
-
- /* Bitmap base sequence number */
- seq_base = rtps_util_add_seq_number(NULL,
- tvb,
- offset,
- little_endian,
- NULL);
- offset += 8;
-
- /* Reads the bitmap size */
- num_bits = NEXT_guint32(tvb, offset, little_endian);
-
- offset += 4;
-
- /* Reads the bits (and format the print buffer) */
- idx = 0;
- for (i = 0; i < num_bits; i += 32) {
- data = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
- for (j = 0; j < 32; ++j) {
- datamask = (1 << (31-j));
- ep_strbuf_append_c(temp_buff, ((data & datamask) == datamask) ? '1':'0');
- ++idx;
- if (idx >= num_bits || temp_buff->len >= ITEM_LABEL_LENGTH - 1) {
- break;
- }
- }
- }
-
- /* removes all the ending '0' */
- last_one = strrchr(temp_buff->str, '1');
- if (last_one) {
- ep_strbuf_truncate(temp_buff, (gsize) (last_one - temp_buff->str));
- }
-
- if (tree) {
- ti = proto_tree_add_text(tree,
- tvb,
- original_offset,
- offset-original_offset,
- "%s: %" G_GINT64_MODIFIER "u/%d:%s",
- label,
- seq_base,
- num_bits,
- temp_buff->str);
- bitmap_tree = proto_item_add_subtree(ti, ett_rtps_bitmap);
- proto_tree_add_text(bitmap_tree,
- tvb,
- original_offset,
- 8,
- "bitmapBase: %" G_GINT64_MODIFIER "u",
- seq_base);
- proto_tree_add_text(bitmap_tree,
- tvb,
- original_offset + 8,
- 4,
- "numBits: %u",
- num_bits);
- if (temp_buff->len > 0) {
- proto_tree_add_text(bitmap_tree,
- tvb,
- original_offset + 12,
- offset - original_offset - 12,
- "bitmap: %s",
- temp_buff->str);
- }
- }
- return offset;
-}
-
-/* ------------------------------------------------------------------------- */
-/* Insert in the protocol tree the next bytes interpreted as a FragmentNumberSet
- * typedef unsigned long FragmentNumber_t;
- * struct {
- * FragmentNumber_t bitmapBase;
- * sequence<FragmentNumber_t> bitmap;
- * } FragmentNumberSet;
- *
- * Returns the new offset after reading the bitmap.
- */
-static int rtps_util_add_fragment_number_set(proto_tree *tree,
- tvbuff_t * tvb,
- gint offset,
- gboolean little_endian,
- const char *label _U_,
- gint section_size) {
- guint64 base;
- gint32 num_bits;
- guint32 data;
- emem_strbuf_t *temp_buff = ep_strbuf_new_label(NULL);
- gchar *last_one;
- int i, j, idx;
- proto_item * ti;
- proto_tree * bitmap_tree;
- const gint original_offset = offset;
- guint32 datamask;
- gint expected_size;
- gint base_size;
-
- /* RTI DDS 4.2d was sending the FragmentNumber_t as a 64-bit long integer
- * instead of 32-bit long.
- * Attempt to decode this section as 32-bit, then check if the size of the
- * message match what is here. If not re-decode it as 64-bit.
- */
- num_bits = NEXT_guint32(tvb, offset+4, little_endian);
- expected_size = (((num_bits / 8) + 3) / 4) * 4 + 8;
- if (expected_size == section_size) {
- base = (guint64)NEXT_guint32(tvb, offset, little_endian);
- base_size = 4;
- offset += 8;
- } else {
- /* Attempt to use 64-bit for base */
- num_bits = NEXT_guint32(tvb, offset+8, little_endian);
- /* num_bits/8 must be aligned to the 4-byte word */
- expected_size = (((num_bits / 8) + 3) / 4) * 4 + 12;
- if (expected_size == section_size) {
- guint64 hi = (guint64)NEXT_guint32(tvb, offset, little_endian);
- guint64 lo = (guint64)NEXT_guint32(tvb, offset+4, little_endian);
- base = (hi << 32) | lo;
- base_size = 8;
- offset += 12;
- } else {
- /* size don't match, packet error */
- if (tree) {
- proto_tree_add_text(tree,
- tvb,
- original_offset,
- section_size,
- "Packet malformed: illegal size for fragment number set");
- }
- return -1;
- }
- }
-
- /* Reads the bits (and format the print buffer) */
- idx = 0;
- for (i = 0; i < num_bits; i += 32) {
- data = NEXT_guint32(tvb, offset, little_endian);
- offset += 4;
- for (j = 0; j < 32; ++j) {
- datamask = (1 << (31-j));
- ep_strbuf_append_c(temp_buff, ((data & datamask) == datamask) ? '1':'0');
- ++idx;
- if (idx >= num_bits || temp_buff->len >= ITEM_LABEL_LENGTH - 1) {
- break;
- }
- }
- }
-
- /* removes all the ending '0' */
- last_one = strrchr(temp_buff->str, '1');
- if (last_one) {
- ep_strbuf_truncate(temp_buff, (gsize) (last_one - temp_buff->str));
- }
-
- if (tree) {
- ti = proto_tree_add_text(tree,
- tvb,
- original_offset,
- offset-original_offset,
- "%s: %" G_GINT64_MODIFIER "u/%d:%s",
- label,
- base,
- num_bits,
- temp_buff->str);
- bitmap_tree = proto_item_add_subtree(ti, ett_rtps_bitmap);
- proto_tree_add_text(bitmap_tree,
- tvb,
- original_offset,
- base_size,
- "bitmapBase: %" G_GINT64_MODIFIER "u",
- base);
- proto_tree_add_text(bitmap_tree,
- tvb,
- original_offset + base_size,
- 4,
- "numBits: %u",
- num_bits);
- if (temp_buff->len > 0) {
- proto_tree_add_text(bitmap_tree,
- tvb,
- original_offset + base_size + 4,
- offset - original_offset - base_size - 4,
- "bitmap: %s",
- temp_buff->str);
- }
- }
- return offset;
-}
-
-
-/* ------------------------------------------------------------------------- */
-/* Decode the submessage flags (8 bit version)
- */
-static void rtps_util_decode_flags(proto_tree * tree,
- tvbuff_t *tvb,
- gint offset,
- guint8 flags,
- const struct Flag_definition * flag_def) {
-
- proto_item * ti;
- proto_tree * flags_tree;
- int i, j;
- char flags_str[MAX_FLAG_SIZE];
- if (tree == NULL) {
- return;
- }
-
- flags_str[0] = '\0';
- for (i = 0; i < 8; ++i) {
- g_snprintf(flags_str + (2 * i), MAX_FLAG_SIZE - (2 * i), "%c ",
- ((flags & (1<<(7-i))) ? flag_def[i].letter : RESERVEDFLAG_CHAR));
- }
-
- ti = proto_tree_add_uint_format(tree,
- hf_rtps_sm_flags,
- tvb,
- offset,
- 1,
- flags,
- "Flags: 0x%02x (%s)",
- flags,
- flags_str);
-
- flags_tree = proto_item_add_subtree(ti,
- ett_rtps_flags);
-
- for (i = 0; i < 8; ++i) {
- int is_set = (flags & (1 << (7-i)));
-
- for (j = 0; j < 8; ++j) {
- flags_str[j] = (i == j) ? (is_set ? '1' : '0') : '.';
- }
- flags_str[8] = '\0';
-
- proto_tree_add_text(flags_tree,
- tvb,
- offset,
- 1,
- "%s = %s: %s",
- flags_str,
- flag_def[i].description,
- is_set ? "Set" : "Not set");
- }
-
-}
-
-/* ------------------------------------------------------------------------- */
-/* Decode the submessage flags (16 bit version)
- */
-static void rtps_util_decode_flags_16bit(proto_tree * tree,
- tvbuff_t *tvb,
- gint offset,
- guint16 flags,
- const struct Flag_definition * flag_def) {
-
- proto_item * ti;
- proto_tree * flags_tree;
- int i, j;
- char flags_str[MAX_FLAG_SIZE];
- if (tree == NULL) {
- return;
- }
-
- flags_str[0] = '\0';
- for (i = 0; i < 16; ++i) {
- g_snprintf(flags_str + (2 * i), MAX_FLAG_SIZE - (2 * i), "%c ",
- ((flags & (1<<(15-i))) ? flag_def[i].letter : RESERVEDFLAG_CHAR));
- }
-
- ti = proto_tree_add_uint_format(tree,
- hf_rtps_sm_flags,
- tvb,
- offset,
- 2,
- flags,
- "Flags: 0x%04x (%s)",
- flags,
- flags_str);
-
- flags_tree = proto_item_add_subtree(ti,
- ett_rtps_flags);
-
- for (i = 0; i < 16; ++i) {
- int is_set = (flags & (1 << (15-i)));
-
- for (j = 0; j < 16; ++j) {
- flags_str[j] = (i == j) ? (is_set ? '1' : '0') : '.';
- }
- flags_str[16] = '\0';
-
- proto_tree_add_text(flags_tree,
- tvb,
- offset,
- 2,
- "%s = %s: %s",
- flags_str,
- flag_def[i].description,
- is_set ? "Set" : "Not set");
- }
-}
-
-
-
-/* *********************************************************************** */
-/* * Serialized data dissector * */
-/* *********************************************************************** */
-/* Note: the encapsulation header is ALWAYS big endian, then the encapsulation
- * type specified the type of endianess of the payload.
- */
-static void dissect_serialized_data(proto_tree *tree, packet_info *pinfo, tvbuff_t *tvb, gint offset,
- int size, const char * label, guint16 vendor_id) {
- proto_item * ti;
- proto_tree * rtps_parameter_sequence_tree;
- guint16 encapsulation_id;
- guint16 encapsulation_len;
- gboolean encapsulation_little_endian = FALSE;
-
- /* Creates the sub-tree */
- ti = proto_tree_add_text(tree,
- tvb,
- offset,
- -1,
- "%s:", label);
- rtps_parameter_sequence_tree = proto_item_add_subtree(ti,
- ett_rtps_serialized_data);
-
-
- /* Encapsulation ID */
- encapsulation_id = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
-
- proto_tree_add_text(rtps_parameter_sequence_tree,
- tvb,
- offset,
- 2,
- "encapsulation kind: %s",
- val_to_str(encapsulation_id, encapsulation_id_vals, "unknown (%02x)"));
- offset += 2;
-
- /* Sets the correct values for encapsulation_le */
- if (encapsulation_id == ENCAPSULATION_CDR_LE ||
- encapsulation_id == ENCAPSULATION_PL_CDR_LE) {
- encapsulation_little_endian = TRUE;
- }
-
- /* Encapsulation length (or option) */
- encapsulation_len = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
- proto_tree_add_text(rtps_parameter_sequence_tree,
- tvb,
- offset,
- 2,
- "encapsulation options: %04x",
- encapsulation_len);
- offset += 2;
-
- /* The payload */
- size -= 4;
- switch (encapsulation_id) {
- case ENCAPSULATION_CDR_LE:
- case ENCAPSULATION_CDR_BE:
- proto_tree_add_item(rtps_parameter_sequence_tree,
- hf_rtps_issue_data,
- tvb,
- offset,
- size,
- encapsulation_little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
- case ENCAPSULATION_PL_CDR_LE:
- case ENCAPSULATION_PL_CDR_BE:
- dissect_parameter_sequence(rtps_parameter_sequence_tree, pinfo, tvb, offset,
- encapsulation_little_endian, size, label, NULL, vendor_id);
- break;
-
- default:
- proto_tree_add_text(rtps_parameter_sequence_tree,
- tvb,
- offset,
- size,
- "%s",
- label);
- }
-}
-
-
-/* ***********************************************************************
- * The dissector for octet seq (serialized data)
- * For a sequence of octets, the first word is always the sequence length
- * followed by all the raw bytes.
- */
-static void dissect_octet_seq(proto_tree *tree,
- tvbuff_t *tvb,
- gint offset,
- const char * label) {
- proto_item * ti;
- proto_tree * rtps_parameter_sequence_tree;
- guint32 length;
- if (tree == NULL) {
- return;
- }
-
- /* Creates the sub-tree */
- ti = proto_tree_add_text(tree,
- tvb,
- offset,
- -1,
- "%s:", label);
- rtps_parameter_sequence_tree = proto_item_add_subtree(ti,
- ett_rtps_serialized_data);
-
-
- /* Length */
- length = NEXT_guint32(tvb, offset, FALSE); /* Always big endian */
-
- proto_tree_add_text(rtps_parameter_sequence_tree,
- tvb,
- offset,
- 4,
- "Sequence length: %d", length);
- offset += 4;
-
- /* The payload */
- proto_tree_add_item(rtps_parameter_sequence_tree,
- hf_rtps_issue_data,
- tvb,
- offset,
- length,
- ENC_NA);
-}
-
-
-
-/* *********************************************************************** */
-/* * Parameter Sequence dissector * */
-/* *********************************************************************** */
-/*
- * It returns the new offset representing the point where the parameter
- * sequence terminates.
- * In case of protocol error, it returns 0 (cannot determine the end of
- * the sequence, the caller should be responsible to find the end of the
- * section if possible or pass the error back and abort dissecting the
- * current packet).
- * If no error occurred, the returned value is ALWAYS > than the offset passed.
- *
- * Note: even if tree==NULL, we still have to go through the PID because
- * since RTPS 2.1, the status info is now stored in a PID (and the
- * status info is required to format the INFO column).
- */
-#define ENSURE_LENGTH(size) \
- if (param_length < size) { \
- proto_tree_add_text(rtps_parameter_tree, \
- tvb, offset, param_length, \
- "RTPS PROTOCOL ERROR: parameter value too small"\
- " (must be at least %d octets)", size); \
- break; \
- }
-
-static gint dissect_parameter_sequence(proto_tree *tree,
- packet_info *pinfo,
- tvbuff_t *tvb,
- gint offset,
- gboolean little_endian,
- int size,
- const char * label,
- guint32 *pStatusInfo,
- guint16 vendor_id) {
- proto_item *ti, *param_item;
- proto_tree *rtps_parameter_sequence_tree, *rtps_parameter_tree, *subtree;
- guint16 parameter, param_length;
- guint8 buffer[MAX_PARAM_SIZE];
- gint original_offset = offset;
-
- buffer[0] = '\0';
-
- ti = proto_tree_add_text(tree,
- tvb,
- offset,
- -1,
- "%s:", label);
- rtps_parameter_sequence_tree = proto_item_add_subtree(ti, ett_rtps_parameter_sequence);
-
- /* Loop through all the parameters defined until PID_SENTINEL is found */
- for (;;) {
- size -= offset - original_offset;
- if (size < 4) {
- proto_tree_add_text(tree,
- tvb,
- offset,
- 1,
- "RTPS PROTOCOL ERROR: not enough bytes to read "
- " the next parameter");
- return 0;
- }
- original_offset = offset;
-
- /* Reads parameter and create the sub tree. At this point we don't know
- * the final string that will identify the node or its length. It will
- * be set later...
- */
- parameter = NEXT_guint16(tvb, offset, little_endian);
- param_item = proto_tree_add_text(rtps_parameter_sequence_tree, tvb, offset, -1,
- "%s", val_to_str(parameter, parameter_id_vals, "Unknown (0x%04x)"));
- rtps_parameter_tree = proto_item_add_subtree(param_item, ett_rtps_parameter);
-
- proto_tree_add_uint(rtps_parameter_tree, hf_rtps_parameter_id,
- tvb, offset, 2, parameter);
- offset += 2;
-
- if (parameter == PID_SENTINEL) {
- /* PID_SENTINEL closes the parameter list, (length is ignored) */
- return offset +2;
- }
-
- /* parameter length */
- param_length = NEXT_guint16(tvb, offset, little_endian);
- if (tree) {
- proto_tree_add_item(rtps_parameter_tree,
- hf_rtps_parameter_length,
- tvb,
- offset,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- }
- offset += 2;
- /* Make sure we have enough bytes for the param value */
- if (size-4 < param_length) {
- if (tree) {
- proto_tree_add_text(tree,
- tvb,
- offset,
- 1,
- "RTPS PROTOCOL ERROR: not enough bytes to read"
- " the parameter value");
- }
- return 0;
- }
-
- /* Sets the end of this item (now we know it!) */
- if (tree) {
- proto_item_set_len(ti, param_length+4);
- }
-
- /* Do a shortcut when tree == NULL. In this case we only care of
- * PID_STATUS_INFO.
- */
- if (tree == NULL) {
- if (parameter == PID_STATUS_INFO) {
- if (pStatusInfo != NULL) {
- *pStatusInfo = NEXT_guint32(tvb, offset, little_endian);
- }
- }
- offset += param_length;
- continue;
- }
-
- switch(parameter) {
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_STATUS_INFO | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long statusInfo |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_STATUS_INFO: {
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_status_info, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (pStatusInfo != NULL) {
- *pStatusInfo = NEXT_guint32(tvb, offset, little_endian);
- }
- break;
- }
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DIRECTED_WRITE | 0x0010 |
- * +---------------+---------------+---------------+---------------+
- * | |
- * +- -+
- * | octet[12] guidPrefix |
- * +- -+
- * | |
- * +---------------+---------------+---------------+---------------+
- * | octet[4] entityId |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DIRECTED_WRITE: {
- guint8 guidPart;
- int i;
- ENSURE_LENGTH(16);
- rtps_util_add_guid_prefix(rtps_parameter_tree,
- tvb,
- offset,
- hf_rtps_sm_guid_prefix,
- hf_rtps_sm_host_id,
- hf_rtps_sm_app_id,
- hf_rtps_sm_counter,
- "guidPrefix",
- NULL,
- 0);
- rtps_util_add_entity_id(rtps_parameter_tree,
- tvb,
- offset+12,
- hf_rtps_sm_entity_id,
- hf_rtps_sm_entity_id_key,
- hf_rtps_sm_entity_id_kind,
- ett_rtps_entity,
- "guidSuffix",
- NULL);
- memset(buffer, 0, MAX_PARAM_SIZE);
- for (i = 0; i < 16; ++i) {
- guidPart = tvb_get_guint8(tvb, offset+i);
- g_snprintf(buffer+strlen(buffer), MAX_PARAM_SIZE-(gulong)strlen(buffer),
- "%02x", guidPart);
- if (i == 3 || i == 7 || i == 11) g_strlcat(buffer, ":", MAX_PARAM_SIZE);
- }
- break;
- }
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_KEY_HASH | xxxx |
- * +---------------+---------------+---------------+---------------+
- * | |
- * +- -+
- * | octet[xxxx] guid |
- * +- -+
- * | |
- * +---------------+---------------+---------------+---------------+
- * Differently from the other GUID, the KEY_HASH parameter may have
- * variable length in the future.
- * As consequence, no interpretation is performed here (and no check
- * for size).
- */
- case PID_KEY_HASH: {
- guint8 guidPart;
- int i;
- g_strlcat(buffer, "guid: ", MAX_PARAM_SIZE);
- for (i = 0; i < param_length; ++i) {
- guidPart = tvb_get_guint8(tvb, offset+i);
- g_snprintf(buffer+strlen(buffer), MAX_PARAM_SIZE-(gulong)strlen(buffer),
- "%02x", guidPart);
- if (( ((i+1) % 4) == 0 ) && (i != param_length-1) )
- g_strlcat(buffer, ":", MAX_PARAM_SIZE);
- }
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- param_length,
- "%s",
- buffer);
- break;
- }
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTICIPANT_LEASE_DURATION| 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PARTICIPANT_LEASE_DURATION:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree, tvb, offset, little_endian, hf_rtps_participant_lease_duration);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TIME_BASED_FILTER | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TIME_BASED_FILTER:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- hf_rtps_time_based_filter_minimum_separation);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TOPIC_NAME | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String.length |
- * +---------------+---------------+---------------+---------------+
- * | str[0] | str[1] | str[2] | str[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TOPIC_NAME:
- rtps_util_add_string(rtps_parameter_tree,
- tvb,
- offset,
- hf_rtps_param_topic_name,
- little_endian,
- NULL, /* No label, use hf param */
- buffer,
- MAX_PARAM_SIZE);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_OWNERSHIP_STRENGTH | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long strength |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_OWNERSHIP_STRENGTH:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_param_strength, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TYPE_NAME | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String.length |
- * +---------------+---------------+---------------+---------------+
- * | str[0] | str[1] | str[2] | str[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TYPE_NAME:
- rtps_util_add_string(rtps_parameter_tree,
- tvb,
- offset,
- hf_rtps_param_type_name,
- little_endian,
- NULL, /* No label, use hf param */
- buffer,
- MAX_PARAM_SIZE);
- break;
-
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_XXXXXXXXXXX | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_METATRAFFIC_MULTICAST_PORT:
- case PID_METATRAFFIC_UNICAST_PORT:
- case PID_DEFAULT_UNICAST_PORT:
- ENSURE_LENGTH(4);
- rtps_util_add_port(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, hf_rtps_param_port);
- break;
-
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_EXPECTS_INLINE_QOS | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | boolean | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_EXPECTS_INLINE_QOS:
- ENSURE_LENGTH(1);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_expects_inline_qos, tvb, offset, 1, ENC_NA );
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_XXXXXXXXXXX | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long ip_address |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_METATRAFFIC_MULTICAST_IPADDRESS:
- case PID_DEFAULT_UNICAST_IPADDRESS:
- case PID_MULTICAST_IPADDRESS:
- case PID_METATRAFFIC_UNICAST_IPADDRESS:
- rtps_util_add_ipv4_address_t(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, hf_param_ip_address);
- break;
-
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PROTOCOL_VERSION | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | uint8 major | uint8 minor | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PROTOCOL_VERSION: {
- guint8 major = 0;
- guint8 minor = 0;
-
- ENSURE_LENGTH(2);
- major = tvb_get_guint8(tvb, offset);
- minor = tvb_get_guint8(tvb, offset+1);
- g_snprintf(buffer, MAX_PARAM_SIZE, "%d.%d", major, minor);
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- param_length,
- "protocolVersion: %s",
- buffer);
- break;
- }
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_VENDOR_ID | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | uint8 major | uint8 minor | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_VENDOR_ID:
- ENSURE_LENGTH(2);
- rtps_util_add_vendor_id(NULL,
- tvb,
- offset);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_RELIABILITY | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_RELIABILITY_OFFERED: /* Deprecated */
- case PID_RELIABILITY:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_reliability_kind, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_LIVELINESS | 0x000c |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- * NDDS 3.1 sends only 'kind' on the wire.
- *
- */
- case PID_LIVELINESS_OFFERED: /* Deprecated */
- case PID_LIVELINESS:
- ENSURE_LENGTH(12);
- rtps_util_add_liveliness_qos(rtps_parameter_tree,
- tvb,
- offset,
- little_endian);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DURABILITY | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DURABILITY:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_durability, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DURABILITY_SERVICE | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- * | long history_depth |
- * +---------------+---------------+---------------+---------------+
- * | long max_samples |
- * +---------------+---------------+---------------+---------------+
- * | long max_instances |
- * +---------------+---------------+---------------+---------------+
- * | long max_samples_per_instance |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DURABILITY_SERVICE:
- ENSURE_LENGTH(28);
- rtps_util_add_durability_service_qos(rtps_parameter_tree, tvb, offset, little_endian);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_OWNERSHIP | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_OWNERSHIP_OFFERED: /* Deprecated */
- case PID_OWNERSHIP:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_ownership, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TRANSPORT_PRIORITY | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long value |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TRANSPORT_PRIORITY:
- ENSURE_LENGTH(4);
- rtps_util_add_long(rtps_parameter_tree,
- tvb,
- offset,
- -1, /* No protocol ID, use label below */
- little_endian,
- FALSE, /* Is Hex ? */
- FALSE, /* Is Signed ? */
- "value",
- buffer,
- MAX_PARAM_SIZE);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PRESENTATION | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- * | boolean | boolean | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PRESENTATION_OFFERED: /* Deprecated */
- case PID_PRESENTATION:
- ENSURE_LENGTH(6);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_access_scope, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_coherent_access, tvb, offset+4, 1, ENC_NA );
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_presentation_ordered_access, tvb, offset+5, 1, ENC_NA );
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DEADLINE | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DEADLINE_OFFERED: /* Deprecated */
- case PID_DEADLINE:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- hf_rtps_deadline_period);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DESTINATION_ORDER | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long kind |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DESTINATION_ORDER_OFFERED: /* Deprecated */
- case PID_DESTINATION_ORDER:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_destination_order, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_LATENCY_BUDGET | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_LATENCY_BUDGET_OFFERED:
- case PID_LATENCY_BUDGET:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- hf_rtps_latency_budget_duration);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTITION | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sequence_size |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long string[0].size |
- * +---------------+---------------+---------------+---------------+
- * | string[0][0] | string[0][1] | string[0][2] | string[0][3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * The value is a sequence of strings.
- */
- case PID_PARTITION_OFFERED: /* Deprecated */
- case PID_PARTITION:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_string(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- param_length,
- "name",
- buffer,
- MAX_PARAM_SIZE);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_LIFESPAN | 0x0008 |
- * +---------------+---------------+---------------+---------------+
- * | long NtpTime.seconds |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long NtpTime.fraction |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_LIFESPAN:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- hf_rtps_lifespan_duration);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_USER_DATA | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sequence_size |
- * +---------------+---------------+---------------+---------------+
- * | octet[0] | octet[1] | octet[2] | octet[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_USER_DATA:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, param_length, hf_rtps_param_user_data);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_GROUP_DATA | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sequence_size |
- * +---------------+---------------+---------------+---------------+
- * | octet[0] | octet[1] | octet[2] | octet[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_GROUP_DATA:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, param_length, hf_rtps_param_group_data);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TOPIC_DATA | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sequence_size |
- * +---------------+---------------+---------------+---------------+
- * | octet[0] | octet[1] | octet[2] | octet[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TOPIC_DATA:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_octets(rtps_parameter_tree, pinfo, tvb, offset,
- little_endian, param_length, hf_rtps_param_topic_data);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_UNICAST_LOCATOR | 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_UNICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb, offset, little_endian, "locator");
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DEFAULT_MULTICAST_LOCATOR | 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DEFAULT_MULTICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb, offset, little_endian, "locator");
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_MULTICAST_LOCATOR | 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_MULTICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb, offset, little_endian, "locator");
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DEFAULT_UNICAST_LOCATOR | 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DEFAULT_UNICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb, offset, little_endian, "locator");
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_METATRAFFIC_UNICAST_LOC...| 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_METATRAFFIC_UNICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb, offset, little_endian, "locator");
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_METATRAFFIC_MULTICAST_L...| 0x0018 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long port |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[0] | ipv6addr[1] | ipv6addr[2] | ipv6addr[3] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[4] | ipv6addr[5] | ipv6addr[6] | ipv6addr[7] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[8] | ipv6addr[9] | ipv6addr[10] | ipv6addr[11] |
- * +---------------+---------------+---------------+---------------+
- * | ipv6addr[12] | ipv6addr[13] | ipv6addr[14] | ipv6addr[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_METATRAFFIC_MULTICAST_LOCATOR:
- ENSURE_LENGTH(24);
- rtps_util_add_locator_t(rtps_parameter_tree, pinfo, tvb, offset, little_endian, "locator");
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTICIPANT_MANUAL_LIVE...| 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long livelinessEpoch |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PARTICIPANT_BUILTIN_ENDPOINTS:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_participant_builtin_endpoints, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
- case PID_PARTICIPANT_MANUAL_LIVELINESS_COUNT:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_participant_manual_liveliness_count, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_HISTORY | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long kind |
- * +---------------+---------------+---------------+---------------+
- * | long depth |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_HISTORY:
- ENSURE_LENGTH(8);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_history_kind, tvb, offset, 4,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_history_depth, tvb, offset+4, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_RESOURCE_LIMIT | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | long max_samples |
- * +---------------+---------------+---------------+---------------+
- * | long max_instances |
- * +---------------+---------------+---------------+---------------+
- * | long max_samples_per_instances |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_RESOURCE_LIMIT:
- ENSURE_LENGTH(12);
- ti = proto_tree_add_text(rtps_parameter_tree, tvb, offset, 12, "Resource Limit");
- subtree = proto_item_add_subtree(ti, ett_rtps_resource_limit);
- proto_tree_add_item(subtree, hf_rtps_resource_limit_max_samples, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- proto_tree_add_item(subtree, hf_rtps_resource_limit_max_instances, tvb, offset+4, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- proto_tree_add_item(subtree, hf_rtps_resource_limit_max_samples_per_instances, tvb, offset+8, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_CONTENT_FILTER_PROPERTY | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String1.length |
- * +---------------+---------------+---------------+---------------+
- * | str1[0] | str1[1] | str1[2] | str1[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String2.length |
- * +---------------+---------------+---------------+---------------+
- * | str2[0] | str2[1] | str2[2] | str2[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String3.length |
- * +---------------+---------------+---------------+---------------+
- * | str3[0] | str3[1] | str3[2] | str3[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String4.length |
- * +---------------+---------------+---------------+---------------+
- * | str4[0] | str4[1] | str4[2] | str4[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * | Filter Parameters |
- * | ... |
- * +---------------+---------------+---------------+---------------+
- *
- * String1: ContentFilterName
- * String2: RelatedTopicName
- * String3: FilterName
- * String4: FilterExpression
- * FilterParameters: sequence of Strings
- *
- * Note: those strings starts all to a word-aligned (4 bytes) offset
- */
- case PID_CONTENT_FILTER_PROPERTY: {
- guint32 temp_offset = offset;
- ENSURE_LENGTH(20);
- temp_offset = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- hf_rtps_param_content_filter_name,
- little_endian,
- NULL, /* No label, use hf param */
- buffer,
- MAX_PARAM_SIZE);
- temp_offset = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- hf_rtps_param_related_topic_name,
- little_endian,
- NULL,
- NULL,
- 0);
- temp_offset = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- hf_rtps_param_filter_name,
- little_endian,
- NULL,
- NULL,
- 0);
- temp_offset = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- -1,
- little_endian,
- "filterExpression",
- NULL,
- 0);
- /*temp_offset = */rtps_util_add_seq_string(rtps_parameter_tree,
- tvb,
- temp_offset,
- little_endian,
- param_length,
- "filterParameters",
- NULL,
- 0);
- break;
- }
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PROPERTY_LIST | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long Seq.Length |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * | Property 1 |
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * | Property 2 |
- * | ... |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * | Property n |
- * | ... |
- * +---------------+---------------+---------------+---------------+
- *
- * IDL:
- * struct PROPERTY {
- * String Name;
- * String Value;
- * };
- *
- * struct PROPERTY_LIST {
- * Sequence<PROPERTY> PropertyList;
- * };
- *
- */
- case PID_PROPERTY_LIST:
- case PID_PROPERTY_LIST_OLD:
- ENSURE_LENGTH(4);
- {
- guint32 prev_offset;
- guint32 temp_offset;
- guint8 tempName[MAX_PARAM_SIZE];
- guint8 tempValue[MAX_PARAM_SIZE];
- guint32 seq_size = NEXT_guint32(tvb, offset, little_endian);
- g_snprintf(buffer, MAX_PARAM_SIZE, "%d properties", seq_size);
- if (seq_size > 0) {
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- 0,
- /* 123456789012345678901234567890|123456789012345678901234567890 */
- " Property Name | Property Value");
-
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- 0,
- /* 123456789012345678901234567890|123456789012345678901234567890 */
- "------------------------------|------------------------------");
-
- temp_offset = offset+4;
- while(seq_size-- > 0) {
- prev_offset = temp_offset;
- temp_offset = rtps_util_add_string(NULL,
- tvb,
- temp_offset,
- -1,
- little_endian,
- NULL,
- tempName,
- MAX_PARAM_SIZE);
- temp_offset = rtps_util_add_string(NULL,
- tvb,
- temp_offset,
- -1,
- little_endian,
- NULL,
- tempValue,
- MAX_PARAM_SIZE);
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- prev_offset,
- temp_offset - prev_offset,
- "%-29s | %-29s",
- tempName,
- tempValue);
- }
- }
- }
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_CONTENT_FILTER_INFO | length |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- *
- * IDL:
- * struct CONTENT_FILTER_SIGNATURE {
- * sequence<long> filterBitmap;
- * sequence<FILTER_SIGNATURE, 4> filterSignature;
- * }
- *
- * where:
- * struct FILTER_SIGNATURE {
- * long filterSignature[4];
- * }
- */
- case PID_CONTENT_FILTER_INFO: {
- guint32 temp_offset = offset;
- guint32 prev_offset;
- guint32 fs_elem;
- guint32 fs[4];
- ENSURE_LENGTH(8);
-
- /* Dissect filter bitmap */
- temp_offset = rtps_util_add_seq_ulong(rtps_parameter_tree, tvb, offset,
- hf_rtps_filter_bitmap, little_endian, param_length, "filterBitmap");
-
- /* Dissect sequence of FILTER_SIGNATURE */
- fs_elem = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- while (fs_elem-- > 0) {
- prev_offset = temp_offset;
- /* Dissect the next FILTER_SIGNATURE object */
- fs[0] = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- fs[1] = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- fs[2] = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- fs[3] = NEXT_guint32(tvb, temp_offset, little_endian);
- temp_offset += 4;
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- prev_offset,
- temp_offset - prev_offset,
- "filterSignature: %08x %08x %08x %08x",
- fs[0], fs[1], fs[2], fs[3]);
- }
-
- break;
- }
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_COHERENT_SET | length |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber seqNumber +
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_COHERENT_SET:
- ENSURE_LENGTH(8);
- rtps_util_add_seq_number(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- "sequenceNumber");
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_BUILTIN_ENDPOINT_SET | length |
- * +---------------+---------------+---------------+---------------+
- * | long value |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_BUILTIN_ENDPOINT_SET: {
- guint32 data;
- guint32 datamask;
- char bitbuf[33];
- int i;
- ENSURE_LENGTH(4);
- data = NEXT_guint32(tvb, offset, little_endian);
- for (i = 0; i < 32; ++i) {
- datamask = (1 << (31-i));
- bitbuf[i] = ((data & datamask) == datamask) ? '1':'0';
- }
- bitbuf[i] = '\0';
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- 4,
- "value: %08x (%s)",
- data, bitbuf);
- break;
- }
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TYPE_MAX_SIZE_SERIALIZED | length |
- * +---------------+---------------+---------------+---------------+
- * | long value |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TYPE_MAX_SIZE_SERIALIZED:
- ENSURE_LENGTH(4);
- rtps_util_add_long(rtps_parameter_tree,
- tvb,
- offset,
- -1, /* No protocol ID, use label below */
- little_endian,
- FALSE, /* Is Hex ? */
- FALSE, /* Is Signed ? */
- "value",
- buffer,
- MAX_PARAM_SIZE);
- break;
-
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_ORIGINAL_WRITER_INFO | length |
- * +---------------+---------------+---------------+---------------+
- * | |
- * +- -+
- * | octet[12] guidPrefix |
- * +- -+
- * | |
- * +---------------+---------------+---------------+---------------+
- * | octet[4] entityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_ORIGINAL_WRITER_INFO:
- ENSURE_LENGTH(16);
- rtps_util_add_guid_prefix(rtps_parameter_tree,
- tvb,
- offset,
- hf_rtps_sm_guid_prefix,
- hf_rtps_sm_host_id,
- hf_rtps_sm_app_id,
- hf_rtps_sm_counter,
- "virtualGUIDPrefix",
- NULL,
- 0);
- rtps_util_add_entity_id(rtps_parameter_tree,
- tvb,
- offset+12,
- hf_rtps_sm_entity_id,
- hf_rtps_sm_entity_id_key,
- hf_rtps_sm_entity_id_kind,
- ett_rtps_entity,
- "virtualGUIDSuffix",
- NULL);
-
- /* Sequence number */
- rtps_util_add_seq_number(rtps_parameter_tree,
- tvb,
- offset+16,
- little_endian,
- "virtualSeqNumber");
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_ENTITY_NAME | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long String.length |
- * +---------------+---------------+---------------+---------------+
- * | str[0] | str[1] | str[2] | str[3] |
- * +---------------+---------------+---------------+---------------+
- * | ... |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_ENTITY_NAME:
- rtps_util_add_string(rtps_parameter_tree,
- tvb,
- offset,
- hf_rtps_param_entity_name,
- little_endian,
- NULL, /* No label, use hf param */
- buffer,
- MAX_PARAM_SIZE);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTICIPANT_GUID | 0x0010 |
- * | PID_ENDPOINT_GUID | |
- * +---------------+---------------+---------------+---------------+
- * | guid[0] | guid[1] | guid[2] | guid[3] |
- * +---------------+---------------+---------------+---------------+
- * | guid[4] | guid[5] | guid[6] | guid[7] |
- * +---------------+---------------+---------------+---------------+
- * | guid[8] | guid[9] | guid[10] | guid[11] |
- * +---------------+---------------+---------------+---------------+
- * | guid[12] | guid[13] | guid[14] | guid[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PARTICIPANT_GUID:
- case PID_ENDPOINT_GUID:
- ENSURE_LENGTH(16);
- rtps_util_add_generic_guid(rtps_parameter_tree,
- tvb,
- offset,
- "GUID",
- buffer,
- MAX_PARAM_SIZE);
-
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PARTICIPANT_ENTITY_ID | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | entity[0] | entity[1] | entity[2] | entity[3] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PARTICIPANT_ENTITY_ID:
- ENSURE_LENGTH(4);
- rtps_util_add_generic_entity_id(rtps_parameter_tree,
- tvb,
- offset,
- "Participant entity ID",
- buffer,
- MAX_PARAM_SIZE);
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_GROUP_GUID | 0x0010 |
- * +---------------+---------------+---------------+---------------+
- * | guid[0] | guid[1] | guid[2] | guid[3] |
- * +---------------+---------------+---------------+---------------+
- * | guid[4] | guid[5] | guid[6] | guid[7] |
- * +---------------+---------------+---------------+---------------+
- * | guid[8] | guid[9] | guid[10] | guid[11] |
- * +---------------+---------------+---------------+---------------+
- * | guid[12] | guid[13] | guid[14] | guid[15] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_GROUP_GUID:
- ENSURE_LENGTH(16);
- rtps_util_add_generic_guid(rtps_parameter_tree,
- tvb,
- offset,
- "Group GUID",
- buffer,
- MAX_PARAM_SIZE);
-
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_GROUP_ENTITY_ID | 0x0004 |
- * +---------------+---------------+---------------+---------------+
- * | entity[0] | entity[1] | entity[2] | entity[3] |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_GROUP_ENTITY_ID:
- ENSURE_LENGTH(4);
-
- rtps_util_add_generic_entity_id(rtps_parameter_tree,
- tvb,
- offset,
- "Group entity ID",
- buffer,
- MAX_PARAM_SIZE);
-
- break;
-
-
-
-
-
- /* ==================================================================
- * Here are all the deprecated items.
- */
-
- case PID_PERSISTENCE:
- ENSURE_LENGTH(8);
- rtps_util_add_ntp_time(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- hf_rtps_persistence);
- break;
-
- case PID_TYPE_CHECKSUM:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_type_checksum, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
- case PID_EXPECTS_ACK:
- ENSURE_LENGTH(1);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_expects_ack, tvb, offset, 1, ENC_NA );
- break;
-
- case PID_MANAGER_KEY: {
- int i = 0;
- char sep = ':';
- guint32 manager_key;
-
- buffer[0] = '\0';
- while (param_length >= 4) {
- manager_key = NEXT_guint32(tvb, offset, little_endian);
- g_snprintf(buffer+strlen(buffer),
- MAX_PARAM_SIZE-(gulong)strlen(buffer),
- "%c 0x%08x",
- sep,
- manager_key);
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- param_length,
- "Key[%d]: 0x%X", i, manager_key);
- ++i;
- offset +=4;
- sep = ',';
- param_length -= 4; /* decrement count */
- }
- offset += param_length;
- break;
- }
-
-
- case PID_RECV_QUEUE_SIZE:
- case PID_SEND_QUEUE_SIZE:
- ENSURE_LENGTH(4);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_queue_size, tvb, offset, 4, little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
- break;
-
-
- case PID_VARGAPPS_SEQUENCE_NUMBER_LAST:
- ENSURE_LENGTH(4);
- rtps_util_add_seq_number(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- "sequenceNumberLast");
- break;
-
- /* This is the default branch when we don't have enough information
- * on how to decode the parameter. It can be used also for known
- * parameters.
- */
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | <pid_id> | 0x0000 |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_IS_RELIABLE:
- case PID_TYPE2_NAME:
- case PID_TYPE2_CHECKSUM:
- case PID_RELIABILITY_ENABLED:
- g_strlcpy(buffer, "[DEPRECATED] - Parameter not decoded", MAX_PARAM_SIZE);
-
- case PID_PAD:
- break;
-
- default:
-
- /* The following PIDS are vendor-specific */
- if (vendor_id == RTPS_VENDOR_RTI) {
- switch(parameter) {
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PRODUCT_VERSION | length |
- * +---------------+---------------+---------------+---------------+
- * | uint8 major | uint8 minor | N O T U S E D |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PRODUCT_VERSION: {
- guint8 major = 0;
- guint8 minor = 0;
- guint8 release;
- guint8 revision;
-
- ENSURE_LENGTH(4);
- major = tvb_get_guint8(tvb, offset);
- minor = tvb_get_guint8(tvb, offset+1);
- release = tvb_get_guint8(tvb, offset+2);
- revision = tvb_get_guint8(tvb, offset+3);
- g_snprintf(buffer, MAX_PARAM_SIZE, "%d.%d%c rev%d",
- major, minor, release, revision);
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- param_length,
- "productVersion: %s",
- buffer);
- break;
- }
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_PLUGIN_PROMISCUITY_KIND | length |
- * +---------------+---------------+---------------+---------------+
- * | short value | |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_PLUGIN_PROMISCUITY_KIND: {
- guint32 val;
- ENSURE_LENGTH(4);
- val = NEXT_guint32(tvb, offset, little_endian);
- g_snprintf(buffer, MAX_PARAM_SIZE, "%s",
- val_to_str(val, plugin_promiscuity_kind_vals,
- "unknown (%04x)"));
-
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- param_length,
- "promiscuityKind: %s",
- buffer);
- break;
- }
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_ENTITY_VIRTUAL_GUID | length |
- * +---------------+---------------+---------------+---------------+
- * | |
- * +- -+
- * | octet[12] guidPrefix |
- * +- -+
- * | |
- * +---------------+---------------+---------------+---------------+
- * | octet[4] entityId |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_ENTITY_VIRTUAL_GUID:
- ENSURE_LENGTH(16);
- rtps_util_add_guid_prefix(rtps_parameter_tree,
- tvb,
- offset,
- hf_rtps_sm_guid_prefix,
- hf_rtps_sm_host_id,
- hf_rtps_sm_app_id,
- hf_rtps_sm_counter,
- "virtualGUIDPrefix",
- NULL,
- 0);
- rtps_util_add_entity_id(rtps_parameter_tree,
- tvb,
- offset+12,
- hf_rtps_sm_entity_id,
- hf_rtps_sm_entity_id_key,
- hf_rtps_sm_entity_id_kind,
- ett_rtps_entity,
- "virtualGUIDSuffix",
- NULL);
- break;
-
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_SERVICE_KIND | length |
- * +---------------+---------------+---------------+---------------+
- * | long value |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_SERVICE_KIND: {
- guint32 val;
- ENSURE_LENGTH(4);
- val = NEXT_guint32(tvb, offset, little_endian);
-
- g_snprintf(buffer, MAX_PARAM_SIZE, "%s",
- val_to_str(val, service_kind_vals, "unknown (%04x)"));
-
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- param_length,
- "serviceKind: %s",
- buffer);
- break;
- }
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TYPECODE_RTPS2 | length |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + Type code description +
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TYPECODE_RTPS2:
- rtps_util_add_typecode(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- 0, /* indent level */
- 0, /* isPointer */
- -1, /* bitfield */
- 0, /* isKey */
- offset,
- NULL, /* name */
- 0, /* not a seq field */
- NULL, /* not an array */
- 0); /* ndds 4.0 hack: init to false */
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_DISABLE_POSITIVE_ACKS | length |
- * +---------------+---------------+---------------+---------------+
- * | boolean value | = = = = = = = = u n u s e d = = = = = = = = |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_DISABLE_POSITIVE_ACKS:
- ENSURE_LENGTH(1);
- proto_tree_add_item(rtps_parameter_tree, hf_rtps_disable_positive_ack, tvb, offset, 1, ENC_NA );
- break;
-
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_LOCATOR_FILTER_LIST | length |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long number_of_channels |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ String filter_name ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ LocatorList ~ <----------+
- * | | Repeat |
- * +---------------+---------------+---------------+---------------+ For each|
- * | | Channel |
- * ~ String filter_expression ~ |
- * | | |
- * +---------------+---------------+---------------+---------------+ <----------+
- */
- case PID_LOCATOR_FILTER_LIST: {
- guint32 number_of_channels = 0;
- proto_tree *channel_tree = NULL;
- proto_item *ti_channel = NULL;
- char temp_buff[MAX_LABEL_SIZE];
- guint32 ch;
- gint old_offset;
- guint32 off = offset;
-
- ENSURE_LENGTH(4);
- number_of_channels = NEXT_guint32(tvb, off, little_endian);
- g_snprintf(buffer, MAX_PARAM_SIZE, "%d channels", number_of_channels);
- off += 4;
-
- if (number_of_channels == 0) {
- /* Do not dissect the rest */
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- off-4,
- 4,
- "numberOfChannels: %d", number_of_channels);
- break;
- }
-
- /* filter name */
- off = rtps_util_add_string(rtps_parameter_tree,
- tvb,
- off,
- -1, /* hf_item not set */
- little_endian,
- "filterName", /* label */
- NULL, /* buffer not set */
- 0); /* buffer length */
-
- /* Foreach channel... */
- for (ch = 0; ch < number_of_channels; ++ch) {
- g_snprintf(temp_buff, MAX_LABEL_SIZE, "Channel[%u]", ch);
- old_offset = off;
- if (tree) {
- ti_channel = proto_tree_add_text(rtps_parameter_tree,
- tvb,
- off,
- 0,
- "%s",
- temp_buff);
- channel_tree = proto_item_add_subtree(ti_channel, ett_rtps_locator_filter_channel);
- }
- off = rtps_util_add_locator_list(channel_tree, pinfo, tvb, off, temp_buff, little_endian);
- /* Filter expression */
- off = rtps_util_add_string(channel_tree,
- tvb,
- off,
- -1, /* hf_item not set */
- little_endian,
- "filterExpression", /* label */
- NULL, /* buffer not set */
- 0); /* buffer length */
- /* Now we know the length of the channel data, set the length */
- if (ti_channel) {
- proto_item_set_len(ti_channel, (off - old_offset));
- }
- } /* End of for each channel */
- break;
- } /* End of case PID_LOCATOR_FILTER_LIST */
-
- } /* End of switch for parameters for vendor RTI */
- } /* End of branch vendor RTI */
- else if (vendor_id == RTPS_VENDOR_TOC) {
- switch(parameter) {
- /* 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | PID_TYPECODE_RTPS2 | length |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + Type code description +
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- case PID_TYPECODE_RTPS2:
- rtps_util_add_typecode(rtps_parameter_tree,
- tvb,
- offset,
- little_endian,
- 0, /* indent level */
- 0, /* isPointer */
- -1, /* bitfield */
- 0, /* isKey */
- offset,
- NULL, /* name */
- 0, /* not a seq field */
- NULL, /* not an array */
- 0); /* ndds 4.0 hack: init to false */
- break;
- default:
- break;
- } /* End of switch for parameters for vendor TOC */
- } /* End of branch vendor TOC */
-
- /* Put here other branches if you are planning to dissect parameters
- * ID from different vendors.
- */
-
- else {
- if (param_length > 0) {
- proto_tree_add_text(rtps_parameter_tree,
- tvb,
- offset,
- param_length,
- "parameterData");
- }
- }
- } /* End main parameter switch */
-
- if (buffer[0]) {
- proto_item_append_text(ti, ": %s", buffer);
- buffer[0] = '\0';
- }
- offset += param_length;
-
- } /* for all the parameters */
- g_assert_not_reached();
-}
-#undef ENSURE_LENGTH
-
-
-/* *********************************************************************** */
-/* * D A T A * */
-/* *********************************************************************** */
-static void dissect_DATA(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree,
- guint16 vendor_id) {
- /*
- *
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | DATA |X|X|X|I|H|D|Q|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + +
- * | KeyHashPrefix keyHashPrefix [only if H==1] |
- * + +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | KeyHashSuffix keyHashSuffix |
- * +---------------+---------------+---------------+---------------+
- * | StatusInfo statusInfo [only if I==1] |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList inlineQos [only if Q==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SerializedData serializedData [only if D==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- int min_len;
- gint old_offset = offset;
- guint32 wid; /* Writer EntityID */
- guint32 status_info = 0xffffffff;
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, DATA_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- /* Calculates the minimum length for this submessage */
- min_len = 20;
- if ((flags & FLAG_DATA_Q_RTPS2) != 0) min_len += 4;
- if ((flags & FLAG_DATA_D_RTPS2) != 0) min_len += 4;
- if ((flags & FLAG_DATA_H) != 0) min_len += 12;
-
- if (octets_to_next_header < min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL)
- * Note that we still need to decode the statusInfo and the writer ID
- */
- if (tree == NULL) {
- offset += 8; /* Skip to writer entity ID */
- wid = NEXT_guint32(tvb, offset, little_endian);
- offset += 12; /* Skip to keyHashPrefix */
- if ((flags & FLAG_DATA_H) != 0) {
- offset += 12;
- }
- offset += 4; /* GUID Entity ID */
- if ((flags & FLAG_DATA_I) != 0) {
- status_info = NEXT_guint32(tvb, offset, little_endian);
- }
- info_summary_append_ex(pinfo, wid, status_info);
- return;
- }
-
- offset += 4;
-
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- &wid);
- offset += 4;
-
-
- /* Sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
- offset += 8;
-
- /* If flag H is defined, read the GUID Prefix */
- if ((flags & FLAG_DATA_H) != 0) {
- rtps_util_add_guid_prefix(tree,
- tvb,
- offset,
- hf_rtps_sm_guid_prefix,
- hf_rtps_sm_host_id,
- hf_rtps_sm_app_id,
- hf_rtps_sm_counter,
- "keyHashPrefix",
- NULL,
- 0);
-
- offset += 12;
- } else {
- /* Flag H not set, use hostId, appId from the packet header */
- }
-
- /* Complete the GUID by reading the Object ID */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_entity_id,
- hf_rtps_sm_entity_id_key,
- hf_rtps_sm_entity_id_kind,
- ett_rtps_entity,
- "keyHashSuffix",
- NULL);
- offset += 4;
-
- if ((flags & FLAG_DATA_I) != 0) {
- status_info = rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 1, /* is_hex */
- 0, /* is_signed */
- "statusInfo",
- NULL,
- 0);
- offset += 4;
- }
-
- /* InlineQos */
- if ((flags & FLAG_DATA_Q_RTPS2) != 0) {
- offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", NULL, vendor_id);
- }
-
- /* SerializedData */
- if ((flags & FLAG_DATA_D_RTPS2) != 0) {
- dissect_serialized_data(tree, pinfo, tvb, offset,
- octets_to_next_header - (offset - old_offset) + 4,
- "serializedData", vendor_id);
- }
- info_summary_append_ex(pinfo, wid, status_info);
-}
-
-
-/* *********************************************************************** */
-/* * D A T A _ F R A G * */
-/* *********************************************************************** */
-static void dissect_DATA_FRAG(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree,
- guint16 vendor_id) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | DATA_FRAG |X|X|X|X|X|H|Q|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + +
- * | KeyHashPrefix keyHashPrefix [only if H==1] |
- * + +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | KeyHashSuffix keyHashSuffix |
- * +---------------+---------------+---------------+---------------+
- * | FragmentNumber fragmentStartingNum |
- * +---------------+---------------+---------------+---------------+
- * | ushort fragmentsInSubmessage | ushort fragmentSize |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sampleSize |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList inlineQos [only if Q==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SerializedData serializedData ~
- * | |
- * +---------------+---------------+---------------+---------------+
- */
-
- int min_len;
- gint old_offset = offset;
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, NOKEY_DATA_FRAG_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
-
- /* Calculates the minimum length for this submessage */
- min_len = 32;
- if ((flags & FLAG_DATA_FRAG_Q) != 0) min_len += 4;
- if ((flags & FLAG_DATA_FRAG_H) != 0) min_len += 12;
-
- if (octets_to_next_header < min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL)
- */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
- /* Sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
- offset += 8;
-
- /* If flag H is defined, read the GUID Prefix */
- if ((flags & FLAG_DATA_H) != 0) {
- rtps_util_add_guid_prefix(tree,
- tvb,
- offset,
- hf_rtps_sm_guid_prefix,
- hf_rtps_sm_host_id,
- hf_rtps_sm_app_id,
- hf_rtps_sm_counter,
- "keyHashPrefix",
- NULL,
- 0);
-
- offset += 12;
- } else {
- /* Flag H not set, use hostId, appId from the packet header */
- }
-
- /* Complete the GUID by reading the Object ID */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_entity_id,
- hf_rtps_sm_entity_id_key,
- hf_rtps_sm_entity_id_kind,
- ett_rtps_entity,
- "keyHashSuffix",
- NULL);
- offset += 4;
-
-
- /* Fragment number */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentStartingNum",
- NULL,
- 0);
- offset += 4;
-
- /* Fragments in submessage */
- rtps_util_add_short(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentsInSubmessage",
- NULL,
- 0);
- offset += 2;
-
- /* Fragment size */
- rtps_util_add_short(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentSize",
- NULL,
- 0);
- offset += 2;
-
- /* sampleSize */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "sampleSize",
- NULL,
- 0);
- offset += 4;
-
- /* InlineQos */
- if ((flags & FLAG_DATA_Q_RTPS2) != 0) {
- offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", NULL, vendor_id);
- }
-
- /* SerializedData */
- if ((flags & FLAG_DATA_D_RTPS2) != 0) {
- dissect_serialized_data(tree, pinfo, tvb, offset,
- octets_to_next_header - (offset - old_offset) + 4,
- "serializedData", vendor_id);
- }
-}
-
-
-
-/* *********************************************************************** */
-/* * N O K E Y _ D A T A * */
-/* *********************************************************************** */
-static void dissect_NOKEY_DATA(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree,
- guint16 vendor_id) {
- /*
- * RTPS 2.0:
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | NOKEY_DATA |X|X|X|X|X|D|Q|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList inlineQos [only if Q==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SerializedData serializedData [only if D==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- */
-
- int min_len;
- gint old_offset = offset;
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, NOKEY_DATA_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- /* Calculates the minimum length for this submessage */
- min_len = 16;
- if ((flags & FLAG_NOKEY_DATA_Q) != 0) min_len += 4;
-
- if (octets_to_next_header < min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL)
- */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
- /* Sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
- offset += 8;
-
- /* InlineQos */
- if ((flags & FLAG_DATA_Q_RTPS2) != 0) {
- offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", NULL, vendor_id);
- }
-
- /* SerializedData */
- if ((flags & FLAG_DATA_D_RTPS2) != 0) {
- dissect_serialized_data(tree, pinfo, tvb, offset,
- octets_to_next_header - (offset - old_offset) + 4,
- "serializedData", vendor_id);
- }
-}
-
-
-/* *********************************************************************** */
-/* * N O K E Y _ D A T A _ F R A G * */
-/* *********************************************************************** */
-static void dissect_NOKEY_DATA_FRAG(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree,
- guint16 vendor_id) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * |NOKEY_DATA_FRAG|X|X|X|X|X|X|Q|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | FragmentNumber fragmentStartingNum |
- * +---------------+---------------+---------------+---------------+
- * | ushort fragmentsInSubmessage | ushort fragmentSize |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sampleSize |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList inlineQos [only if Q==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SerializedData serializedData ~
- * | |
- * +---------------+---------------+---------------+---------------+
- */
-
- int min_len;
- gint old_offset = offset;
- proto_item* octet_item;
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, NOKEY_DATA_FRAG_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
-
- /* Calculates the minimum length for this submessage */
- min_len = 28;
- if ((flags & FLAG_NOKEY_DATA_Q) != 0) min_len += 4;
-
- if (octets_to_next_header < min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL) */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
- /* Sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
- offset += 8;
-
- /* Fragment number */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentStartingNum",
- NULL,
- 0);
- offset += 4;
-
- /* Fragments in submessage */
- rtps_util_add_short(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentsInSubmessage",
- NULL,
- 0);
- offset += 2;
-
- /* Fragment size */
- rtps_util_add_short(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentSize",
- NULL,
- 0);
- offset += 2;
-
- /* InlineQos */
- if ((flags & FLAG_DATA_Q_RTPS2) != 0) {
- offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", NULL, vendor_id);
- }
-
- /* SerializedData */
- if ((flags & FLAG_DATA_D_RTPS2) != 0) {
- dissect_serialized_data(tree, pinfo, tvb,offset,
- octets_to_next_header - (offset - old_offset) + 4,
- "serializedData", vendor_id);
- }
-}
-
-
-
-/* *********************************************************************** */
-/* * A C K N A C K * */
-/* *********************************************************************** */
-static void dissect_ACKNACK(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | ACKNACK |X|X|X|X|X|X|F|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumberSet readerSNState +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | Counter count |
- * +---------------+---------------+---------------+---------------+
- */
- gint original_offset; /* Offset to the readerEntityId */
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, ACKNACK_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (octets_to_next_header < 20) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 20)");
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL)
- * Note that we still need to decode the statusInfo and the writer ID
- */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
- original_offset = offset;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
- /* Bitmap */
- offset = rtps_util_add_bitmap(tree,
- tvb,
- offset,
- little_endian,
- "readerSNState");
-
-
- /* RTPS 1.0 didn't have count: make sure we don't decode it wrong
- * in this case
- */
- if (offset + 4 == original_offset + octets_to_next_header) {
- /* Count is present */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- FALSE, /* Is Hex ? */
- TRUE, /* Is Signed ? */
- "counter", /* No Label, use the protocol item ID */
- NULL,
- 0);
- } else if (offset < original_offset + octets_to_next_header) {
- /* In this case there must be something wrong in the bitmap: there
- * are some extra bytes that we don't know how to decode
- */
- proto_tree_add_text(tree,
- tvb,
- offset,
- octets_to_next_header - offset,
- "Packet malformed: don't know how to decode those "
- "extra bytes: %d",
- octets_to_next_header - offset);
- } else if (offset > original_offset + octets_to_next_header) {
- /* Decoding the bitmap went over the end of this submessage.
- * Enter an item in the protocol tree that spans over the entire
- * submessage.
- */
- proto_tree_add_text(tree,
- tvb,
- original_offset,
- octets_to_next_header + original_offset,
- "Packet malformed: not enough bytes to decode");
- }
-}
-
-
-/* *********************************************************************** */
-/* * N A C K _ F R A G * */
-/* *********************************************************************** */
-static void dissect_NACK_FRAG(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | NACK_FRAG |X|X|X|X|X|X|X|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumberSet writerSN +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ FragmentNumberSet fragmentNumberState +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | Counter count |
- * +---------------+---------------+---------------+---------------+
- */
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, NACK_FRAG_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (octets_to_next_header < 24) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 24)");
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL)
- * Note that we still need to decode the statusInfo and the writer ID
- */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
- /* Writer sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSN");
- offset += 8;
-
- /* FragmentNumberSet */
- offset = rtps_util_add_fragment_number_set(tree,
- tvb,
- offset,
- little_endian,
- "fragmentNumberState",
- octets_to_next_header - 20);
-
- if (offset == -1) {
- return;
- }
- /* Count */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- FALSE, /* Is Hex ? */
- TRUE, /* Is Signed ? */
- "count", /* No Label, use the protocol item ID */
- NULL,
- 0);
-}
-
-
-
-/* *********************************************************************** */
-/* * H E A R T B E A T * */
-/* *********************************************************************** */
-static void dissect_HEARTBEAT(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | HEARTBEAT |X|X|X|X|X|L|F|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber firstSeqNumber +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber lastSeqNumber +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | Counter count |
- * +---------------+---------------+---------------+---------------+
- */
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, HEARTBEAT_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (octets_to_next_header < 28) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 28)");
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL) */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
- /* First available Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "firstSeqNumber");
- offset += 8;
-
- /* Last Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "lastSeqNumber");
- offset += 8;
-
- /* Counter */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "count",
- NULL,
- 0);
-}
-
-
-/* *********************************************************************** */
-/* * H E A R T B E A T _ B A T C H * */
-/* *********************************************************************** */
-static void dissect_HEARTBEAT_BATCH(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * |HEARTBEAT_BATCH|X|X|X|X|X|L|F|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber firstBatchSN +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber lastBatchSN +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber firstSN +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber lastSN +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | Count count |
- * +---------------+---------------+---------------+---------------+
- */
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, HEARTBEAT_BATCH_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (octets_to_next_header < 36) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 36)");
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL) */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
- /* First available Batch Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "firstBatchSN");
- offset += 8;
-
- /* Last Batch Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "lastBatchSN");
- offset += 8;
-
- /* First available Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "firstSeqNumber");
- offset += 8;
-
- /* Last Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "lastSeqNumber");
- offset += 8;
-
- /* Counter */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "count",
- NULL,
- 0);
-}
-
-
-/* *********************************************************************** */
-/* * H E A R T B E A T _ F R A G * */
-/* *********************************************************************** */
-static void dissect_HEARTBEAT_FRAG(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * |HEARTBEAT_FRAG |X|X|X|X|X|X|X|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSeqNumber +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | FragmentNumber lastFragmentNum |
- * +---------------+---------------+---------------+---------------+
- * | Counter count |
- * +---------------+---------------+---------------+---------------+
- */
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, HEARTBEAT_FRAG_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (octets_to_next_header < 24) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 24)");
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL) */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
- /* First available Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
- offset += 8;
-
- /* Fragment number */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "lastFragmentNum",
- NULL,
- 0);
- offset += 4;
-
- /* Counter */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "count",
- NULL,
- 0);
-}
-
-
-
-/* *********************************************************************** */
-/* * G A P * */
-/* *********************************************************************** */
-static void dissect_GAP(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | GAP |X|X|X|X|X|X|X|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber gapStart +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SequenceNumberSet gapList ~
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, GAP_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (octets_to_next_header < 24) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= 24)");
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL) */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- NULL);
- offset += 4;
-
-
- /* First Sequence Number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "gapStart");
- offset += 8;
-
- /* Bitmap */
- rtps_util_add_bitmap(tree,
- tvb,
- offset,
- little_endian,
- "gapList");
-}
-
-
-/* *********************************************************************** */
-/* * I N F O _ R E P L Y _ I P 4 * */
-/* *********************************************************************** */
-static void dissect_INFO_REPLY_IP4(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * |INFO_REPLY_IP4 |X|X|X|X|X|X|M|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + LocatorUDPv4 unicastReplyLocator +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + LocatorUDPv4 multicastReplyLocator [only if M==1] +
- * | |
- * +---------------+---------------+---------------+---------------+
- */
-
- int min_len;
- proto_item* octet_item;
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, INFO_REPLY_IP4_FLAGS);
-
- min_len = 8;
- if ((flags & FLAG_INFO_REPLY_IP4_M) != 0) min_len += 8;
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (octets_to_next_header != min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be == %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL) */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
-
- /* unicastReplyLocator */
- rtps_util_add_locator_udp_v4(tree, pinfo, tvb, offset,
- "unicastReplyLocator", little_endian);
-
- offset += 8;
-
- /* multicastReplyLocator */
- if ((flags & FLAG_INFO_REPLY_IP4_M) != 0) {
- rtps_util_add_locator_udp_v4(tree, pinfo, tvb, offset,
- "multicastReplyLocator", little_endian);
- /*offset += 8;*/
- }
-}
-
-/* *********************************************************************** */
-/* * I N F O _ D S T * */
-/* *********************************************************************** */
-static void dissect_INFO_DST(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | INFO_DST |X|X|X|X|X|X|X|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + +
- * | GuidPrefix guidPrefix |
- * + +
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, INFO_DST_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- if (octets_to_next_header != 12) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be == 12)");
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL) */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
- rtps_util_add_guid_prefix(tree,
- tvb,
- offset,
- hf_rtps_sm_guid_prefix,
- hf_rtps_sm_host_id,
- hf_rtps_sm_app_id,
- hf_rtps_sm_counter,
- NULL,
- NULL,
- 0);
-}
-
-
-
-/* *********************************************************************** */
-/* * I N F O _ R E P L Y * */
-/* *********************************************************************** */
-static void dissect_INFO_REPLY(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree) {
- /*
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | INFO_REPLY |X|X|X|X|X|X|M|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ LocatorList unicastReplyLocatorList ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ LocatorList multicastReplyLocatorList [only if M==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- int min_len;
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, INFO_REPLY_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- min_len = 4;
- if ((flags & FLAG_INFO_REPLY_M) != 0) min_len += 4;
-
- if (octets_to_next_header < min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL) */
- if (tree == NULL) {
- return;
- }
-
- offset += 4;
-
-
- /* unicastReplyLocatorList */
- offset = rtps_util_add_locator_list(tree, pinfo, tvb, offset, "unicastReplyLocatorList", little_endian);
-
- /* multicastReplyLocatorList */
- if ((flags & FLAG_INFO_REPLY_M) != 0) {
- /*offset = */rtps_util_add_locator_list(tree, pinfo, tvb, offset, "multicastReplyLocatorList", little_endian);
- }
-}
-
-/* *********************************************************************** */
-/* * R T P S _ D A T A * */
-/* * A N D * */
-/* * R T P S _ D A T A _ S E S S I O N * */
-/* *********************************************************************** */
-static void dissect_RTPS_DATA(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree,
- guint16 vendor_id,
- int is_session) {
- /*
- *
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * | RTPS_DATA |X|X|X|X|K|D|Q|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | Flags extraFlags | octetsToInlineQos |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList inlineQos [only if Q==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SerializedData serializedData [only if D==1 || K==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- *
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * |RTPS_DATA_SESSI|X|X|X|X|K|D|Q|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | Flags extraFlags | octetsToInlineQos |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSessionSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerVirtualSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList inlineQos [only if Q==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SerializedData serializedData [only if D==1 || K==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- int min_len;
- gint old_offset = offset;
- guint32 wid; /* Writer EntityID */
- guint32 status_info = 0xffffffff;
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, RTPS_DATA_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- /* Calculates the minimum length for this submessage */
- min_len = 24;
- if (is_session) {
- min_len += 8;
- }
- if ((flags & FLAG_RTPS_DATA_Q) != 0) min_len += 4;
- if ((flags & FLAG_RTPS_DATA_D) != 0) min_len += 4;
- if ((flags & FLAG_RTPS_DATA_K) != 0) min_len += 4;
-
- if (octets_to_next_header < min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL)
- * Note that we still need to decode the statusInfo and the writer ID
- */
- if (tree == NULL) {
- offset += 12;
- /* writerEntityId */
- wid = NEXT_guint32(tvb, offset, little_endian);
-
- offset += 12;
- if ((flags & FLAG_RTPS_DATA_Q) != 0) {
- /*offset = */dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", &status_info, vendor_id);
- }
- info_summary_append_ex(pinfo, wid, status_info);
- return;
- }
-
- offset += 4;
-
-
- /* extraFlags */
- rtps_util_add_extra_flags(tree,
- tvb,
- offset,
- "Extra flags:");
- offset += 2;
-
- /* octetsToInlineQos */
- proto_tree_add_text(tree,
- tvb,
- offset,
- 2,
- "Octets to inline QoS: %d",
- NEXT_guint16(tvb, offset, little_endian));
- offset += 2;
-
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- &wid);
- offset += 4;
-
- /* Sequence number */
- if (is_session) {
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSessionSeqNumber");
- offset += 8;
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerVirtualSeqNumber");
- offset += 8;
- } else {
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
- offset += 8;
- }
-
- /* InlineQos */
- if ((flags & FLAG_RTPS_DATA_Q) != 0) {
- offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", &status_info, vendor_id);
- }
-
- /* SerializedData */
- if (((flags & FLAG_RTPS_DATA_D) != 0) || ((flags & FLAG_RTPS_DATA_K) != 0)) {
- if (wid == ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER) {
- /* Dissect the serialized data as ParticipantMessageData:
- * struct ParticipantMessageData {
- * KeyHashPrefix_t participantGuidPrefix;
- * KeyHashSuffix_t kind;
- * sequence<octet> data;
- * }
- */
- proto_tree * rtps_pm_tree;
- proto_tree * guid_tree;
- guint32 kind;
- guint16 encapsulation_id;
- guint16 encapsulation_len;
- /*int encapsulation_little_endian = 0;*/
- proto_item * ti = proto_tree_add_text(tree,
- tvb,
- offset,
- octets_to_next_header - (offset - old_offset) + 4,
- "ParticipantMessageData");
-
- rtps_pm_tree = proto_item_add_subtree(ti, ett_rtps_part_message_data);
- /* Encapsulation ID */
- encapsulation_id = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
-
- proto_tree_add_text(rtps_pm_tree,
- tvb,
- offset,
- 2,
- "encapsulation kind: %s",
- val_to_str(encapsulation_id,
- encapsulation_id_vals, "unknown (%02x)"));
- offset += 2;
-
-#if 0 /* XXX: encapsulation_little_endian not actually used anywhere ?? */
- /* Sets the correct values for encapsulation_le */
- if (encapsulation_id == ENCAPSULATION_CDR_LE ||
- encapsulation_id == ENCAPSULATION_PL_CDR_LE) {
- encapsulation_little_endian = 1;
- }
-#endif
-
- /* Encapsulation length (or option) */
- encapsulation_len = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
- proto_tree_add_text(rtps_pm_tree,
- tvb,
- offset,
- 2,
- "encapsulation options: %04x",
- encapsulation_len);
- offset += 2;
-
- guid_tree = proto_item_add_subtree(ti,
- ett_rtps_part_message_data);
-
- rtps_util_add_guid_prefix(guid_tree,
- tvb,
- offset,
- hf_rtps_sm_guid_prefix,
- hf_rtps_sm_host_id,
- hf_rtps_sm_app_id,
- hf_rtps_sm_counter,
- "participantGuidPrefix",
- NULL,
- 0);
- offset += 12;
-
- /* Kind */
- kind = NEXT_guint32(tvb, offset, FALSE); /* Always big endian */
- proto_tree_add_text(guid_tree,
- tvb,
- offset,
- 4,
- "kind: %s",
- val_to_str(kind, participant_message_data_kind, "unknown (%04x)"));
- offset += 4;
-
- dissect_octet_seq(rtps_pm_tree, /* guid_tree, */
- tvb,
- offset,
- "serializedData");
- } else {
- const char *label;
- if (((flags & FLAG_RTPS_DATA_D) != 0) || ((flags & FLAG_RTPS_DATA_K) == 0)) {
- label = "serializedData";
- } else if (((flags & FLAG_RTPS_DATA_D) == 0) || ((flags & FLAG_RTPS_DATA_K) != 0)) {
- label = "serializedKey";
- } else {
- /* D==1 && K==1 */
- label = "<invalid or unknown data type>";
- }
-
- /* At the end still dissect the rest of the bytes as raw data */
- dissect_serialized_data(tree, pinfo, tvb, offset,
- octets_to_next_header - (offset - old_offset) + 4,
- label, vendor_id);
- }
- }
-
- info_summary_append_ex(pinfo, wid, status_info);
-}
-
-
-
-
-/* *********************************************************************** */
-/* * R T P S _ D A T A _ F R A G * */
-/* *********************************************************************** */
-static void dissect_RTPS_DATA_FRAG(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree,
- guint16 vendor_id) {
- /*
- *
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * |RTPS_DATA_FRAG |X|X|X|X|X|K|Q|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | Flags extraFlags | octetsToInlineQos |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerEntityId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber writerSeqNum +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | FragmentNumber fragmentStartingNum |
- * +---------------+---------------+---------------+---------------+
- * | ushort fragmentsInSubmessage | ushort fragmentSize |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long sampleSize |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList inlineQos [only if Q==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SerializedData serializedData ~
- * | |
- * +---------------+---------------+---------------+---------------+
- */
- int min_len;
- gint old_offset = offset;
- guint32 wid; /* Writer EntityID */
- guint32 status_info = 0xffffffff;
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, RTPS_DATA_FRAG_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- /* Calculates the minimum length for this submessage */
- min_len = 36;
- if ((flags & FLAG_RTPS_DATA_FRAG_Q) != 0) min_len += 4;
-
- if (octets_to_next_header < min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL)
- * Note that we still need to decode the statusInfo and the writer ID
- */
- if (tree == NULL) {
- offset += 12;
- /* writerEntityId */
- wid = NEXT_guint32(tvb, offset, little_endian);
-
- offset += 24;
- if ((flags & FLAG_RTPS_DATA_FRAG_Q) != 0) {
- /*offset = */dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", &status_info, vendor_id);
- }
- info_summary_append_ex(pinfo, wid, status_info);
- return;
- }
-
- offset += 4;
-
-
- /* extraFlags */
- rtps_util_add_extra_flags(tree,
- tvb,
- offset,
- "Extra flags:");
- offset += 2;
-
- /* octetsToInlineQos */
- proto_tree_add_text(tree,
- tvb,
- offset,
- 2,
- "Octets to inline QoS: %d",
- NEXT_guint16(tvb, offset, little_endian));
- offset += 2;
-
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- &wid);
- offset += 4;
-
-
- /* Sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "writerSeqNumber");
- offset += 8;
-
- /* Fragment number */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentStartingNum",
- NULL,
- 0);
- offset += 4;
-
- /* Fragments in submessage */
- rtps_util_add_short(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentsInSubmessage",
- NULL,
- 0);
- offset += 2;
-
- /* Fragment size */
- rtps_util_add_short(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "fragmentSize",
- NULL,
- 0);
- offset += 2;
-
- /* sampleSize */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "sampleSize",
- NULL,
- 0);
- offset += 4;
-
- /* InlineQos */
- if ((flags & FLAG_RTPS_DATA_FRAG_Q) != 0) {
- offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", &status_info, vendor_id);
- }
-
- /* SerializedData */
- {
- const char *label = "serializedData";
- if ((flags & FLAG_RTPS_DATA_FRAG_K) != 0) {
- label = "serializedKey";
- }
- dissect_serialized_data(tree, pinfo, tvb, offset,
- octets_to_next_header - (offset - old_offset) + 4,
- label, vendor_id);
- }
- info_summary_append_ex(pinfo, wid, status_info);
-}
-
-
-
-
-/* *********************************************************************** */
-/* * R T P S _ D A T A _ B A T C H * */
-/* *********************************************************************** */
-static void dissect_RTPS_DATA_BATCH(tvbuff_t *tvb,
- packet_info *pinfo,
- gint offset,
- guint8 flags,
- gboolean little_endian,
- int octets_to_next_header,
- proto_tree *tree,
- guint16 vendor_id) {
- /*
- *
- * 0...2...........7...............15.............23...............31
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * |RTPS_DATA_BATCH|X|X|X|X|X|X|Q|E| octetsToNextHeader |
- * +---------------+---------------+---------------+---------------+
- * | Flags extraFlags | octetsToInlineQos |
- * +---------------+---------------+---------------+---------------+
- * | EntityId readerId |
- * +---------------+---------------+---------------+---------------+
- * | EntityId writerId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber batchSN +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + SequenceNumber firstSampleSN +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | SequenceNumberOffset offsetToLastSampleSN |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long batchSampleCount |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList batchInlineQos [only if Q==1] ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long octetsToSLEncapsulationId |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SampleInfoList sampleInfoList ~
- * | |
- * +---------------+---------------+---------------+---------------+
- * | SampleListEncapsulationId | |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SampleList sampleList ~
- * | |
- * +---------------+---------------+---------------+---------------+
- *
- *
- * SampleInfo:
- * 0...............8..............16..............24..............32
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- * |X|X|X|X|X|X|X|X|X|X|K|I|D|O|Q|T| octetsToInlineQoS |
- * +---------------+---------------+---------------+---------------+
- * | unsigned long serializedDataLength |
- * +---------------+---------------+---------------+---------------+
- * | |
- * + Timestamp timestamp [only if T==1] +
- * | |
- * +---------------+---------------+---------------+---------------+
- * | SequenceNumberOffset offsetSN [only if O==1] |
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ ParameterList sampleInlineQos [only if Q==1] ~
- * | |
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- *
- *
- * Sample:
- * 0...............8..............16..............24..............32
- * +---------------+---------------+---------------+---------------+
- * | |
- * ~ SerializedData serializedData [sampleInfo D==1 || K==1] ~
- * | |
- * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- */
-
- int min_len;
- gint old_offset = offset;
- guint32 wid; /* Writer EntityID */
- guint32 status_info = 0xffffffff;
- gint32 octectsToSLEncapsulationId;
- /*guint32 batchSampleCount;*/
- gint32 sampleListOffset;
- guint16 encapsulation_id;
- guint16 *sample_info_flags = NULL;
- guint32 *sample_info_length = NULL;
- gint32 sample_info_count = 0,
- sample_info_max = rtps_max_batch_samples_dissected;
- proto_item* octet_item;
-
- rtps_util_decode_flags(tree, tvb, offset + 1, flags, RTPS_DATA_BATCH_FLAGS);
-
- octet_item = proto_tree_add_item(tree,
- hf_rtps_sm_octets_to_next_header,
- tvb,
- offset + 2,
- 2,
- little_endian ? ENC_LITTLE_ENDIAN : ENC_BIG_ENDIAN);
-
- /* Calculates the minimum length for this submessage */
- min_len = 44;
- if ((flags & FLAG_RTPS_DATA_BATCH_Q) != 0) min_len += 4;
-
- if (octets_to_next_header < min_len) {
- expert_add_info_format(pinfo, octet_item, PI_PROTOCOL, PI_WARN, "(Error: should be >= %u)", min_len);
- return;
- }
-
- /* Skip decoding the entire packet if (tree == NULL)
- * Note that we still need to decode the statusInfo and the writer ID
- */
- if (tree == NULL) {
- offset += 12;
- /* writerEntityId */
- wid = NEXT_guint32(tvb, offset, little_endian);
-
- offset += 24;
- if ((flags & FLAG_DATA_Q_RTPS2) != 0) {
- /*offset = */dissect_parameter_sequence(tree, pinfo, tvb, offset,
- little_endian, octets_to_next_header - (offset - old_offset) + 4,
- "inlineQos", &status_info, vendor_id);
- }
- info_summary_append_ex(pinfo, wid, status_info);
- return;
- }
-
- offset += 4;
-
-
- /* extraFlags */
- rtps_util_add_extra_flags(tree,
- tvb,
- offset,
- "Extra flags:");
- offset += 2;
-
- /* octetsToInlineQos */
- proto_tree_add_text(tree,
- tvb,
- offset,
- 2,
- "Octets to inline QoS: %d",
- NEXT_guint16(tvb, offset, little_endian));
- offset += 2;
-
-
- /* readerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_rdentity_id,
- hf_rtps_sm_rdentity_id_key,
- hf_rtps_sm_rdentity_id_kind,
- ett_rtps_rdentity,
- "readerEntityId",
- NULL);
- offset += 4;
-
- /* writerEntityId */
- rtps_util_add_entity_id(tree,
- tvb,
- offset,
- hf_rtps_sm_wrentity_id,
- hf_rtps_sm_wrentity_id_key,
- hf_rtps_sm_wrentity_id_kind,
- ett_rtps_wrentity,
- "writerEntityId",
- &wid);
- offset += 4;
-
-
- /* Batch sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "batchSeqNumber");
- offset += 8;
-
- /* First stample sequence number */
- rtps_util_add_seq_number(tree,
- tvb,
- offset,
- little_endian,
- "firstSampleSeqNumber");
- offset += 8;
-
- /* offsetToLastSampleSN */
- rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "offsetToLastSampleSN",
- NULL,
- 0);
- offset += 4;
-
- /* batchSampleCount */
- /*batchSampleCount =*/ rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "batchSampleCount",
- NULL,
- 0);
- offset += 4;
-
- /* Parameter list (if Q==1) */
- /* InlineQos */
- if ((flags & FLAG_RTPS_DATA_BATCH_Q) != 0) {
- offset = dissect_parameter_sequence(tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "batchInlineQos", &status_info, vendor_id);
- }
-
- /* octetsToSLEncapsulationId */
- octectsToSLEncapsulationId = (gint32)rtps_util_add_long(tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "octetsToSLEncapsulationId",
- NULL,
- 0);
- offset += 4;
- sampleListOffset = offset + octectsToSLEncapsulationId;
-
-
- /* Sample info list */
- {
- proto_item * ti;
- proto_tree * sil_tree;
- sample_info_count = 0;
-
- ti = proto_tree_add_text(tree,
- tvb,
- offset,
- -1,
- "Sample Info List");
- sil_tree = proto_item_add_subtree(ti, ett_rtps_sample_info_list);
-
- /* Allocate sample_info_flags and sample_info_length
- * to store a copy of the flags for each sample info */
- if (rtps_max_batch_samples_dissected == 0) {
- sample_info_max = 1024; /* Max size of sampleInfo shown */
- }
- sample_info_flags = (guint16 *)ep_alloc(sizeof(guint16) * sample_info_max);
- sample_info_length = (guint32 *)ep_alloc(sizeof(guint32) * sample_info_max);
-
- /* Sample Info List: start decoding the sample info list until the offset
- * is greater or equal than 'sampleListOffset' */
- while (offset < sampleListOffset) {
- guint16 flags2;
- /*guint16 octetsToInlineQos;*/
- gint min_length;
- proto_tree * si_tree;
- gint offset_begin_sampleinfo = offset;
-
- if (rtps_max_batch_samples_dissected > 0 && (guint)sample_info_count >= rtps_max_batch_samples_dissected) {
- proto_tree_add_text(sil_tree,
- tvb,
- offset,
- -1,
- "... (more samples available. Configure this limit from preferences dialog)");
- offset = sampleListOffset;
- break;
- }
-
- ti = proto_tree_add_text(sil_tree,
- tvb,
- offset,
- -1,
- "sampleInfo[%d]", sample_info_count);
- si_tree = proto_item_add_subtree(ti, ett_rtps_sample_info);
-
- flags2 = NEXT_guint16(tvb, offset, FALSE); /* Flags are always big endian */
- sample_info_flags[sample_info_count] = flags2;
- rtps_util_decode_flags_16bit(si_tree, tvb, offset, flags2, RTPS_SAMPLE_INFO_FLAGS16);
- offset += 2;
- /*octetsToInlineQos =*/ rtps_util_add_short(si_tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "octetsToInlineQos",
- NULL,
- 0);
- offset += 2;
-
- min_length = 4;
- if ((flags2 & FLAG_SAMPLE_INFO_T) != 0) min_len += 8;
- if ((flags2 & FLAG_SAMPLE_INFO_Q) != 0) min_len += 4;
- if ((flags2 & FLAG_SAMPLE_INFO_O) != 0) min_len += 4;
-
- /* Ensure there are enough bytes to decode */
- if (sampleListOffset - offset < min_length) {
- proto_tree_add_text(si_tree,
- tvb,
- offset-4,
- 4,
- "Error: not enough bytes to dissect sample info");
- return;
- }
-
- /* Serialized data length */
- sample_info_length[sample_info_count] = rtps_util_add_long(si_tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "serializedDataLength",
- NULL,
- 0);
- offset += 4;
-
- /* Timestamp [only if T==1] */
- if ((flags2 & FLAG_SAMPLE_INFO_T) != 0) {
- rtps_util_add_ntp_time(si_tree,
- tvb,
- offset,
- little_endian,
- hf_rtps_data_batch_timestamp);
- offset += 8;
- }
-
- /* Offset SN [only if O==1] */
- if ((flags2 & FLAG_SAMPLE_INFO_O) != 0) {
- rtps_util_add_long(si_tree,
- tvb,
- offset,
- -1,
- little_endian,
- 0, /* is_hex */
- 0, /* is_signed */
- "offsetSN",
- NULL,
- 0);
- offset += 4;
- }
-
- /* Parameter list [only if Q==1] */
- if ((flags2 & FLAG_SAMPLE_INFO_Q) != 0) {
- offset = dissect_parameter_sequence(si_tree, pinfo, tvb, offset, little_endian,
- octets_to_next_header - (offset - old_offset) + 4,
- "sampleInlineQos", &status_info, vendor_id);
- }
- proto_item_set_len(ti, offset - offset_begin_sampleinfo);
- sample_info_count++;
- } /* while (offset < sampleListOffset) */
- }
-
- /* Encapsulation ID for the entire data sequence */
- encapsulation_id = NEXT_guint16(tvb, offset, FALSE); /* Always big endian */
- proto_tree_add_text(tree,
- tvb,
- offset,
- 2,
- "encapsulation kind: %s",
- val_to_str(encapsulation_id, encapsulation_id_vals, "unknown (%02x)"));
- offset += 2;
-
- /* The next two bytes are ignored */
- offset += 2;
-
- /* Now the list of serialized data:
- * Serialized data is allocated one after another one.
- * We need to use the data previously stored in the sampleInfo to detect the
- * kind and size.
- * - sample_info_flags -> Array of guint16 holding the flags for this sample info
- * - sample_info_length -> Array of guint32 with the size of this sample info
- * - sample_info_count -> size of the above arrays
- * This section will NEVER dissect more than 'sample_info_count'.
- * Note, if there are not enough bytes in the buffer, don't dissect it (this
- * can happen for example when a DISPOSE message is sent, there are sample
- * info records, but the payload size is zero for all of them)
- */
- if (octets_to_next_header - (offset - old_offset) > 0) {
- proto_item * ti;
- proto_tree * sil_tree;
- gint count = 0;
- const char * label;
-
- ti = proto_tree_add_text(tree,
- tvb,
- offset,
- -1,
- "Serialized Sample List");
- sil_tree = proto_item_add_subtree(ti, ett_rtps_sample_batch_list);
- for (count = 0; count < sample_info_count; ++count) {
- /* Ensure there are enough bytes in the buffer to dissect the next sample */
- if (octets_to_next_header - (offset - old_offset) + 4 < (gint)sample_info_length[count]) {
- proto_tree_add_text(sil_tree,
- tvb,
- offset,
- 4,
- "Error: not enough bytes to dissect sample");
- return;
- }
-
- if ((sample_info_flags[count] & FLAG_SAMPLE_INFO_K) != 0) {
- label = "serializedKey[%d]";
- } else {
- label = "serializedData[%d]";
- }
- proto_tree_add_text(sil_tree,
- tvb,
- offset,
- sample_info_length[count],
- label,
- count);
- offset += sample_info_length[count];
- }
- }
- info_summary_append_ex(pinfo, wid, status_info);
-}
-
-
-
-#define RTPS_MAGIC_NUMBER 0x52545053 /* RTPS */
-
-/***************************************************************************/
-/* The main packet dissector function
- */
-static gboolean dissect_rtps(tvbuff_t *tvb,
- packet_info *pinfo,
- proto_tree *tree,
- void *data _U_)
-{
- proto_item *ti = NULL;
- proto_tree *rtps_tree = NULL;
- gint offset = 0;
- proto_tree *rtps_submessage_tree = NULL;
- guint8 submessageId;
- guint8 flags;
- gboolean little_endian;
- gboolean is_ping = FALSE;
- gint next_submsg, octets_to_next_header;
- guint16 vendor_id = RTPS_VENDOR_UNKNOWN;
-
- /* Check 'RTPS' signature:
- * A header is invalid if it has less than 16 octets
- */
- if (!tvb_bytes_exist(tvb, offset, 16)) return FALSE;
-
- /* Check packet signature */
- if ( (tvb_get_ntohl(tvb, offset) != RTPS_MAGIC_NUMBER) ||
- (tvb_get_guint8(tvb,offset+4) != 2) ) {
- return FALSE;
- }
-
- /* --- Make entries in Protocol column ---*/
- col_set_str(pinfo->cinfo, COL_PROTOCOL, "RTPS2");
- col_clear(pinfo->cinfo, COL_INFO);
-
- /* Check if is NDDSPING */
- is_ping = rtps_is_ping(tvb, pinfo, offset+8);
-
- /* create display subtree for the protocol */
- ti = proto_tree_add_item(tree, proto_rtps, tvb, 0, -1, ENC_NA);
- rtps_tree = proto_item_add_subtree(ti, ett_rtps);
-
- /* Protocol Version */
- rtps_util_add_protocol_version(rtps_tree, tvb, offset+4);
-
- /* Vendor Id */
- vendor_id = NEXT_guint16(tvb, offset+6, FALSE);
- rtps_util_add_vendor_id(rtps_tree, tvb, offset+6);
-
- /* If is not PING, the next 12 bytes are the GUID prefix */
- if (!is_ping) {
- rtps_util_add_guid_prefix(rtps_tree,
- tvb,
- offset+8,
- hf_rtps_guid_prefix,
- hf_rtps_host_id,
- hf_rtps_app_id,
- hf_rtps_sm_counter,
- NULL,
- NULL,
- 0);
- }
-
-#ifdef RTI_BUILD
- else {
- pinfo->guid_prefix_host = tvb_get_ntohl(tvb, offset + 8);
- pinfo->guid_prefix_app = tvb_get_ntohl(tvb, offset + 12);
- pinfo->guid_prefix_count = tvb_get_ntohl(tvb, offset + 16);
- pinfo->guid_rtps2 = 1;
- }
-#endif
-
- /* Extract the domain id and participant index for the default mapping */
- if (tree) {
- int domain_id;
- int participant_idx = -1;
- int nature;
- int Doffset;
- proto_item *ti2;
- proto_tree *mapping_tree;
-
- /* For a complete description of these rules, see RTPS documentation
-
- RTPS 1.2 mapping:
- domain_id = ((pinfo->destport - PORT_BASE)/10) % 100;
- participant_idx = (pinfo->destport - PORT_BASE) / 1000;
- nature = (pinfo->destport % 10);
-
- For Unicast, the port mapping formula is:
- metatraffic_unicast_port = port_base +
- (domain_id_gain * domain_id) +
- (participant_id_gain * participant_id) +
- builtin_unicast_port_offset
- For Multicast, the port mapping is:
- metatraffic_multicast_port = port_base +
- (domain_id_gain * domain_id) +
- builtin_multicast_port_offset
-
- Where the constants are:
- port_base = 7400
- domain_id_gain = 250
- participant_id_gain = 2
- builtin_multicast_port_offset = 0
- builtin_unicast_port_offset = 10
- user_multicast_port_offset = 1
- user_unicast_port_offset = 11
-
-
- To obtain the individual components from the port number, the reverse formulas are:
- domain_id = (port - port_base) / 250 (valid both multicast / unicast)
- Doffset = (port - port_Base - (domain_id * 250));
- participant_idx = (Doffset - 10) / 2;
-
- */
- domain_id = (pinfo->destport - PORT_BASE) / 250;
- Doffset = (pinfo->destport - PORT_BASE - domain_id * 250);
- if (Doffset == 0) {
- nature = PORT_METATRAFFIC_MULTICAST;
- } else if (Doffset == 1) {
- nature = PORT_USERTRAFFIC_MULTICAST;
- } else {
- participant_idx = (Doffset - 10) / 2;
- if ( (Doffset - 10) % 2 == 0) {
- nature = PORT_METATRAFFIC_UNICAST;
- } else {
- nature = PORT_USERTRAFFIC_UNICAST;
- }
- }
-
- if (nature == PORT_METATRAFFIC_UNICAST || nature == PORT_USERTRAFFIC_UNICAST) {
- ti2 = proto_tree_add_text(rtps_tree,
- tvb,
- 0,
- 4,
- "Default port mapping: %s, domainId=%d, "
- "participantIdx=%d",
- val_to_str(nature, nature_type_vals, "%02x"),
- domain_id,
- participant_idx);
- } else {
- /* Multicast doesn't print the participant index */
- ti2 = proto_tree_add_text(rtps_tree,
- tvb,
- 0,
- 4,
- "Default port mapping: %s, domainId=%d",
- val_to_str(nature, nature_type_vals, "%02x"),
- domain_id);
- }
-
- /* Build the searchable protocol tree */
- mapping_tree = proto_item_add_subtree(ti2, ett_rtps_default_mapping);
- proto_tree_add_uint(mapping_tree,
- hf_rtps_domain_id,
- tvb,
- 0,
- 4,
- domain_id);
- if (nature == PORT_METATRAFFIC_UNICAST || nature == PORT_USERTRAFFIC_UNICAST) {
- proto_tree_add_uint(mapping_tree,
- hf_rtps_participant_idx,
- tvb,
- 0,
- 4,
- participant_idx);
- }
- proto_tree_add_uint(mapping_tree,
- hf_rtps_nature_type,
- tvb,
- 0,
- 4,
- nature);
- }
-
- /* offset behind RTPS's Header (need to be set in case tree=NULL)*/
- offset=20;
-
- while (tvb_reported_length_remaining(tvb, offset) > 0) {
- submessageId = tvb_get_guint8(tvb, offset);
-
- /* Creates the subtree 'Submessage: XXXX' */
- if (submessageId & 0x80) {
- ti = proto_tree_add_text(rtps_tree,
- tvb,
- offset,
- -1,
- "Submessage: %s",
- val_to_str(submessageId, submessage_id_vals,
- "Vendor-specific (0x%02x)"));
- } else {
- ti = proto_tree_add_text(rtps_tree,
- tvb,
- offset,
- -1,
- "Submessage: %s",
- val_to_str(submessageId, submessage_id_vals,
- "Unknown (0x%02x)"));
- }
- rtps_submessage_tree = proto_item_add_subtree(ti, ett_rtps_submessage);
-
- /* Decode the submessage ID */
- if (submessageId & 0x80) {
- proto_tree_add_uint_format(rtps_submessage_tree,
- hf_rtps_sm_id,
- tvb,
- offset,
- 1,
- submessageId,
- "submessageId: Vendor-specific (0x%02x)",
- submessageId);
- } else {
- proto_tree_add_uint(rtps_submessage_tree, hf_rtps_sm_id,
- tvb, offset, 1, submessageId);
- }
-
- /* Gets the flags */
- flags = tvb_get_guint8(tvb, offset + 1);
-
- /* Gets the E (Little endian) flag */
- little_endian = ((flags & FLAG_E) != 0);
-
- /* octet-to-next-header */
- octets_to_next_header = NEXT_guint16(tvb, offset + 2, little_endian);
- if (octets_to_next_header == 0)
- octets_to_next_header = tvb_reported_length_remaining(tvb, offset + 4);
- next_submsg = offset + octets_to_next_header + 4;
-
- /* Set length of this item */
- if (ti != NULL) {
- proto_item_set_len(ti, octets_to_next_header + 4);
- }
-
- /* Now decode each single submessage
- *
- * Note: if tree==NULL, it's true we don't care too much about the
- * details, but we are still calling the individual submessage
- * dissectors in order to correctly compose the INFO list.
- * The offset passed to the dissectors points to the start of the
- * submessage (at the ID byte).
- */
- col_append_sep_str(pinfo->cinfo, COL_INFO, ", ", val_to_str(submessageId, submessage_id_vals, "Unknown[%02x]"));
- switch (submessageId) {
- case SUBMESSAGE_PAD:
- dissect_PAD(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_DATA:
- dissect_DATA(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree,
- vendor_id);
- break;
-
- case SUBMESSAGE_DATA_FRAG:
- dissect_DATA_FRAG(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree,
- vendor_id);
- break;
-
- case SUBMESSAGE_NOKEY_DATA:
- dissect_NOKEY_DATA(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree,
- vendor_id);
- break;
-
- case SUBMESSAGE_NOKEY_DATA_FRAG:
- dissect_NOKEY_DATA_FRAG(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree,
- vendor_id);
- break;
-
- case SUBMESSAGE_NACK_FRAG:
- dissect_NACK_FRAG(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
-
- case SUBMESSAGE_ACKNACK_SESSION:
- case SUBMESSAGE_ACKNACK_BATCH:
- case SUBMESSAGE_ACKNACK:
- dissect_ACKNACK(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_HEARTBEAT:
- dissect_HEARTBEAT(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_HEARTBEAT_SESSION:
- case SUBMESSAGE_HEARTBEAT_BATCH:
- dissect_HEARTBEAT_BATCH(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_HEARTBEAT_FRAG:
- dissect_HEARTBEAT_FRAG(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_GAP:
- dissect_GAP(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_INFO_TS:
- dissect_INFO_TS(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_INFO_SRC:
- dissect_INFO_SRC(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_INFO_REPLY_IP4:
- dissect_INFO_REPLY_IP4(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_INFO_DST:
- dissect_INFO_DST(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_INFO_REPLY:
- dissect_INFO_REPLY(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree);
- break;
-
- case SUBMESSAGE_RTPS_DATA_SESSION:
- case SUBMESSAGE_RTPS_DATA:
- dissect_RTPS_DATA(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree,
- vendor_id,
- (submessageId == SUBMESSAGE_RTPS_DATA_SESSION));
- break;
-
- case SUBMESSAGE_RTPS_DATA_FRAG:
- dissect_RTPS_DATA_FRAG(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree,
- vendor_id);
- break;
-
- case SUBMESSAGE_RTPS_DATA_BATCH:
- dissect_RTPS_DATA_BATCH(tvb,
- pinfo,
- offset,
- flags,
- little_endian,
- octets_to_next_header,
- rtps_submessage_tree,
- vendor_id);
- break;
-
-
- default:
- if (rtps_submessage_tree != NULL) {
- proto_tree_add_uint(rtps_submessage_tree, hf_rtps_sm_flags,
- tvb, offset + 1, 1, flags);
- proto_tree_add_uint(rtps_submessage_tree,
- hf_rtps_sm_octets_to_next_header,
- tvb, offset + 2, 2, next_submsg);
- }
- }
-
- /* next submessage's offset */
- offset = next_submsg;
- }
-
- return TRUE;
-} /* dissect_rtps(...) */
-
-
-
-
-
-/***************************************************************************
- * Register the protocol with Wireshark
- * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
- */
-void proto_register_rtps2(void) {
-
- /* Definition of the protocol tree items:
- * This section declares all the protocol items that are parsed in the
- * dissectors.
- * Structure of each element:
- * {
- * item_id, {
- * name, // As appears in the GUI tree
- * abbrev, // Referenced by filters (rtps.xxxx[.yyyy])
- * type, // FT_BOOLEAN, FT_UINT8, ...
- * display, // BASE_HEX | BASE_DEC | BASE_OCT or other meanings
- * strings, // String table (for enums) or NULL
- * bitmask, // only for bitfields
- * blurb, // Complete description of this item
- * HFILL
- * }
- * }
- */
- static hf_register_info hf[] = {
-
- /* Domain Participant and Participant Index ---------------------------- */
- { &hf_rtps_domain_id, {
- "domain_id",
- "rtps2.domain_id",
- FT_UINT32,
- BASE_DEC,
- NULL,
- 0,
- "Domain ID",
- HFILL }
- },
-
- { &hf_rtps_participant_idx, {
- "participant_idx",
- "rtps2.participant_idx",
- FT_UINT32,
- BASE_DEC,
- NULL,
- 0,
- "Participant index",
- HFILL }
- },
- { &hf_rtps_nature_type, {
- "traffic_nature",
- "rtps2.traffic_nature",
- FT_UINT32,
- BASE_DEC,
- VALS(nature_type_vals),
- 0,
- "Nature of the traffic (meta/user-traffic uni/multi-cast)",
- HFILL }
- },
-
- /* Guid Prefix for the Packet ------------------------------------------ */
- { &hf_rtps_guid_prefix, {
- "guidPrefix",
- "rtps2.guidPrefix",
- FT_BYTES,
- BASE_NONE,
- NULL,
- 0,
- "GuidPrefix of the RTPS packet",
- HFILL }
- },
-
- /* Host ID ------------------------------------------------------------- */
- { &hf_rtps_host_id, { /* HIDDEN */
- "hostId",
- "rtps2.hostId",
- FT_UINT32,
- BASE_HEX,
- NULL,
- 0,
- "Sub-component 'hostId' of the GuidPrefix of the RTPS packet",
- HFILL }
- },
-
- /* AppID --------------------------------------------------------------- */
- { &hf_rtps_app_id, {
- "appId",
- "rtps2.appId",
- FT_UINT32,
- BASE_HEX,
- NULL,
- 0,
- "Sub-component 'appId' of the GuidPrefix of the RTPS packet",
- HFILL }
- },
-
- /* Counter ------------------------------------------------------------- */
-#if 0
- { &hf_rtps_counter, { / * HIDDEN * /
- "counter",
- "rtps2.counter",
- FT_UINT32,
- BASE_HEX,
- NULL,
- 0,
- "Sub-component 'counter' of the GuidPrefix of the RTPS packet",
- HFILL }
- },
-#endif
-
- /* Submessage ID ------------------------------------------------------- */
- { &hf_rtps_sm_id, {
- "submessageId",
- "rtps2.sm.id",
- FT_UINT8,
- BASE_HEX,
- VALS(submessage_id_vals),
- 0,
- "defines the type of submessage",
- HFILL }
- },
-
- /* Submessage flags ---------------------------------------------------- */
- { &hf_rtps_sm_flags, {
- "flags",
- "rtps2.sm.flags",
- FT_UINT8,
- BASE_HEX,
- NULL,
- 0,
- "bitmask representing the flags associated with a submessage",
- HFILL }
- },
-
- /* octets to next header ---------------------------------------------- */
- { &hf_rtps_sm_octets_to_next_header, {
- "octetsToNextHeader",
- "rtps2.sm.octetsToNextHeader",
- FT_UINT16,
- BASE_DEC,
- NULL,
- 0,
- "Size of the submessage payload",
- HFILL }
- },
-
- /* GUID as {GuidPrefix, EntityId} ------------------------------------ */
- { &hf_rtps_sm_guid_prefix, {
- "guidPrefix",
- "rtps2.sm.guidPrefix",
- FT_BYTES,
- BASE_NONE,
- NULL,
- 0,
- "a generic guidPrefix that is transmitted inside the submessage (this is NOT the guidPrefix described in the packet header",
- HFILL }
- },
-
- { &hf_rtps_sm_host_id, {
- "host_id",
- "rtps2.sm.guidPrefix.hostId",
- FT_UINT32,
- BASE_HEX,
- NULL,
- 0,
- "The hostId component of the rtps2.sm.guidPrefix",
- HFILL }
- },
-
- { &hf_rtps_sm_app_id, {
- "appId",
- "rtps2.sm.guidPrefix.appId",
- FT_UINT32,
- BASE_HEX,
- NULL,
- 0,
- "AppId component of the rtps2.sm.guidPrefix",
- HFILL }
- },
-#if 0
- { &hf_rtps_sm_instance_id, {
- "instanceId",
- "rtps2.sm.guidPrefix.appId.instanceId",
- FT_UINT24,
- BASE_HEX,
- NULL,
- 0,
- "instanceId component of the AppId of the rtps2.sm.guidPrefix",
- HFILL }
- },
-#endif
-#if 0
- { &hf_rtps_sm_app_kind, {
- "appKind",
- "rtps2.sm.guidPrefix.appId.appKind",
- FT_UINT8,
- BASE_HEX,
- NULL,
- 0,
- "appKind component of the AppId of the rtps2.sm.guidPrefix",
- HFILL }
- },
-#endif
-
- { &hf_rtps_sm_counter, {
- "counter",
- "rtps2.sm.guidPrefix.counter",
- FT_UINT32,
- BASE_HEX,
- NULL,
- 0,
- "The counter component of the rtps2.sm.guidPrefix",
- HFILL }
- },
-
- /* Entity ID (composed as entityKey, entityKind) ----------------------- */
- { &hf_rtps_sm_entity_id, {
- "entityId",
- "rtps2.sm.entityId",
- FT_UINT32,
- BASE_HEX,
- VALS(entity_id_vals),
- 0,
- "Object entity ID as it appears in a DATA submessage (keyHashSuffix)",
- HFILL }
- },
- { &hf_rtps_sm_entity_id_key, {
- "entityKey",
- "rtps2.sm.entityId.entityKey",
- FT_UINT24,
- BASE_HEX,
- NULL,
- 0,
- "'entityKey' field of the object entity ID",
- HFILL }
- },
- { &hf_rtps_sm_entity_id_kind, {
- "entityKind",
- "rtps2.sm.entityId.entityKind",
- FT_UINT8,
- BASE_HEX,
- VALS(entity_kind_vals),
- 0,
- "'entityKind' field of the object entity ID",
- HFILL }
- },
-
- { &hf_rtps_sm_rdentity_id, {
- "readerEntityId",
- "rtps2.sm.rdEntityId",
- FT_UINT32,
- BASE_HEX,
- VALS(entity_id_vals),
- 0,
- "Reader entity ID as it appears in a submessage",
- HFILL }
- },
- { &hf_rtps_sm_rdentity_id_key, {
- "readerEntityKey",
- "rtps2.sm.rdEntityId.entityKey",
- FT_UINT24,
- BASE_HEX,
- NULL,
- 0,
- "'entityKey' field of the reader entity ID",
- HFILL }
- },
- { &hf_rtps_sm_rdentity_id_kind, {
- "readerEntityKind",
- "rtps2.sm.rdEntityId.entityKind",
- FT_UINT8,
- BASE_HEX,
- VALS(entity_kind_vals),
- 0,
- "'entityKind' field of the reader entity ID",
- HFILL }
- },
-
- { &hf_rtps_sm_wrentity_id, {
- "writerEntityId",
- "rtps2.sm.wrEntityId",
- FT_UINT32,
- BASE_HEX,
- VALS(entity_id_vals),
- 0,
- "Writer entity ID as it appears in a submessage",
- HFILL }
- },
- { &hf_rtps_sm_wrentity_id_key, {
- "writerEntityKey",
- "rtps2.sm.wrEntityId.entityKey",
- FT_UINT24,
- BASE_HEX,
- NULL,
- 0,
- "'entityKey' field of the writer entity ID",
- HFILL }
- },
- { &hf_rtps_sm_wrentity_id_kind, {
- "writerEntityKind",
- "rtps2.sm.wrEntityId.entityKind",
- FT_UINT8,
- BASE_HEX,
- VALS(entity_kind_vals),
- 0,
- "'entityKind' field of the writer entity ID",
- HFILL }
- },
-
- /* Parameter Id -------------------------------------------------------- */
- { &hf_rtps_parameter_id, {
- "parameterId",
- "rtps2.param.id",
- FT_UINT16,
- BASE_HEX,
- VALS(parameter_id_vals),
- 0,
- "Parameter Id",
- HFILL }
- },
-
- /* Parameter Length ---------------------------------------------------- */
- { &hf_rtps_parameter_length, {
- "parameterLength",
- "rtps2.param.length",
- FT_UINT16,
- BASE_DEC,
- NULL,
- 0,
- "Parameter Length",
- HFILL }
- },
-
- /* Parameter / Status Info --------------------------------------------- */
- { &hf_rtps_param_status_info, {
- "statusInfo",
- "rtps2.param.statusInfo",
- FT_UINT32,
- BASE_HEX,
- NULL,
- 0,
- "State information of the data object to which the message apply (i.e. lifecycle)",
- HFILL }
- },
-
- /* Parameter / Topic --------------------------------------------------- */
- { &hf_rtps_param_topic_name, {
- "topic",
- "rtps2.param.topicName",
- FT_STRINGZ,
- BASE_NONE,
- NULL,
- 0,
- "String representing the value value of a PID_TOPIC parameter",
- HFILL }
- },
-
- /* Parameter / Entity -------------------------------------------------- */
- { &hf_rtps_param_entity_name, {
- "entity",
- "rtps2.param.entityName",
- FT_STRINGZ,
- BASE_NONE,
- NULL,
- 0,
- "String representing the name of the entity addressed by the submessage",
- HFILL }
- },
-
-
- /* Parameter / Strength ------------------------------------------------ */
- { &hf_rtps_param_strength, {
- "strength",
- "rtps2.param.strength",
- FT_INT32,
- BASE_DEC,
- NULL,
- 0,
- "Decimal value representing the value of a PID_OWNERSHIP_STRENGTH parameter",
- HFILL }
- },
-
- /* Parameter / Type Name ----------------------------------------------- */
- { &hf_rtps_param_type_name, {
- "typeName",
- "rtps2.param.typeName",
- FT_STRINGZ,
- BASE_NONE,
- NULL,
- 0,
- "String representing the value of a PID_TYPE_NAME parameter",
- HFILL }
- },
-
- /* Parameter / User Data ----------------------------------------------- */
- { &hf_rtps_param_user_data, {
- "userData",
- "rtps2.param.userData",
- FT_BYTES,
- BASE_NONE,
- NULL,
- 0,
- "The user data sent in a PID_USER_DATA parameter",
- HFILL }
- },
-
- /* Parameter / Group Data ---------------------------------------------- */
- { &hf_rtps_param_group_data, {
- "groupData",
- "rtps2.param.groupData",
- FT_BYTES,
- BASE_NONE,
- NULL,
- 0,
- "The user data sent in a PID_GROUP_DATA parameter",
- HFILL }
- },
-
- /* Parameter / Topic Data ---------------------------------------------- */
- { &hf_rtps_param_topic_data, {
- "topicData",
- "rtps2.param.topicData",
- FT_BYTES,
- BASE_NONE,
- NULL,
- 0,
- "The user data sent in a PID_TOPIC_DATA parameter",
- HFILL }
- },
-
-
- /* Parameter / Content Filter Name ------------------------------------- */
- { &hf_rtps_param_content_filter_name, {
- "contentFilterName",
- "rtps2.param.contentFilterName",
- FT_STRINGZ,
- BASE_NONE,
- NULL,
- 0,
- "Value of the content filter name as sent in a PID_CONTENT_FILTER_PROPERTY parameter",
- HFILL }
- },
- { &hf_rtps_param_related_topic_name, {
- "relatedTopicName",
- "rtps2.param.relatedTopicName",
- FT_STRINGZ,
- BASE_NONE,
- NULL,
- 0,
- "Value of the related topic name as sent in a PID_CONTENT_FILTER_PROPERTY parameter",
- HFILL }
- },
- { &hf_rtps_param_filter_name, {
- "filterName",
- "rtps2.param.filterName",
- FT_STRINGZ,
- BASE_NONE,
- NULL,
- 0,
- "Value of the filter name as sent in a PID_CONTENT_FILTER_PROPERTY parameter",
- HFILL }
- },
-
- /* Finally the raw issue data ------------------------------------------ */
- { &hf_rtps_issue_data, {
- "serializedData",
- "rtps2.serializedData",
- FT_BYTES,
- BASE_NONE,
- NULL,
- 0,
- "The user data transferred in a ISSUE submessage",
- HFILL }
- },
-
- { &hf_rtps_participant_lease_duration,
- { "Duration", "rtps2.participant_lease_duration",
- FT_ABSOLUTE_TIME, ABSOLUTE_TIME_UTC, NULL, 0,
- "Time using the NTP standard format", HFILL }
- },
-
- { &hf_rtps_time_based_filter_minimum_separation,
- { "Minimum Separation", "rtps2.time_based_filter.minimum_separation",
- FT_ABSOLUTE_TIME, ABSOLUTE_TIME_UTC, NULL, 0,
- "Time using the NTP standard format", HFILL }
- },
-
- { &hf_rtps_deadline_period,
- { "Period", "rtps2.deadline_period",
- FT_ABSOLUTE_TIME, ABSOLUTE_TIME_UTC, NULL, 0,
- "Time using the NTP standard format", HFILL }
- },
-
- { &hf_rtps_latency_budget_duration,
- { "Duration", "rtps2.latency_budget.duration",
- FT_ABSOLUTE_TIME, ABSOLUTE_TIME_UTC, NULL, 0,
- "Time using the NTP standard format", HFILL }
- },
-
- { &hf_rtps_lifespan_duration,
- { "Duration", "rtps2.lifespan",
- FT_ABSOLUTE_TIME, ABSOLUTE_TIME_UTC, NULL, 0,
- "Time using the NTP standard format", HFILL }
- },
-
- { &hf_rtps_persistence,
- { "Persistence", "rtps2.persistence",
- FT_ABSOLUTE_TIME, ABSOLUTE_TIME_UTC, NULL, 0,
- "Time using the NTP standard format", HFILL }
- },
-
- { &hf_rtps_data_batch_timestamp,
- { "Timestamp", "rtps2.data_batch.timestamp",
- FT_ABSOLUTE_TIME, ABSOLUTE_TIME_UTC, NULL, 0,
- "Time using the NTP standard format", HFILL }
- },
-
- { &hf_rtps_participant_builtin_endpoints,
- { "BuiltIn Endpoint", "rtps.participant_builtin_endpoints",
- FT_UINT32, BASE_HEX, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_participant_manual_liveliness_count,
- { "Manual Liveliness Count", "rtps.participant_manual_liveliness_count",
- FT_UINT32, BASE_HEX, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_history_depth,
- { "Depth", "rtps.history_depth",
- FT_INT32, BASE_DEC, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_resource_limit_max_samples,
- { "Max Samples", "rtps.resource_limit.max_samples",
- FT_INT32, BASE_DEC, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_resource_limit_max_instances,
- { "Max Instances", "rtps.resource_limit.max_instances",
- FT_INT32, BASE_DEC, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_resource_limit_max_samples_per_instances,
- { "Max Samples Per Instance", "rtps.resource_limit.max_samples_per_instance",
- FT_INT32, BASE_DEC, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_filter_bitmap,
- { "Filter Bitmap", "rtps.filter_bitmap",
- FT_UINT32, BASE_HEX, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_type_checksum,
- { "Checksum", "rtps.type_checksum",
- FT_UINT32, BASE_HEX, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_queue_size,
- { "queueSize", "rtps.queue_size",
- FT_UINT32, BASE_HEX, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_param_ip_address,
- { "Address", "rtps.param.ip_address",
- FT_IPv4, BASE_NONE, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_param_port,
- { "Port", "rtps.param.port",
- FT_UINT32, BASE_HEX, NULL, 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_expects_inline_qos,
- { "Inline QoS", "rtps.expects_inline_qos",
- FT_BOOLEAN, 8, TFS(&tfs_true_false), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_presentation_coherent_access,
- { "Coherent Access", "rtps.presentation.coherent_access",
- FT_BOOLEAN, 8, TFS(&tfs_true_false), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_presentation_ordered_access,
- { "Ordered Access", "rtps.presentation.ordered_access",
- FT_BOOLEAN, 8, TFS(&tfs_true_false), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_expects_ack,
- { "expectsAck", "rtps.expects_ack",
- FT_BOOLEAN, 8, TFS(&tfs_true_false), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_disable_positive_ack,
- { "disablePositiveAcks", "rtps.disable_positive_ack",
- FT_BOOLEAN, 8, TFS(&tfs_true_false), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_reliability_kind,
- { "Kind", "rtps.reliability_kind",
- FT_UINT32, BASE_HEX, VALS(reliability_qos_vals), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_durability,
- { "Durability", "rtps.durability",
- FT_UINT32, BASE_HEX, VALS(durability_qos_vals), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_ownership,
- { "Kind", "rtps.ownership",
- FT_UINT32, BASE_HEX, VALS(ownership_qos_vals), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_presentation_access_scope,
- { "Access Scope", "rtps.presentation.access_scope",
- FT_UINT32, BASE_HEX, VALS(presentation_qos_vals), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_destination_order,
- { "Kind", "rtps.destination_order",
- FT_UINT32, BASE_HEX, VALS(destination_order_qos_vals), 0,
- NULL, HFILL }
- },
-
- { &hf_rtps_history_kind,
- { "Kind", "rtps.history.kind",
- FT_UINT32, BASE_HEX, VALS(history_qos_vals), 0,
- NULL, HFILL }
- },
- };
-
- static gint *ett[] = {
- &ett_rtps,
- &ett_rtps_default_mapping,
- &ett_rtps_proto_version,
- &ett_rtps_submessage,
- &ett_rtps_parameter_sequence,
- &ett_rtps_parameter,
- &ett_rtps_flags,
- &ett_rtps_entity,
- &ett_rtps_rdentity,
- &ett_rtps_wrentity,
- &ett_rtps_guid_prefix,
- &ett_rtps_part_message_data,
- &ett_rtps_part_message_guid,
- &ett_rtps_locator_udp_v4,
- &ett_rtps_locator,
- &ett_rtps_locator_list,
- &ett_rtps_ntp_time,
- &ett_rtps_bitmap,
- &ett_rtps_seq_string,
- &ett_rtps_seq_ulong,
- &ett_rtps_serialized_data,
- &ett_rtps_sample_info_list,
- &ett_rtps_sample_info,
- &ett_rtps_sample_batch_list,
- &ett_rtps_locator_filter_channel,
- &ett_rtps_locator_filter_locator,
- &ett_rtps_resource_limit
- };
- module_t *rtps_module;
-
- proto_rtps = proto_register_protocol(
- "Real-Time Publish-Subscribe Wire Protocol 2.x",
- "RTPS2",
- "rtps2");
- proto_register_field_array(proto_rtps, hf, array_length(hf));
- proto_register_subtree_array(ett, array_length(ett));
-
- /* Registers the control in the preference panel */
- rtps_module = prefs_register_protocol(proto_rtps, NULL);
- prefs_register_uint_preference(rtps_module, "max_batch_samples_dissected",
- "Max samples dissected for DATA_BATCH",
- "Specifies the maximum number of samples dissected in "
- "a DATA_BATCH submessage. Increasing this value may affect "
- "performances if the trace has a lot of big batched samples.",
- 10, &rtps_max_batch_samples_dissected);
-}
-
-void proto_reg_handoff_rtps2(void) {
- heur_dissector_add("udp", dissect_rtps, proto_rtps);
-}
diff --git a/epan/dissectors/packet-rtps2.h b/epan/dissectors/packet-rtps2.h
deleted file mode 100644
index 6b69385152..0000000000
--- a/epan/dissectors/packet-rtps2.h
+++ /dev/null
@@ -1,268 +0,0 @@
-/* packet-rtps2.h
- * ~~~~~~~~~~~~~~
- *
- * Routines for Real-Time Publish-Subscribe Protocol (RTPS) dissection
- *
- * Copyright 2005, Fabrizio Bertocci <fabrizio@rti.com>
- * Real-Time Innovations, Inc.
- * 385 Moffett Park Drive
- * Sunnyvale, CA 94089
- *
- * $Id$
- *
- * Wireshark - Network traffic analyzer
- * By Gerald Combs <gerald@wireshark.org>
- * Copyright 1998 Gerald Combs
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
- *
- * -------------------------------------
- *
- * This is the RTPS packet dissector for RTPS version 2.x
- *
- * RTPS protocol was initially developed by Real-Time Innovations, Inc. as wire
- * protocol for Data Distribution System, and then adopted as a standard by
- * the Object Management Group (as version 2.0).
- *
- * Additional information at:
- * Full OMG DDS Standard Specification:
- * http://www.omg.org/cgi-bin/doc?ptc/2003-07-07
- *
- * RTI DDS and RTPS information: http://www.rti.com/resources.html
- *
- */
-
-
-/* Note: This file is only included from packet-rtps2.c, so there is no risk
- * of namespace conflicts with all those macros.
- */
-
-#ifndef _TYPEDEFS_DEFINES_RTPS2_H
-#define _TYPEDEFS_DEFINES_RTPS2_H
-
-#ifdef __cplusplus
-extern "C" {
-#endif
-
-
-
-/* Traffic type */
-#define PORT_BASE (7400)
-#define PORT_METATRAFFIC_UNICAST (0)
-#define PORT_USERTRAFFIC_MULTICAST (1)
-#define PORT_METATRAFFIC_MULTICAST (2)
-#define PORT_USERTRAFFIC_UNICAST (3)
-
-/* Flags defined in the 'flag' bitmask of a submessage */
-#define FLAG_E (0x01) /* Common to all the submessages */
-#define FLAG_DATA_Q_RTPS2 (0x02)
-#define FLAG_DATA_D_RTPS2 (0x04)
-#define FLAG_DATA_H (0x08)
-#define FLAG_DATA_I (0x10)
-
-#define FLAG_DATA_FRAG_Q (0x02)
-#define FLAG_DATA_FRAG_H (0x04)
-
-
-#define FLAG_NOKEY_DATA_Q (0x02)
-#define FLAG_NOKEY_DATA_D (0x04)
-#define FLAG_NOKEY_DATA_FRAG_Q (0x02)
-#define FLAG_NOKEY_DATA_FRAG_D (0x04)
-#define FLAG_ACKNACK_F (0x02)
-
-#define FLAG_HEARTBEAT_F (0x02)
-#define FLAG_HEARTBEAT_L (0x04)
-
-#define FLAG_INFO_TS_T (0x02)
-
-#define FLAG_INFO_REPLY_IP4_M (0x02)
-
-#define FLAG_INFO_REPLY_M (0x02)
-
-#define FLAG_RTPS_DATA_Q (0x02)
-#define FLAG_RTPS_DATA_D (0x04)
-#define FLAG_RTPS_DATA_K (0x08)
-
-#define FLAG_RTPS_DATA_FRAG_Q (0x02)
-#define FLAG_RTPS_DATA_FRAG_K (0x04)
-
-#define FLAG_RTPS_DATA_BATCH_Q (0x02)
-
-#define FLAG_SAMPLE_INFO_T (0x01)
-#define FLAG_SAMPLE_INFO_Q (0x02)
-#define FLAG_SAMPLE_INFO_O (0x04)
-#define FLAG_SAMPLE_INFO_D (0x08)
-#define FLAG_SAMPLE_INFO_I (0x10)
-#define FLAG_SAMPLE_INFO_K (0x20)
-
-
-/* The following PIDs are defined since RTPS 1.0 */
-#define PID_DEFAULT_MULTICAST_LOCATOR (0x0048)
-#define PID_TRANSPORT_PRIORITY (0x0049)
-#define PID_CONTENT_FILTER_INFO (0x0055)
-#define PID_DIRECTED_WRITE (0x0057)
-#define PID_BUILTIN_ENDPOINT_SET (0x0058)
-#define PID_PROPERTY_LIST (0x0059) /* RTI DDS 4.2e and newer */
-#define PID_ENDPOINT_GUID (0x005a)
-#define PID_TYPE_MAX_SIZE_SERIALIZED (0x0060)
-#define PID_ORIGINAL_WRITER_INFO (0x0061)
-#define PID_ENTITY_NAME (0x0062)
-#define PID_KEY_HASH (0x0070)
-#define PID_STATUS_INFO (0x0071)
-
-/* Vendor-specific: RTI */
-#define PID_PRODUCT_VERSION (0x8000)
-#define PID_PLUGIN_PROMISCUITY_KIND (0x8001)
-#define PID_ENTITY_VIRTUAL_GUID (0x8002)
-#define PID_SERVICE_KIND (0x8003)
-#define PID_TYPECODE_RTPS2 (0x8004) /* Was: 0x47 in RTPS 1.2 */
-#define PID_DISABLE_POSITIVE_ACKS (0x8005)
-#define PID_LOCATOR_FILTER_LIST (0x8006)
-
-
-/* appId.appKind possible values */
-#define APPKIND_UNKNOWN (0x00)
-#define APPKIND_MANAGED_APPLICATION (0x01)
-#define APPKIND_MANAGER (0x02)
-
-
-
-/* Predefined EntityIds */
-#define ENTITYID_UNKNOWN (0x00000000)
-#define ENTITYID_PARTICIPANT (0x000001c1)
-#define ENTITYID_SEDP_BUILTIN_TOPIC_WRITER (0x000002c2) /* Was: ENTITYID_BUILTIN_TOPIC_WRITER */
-#define ENTITYID_SEDP_BUILTIN_TOPIC_READER (0x000002c7) /* Was: ENTITYID_BUILTIN_TOPIC_READER */
-#define ENTITYID_SEDP_BUILTIN_PUBLICATIONS_WRITER (0x000003c2) /* Was: ENTITYID_BUILTIN_PUBLICATIONS_WRITER */
-#define ENTITYID_SEDP_BUILTIN_PUBLICATIONS_READER (0x000003c7) /* Was: ENTITYID_BUILTIN_PUBLICATIONS_READER */
-#define ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_WRITER (0x000004c2) /* Was: ENTITYID_BUILTIN_SUBSCRIPTIONS_WRITER */
-#define ENTITYID_SEDP_BUILTIN_SUBSCRIPTIONS_READER (0x000004c7) /* Was: ENTITYID_BUILTIN_SUBSCRIPTIONS_READER */
-#define ENTITYID_SPDP_BUILTIN_PARTICIPANT_WRITER (0x000100c2) /* Was: ENTITYID_BUILTIN_SDP_PARTICIPANT_WRITER */
-#define ENTITYID_SPDP_BUILTIN_PARTICIPANT_READER (0x000100c7) /* Was: ENTITYID_BUILTIN_SDP_PARTICIPANT_READER */
-#define ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_WRITER (0x000200c2)
-#define ENTITYID_P2P_BUILTIN_PARTICIPANT_MESSAGE_READER (0x000200c7)
-
-
-/* Deprecated EntityId */
-#define ENTITYID_APPLICATIONS_WRITER (0x000001c2)
-#define ENTITYID_APPLICATIONS_READER (0x000001c7)
-#define ENTITYID_CLIENTS_WRITER (0x000005c2)
-#define ENTITYID_CLIENTS_READER (0x000005c7)
-#define ENTITYID_SERVICES_WRITER (0x000006c2)
-#define ENTITYID_SERVICES_READER (0x000006c7)
-#define ENTITYID_MANAGERS_WRITER (0x000007c2)
-#define ENTITYID_MANAGERS_READER (0x000007c7)
-#define ENTITYID_APPLICATION_SELF (0x000008c1)
-#define ENTITYID_APPLICATION_SELF_WRITER (0x000008c2)
-#define ENTITYID_APPLICATION_SELF_READER (0x000008c7)
-
-/* Predefined Entity Kind */
-#define ENTITYKIND_APPDEF_UNKNOWN (0x00)
-#define ENTITYKIND_APPDEF_PARTICIPANT (0x01)
-#define ENTITYKIND_APPDEF_WRITER_WITH_KEY (0x02)
-#define ENTITYKIND_APPDEF_WRITER_NO_KEY (0x03)
-#define ENTITYKIND_APPDEF_READER_NO_KEY (0x04)
-#define ENTITYKIND_APPDEF_READER_WITH_KEY (0x07)
-#define ENTITYKIND_BUILTIN_PARTICIPANT (0xc1)
-#define ENTITYKIND_BUILTIN_WRITER_WITH_KEY (0xc2)
-#define ENTITYKIND_BUILTIN_WRITER_NO_KEY (0xc3)
-#define ENTITYKIND_BUILTIN_READER_NO_KEY (0xc4)
-#define ENTITYKIND_BUILTIN_READER_WITH_KEY (0xc7)
-
-
-/* Submessage Type */
-#define SUBMESSAGE_PAD (0x01)
-#define SUBMESSAGE_DATA (0x02)
-#define SUBMESSAGE_NOKEY_DATA (0x03)
-#define SUBMESSAGE_ACKNACK (0x06)
-#define SUBMESSAGE_HEARTBEAT (0x07)
-#define SUBMESSAGE_GAP (0x08)
-#define SUBMESSAGE_INFO_TS (0x09)
-#define SUBMESSAGE_INFO_SRC (0x0c)
-#define SUBMESSAGE_INFO_REPLY_IP4 (0x0d)
-#define SUBMESSAGE_INFO_DST (0x0e)
-#define SUBMESSAGE_INFO_REPLY (0x0f)
-
-#define SUBMESSAGE_DATA_FRAG (0x10) /* RTPS 2.0 Only */
-#define SUBMESSAGE_NOKEY_DATA_FRAG (0x11) /* RTPS 2.0 Only */
-#define SUBMESSAGE_NACK_FRAG (0x12) /* RTPS 2.0 Only */
-#define SUBMESSAGE_HEARTBEAT_FRAG (0x13) /* RTPS 2.0 Only */
-
-#define SUBMESSAGE_RTPS_DATA_SESSION (0x14) /* RTPS 2.1 only */
-#define SUBMESSAGE_RTPS_DATA (0x15) /* RTPS 2.1 only */
-#define SUBMESSAGE_RTPS_DATA_FRAG (0x16) /* RTPS 2.1 only */
-#define SUBMESSAGE_ACKNACK_BATCH (0x17) /* RTPS 2.1 only */
-#define SUBMESSAGE_RTPS_DATA_BATCH (0x18) /* RTPS 2.1 Only */
-#define SUBMESSAGE_HEARTBEAT_BATCH (0x19) /* RTPS 2.1 only */
-#define SUBMESSAGE_ACKNACK_SESSION (0x1a) /* RTPS 2.1 only */
-#define SUBMESSAGE_HEARTBEAT_SESSION (0x1b) /* RTPS 2.1 only */
-
-/* Data encapsulation */
-#define ENCAPSULATION_CDR_BE (0x0000)
-#define ENCAPSULATION_CDR_LE (0x0001)
-#define ENCAPSULATION_PL_CDR_BE (0x0002)
-#define ENCAPSULATION_PL_CDR_LE (0x0003)
-
-/* Parameter Liveliness */
-#define LIVELINESS_AUTOMATIC (0)
-#define LIVELINESS_BY_PARTICIPANT (1)
-#define LIVELINESS_BY_TOPIC (2)
-
-/* Parameter Durability */
-#define DURABILITY_VOLATILE (0)
-#define DURABILITY_TRANSIENT_LOCAL (1)
-#define DURABILITY_TRANSIENT (2)
-#define DURABILITY_PERSISTENT (3)
-
-/* Parameter Ownership */
-#define OWNERSHIP_SHARED (0)
-#define OWNERSHIP_EXCLUSIVE (1)
-
-/* Parameter Presentation */
-#define PRESENTATION_INSTANCE (0)
-#define PRESENTATION_TOPIC (1)
-#define PRESENTATION_GROUP (2)
-
-
-#define LOCATOR_KIND_INVALID (-1)
-#define LOCATOR_KIND_RESERVED (0)
-#define LOCATOR_KIND_UDPV4 (1)
-#define LOCATOR_KIND_UDPV6 (2)
-
-/* History Kind */
-#define HISTORY_KIND_KEEP_LAST (0)
-#define HISTORY_KIND_KEEP_ALL (1)
-
-/* Reliability Values */
-#define RELIABILITY_BEST_EFFORT (1)
-#define RELIABILITY_RELIABLE (2)
-
-/* Destination Order */
-#define BY_RECEPTION_TIMESTAMP (0)
-#define BY_SOURCE_TIMESTAMP (1)
-
-
-
-/* Participant message data kind */
-#define PARTICIPANT_MESSAGE_DATA_KIND_UNKNOWN (0x00000000)
-#define PARTICIPANT_MESSAGE_DATA_KIND_AUTOMATIC_LIVELINESS_UPDATE (0x00000001)
-#define PARTICIPANT_MESSAGE_DATA_KIND_MANUAL_LIVELINESS_UPDATE (0x00000002)
-
-
-
-#ifdef __cplusplus
-} /* extern "C"*/
-#endif
-
-#endif /* _TYPEDEFS_DEFINES_RTPS2_H */
generated by cgit v1.2.1 (git 2.18.0) at 2024-06-29 03:04:46 +0000