wireshark/epan/dissectors/packet-idn.c

1690 lines
51 KiB
C

/* packet-idn.c
* Routines for IDN dissection
* By Maxim Kropp <maxim.kropp@hotmail.de>
* Copyright 2017 Maxim Kropp
*
* Supervised by Matthias Frank <matthew@cs.uni-bonn.de>
* Copyright 2017 Matthias Frank, Institute of Computer Science 4, University of Bonn
*
* Stream Specification: https://www.ilda.com/resources/StandardsDocs/ILDA_IDN-Stream_rev001.pdf
* This specification only defines IDN messages, the other packet commands
* are part of the hello specification which is not released yet.
*
* Wireshark - Network traffic analyzer
* By Gerald Combs <gerald@wireshark.org>
* Copyright 1998 Gerald Combs
*
* SPDX-License-Identifier: GPL-2.0-or-later
*/
#include <config.h>
#include <epan/packet.h>
#include <epan/conversation.h>
#define IDN_PORT 7255
#define MAX_CHANNELS 512
#define MAX_BUFFER 2048
/* Packet Commands */
#define IDNCMD_VOID 0x00
#define IDNCMD_PING_REQUEST 0x08
#define IDNCMD_PING_RESPONSE 0x09
#define IDNCMD_SCAN_REQUEST 0x10
#define IDNCMD_SCAN_RESPONSE 0x11
#define IDNCMD_SERVICEMAP_REQUEST 0x12
#define IDNCMD_SERVICEMAP_RESPONSE 0x13
#define IDNCMD_MESSAGE 0x40
#define IDNCMD_MESSAGE_ACKREQ 0x41
#define IDNCMD_MESSAGE_CLOSE 0x44
#define IDNCMD_MESSAGE_ACKREQ_CLOSE 0x45
#define IDNCMD_MESSAGE_ACK 0x47
/* Chunk Types */
#define IDNCT_VOID 0x00
#define IDNCT_LP_WAVE_SAMPLE 0x01
#define IDNCT_LP_FRAME_CHUNK 0x02
#define IDNCT_LP_FRAME_FF 0x03
#define IDNCT_LP_FRAME_SF 0xC0
#define IDNCT_OCTET_SEGMENT 0x10
#define IDNCT_OCTET_STRING 0x11
#define IDNCT_DIMMER_LEVELS 0x18
/* Service Modes (CONT = continuous stream, DISC = discrete stream) */
#define IDNSM_VOID 0x00
#define IDNSM_LP_GRAPHIC_CONT 0x01
#define IDNSM_LP_GRAPHIC_DISC 0x02
#define IDNSM_LP_EFFECTS_CONT 0x03
#define IDNSM_LP_EFFECTS_DISC 0x04
#define IDNSM_DMX512_CONT 0x05
#define IDNSM_DMX512_DISC 0x06
/* Dictionary Tags */
#define IDNTAG_PRECISION 0x4010
#define IDNTAG_WAVELENGTH_PREFIX 0x5C00
#define IDNTAG_INTENSITY 0x5C10
#define IDNTAG_BEAM_BRUSH 0x5C20
#define IDNTAG_BREAK_START 0x1000
#define IDNTAG_BREAK_END 0x100F
#define IDNTAG_SPACE_MOD_START 0x1100
#define IDNTAG_SPACE_MOD_END 0x11FF
#define IDNTAG_NOP 0x4000
#define IDNTAG_HINT0 0x4100
#define IDNTAG_HINT1 0x4101
#define IDNTAG_COLOR_START 0x5000
#define IDNTAG_COLOR_END 0x53FF
#define IDNTAG_COLOR_RED 0x527E
#define IDNTAG_COLOR_GREEN 0x5214
#define IDNTAG_COLOR_BLUE 0x51CC
#define IDNTAG_OPTIONAL_U1 0x51BD
#define IDNTAG_OPTIONAL_U2 0x5241
#define IDNTAG_OPTIONAL_U3 0x51E8
#define IDNTAG_OPTIONAL_U4 0x4201
#define IDNTAG_COORD_X 0x4200
#define IDNTAG_COORD_X_END 0x420F
#define IDNTAG_COORD_Y 0x4210
#define IDNTAG_COORD_Y_END 0x421F
#define IDNTAG_COORD_Z 0x4220
#define IDNTAG_COORD_Z_END 0x422F
#define IDNTAG_DIMMER_START 0x0040
#define IDNTAG_DIMMER_END 0x004F
/* Other */
#define IDNO_VOID_AREA 0xF
typedef struct {
gboolean has_config_header;
gboolean is_dmx;
guint16 total_size;
guint8 channel_id;
guint8 chunk_type;
} message_info;
typedef struct {
guint8 word_count;
guint8 sdm;
char *dic_precision;
char *sample_column_string;
int sample_size;
int *count;
int *base;
} configuration_info;
void proto_register_idn(void);
void proto_reg_handoff_idn(void);
static int proto_idn = -1;
static gint ett_idn = -1;
static gint ett_idn_header_tree = -1;
static gint ett_idn_scanreply_header_tree = -1;
static gint ett_idn_channel_message_header_tree = -1;
static gint ett_protocol_version = -1;
static gint ett_status = -1;
static gint ett_idn_cnl = -1;
static gint ett_configuration_header = -1;
static gint ett_chunk_header_tree = -1;
static gint ett_chunk_header_flags = -1;
static gint ett_cfl = -1;
static gint ett_dic = -1;
static gint ett_dic_tree = -1;
static gint ett_data = -1;
static gint ett_subdata = -1;
static gint ett_dmx_subtree = -1;
/* IDN-Header */
static int idn_command = -1;
static int idn_flags = -1;
static int idn_sequence = -1;
static int idn_total_size = -1;
/* Scanreply Header */
static int idn_struct_size = -1;
static int idn_protocol_version = -1;
static int idn_protocol_version_major = -1;
static int idn_protocol_version_minor = -1;
static int idn_status = -1;
static int idn_malfn = -1;
static int idn_offline = -1;
static int idn_xcld = -1;
static int idn_ocpd = -1;
static int idn_rt = -1;
static int idn_reserved8 = -1;
static int idn_unit_id = -1;
static int idn_name = -1;
/* Service Map Response */
static int idn_entry_size = -1;
static int idn_relay_count = -1;
static int idn_service_count = -1;
static int idn_relay_number = -1;
/* Channel Message Header */
static int idn_cnl = -1;
static int idn_most_significant_bit_cnl = -1;
static int idn_cclf = -1;
static int idn_channel_id = -1;
static int idn_chunk_type = -1;
static int idn_timestamp = -1;
/* Configuration Header */
static int idn_scwc = -1;
static int idn_cfl = -1;
static int idn_sdm = -1;
static int idn_close = -1;
static int idn_routing = -1;
static int idn_service_id = -1;
static int idn_service_mode = -1;
/* Chunk Header */
static int idn_chunk_header_flags = -1;
static int idn_two_bits_reserved_1 = -1;
static int idn_two_bits_reserved_2 = -1;
static int idn_three_bits_reserved = -1;
static int idn_four_bits_reserved = -1;
static int idn_scm = -1;
static int idn_once = -1;
static int idn_duration = -1;
static int idn_chunk_data_sequence = -1;
static int idn_offset = -1;
static int idn_dlim = -1;
static int idn_reserved = -1;
/* Tags */
static int idn_gts = -1;
static int idn_gts_void = -1;
static int idn_boundary = -1;
static int idn_gts_word = -1;
static int idn_gts_break = -1;
static int idn_gts_space_modifier = -1;
static int idn_gts_hint = -1;
static int idn_gts_category = -1;
static int idn_gts_subcategory = -1;
static int idn_gts_identifier = -1;
static int idn_gts_parameter = -1;
static int idn_gts_glin = -1;
static int idn_gts_clin = -1;
static int idn_gts_cbal = -1;
static int idn_gts_ctim = -1;
static int idn_gts_nop = -1;
static int idn_gts_precision = -1;
static int idn_gts_cscl = -1;
static int idn_gts_iscl = -1;
static int idn_gts_sht = -1;
static int idn_gts_u4 = -1;
static int idn_gts_x = -1;
static int idn_gts_y = -1;
static int idn_gts_z = -1;
static int idn_gts_color = -1;
static int idn_gts_wavelength_prefix = -1;
static int idn_gts_intensity = -1;
static int idn_gts_beam_brush = -1;
static int idn_gts_sample = -1;
static int idn_dmx_octet = -1;
static int idn_dmx_identifier = -1;
static int idn_dmx_parameter = -1;
static int idn_dmx_void = -1;
static int idn_octet = -1;
static int idn_dmx_base = -1;
static int idn_dmx_count = -1;
static int idn_dmx_dls = -1;
static int idn_dmx_unknown = -1;
/* Acknowledgement */
static int idn_result_code = -1;
static int idn_event_flags = -1;
static const value_string command_code[] = {
{ IDNCMD_VOID, "VOID" },
{ IDNCMD_PING_REQUEST, "PING_REQUEST" },
{ IDNCMD_PING_RESPONSE, "PING_RESPONSE" },
{ IDNCMD_SCAN_REQUEST, "SCAN_REQUEST" },
{ IDNCMD_SCAN_RESPONSE, "SCAN_RESPONSE" },
{ IDNCMD_SERVICEMAP_REQUEST, "SERVICEMAP_REQUEST" },
{ IDNCMD_SERVICEMAP_RESPONSE, "SERVICEMAP_RESPONSE" },
{ IDNCMD_MESSAGE, "MESSAGE" },
{ IDNCMD_MESSAGE_ACKREQ, "MESSAGE_ACKREQ" },
{ IDNCMD_MESSAGE_CLOSE, "MESSAGE_CLOSE" },
{ IDNCMD_MESSAGE_ACKREQ_CLOSE, "MESSAGE_ACKREQ_CLOSE" },
{ IDNCMD_MESSAGE_ACK, "MESSAGE_ACK" },
{ 0, NULL}
};
static const value_string chunk_type[] = {
{ IDNCT_VOID, "VOID" },
{ IDNCT_LP_WAVE_SAMPLE, "Laser Projector Wave Samples" },
{ IDNCT_LP_FRAME_CHUNK, "Laser Projector Frame Samples (entire chunk)" },
{ IDNCT_LP_FRAME_FF, "Laser Projector Frame Samples (first fragment)" },
{ IDNCT_OCTET_SEGMENT, "Octet Segment" },
{ IDNCT_OCTET_STRING, "Octet String" },
{ IDNCT_DIMMER_LEVELS, "Dimmer Levels" },
{ IDNCT_LP_FRAME_SF, "Laser Projector Frame Samples (sequel fragment)" },
{ 0, NULL}
};
static const value_string cfl_string[] = {
{ 0x30, "DATA_MATCH" },
{ 0x01, "ROUTING" },
{ 0x02, "CLOSE" },
{ 0, NULL}
};
static const value_string service_mode_string[] = {
{ IDNSM_VOID, "VOID" },
{ IDNSM_LP_GRAPHIC_CONT, "Laser Projector Graphic (Continuous)" },
{ IDNSM_LP_GRAPHIC_DISC, "Laser Projector Graphic (Discrete)" },
{ IDNSM_LP_EFFECTS_CONT, "Laser Projector Effects (Continuous)" },
{ IDNSM_LP_EFFECTS_DISC, "Laser Projector Effects (Discrete)" },
{ IDNSM_DMX512_CONT, "DMX512 (Continuous)" },
{ IDNSM_DMX512_DISC, "DMX512 (Discrete)" },
{ 0, NULL}
};
static const value_string gts_glin[] = {
{ 0, "Projector specific" },
{ 1, "Geometrically corrected and linear, aspect ratio 1:1" },
{ 2, "Reserved" },
{ 3, "No transformation" },
{ 0, NULL}
};
static const value_string gts_clin[] = {
{ 0, "Projector specific" },
{ 1, "Power linear (half value SHALL be half power)" },
{ 2, "Visually linear (half value SHALL be half brightness)" },
{ 3, "No transformation" },
{ 0, NULL}
};
static const value_string gts_cbal[] = {
{ 0, "Projector specific" },
{ 1, "White balanced" },
{ 2, "Reserved" },
{ 3, "No transformation" },
{ 0, NULL}
};
static const value_string gts_ctim[] = {
{ 0, "Projector specific" },
{ 1, "Coordinates and colors correlated in time" },
{ 2, "Reserved" },
{ 3, "No transformation" },
{ 0, NULL}
};
static const value_string idn_color[] = {
{ 638, "Red" },
{ 532, "Green" },
{ 460, "Blue" },
{ 445, "Optional(U1), used as deep blue" },
{ 577, "Optional(U2), used as yellow" },
{ 488, "Optional(U3), used as cyan" },
{ 0, NULL}
};
static const value_string result_code[] = {
{ 0x00, "Message successfully received and passed to the IDN session" },
{ 0xEB, "Empty (no message) close command without established connection" },
{ 0xEC, "All sessions are occupied by clients (new connection refused)" },
{ 0xED, "The client group is excluded from streaming" },
{ 0xEE, "Invalid payload" },
{ 0xEF, "Any other processing error" },
{ 0, NULL}
};
static int get_service_match(guint8 flags) {
return flags >> 4;
}
static void determine_message_type(packet_info *pinfo, message_info *minfo) {
minfo->is_dmx = 0;
switch(minfo->chunk_type) {
case IDNCT_VOID:
col_append_str(pinfo->cinfo, COL_INFO, "-VOID");
break;
case IDNCT_LP_WAVE_SAMPLE:
col_append_str(pinfo->cinfo, COL_INFO, "-WAVE");
break;
case IDNCT_LP_FRAME_CHUNK:
col_append_str(pinfo->cinfo, COL_INFO, "-FRAME");
break;
case IDNCT_LP_FRAME_FF:
col_append_str(pinfo->cinfo, COL_INFO, "-FIRST");
break;
case IDNCT_DIMMER_LEVELS:
col_append_str(pinfo->cinfo, COL_INFO, "-DMX");
minfo->is_dmx = 1;
break;
case IDNCT_OCTET_STRING:
col_append_str(pinfo->cinfo, COL_INFO, "-DMX");
minfo->is_dmx = 1;
break;
case IDNCT_OCTET_SEGMENT:
col_append_str(pinfo->cinfo, COL_INFO, "-DMX");
minfo->is_dmx = 1;
break;
case IDNCT_LP_FRAME_SF:
if(minfo->has_config_header) {
col_append_str(pinfo->cinfo, COL_INFO, "-LAST");
}else {
col_append_str(pinfo->cinfo, COL_INFO, "-SEQ");
}
break;
default:
col_append_str(pinfo->cinfo, COL_INFO, "-UNKNOWN");
}
}
static void determine_color(guint16 catsub, configuration_info *config) {
char *column_str = config->sample_column_string;
const int l = (const int)strlen(column_str);
switch(catsub) {
case IDNTAG_COLOR_RED:
snprintf(column_str+l, MAX_BUFFER-l, " R");
break;
case IDNTAG_COLOR_GREEN:
snprintf(column_str+l, MAX_BUFFER-l, " G");
break;
case IDNTAG_COLOR_BLUE:
snprintf(column_str+l, MAX_BUFFER-l, " B");
break;
case IDNTAG_OPTIONAL_U1:
snprintf(column_str+l, MAX_BUFFER-l, " U1");
break;
case IDNTAG_OPTIONAL_U2:
snprintf(column_str+l, MAX_BUFFER-l, " U2");
break;
case IDNTAG_OPTIONAL_U3:
snprintf(column_str+l, MAX_BUFFER-l, " U3");
break;
default:
snprintf(column_str+l, MAX_BUFFER-l, " C");
}
}
static int dissect_idn_message_acknowledgement(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
proto_tree *idn_message_acknowledgement_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 4, ett_idn_header_tree, NULL, "Message Acknowledgement");
proto_tree_add_item(idn_message_acknowledgement_tree, idn_struct_size, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_message_acknowledgement_tree, idn_result_code, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_message_acknowledgement_tree, idn_event_flags, tvb, offset, 2, ENC_BIG_ENDIAN);
offset += 2;
return offset;
}
static configuration_info *get_configuration_info(packet_info *pinfo, int channel_id) {
configuration_info *config = NULL;
conversation_t *conv = find_conversation(pinfo->fd->num, &pinfo->src, &pinfo->dst, conversation_pt_to_conversation_type(pinfo->ptype), pinfo->srcport, pinfo->destport, channel_id);
if(conv)
config = (configuration_info *)conversation_get_proto_data(conv, proto_idn);
if(!config)
col_append_str(pinfo->cinfo, COL_INFO, ", no valid Configuration");
return config;
}
static int dissect_idn_dmx_sample_values(tvbuff_t *tvb, int offset, proto_tree *idn_dmx_subtree, guint16 data_size, int base) {
int i, j, l;
short int rest;
char values[MAX_BUFFER];
for(i=0; i+16<=data_size; i+=16) {
l = 0;
for(j=1; j<16; j++){
l += snprintf(values+l, MAX_BUFFER-l, " %3d", tvb_get_guint8(tvb, offset+j));
}
proto_tree_add_int_format(idn_dmx_subtree, idn_gts_sample, tvb, offset, 16, 16, "%3d: %s", base+i, values);
offset += 16;
}
rest = data_size - i;
if(rest > 0) {
l = 0;
for(j=0; j<rest; j++){
l += snprintf(values+l, MAX_BUFFER-l, " %3d", tvb_get_guint8(tvb, offset+j));
}
proto_tree_add_int_format(idn_dmx_subtree, idn_gts_sample, tvb, offset, rest, rest, "%3d: %s", base+i, values);
offset += rest;
}
return offset;
}
static void set_laser_sample_values_string(tvbuff_t *tvb, int offset, configuration_info *config, char *values) {
int i;
int l = 0;
if((config->dic_precision)[2] == 1)
l += snprintf(values, MAX_BUFFER, "%5d", tvb_get_guint16(tvb, offset, 2));
else
l += snprintf(values, MAX_BUFFER, "%5d", tvb_get_guint8(tvb, offset));
for(i=1; i<config->sample_size && (l < MAX_BUFFER-100); i++){
if((config->dic_precision)[i+1] == 1) {
//do nothing
}else if((config->dic_precision)[i+2] == 1) {
l += snprintf(values+l, MAX_BUFFER-l, " %5d", tvb_get_guint16(tvb, offset+i, 2));
i++;
}else {
l += snprintf(values+l, MAX_BUFFER-l, " %5d", tvb_get_guint8(tvb, offset+i));
}
}
}
static int dissect_idn_octet_segment(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
int i, j, l;
short int rest;
char values[MAX_BUFFER];
values[0] = '\0';
int data_size = tvb_reported_length_remaining(tvb, offset);
proto_tree *idn_samples_tree = proto_tree_add_subtree(idn_tree, tvb, offset, data_size, ett_data, NULL, "Octets");
for(i=0; i+16<=data_size; i+=16) {
l = 0;
for(j=0; j<16 && (l < MAX_BUFFER-100); j++){
l += snprintf(values+l, MAX_BUFFER-l, " %3d", tvb_get_gint8(tvb, offset+j));
}
proto_tree_add_int_format(idn_samples_tree, idn_gts_sample, tvb, offset, 16, 16, "%s", values);
offset += 16;
}
rest = data_size - i;
if(rest > 0) {
l = 0;
for(j=0; j<rest && (l < MAX_BUFFER-100); j++){
l += snprintf(values+l, MAX_BUFFER-l, " %3d", tvb_get_gint8(tvb, offset+j));
}
proto_tree_add_int_format(idn_samples_tree, idn_gts_sample, tvb, offset, rest, rest, "%s", values);
offset += rest;
}
return offset;
}
static int dissect_idn_dmx_data(tvbuff_t *tvb, packet_info *pinfo, int offset, proto_tree *idn_tree, configuration_info *config) {
int i;
int *count = config->count;
int *base = config->base;
int base_value;
guint16 data_size = tvb_reported_length_remaining(tvb, offset);
proto_tree *idn_samples_tree = proto_tree_add_subtree(idn_tree, tvb, offset, data_size, ett_data, NULL, "Channels");
proto_tree *idn_dmx_subtree;
for(i=0; i<config->word_count; i++) {
base_value = base[i]-1;
if(base_value == -1)
break;
if(count[i] != -1) {
data_size = count[i];
if(data_size + base_value > MAX_CHANNELS) {
col_append_fstr(pinfo->cinfo, COL_INFO, " (Error: over %5d Channels)", MAX_CHANNELS);
return offset;
}
idn_dmx_subtree = proto_tree_add_subtree_format(idn_samples_tree, tvb, offset, data_size, ett_dmx_subtree, NULL, "Range: %3d - %3d", base[i], base_value+data_size);
}else {
int base_size = MAX_CHANNELS - base_value;
data_size = tvb_reported_length_remaining(tvb, offset);
if(data_size > base_size) {
data_size = base_size;
}
if(data_size + base_value > MAX_CHANNELS) {
data_size = MAX_CHANNELS - base_value;
}
idn_dmx_subtree = proto_tree_add_subtree_format(idn_samples_tree, tvb, offset, data_size, ett_dmx_subtree, NULL, "Range: %3d - %3d", base[i], base_value+data_size);
}
offset = dissect_idn_dmx_sample_values(tvb, offset, idn_dmx_subtree, data_size, base_value);
}
return offset;
}
static int dissect_idn_laser_data(tvbuff_t *tvb, int offset, proto_tree *idn_tree, configuration_info *config) {
char values[MAX_BUFFER];
values[0] = '\0';
int i;
int laser_data_size = tvb_reported_length_remaining(tvb, offset);
if (config->sample_size == 0) {
/* TODO: log expert info error? */
return 0;
}
int sample_size = laser_data_size/config->sample_size;
proto_tree *idn_samples_tree = proto_tree_add_subtree_format(idn_tree, tvb, offset, laser_data_size, ett_data, NULL, "Samples %s", config->sample_column_string);
proto_tree *idn_samples_subtree = NULL;
for(i=1; i<=sample_size; i++) {
if((i-1)%10 == 0 && i+10 > sample_size) {
idn_samples_subtree = proto_tree_add_subtree_format(idn_samples_tree, tvb, offset, tvb_reported_length_remaining(tvb, offset), ett_subdata, NULL, "Samples %3d - %3d", i, sample_size);
}else if((i-1)%10 == 0) {
idn_samples_subtree = proto_tree_add_subtree_format(idn_samples_tree, tvb, offset, config->sample_size*10, ett_subdata, NULL, "Samples %3d - %3d", i, i+9);
}
set_laser_sample_values_string(tvb, offset, config, values);
proto_tree_add_int_format(idn_samples_subtree, idn_gts_sample, tvb, offset, config->sample_size, config->sample_size, "Sample %3d: %s", i, values);
offset += config->sample_size;
}
return offset;
}
static int dissect_idn_dimmer_levels_chunk_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
static int * const dimmer_levels_chunk_flags[] = {
&idn_two_bits_reserved_1,
&idn_scm,
&idn_four_bits_reserved,
NULL
};
proto_tree *chunk_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 4, ett_chunk_header_tree, NULL, "Dimmer Levels Chunk Header");
proto_tree_add_bitmask(chunk_header_tree, tvb, offset, idn_chunk_header_flags, ett_chunk_header_flags, dimmer_levels_chunk_flags, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_reserved, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_reserved, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_reserved, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
return offset;
}
static int dissect_idn_octet_string_chunk_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
static int * const octet_string_chunk_flags[] = {
&idn_two_bits_reserved_1,
&idn_scm,
&idn_four_bits_reserved,
NULL
};
proto_tree *chunk_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 4, ett_chunk_header_tree, NULL, "Octet String Chunk Header");
proto_tree_add_bitmask(chunk_header_tree, tvb, offset, idn_chunk_header_flags, ett_chunk_header_flags, octet_string_chunk_flags, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_reserved, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_reserved, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_reserved, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
return offset;
}
static int dissect_idn_octet_segment_chunk_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
static int * const octet_segment_chunk_flags[] = {
&idn_two_bits_reserved_1,
&idn_scm,
&idn_three_bits_reserved,
&idn_dlim,
NULL
};
proto_tree *chunk_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 4, ett_chunk_header_tree, NULL, "Octet Segment Chunk Header");
proto_tree_add_bitmask(chunk_header_tree, tvb, offset, idn_chunk_header_flags, ett_chunk_header_flags, octet_segment_chunk_flags, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_chunk_data_sequence, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_offset, tvb, offset, 2, ENC_BIG_ENDIAN);
offset += 2;
return offset;
}
static int dissect_idn_frame_chunk_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
static int * const frame_sample_chunk_flags[] = {
&idn_two_bits_reserved_1,
&idn_scm,
&idn_three_bits_reserved,
&idn_once,
NULL
};
proto_tree *chunk_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 4, ett_chunk_header_tree, NULL, "Frame Sample Chunk Header");
proto_tree_add_bitmask(chunk_header_tree, tvb, offset, idn_chunk_header_flags, ett_chunk_header_flags, frame_sample_chunk_flags, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_duration, tvb, offset, 3, ENC_BIG_ENDIAN);
offset += 3;
return offset;
}
static int dissect_idn_wave_chunk_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
static int * const wave_sample_chunk_flags[] = {
&idn_two_bits_reserved_1,
&idn_scm,
&idn_four_bits_reserved,
NULL
};
proto_tree *chunk_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 4, ett_chunk_header_tree, NULL, "Wave Sample Chunk Header");
proto_tree_add_bitmask(chunk_header_tree, tvb, offset, idn_chunk_header_flags, ett_chunk_header_flags, wave_sample_chunk_flags, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(chunk_header_tree, idn_duration, tvb, offset, 3, ENC_BIG_ENDIAN);
offset += 3;
return offset;
}
static int dissect_idn_chunk_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree, message_info *minfo) {
switch(minfo->chunk_type) {
case IDNCT_LP_WAVE_SAMPLE:
offset = dissect_idn_wave_chunk_header(tvb, offset, idn_tree);
break;
case IDNCT_LP_FRAME_CHUNK:
offset = dissect_idn_frame_chunk_header(tvb, offset, idn_tree);
break;
case IDNCT_LP_FRAME_FF:
offset = dissect_idn_frame_chunk_header(tvb, offset, idn_tree);
break;
case IDNCT_OCTET_SEGMENT:
offset = dissect_idn_octet_segment_chunk_header(tvb, offset, idn_tree);
break;
case IDNCT_OCTET_STRING:
offset = dissect_idn_octet_string_chunk_header(tvb, offset, idn_tree);
break;
case IDNCT_DIMMER_LEVELS:
offset = dissect_idn_dimmer_levels_chunk_header(tvb, offset, idn_tree);
break;
default:
return offset;
}
return offset;
}
static int dissect_idn_dmx_gts(tvbuff_t *tvb, int offset, proto_tree *gts_tree, const int hf_hdr, int *dictionary_size) {
static int * const gts[] = {
&idn_dmx_identifier,
&idn_dmx_parameter,
NULL
};
proto_tree_add_bitmask(gts_tree, tvb, offset, hf_hdr, ett_dic, gts, ENC_BIG_ENDIAN);
offset++;
if(dictionary_size)
(*dictionary_size)++;
return offset;
}
static int dissect_idn_dimmer_level_subset(tvbuff_t *tvb, int offset, proto_tree *gts_tree, configuration_info *config, int i, int *dictionary_size) {
guint8 dls = tvb_get_guint8(tvb, offset);
offset = dissect_idn_dmx_gts(tvb, offset, gts_tree, idn_dmx_dls, dictionary_size);
if(dls & 2) {
proto_tree_add_item(gts_tree, idn_dmx_base, tvb, offset, 2, ENC_BIG_ENDIAN);
config->base[i-1] = tvb_get_guint16(tvb, offset, 2);
offset += 2;
(*dictionary_size) += 2;
if(dls & 1) {
proto_tree_add_item(gts_tree, idn_dmx_count, tvb, offset, 1, ENC_BIG_ENDIAN);
config->count[i-1] = tvb_get_guint8(tvb, offset);
offset++;
(*dictionary_size)++;
}else {
config->count[i-1] = -1;
}
}
return offset;
}
static int dissect_idn_dmx_dictionary(tvbuff_t *tvb, int offset, proto_tree *idn_tree, configuration_info *config) {
int i, j, curr_size;
gboolean words_found = 0;
int dictionary_size = 0;
guint8 idepar; /* idetifier + parameter */
proto_tree *gts_tree = proto_tree_add_subtree(idn_tree, tvb, offset, -1, ett_dic_tree, NULL, "Dictionary");
for(i=1; i<=config->word_count; i++) {
idepar = tvb_get_guint8(tvb, offset);
if(idepar <= IDNO_VOID_AREA) {
if(idepar == 0) {
proto_tree_add_item(gts_tree, idn_dmx_void, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
dictionary_size += 1;
if(!words_found)
i -= 1;
}else {
offset = dissect_idn_dmx_gts(tvb, offset, gts_tree, idn_dmx_unknown, NULL);
for(j=1; j<=idepar; j++) {
proto_tree_add_item(gts_tree, idn_octet, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
dictionary_size += 1;
if(words_found)
i += 1;
}
if(!words_found)
i -= 1;
}
}else if(idepar >= IDNTAG_DIMMER_START && idepar <= IDNTAG_DIMMER_END) {
offset = dissect_idn_dimmer_level_subset(tvb, offset, gts_tree, config, i, &dictionary_size);
}else {
offset = dissect_idn_dmx_gts(tvb, offset, gts_tree, idn_dmx_unknown, &dictionary_size);
}
if(i == config->word_count && !words_found) {
curr_size = dictionary_size;
while(curr_size%4 != 0 && i > 0) {
i -= 1;
curr_size += 1;
}
words_found = 1;
}
}
proto_item_set_len(gts_tree, dictionary_size);
return offset;
}
static int dissect_idn_laser_gts(tvbuff_t *tvb, int offset, proto_tree *gts_tree, const int hf_hdr, int *dictionary_size, configuration_info *config, gboolean is_sample) {
static int * const gts[] = {
&idn_gts_category,
&idn_gts_subcategory,
&idn_gts_identifier,
&idn_gts_parameter,
NULL
};
proto_tree_add_bitmask(gts_tree, tvb, offset, hf_hdr, ett_dic, gts, ENC_BIG_ENDIAN);
if(dictionary_size)
*dictionary_size += 2;
if(config && is_sample)
config->sample_size++;
return offset + 2;
}
static int dissect_idn_x_area(tvbuff_t *tvb, int offset, proto_tree *gts_tree, guint16 catsub, int *dictionary_size, configuration_info *config) {
char *column_str = config->sample_column_string;
const int l = (const int)strlen(column_str);
if(catsub == IDNTAG_OPTIONAL_U4) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_u4, dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " U4");
}else {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_x, dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " X");
}
return offset;
}
static int dissect_idn_laser_dictionary(tvbuff_t *tvb, int offset, proto_tree *idn_tree, configuration_info *config) {
int i, j;
int dictionary_size = 0;
char *column_str = config->sample_column_string;
guint16 catsub; /* category + subcategory */
proto_tree *gts_tree = proto_tree_add_subtree(idn_tree, tvb, offset, -1, ett_dic_tree, NULL, "Dictionary");
snprintf(column_str, MAX_BUFFER, "(");
for(i=1; i<=config->word_count*2; i++) {
catsub = tvb_get_guint16(tvb, offset, 2);
const int l = (const int)strlen(column_str);
if(catsub <= IDNO_VOID_AREA) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_void, &dictionary_size, config, 0);
if(catsub > 0) {
for(j=0; j<catsub; j++) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_void, &dictionary_size, config, 0);
}
}
}else if(catsub == IDNTAG_PRECISION) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_precision, &dictionary_size, config, 1);
(config->dic_precision)[i] = 1;
}else if(catsub >= IDNTAG_BREAK_START && catsub <= IDNTAG_BREAK_END) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_break, &dictionary_size, config, 0);
}else if(catsub >= IDNTAG_SPACE_MOD_START && catsub <= IDNTAG_SPACE_MOD_END) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_space_modifier, &dictionary_size, config, 0);
}else if(catsub == IDNTAG_NOP) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_nop, &dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " NOP");
}else if(catsub >= IDNTAG_HINT0 && catsub <= IDNTAG_HINT1) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_hint, &dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " H");
}else if(catsub >= IDNTAG_COORD_X && catsub <= IDNTAG_COORD_X_END) {
offset = dissect_idn_x_area(tvb, offset, gts_tree, catsub, &dictionary_size, config);
}else if(catsub >= IDNTAG_COORD_Y && catsub <= IDNTAG_COORD_Y_END) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_y, &dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " Y");
}else if(catsub >= IDNTAG_COORD_Z && catsub <= IDNTAG_COORD_Z_END) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_z, &dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " Z");
}else if(catsub >= IDNTAG_COLOR_START && catsub <= IDNTAG_COLOR_END) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_color, &dictionary_size, config, 1);
determine_color(catsub, config);
}else if(catsub == IDNTAG_WAVELENGTH_PREFIX) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_wavelength_prefix, &dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " WP");
}else if(catsub == IDNTAG_INTENSITY) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_intensity, &dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " I");
}else if(catsub == IDNTAG_BEAM_BRUSH) {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts_beam_brush, &dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " BB");
}else {
offset = dissect_idn_laser_gts(tvb, offset, gts_tree, idn_gts, &dictionary_size, config, 1);
snprintf(column_str+l, MAX_BUFFER-l, " U/R");
}
}
proto_item_set_len(gts_tree, dictionary_size);
const int l = (const int)strlen(column_str);
snprintf(column_str+l, MAX_BUFFER-l, " )");
return offset;
}
static int dissect_idn_channel_configuration_header(tvbuff_t *tvb, packet_info *pinfo, int offset, proto_tree *idn_tree, int channel_id, configuration_info *config) {
conversation_t *conv;
guint8 word_count;
guint8 sdm;
static int * const channel_and_service_configuration_flags[] = {
&idn_two_bits_reserved_1,
&idn_sdm,
&idn_two_bits_reserved_2,
&idn_close,
&idn_routing,
NULL
};
col_append_str(pinfo->cinfo, COL_INFO, " (Configuration Header)");
proto_tree *configuration_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 4, ett_configuration_header, NULL, "Channel Configuration Header");
proto_tree_add_item(configuration_header_tree, idn_scwc, tvb, offset, 1, ENC_BIG_ENDIAN);
word_count = tvb_get_guint8(tvb, offset);
offset += 1;
proto_tree_add_bitmask(configuration_header_tree, tvb, offset, idn_cfl, ett_cfl, channel_and_service_configuration_flags, ENC_BIG_ENDIAN);
sdm = get_service_match(tvb_get_guint8(tvb, offset));
offset += 1;
proto_tree_add_item(configuration_header_tree, idn_service_id, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(configuration_header_tree, idn_service_mode, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
config->word_count = word_count;
config->sdm = sdm;
config->sample_size = 0;
config->dic_precision = wmem_alloc0_array(wmem_file_scope(), char, (255*2)+1);
config->sample_column_string = wmem_alloc0_array(wmem_file_scope(), char, MAX_BUFFER);
config->count = wmem_alloc0_array(wmem_file_scope(), int, word_count+1);
config->base = wmem_alloc0_array(wmem_file_scope(), int, word_count+1);
conv = conversation_new(pinfo->fd->num, &pinfo->src, &pinfo->dst, conversation_pt_to_conversation_type(pinfo->ptype), pinfo->srcport, pinfo->destport, channel_id);
conversation_add_proto_data(conv, proto_idn, config);
return offset;
}
static int dissect_idn_channel_configuration(tvbuff_t *tvb, packet_info *pinfo, int offset, proto_tree *idn_tree, message_info *minfo, configuration_info *config) {
offset = dissect_idn_channel_configuration_header(tvb, pinfo, offset, idn_tree, minfo->channel_id, config);
if(config->word_count > 0) {
if(minfo->chunk_type == IDNCT_OCTET_SEGMENT) {
return offset;
}else if(minfo->is_dmx) {
offset = dissect_idn_dmx_dictionary(tvb, offset, idn_tree, config);
}else {
offset = dissect_idn_laser_dictionary(tvb, offset, idn_tree, config);
}
}
return offset;
}
static int dissect_idn_message_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree, message_info *minfo) {
guint8 cnl;
static int * const cnl_data[] = {
&idn_most_significant_bit_cnl,
&idn_cclf,
&idn_channel_id,
NULL
};
proto_tree *idn_channel_message_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 8, ett_idn_channel_message_header_tree, NULL, "Channel Message Header");
proto_tree_add_item(idn_channel_message_header_tree, idn_total_size, tvb, offset, 2, ENC_BIG_ENDIAN);
minfo->total_size = tvb_get_guint16(tvb, offset, 2);
offset += 2;
proto_tree_add_bitmask(idn_channel_message_header_tree, tvb, offset, idn_cnl, ett_idn_cnl, cnl_data, ENC_BIG_ENDIAN);
cnl = tvb_get_guint8(tvb, offset);
minfo->has_config_header = cnl & 0x40;
minfo->channel_id = cnl & 0x3f;
offset += 1;
proto_tree_add_item(idn_channel_message_header_tree, idn_chunk_type, tvb, offset, 1, ENC_BIG_ENDIAN);
minfo->chunk_type = tvb_get_guint8(tvb, offset);
offset += 1;
proto_tree_add_item(idn_channel_message_header_tree, idn_timestamp, tvb, offset, 4, ENC_BIG_ENDIAN);
offset += 4;
return offset;
}
static int dissect_idn_message(tvbuff_t *tvb, packet_info *pinfo, int offset, proto_tree *idn_tree) {
int scm;
configuration_info *config = NULL;
message_info *minfo = wmem_new(wmem_file_scope(), message_info);
offset = dissect_idn_message_header(tvb, offset, idn_tree, minfo);
determine_message_type(pinfo, minfo);
if(minfo->total_size == 8)
return offset;
if(minfo->has_config_header && minfo->chunk_type != IDNCT_LP_FRAME_SF) {
config = wmem_new0(wmem_file_scope(), configuration_info);
offset = dissect_idn_channel_configuration(tvb, pinfo, offset, idn_tree, minfo, config);
}else if(minfo->chunk_type != IDNCT_VOID) {
config = get_configuration_info(pinfo, minfo->channel_id);
}
if(config) {
if(config->word_count == 0 && minfo->chunk_type != IDNCT_OCTET_SEGMENT) {
col_append_str(pinfo->cinfo, COL_INFO, ", SCWC is zero/unknown");
return offset;
}
if(minfo->chunk_type != IDNCT_VOID && minfo->chunk_type != IDNCT_LP_FRAME_SF) {
scm = get_service_match(tvb_get_guint8(tvb, offset));
offset = dissect_idn_chunk_header(tvb, offset, idn_tree, minfo);
if(config->sdm != scm) {
col_append_str(pinfo->cinfo, COL_INFO, ", SCM doesn't match SDM");
return offset;
}
}else if(minfo->chunk_type == IDNCT_VOID) {
return offset;
}
if(minfo->chunk_type == IDNCT_OCTET_SEGMENT) {
offset = dissect_idn_octet_segment(tvb, offset, idn_tree);
}else if(minfo->is_dmx) {
offset = dissect_idn_dmx_data(tvb, pinfo, offset, idn_tree, config);
}else {
offset = dissect_idn_laser_data(tvb, offset, idn_tree, config);
}
}
return offset;
}
static int dissect_idn_servicemap_entry(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
guint8 service_id = tvb_get_guint8(tvb, offset);
proto_tree *idn_servicemap_entry_tree = NULL;
gchar *name = (gchar *)tvb_get_string_enc(wmem_file_scope(), tvb, offset+4, 20, ENC_ASCII);
char tree_title[MAX_BUFFER];
if(service_id == 0) {
snprintf(tree_title, MAX_BUFFER, "Relay Entry - %s", name);
idn_servicemap_entry_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 24, ett_idn_header_tree, NULL, tree_title);
}else {
snprintf(tree_title, MAX_BUFFER, "Service Entry - %s", name);
idn_servicemap_entry_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 24, ett_idn_header_tree, NULL, tree_title);
}
proto_tree_add_item(idn_servicemap_entry_tree, idn_service_id, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_servicemap_entry_tree, idn_service_mode, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_servicemap_entry_tree, idn_flags, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_servicemap_entry_tree, idn_relay_number, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_servicemap_entry_tree, idn_name, tvb, offset, 20, ENC_ASCII);
offset += 20;
return offset;
}
static int dissect_idn_servicemap_response_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree, guint8 *relay_count, guint8 *service_count) {
proto_tree *idn_servicemap_response_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 4, ett_idn_header_tree, NULL, "Service Map Response Header");
proto_tree_add_item(idn_servicemap_response_header_tree, idn_struct_size, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_servicemap_response_header_tree, idn_entry_size, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
*relay_count = tvb_get_guint8(tvb, offset);
proto_tree_add_item(idn_servicemap_response_header_tree, idn_relay_count, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
*service_count = tvb_get_guint8(tvb, offset);
proto_tree_add_item(idn_servicemap_response_header_tree, idn_service_count, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
return offset;
}
static int dissect_idn_servicemap_response(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
guint8 relay_count, service_count;
guint16 map_entries_size;
offset = dissect_idn_servicemap_response_header(tvb, offset, idn_tree, &relay_count, &service_count);
map_entries_size = relay_count + service_count;
proto_tree *idn_servicemap_entries_tree = proto_tree_add_subtree(idn_tree, tvb, offset, map_entries_size*24, ett_idn_header_tree, NULL, "Service Map Entries");
for(int i=0; i<map_entries_size; i++)
offset = dissect_idn_servicemap_entry(tvb, offset, idn_servicemap_entries_tree);
return offset;
}
static int dissect_idn_scan_response(tvbuff_t *tvb, int offset, proto_tree *idn_tree) {
static int * const protocol_version[] = {
&idn_protocol_version_major,
&idn_protocol_version_minor,
NULL
};
static int * const status[] = {
&idn_malfn,
&idn_offline,
&idn_xcld,
&idn_ocpd,
&idn_three_bits_reserved,
&idn_rt,
NULL
};
proto_tree *idn_scanreply_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, 40, ett_idn_header_tree, NULL, "Scan Response");
proto_tree_add_item(idn_scanreply_header_tree, idn_struct_size, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_bitmask(idn_scanreply_header_tree, tvb, offset, idn_protocol_version, ett_protocol_version, protocol_version, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_bitmask(idn_scanreply_header_tree, tvb, offset, idn_status, ett_status, status, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_scanreply_header_tree, idn_reserved8, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_scanreply_header_tree, idn_unit_id, tvb, offset, 16, ENC_NA);
offset += 16;
proto_tree_add_item(idn_scanreply_header_tree, idn_name, tvb, offset, 20, ENC_ASCII);
offset += 20;
return offset;
}
static int dissect_idn_header(tvbuff_t *tvb, int offset, proto_tree *idn_tree, guint8 packet_type) {
proto_tree *idn_header_tree = proto_tree_add_subtree(idn_tree, tvb, offset, -1, ett_idn_header_tree, NULL, "IDN Header");
proto_tree_add_item(idn_header_tree, idn_command, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
if(packet_type == IDNCMD_VOID || packet_type == IDNCMD_PING_RESPONSE) {
proto_item_set_len(idn_header_tree, offset);
return offset;
}
proto_tree_add_item(idn_header_tree, idn_flags, tvb, offset, 1, ENC_BIG_ENDIAN);
offset += 1;
proto_tree_add_item(idn_header_tree, idn_sequence, tvb, offset, 2, ENC_BIG_ENDIAN);
offset += 2;
proto_item_set_len(idn_header_tree, offset);
return offset;
}
static int dissect_idn(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_) {
gint offset = 0;
guint8 packet_type = tvb_get_guint8(tvb, 0);
proto_item *ti = proto_tree_add_item(tree, proto_idn, tvb, 0, -1, ENC_NA);
proto_tree *idn_tree = proto_item_add_subtree(ti, ett_idn);
col_set_str(pinfo->cinfo, COL_PROTOCOL, "IDN");
col_clear(pinfo->cinfo, COL_INFO);
col_add_fstr(pinfo->cinfo, COL_INFO, "%s", val_to_str(packet_type, command_code, "Unknown (0x%02x)"));
offset = dissect_idn_header(tvb, offset, idn_tree, packet_type);
switch (packet_type) {
case IDNCMD_SCAN_RESPONSE:
dissect_idn_scan_response(tvb, offset, idn_tree);
break;
case IDNCMD_SERVICEMAP_RESPONSE:
offset = dissect_idn_servicemap_response(tvb, offset, idn_tree);
break;
case IDNCMD_MESSAGE:
case IDNCMD_MESSAGE_ACKREQ:
case IDNCMD_MESSAGE_CLOSE:
case IDNCMD_MESSAGE_ACKREQ_CLOSE:
offset = dissect_idn_message(tvb, pinfo, offset, idn_tree);
break;
case IDNCMD_MESSAGE_ACK:
offset = dissect_idn_message_acknowledgement(tvb, offset, idn_tree);
break;
default:
break;
}
return offset;
}
void proto_register_idn(void) {
static hf_register_info hf[] = {
{ &idn_command,
{ "Command code", "idn.command",
FT_UINT8, BASE_HEX,
VALS(command_code), 0x0,
NULL, HFILL }
},
{ &idn_flags,
{ "Flags", "idn.flags",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_sequence,
{ "Sequence counter", "idn.sequence",
FT_UINT16, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_total_size,
{ "Total Size", "idn.total_size",
FT_UINT16, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_struct_size,
{ "Struct Size", "idn.struct_size",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_protocol_version,
{ "Protocol Version", "idn.protocol_version",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_protocol_version_major,
{ "Major", "idn.protocol_version_major",
FT_UINT8, BASE_DEC,
NULL, 0xF0,
NULL, HFILL }
},
{ &idn_protocol_version_minor,
{ "Minor", "idn.idn_protocol_version_minor",
FT_UINT8, BASE_DEC,
NULL, 0x0F,
NULL, HFILL }
},
{ &idn_status,
{ "Status", "idn.status",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_malfn,
{ "Malfunction", "idn.status_malfn",
FT_UINT8, BASE_DEC,
NULL, 0x80,
NULL, HFILL }
},
{ &idn_offline,
{ "Offline", "idn.offline",
FT_UINT8, BASE_DEC,
NULL, 0x40,
NULL, HFILL }
},
{ &idn_xcld,
{ "Excluded", "idn.xcld",
FT_UINT8, BASE_DEC,
NULL, 0x20,
NULL, HFILL }
},
{ &idn_ocpd,
{ "Occupied", "idn.ocpd",
FT_UINT8, BASE_DEC,
NULL, 0x10,
NULL, HFILL }
},
{ &idn_rt,
{ "Realtime", "idn.rt",
FT_UINT8, BASE_DEC,
NULL, 0x1,
NULL, HFILL }
},
{ &idn_reserved8,
{ "Reserved", "idn.reserved8",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_unit_id,
{ "Unit ID", "idn.unit_id",
FT_BYTES, SEP_SPACE,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_name,
{ "Name", "idn.name",
FT_STRING, ENC_ASCII,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_entry_size,
{ "Entry Size", "idn.entry_size",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_relay_count,
{ "Relay Count", "idn.relay_count",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_service_count,
{ "Service Count", "idn.service_count",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_cnl,
{ "Channel configuration and routing information (CNL)", "idn.cnl",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_most_significant_bit_cnl,
{ "Most significant bit (always 1)", "idn.most_significant_bit_cnl",
FT_UINT8, BASE_DEC,
NULL, 0x80,
NULL, HFILL }
},
{ &idn_cclf,
{ "Channel Configuration and Last Fragment bit (CCLF)", "idn.cclf",
FT_UINT8, BASE_DEC,
NULL, 0x40,
NULL, HFILL }
},
{ &idn_channel_id,
{ "Channel ID (opened Channels)", "idn.channel_id",
FT_UINT8, BASE_DEC,
NULL, 0x3F,
NULL, HFILL }
},
{ &idn_chunk_type,
{ "Chunk Type", "idn.chunk_type",
FT_UINT8, BASE_HEX,
VALS(chunk_type), 0x0,
NULL, HFILL }
},
{ &idn_timestamp,
{ "Timestamp", "idn.timestamp",
FT_UINT32, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_scwc,
{ "Service Configuration Word Count (SCWC)", "idn.scwc",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_cfl,
{ "Channel and service configuration Flags (CFL)", "idn.cfl",
FT_UINT8, BASE_HEX,
VALS(cfl_string), 0x0,
NULL, HFILL }
},
{ &idn_sdm,
{ "Service Data Match (SDM)", "idn.sdm",
FT_UINT8, BASE_DEC,
NULL, 0x30,
NULL, HFILL }
},
{ &idn_close,
{ "Close", "idn.close",
FT_UINT8, BASE_DEC,
NULL, 0x2,
NULL, HFILL }
},
{ &idn_routing,
{ "Routing", "idn.routing",
FT_UINT8, BASE_DEC,
NULL, 0x1,
NULL, HFILL }
},
{ &idn_service_id,
{ "Service ID", "idn.service_id",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_relay_number,
{ "Relay Number", "idn.relay_number",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_service_mode,
{ "Service Mode", "idn.service_mode",
FT_UINT8, BASE_HEX,
VALS(service_mode_string), 0x0,
NULL, HFILL }
},
{ &idn_chunk_header_flags,
{ "Chunk Header Flags", "idn.chunk_header_flags",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_two_bits_reserved_1,
{ "Reserved", "idn.zero_zero",
FT_UINT8, BASE_DEC,
NULL, 0xC0,
NULL, HFILL }
},
{ &idn_two_bits_reserved_2,
{ "Reserved", "idn.zero_zero",
FT_UINT8, BASE_DEC,
NULL, 0xC,
NULL, HFILL }
},
{ &idn_scm,
{ "Service configuration match (SCM)", "idn.scm",
FT_UINT8, BASE_DEC,
NULL, 0x30,
NULL, HFILL }
},
{ &idn_three_bits_reserved,
{ "Reserved", "idn.three_bit_reserved",
FT_UINT8, BASE_DEC,
NULL, 0xE,
NULL, HFILL }
},
{ &idn_four_bits_reserved,
{ "Reserved", "idn.three_bit_reserved",
FT_UINT8, BASE_DEC,
NULL, 0xF,
NULL, HFILL }
},
{ &idn_once,
{ "Once", "idn.once",
FT_UINT8, BASE_DEC,
NULL, 0x1,
NULL, HFILL }
},
{ &idn_dlim,
{ "Delimiter (DLIM)", "idn.dlim",
FT_UINT8, BASE_DEC,
NULL, 0x1,
NULL, HFILL }
},
{ &idn_duration,
{ "Duration", "idn.frame_sample_duration",
FT_UINT24, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_chunk_data_sequence,
{ "Sequence", "idn.octet_segment_sequence",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_offset,
{ "Offset", "idn.octet_segment_sequence",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_reserved,
{ "Reserved", "idn.reserved",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts,
{ "Unknown", "idn.unknown",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_void,
{ "Void", "idn.gts_void",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_boundary,
{ "Void (32-bit boundary)", "idn.gts_boundary",
FT_UINT32, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_word,
{ "16-bit word", "idn.gts_word",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_break,
{ "Break", "idn.gts_break",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_space_modifier,
{ "Space Modifier", "idn.gts_space_modifier",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_hint,
{ "Hint", "idn.gts_hint",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_category,
{ "Category", "idn.gts_category",
FT_UINT16, BASE_DEC,
NULL, 0xF000,
NULL, HFILL }
},
{ &idn_gts_subcategory,
{ "Subcategory", "idn.gts_subcategory",
FT_UINT16, BASE_DEC,
NULL, 0xF00,
NULL, HFILL }
},
{ &idn_gts_identifier,
{ "Identifier", "idn.gts_identifier",
FT_UINT16, BASE_DEC,
NULL, 0xF0,
NULL, HFILL }
},
{ &idn_gts_parameter,
{ "Parameter", "idn.gts_parameter",
FT_UINT16, BASE_DEC,
NULL, 0xF,
NULL, HFILL }
},
{ &idn_gts_glin,
{ "Graphic Space Linearity (GLIN)", "idn.gts_glin",
FT_UINT16, BASE_DEC,
VALS(gts_glin), 0xC0,
NULL, HFILL }
},
{ &idn_gts_clin,
{ "Color Space Linearity (CLIN)", "idn.gts_clin",
FT_UINT16, BASE_DEC,
VALS(gts_clin), 0x30,
NULL, HFILL }
},
{ &idn_gts_cbal,
{ "Color Balance (CBAL)", "idn.gts_cbal",
FT_UINT16, BASE_DEC,
VALS(gts_cbal), 0xC,
NULL, HFILL }
},
{ &idn_gts_ctim,
{ "Color Timing (CTIM)", "idn.gts_ctim",
FT_UINT16, BASE_DEC,
VALS(gts_ctim), 0x3,
NULL, HFILL }
},
{ &idn_gts_nop,
{ "No Operation (NOP)", "idn.gts_nop",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_precision,
{ "Precision", "idn.gts_precision",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_cscl,
{ "Color scale (CSCL)", "idn.gts_cscl",
FT_UINT16, BASE_DEC,
NULL, 0xC0,
NULL, HFILL }
},
{ &idn_gts_iscl,
{ "Intensity scale (ISCL)", "idn.gts_iscl",
FT_UINT16, BASE_DEC,
NULL, 0x30,
NULL, HFILL }
},
{ &idn_gts_sht,
{ "Shutter (SHT)", "idn.gts_sht",
FT_UINT16, BASE_DEC,
NULL, 0xF,
NULL, HFILL }
},
{ &idn_gts_u4,
{ "Optional(U4), used as X-prime", "idn.gts_u4",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_x,
{ "X", "idn.gts_x",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_y,
{ "Y", "idn.gts_y",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_z,
{ "Z", "idn.gts_z",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_color,
{ "Color", "idn.gts_color",
FT_UINT16, BASE_DEC,
VALS(idn_color), 0x3FF,
NULL, HFILL }
},
{ &idn_gts_wavelength_prefix,
{ "Wavelength Prefix", "idn.gts_wavelength_prefix",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_intensity,
{ "Intensity/blanking", "idn.gts_intensity",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_beam_brush,
{ "Beam-Brush", "idn.gts_beam_brush",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_gts_sample,
{ "Sample", "idn.gts_sample",
FT_INT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_dmx_octet,
{ "Octet", "idn.gts_octet",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_dmx_identifier,
{ "Identifier", "idn.gts_dmx_identifier",
FT_UINT8, BASE_DEC,
NULL, 0xF0,
NULL, HFILL }
},
{ &idn_dmx_parameter,
{ "Parameter", "idn.gts_dmx_parameter",
FT_UINT8, BASE_DEC,
NULL, 0xF,
NULL, HFILL }
},
{ &idn_dmx_void,
{ "Void", "idn.gts_dmx_void",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_octet,
{ "Octet", "idn.gts_dmx_octet",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_dmx_dls,
{ "Dimmer Level Subset", "idn.dmx_dls",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_dmx_base,
{ "Base", "idn.dmx_base",
FT_UINT16, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_dmx_count,
{ "Count", "idn.dmx_count",
FT_UINT8, BASE_DEC,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_dmx_unknown,
{ "Unknown", "idn.dmx_unknown",
FT_UINT8, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
},
{ &idn_result_code,
{ "Result Code", "idn.result_code",
FT_UINT8, BASE_DEC,
VALS(result_code), 0x0,
NULL, HFILL }
},
{ &idn_event_flags,
{ "Event Flags", "idn.event_flags",
FT_UINT16, BASE_HEX,
NULL, 0x0,
NULL, HFILL }
}
};
static gint *ett[] = {
&ett_idn,
&ett_idn_header_tree,
&ett_idn_scanreply_header_tree,
&ett_idn_channel_message_header_tree,
&ett_protocol_version,
&ett_status,
&ett_idn_cnl,
&ett_cfl,
&ett_configuration_header,
&ett_chunk_header_tree,
&ett_chunk_header_flags,
&ett_dic,
&ett_dic_tree,
&ett_data,
&ett_subdata,
&ett_dmx_subtree
};
proto_idn = proto_register_protocol (
"Ilda Digital Network Protocol",
"IDN",
"idn"
);
proto_register_field_array(proto_idn, hf, array_length(hf));
proto_register_subtree_array(ett, array_length(ett));
}
void proto_reg_handoff_idn(void) {
static dissector_handle_t idn_handle;
idn_handle = create_dissector_handle(dissect_idn, proto_idn);
dissector_add_uint("udp.port", IDN_PORT, idn_handle);
}
/*
* Editor modelines - https://www.wireshark.org/tools/modelines.html
*
* Local variables:
* c-basic-offset: 8
* tab-width: 8
* indent-tabs-mode: t
* End:
*
* vi: set shiftwidth=8 tabstop=8 noexpandtab:
* :indentSize=8:tabSize=8:noTabs=false:
*/