/* packet-epl.c * Routines for "Ethernet POWERLINK 2.0" dissection * (Ethernet POWERLINK V2.0 Communication Profile Specification Draft Standard Version 1.2.0) * * Copyright (c) 2006: Zurich University of Applied Sciences Winterthur (ZHW) * Institute of Embedded Systems (InES) * http://ines.zhwin.ch * * - Dominic Bechaz * - Damir Bursic * - David Buechi * * Copyright (c) 2007: SYS TEC electronic GmbH * http://www.systec-electronic.com * - Daniel Krueger * * Copyright (c) 2013: B&R Industrieelektronik GmbH * http://www.br-automation.com * * - Christoph Schlosser * - Lukas Emersberger * - Josef Baumgartner * - Roland Knall * - Extended to be similair in handling as to B&R plugin * - Multiple SOD Read/Write dissection * - Include AInv message type * - Straighten text formatting * - Remove unnecessary if(tree) checks * * Copyright (c) 2017: Karlsruhe Institute of Technology (KIT) * Institute for Anthropomatics and Robotics (IAR) * Intelligent Process Control and Robotics (IPR) * http://rob.ipr.kit.edu/ * * - Ahmad Fatoum * - ObjectMappings now used for dissecting PDOs * - XDD/EDS files can be read for name/type information * * Copyright (c) 2020: B&R Industrial Automation GmbH * http://www.br-automation.com * * - Christian Krump * - extended decoding of ring redundancy flags in the SOA frame * - put a boolean hotfield to all available EPL message types * - modified timestamp format of errorcodelist entries * - append summary info with additional flag information * - usage of segment size during sdo (write by index) payload decoding process * - set mapping-sections of sdo objects one level lower * - dissect some additional (cable redundancy specific) flags * * A dissector for: * Wireshark - Network traffic analyzer * By Gerald Combs * Copyright 1999 Gerald Combs * * SPDX-License-Identifier: GPL-2.0-or-later */ #include "config.h" #include "packet-epl.h" #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #ifdef HAVE_LIBXML2 #define IF_LIBXML(x) x #else #define IF_LIBXML(x) #endif void proto_register_epl(void); void proto_reg_handoff_epl(void); #ifndef UDP_PORT_EPL #define UDP_PORT_EPL 3819 #endif /* Allow heuristic dissection and ASND manufacturer dissection */ static heur_dissector_list_t heur_epl_subdissector_list; static heur_dissector_list_t heur_epl_data_subdissector_list; static dissector_table_t epl_asnd_dissector_table; #if 0 /* Container for tapping relevant data */ typedef struct _epl_info_t { unsigned char epl_mtyp; } epl_info_t; #endif /*EPL Addressing*/ #define EPL_DYNAMIC_NODEID 0 #define EPL_MN_NODEID 240 #define EPL_DIAGNOSTIC_DEVICE_NODEID 253 #define EPL_TO_LEGACY_ETHERNET_ROUTER_NODEID 254 #define EPL_BROADCAST_NODEID 255 #define EPL_IS_CN_NODEID(nodeid) (EPL_DYNAMIC_NODEID < (nodeid) && (nodeid) < EPL_MN_NODEID) static const value_string addr_str_vals[] = { {EPL_DYNAMIC_NODEID, " (Dynamically assigned)" }, {EPL_MN_NODEID, " (Managing Node)" }, {EPL_DIAGNOSTIC_DEVICE_NODEID, " (Diagnostic Device)" }, {EPL_TO_LEGACY_ETHERNET_ROUTER_NODEID, " (POWERLINK to legacy Ethernet Router)" }, {EPL_BROADCAST_NODEID, " (broadcast)" }, {0,NULL} }; static const value_string addr_str_abbr_vals[] _U_ = { {EPL_DYNAMIC_NODEID, " (dyn.)" }, {EPL_MN_NODEID, " (MN)" }, {EPL_DIAGNOSTIC_DEVICE_NODEID, " (diag.)" }, {EPL_TO_LEGACY_ETHERNET_ROUTER_NODEID, " (router)" }, {EPL_BROADCAST_NODEID, " (bc)" }, {0,NULL} }; /* static const char* addr_str_abbr_cn = " (CN)"; static const char* addr_str_abbr_res = " (res.)"; */ /* Offsets of fields within an EPL packet. */ #define EPL_MTYP_OFFSET 0 /* same offset for all message types*/ #define EPL_DEST_OFFSET 1 /* same offset for all message types*/ #define EPL_SRC_OFFSET 2 /* same offset for all message types*/ #define EPL_SOA_SVID_OFFSET 6 #define EPL_SOA_SVTG_OFFSET 7 #define EPL_SOA_EPLV_OFFSET 8 /* SyncRequest */ #define EPL_SOA_SYNC_OFFSET 10 #define EPL_SOA_PRFE_OFFSET 14 #define EPL_SOA_PRSE_OFFSET 18 #define EPL_SOA_MNDF_OFFSET 22 #define EPL_SOA_MNDS_OFFSET 26 #define EPL_SOA_PRTO_OFFSET 30 #define EPL_SOA_DEST_OFFSET 34 #define EPL_ASND_SVID_OFFSET 3 #define EPL_ASND_DATA_OFFSET 4 /* NMT Command DNA size */ #define EPL_SIZEOF_NMTCOMMAND_DNA 27 /* EPL message types */ #define EPL_SOC 0x01 #define EPL_PREQ 0x03 #define EPL_PRES 0x04 #define EPL_SOA 0x05 #define EPL_ASND 0x06 #define EPL_AMNI 0x07 #define EPL_AINV 0x0D static const value_string mtyp_vals[] = { {EPL_SOC, "Start of Cycle (SoC)" }, {EPL_PREQ, "PollRequest (PReq)" }, {EPL_PRES, "PollResponse (PRes)" }, {EPL_SOA, "Start of Asynchronous (SoA)" }, {EPL_ASND, "Asynchronous Send (ASnd)" }, {EPL_AINV, "Asynchronous Invite (AInv)" }, {EPL_AMNI, "ActiveManagingNodeIndication (AMNI)" }, {0,NULL} }; /* flags/masks */ #define EPL_SOC_MC_MASK 0x80 #define EPL_SOC_PS_MASK 0x40 #define EPL_SOC_AN_MASK 0x08 #define EPL_PDO_RD_MASK 0x01 #define EPL_PDO_EA_MASK 0x04 #define EPL_PDO_EN_MASK 0x10 #define EPL_PDO_RS_MASK 0x07 #define EPL_PDO_PR_MASK 0x38 #define EPL_PDO_SLS_MASK 0x40 #define EPL_PDO_FLS_MASK 0x80 #define EPL_SOA_EA_MASK 0x04 #define EPL_SOA_ER_MASK 0x02 #define EPL_ASND_EN_MASK 0x10 #define EPL_ASND_EC_MASK 0x08 #define EPL_ASND_RS_MASK 0x07 #define EPL_ASND_PR_MASK 0x38 #define EPL_ASND_SLS_MASK 0x40 #define EPL_ASND_FLS_MASK 0x80 /* RequestedServiceID s for EPL message type "SoA" */ #define EPL_SOA_NOSERVICE 0 #define EPL_SOA_IDENTREQUEST 1 #define EPL_SOA_STATUSREQUEST 2 #define EPL_SOA_NMTREQUESTINVITE 3 #define EPL_SOA_SYNCREQUEST 6 #define EPL_SOA_UNSPECIFIEDINVITE 255 #define EPL_SOA_SYNC_PRES_FIRST 0x01 #define EPL_SOA_SYNC_PRES_SECOND 0x02 #define EPL_SOA_SYNC_MND_FIRST 0x04 #define EPL_SOA_SYNC_MND_SECOND 0x08 #define EPL_SOA_SYNC_PRES_TIMEOUT 0x10 #define EPL_SOA_SYNC_MAC_VALID 0x20 #define EPL_SOA_SYNC_PRES_RESET 0x40 #define EPL_SOA_SYNC_PRES_SET 0x80 static const range_string soa_svid_vals[] = { {EPL_SOA_NOSERVICE, EPL_SOA_NOSERVICE, "NoService"}, {EPL_SOA_IDENTREQUEST, EPL_SOA_IDENTREQUEST, "IdentRequest"}, {EPL_SOA_STATUSREQUEST, EPL_SOA_STATUSREQUEST, "StatusRequest"}, {EPL_SOA_NMTREQUESTINVITE, EPL_SOA_NMTREQUESTINVITE, "NMTRequestInvite"}, {0x04, 0x05, "Reserved"}, {EPL_SOA_SYNCREQUEST, EPL_SOA_SYNCREQUEST, "SyncRequest"}, {0x07, 0x9F, "Reserved"}, {0xA0, 0xFE, "Manufacturer Specific"}, {EPL_SOA_UNSPECIFIEDINVITE, EPL_SOA_UNSPECIFIEDINVITE, "UnspecifiedInvite"}, {0, 0, NULL} }; /* ServiceID values for EPL message type "ASnd" */ #define EPL_ASND_IDENTRESPONSE 1 #define EPL_ASND_STATUSRESPONSE 2 #define EPL_ASND_NMTREQUEST 3 #define EPL_ASND_NMTCOMMAND 4 #define EPL_ASND_SDO 5 #define EPL_ASND_SYNCRESPONSE 6 #define EPL_ASND_SYNCRESPONSE_FST_VALID 0x01 #define EPL_ASND_SYNCRESPONSE_SEC_VALID 0x02 #define EPL_ASND_SYNCRESPONSE_MODE 0x80 static const range_string soa_svid_id_vals[] = { {EPL_SOA_NOSERVICE, EPL_SOA_NOSERVICE, "NO_SERVICE"}, {EPL_SOA_IDENTREQUEST, EPL_SOA_IDENTREQUEST, "IDENT_REQUEST"}, {EPL_SOA_STATUSREQUEST, EPL_SOA_STATUSREQUEST, "STATUS_REQUEST"}, {EPL_SOA_NMTREQUESTINVITE, EPL_SOA_NMTREQUESTINVITE, "NMT_REQUEST_INV"}, {0x04, 0x05, "RESERVED"}, {EPL_SOA_SYNCREQUEST, EPL_SOA_SYNCREQUEST, "SYNC_REQUEST"}, {0x07, 0x9F, "RESERVED"}, {0xA0, 0xFE, "MANUFACTURER SPECIFIC"}, {EPL_SOA_UNSPECIFIEDINVITE, EPL_SOA_UNSPECIFIEDINVITE, "UNSPEC_INVITE"}, {0, 0, NULL} }; static const range_string asnd_svid_vals[] = { {0, 0, "Reserved"}, {EPL_ASND_IDENTRESPONSE, EPL_ASND_IDENTRESPONSE, "IdentResponse"}, {EPL_ASND_STATUSRESPONSE, EPL_ASND_STATUSRESPONSE, "StatusResponse"}, {EPL_ASND_NMTREQUEST, EPL_ASND_NMTREQUEST, "NMTRequest"}, {EPL_ASND_NMTCOMMAND, EPL_ASND_NMTCOMMAND, "NMTCommand"}, {EPL_ASND_SDO, EPL_ASND_SDO, "SDO"}, {EPL_ASND_SYNCRESPONSE, EPL_ASND_SYNCRESPONSE, "SyncResponse"}, {0x07, 0x9F, "Reserved"}, {0xA0, 0xFE, "Manufacturer Specific"}, {0xFF, 0xFF, "Reserved"}, {0, 0, NULL} }; static const range_string asnd_svid_id_vals[] = { {0, 0, "RESERVED"}, {EPL_ASND_IDENTRESPONSE, EPL_ASND_IDENTRESPONSE, "IDENT_RESPONSE"}, {EPL_ASND_STATUSRESPONSE, EPL_ASND_STATUSRESPONSE, "STATUS_RESPONSE"}, {EPL_ASND_NMTREQUEST, EPL_ASND_NMTREQUEST, "NMT_REQUEST"}, {EPL_ASND_NMTCOMMAND, EPL_ASND_NMTCOMMAND, "NMT_COMMAND"}, {EPL_ASND_SDO, EPL_ASND_SDO, "SDO"}, {EPL_ASND_SYNCRESPONSE, EPL_ASND_SYNCRESPONSE, "SYNC_RESPONSE"}, {0x07, 0x9F, "RESERVED"}, {0xA0, 0xFE, "MANUFACTURER SPECIFIC"}, {0xFF, 0xFF, "RESERVED"}, {0, 0, NULL} }; /* NMTCommand values for EPL message type "ASnd" */ #define EPL_ASND_NMTCOMMAND_NMTSTARTNODE 0x21 #define EPL_ASND_NMTCOMMAND_NMTSTOPNODE 0x22 #define EPL_ASND_NMTCOMMAND_NMTENTERPREOPERATIONAL2 0x23 #define EPL_ASND_NMTCOMMAND_NMTENABLEREADYTOOPERATE 0x24 #define EPL_ASND_NMTCOMMAND_NMTRESETNODE 0x28 #define EPL_ASND_NMTCOMMAND_NMTRESETCOMMUNICATION 0x29 #define EPL_ASND_NMTCOMMAND_NMTRESETCONFIGURATION 0x2A #define EPL_ASND_NMTCOMMAND_NMTSWRESET 0x2B #define EPL_ASND_NMTCOMMAND_NMTDNA 0x2D #define EPL_ASND_NMTCOMMAND_NMTSTARTNODEEX 0x41 #define EPL_ASND_NMTCOMMAND_NMTSTOPNODEEX 0x42 #define EPL_ASND_NMTCOMMAND_NMTENTERPREOPERATIONAL2EX 0x43 #define EPL_ASND_NMTCOMMAND_NMTENABLEREADYTOOPERATEEX 0x44 #define EPL_ASND_NMTCOMMAND_NMTRESETNODEEX 0x48 #define EPL_ASND_NMTCOMMAND_NMTRESETCOMMUNICATIONEX 0x49 #define EPL_ASND_NMTCOMMAND_NMTRESETCONFIGURATIONEX 0x4A #define EPL_ASND_NMTCOMMAND_NMTSWRESETEX 0x4B #define EPL_ASND_NMTCOMMAND_NMTNETHOSTNAMESET 0x62 #define EPL_ASND_NMTCOMMAND_NMTFLUSHARPENTRY 0x63 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHCONFIGUREDNODES 0x80 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHACTIVENODES 0x90 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHPREOPERATIONAL1 0x91 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHPREOPERATIONAL2 0x92 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHREADYTOOPERATE 0x93 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHOPERATIONAL 0x94 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHSTOPPED 0x95 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHEMERGENCYNEW 0xA0 #define EPL_ASND_NMTCOMMAND_NMTPUBLISHTIME 0XB0 #define EPL_ASND_NMTCOMMAND_NMTINVALIDSERVICE 0xFF static const value_string asnd_cid_vals[] = { /* "special" values to cover all possibilities of CommandID in NMTRequests */ {EPL_ASND_IDENTRESPONSE, "IdentResponse" }, {EPL_ASND_STATUSRESPONSE, "StatusResponse" }, /* ... */ {EPL_ASND_NMTCOMMAND_NMTSTARTNODE, "NMTStartNode" }, {EPL_ASND_NMTCOMMAND_NMTSTOPNODE, "NMTStopNode" }, {EPL_ASND_NMTCOMMAND_NMTENTERPREOPERATIONAL2, "NMTEnterPreOperational2" }, {EPL_ASND_NMTCOMMAND_NMTENABLEREADYTOOPERATE, "NMTEnableReadyToOperate" }, {EPL_ASND_NMTCOMMAND_NMTRESETNODE, "NMTResetNode" }, {EPL_ASND_NMTCOMMAND_NMTRESETCOMMUNICATION, "NMTResetCommunication" }, {EPL_ASND_NMTCOMMAND_NMTRESETCONFIGURATION, "NMTResetConfiguration" }, {EPL_ASND_NMTCOMMAND_NMTSWRESET, "NMTSwReset" }, {EPL_ASND_NMTCOMMAND_NMTDNA, "NMTDNA" }, {EPL_ASND_NMTCOMMAND_NMTSTARTNODEEX, "NMTStartNodeEx" }, {EPL_ASND_NMTCOMMAND_NMTSTOPNODEEX, "NMTStopNodeEx" }, {EPL_ASND_NMTCOMMAND_NMTENTERPREOPERATIONAL2EX, "NMTEnterPreOperational2Ex" }, {EPL_ASND_NMTCOMMAND_NMTENABLEREADYTOOPERATEEX, "NMTEnableReadyToOperateEx" }, {EPL_ASND_NMTCOMMAND_NMTRESETNODEEX, "NMTResetNodeEx" }, {EPL_ASND_NMTCOMMAND_NMTRESETCOMMUNICATIONEX, "NMTCommunicationEx" }, {EPL_ASND_NMTCOMMAND_NMTRESETCONFIGURATIONEX, "NMTResetConfigurationEx" }, {EPL_ASND_NMTCOMMAND_NMTSWRESETEX, "NMTSwResetEx" }, {EPL_ASND_NMTCOMMAND_NMTNETHOSTNAMESET, "NMTNetHostNameSet" }, {EPL_ASND_NMTCOMMAND_NMTFLUSHARPENTRY, "NMTFlushArpEntry" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHCONFIGUREDNODES, "NMTPublishConfiguredNodes" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHACTIVENODES, "NMTPublishActiveNodes" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHPREOPERATIONAL1, "NMTPublishPreOperational1" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHPREOPERATIONAL2, "NMTPublishPreOperational2" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHREADYTOOPERATE, "NMTPublishReadyToOperate" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHOPERATIONAL, "NMTPublishOperational" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHSTOPPED, "NMTPublishStopped" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHEMERGENCYNEW, "NMTPublishEmergencyNew" }, {EPL_ASND_NMTCOMMAND_NMTPUBLISHTIME, "NMTPublishTime" }, {EPL_ASND_NMTCOMMAND_NMTINVALIDSERVICE, "NMTInvalidService" }, {0,NULL} }; static value_string_ext asnd_cid_vals_ext = VALUE_STRING_EXT_INIT(asnd_cid_vals); /* Maximal Sequence */ #define EPL_MAX_SEQUENCE 0x40 #define EPL_MAX_ADDRESSES 0xF1 /* SCON and RCON values*/ #define EPL_NO_CONNECTION 0x00 #define EPL_INITIALIZATION 0x01 #define EPL_VALID 0x02 #define EPL_ACKREQ 0x03 #define EPL_RETRANSMISSION 0x03 /* MAX Frame offset */ #define EPL_MAX_FRAME_OFFSET 0x64 /* error codes */ #define E_NO_ERROR 0x0000 #define E_NMT_NO_IDENT_RES 0xF001 #define E_NMT_NO_STATUS_RES 0xF002 #define E_DLL_BAD_PHYS_MODE 0x8161 #define E_DLL_COLLISION 0x8162 #define E_DLL_COLLISION_TH 0x8163 #define E_DLL_CRC_TH 0x8164 #define E_DLL_LOSS_OF_LINK 0x8165 #define E_DLL_MAC_BUFFER 0x8166 #define E_DLL_ADDRESS_CONFLICT 0x8201 #define E_DLL_MULTIPLE_MN 0x8202 #define E_PDO_SHORT_RX 0x8210 #define E_PDO_MAP_VERS 0x8211 #define E_NMT_ASND_MTU_DIF 0x8212 #define E_NMT_ASND_MTU_LIM 0x8213 #define E_NMT_ASND_TX_LIM 0x8214 #define E_NMT_CYCLE_LEN 0x8231 #define E_DLL_CYCLE_EXCEED 0x8232 #define E_DLL_CYCLE_EXCEED_TH 0x8233 #define E_NMT_IDLE_LIM 0x8234 #define E_DLL_JITTER_TH 0x8235 #define E_DLL_LATE_PRES_TH 0x8236 #define E_NMT_PREQ_CN 0x8237 #define E_NMT_PREQ_LIM 0x8238 #define E_NMT_PRES_CN 0x8239 #define E_NMT_PRES_RX_LIM 0x823A #define E_NMT_PRES_TX_LIM 0x823B #define E_DLL_INVALID_FORMAT 0x8241 #define E_DLL_LOSS_PREQ_TH 0x8242 #define E_DLL_LOSS_PRES_TH 0x8243 #define E_DLL_LOSS_SOA_TH 0x8244 #define E_DLL_LOSS_SOC_TH 0x8245 #define E_NMT_BA1 0x8410 #define E_NMT_BA1_NO_MN_SUPPORT 0x8411 #define E_NMT_BPO1 0x8420 #define E_NMT_BPO1_GET_IDENT 0x8421 #define E_NMT_BPO1_DEVICE_TYPE 0x8422 #define E_NMT_BPO1_VENDOR_ID 0x8423 #define E_NMT_BPO1_PRODUCT_CODE 0x8424 #define E_NMT_BPO1_REVISION_NO 0x8425 #define E_NMT_BPO1_SERIAL_NO 0x8426 #define E_NMT_BPO1_CF_VERIFY 0x8428 #define E_NMT_BPO2 0x8430 #define E_NMT_BRO 0x8440 #define E_NMT_WRONG_STATE 0x8480 static const value_string errorcode_vals[] = { { E_NO_ERROR, "E_NO_ERROR" }, { E_DLL_BAD_PHYS_MODE, "E_DLL_BAD_PHYS_MODE" }, { E_DLL_COLLISION, "E_DLL_COLLISION" }, { E_DLL_COLLISION_TH, "E_DLL_COLLISION_TH" }, { E_DLL_CRC_TH, "E_DLL_CRC_TH" }, { E_DLL_LOSS_OF_LINK, "E_DLL_LOSS_OF_LINK" }, { E_DLL_MAC_BUFFER, "E_DLL_MAC_BUFFER" }, { E_DLL_ADDRESS_CONFLICT, "E_DLL_ADDRESS_CONFLICT" }, { E_DLL_MULTIPLE_MN, "E_DLL_MULTIPLE_MN" }, { E_PDO_SHORT_RX, "E_PDO_SHORT_RX" }, { E_PDO_MAP_VERS, "E_PDO_MAP_VERS" }, { E_NMT_ASND_MTU_DIF, "E_NMT_ASND_MTU_DIF" }, { E_NMT_ASND_MTU_LIM, "E_NMT_ASND_MTU_LIM" }, { E_NMT_ASND_TX_LIM, "E_NMT_ASND_TX_LIM" }, { E_NMT_CYCLE_LEN, "E_NMT_CYCLE_LEN" }, { E_DLL_CYCLE_EXCEED, "E_DLL_CYCLE_EXCEED" }, { E_DLL_CYCLE_EXCEED_TH, "E_DLL_CYCLE_EXCEED_TH" }, { E_NMT_IDLE_LIM, "E_NMT_IDLE_LIM" }, { E_DLL_JITTER_TH, "E_DLL_JITTER_TH" }, { E_DLL_LATE_PRES_TH, "E_DLL_LATE_PRES_TH" }, { E_NMT_PREQ_CN, "E_NMT_PREQ_CN" }, { E_NMT_PREQ_LIM, "E_NMT_PREQ_LIM" }, { E_NMT_PRES_CN, "E_NMT_PRES_CN" }, { E_NMT_PRES_RX_LIM, "E_NMT_PRES_RX_LIM" }, { E_NMT_PRES_TX_LIM, "E_NMT_PRES_TX_LIM" }, { E_DLL_INVALID_FORMAT, "E_DLL_INVALID_FORMAT" }, { E_DLL_LOSS_PREQ_TH, "E_DLL_LOSS_PREQ_TH" }, { E_DLL_LOSS_PRES_TH, "E_DLL_LOSS_PRES_TH" }, { E_DLL_LOSS_SOA_TH, "E_DLL_LOSS_SOA_TH" }, { E_DLL_LOSS_SOC_TH, "E_DLL_LOSS_SOC_TH" }, { E_NMT_BA1, "E_NMT_BA1" }, { E_NMT_BA1_NO_MN_SUPPORT, "E_NMT_BA1_NO_MN_SUPPORT" }, { E_NMT_BPO1, "E_NMT_BPO1" }, { E_NMT_BPO1_GET_IDENT, "E_NMT_BPO1_GET_IDENT" }, { E_NMT_BPO1_DEVICE_TYPE, "E_NMT_BPO1_DEVICE_TYPE" }, { E_NMT_BPO1_VENDOR_ID, "E_NMT_BPO1_VENDOR_ID" }, { E_NMT_BPO1_PRODUCT_CODE, "E_NMT_BPO1_PRODUCT_CODE" }, { E_NMT_BPO1_REVISION_NO, "E_NMT_BPO1_REVISION_NO" }, { E_NMT_BPO1_SERIAL_NO, "E_NMT_BPO1_SERIAL_NO" }, { E_NMT_BPO1_CF_VERIFY, "E_NMT_BPO1_CF_VERIFY" }, { E_NMT_BPO2, "E_NMT_BPO2" }, { E_NMT_BRO, "E_NMT_BRO" }, { E_NMT_WRONG_STATE, "E_NMT_WRONG_STATE" }, { E_NMT_NO_IDENT_RES, "E_NMT_NO_IDENT_RES" }, { E_NMT_NO_STATUS_RES, "E_NMT_NO_STATUS_RES" }, {0,NULL} }; static value_string_ext errorcode_vals_ext = VALUE_STRING_EXT_INIT(errorcode_vals); /* duplication table key */ typedef struct { uint8_t src; uint8_t dest; uint8_t seq_send; uint8_t seq_recv; } duplication_key; /* duplication table value */ typedef struct { uint32_t frame; } duplication_data; static uint32_t ct; static uint32_t count; typedef struct _epl_sdo_reassembly { uint32_t frame[EPL_MAX_SEQUENCE][EPL_MAX_SEQUENCE]; } epl_sdo_reassembly; static struct _epl_segmentation{ uint8_t src; uint8_t dest; uint8_t recv; uint8_t send; } epl_segmentation; static epl_sdo_reassembly epl_asnd_sdo_reassembly_write; static epl_sdo_reassembly epl_asnd_sdo_reassembly_read; static bool first_read = true; static bool first_write = true; /* Priority values for EPL message type "ASnd", "", "", field PR */ #define EPL_PR_GENERICREQUEST 0x03 #define EPL_PR_NMTREQUEST 0x07 static const value_string epl_pr_vals[] = { {0, "lowest"}, {1, "lower"}, {2, "below generic"}, {EPL_PR_GENERICREQUEST, "GenericRequest"}, {4, "above generic"}, {5, "higher"}, {6, "below NMTRequest"}, {EPL_PR_NMTREQUEST, "NMTRequest"}, {0,NULL} }; /* NMT State values (for CN)*/ #define EPL_NMT_GS_OFF 0x00 #define EPL_NMT_GS_INITIALIZING 0x19 #define EPL_NMT_GS_RESET_APPLICATION 0x29 #define EPL_NMT_GS_RESET_COMMUNICATION 0x39 #define EPL_NMT_CS_NOT_ACTIVE 0x1C #define EPL_NMT_CS_PRE_OPERATIONAL_1 0x1D #define EPL_NMT_CS_PRE_OPERATIONAL_2 0x5D #define EPL_NMT_CS_READY_TO_OPERATE 0x6D #define EPL_NMT_CS_OPERATIONAL 0xFD #define EPL_NMT_CS_STOPPED 0x4D #define EPL_NMT_CS_BASIC_ETHERNET 0x1E static const value_string epl_nmt_cs_vals[] = { {EPL_NMT_GS_OFF, "NMT_GS_OFF" }, {EPL_NMT_GS_INITIALIZING, "NMT_GS_INITIALIZING" }, {EPL_NMT_GS_RESET_APPLICATION, "NMT_GS_RESET_APPLICATION" }, {EPL_NMT_GS_RESET_COMMUNICATION, "NMT_GS_RESET_COMMUNICATION"}, {EPL_NMT_CS_NOT_ACTIVE, "NMT_CS_NOT_ACTIVE" }, {EPL_NMT_CS_PRE_OPERATIONAL_1, "NMT_CS_PRE_OPERATIONAL_1" }, {EPL_NMT_CS_PRE_OPERATIONAL_2, "NMT_CS_PRE_OPERATIONAL_2" }, {EPL_NMT_CS_READY_TO_OPERATE, "NMT_CS_READY_TO_OPERATE" }, {EPL_NMT_CS_OPERATIONAL, "NMT_CS_OPERATIONAL" }, {EPL_NMT_CS_STOPPED, "NMT_CS_STOPPED" }, {EPL_NMT_CS_BASIC_ETHERNET, "NMT_CS_BASIC_ETHERNET" }, {0,NULL} }; /* NMT State values (for MN)*/ #define EPL_NMT_GS_OFF 0x00 #define EPL_NMT_GS_INITIALIZING 0x19 #define EPL_NMT_GS_RESET_APPLICATION 0x29 #define EPL_NMT_GS_RESET_COMMUNICATION 0x39 #define EPL_NMT_MS_NOT_ACTIVE 0x1C #define EPL_NMT_MS_PRE_OPERATIONAL_1 0x1D #define EPL_NMT_MS_PRE_OPERATIONAL_2 0x5D #define EPL_NMT_MS_READY_TO_OPERATE 0x6D #define EPL_NMT_MS_OPERATIONAL 0xFD #define EPL_NMT_MS_BASIC_ETHERNET 0x1E static const value_string epl_nmt_ms_vals[] = { {EPL_NMT_GS_OFF, "NMT_GS_OFF" }, {EPL_NMT_GS_INITIALIZING, "NMT_GS_INITIALIZING" }, {EPL_NMT_GS_RESET_APPLICATION, "NMT_GS_RESET_APPLICATION" }, {EPL_NMT_GS_RESET_COMMUNICATION, "NMT_GS_RESET_COMMUNICATION"}, {EPL_NMT_MS_NOT_ACTIVE, "NMT_MS_NOT_ACTIVE" }, {EPL_NMT_MS_PRE_OPERATIONAL_1, "NMT_MS_PRE_OPERATIONAL_1" }, {EPL_NMT_MS_PRE_OPERATIONAL_2, "NMT_MS_PRE_OPERATIONAL_2" }, {EPL_NMT_MS_READY_TO_OPERATE, "NMT_MS_READY_TO_OPERATE" }, {EPL_NMT_MS_OPERATIONAL, "NMT_MS_OPERATIONAL" }, {EPL_NMT_MS_BASIC_ETHERNET, "NMT_MS_BASIC_ETHERNET" }, {0,NULL} }; /* EPL Device Profiles according to CANopen */ #define EPL_PROFILE_NO 0 #define EPL_PROFILE_GENERIC_IO 401 #define EPL_PROFILE_DRIVE 402 #define EPL_PROFILE_HMI 403 #define EPL_PROFILE_MEASURING 404 #define EPL_PROFILE_PLC 405 #define EPL_PROFILE_ENCODER 406 static const value_string epl_device_profiles[] = { {EPL_PROFILE_NO, "No Standard Device"}, {EPL_PROFILE_GENERIC_IO, "Generic I/O module"}, {EPL_PROFILE_DRIVE, "Drive and motion control"}, {EPL_PROFILE_HMI, "Human Machine Interface"}, {EPL_PROFILE_MEASURING, "Measuring device"}, {EPL_PROFILE_PLC, "IEC 61131-3 PLC"}, {EPL_PROFILE_ENCODER, "Encoder"}, {0,NULL} }; /* EPL Device Profiles loading */ /* User Access Table Checkers */ static bool epl_profile_uat_fld_fileopen_check_cb(void *, const char *, unsigned, const void *, const void *, char **); static bool epl_uat_fld_cn_check_cb(void *, const char *, unsigned, const void *, const void *, char **); static bool epl_uat_fld_uint16dec_check_cb(void *, const char *, unsigned, const void *, const void *, char **); static bool epl_uat_fld_uint32hex_check_cb(void *, const char *, unsigned, const void *, const void *, char **); /* DeviceType:Path User Access Table */ struct device_profile_uat_assoc { char *path; unsigned device_type; unsigned vendor_id; unsigned product_code; }; static uat_t *device_profile_uat; static struct device_profile_uat_assoc *device_profile_list_uats; static unsigned ndevice_profile_uat; static void *device_profile_uat_copy_cb(void *, const void *, size_t); static void device_profile_uat_free_cb(void *); static bool device_profile_uat_update_record(void *, char **); static void device_profile_parse_uat(void); UAT_DEC_CB_DEF(device_profile_list_uats, device_type, struct device_profile_uat_assoc) UAT_HEX_CB_DEF(device_profile_list_uats, vendor_id, struct device_profile_uat_assoc) UAT_HEX_CB_DEF(device_profile_list_uats, product_code, struct device_profile_uat_assoc) UAT_FILENAME_CB_DEF(device_profile_list_uats, path, struct device_profile_uat_assoc) static uat_field_t device_profile_list_uats_flds[] = { UAT_FLD_CSTRING_OTHER(device_profile_list_uats, device_type, "DeviceType", epl_uat_fld_uint16dec_check_cb, "e.g. 401"), UAT_FLD_CSTRING_OTHER(device_profile_list_uats, vendor_id, "VendorId", epl_uat_fld_uint32hex_check_cb, "e.g. DEADBEEF"), UAT_FLD_CSTRING_OTHER(device_profile_list_uats, product_code, "ProductCode", epl_uat_fld_uint32hex_check_cb, "e.g. 8BADFOOD"), UAT_FLD_FILENAME_OTHER(device_profile_list_uats, path, "Profile Path", epl_profile_uat_fld_fileopen_check_cb, "Path to the EDS" IF_LIBXML("/XDD/XDC")), UAT_END_FIELDS }; /* NodeID:Path User Access Table */ struct nodeid_profile_uat_assoc { char *path; uint8_t is_nodeid:1; union { uint8_t id; address addr; } node; char *id_str; }; static uat_t *nodeid_profile_uat; static struct nodeid_profile_uat_assoc *nodeid_profile_list_uats; static unsigned nnodeid_profile_uat; static void nodeid_profile_list_uats_nodeid_set_cb(void *, const char *, unsigned, const void*, const void*); static void nodeid_profile_list_uats_nodeid_tostr_cb(void *, char **, unsigned *, const void*, const void*); static void *nodeid_profile_uat_copy_cb(void *, const void *, size_t); static void nodeid_profile_uat_free_cb(void *); static bool nodeid_profile_uat_update_record(void *, char **); static void nodeid_profile_parse_uat(void); UAT_FILENAME_CB_DEF(nodeid_profile_list_uats, path, struct nodeid_profile_uat_assoc) static uat_field_t nodeid_profile_list_uats_flds[] = { UAT_FLD_CSTRING_OTHER(nodeid_profile_list_uats, nodeid, "Node ID", epl_uat_fld_cn_check_cb, "e.g. 1 or 00-00-5E-00-53-00"), UAT_FLD_FILENAME_OTHER(nodeid_profile_list_uats, path, "Profile Path", epl_profile_uat_fld_fileopen_check_cb, "Path to the EDS" IF_LIBXML("/XDD/XDC")), UAT_END_FIELDS }; /* SDO SequenceLayer */ #define EPL_ASND_SDO_SEQ_RECEIVE_SEQUENCE_NUMBER_OFFSET 4 #define EPL_ASND_SDO_SEQ_RECEIVE_CON_OFFSET 4 #define EPL_ASND_SDO_SEQ_SEND_SEQUENCE_NUMBER_OFFSET 5 #define EPL_ASND_SDO_SEQ_SEND_CON_OFFSET 5 #define EPL_ASND_SDO_SEQ_RECEIVE_CON_NO_CONNECTION 0x00 #define EPL_ASND_SDO_SEQ_RECEIVE_CON_INITIALIZATION 0x01 #define EPL_ASND_SDO_SEQ_RECEIVE_CON_CONNECTION_VALID 0x02 #define EPL_ASND_SDO_SEQ_RECEIVE_CON_ERROR_RESPONSE 0x03 #define EPL_ASND_SDO_SEQ_CON_MASK 0x03 #define EPL_ASND_SDO_SEQ_MASK 0x02 static const value_string epl_sdo_receive_con_vals[] = { {EPL_ASND_SDO_SEQ_RECEIVE_CON_NO_CONNECTION, "No connection" }, {EPL_ASND_SDO_SEQ_RECEIVE_CON_INITIALIZATION, "Initialization" }, {EPL_ASND_SDO_SEQ_RECEIVE_CON_CONNECTION_VALID, "Connection valid" }, {EPL_ASND_SDO_SEQ_RECEIVE_CON_ERROR_RESPONSE, "Error Response (retransmission request)"}, {0,NULL} }; #define EPL_ASND_SDO_SEQ_SEND_CON_NO_CONNECTION 0x00 #define EPL_ASND_SDO_SEQ_SEND_CON_INITIALIZATION 0x01 #define EPL_ASND_SDO_SEQ_SEND_CON_CONNECTION_VALID 0x02 #define EPL_ASND_SDO_SEQ_SEND_CON_ERROR_VALID_ACK_REQ 0x03 static const value_string epl_sdo_init_abbr_vals[] = { {EPL_ASND_SDO_SEQ_RECEIVE_CON_NO_CONNECTION, "n" }, {EPL_ASND_SDO_SEQ_RECEIVE_CON_INITIALIZATION, "i" }, {EPL_ASND_SDO_SEQ_RECEIVE_CON_CONNECTION_VALID, "c" }, {EPL_ASND_SDO_SEQ_RECEIVE_CON_ERROR_RESPONSE, "e" }, {0,NULL} }; static const value_string epl_sdo_send_con_vals[] = { {EPL_ASND_SDO_SEQ_SEND_CON_NO_CONNECTION, "No connection" }, {EPL_ASND_SDO_SEQ_SEND_CON_INITIALIZATION, "Initialization" }, {EPL_ASND_SDO_SEQ_SEND_CON_CONNECTION_VALID, "Connection valid" }, {EPL_ASND_SDO_SEQ_SEND_CON_ERROR_VALID_ACK_REQ, "Connection valid with acknowledge request" }, {0,NULL} }; #define EPL_SDO_INIT_REQUEST ((EPL_NO_CONNECTION << 8) | EPL_INITIALIZATION) #define EPL_SDO_INIT_ACK ((EPL_INITIALIZATION << 8) | EPL_INITIALIZATION) #define EPL_SDO_INIT_RESPONSE ((EPL_INITIALIZATION << 8) | EPL_VALID) #define EPL_SDO_VALID ((EPL_VALID << 8) | EPL_VALID) #define EPL_SDO_RETRANSMISSION ((EPL_RETRANSMISSION << 8) | EPL_VALID) #define EPL_SDO_ACKREQ ((EPL_VALID << 8) | EPL_ACKREQ) #define EPL_SDO_CLOSE ((EPL_NO_CONNECTION << 8) | EPL_NO_CONNECTION) static const value_string epl_sdo_init_con_vals[] = { {EPL_SDO_INIT_REQUEST, "InitReq" }, {EPL_SDO_INIT_ACK, "InitAck" }, {EPL_SDO_INIT_RESPONSE, "InitResp" }, {EPL_SDO_VALID, "Valid" }, {EPL_SDO_RETRANSMISSION, "Retrans" }, {EPL_SDO_ACKREQ, "AckReq" }, {EPL_SDO_CLOSE, "Close" }, {0,NULL} }; /* SDO Command Layer Protocol */ #define EPL_ASND_SDO_CMD_ABORT_FILTER 0x40 #define EPL_ASND_SDO_CMD_SEGMENTATION_FILTER 0x30 #define EPL_ASND_SDO_CMD_RESPONSE_FILTER 0x80 #define EPL_ASND_SDO_CMD_RESPONSE_RESPONSE 0 #define EPL_ASND_SDO_CMD_RESPONSE_REQUEST 1 #define EPL_ASND_SDO_CMD_ABORT_TRANSFER_OK 0 #define EPL_ASND_SDO_CMD_ABORT_ABORT_TRANSFER 1 #define EPL_ASND_SDO_CMD_SEGMENTATION_EPEDITED_TRANSFER 0 #define EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER 1 #define EPL_ASND_SDO_CMD_SEGMENTATION_SEGMENT 2 #define EPL_ASND_SDO_CMD_SEGMENTATION_TRANSFER_COMPLETE 3 #define EPL_ASND_SDO_COMMAND_NOT_IN_LIST 0x00 #define EPL_ASND_SDO_COMMAND_WRITE_BY_INDEX 0x01 #define EPL_ASND_SDO_COMMAND_READ_BY_INDEX 0x02 #define EPL_ASND_SDO_COMMAND_WRITE_ALL_BY_INDEX 0x03 #define EPL_ASND_SDO_COMMAND_READ_ALL_BY_INDEX 0x04 #define EPL_ASND_SDO_COMMAND_WRITE_BY_NAME 0x05 #define EPL_ASND_SDO_COMMAND_READ_BY_NAME 0x06 #define EPL_ASND_SDO_COMMAND_FILE_WRITE 0x20 #define EPL_ASND_SDO_COMMAND_FILE_READ 0x21 #define EPL_ASND_SDO_COMMAND_WRITE_MULTIPLE_PARAMETER_BY_INDEX 0x31 #define EPL_ASND_SDO_COMMAND_READ_MULTIPLE_PARAMETER_BY_INDEX 0x32 #define EPL_ASND_SDO_COMMAND_MAXIMUM_SEGMENT_SIZE 0x70 #define EPL_ASND_SDO_COMMAND_LINK_NAME_TO_INDEX 0x71 /* OD indexes */ #define EPL_SOD_CYLE_LEN 0x1006 #define EPL_SOD_PDO_RX_COMM 0x1400 #define EPL_SOD_PDO_RX_MAPP 0x1600 #define EPL_SOD_PDO_TX_COMM 0x1800 #define EPL_SOD_PDO_TX_MAPP 0x1A00 #define EPL_SDO_SERVER_CONT 0x1200 #define EPL_SDO_CLIENT_CONT 0x1280 #define EPL_SOD_ERR_HISTORY 0x1003 #define EPL_SOD_STORE_PARAM 0x1010 #define EPL_SOD_RESTORE_PARAM 0x1011 #define EPL_SOD_HEARTBEAT_TMN 0x1016 #define EPL_SOD_IDENTITY_OBJECT 0x1018 #define EPL_SOD_VERIFY_CONF 0x1020 #define EPL_SOD_INT_GRP 0x1030 #define EPL_SOD_RLATENCY_DIFF 0x1050 #define EPL_SOD_TELEG_Count 0x1101 #define EPL_SOD_ERR_STAT 0x1102 #define EPL_SOD_STORE_DCF_LST 0x1F20 #define EPL_SOD_STORE_CFM_FMT 0x1F21 #define EPL_SOD_STORE_CON_LST 0x1F22 #define EPL_SOD_STORE_DEV_FILE 0x1F23 #define EPL_SOD_STORE_DEV_FMT 0x1F24 #define EPL_SOD_CONF_REQ 0x1F25 #define EPL_SOD_CONF_DATE 0x1F26 #define EPL_SOD_CONF_TIME 0x1F27 #define EPL_SOD_CONF_ID 0x1F28 #define EPL_SOD_DL_PROG_DATA 0x1F50 #define EPL_SOD_DL_PROG_CTRL 0x1F51 #define EPL_SOD_LOC_SW 0x1F52 #define EPL_SOD_MN_SW_DATE 0x1F53 #define EPL_SOD_MN_SW_TIME 0x1F54 #define EPL_SOD_PROC_IMG 0x1F70 #define EPL_SOD_NMT_NODE 0x1F81 #define EPL_SOD_DEVICE_TYPE_LST 0x1F84 #define EPL_SOD_VENDORID_LST 0x1F85 #define EPL_SOD_PRODUCTEC_LST 0x1F86 #define EPL_SOD_REVISION_NO_LST 0x1F87 #define EPL_SOD_SERIAL_NO_LST 0x1F88 #define EPL_SOD_BOOT_TIME 0x1F89 #define EPL_SOD_CYCLE_TIME 0x1F8A #define EPL_SOD_PREQ_PAYLOAD 0x1F8B #define EPL_SOD_PRES_PAYLOAD 0x1F8D #define EPL_SOD_NODE_STATE 0x1F8E #define EPL_SOD_NODE_EXP_STATE 0x1F8F #define EPL_SOD_CNRES_TMOUT 0x1F92 #define EPL_SOD_MULT_CYCL 0x1F9B #define EPL_SOD_ISO_SLOT_ASSIGN 0x1F9C #define EPL_SOD_NAT_TABLE 0x1D00 #define EPL_SOD_IP_ADD_TABLE 0x1E40 #define EPL_SOD_ROUTING_TABLE 0x1E90 #define EPL_SOD_ACL_IN_TABLE 0x1ED0 #define EPL_SOD_ACL_OUT_TABLE 0x1EE0 #define EPL_SOD_CYLE_LEN 0x1006 #define EPL_NMT_DEVICE_TYPE 0x1000 #define EPL_ERR_ERROR_REGISTER 0x1001 #define EPL_MANUFACT_DEV_NAME 0x1008 #define EPL_MANUFACT_HW_VERS 0x1009 #define EPL_MANUFACT_SW_VERS 0x100A #define EPL_STORE_DEV_FILE 0x1021 #define EPL_STORE_DEV_FORMAT 0x1022 #define EPL_INT_GROUP 0x1300 #define EPL_INT_INDEX 0x1301 #define EPL_INT_DESC 0x1302 #define EPL_VERSION 0x1F83 #define EPL_CN_ETH_TIMEOUT 0x1F99 #define EPL_HOST_NAME 0x1F9A #define EPL_CN_LINK_CUM 0x1C10 #define EPL_CN_JITTER 0x1C13 #define EPL_LOSS_OF_FRAME 0x1C14 static const range_string sod_cmd_str[] = { {EPL_SOD_PDO_RX_COMM, 0x14FF, "0x1400"}, {EPL_SOD_PDO_RX_MAPP, 0x16FF, "0x1600"}, {EPL_SOD_PDO_TX_COMM, 0x18FF, "0x1800"}, {EPL_SOD_PDO_TX_MAPP, 0x1AFF, "0x1A00"}, {EPL_SDO_SERVER_CONT, 0x1279, "0x1200"}, {EPL_SDO_CLIENT_CONT, 0x12FF, "0x1280"}, {EPL_SOD_NAT_TABLE, 0x1DFF, "0x1D00"}, {EPL_SOD_IP_ADD_TABLE, 0x1E49, "0x1E40"}, {EPL_SOD_ROUTING_TABLE, 0x1ECF, "0x1E90"}, {EPL_SOD_ACL_IN_TABLE, 0x1EDF, "0x1ED0"}, {EPL_SOD_ACL_OUT_TABLE, 0x1EEF, "0x1EE0"}, {0,0,NULL} }; static const value_string sod_cmd_str_val[] = { {EPL_SOD_PDO_RX_COMM, "0x1400"}, {EPL_SOD_PDO_RX_MAPP, "0x1600"}, {EPL_SOD_PDO_TX_COMM, "0x1800"}, {EPL_SOD_PDO_TX_MAPP, "0x1A00"}, {EPL_SDO_SERVER_CONT, "0x1200"}, {EPL_SDO_CLIENT_CONT, "0x1280"}, {EPL_SOD_NAT_TABLE, "0x1D00"}, {EPL_SOD_IP_ADD_TABLE, "0x1E40"}, {EPL_SOD_ROUTING_TABLE, "0x1E90"}, {EPL_SOD_ACL_IN_TABLE, "0x1ED0"}, {EPL_SOD_ACL_OUT_TABLE, "0x1EE0"}, {0,NULL} }; static const value_string sod_cmd_sub_str_val[] = { {EPL_SOD_ERR_HISTORY, "0x1003"}, {EPL_SOD_HEARTBEAT_TMN, "0x1016"}, {EPL_SOD_STORE_DCF_LST, "0x1F20"}, {EPL_SOD_STORE_CFM_FMT, "0x1F21"}, {EPL_SOD_STORE_CON_LST, "0x1F22"}, {EPL_SOD_STORE_DEV_FILE, "0x1F23"}, {EPL_SOD_STORE_DEV_FMT, "0x1F24"}, {EPL_SOD_CONF_REQ, "0x1F25"}, {EPL_SOD_CONF_DATE, "0x1F26"}, {EPL_SOD_CONF_TIME, "0x1F27"}, {EPL_SOD_CONF_ID, "0x1F28"}, {EPL_SOD_DL_PROG_DATA, "0x1F50"}, {EPL_SOD_DL_PROG_CTRL, "0x1F51"}, {EPL_SOD_MN_SW_DATE, "0x1F53"}, {EPL_SOD_MN_SW_TIME, "0x1F54"}, {EPL_SOD_NMT_NODE, "0x1F81"}, {EPL_SOD_DEVICE_TYPE_LST,"0x1F84"}, {EPL_SOD_VENDORID_LST, "0x1F85"}, {EPL_SOD_PRODUCTEC_LST, "0x1F86"}, {EPL_SOD_REVISION_NO_LST,"0x1F87"}, {EPL_SOD_SERIAL_NO_LST, "0x1F88"}, {EPL_SOD_PREQ_PAYLOAD, "0x1F8B"}, {EPL_SOD_PRES_PAYLOAD, "0x1F8D"}, {EPL_SOD_NODE_STATE, "0x1F8E"}, {EPL_SOD_NODE_EXP_STATE, "0x1F8F"}, {EPL_SOD_CNRES_TMOUT, "0x1F92"}, {EPL_SOD_MULT_CYCL, "0x1F9B"}, {EPL_SOD_ISO_SLOT_ASSIGN,"0x1F9C"}, {0,NULL} }; static value_string_ext sod_cmd_sub_str = VALUE_STRING_EXT_INIT(sod_cmd_sub_str_val); static const value_string sod_cmd_str_no_sub[] = { {EPL_NMT_DEVICE_TYPE, "0x1000"}, {EPL_ERR_ERROR_REGISTER, "0x1001"}, {EPL_SOD_CYLE_LEN, "0x1006"}, {EPL_MANUFACT_DEV_NAME, "0x1008"}, {EPL_MANUFACT_HW_VERS, "0x1009"}, {EPL_MANUFACT_SW_VERS, "0x100A"}, {EPL_STORE_DEV_FILE, "0x1021"}, {EPL_STORE_DEV_FORMAT, "0x1022"}, {EPL_INT_GROUP, "0x1300"}, {EPL_INT_INDEX, "0x1301"}, {EPL_INT_DESC, "0x1302"}, {EPL_CN_LINK_CUM, "0x1C10"}, {EPL_CN_JITTER, "0x1C13"}, {EPL_LOSS_OF_FRAME, "0x1C14"}, {EPL_VERSION, "0x1F83"}, {EPL_CN_ETH_TIMEOUT, "0x1F99"}, {EPL_HOST_NAME, "0x1F9A"}, {0,NULL} }; static value_string_ext sod_cmd_no_sub = VALUE_STRING_EXT_INIT(sod_cmd_str_no_sub); static const value_string sod_idx_names[] = { /* SDO directory names */ {0x10000000, "NMT_DeviceType_U32"}, {0x10010000, "ERR_ErrorRegister_U8"}, {0x10030000, "ERR_History_ADOM"}, {0x10030001, "ErrorEntry_DOM"}, {0x10060000, "NMT_CycleLen_U32"}, {0x10080000, "NMT_ManufactDevName_VS"}, {0x10090000, "NMT_ManufactHwVers_VS"}, {0x100A0000, "NMT_ManufactSwVers_VS"}, {0x10100000, "NMT_StoreParam_REC"}, {0x10100001, "AllParam_U32"}, {0x10100002, "CommunicationParam_U32"}, {0x10100003, "ApplicationParam_U32"}, {0x10100004, "ManufacturerParam_XXh_U32"}, {0x10110000, "NMT_RestoreDefParam_REC"}, {0x10110001, "AllParam_U32"}, {0x10110002, "CommunicationParam_U32"}, {0x10110003, "ApplicationParam_U32"}, {0x10110004, "ManufacturerParam_XXh_U32"}, {0x10160000, "NMT_ConsumerHeartbeatTime_AU32"}, {0x10160001, "HeartbeatDescription"}, {0x10180000, "NMT_IdentityObject_REC" }, {0x10180001, "VendorId_U32" }, {0x10180002, "ProductCode_U32" }, {0x10180003, "RevisionNo_U32" }, {0x10180004, "SerialNo_U32" }, {0x10200000, "CFM_VerifyConfiguration_REC"}, {0x10200001, "ConfDate_U32"}, {0x10200002, "ConfTime_U32"}, {0x10200003, "ConfId_U32"}, {0x10200004, "VerifyConfInvalid_BOOL"}, {0x10210000, "CFM_StoreDevDescrFile_DOM"}, {0x10220000, "CFM_StoreDevDescrFormat_U16"}, {0x10300000, "NMT_InterfaceGroup_XX_REC"}, {0x10300001, "InterfaceIndex_U16"}, {0x10300002, "InterfaceDescription_VSTR"}, {0x10300003, "InterfaceType_U8"}, {0x10300004, "InterfaceMtu_U16"}, {0x10300005, "InterfacePhysAddress_OSTR"}, {0x10300006, "InterfaceName_VSTR"}, {0x10300007, "InterfaceOperStatus_U8"}, {0x10300008, "InterfaceAdminState_U8"}, {0x10300009, "Valid_BOOL"}, {0x10500000, "NMT_RelativeLatencyDiff_AU32"}, /* TODO: same value, so effectively hidden. Is there another value? {0x10500000, "RelativeLatencyDiff"}, */ {0x11010000, "DIA_NMTTelegrCount_REC"}, {0x11010001, "IsochrCyc_U32"}, {0x11010002, "IsochrRx_U32"}, {0x11010003, "IsochrTx_U32"}, {0x11010004, "AsyncRx_U32"}, {0x11010005, "AsyncTx_U32"}, {0x11010006, "SdoRx_U32"}, {0x11010007, "SdoTx_U32"}, {0x11010008, "Status_U32"}, {0x11020000, "DIA_ERRStatistics_REC"}, {0x11020001, "HistoryEntryWrite_U32"}, {0x11020002, "EmergencyQueueWrite_U32"}, {0x11020003, "EmergencyQueueOverflow_U32"}, {0x11020004, "StatusEntryChanged_U32"}, {0x11020005, "StaticErrorBitFieldChanged_U32"}, {0x11020006, "ExceptionResetEdgePos_U32"}, {0x11020007, "ExceptionNewEdge_U32"}, {0x12000000, "SDO_ServerContainerParam"}, {0x12000001, "ClientNodeID_U8"}, {0x12000002, "ServerNodeID_U8"}, {0x12000003, "ContainerLen_U8"}, {0x12000004, "HistorySize_U8"}, {0x12800000, "SDO_ClientContainerParam"}, {0x12800001, "ClientNodeID_U8"}, {0x12800002, "ServerNodeID_U8"}, {0x12800003, "ContainerLen_U8"}, {0x12800004, "HistorySize_U8"}, {0x12800005, "Reserved"}, {0x13000000, "SDO_SequLayerTimeout_U32"}, {0x13010000, "SDO_CmdLayerTimeout_U32"}, {0x13020000, "SDO_SequLayerNoAck_U32"}, {0x14000000, "PDO_RxCommParam"}, {0x14000001, "NodeID_U8"}, {0x14000002, "MappingVersion_U8"}, {0x16000000, "PDO_RxMappParam"}, {0x16000001, "ObjectMapping"}, {0x18000000, "PDO_TxCommParam"}, {0x18000001, "NodeID_U8"}, {0x18000002, "MappingVersion"}, {0x1A000000, "PDO_TxMappParam"}, {0x1A000001, "ObjectMapping"}, {0x1C0A0000, "DLL_CNCollision_REC"}, {0x1C0A0001, "CumulativeCnt_U32"}, {0x1C0A0002, "ThresholdCnt_U32"}, {0x1C0A0003, "Threshold_U32"}, {0x1C0B0000, "DLL_CNLossSoC_REC"}, {0x1C0B0001, "CumulativeCnt_U32"}, {0x1C0B0002, "ThresholdCnt_U32"}, {0x1C0B0003, "Threshold_U32"}, {0x1C0C0000, "DLL_CNLossSoA_REC"}, {0x1C0C0001, "CumulativeCnt_U32"}, {0x1C0C0002, "ThresholdCnt_U32"}, {0x1C0C0003, "Threshold_U32"}, {0x1C0D0000, "DLL_CNLossPReq_REC"}, {0x1C0D0001, "CumulativeCnt_U32"}, {0x1C0D0002, "ThresholdCnt_U32"}, {0x1C0D0003, "Threshold_U32"}, {0x1C0E0000, "DLL_CNSoCJitter_REC"}, {0x1C0E0001, "CumulativeCnt_U32"}, {0x1C0E0002, "ThresholdCnt_U32"}, {0x1C0E0003, "Threshold_U32"}, {0x1C0F0000, "DLL_CNCRCError_REC"}, {0x1C0F0001, "CumulativeCnt_U32"}, {0x1C0F0002, "ThresholdCnt_U32"}, {0x1C0F0003, "Threshold_U32"}, {0x1C100000, "DLL_CNLossOfLinkCum_U32"}, {0x1C130000, "DLL_CNSoCJitterRange_U32"}, {0x1C140000, "DLL_LossOfFrameTolerance_U32"}, {0x1D000000, "RT1_NatTable"}, {0x1D000001, "EplIpAddr_IPAD"}, {0x1D000002, "ExtIpAddr_IPAD"}, {0x1D000003, "Mask_IPAD"}, {0x1D000004, "Type_U8"}, {0x1E400000, "NWL_IpAddrTable"}, {0x1E400001, "IfIndex_U16"}, {0x1E400002, "Addr_IPAD"}, {0x1E400003, "NetMask_IPAD"}, {0x1E400004, "ReasmMaxSize_U16"}, {0x1E400005, "DefaultGateway_IPAD"}, {0x1E4A0000, "NWL_IpGroup_REC"}, {0x1E4A0001, "Forwarding_BOOL"}, {0x1E4A0002, "DefaultTTL_U16"}, {0x1E4A0003, "ForwardDatagrams_U32"}, {0x1E800000, "RT1_EplRouter_REC"}, {0x1E800001, "EnableNat_BOOL"}, {0x1E800002, "EnablePacketFiltering_BOOL"}, {0x1E810000, "RT1_SecurityGroup_REC"}, {0x1E810001, "FwdTablePolicy_U8"}, {0x1E810002, "InTablePolicy_U8"}, {0x1E810003, "OutTablePolicy_U8"}, {0x1E900000, "RT1_IpRoutingTable"}, {0x1E900001, "IpForwardDest_IPAD"}, {0x1E900002, "IpForwardMask_IPAD"}, {0x1E900003, "IpForwardNextHop_IPAD"}, {0x1E900004, "IpForwardType_U8"}, {0x1E900005, "IpForwardAge_U32"}, {0x1E900006, "IpForwardItfIndex_U16"}, {0x1E900007, "IpForwardMetric1_S32"}, {0x1ED00000, "RT1_AclInTable"}, {0x1ED00001, "SrcIp_IPAD"}, {0x1ED00002, "SrcMask_IPAD"}, {0x1ED00003, "DstIp_IPAD"}, {0x1ED00004, "DstMask_IPAD"}, {0x1ED00005, "Protocol_U8"}, {0x1ED00006, "SrcPort_U16"}, {0x1ED00007, "DstPort_U16"}, {0x1ED00008, "SrcMac_MAC"}, {0x1ED00009, "Target_U8"}, {0x1EE00000, "RT1_AclOutTable"}, {0x1EE00001, "SrcIp_IPAD"}, {0x1EE00002, "SrcMask_IPAD"}, {0x1EE00003, "DstIp_IPAD"}, {0x1EE00004, "DstMask_IPAD"}, {0x1EE00005, "Protocol_U8"}, {0x1EE00006, "SrcPort_U16"}, {0x1EE00007, "DstPort_U16"}, {0x1EE00008, "SrcMac_MAC"}, {0x1EE00009, "Target_U8"}, {0x1F200000, "CFM_StoreDcfList_ADOM"}, {0x1F200001, "CNDcf"}, {0x1F210000, "CFM_DcfStorageFormatList_AU8"}, {0x1F210001, "CNDcfFormat"}, {0x1F220000, "CFM_ConciseDcfList_ADOM"}, {0x1F220001, "CNConciseDcfData"}, {0x1F230000, "CFM_StoreDevDescrFileList_ADOM"}, {0x1F230001, "CNDevDescrFile"}, {0x1F240000, "CFM_DevDescrFileFormatList_AU8"}, {0x1F240001, "CNDevDescrFileFormat"}, {0x1F250000, "CFM_ConfCNRequest_AU32"}, {0x1F250001, "CNConfigurationRequest"}, {0x1F260000, "CFM_ExpConfDateList_AU32"}, {0x1F260001, "CNConfigurationDate"}, {0x1F270000, "CFM_ExpConfTimeList_AU32"}, {0x1F270001, "CNConfigurationTime"}, {0x1F280000, "CFM_ExpConfIdList_AU32"}, {0x1F280001, "CNConfigurationId"}, {0x1F500000, "PDL_DownloadProgData_ADOM"}, {0x1F500001, "Program"}, {0x1F510000, "PDL_ProgCtrl_AU8"}, {0x1F510001, "ProgCtrl"}, {0x1F520000, "PDL_LocVerApplSw_REC"}, {0x1F520001, "ApplSwDate_U32"}, {0x1F520002, "ApplSwTime_U32"}, {0x1F530000, "PDL_MnExpAppSwDateList_AU32"}, {0x1F530001, "AppSwDate"}, {0x1F540000, "PDL_MnExpAppSwTimeList_AU32"}, {0x1F540001, "AppSwTime"}, {0x1F700000, "INP_ProcessImage_REC"}, {0x1F700001, "SelectedRange_U32"}, {0x1F700002, "ProcessImageDomain_DOM"}, {0x1F800000, "NMT_StartUp_U32"}, {0x1F810000, "NMT_NodeAssignment_AU32"}, {0x1F810001, "NodeAssignment"}, {0x1F820000, "NMT_FeatureFlags_U32"}, {0x1F830000, "NMT_EPLVersion_U8"}, {0x1F840000, "NMT_MNDeviceTypeIdList_AU32"}, {0x1F840001, "CNDeviceTypeId"}, {0x1F850000, "NMT_MNVendorIdList_AU32"}, {0x1F850001, "CNVendorId"}, {0x1F860000, "NMT_MNProductCodeList_AU32"}, {0x1F860001, "CNProductCode"}, {0x1F870000, "NMT_MNRevisionNoList_AU32"}, {0x1F870001, "CNRevisionNo"}, {0x1F880000, "NMT_MNSerialNoList_AU32"}, {0x1F880001, "CNSerialNo"}, {0x1F890000, "NMT_BootTime_REC"}, {0x1F890001, "MNWaitNotAct_U32"}, {0x1F890002, "MNTimeoutPreOp1_U32"}, {0x1F890003, "MNWaitPreOp1_U32"}, {0x1F890004, "MNTimeoutPreOp2_U32"}, {0x1F890005, "MNTimeoutReadyToOp_U32"}, {0x1F890006, "MNIdentificationTimeout_U32"}, {0x1F890007, "MNSoftwareTimeout_U32"}, {0x1F890008, "MNConfigurationTimeout_U32"}, {0x1F890009, "MNStartCNTimeout_U32"}, {0x1F89000A, "MNSwitchOverPriority_U32"}, {0x1F89000B, "MNSwitchOverDelay_U32"}, {0x1F89000C, "MNSwitchOverCycleDivider_U32"}, {0x1F8A0000, "NMT_MNCycleTiming_REC"}, {0x1F8A0001, "WaitSoCPReq_U32"}, {0x1F8A0002, "AsyncSlotTimeout_U32"}, {0x1F8A0003, "ASndMaxNumber"}, {0x1F8B0000, "NMT_MNPReqPayloadLimitList_AU16"}, {0x1F8B0001, "CNPReqPayload"}, {0x1F8C0000, "NMT_CurrNMTState_U8"}, {0x1F8D0000, "NMT_PResPayloadLimitList_AU16"}, {0x1F8D0001, "PResPayloadLimit"}, {0x1F8E0000, "NMT_MNNodeCurrState_AU8"}, {0x1F8E0001, "CurrState"}, {0x1F8F0000, "NMT_MNNodeExpState_AU8"}, {0x1F8F0001, "ExpState"}, {0x1F920000, "NMT_MNCNPResTimeout_AU32"}, {0x1F920001, "CNResTimeout"}, {0x1F930000, "NMT_EPLNodeID_REC"}, {0x1F930001, "NodeID_U8"}, {0x1F930002, "NodeIDByHW_BOOL"}, {0x1F930003, "SWNodeID_U8"}, {0x1F980000, "NMT_CycleTiming_REC"}, {0x1F980001, "IsochrTxMaxPayload_U16"}, {0x1F980002, "IsochrRxMaxPayload_U16"}, {0x1F980003, "PResMaxLatency_U32"}, {0x1F980004, "PReqActPayloadLimit_U16"}, {0x1F980005, "PResActPayloadLimit_U16"}, {0x1F980006, "ASndMaxLatency_U32"}, {0x1F980007, "MultiplCycleCnt_U8"}, {0x1F980008, "AsyncMTU_U16"}, {0x1F980009, "Prescaler_U16"}, {0x1F98000A, "PResMode_U8"}, {0x1F98000B, "PResTimeFirst_U32"}, {0x1F98000C, "PResTimeSecond_U32"}, {0x1F98000D, "SyncMNDelayFirst_U32"}, {0x1F98000E, "SyncMNDelaySecond_U32"}, {0x1F990000, "NMT_CNBasicEthernetTimeout_U32"}, {0x1F9A0000, "NMT_HostName_VSTR"}, {0x1F9B0000, "NMT_MultiplCycleAssign_AU8"}, {0x1F9B0001, "CycleNo"}, {0x1F9C0000, "NMT_IsochrSlotAssign_AU8"}, {0x1F9C0001, "NodeId"}, {0x1F9E0000, "NMT_ResetCmd_U8"}, {0x1F9F0000, "NMT_RequestCmd_REC"}, {0x1F9F0001, "Release_BOOL"}, {0x1F9F0002, "CmdID_U8"}, {0x1F9F0003, "CmdTarget_U8"}, {0x1F9F0004, "CmdData_DOM"}, {0,NULL} }; static value_string_ext sod_index_names = VALUE_STRING_EXT_INIT(sod_idx_names); /* SDO - Abort Transfer */ static const value_string sdo_cmd_abort_code[] = { {0x05030000, "reserved" }, {0x05040000, "SDO protocol timed out." }, {0x05040001, "Client/server Command ID not valid or unknown." }, {0x05040002, "Invalid block size." }, {0x05040003, "Invalid sequence number." }, {0x05040004, "reserved" }, {0x05040005, "Out of memory." }, {0x06010000, "Unsupported access to an object." }, {0x06010001, "Attempt to read a write-only object." }, {0x06010002, "Attempt to write a read-only object." }, {0x06020000, "Object does not exist in the object dictionary." }, {0x06040041, "Object cannot be mapped to the PDO." }, {0x06040042, "The number and length of the objects to be mapped would exceed PDO length." }, {0x06040043, "General parameter incompatibility." }, {0x06040047, "General internal incompatibility in the device." }, {0x06060000, "Access failed due to a hardware error." }, {0x06070010, "Data type does not match, length of service parameter does not match." }, {0x06070012, "Data type does not match, length of service parameter too high." }, {0x06070013, "Data type does not match, length of service parameter too low." }, {0x06090011, "Sub-index does not exist." }, {0x06090030, "Value range of parameter exceeded (only for write access)." }, {0x06090031, "Value of parameter written too high." }, {0x06090032, "Value of parameter written too low." }, {0x06090036, "Maximum value is less then minimum value." }, {0x08000000, "General error" }, {0x08000020, "Data cannot be transferred or stored to the application." }, {0x08000021, "Data cannot be transferred or stored to the application because of local control." }, {0x08000022, "Data cannot be transferred or stored to the application because of the present device state." }, {0x08000023, "Object dictionary dynamic generation fails or no object dictionary is present." }, {0x08000024, "EDS, DCF or Concise DCF Data set empty." }, {0,NULL} }; static value_string_ext sdo_cmd_abort_code_ext = VALUE_STRING_EXT_INIT(sdo_cmd_abort_code); static const value_string epl_sdo_asnd_cmd_response[] = { {EPL_ASND_SDO_CMD_RESPONSE_RESPONSE, "Request" }, {EPL_ASND_SDO_CMD_RESPONSE_REQUEST, "Response" }, {0,NULL} }; static const value_string epl_sdo_asnd_cmd_abort[] = { {EPL_ASND_SDO_CMD_ABORT_TRANSFER_OK, "Transfer OK" }, {EPL_ASND_SDO_CMD_ABORT_ABORT_TRANSFER, "Abort Transfer" }, {0,NULL} }; static const value_string epl_sdo_asnd_cmd_segmentation[] = { {EPL_ASND_SDO_CMD_SEGMENTATION_EPEDITED_TRANSFER, "Expedited Transfer" }, {EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER, "Initiate Transfer" }, {EPL_ASND_SDO_CMD_SEGMENTATION_SEGMENT, "Segment" }, {EPL_ASND_SDO_CMD_SEGMENTATION_TRANSFER_COMPLETE, "Transfer Complete" }, {0,NULL} }; static const value_string epl_sdo_asnd_cmd_segmentation_abbr[] = { {EPL_ASND_SDO_CMD_SEGMENTATION_EPEDITED_TRANSFER, "EX" }, {EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER, "SI" }, {EPL_ASND_SDO_CMD_SEGMENTATION_SEGMENT, "ST" }, {EPL_ASND_SDO_CMD_SEGMENTATION_TRANSFER_COMPLETE, "SC" }, {0,NULL} }; static const value_string epl_sdo_asnd_commands[] = { {EPL_ASND_SDO_COMMAND_NOT_IN_LIST , "Not in List" }, {EPL_ASND_SDO_COMMAND_WRITE_BY_INDEX , "Write by Index" }, {EPL_ASND_SDO_COMMAND_READ_BY_INDEX , "Read by Index" }, {EPL_ASND_SDO_COMMAND_WRITE_ALL_BY_INDEX , "Write All by Index" }, {EPL_ASND_SDO_COMMAND_READ_ALL_BY_INDEX , "Read All by Index" }, {EPL_ASND_SDO_COMMAND_WRITE_BY_NAME , "Write by Name" }, {EPL_ASND_SDO_COMMAND_READ_BY_NAME , "Read by Name" }, {EPL_ASND_SDO_COMMAND_FILE_WRITE , "File Write" }, {EPL_ASND_SDO_COMMAND_FILE_READ , "File Read" }, {EPL_ASND_SDO_COMMAND_WRITE_MULTIPLE_PARAMETER_BY_INDEX, "Write Multiple Parameter by Index" }, {EPL_ASND_SDO_COMMAND_READ_MULTIPLE_PARAMETER_BY_INDEX , "Read Multiple Parameter by Index" }, {EPL_ASND_SDO_COMMAND_MAXIMUM_SEGMENT_SIZE , "Maximum Segment Size" }, {EPL_ASND_SDO_COMMAND_LINK_NAME_TO_INDEX , "Link objects only accessible via name to an index/sub-index"}, {0,NULL} }; static value_string_ext epl_sdo_asnd_commands_ext = VALUE_STRING_EXT_INIT(epl_sdo_asnd_commands); static const value_string epl_sdo_asnd_commands_short[] = { {EPL_ASND_SDO_COMMAND_NOT_IN_LIST , "NotInList" }, {EPL_ASND_SDO_COMMAND_WRITE_BY_INDEX , "WriteByIndex" }, {EPL_ASND_SDO_COMMAND_READ_BY_INDEX , "ReadByIndex" }, {EPL_ASND_SDO_COMMAND_WRITE_ALL_BY_INDEX , "WriteAllByIndex" }, {EPL_ASND_SDO_COMMAND_READ_ALL_BY_INDEX , "ReadAllByIndex" }, {EPL_ASND_SDO_COMMAND_WRITE_BY_NAME , "WriteByName" }, {EPL_ASND_SDO_COMMAND_READ_BY_NAME , "ReadByName" }, {EPL_ASND_SDO_COMMAND_FILE_WRITE , "FileWrite" }, {EPL_ASND_SDO_COMMAND_FILE_READ , "FileRead" }, {EPL_ASND_SDO_COMMAND_WRITE_MULTIPLE_PARAMETER_BY_INDEX, "WriteMultipleParam" }, {EPL_ASND_SDO_COMMAND_READ_MULTIPLE_PARAMETER_BY_INDEX , "ReadMultipleParam" }, {0,NULL} }; static value_string_ext epl_sdo_asnd_commands_short_ext = VALUE_STRING_EXT_INIT(epl_sdo_asnd_commands_short); static const char* addr_str_cn = " (Controlled Node)"; static const char* addr_str_res = " (reserved)"; struct object_mapping { struct { uint16_t idx; uint8_t subindex; } pdo, /* The PDO to be mapped */ param; /* The ObjectMapping OD entry that mapped it */ uint16_t bit_offset; uint16_t no_of_bits; int ett; /* info */ struct { uint32_t first, last; } frame; /* frames for which object_mapping applies */ const struct od_entry *info; const char *index_name; char title[32]; }; #define OBJECT_MAPPING_INITIALIZER { { 0, 0 }, { 0, 0 }, 0, 0, 0, { 0, 0 }, 0, 0, { 0 } } #define CONVO_FOR_RESPONSE 1 #define CONVO_FOR_REQUEST 2 #define CONVO_ALWAYS_CREATE 4 struct read_req { uint16_t idx; uint8_t subindex; uint8_t sendsequence; const char *index_name; const struct od_entry *info; }; struct epl_convo { uint8_t CN; uint16_t device_type; uint32_t response_time; uint32_t vendor_id; uint32_t product_code; unsigned generation; /* FIXME remove */ wmem_array_t *TPDO; /* CN->MN */ wmem_array_t *RPDO; /* MN->CN */ struct profile *profile; uint32_t last_frame; uint8_t next_read_req; uint8_t seq_send; struct read_req read_reqs[4]; /* In lieu of allocating an unknown number of read requests, we'll keep a ring * buff of the 4 most recent ones and when a response comes we add them as packet * data */ }; static int dissect_epl_payload(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, int len, const struct epl_datatype *type, uint8_t msgType); static int dissect_epl_soc(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_preq(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_pres(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_soa(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_asnd_ires(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_asnd_sres(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_asnd_nmtcmd(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_asnd_nmtreq(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_asnd_nmtdna(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_asnd(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_ainv(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_asnd_sdo(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_asnd_resp(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset); static int dissect_epl_sdo_sequence(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t *seq); static int dissect_epl_sdo_command(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t seq); static int dissect_epl_sdo_command_write_by_index(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t segmented, bool response, uint16_t segment_size); static int dissect_epl_sdo_command_write_multiple_by_index(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t segmented, bool response, uint16_t segment_size); static int dissect_epl_sdo_command_read_by_index(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t segmented, bool response, uint16_t segment_size); static int dissect_epl_sdo_command_read_multiple_by_index(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t segmented, bool response, uint16_t segment_size); static int dissect_object_mapping(struct profile *profile, wmem_array_t *mappings, proto_tree *epl_tree, tvbuff_t *tvb, uint32_t framenum, int offset, uint16_t idx, uint8_t subindex); static const char* decode_epl_address(unsigned char adr); /* Initialize the protocol and registered fields */ static int proto_epl; static int hf_epl_mtyp; static int hf_epl_node; static int hf_epl_dest; static int hf_epl_src; static int hf_epl_payload_real; /* available epl message types */ static int hf_epl_soc; static int hf_epl_preq; static int hf_epl_pres; static int hf_epl_soa; static int hf_epl_asnd; static int hf_epl_amni; static int hf_epl_ainv; static int hf_epl_soc_flags; static int hf_epl_soc_mc; static int hf_epl_soc_ps; static int hf_epl_soc_dna_an; static int hf_epl_soc_nettime; static int hf_epl_soc_relativetime; static int hf_epl_preq_flags; static int hf_epl_preq_ms; static int hf_epl_preq_ea; static int hf_epl_preq_rd; static int hf_epl_preq_sls; static int hf_epl_preq_fls; static int hf_epl_preq_pdov; static int hf_epl_preq_size; static int hf_epl_pres_stat_ms; static int hf_epl_pres_stat_cs; static int hf_epl_pres_flags; static int hf_epl_pres_ms; static int hf_epl_pres_en; static int hf_epl_pres_rd; static int hf_epl_pres_pr; static int hf_epl_pres_rs; static int hf_epl_pres_sls; static int hf_epl_pres_fls; static int hf_epl_pres_pdov; static int hf_epl_pres_size; static int hf_epl_soa_stat_ms; static int hf_epl_soa_stat_cs; static int hf_epl_soa_ea; static int hf_epl_soa_er; static int hf_epl_soa_svid; static int hf_epl_soa_svtg; static int hf_epl_soa_eplv; static int hf_epl_soa_rrflags; static int hf_epl_soa_rrflags_mnred; static int hf_epl_soa_rrflags_cblred; static int hf_epl_soa_rrflags_ringred; static int hf_epl_soa_rrflags_ringstat; /*SyncRequest*/ static int hf_epl_soa_sync; static int hf_epl_soa_mac; static int hf_epl_soa_pre_fst; static int hf_epl_soa_pre_sec; static int hf_epl_soa_mnd_fst; static int hf_epl_soa_mnd_sec; static int hf_epl_soa_pre_tm; static int hf_epl_soa_pre_set; static int hf_epl_soa_pre_res; static int hf_epl_soa_mac_end; static int hf_epl_soa_pre_fst_end; static int hf_epl_soa_pre_sec_end; static int hf_epl_soa_mnd_fst_end; static int hf_epl_soa_mnd_sec_end; static int hf_epl_soa_pre_tm_end; static int hf_epl_soa_dna_an_glb; static int hf_epl_soa_dna_an_lcl; /*SyncResponse*/ static int hf_epl_asnd_syncResponse_sync; static int hf_epl_asnd_syncResponse_latency; static int hf_epl_asnd_syncResponse_node; static int hf_epl_asnd_syncResponse_delay; static int hf_epl_asnd_syncResponse_pre_fst; static int hf_epl_asnd_syncResponse_pre_sec; static int hf_epl_asnd_syncResponse_fst_val; static int hf_epl_asnd_syncResponse_sec_val; static int hf_epl_asnd_syncResponse_mode; static int hf_epl_asnd_svid; static int hf_epl_asnd_svtg; /* static int hf_epl_asnd_data; */ /*IdentResponse*/ static int hf_epl_asnd_identresponse_en; static int hf_epl_asnd_identresponse_ec; static int hf_epl_asnd_identresponse_pr; static int hf_epl_asnd_identresponse_rs; static int hf_epl_asnd_identresponse_sls; static int hf_epl_asnd_identresponse_fls; static int hf_epl_asnd_identresponse_stat_ms; static int hf_epl_asnd_identresponse_stat_cs; static int hf_epl_asnd_identresponse_ever; static int hf_epl_asnd_identresponse_feat; static int hf_epl_asnd_identresponse_feat_bit0; static int hf_epl_asnd_identresponse_feat_bit1; static int hf_epl_asnd_identresponse_feat_bit2; static int hf_epl_asnd_identresponse_feat_bit3; static int hf_epl_asnd_identresponse_feat_bit4; static int hf_epl_asnd_identresponse_feat_bit5; static int hf_epl_asnd_identresponse_feat_bit6; static int hf_epl_asnd_identresponse_feat_bit7; static int hf_epl_asnd_identresponse_feat_bit8; static int hf_epl_asnd_identresponse_feat_bit9; static int hf_epl_asnd_identresponse_feat_bitA; static int hf_epl_asnd_identresponse_feat_bitB; static int hf_epl_asnd_identresponse_feat_bitC; static int hf_epl_asnd_identresponse_feat_bitD; static int hf_epl_asnd_identresponse_feat_bitE; static int hf_epl_asnd_identresponse_feat_bitF; static int hf_epl_asnd_identresponse_feat_bit10; static int hf_epl_asnd_identresponse_feat_bit11; static int hf_epl_asnd_identresponse_feat_bit12; static int hf_epl_asnd_identresponse_feat_bit13; static int hf_epl_asnd_identresponse_feat_bit14; static int hf_epl_asnd_identresponse_feat_bit21; static int hf_epl_asnd_identresponse_mtu; static int hf_epl_asnd_identresponse_pis; static int hf_epl_asnd_identresponse_pos; static int hf_epl_asnd_identresponse_rst; static int hf_epl_asnd_identresponse_dt; static int hf_epl_asnd_identresponse_dt_add; static int hf_epl_asnd_identresponse_vid; static int hf_epl_asnd_identresponse_productcode; static int hf_epl_asnd_identresponse_rno; static int hf_epl_asnd_identresponse_sno; static int hf_epl_asnd_identresponse_vex1; static int hf_epl_asnd_identresponse_vcd; static int hf_epl_asnd_identresponse_vct; static int hf_epl_asnd_identresponse_ad; static int hf_epl_asnd_identresponse_at; static int hf_epl_asnd_identresponse_ipa; static int hf_epl_asnd_identresponse_snm; static int hf_epl_asnd_identresponse_gtw; static int hf_epl_asnd_identresponse_hn; static int hf_epl_asnd_identresponse_vex2; /*StatusResponse*/ static int hf_epl_asnd_statusresponse_en; static int hf_epl_asnd_statusresponse_ec; static int hf_epl_asnd_statusresponse_pr; static int hf_epl_asnd_statusresponse_rs; static int hf_epl_asnd_statusresponse_sls; static int hf_epl_asnd_statusresponse_fls; static int hf_epl_asnd_statusresponse_stat_ms; static int hf_epl_asnd_statusresponse_stat_cs; /* static int hf_epl_asnd_statusresponse_seb; */ /*StaticErrorBitField */ static int hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit0; static int hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit1; static int hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit2; static int hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit3; static int hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit4; static int hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit5; static int hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit7; static int hf_epl_asnd_statusresponse_seb_devicespecific_err; /*List of Errors/Events*/ /* static int hf_epl_asnd_statusresponse_el; */ /* static int hf_epl_asnd_statusresponse_el_entry; */ static int hf_epl_asnd_statusresponse_el_entry_type; static int hf_epl_asnd_statusresponse_el_entry_type_profile; static int hf_epl_asnd_statusresponse_el_entry_type_mode; static int hf_epl_asnd_statusresponse_el_entry_type_bit14; static int hf_epl_asnd_statusresponse_el_entry_type_bit15; static int hf_epl_asnd_statusresponse_el_entry_code; static int hf_epl_asnd_statusresponse_el_entry_time; static int hf_epl_asnd_statusresponse_el_entry_add; /*NMTRequest*/ static int hf_epl_asnd_nmtrequest_rcid; static int hf_epl_asnd_nmtrequest_rct; static int hf_epl_asnd_nmtrequest_rcd; /*NMTCommand*/ static int hf_epl_asnd_nmtcommand_cid; static int hf_epl_asnd_nmtcommand_cdat; static int hf_epl_asnd_nmtcommand_resetnode_reason; /*static int hf_epl_asnd_nmtcommand_nmtnetparameterset_mtu;*/ static int hf_epl_asnd_nmtcommand_nmtnethostnameset_hn; static int hf_epl_asnd_nmtcommand_nmtflusharpentry_nid; static int hf_epl_asnd_nmtcommand_nmtpublishtime_dt; static int hf_epl_asnd_nmtcommand_nmtdna; static int hf_epl_asnd_nmtcommand_nmtdna_flags; static int hf_epl_asnd_nmtcommand_nmtdna_ltv; static int hf_epl_asnd_nmtcommand_nmtdna_hpm; static int hf_epl_asnd_nmtcommand_nmtdna_nnn; static int hf_epl_asnd_nmtcommand_nmtdna_mac; static int hf_epl_asnd_nmtcommand_nmtdna_cnn; static int hf_epl_asnd_nmtcommand_nmtdna_currmac; static int hf_epl_asnd_nmtcommand_nmtdna_hubenmsk; static int hf_epl_asnd_nmtcommand_nmtdna_currnn; static int hf_epl_asnd_nmtcommand_nmtdna_newnn; static int hf_epl_asnd_nmtcommand_nmtdna_leasetime; /*Asynchronous SDO Sequence Layer*/ static int hf_epl_asnd_sdo_seq; static int hf_epl_asnd_sdo_seq_receive_sequence_number; static int hf_epl_asnd_sdo_seq_receive_con; static int hf_epl_asnd_sdo_seq_send_sequence_number; static int hf_epl_asnd_sdo_seq_send_con; /*Asynchronous SDO Command Layer*/ static int hf_epl_asnd_sdo_cmd; static int hf_epl_asnd_sdo_cmd_transaction_id; static int hf_epl_asnd_sdo_cmd_response; #if 0 static int hf_epl_asnd_sdo_resp_in; static int hf_epl_asnd_sdo_no_resp; static int hf_epl_asnd_sdo_resp_to; #endif static int hf_epl_asnd_sdo_cmd_abort; static int hf_epl_asnd_sdo_cmd_sub_abort; static int hf_epl_asnd_sdo_cmd_segmentation; static int hf_epl_asnd_sdo_cmd_command_id; static int hf_epl_asnd_sdo_cmd_segment_size; static int hf_epl_asnd_sdo_cmd_data_size; static int hf_epl_asnd_sdo_cmd_data_padding; static int hf_epl_asnd_sdo_cmd_data_index; static int hf_epl_asnd_sdo_cmd_data_subindex; static int hf_epl_asnd_sdo_cmd_data_mapping; static int hf_epl_asnd_sdo_cmd_data_mapping_index; static int hf_epl_asnd_sdo_cmd_data_mapping_subindex; static int hf_epl_asnd_sdo_cmd_data_mapping_offset; static int hf_epl_asnd_sdo_cmd_data_mapping_length; /*static int hf_epl_asnd_sdo_cmd_data_response;*/ static int hf_epl_asnd_sdo_cmd_reassembled; static int hf_epl_fragments; static int hf_epl_fragment; static int hf_epl_fragment_overlap; static int hf_epl_fragment_overlap_conflicts; static int hf_epl_fragment_multiple_tails; static int hf_epl_fragment_too_long_fragment; static int hf_epl_fragment_error; static int hf_epl_fragment_count; static int hf_epl_reassembled_in; static int hf_epl_reassembled_length; static int hf_epl_reassembled_data; static int hf_epl_sdo_multi_param_sub_abort; static int hf_epl_asnd_identresponse_profile_path; /* EPL OD Data Types */ static int hf_epl_pdo; static int hf_epl_pdo_index; static int hf_epl_pdo_subindex; static int hf_epl_od_meta; static int hf_epl_od_meta_mapping_index; static int hf_epl_od_meta_mapping_subindex; static int hf_epl_od_meta_lifetime_start; static int hf_epl_od_meta_lifetime_end; static int hf_epl_od_meta_offset; static int hf_epl_od_meta_length; static int hf_epl_od_boolean; static int hf_epl_od_int; static int hf_epl_od_uint; static int hf_epl_od_real; static int hf_epl_od_string; static int hf_epl_od_octet_string; static int hf_epl_od_time; #if 0 static int hf_epl_od_time_difference; static int hf_epl_od_domain; #endif static int hf_epl_od_mac; static int hf_epl_od_ipv4; #define EPL_PDO_TYPE_COUNT 8 static const struct epl_datatype { const char *name; int *hf; unsigned encoding; uint8_t len; } epl_datatype[] = { { "Boolean", &hf_epl_od_boolean, ENC_LITTLE_ENDIAN , 1 }, /* integer types */ { "Integer8", &hf_epl_od_int, ENC_LITTLE_ENDIAN, 1 }, { "Integer16", &hf_epl_od_int, ENC_LITTLE_ENDIAN, 2 }, { "Integer24", &hf_epl_od_int, ENC_LITTLE_ENDIAN, 3 }, { "Integer32", &hf_epl_od_int, ENC_LITTLE_ENDIAN, 4 }, { "Integer40", &hf_epl_od_int, ENC_LITTLE_ENDIAN, 5 }, { "Integer48", &hf_epl_od_int, ENC_LITTLE_ENDIAN, 6 }, { "Integer56", &hf_epl_od_int, ENC_LITTLE_ENDIAN, 7 }, { "Integer64", &hf_epl_od_int, ENC_LITTLE_ENDIAN, 8 }, { "Unsigned8", &hf_epl_od_uint, ENC_LITTLE_ENDIAN, 1 }, { "Unsigned16", &hf_epl_od_uint, ENC_LITTLE_ENDIAN, 2 }, { "Unsigned24", &hf_epl_od_uint, ENC_LITTLE_ENDIAN, 3 }, { "Unsigned32", &hf_epl_od_uint, ENC_LITTLE_ENDIAN, 4 }, { "Unsigned40", &hf_epl_od_uint, ENC_LITTLE_ENDIAN, 5 }, { "Unsigned48", &hf_epl_od_uint, ENC_LITTLE_ENDIAN, 6 }, { "Unsigned56", &hf_epl_od_uint, ENC_LITTLE_ENDIAN, 7 }, { "Unsigned64", &hf_epl_od_uint, ENC_LITTLE_ENDIAN, 8 }, /* non-integer types */ { "Real32", &hf_epl_od_real, ENC_LITTLE_ENDIAN, 4 }, { "Real64", &hf_epl_od_real, ENC_LITTLE_ENDIAN, 8 }, { "Visible_String", &hf_epl_od_string, ENC_ASCII, 0 }, { "Octet_String", &hf_epl_od_octet_string, ENC_NA, 0 }, { "Unicode_String", &hf_epl_od_string, ENC_UCS_2 | ENC_LITTLE_ENDIAN, 0 }, { "MAC_ADDRESS", &hf_epl_od_mac, ENC_BIG_ENDIAN, 6 }, { "IP_ADDRESS", &hf_epl_od_ipv4, ENC_BIG_ENDIAN, 4 }, #if 0 { "Domain", &hf_epl_od_domain, ENC_NA }, { "Time_of_Day", &hf_epl_od_time, ENC_NA }, { "Time_Diff", &hf_epl_od_time_difference, ENC_NA }, #endif { "NETTIME", &hf_epl_od_time, ENC_TIME_SECS_NSECS, 8 }, { 0, 0, 0, 0 } }; static int ett_epl_fragment; static int ett_epl_fragments; static const fragment_items epl_frag_items = { /* Fragment subtrees */ &ett_epl_fragment, &ett_epl_fragments, /* Fragment fields */ &hf_epl_fragments, &hf_epl_fragment, &hf_epl_fragment_overlap, &hf_epl_fragment_overlap_conflicts, &hf_epl_fragment_multiple_tails, &hf_epl_fragment_too_long_fragment, &hf_epl_fragment_error, &hf_epl_fragment_count, /* Reassembled in field */ &hf_epl_reassembled_in, /* Reassembled length field */ &hf_epl_reassembled_length, /* Reassembled data */ &hf_epl_reassembled_data, /* Tag */ "Message fragments" }; static int hf_epl_asnd_sdo_cmd_abort_code; #if 0 static int hf_epl_asnd_sdo_cmd_abort_flag; static int hf_epl_asnd_sdo_cmd_segmentation_flag; static int hf_epl_asnd_sdo_cmd_cmd_valid_test; static int hf_epl_asnd_sdo_actual_command_id; static int hf_epl_asnd_sdo_actual_segment_size; static int hf_epl_asnd_sdo_actual_payload_size_read; #endif /* Initialize the subtree pointers */ static int ett_epl; static int ett_epl_soc; static int ett_epl_preq; static int ett_epl_pres; static int ett_epl_feat; static int ett_epl_seb; static int ett_epl_el; static int ett_epl_el_entry; static int ett_epl_el_entry_type; static int ett_epl_sdo_entry_type; static int ett_epl_asnd_nmt_dna; static int ett_epl_sdo; static int ett_epl_sdo_sequence_layer; static int ett_epl_sdo_command_layer; static int ett_epl_sdo_data; static int ett_epl_asnd_sdo_cmd_data_mapping; static int ett_epl_soa_sync; static int ett_epl_asnd_sync; static int ett_epl_pdo_meta; static expert_field ei_duplicated_frame; static expert_field ei_recvseq_value; static expert_field ei_sendseq_value; static expert_field ei_real_length_differs; static dissector_handle_t epl_handle; static dissector_handle_t epl_udp_handle; static bool show_cmd_layer_for_duplicated; static bool show_pdo_meta_info; static bool use_xdc_mappings = true; static bool interpret_untyped_as_le = true; static bool use_sdo_mappings = true; static int ett_epl_asnd_sdo_data_reassembled; static reassembly_table epl_reassembly_table; static GHashTable *epl_duplication_table; const struct epl_datatype *epl_type_to_hf(const char *name) { const struct epl_datatype *entry; for (entry = epl_datatype; entry->name; entry++) { if (strcmp(name, entry->name) == 0) return entry; } return NULL; } static unsigned epl_address_hash(const void *a) { return add_address_to_hash(0, (const address*)a); } static gboolean epl_address_equal(const void *a, const void *b) { return addresses_equal((const address*)a, (const address*)b); } /* FIXME * PDO Mappings store object/subobjct pointers and thus need to be * updated after a profile change. We purge them by resetting the * memory pool. As PDO Mappings are referenced via Conversations, * we need to fix up those too. I didn't figure out how to clear * conversations yet, so till now, we keep a variable to tell us * if we have dangling pointers. Courtesy of Peter Wu. */ unsigned current_convo_generation; /* FIXME remove */ static wmem_allocator_t *pdo_mapping_scope; static struct object_mapping * get_object_mappings(wmem_array_t *arr, unsigned *len) { *len = wmem_array_get_count(arr); return (struct object_mapping*)wmem_array_get_raw(arr); } static int object_mapping_cmp(const void *_a, const void *_b) { const struct object_mapping *a = (const struct object_mapping*)_a; const struct object_mapping *b = (const struct object_mapping*)_b; if (a->bit_offset < b->bit_offset) return -1; if (a->bit_offset > b->bit_offset) return +1; return 0; } static bool object_mapping_eq(struct object_mapping *a, struct object_mapping *b) { return a->pdo.idx == b->pdo.idx && a->pdo.subindex == b->pdo.subindex && a->frame.first == b->frame.first && a->param.idx == b->param.idx && a->param.subindex == b->param.subindex; } static unsigned add_object_mapping(wmem_array_t *arr, struct object_mapping *mapping) { /* let's check if this overwrites an existing mapping */ unsigned i, len; /* A bit inefficient (looping backwards would be better), but it's acyclic anyway */ struct object_mapping *old = get_object_mappings(arr, &len); for (i = 0; i < len; i++) { if (object_mapping_eq(&old[i], mapping)) return len; if (old[i].frame.first < mapping->frame.first && (CHECK_OVERLAP_LENGTH(old[i].bit_offset, old[i].no_of_bits, mapping->bit_offset, mapping->no_of_bits) || (old[i].param.idx == mapping->param.idx && old[i].param.subindex == mapping->param.subindex && CHECK_OVERLAP_ENDS(old[i].frame.first, old[i].frame.last, mapping->frame.first, mapping->frame.last)))) { old[i].frame.last = mapping->frame.first; } } wmem_array_append(arr, mapping, 1); wmem_array_sort(arr, object_mapping_cmp); return len + 1; } static wmem_map_t *epl_profiles_by_device, *epl_profiles_by_nodeid, *epl_profiles_by_address; static struct profile *epl_default_profile; static const char *epl_default_profile_path = NULL, *epl_default_profile_path_last; static bool profile_del_cb(wmem_allocator_t *pool _U_, wmem_cb_event_t event _U_, void *_profile) { struct profile *profile = (struct profile*)_profile; if (profile->parent_map) wmem_map_remove(profile->parent_map, profile->data); wmem_destroy_allocator(profile->scope); return false; } static void profile_del(struct profile *profile) { if (!profile) return; wmem_unregister_callback(profile->parent_scope, profile->cb_id); profile_del_cb(NULL, WMEM_CB_DESTROY_EVENT, profile); } static struct profile * profile_new(wmem_allocator_t *parent_pool) { wmem_allocator_t *pool; struct profile *profile; pool = wmem_allocator_new(WMEM_ALLOCATOR_SIMPLE); profile = wmem_new0(pool, struct profile); profile->cb_id = wmem_register_callback(parent_pool, profile_del_cb, profile); profile->scope = pool; profile->parent_scope = parent_pool; profile->parent_map = NULL; profile->objects = wmem_map_new(pool, g_direct_hash, g_direct_equal); profile->name = NULL; profile->path = NULL; profile->RPDO = wmem_array_new(pool, sizeof (struct object_mapping)); profile->TPDO = wmem_array_new(pool, sizeof (struct object_mapping)); profile->next = NULL; return profile; } static struct object *object_lookup(struct profile *profile, uint16_t idx); static const struct subobject *subobject_lookup(struct object *obj, uint8_t subindex); struct object * epl_profile_object_add(struct profile *profile, uint16_t idx) { struct object *object = wmem_new0(profile->scope, struct object); object->info.idx = idx; wmem_map_insert(profile->objects, GUINT_TO_POINTER(object->info.idx), object); return object; } struct object * epl_profile_object_lookup_or_add(struct profile *profile, uint16_t idx) { struct object *obj = object_lookup(profile, idx); return obj ? obj : epl_profile_object_add(profile, idx); } bool epl_profile_object_mapping_add(struct profile *profile, uint16_t idx, uint8_t subindex, uint64_t mapping) { wmem_array_t *mappings; tvbuff_t *tvb; uint64_t mapping_le; if (!use_xdc_mappings) return false; if(idx == EPL_SOD_PDO_RX_MAPP && subindex >= 0x01 && subindex <= 0xfe) mappings = profile->RPDO; else if (idx == EPL_SOD_PDO_TX_MAPP && subindex >= 0x01 && subindex <= 0xfe) mappings = profile->TPDO; else return false; mapping_le = GUINT64_TO_LE(mapping); tvb = tvb_new_real_data((uint8_t*)&mapping_le, sizeof mapping_le, sizeof mapping_le); return dissect_object_mapping(profile, mappings, NULL, tvb, 0, 0, idx, subindex) == EPL_OBJECT_MAPPING_SIZE; } bool epl_profile_object_mappings_update(struct profile *profile) { bool updated_any = false; struct object_mapping *mappings; wmem_array_t *PDOs[3], **PDO; if (!use_xdc_mappings) return false; PDOs[0] = profile->RPDO; PDOs[1] = profile->TPDO; PDOs[2] = NULL; for (PDO = PDOs; *PDO; PDO++) { unsigned i, len; len = wmem_array_get_count(*PDO); mappings = (struct object_mapping*)wmem_array_get_raw(*PDO); for (i = 0; i < len; i++) { struct object_mapping *map = &mappings[i]; struct object *mapping_obj; const struct subobject *mapping_subobj; if (!(mapping_obj = object_lookup(profile, map->pdo.idx))) continue; map->info = &mapping_obj->info; map->index_name = map->info->name; updated_any = true; if (!(mapping_subobj = subobject_lookup(mapping_obj, map->pdo.subindex))) continue; map->info = &mapping_subobj->info; } } return updated_any; } static struct read_req * convo_read_req_get(struct epl_convo *convo, packet_info *pinfo, uint8_t SendSequenceNumber) { unsigned i; uint32_t seq_p_key = (ETHERTYPE_EPL_V2 << 16) | convo->seq_send; struct read_req *req = (struct read_req*)p_get_proto_data(wmem_file_scope(), pinfo, proto_epl, seq_p_key); if (req) return req; for (i = 0; i < array_length(convo->read_reqs); i++) { if(convo->read_reqs[i].sendsequence == SendSequenceNumber) { req = wmem_new(wmem_file_scope(), struct read_req); *req = convo->read_reqs[i]; p_add_proto_data(wmem_file_scope(), pinfo, proto_epl, seq_p_key, req); return req; } } return NULL; } static struct read_req * convo_read_req_set(struct epl_convo *convo, uint8_t SendSequenceNumber) { struct read_req *slot = &convo->read_reqs[convo->next_read_req++]; convo->next_read_req %= array_length(convo->read_reqs); slot->sendsequence = SendSequenceNumber; return slot; } static int dissect_epl_pdo(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, unsigned offset, unsigned len, uint8_t msgType) { wmem_array_t *mapping = msgType == EPL_PRES ? convo->TPDO : convo->RPDO; tvbuff_t *payload_tvb; unsigned rem_len, payload_len, payload_len_bits; heur_dtbl_entry_t *hdtbl_entry = NULL; proto_item *item; unsigned i, maps_count; unsigned off = 0; struct object_mapping *mappings = get_object_mappings(mapping, &maps_count); if (len <= 0) return offset; rem_len = tvb_captured_length_remaining(tvb, offset); payload_tvb = tvb_new_subset_length(tvb, offset, MIN(len, rem_len)); payload_len = tvb_captured_length_remaining(payload_tvb, 0); payload_len_bits = payload_len * 8; if ( payload_len < len ) { item = proto_tree_add_uint(epl_tree, hf_epl_payload_real, tvb, offset, payload_len, payload_len); proto_item_set_generated(item); expert_add_info(pinfo, item, &ei_real_length_differs ); } if ( dissector_try_heuristic(heur_epl_data_subdissector_list, payload_tvb, pinfo, epl_tree, &hdtbl_entry, &msgType)) return offset + payload_len; for (i = 0; i < maps_count; i++) { proto_tree *pdo_tree; struct object_mapping *map = &mappings[i]; unsigned willbe_offset_bits = map->bit_offset + map->no_of_bits; if (!(map->frame.first < pinfo->num && pinfo->num < map->frame.last)) continue; if (willbe_offset_bits > payload_len_bits) break; item = proto_tree_add_string_format(epl_tree, hf_epl_pdo, payload_tvb, 0, 0, "", "%s", map->title); pdo_tree = proto_item_add_subtree(item, map->ett); item = proto_tree_add_uint_format_value(pdo_tree, hf_epl_pdo_index, payload_tvb, 0, 0, map->pdo.idx, "%04X", map->pdo.idx); proto_item_set_generated(item); if (map->info) proto_item_append_text (item, " (%s)", map->index_name); item = proto_tree_add_uint_format_value(pdo_tree, hf_epl_pdo_subindex, payload_tvb, 0, 0, map->pdo.subindex, "%02X", map->pdo.subindex); proto_item_set_generated(item); if (map->info && map->info->name != map->index_name) proto_item_append_text (item, " (%s)", map->info->name); if (show_pdo_meta_info) { proto_tree *meta_tree; proto_item *meta_item = proto_tree_add_item(pdo_tree, hf_epl_od_meta, tvb, offset, 0, ENC_NA); meta_tree = proto_item_add_subtree(meta_item, ett_epl_pdo_meta); proto_tree_add_uint(meta_tree, hf_epl_od_meta_mapping_index, tvb, 0, 0, map->param.idx); proto_tree_add_uint(meta_tree, hf_epl_od_meta_mapping_subindex, tvb, 0, 0, map->param.subindex); proto_tree_add_uint(meta_tree, hf_epl_od_meta_lifetime_start, tvb, 0, 0, map->frame.first); if (map->frame.last != UINT32_MAX) proto_tree_add_uint(meta_tree, hf_epl_od_meta_lifetime_end, tvb, 0, 0, map->frame.last); item = proto_tree_add_uint(meta_tree, hf_epl_od_meta_offset, tvb, 0, 0, map->bit_offset); proto_item_append_text (item, " bits"); item = proto_tree_add_uint(meta_tree, hf_epl_od_meta_length, tvb, 0, 0, map->no_of_bits); proto_item_append_text (item, " bits"); proto_item_set_generated(meta_item); } dissect_epl_payload( pdo_tree, tvb_new_octet_aligned(payload_tvb, map->bit_offset, map->no_of_bits), pinfo, 0, map->no_of_bits / 8, map->info ? map->info->type : NULL, msgType ); payload_len -= map->no_of_bits / 8; off = willbe_offset_bits / 8; } /* If we don't have more information, resort to data dissector */ if (tvb_captured_length_remaining(payload_tvb, off)) { return dissect_epl_payload(epl_tree, payload_tvb, pinfo, off, payload_len, NULL, msgType); } return offset + payload_len; } static uint8_t epl_placeholder_mac_addr[6] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }; static address epl_placeholder_mac = ADDRESS_INIT(AT_ETHER, 6, epl_placeholder_mac_addr); static struct epl_convo * epl_get_convo(packet_info *pinfo, int opts) { struct epl_convo *convo; conversation_t * epan_convo; uint32_t node_port; address *node_addr = &epl_placeholder_mac; address *node_dl_addr = &epl_placeholder_mac; if (opts & CONVO_FOR_REQUEST) { node_port = pinfo->destport; #if 0 if (pinfo->dst.type == AT_IPv4 || pinfo->dst.type == AT_ETHER) node_addr = &pinfo->dst; #endif if (pinfo->dl_dst.type == AT_ETHER) node_dl_addr = &pinfo->dl_dst; } else { node_port = pinfo->srcport; #if 0 if (pinfo->src.type == AT_IPv4 || pinfo->src.type == AT_ETHER) node_addr = &pinfo->src; #endif if (pinfo->dl_src.type == AT_ETHER) node_dl_addr = &pinfo->dl_src; } /* It'd be better to consult the Ethernet or IP address when matching conversations, * but an ASnd request is targeted at a Multicast MAC address, so we'll use * a constant address for lookup * TODO: If you, the reader, figure out a way to lookup a conversation by port only * remove the following assignment */ node_addr = &epl_placeholder_mac; if ((epan_convo = find_conversation(pinfo->num, node_addr, node_addr, conversation_pt_to_conversation_type(pinfo->ptype), node_port, node_port, NO_ADDR_B|NO_PORT_B))) { /* XXX Do I need to check setup_frame != pinfo->num in order to not * create unnecessary new conversations? * if not, move the CONVO_ALWAYS_CREATE check up into the if and drop * the goto */ if ((opts & CONVO_ALWAYS_CREATE) && epan_convo->setup_frame != pinfo->num) goto new_convo_creation; if (pinfo->num > epan_convo->last_frame) epan_convo->last_frame = pinfo->num; } else { new_convo_creation: epan_convo = conversation_new(pinfo->num, node_addr, node_addr, conversation_pt_to_conversation_type(pinfo->ptype), node_port, node_port, NO_ADDR2|NO_PORT2); } convo = (struct epl_convo*)conversation_get_proto_data(epan_convo, proto_epl); if (convo == NULL) { convo = wmem_new0(wmem_file_scope(), struct epl_convo); convo->CN = (uint8_t)node_port; convo->generation = current_convo_generation; /* FIXME remove */ convo->TPDO = wmem_array_new(pdo_mapping_scope, sizeof (struct object_mapping)); convo->RPDO = wmem_array_new(pdo_mapping_scope, sizeof (struct object_mapping)); convo->profile = (struct profile*)wmem_map_lookup(epl_profiles_by_address, node_dl_addr); if (!convo->profile) convo->profile = (struct profile*)wmem_map_lookup(epl_profiles_by_nodeid, GUINT_TO_POINTER(convo->CN)); if (!convo->profile) convo->profile = epl_default_profile; convo->seq_send = 0x00; conversation_add_proto_data(epan_convo, proto_epl, (void *)convo); } if (convo->generation != current_convo_generation) { /* FIXME remove */ convo->TPDO = wmem_array_new(pdo_mapping_scope, sizeof (struct object_mapping)); convo->RPDO = wmem_array_new(pdo_mapping_scope, sizeof (struct object_mapping)); convo->generation = current_convo_generation; } return convo; } static bool epl_update_convo_cn_profile(struct epl_convo *convo) { struct profile *candidate; /* Best matching profile */ if ((candidate = (struct profile*)wmem_map_lookup(epl_profiles_by_device, GUINT_TO_POINTER(convo->device_type)))) { struct profile *iter = candidate; do { if ((iter->vendor_id == 0 && convo->product_code == 0 && !candidate->vendor_id) || (iter->vendor_id == convo->vendor_id && !candidate->product_code) || (iter->vendor_id == convo->vendor_id && iter->product_code == convo->product_code)) { candidate = iter; } } while ((iter = iter->next)); convo->profile = candidate; if (!wmem_array_get_count(convo->RPDO)) { wmem_array_append(convo->RPDO, wmem_array_get_raw(candidate->RPDO), wmem_array_get_count(candidate->RPDO) ); } if (!wmem_array_get_count(convo->TPDO)) { wmem_array_append(convo->TPDO, wmem_array_get_raw(candidate->TPDO), wmem_array_get_count(candidate->TPDO) ); } return true; } return false; } static struct object * object_lookup(struct profile *profile, uint16_t idx) { if (profile == NULL) return NULL; return (struct object*)wmem_map_lookup(profile->objects, GUINT_TO_POINTER(idx)); } static const struct subobject * subobject_lookup(struct object *obj, uint8_t subindex) { if (!obj || !obj->subindices) return NULL; return (const struct subobject*)epl_wmem_iarray_find(obj->subindices, subindex); } /* epl duplication table hash function */ static unsigned epl_duplication_hash(const void *k) { const duplication_key *key = (const duplication_key*)k; unsigned hash; hash = ((key->src)<<24) | ((key->dest)<<16)| ((key->seq_recv)<<8)|(key->seq_send); return hash; } /* epl duplication table equal function */ static int epl_duplication_equal(const void *k1, const void *k2) { const duplication_key *key1 = (const duplication_key*)k1; const duplication_key *key2 = (const duplication_key*)k2; int hash; hash = (key1->src == key2->src)&&(key1->dest == key2->dest)&& (key1->seq_recv == key2->seq_recv)&&(key1->seq_send == key2->seq_send); return hash; } /* free the permanent key */ static void free_key(void *ptr) { duplication_key *key = (duplication_key *)ptr; g_slice_free(duplication_key, key); } /* removes the table entries of a specific transfer */ static void epl_duplication_remove(GHashTable* table, uint8_t src, uint8_t dest) { GHashTableIter iter; void *pkey; duplication_key *key; g_hash_table_iter_init(&iter, table); while(g_hash_table_iter_next(&iter, &pkey, NULL)) { key = (duplication_key *)pkey; if((src == key->src) && (dest == key->dest)) { /* remove the key + value from the hash table */ g_hash_table_iter_remove(&iter); } } } /* insert function */ static void epl_duplication_insert(GHashTable* table, void *ptr, uint32_t frame) { duplication_data *data = NULL; duplication_key *key = NULL; void *pdata; /* check if the values are stored */ if(g_hash_table_lookup_extended(table, ptr, NULL, &pdata)) { data = (duplication_data *)pdata; data->frame = frame; } /* insert the data struct into the table */ else { key = (duplication_key *)wmem_memdup(wmem_file_scope(), ptr,sizeof(duplication_key)); /* create memory */ data = wmem_new0(wmem_file_scope(), duplication_data); data->frame = frame; g_hash_table_insert(table,(void *)key, data); } } /* create a key*/ static void * epl_duplication_key(uint8_t src, uint8_t dest, uint8_t seq_recv, uint8_t seq_send) { duplication_key *key = g_slice_new(duplication_key); key->src = src; key->dest = dest; key->seq_recv = seq_recv; key->seq_send = seq_send; return (void *)key; } /* get the saved data */ static uint32_t epl_duplication_get(GHashTable* table, void *ptr) { duplication_data *data = NULL; void *pdata; if(g_hash_table_lookup_extended(table, ptr, NULL, &pdata)) { data = (duplication_data *)pdata; if(data->frame == 0x00) return 0x00; } if(data != NULL) return data->frame; else return 0x00; } static void setup_dissector(void) { /* init duplication hash table */ epl_duplication_table = g_hash_table_new(epl_duplication_hash, epl_duplication_equal); /* create memory block for upload/download */ memset(&epl_asnd_sdo_reassembly_write, 0, sizeof(epl_sdo_reassembly)); memset(&epl_asnd_sdo_reassembly_read, 0, sizeof(epl_sdo_reassembly)); /* free object mappings in one swoop */ pdo_mapping_scope = wmem_allocator_new(WMEM_ALLOCATOR_SIMPLE); } static void cleanup_dissector(void) { wmem_destroy_allocator(pdo_mapping_scope); pdo_mapping_scope = NULL; g_hash_table_destroy(epl_duplication_table); count = 0; ct = 0; first_read = true; first_write = true; } /* preference whether or not display the SoC flags in info column */ bool show_soc_flags; /* Define the tap for epl */ /*static int epl_tap = -1;*/ static uint16_t epl_get_sequence_nr(packet_info *pinfo) { uint16_t seqnum = 0x00; void *data = NULL; if ( ( data = p_get_proto_data ( wmem_file_scope(), pinfo, proto_epl, ETHERTYPE_EPL_V2 ) ) == NULL ) p_add_proto_data ( wmem_file_scope(), pinfo, proto_epl, ETHERTYPE_EPL_V2, GUINT_TO_POINTER((unsigned)seqnum) ); else seqnum = GPOINTER_TO_UINT(data); return seqnum; } static void epl_set_sequence_nr(packet_info *pinfo, uint16_t seqnum) { if ( p_get_proto_data ( wmem_file_scope(), pinfo, proto_epl, ETHERTYPE_EPL_V2 ) != NULL ) p_remove_proto_data( wmem_file_scope(), pinfo, proto_epl, ETHERTYPE_EPL_V2 ); p_add_proto_data ( wmem_file_scope(), pinfo, proto_epl, ETHERTYPE_EPL_V2, GUINT_TO_POINTER((unsigned)seqnum) ); } static void elp_version( char *result, uint32_t version ) { snprintf( result, ITEM_LABEL_LENGTH, "%d.%d", hi_nibble(version), lo_nibble(version)); } /* Code to actually dissect the packets */ static int dissect_eplpdu(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, bool udpencap) { uint8_t epl_mtyp; const char *src_str, *dest_str; /* static epl_info_t mi; */ /* Set up structures needed to add the protocol subtree and manage it */ proto_item *ti; proto_tree *epl_tree = NULL, *epl_src_item, *epl_dest_item; int offset = 0, size = 0; heur_dtbl_entry_t *hdtbl_entry; struct epl_convo *convo; proto_item *msg_typ_hidden = NULL; if (tvb_reported_length(tvb) < 3) { /* Not enough data for an EPL header; don't try to interpret it */ return 0; } /* Get message type */ epl_mtyp = tvb_get_uint8(tvb, EPL_MTYP_OFFSET) & 0x7F; /* * In case the packet is a protocol encoded in the basic EPL transport stream, * give that protocol a chance to make a heuristic dissection, before we continue * to dissect it as a normal EPL packet. */ if (dissector_try_heuristic(heur_epl_subdissector_list, tvb, pinfo, tree, &hdtbl_entry, &epl_mtyp)) return tvb_reported_length(tvb); if (!try_val_to_str(epl_mtyp, mtyp_vals)) { /* Not an EPL packet */ return 0; } /* Make entries in Protocol column and Info column on summary display */ col_set_str(pinfo->cinfo, COL_PROTOCOL, udpencap ? "POWERLINK/UDP" : "POWERLINK"); /* tap */ /* mi.epl_mtyp = epl_mtyp; tap_queue_packet(epl_tap, pinfo, &mi); */ /* IP addresses are always in 192.168.100.0/24 * with last octet being the node id * The original src/dest node ids are reserved */ pinfo->ptype = PT_NONE; /* Get Destination and Source */ if (udpencap) { /* The dissector may be invoked without an IP layer, * so we need to check we can actually index into the buffer */ if (pinfo->net_dst.type == AT_IPv4) pinfo->destport = ((const uint8_t*)pinfo->net_dst.data)[3]; if (pinfo->net_src.type == AT_IPv4) pinfo->srcport = ((const uint8_t*)pinfo->net_src.data)[3]; } else { pinfo->destport = tvb_get_uint8(tvb, EPL_DEST_OFFSET); pinfo->srcport = tvb_get_uint8(tvb, EPL_SRC_OFFSET); } epl_segmentation.dest = pinfo->destport; dest_str = decode_epl_address(pinfo->destport); epl_segmentation.src = pinfo->srcport; src_str = decode_epl_address(pinfo->srcport); col_clear(pinfo->cinfo, COL_INFO); /* Choose the right string for "Info" column (message type) */ switch (epl_mtyp) { case EPL_SOC: col_add_fstr(pinfo->cinfo, COL_INFO, "%3d->%3d SoC ", pinfo->srcport, pinfo->destport); break; case EPL_PREQ: col_add_fstr(pinfo->cinfo, COL_INFO, "%3d->%3d PReq ", pinfo->srcport, pinfo->destport); break; case EPL_PRES: col_add_fstr(pinfo->cinfo, COL_INFO, "%3d->%3d PRes ", pinfo->srcport, pinfo->destport); break; case EPL_SOA: col_add_fstr(pinfo->cinfo, COL_INFO, "%3d->%3d SoA ", pinfo->srcport, pinfo->destport); break; case EPL_ASND: col_add_fstr(pinfo->cinfo, COL_INFO, "%3d->%3d ASnd ", pinfo->srcport, pinfo->destport); break; case EPL_AINV: col_add_fstr(pinfo->cinfo, COL_INFO, "%3d->%3d AInv ", pinfo->srcport, pinfo->destport); break; case EPL_AMNI: col_add_fstr(pinfo->cinfo, COL_INFO, "%3d->%3d AMNI ", pinfo->srcport, pinfo->destport); break; default: /* no valid EPL packet */ return 0; } if (tree) { /* create display subtree for the protocol */ ti = proto_tree_add_item(tree, proto_epl, tvb, 0, -1, ENC_NA); epl_tree = proto_item_add_subtree(ti, ett_epl); /* create a hidden field for filtering all EPL message types with simple syntax (epl.soc, epl.soa,...) */ switch(epl_mtyp) { case EPL_SOC: msg_typ_hidden = proto_tree_add_boolean(epl_tree, hf_epl_soc, tvb, offset, 1, epl_mtyp); break; case EPL_PREQ: msg_typ_hidden = proto_tree_add_boolean(epl_tree, hf_epl_preq, tvb, offset, 1, epl_mtyp); break; case EPL_PRES: msg_typ_hidden = proto_tree_add_boolean(epl_tree, hf_epl_pres, tvb, offset, 1, epl_mtyp); break; case EPL_SOA: msg_typ_hidden = proto_tree_add_boolean(epl_tree, hf_epl_soa, tvb, offset, 1, epl_mtyp); break; case EPL_ASND: msg_typ_hidden = proto_tree_add_boolean(epl_tree, hf_epl_asnd, tvb, offset, 1, epl_mtyp); break; case EPL_AMNI: msg_typ_hidden = proto_tree_add_boolean(epl_tree, hf_epl_amni, tvb, offset, 1, epl_mtyp); break; case EPL_AINV: msg_typ_hidden = proto_tree_add_boolean(epl_tree, hf_epl_ainv, tvb, offset, 1, epl_mtyp); break; } proto_item_set_hidden(msg_typ_hidden); proto_tree_add_item(epl_tree, hf_epl_mtyp, tvb, offset, 1, ENC_LITTLE_ENDIAN); } offset += 1; if (tree && !udpencap) { epl_dest_item = proto_tree_add_item(epl_tree, hf_epl_node, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_set_hidden(epl_dest_item); epl_dest_item = proto_tree_add_item(epl_tree, hf_epl_dest, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text (epl_dest_item, "%s", dest_str); offset += 1; epl_src_item = proto_tree_add_item(epl_tree, hf_epl_node, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_set_hidden(epl_src_item); epl_src_item = proto_tree_add_item(epl_tree, hf_epl_src, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text (epl_src_item, "%s", src_str); offset += 1; } else { offset += 2; } /* The rest of the EPL dissector depends on the message type */ switch (epl_mtyp) { case EPL_SOC: offset = dissect_epl_soc(epl_tree, tvb, pinfo, offset); break; case EPL_PREQ: convo = epl_get_convo(pinfo, CONVO_FOR_REQUEST); offset = dissect_epl_preq(convo, epl_tree, tvb, pinfo, offset); break; case EPL_PRES: convo = epl_get_convo(pinfo, CONVO_FOR_RESPONSE); offset = dissect_epl_pres(convo, epl_tree, tvb, pinfo, offset); break; case EPL_SOA: offset = dissect_epl_soa(epl_tree, tvb, pinfo, offset); break; case EPL_ASND: offset = dissect_epl_asnd(epl_tree, tvb, pinfo, offset); break; case EPL_AINV: offset = dissect_epl_ainv(epl_tree, tvb, pinfo, offset); break; case EPL_AMNI: /* Currently all fields in the AMNI frame are reserved. Therefore * there's nothing to dissect! Everything is given to the heuristic, * which will dissect as data, if no heuristic dissector uses it. */ size = tvb_captured_length_remaining(tvb, offset); offset = dissect_epl_payload(epl_tree, tvb, pinfo, offset, size, NULL, EPL_AMNI); break; /* Switch cases are exhaustive. Default case never occurs */ } return offset; } static int dissect_epl(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_) { return dissect_eplpdu(tvb, pinfo, tree, false); } static int dissect_epludp(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_) { return dissect_eplpdu(tvb, pinfo, tree, true); } static const char* decode_epl_address (unsigned char adr) { const char *addr_str; addr_str = try_val_to_str(adr, addr_str_vals); if (addr_str != NULL) { return addr_str; } else { if (EPL_IS_CN_NODEID(adr)) { return addr_str_cn; } else { return addr_str_res; } } } static int dissect_epl_payload(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, int len, const struct epl_datatype *type, uint8_t msgType) { int rem_len = 0, payload_len = 0; tvbuff_t *payload_tvb = NULL; heur_dtbl_entry_t *hdtbl_entry = NULL; proto_item *item = NULL; if (len <= 0) return offset; rem_len = tvb_captured_length_remaining(tvb, offset); payload_tvb = tvb_new_subset_length(tvb, offset, MIN(len, rem_len)); payload_len = tvb_captured_length_remaining(payload_tvb, 0); if ( payload_len < len ) { item = proto_tree_add_uint(epl_tree, hf_epl_payload_real, tvb, offset, payload_len, payload_len); proto_item_set_generated(item); expert_add_info(pinfo, item, &ei_real_length_differs ); } /* To satisfy heurstic dissectors, we need to pass then the whole PDO payload as-is, * so we check whether we were called from dissect_epl_pdo and skip trying heuristic * dissectors for the PDO's components */ if (msgType != EPL_PREQ && msgType != EPL_PRES) { if ( dissector_try_heuristic(heur_epl_data_subdissector_list, payload_tvb, pinfo, epl_tree, &hdtbl_entry, &msgType)) return offset + payload_len; } if (type && (!type->len || type->len == payload_len)) { if (*type->hf != hf_epl_od_uint) { proto_tree_add_item(epl_tree, *type->hf, tvb, offset, type->len, type->encoding); } else { /* proto_tree_add_item would zero-pad our hex representation * to full 64 bit, which looks kind of ugly, so we add the * HEX part of BASE_DEC_HEX ourselves */ uint64_t val; item = proto_tree_add_item_ret_uint64(epl_tree, *type->hf, tvb, offset, type->len, type->encoding, &val); proto_item_append_text(item, " (0x%.*" PRIx64 ")", 2*type->len, val); } } /* If a mapping uses a type of fixed width that's not equal to * the function argument's length, fallback to raw data dissector */ else { /* We don't know the type, so let's use appropriate unsignedX */ if (payload_len < (int)sizeof (uint64_t) && interpret_untyped_as_le) { uint64_t val; item = proto_tree_add_item_ret_uint64(epl_tree, hf_epl_od_uint, payload_tvb, 0, payload_len, ENC_LITTLE_ENDIAN, &val); proto_item_append_text(item, " (0x%.*" PRIx64 ")", 2*payload_len, val); } else { call_data_dissector(payload_tvb, pinfo, epl_tree); } } return offset + payload_len; } static int dissect_epl_soc(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint8_t flags; static int * const soc_flags[] = { &hf_epl_soc_mc, &hf_epl_soc_ps, &hf_epl_soc_dna_an, NULL }; offset += 1; flags = tvb_get_uint8(tvb, offset); proto_tree_add_bitmask(epl_tree, tvb, offset, hf_epl_soc_flags, ett_epl_soc, soc_flags, ENC_NA); offset += 2; if (show_soc_flags) { col_append_fstr(pinfo->cinfo, COL_INFO, "F:MC=%d,PS=%d", ((EPL_SOC_MC_MASK & flags) >> 7), ((EPL_SOC_PS_MASK & flags) >> 6)); } proto_tree_add_item(epl_tree, hf_epl_soc_nettime, tvb, offset, 8, ENC_TIME_SECS_NSECS|ENC_LITTLE_ENDIAN); offset += 8; proto_tree_add_item(epl_tree, hf_epl_soc_relativetime, tvb, offset, 8, ENC_TIME_SECS_NSECS|ENC_LITTLE_ENDIAN); offset += 8; return offset; } static int dissect_epl_preq(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint16_t len; uint8_t pdoversion; uint8_t flags; static int * const req_flags[] = { &hf_epl_preq_ms, &hf_epl_preq_ea, &hf_epl_preq_rd, NULL }; offset += 1; flags = tvb_get_uint8(tvb, offset); proto_tree_add_bitmask(epl_tree, tvb, offset, hf_epl_preq_flags, ett_epl_preq, req_flags, ENC_NA); offset += 1; /* dissect 2nd flag field */ proto_tree_add_item(epl_tree, hf_epl_preq_fls, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_preq_sls, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; pdoversion = tvb_get_uint8(tvb, offset); proto_tree_add_item(epl_tree, hf_epl_preq_pdov, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 2; /* get size of payload */ len = tvb_get_letohs(tvb, offset); proto_tree_add_uint(epl_tree, hf_epl_preq_size, tvb, offset, 2, len); col_append_fstr(pinfo->cinfo, COL_INFO, "[%4d] F:RD=%d,EA=%d V:%d.%d", len, ((EPL_PDO_RD_MASK & flags) >> 0), ((EPL_PDO_EA_MASK & flags) >> 2), hi_nibble(pdoversion), lo_nibble(pdoversion)); offset += 2; offset = dissect_epl_pdo(convo, epl_tree, tvb, pinfo, offset, len, EPL_PREQ ); return offset; } static int dissect_epl_pres(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint16_t len; uint8_t pdoversion; uint8_t state, flags, flags2; static int * const res_flags[] = { &hf_epl_pres_ms, &hf_epl_pres_en, &hf_epl_pres_rd, NULL }; state = tvb_get_uint8(tvb, offset); if (pinfo->srcport != EPL_MN_NODEID) /* check if the sender is CN or MN */ { proto_tree_add_item(epl_tree, hf_epl_pres_stat_cs, tvb, offset, 1, ENC_LITTLE_ENDIAN); } else /* MN */ { proto_tree_add_item(epl_tree, hf_epl_pres_stat_ms, tvb, offset, 1, ENC_LITTLE_ENDIAN); } offset += 1; flags = tvb_get_uint8(tvb, offset); proto_tree_add_bitmask(epl_tree, tvb, offset, hf_epl_pres_flags, ett_epl_pres, res_flags, ENC_NA); offset += 1; flags2 = tvb_get_uint8(tvb, offset); proto_tree_add_item(epl_tree, hf_epl_pres_fls, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_pres_sls, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_pres_pr, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_pres_rs, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; pdoversion = tvb_get_uint8(tvb, offset); proto_tree_add_item(epl_tree, hf_epl_pres_pdov, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 2; /* get size of payload */ len = tvb_get_letohs(tvb, offset); proto_tree_add_uint(epl_tree, hf_epl_pres_size, tvb, offset, 2, len); col_append_fstr(pinfo->cinfo, COL_INFO, "[%4d]", len); col_append_fstr(pinfo->cinfo, COL_INFO, " F:RD=%d,EN=%d,RS=%d,PR=%d V=%d.%d", ((EPL_PDO_RD_MASK & flags) >> 0), ((EPL_PDO_EN_MASK & flags) >> 4), (EPL_PDO_RS_MASK & flags2), (EPL_PDO_PR_MASK & flags2) >> 3, hi_nibble(pdoversion), lo_nibble(pdoversion)); if (pinfo->srcport != EPL_MN_NODEID) /* check if the sender is CN or MN */ { col_append_fstr(pinfo->cinfo, COL_INFO, " %s", val_to_str(state, epl_nmt_cs_vals, "Unknown(%d)")); } else /* MN */ { col_append_fstr(pinfo->cinfo, COL_INFO, " %s", val_to_str(state, epl_nmt_ms_vals, "Unknown(%d)")); } offset += 2; offset = dissect_epl_pdo(convo, epl_tree, tvb, pinfo, offset, len, EPL_PRES ); return offset; } static int dissect_epl_soa(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint8_t svid, target; uint8_t state, flags; proto_item *psf_item = NULL; proto_tree *psf_tree = NULL; state = tvb_get_uint8(tvb, offset); if (pinfo->srcport != EPL_MN_NODEID) /* check if CN or MN */ { proto_tree_add_item(epl_tree, hf_epl_soa_stat_cs, tvb, offset, 1, ENC_LITTLE_ENDIAN); } else /* MN */ { proto_tree_add_item(epl_tree, hf_epl_soa_stat_ms, tvb, offset, 1, ENC_LITTLE_ENDIAN); } offset += 1; flags = tvb_get_uint8(tvb, offset); svid = tvb_get_uint8(tvb, offset + 2); if (svid == EPL_SOA_IDENTREQUEST) { proto_tree_add_item(epl_tree, hf_epl_soa_dna_an_lcl, tvb, offset, 1, ENC_LITTLE_ENDIAN); } proto_tree_add_item(epl_tree, hf_epl_soa_dna_an_glb, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_soa_ea, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_soa_er, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 2; proto_tree_add_uint(epl_tree, hf_epl_soa_svid, tvb, offset, 1, svid); offset += 1; target = tvb_get_uint8(tvb, offset); proto_tree_add_uint(epl_tree, hf_epl_soa_svtg, tvb, offset, 1, target); offset += 1; col_append_fstr(pinfo->cinfo, COL_INFO, "(%s)->%3d", rval_to_str_const(svid, soa_svid_id_vals, "Unknown"), target); /* append info entry with flag information */ col_append_fstr(pinfo->cinfo, COL_INFO, " F:EA=%d,ER=%d ", ((EPL_SOA_EA_MASK & flags) >> 2), ((EPL_SOA_ER_MASK & flags) >> 1)); if (pinfo->srcport != EPL_MN_NODEID) /* check if CN or MN */ { col_append_fstr(pinfo->cinfo, COL_INFO, " %s", val_to_str(state, epl_nmt_cs_vals, "Unknown(%d)")); } else /* MN */ { col_append_fstr(pinfo->cinfo, COL_INFO, " %s", val_to_str(state, epl_nmt_ms_vals, "Unknown(%d)")); } proto_tree_add_item(epl_tree, hf_epl_soa_eplv, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; /* decode redundancy flags */ proto_tree_add_item(epl_tree, hf_epl_soa_rrflags, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_soa_rrflags_ringstat, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_soa_rrflags_ringred, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_soa_rrflags_cblred, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_soa_rrflags_mnred, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; if (svid == EPL_SOA_SYNCREQUEST) { /* SyncControl bit0-7 */ psf_item = proto_tree_add_item(epl_tree, hf_epl_soa_sync, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (Bits 0..7)"); psf_tree = proto_item_add_subtree(psf_item, ett_epl_soa_sync); proto_tree_add_item(psf_tree, hf_epl_soa_mac, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(psf_tree, hf_epl_soa_pre_tm, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(psf_tree, hf_epl_soa_mnd_sec, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(psf_tree, hf_epl_soa_mnd_fst, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(psf_tree, hf_epl_soa_pre_sec, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(psf_tree, hf_epl_soa_pre_fst, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; /* SyncControl 2 - reserved */ psf_item = proto_tree_add_item(epl_tree, hf_epl_soa_sync, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (Bits 8..15)"); #if 0 psf_tree = proto_item_add_subtree(psf_item, ett_epl_soa_sync); #endif offset += 1; /* SyncControl 3 - reserved */ psf_item = proto_tree_add_item(epl_tree, hf_epl_soa_sync, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (Bits 16..23)"); #if 0 psf_tree = proto_item_add_subtree(psf_item, ett_epl_soa_sync); #endif offset += 1; /* SyncControl 4 */ psf_item = proto_tree_add_item(epl_tree, hf_epl_soa_sync, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (Bits 24..31)"); psf_tree = proto_item_add_subtree(psf_item, ett_epl_soa_sync); proto_tree_add_item(psf_tree, hf_epl_soa_pre_set, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(psf_tree, hf_epl_soa_pre_res, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; /* PResTimeFirst */ proto_tree_add_item(epl_tree, hf_epl_soa_pre_fst_end, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* PResTimeSecond */ proto_tree_add_item(epl_tree, hf_epl_soa_pre_sec_end, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* SyncMNDelayFirst */ proto_tree_add_item(epl_tree, hf_epl_soa_mnd_fst_end, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* SyncMNDelaySecond */ proto_tree_add_item(epl_tree, hf_epl_soa_mnd_sec_end, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* PResFallBackTimeout */ proto_tree_add_item(epl_tree, hf_epl_soa_pre_tm_end, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* DestMacAddress */ proto_tree_add_item(epl_tree, hf_epl_soa_mac_end, tvb, offset, 6, ENC_NA); offset += 6; } return offset; } static int dissect_epl_asnd(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint8_t svid; uint8_t flags, flags2; int size, reported_len; tvbuff_t *next_tvb; proto_item *item; proto_tree *subtree; struct epl_convo *convo; /* get ServiceID of payload */ svid = tvb_get_uint8(tvb, offset); item = proto_tree_add_uint(epl_tree, hf_epl_asnd_svid, tvb, offset, 1, svid ); offset += 1; flags = tvb_get_uint8(tvb, offset); flags2 = tvb_get_uint8(tvb, offset + 1); col_append_fstr(pinfo->cinfo, COL_INFO, "(%s) ", rval_to_str_const(svid, asnd_svid_id_vals, "Unknown")); /* append info entry with flag information for sres/ires frames */ if ((svid == EPL_ASND_IDENTRESPONSE) || (svid == EPL_ASND_STATUSRESPONSE)) { col_append_fstr(pinfo->cinfo, COL_INFO, " F:EC=%d,EN=%d,RS=%d,PR=%d ", ((EPL_ASND_EC_MASK & flags) >> 3), ((EPL_ASND_EN_MASK & flags) >> 4), (EPL_ASND_RS_MASK & flags2), (EPL_ASND_PR_MASK & flags2) >> 3); } switch (svid) { case EPL_ASND_IDENTRESPONSE: convo = epl_get_convo(pinfo, CONVO_FOR_RESPONSE); offset = dissect_epl_asnd_ires(convo, epl_tree, tvb, pinfo, offset); break; case EPL_ASND_STATUSRESPONSE: offset = dissect_epl_asnd_sres(epl_tree, tvb, pinfo, offset); break; case EPL_ASND_NMTREQUEST: offset = dissect_epl_asnd_nmtreq(epl_tree, tvb, pinfo, offset); break; case EPL_ASND_NMTCOMMAND: offset = dissect_epl_asnd_nmtcmd(epl_tree, tvb, pinfo, offset); break; case EPL_ASND_SDO: subtree = proto_item_add_subtree ( item, ett_epl_sdo ); offset = dissect_epl_asnd_sdo(subtree, tvb, pinfo, offset); break; case EPL_ASND_SYNCRESPONSE: offset = dissect_epl_asnd_resp(epl_tree, tvb, pinfo, offset); break; default: size = tvb_captured_length_remaining(tvb, offset); reported_len = tvb_reported_length_remaining(tvb, offset); next_tvb = tvb_new_subset_length_caplen(tvb, offset, size, reported_len); /* Manufacturer specific entries for ASND services */ if (svid >= 0xA0 && svid < 0xFF && dissector_try_uint(epl_asnd_dissector_table, svid, next_tvb, pinfo, ( epl_tree ? epl_tree->parent : NULL ))) { break; } dissect_epl_payload(epl_tree, tvb, pinfo, offset, size, NULL, EPL_ASND); } return offset; } static int dissect_epl_ainv(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint8_t svid; proto_item *item; proto_tree *subtree; struct epl_convo *convo; if (pinfo->srcport != EPL_MN_NODEID) /* check if CN or MN */ { proto_tree_add_item(epl_tree, hf_epl_soa_stat_cs, tvb, offset, 1, ENC_LITTLE_ENDIAN); } else /* MN */ { proto_tree_add_item(epl_tree, hf_epl_soa_stat_ms, tvb, offset, 1, ENC_LITTLE_ENDIAN); } offset += 2; proto_tree_add_item(epl_tree, hf_epl_soa_ea, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_soa_er, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; svid = tvb_get_uint8(tvb, offset); col_append_fstr(pinfo->cinfo, COL_INFO, "(%s) ", rval_to_str(svid, asnd_svid_id_vals, "UNKNOWN(%d)")); item = proto_tree_add_uint(epl_tree, hf_epl_asnd_svid, tvb, offset, 1, svid ); offset += 1; switch (svid) { case EPL_ASND_IDENTRESPONSE: convo = epl_get_convo(pinfo, CONVO_FOR_RESPONSE); offset = dissect_epl_asnd_ires(convo, epl_tree, tvb, pinfo, offset); break; case EPL_ASND_STATUSRESPONSE: offset = dissect_epl_asnd_sres(epl_tree, tvb, pinfo, offset); break; case EPL_ASND_NMTREQUEST: offset = dissect_epl_asnd_nmtreq(epl_tree, tvb, pinfo, offset); break; case EPL_ASND_NMTCOMMAND: offset = dissect_epl_asnd_nmtcmd(epl_tree, tvb, pinfo, offset); break; case EPL_SOA_UNSPECIFIEDINVITE: proto_tree_add_item(epl_tree, hf_epl_asnd_svtg, tvb, offset, 1, ENC_LITTLE_ENDIAN ); offset += 1; proto_tree_add_item(epl_tree, hf_epl_soa_eplv, tvb, offset, 1, ENC_LITTLE_ENDIAN); break; case EPL_ASND_SDO: subtree = proto_item_add_subtree ( item, ett_epl_sdo ); offset = dissect_epl_asnd_sdo(subtree, tvb, pinfo, offset); break; } return offset; } static int dissect_epl_asnd_nmtreq(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint8_t rcid; rcid = tvb_get_uint8(tvb, offset); proto_tree_add_uint(epl_tree, hf_epl_asnd_nmtrequest_rcid, tvb, offset, 1, rcid); proto_tree_add_item(epl_tree, hf_epl_asnd_nmtrequest_rct, tvb, offset+1, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_nmtrequest_rcd, tvb, offset+2, -1, ENC_NA); offset += 2; col_append_str(pinfo->cinfo, COL_INFO, val_to_str_ext(rcid, &asnd_cid_vals_ext, "Unknown (%d)")); return offset; } static int dissect_epl_asnd_nmtdna(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { proto_item *ti_dna; proto_tree *epl_dna_tree; uint32_t curr_node_num; uint32_t new_node_num; uint32_t lease_time; uint32_t lease_time_s; nstime_t us; static int * const dna_flags[] = { &hf_epl_asnd_nmtcommand_nmtdna_ltv, &hf_epl_asnd_nmtcommand_nmtdna_hpm, &hf_epl_asnd_nmtcommand_nmtdna_nnn, &hf_epl_asnd_nmtcommand_nmtdna_mac, &hf_epl_asnd_nmtcommand_nmtdna_cnn, NULL }; ti_dna = proto_tree_add_item(epl_tree, hf_epl_asnd_nmtcommand_nmtdna, tvb, offset, EPL_SIZEOF_NMTCOMMAND_DNA, ENC_NA); epl_dna_tree = proto_item_add_subtree(ti_dna, ett_epl_feat); proto_tree_add_bitmask(epl_dna_tree, tvb, offset, hf_epl_asnd_nmtcommand_nmtdna_flags, ett_epl_asnd_nmt_dna, dna_flags, ENC_NA); offset += 1; proto_tree_add_item(epl_dna_tree, hf_epl_asnd_nmtcommand_nmtdna_currmac, tvb, offset, 6, ENC_NA); offset += 6; /* 64-bit mask specifying which hub ports are active (1) or inactive (0) */ proto_tree_add_item(epl_dna_tree, hf_epl_asnd_nmtcommand_nmtdna_hubenmsk, tvb, offset, 8, ENC_LITTLE_ENDIAN); offset += 8; proto_tree_add_item_ret_uint(epl_dna_tree, hf_epl_asnd_nmtcommand_nmtdna_currnn, tvb, offset, 4, ENC_LITTLE_ENDIAN, &curr_node_num); offset += 4; proto_tree_add_item_ret_uint (epl_dna_tree, hf_epl_asnd_nmtcommand_nmtdna_newnn, tvb, offset, 4, ENC_LITTLE_ENDIAN, &new_node_num); offset += 4; lease_time = tvb_get_uint32(tvb, offset, ENC_LITTLE_ENDIAN); lease_time_s = lease_time / 1000000; /* us->s */ us.nsecs = (lease_time - lease_time_s * 1000000) * 1000; /* us->ns */ us.secs = lease_time_s; proto_tree_add_time(epl_dna_tree, hf_epl_asnd_nmtcommand_nmtdna_leasetime, tvb, offset, 4, &us); offset += 4; col_append_fstr(pinfo->cinfo, COL_INFO, ": %4d -> %4d", curr_node_num, new_node_num); return offset; } static int dissect_epl_asnd_nmtcmd(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint8_t epl_asnd_nmtcommand_cid; uint16_t errorcode; epl_asnd_nmtcommand_cid = tvb_get_uint8(tvb, offset); proto_tree_add_uint(epl_tree, hf_epl_asnd_nmtcommand_cid, tvb, offset, 1, epl_asnd_nmtcommand_cid); offset += 2; col_append_str(pinfo->cinfo, COL_INFO, val_to_str_ext(epl_asnd_nmtcommand_cid, &asnd_cid_vals_ext, "Unknown(%d)")); switch (epl_asnd_nmtcommand_cid) { case EPL_ASND_NMTCOMMAND_NMTNETHOSTNAMESET: proto_tree_add_item(epl_tree, hf_epl_asnd_nmtcommand_nmtnethostnameset_hn, tvb, offset, 32, ENC_NA); offset += 32; break; case EPL_ASND_NMTCOMMAND_NMTFLUSHARPENTRY: proto_tree_add_item(epl_tree, hf_epl_asnd_nmtcommand_nmtflusharpentry_nid, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; break; case EPL_ASND_NMTCOMMAND_NMTPUBLISHTIME: proto_tree_add_item(epl_tree, hf_epl_asnd_nmtcommand_nmtpublishtime_dt, tvb, offset, 6, ENC_NA); offset += 6; break; case EPL_ASND_NMTCOMMAND_NMTDNA: /* This byte is reserved for the other NMT commands but some flags are placed in it for DNA */ offset -= 1; offset = dissect_epl_asnd_nmtdna(epl_tree, tvb, pinfo, offset); break; case EPL_ASND_NMTCOMMAND_NMTRESETNODE: errorcode = tvb_get_letohs(tvb, offset); if (errorcode != 0) { col_append_fstr(pinfo->cinfo, COL_INFO, " (%s)", val_to_str(errorcode, errorcode_vals, "Unknown Error(0x%04x")); proto_tree_add_item(epl_tree, hf_epl_asnd_nmtcommand_resetnode_reason, tvb, offset, 2, ENC_LITTLE_ENDIAN); } else proto_tree_add_item(epl_tree, hf_epl_asnd_nmtcommand_cdat, tvb, offset, -1, ENC_NA); break; default: proto_tree_add_item(epl_tree, hf_epl_asnd_nmtcommand_cdat, tvb, offset, -1, ENC_NA); } return offset; } static int dissect_epl_asnd_ires(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { uint32_t epl_asnd_identresponse_ipa, epl_asnd_identresponse_snm, epl_asnd_identresponse_gtw; proto_item *ti_feat, *ti; proto_tree *epl_feat_tree; uint16_t device_type; const char *profile_name = NULL; uint32_t response_time; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_en, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_ec, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_fls, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_sls, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_pr, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_rs, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; if (pinfo->srcport != EPL_MN_NODEID) /* check if CN or MN */ { proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_stat_cs, tvb, offset, 1, ENC_LITTLE_ENDIAN); } else /* MN */ { proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_stat_ms, tvb, offset, 1, ENC_LITTLE_ENDIAN); } offset += 2; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_ever, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 2; /* decode FeatureFlags */ ti_feat = proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_feat, tvb, offset, 4, ENC_LITTLE_ENDIAN); epl_feat_tree = proto_item_add_subtree(ti_feat, ett_epl_feat); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit0, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit1, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit2, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit3, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit4, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit5, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit6, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit7, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit8, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit9, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bitA, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bitB, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bitC, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bitD, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bitE, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bitF, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit10, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit11, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit12, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit13, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit14, tvb, offset, 4, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_feat_tree, hf_epl_asnd_identresponse_feat_bit21, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_mtu, tvb, offset, 2, ENC_LITTLE_ENDIAN); offset += 2; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_pis, tvb, offset, 2, ENC_LITTLE_ENDIAN); offset += 2; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_pos, tvb, offset, 2, ENC_LITTLE_ENDIAN); offset += 2; response_time = tvb_get_letohl(tvb, offset); proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_rst, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 6; device_type = tvb_get_letohs(tvb, offset); if (device_type != convo->device_type) convo = epl_get_convo(pinfo, CONVO_FOR_RESPONSE | CONVO_ALWAYS_CREATE); convo->response_time = response_time; convo->device_type = device_type; ti = proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_dt, tvb, offset, 2, ENC_LITTLE_ENDIAN); if (!convo->profile || !convo->profile->nodeid) epl_update_convo_cn_profile(convo); if (convo->profile && convo->profile->name) profile_name = convo->profile->name; if (!profile_name) profile_name = val_to_str_const(convo->device_type, epl_device_profiles, "Unknown Profile"); proto_item_append_text(ti, " (%s)", profile_name); proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_dt_add, tvb, offset+2, 2, ENC_LITTLE_ENDIAN); if (convo->profile && convo->profile->path) { ti = proto_tree_add_string(epl_tree, hf_epl_asnd_identresponse_profile_path, tvb, offset, 2, convo->profile->path); proto_item_set_generated(ti); } offset += 4; convo->vendor_id = tvb_get_letohl(tvb, offset); proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_vid, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; convo->product_code = tvb_get_letohl(tvb, offset); proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_productcode, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_rno, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_sno, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_vex1, tvb, offset, 8, ENC_LITTLE_ENDIAN); offset += 8; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_vcd, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_vct, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_ad, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_at, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; epl_asnd_identresponse_ipa = tvb_get_ntohl(tvb, offset); proto_tree_add_ipv4(epl_tree , hf_epl_asnd_identresponse_ipa, tvb, offset, 4, epl_asnd_identresponse_ipa); offset += 4; epl_asnd_identresponse_snm = tvb_get_ntohl(tvb, offset); proto_tree_add_ipv4(epl_tree , hf_epl_asnd_identresponse_snm, tvb, offset, 4, epl_asnd_identresponse_snm); offset += 4; epl_asnd_identresponse_gtw = tvb_get_ntohl(tvb, offset); proto_tree_add_ipv4(epl_tree , hf_epl_asnd_identresponse_gtw, tvb, offset, 4, epl_asnd_identresponse_gtw); offset += 4; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_hn, tvb, offset, 32, ENC_ASCII); offset += 32; proto_tree_add_item(epl_tree, hf_epl_asnd_identresponse_vex2, tvb, offset, 48, ENC_NA); offset += 48; col_append_str(pinfo->cinfo, COL_INFO, val_to_str(convo->device_type, epl_device_profiles, "Device Profile %d")); return offset; } static int dissect_epl_asnd_resp(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo _U_, int offset) { proto_item *psf_item = NULL; proto_tree *psf_tree = NULL; /* reserved 2 byte*/ offset +=2; /* SyncStatus bit 0 - 7 */ psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_sync, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (Bits 0..7)"); psf_tree = proto_item_add_subtree(psf_item, ett_epl_asnd_sync); proto_tree_add_item(psf_tree, hf_epl_asnd_syncResponse_sec_val, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(psf_tree, hf_epl_asnd_syncResponse_fst_val, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; /* SyncStatus bit 8 - 15 reserved */ psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_sync, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (Bits 8..15)"); #if 0 psf_tree = proto_item_add_subtree(psf_item, ett_epl_asnd_sync); #endif offset += 1; /* SyncStatus bit 16 - 23 reserved */ psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_sync, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (Bits 16..23)"); #if 0 psf_tree = proto_item_add_subtree(psf_item, ett_epl_asnd_sync); #endif offset += 1; /* SyncStatus bit 24 - 31 reserved */ psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_sync, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (Bits 24..31)"); psf_tree = proto_item_add_subtree(psf_item, ett_epl_asnd_sync); proto_tree_add_item(psf_tree, hf_epl_asnd_syncResponse_mode, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; /* Latency */ proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_latency, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* SyncDelayStation */ proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_node, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* SyncDelay */ proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_delay, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* PResTimeFirst */ proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_pre_fst, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; /* PResTimeSecond */ proto_tree_add_item(epl_tree, hf_epl_asnd_syncResponse_pre_sec, tvb, offset, 4, ENC_LITTLE_ENDIAN); offset += 4; return offset; } static int dissect_epl_asnd_sres(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset) { proto_item *ti_el_entry, *ti_el_entry_type; proto_tree *epl_seb_tree, *epl_el_tree, *epl_el_entry_tree, *epl_el_entry_type_tree; unsigned number_of_entries, cnt; /* used for dissection of ErrorCodeList */ uint8_t nmt_state; proto_tree_add_item(epl_tree, hf_epl_asnd_statusresponse_en, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_statusresponse_ec, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; proto_tree_add_item(epl_tree, hf_epl_asnd_statusresponse_fls, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_statusresponse_sls, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_statusresponse_pr, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_tree, hf_epl_asnd_statusresponse_rs, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; nmt_state = tvb_get_uint8(tvb, offset); col_append_fstr(pinfo->cinfo, COL_INFO, "%s ", val_to_str(nmt_state, epl_nmt_cs_vals, "Unknown (%d)")); if (pinfo->srcport != EPL_MN_NODEID) /* check if CN or MN */ { proto_tree_add_uint(epl_tree, hf_epl_asnd_statusresponse_stat_cs, tvb, offset, 1, nmt_state); } else /* MN */ { proto_tree_add_uint(epl_tree, hf_epl_asnd_statusresponse_stat_ms, tvb, offset, 1, nmt_state); } offset += 4; /* Subtree for the static error bitfield */ epl_seb_tree = proto_tree_add_subtree(epl_tree, tvb, offset, 8, ett_epl_seb, NULL, "StaticErrorBitfield"); proto_tree_add_item(epl_seb_tree, hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit0, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_seb_tree, hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit1, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_seb_tree, hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit2, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_seb_tree, hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit3, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_seb_tree, hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit4, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_seb_tree, hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit5, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(epl_seb_tree, hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit7, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 2; proto_tree_add_item(epl_seb_tree, hf_epl_asnd_statusresponse_seb_devicespecific_err, tvb,offset, 6, ENC_NA); offset += 6; /* List of errors / events */ /* get the number of entries in the error code list*/ number_of_entries = (tvb_reported_length(tvb)-offset)/20; epl_el_tree = proto_tree_add_subtree_format(epl_tree, tvb, offset, -1, ett_epl_el, NULL, "ErrorCodeList: %d entries", number_of_entries); /*Dissect the whole Error List (display each entry)*/ for (cnt = 0; cnt 0) { offset = dissect_epl_sdo_command(epl_tree, tvb, pinfo, offset, seq_read); } else col_append_str(pinfo->cinfo, COL_INFO, "Empty CommandLayer"); } return offset; } static int dissect_epl_sdo_sequence(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t* seq) { uint8_t seq_recv = 0x00, seq_send = 0x00, rcon = 0x00, scon = 0x00; uint32_t frame = 0x00; proto_tree *sod_seq_tree; proto_item *item; uint8_t duplication = 0x00; void *key; uint32_t saved_frame; uint16_t seqnum = 0; /* read buffer */ seq_recv = tvb_get_uint8(tvb, offset); /* get rcon */ rcon = seq_recv & EPL_ASND_SDO_SEQ_CON_MASK; /* get seq_recv */ seq_recv = seq_recv >> EPL_ASND_SDO_SEQ_MASK; epl_segmentation.recv = seq_recv; /* read buffer */ seq_send = tvb_get_uint8(tvb, offset+1); /* get scon */ scon = seq_send & EPL_ASND_SDO_SEQ_CON_MASK; /* get seq_send */ seq_send = seq_send >> EPL_ASND_SDO_SEQ_MASK; epl_segmentation.send = seq_send; /* get the current frame-number */ frame = pinfo->num; /* Create a key */ key = epl_duplication_key(epl_segmentation.src,epl_segmentation.dest,seq_recv,seq_send); /* Get the saved data */ saved_frame = epl_duplication_get(epl_duplication_table, key); /* clear array at the start Sequence */ if((rcon < EPL_VALID && scon < EPL_VALID) ||(rcon == EPL_VALID && scon < EPL_VALID) ||(rcon < EPL_VALID && scon == EPL_VALID)) { /* remove all the keys of the specified src and dest address*/ epl_duplication_remove(epl_duplication_table,epl_segmentation.src,epl_segmentation.dest); /* There is no cmd layer */ epl_set_sequence_nr(pinfo, 0x02); } /* if cooked/fuzzed capture*/ else if(seq_recv >= EPL_MAX_SEQUENCE || seq_send >= EPL_MAX_SEQUENCE ||rcon > EPL_RETRANSMISSION || scon > EPL_RETRANSMISSION ) { if(seq_recv >= EPL_MAX_SEQUENCE) { expert_add_info(pinfo, epl_tree, &ei_recvseq_value); } if(seq_send >= EPL_MAX_SEQUENCE) { expert_add_info(pinfo, epl_tree, &ei_sendseq_value); } duplication = 0x00; epl_set_sequence_nr(pinfo, 0x00); } else { /* if retransmission request or connection valid with acknowledge request */ if((rcon == EPL_VALID && scon == EPL_RETRANSMISSION) || (rcon == EPL_RETRANSMISSION && scon == EPL_VALID)) { /* replace the saved frame with the new frame */ epl_duplication_insert(epl_duplication_table, key, frame); } /* if connection valid */ else { /* store the new frame in the hash table */ if(saved_frame == 0x00) { /* store the new frame in the hash table */ epl_duplication_insert(epl_duplication_table,key,frame); } /* if the frame is bigger than the stored frame + the max frame offset or the saved frame is bigger that the current frame then store the current frame */ else if(((frame > (saved_frame + EPL_MAX_FRAME_OFFSET)) ||(saved_frame > frame))) { /* store the new frame in the hash table */ epl_duplication_insert(epl_duplication_table,key,frame); } else if((frame < (saved_frame + EPL_MAX_FRAME_OFFSET)) &&(frame > saved_frame)) { duplication = 0x01; } } } /* if the frame is a duplicated frame */ seqnum = epl_get_sequence_nr(pinfo); if((duplication == 0x01 && seqnum == 0x00)||(seqnum == 0x01)) { seqnum = 0x01; epl_set_sequence_nr(pinfo, seqnum); expert_add_info_format(pinfo, epl_tree, &ei_duplicated_frame, "Duplication of Frame: %d ReceiveSequenceNumber: %d and SendSequenceNumber: %d ", saved_frame,seq_recv,seq_send ); } /* if the last frame in the ReceiveSequence is sent get new memory */ if(seq_recv == 0x3f && seq_send <= 0x3f) { /* reset all entries of the transfer */ epl_duplication_remove(epl_duplication_table,epl_segmentation.src,epl_segmentation.dest); } free_key(key); item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_seq, tvb, offset, 5, ENC_NA); sod_seq_tree = proto_item_add_subtree(item, ett_epl_sdo_sequence_layer); /* Asynchronous SDO Sequence Layer */ seq_recv = tvb_get_uint8(tvb, offset); proto_tree_add_uint(sod_seq_tree, hf_epl_asnd_sdo_seq_receive_sequence_number, tvb, offset, 1, seq_recv); proto_tree_add_uint(sod_seq_tree, hf_epl_asnd_sdo_seq_receive_con, tvb, offset, 1, seq_recv); offset += 1; *seq = seq_send = tvb_get_uint8(tvb, offset); proto_tree_add_uint(sod_seq_tree, hf_epl_asnd_sdo_seq_send_sequence_number, tvb, offset, 1, seq_send); proto_tree_add_uint(sod_seq_tree, hf_epl_asnd_sdo_seq_send_con, tvb, offset, 1, seq_send); offset += 3; col_append_fstr(pinfo->cinfo, COL_INFO, "Seq:%02d%s,%02d%s", seq_recv >> EPL_ASND_SDO_SEQ_MASK, val_to_str_const(seq_recv & EPL_ASND_SDO_SEQ_CON_MASK, epl_sdo_init_abbr_vals, "x"), seq_send >> EPL_ASND_SDO_SEQ_MASK, val_to_str_const(seq_send & EPL_ASND_SDO_SEQ_CON_MASK, epl_sdo_init_abbr_vals, "x")); seq_recv &= EPL_ASND_SDO_SEQ_CON_MASK; seq_send &= EPL_ASND_SDO_SEQ_CON_MASK; col_append_fstr(pinfo->cinfo, COL_INFO, "(%s) ", val_to_str_const((seq_recv << 8) | seq_send, epl_sdo_init_con_vals, "Invalid")); return offset; } static int dissect_epl_sdo_command(proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t seq) { int payload_length; uint8_t segmented, command_id, transaction_id; bool response, abort_flag; uint32_t abort_code = 0; uint32_t fragmentId = 0, remlength = 0; uint16_t segment_size = 0; proto_tree *sdo_cmd_tree = NULL; proto_item *item; uint8_t sendCon = 0; unsigned is_response = 0; offset += 1; sendCon = tvb_get_uint8(tvb, 5) & EPL_ASND_SDO_SEQ_SEND_CON_ERROR_VALID_ACK_REQ; command_id = tvb_get_uint8(tvb, offset + 2); abort_flag = tvb_get_uint8(tvb, offset + 1) & EPL_ASND_SDO_CMD_ABORT_FILTER; /* test if CommandField == empty */ if (command_id != 0 || abort_flag) { item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd, tvb, offset, 0, ENC_NA); sdo_cmd_tree = proto_item_add_subtree(item, ett_epl_sdo_command_layer); transaction_id = tvb_get_uint8(tvb, offset); response = tvb_get_uint8(tvb, offset + 1) & EPL_ASND_SDO_CMD_RESPONSE_FILTER; segmented = (tvb_get_uint8(tvb, offset + 1) & EPL_ASND_SDO_CMD_SEGMENTATION_FILTER) >> 4; segment_size = tvb_get_letohs(tvb, offset + 3); col_append_fstr(pinfo->cinfo, COL_INFO, "Cmd:%s,TID=%02d ", val_to_str(segmented, epl_sdo_asnd_cmd_segmentation_abbr, " Inv(%d)"), transaction_id); proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_transaction_id, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; proto_tree_add_item_ret_uint(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_response, tvb, offset, 1, ENC_LITTLE_ENDIAN, &is_response); proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_abort, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_segmentation, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_command_id, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; item = proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_segment_size, tvb, offset, 2, ENC_LITTLE_ENDIAN); offset += 4; if ( tvb_reported_length_remaining(tvb, offset) < segment_size ) expert_add_info_format(pinfo, item, &ei_real_length_differs, "Captured length differs, only %d octets will be displayed", tvb_reported_length_remaining(tvb, offset) - 4 ); if (segmented == EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER) { if((command_id == EPL_ASND_SDO_COMMAND_WRITE_BY_INDEX) || (command_id == EPL_ASND_SDO_COMMAND_READ_BY_INDEX)) { if (sendCon != EPL_ASND_SDO_SEQ_SEND_CON_ERROR_VALID_ACK_REQ) { /* if download => reset counter */ if(command_id == EPL_ASND_SDO_COMMAND_WRITE_BY_INDEX) ct = 0x00; /* if upload => reset counter */ else if(command_id == EPL_ASND_SDO_COMMAND_READ_BY_INDEX) count = 0x00; } /* payload length */ payload_length = tvb_reported_length_remaining(tvb, offset); /* create a key for reassembly => first 16 bit are src-address and last 16 bit are the dest-address */ fragmentId = (uint32_t)((((uint32_t)epl_segmentation.src)<<16)+epl_segmentation.dest); /* set fragmented flag */ pinfo->fragmented = true; fragment_add_seq_check(&epl_reassembly_table, tvb, offset, pinfo, fragmentId, NULL, 0, payload_length, true ); fragment_add_seq_offset ( &epl_reassembly_table, pinfo, fragmentId, NULL, 0 ); if (command_id == EPL_ASND_SDO_COMMAND_WRITE_BY_INDEX) { first_write = false; } else { first_read = false; } /* if Segmentation = Initiate then print DataSize */ proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_data_size, tvb, offset, 4, ENC_LITTLE_ENDIAN); segmented = true; offset += 4; } else { /* if Segmentation = Initiate then print DataSize */ proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_data_size, tvb, offset, 4, ENC_LITTLE_ENDIAN); segmented = true; offset += 4; } } if (abort_flag) { remlength = tvb_captured_length_remaining(tvb, offset); if (command_id == EPL_ASND_SDO_COMMAND_WRITE_MULTIPLE_PARAMETER_BY_INDEX && response) { /* the SDO response can contain several abort codes for multiple transfers */ while (remlength > 0) { /* TODO enhance Index and SubIndex with string representation */ proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_data_index, tvb, offset, 2, ENC_LITTLE_ENDIAN); offset += 2; proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; proto_tree_add_item(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_sub_abort, tvb, offset, 1, ENC_LITTLE_ENDIAN); offset += 1; abort_code = tvb_get_letohl(tvb, offset); /* if AbortBit is set then print AbortMessage */ proto_tree_add_uint(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_abort_code, tvb, offset, 4, abort_code); col_append_fstr(pinfo->cinfo, COL_INFO, "Abort:0x%08X (%s)", abort_code, val_to_str_ext_const(abort_code, &sdo_cmd_abort_code_ext, "Unknown")); offset += 4; remlength = tvb_captured_length_remaining(tvb, offset); } } else { abort_code = tvb_get_letohl(tvb, offset); /* if AbortBit is set then print AbortMessage */ proto_tree_add_uint(sdo_cmd_tree, hf_epl_asnd_sdo_cmd_abort_code, tvb, offset, 4, abort_code); col_append_fstr(pinfo->cinfo, COL_INFO, "Abort:0x%08X (%s)", abort_code, val_to_str_ext_const(abort_code, &sdo_cmd_abort_code_ext, "Unknown")); } } else { int opts = is_response ? CONVO_FOR_RESPONSE : CONVO_FOR_REQUEST; struct epl_convo *convo = epl_get_convo(pinfo, opts); convo->seq_send = seq; switch (command_id) { case EPL_ASND_SDO_COMMAND_WRITE_BY_INDEX: offset = dissect_epl_sdo_command_write_by_index(convo, sdo_cmd_tree, tvb, pinfo, offset, segmented, response, segment_size); break; case EPL_ASND_SDO_COMMAND_WRITE_MULTIPLE_PARAMETER_BY_INDEX: offset = dissect_epl_sdo_command_write_multiple_by_index(convo, sdo_cmd_tree, tvb, pinfo, offset, segmented, response, segment_size); break; case EPL_ASND_SDO_COMMAND_READ_MULTIPLE_PARAMETER_BY_INDEX: offset = dissect_epl_sdo_command_read_multiple_by_index(convo, sdo_cmd_tree, tvb, pinfo, offset, segmented, response, segment_size); break; case EPL_ASND_SDO_COMMAND_READ_BY_INDEX: offset = dissect_epl_sdo_command_read_by_index(convo, sdo_cmd_tree, tvb, pinfo, offset, segmented, response, segment_size); break; default: return false; } } } return offset; } static int dissect_epl_sdo_command_write_by_index(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t segmented, bool response, uint16_t segment_size) { int size, payload_length, rem_size = 0; uint16_t idx = 0x00, sod_index = 0xFF, error = 0xFF, sub_val = 0x00; bool nosub = false; uint8_t subindex = 0x00; uint32_t fragmentId = 0; uint32_t frame = 0; bool end_segment = false; proto_item *psf_item, *cmd_payload; proto_tree *payload_tree; const char *index_str, *sub_str, *sub_index_str; fragment_head *frag_msg = NULL; struct object *obj = NULL; const struct subobject *subobj = NULL; /* get the current frame number */ frame = pinfo->num; if (!response) { /* request */ if (segmented <= EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER) { /* get index offset */ idx = tvb_get_letohs(tvb, offset); /* add index item */ psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_index, tvb, offset, 2, ENC_LITTLE_ENDIAN); /* look up index in registered profile */ obj = object_lookup(convo->profile, idx); if (!obj) { /* value to string */ index_str = rval_to_str_const(idx, sod_cmd_str, "unknown"); /* get index string value */ sod_index = str_to_val(index_str, sod_cmd_str_val, error); /* get subindex string */ sub_index_str = val_to_str_ext_const(idx, &sod_cmd_no_sub, "unknown"); /* get subindex string value */ nosub = str_to_val(sub_index_str, sod_cmd_str_no_sub, 0xFF) != 0xFF; } offset += 2; /* get subindex offset */ subindex = tvb_get_uint8(tvb, offset); subobj = subobject_lookup(obj, subindex); /* get subindex string */ sub_str = val_to_str_ext_const(subindex, &sod_cmd_sub_str, "unknown"); /* get string value */ sub_val = str_to_val(sub_str, sod_cmd_sub_str_val, error); col_append_fstr(pinfo->cinfo, COL_INFO, "%s[%d]: (0x%04X/%d)", val_to_str_ext(EPL_ASND_SDO_COMMAND_WRITE_BY_INDEX, &epl_sdo_asnd_commands_short_ext, "Command(%02X)"), segment_size, idx, subindex); if (obj || sod_index == error) { const char *name = obj ? obj->info.name : val_to_str_ext_const(((uint32_t)(idx<<16)), &sod_index_names, "User Defined"); proto_item_append_text(psf_item, " (%s)", name); col_append_fstr(pinfo->cinfo, COL_INFO, " (%s", name); if (obj) nosub = obj->info.type_class == OD_ENTRY_SCALAR; } else /* string is in list */ { /* add index string to index item */ proto_item_append_text(psf_item," (%s", val_to_str_ext_const(((uint32_t)(sod_index<<16)), &sod_index_names, "User Defined")); proto_item_append_text(psf_item,"_%02Xh", (idx-sod_index)); if(sod_index == EPL_SOD_PDO_RX_MAPP || sod_index == EPL_SOD_PDO_TX_MAPP) { proto_item_append_text(psf_item,"_AU64)"); } else { proto_item_append_text(psf_item,"_REC)"); } /* info text */ col_append_fstr(pinfo->cinfo, COL_INFO, " (%s", val_to_str_ext_const(((uint32_t)(sod_index << 16)), &sod_index_names, "User Defined")); col_append_fstr(pinfo->cinfo, COL_INFO, "_%02Xh", (idx-sod_index)); if(sod_index == EPL_SOD_PDO_RX_MAPP || sod_index == EPL_SOD_PDO_TX_MAPP) { col_append_str(pinfo->cinfo, COL_INFO, "_AU64"); } else { col_append_str(pinfo->cinfo, COL_INFO, "_REC"); } idx = sod_index; } if(sub_val != error) idx = sub_val; if (subobj) { psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (%s)", subobj->info.name); col_append_fstr(pinfo->cinfo, COL_INFO, "/%s)", subobj->info.name); } /* if the subindex is a EPL_SOD_STORE_PARAM */ /* if the subindex is a EPL_SOD_RESTORE_PARAM */ else if((idx == EPL_SOD_STORE_PARAM && subindex <= 0x7F && subindex >= 0x04) || (idx == EPL_SOD_RESTORE_PARAM && subindex <= 0x7F && subindex >= 0x04)) { psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ManufacturerParam_%02Xh_U32)", subindex); col_append_fstr(pinfo->cinfo, COL_INFO, "/ManufacturerParam_%02Xh_U32)", subindex); } /* if the subindex is a EPL_SOD_PDO_RX_MAPP */ /* if the subindex is a EPL_SOD_PDO_TX_MAPP */ else if((idx == EPL_SOD_PDO_RX_MAPP && subindex >= 0x01 && subindex <= 0xfe) || (idx == EPL_SOD_PDO_TX_MAPP && subindex >= 0x01 && subindex <= 0xfe)) { psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ObjectMapping)"); col_append_str(pinfo->cinfo, COL_INFO, "/ObjectMapping)"); } /* no subindex */ else if(nosub) { col_append_str(pinfo->cinfo, COL_INFO, ")"); } else if(subindex == 0x00) { psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (NumberOfEntries)"); col_append_str(pinfo->cinfo, COL_INFO, "/NumberOfEntries)"); } else { psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, offset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (%s)", val_to_str_ext_const((subindex | (idx << 16)), &sod_index_names, "User Defined")); col_append_fstr(pinfo->cinfo, COL_INFO, "/%s)",val_to_str_ext_const((subindex | (idx << 16)), &sod_index_names, "User Defined")); } offset += 2; } /* Download */ else if((segmented == EPL_ASND_SDO_CMD_SEGMENTATION_TRANSFER_COMPLETE) || (segmented == EPL_ASND_SDO_CMD_SEGMENTATION_SEGMENT)) { /* get the fragmentId */ fragmentId = (uint32_t)((((uint32_t)epl_segmentation.src)<<16)+epl_segmentation.dest); /* set the fragmented flag */ pinfo->fragmented = true; /* get payload size */ payload_length = tvb_reported_length_remaining(tvb, offset); /* if the frame is the last frame */ if(segmented == EPL_ASND_SDO_CMD_SEGMENTATION_TRANSFER_COMPLETE) end_segment = true; /* if the send-sequence-number is at the end or the beginning of a sequence */ if(epl_segmentation.send == 0x3f || epl_segmentation.send <= 0x01 ) { /* reset memory */ memset(&epl_asnd_sdo_reassembly_write,0,sizeof(epl_sdo_reassembly)); /* save the current frame and increase the counter */ epl_asnd_sdo_reassembly_write.frame[epl_segmentation.recv][epl_segmentation.send] = frame; ct += 1; /* add the frame to reassembly_table */ frag_msg = fragment_add_seq_check(&epl_reassembly_table, tvb, offset, pinfo, fragmentId, NULL, ct, payload_length, end_segment ? false : true ); } else { if(epl_asnd_sdo_reassembly_write.frame[epl_segmentation.recv][epl_segmentation.send] == 0x00) { /* save the current frame and increase counter */ epl_asnd_sdo_reassembly_write.frame[epl_segmentation.recv][epl_segmentation.send] = frame; ct += 1; /* add the frame to reassembly_table */ if (first_write) { frag_msg = fragment_add_seq_check(&epl_reassembly_table, tvb, offset, pinfo, fragmentId, NULL, 0, payload_length, end_segment ? false : true ); fragment_add_seq_offset(&epl_reassembly_table, pinfo, fragmentId, NULL, ct); first_write = false; } else { frag_msg = fragment_add_seq_check(&epl_reassembly_table, tvb, offset, pinfo, fragmentId, NULL, ct, payload_length, end_segment ? false : true ); } } else { frag_msg = fragment_add_seq_check(&epl_reassembly_table, tvb, offset, pinfo, fragmentId, NULL, 0, payload_length, end_segment ? false : true); epl_asnd_sdo_reassembly_write.frame[epl_segmentation.recv][epl_segmentation.send] = frame; } } /* if the reassembly_table is not Null and the frame stored is the same as the current frame */ if(frag_msg != NULL && (epl_asnd_sdo_reassembly_write.frame[epl_segmentation.recv][epl_segmentation.send] == frame)) { /* if the frame is the last frame */ if(end_segment) { cmd_payload = proto_tree_add_uint_format(epl_tree, hf_epl_asnd_sdo_cmd_reassembled, tvb, offset, payload_length,0, "Reassembled: %d bytes total (%d bytes in this frame)",frag_msg->len,payload_length); payload_tree = proto_item_add_subtree(cmd_payload, ett_epl_asnd_sdo_data_reassembled); /* add the reassembly fields */ process_reassembled_data(tvb, 0, pinfo, "Reassembled Message", frag_msg, &epl_frag_items, NULL, payload_tree ); proto_tree_add_uint_format_value(payload_tree, hf_epl_asnd_sdo_cmd_reassembled, tvb, 0, 0, payload_length, "%d bytes (over all fragments)", frag_msg->len); col_append_str(pinfo->cinfo, COL_INFO, " (Message Reassembled)" ); } else { cmd_payload = proto_tree_add_uint_format(epl_tree, hf_epl_asnd_sdo_cmd_reassembled, tvb, offset, payload_length,0, "Reassembled: %d bytes total (%d bytes in this frame)",frag_msg->len,payload_length); payload_tree = proto_item_add_subtree(cmd_payload, ett_epl_asnd_sdo_data_reassembled); /* add reassemble field => Reassembled in: */ process_reassembled_data(tvb, 0, pinfo, "Reassembled Message", frag_msg, &epl_frag_items, NULL, payload_tree ); } ct = 0; } } /* determine remaining SDO payload size (depends on segment size of current command) */ size = tvb_reported_length_remaining(tvb, offset); if(size > (segment_size - 4)) { rem_size = (segment_size - 4); } else { rem_size = size; } /* if the frame is a PDO Mapping and the subindex is bigger than 0x00 */ if((idx == EPL_SOD_PDO_TX_MAPP && subindex > 0x00) || (idx == EPL_SOD_PDO_RX_MAPP && subindex > 0x00)) { wmem_array_t *mappings = NULL; if (use_sdo_mappings) mappings = idx == EPL_SOD_PDO_TX_MAPP ? convo->TPDO : convo->RPDO; offset = dissect_object_mapping(convo->profile, mappings, epl_tree, tvb, pinfo->num, offset, idx, subindex); } else { /* dissect the payload */ const struct epl_datatype *type = NULL; if (subobj) type = subobj->info.type; else if (obj) type = obj->info.type; offset = dissect_epl_payload(epl_tree, tvb, pinfo, offset, rem_size, type, EPL_ASND); } } else { /* response, no payload */ col_append_str(pinfo->cinfo, COL_INFO, "Response"); } return offset; } /* epl_tree may be null here, when this function is called from the profile parser */ static int dissect_object_mapping(struct profile *profile, wmem_array_t *mappings, proto_tree *epl_tree, tvbuff_t *tvb, uint32_t framenum, int offset, uint16_t idx, uint8_t subindex) { proto_item *ti_obj, *ti_subobj, *psf_item; proto_tree *psf_tree; struct object_mapping map = OBJECT_MAPPING_INITIALIZER; struct object *mapping_obj; int *ett; const struct subobject *mapping_subobj; bool nosub = false; /* If we don't populate the tree or record mappings, skip over it */ if (!epl_tree && !mappings) return offset + EPL_OBJECT_MAPPING_SIZE; map.param.idx = idx; map.param.subindex = subindex; map.frame.first = framenum; map.frame.last = UINT32_MAX; psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_mapping, tvb, offset, 1, ENC_NA); psf_tree = proto_item_add_subtree(psf_item, ett_epl_asnd_sdo_cmd_data_mapping); map.pdo.idx = tvb_get_letohs(tvb, offset); ti_obj = proto_tree_add_uint_format(psf_tree, hf_epl_asnd_sdo_cmd_data_mapping_index, tvb, offset, 2, map.pdo.idx,"Index: 0x%04X", map.pdo.idx); offset += 2; map.pdo.subindex = tvb_get_uint8(tvb, offset); ti_subobj = proto_tree_add_uint_format(psf_tree, hf_epl_asnd_sdo_cmd_data_mapping_subindex, tvb, offset, 1, map.pdo.subindex, "SubIndex: 0x%02X", map.pdo.subindex); offset += 2; /* look up index in registered profiles */ if ((mapping_obj = object_lookup(profile, map.pdo.idx))) { if (!map.pdo.subindex && mapping_obj->info.type_class == OD_ENTRY_SCALAR) nosub = true; map.info = &mapping_obj->info; map.index_name = map.info->name; proto_item_append_text (ti_obj, " (%s)", map.info->name); mapping_subobj = subobject_lookup(mapping_obj, map.pdo.subindex); if (mapping_subobj) { map.info = &mapping_subobj->info; proto_item_append_text (ti_subobj, " (%s)", map.info->name); } else { proto_item_set_hidden(ti_subobj); } } map.bit_offset = tvb_get_letohs(tvb, offset); proto_tree_add_uint_format(psf_tree, hf_epl_asnd_sdo_cmd_data_mapping_offset, tvb, offset, 2, map.bit_offset,"Offset: 0x%04X", map.bit_offset); offset += 2; map.no_of_bits = tvb_get_uint8(tvb, offset); psf_item = proto_tree_add_item(psf_tree, hf_epl_asnd_sdo_cmd_data_mapping_length, tvb, offset, 2, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " bits"); offset += 2; map.ett = -1; ett = &map.ett; /* We leak an ett entry every time we destruct a mapping * Not sure what to do about that */ proto_register_subtree_array(&ett, 1); if (mappings) { /* TODO One could think of a better string here? */ if (nosub) snprintf(map.title, sizeof(map.title), "PDO - %04X", map.pdo.idx); else snprintf(map.title, sizeof(map.title), "PDO - %04X:%02X", map.pdo.idx, map.pdo.subindex); add_object_mapping(mappings, &map); } return offset; } static int dissect_epl_sdo_command_write_multiple_by_index(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t segmented, bool response, uint16_t segment_size) { int dataoffset; uint8_t subindex = 0x00, padding = 0x00; uint16_t idx = 0x00, error = 0xFF, sub_val = 0x00; bool nosub = false; uint32_t size, offsetincrement, datalength, remlength, objectcnt, abort_code = 0; bool lastentry = false, is_abort = false; const char *index_str, *sub_str, *sub_index_str; proto_item *psf_item; proto_tree *psf_od_tree; struct object *obj = NULL; const struct subobject *subobj = NULL; uint16_t segment_restsize = segment_size; /* Offset is calculated simply by only applying EPL payload offset, not packet offset. * The packet offset is 16, as this is the number of bytes trailing the SDO payload. * EPL_SOA_EPLV_OFFSET has to be recognized, because the increment of PLK SDO payloads * is calculated, starting with the byte position AFTER the Sequence Layer. */ if (!response) { /* request */ col_append_fstr(pinfo->cinfo, COL_INFO, "%s[%d]:", val_to_str_ext(EPL_ASND_SDO_COMMAND_WRITE_MULTIPLE_PARAMETER_BY_INDEX, &epl_sdo_asnd_commands_short_ext, "Command(%02X)"), segment_size); remlength = (uint32_t)tvb_reported_length_remaining(tvb, offset); objectcnt = 0; /* As long as no lastentry has been detected, and we have still bytes left, * we start the loop. lastentry is probably not necessary anymore, since * we now use length_remaining, but it is kept to be on the safe side. */ while ( !lastentry && remlength > 0 ) { uint16_t sod_index = error; offsetincrement = tvb_get_letohl(tvb, offset); /* the data is aligned in 4-byte increments, therefore maximum padding is 3 */ padding = tvb_get_uint8 ( tvb, offset + 7 ) & 0x03; /* An offset increment of zero usually indicates, that we are at the end * of the payload. But we cannot ignore the end, because packages are * stacked up until the last byte */ if (offsetincrement == 0) { datalength = segment_restsize; lastentry = true; } else { datalength = offsetincrement - (offset - EPL_SOA_EPLV_OFFSET); } /* decrease restsize */ segment_restsize -= datalength; /* Possible unsigned overflow */ if ( datalength > remlength ) break; /* Each entry has a header size of 8, based on the following calculation: * - 4 byte for byte position of next data set * - 2 byte for index * - 1 byte for subindex * - 1 byte for reserved and padding */ /* Guarding against readout of padding. Probability is nearly zero, as * padding was checked above, but to be sure, this remains here */ if ((uint32_t)(padding + 8) >= datalength) break; /* size of data is datalength - ( entry header size and padding ) */ size = datalength - 8 - padding; dataoffset = offset + 4; /* add object subtree */ psf_od_tree = proto_tree_add_subtree(epl_tree, tvb, offset+4, 4+size, 0, NULL , "OD"); if (segmented <= EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER) { /* get SDO index value */ idx = tvb_get_letohs(tvb, dataoffset); /* add index item */ psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_index, tvb, offset+4, 2, ENC_LITTLE_ENDIAN); /* Check profile for name */ obj = object_lookup(convo->profile, idx); if (!obj) { /* value to string */ index_str = rval_to_str_const(idx, sod_cmd_str, "unknown"); /* get index string value */ sod_index = str_to_val(index_str, sod_cmd_str_val, error); /* get subindex string */ sub_index_str = val_to_str_ext_const(idx, &sod_cmd_no_sub, "unknown"); /* get subindex string value*/ nosub = str_to_val(sub_index_str, sod_cmd_str_no_sub, 0xFF) != 0xFF; } if(sod_index == error) { const char *name = obj ? obj->info.name :val_to_str_ext_const(((uint32_t)(idx<<16)), &sod_index_names, "User Defined"); proto_item_append_text(psf_item," (%s)", name); } else { /* add index string */ proto_item_append_text(psf_item," (%s", val_to_str_ext_const(((uint32_t)(sod_index<<16)), &sod_index_names, "User Defined")); proto_item_append_text(psf_item,"_%02Xh", (idx-sod_index)); if(sod_index == EPL_SOD_PDO_RX_MAPP || sod_index == EPL_SOD_PDO_TX_MAPP) { proto_item_append_text(psf_item,"_AU64)"); } else { proto_item_append_text(psf_item,"_REC)"); } } if (objectcnt < 8) col_append_fstr(pinfo->cinfo, COL_INFO, " (0x%04X", idx); else col_append_str(pinfo->cinfo, COL_INFO, "."); dataoffset += 2; proto_item_append_text(psf_od_tree, " Idx: 0x%04X", idx); if (sod_index != error) idx = sod_index; /* get subindex offset */ subindex = tvb_get_uint8(tvb, dataoffset); subobj = subobject_lookup(obj, subindex); proto_item_append_text(psf_od_tree, " SubIdx: 0x%02X", subindex); /* get subindex string */ sub_str = val_to_str_ext_const(idx, &sod_cmd_sub_str, "unknown"); /* get string value */ sub_val = str_to_val(sub_str, sod_cmd_sub_str_val,error); if(sub_val != error) idx = sub_val; if (subobj) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (%s)", subobj->info.name); } /* if the subindex is a EPL_SOD_STORE_PARAM */ else if(idx == EPL_SOD_STORE_PARAM && subindex <= 0x7F && subindex >= 0x04) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ManufacturerParam_%02Xh_U32)", subindex); } /* if the subindex is a EPL_SOD_RESTORE_PARAM */ else if(idx == EPL_SOD_RESTORE_PARAM && subindex <= 0x7F && subindex >= 0x04) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ManufacturerParam_%02Xh_U32)", subindex); } /* if the subindex is a EPL_SOD_PDO_RX_MAPP */ else if(idx == EPL_SOD_PDO_RX_MAPP && subindex >= 0x01 && subindex <= 0xfe) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ObjectMapping)"); } /* if the subindex is a EPL_SOD_PDO_TX_MAPP */ else if(idx == EPL_SOD_PDO_TX_MAPP && subindex >= 0x01 && subindex <= 0xfe) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ObjectMapping)"); } /* if the subindex has the value 0x00 */ else if(subindex == 0x00) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (NumberOfEntries)"); } /* subindex */ else { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (%s)", val_to_str_ext_const((subindex | (idx << 16)), &sod_index_names, "User Defined")); } /* info text */ if (objectcnt < 8) { if (nosub) /* no subindex */ col_append_str(pinfo->cinfo, COL_INFO, ")"); else col_append_fstr(pinfo->cinfo, COL_INFO, "/%d)", subindex); } dataoffset += 1; proto_tree_add_uint(psf_od_tree, hf_epl_asnd_sdo_cmd_data_padding, tvb, dataoffset, 1, padding); dataoffset += 1; objectcnt++; } /* size of embedded data */ psf_item = proto_tree_add_uint_format(psf_od_tree, hf_epl_asnd_sdo_cmd_data_size, tvb, dataoffset, size, size, "Data size: %d byte", size); proto_item_set_generated(psf_item); /* if the frame is a PDO Mapping and the subindex is bigger than 0x00 */ if((idx == EPL_SOD_PDO_TX_MAPP && subindex > 0x00) ||(idx == EPL_SOD_PDO_RX_MAPP && subindex > 0x00)) { wmem_array_t *mappings = NULL; if (use_sdo_mappings) mappings = idx == EPL_SOD_PDO_TX_MAPP ? convo->TPDO : convo->RPDO; dissect_object_mapping(convo->profile, mappings, psf_od_tree, tvb, pinfo->num, dataoffset, idx, subindex); } else /* dissect the payload */ { const struct epl_datatype *type = NULL; if (subobj) type = subobj->info.type; else if (obj) type = obj->info.type; dissect_epl_payload(psf_od_tree, tvb, pinfo, dataoffset, size, type, EPL_ASND); } offset += datalength; /* calculating the remaining length, based on the current offset */ remlength = (uint32_t)tvb_reported_length_remaining(tvb, offset); } col_append_fstr(pinfo->cinfo, COL_INFO, " (%d)", objectcnt); } else { col_append_fstr(pinfo->cinfo, COL_INFO, "Response %s[%d]:", val_to_str_ext(EPL_ASND_SDO_COMMAND_WRITE_MULTIPLE_PARAMETER_BY_INDEX, &epl_sdo_asnd_commands_short_ext, "Command(%02X)"), segment_size); remlength = (uint32_t)tvb_reported_length_remaining(tvb, offset); objectcnt = 0; dataoffset = offset; /* As long as no lastentry has been detected, and we have still bytes left, * we start the loop. */ while ( remlength > 0 ) { uint16_t sod_index; if ((tvb_get_uint8 ( tvb, offset + 3 ) & 0x80) == 0x80) is_abort = true; /* add object subtree */ psf_od_tree = proto_tree_add_subtree(epl_tree, tvb, offset, 8, 0, NULL , "OD"); if (segmented <= EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER) { /* get SDO index value */ idx = tvb_get_letohs(tvb, dataoffset); /* value to string */ index_str = rval_to_str_const(idx, sod_cmd_str, "unknown"); /* get index string value */ sod_index = str_to_val(index_str, sod_cmd_str_val, error); /* get subindex string */ sub_index_str = val_to_str_ext_const(idx, &sod_cmd_no_sub, "unknown"); /* get subindex string value*/ nosub = str_to_val(sub_index_str, sod_cmd_str_no_sub,error); if (objectcnt < 8) col_append_fstr(pinfo->cinfo, COL_INFO, " (0x%04X", idx); else col_append_str(pinfo->cinfo, COL_INFO, "."); proto_tree_add_uint_format(psf_od_tree, hf_epl_asnd_sdo_cmd_data_mapping_index, tvb, dataoffset, 2, idx,"Index: 0x%04X", idx); proto_item_append_text(psf_od_tree, " Idx: 0x%04X", idx); if (sod_index != error) idx = sod_index; dataoffset += 2; /* get subindex offset */ subindex = tvb_get_uint8(tvb, dataoffset); proto_item_append_text(psf_od_tree, " SubIdx: 0x%02X", subindex); proto_tree_add_uint_format(psf_od_tree, hf_epl_asnd_sdo_cmd_data_mapping_subindex, tvb, dataoffset, 1, idx,"SubIndex: 0x%02X", subindex); /* info text */ if (objectcnt < 8) { if (nosub) /* no subindex */ col_append_str(pinfo->cinfo, COL_INFO, ")"); else col_append_fstr(pinfo->cinfo, COL_INFO, "/%d)", subindex); } dataoffset += 1; proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_sub_abort, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); dataoffset += 1; if (is_abort) { abort_code = tvb_get_letohl(tvb, dataoffset); proto_item_append_text(psf_od_tree, " - %s", "Aborted"); psf_item = proto_tree_add_item(psf_od_tree, hf_epl_sdo_multi_param_sub_abort, tvb, dataoffset, 4, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item," (%s)", val_to_str_ext_const(abort_code, &sdo_cmd_abort_code_ext, "Unknown")); is_abort = false; } objectcnt++; } /* each sub response is 8 bytes */ offset += 8; /* calculating the remaining length, based on the current offset */ remlength = (uint32_t)tvb_reported_length_remaining(tvb, offset); } col_append_fstr(pinfo->cinfo, COL_INFO, " (%d)", objectcnt); } return offset; } static int dissect_epl_sdo_command_read_multiple_by_index(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t segmented, bool response, uint16_t segment_size) { int dataoffset; uint8_t subindex = 0x00, padding = 0x00; uint16_t idx = 0x00, error = 0xFF, sub_val = 0x00; bool nosub = false; uint32_t size, offsetincrement, datalength, remlength, objectcnt, abort_code; bool lastentry = false, is_abort = false; const char *index_str, *sub_str, *sub_index_str; proto_item *psf_item, *psf_od_item; proto_tree *psf_tree, *psf_od_tree; struct object *obj = NULL; const struct subobject *subobj = NULL; const char *name; uint16_t segment_restsize = segment_size; /* Offset is calculated simply by only applying EPL payload offset, not packet offset. * The packet offset is 16, as this is the number of bytes trailing the SDO payload. * EPL_SOA_EPLV_OFFSET has to be recognized, because the increment of PLK SDO payloads * is calculated, starting with the byte position AFTER the Sequence Layer. */ if (response) { col_append_fstr(pinfo->cinfo, COL_INFO, "%s[%d]:", val_to_str_ext(EPL_ASND_SDO_COMMAND_READ_MULTIPLE_PARAMETER_BY_INDEX, &epl_sdo_asnd_commands_short_ext, "Command(%02X)"), segment_size); remlength = (uint32_t)tvb_reported_length_remaining(tvb, offset); objectcnt = 0; /* As long as no lastentry has been detected, and we have still bytes left, * we start the loop. lastentry is probably not necessary anymore, since * we now use length_remaining, but it is kept to be on the safe side. */ while ( !lastentry && remlength > 0 ) { uint16_t sod_index = error; offsetincrement = tvb_get_letohl(tvb, offset); /* the data is aligned in 4-byte increments, therefor maximum padding is 3 */ padding = tvb_get_uint8 ( tvb, offset + 7 ) & 0x03; if ((tvb_get_uint8 ( tvb, offset + 7 ) & 0x80) == 0x80) is_abort = true; /* An offset increment of zero usually indicates, that we are at the end * of the payload. But we cannot ignore the end, because packages are * stacked up until the last byte */ if (offsetincrement == 0) { datalength = segment_restsize; lastentry = true; } else { datalength = offsetincrement - (offset - EPL_SOA_EPLV_OFFSET); } /* decrease restsize */ segment_restsize -= datalength; /* Possible unsigned overflow */ if (datalength > remlength) break; /* Each entry has a header size of 8, based on the following calculation: * - 4 byte for byte position of next data set * - 2 byte for index * - 1 byte for subindex * - 1 byte for reserved and padding */ /* Guarding against readout of padding. Probability is nearly zero, as * padding was checked above, but to be sure, this remains here */ if ((uint32_t)(padding + 8) >= datalength) break; /* size of data is datalength - ( entry header size and padding ) */ size = datalength - 8 - padding; dataoffset = offset + 4; /* add object subtree */ psf_od_tree = proto_tree_add_subtree(epl_tree, tvb, offset+4, 4+size, 0, NULL , "OD"); if (segmented <= EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER) { /* get SDO index value */ idx = tvb_get_letohs(tvb, dataoffset); obj = object_lookup(convo->profile, idx); if (!obj) { /* value to string */ index_str = rval_to_str_const(idx, sod_cmd_str, "unknown"); /* get index string value */ sod_index = str_to_val(index_str, sod_cmd_str_val, error); /* get subindex string */ sub_index_str = val_to_str_ext_const(idx, &sod_cmd_no_sub, "unknown"); /* get subindex string value*/ nosub = str_to_val(sub_index_str, sod_cmd_str_no_sub, 0xFF) != 0xFF; } /* add index item */ psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_index, tvb, offset+4, 2, ENC_LITTLE_ENDIAN); if(obj) { proto_item_append_text(psf_item, " (%s)", obj->info.name); nosub = obj->info.type_class == OD_ENTRY_SCALAR; } else if(sod_index == error) { proto_item_append_text(psf_item," (%s)", val_to_str_ext_const(((uint32_t)(idx<<16)), &sod_index_names, "User Defined")); } else { /* add index string */ proto_item_append_text(psf_item," (%s", val_to_str_ext_const(((uint32_t)(sod_index<<16)), &sod_index_names, "User Defined")); proto_item_append_text(psf_item,"_%02Xh", (idx-sod_index)); if(sod_index == EPL_SOD_PDO_RX_MAPP || sod_index == EPL_SOD_PDO_TX_MAPP) { proto_item_append_text(psf_item,"_AU64)"); } else { proto_item_append_text(psf_item,"_REC)"); } } if (objectcnt < 8) col_append_fstr(pinfo->cinfo, COL_INFO, " (0x%04X", idx); else col_append_str(pinfo->cinfo, COL_INFO, "."); if (sod_index != error) idx = sod_index; proto_item_append_text(psf_od_tree, " Idx: 0x%04X", idx); dataoffset += 2; /* get subindex offset */ subindex = tvb_get_uint8(tvb, dataoffset); subobj = subobject_lookup(obj, subindex); proto_item_append_text(psf_od_tree, " SubIdx: 0x%02X", subindex); /* get subindex string */ sub_str = val_to_str_ext_const(idx, &sod_cmd_sub_str, "unknown"); /* get string value */ sub_val = str_to_val(sub_str, sod_cmd_sub_str_val,error); if(sub_val != error) idx = sub_val; if (subobj) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (%s)", subobj->info.name); } /* if the subindex is a EPL_SOD_STORE_PARAM */ else if(idx == EPL_SOD_STORE_PARAM && subindex <= 0x7F && subindex >= 0x04) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ManufacturerParam_%02Xh_U32)", subindex); } /* if the subindex is a EPL_SOD_RESTORE_PARAM */ else if(idx == EPL_SOD_RESTORE_PARAM && subindex <= 0x7F && subindex >= 0x04) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ManufacturerParam_%02Xh_U32)", subindex); } /* if the subindex is a EPL_SOD_PDO_RX_MAPP */ else if(idx == EPL_SOD_PDO_RX_MAPP && subindex >= 0x01 && subindex <= 0xfe) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ObjectMapping)"); } /* if the subindex is a EPL_SOD_PDO_TX_MAPP */ else if(idx == EPL_SOD_PDO_TX_MAPP && subindex >= 0x01 && subindex <= 0xfe) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (ObjectMapping)"); } else if(subindex == 0x00) { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (NumberOfEntries)"); } /* subindex */ else { psf_item = proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, dataoffset, 1, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item, " (%s)", val_to_str_ext_const((subindex | (idx << 16)), &sod_index_names, "User Defined")); } /* info text */ if (objectcnt < 8) { if (nosub) /* no subindex */ col_append_str(pinfo->cinfo, COL_INFO, ")"); else col_append_fstr(pinfo->cinfo, COL_INFO, "/%d)", subindex); } dataoffset += 1; proto_tree_add_uint(psf_od_tree, hf_epl_asnd_sdo_cmd_data_padding, tvb, dataoffset, 1, padding); dataoffset += 1; objectcnt++; } if (is_abort) { proto_tree_add_item(psf_od_tree, hf_epl_asnd_sdo_cmd_sub_abort, tvb, dataoffset - 1, 1, ENC_LITTLE_ENDIAN); abort_code = tvb_get_letohl(tvb, dataoffset); proto_item_append_text(psf_od_tree, " - %s", "Aborted"); psf_item = proto_tree_add_item(psf_od_tree, hf_epl_sdo_multi_param_sub_abort, tvb, dataoffset, 4, ENC_LITTLE_ENDIAN); proto_item_append_text(psf_item," (%s)", val_to_str_ext_const(abort_code, &sdo_cmd_abort_code_ext, "Unknown")); is_abort = false; } else { /* if the frame is a PDO Mapping and the subindex is bigger than 0x00 */ if((idx == EPL_SOD_PDO_TX_MAPP && subindex > 0x00) ||(idx == EPL_SOD_PDO_RX_MAPP && subindex > 0x00)) { psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_mapping, tvb, dataoffset, 1, ENC_NA); psf_tree = proto_item_add_subtree(psf_item, ett_epl_asnd_sdo_cmd_data_mapping); idx = tvb_get_letohs(tvb, dataoffset); proto_tree_add_uint_format(psf_tree, hf_epl_asnd_sdo_cmd_data_mapping_index, tvb, dataoffset, 2, idx,"Index: 0x%04X", idx); dataoffset += 2; idx = tvb_get_letohs(tvb, dataoffset); proto_tree_add_uint_format(psf_tree, hf_epl_asnd_sdo_cmd_data_mapping_subindex, tvb, dataoffset, 1, idx,"SubIndex: 0x%02X", idx); dataoffset += 2; idx = tvb_get_letohs(tvb, dataoffset); proto_tree_add_uint_format(psf_tree, hf_epl_asnd_sdo_cmd_data_mapping_offset, tvb, dataoffset, 2, idx,"Offset: 0x%04X", idx); dataoffset += 2; proto_tree_add_item(psf_tree, hf_epl_asnd_sdo_cmd_data_mapping_length, tvb, dataoffset, 2, ENC_LITTLE_ENDIAN); } else { /* dissect the payload */ const struct epl_datatype *type = NULL; if (subobj) type = subobj->info.type; else if (obj) type = obj->info.type; dissect_epl_payload ( psf_od_tree, tvb, pinfo, dataoffset, size, type, EPL_ASND); } } offset += datalength; /* calculating the remaining length, based on the current offset */ remlength = (uint32_t)tvb_reported_length_remaining(tvb, offset); } col_append_fstr(pinfo->cinfo, COL_INFO, " (%d)", objectcnt); } else { col_append_fstr(pinfo->cinfo, COL_INFO, "Request %s[%d]:", val_to_str_ext(EPL_ASND_SDO_COMMAND_READ_MULTIPLE_PARAMETER_BY_INDEX, &epl_sdo_asnd_commands_short_ext, "Command(%02X)"), segment_size); remlength = (uint32_t)tvb_reported_length_remaining(tvb, offset); objectcnt = 0; dataoffset = offset; /* As long as no lastentry has been detected, and we have still bytes left, * we start the loop. */ while ( remlength > 0 ) { uint16_t sod_index = error; proto_tree *psf_entry; /* add object subtree */ psf_od_item = proto_tree_add_subtree(epl_tree, tvb, offset, 4, 0, NULL, "OD"); if (segmented <= EPL_ASND_SDO_CMD_SEGMENTATION_INITIATE_TRANSFER) { /* get SDO index value */ idx = tvb_get_letohs(tvb, dataoffset); obj = object_lookup(convo->profile, idx); if (!obj) { /* value to string */ index_str = rval_to_str_const(idx, sod_cmd_str, "unknown"); /* get index string value */ sod_index = str_to_val(index_str, sod_cmd_str_val, error); /* get subindex string */ sub_index_str = val_to_str_ext_const(idx, &sod_cmd_no_sub, "unknown"); /* get subindex string value*/ nosub = str_to_val(sub_index_str, sod_cmd_str_no_sub,0xFF) != 0xFF; } if (objectcnt < 8) col_append_fstr(pinfo->cinfo, COL_INFO, " (0x%04X", idx); else col_append_str(pinfo->cinfo, COL_INFO, "."); if (sod_index != error) idx = sod_index; proto_item_append_text(psf_od_item, " Idx: 0x%04X", idx); psf_entry = proto_tree_add_uint_format(psf_od_item, hf_epl_asnd_sdo_cmd_data_mapping_index, tvb, dataoffset, 2, idx,"Index: 0x%04X", idx); if(obj) { proto_item_append_text(psf_entry, " (%s)", obj->info.name); nosub = obj->info.type_class == OD_ENTRY_SCALAR; } else if(sod_index == error) { name = val_to_str_ext_const(((uint32_t)(idx<<16)), &sod_index_names, "User Defined"); proto_item_append_text(psf_entry," (%s)", name); } else { /* add index string */ proto_item_append_text(psf_entry," (%s", val_to_str_ext_const(((uint32_t)(sod_index<<16)), &sod_index_names, "User Defined")); proto_item_append_text(psf_entry,"_%02Xh", (idx-sod_index)); if(sod_index == EPL_SOD_PDO_RX_MAPP || sod_index == EPL_SOD_PDO_TX_MAPP) { proto_item_append_text(psf_entry,"_AU64)"); } else { proto_item_append_text(psf_entry,"_REC)"); } } dataoffset += 2; /* get subindex offset */ subindex = tvb_get_uint8(tvb, dataoffset); proto_item_append_text(psf_od_item, " SubIdx: 0x%02X", subindex); psf_item = proto_tree_add_uint_format(psf_od_item, hf_epl_asnd_sdo_cmd_data_mapping_subindex, tvb, dataoffset, 1, subindex,"SubIndex: 0x%02X", subindex); subobj = subobject_lookup(obj, subindex); name = subobj ? subobj->info.name : val_to_str_ext_const((subindex|(idx<<16)), &sod_index_names, "User Defined"); proto_item_append_text(psf_item, " (%s)", name); /* info text */ if (objectcnt < 8) { if (nosub) /* no subindex */ col_append_str(pinfo->cinfo, COL_INFO, ")"); else col_append_fstr(pinfo->cinfo, COL_INFO, "/%d)", subindex); } dataoffset += 2; objectcnt++; } /* each sub request is 4 bytes */ offset += 4; /* calculating the remaining length, based on the current offset */ remlength = (uint32_t)tvb_reported_length_remaining(tvb, offset); } col_append_fstr(pinfo->cinfo, COL_INFO, " (%d)", objectcnt); } return offset; } static int dissect_epl_sdo_command_read_by_index(struct epl_convo *convo, proto_tree *epl_tree, tvbuff_t *tvb, packet_info *pinfo, int offset, uint8_t segmented, bool response, uint16_t segment_size) { int size, payload_length, rem_size = 0; uint16_t idx = 0x00; uint8_t subindex = 0x00; uint32_t fragmentId, frame; proto_item *psf_item, *cmd_payload; proto_tree *payload_tree; bool end_segment = false; fragment_head *frag_msg = NULL; struct object *obj = NULL; const struct subobject *subobj = NULL; struct read_req *req; const struct epl_datatype *type = NULL; /* get the current frame number */ frame = pinfo->num; if (!response) { /* request */ const char *name; idx = tvb_get_letohs(tvb, offset); psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_index, tvb, offset, 2, ENC_LITTLE_ENDIAN); obj = object_lookup(convo->profile, idx); name = obj ? obj->info.name : val_to_str_ext_const(((uint32_t)(idx<<16)), &sod_index_names, "User Defined"); proto_item_append_text(psf_item," (%s)", name); offset += 2; subindex = tvb_get_uint8(tvb, offset); psf_item = proto_tree_add_item(epl_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, offset, 1, ENC_LITTLE_ENDIAN); subobj = subobject_lookup(obj, subindex); name = subobj ? subobj->info.name : val_to_str_ext_const((subindex|(idx<<16)), &sod_index_names, "User Defined"); proto_item_append_text(psf_item, " (%s)", name); offset += 1; col_append_fstr(pinfo->cinfo, COL_INFO, "%s[%d]: (0x%04X/%d)", val_to_str_ext(EPL_ASND_SDO_COMMAND_READ_BY_INDEX, &epl_sdo_asnd_commands_short_ext, "Command(%02X)"), segment_size, idx, subindex); col_append_fstr(pinfo->cinfo, COL_INFO, " (%s", val_to_str_ext_const(((uint32_t) (idx << 16)), &sod_index_names, "User Defined")); col_append_fstr(pinfo->cinfo, COL_INFO, "/%s)",val_to_str_ext_const((subindex|(idx<<16)), &sod_index_names, "User Defined")); /* Cache object for read in next response */ req = convo_read_req_set(convo, convo->seq_send); req->idx = idx; req->subindex = subindex; if (obj) { req->info = subobj ? &subobj->info : &obj->info; req->index_name = obj->info.name; } else { req->info = NULL; req->index_name = NULL; } } else { /* upload and no response */ if(segmented > 0x01 && segment_size != 0) { /* get the fragmentId */ fragmentId = (uint32_t)((((uint32_t)epl_segmentation.src)<<16)+epl_segmentation.dest); /* set the fragmented flag */ pinfo->fragmented = true; /* get payload size */ payload_length = tvb_reported_length_remaining(tvb, offset); /* if the frame is the last frame */ if(segmented == EPL_ASND_SDO_CMD_SEGMENTATION_TRANSFER_COMPLETE) end_segment = true; if(epl_asnd_sdo_reassembly_read.frame[epl_segmentation.recv][epl_segmentation.send] == 0x00 || epl_asnd_sdo_reassembly_read.frame[epl_segmentation.recv][epl_segmentation.send] == frame) { if (epl_asnd_sdo_reassembly_read.frame[epl_segmentation.recv][epl_segmentation.send] == 0x00) count += 1; /* store the current frame and increase the counter */ epl_asnd_sdo_reassembly_read.frame[epl_segmentation.recv][epl_segmentation.send] = frame; /* add the frame to reassembly_table */ if (first_read) { frag_msg = fragment_add_seq_check(&epl_reassembly_table, tvb, offset, pinfo, fragmentId, NULL, 0, payload_length, end_segment ? false : true ); fragment_add_seq_offset(&epl_reassembly_table, pinfo, fragmentId, NULL, count); first_read = false; } else { frag_msg = fragment_add_seq_check(&epl_reassembly_table, tvb, offset, pinfo, fragmentId, NULL, count, payload_length, end_segment ? false : true ); } } /* if the reassembly_table is not Null and the frame stored is the same as the current frame */ if(frag_msg != NULL && (epl_asnd_sdo_reassembly_read.frame[epl_segmentation.recv][epl_segmentation.send] == frame)) { if(end_segment || payload_length > 0) { cmd_payload = proto_tree_add_uint_format(epl_tree, hf_epl_asnd_sdo_cmd_reassembled, tvb, offset, payload_length,0, "Reassembled: %d bytes total (%d bytes in this frame)",frag_msg->len,payload_length); payload_tree = proto_item_add_subtree(cmd_payload, ett_epl_asnd_sdo_data_reassembled); /* add the reassembly fields */ process_reassembled_data(tvb, 0, pinfo, "Reassembled Message", frag_msg, &epl_frag_items, NULL, payload_tree ); proto_tree_add_uint_format_value(payload_tree, hf_epl_asnd_sdo_cmd_reassembled, tvb, 0, 0, payload_length, "%d bytes (over all fragments)", frag_msg->len); if (frag_msg->reassembled_in == frame) col_append_str(pinfo->cinfo, COL_INFO, " (Message Reassembled)" ); /* reset memory */ memset(&epl_asnd_sdo_reassembly_read.frame[epl_segmentation.recv], 0, sizeof(uint32_t) * EPL_MAX_SEQUENCE); } else { cmd_payload = proto_tree_add_uint_format(epl_tree, hf_epl_asnd_sdo_cmd_reassembled, tvb, offset, payload_length,0, "Reassembled: %d bytes total (%d bytes in this frame)",frag_msg->len,payload_length); payload_tree = proto_item_add_subtree(cmd_payload, ett_epl_asnd_sdo_data_reassembled); /* add reassemble field => Reassembled in: */ process_reassembled_data(tvb, 0, pinfo, "Reassembled Message", frag_msg, &epl_frag_items, NULL, payload_tree ); } count = 0; } } /* response */ col_append_str(pinfo->cinfo, COL_INFO, "Response"); size = tvb_reported_length_remaining(tvb, offset); /* Did we register the read req? */ if ((req = convo_read_req_get(convo, pinfo, convo->seq_send))) { proto_item *ti; ti = proto_tree_add_uint_format_value(epl_tree, hf_epl_asnd_sdo_cmd_data_index, tvb, 0, 0, req->idx, "%04X", req->idx); proto_item_set_generated(ti); if (req->info) { proto_item_append_text (ti, " (%s)", req->index_name); type = req->info->type; } ti = proto_tree_add_uint_format_value(epl_tree, hf_epl_asnd_sdo_cmd_data_subindex, tvb, 0, 0, req->subindex, "%02X", req->subindex); proto_item_set_generated(ti); if (req->info && req->info->name != req->index_name) proto_item_append_text (ti, " (%s)", req->info->name); } /* determine remaining SDO payload size (depends on segment size of current command) */ if (size > segment_size) { rem_size = segment_size; } else { rem_size = size; } offset = dissect_epl_payload(epl_tree, tvb, pinfo, offset, rem_size, type, EPL_ASND); } return offset; } static struct profile *profile_load(wmem_allocator_t *allocator, const char *path) { struct profile *profile = NULL; char *err; if (!epl_profile_uat_fld_fileopen_check_cb(NULL, path, (unsigned)strlen(path), NULL, NULL, &err)) { report_failure("%s", err); g_free(err); return NULL; } if (g_str_has_suffix(path, ".eds")) { profile = profile_new(allocator); if (!epl_eds_load(profile, path)) profile_del(profile); } #if HAVE_LIBXML2 else if (g_str_has_suffix(path, ".xdd") || g_str_has_suffix(path, ".xdc")) { profile = profile_new(allocator); if (!epl_xdd_load(profile, path)) profile_del(profile); } #endif if (!profile) report_failure("Profile '%s' couldn't be parsed", path); return profile; } static void apply_prefs(void) { /* This gets called for all preferences, so we only load profile if path changes */ if (epl_default_profile_path != epl_default_profile_path_last && epl_default_profile_path && *epl_default_profile_path) { profile_del(epl_default_profile); epl_default_profile = profile_load(wmem_epan_scope(), epl_default_profile_path); epl_default_profile_path_last = epl_default_profile_path; /* TODO we could use something like UAT_AFFECTS_DISSECTION */ } } /* Register the protocol with Wireshark */ void proto_register_epl(void) { static hf_register_info hf[] = { /* Common data fields (same for all message types) */ { &hf_epl_mtyp, { "MessageType", "epl.mtyp", FT_UINT8, BASE_DEC, VALS(mtyp_vals), 0x7F, NULL, HFILL } }, { &hf_epl_node, { "Node", "epl.node", FT_UINT8, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_dest, { "Destination", "epl.dest", FT_UINT8, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_src, { "Source", "epl.src", FT_UINT8, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_payload_real, { "Captured Size", "epl.payload.capture_size", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, /* hotfields for all available EPL message types (depends on EPL MessageType) */ { &hf_epl_soc, { "SoC", "epl.soc", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_preq, { "PReq", "epl.preq", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_pres, { "PRes", "epl.pres", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa, { "SoA", "epl.soa", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd, { "ASnd", "epl.asnd", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_amni, { "AMNI", "epl.amni", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_ainv, { "AInv", "epl.ainv", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, /* SoC data fields*/ { &hf_epl_soc_flags, { "Flags", "epl.soc.flags", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_epl_soc_mc, { "MC (Multiplexed Cycle Completed)", "epl.soc.mc", FT_BOOLEAN, 8, NULL, EPL_SOC_MC_MASK, NULL, HFILL } }, { &hf_epl_soc_ps, { "PS (Prescaled Slot)", "epl.soc.ps", FT_BOOLEAN, 8, NULL, EPL_SOC_PS_MASK, NULL, HFILL } }, { &hf_epl_soc_dna_an, { "AN (Global)", "epl.soc.an", FT_BOOLEAN, 8, NULL, EPL_SOC_AN_MASK, NULL, HFILL } }, { &hf_epl_soc_nettime, { "NetTime", "epl.soc.nettime", FT_ABSOLUTE_TIME, ABSOLUTE_TIME_LOCAL, NULL, 0x0, NULL, HFILL } }, { &hf_epl_soc_relativetime, { "RelativeTime", "epl.soc.relativetime", FT_UINT64, BASE_DEC, NULL, 0x0, NULL, HFILL } }, /* PReq data fields*/ { &hf_epl_preq_flags, { "Flags", "epl.preq.flags", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_epl_preq_ms, { "MS (Multiplexed Slot)", "epl.preq.ms", FT_BOOLEAN, 8, NULL, 0x20, NULL, HFILL } }, { &hf_epl_preq_ea, { "EA (Exception Acknowledge)", "epl.preq.ea", FT_BOOLEAN, 8, NULL, EPL_PDO_EA_MASK, NULL, HFILL } }, { &hf_epl_preq_rd, { "RD (Ready)", "epl.preq.rd", FT_BOOLEAN, 8, NULL, EPL_PDO_RD_MASK, NULL, HFILL } }, { &hf_epl_preq_sls, { "SLS (Second Link Status)", "epl.preq.sls", FT_BOOLEAN, 8, NULL, EPL_PDO_SLS_MASK, NULL, HFILL } }, { &hf_epl_preq_fls, { "FLS (First Link Status)", "epl.preq.fls", FT_BOOLEAN, 8, NULL, EPL_PDO_FLS_MASK, NULL, HFILL } }, { &hf_epl_preq_pdov, { "PDOVersion", "epl.preq.pdov", FT_UINT8, BASE_CUSTOM, CF_FUNC(elp_version), 0x00, NULL, HFILL } }, { &hf_epl_preq_size, { "Size", "epl.preq.size", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, /* PRes data fields*/ { &hf_epl_pres_stat_ms, { "NMTStatus", "epl.pres.stat", FT_UINT8, BASE_HEX, VALS(epl_nmt_ms_vals), 0x00, NULL, HFILL } }, { &hf_epl_pres_stat_cs, { "NMTStatus", "epl.pres.stat", FT_UINT8, BASE_HEX, VALS(epl_nmt_cs_vals), 0x00, NULL, HFILL } }, { &hf_epl_pres_flags, { "Flags", "epl.pres.flags", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_epl_pres_ms, { "MS (Multiplexed Slot)", "epl.pres.ms", FT_BOOLEAN, 8, NULL, 0x20, NULL, HFILL } }, { &hf_epl_pres_en, { "EN (Exception New)", "epl.pres.en", FT_BOOLEAN, 8, NULL, EPL_PDO_EN_MASK, NULL, HFILL } }, { &hf_epl_pres_rd, { "RD (Ready)", "epl.pres.rd", FT_BOOLEAN, 8, NULL, EPL_PDO_RD_MASK, NULL, HFILL } }, { &hf_epl_pres_pr, { "PR (Priority)", "epl.pres.pr", FT_UINT8, BASE_DEC, VALS(epl_pr_vals), 0x38, NULL, HFILL } }, { &hf_epl_pres_rs, { "RS (RequestToSend)", "epl.pres.rs", FT_UINT8, BASE_DEC, NULL, EPL_PDO_RS_MASK, NULL, HFILL } }, { &hf_epl_pres_sls, { "SLS (Second Link Status)", "epl.pres.sls", FT_BOOLEAN, 8, NULL, EPL_PDO_SLS_MASK, NULL, HFILL } }, { &hf_epl_pres_fls, { "FLS (First Link Status)", "epl.pres.fls", FT_BOOLEAN, 8, NULL, EPL_PDO_FLS_MASK, NULL, HFILL } }, { &hf_epl_pres_pdov, { "PDOVersion", "epl.pres.pdov", FT_UINT8, BASE_CUSTOM, CF_FUNC(elp_version), 0x00, NULL, HFILL } }, { &hf_epl_pres_size, { "Size", "epl.pres.size", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, /* SoA data fields*/ { &hf_epl_soa_stat_ms, { "NMTStatus", "epl.soa.stat", FT_UINT8, BASE_HEX, VALS(epl_nmt_ms_vals), 0x00, NULL, HFILL } }, { &hf_epl_soa_stat_cs, { "NMTStatus", "epl.soa.stat", FT_UINT8, BASE_HEX, VALS(epl_nmt_cs_vals), 0x00, NULL, HFILL } }, { &hf_epl_soa_ea, { "EA (Exception Acknowledge)", "epl.soa.ea", FT_BOOLEAN, 8, NULL, EPL_SOA_EA_MASK, NULL, HFILL } }, { &hf_epl_soa_er, { "ER (Exception Reset)", "epl.soa.er", FT_BOOLEAN, 8, NULL, EPL_SOA_ER_MASK, NULL, HFILL } }, { &hf_epl_soa_svid, { "RequestedServiceID", "epl.soa.svid", FT_UINT8, BASE_DEC|BASE_RANGE_STRING, RVALS(soa_svid_vals), 0x00, NULL, HFILL } }, { &hf_epl_soa_svtg, { "RequestedServiceTarget", "epl.soa.svtg", FT_UINT8, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa_eplv, { "EPLVersion", "epl.soa.eplv", FT_UINT8, BASE_CUSTOM, CF_FUNC(elp_version), 0x00, NULL, HFILL } }, { &hf_epl_soa_rrflags, { "RedundancyFlags", "epl.soa.rrFlags", FT_UINT8, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa_rrflags_mnred, { "MR - MN Redundancy", "epl.soa.rrFlags.mnred", FT_BOOLEAN, 8, TFS(&tfs_active_inactive), 0x01, NULL, HFILL } }, { &hf_epl_soa_rrflags_cblred, { "CR - Cable Redundancy", "epl.soa.rrFlags.cblred", FT_BOOLEAN, 8, TFS(&tfs_active_inactive), 0x02, NULL, HFILL } }, { &hf_epl_soa_rrflags_ringred, { "RR - Ring Redundancy", "epl.soa.rrFlags.ringred", FT_BOOLEAN, 8, TFS(&tfs_active_inactive), 0x04, NULL, HFILL } }, { &hf_epl_soa_rrflags_ringstat, { "RR - Ring Status", "epl.soa.rrFlags.ringstat", FT_BOOLEAN, 8, TFS(&tfs_open_closed), 0x08, NULL, HFILL } }, { &hf_epl_soa_sync, { "SyncControl", "epl.soa.sync", FT_UINT8, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa_mac, { "DestMacAddressValid", "epl.soa.adva", FT_BOOLEAN, 8, NULL, EPL_SOA_SYNC_MAC_VALID, NULL, HFILL } }, { &hf_epl_soa_pre_tm, { "PResFallBackTimeoutValid", "epl.soa.tm", FT_BOOLEAN, 8, NULL, EPL_SOA_SYNC_PRES_TIMEOUT, NULL, HFILL } }, { &hf_epl_soa_mnd_sec, { "SyncMNDelaySecondValid", "epl.soa.mnsc", FT_BOOLEAN, 8, NULL, EPL_SOA_SYNC_MND_SECOND, NULL, HFILL } }, { &hf_epl_soa_mnd_fst, { "SyncMNDelayFirstValid", "epl.soa.mnft", FT_BOOLEAN, 8, NULL, EPL_SOA_SYNC_MND_FIRST, NULL, HFILL } }, { &hf_epl_soa_pre_sec, { "PResTimeSecondValid", "epl.soa.prsc", FT_BOOLEAN, 8, NULL, EPL_SOA_SYNC_PRES_SECOND, NULL, HFILL } }, { &hf_epl_soa_pre_fst, { "PResTimeFirstValid", "epl.soa.prft", FT_BOOLEAN, 8, NULL, EPL_SOA_SYNC_PRES_FIRST, NULL, HFILL } }, { &hf_epl_soa_pre_set , { "PResModeSet", "epl.soa.prmst", FT_BOOLEAN, 8, NULL, EPL_SOA_SYNC_PRES_SET, NULL, HFILL } }, { &hf_epl_soa_pre_res, { "PResModeReset", "epl.soa.prmrst", FT_BOOLEAN, 8, NULL, EPL_SOA_SYNC_PRES_RESET, NULL, HFILL } }, { &hf_epl_soa_mac_end, { "DestMacAddress", "epl.soa.adva.end", FT_ETHER, BASE_NONE, NULL, 0x0, NULL, HFILL } }, { &hf_epl_soa_pre_tm_end, { "PResFallBackTimeoutValid", "epl.soa.tm.end", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa_mnd_sec_end, { "SyncMNDelaySecondValid", "epl.soa.mnsc.end", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa_mnd_fst_end, { "SyncMNDelayFirstValid", "epl.soa.mnft.end", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa_pre_sec_end, { "PResTimeSecondValid", "epl.soa.prsc.end", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa_pre_fst_end, { "PResTimeFirstValid", "epl.soa.prft.end", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_soa_dna_an_glb, { "AN (Global)", "epl.soa.an.global", FT_BOOLEAN, 8, NULL, 0x08, NULL, HFILL } }, { &hf_epl_soa_dna_an_lcl, { "AN (Local)", "epl.soa.an.local", FT_BOOLEAN, 8, NULL, 0x10, NULL, HFILL } }, /* ASnd header */ { &hf_epl_asnd_svid, { "Requested Service ID", "epl.asnd.svid", FT_UINT8, BASE_HEX|BASE_RANGE_STRING, RVALS(asnd_svid_vals), 0x00, NULL, HFILL } }, { &hf_epl_asnd_svtg, { "Requested Service Target", "epl.asnd.svtg", FT_UINT8, BASE_DEC, NULL, 0x00, NULL, HFILL } }, #if 0 { &hf_epl_asnd_data, { "Data", "epl.asnd.data", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, #endif /* ASnd-->IdentResponse */ { &hf_epl_asnd_identresponse_en, { "EN (Exception New)", "epl.asnd.ires.en", FT_BOOLEAN, 8, NULL, EPL_ASND_EN_MASK, NULL, HFILL } }, { &hf_epl_asnd_identresponse_ec, { "EC (Exception Clear)", "epl.asnd.ires.ec", FT_BOOLEAN, 8, NULL, EPL_ASND_EC_MASK, NULL, HFILL } }, { &hf_epl_asnd_identresponse_pr, { "PR (Priority)", "epl.asnd.ires.pr", FT_UINT8, BASE_DEC, VALS(epl_pr_vals), 0x38, NULL, HFILL } }, { &hf_epl_asnd_identresponse_rs, { "RS (RequestToSend)", "epl.asnd.ires.rs", FT_UINT8, BASE_DEC, NULL, EPL_ASND_RS_MASK, NULL, HFILL } }, { &hf_epl_asnd_identresponse_sls, { "SLS (Second Link Status)", "epl.asnd.ires.sls", FT_BOOLEAN, 8, NULL, EPL_ASND_SLS_MASK, NULL, HFILL } }, { &hf_epl_asnd_identresponse_fls, { "FLS (First Link Status)", "epl.asnd.ires.fls", FT_BOOLEAN, 8, NULL, EPL_ASND_FLS_MASK, NULL, HFILL } }, { &hf_epl_asnd_identresponse_stat_ms, { "NMTStatus", "epl.asnd.ires.state", FT_UINT8, BASE_HEX, VALS(epl_nmt_ms_vals), 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_stat_cs, { "NMTStatus", "epl.asnd.ires.state", FT_UINT8, BASE_HEX, VALS(epl_nmt_cs_vals), 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_ever, { "EPLVersion", "epl.asnd.ires.eplver", FT_UINT8, BASE_CUSTOM, CF_FUNC(elp_version), 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat, { "FeatureFlags", "epl.asnd.ires.features", FT_UINT32, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit0, { "Isochronous", "epl.asnd.ires.features.bit0", FT_BOOLEAN, 32, NULL, 0x00000001, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit1, { "SDO by UDP/IP", "epl.asnd.ires.features.bit1", FT_BOOLEAN, 32, NULL, 0x00000002, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit2, { "SDO by ASnd", "epl.asnd.ires.features.bit2", FT_BOOLEAN, 32, NULL, 0x00000004, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit3, { "SDO by PDO", "epl.asnd.ires.features.bit3", FT_BOOLEAN, 32, NULL, 0x00000008, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit4, { "NMT Info Services", "epl.asnd.ires.features.bit4", FT_BOOLEAN, 32, NULL, 0x00000010, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit5, { "Ext. NMT State Commands", "epl.asnd.ires.features.bit5", FT_BOOLEAN, 32, NULL, 0x00000020, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit6, { "Dynamic PDO Mapping", "epl.asnd.ires.features.bit6", FT_BOOLEAN, 32, NULL, 0x00000040, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit7, { "NMT Service by UDP/IP", "epl.asnd.ires.features.bit7", FT_BOOLEAN, 32, NULL, 0x00000080, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit8, { "Configuration Manager", "epl.asnd.ires.features.bit8", FT_BOOLEAN, 32, NULL, 0x00000100, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit9, { "Multiplexed Access", "epl.asnd.ires.features.bit9", FT_BOOLEAN, 32, NULL, 0x00000200, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bitA, { "NodeID setup by SW", "epl.asnd.ires.features.bitA", FT_BOOLEAN, 32, NULL, 0x00000400, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bitB, { "MN Basic Ethernet Mode", "epl.asnd.ires.features.bitB", FT_BOOLEAN, 32, NULL, 0x00000800, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bitC, { "Routing Type 1 Support", "epl.asnd.ires.features.bitC", FT_BOOLEAN, 32, NULL, 0x00001000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bitD, { "Routing Type 2 Support", "epl.asnd.ires.features.bitD", FT_BOOLEAN, 32, NULL, 0x00002000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bitE, { "SDO Read/Write All", "epl.asnd.ires.features.bitE", FT_BOOLEAN, 32, NULL, 0x00004000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bitF, { "SDO Read/Write Multiple", "epl.asnd.ires.features.bitF", FT_BOOLEAN, 32, NULL, 0x00008000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit10, { "Multiple-ASend Support", "epl.asnd.ires.features.bit10", FT_BOOLEAN, 32, NULL, 0x00010000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit11, { "Ring Redundancy", "epl.asnd.ires.features.bit11", FT_BOOLEAN, 32, NULL, 0x00020000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit12, { "PResChaining", "epl.asnd.ires.features.bit12", FT_BOOLEAN, 32, NULL, 0x00040000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit13, { "Multiple PReq/PRes", "epl.asnd.ires.features.bit13", FT_BOOLEAN, 32, NULL, 0x00080000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit14, { "Dynamic Node Allocation", "epl.asnd.ires.features.bit14", FT_BOOLEAN, 32, NULL, 0x00100000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_feat_bit21, { "Modular Device", "epl.asnd.ires.features.bit21", FT_BOOLEAN, 32, NULL, 0x00200000, NULL, HFILL } }, { &hf_epl_asnd_identresponse_mtu, { "MTU", "epl.asnd.ires.mtu", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_pis, { "PollInSize", "epl.asnd.ires.pollinsize", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_pos, { "PollOutSize", "epl.asnd.ires.polloutsizes", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_rst, { "ResponseTime", "epl.asnd.ires.resptime", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_dt, { "DeviceType", "epl.asnd.ires.devicetype", FT_UINT16, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_dt_add, { "DeviceType additional info", "epl.asnd.ires.devicetype.add", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_profile_path, { "Profile Path", "epl.asnd.ires.profilepath", FT_STRING, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_vid, { "VendorId", "epl.asnd.ires.vendorid", FT_UINT32, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_productcode, { "ProductCode", "epl.asnd.ires.productcode", FT_UINT32, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_rno, { "RevisionNumber", "epl.asnd.ires.revisionno", FT_UINT32, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_sno, { "SerialNumber", "epl.asnd.ires.serialno", FT_UINT32, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_vex1, { "VendorSpecificExtension1", "epl.asnd.ires.vendorext1", FT_UINT64, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_vcd, { "VerifyConfigurationDate", "epl.asnd.ires.confdate", FT_UINT32, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_vct, { "VerifyConfigurationTime", "epl.asnd.ires.conftime", FT_UINT32, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_ad, { "ApplicationSwDate", "epl.asnd.ires.appswdate", FT_UINT32, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_at, { "ApplicationSwTime", "epl.asnd.ires.appswtime", FT_UINT32, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_ipa, { "IPAddress", "epl.asnd.ires.ip", FT_IPv4, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_snm, { "SubnetMask", "epl.asnd.ires.subnet", FT_IPv4, BASE_NETMASK, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_gtw, { "DefaultGateway", "epl.asnd.ires.gateway", FT_IPv4, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_hn, { "HostName", "epl.asnd.ires.hostname", FT_STRING, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_identresponse_vex2, { "VendorSpecificExtension2", "epl.asnd.ires.vendorext2", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, /* ASnd-->StatusResponse */ { &hf_epl_asnd_statusresponse_en, { "EN (Exception New)", "epl.asnd.sres.en", FT_BOOLEAN, 8, NULL, EPL_ASND_EN_MASK, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_ec, { "EC (Exception Clear)", "epl.asnd.sres.ec", FT_BOOLEAN, 8, NULL, EPL_ASND_EC_MASK, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_pr, { "PR (Priority)", "epl.asnd.sres.pr", FT_UINT8, BASE_DEC, VALS(epl_pr_vals), 0x38, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_rs, { "RS (RequestToSend)", "epl.asnd.sres.rs", FT_UINT8, BASE_DEC, NULL, EPL_ASND_RS_MASK, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_sls, { "SLS (Second Link Status)", "epl.asnd.sres.sls", FT_BOOLEAN, 8, NULL, EPL_ASND_SLS_MASK, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_fls, { "FLS (First Link Status)", "epl.asnd.sres.fls", FT_BOOLEAN, 8, NULL, EPL_ASND_FLS_MASK, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_stat_ms, { "NMTStatus", "epl.asnd.sres.stat", FT_UINT8, BASE_HEX, VALS(epl_nmt_ms_vals), 0x00, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_stat_cs, { "NMTStatus", "epl.asnd.sres.stat", FT_UINT8, BASE_HEX, VALS(epl_nmt_cs_vals), 0x00, NULL, HFILL } }, /* ASnd-->SyncResponse */ { &hf_epl_asnd_syncResponse_sync, { "SyncResponse", "epl.asnd.syncresponse.sync", FT_UINT8, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_syncResponse_fst_val, { "PResTimeFirstValid", "epl.asnd.syncresponse.fst.val", FT_BOOLEAN, 8, NULL, EPL_ASND_SYNCRESPONSE_FST_VALID, NULL, HFILL } }, { &hf_epl_asnd_syncResponse_sec_val, { "PResTimeSecondValid", "epl.asnd.syncresponse.sec.val", FT_BOOLEAN, 8, NULL, EPL_ASND_SYNCRESPONSE_SEC_VALID, NULL, HFILL } }, { &hf_epl_asnd_syncResponse_mode, { "PResModeStatus", "epl.asnd.syncresponse.mode", FT_BOOLEAN, 8, NULL, EPL_ASND_SYNCRESPONSE_MODE, NULL, HFILL } }, { &hf_epl_asnd_syncResponse_latency, { "Latency", "epl.asnd.syncresponse.latency", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_syncResponse_node, { "SyncDelayStation", "epl.asnd.syncresponse.delay.station", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_syncResponse_delay, { "SyncDelay", "epl.asnd.syncresponse.delay", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_syncResponse_pre_fst, { "PResTimeFirst", "epl.asnd.syncresponse.pres.fst", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_syncResponse_pre_sec, { "PResTimeSecond", "epl.asnd.syncresponse.pres.sec", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, #if 0 { &hf_epl_asnd_statusresponse_seb, { "StaticErrorBitField", "epl.asnd.sres.seb", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, #endif /*StaticErrorBitField */ { &hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit0, { "Generic error", "epl.asnd.res.seb.bit0", FT_UINT8, BASE_DEC, NULL, 0x01, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit1, { "Current", "epl.asnd.res.seb.bit1", FT_UINT8, BASE_DEC, NULL, 0x02, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit2, { "Voltage", "epl.asnd.res.seb.bit2", FT_UINT8, BASE_DEC, NULL, 0x04, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit3, { "Temperature", "epl.asnd.res.seb.bit3", FT_UINT8, BASE_DEC, NULL, 0x08, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit4, { "Communication error", "epl.asnd.res.seb.bit4", FT_UINT8, BASE_DEC, NULL, 0x10, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit5, { "Device Profile Spec", "epl.asnd.res.seb.bit5", FT_UINT8, BASE_DEC, NULL, 0x20, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_seb_err_errorregister_u8_bit7, { "Manufacturer Spec", "epl.asnd.res.seb.bit7", FT_UINT8, BASE_DEC, NULL, 0x80, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_seb_devicespecific_err, { "Device Profile Spec", "epl.asnd.res.seb.devicespecific_err", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, #if 0 { &hf_epl_asnd_statusresponse_el, { "ErrorCodesList", "epl.asnd.sres.el", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_el_entry, { "Entry", "epl.asnd.sres.el.entry", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, #endif /*List of Errors/Events*/ { &hf_epl_asnd_statusresponse_el_entry_type, { "Entry Type", "epl.asnd.sres.el.entry.type", FT_UINT16, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_el_entry_type_profile, { "Profile", "epl.asnd.sres.el.entry.type.profile", FT_UINT16, BASE_DEC, NULL, 0x0FFF, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_el_entry_type_mode, { "Mode", "epl.asnd.sres.el.entry.type.mode", FT_UINT16, BASE_DEC, NULL, 0x3000, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_el_entry_type_bit14, { "Bit14", "epl.asnd.sres.el.entry.type.bit14", FT_UINT16, BASE_DEC, NULL, 0x4000, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_el_entry_type_bit15, { "Bit15", "epl.asnd.sres.el.entry.type.bit15", FT_UINT16, BASE_DEC, NULL, 0x8000, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_el_entry_code, { "Error Code", "epl.asnd.sres.el.entry.code", FT_UINT16, BASE_HEX|BASE_EXT_STRING, &errorcode_vals_ext, 0x00, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_el_entry_time, { "Time Stamp", "epl.asnd.sres.el.entry.time", FT_ABSOLUTE_TIME, ABSOLUTE_TIME_LOCAL, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_statusresponse_el_entry_add, { "Additional Information", "epl.asnd.sres.el.entry.add", FT_UINT64, BASE_DEC, NULL, 0x00, NULL, HFILL } }, /* ASnd-->NMTRequest */ { &hf_epl_asnd_nmtrequest_rcid, { "NMTRequestedCommandID", "epl.asnd.nmtrequest.rcid", FT_UINT8, BASE_HEX_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtrequest_rct, { "NMTRequestedCommandTarget", "epl.asnd.nmtrequest.rct", FT_UINT8, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtrequest_rcd, { "NMTRequestedCommandData", "epl.asnd.nmtrequest.rcd", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, /* ASnd-->NMTCommand */ { &hf_epl_asnd_nmtcommand_cid, { "NMTCommandId", "epl.asnd.nmtcommand.cid", FT_UINT8, BASE_HEX_DEC | BASE_EXT_STRING, &asnd_cid_vals_ext, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_resetnode_reason, { "Reset Reason", "epl.asnd.nmtcommand.resetnode_reason", FT_UINT16, BASE_HEX | BASE_EXT_STRING, &errorcode_vals_ext, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_cdat, { "NMTCommandData", "epl.asnd.nmtcommand.cdat", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtnethostnameset_hn, { "HostName", "epl.asnd.nmtcommand.nmtnethostnameset.hn", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtflusharpentry_nid, { "NodeID", "epl.asnd.nmtcommand.nmtflusharpentry.nid", FT_UINT8, BASE_DEC_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtpublishtime_dt, { "DateTime", "epl.asnd.nmtcommand.nmtpublishtime.dt", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna, { "DNA", "epl.asnd.nmtcommand.dna", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_flags, { "Valid flags", "epl.asnd.nmtcommand.dna.flags", FT_UINT8, BASE_HEX, NULL, 0x0, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_ltv, { "Lease time valid", "epl.asnd.nmtcommand.dna.ltv", FT_BOOLEAN, 8, NULL, 0x10, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_hpm, { "Hub port enable mask valid", "epl.asnd.nmtcommand.dna.hpm", FT_BOOLEAN, 8, NULL, 0x08, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_nnn, { "Set new node number", "epl.asnd.nmtcommand.dna.nnn", FT_BOOLEAN, 8, NULL, 0x04, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_mac, { "Compare current MAC ID", "epl.asnd.nmtcommand.dna.mac", FT_BOOLEAN, 8, NULL, 0x02, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_cnn, { "Compare current node number", "epl.asnd.nmtcommand.dna.cnn", FT_BOOLEAN, 8, NULL, 0x01, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_currmac, { "Current MAC ID", "epl.asnd.nmtcommand.dna.currmac", FT_ETHER, BASE_NONE, NULL, 0x0, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_hubenmsk, { "Hub port enable mask", "epl.asnd.nmtcommand.dna.hubenmsk", FT_UINT64, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_currnn, { "Current node number", "epl.asnd.nmtcommand.dna.currnn", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_newnn, { "New node number", "epl.asnd.nmtcommand.dna.newnn", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_nmtcommand_nmtdna_leasetime, { "Lease Time", "epl.asnd.nmtcommand.dna.leasetime", FT_RELATIVE_TIME, BASE_NONE, NULL, 0x00, NULL, HFILL } }, /* ASnd-->SDO */ { &hf_epl_asnd_sdo_seq, { "Sequence Layer", "epl.asnd.sdo.seq", FT_NONE, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_seq_receive_sequence_number, { "ReceiveSequenceNumber", "epl.asnd.sdo.seq.receive.sequence.number", FT_UINT8, BASE_DEC, NULL, 0xfc, NULL, HFILL } }, { &hf_epl_asnd_sdo_seq_receive_con, { "ReceiveCon", "epl.asnd.sdo.seq.receive.con", FT_UINT8, BASE_DEC, VALS(epl_sdo_receive_con_vals), 0x03, NULL, HFILL } }, { &hf_epl_asnd_sdo_seq_send_sequence_number, { "SendSequenceNumber", "epl.asnd.sdo.seq.send.sequence.number", FT_UINT8, BASE_DEC, NULL, 0xfc, NULL, HFILL } }, { &hf_epl_asnd_sdo_seq_send_con, { "SendCon", "epl.asnd.sdo.seq.send.con", FT_UINT8, BASE_DEC, VALS(epl_sdo_send_con_vals), 0x03, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_transaction_id, { "SDO Transaction ID", "epl.asnd.sdo.cmd.transaction.id", FT_UINT8, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_response, { "SDO Response", "epl.asnd.sdo.cmd.response", FT_UINT8, BASE_DEC, VALS(epl_sdo_asnd_cmd_response), 0x80, NULL, HFILL } }, #if 0 { &hf_epl_asnd_sdo_resp_in, { "Response frame", "epl.asnd.sdo.resp_in", FT_FRAMENUM, BASE_NONE, FRAMENUM_TYPE(FT_FRAMENUM_RESPONSE), 0x0, "The frame number of the corresponding response", HFILL } }, { &hf_epl_asnd_sdo_no_resp, { "No response seen", "epl.asnd.sdo.no_resp", FT_NONE, BASE_NONE, NULL, 0x0, "No corresponding response frame was seen", HFILL } }, { &hf_epl_asnd_sdo_resp_to, { "Request frame", "epl.asnd.sdo.resp_to", FT_FRAMENUM, BASE_NONE, FRAMENUM_TYPE(FT_FRAMENUM_REQUEST), 0x0, "The frame number of the corresponding request", HFILL } }, #endif { &hf_epl_asnd_sdo_cmd, { "Command Layer", "epl.asnd.sdo.cmd", FT_NONE, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_abort, { "SDO Abort", "epl.asnd.sdo.cmd.abort", FT_UINT8, BASE_DEC, VALS(epl_sdo_asnd_cmd_abort), 0x40, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_sub_abort, { "SDO Sub Transfer", "epl.asnd.sdo.cmd.sub.abort", FT_UINT8, BASE_DEC, VALS(epl_sdo_asnd_cmd_abort), 0x80, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_segmentation, { "SDO Segmentation", "epl.asnd.sdo.cmd.segmentation", FT_UINT8, BASE_DEC, VALS(epl_sdo_asnd_cmd_segmentation), 0x30, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_command_id, { "SDO Command ID", "epl.asnd.sdo.cmd.command.id", FT_UINT8, BASE_DEC | BASE_EXT_STRING, &epl_sdo_asnd_commands_ext, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_segment_size, { "SDO Segment size", "epl.asnd.sdo.cmd.segment.size", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_size, { "SDO Data size", "epl.asnd.sdo.cmd.data.size", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_padding, { "SDO Data Padding", "epl.asnd.sdo.cmd.data.padding", FT_UINT8, BASE_DEC, NULL, 0x03, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_abort_code, { "SDO Transfer Abort", "epl.asnd.sdo.cmd.abort.code", FT_UINT32, BASE_HEX | BASE_EXT_STRING, &sdo_cmd_abort_code_ext, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_index, { "OD Index", "epl.asnd.sdo.cmd.data.index", FT_UINT16, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_subindex, { "OD SubIndex", "epl.asnd.sdo.cmd.data.subindex", FT_UINT8, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_mapping, { "Mapping", "epl.asnd.sdo.cmd.data.mapping", FT_NONE, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_mapping_index, { "Index", "epl.asnd.sdo.cmd.data.mapping.index", FT_UINT16, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_mapping_subindex, { "SubIndex", "epl.asnd.sdo.cmd.data.mapping.subindex", FT_UINT8, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_mapping_offset, { "Offset", "epl.asnd.sdo.cmd.data.mapping.offset", FT_UINT16, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_data_mapping_length, { "Length", "epl.asnd.sdo.cmd.data.mapping.length", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_fragments, { "Message fragments", "epl.asnd.sdo.cmd.fragments", FT_NONE, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_fragment, { "Message fragment", "epl.asnd.sdo.cmd.fragment", FT_FRAMENUM, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_fragment_overlap, { "Message fragment overlap", "epl.asnd.sdo.cmd.fragment.overlap", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_fragment_overlap_conflicts, { "Message fragment overlapping with conflicting data", "epl.asnd.sdo.cmd.fragment.overlap.conflicts", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_fragment_multiple_tails, { "Message has multiple tail fragments", "epl.asnd.sdo.cmd.fragment.multiple_tails", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_fragment_too_long_fragment, { "Message fragment too long", "epl.asnd.sdo.cmd.fragment.too_long_fragment", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_fragment_error, { "Message defragmentation error", "epl.asnd.sdo.cmd.fragment.error", FT_FRAMENUM, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_fragment_count, { "Message fragment count", "epl.asnd.sdo.cmd.fragment.count", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_asnd_sdo_cmd_reassembled, { "Reassembled", "epl.asnd.sdo.cmd.reassembled", FT_UINT8, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_reassembled_in, { "Reassembled in", "epl.asnd.sdo.cmd.reassembled.in", FT_FRAMENUM, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_reassembled_length, { "Reassembled length", "epl.asnd.sdo.cmd.reassembled.length", FT_UINT32, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_reassembled_data, { "Reassembled Data", "epl.asnd.sdo.cmd.reassembled.data", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_sdo_multi_param_sub_abort, { "Sub Abort Code", "epl.asnd.sdo.od.multiparam.abort", FT_UINT32, BASE_HEX, NULL, 0x00, NULL, HFILL } }, /* EPL Data types */ { &hf_epl_pdo, { "PDO", "epl.pdo", FT_STRING, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_pdo_index, { "Index", "epl.pdo.index", FT_UINT16, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_pdo_subindex, { "SubIndex", "epl.pdo.subindex", FT_UINT8, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_meta, { "PDO meta info", "epl.od.meta", FT_NONE, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_meta_mapping_index, { "Mapped by index", "epl.od.meta.index", FT_UINT16, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_meta_mapping_subindex, { "Mapped by subindex", "epl.od.meta.subindex", FT_UINT8, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_meta_lifetime_start, { "Lifetime start", "epl.od.meta.lifetime.start", FT_FRAMENUM, FT_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_meta_lifetime_end, { "Lifetime end", "epl.od.meta.lifetime.end", FT_FRAMENUM, FT_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_meta_offset, { "Offset", "epl.od.meta.offset", FT_UINT16, BASE_HEX, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_meta_length, { "Length", "epl.od.meta.length", FT_UINT16, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_boolean, { "Data", "epl.od.data.boolean", FT_BOOLEAN, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_int, { "Data", "epl.od.data.int", FT_INT64, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_uint, { "Data", "epl.od.data.uint", /* We can't use BASE_DEC_HEX directly, because a FT_UINT8 * would then have 15 leading zeroes */ FT_UINT64, BASE_DEC, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_real, { "Data", "epl.od.data.real", FT_FLOAT, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_string, { "Data", "epl.od.data.string", FT_STRING, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_octet_string, { "Data", "epl.od.data.bytestring", FT_BYTES, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_mac, { "Data", "epl.od.data.ethaddr", FT_ETHER, BASE_NONE, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_ipv4, { "Data", "epl.od.data.ipv4", FT_IPv4, BASE_NONE, NULL, 0x00, NULL, HFILL } }, #if 0 { &hf_epl_od_domain, { "Data", "epl.od.data.domain", FT_BYTES, BASE_ALLOW_ZERO, NULL, 0x00, NULL, HFILL } }, { &hf_epl_od_time_difference, /* not 1:1 */ { "Data", "epl.od.data.time", FT_RELATIVE_TIME, BASE_NONE, NULL, 0x00, NULL, HFILL } }, #endif { &hf_epl_od_time, { "Data", "epl.od.data.time", FT_ABSOLUTE_TIME, ABSOLUTE_TIME_LOCAL, NULL, 0x0, NULL, HFILL } }, }; /* Setup protocol subtree array */ static int *ett[] = { &ett_epl, &ett_epl_soc, &ett_epl_preq, &ett_epl_pres, &ett_epl_feat, &ett_epl_seb, &ett_epl_el, &ett_epl_el_entry, &ett_epl_el_entry_type, &ett_epl_sdo_entry_type, &ett_epl_sdo, &ett_epl_sdo_data, &ett_epl_asnd_sdo_cmd_data_mapping, &ett_epl_sdo_sequence_layer, &ett_epl_sdo_command_layer, &ett_epl_soa_sync, &ett_epl_asnd_sync, &ett_epl_fragment, &ett_epl_fragments, &ett_epl_asnd_sdo_data_reassembled, &ett_epl_asnd_nmt_dna, &ett_epl_pdo_meta }; static ei_register_info ei[] = { { &ei_duplicated_frame, { "epl.asnd.sdo.duplication", PI_PROTOCOL, PI_NOTE, "Duplicated Frame", EXPFILL } }, { &ei_recvseq_value, { "epl.error.value.receive.sequence", PI_PROTOCOL, PI_ERROR, "Invalid Value for ReceiveSequenceNumber", EXPFILL } }, { &ei_sendseq_value, { "epl.error.value.send.sequence", PI_PROTOCOL, PI_ERROR, "Invalid Value for SendSequenceNumber", EXPFILL } }, { &ei_real_length_differs, { "epl.error.payload.length.differs", PI_PROTOCOL, PI_ERROR, "Captured length differs from header information", EXPFILL } } }; module_t *epl_module; expert_module_t *expert_epl; /* Register the protocol name and description */ proto_epl = proto_register_protocol("Ethernet POWERLINK", "EPL", "epl"); /* subdissector code */ heur_epl_subdissector_list = register_heur_dissector_list_with_description("epl", "Data encapsulated in EPL", proto_epl); heur_epl_data_subdissector_list = register_heur_dissector_list_with_description("epl_data", "EPL Data", proto_epl); epl_asnd_dissector_table = register_dissector_table("epl.asnd", "Manufacturer specific ASND service", proto_epl, FT_UINT8, BASE_DEC /*, DISSECTOR_TABLE_NOT_ALLOW_DUPLICATE*/); /* Registering protocol to be called by another dissector */ epl_handle = register_dissector("epl", dissect_epl, proto_epl); epl_udp_handle = register_dissector("epl.udp", dissect_epludp, proto_epl); /* Required function calls to register the header fields and subtrees used */ proto_register_field_array(proto_epl, hf, array_length(hf)); proto_register_subtree_array(ett, array_length(ett)); /* Register expert information field */ expert_epl = expert_register_protocol ( proto_epl ); expert_register_field_array ( expert_epl, ei, array_length (ei ) ); /* register preferences */ epl_module = prefs_register_protocol(proto_epl, apply_prefs); prefs_register_bool_preference(epl_module, "show_soc_flags", "Show flags of SoC frame in Info column", "If you are capturing in networks with multiplexed or slow nodes, this can be useful", &show_soc_flags); prefs_register_bool_preference(epl_module, "show_duplicated_command_layer", "Show command-layer in duplicated frames", "For analysis purposes one might want to show the command layer even if the dissector assumes a duplicated frame", &show_cmd_layer_for_duplicated); prefs_register_bool_preference(epl_module, "show_pdo_meta_info", "Show life times and origin PDO Tx/Rx params for PDO entries", "For analysis purposes one might want to see how long the current mapping has been active for and what OD write caused it", &show_pdo_meta_info); prefs_register_bool_preference(epl_module, "use_sdo_mappings", "Use SDO ObjectMappings for PDO dissection", "Partition PDOs according to ObjectMappings sent via SDO", &use_sdo_mappings); #ifdef HAVE_LIBXML2 prefs_register_bool_preference(epl_module, "use_xdc_mappings", "Use XDC ObjectMappings for PDO dissection", "If you want to parse the defaultValue (XDD) and actualValue (XDC) attributes for ObjectMappings in order to detect default PDO mappings, which may not be sent over SDO ", &use_xdc_mappings); #endif prefs_register_bool_preference(epl_module, "interpret_untyped_as_le", "Interpret short (<64bit) data as little endian integers", "If a data field has untyped data under 8 byte long, interpret it as unsigned little endian integer and show decimal and hexadecimal representation thereof. Otherwise use stock data dissector", &interpret_untyped_as_le); /* init device profiles support */ epl_profiles_by_device = wmem_map_new(wmem_epan_scope(), g_direct_hash, g_direct_equal); epl_profiles_by_nodeid = wmem_map_new(wmem_epan_scope(), g_direct_hash, g_direct_equal); epl_profiles_by_address = wmem_map_new(wmem_epan_scope(), epl_address_hash, epl_address_equal); epl_eds_init(); prefs_register_filename_preference(epl_module, "default_profile", "Default Profile to use if no specific profiles exist", "If you have a capture without IdentResponse and many nodes, it's easier to set a default profile here than to add entries for all MAC address or Node IDs", &epl_default_profile_path, false); device_profile_uat = uat_new("Device-Specific Profiles", sizeof (struct device_profile_uat_assoc), "epl_device_profiles", /* filename */ true, /* from_profile */ &device_profile_list_uats, /* data_ptr */ &ndevice_profile_uat, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* affects dissection of packets, but not set of named fields */ NULL, /* Help section (currently a wiki page) */ device_profile_uat_copy_cb, device_profile_uat_update_record, device_profile_uat_free_cb, device_profile_parse_uat, NULL, device_profile_list_uats_flds); prefs_register_uat_preference(epl_module, "device_profiles", "Device-Specific Profiles", "Add vendor-provided EDS" IF_LIBXML("/XDD") " profiles here", device_profile_uat ); nodeid_profile_uat = uat_new("NodeID-Specific Profiles", sizeof (struct nodeid_profile_uat_assoc), "epl_nodeid_profiles", /* filename */ true, /* from_profile */ &nodeid_profile_list_uats, /* data_ptr */ &nnodeid_profile_uat, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* affects dissection of packets, but not set of named fields */ NULL, /* Help section (currently a wiki page) */ nodeid_profile_uat_copy_cb, nodeid_profile_uat_update_record, nodeid_profile_uat_free_cb, nodeid_profile_parse_uat, NULL, nodeid_profile_list_uats_flds); prefs_register_uat_preference(epl_module, "nodeid_profiles", "Node-Specific Profiles", "Assign vendor-provided EDS" IF_LIBXML("/XDD") " profiles to CN IDs here", nodeid_profile_uat ); /* tap-registration */ /* epl_tap = register_tap("epl");*/ } void proto_reg_handoff_epl(void) { dissector_add_uint("ethertype", ETHERTYPE_EPL_V2, epl_handle); dissector_add_uint_with_preference("udp.port", UDP_PORT_EPL, epl_udp_handle); apply_prefs(); /* register frame init routine */ register_init_routine( setup_dissector ); register_cleanup_routine( cleanup_dissector ); /* register reassembly table */ reassembly_table_register(&epl_reassembly_table, &addresses_reassembly_table_functions); } static bool epl_uat_fld_uint16dec_check_cb(void *_record _U_, const char *str, unsigned len _U_, const void *chk_data _U_, const void *fld_data _U_, char **err) { uint16_t val; if (!ws_strtou16(str, NULL, &val)) { *err = g_strdup("Invalid argument. Expected a decimal between [0-65535]"); return false; } return true; } static bool epl_uat_fld_uint32hex_check_cb(void *_record _U_, const char *str, unsigned len _U_, const void *chk_data _U_, const void *fld_data _U_, char **err) { uint32_t val; if (!ws_hexstrtou32(str, NULL, &val)) { *err = g_strdup("Invalid argument. Expected a hexadecimal between [0-ffffffff]"); return false; } return true; } static bool epl_profile_uat_fld_fileopen_check_cb(void *record _U_, const char *path, unsigned len, const void *chk_data _U_, const void *fld_data _U_, char **err) { const char *supported = "Only" IF_LIBXML(" *.xdd, *.xdc and") " *.eds profiles supported."; ws_statb64 st; if (!path || !len) { *err = g_strdup("No filename given."); return false; } if (ws_stat64(path, &st) != 0) { *err = ws_strdup_printf("File '%s' does not exist or access was denied.", path); return false; } if (g_str_has_suffix(path, ".eds")) { *err = NULL; return true; } if (g_str_has_suffix(path, ".xdd") || g_str_has_suffix(path, ".xdc")) { #ifdef HAVE_LIBXML2 *err = NULL; return true; #else *err = ws_strdup_printf("*.xdd and *.xdc support not compiled in. %s", supported); return false; #endif } *err = g_strdup(supported); return false; } static void drop_profiles(void *key _U_, void *value, void *user_data _U_) { struct profile *head = (struct profile*)value, *curr; while ((curr = head)) { head = head->next; profile_del(curr); } } static void device_profile_parse_uat(void) { unsigned i; struct profile *profile = NULL; wmem_map_foreach(epl_profiles_by_device, drop_profiles, NULL); /* PDO Mappings will have stale pointers after a profile change * so we reset the memory pool. As PDO Mappings are referenced * via Conversations, we need to fixup those too to avoid a use * after free, preferably by clearing them. * This generation++ is a temporary workaround */ if (pdo_mapping_scope) { wmem_free_all(pdo_mapping_scope); current_convo_generation++; /* FIXME remove */ } for (i = 0; i < ndevice_profile_uat; i++) { struct device_profile_uat_assoc *uat = &(device_profile_list_uats[i]); profile = (struct profile*)wmem_map_lookup(epl_profiles_by_device, GUINT_TO_POINTER(uat->device_type)); /* do a shallow copy, we can't use the original because we need different * ->next pointer for each. May be we should've used Glib's non-intrusive * linked list to begin with */ if (profile) { struct profile *clone = wmem_new0(profile->scope, struct profile); *clone = *profile; profile = clone; } if (!profile) profile = profile_load(wmem_epan_scope(), uat->path); if (!profile) continue; struct profile *profile_head; if ((profile_head = (struct profile*)wmem_map_lookup(epl_profiles_by_device, GUINT_TO_POINTER(profile->id)))) { wmem_map_remove(epl_profiles_by_device, GUINT_TO_POINTER(profile_head->id)); profile->next = profile_head; } profile->id = uat->device_type; profile->data = GUINT_TO_POINTER(profile->id); profile->vendor_id = uat->vendor_id; profile->product_code = uat->product_code; wmem_map_insert(epl_profiles_by_device, GUINT_TO_POINTER(profile->id), profile); profile->parent_map = epl_profiles_by_device; ws_log(NULL, LOG_LEVEL_INFO, "Loading %s\n", profile->path); } } static bool device_profile_uat_update_record(void *_record _U_, char **err _U_) { return true; } static void device_profile_uat_free_cb(void *_r) { struct device_profile_uat_assoc *r = (struct device_profile_uat_assoc *)_r; g_free(r->path); } static void* device_profile_uat_copy_cb(void *dst_, const void *src_, size_t len _U_) { const struct device_profile_uat_assoc *src = (const struct device_profile_uat_assoc *)src_; struct device_profile_uat_assoc *dst = (struct device_profile_uat_assoc *)dst_; dst->path = g_strdup(src->path); dst->device_type = src->device_type; dst->vendor_id = src->vendor_id; dst->product_code = src->product_code; return dst; } static void nodeid_profile_parse_uat(void) { unsigned i; struct profile *profile = NULL; wmem_map_foreach(epl_profiles_by_nodeid, drop_profiles, NULL); wmem_map_foreach(epl_profiles_by_address, drop_profiles, NULL); /* PDO Mappings will have stale pointers after a profile change * so we reset the memory pool. As PDO Mappings are referenced * via Conversations, we need to fixup those too to avoid a use * after free, preferably by clearing them. * This generation++ is a temporary workaround */ if (pdo_mapping_scope) { wmem_free_all(pdo_mapping_scope); current_convo_generation++; /* FIXME remove */ } for (i = 0; i < nnodeid_profile_uat; i++) { struct nodeid_profile_uat_assoc *uat = &(nodeid_profile_list_uats[i]); profile = uat->is_nodeid ? (struct profile*)wmem_map_lookup(epl_profiles_by_nodeid, GUINT_TO_POINTER(uat->node.id)) : (struct profile*)wmem_map_lookup(epl_profiles_by_address, &uat->node.addr); if (!profile) profile = profile_load(wmem_epan_scope(), uat->path); if (!profile) continue; if (uat->is_nodeid) { profile->nodeid = uat->node.id; profile->data = GUINT_TO_POINTER(profile->nodeid); wmem_map_insert(epl_profiles_by_nodeid, GUINT_TO_POINTER(profile->nodeid), profile); profile->parent_map = epl_profiles_by_nodeid; } else { copy_address_wmem(profile->scope, &profile->node_addr, &uat->node.addr); profile->data = &profile->node_addr; wmem_map_insert(epl_profiles_by_address, &profile->node_addr, profile); profile->parent_map = epl_profiles_by_address; } ws_log(NULL, LOG_LEVEL_INFO, "Loading %s\n", profile->path); } } static bool nodeid_profile_uat_update_record(void *_record _U_, char **err _U_) { return true; } static void nodeid_profile_uat_free_cb(void *_r) { struct nodeid_profile_uat_assoc *r = (struct nodeid_profile_uat_assoc *)_r; if (!r->is_nodeid) free_address(&r->node.addr); g_free(r->path); } static void* nodeid_profile_uat_copy_cb(void *dst_, const void *src_, size_t len _U_) { const struct nodeid_profile_uat_assoc *src = (const struct nodeid_profile_uat_assoc *)src_; struct nodeid_profile_uat_assoc *dst = (struct nodeid_profile_uat_assoc *)dst_; dst->path = g_strdup(src->path); dst->id_str = g_strdup(src->id_str); if ((dst->is_nodeid = src->is_nodeid)) dst->node.id = src->node.id; else copy_address(&dst->node.addr, &src->node.addr); return dst; } static void nodeid_profile_list_uats_nodeid_tostr_cb(void *_rec, char **out_ptr, unsigned *out_len, const void *u1 _U_, const void *u2 _U_) { struct nodeid_profile_uat_assoc *rec = (struct nodeid_profile_uat_assoc*)_rec; if (rec->id_str) { *out_ptr = g_strdup(rec->id_str); *out_len = (unsigned)strlen(rec->id_str); } else { *out_ptr = g_strdup(""); *out_len = 0; } } static bool epl_uat_fld_cn_check_cb(void *record _U_, const char *str, unsigned len _U_, const void *u1 _U_, const void *u2 _U_, char **err) { uint8_t nodeid; if (ws_strtou8(str, NULL, &nodeid) && EPL_IS_CN_NODEID(nodeid)) return true; GByteArray *addr = g_byte_array_new(); if (hex_str_to_bytes(str, addr, false) && addr->len == FT_ETHER_LEN) { g_byte_array_free(addr, true); return true; } g_byte_array_free(addr, true); *err = g_strdup("Invalid argument. Expected either a CN ID [1-239] or a MAC address"); return false; } static void nodeid_profile_list_uats_nodeid_set_cb(void *_rec, const char *str, unsigned len, const void *set_data _U_, const void *fld_data _U_) { struct nodeid_profile_uat_assoc *rec = (struct nodeid_profile_uat_assoc*)_rec; GByteArray *addr = g_byte_array_new(); rec->is_nodeid = true; if (hex_str_to_bytes(str, addr, false) && addr->len == FT_ETHER_LEN) { alloc_address_wmem(NULL, &rec->node.addr, AT_ETHER, FT_ETHER_LEN, addr->data); rec->is_nodeid = false; } else if (!ws_strtou8(str, NULL, &rec->node.id)) { /* Invalid input. Set this to a bad value and let * epl_uat_fld_cn_check_cb return an error message. */ rec->node.id = 0; } g_byte_array_free(addr, true); g_free(rec->id_str); rec->id_str = g_strndup(str, len); } /* * 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: */