/* packet-ieee1722.c * Routines for AVTP (Audio Video Transport Protocol) dissection * Copyright 2010, Torrey Atcitty * Dave Olsen * Levi Pearson * * Copyright 2011, Thomas Bottom * * Copyright 2016, Andreas Leibold * Dissection for the following 1722 subtypes added: * Clock Reference Format (CRF). * IEC 61883-4 MPEG-TS data transmission. * IEC 61883-6 audio/music data transmission protocol improved. * Changes to meet 1722 Draft 15 specification. * * Copyright 2017, Marouen Ghodhbane * Dissection for the 1722 Compressed Video subtype added. * CVF Format subtype supported: H264 and MJPEG * The dissection meets the 1722-2016 specification. * * Copyright 2019, Dmitry Linikov * Dissection for the 1722 Time-Sensitive and Non-Time-Sensitive * Control formats added. * ACF Message types supported: CAN, CAN_BRIEF, LIN * * Wireshark - Network traffic analyzer * By Gerald Combs * Copyright 1998 Gerald Combs * * SPDX-License-Identifier: GPL-2.0-or-later * * The 1722 Protocol specification can be found at the following: * http://grouper.ieee.org/groups/1722/ * */ #include "config.h" #include #include #include #include #include #include #include #include "packet-mp2t.h" void proto_register_1722(void); void proto_reg_handoff_1722(void); void proto_register_1722_crf(void); void proto_reg_handoff_1722_crf(void); void proto_register_1722_aaf(void); void proto_reg_handoff_1722_aaf(void); void proto_register_1722_61883(void); void proto_reg_handoff_1722_61883(void); void proto_register_1722_cvf(void); void proto_reg_handoff_1722_cvf(void); void proto_register_1722_ntscf(void); void proto_reg_handoff_1722_ntscf(void); void proto_register_1722_tscf(void); void proto_reg_handoff_1722_tscf(void); void proto_register_1722_acf(void); void proto_reg_handoff_1722_acf(void); void proto_register_1722_acf_can(void); void proto_reg_handoff_1722_acf_can(void); void proto_register_1722_acf_lin(void); void proto_reg_handoff_1722_acf_lin(void); static dissector_handle_t jpeg_handle; static dissector_handle_t h264_handle; static dissector_handle_t mp2t_handle; #define UDP_PORT_IEEE_1722 17220 /* One of two IANA registered ports */ enum IEEE_1722_TRANSPORT { IEEE_1722_TRANSPORT_ETH, IEEE_1722_TRANSPORT_UDP, }; typedef struct _ieee1722_seq_data_t { guint32 seqnum_exp; } ieee1722_seq_data_t; /**************************************************************************************************/ /* 1722 */ /* */ /**************************************************************************************************/ #define IEEE_1722_SUBTYPE_61883 0x00 #define IEEE_1722_SUBTYPE_AAF 0x02 #define IEEE_1722_SUBTYPE_CVF 0x03 #define IEEE_1722_SUBTYPE_CRF 0x04 #define IEEE_1722_SUBTYPE_TSCF 0x05 #define IEEE_1722_SUBTYPE_NTSCF 0x82 /* Bit Field Masks */ #define IEEE_1722_SV_MASK 0x80 #define IEEE_1722_VER_MASK 0x70 /**************************************************************************************************/ /* subtype IEC 61883 */ /* */ /**************************************************************************************************/ #define IEEE_1722_CIP_HEADER_SIZE 8 #define IEEE_1722_61883_TAG_NO_CIP 0x00 #define IEEE_1722_61883_TAG_CIP 0x40 #define IEEE_1722_61883_CHANNEL_AVTP 31 #define IEEE_1722_61883_SID_AVTP 63 #define IEEE_1722_61883_4_LEN_SOURCE_PACKET 192 #define IEEE_1722_61883_4_LEN_SP_TIMESTAMP 4 #define IEEE_1722_61883_4 0x20 #define IEEE_1722_61883_6 0x10 /* Bit Field Masks */ #define IEEE_1722_MR_MASK 0x08 #define IEEE_1722_GV_MASK 0x02 #define IEEE_1722_TV_MASK 0x01 #define IEEE_1722_TU_MASK 0x01 #define IEEE_1722_TAG_MASK 0xc0 #define IEEE_1722_CHANNEL_MASK 0x3f #define IEEE_1722_TCODE_MASK 0xf0 #define IEEE_1722_SY_MASK 0x0f #define IEEE_1722_QI1_MASK 0xc0 #define IEEE_1722_SID_MASK 0x3f #define IEEE_1722_FN_MASK 0xc0 #define IEEE_1722_QPC_MASK 0x38 #define IEEE_1722_SPH_MASK 0x04 #define IEEE_1722_QI2_MASK 0xc0 #define IEEE_1722_FMT_MASK 0x3f #define IEEE_1722_FDF_TSF_MASK 0x80 #define IEEE_1722_FDF_MASK 0xf8 /**************************************************************************************************/ /* subtype AAF */ /* */ /**************************************************************************************************/ #define IEEE_1722_AAF_FORMAT_USER 0x00 #define IEEE_1722_AAF_FORMAT_FLOAT_32_BIT 0x01 #define IEEE_1722_AAF_FORMAT_INT_32_BIT 0x02 #define IEEE_1722_AAF_FORMAT_INT_24_BIT 0x03 #define IEEE_1722_AAF_FORMAT_INT_16_BIT 0x04 #define IEEE_1722_AAF_FORMAT_AES3_32_BIT 0x05 /* Bit Field Masks */ #define IEEE_1722_MR_MASK 0x08 #define IEEE_1722_TV_MASK 0x01 #define IEEE_1722_SEQ_NUM_MASK 0x00 #define IEEE_1722_TU_MASK 0x01 #define IEEE_1722_STREAM_ID_MASK 0x00 #define IEEE_1722_TIMESTAMP_MASK 0x00 #define IEEE_1722_FORMAT_MASK 0x00 #define IEEE_1722_NOM_SAMPLE_RATE_MASK 0xf000 #define IEEE_1722_CHANNEL_PER_FRAME_MASK 0x03ff #define IEEE_1722_BIT_DEPTH_MASK 0x00 #define IEEE_1722_AES3_DATA_TYPE_H_MASK 0x00 #define IEEE_1722_STREAM_DATA_LENGTH_MASK 0x00 #define IEEE_1722_AES3_DATA_TYPE_REFERENCE_MASK 0xe0 #define IEEE_1722_SP_MASK 0x10 #define IEEE_1722_EVT_MASK 0x0f #define IEEE_1722_AES3_DATA_TYPE_L_MASK 0x00 #define IEEE_1722_DATA_MASK 0x00 #define IEEE_1722_SAMPLE_MASK 0x00 /**************************************************************************************************/ /* subtype CVF */ /* */ /**************************************************************************************************/ #define IEEE_1722_CVF_FORMAT_RFC 0x02 #define IEEE_1722_CVF_FORMAT_SUBTYPE_MJPEG 0x00 #define IEEE_1722_CVF_FORMAT_SUBTYPE_H264 0x01 #define IEEE_1722_CVF_FORMAT_SUBTYPE_JPEG2000 0x02 /* Bit Field Masks */ #define IEEE_1722_MR_MASK 0x08 #define IEEE_1722_TV_MASK 0x01 #define IEEE_1722_SEQ_NUM_MASK 0x00 #define IEEE_1722_TU_MASK 0x01 #define IEEE_1722_STREAM_ID_MASK 0x00 #define IEEE_1722_TIMESTAMP_MASK 0x00 #define IEEE_1722_FORMAT_MASK 0x00 #define IEEE_1722_FORMAT_SUBTYPE_MASK 0x00 #define IEEE_1722_CVF_H264_TIMESTAMP_MASK 0x00 #define IEEE_1722_H264_PTV_MASK 0x20 #define IEEE_1722_MARKER_BIT_MASK 0x10 #define IEEE_1722_EVT_MASK 0x0f /**************************************************************************************************/ /* subtype CRF */ /* */ /**************************************************************************************************/ #define IEEE_1722_CRF_TIMESTAMP_SIZE 8 /* size of the CRF timestamp in bytes */ /* Bit Field Masks */ #define IEEE_1722_MR_MASK 0x08 #define IEEE_1722_FS_MASK 0x02 #define IEEE_1722_TU_MASK 0x01 #define IEEE_1722_PULL_MASK 0xe0000000 #define IEEE_1722_BASE_FREQUENCY_MASK 0x1fffffff /**************************************************************************************************/ /* subtype NTSCF */ /* */ /**************************************************************************************************/ #define IEEE_1722_NTSCF_HEADER_SIZE 12 /* including common header */ /* Bit Field Masks */ #define IEEE_1722_NTSCF_R_MASK 0x800 #define IEEE_1722_NTSCF_DATA_LENGTH_MASK 0x7ff #define IEEE_1722_NTSCF_SEQ_NUM_MASK 0xff #define IEEE_1722_NTSCF_STREAM_ID_MASK 0x00 /**************************************************************************************************/ /* subtype TSCF */ /* */ /**************************************************************************************************/ #define IEEE_1722_TSCF_HEADER_SIZE 24 /* including common header */ /* Bit Field Masks */ #define IEEE_1722_TSCF_MR_MASK 0x08 #define IEEE_1722_TSCF_RSV1_MASK 0x06 #define IEEE_1722_TSCF_TV_MASK 0x01 #define IEEE_1722_TSCF_SEQNUM_MASK 0x00 #define IEEE_1722_TSCF_RSV2_MASK 0xFE #define IEEE_1722_TSCF_TU_MASK 0x01 #define IEEE_1722_TSCF_STREAM_ID_MASK 0x00 #define IEEE_1722_TSCF_AVTP_TIMESTAMP_MASK 0x00 #define IEEE_1722_TSCF_RSV3_MASK 0x00 #define IEEE_1722_TSCF_DATA_LENGTH_MASK 0x00 #define IEEE_1722_TSCF_RSV4_MASK 0x00 /**************************************************************************************************/ /* AVTP Control Format (ACF) Message Header */ /* */ /**************************************************************************************************/ #define IEEE_1722_ACF_HEADER_SIZE 2 /* ACF message types */ #define IEEE_1722_ACF_TYPE_FLEXRAY 0x00 #define IEEE_1722_ACF_TYPE_CAN 0x01 #define IEEE_1722_ACF_TYPE_CAN_BRIEF 0x02 #define IEEE_1722_ACF_TYPE_LIN 0x03 #define IEEE_1722_ACF_TYPE_MOST 0x04 #define IEEE_1722_ACF_TYPE_GPC 0x05 #define IEEE_1722_ACF_TYPE_SERIAL 0x06 #define IEEE_1722_ACF_TYPE_PARALLEL 0x07 #define IEEE_1722_ACF_TYPE_SENSOR 0x08 #define IEEE_1722_ACF_TYPE_SENSOR_BRIEF 0x09 #define IEEE_1722_ACF_TYPE_AECP 0x0A #define IEEE_1722_ACF_TYPE_ANCILLARY 0x0B #define IEEE_1722_ACF_TYPE_USER0 0x78 #define IEEE_1722_ACF_TYPE_USER1 0x79 #define IEEE_1722_ACF_TYPE_USER2 0x7A #define IEEE_1722_ACF_TYPE_USER3 0x7B #define IEEE_1722_ACF_TYPE_USER4 0x7C #define IEEE_1722_ACF_TYPE_USER5 0x7D #define IEEE_1722_ACF_TYPE_USER6 0x7E #define IEEE_1722_ACF_TYPE_USER7 0x7F /* Bit Field Masks */ #define IEEE_1722_ACF_MSG_TYPE_MASK 0xFE00 #define IEEE_1722_ACF_MSG_LENGTH_MASK 0x01FF /**************************************************************************************************/ /* ACF CAN Message */ /* */ /**************************************************************************************************/ #define IEEE_1722_ACF_CAN_BRIEF_HEADER_SIZE 6 #define IEEE_1722_ACF_CAN_HEADER_SIZE 14 /* Bit Field Masks */ #define IEEE_1722_ACF_CAN_PAD_MASK 0xC0u #define IEEE_1722_ACF_CAN_FLAGS_MASK 0x3Fu #define IEEE_1722_ACF_CAN_MTV_MASK 0x20u #define IEEE_1722_ACF_CAN_RTR_MASK 0x10u #define IEEE_1722_ACF_CAN_EFF_MASK 0x08u #define IEEE_1722_ACF_CAN_BRS_MASK 0x04u #define IEEE_1722_ACF_CAN_FDF_MASK 0x02u #define IEEE_1722_ACF_CAN_ESI_MASK 0x01u #define IEEE_1722_ACF_CAN_RSV1_MASK 0xE0u #define IEEE_1722_ACF_CAN_BUS_ID_MASK 0x1Fu #define IEEE_1722_ACF_CAN_MSG_TIMESTAMP_MASK 0x00u #define IEEE_1722_ACF_CAN_RSV2_MASK 0xE0000000u #define IEEE_1722_ACF_CAN_IDENTIFIER_MASK 0x1FFFFFFFu #define IEEE_1722_ACF_CAN_11BIT_ID_MASK 0x7FFu /* Definitions to forge socketcan frame from acf-can message */ #define SOCKETCAN_HEADER_SIZE 8 #define SOCKETCAN_PAYLOAD_SIZE 8 #define SOCKETCANFD_PAYLOAD_SIZE 64 #define SOCKETCAN_FRAME_SIZE (SOCKETCAN_HEADER_SIZE + SOCKETCAN_PAYLOAD_SIZE) #define SOCKETCANFD_FRAME_SIZE (SOCKETCAN_HEADER_SIZE + SOCKETCANFD_PAYLOAD_SIZE) #define SOCKETCAN_MAX_FRAME_SIZE SOCKETCANFD_FRAME_SIZE #define SOCKETCAN_BRS_FLAG 0x01 #define SOCKETCAN_ESI_FLAG 0x02 /**************************************************************************************************/ /* ACF LIN Message */ /* */ /**************************************************************************************************/ #define IEEE_1722_ACF_LIN_HEADER_SIZE 10 /* Bit Field Masks */ #define IEEE_1722_ACF_LIN_PAD_MASK 0xC0 #define IEEE_1722_ACF_LIN_MTV_MASK 0x20 #define IEEE_1722_ACF_LIN_BUS_ID_MASK 0x1F #define IEEE_1722_ACF_LIN_IDENTIFIER_MASK 0x00 #define IEEE_1722_ACF_LIN_MSG_TIMESTAMP_MASK 0x00 /**************************************************************************************************/ /* 1722 */ /* */ /**************************************************************************************************/ static const range_string subtype_range_rvals[] = { { 0, 0, "IEC 61883/IIDC Format" }, { 1, 1, "MMA Streams" }, { 2, 2, "AVTP Audio Format" }, { 3, 3, "Compressed Video Format" }, { 4, 4, "Clock Reference Format" }, { 5, 5, "Time Synchronous Control Format" }, { 6, 6, "SDI Video Format" }, { 7, 7, "Raw Video Format" }, { 8, 0x6d, "Reserved for future protocols" }, { 0x6e, 0x6e, "AES Encrypted Format Continuous" }, { 0x6f, 0x6f, "Vendor Specific Format Stream" }, { 0x70, 0x7e, "Reserved for future protocols" }, { 0x7f, 0x7f, "Experimental Format Stream" }, { 0x80, 0x81, "Reserved for future protocols" }, { 0x82, 0x82, "Non Time Synchronous Control Format" }, { 0x83, 0xeb, "Reserved for future protocols" }, { 0xec, 0xec, "ECC Signed Control Format" }, { 0xed, 0xed, "ECC Encrypted Control Format" }, { 0xee, 0xee, "AES Encrypted Format Discrete" }, { 0xef, 0xf9, "Reserved for future protocols" }, { 0xfa, 0xfa, "AVDECC Discovery Protocol" }, { 0xfb, 0xfb, "AVDECC Enumeration and Control Protocol" }, { 0xfc, 0xfc, "AVDECC Connection Management Protocol" }, { 0xfd, 0xfd, "Reserved for future protocols" }, { 0xfe, 0xfe, "MAAP" }, { 0xff, 0xff, "Experimental Format Control" }, { 0, 0, NULL } }; /* Initialize the protocol and registered fields */ static int proto_1722 = -1; static int hf_1722_encap_seqnum = -1; static int hf_1722_subtype = -1; static int hf_1722_svfield = -1; static int hf_1722_verfield = -1; /* Initialize the subtree pointers */ static int ett_1722 = -1; static expert_field ei_1722_encap_seqnum_dup = EI_INIT; static expert_field ei_1722_encap_seqnum_ooo = EI_INIT; static dissector_table_t avb_dissector_table; /**************************************************************************************************/ /* subtype IEC 61883 */ /* */ /**************************************************************************************************/ static const value_string tag_vals [] = { {0, "No CIP header included"}, {1, "CIP header included"}, {2, "Reserved by IEEE 1394.1 clock adjustment"}, {3, "Global asynchronous stream packet format"}, {0, NULL} }; static const range_string format_rvals [] = { {0, 0, "DVCR transmission"}, {1, 0x0f, "Reserved"}, {IEEE_1722_61883_4, IEEE_1722_61883_4, "IEC 61883-4: MPEG2-TS data transmission"}, {0x11, 0x1d, "Reserved"}, {0x1e, 0x1e, "Free (vendor unique)"}, {0x1f, 0x1f, "Reserved"}, {IEEE_1722_61883_6, IEEE_1722_61883_6, "IEC 61883-6: Audio and music transmission"}, {0x21, 0x21, "ITU-R B0.1294 System B transmission"}, {0x22, 0x2d, "Reserved"}, {0x3e, 0x3e, "Free (vendor unique)"}, {0x3f, 0x3f, "No data"}, {0, 0, NULL} }; static const value_string fraction_number_vals [] = { {0, "Not divided"}, {1, "Divided into 2 datablocks"}, {2, "Divided into 4 datablocks"}, {3, "Divided into 8 datablocks"}, {0, NULL} }; static const range_string fdf_rvals [] = { {0x00, 0x07, "Basic format for AM824"}, {0x08, 0x0f, "Basic format for AM824. Transmission rate may be controlled by an AV/C command set"}, {0x10, 0x17, "Basic format for 24-bit*4 audio pack"}, {0x18, 0x1f, "Reserved"}, {0x20, 0x27, "Basic format for 32-bit floating-point data"}, {0x28, 0x2f, "Reserved"}, {0x30, 0x37, "Basic format for 32-bit generic data"}, {0x38, 0x3f, "Reserved"}, {0x40, 0xfe, "Reserved"}, {0xff, 0xff, "Packet for NO-DATA"}, {0, 0, NULL} }; static const range_string syt_rvals [] = { {0x0000, 0x0bff, "Timestamp"}, {0x0c00, 0x0fff, "Reserved"}, {0x1000, 0x1bff, "Timestamp"}, {0x1c00, 0x1fff, "Reserved"}, {0x2000, 0x2bff, "Timestamp"}, {0x2c00, 0x2fff, "Reserved"}, {0x3000, 0x3bff, "Timestamp"}, {0x3c00, 0x3fff, "Reserved"}, {0x4000, 0x4bff, "Timestamp"}, {0x4c00, 0x4fff, "Reserved"}, {0x5000, 0x5bff, "Timestamp"}, {0x5c00, 0x5fff, "Reserved"}, {0x6000, 0x6bff, "Timestamp"}, {0x6c00, 0x6fff, "Reserved"}, {0x7000, 0x7bff, "Timestamp"}, {0x7c00, 0x7fff, "Reserved"}, {0x8000, 0x8bff, "Timestamp"}, {0x8c00, 0x8fff, "Reserved"}, {0x9000, 0x9bff, "Timestamp"}, {0x9c00, 0x9fff, "Reserved"}, {0xa000, 0xabff, "Timestamp"}, {0xac00, 0xafff, "Reserved"}, {0xb000, 0xbbff, "Timestamp"}, {0xbc00, 0xbfff, "Reserved"}, {0xc000, 0xcbff, "Timestamp"}, {0xcc00, 0xcfff, "Reserved"}, {0xd000, 0xdbff, "Timestamp"}, {0xdc00, 0xdfff, "Reserved"}, {0xe000, 0xebff, "Timestamp"}, {0xec00, 0xefff, "Reserved"}, {0xf000, 0xfbff, "Timestamp"}, {0xfc00, 0xfffe, "Reserved"}, {0xffff, 0xffff, "No information"}, {0, 0, NULL} }; /* Initialize the protocol and registered fields */ static int proto_1722_61883 = -1; static int hf_1722_61883_mrfield = -1; static int hf_1722_61883_gvfield = -1; static int hf_1722_61883_tvfield = -1; static int hf_1722_61883_seqnum = -1; static int hf_1722_61883_tufield = -1; static int hf_1722_61883_stream_id = -1; static int hf_1722_61883_avtp_timestamp = -1; static int hf_1722_61883_gateway_info = -1; static int hf_1722_61883_stream_data_length = -1; static int hf_1722_61883_tag = -1; static int hf_1722_61883_channel = -1; static int hf_1722_61883_tcode = -1; static int hf_1722_61883_sy = -1; static int hf_1722_61883_cip_qi1 = -1; static int hf_1722_61883_cip_sid = -1; static int hf_1722_61883_cip_dbs = -1; static int hf_1722_61883_cip_fn = -1; static int hf_1722_61883_cip_qpc = -1; static int hf_1722_61883_cip_sph = -1; static int hf_1722_61883_cip_dbc = -1; static int hf_1722_61883_cip_qi2 = -1; static int hf_1722_61883_cip_fmt = -1; static int hf_1722_61883_cip_fdf_no_syt = -1; static int hf_1722_61883_cip_fdf_tsf = -1; static int hf_1722_61883_cip_fdf = -1; static int hf_1722_61883_cip_syt = -1; static int hf_1722_61883_audio_data = -1; static int hf_1722_61883_label = -1; static int hf_1722_61883_sample = -1; static int hf_1722_61883_video_data = -1; static int hf_1722_61883_source_packet_header_timestamp = -1; /* Initialize the subtree pointers */ static int ett_1722_61883 = -1; static int ett_1722_61883_audio = -1; static int ett_1722_61883_sample = -1; static int ett_1722_61883_video = -1; /* Initialize expert fields */ static expert_field ei_1722_61883_incorrect_tag = EI_INIT; static expert_field ei_1722_61883_incorrect_tcode = EI_INIT; static expert_field ei_1722_61883_incorrect_qi1 = EI_INIT; static expert_field ei_1722_61883_incorrect_qpc = EI_INIT; static expert_field ei_1722_61883_incorrect_qi2 = EI_INIT; static expert_field ei_1722_61883_unknown_format = EI_INIT; static expert_field ei_1722_61883_incorrect_channel_sid = EI_INIT; static expert_field ei_1722_61883_incorrect_datalen = EI_INIT; static expert_field ei_1722_61883_4_incorrect_cip_fn = EI_INIT; static expert_field ei_1722_61883_4_incorrect_cip_dbs = EI_INIT; static expert_field ei_1722_61883_4_incorrect_cip_sph = EI_INIT; static expert_field ei_1722_61883_6_incorrect_cip_fn = EI_INIT; static expert_field ei_1722_61883_6_incorrect_cip_sph = EI_INIT; static expert_field ei_1722_61883_incorrect_cip_fdf = EI_INIT; /**************************************************************************************************/ /* subtype AAF */ /* */ /**************************************************************************************************/ static const range_string aaf_format_range_rvals [] = { {0, 0, "User specified"}, {1, 1, "32bit floating point"}, {2, 2, "32bit integer"}, {3, 3, "24bit integer"}, {4, 4, "16bit integer"}, {5, 5, "32bit AES3 format"}, {6, 0xff, "Reserved"}, {0, 0, NULL} }; static const range_string aaf_nominal_sample_rate_range_rvals [] = { {0, 0, "User specified"}, {1, 1, "8kHz"}, {2, 2, "16kHz"}, {3, 3, "32kHz"}, {4, 4, "44.1kHz"}, {5, 5, "48kHz"}, {6, 6, "88.2kHz"}, {7, 7, "96kHz"}, {8, 8, "176.4kHz"}, {9, 9, "192kHz"}, {0xa, 0xa, "24kHz"}, {0xb, 0xf, "Reserved"}, {0, 0, NULL} }; static const value_string aaf_sparse_timestamp_vals [] = { {0, "Normal operation, timestamp in every AAF AVTPDU"}, {1, "Sparse mode, timestamp in every eighth AAF AVTPDU"}, {0, NULL} }; /* Initialize the protocol and registered fields */ static int proto_1722_aaf = -1; static int hf_1722_aaf_mrfield = -1; static int hf_1722_aaf_tvfield = -1; static int hf_1722_aaf_seqnum = -1; static int hf_1722_aaf_tufield = -1; static int hf_1722_aaf_stream_id = -1; static int hf_1722_aaf_avtp_timestamp = -1; static int hf_1722_aaf_format = -1; static int hf_1722_aaf_nominal_sample_rate = -1; static int hf_1722_aaf_bit_depth = -1; static int hf_1722_aaf_stream_data_length = -1; static int hf_1722_aaf_sparse_timestamp = -1; static int hf_1722_aaf_evtfield = -1; static int hf_1722_aaf_channels_per_frame = -1; static int hf_1722_aaf_data = -1; static int hf_1722_aaf_sample = -1; /* Initialize the subtree pointers */ static int ett_1722_aaf = -1; static int ett_1722_aaf_audio = -1; static int ett_1722_aaf_sample = -1; /* Initialize expert fields */ static expert_field ei_aaf_sample_width = EI_INIT; static expert_field ei_aaf_reserved_format = EI_INIT; static expert_field ei_aaf_aes3_format = EI_INIT; static expert_field ei_aaf_channels_per_frame = EI_INIT; static expert_field ei_aaf_incorrect_bit_depth = EI_INIT; /**************************************************************************************************/ /* subtype CRF */ /* */ /**************************************************************************************************/ static const range_string crf_pull_range_rvals [] = { {0, 0, "[1.0]"}, {1, 1, "[1/1.001]"}, {2, 2, "[1.001]"}, {3, 3, "[24/25]"}, {4, 4, "[25/24]"}, {5, 5, "[1/8]"}, {6, 7, "Reserved"}, {0, 0, NULL} }; static const range_string crf_type_range_rvals [] = { {0, 0, "User Specified"}, {1, 1, "Audio Sample Timestamp"}, {2, 2, "Video Frame Sync Timestamp"}, {3, 3, "Video Line Sync Timestamp"}, {4, 4, "Machine Cycle Timestamp"}, {5, 0xff, "Reserved"}, {0, 0, NULL} }; /* Initialize the protocol and registered fields */ static int proto_1722_crf = -1; static int hf_1722_crf_mrfield = -1; static int hf_1722_crf_fsfield = -1; static int hf_1722_crf_tufield = -1; static int hf_1722_crf_seqnum = -1; static int hf_1722_crf_type = -1; static int hf_1722_crf_stream_id = -1; static int hf_1722_crf_pull = -1; static int hf_1722_crf_base_frequency = -1; static int hf_1722_crf_data_length = -1; static int hf_1722_crf_timestamp_interval = -1; static int hf_1722_crf_timestamp_data = -1; static int hf_1722_crf_timestamp = -1; /* Initialize the subtree pointers */ static int ett_1722_crf = -1; static int ett_1722_crf_timestamp = -1; /* Initialize expert fields */ static expert_field ei_crf_datalen = EI_INIT; /**************************************************************************************************/ /* subtype CVF */ /* */ /**************************************************************************************************/ static const range_string cvf_format_range_rvals [] = { {0, 1, "Reserved"}, {2, 2, "RFC payload type"}, {3, 0xff, "Reserved"}, {0, 0, NULL} }; static const range_string cvf_format_subtype_range_rvals [] = { {0, 0, "MJPEG Format (RFC 2435)"}, {1, 1, "H.264 Format (RFC 6184)"}, {2, 2, "JPEG 2000 Video (RFC 5371)"}, {3, 0xff, "Reserved"}, {0, 0, NULL} }; /* Initialize the protocol and registered fields */ static int proto_1722_cvf = -1; static int hf_1722_cvf_mrfield = -1; static int hf_1722_cvf_tvfield = -1; static int hf_1722_cvf_seqnum = -1; static int hf_1722_cvf_tufield = -1; static int hf_1722_cvf_stream_id = -1; static int hf_1722_cvf_avtp_timestamp = -1; static int hf_1722_cvf_format = -1; static int hf_1722_cvf_format_subtype = -1; static int hf_1722_cvf_stream_data_length = -1; static int hf_1722_cvf_evtfield = -1; static int hf_1722_cvf_marker_bit = -1; static int hf_1722_cvf_h264_ptvfield = -1; static int hf_1722_cvf_h264_timestamp = -1; /* Initialize the subtree pointers */ static int ett_1722_cvf = -1; /* Initialize expert fields */ static expert_field ei_cvf_jpeg2000_format = EI_INIT; static expert_field ei_cvf_reserved_format = EI_INIT; static expert_field ei_cvf_invalid_data_length = EI_INIT; /**************************************************************************************************/ /* subtype NTSCF */ /* */ /**************************************************************************************************/ /* Initialize the protocol and registered fields */ static int proto_1722_ntscf = -1; static int hf_1722_ntscf_rfield = -1; static int hf_1722_ntscf_data_length = -1; static int hf_1722_ntscf_seqnum = -1; static int hf_1722_ntscf_stream_id = -1; /* Initialize the subtree pointers */ static int ett_1722_ntscf = -1; /* Initialize expert fields */ static expert_field ei_1722_ntscf_no_space_for_header = EI_INIT; static expert_field ei_1722_ntscf_invalid_data_length = EI_INIT; /**************************************************************************************************/ /* subtype TSCF */ /* */ /**************************************************************************************************/ /* Initialize the protocol and registered fields */ static int proto_1722_tscf = -1; static int hf_1722_tscf_mr = -1; static int hf_1722_tscf_rsv1 = -1; static int hf_1722_tscf_tv = -1; static int hf_1722_tscf_seqnum = -1; static int hf_1722_tscf_rsv2 = -1; static int hf_1722_tscf_tu = -1; static int hf_1722_tscf_stream_id = -1; static int hf_1722_tscf_avtp_timestamp = -1; static int hf_1722_tscf_rsv3 = -1; static int hf_1722_tscf_data_length = -1; static int hf_1722_tscf_rsv4 = -1; /* Initialize the subtree pointers */ static int ett_1722_tscf = -1; static int ett_1722_tscf_flags = -1; static int ett_1722_tscf_tu = -1; /* Initialize expert fields */ static expert_field ei_1722_tscf_no_space_for_header = EI_INIT; static expert_field ei_1722_tscf_invalid_data_length = EI_INIT; /**************************************************************************************************/ /* AVTP Control Format (ACF) Message Header */ /* */ /**************************************************************************************************/ static const range_string acf_msg_type_range_rvals [] = { {0x00, 0x00, "FlexRay"}, {0x01, 0x01, "CAN"}, {0x02, 0x02, "CAN Brief"}, {0x03, 0x03, "LIN"}, {0x04, 0x04, "MOST"}, {0x05, 0x05, "General purpose control"}, {0x06, 0x06, "Serial port"}, {0x07, 0x07, "Parallel port"}, {0x08, 0x08, "Analog sensor"}, {0x09, 0x09, "Abbreviated sensor"}, {0x0A, 0x0A, "IEEE Std 1722.1 AECP"}, {0x0B, 0x0B, "Video ancillary data"}, {0x0C, 0x77, "Reserved"}, {0x78, 0x7F, "User-defined"}, {0, 0, NULL} }; /* Initialize the protocol and registered fields */ static int proto_1722_acf = -1; static int hf_1722_acf_msg_type = -1; static int hf_1722_acf_msg_length = -1; /* Initialize the subtree pointers */ static int ett_1722_acf = -1; static int ett_1722_acf_header = -1; /* Initialize expert fields */ static expert_field ei_1722_acf_invalid_msg_length = EI_INIT; static expert_field ei_1722_acf_message_is_cropped = EI_INIT; /* Dissector handles */ static dissector_handle_t avb1722_acf_handle; static dissector_table_t avb1722_acf_dissector_table; /**************************************************************************************************/ /* ACF CAN Message */ /* */ /**************************************************************************************************/ typedef struct { guint32 id; guint32 bus_id; guint datalen; gboolean is_fd; gboolean is_xtd; gboolean is_rtr; gboolean is_brs; gboolean is_esi; } acf_can_t; /* Initialize the protocol and registered fields */ static int proto_1722_acf_can = -1; static int hf_1722_can_flags = -1; static int hf_1722_can_pad = -1; static int hf_1722_can_len = -1; static int hf_1722_can_mtvfield = -1; static int hf_1722_can_rtrfield = -1; static int hf_1722_can_efffield = -1; static int hf_1722_can_brsfield = -1; static int hf_1722_can_fdffield = -1; static int hf_1722_can_esifield = -1; static int hf_1722_can_rsv1 = -1; static int hf_1722_can_bus_id = -1; static int hf_1722_can_message_timestamp = -1; static int hf_1722_can_rsv2 = -1; static int hf_1722_can_identifier = -1; static int hf_1722_can_padding = -1; /* Initialize the subtree pointers */ static int ett_can = -1; static int ett_1722_can = -1; static int ett_1722_can_flags = -1; static int ett_1722_can_bus_id = -1; static int ett_1722_can_msg_id = -1; /* Initialize expert fields */ static expert_field ei_1722_can_header_cropped = EI_INIT; static expert_field ei_1722_can_invalid_message_id = EI_INIT; static expert_field ei_1722_can_invalid_payload_length = EI_INIT; static expert_field ei_1722_canfd_invalid_payload_length = EI_INIT; /* Dissector handles */ static dissector_handle_t avb1722_can_brief_handle; static dissector_handle_t avb1722_can_handle; static int proto_can = -1; static int proto_canfd = -1; static gboolean can_heuristic_first = FALSE; /**************************************************************************************************/ /* ACF LIN Message */ /* */ /**************************************************************************************************/ /* Initialize the protocol and registered fields */ static int proto_1722_acf_lin = -1; static int hf_1722_lin_pad = -1; static int hf_1722_lin_mtv = -1; static int hf_1722_lin_bus_id = -1; static int hf_1722_lin_identifier = -1; static int hf_1722_lin_message_timestamp = -1; static int hf_1722_lin_padding = -1; /* Initialize the subtree pointers */ static int ett_1722_lin = -1; static int ett_1722_lin_flags = -1; /* Initialize expert fields */ static expert_field ei_1722_lin_header_cropped = EI_INIT; static expert_field ei_1722_lin_invalid_payload_length = EI_INIT; static dissector_table_t avb1722_acf_lin_dissector_table; /**************************************************************************************************/ /* 1722 dissector implementation */ /* */ /**************************************************************************************************/ static guint32 get_seqnum_exp_1722_udp(packet_info *pinfo, const guint32 seqnum) { conversation_t *conv; ieee1722_seq_data_t *conv_seq_data, *p_seq_data; if (!PINFO_FD_VISITED(pinfo)) { conv = find_or_create_conversation(pinfo); conv_seq_data = (ieee1722_seq_data_t *)conversation_get_proto_data(conv, proto_1722); if (conv_seq_data == NULL) { conv_seq_data = wmem_new(wmem_file_scope(), ieee1722_seq_data_t); conv_seq_data->seqnum_exp = seqnum; conversation_add_proto_data(conv, proto_1722, conv_seq_data); } else { conv_seq_data->seqnum_exp++; } p_seq_data = wmem_new(wmem_file_scope(), ieee1722_seq_data_t); p_seq_data->seqnum_exp = conv_seq_data->seqnum_exp; p_add_proto_data(wmem_file_scope(), pinfo, proto_1722, 0, p_seq_data); } else { p_seq_data = (ieee1722_seq_data_t *)p_get_proto_data(wmem_file_scope(), pinfo, proto_1722, 0); } DISSECTOR_ASSERT(p_seq_data != NULL); return p_seq_data->seqnum_exp; } static int dissect_1722_common(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, enum IEEE_1722_TRANSPORT transport) { tvbuff_t *next_tvb; proto_item *ti; proto_tree *ieee1722_tree; guint32 encap_seqnum, encap_seqnum_exp; guint subtype = 0; gint offset = 0; int dissected_size; int * const fields[] = { &hf_1722_svfield, &hf_1722_verfield, NULL }; col_set_str(pinfo->cinfo, COL_PROTOCOL, "IEEE1722"); col_set_str(pinfo->cinfo, COL_INFO, "Audio Video Transport Protocol"); ti = proto_tree_add_item(tree, proto_1722, tvb, 0, -1, ENC_NA); ieee1722_tree = proto_item_add_subtree(ti, ett_1722); if (transport == IEEE_1722_TRANSPORT_UDP) { /* IEEE 1722-2016 Annex J IP Encapsulation */ ti = proto_tree_add_item_ret_uint(ieee1722_tree, hf_1722_encap_seqnum, tvb, offset, 4, ENC_BIG_ENDIAN, &encap_seqnum); encap_seqnum_exp = get_seqnum_exp_1722_udp(pinfo, encap_seqnum); if (encap_seqnum != encap_seqnum_exp) { if ((encap_seqnum + 1) == encap_seqnum_exp) { expert_add_info(pinfo, ti, &ei_1722_encap_seqnum_dup); } else { expert_add_info(pinfo, ti, &ei_1722_encap_seqnum_ooo); } } offset += 4; next_tvb = tvb_new_subset_remaining(tvb, offset); } else { next_tvb = tvb; } proto_tree_add_item_ret_uint(ieee1722_tree, hf_1722_subtype, tvb, offset, 1, ENC_BIG_ENDIAN, &subtype); offset += 1; proto_tree_add_bitmask_list(ieee1722_tree, tvb, offset, 1, fields, ENC_NA); /* call any registered subtype dissectors which use only the common AVTPDU (e.g. 1722.1, MAAP, 61883, AAF, CRF or CVF) */ dissected_size = dissector_try_uint(avb_dissector_table, subtype, next_tvb, pinfo, tree); if (dissected_size > 0) { return dissected_size; } call_data_dissector(next_tvb, pinfo, ieee1722_tree); return tvb_captured_length(tvb); } static int dissect_1722_eth(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_) { return dissect_1722_common(tvb, pinfo, tree, IEEE_1722_TRANSPORT_ETH); } static int dissect_1722_udp(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_) { return dissect_1722_common(tvb, pinfo, tree, IEEE_1722_TRANSPORT_UDP); } /* Register the protocol with Wireshark */ void proto_register_1722(void) { static hf_register_info hf[] = { { &hf_1722_encap_seqnum, { "Encapsulation Sequence Number", "ieee1722.encapsulation_sequence_num", FT_UINT32, BASE_HEX, NULL, 0x00, "Sequence number incremented for each AVTPDU on a 5-tuple", HFILL } }, { &hf_1722_subtype, { "AVTP Subtype", "ieee1722.subtype", FT_UINT8, BASE_HEX | BASE_RANGE_STRING, RVALS(subtype_range_rvals), 0x0, NULL, HFILL } }, { &hf_1722_svfield, { "AVTP Stream ID Valid", "ieee1722.svfield", FT_BOOLEAN, 8, NULL, IEEE_1722_SV_MASK, NULL, HFILL } }, { &hf_1722_verfield, { "AVTP Version", "ieee1722.verfield", FT_UINT8, BASE_HEX, NULL, IEEE_1722_VER_MASK, NULL, HFILL } } }; static ei_register_info ei[] = { { &ei_1722_encap_seqnum_dup, { "ieee1722.encapsulation_sequence_num.dup", PI_SEQUENCE, PI_NOTE, "Duplicate encapsulation_sequence_num (retransmission?)", EXPFILL }}, { &ei_1722_encap_seqnum_ooo, { "ieee1722.encapsulation_sequence_num.ooo", PI_SEQUENCE, PI_WARN, "Unexpected encapsulation_sequence_num (lost or out-of-order?)", EXPFILL }}, }; static gint *ett[] = { &ett_1722 }; expert_module_t *expert_1722; /* Register the protocol name and description */ proto_1722 = proto_register_protocol("IEEE 1722 Audio Video Transport Protocol (AVTP)", "IEEE1722", "ieee1722"); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722 = expert_register_protocol(proto_1722); expert_register_field_array(expert_1722, ei, array_length(ei)); /* Sub-dissector for 1722.1, 1722 AAF, 1722 CRF, 1722 61883, 1722 CVF */ avb_dissector_table = register_dissector_table("ieee1722.subtype", "IEEE1722 AVTP Subtype", proto_1722, FT_UINT8, BASE_HEX); } void proto_reg_handoff_1722(void) { dissector_handle_t avtp_handle_eth, avtp_handle_udp; avtp_handle_eth = create_dissector_handle(dissect_1722_eth, proto_1722); avtp_handle_udp = create_dissector_handle(dissect_1722_udp, proto_1722); dissector_add_uint("ethertype", ETHERTYPE_AVTP, avtp_handle_eth); dissector_add_uint_with_preference("udp.port", UDP_PORT_IEEE_1722, avtp_handle_udp); } /**************************************************************************************************/ /* IEC 61883 dissector implementation */ /* */ /**************************************************************************************************/ static int dissect_1722_61883(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { proto_item *ti; proto_tree *ti_61883_tree; proto_tree *ti_channel; proto_tree *ti_datalen; proto_tree *ti_cip_fn; proto_tree *ti_cip_dbs; proto_tree *ti_cip_sph; proto_tree *ti_cip_fmt; proto_tree *ti_cip_fdf; proto_tree *ti_audio_tree; proto_tree *ti_sample_tree; proto_tree *ti_video_tree; gint offset = 1; guint8 cip_dbs = 0; guint8 tag = 0; guint8 channel = 0; guint8 tcode = 0; guint8 cip_qi1 = 0; guint8 cip_sid = 0; guint8 cip_qpc = 0; guint8 cip_qi2 = 0; guint8 cip_fmt = 0; guint8 cip_sph = 0; guint8 cip_fn = 0; guint datalen = 0; guint db_size = 0; guint numSourcePackets = 0; guint i = 0; guint j = 0; int * const fields[] = { &hf_1722_61883_mrfield, &hf_1722_61883_gvfield, &hf_1722_61883_tvfield, NULL }; ti = proto_tree_add_item(tree, proto_1722_61883, tvb, 0, -1, ENC_NA); ti_61883_tree = proto_item_add_subtree(ti, ett_1722_61883); proto_tree_add_bitmask_list(ti_61883_tree, tvb, offset, 1, fields, ENC_NA); offset += 1; proto_tree_add_item(ti_61883_tree, hf_1722_61883_seqnum, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_61883_tree, hf_1722_61883_tufield, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_61883_tree, hf_1722_61883_stream_id, tvb, offset, 8, ENC_BIG_ENDIAN); offset += 8; proto_tree_add_item(ti_61883_tree, hf_1722_61883_avtp_timestamp, tvb, offset, 4, ENC_BIG_ENDIAN); offset += 4; proto_tree_add_item(ti_61883_tree, hf_1722_61883_gateway_info, tvb, offset, 4, ENC_BIG_ENDIAN); offset += 4; ti_datalen = proto_tree_add_item_ret_uint(ti_61883_tree, hf_1722_61883_stream_data_length, tvb, offset, 2, ENC_BIG_ENDIAN, &datalen); offset += 2; /* tag field defines if CIP header is included or not */ ti = proto_tree_add_item(ti_61883_tree, hf_1722_61883_tag, tvb, offset, 1, ENC_BIG_ENDIAN); tag = tvb_get_guint8(tvb, offset) & IEEE_1722_TAG_MASK; if (tag > 0x40) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_tag); } ti_channel = proto_tree_add_item(ti_61883_tree, hf_1722_61883_channel, tvb, offset, 1, ENC_BIG_ENDIAN); channel = tvb_get_guint8(tvb, offset) & IEEE_1722_CHANNEL_MASK; if (channel != IEEE_1722_61883_CHANNEL_AVTP) { proto_item_append_text(ti_channel, ": Originating Source ID from an IEEE 1394 serial bus"); } else { proto_item_append_text(ti_channel, ": Originating source is on AVTP network (native AVTP)"); } offset += 1; ti = proto_tree_add_item(ti_61883_tree, hf_1722_61883_tcode, tvb, offset, 1, ENC_BIG_ENDIAN); tcode = tvb_get_guint8(tvb, offset) & IEEE_1722_TCODE_MASK; if (tcode != 0xa0) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_tcode); } proto_tree_add_item(ti_61883_tree, hf_1722_61883_sy, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; switch (tag) { case IEEE_1722_61883_TAG_NO_CIP: proto_item_prepend_text(ti, "IIDC 1394 video payload:"); break; case IEEE_1722_61883_TAG_CIP: ti = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_qi1, tvb, offset, 1, ENC_BIG_ENDIAN); cip_qi1 = tvb_get_guint8(tvb, offset) & IEEE_1722_QI1_MASK; if (cip_qi1 != 0) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_qi1); } ti = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_sid, tvb, offset, 1, ENC_BIG_ENDIAN); cip_sid = tvb_get_guint8(tvb, offset) & IEEE_1722_SID_MASK; if (cip_sid != IEEE_1722_61883_SID_AVTP) { proto_item_append_text(ti, ": Originating Source ID from an IEEE 1394 serial bus"); if (channel == IEEE_1722_61883_CHANNEL_AVTP) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_channel_sid); expert_add_info(pinfo, ti_channel, &ei_1722_61883_incorrect_channel_sid); } } else { proto_item_append_text(ti, ": Originating source is on AVTP network"); if (channel != IEEE_1722_61883_CHANNEL_AVTP) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_channel_sid); expert_add_info(pinfo, ti_channel, &ei_1722_61883_incorrect_channel_sid); } } offset += 1; ti_cip_dbs = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_dbs, tvb, offset, 1, ENC_BIG_ENDIAN); cip_dbs = tvb_get_guint8(tvb, offset); offset += 1; ti_cip_fn = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_fn, tvb, offset, 1, ENC_BIG_ENDIAN); switch (tvb_get_guint8(tvb, offset) & IEEE_1722_FN_MASK) { case 0: cip_fn = 0; break; case 0x40: cip_fn = 2; break; case 0x80: cip_fn = 4; break; case 0xc0: cip_fn = 8; break; default: break; } ti = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_qpc, tvb, offset, 1, ENC_BIG_ENDIAN); cip_qpc = tvb_get_guint8(tvb, offset) & IEEE_1722_QPC_MASK; if (cip_qpc != 0) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_qpc); } ti_cip_sph = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_sph, tvb, offset, 1, ENC_BIG_ENDIAN); cip_sph = tvb_get_guint8(tvb, offset) & IEEE_1722_SPH_MASK; offset += 1; proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_dbc, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; ti = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_qi2, tvb, offset, 1, ENC_BIG_ENDIAN); cip_qi2 = tvb_get_guint8(tvb, offset) & IEEE_1722_QI2_MASK; if (cip_qi2 != 0x80) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_qi2); } /* Check format field for 61883-4 MPEG-TS video or 61883-6 for audio */ ti_cip_fmt = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_fmt, tvb, offset, 1, ENC_BIG_ENDIAN); cip_fmt = tvb_get_guint8(tvb, offset) & IEEE_1722_FMT_MASK; offset += 1; if ((cip_fmt & 0x20) == 0) { proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_fdf, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_syt, tvb, offset, 2, ENC_BIG_ENDIAN); offset += 2; } else { ti_cip_fdf = proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_fdf_no_syt, tvb, offset, 3, ENC_BIG_ENDIAN); if (((tvb_get_ntoh24(tvb, offset) & 0x7fffff) != 0)) { expert_add_info(pinfo, ti_cip_fdf, &ei_1722_61883_incorrect_cip_fdf); } proto_tree_add_item(ti_61883_tree, hf_1722_61883_cip_fdf_tsf, tvb, offset, 3, ENC_BIG_ENDIAN); offset += 3; } /* Calculate the remaining size by subtracting the CIP header size from the value in the packet data length field */ datalen -= IEEE_1722_CIP_HEADER_SIZE; if (cip_dbs == 0) { db_size = 256; } else { db_size = cip_dbs; } switch (cip_fmt) { case IEEE_1722_61883_6: if (cip_fn != 0) { expert_add_info(pinfo, ti_cip_fn, &ei_1722_61883_6_incorrect_cip_fn); } if (cip_sph != 0) { expert_add_info(pinfo, ti_cip_sph, &ei_1722_61883_6_incorrect_cip_sph); } /* Make the Audio sample tree. */ ti = proto_tree_add_item(ti_61883_tree, hf_1722_61883_audio_data, tvb, offset, datalen, ENC_NA); ti_audio_tree = proto_item_add_subtree(ti, ett_1722_61883_audio); if ((datalen % (db_size*4)) != 0) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_datalen); expert_add_info(pinfo, ti_datalen, &ei_1722_61883_incorrect_datalen); } numSourcePackets = datalen / (db_size*4); if (ti_audio_tree) { /* Loop through all samples and add them to the audio tree. */ for (j = 0; j < numSourcePackets; j++) { ti_sample_tree = proto_tree_add_subtree_format(ti_audio_tree, tvb, offset, 1, ett_1722_61883_sample, NULL, "Sample %d", j+1); for (i = 0; i < db_size; i++) { proto_tree_add_item(ti_sample_tree, hf_1722_61883_label, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_sample_tree, hf_1722_61883_sample, tvb, offset, 3, ENC_NA); offset += 3; } } } break; case IEEE_1722_61883_4: if (db_size != 6) { expert_add_info(pinfo, ti_cip_dbs, &ei_1722_61883_4_incorrect_cip_dbs); } if (cip_fn != 8) { expert_add_info(pinfo, ti_cip_fn, &ei_1722_61883_4_incorrect_cip_fn); } if (cip_sph != 4) { expert_add_info(pinfo, ti_cip_sph, &ei_1722_61883_4_incorrect_cip_sph); } /* Make the video tree. */ ti = proto_tree_add_item(ti_61883_tree, hf_1722_61883_video_data, tvb, offset, datalen, ENC_NA); ti_video_tree = proto_item_add_subtree(ti, ett_1722_61883_video); if ((datalen % IEEE_1722_61883_4_LEN_SOURCE_PACKET) != 0) { expert_add_info(pinfo, ti, &ei_1722_61883_incorrect_datalen); expert_add_info(pinfo, ti_datalen, &ei_1722_61883_incorrect_datalen); } numSourcePackets = datalen / IEEE_1722_61883_4_LEN_SOURCE_PACKET; /* if (ti_video_tree) - MP2T needs to be called regardless * for fragmentation handling */ for (j = 0; j < numSourcePackets; j++) { proto_tree_add_item(ti_video_tree, hf_1722_61883_source_packet_header_timestamp, tvb, offset, IEEE_1722_61883_4_LEN_SP_TIMESTAMP, ENC_BIG_ENDIAN); offset += IEEE_1722_61883_4_LEN_SP_TIMESTAMP; call_dissector(mp2t_handle, tvb_new_subset_length(tvb, offset, MP2T_PACKET_SIZE), pinfo, ti_video_tree); offset += MP2T_PACKET_SIZE; } break; default: expert_add_info(pinfo, ti_cip_fmt, &ei_1722_61883_unknown_format); break; } break; default: break; } return tvb_captured_length(tvb); } void proto_register_1722_61883(void) { static hf_register_info hf[] = { { &hf_1722_61883_mrfield, { "Media Clock Restart", "iec61883.mrfield", FT_BOOLEAN, 8, NULL, IEEE_1722_MR_MASK, NULL, HFILL } }, { &hf_1722_61883_gvfield, { "Gateway Info Valid", "iec61883.gvfield", FT_BOOLEAN, 8, NULL, IEEE_1722_GV_MASK, NULL, HFILL } }, { &hf_1722_61883_tvfield, { "Timestamp Valid", "iec61883.tvfield", FT_BOOLEAN, 8, NULL, IEEE_1722_TV_MASK, NULL, HFILL } }, { &hf_1722_61883_seqnum, { "Sequence Number", "iec61883.seqnum", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_tufield, { "Timestamp Uncertain", "iec61883.tufield", FT_BOOLEAN, 8, NULL, IEEE_1722_TU_MASK, NULL, HFILL } }, { &hf_1722_61883_stream_id, { "Stream ID", "iec61883.stream_id", FT_UINT64, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_avtp_timestamp, { "AVTP Timestamp", "iec61883.avtp_timestamp", FT_UINT32, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_gateway_info, { "Gateway Info", "iec61883.gateway_info", FT_UINT32, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_stream_data_length, { "1394 Stream Data Length", "iec61883.stream_data_len", FT_UINT16, BASE_DEC|BASE_UNIT_STRING, &units_byte_bytes, 0x0, NULL, HFILL } }, { &hf_1722_61883_tag, { "1394 Packet Format Tag", "iec61883.tag", FT_UINT8, BASE_HEX, VALS(tag_vals), IEEE_1722_TAG_MASK, NULL, HFILL } }, { &hf_1722_61883_channel, { "1394 Packet Channel", "iec61883.channel", FT_UINT8, BASE_DEC, NULL, IEEE_1722_CHANNEL_MASK, NULL, HFILL } }, { &hf_1722_61883_tcode, { "1394 Packet Tcode", "iec61883.tcode", FT_UINT8, BASE_HEX, NULL, IEEE_1722_TCODE_MASK, NULL, HFILL } }, { &hf_1722_61883_sy, { "1394 App-specific Control", "iec61883.sy", FT_UINT8, BASE_HEX, NULL, IEEE_1722_SY_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_qi1, { "CIP Quadlet Indicator 1", "iec61883.qi1", FT_UINT8, BASE_HEX, NULL, IEEE_1722_QI1_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_sid, { "CIP Source ID", "iec61883.sid", FT_UINT8, BASE_DEC, NULL, IEEE_1722_SID_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_dbs, { "CIP Data Block Size", "iec61883.dbs", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_cip_fn, { "CIP Fraction Number", "iec61883.fn", FT_UINT8, BASE_HEX, VALS(fraction_number_vals), IEEE_1722_FN_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_qpc, { "CIP Quadlet Padding Count", "iec61883.qpc", FT_UINT8, BASE_HEX, NULL, IEEE_1722_QPC_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_sph, { "CIP Source Packet Header", "iec61883.sph", FT_BOOLEAN, 8, NULL, IEEE_1722_SPH_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_dbc, { "CIP Data Block Continuity", "iec61883.dbc", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_cip_qi2, { "CIP Quadlet Indicator 2", "iec61883.qi2", FT_UINT8, BASE_HEX, NULL, IEEE_1722_QI2_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_fmt, { "CIP Format ID", "iec61883.fmt", FT_UINT8, BASE_HEX | BASE_RANGE_STRING, RVALS(format_rvals), IEEE_1722_FMT_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_fdf_no_syt, { "CIP Format Dependent Field", "iec61883.fdf_no_syt", FT_UINT24, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_cip_fdf_tsf, { "Time shift flag", "iec61883.fdf_tsf", FT_BOOLEAN, 8, NULL, IEEE_1722_FDF_TSF_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_fdf, { "CIP Format Dependent Field", "iec61883.fdf", FT_UINT8, BASE_HEX | BASE_RANGE_STRING, RVALS(fdf_rvals), IEEE_1722_FDF_MASK, NULL, HFILL } }, { &hf_1722_61883_cip_syt, { "CIP SYT", "iec61883.syt", FT_UINT16, BASE_HEX | BASE_RANGE_STRING, RVALS(syt_rvals), 0x0, NULL, HFILL } }, { &hf_1722_61883_audio_data, { "Audio Data", "iec61883.audiodata", FT_BYTES, BASE_NONE, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_label, { "Label", "iec61883.audiodata.sample.label", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_sample, { "Sample", "iec61883.audiodata.sample.sampledata", FT_BYTES, BASE_NONE, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_video_data, { "Video Data", "iec61883.videodata", FT_BYTES, BASE_NONE, NULL, 0x0, NULL, HFILL } }, { &hf_1722_61883_source_packet_header_timestamp, { "Source Packet Header Timestamp", "iec61883.spht", FT_UINT32, BASE_HEX, NULL, 0x0, NULL, HFILL } } }; static gint *ett[] = { &ett_1722_61883, &ett_1722_61883_audio, &ett_1722_61883_sample, &ett_1722_61883_video }; static ei_register_info ei[] = { { &ei_1722_61883_incorrect_tag, { "iec61883.incorrect_tag", PI_PROTOCOL, PI_WARN, "Incorrect tag field, only 0x00 and 0x01 supported for AVTP", EXPFILL }}, { &ei_1722_61883_incorrect_tcode, { "iec61883.incorrect_tcode", PI_PROTOCOL, PI_WARN, "Incorrect tcode, talker shall set this field to 0x0A", EXPFILL }}, { &ei_1722_61883_incorrect_qi1, { "iec61883.incorrect_qi1", PI_PROTOCOL, PI_WARN, "Incorrect quadlet indicator 1 field, talker shall set this field to 0x00", EXPFILL }}, { &ei_1722_61883_incorrect_qpc, { "iec61883.incorrect_qpc", PI_PROTOCOL, PI_WARN, "Incorrect quadlet padding count field, shall be set to 0", EXPFILL }}, { &ei_1722_61883_incorrect_qi2, { "iec61883.incorrect_qi2", PI_PROTOCOL, PI_WARN, "Incorrect quadlet indicator 2 field, talker shall set this field to 0x02", EXPFILL }}, { &ei_1722_61883_unknown_format, { "iec61883.unknown_format", PI_PROTOCOL, PI_NOTE, "IEC 61883 format not dissected yet", EXPFILL }}, { &ei_1722_61883_incorrect_channel_sid, { "iec61883.incorrect_channel_sid", PI_PROTOCOL, PI_WARN, "1394 Packet Channel and Source ID don`t match", EXPFILL }}, { &ei_1722_61883_incorrect_datalen, { "iec61883.incorrect_datalen", PI_PROTOCOL, PI_WARN, "Incorrect stream data length field, must be multiple of 192 plus 8 bytes CIP header", EXPFILL }}, { &ei_1722_61883_4_incorrect_cip_fn, { "iec61883.4_incorrect_cip_fn", PI_PROTOCOL, PI_WARN, "Incorrect fraction number, shall be 8 for IEC 61883-4", EXPFILL }}, { &ei_1722_61883_4_incorrect_cip_dbs, { "iec61883.4_incorrect_cip_dbs", PI_PROTOCOL, PI_WARN, "Incorrect data block size, shall be 6 for IEC 61883-4", EXPFILL }}, { &ei_1722_61883_4_incorrect_cip_sph, { "iec61883.4_incorrect_cip_sph", PI_PROTOCOL, PI_WARN, "Incorrect source packet header value, shall be 1 for IEC 61883-4", EXPFILL }}, { &ei_1722_61883_6_incorrect_cip_fn, { "iec61883.6_incorrect_cip_fn", PI_PROTOCOL, PI_WARN, "Incorrect fraction number, shall be 0 for IEC 61883-6", EXPFILL }}, { &ei_1722_61883_6_incorrect_cip_sph, { "iec61883.6_incorrect_cip_sph", PI_PROTOCOL, PI_WARN, "Incorrect source packet header value, shall be 0 for IEC 61883-6", EXPFILL }}, { &ei_1722_61883_incorrect_cip_fdf, { "iec61883.6_incorrect_cip_fdf", PI_PROTOCOL, PI_WARN, "Incorrect frame dependent field value, shall be 0", EXPFILL }} }; expert_module_t* expert_1722_61883; /* Register the protocol name and description */ proto_1722_61883 = proto_register_protocol( "IEC 61883 Protocol", /* name */ "IEC 61883", /* short name */ "iec61883"); /* abbrev */ /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_61883, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722_61883 = expert_register_protocol(proto_1722_61883); expert_register_field_array(expert_1722_61883, ei, array_length(ei)); } void proto_reg_handoff_1722_61883(void) { dissector_handle_t avb1722_61883_handle; avb1722_61883_handle = create_dissector_handle(dissect_1722_61883, proto_1722_61883); dissector_add_uint("ieee1722.subtype", IEEE_1722_SUBTYPE_61883, avb1722_61883_handle); mp2t_handle = find_dissector_add_dependency("mp2t", proto_1722_61883); } /**************************************************************************************************/ /* 1722 AAF dissector implementation */ /* */ /**************************************************************************************************/ static int dissect_1722_aaf (tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { proto_item *ti; proto_tree *ti_aaf_tree; proto_tree *ti_channels_per_frame; proto_tree *ti_format; proto_tree *ti_audio_tree; proto_tree *ti_sample_tree; gint offset = 1; guint datalen = 0; guint channels_per_frame = 0; guint bit_depth = 0; guint sample_width = 0; guint format = 0; guint i = 0; guint j = 0; int * const fields[] = { &hf_1722_aaf_mrfield, &hf_1722_aaf_tvfield, NULL }; int * const fields_pcm[] = { &hf_1722_aaf_sparse_timestamp, &hf_1722_aaf_evtfield, NULL }; ti = proto_tree_add_item(tree, proto_1722_aaf, tvb, 0, -1, ENC_NA); ti_aaf_tree = proto_item_add_subtree(ti, ett_1722_aaf); proto_tree_add_bitmask_list(ti_aaf_tree, tvb, offset, 1, fields, ENC_NA); offset += 1; proto_tree_add_item(ti_aaf_tree, hf_1722_aaf_seqnum, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_aaf_tree, hf_1722_aaf_tufield, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_aaf_tree, hf_1722_aaf_stream_id, tvb, offset, 8, ENC_BIG_ENDIAN); offset += 8; proto_tree_add_item(ti_aaf_tree, hf_1722_aaf_avtp_timestamp, tvb, offset, 4, ENC_BIG_ENDIAN); offset += 4; ti_format = proto_tree_add_item_ret_uint(ti_aaf_tree, hf_1722_aaf_format, tvb, offset, 1, ENC_BIG_ENDIAN, &format); offset += 1; switch (format) { case IEEE_1722_AAF_FORMAT_USER: break; case IEEE_1722_AAF_FORMAT_FLOAT_32_BIT: sample_width = 32; break; case IEEE_1722_AAF_FORMAT_INT_32_BIT: sample_width = 32; break; case IEEE_1722_AAF_FORMAT_INT_24_BIT: sample_width = 24; break; case IEEE_1722_AAF_FORMAT_INT_16_BIT: sample_width = 16; break; case IEEE_1722_AAF_FORMAT_AES3_32_BIT: sample_width = 32; break; default: break; } if (format < IEEE_1722_AAF_FORMAT_AES3_32_BIT) { proto_tree_add_item(ti_aaf_tree, hf_1722_aaf_nominal_sample_rate, tvb, offset, 2, ENC_BIG_ENDIAN); ti_channels_per_frame = proto_tree_add_item_ret_uint(ti_aaf_tree, hf_1722_aaf_channels_per_frame, tvb, offset, 2, ENC_BIG_ENDIAN, &channels_per_frame); if (channels_per_frame == 0) { expert_add_info(pinfo, ti_channels_per_frame, &ei_aaf_channels_per_frame); } else { offset += 2; ti = proto_tree_add_item_ret_uint(ti_aaf_tree, hf_1722_aaf_bit_depth, tvb, offset, 1, ENC_BIG_ENDIAN, &bit_depth); if ((bit_depth == 0) || (bit_depth > sample_width)) { expert_add_info(pinfo, ti, &ei_aaf_incorrect_bit_depth); } offset += 1; proto_tree_add_item_ret_uint(ti_aaf_tree, hf_1722_aaf_stream_data_length, tvb, offset, 2, ENC_BIG_ENDIAN, &datalen); offset += 2; proto_tree_add_bitmask_list(ti_aaf_tree, tvb, offset, 1, fields_pcm, ENC_BIG_ENDIAN); offset += 2; /* Make the Audio sample tree. */ ti = proto_tree_add_item(ti_aaf_tree, hf_1722_aaf_data, tvb, offset, datalen, ENC_NA); ti_audio_tree = proto_item_add_subtree(ti, ett_1722_aaf_audio); if (sample_width == 0) { expert_add_info(pinfo, ti, &ei_aaf_sample_width); } else { /* Loop through all samples and add them to the audio tree. */ for (j = 0; j < ((datalen * 8) / (channels_per_frame * sample_width)); j++) { ti_sample_tree = proto_tree_add_subtree_format(ti_audio_tree, tvb, offset, 1, ett_1722_aaf_sample, NULL, "Sample Chunk %d", j); for (i = 0; i < channels_per_frame; i++) { ti = proto_tree_add_item(ti_sample_tree, hf_1722_aaf_sample, tvb, offset, sample_width / 8, ENC_NA); proto_item_prepend_text(ti, "Channel: %d ", i); offset += (sample_width / 8); } } } } } else if (format == IEEE_1722_AAF_FORMAT_AES3_32_BIT) { expert_add_info(pinfo, ti_format, &ei_aaf_aes3_format); } else { expert_add_info(pinfo, ti_format, &ei_aaf_reserved_format); } return tvb_captured_length(tvb); } void proto_register_1722_aaf (void) { static hf_register_info hf[] = { { &hf_1722_aaf_mrfield, { "Media Clock Restart", "aaf.mrfield", FT_BOOLEAN, 8, NULL, IEEE_1722_MR_MASK, NULL, HFILL } }, { &hf_1722_aaf_tvfield, { "Source Timestamp Valid", "aaf.tvfield", FT_BOOLEAN, 8, NULL, IEEE_1722_TV_MASK, NULL, HFILL } }, { &hf_1722_aaf_seqnum, { "Sequence Number", "aaf.seqnum", FT_UINT8, BASE_DEC, NULL, IEEE_1722_SEQ_NUM_MASK, NULL, HFILL } }, { &hf_1722_aaf_tufield, { "Timestamp Uncertain", "aaf.tufield", FT_BOOLEAN, 8, NULL, IEEE_1722_TU_MASK, NULL, HFILL } }, { &hf_1722_aaf_stream_id, { "Stream ID", "aaf.stream_id", FT_UINT64, BASE_HEX, NULL, IEEE_1722_STREAM_ID_MASK, NULL, HFILL } }, { &hf_1722_aaf_avtp_timestamp, { "AVTP Timestamp", "aaf.avtp_timestamp", FT_UINT32, BASE_DEC, NULL, IEEE_1722_TIMESTAMP_MASK, NULL, HFILL } }, { &hf_1722_aaf_format, { "Format", "aaf.format_info", FT_UINT8, BASE_HEX | BASE_RANGE_STRING, RVALS(aaf_format_range_rvals), IEEE_1722_FORMAT_MASK, NULL, HFILL } }, { &hf_1722_aaf_nominal_sample_rate, { "Nominal Sample Rate", "aaf.nominal_sample_rate", FT_UINT16, BASE_HEX | BASE_RANGE_STRING, RVALS(aaf_nominal_sample_rate_range_rvals), IEEE_1722_NOM_SAMPLE_RATE_MASK, NULL, HFILL } }, { &hf_1722_aaf_channels_per_frame, { "Channels per Frame", "aaf.channels_per_frame", FT_UINT16, BASE_DEC, NULL, IEEE_1722_CHANNEL_PER_FRAME_MASK, NULL, HFILL } }, { &hf_1722_aaf_bit_depth, { "Bit Depth", "aaf.bit_depth", FT_UINT8, BASE_DEC, NULL, IEEE_1722_BIT_DEPTH_MASK, NULL, HFILL } }, { &hf_1722_aaf_stream_data_length, { "Stream Data Length", "aaf.stream_data_len", FT_UINT16, BASE_DEC|BASE_UNIT_STRING, &units_byte_bytes, IEEE_1722_STREAM_DATA_LENGTH_MASK, NULL, HFILL } }, { &hf_1722_aaf_sparse_timestamp, { "Sparse Timestamp Mode", "aaf.sparse_timestamp", FT_UINT8, BASE_DEC, VALS(aaf_sparse_timestamp_vals), IEEE_1722_SP_MASK, NULL, HFILL } }, { &hf_1722_aaf_evtfield, { "EVT", "aaf.evtfield", FT_UINT8, BASE_HEX, NULL, IEEE_1722_EVT_MASK, NULL, HFILL } }, { &hf_1722_aaf_data, { "Audio Data", "aaf.data", FT_BYTES, BASE_NONE, NULL, IEEE_1722_DATA_MASK, NULL, HFILL } }, { &hf_1722_aaf_sample, { "Sample Data", "aaf.data.sample", FT_BYTES, BASE_NONE, NULL, IEEE_1722_SAMPLE_MASK, NULL, HFILL } } }; static ei_register_info ei[] = { { &ei_aaf_sample_width, { "aaf.expert.sample_width_zero", PI_PROTOCOL, PI_WARN, "Sample_width of 0 can`t be dissected", EXPFILL }}, { &ei_aaf_reserved_format, { "aaf.expert.reserved_format", PI_PROTOCOL, PI_WARN, "Incorrect format, can`t be dissected", EXPFILL }}, { &ei_aaf_aes3_format, { "aaf.expert.aes3_format", PI_PROTOCOL, PI_WARN, "AES3 format is currently not supported", EXPFILL }}, { &ei_aaf_channels_per_frame, { "aaf.expert.channels_per_frame_zero", PI_PROTOCOL, PI_WARN, "Channels_per_frame value shall not be 0", EXPFILL }}, { &ei_aaf_incorrect_bit_depth, { "aaf.expert.incorrect_bit_depth", PI_PROTOCOL, PI_WARN, "Incorrect bit_depth value", EXPFILL }} }; static gint *ett[] = { &ett_1722_aaf, &ett_1722_aaf_audio, &ett_1722_aaf_sample, }; expert_module_t *expert_1722_aaf; /* Register the protocol name and description */ proto_1722_aaf = proto_register_protocol("AVTP Audio Format", "AAF", "aaf"); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_aaf, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722_aaf = expert_register_protocol(proto_1722_aaf); expert_register_field_array(expert_1722_aaf, ei, array_length(ei)); } void proto_reg_handoff_1722_aaf(void) { dissector_handle_t avb1722_aaf_handle; avb1722_aaf_handle = create_dissector_handle(dissect_1722_aaf, proto_1722_aaf); dissector_add_uint("ieee1722.subtype", IEEE_1722_SUBTYPE_AAF, avb1722_aaf_handle); } /**************************************************************************************************/ /* 1722 CVF dissector implementation */ /* */ /**************************************************************************************************/ static int dissect_1722_cvf (tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { proto_item *ti; proto_tree *ti_cvf_tree; tvbuff_t *next_tvb; gint offset = 1; guint reported_len; guint32 datalen, format, format_subtype = 0; proto_tree *ti_format, *ti_datalen; int * const fields[] = { &hf_1722_cvf_mrfield, &hf_1722_cvf_tvfield, NULL }; int * const fields_cvf[] = { &hf_1722_cvf_marker_bit, &hf_1722_cvf_evtfield, NULL }; /* The PTV field is only defined for the H264 subtype, * reserved for others. */ int * const fields_h264[] = { &hf_1722_cvf_h264_ptvfield, &hf_1722_cvf_marker_bit, &hf_1722_cvf_evtfield, NULL }; ti = proto_tree_add_item(tree, proto_1722_cvf, tvb, 0, 24, ENC_NA); ti_cvf_tree = proto_item_add_subtree(ti, ett_1722_cvf); proto_tree_add_bitmask_list(ti_cvf_tree, tvb, offset, 1, fields, ENC_NA); offset += 1; proto_tree_add_item(ti_cvf_tree, hf_1722_cvf_seqnum, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_cvf_tree, hf_1722_cvf_tufield, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_cvf_tree, hf_1722_cvf_stream_id, tvb, offset, 8, ENC_BIG_ENDIAN); offset += 8; proto_tree_add_item(ti_cvf_tree, hf_1722_cvf_avtp_timestamp, tvb, offset, 4, ENC_BIG_ENDIAN); offset += 4; ti_format = proto_tree_add_item_ret_uint(ti_cvf_tree, hf_1722_cvf_format, tvb, offset, 1, ENC_BIG_ENDIAN, &format); if (format == IEEE_1722_CVF_FORMAT_RFC) { offset += 1; ti_format = proto_tree_add_item_ret_uint(ti_cvf_tree, hf_1722_cvf_format_subtype, tvb, offset, 1, ENC_BIG_ENDIAN, &format_subtype); offset += 3; } else { expert_add_info(pinfo, ti_format, &ei_cvf_reserved_format); offset += 4; } ti_datalen = proto_tree_add_item_ret_uint(ti_cvf_tree, hf_1722_cvf_stream_data_length, tvb, offset, 2, ENC_BIG_ENDIAN, &datalen); offset += 2; if (format == IEEE_1722_CVF_FORMAT_RFC && format_subtype == IEEE_1722_CVF_FORMAT_SUBTYPE_H264) { proto_tree_add_bitmask_list(ti_cvf_tree, tvb, offset, 1, fields_h264, ENC_BIG_ENDIAN); } else { proto_tree_add_bitmask_list(ti_cvf_tree, tvb, offset, 1, fields_cvf, ENC_BIG_ENDIAN); } offset += 2; reported_len = tvb_reported_length_remaining(tvb, offset); if (reported_len < datalen) { expert_add_info(pinfo, ti_datalen, &ei_cvf_invalid_data_length); datalen = reported_len; } next_tvb = tvb_new_subset_length(tvb, offset, datalen); if (format == IEEE_1722_CVF_FORMAT_RFC) { switch(format_subtype) { case IEEE_1722_CVF_FORMAT_SUBTYPE_MJPEG: call_dissector(jpeg_handle, next_tvb, pinfo, tree); break; case IEEE_1722_CVF_FORMAT_SUBTYPE_H264: proto_tree_add_item(ti_cvf_tree, hf_1722_cvf_h264_timestamp, tvb, offset, 4, ENC_BIG_ENDIAN); call_dissector(h264_handle, tvb_new_subset_remaining(next_tvb, 4), pinfo, tree); break; case IEEE_1722_CVF_FORMAT_SUBTYPE_JPEG2000: expert_add_info(pinfo, ti_format, &ei_cvf_jpeg2000_format); call_data_dissector(next_tvb, pinfo, tree); break; default: expert_add_info(pinfo, ti_format, &ei_cvf_reserved_format); call_data_dissector(next_tvb, pinfo, tree); break; } } else { call_data_dissector(next_tvb, pinfo, tree); } return offset + datalen; } void proto_register_1722_cvf (void) { static hf_register_info hf[] = { { &hf_1722_cvf_mrfield, { "Media Clock Restart", "cvf.mrfield", FT_BOOLEAN, 8, NULL, IEEE_1722_MR_MASK, NULL, HFILL } }, { &hf_1722_cvf_tvfield, { "Source Timestamp Valid", "cvf.tvfield", FT_BOOLEAN, 8, TFS(&tfs_valid_invalid), IEEE_1722_TV_MASK, "Indicates whether avtp_timestamp contains a valid value", HFILL } }, { &hf_1722_cvf_seqnum, { "Sequence Number", "cvf.seqnum", FT_UINT8, BASE_DEC, NULL, IEEE_1722_SEQ_NUM_MASK, NULL, HFILL } }, { &hf_1722_cvf_tufield, { "Timestamp Uncertain", "cvf.tufield", FT_BOOLEAN, 8, NULL, IEEE_1722_TU_MASK, NULL, HFILL } }, { &hf_1722_cvf_stream_id, { "Stream ID", "cvf.stream_id", FT_UINT64, BASE_HEX, NULL, IEEE_1722_STREAM_ID_MASK, NULL, HFILL } }, { &hf_1722_cvf_avtp_timestamp, { "AVTP Timestamp", "cvf.avtp_timestamp", FT_UINT32, BASE_DEC, NULL, IEEE_1722_TIMESTAMP_MASK, NULL, HFILL } }, { &hf_1722_cvf_format, { "Format", "cvf.format", FT_UINT8, BASE_HEX | BASE_RANGE_STRING, RVALS(cvf_format_range_rvals), IEEE_1722_FORMAT_MASK, NULL, HFILL } }, { &hf_1722_cvf_format_subtype, { "CVF Format Subtype", "cvf.format_subtype", FT_UINT8, BASE_HEX | BASE_RANGE_STRING, RVALS(cvf_format_subtype_range_rvals), IEEE_1722_FORMAT_SUBTYPE_MASK, NULL, HFILL } }, { &hf_1722_cvf_stream_data_length, { "Stream Data Length", "cvf.stream_data_len", FT_UINT16, BASE_DEC | BASE_UNIT_STRING, &units_byte_bytes, IEEE_1722_STREAM_DATA_LENGTH_MASK, NULL, HFILL } }, { &hf_1722_cvf_h264_ptvfield, { "H264 Payload Timestamp Valid", "cvf.h264_ptvfield", FT_BOOLEAN, 8, TFS(&tfs_valid_invalid), IEEE_1722_H264_PTV_MASK, "Indicates whether h264_timestamp contains a valid value", HFILL } }, { &hf_1722_cvf_marker_bit, { "Marker Bit", "cvf.marker_bit", FT_BOOLEAN, 8, TFS(&tfs_set_notset), IEEE_1722_MARKER_BIT_MASK, NULL, HFILL } }, { &hf_1722_cvf_evtfield, { "EVT", "cvf.evtfield", FT_UINT8, BASE_HEX, NULL, IEEE_1722_EVT_MASK, NULL, HFILL } }, { &hf_1722_cvf_h264_timestamp, { "H264 Timestamp", "cvf.h264_timestamp", FT_UINT32, BASE_DEC, NULL, IEEE_1722_CVF_H264_TIMESTAMP_MASK, NULL, HFILL } }, }; static ei_register_info ei[] = { { &ei_cvf_jpeg2000_format, { "cvf.expert.jpeg2000_video", PI_UNDECODED, PI_WARN, "JPEG2000 format is currently not supported", EXPFILL }}, { &ei_cvf_reserved_format, { "cvf.expert.reserved_format", PI_PROTOCOL, PI_WARN, "Incorrect format, can't be dissected", EXPFILL }}, { &ei_cvf_invalid_data_length, { "cvf.expert.data_len", PI_PROTOCOL, PI_WARN, "data_length is too large or frame is incomplete", EXPFILL }} }; static gint *ett[] = { &ett_1722_cvf, }; expert_module_t *expert_1722_cvf; /* Register the protocol name and description */ proto_1722_cvf = proto_register_protocol("AVTP Compressed Video Format", "CVF", "cvf"); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_cvf, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722_cvf = expert_register_protocol(proto_1722_cvf); expert_register_field_array(expert_1722_cvf, ei, array_length(ei)); } void proto_reg_handoff_1722_cvf(void) { dissector_handle_t avb1722_cvf_handle; avb1722_cvf_handle = create_dissector_handle(dissect_1722_cvf, proto_1722_cvf); dissector_add_uint("ieee1722.subtype", IEEE_1722_SUBTYPE_CVF, avb1722_cvf_handle); jpeg_handle = find_dissector_add_dependency("jpeg", proto_1722_cvf); h264_handle = find_dissector_add_dependency("h264", proto_1722_cvf); } /**************************************************************************************************/ /* 1722 CRF dissector implementation */ /* */ /**************************************************************************************************/ static int dissect_1722_crf (tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { proto_item *ti; proto_tree *ti_crf_tree; proto_tree *timestamp_tree; gint offset = 1; guint datalen = 0; guint j = 0; int * const fields[] = { &hf_1722_crf_mrfield, &hf_1722_crf_fsfield, &hf_1722_crf_tufield, NULL }; int * const pull_frequency[] = { &hf_1722_crf_pull, &hf_1722_crf_base_frequency, NULL }; ti = proto_tree_add_item(tree, proto_1722_crf, tvb, 0, -1, ENC_NA); ti_crf_tree = proto_item_add_subtree(ti, ett_1722_crf); proto_tree_add_bitmask_list(ti_crf_tree, tvb, offset, 1, fields, ENC_NA); offset += 1; proto_tree_add_item(ti_crf_tree, hf_1722_crf_seqnum, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_crf_tree, hf_1722_crf_type, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(ti_crf_tree, hf_1722_crf_stream_id, tvb, offset, 8, ENC_BIG_ENDIAN); offset += 8; proto_tree_add_bitmask_list(ti_crf_tree, tvb, offset, 4, pull_frequency, ENC_NA); offset += 4; proto_tree_add_item_ret_uint(ti_crf_tree, hf_1722_crf_data_length, tvb, offset, 2, ENC_BIG_ENDIAN, &datalen); offset += 2; proto_tree_add_item(ti_crf_tree, hf_1722_crf_timestamp_interval, tvb, offset, 2, ENC_BIG_ENDIAN); offset += 2; /* Make the Timestamp tree. */ ti = proto_tree_add_item(ti_crf_tree, hf_1722_crf_timestamp_data, tvb, offset, datalen, ENC_NA); timestamp_tree = proto_item_add_subtree(ti, ett_1722_crf_timestamp); if (datalen%8) { expert_add_info(pinfo, ti, &ei_crf_datalen); } else { /* Loop through all timestamps and add them to the timestamp tree. */ for (j = 0; j < (datalen / IEEE_1722_CRF_TIMESTAMP_SIZE); j++) { ti = proto_tree_add_item(timestamp_tree, hf_1722_crf_timestamp, tvb, offset, IEEE_1722_CRF_TIMESTAMP_SIZE, ENC_BIG_ENDIAN); proto_item_prepend_text(ti, "Timestamp %d ", j); offset += IEEE_1722_CRF_TIMESTAMP_SIZE; } } return tvb_captured_length(tvb); } void proto_register_1722_crf(void) { static hf_register_info hf[] = { { &hf_1722_crf_mrfield, { "Media Clock Restart", "crf.mrfield", FT_BOOLEAN, 8, NULL, IEEE_1722_MR_MASK, NULL, HFILL } }, { &hf_1722_crf_fsfield, { "Frame Sync", "crf.fsfield", FT_BOOLEAN, 8, NULL, IEEE_1722_FS_MASK, NULL, HFILL } }, { &hf_1722_crf_tufield, { "Timestamp Uncertain", "crf.tufield", FT_BOOLEAN, 8, NULL, IEEE_1722_TU_MASK, NULL, HFILL } }, { &hf_1722_crf_seqnum, { "Sequence Number", "crf.seqnum", FT_UINT8, BASE_DEC, NULL, 0x0, NULL, HFILL } }, { &hf_1722_crf_type, { "Type", "crf.type", FT_UINT8, BASE_HEX | BASE_RANGE_STRING, RVALS(crf_type_range_rvals), 0x0, NULL, HFILL } }, { &hf_1722_crf_stream_id, { "Stream ID", "crf.stream_id", FT_UINT64, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_1722_crf_pull, { "Pull", "crf.pull", FT_UINT32, BASE_HEX | BASE_RANGE_STRING, RVALS(crf_pull_range_rvals), IEEE_1722_PULL_MASK, NULL, HFILL } }, { &hf_1722_crf_base_frequency, { "Base Frequency", "crf.base_frequency", FT_UINT32, BASE_DEC, NULL, IEEE_1722_BASE_FREQUENCY_MASK, NULL, HFILL } }, { &hf_1722_crf_data_length, { "Data Length", "crf.data_len", FT_UINT16, BASE_DEC|BASE_UNIT_STRING, &units_byte_bytes, 0x0, NULL, HFILL } }, { &hf_1722_crf_timestamp_interval, { "Timestamp Interval", "crf.timestamp_interval", FT_UINT16, BASE_DEC, NULL, 0x0, NULL, HFILL } }, { &hf_1722_crf_timestamp_data, { "Timestamp Data", "crf.timestamp_data", FT_BYTES, BASE_NONE, NULL, 0x0, NULL, HFILL } }, { &hf_1722_crf_timestamp, { "Data", "crf.timestamp", FT_UINT64, BASE_HEX, NULL, 0x0, NULL, HFILL } } }; static ei_register_info ei[] = { { &ei_crf_datalen, { "crf.expert.crf_datalen", PI_PROTOCOL, PI_WARN, "The CRF data length must be multiple of 8", EXPFILL }} }; static gint *ett[] = { &ett_1722_crf, &ett_1722_crf_timestamp }; expert_module_t *expert_1722_crf; /* Register the protocol name and description */ proto_1722_crf = proto_register_protocol("Clock Reference Format", "CRF", "crf"); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_crf, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722_crf = expert_register_protocol(proto_1722_crf); expert_register_field_array(expert_1722_crf, ei, array_length(ei)); } void proto_reg_handoff_1722_crf(void) { dissector_handle_t avb1722_crf_handle; avb1722_crf_handle = create_dissector_handle(dissect_1722_crf, proto_1722_crf); dissector_add_uint("ieee1722.subtype", IEEE_1722_SUBTYPE_CRF, avb1722_crf_handle); } /**************************************************************************************************/ /* 1722 NTSCF dissector implementation */ /* */ /**************************************************************************************************/ static int dissect_1722_ntscf (tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { proto_item *ti_ntscf; proto_item *ti_data_length; proto_tree *tree_ntscf; gint offset = 1; guint32 datalen = 0; guint captured_length = tvb_captured_length(tvb); gint captured_payload_length; int * const fields[] = { &hf_1722_ntscf_rfield, NULL, }; col_set_str(pinfo->cinfo, COL_PROTOCOL, "NTSCF"); col_set_str(pinfo->cinfo, COL_INFO, "AVTP Non-Time-Synchronous Control Format"); ti_ntscf = proto_tree_add_item(tree, proto_1722_ntscf, tvb, 0, -1, ENC_NA); tree_ntscf = proto_item_add_subtree(ti_ntscf, ett_1722_ntscf); if (captured_length < IEEE_1722_NTSCF_HEADER_SIZE) { expert_add_info(pinfo, ti_ntscf, &ei_1722_ntscf_no_space_for_header); return captured_length; } proto_tree_add_bitmask_list(tree_ntscf, tvb, offset, 2, fields, ENC_BIG_ENDIAN); ti_data_length = proto_tree_add_item_ret_uint(tree_ntscf, hf_1722_ntscf_data_length, tvb, offset, 2, ENC_BIG_ENDIAN, &datalen); offset += 2; proto_tree_add_item(tree_ntscf, hf_1722_ntscf_seqnum, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; proto_tree_add_item(tree_ntscf, hf_1722_ntscf_stream_id, tvb, offset, 8, ENC_BIG_ENDIAN); offset += 8; captured_payload_length = tvb_captured_length_remaining(tvb, offset); if (captured_payload_length < 0 || (gint)datalen > captured_payload_length) { expert_add_info(pinfo, ti_data_length, &ei_1722_ntscf_invalid_data_length); } if ((gint)datalen > captured_payload_length) { datalen = captured_payload_length > 0 ? captured_payload_length : 0; } while(datalen > 0) { guint processed_bytes; tvbuff_t* next_tvb; next_tvb = tvb_new_subset_length(tvb, offset, datalen); if (call_dissector(avb1722_acf_handle, next_tvb, pinfo, tree) <= 0) { break; } processed_bytes = tvb_reported_length(next_tvb); offset += processed_bytes; if (processed_bytes < datalen) { datalen -= processed_bytes; } else { datalen = 0; } } set_actual_length(tvb, offset); proto_item_set_len(ti_ntscf, offset); return tvb_captured_length(tvb); } void proto_register_1722_ntscf(void) { static hf_register_info hf[] = { { &hf_1722_ntscf_rfield, { "Reserved bits", "ntscf.rfield", FT_UINT16, BASE_HEX, NULL, IEEE_1722_NTSCF_R_MASK, NULL, HFILL } }, { &hf_1722_ntscf_data_length, { "Data Length", "ntscf.data_len", FT_UINT16, BASE_DEC, NULL, IEEE_1722_NTSCF_DATA_LENGTH_MASK, NULL, HFILL } }, { &hf_1722_ntscf_seqnum, { "Sequence Number", "ntscf.seqnum", FT_UINT8, BASE_DEC, NULL, 0x0, NULL, HFILL } }, { &hf_1722_ntscf_stream_id, { "Stream ID", "ntscf.stream_id", FT_UINT64, BASE_HEX, NULL, 0x0, NULL, HFILL } } }; static gint *ett[] = { &ett_1722_ntscf }; static ei_register_info ei[] = { { &ei_1722_ntscf_no_space_for_header, { "ntscf.expert.no_space_for_header", PI_PROTOCOL, PI_WARN, "Frame is cropped: NTSCF header won't fit into captured data.", EXPFILL}}, { &ei_1722_ntscf_invalid_data_length, { "ntscf.expert.data_len", PI_PROTOCOL, PI_WARN, "data_length is too large or frame is incomplete", EXPFILL }} }; expert_module_t *expert_1722_ntscf; /* Register the protocol name and description */ proto_1722_ntscf = proto_register_protocol("Non-Time-Synchronous Control Format", "NTSCF", "ntscf"); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_ntscf, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722_ntscf = expert_register_protocol(proto_1722_ntscf); expert_register_field_array(expert_1722_ntscf, ei, array_length(ei)); } void proto_reg_handoff_1722_ntscf(void) { dissector_handle_t avb1722_ntscf_handle; avb1722_ntscf_handle = create_dissector_handle(dissect_1722_ntscf, proto_1722_ntscf); dissector_add_uint("ieee1722.subtype", IEEE_1722_SUBTYPE_NTSCF, avb1722_ntscf_handle); } /**************************************************************************************************/ /* 1722 TSCF dissector implementation */ /* */ /**************************************************************************************************/ static int dissect_1722_tscf (tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { proto_item *ti; proto_item *ti_tscf; proto_tree *tree_tscf; proto_tree *tree_flags; proto_tree *tree_tu; gint offset = 1; guint32 mr; guint32 tv; guint32 tu; guint32 datalen = 0; guint captured_length = tvb_captured_length(tvb); gint captured_payload_length; col_set_str(pinfo->cinfo, COL_PROTOCOL, "TSCF"); col_set_str(pinfo->cinfo, COL_INFO, "AVTP Time-Synchronous Control Format"); ti_tscf = proto_tree_add_item(tree, proto_1722_tscf, tvb, 0, -1, ENC_NA); tree_tscf = proto_item_add_subtree(ti_tscf, ett_1722_tscf); if (captured_length < IEEE_1722_TSCF_HEADER_SIZE) { expert_add_info(pinfo, ti_tscf, &ei_1722_tscf_no_space_for_header); return captured_length; } tree_flags = proto_tree_add_subtree(tree_tscf, tvb, offset, 1, ett_1722_tscf_flags, &ti, "Flags"); proto_tree_add_item_ret_uint(tree_flags, hf_1722_tscf_mr, tvb, offset, 1, ENC_BIG_ENDIAN, &mr); proto_tree_add_item(tree_flags, hf_1722_tscf_rsv1, tvb, offset, 1, ENC_BIG_ENDIAN); proto_tree_add_item_ret_uint(tree_flags, hf_1722_tscf_tv, tvb, offset, 1, ENC_BIG_ENDIAN, &tv); proto_item_append_text(ti, ": mr=%d, tv=%d", mr, tv); offset += 1; proto_tree_add_item(tree_tscf, hf_1722_tscf_seqnum, tvb, offset, 1, ENC_BIG_ENDIAN); offset += 1; tree_tu = proto_tree_add_subtree(tree_tscf, tvb, offset, 1, ett_1722_tscf_tu, &ti, "Timestamp Uncertain"); proto_tree_add_item(tree_tu, hf_1722_tscf_rsv2, tvb, offset, 1, ENC_BIG_ENDIAN); proto_tree_add_item_ret_uint(tree_tu, hf_1722_tscf_tu, tvb, offset, 1, ENC_BIG_ENDIAN, &tu); proto_item_append_text(ti, ": %d", tu); offset += 1; proto_tree_add_item(tree_tscf, hf_1722_tscf_stream_id, tvb, offset, 8, ENC_BIG_ENDIAN); offset += 8; proto_tree_add_item(tree_tscf, hf_1722_tscf_avtp_timestamp, tvb, offset, 4, ENC_BIG_ENDIAN); offset += 4; proto_tree_add_item(tree_tscf, hf_1722_tscf_rsv3, tvb, offset, 4, ENC_BIG_ENDIAN); offset += 4; ti = proto_tree_add_item_ret_uint(tree_tscf, hf_1722_tscf_data_length, tvb, offset, 2, ENC_BIG_ENDIAN, &datalen); captured_payload_length = tvb_captured_length_remaining(tvb, offset); if (captured_payload_length < 0 || (gint)datalen > captured_payload_length) { expert_add_info(pinfo, ti, &ei_1722_tscf_invalid_data_length); } offset += 2; proto_tree_add_item(tree_tscf, hf_1722_tscf_rsv4, tvb, offset, 2, ENC_BIG_ENDIAN); offset += 2; if ((gint)datalen > captured_payload_length) { datalen = captured_payload_length > 0 ? captured_payload_length : 0; } while(datalen > 0) { guint processed_bytes; tvbuff_t* next_tvb = tvb_new_subset_length(tvb, offset, datalen); if (call_dissector(avb1722_acf_handle, next_tvb, pinfo, tree) <= 0) { break; } processed_bytes = tvb_reported_length(next_tvb); offset += processed_bytes; if (processed_bytes < datalen) { datalen -= processed_bytes; } else { datalen = 0; } } set_actual_length(tvb, offset); proto_item_set_len(ti_tscf, offset); return captured_length; } void proto_register_1722_tscf(void) { static hf_register_info hf[] = { { &hf_1722_tscf_mr, { "Media Clock Restart", "tscf.flags.mr", FT_UINT8, BASE_HEX, NULL, IEEE_1722_TSCF_MR_MASK, NULL, HFILL } }, { &hf_1722_tscf_rsv1, { "Reserved bits", "tscf.flags.rsv1", FT_UINT8, BASE_HEX, NULL, IEEE_1722_TSCF_RSV1_MASK, NULL, HFILL } }, { &hf_1722_tscf_tv, { "Avtp Timestamp Valid", "tscf.flags.tv", FT_UINT8, BASE_HEX, NULL, IEEE_1722_TSCF_TV_MASK, NULL, HFILL } }, { &hf_1722_tscf_seqnum, { "Sequence Number", "tscf.seqnum", FT_UINT8, BASE_DEC, NULL, IEEE_1722_TSCF_SEQNUM_MASK, NULL, HFILL } }, { &hf_1722_tscf_rsv2, { "Reserved Bits", "tscf.rsv2", FT_UINT8, BASE_DEC, NULL, IEEE_1722_TSCF_RSV2_MASK, NULL, HFILL } }, { &hf_1722_tscf_tu, { "Timestamp Uncertain", "tscf.flags.tu", FT_UINT8, BASE_DEC, NULL, IEEE_1722_TSCF_TU_MASK, NULL, HFILL } }, { &hf_1722_tscf_stream_id, { "Stream ID", "tscf.stream_id", FT_UINT64, BASE_HEX, NULL, IEEE_1722_TSCF_STREAM_ID_MASK, NULL, HFILL } }, { &hf_1722_tscf_avtp_timestamp, { "AVTP Timestamp", "tscf.avtp_timestamp", FT_UINT32, BASE_HEX, NULL, IEEE_1722_TSCF_AVTP_TIMESTAMP_MASK, NULL, HFILL } }, { &hf_1722_tscf_rsv3, { "Reserved Bits", "tscf.rsv3", FT_UINT32, BASE_HEX, NULL, IEEE_1722_TSCF_RSV3_MASK, NULL, HFILL } }, { &hf_1722_tscf_data_length, { "Data Length", "tscf.data_len", FT_UINT16, BASE_DEC, NULL, IEEE_1722_TSCF_DATA_LENGTH_MASK, NULL, HFILL } }, { &hf_1722_tscf_rsv4, { "Reserved Bits", "tscf.rsv4", FT_UINT16, BASE_HEX, NULL, IEEE_1722_TSCF_RSV4_MASK, NULL, HFILL } }, }; static gint *ett[] = { &ett_1722_tscf, &ett_1722_tscf_flags, &ett_1722_tscf_tu, }; static ei_register_info ei[] = { { &ei_1722_tscf_no_space_for_header, { "tscf.expert.no_space_for_header", PI_PROTOCOL, PI_WARN, "Frame is cropped: TSCF header won't fit into captured data.", EXPFILL}}, { &ei_1722_tscf_invalid_data_length, { "tscf.expert.data_len", PI_PROTOCOL, PI_WARN, "data_length is too large or frame is incomplete", EXPFILL }} }; expert_module_t *expert_1722_tscf; /* Register the protocol name and description */ proto_1722_tscf = proto_register_protocol("Time-Synchronous Control Format", "TSCF", "tscf"); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_tscf, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722_tscf = expert_register_protocol(proto_1722_tscf); expert_register_field_array(expert_1722_tscf, ei, array_length(ei)); } void proto_reg_handoff_1722_tscf(void) { dissector_handle_t avb1722_tscf_handle; avb1722_tscf_handle = create_dissector_handle(dissect_1722_tscf, proto_1722_tscf); dissector_add_uint("ieee1722.subtype", IEEE_1722_SUBTYPE_TSCF, avb1722_tscf_handle); } /**************************************************************************************************/ /* AVTP Control Format (ACF) Message dissector implementation */ /* */ /**************************************************************************************************/ static int dissect_1722_acf (tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { proto_item *ti; proto_item *ti_acf; proto_item *ti_header; proto_tree *tree_acf; proto_tree *tree_header; guint32 msg_type; guint32 msg_length; guint32 payload_length; guint captured_length = tvb_captured_length(tvb); const gchar *msg_type_str; tvbuff_t *next_tvb; if (captured_length < IEEE_1722_ACF_HEADER_SIZE) { return captured_length; } ti_acf = proto_tree_add_item(tree, proto_1722_acf, tvb, 0, -1, ENC_NA); tree_acf = proto_item_add_subtree(ti_acf, ett_1722_acf); tree_header = proto_tree_add_subtree(tree_acf, tvb, 0, 2, ett_1722_acf_header, &ti_header, "ACF Header"); proto_tree_add_item_ret_uint(tree_header, hf_1722_acf_msg_type, tvb, 0, 2, ENC_BIG_ENDIAN, &msg_type); ti = proto_tree_add_item_ret_uint(tree_header, hf_1722_acf_msg_length, tvb, 0, 2, ENC_BIG_ENDIAN, &msg_length); msg_length = msg_length * 4; /* msg_length is stored as number of quadlets */ if (msg_length < IEEE_1722_ACF_HEADER_SIZE) { expert_add_info(pinfo, ti, &ei_1722_acf_invalid_msg_length); return captured_length; } if (captured_length < msg_length) { expert_add_info_format(pinfo, ti, &ei_1722_acf_message_is_cropped, "expected: %u bytes, available: %u bytes", msg_length, tvb_captured_length(tvb)); return captured_length; } set_actual_length(tvb, msg_length); proto_item_set_len(ti_acf, msg_length); msg_type_str = rval_to_str(msg_type, acf_msg_type_range_rvals, "%s"); proto_item_append_text(ti_header, ": %s (0x%02X), %d bytes with header", msg_type_str, msg_type, msg_length); proto_item_append_text(ti_acf, ": %s (0x%02X)", msg_type_str, msg_type); payload_length = msg_length - IEEE_1722_ACF_HEADER_SIZE; /* call any registered message dissectors */ next_tvb = tvb_new_subset_length(tvb, IEEE_1722_ACF_HEADER_SIZE, payload_length); if (!dissector_try_uint(avb1722_acf_dissector_table, msg_type, next_tvb, pinfo, tree_acf)) { call_data_dissector(next_tvb, pinfo, tree_acf); } return captured_length; } void proto_register_1722_acf(void) { static hf_register_info hf[] = { { &hf_1722_acf_msg_type, { "Message Type", "acf.msg_type", FT_UINT16, BASE_HEX | BASE_RANGE_STRING, RVALS(acf_msg_type_range_rvals), IEEE_1722_ACF_MSG_TYPE_MASK, NULL, HFILL } }, { &hf_1722_acf_msg_length, { "Message Length (Quadlets)", "acf.msg_length", FT_UINT16, BASE_DEC, NULL, IEEE_1722_ACF_MSG_LENGTH_MASK, NULL, HFILL } }, }; static gint *ett[] = { &ett_1722_acf, &ett_1722_acf_header, }; static ei_register_info ei[] = { { &ei_1722_acf_invalid_msg_length, { "acf.expert.msg_length", PI_PROTOCOL, PI_WARN, "msg_length shall be at least 1 quadlet", EXPFILL }}, { &ei_1722_acf_message_is_cropped, { "acf.expert.msg_cropped", PI_PROTOCOL, PI_WARN, "Message is cropped or msg_length is invalid", EXPFILL }}, }; expert_module_t *expert_1722_acf; /* Register the protocol name and description */ proto_1722_acf = proto_register_protocol("ACF Message", "ACF", "acf"); avb1722_acf_handle = register_dissector("acf", dissect_1722_acf, proto_1722_acf); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_acf, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); /* Sub-dissector for ACF messages */ avb1722_acf_dissector_table = register_dissector_table("acf.msg_type", "IEEE1722 AVTP Control Message Type", proto_1722_acf, FT_UINT8, BASE_HEX); expert_1722_acf = expert_register_protocol(proto_1722_acf); expert_register_field_array(expert_1722_acf, ei, array_length(ei)); } void proto_reg_handoff_1722_acf(void) { register_depend_dissector("ntscf", "acf"); register_depend_dissector("tscf", "acf"); } /**************************************************************************************************/ /* ACF CAN Message dissector implementation */ /* */ /**************************************************************************************************/ static void describe_can_message(proto_item* dst, guint bus_id, guint32 can_id, guint8 flags) { /* Add text describing the CAN message to the parent item. * Example: ": bus_id=2, id=0x100, rtr=1, brs=1, esi=1" */ const char* format_str = (flags & IEEE_1722_ACF_CAN_EFF_MASK) != 0 ? ": bus_id=%u, id=0x%08X" : ": bus_id=%u, id=0x%03X"; proto_item_append_text (dst, format_str, bus_id, can_id); } static void describe_can_flags(proto_item* dst, guint8 pad, guint8 flags) { proto_item_append_text(dst, ": pad=%u, mtv=%d, rtr=%d, eff=%d, brs=%d, fdf=%d, esi=%d", pad, (flags & IEEE_1722_ACF_CAN_MTV_MASK) != 0, (flags & IEEE_1722_ACF_CAN_RTR_MASK) != 0, (flags & IEEE_1722_ACF_CAN_EFF_MASK) != 0, (flags & IEEE_1722_ACF_CAN_BRS_MASK) != 0, (flags & IEEE_1722_ACF_CAN_FDF_MASK) != 0, (flags & IEEE_1722_ACF_CAN_ESI_MASK) != 0 ); } static int is_valid_can_payload_length(int len) { return len >= 0 && len <= 8; } static int is_valid_canfd_payload_length(int len) { return is_valid_can_payload_length(len) || len == 12 || len == 16 || len == 20 || len == 24 || len == 32 || len == 48 || len == 64; } static int dissect_1722_acf_can_common(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_, const gboolean is_brief) { acf_can_t parsed; guint32 pad_length; gint payload_length; guint8 flags; proto_item *ti; proto_item *ti_acf_can; proto_tree *tree_acf_can; proto_tree *tree_acf_can_flags; proto_tree *tree_acf_can_bus_id; proto_item *ti_can; proto_tree *tree_can; proto_tree *tree_can_id; gint can_protocol; int * const *can_flags; struct can_info can_info; tvbuff_t* next_tvb; gint offset = 0; guint captured_length = tvb_captured_length(tvb); guint header_size = is_brief ? IEEE_1722_ACF_CAN_BRIEF_HEADER_SIZE : IEEE_1722_ACF_CAN_HEADER_SIZE; int * const fields[] = { &hf_1722_can_mtvfield, &hf_1722_can_fdffield, NULL, }; int * const can_std_flags[] = { &hf_1722_can_rtrfield, &hf_1722_can_efffield, NULL }; int * const can_fd_flags[] = { &hf_1722_can_efffield, &hf_1722_can_brsfield, &hf_1722_can_esifield, NULL }; memset(&parsed, 0, sizeof(parsed)); /* create tree for ACF-CAN-specific fields */ ti_acf_can = proto_tree_add_item(tree, proto_1722_acf_can, tvb, offset, -1, ENC_NA); tree_acf_can = proto_item_add_subtree(ti_acf_can, ett_1722_can); if (is_brief) { proto_item_append_text(ti_acf_can, " Brief"); } /* parse flags */ flags = tvb_get_guint8(tvb, offset); parsed.is_fd = (flags & IEEE_1722_ACF_CAN_FDF_MASK) != 0; parsed.is_xtd = (flags & IEEE_1722_ACF_CAN_EFF_MASK) != 0; parsed.is_rtr = (flags & IEEE_1722_ACF_CAN_RTR_MASK) != 0; parsed.is_brs = (flags & IEEE_1722_ACF_CAN_BRS_MASK) != 0; parsed.is_esi = (flags & IEEE_1722_ACF_CAN_ESI_MASK) != 0; /* create the tree for CAN-specific fields */ can_protocol = parsed.is_fd ? proto_canfd : proto_can; can_flags = parsed.is_fd ? can_fd_flags : can_std_flags; ti_can = proto_tree_add_item(tree, can_protocol, tvb, offset, -1, ENC_NA); tree_can = proto_item_add_subtree(ti_can, ett_can); if (captured_length < header_size) { expert_add_info(pinfo, ti_acf_can, &ei_1722_can_header_cropped); return captured_length; } /* Add flags subtree to ACF_CAN message */ ti = proto_tree_add_item(tree_acf_can, hf_1722_can_flags, tvb, offset, 1, ENC_NA); tree_acf_can_flags = proto_item_add_subtree(ti, ett_1722_can_flags); proto_tree_add_item_ret_uint(tree_acf_can_flags, hf_1722_can_pad, tvb, offset, 1, ENC_BIG_ENDIAN, &pad_length); proto_tree_add_bitmask_list(tree_acf_can_flags, tvb, offset, 1, fields, ENC_BIG_ENDIAN); describe_can_flags(ti, pad_length, flags); /* Add flags to CAN message */ proto_tree_add_bitmask_list(tree_can, tvb, offset, 1, can_flags, ENC_BIG_ENDIAN); offset += 1; /* Add bus id subtree to ACF_CAN message */ tree_acf_can_bus_id = proto_tree_add_subtree(tree_acf_can, tvb, offset, 1, ett_1722_can_bus_id, &ti, "Bus Identifier"); proto_tree_add_item(tree_acf_can_bus_id, hf_1722_can_rsv1, tvb, offset, 1, ENC_BIG_ENDIAN); proto_tree_add_item_ret_uint(tree_acf_can_bus_id, hf_1722_can_bus_id, tvb, offset, 1, ENC_BIG_ENDIAN, &parsed.bus_id); proto_item_append_text(ti, ": %u", parsed.bus_id); offset += 1; /* Add message_timestamp to ACF_CAN if present */ if (!is_brief) { proto_tree_add_item(tree_acf_can, hf_1722_can_message_timestamp, tvb, offset, 8, ENC_BIG_ENDIAN); offset += 8; } /* Add message id subtree to CAN message */ tree_can_id = proto_tree_add_subtree(tree_can, tvb, offset, 4, ett_1722_can_msg_id, &ti, "Message Identifier"); proto_tree_add_item(tree_can_id, hf_1722_can_rsv2, tvb, offset, 4, ENC_BIG_ENDIAN); proto_item *ti_id = proto_tree_add_item_ret_uint(tree_can_id, hf_1722_can_identifier, tvb, offset, 4, ENC_BIG_ENDIAN, &parsed.id); proto_item_append_text(ti, parsed.is_xtd ? ": 0x%08X" : ": 0x%03X", parsed.id); if (!parsed.is_xtd && (parsed.id & ~IEEE_1722_ACF_CAN_11BIT_ID_MASK) != 0) { expert_add_info(pinfo, ti_id, &ei_1722_can_invalid_message_id); } offset += 4; /* Add text description to tree items and info column*/ describe_can_message(ti_acf_can, parsed.bus_id, parsed.id, flags); describe_can_message(proto_tree_get_parent(tree), parsed.bus_id, parsed.id, flags); col_set_str(pinfo->cinfo, COL_PROTOCOL, "ACF-CAN"); col_clear(pinfo->cinfo, COL_INFO); col_add_fstr(pinfo->cinfo, COL_INFO, "ACF-CAN(%u): 0x%08x ", parsed.bus_id, parsed.id); payload_length = tvb_reported_length_remaining(tvb, offset) - pad_length; if (payload_length < 0) { payload_length = 0; } parsed.datalen = (guint)payload_length; proto_tree_add_uint(tree_acf_can, hf_1722_can_len, tvb, offset, 1, parsed.datalen); if (payload_length > 0) col_append_str(pinfo->cinfo, COL_INFO, tvb_bytes_to_str_punct(pinfo->pool, tvb, offset, payload_length, ' ')); if (parsed.is_fd && !is_valid_canfd_payload_length(payload_length)) { expert_add_info(pinfo, ti_acf_can, &ei_1722_canfd_invalid_payload_length); } else if (!parsed.is_fd && !is_valid_can_payload_length(payload_length)) { expert_add_info(pinfo, ti_acf_can, &ei_1722_can_invalid_payload_length); } /* Add payload to parent tree */ /* * CAN sub-dissectors expect several flags to be merged into ID that is passed * to dissector_try_payload_new. Add them */ can_info.id = parsed.id; if (parsed.is_xtd) { can_info.id |= CAN_EFF_FLAG; } if (parsed.is_rtr) { can_info.id |= CAN_RTR_FLAG; } next_tvb = tvb_new_subset_length(tvb, offset, parsed.datalen); if (!socketcan_call_subdissectors(next_tvb, pinfo, tree, &can_info, can_heuristic_first)) { call_data_dissector(next_tvb, pinfo, tree); } /* Add padding bytes to ACF-CAN tree if any */ if (pad_length > 0 && tvb_reported_length_remaining(tvb, offset) >= (gint)pad_length) { proto_tree_add_item(tree_acf_can, hf_1722_can_padding, tvb, offset, pad_length, ENC_NA); } return captured_length; } static int dissect_1722_acf_can(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { return dissect_1722_acf_can_common(tvb, pinfo, tree, data, FALSE); } static int dissect_1722_acf_can_brief(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { return dissect_1722_acf_can_common(tvb, pinfo, tree, data, TRUE); } void proto_register_1722_acf_can(void) { static hf_register_info hf[] = { /* ACF-CAN, ACF-CAN-BRIEF and CAN fields */ { &hf_1722_can_flags, { "Flags", "acf-can.flags", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL }, }, { &hf_1722_can_pad, { "Padding Length", "acf-can.flags.pad", FT_UINT8, BASE_DEC, NULL, IEEE_1722_ACF_CAN_PAD_MASK, NULL, HFILL } }, { &hf_1722_can_len, { "Frame-Length", "can.len", FT_UINT8, BASE_DEC, NULL, 0x0, NULL, HFILL } }, { &hf_1722_can_mtvfield, { "Message Timestamp Valid", "acf-can.flags.mtv", FT_BOOLEAN, 8, NULL, IEEE_1722_ACF_CAN_MTV_MASK, NULL, HFILL } }, { &hf_1722_can_fdffield, { "CAN Flexible Data-rate Format", "acf-can.flags.fdf", FT_BOOLEAN, 8, NULL, IEEE_1722_ACF_CAN_FDF_MASK, NULL, HFILL } }, { &hf_1722_can_rtrfield, { "Remote Transmission Request Flag", "can.flags.rtr", FT_BOOLEAN, 8, NULL, IEEE_1722_ACF_CAN_RTR_MASK, NULL, HFILL } }, { &hf_1722_can_efffield, { "Extended Flag", "can.flags.xtd", FT_BOOLEAN, 8, NULL, IEEE_1722_ACF_CAN_EFF_MASK, NULL, HFILL } }, { &hf_1722_can_brsfield, { "Bit Rate Setting", "canfd.flags.brs", FT_BOOLEAN, 8, NULL, IEEE_1722_ACF_CAN_BRS_MASK, NULL, HFILL } }, { &hf_1722_can_esifield, { "Error Message Flag", "canfd.flags.esi", FT_BOOLEAN, 8, NULL, IEEE_1722_ACF_CAN_ESI_MASK, NULL, HFILL } }, { &hf_1722_can_rsv1, { "Reserved Bits", "acf-can.rsv1", FT_UINT8, BASE_HEX, NULL, IEEE_1722_ACF_CAN_RSV1_MASK, NULL, HFILL } }, { &hf_1722_can_bus_id, { "CAN Bus Identifier", "acf-can.bus_id", FT_UINT8, BASE_DEC, NULL, IEEE_1722_ACF_CAN_BUS_ID_MASK, NULL, HFILL } }, { &hf_1722_can_message_timestamp, { "Message Timestamp", "acf-can.message_timestamp", FT_UINT64, BASE_HEX, NULL, IEEE_1722_ACF_CAN_MSG_TIMESTAMP_MASK, NULL, HFILL } }, { &hf_1722_can_rsv2, { "Reserved", "can.reserved", FT_UINT32, BASE_HEX, NULL, IEEE_1722_ACF_CAN_RSV2_MASK, NULL, HFILL } }, { &hf_1722_can_identifier, { "CAN Message Identifier", "can.id", FT_UINT32, BASE_HEX, NULL, IEEE_1722_ACF_CAN_IDENTIFIER_MASK, NULL, HFILL } }, { &hf_1722_can_padding, { "Padding", "can.padding", FT_BYTES, BASE_NONE, NULL, 0x0, NULL, HFILL } }, }; static gint *ett[] = { &ett_1722_can, &ett_1722_can_flags, &ett_1722_can_bus_id, &ett_1722_can_msg_id, &ett_can }; static ei_register_info ei[] = { { &ei_1722_can_header_cropped, { "acf-can.expert.header_cropped", PI_PROTOCOL, PI_WARN, "Message is cropped, no space for header", EXPFILL }}, { &ei_1722_can_invalid_message_id, { "acf-can.expert.incorrect_can_id", PI_PROTOCOL, PI_WARN, "Incorrect msg id, shall be 0..1FF when EFF flag is not set", EXPFILL }}, { &ei_1722_can_invalid_payload_length, { "acf-can.expert.incorrect_datalen", PI_PROTOCOL, PI_WARN, "Incorrect payload length, shall be [0..8] when FDF flag is not set", EXPFILL }}, { &ei_1722_canfd_invalid_payload_length,{ "acf-can.expert.incorrect_fd_datalen", PI_PROTOCOL, PI_WARN, "Incorrect FD payload length, shall be [0..8, 12, 16, 20, 32, 48, 64] when FDF flag is set", EXPFILL }}, }; module_t* module_acf_can; expert_module_t* expert_1722_acf_can; /* Register the protocol name and description */ proto_1722_acf_can = proto_register_protocol("ACF CAN", "CAN over AVTP", "acf-can"); avb1722_can_handle = register_dissector("acf-can", dissect_1722_acf_can, proto_1722_acf_can); avb1722_can_brief_handle = register_dissector("acf-can-brief", dissect_1722_acf_can_brief, proto_1722_acf_can); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_acf_can, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722_acf_can = expert_register_protocol(proto_1722_acf_can); expert_register_field_array(expert_1722_acf_can, ei, array_length(ei)); /* register preferences */ module_acf_can = prefs_register_protocol(proto_1722_acf_can, NULL); prefs_register_obsolete_preference(module_acf_can, "protocol"); prefs_register_bool_preference( module_acf_can, "try_heuristic_first", "Try heuristic sub-dissectors first", "Try to decode a packet using an heuristic sub-dissector" " before using a sub-dissector registered to \"decode as\"", &can_heuristic_first ); } void proto_reg_handoff_1722_acf_can(void) { dissector_add_uint("acf.msg_type", IEEE_1722_ACF_TYPE_CAN, avb1722_can_handle); dissector_add_uint("acf.msg_type", IEEE_1722_ACF_TYPE_CAN_BRIEF, avb1722_can_brief_handle); register_depend_dissector("acf-can", "can"); register_depend_dissector("acf-can", "canfd"); proto_can = proto_get_id_by_filter_name("can"); proto_canfd = proto_get_id_by_filter_name("canfd"); } /**************************************************************************************************/ /* ACF LIN Message dissector implementation */ /* */ /**************************************************************************************************/ static void describe_lin_message(proto_item *dst, guint32 bus_id, guint32 lin_id) { proto_item_append_text(dst, ": bus_id=%u, id=0x%02X", bus_id, lin_id); } static int dissect_1722_acf_lin(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_) { proto_item *ti; proto_item *ti_lin; proto_tree *tree_lin; proto_tree *tree_flags; guint offset = 0; guint captured_length = tvb_captured_length(tvb); guint32 pad_length; gboolean mtv; guint32 bus_id; guint32 lin_id; gint payload_length; ti_lin = proto_tree_add_item(tree, proto_1722_acf_lin, tvb, offset, -1, ENC_NA); tree_lin = proto_item_add_subtree(ti_lin, ett_1722_lin); if (captured_length < IEEE_1722_ACF_LIN_HEADER_SIZE) { expert_add_info(pinfo, ti_lin, &ei_1722_lin_header_cropped); return captured_length; } tree_flags = proto_tree_add_subtree(tree_lin, tvb, offset, 1, ett_1722_lin_flags, &ti, "Flags and BusID"); proto_tree_add_item_ret_uint(tree_flags, hf_1722_lin_pad, tvb, offset, 1, ENC_BIG_ENDIAN, &pad_length); proto_tree_add_item_ret_boolean(tree_flags, hf_1722_lin_mtv, tvb, offset, 1, ENC_BIG_ENDIAN, &mtv); proto_tree_add_item_ret_uint(tree_flags, hf_1722_lin_bus_id, tvb, offset, 1, ENC_BIG_ENDIAN, &bus_id); proto_item_append_text(ti, ": pad=%u, mtv=%u, bus_id=%u", pad_length, (unsigned)mtv, bus_id); offset += 1; proto_tree_add_item_ret_uint(tree_lin, hf_1722_lin_identifier, tvb, offset, 1, ENC_BIG_ENDIAN, &lin_id); offset += 1; proto_tree_add_item(tree_lin, hf_1722_lin_message_timestamp, tvb, offset, 8, ENC_BIG_ENDIAN); offset += 8; describe_lin_message(ti_lin, bus_id, lin_id); describe_lin_message(proto_tree_get_parent(tree), bus_id, lin_id); col_set_str(pinfo->cinfo, COL_PROTOCOL, "ACF-LIN"); col_clear(pinfo->cinfo, COL_INFO); col_add_fstr(pinfo->cinfo, COL_INFO, "ACF-LIN(%u): 0x%02x ", bus_id, lin_id); payload_length = tvb_reported_length_remaining(tvb, offset) - pad_length; if (payload_length < 0 || payload_length > 8) { expert_add_info(pinfo, ti_lin, &ei_1722_lin_invalid_payload_length); } else if (payload_length > 0) { tvbuff_t* next_tvb = tvb_new_subset_length(tvb, offset, payload_length); col_append_str(pinfo->cinfo, COL_INFO, tvb_bytes_to_str_punct(pinfo->pool, tvb, offset, payload_length, ' ')); /* at the moment, there's no global LIN sub-protocols support. Use our own. */ if (dissector_try_payload_new(avb1722_acf_lin_dissector_table, next_tvb, pinfo, tree, TRUE, &lin_id) <= 0) { call_data_dissector(next_tvb, pinfo, tree); } offset += payload_length; } if (pad_length > 0 && tvb_reported_length_remaining(tvb, offset) >= (gint)pad_length) { proto_tree_add_item(tree_lin, hf_1722_lin_padding, tvb, offset, pad_length, ENC_NA); } return captured_length; } void proto_register_1722_acf_lin(void) { static hf_register_info hf[] = { { &hf_1722_lin_pad, { "Padding Length", "acf-lin.flags.pad", FT_UINT8, BASE_DEC, NULL, IEEE_1722_ACF_LIN_PAD_MASK, NULL, HFILL } }, { &hf_1722_lin_mtv, { "Message Timestamp Valid", "acf-lin.flags.mtv", FT_BOOLEAN, 8, NULL, IEEE_1722_ACF_LIN_MTV_MASK, NULL, HFILL } }, { &hf_1722_lin_bus_id, { "LIN Bus Identifier", "acf-lin.bus_id", FT_UINT8, BASE_DEC, NULL, IEEE_1722_ACF_LIN_BUS_ID_MASK, NULL, HFILL } }, { &hf_1722_lin_identifier, { "LIN Message Identifier", "acf-lin.id", FT_UINT8, BASE_HEX, NULL, IEEE_1722_ACF_LIN_IDENTIFIER_MASK, NULL, HFILL } }, { &hf_1722_lin_message_timestamp, { "Message Timestamp", "acf-lin.message_timestamp", FT_UINT64, BASE_HEX, NULL, IEEE_1722_ACF_LIN_MSG_TIMESTAMP_MASK, NULL, HFILL } }, { &hf_1722_lin_padding, { "Padding", "acf-lin.padding", FT_BYTES, BASE_NONE, NULL, 0x0, NULL, HFILL } }, }; static gint *ett[] = { &ett_1722_lin, &ett_1722_lin_flags, }; static ei_register_info ei[] = { { &ei_1722_lin_header_cropped, { "acf-lin.expert.header_cropped", PI_PROTOCOL, PI_WARN, "Message is cropped, no space for header", EXPFILL }}, { &ei_1722_lin_invalid_payload_length, { "acf-lin.expert.incorrect_datalen", PI_PROTOCOL, PI_WARN, "Incorrect payload length, shall be [0..8]", EXPFILL }}, }; expert_module_t* expert_1722_acf_lin; /* Register the protocol name and description */ proto_1722_acf_lin = proto_register_protocol("ACF LIN", "LIN over AVTP", "acf-lin"); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_1722_acf_lin, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); expert_1722_acf_lin = expert_register_protocol(proto_1722_acf_lin); expert_register_field_array(expert_1722_acf_lin, ei, array_length(ei)); avb1722_acf_lin_dissector_table = register_decode_as_next_proto(proto_1722_acf_lin, "acf-lin.subdissector", "ACF-LIN next level dissector", NULL); } void proto_reg_handoff_1722_acf_lin(void) { dissector_handle_t avb1722_acf_lin_handle; avb1722_acf_lin_handle = create_dissector_handle(dissect_1722_acf_lin, proto_1722_acf_lin); dissector_add_uint("acf.msg_type", IEEE_1722_ACF_TYPE_LIN, avb1722_acf_lin_handle); } /* * Editor modelines - https://www.wireshark.org/tools/modelines.html * * Local variables: * c-basic-offset: 4 * tab-width: 8 * indent-tabs-mode: nil * End: * * vi: set shiftwidth=4 tabstop=8 expandtab: * :indentSize=4:tabSize=8:noTabs=true: */