diff options
Diffstat (limited to 'plugins/epan/profinet/packet-pn-dcp.c')
| -rw-r--r-- | plugins/epan/profinet/packet-pn-dcp.c | 1400 |
1 files changed, 1400 insertions, 0 deletions
diff --git a/plugins/epan/profinet/packet-pn-dcp.c b/plugins/epan/profinet/packet-pn-dcp.c new file mode 100644 index 0000000000..2838663b5c --- /dev/null +++ b/plugins/epan/profinet/packet-pn-dcp.c @@ -0,0 +1,1400 @@ +/* packet-pn-dcp.c + * Routines for PN-DCP (PROFINET Discovery and basic Configuration Protocol) + * packet dissection. + * + * Wireshark - Network traffic analyzer + * By Gerald Combs <gerald@wireshark.org> + * Copyright 1999 Gerald Combs + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version 2 + * of the License, or (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. + */ + +/* + * Cyclic PNIO RTC1 Data Dissection: + * + * Added new functions to packet-pn-dcp.c. The profinet plug-in will now save + * the information (Stationname, -type, -id) of "Ident OK" frames. Those + * informations will later be used for detailled dissection of cyclic PNIO RTC1 + * dataframes. + * + * The declaration of the new added structures are within packet-pn.h to + * use the information within packet-pn-rtc-one.c + * + * Overview for cyclic PNIO RTC1 data dissection functions: + * -> dissect_PNDCP_Suboption_Device (Save Stationname, -type, -id) + */ + + +#include "config.h" + +#include <string.h> + +#include <glib.h> + +#include <epan/packet.h> +#include <epan/exceptions.h> +#include <epan/to_str.h> +#include <epan/wmem/wmem.h> +#include <epan/expert.h> +#include <epan/conversation.h> + +#include "packet-pn.h" + + +void proto_register_pn_dcp(void); +void proto_reg_handoff_pn_dcp(void); + +int proto_pn_dcp = -1; + +static int hf_pn_dcp_service_id = -1; +static int hf_pn_dcp_service_type = -1; +static int hf_pn_dcp_xid = -1; +static int hf_pn_dcp_reserved8 = -1; +static int hf_pn_dcp_reserved16 = -1; +static int hf_pn_dcp_response_delay = -1; +static int hf_pn_dcp_data_length = -1; +static int hf_pn_dcp_block_length = -1; + +static int hf_pn_dcp_block = -1; + +static int hf_pn_dcp_block_error = -1; + +static int hf_pn_dcp_option = -1; +static int hf_pn_dcp_block_info = -1; +static int hf_pn_dcp_block_qualifier = -1; +static int hf_pn_dcp_blockqualifier = -1; +static int hf_pn_dcp_blockqualifier_r2f = -1; + +static int hf_pn_dcp_suboption_ip = -1; +static int hf_pn_dcp_suboption_ip_block_info = -1; +static int hf_pn_dcp_suboption_ip_ip = -1; +static int hf_pn_dcp_suboption_ip_subnetmask = -1; +static int hf_pn_dcp_suboption_ip_standard_gateway = -1; + +static int hf_pn_dcp_suboption_device = -1; +static int hf_pn_dcp_suboption_device_typeofstation = -1; +static int hf_pn_dcp_suboption_device_nameofstation = -1; +static int hf_pn_dcp_suboption_vendor_id = -1; +static int hf_pn_dcp_suboption_device_id = -1; +static int hf_pn_dcp_suboption_device_role = -1; +static int hf_pn_dcp_suboption_device_aliasname = -1; +static int hf_pn_dcp_suboption_device_instance_high = -1; +static int hf_pn_dcp_suboption_device_instance_low = -1; +static int hf_pn_dcp_suboption_device_oem_ven_id = -1; +static int hf_pn_dcp_suboption_device_oem_dev_id = -1; + +static int hf_pn_dcp_suboption_dhcp = -1; +static int hf_pn_dcp_suboption_dhcp_device_id = -1; + +static int hf_pn_dcp_suboption_control = -1; +static int hf_pn_dcp_suboption_control_response = -1; +static int hf_pn_dcp_suboption_control_signal_value = -1; + +static int hf_pn_dcp_suboption_deviceinitiative = -1; +static int hf_pn_dcp_deviceinitiative_value = -1; + +static int hf_pn_dcp_suboption_all = -1; + +static int hf_pn_dcp_suboption_manuf = -1; + + +static gint ett_pn_dcp = -1; +static gint ett_pn_dcp_block = -1; + +static expert_field ei_pn_dcp_block_parse_error = EI_INIT; +static expert_field ei_pn_dcp_block_error_unknown = EI_INIT; +static expert_field ei_pn_dcp_ip_conflict = EI_INIT; + +#define PNDCP_SERVICE_ID_GET 0x03 +#define PNDCP_SERVICE_ID_SET 0x04 +#define PNDCP_SERVICE_ID_IDENTIFY 0x05 +#define PNDCP_SERVICE_ID_HELLO 0x06 + +static const value_string pn_dcp_service_id[] = { + { 0x00, "reserved" }, + { 0x01, "Manufacturer specific" }, + { 0x02, "Manufacturer specific" }, + { PNDCP_SERVICE_ID_GET, "Get" }, + { PNDCP_SERVICE_ID_SET, "Set" }, + { PNDCP_SERVICE_ID_IDENTIFY,"Identify" }, + { PNDCP_SERVICE_ID_HELLO, "Hello" }, + /* 0x07 - 0xff reserved */ + { 0, NULL } +}; + +#define PNDCP_SERVICE_TYPE_REQUEST 0 +#define PNDCP_SERVICE_TYPE_RESPONSE_SUCCESS 1 +#define PNDCP_SERVICE_TYPE_RESPONSE_UNSUPPORTED 5 + +static const value_string pn_dcp_service_type[] = { + { PNDCP_SERVICE_TYPE_REQUEST, "Request" }, + { PNDCP_SERVICE_TYPE_RESPONSE_SUCCESS, "Response Success" }, + { PNDCP_SERVICE_TYPE_RESPONSE_UNSUPPORTED, "Response - Request not supported" }, + /* all others reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_block_error[] = { + { 0x00, "Ok" }, + { 0x01, "Option unsupp." }, + { 0x02, "Suboption unsupp. or no DataSet avail." }, + { 0x03, "Suboption not set" }, + { 0x04, "Resource Error" }, + { 0x05, "SET not possible by local reasons" }, + { 0x06, "In operation, SET not possible" }, + /* all others reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_block_info[] = { + { 0x0000, "Reserved" }, + /*0x0001 - 0xffff reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_block_qualifier[] = { + { 0x0000, "Use the value temporary" }, + { 0x0001, "Save the value permanent" }, + /*0x0002 - 0xffff reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_BlockQualifier[] = { + { 0x0002, "Reset application data" }, + { 0x0003, "Reset application data" }, + { 0x0004, "Reset communication parameter" }, + { 0x0005, "Reset communication parameter" }, + { 0x0006, "Reset engineering parameter" }, + { 0x0007, "Reset engineering parameter" }, + { 0x0008, "Resets all stored data" }, + { 0x0009, "Resets all stored data" }, + { 0x000A, "Reset engineering parameter" }, + { 0x000B, "Reset engineering parameter" }, + { 0x000C, "Reserved" }, + { 0x000D, "Reserved" }, + { 0x000E, "Reserved" }, + { 0x0010, "Resets all stored data in the IOD or IOC to its factory values" }, + { 0x0011, "Resets all stored data in the IOD or IOC to its factory values" }, + { 0x0012, "Reset and restore data" }, + { 0x0013, "Reset and restore data" }, + { 0x0014, "Reserved" }, + { 0x0015, "Reserved" }, + { 0x0016, "Reserved" }, + { 0, NULL } +}; + +#define PNDCP_OPTION_IP 0x01 +#define PNDCP_OPTION_DEVICE 0x02 +#define PNDCP_OPTION_DHCP 0x03 +#define PNDCP_OPTION_RESERVED 0x04 +#define PNDCP_OPTION_CONTROL 0x05 +#define PNDCP_OPTION_DEVICEINITIATIVE 0x06 +#define PNDCP_OPTION_MANUF_X80 0x80 +#define PNDCP_OPTION_MANUF_X81 0x81 +#define PNDCP_OPTION_MANUF_X82 0x82 +#define PNDCP_OPTION_MANUF_X83 0x83 +#define PNDCP_OPTION_MANUF_X84 0x84 +#define PNDCP_OPTION_MANUF_X85 0x85 +#define PNDCP_OPTION_MANUF_X86 0x86 +#define PNDCP_OPTION_ALLSELECTOR 0xff + +static const value_string pn_dcp_option[] = { + { 0x00, "reserved" }, + { PNDCP_OPTION_IP, "IP" }, + { PNDCP_OPTION_DEVICE, "Device properties" }, + { PNDCP_OPTION_DHCP, "DHCP" }, + { PNDCP_OPTION_RESERVED, "Reserved" }, + { PNDCP_OPTION_CONTROL, "Control" }, + { PNDCP_OPTION_DEVICEINITIATIVE, "Device Initiative" }, + /*0x07 - 0x7f reserved */ + /*0x80 - 0xfe manufacturer specific */ + { PNDCP_OPTION_MANUF_X80, "Manufacturer specific" }, + { PNDCP_OPTION_MANUF_X81, "Manufacturer specific" }, + { PNDCP_OPTION_MANUF_X82, "Manufacturer specific" }, + { PNDCP_OPTION_MANUF_X83, "Manufacturer specific" }, + { PNDCP_OPTION_MANUF_X84, "Manufacturer specific" }, + { PNDCP_OPTION_MANUF_X85, "Manufacturer specific" }, + { PNDCP_OPTION_MANUF_X86, "Manufacturer specific" }, + { PNDCP_OPTION_ALLSELECTOR, "All Selector" }, + { 0, NULL } +}; + +#define PNDCP_SUBOPTION_IP_MAC 0x01 +#define PNDCP_SUBOPTION_IP_IP 0x02 + +static const value_string pn_dcp_suboption_ip[] = { + { 0x00, "Reserved" }, + { PNDCP_SUBOPTION_IP_MAC, "MAC address" }, + { PNDCP_SUBOPTION_IP_IP, "IP parameter" }, + /*0x03 - 0xff reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_suboption_ip_block_info[] = { + { 0x0000, "IP not set" }, + { 0x0001, "IP set" }, + { 0x0002, "IP set by DHCP" }, + { 0x0080, "IP not set (address conflict detected)" }, + { 0x0081, "IP set (address conflict detected)" }, + { 0x0082, "IP set by DHCP (address conflict detected)" }, + /*0x0003 - 0xffff reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_suboption_control_signal_value[] = { + {0x0100, "Flash Once"}, + {0, NULL} +}; + +#define PNDCP_SUBOPTION_DEVICE_MANUF 0x01 +#define PNDCP_SUBOPTION_DEVICE_NAMEOFSTATION 0x02 +#define PNDCP_SUBOPTION_DEVICE_DEV_ID 0x03 +#define PNDCP_SUBOPTION_DEVICE_DEV_ROLE 0x04 +#define PNDCP_SUBOPTION_DEVICE_DEV_OPTIONS 0x05 +#define PNDCP_SUBOPTION_DEVICE_ALIAS_NAME 0x06 +#define PNDCP_SUBOPTION_DEVICE_DEV_INSTANCE 0x07 +#define PNDCP_SUBOPTION_DEVICE_OEM_DEV_ID 0x08 + +static const value_string pn_dcp_suboption_device[] = { + { 0x00, "Reserved" }, + { PNDCP_SUBOPTION_DEVICE_MANUF, "Manufacturer specific (Type of Station)" }, + { PNDCP_SUBOPTION_DEVICE_NAMEOFSTATION, "Name of Station" }, + { PNDCP_SUBOPTION_DEVICE_DEV_ID, "Device ID" }, + { PNDCP_SUBOPTION_DEVICE_DEV_ROLE, "Device Role" }, + { PNDCP_SUBOPTION_DEVICE_DEV_OPTIONS, "Device Options" }, + { PNDCP_SUBOPTION_DEVICE_ALIAS_NAME, "Alias Name" }, + { PNDCP_SUBOPTION_DEVICE_DEV_INSTANCE, "Device Instance" }, + { PNDCP_SUBOPTION_DEVICE_OEM_DEV_ID, "OEM Device ID"}, + /*0x09 - 0xff reserved */ + { 0, NULL } +}; + +#define PNDCP_SUBOPTION_DHCP_CLIENT_ID 61 + +static const value_string pn_dcp_suboption_dhcp[] = { + { 12, "Host name" }, + { 43, "Vendor specific" }, + { 54, "Server identifier" }, + { 55, "Parameter request list" }, + { 60, "Class identifier" }, + { PNDCP_SUBOPTION_DHCP_CLIENT_ID, "DHCP client identifier" }, + { 81, "FQDN, Fully Qualified Domain Name" }, + { 97, "UUID/GUID-based Client" }, + { 255, "Control DHCP for address resolution" }, + /*all others reserved */ + { 0, NULL } +}; + +#define PNDCP_SUBOPTION_CONTROL_START_TRANS 0x01 +#define PNDCP_SUBOPTION_CONTROL_END_TRANS 0x02 +#define PNDCP_SUBOPTION_CONTROL_SIGNAL 0x03 +#define PNDCP_SUBOPTION_CONTROL_RESPONSE 0x04 +#define PNDCP_SUBOPTION_CONTROL_FACT_RESET 0x05 +#define PNDCP_SUBOPTION_CONTROL_RESET_TO_FACT 0x06 + +static const value_string pn_dcp_suboption_control[] = { + { 0x00, "Reserved" }, + { PNDCP_SUBOPTION_CONTROL_START_TRANS, "Start Transaction" }, + { PNDCP_SUBOPTION_CONTROL_END_TRANS, "End Transaction" }, + { PNDCP_SUBOPTION_CONTROL_SIGNAL, "Signal" }, + { PNDCP_SUBOPTION_CONTROL_RESPONSE, "Response" }, + { PNDCP_SUBOPTION_CONTROL_FACT_RESET, "Reset Factory Settings" }, + { PNDCP_SUBOPTION_CONTROL_RESET_TO_FACT,"Reset to Factory" }, + /*0x07 - 0xff reserved */ + { 0, NULL } +}; + +#define PNDCP_SUBOPTION_DEVICEINITIATIVE 0x01 + +static const value_string pn_dcp_suboption_deviceinitiative[] = { + { 0x00, "Reserved" }, + { PNDCP_SUBOPTION_DEVICEINITIATIVE, "Device Initiative" }, + /*0x00 - 0xff reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_deviceinitiative_value[] = { + { 0x00, "Device does not issue a DCP-Hello-ReqPDU after power on" }, + { 0x01, "Device does issue a DCP-Hello-ReqPDU after power on" }, + /*0x02 - 0xff reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_suboption_all[] = { + { 0xff, "ALL Selector" }, + /* all other reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_suboption_other[] = { + { 0x00, "Default" }, + /* all other reserved */ + { 0, NULL } +}; + +static const value_string pn_dcp_suboption_manuf[] = { + /* none known */ + { 0, NULL } +}; + + + + + +/* dissect the option field */ +static int +dissect_PNDCP_Option(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *block_item, int hfindex, gboolean append_col) +{ + guint8 option; + guint8 suboption; + const value_string *val_str; + + offset = dissect_pn_uint8 (tvb, offset, pinfo, tree, hfindex, &option); + switch (option) { + case PNDCP_OPTION_IP: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_ip, &suboption); + val_str = pn_dcp_suboption_ip; + break; + case PNDCP_OPTION_DEVICE: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_device, &suboption); + val_str = pn_dcp_suboption_device; + break; + case PNDCP_OPTION_DHCP: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_dhcp, &suboption); + val_str = pn_dcp_suboption_dhcp; + break; + case PNDCP_OPTION_CONTROL: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_control, &suboption); + val_str = pn_dcp_suboption_control; + break; + case PNDCP_OPTION_DEVICEINITIATIVE: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_deviceinitiative, &suboption); + val_str = pn_dcp_suboption_deviceinitiative; + break; + case PNDCP_OPTION_ALLSELECTOR: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_all, &suboption); + val_str = pn_dcp_suboption_all; + break; + default: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_manuf, &suboption); + val_str = pn_dcp_suboption_manuf; + } + + proto_item_append_text(block_item, ", Status from %s - %s", + val_to_str(option, pn_dcp_option, "Unknown"), val_to_str(suboption, val_str, "Unknown")); + + if (append_col) { + col_append_fstr(pinfo->cinfo, COL_INFO, ", %s", val_to_str(suboption, val_str, "Unknown")); + } + + return offset; +} + + +/* dissect the "IP" suboption */ +static int +dissect_PNDCP_Suboption_IP(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *block_item, proto_item *dcp_item, + guint8 service_id, gboolean is_response) +{ + guint8 suboption; + guint16 block_length; + guint16 block_info; + guint16 block_qualifier; + guint32 ip; + proto_item *item = NULL; + address addr; + + + /* SuboptionIPParameter */ + offset = dissect_pn_uint8 (tvb, offset, pinfo, tree, hf_pn_dcp_suboption_ip, &suboption); + /* DCPBlockLength */ + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_length, &block_length); + + switch (suboption) { + case PNDCP_SUBOPTION_IP_MAC: + /* MACAddressValue? */ + pn_append_info(pinfo, dcp_item, ", MAC"); + proto_item_append_text(block_item, "IP/MAC"); + + offset = dissect_pn_undecoded(tvb, offset, pinfo, tree, block_length); + break; + case PNDCP_SUBOPTION_IP_IP: + pn_append_info(pinfo, dcp_item, ", IP"); + proto_item_append_text(block_item, "IP/IP"); + + /* BlockInfo? */ + if ( ((service_id == PNDCP_SERVICE_ID_IDENTIFY) && is_response) || + ((service_id == PNDCP_SERVICE_ID_HELLO) && !is_response) || + ((service_id == PNDCP_SERVICE_ID_GET) && is_response)) { + block_info = tvb_get_ntohs (tvb, offset); + if (tree) { + item = proto_tree_add_uint(tree, hf_pn_dcp_suboption_ip_block_info, tvb, offset, 2, block_info); + } + offset += 2; + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_suboption_ip_block_info, "Undecoded")); + block_length -= 2; + if (block_info & 0x80) { + expert_add_info(pinfo, item, &ei_pn_dcp_ip_conflict); + } + } + + /* BlockQualifier? */ + if ( (service_id == PNDCP_SERVICE_ID_SET) && !is_response) { + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_qualifier, &block_qualifier); + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + block_length -= 2; + } + + /* IPParameterValue ... */ + + /* IPAddress */ + offset = dissect_pn_ipv4(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_ip_ip, &ip); + set_address(&addr, AT_IPv4, 4, &ip); + proto_item_append_text(block_item, ", IP: %s", address_to_str(wmem_packet_scope(), &addr)); + + /* Subnetmask */ + offset = dissect_pn_ipv4(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_ip_subnetmask, &ip); + set_address(&addr, AT_IPv4, 4, &ip); + proto_item_append_text(block_item, ", Subnet: %s", address_to_str(wmem_packet_scope(), &addr)); + + /* StandardGateway */ + offset = dissect_pn_ipv4(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_ip_standard_gateway, &ip); + set_address(&addr, AT_IPv4, 4, &ip); + proto_item_append_text(block_item, ", Gateway: %s", address_to_str(wmem_packet_scope(), &addr)); + break; + default: + offset = dissect_pn_undecoded(tvb, offset, pinfo, tree, block_length); + } + + return offset; +} + + +/* dissect the "device" suboption */ +static int +dissect_PNDCP_Suboption_Device(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *block_item, proto_item *dcp_item, + guint8 service_id, gboolean is_response) +{ + guint8 suboption; + guint16 block_length; + gchar *info_str; + guint8 device_role; + guint16 vendor_id; + guint16 device_id; + char *typeofstation; + char *nameofstation; + char *aliasname; + guint16 block_info = 0; + guint16 block_qualifier = 0; + gboolean have_block_info = FALSE; + gboolean have_block_qualifier = FALSE; + guint8 device_instance_high; + guint8 device_instance_low; + guint16 oem_vendor_id; + guint16 oem_device_id; + conversation_t *conversation; + stationInfo *station_info; + + /* SuboptionDevice... */ + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_device, &suboption); + /* DCPBlockLength */ + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_length, &block_length); + + /* BlockInfo? */ + if ( ((service_id == PNDCP_SERVICE_ID_IDENTIFY) && is_response) || + ((service_id == PNDCP_SERVICE_ID_HELLO) && !is_response) || + ((service_id == PNDCP_SERVICE_ID_GET) && is_response)) { + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_info, &block_info); + have_block_info = TRUE; + block_length -= 2; + } + + /* BlockQualifier? */ + if ( (service_id == PNDCP_SERVICE_ID_SET) && !is_response) { + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_qualifier, &block_qualifier); + have_block_qualifier = TRUE; + block_length -= 2; + } + + switch (suboption) { + case PNDCP_SUBOPTION_DEVICE_MANUF: + typeofstation = (char *)wmem_alloc(wmem_packet_scope(), block_length+1); + tvb_memcpy(tvb, (guint8 *) typeofstation, offset, block_length); + typeofstation[block_length] = '\0'; + proto_tree_add_string (tree, hf_pn_dcp_suboption_device_typeofstation, tvb, offset, block_length, typeofstation); + pn_append_info(pinfo, dcp_item, ", DeviceVendorValue"); + proto_item_append_text(block_item, "Device/Manufacturer specific"); + if (have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if (have_block_info){ + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + } + proto_item_append_text(block_item, ", DeviceVendorValue: \"%s\"", typeofstation); + + + if (pinfo->fd->flags.visited == FALSE) { + /* Create a conversation between the MAC addresses */ + conversation = find_conversation(pinfo->num, &pinfo->dl_src, &pinfo->dl_dst, ENDPOINT_NONE, 0, 0, 0); + if (conversation == NULL) { + conversation = conversation_new(pinfo->num, &pinfo->dl_src, &pinfo->dl_dst, ENDPOINT_NONE, 0, 0, 0); + } + + station_info = (stationInfo*)conversation_get_proto_data(conversation, proto_pn_dcp); + if (station_info == NULL) { + station_info = wmem_new0(wmem_file_scope(), stationInfo); + init_pnio_rtc1_station(station_info); + conversation_add_proto_data(conversation, proto_pn_dcp, station_info); + } + + station_info->typeofstation = wmem_strdup(wmem_file_scope(), typeofstation); + } + + offset += block_length; + break; + + case PNDCP_SUBOPTION_DEVICE_NAMEOFSTATION: + nameofstation = (char *)wmem_alloc(wmem_packet_scope(), block_length+1); + tvb_memcpy(tvb, (guint8 *) nameofstation, offset, block_length); + nameofstation[block_length] = '\0'; + proto_tree_add_string (tree, hf_pn_dcp_suboption_device_nameofstation, tvb, offset, block_length, nameofstation); + pn_append_info(pinfo, dcp_item, wmem_strdup_printf(wmem_packet_scope(), ", NameOfStation:\"%s\"", nameofstation)); + proto_item_append_text(block_item, "Device/NameOfStation"); + if (have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if (have_block_info) { + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + } + proto_item_append_text(block_item, ", \"%s\"", nameofstation); + + + if (pinfo->fd->flags.visited == FALSE) { + /* Create a conversation between the MAC addresses */ + conversation = find_conversation(pinfo->num, &pinfo->dl_src, &pinfo->dl_dst, ENDPOINT_NONE, 0, 0, 0); + if (conversation == NULL) { + conversation = conversation_new(pinfo->num, &pinfo->dl_src, &pinfo->dl_dst, ENDPOINT_NONE, 0, 0, 0); + } + + station_info = (stationInfo*)conversation_get_proto_data(conversation, proto_pn_dcp); + if (station_info == NULL) { + station_info = wmem_new0(wmem_file_scope(), stationInfo); + init_pnio_rtc1_station(station_info); + conversation_add_proto_data(conversation, proto_pn_dcp, station_info); + } + + station_info->nameofstation = wmem_strdup(wmem_file_scope(), nameofstation); + } + + offset += block_length; + break; + + case PNDCP_SUBOPTION_DEVICE_DEV_ID: + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_vendor_id, &vendor_id); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_device_id, &device_id); + + if (pinfo->fd->flags.visited == FALSE) { + /* Create a conversation between the MAC addresses */ + conversation = find_conversation(pinfo->num, &pinfo->dl_src, &pinfo->dl_dst, ENDPOINT_NONE, 0, 0, 0); + if (conversation == NULL) { + conversation = conversation_new(pinfo->num, &pinfo->dl_src, &pinfo->dl_dst, ENDPOINT_NONE, 0, 0, 0); + } + + station_info = (stationInfo*)conversation_get_proto_data(conversation, proto_pn_dcp); + if (station_info == NULL) { + station_info = wmem_new0(wmem_file_scope(), stationInfo); + init_pnio_rtc1_station(station_info); + conversation_add_proto_data(conversation, proto_pn_dcp, station_info); + } + + station_info->u16Vendor_id = vendor_id; + station_info->u16Device_id = device_id; + } + + + pn_append_info(pinfo, dcp_item, ", Dev-ID"); + proto_item_append_text(block_item, "Device/Device ID"); + if (have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if (have_block_info) { + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + } + proto_item_append_text(block_item, ", VendorID: 0x%04x / DeviceID: 0x%04x", vendor_id, device_id); + break; + case PNDCP_SUBOPTION_DEVICE_DEV_ROLE: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_device_role, &device_role); + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_reserved8, NULL); + pn_append_info(pinfo, dcp_item, ", Dev-Role"); + proto_item_append_text(block_item, "Device/Device Role"); + if (have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if (have_block_info) + proto_item_append_text(block_item, ", BlockInfo: %s", val_to_str(block_info, pn_dcp_block_info, "Unknown")); + if (device_role & 0x01) + proto_item_append_text(block_item, ", IO-Device"); + if (device_role & 0x02) + proto_item_append_text(block_item, ", IO-Controller"); + if (device_role & 0x04) + proto_item_append_text(block_item, ", IO-Multidevice"); + if (device_role & 0x08) + proto_item_append_text(block_item, ", PN-Supervisor"); + break; + case PNDCP_SUBOPTION_DEVICE_DEV_OPTIONS: + info_str = wmem_strdup_printf(wmem_packet_scope(), ", Dev-Options(%u)", block_length/2); + pn_append_info(pinfo, dcp_item, info_str); + proto_item_append_text(block_item, "Device/Device Options"); + if (have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if (have_block_info) { + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + } + proto_item_append_text(block_item, ", %u options", block_length/2); + for( ; block_length != 0; block_length -= 2) { + offset = dissect_PNDCP_Option(tvb, offset, pinfo, tree, NULL /*block_item*/, hf_pn_dcp_option, + FALSE /* append_col */); + } + break; + case PNDCP_SUBOPTION_DEVICE_ALIAS_NAME: + aliasname = (char *)wmem_alloc(wmem_packet_scope(), block_length+1); + tvb_memcpy(tvb, (guint8 *) aliasname, offset, block_length); + aliasname[block_length] = '\0'; + proto_tree_add_string (tree, hf_pn_dcp_suboption_device_aliasname, tvb, offset, block_length, aliasname); + pn_append_info(pinfo, dcp_item, wmem_strdup_printf(wmem_packet_scope(), ", AliasName:\"%s\"", aliasname)); + proto_item_append_text(block_item, "Device/AliasName"); + if (have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if (have_block_info) { + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + } + proto_item_append_text(block_item, ", \"%s\"", aliasname); + offset += block_length; + break; + case PNDCP_SUBOPTION_DEVICE_DEV_INSTANCE: + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_device_instance_high, &device_instance_high); + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_device_instance_low, &device_instance_low); + pn_append_info(pinfo, dcp_item, ", Dev-Instance"); + proto_item_append_text(block_item, "Device/Device Instance"); + if (have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if (have_block_info) { + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + } + proto_item_append_text(block_item, ", InstanceHigh: %d, Instance Low: %d", + device_instance_high, device_instance_low); + break; + case PNDCP_SUBOPTION_DEVICE_OEM_DEV_ID: + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_device_oem_ven_id, &oem_vendor_id); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_device_oem_dev_id, &oem_device_id); + pn_append_info(pinfo, dcp_item, ", OEM-Dev-ID"); + proto_item_append_text(block_item, "Device/OEM Device ID"); + if(have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if(have_block_info) { + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + } + proto_item_append_text(block_item, ", OEMVendorID: 0x%04x / OEMDeviceID: 0x%04x", oem_vendor_id, oem_device_id); + break; + default: + offset = dissect_pn_undecoded(tvb, offset, pinfo, tree, block_length); + } + + return offset; +} + + +/* dissect the "DHCP" suboption */ +static int +dissect_PNDCP_Suboption_DHCP(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *block_item, proto_item *dcp_item, + guint8 service_id _U_, gboolean is_response _U_) +{ + guint8 suboption; + guint16 block_length; + guint16 block_info = 0; + guint16 block_qualifier = 0; + gboolean have_block_info = FALSE; + gboolean have_block_qualifier = FALSE; + + + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_dhcp, &suboption); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_length, &block_length); + + /* BlockInfo? */ + if ( ((service_id == PNDCP_SERVICE_ID_IDENTIFY) && is_response) || + ((service_id == PNDCP_SERVICE_ID_HELLO) && !is_response) || + ((service_id == PNDCP_SERVICE_ID_GET) && is_response)) { + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_info, &block_info); + have_block_info=TRUE; + block_length -= 2; + } + + /* BlockQualifier? */ + if ( (service_id == PNDCP_SERVICE_ID_SET) && !is_response) { + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_qualifier, &block_qualifier); + have_block_qualifier=TRUE; + block_length -= 2; + } + + switch (suboption) { + case PNDCP_SUBOPTION_DHCP_CLIENT_ID: + pn_append_info(pinfo, dcp_item, ", DHCP client identifier"); + proto_item_append_text(block_item, "DHCP/Client-ID"); + if (have_block_qualifier) { + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + } + if (have_block_info) { + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + } + proto_tree_add_item(tree, hf_pn_dcp_suboption_dhcp_device_id, tvb, offset, block_length, ENC_NA); + offset += block_length; + break; + default: + offset = dissect_pn_undecoded(tvb, offset, pinfo, tree, block_length); + } + + return offset; +} + + +/* dissect the "control" suboption */ +static int +dissect_PNDCP_Suboption_Control(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *block_item, proto_item *dcp_item, + guint8 service_id _U_, gboolean is_response _U_) +{ + guint8 suboption; + guint16 block_length; + guint16 block_qualifier; + guint16 BlockQualifier; + guint16 u16SignalValue; + gchar *info_str; + guint8 block_error; + proto_item *item = NULL; + + + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_control, &suboption); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_length, &block_length); + + switch (suboption) { + case PNDCP_SUBOPTION_CONTROL_START_TRANS: + pn_append_info(pinfo, dcp_item, ", Start-Trans"); + proto_item_append_text(block_item, "Control/Start-Transaction"); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_qualifier, &block_qualifier); + break; + case PNDCP_SUBOPTION_CONTROL_END_TRANS: + pn_append_info(pinfo, dcp_item, ", End-Trans"); + proto_item_append_text(block_item, "Control/End-Transaction"); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_qualifier, &block_qualifier); + break; + case PNDCP_SUBOPTION_CONTROL_SIGNAL: + pn_append_info(pinfo, dcp_item, ", Signal"); + proto_item_append_text(block_item, "Control/Signal"); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_qualifier, &block_qualifier); + block_length -= 2; + + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_control_signal_value, &u16SignalValue); + break; + case PNDCP_SUBOPTION_CONTROL_RESPONSE: + proto_item_append_text(block_item, "Control/Response"); + offset = dissect_PNDCP_Option(tvb, offset, pinfo, tree, block_item, hf_pn_dcp_suboption_control_response, + FALSE /* append_col */); + block_error = tvb_get_guint8 (tvb, offset); + if (tree) { + item = proto_tree_add_uint(tree, hf_pn_dcp_block_error, tvb, offset, 1, block_error); + } + offset += 1; + if (block_error != 0) { + expert_add_info_format(pinfo, item, &ei_pn_dcp_block_error_unknown, "%s", + val_to_str(block_error, pn_dcp_block_error, "Unknown")); + } + info_str = wmem_strdup_printf(wmem_packet_scope(), ", Response(%s)", + val_to_str(block_error, pn_dcp_block_error, "Unknown")); + pn_append_info(pinfo, dcp_item, info_str); + proto_item_append_text(block_item, ", BlockError: %s", + val_to_str(block_error, pn_dcp_block_error, "Unknown")); + + break; + case PNDCP_SUBOPTION_CONTROL_FACT_RESET: + pn_append_info(pinfo, dcp_item, ", Reset FactorySettings"); + proto_item_append_text(block_item, "Control/Reset FactorySettings"); + block_length -= 2; + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_blockqualifier_r2f, &BlockQualifier); + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(BlockQualifier, pn_dcp_suboption_other, "reserved")); + block_length -= 2; + break; + + case PNDCP_SUBOPTION_CONTROL_RESET_TO_FACT: + pn_append_info(pinfo, dcp_item, ", Reset to Factory"); + proto_item_append_text(block_item, "Reset to FactorySettings"); + + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_blockqualifier, &BlockQualifier); + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(BlockQualifier, pn_dcp_BlockQualifier, "reserved")); + block_length -= 2; + + break; + default: + offset = dissect_pn_undecoded(tvb, offset, pinfo, tree, block_length); + } + + return offset; +} + + +/* dissect the "deviceinitaitve" suboption */ +static int +dissect_PNDCP_Suboption_DeviceInitiative(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *block_item, proto_item *dcp_item, + guint8 service_id, gboolean is_response) +{ + guint8 suboption; + guint16 block_length; + guint16 block_info; + guint16 block_qualifier; + guint16 value; + + + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_deviceinitiative, &suboption); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_length, &block_length); + + pn_append_info(pinfo, dcp_item, ", DeviceInitiative"); + proto_item_append_text(block_item, "DeviceInitiative/DeviceInitiative"); + + /* BlockInfo? */ + if ( ((service_id == PNDCP_SERVICE_ID_IDENTIFY) && is_response) || + ((service_id == PNDCP_SERVICE_ID_HELLO) && !is_response) || + ((service_id == PNDCP_SERVICE_ID_GET) && is_response)) { + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_info, &block_info); + proto_item_append_text(block_item, ", BlockInfo: %s", + val_to_str(block_info, pn_dcp_block_info, "Unknown")); + block_length -= 2; + } + + /* BlockQualifier? */ + if ( (service_id == PNDCP_SERVICE_ID_SET) && !is_response) { + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_qualifier, &block_qualifier); + proto_item_append_text(block_item, ", BlockQualifier: %s", + val_to_str(block_qualifier, pn_dcp_block_qualifier, "Unknown")); + block_length -= 2; + } + + /* DeviceInitiativeValue */ + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_deviceinitiative_value, &value); + + return offset; +} + + +/* dissect the "all" suboption */ +static int +dissect_PNDCP_Suboption_All(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *block_item, proto_item *dcp_item, + guint8 service_id _U_, gboolean is_response _U_) +{ + guint8 suboption; + guint16 block_length; + + + offset = dissect_pn_uint8(tvb, offset, pinfo, tree, hf_pn_dcp_suboption_all, &suboption); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_length, &block_length); + + switch (suboption) { + case 255: /* All */ + pn_append_info(pinfo, dcp_item, ", All"); + proto_item_append_text(block_item, "All/All"); + break; + default: + offset = dissect_pn_undecoded(tvb, offset, pinfo, tree, block_length); + } + + return offset; +} + + +/* dissect the "manufacturer" suboption */ +static int +dissect_PNDCP_Suboption_Manuf(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *block_item, proto_item *dcp_item, + guint8 service_id _U_, gboolean is_response _U_) +{ + guint16 block_length; + + offset = dissect_pn_uint8( tvb, offset, pinfo, tree, hf_pn_dcp_suboption_manuf, NULL); + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_block_length, &block_length); + + pn_append_info(pinfo, dcp_item, ", Manufacturer Specific"); + proto_item_append_text(block_item, "Manufacturer Specific"); + offset = dissect_pn_undecoded(tvb, offset, pinfo, tree, block_length); + + return offset; +} + + +/* dissect one DCP block */ +static int +dissect_PNDCP_Block(tvbuff_t *tvb, int offset, packet_info *pinfo, + proto_tree *tree, proto_item *dcp_item, + guint8 service_id, gboolean is_response) +{ + guint8 option; + proto_item *block_item; + proto_tree *block_tree; + int ori_offset = offset; + + /* subtree for block */ + block_item = proto_tree_add_none_format(tree, hf_pn_dcp_block, + tvb, offset, 0, "Block: "); + block_tree = proto_item_add_subtree(block_item, ett_pn_dcp_block); + + + offset = dissect_pn_uint8(tvb, offset, pinfo, block_tree, hf_pn_dcp_option, &option); + + switch (option) { + case PNDCP_OPTION_IP: + offset = dissect_PNDCP_Suboption_IP(tvb, offset, pinfo, block_tree, block_item, dcp_item, service_id, is_response); + break; + case PNDCP_OPTION_DEVICE: + offset = dissect_PNDCP_Suboption_Device(tvb, offset, pinfo, block_tree, block_item, dcp_item, service_id, is_response); + break; + case PNDCP_OPTION_DHCP: + offset = dissect_PNDCP_Suboption_DHCP(tvb, offset, pinfo, block_tree, block_item, dcp_item, service_id, is_response); + break; + case PNDCP_OPTION_CONTROL: + offset = dissect_PNDCP_Suboption_Control(tvb, offset, pinfo, block_tree, block_item, dcp_item, service_id, is_response); + break; + case PNDCP_OPTION_DEVICEINITIATIVE: + offset = dissect_PNDCP_Suboption_DeviceInitiative(tvb, offset, pinfo, block_tree, block_item, dcp_item, service_id, is_response); + break; + case PNDCP_OPTION_ALLSELECTOR: + offset = dissect_PNDCP_Suboption_All(tvb, offset, pinfo, block_tree, block_item, dcp_item, service_id, is_response); + break; + case PNDCP_OPTION_MANUF_X80: + case PNDCP_OPTION_MANUF_X81: + default: + offset = dissect_PNDCP_Suboption_Manuf(tvb, offset, pinfo, block_tree, block_item, dcp_item, service_id, is_response); + } + + proto_item_set_len(block_item, offset-ori_offset); + + if ((offset-ori_offset) & 1) { + /* we have an odd number of bytes in this block, add a padding byte */ + offset = dissect_pn_padding(tvb, offset, pinfo, tree, 1); + } + + return offset; +} + + +/* dissect a whole DCP PDU */ +static void +dissect_PNDCP_PDU(tvbuff_t *tvb, + packet_info *pinfo, proto_tree *tree, proto_item *dcp_item) +{ + guint8 service_id; + guint8 service_type; + guint32 xid; + guint16 response_delay; + guint16 data_length; + int offset = 0; + gchar *xid_str; + gboolean is_response = FALSE; + + + offset = dissect_pn_uint8 (tvb, offset, pinfo, tree, hf_pn_dcp_service_id, &service_id); + offset = dissect_pn_uint8 (tvb, offset, pinfo, tree, hf_pn_dcp_service_type, &service_type); + proto_tree_add_item_ret_uint(tree, hf_pn_dcp_xid, tvb, offset, 4, ENC_BIG_ENDIAN, &xid); + offset += 4; + if (service_id == PNDCP_SERVICE_ID_IDENTIFY && service_type == PNDCP_SERVICE_TYPE_REQUEST) { + /* multicast header */ + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_response_delay, &response_delay); + } else { + /* unicast header */ + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_reserved16, NULL); + } + offset = dissect_pn_uint16(tvb, offset, pinfo, tree, hf_pn_dcp_data_length, &data_length); + + switch (service_id) { + case PNDCP_SERVICE_ID_GET: + pn_append_info(pinfo, dcp_item, "Get"); + break; + case PNDCP_SERVICE_ID_SET: + pn_append_info(pinfo, dcp_item, "Set"); + break; + case PNDCP_SERVICE_ID_IDENTIFY: + pn_append_info(pinfo, dcp_item, "Ident"); + break; + case PNDCP_SERVICE_ID_HELLO: + pn_append_info(pinfo, dcp_item, "Hello"); + break; + default: + dissect_pn_undecoded(tvb, offset, pinfo, tree, tvb_captured_length_remaining(tvb, offset)); + return; + } + + switch (service_type) { + case PNDCP_SERVICE_TYPE_REQUEST: + pn_append_info(pinfo, dcp_item, " Req"); + break; + case PNDCP_SERVICE_TYPE_RESPONSE_SUCCESS: + pn_append_info(pinfo, dcp_item, " Ok "); + is_response = TRUE; + break; + case PNDCP_SERVICE_TYPE_RESPONSE_UNSUPPORTED: + pn_append_info(pinfo, dcp_item, " unsupported"); + is_response = TRUE; + break; + default: + dissect_pn_undecoded(tvb, offset, pinfo, tree, tvb_captured_length_remaining(tvb, offset)); + return; + } + + xid_str = wmem_strdup_printf(wmem_packet_scope(), ", Xid:0x%x", xid); + pn_append_info(pinfo, dcp_item, xid_str); + + /* dissect a number of blocks (depending on the remaining length) */ + while(data_length) { + int ori_offset = offset; + + if (service_id == PNDCP_SERVICE_ID_GET && service_type == PNDCP_SERVICE_TYPE_REQUEST) { + /* Selectors */ + offset = dissect_PNDCP_Option(tvb, offset, pinfo, + tree, dcp_item, hf_pn_dcp_option, TRUE /* append_col */); + } else { + offset = dissect_PNDCP_Block(tvb, offset, pinfo, tree, dcp_item, service_id, is_response); + } + /* prevent an infinite loop */ + if (offset <= ori_offset || data_length < (offset - ori_offset)) { + proto_tree_add_expert(tree, pinfo, &ei_pn_dcp_block_parse_error, + tvb, ori_offset, tvb_captured_length_remaining(tvb, ori_offset)); + break; + } + data_length -= (offset - ori_offset); + } +} + + +/* possibly dissect a PN-RT packet (frame ID must be in the appropriate range) */ +static gboolean +dissect_PNDCP_Data_heur(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, + void *data) +{ + /* the tvb will NOT contain the frame_id here, so get it from dissection data! */ + guint16 u16FrameID = GPOINTER_TO_UINT(data); + proto_item *item; + proto_tree *dcp_tree; + + + /* frame id must be in valid range (acyclic Real-Time, DCP) */ + if (u16FrameID < FRAME_ID_DCP_HELLO || u16FrameID > FRAME_ID_DCP_IDENT_RES) { + /* we are not interested in this packet */ + return FALSE; + } + + col_set_str(pinfo->cinfo, COL_PROTOCOL, "PN-DCP"); + col_clear(pinfo->cinfo, COL_INFO); + + /* subtree for DCP */ + item = proto_tree_add_protocol_format(tree, proto_pn_dcp, tvb, 0, tvb_get_ntohs(tvb, 8) + 10, + "PROFINET DCP, "); + dcp_tree = proto_item_add_subtree(item, ett_pn_dcp); + + /* dissect this PDU */ + dissect_PNDCP_PDU(tvb, pinfo, dcp_tree, item); + + return TRUE; +} + + +void +proto_register_pn_dcp (void) +{ + static hf_register_info hf[] = { + { &hf_pn_dcp_service_id, + { "ServiceID", "pn_dcp.service_id", + FT_UINT8, BASE_DEC, VALS(pn_dcp_service_id), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_service_type, + { "ServiceType", "pn_dcp.service_type", + FT_UINT8, BASE_DEC, VALS(pn_dcp_service_type), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_xid, + { "Xid", "pn_dcp.xid", + FT_UINT32, BASE_HEX, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_reserved8, + { "Reserved", "pn_dcp.reserved8", + FT_UINT8, BASE_DEC, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_reserved16, + { "Reserved", "pn_dcp.reserved16", + FT_UINT16, BASE_DEC, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_response_delay, + { "ResponseDelay", "pn_dcp.response_delay", + FT_UINT16, BASE_DEC, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_data_length, + { "DCPDataLength", "pn_dcp.data_length", + FT_UINT16, BASE_DEC, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_block_length, + { "DCPBlockLength", "pn_dcp.block_length", + FT_UINT16, BASE_DEC, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_option, + { "Option", "pn_dcp.option", + FT_UINT8, BASE_DEC, VALS(pn_dcp_option), 0x0, + NULL, HFILL }}, + +#if 0 + { &hf_pn_dcp_suboption, + { "Suboption", "pn_dcp.suboption", + FT_UINT8, BASE_DEC, NULL, 0x0, + NULL, HFILL }}, +#endif + + { &hf_pn_dcp_block_error, + { "BlockError", "pn_dcp.block_error", + FT_UINT8, BASE_DEC, VALS(pn_dcp_block_error), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_block, + { "Block", "pn_dcp.block", + FT_NONE, BASE_NONE, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_block_info, + { "BlockInfo", "pn_dcp.block_info", + FT_UINT16, BASE_DEC, VALS(pn_dcp_block_info), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_block_qualifier, + { "BlockQualifier", "pn_dcp.block_qualifier", + FT_UINT16, BASE_DEC, VALS(pn_dcp_block_qualifier), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_blockqualifier_r2f, + { "BlockQualifier: ResettoFactory", "pn_dcp.block_qualifier_reset", + FT_UINT16, BASE_DEC, VALS(pn_dcp_BlockQualifier), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_blockqualifier, + { "BlockQualifier: ResetFactorySettings", "pn_dcp.block_qualifier_reset", + FT_UINT16, BASE_DEC, VALS(pn_dcp_suboption_other), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_ip, + { "Suboption", "pn_dcp.suboption_ip", + FT_UINT8, BASE_DEC, VALS(pn_dcp_suboption_ip), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_ip_block_info, + { "BlockInfo", "pn_dcp.suboption_ip_block_info", + FT_UINT16, BASE_DEC, VALS(pn_dcp_suboption_ip_block_info), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_ip_ip, + { "IPaddress", "pn_dcp.subobtion_ip_ip", + FT_IPv4, BASE_NONE, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_ip_subnetmask, + { "Subnetmask", "pn_dcp.subobtion_ip_subnetmask", + FT_IPv4, BASE_NONE, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_ip_standard_gateway, + { "StandardGateway", "pn_dcp.suboption_ip_standard_gateway", + FT_IPv4, BASE_NONE, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device, + { "Suboption", "pn_dcp.suboption_device", + FT_UINT8, BASE_DEC, VALS(pn_dcp_suboption_device), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_typeofstation, + { "DeviceVendorValue", "pn_dcp.suboption_device_devicevendorvalue", + FT_STRING, BASE_NONE, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_nameofstation, + { "NameOfStation", "pn_dcp.suboption_device_nameofstation", + FT_STRING, BASE_NONE, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_vendor_id, + { "VendorID", "pn_dcp.suboption_vendor_id", + FT_UINT16, BASE_HEX, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_id, + { "DeviceID", "pn_dcp.suboption_device_id", + FT_UINT16, BASE_HEX, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_role, + { "DeviceRoleDetails", "pn_dcp.suboption_device_role", + FT_UINT8, BASE_HEX, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_aliasname, + { "AliasName", "pn_dcp.suboption_device_aliasname", + FT_STRING, BASE_NONE, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_instance_high, + { "DeviceInstanceHigh", "pn_dcp.suboption_device_instance", + FT_UINT8, BASE_HEX, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_instance_low, + { "DeviceInstanceLow", "pn_dcp.suboption_device_instance", + FT_UINT8, BASE_HEX, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_oem_ven_id, + { "OEMVendorID", "pn_dcp.suboption_device_oem_ven_id", + FT_UINT16, BASE_HEX, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_device_oem_dev_id, + { "OEMDeviceID", "pn_dcp.suboption_device_oem_dev_id", + FT_UINT16, BASE_HEX, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_dhcp, + { "Suboption", "pn_dcp.suboption_dhcp", + FT_UINT8, BASE_DEC, VALS(pn_dcp_suboption_dhcp), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_dhcp_device_id, + { "Device ID", "pn_dcp.suboption_dhcp_device_id", + FT_BYTES, BASE_NONE, NULL, 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_control, + { "Suboption", "pn_dcp.suboption_control", + FT_UINT8, BASE_DEC, VALS(pn_dcp_suboption_control), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_control_response, + { "Response", "pn_dcp.suboption_control_response", + FT_UINT8, BASE_DEC, VALS(pn_dcp_option), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_control_signal_value, + { "SignalValue", "pn_dcp.suboption_control_signal_value", + FT_UINT16, BASE_HEX, VALS(pn_dcp_suboption_control_signal_value), 0x0, + NULL, HFILL } }, + + { &hf_pn_dcp_suboption_deviceinitiative, + { "Suboption", "pn_dcp.suboption_deviceinitiative", + FT_UINT8, BASE_DEC, VALS(pn_dcp_suboption_deviceinitiative), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_deviceinitiative_value, + { "DeviceInitiativeValue", "pn_dcp.deviceinitiative_value", + FT_UINT16, BASE_DEC, VALS(pn_dcp_deviceinitiative_value), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_all, + { "Suboption", "pn_dcp.suboption_all", + FT_UINT8, BASE_DEC, VALS(pn_dcp_suboption_all), 0x0, + NULL, HFILL }}, + + { &hf_pn_dcp_suboption_manuf, + { "Suboption", "pn_dcp.suboption_manuf", + FT_UINT8, BASE_DEC, VALS(pn_dcp_suboption_manuf), 0x0, + NULL, HFILL }}, + + }; + + static gint *ett[] = { + &ett_pn_dcp, + &ett_pn_dcp_block + }; + + static ei_register_info ei[] = { + { &ei_pn_dcp_block_parse_error, { "pn_dcp.block_error.parse", PI_PROTOCOL, PI_ERROR, "parse error", EXPFILL }}, + { &ei_pn_dcp_block_error_unknown, { "pn_dcp.block_error.unknown", PI_RESPONSE_CODE, PI_CHAT, "Unknown", EXPFILL }}, + { &ei_pn_dcp_ip_conflict, { "pn_dcp.ip_conflict", PI_RESPONSE_CODE, PI_NOTE, "IP address conflict detected!", EXPFILL }}, + }; + + expert_module_t* expert_pn_dcp; + + proto_pn_dcp = proto_register_protocol ("PROFINET DCP", "PN-DCP", "pn_dcp"); + proto_register_field_array (proto_pn_dcp, hf, array_length (hf)); + proto_register_subtree_array (ett, array_length (ett)); + expert_pn_dcp = expert_register_protocol(proto_pn_dcp); + expert_register_field_array(expert_pn_dcp, ei, array_length(ei)); +} + +void +proto_reg_handoff_pn_dcp (void) +{ + /* register ourself as an heuristic pn-rt payload dissector */ + heur_dissector_add("pn_rt", dissect_PNDCP_Data_heur, "PROFINET DCP IO", "pn_dcp_pn_rt", proto_pn_dcp, HEURISTIC_ENABLE); +} + +/* + * Editor modelines - http://www.wireshark.org/tools/modelines.html + * + * Local variables: + * c-basic-offset: 4 + * tab-width: 8 + * indent-tabs-mode: nil + * End: + * + * vi: set shiftwidth=4 tabstop=8 expandtab: + * :indentSize=4:tabSize=8:noTabs=true: + */ |