osmocom
/
wireshark
11
0
Fork 1
Code Issues Pull Requests Projects Releases Wiki Activity
wireshark/plugins/epan/profinet/packet-pn-rtc-one.c

1092 lines
47 KiB
C
Raw Blame History

/* packet-pn-rtc-one.c
* Routines for PROFINET IO - RTC1 dissection.
*
* Wireshark - Network traffic analyzer
* By Gerald Combs <gerald@wireshark.org>
* Copyright 1999 Gerald Combs
*
* SPDX-License-Identifier: GPL-2.0-or-later
*/
/*
* The PN-IO protocol is a field bus protocol related to decentralized
* periphery and is developed by the PROFIBUS Nutzerorganisation e.V. (PNO),
* see: www.profibus.com
*
*
* PN-IO is based on the common DCE-RPC and the "lightweight" PN-RT
* (ethernet type 0x8892) protocols.
*
* The context manager (CM) part is handling context information
* (like establishing, ...) and is using DCE-RPC as its underlying
* protocol.
*
* The actual cyclic data transfer and acyclic notification uses the
* "lightweight" PN-RT protocol.
*
* There are some other related PROFINET protocols (e.g. PN-DCP, which is
* handling addressing topics).
*
* Please note: the PROFINET CBA protocol is independent of the PN-IO protocol!
*/
/*
* Cyclic PNIO RTC1 Data Dissection:
*
* To dissect cyclic PNIO RTC1 frames, this plug-in has to collect important module
* information out of "Ident OK", "Connect Request" and "Write Response"
* frames first.
*
* The data of Stationname-, -type and -id will be gained out of
* packet-pn-dcp.c. The header packet-pn.h will transfer those data between
* those two files.
*
* This file is used as a "addon" for packet-dcerpc-pn-io.c. Within "packet-dcerpc-pn-io.c"
* the defined structures in "packet-pn.h" will be filled with all necessary information.
* Those informations will be used in thise file to dissect cyclic PNIO RTC1 and PROFIsafe
* frames. Furthermore since RTC1 is a special frame type of PNIO, this dissection uses the
* already defined protocol PNIO.
*
* Overview for cyclic PNIO RTC1 data dissection functions:
* -> dissect_PNIO_C_SDU_RTC1 (general dissection of RTC1)
*/
#include "config.h"
#include <stdio.h>
#include <string.h>
#include <glib.h>
#include <epan/packet.h>
#include <epan/dissectors/packet-dcerpc.h>
#include <epan/proto.h>
#include <epan/expert.h>
#include "packet-pn.h"
#define F_MESSAGE_TRAILER_4BYTE 4 /* PROFIsafe: Defines the Amount of Bytes for CRC and Status-/Controlbyte */
#define PN_INPUT_CR 1 /* PROFINET Input Connect Request value */
#define PN_INPUT_DATADESCRITPION 1 /* PROFINET Input Data Description value */
static int proto_pn_io_rtc1 = -1;
/* General module information */
static int hf_pn_io_frame_info_type = -1;
static int hf_pn_io_frame_info_vendor = -1;
static int hf_pn_io_frame_info_nameofstation = -1;
static int hf_pn_io_frame_info_gsd_found = -1;
static int hf_pn_io_frame_info_gsd_error = -1;
static int hf_pn_io_frame_info_gsd_path = -1;
static int hf_pn_io_io_data_object = -1;
static int hf_pn_io_io_data_object_info_module_diff = -1;
static int hf_pn_io_io_data_object_info_moduleidentnumber = -1;
static int hf_pn_io_io_data_object_info_submoduleidentnumber = -1;
static int hf_pn_io_iocs = -1;
static int hf_pn_io_iops = -1;
static int hf_pn_io_ioxs_extension = -1;
static int hf_pn_io_ioxs_res14 = -1;
static int hf_pn_io_ioxs_instance = -1;
static int hf_pn_io_ioxs_datastate = -1;
/* PROFIsafe statusbyte and controlbyte */
static int hf_pn_io_ps_sb = -1;
static int hf_pn_io_ps_sb_iparOK = -1;
static int hf_pn_io_ps_sb_DeviceFault = -1;
static int hf_pn_io_ps_sb_CECRC = -1;
static int hf_pn_io_ps_sb_WDtimeout = -1;
static int hf_pn_io_ps_sb_FVactivated = -1;
static int hf_pn_io_ps_sb_Toggle_d = -1;
static int hf_pn_io_ps_sb_ConsNr_reset = -1;
static int hf_pn_io_ps_sb_res = -1;
static int hf_pn_io_ps_sb_toggelBitChanged = -1;
static int hf_pn_io_ps_sb_toggelBitChange_slot_nr = -1;
static int hf_pn_io_ps_sb_toggelBitChange_subslot_nr = -1;
static int hf_pn_io_ps_cb = -1;
static int hf_pn_io_ps_cb_iparEN = -1;
static int hf_pn_io_ps_cb_OAReq = -1;
static int hf_pn_io_ps_cb_resetConsNr = -1;
static int hf_pn_io_ps_cb_useTO2 = -1;
static int hf_pn_io_ps_cb_activateFV = -1;
static int hf_pn_io_ps_cb_Toggle_h = -1;
static int hf_pn_io_ps_cb_Chf_ACK = -1;
static int hf_pn_io_ps_cb_loopcheck = -1;
static int hf_pn_io_ps_cb_toggelBitChanged = -1;
static int hf_pn_io_ps_cb_toggelBitChange_slot_nr = -1;
static int hf_pn_io_ps_cb_toggelBitChange_subslot_nr = -1;
/* PROFIsafe */
static int hf_pn_io_ps_f_dest_adr = -1;
static int hf_pn_io_ps_f_data = -1;
static gint ett_pn_io_rtc = -1;
static gint ett_pn_io_ioxs = -1;
static gint ett_pn_io_io_data_object = -1;
static expert_field ei_pn_io_too_many_data_objects = EI_INIT;
static const value_string pn_io_ioxs_extension[] = {
{ 0x00 /* 0*/, "No IOxS octet follows" },
{ 0x01 /* 1*/, "One more IOxS octet follows" },
{ 0, NULL }
};
static const value_string pn_io_ioxs_instance[] = {
{ 0x00 /* 0*/, "Detected by subslot" },
{ 0x01 /* 1*/, "Detected by slot" },
{ 0x02 /* 2*/, "Detected by IO device" },
{ 0x03 /* 3*/, "Detected by IO controller" },
{ 0, NULL }
};
static const value_string pn_io_ioxs_datastate[] = {
{ 0x00 /* 0*/, "Bad" },
{ 0x01 /* 1*/, "Good" },
{ 0, NULL }
};
static const int *ps_sb_fields[] = {
&hf_pn_io_ps_sb_res,
&hf_pn_io_ps_sb_ConsNr_reset,
&hf_pn_io_ps_sb_Toggle_d,
&hf_pn_io_ps_sb_FVactivated,
&hf_pn_io_ps_sb_WDtimeout,
&hf_pn_io_ps_sb_CECRC,
&hf_pn_io_ps_sb_DeviceFault,
&hf_pn_io_ps_sb_iparOK,
NULL
};
static const int *ps_cb_fields[] = {
&hf_pn_io_ps_cb_loopcheck,
&hf_pn_io_ps_cb_Chf_ACK,
&hf_pn_io_ps_cb_Toggle_h,
&hf_pn_io_ps_cb_activateFV,
&hf_pn_io_ps_cb_useTO2,
&hf_pn_io_ps_cb_resetConsNr,
&hf_pn_io_ps_cb_OAReq,
&hf_pn_io_ps_cb_iparEN,
NULL
};
static const int *ioxs_fields[] = {
&hf_pn_io_ioxs_datastate,
&hf_pn_io_ioxs_instance,
&hf_pn_io_ioxs_res14,
&hf_pn_io_ioxs_extension,
NULL
};
/* Dissector for PROFIsafe Status Byte */
static int
dissect_pn_io_ps_SB(tvbuff_t *tvb, int offset,
packet_info *pinfo _U_, proto_tree *tree, guint8 *drep _U_, int hfindex, const int **fields)
{
if (tree) {
guint8 u8StatusByte;
proto_item *sb_item;
u8StatusByte = tvb_get_guint8(tvb, offset);
/* Add Status Byte subtree */
sb_item = proto_tree_add_bitmask_with_flags(tree, tvb, offset, hfindex, ett_pn_io_ioxs, fields,
ENC_LITTLE_ENDIAN, BMT_NO_APPEND);
proto_item_append_text(sb_item, " (%s)", ((u8StatusByte == 0x20) || (u8StatusByte == 0x00)) ? "normal" : "unnormal");
}
return offset + 1;
}
/* Dissector for PROFIsafe Control Byte */
static int
dissect_pn_io_ps_CB(tvbuff_t *tvb, int offset,
packet_info *pinfo _U_, proto_tree *tree, guint8 *drep _U_, int hfindex, const int **fields)
{
if (tree) {
guint8 u8ControlByte;
proto_item *cb_item;
u8ControlByte = tvb_get_guint8(tvb, offset);
/* Add Status Byte subtree */
cb_item = proto_tree_add_bitmask_with_flags(tree, tvb, offset, hfindex, ett_pn_io_ioxs, fields,
ENC_LITTLE_ENDIAN, BMT_NO_APPEND);
proto_item_append_text(cb_item, " (%s)", ((u8ControlByte == 0x20) || (u8ControlByte == 0x00) ||
(u8ControlByte == 0xa0) || (u8ControlByte == 0x80)) ? "normal" : "unnormal");
}
return offset + 1;
}
/* Dissector for IOCS (As each IOCS stands for a specific Slot & Subslot) */
static int
dissect_PNIO_IOCS(tvbuff_t *tvb, int offset, packet_info *pinfo _U_, proto_tree *tree,
guint8 *drep _U_, int hfindex, guint16 slotNr, guint16 subSlotNr, const int **fields)
{
if (tree) {
guint8 u8IOxS;
proto_item *ioxs_item;
u8IOxS = tvb_get_guint8(tvb, offset);
/* Add ioxs subtree */
ioxs_item = proto_tree_add_bitmask_with_flags(tree, tvb, offset, hfindex,
ett_pn_io_ioxs, fields, ENC_LITTLE_ENDIAN, BMT_NO_APPEND);
proto_item_append_text(ioxs_item,
" (%s%s), Slot: 0x%x, Subslot: 0x%x",
(u8IOxS & 0x01) ? "another IOxS follows " : "",
(u8IOxS & 0x80) ? "good" : "bad",
slotNr,
subSlotNr);
}
return offset + 1;
}
/* dissect the IOxS (IOCS, IOPS) field */
static int
dissect_PNIO_IOxS(tvbuff_t *tvb, int offset,
packet_info *pinfo _U_, proto_tree *tree, guint8 *drep _U_, int hfindex, const int **fields)
{
if (tree) {
guint8 u8IOxS;
proto_item *ioxs_item;
u8IOxS = tvb_get_guint8(tvb, offset);
/* Add ioxs subtree */
ioxs_item = proto_tree_add_bitmask_with_flags(tree, tvb, offset, hfindex,
ett_pn_io_ioxs, fields, ENC_LITTLE_ENDIAN, BMT_NO_APPEND);
proto_item_append_text(ioxs_item,
" (%s%s)",
(u8IOxS & 0x01) ? "another IOxS follows " : "",
(u8IOxS & 0x80) ? "good" : "bad");
}
return offset + 1;
}
/* Universel dissector for flexibel PROFIsafe Data 8 to 64 Bits */
static int
dissect_pn_io_ps_uint(tvbuff_t *tvb, gint offset, packet_info *pinfo _U_,
proto_tree *tree, guint8 *drep,
int hfindex, guint8 bytelength, guint64 *pdata)
{
guint64 data;
gboolean generalDissection;
generalDissection = FALSE;
switch (bytelength) {
case 1: /* 8 Bit Safety IO Data */
data = tvb_get_guint8(tvb, offset);
if (pdata)
*pdata = data;
break;
case 2: /* 16 Bit Safety IO Data */
data = tvb_get_letohs(tvb, offset);
if (pdata)
*pdata = data;
break;
case 3: /* 24 Bit Safety IO Data */
data = tvb_get_letoh24(tvb, offset);
if (pdata)
*pdata = data;
break;
case 4: /* 32 Bit Safety IO Data */
data = tvb_get_letohl(tvb, offset);
if (pdata)
*pdata = data;
break;
case 5: /* 40 Bit Safety IO Data */
data = tvb_get_letoh40(tvb, offset);
if (pdata)
*pdata = data;
break;
case 6: /* 48 Bit Safety IO Data */
data = tvb_get_letoh48(tvb, offset);
if (pdata)
*pdata = data;
break;
case 7: /* 56 Bit Safety IO Data */
data = tvb_get_letoh56(tvb, offset);
if (pdata)
*pdata = data;
break;
case 8: /* 64 Bit Safety IO Data */
data = tvb_get_letoh64(tvb, offset);
if (pdata)
*pdata = data;
break;
default: /* Safety IO Data is too big to save it into one variable */
dissect_pn_user_data(tvb, offset, pinfo, tree, bytelength, "Safety IO Data");
generalDissection = TRUE;
break;
}
if (tree && generalDissection == FALSE) {
proto_tree_add_item(tree, hfindex, tvb, offset, bytelength, DREP_ENC_INTEGER(drep));
}
return offset + bytelength;
}
/* dissect a PN-IO RTC1 Cyclic Service Data Unit */
int
dissect_PNIO_C_SDU_RTC1(tvbuff_t *tvb, int offset,
packet_info *pinfo, proto_tree *tree, guint8 *drep _U_)
{
proto_tree *data_tree = NULL;
/* Count & offset for comparation of the arrays */
guint16 frameOffset;
guint32 objectCounter;
gboolean inputFlag;
gboolean outputFlag;
gboolean psInfoText; /* Used to display only once per frame the info text "PROFIsafe Device" */
proto_item *data_item;
proto_item *IODataObject_item;
proto_item *IODataObject_item_info;
proto_tree *IODataObject_tree;
proto_item *ModuleID_item;
proto_item *ModuleDiff_item;
wmem_strbuf_t *moduleName;
guint8 toggleBitSb;
guint8 toggleBitCb;
guint64 f_data;
guint8 statusbyte;
guint8 controlbyte;
guint16 number_io_data_objects_input_cr;
guint16 number_iocs_input_cr;
guint16 number_io_data_objects_output_cr;
guint16 number_iocs_output_cr;
conversation_t *conversation;
stationInfo *station_info = NULL;
iocsObject *iocs_object;
ioDataObject *io_data_object;
moduleDiffInfo *module_diff_info;
wmem_list_frame_t *frame;
wmem_list_frame_t *frame_diff;
/* Initial */
frameOffset = 0;
f_data = 0;
inputFlag = FALSE;
outputFlag = FALSE;
psInfoText = FALSE;
number_io_data_objects_input_cr = 0;
number_iocs_input_cr = 0;
number_io_data_objects_output_cr = 0;
number_iocs_output_cr = 0;
col_set_str(pinfo->cinfo, COL_PROTOCOL, "PNIO"); /* set protocol name */
data_item = proto_tree_add_protocol_format(tree, proto_pn_io_rtc1, tvb, offset, tvb_captured_length(tvb),
"PROFINET IO Cyclic Service Data Unit: %u bytes", tvb_captured_length(tvb));
data_tree = proto_item_add_subtree(data_item, ett_pn_io_rtc);
/* dissect_dcerpc_uint16(tvb, offset, pinfo, data_tree, drep, hf_pn_io_packedframe_SFCRC, &u16SFCRC); */
if (!(dissect_CSF_SDU_heur(tvb, pinfo, data_tree, NULL) == FALSE))
return(tvb_captured_length(tvb));
/* Only dissect cyclic RTC1 frames, if PN Connect Request has been read */
conversation = find_conversation(pinfo->num, &pinfo->dl_src, &pinfo->dl_dst, ENDPOINT_NONE, 0, 0, 0);
/* Detect input data package and output data package */
if (conversation != NULL) {
station_info = (stationInfo*)conversation_get_proto_data(conversation, proto_pn_dcp);
if (station_info != NULL) {
if (pnio_ps_selection == TRUE) {
col_set_str(pinfo->cinfo, COL_PROTOCOL, "PNIO_PS"); /* set PROFISsafe protocol name */
}
if (addresses_equal(&(pinfo->src), conversation_key_addr1(conversation->key_ptr)) && addresses_equal(&(pinfo->dst), conversation_key_addr2(conversation->key_ptr))) {
inputFlag = TRUE;
outputFlag = FALSE;
number_io_data_objects_input_cr = station_info->ioDataObjectNr;
number_iocs_input_cr = station_info->iocsNr;
}
if (addresses_equal(&(pinfo->dst), conversation_key_addr1(conversation->key_ptr)) && addresses_equal(&(pinfo->src), conversation_key_addr2(conversation->key_ptr))) {
outputFlag = TRUE;
inputFlag = FALSE;
number_io_data_objects_output_cr = station_info->ioDataObjectNr;
number_iocs_output_cr = station_info->iocsNr;
}
}
}
/* ------- Input (PNIO) / Response (PNIO_PS) Frame Handling ------- */
if (inputFlag) {
if (pnio_ps_selection == TRUE) {
proto_tree_add_string_format_value(data_tree, hf_pn_io_frame_info_type, tvb,
offset, 0, "Response", "Response Frame (IO_Device -> IO_Controller)");
}
else {
proto_tree_add_string_format_value(data_tree, hf_pn_io_frame_info_type, tvb,
offset, 0, "Input", "Input Frame (IO_Device -> IO_Controller)");
}
if (station_info != NULL) {
if (station_info->typeofstation != NULL) {
proto_tree_add_string_format_value(data_tree, hf_pn_io_frame_info_vendor, tvb, 0,
0, station_info->typeofstation, "\"%s\"", station_info->typeofstation);
}
if (station_info->nameofstation != NULL) {
proto_tree_add_string_format_value(data_tree, hf_pn_io_frame_info_nameofstation, tvb, 0,
0, station_info->nameofstation, "\"%s\"", station_info->nameofstation);
}
if (station_info->gsdPathLength == TRUE) { /* given path isn't too long for the array */
if (station_info->gsdFound == TRUE) { /* found a GSD-file */
if (station_info->gsdLocation != NULL) {
IODataObject_item_info = proto_tree_add_item(data_tree, hf_pn_io_frame_info_gsd_found, tvb, offset, 0, ENC_NA);
proto_item_append_text(IODataObject_item_info, ": \"%s\"", station_info->gsdLocation);
}
}
else {
if (station_info->gsdLocation != NULL) {
IODataObject_item_info = proto_tree_add_item(data_tree, hf_pn_io_frame_info_gsd_error, tvb, offset, 0, ENC_NA);
proto_item_append_text(IODataObject_item_info, " Please place relevant GSD-file under \"%s\"", station_info->gsdLocation);
}
}
}
else {
IODataObject_item_info = proto_tree_add_item(data_tree, hf_pn_io_frame_info_gsd_path, tvb, offset, 0, ENC_NA);
proto_item_append_text(IODataObject_item_info, " Please check your GSD-file networkpath. (No Path configured)");
}
}
/* ---- Input IOData-/IOCS-Object Handling ---- */
objectCounter = number_io_data_objects_input_cr + number_iocs_input_cr;
if (objectCounter > (guint)tvb_reported_length_remaining(tvb, offset)) {
expert_add_info_format(pinfo, data_item, &ei_pn_io_too_many_data_objects, "Too many data objects: %d", objectCounter);
return(tvb_captured_length(tvb));
}
while (objectCounter--) {
/* ---- Input IO Data Object Handling ---- */
if (station_info != NULL) {
for (frame = wmem_list_head(station_info->ioobject_data_in); frame != NULL; frame = wmem_list_frame_next(frame)) {
io_data_object = (ioDataObject*)wmem_list_frame_data(frame);
if (io_data_object->frameOffset == frameOffset) {
/* Found following object */
IODataObject_item = proto_tree_add_item(data_tree, hf_pn_io_io_data_object, tvb, offset, 0, ENC_NA);
IODataObject_tree = proto_item_add_subtree(IODataObject_item, ett_pn_io_io_data_object);
/* Control: the Device still uses the correct ModuleIdentNumber? */
for (frame_diff = wmem_list_head(station_info->diff_module); frame_diff != NULL; frame_diff = wmem_list_frame_next(frame_diff)) {
module_diff_info = (moduleDiffInfo*)wmem_list_frame_data(frame_diff);
if (io_data_object->moduleIdentNr != module_diff_info->modulID) {
ModuleDiff_item = proto_tree_add_item(IODataObject_tree, hf_pn_io_io_data_object_info_module_diff, tvb, 0, 0, ENC_NA);
proto_item_append_text(ModuleDiff_item, ": Device using ModuleIdentNumber 0x%08x instead of 0x%08x", module_diff_info->modulID, io_data_object->moduleIdentNr);
break;
}
}
proto_tree_add_uint(IODataObject_tree, hf_pn_io_io_data_object_info_moduleidentnumber, tvb, 0, 0, io_data_object->moduleIdentNr);
proto_tree_add_uint(IODataObject_tree, hf_pn_io_io_data_object_info_submoduleidentnumber, tvb, 0, 0, io_data_object->subModuleIdentNr);
/* PROFIsafe Supported Inputmodule handling */
if (io_data_object->profisafeSupported == TRUE && pnio_ps_selection == TRUE) {
if (io_data_object->profisafeSupported == TRUE && psInfoText == FALSE) {
/* Only add one information string per device to the infotext */
col_append_str(pinfo->cinfo, COL_INFO, ", PROFIsafe Device"); /* Add string to wireshark infotext */
psInfoText = TRUE;
}
proto_tree_add_uint(IODataObject_tree, hf_pn_io_ps_f_dest_adr, tvb, 0, 0, io_data_object->f_dest_adr);
/* Get Safety IO Data */
if ((io_data_object->length - F_MESSAGE_TRAILER_4BYTE) > 0) {
offset = dissect_pn_io_ps_uint(tvb, offset, pinfo, IODataObject_tree, drep, hf_pn_io_ps_f_data,
(io_data_object->length - F_MESSAGE_TRAILER_4BYTE), &f_data);
}
/* ---- Check for new PNIO data using togglebit ---- */
statusbyte = tvb_get_guint8(tvb, offset);
toggleBitSb = statusbyte & 0x20; /* get ToggleBit of StatusByte */
if (io_data_object->lastToggleBit != toggleBitSb) { /* ToggleBit has changed --> new Data incoming */
/* Special Filter for ToggleBit within Statusbyte */
ModuleID_item = proto_tree_add_uint(IODataObject_tree, hf_pn_io_ps_sb_toggelBitChanged, tvb, offset, 0, toggleBitSb);
PROTO_ITEM_SET_HIDDEN(ModuleID_item);
ModuleID_item = proto_tree_add_uint(IODataObject_tree, hf_pn_io_ps_sb_toggelBitChange_slot_nr, tvb, offset, 0, io_data_object->slotNr);
PROTO_ITEM_SET_HIDDEN(ModuleID_item);
ModuleID_item = proto_tree_add_uint(IODataObject_tree, hf_pn_io_ps_sb_toggelBitChange_subslot_nr, tvb, offset, 0, io_data_object->subSlotNr);
PROTO_ITEM_SET_HIDDEN(ModuleID_item);
}
offset = dissect_pn_io_ps_SB(tvb, offset, pinfo, IODataObject_tree, drep, hf_pn_io_ps_sb, ps_sb_fields);
offset = dissect_pn_user_data(tvb, offset, pinfo, IODataObject_tree, io_data_object->f_crc_len, "CRC");
io_data_object->last_sb_cb = statusbyte; /* save the value of current statusbyte */
io_data_object->lastToggleBit = toggleBitSb; /* save the value of current togglebit within statusbyte */
} /* END of PROFIsafe Module Handling */
else {
/* Module is not PROFIsafe supported */
offset = dissect_pn_user_data(tvb, offset, pinfo, IODataObject_tree, io_data_object->length, "IO Data");
}
if (io_data_object->discardIOXS == FALSE) {
offset = dissect_PNIO_IOxS(tvb, offset, pinfo, IODataObject_tree, drep, hf_pn_io_iops, ioxs_fields);
proto_item_set_len(IODataObject_item, io_data_object->length + 1); /* Length = Databytes + IOXS Byte */
}
else {
proto_item_set_len(IODataObject_item, io_data_object->length); /* Length = Databytes */
}
proto_item_append_text(IODataObject_item, ": Slot: 0x%x Subslot: 0x%x",
io_data_object->slotNr, io_data_object->subSlotNr);
/* ModuleIdentNr appears not only once in GSD-file -> set module name more generally */
if (io_data_object->amountInGSDML > 1) { /* if ModuleIdentNr only appears once in GSD-file, use the found GSD-file-ModuleName, else ... */
if (io_data_object->slotNr == 0) {
moduleName = wmem_strbuf_new(wmem_packet_scope(), "Headstation");
}
else {
moduleName = wmem_strbuf_new(wmem_packet_scope(), "Module");
}
if (io_data_object->profisafeSupported == TRUE) {
/* PROFIsafe */
if (io_data_object->length >= 5) { /* 5 due to 3 CRC bytes & 1 status byte & (at least) 1 data byte */
wmem_strbuf_append(moduleName, ", DI");
}
else {
wmem_strbuf_append(moduleName, ", DO");
}
}
else {
/* PROFINET */
if (io_data_object->length > 0) {
wmem_strbuf_append(moduleName, ", DI");
}
else {
wmem_strbuf_append(moduleName, ", DO");
}
}
io_data_object->moduleNameStr = wmem_strdup(wmem_file_scope(), wmem_strbuf_get_str(moduleName));
}
proto_item_append_text(IODataObject_item, " ModuleName: \"%s\"", io_data_object->moduleNameStr);
/* emphasize the PROFIsafe supported Modul */
if (io_data_object->profisafeSupported == TRUE && pnio_ps_selection == TRUE) {
(proto_item_append_text(IODataObject_item, " (PROFIsafe Module)"));
}
/* Set frameOffset to its new value, to find the next object */
frameOffset = frameOffset + io_data_object->length; /* frameOffset = current value + data bytes */
if (io_data_object->discardIOXS == FALSE) {
frameOffset = frameOffset + 1; /* frameOffset = current value + iops byte */
}
}
}
}
/* ---- Input IOCS Object Handling ---- */
if (station_info != NULL) {
for (frame = wmem_list_head(station_info->iocs_data_in); frame != NULL; frame = wmem_list_frame_next(frame)) {
iocs_object = (iocsObject*)wmem_list_frame_data(frame);
if (iocs_object->frameOffset == frameOffset) {
offset = dissect_PNIO_IOCS(tvb, offset, pinfo, data_tree, drep, hf_pn_io_iocs, iocs_object->slotNr,
iocs_object->subSlotNr, ioxs_fields);
/* Set frameOffset to its new value, to find the next object */
frameOffset = frameOffset + 1; /* frameOffset = current value + iops byte */
break;
}
}
}
}
/* Dissect padding */
offset = dissect_pn_user_data(tvb, offset, pinfo, tree, tvb_captured_length_remaining(tvb, offset), "GAP and RTCPadding");
} /* END of Input Frame Handling */
/* ----- Output (PNIO) / Request (PNIO_PS) Frame Handling ------ */
else if (outputFlag) {
if (pnio_ps_selection == TRUE) {
proto_tree_add_string_format_value(data_tree, hf_pn_io_frame_info_type, tvb,
offset, 0, "Request", "Request Frame (IO_Controller -> IO_Device)");
}
else {
proto_tree_add_string_format_value(data_tree, hf_pn_io_frame_info_type, tvb,
offset, 0, "Output", "Output Frame (IO_Controller -> IO_Device)");
}
if (station_info != NULL) {
if (station_info->typeofstation != NULL) {
proto_tree_add_string_format_value(data_tree, hf_pn_io_frame_info_vendor, tvb, 0,
0, station_info->typeofstation, "\"%s\"", station_info->typeofstation);
}
if (station_info->nameofstation != NULL) {
proto_tree_add_string_format_value(data_tree, hf_pn_io_frame_info_nameofstation, tvb, 0,
0, station_info->nameofstation, "\"%s\"", station_info->nameofstation);
}
if (station_info->gsdPathLength == TRUE) { /* given path isn't too long for the array */
if (station_info->gsdFound == TRUE) { /* found a GSD-file */
if (station_info->gsdLocation != NULL) {
IODataObject_item_info = proto_tree_add_item(data_tree, hf_pn_io_frame_info_gsd_found, tvb, offset, 0, ENC_NA);
proto_item_append_text(IODataObject_item_info, ": \"%s\"", station_info->gsdLocation);
}
}
else {
if (station_info->gsdLocation != NULL) {
IODataObject_item_info = proto_tree_add_item(data_tree, hf_pn_io_frame_info_gsd_error, tvb, offset, 0, ENC_NA);
proto_item_append_text(IODataObject_item_info, " Please place relevant GSD-file under \"%s\"", station_info->gsdLocation);
}
}
}
else {
IODataObject_item_info = proto_tree_add_item(data_tree, hf_pn_io_frame_info_gsd_path, tvb, offset, 0, ENC_NA);
proto_item_append_text(IODataObject_item_info, " Please check your GSD-file networkpath. (No Path configured)");
}
}
/* ---- Output IOData-/IOCS-Object Handling ---- */
objectCounter = number_io_data_objects_output_cr + number_iocs_output_cr;
if (objectCounter > (guint)tvb_reported_length_remaining(tvb, offset)) {
expert_add_info_format(pinfo, data_item, &ei_pn_io_too_many_data_objects, "Too many data objects: %d", objectCounter);
return(tvb_captured_length(tvb));
}
while (objectCounter--) {
/* ---- Output IO Data Object Handling ---- */
if (station_info != NULL) {
for (frame = wmem_list_head(station_info->ioobject_data_out); frame != NULL; frame = wmem_list_frame_next(frame)) {
io_data_object = (ioDataObject*)wmem_list_frame_data(frame);
if (io_data_object != NULL && io_data_object->frameOffset == frameOffset) {
/* Found following object */
IODataObject_item = proto_tree_add_item(data_tree, hf_pn_io_io_data_object, tvb, offset, 0, ENC_NA);
IODataObject_tree = proto_item_add_subtree(IODataObject_item, ett_pn_io_io_data_object);
/* Control: the Device still uses the correct ModuleIdentNumber? */
for (frame_diff = wmem_list_head(station_info->diff_module); frame_diff != NULL; frame_diff = wmem_list_frame_next(frame_diff)) {
module_diff_info = (moduleDiffInfo*)wmem_list_frame_data(frame_diff);
if (io_data_object->moduleIdentNr != module_diff_info->modulID) {
ModuleDiff_item = proto_tree_add_item(IODataObject_tree, hf_pn_io_io_data_object_info_module_diff, tvb, 0, 0, ENC_NA);
proto_item_append_text(ModuleDiff_item, ": Device using ModuleIdentNumber 0x%08x instead of 0x%08x", module_diff_info->modulID, io_data_object->moduleIdentNr);
break;
}
}
proto_tree_add_uint(IODataObject_tree, hf_pn_io_io_data_object_info_moduleidentnumber, tvb, 0, 0, io_data_object->moduleIdentNr);
proto_tree_add_uint(IODataObject_tree, hf_pn_io_io_data_object_info_submoduleidentnumber, tvb, 0, 0, io_data_object->subModuleIdentNr);
if (io_data_object->profisafeSupported == TRUE && pnio_ps_selection == TRUE) {
if (io_data_object->profisafeSupported == TRUE && psInfoText == FALSE) {
/* Only add one information string per device to the infotext */
col_append_str(pinfo->cinfo, COL_INFO, ", PROFIsafe Device"); /* Add string to wireshark infotext */
psInfoText = TRUE;
}
proto_tree_add_uint(IODataObject_tree, hf_pn_io_ps_f_dest_adr, tvb, 0, 0, io_data_object->f_dest_adr);
/* Get Safety IO Data */
if ((io_data_object->length - F_MESSAGE_TRAILER_4BYTE) > 0) {
offset = dissect_pn_io_ps_uint(tvb, offset, pinfo, IODataObject_tree, drep, hf_pn_io_ps_f_data,
(io_data_object->length - F_MESSAGE_TRAILER_4BYTE), &f_data);
}
/* ---- Check for new PNIO data using togglebit ---- */
controlbyte = tvb_get_guint8(tvb, offset);
toggleBitCb = controlbyte & 0x20; /* get ToggleBit of Controlbyte */
if (io_data_object->lastToggleBit != toggleBitCb) { /* ToggleBit has changed --> new Data incoming */
/* Special Filter for ToggleBit within Controlbyte */
ModuleID_item = proto_tree_add_uint(IODataObject_tree, hf_pn_io_ps_cb_toggelBitChanged, tvb, offset, 0, toggleBitCb);
PROTO_ITEM_SET_HIDDEN(ModuleID_item);
ModuleID_item = proto_tree_add_uint(IODataObject_tree, hf_pn_io_ps_cb_toggelBitChange_slot_nr, tvb, offset, 0, io_data_object->slotNr);
PROTO_ITEM_SET_HIDDEN(ModuleID_item);
ModuleID_item = proto_tree_add_uint(IODataObject_tree, hf_pn_io_ps_cb_toggelBitChange_subslot_nr, tvb, offset, 0, io_data_object->subSlotNr);
PROTO_ITEM_SET_HIDDEN(ModuleID_item);
}
offset = dissect_pn_io_ps_CB(tvb, offset, pinfo, IODataObject_tree, drep, hf_pn_io_ps_cb, ps_cb_fields);
offset = dissect_pn_user_data(tvb, offset, pinfo, IODataObject_tree, io_data_object->f_crc_len, "CRC");
io_data_object->last_sb_cb = controlbyte; /* save the value of current controlbyte */
io_data_object->lastToggleBit = toggleBitCb; /* save the value of current togglebit within controlbyte */
} /* End of PROFIsafe Module Handling */
else {
/* Module is not PROFIsafe supported */
offset = dissect_pn_user_data(tvb, offset, pinfo, IODataObject_tree, io_data_object->length, "IO Data");
}
if (io_data_object->discardIOXS == FALSE) {
offset = dissect_PNIO_IOxS(tvb, offset, pinfo, IODataObject_tree, drep, hf_pn_io_iops, ioxs_fields);
proto_item_set_len(IODataObject_item, io_data_object->length + 1); /* Length = Databytes + IOXS Byte */
}
else {
proto_item_set_len(IODataObject_item, io_data_object->length); /* Length = Databytes */
}
proto_item_append_text(IODataObject_item, ": Slot: 0x%x Subslot: 0x%x",
io_data_object->slotNr, io_data_object->subSlotNr);
/* ModuleIdentNr appears not only once in GSD-file -> set module name more generally */
if (io_data_object->amountInGSDML > 1) { /* if ModuleIdentNr only appears once in GSD-file, use the found GSD-file-ModuleName, else ... */
if (io_data_object->slotNr == 0) {
moduleName = wmem_strbuf_new(wmem_packet_scope(), "Headstation");
}
else {
moduleName = wmem_strbuf_new(wmem_packet_scope(), "Module");
}
if (io_data_object->profisafeSupported == TRUE) {
/* PROFIsafe */
if (io_data_object->length >= 5) { /* 5 due to 3 CRC bytes & 1 status byte & (at least) 1 data byte */
wmem_strbuf_append(moduleName, ", DO");
}
else {
wmem_strbuf_append(moduleName, ", DI");
}
}
else {
/* PROFINET */
if (io_data_object->length > 0) {
wmem_strbuf_append(moduleName, ", DO");
}
else {
wmem_strbuf_append(moduleName, ", DI");
}
}
io_data_object->moduleNameStr = wmem_strdup(wmem_file_scope(), wmem_strbuf_get_str(moduleName));
}
proto_item_append_text(IODataObject_item, " ModuleName: \"%s\"", io_data_object->moduleNameStr);
/* emphasize the PROFIsafe supported Modul */
if (io_data_object->profisafeSupported == TRUE && pnio_ps_selection == TRUE) {
proto_item_append_text(IODataObject_item, " (PROFIsafe Module)");
}
/* Set frameOffset to its new value, to find the next object */
frameOffset = frameOffset + io_data_object->length; /* frameOffset = current value + data bytes */
if (io_data_object->discardIOXS == FALSE) {
frameOffset = frameOffset + 1; /* frameOffset = current value + iops byte */
}
}
}
}
/* ---- Output IOCS Object Handling ---- */
if (station_info != NULL) {
for (frame = wmem_list_head(station_info->iocs_data_out); frame != NULL; frame = wmem_list_frame_next(frame)) {
iocs_object = (iocsObject*)wmem_list_frame_data(frame);
if (iocs_object->frameOffset == frameOffset) {
offset = dissect_PNIO_IOCS(tvb, offset, pinfo, data_tree, drep, hf_pn_io_iocs, iocs_object->slotNr,
iocs_object->subSlotNr, ioxs_fields);
/* Set frameOffset to its new value, to find the next object */
frameOffset = frameOffset + 1; /* frameOffset = current value + iops byte */
break;
}
}
}
}
/* Dissect padding */
offset = dissect_pn_user_data(tvb, offset, pinfo, tree, tvb_captured_length_remaining(tvb, offset), "GAP and RTCPadding");
} /* END of Output Frame Handling */
return offset;
}
void
init_pn_io_rtc1(int proto)
{
static hf_register_info hf[] = {
{ &hf_pn_io_io_data_object,
{ "IODataObject", "pn_io.io_data_object",
FT_NONE, BASE_NONE, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_io_data_object_info_module_diff,
{ "Difference", "pn_io.io_data_object.diff_module",
FT_NONE, BASE_NONE, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_io_data_object_info_moduleidentnumber,
{ "ModuleIdentNumber", "pn_io.io_data_object.module_nr",
FT_UINT32, BASE_HEX, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_io_data_object_info_submoduleidentnumber,
{ "SubmoduleIdentNumber", "pn_io.io_data_object.submodule_nr",
FT_UINT32, BASE_HEX, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_frame_info_type,
{ "PN Frame Type", "pn_io.frame_info.type",
FT_STRING, BASE_NONE, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_frame_info_vendor,
{ "DeviceVendorValue", "pn_io.frame_info.vendor",
FT_STRING, BASE_NONE, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_frame_info_nameofstation,
{ "NameOfStation", "pn_io.frame_info.nameofstation",
FT_STRING, BASE_NONE, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_frame_info_gsd_found,
{ "GSD-file found", "pn_io.frame_info.gsd_found",
FT_NONE, BASE_NONE, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_frame_info_gsd_error,
{ "GSD-file not found.", "pn_io.frame_info.gsd_error",
FT_NONE, BASE_NONE, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_frame_info_gsd_path,
{ "GSD-file networkpath failure!", "pn_io.frame_info.gsd_path",
FT_NONE, BASE_NONE, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_iocs,
{ "IOCS", "pn_io.ioxs",
FT_UINT8, BASE_HEX, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_iops,
{ "IOPS", "pn_io.ioxs",
FT_UINT8, BASE_HEX, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_ioxs_extension,
{ "Extension", "pn_io.ioxs.extension",
FT_UINT8, BASE_HEX, VALS(pn_io_ioxs_extension), 0x01,
NULL, HFILL }
},
{ &hf_pn_io_ioxs_res14,
{ "Reserved", "pn_io.ioxs.res14",
FT_UINT8, BASE_HEX, NULL, 0x1E,
NULL, HFILL }
},
{ &hf_pn_io_ioxs_instance,
{ "Instance", "pn_io.ioxs.instance",
FT_UINT8, BASE_HEX, VALS(pn_io_ioxs_instance), 0x60,
NULL, HFILL }
},
{ &hf_pn_io_ioxs_datastate,
{ "DataState", "pn_io.ioxs.datastate",
FT_UINT8, BASE_HEX, VALS(pn_io_ioxs_datastate), 0x80,
NULL, HFILL }
},
/* PROFIsafe parameter */
/* Status Byte & Control Byte for PROFIsafe --- dissector handle */
{ &hf_pn_io_ps_sb,
{ "Status Byte", "pn_io.ps.sb",
FT_UINT8, BASE_HEX, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_toggelBitChanged,
{ "Status Byte", "pn_io.ps.sb.toggle_d_changed",
FT_UINT8, BASE_DEC, NULL, 0x00,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_toggelBitChange_slot_nr,
{ "Slot_Number", "pn_io.ps.sb.toggle_d_changed.slot",
FT_UINT16, BASE_DEC, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_toggelBitChange_subslot_nr,
{ "Sub_Slot_Number", "pn_io.ps.sb.toggle_d_changed.subslot",
FT_UINT16, BASE_DEC, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb,
{ "Control Byte", "pn_io.ps.cb",
FT_UINT8, BASE_HEX, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_toggelBitChanged,
{ "Control Byte", "pn_io.ps.cb.toggle_h_changed",
FT_UINT8, BASE_DEC, NULL, 0x00,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_toggelBitChange_slot_nr,
{ "Slot_Number", "pn_io.ps.cb.toggle_h_changed.slot",
FT_UINT16, BASE_DEC, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_toggelBitChange_subslot_nr,
{ "Sub_Slot_Number", "pn_io.ps.cb.toggle_h_changed.subslot",
FT_UINT16, BASE_DEC, NULL, 0x0,
NULL, HFILL }
},
/* Structures for dissecting Status Byte & Control Byte PROFIsafe ---dissector details */
{ &hf_pn_io_ps_sb_iparOK,
{ "iPar_OK - F-Device has new iParameter values assigned", "pn_io.ps.sb.iPar_OK",
FT_UINT8, BASE_HEX, NULL, 0x01,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_DeviceFault,
{ "Device_Fault - Failure exists in F-Device or F-Module", "pn_io.ps.sb.DeviceFault",
FT_UINT8, BASE_HEX, NULL, 0x02,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_CECRC,
{ "CE_CRC - CRC Communication fault", "pn_io.ps.sb.CE_CRC",
FT_UINT8, BASE_HEX, NULL, 0x04,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_WDtimeout,
{ "WD_timeout - WatchDog timeout Communication fault", "pn_io.ps.sb.WD_timeout",
FT_UINT8, BASE_HEX, NULL, 0x08,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_FVactivated,
{ "FV_activated - Fail-safe values (FV) activated", "pn_io.ps.sb.FV_activated",
FT_UINT8, BASE_HEX, NULL, 0x10,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_Toggle_d,
{ "Toggle_d - Device-based Toggle Bit", "pn_io.ps.sb.Toggle_d",
FT_UINT8, BASE_HEX, NULL, 0x20,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_ConsNr_reset,
{ "cons_nr_R - F-Device has reset its consecutive number counter", "pn_io.ps.sb.cons_nr_R",
FT_UINT8, BASE_HEX, NULL, 0x40,
NULL, HFILL }
},
{ &hf_pn_io_ps_sb_res,
{ "Bit7 - reserved for future releases", "pn_io.ps.sb.bit7",
FT_UINT8, BASE_HEX, NULL, 0x80,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_iparEN,
{ "iPar_EN - iParameter assignment deblocked", "pn_io.ps.cb.iparEN",
FT_UINT8, BASE_HEX, NULL, 0x01,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_OAReq,
{ "OA_Req - Operator acknowledge requested", "pn_io.ps.cb.OA_Req",
FT_UINT8, BASE_HEX, NULL, 0x02,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_resetConsNr,
{ "R_cons_nr - Set the Virtual Consecutive Number within the F-Device to be \"0\"", "pn_io.ps.cb.R_cons_nr",
FT_UINT8, BASE_HEX, NULL, 0x04,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_useTO2,
{ "Bit3 - Reserved or Use the secondary watchdog (Use_TO2)", "pn_io.ps.cb.bit3",
FT_UINT8, BASE_HEX, NULL, 0x08,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_activateFV,
{ "activate_FV - Fail-safe values (FV) to be activated", "pn_io.ps.cb.activate_FV",
FT_UINT8, BASE_HEX, NULL, 0x10,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_Toggle_h,
{ "Toggle_h - Host-based Toggle Bit", "pn_io.ps.cb.Toggle_h",
FT_UINT8, BASE_HEX, NULL, 0x20,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_Chf_ACK,
{ "Bit6 - Reserved or Operator acknowledge after cleared channel fault (ChF_Ack)", "pn_io.ps.cb.bit6",
FT_UINT8, BASE_HEX, NULL, 0x40,
NULL, HFILL }
},
{ &hf_pn_io_ps_cb_loopcheck,
{ "Bit7 - Reserved or Loop-back check (Loopcheck, shall be set to 1)", "pn_io.ps.cb.bit7",
FT_UINT8, BASE_HEX, NULL, 0x80,
NULL, HFILL }
},
/* PROFIsafe */
{ &hf_pn_io_ps_f_dest_adr,
{ "F_Dest_Add", "pn_io.ps.f_dest_add",
FT_UINT16, BASE_DEC, NULL, 0x0,
NULL, HFILL }
},
{ &hf_pn_io_ps_f_data,
{ "SafetyIO Data", "pn_io.ps.f_data",
FT_UINT64, BASE_HEX, NULL, 0x0,
NULL, HFILL }
},
};
static gint *ett[] = {
&ett_pn_io_rtc,
&ett_pn_io_ioxs,
&ett_pn_io_io_data_object
};
static ei_register_info ei[] = {
{ &ei_pn_io_too_many_data_objects, { "pn_io.too_many_data_objects", PI_MALFORMED, PI_ERROR, "Too many data objects", EXPFILL }},
};
expert_module_t* expert_pn_io;
proto_pn_io_rtc1 = proto;
proto_register_field_array(proto, hf, array_length(hf));
proto_register_subtree_array(ett, array_length(ett));
expert_pn_io = expert_register_protocol(proto_pn_io_rtc1);
expert_register_field_array(expert_pn_io, ei, array_length(ei));
}
/*
* Editor modelines - http://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:
*/
Reference in New Issue View Git Blame Copy Permalink