/* packet-pn-rtc-one.c * Routines for PROFINET IO - RTC1 dissection. * * Wireshark - Network traffic analyzer * By Gerald Combs * Copyright 1999 Gerald Combs * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version 2 * of the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. */ /* * 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 #include #include #include #include #include #include #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, PT_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_ptr->addr1)) && addresses_equal(&(pinfo->dst), &(conversation->key_ptr->addr2))) { 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_ptr->addr1)) && addresses_equal(&(pinfo->src), &(conversation->key_ptr->addr2))) { 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: */