{
/* Add service to info column */
col_append_sep_fstr(pinfo->cinfo, COL_INFO, " | ", "%s",
- val_to_str( service & 0x7F,
+ val_to_str( service & CIP_SC_MASK,
service_vals, "Unknown Service (0x%02x)") );
col_set_fence(pinfo->cinfo, COL_INFO);
}
else
{
col_append_str( pinfo->cinfo, COL_INFO,
- val_to_str(service & 0x7F,
+ val_to_str(service & CIP_SC_MASK,
service_vals, "Unknown Service (0x%02x)") );
col_set_fence(pinfo->cinfo, COL_INFO);
/* Make sure it's only set once */
static void
dissect_cip_data( proto_tree *item_tree, tvbuff_t *tvb, int offset, packet_info *pinfo, cip_req_info_t *preq_info );
-static attribute_info_t* cip_get_attribute(guint class_id, guint instance, guint attribute)
+attribute_info_t* cip_get_attribute(guint class_id, guint instance, guint attribute)
{
size_t i, j;
attribute_val_array_t* att_array;
unsigned char add_stat_size;
guint8 service = tvb_get_guint8( tvb, offset );
- if (service & 0x80)
+ if (service & CIP_SC_RESPONSE_MASK)
{
/* Response message */
add_stat_size = tvb_get_guint8( tvb, offset+3 ) * 2;
int req_path_size,
offset = 0;
proto_tree *cmd_data_tree;
- guint8 service = tvb_get_guint8( tvb, offset ) & 0x7F;
+ guint8 service = tvb_get_guint8( tvb, offset ) & CIP_SC_MASK;
add_cip_service_to_info_column(pinfo, service, cip_sc_vals);
cip_simple_request_info_t req_data;
int offset = 0,
item_length = tvb_length(tvb);
- guint8 service = tvb_get_guint8( tvb, offset ) & 0x7F,
+ guint8 service = tvb_get_guint8( tvb, offset ) & CIP_SC_MASK,
add_stat_size = tvb_get_guint8( tvb, offset+3 ) * 2;
/* If there is any command specific data create a sub-tree for it */
/* Special handling for Unconnected send response. If successful, embedded service code is sent.
* If failed, it can be either an Unconnected send response or the embedded service code response. */
preq_info = (cip_req_info_t*)p_get_proto_data(wmem_file_scope(), pinfo, proto_cip, 0 );
- if ( preq_info != NULL && ( service & 0x80 )
+ if ( preq_info != NULL && ( service & CIP_SC_RESPONSE_MASK )
&& preq_info->bService == SC_CM_UNCON_SEND
)
{
else
add_status = 0;
if( gen_status == 0 /* success response ) */
- || ( ( service & 0x7F ) != SC_CM_UNCON_SEND )
+ || ( ( service & CIP_SC_MASK ) != SC_CM_UNCON_SEND )
|| !( ( gen_status == CI_GRC_FAILURE && (add_status == CM_ES_UNCONNECTED_REQUEST_TIMED_OUT ||
add_status == CM_ES_PORT_NOT_AVAILABLE ||
add_status == CM_ES_LINK_ADDRESS_NOT_VALID ||
/* watch for service collisions */
proto_item_append_text( rrsc_item, "%s (%s)",
- val_to_str( ( service & 0x7F ),
+ val_to_str( ( service & CIP_SC_MASK ),
cip_sc_vals_cm , "Unknown Service (0x%02x)"),
- val_to_str_const( ( service & 0x80 )>>7,
+ val_to_str_const( ( service & CIP_SC_RESPONSE_MASK )>>7,
cip_sc_rr, "") );
/* Add Service code */
proto_tree_add_item(rrsc_tree, hf_cip_cm_sc, tvb, offset, 1, ENC_LITTLE_ENDIAN );
- if( service & 0x80 )
+ if( service & CIP_SC_RESPONSE_MASK )
{
/* Response message */
gen_status = tvb_get_guint8( tvb, offset+2 );
if( gen_status == CI_GRC_SUCCESS || gen_status == CI_GRC_SERVICE_ERROR )
{
/* Success responses */
- switch (service & 0x7F)
+ switch (service & CIP_SC_MASK)
{
case SC_CM_FWD_OPEN:
case SC_CM_LARGE_FWD_OPEN:
else
{
/* Error responses */
- switch (service & 0x7F)
+ switch (service & CIP_SC_MASK)
{
case SC_CM_FWD_OPEN:
case SC_CM_LARGE_FWD_OPEN:
proto_tree_add_item( rrsc_tree, hf_cip_reqrsp, tvb, offset, 1, ENC_LITTLE_ENDIAN );
proto_item_append_text( rrsc_item, "%s (%s)",
- val_to_str( ( service & 0x7F ),
+ val_to_str( ( service & CIP_SC_MASK ),
cip_sc_vals_mb , "Unknown Service (0x%02x)"),
- val_to_str_const( ( service & 0x80 )>>7,
+ val_to_str_const( ( service & CIP_SC_RESPONSE_MASK )>>7,
cip_sc_rr, "") );
/* Add Service code */
proto_tree_add_item(rrsc_tree, hf_cip_mb_sc, tvb, offset, 1, ENC_LITTLE_ENDIAN );
- if( service & 0x80 )
+ if( service & CIP_SC_RESPONSE_MASK )
{
/* Response message */
gen_status = tvb_get_guint8( tvb, offset+2 );
if( gen_status == CI_GRC_SUCCESS || gen_status == CI_GRC_SERVICE_ERROR )
{
/* Success responses */
- switch (service & 0x7F)
+ switch (service & CIP_SC_MASK)
{
case SC_MB_READ_DISCRETE_INPUTS:
proto_tree_add_item(cmd_data_tree, hf_cip_mb_read_discrete_inputs_data, tvb, offset+4+add_stat_size, item_length-4-add_stat_size, ENC_NA);
proto_tree_add_item( rrsc_tree, hf_cip_reqrsp, tvb, offset, 1, ENC_LITTLE_ENDIAN );
proto_item_append_text( rrsc_item, "%s (%s)",
- val_to_str( ( service & 0x7F ),
+ val_to_str( ( service & CIP_SC_MASK ),
cip_sc_vals_cco , "Unknown Service (0x%02x)"),
- val_to_str_const( ( service & 0x80 )>>7,
+ val_to_str_const( ( service & CIP_SC_RESPONSE_MASK )>>7,
cip_sc_rr, "") );
/* Add Service code */
req_data.iMember = (guint32)-1;
}
- if(service & 0x80 )
+ if(service & CIP_SC_RESPONSE_MASK )
{
/* Response message */
if( gen_status == CI_GRC_SUCCESS || gen_status == CI_GRC_SERVICE_ERROR )
{
/* Success responses */
- if (((service & 0x7F) == SC_GET_ATT_ALL) &&
+ if (((service & CIP_SC_MASK) == SC_GET_ATT_ALL) &&
(req_data.iInstance != (guint32)-1))
{
if (req_data.iInstance == 0)
int offset = 0;
service = tvb_get_guint8( tvb, offset );
- service_code = service & 0x7F;
+ service_code = service & CIP_SC_MASK;
/* Handle GetAttributeAll and SetAttributeAll in CCO class */
if ((service_code == SC_GET_ATT_ALL) ||
(service_code == SC_SET_ATT_ALL))
{
- if (service & 0x80)
+ if (service & CIP_SC_RESPONSE_MASK)
{
/* Service response */
preq_info = (cip_req_info_t*)p_get_proto_data(wmem_file_scope(), pinfo, proto_cip, 0);
/* Add Service code & Request/Response tree */
rrsc_item = proto_tree_add_uint_format_value(cip_tree, hf_cip_service,
tvb, offset, 1, service, "%s (%s)",
- val_to_str( ( service & 0x7F ), cip_sc_vals , "Unknown Service (0x%02x)"),
- val_to_str_const( ( service & 0x80 )>>7, cip_sc_rr, ""));
+ val_to_str( ( service & CIP_SC_MASK ), cip_sc_vals , "Unknown Service (0x%02x)"),
+ val_to_str_const( ( service & CIP_SC_RESPONSE_MASK )>>7, cip_sc_rr, ""));
rrsc_tree = proto_item_add_subtree( rrsc_item, ett_rrsc );
proto_tree_add_item( rrsc_tree, hf_cip_reqrsp, tvb, offset, 1, ENC_LITTLE_ENDIAN);
proto_tree_add_item(rrsc_tree, hf_cip_service_code, tvb, offset, 1, ENC_LITTLE_ENDIAN);
- if( service & 0x80 )
+ if( service & CIP_SC_RESPONSE_MASK )
{
/* Response message */
status_item = proto_tree_add_text( cip_tree, tvb, offset+2, 1, "Status: " );
if( preq_info
- && !( preq_info->bService == ( service & 0x7F )
+ && !( preq_info->bService == ( service & CIP_SC_MASK )
|| ( preq_info->bService == SC_CM_UNCON_SEND && preq_info->dissector == cip_class_cm_handle )
)
)
}
/* Check to see if service is 'generic' */
- try_val_to_str_idx((service & 0x7F), cip_sc_vals, &service_index);
+ try_val_to_str_idx((service & CIP_SC_MASK), cip_sc_vals, &service_index);
if (service_index >= 0)
{
/* See if object dissector wants to override generic service handling */
static hf_register_info hf[] = {
{ &hf_cip_service, { "Service", "cip.service", FT_UINT8, BASE_HEX, NULL, 0, "Service Code + Request/Response", HFILL }},
- { &hf_cip_reqrsp, { "Request/Response", "cip.rr", FT_UINT8, BASE_HEX, VALS(cip_sc_rr), 0x80, "Request or Response message", HFILL }},
- { &hf_cip_service_code, { "Service", "cip.sc", FT_UINT8, BASE_HEX, VALS(cip_sc_vals), 0x7F, "Service Code", HFILL }},
+ { &hf_cip_reqrsp, { "Request/Response", "cip.rr", FT_UINT8, BASE_HEX, VALS(cip_sc_rr), CIP_SC_RESPONSE_MASK, "Request or Response message", HFILL }},
+ { &hf_cip_service_code, { "Service", "cip.sc", FT_UINT8, BASE_HEX, VALS(cip_sc_vals), CIP_SC_MASK, "Service Code", HFILL }},
{ &hf_cip_epath, { "EPath", "cip.epath", FT_BYTES, BASE_NONE, NULL, 0, NULL, HFILL }},
{ &hf_cip_genstat, { "General Status", "cip.genstat", FT_UINT8, BASE_HEX|BASE_EXT_STRING, &cip_gs_vals_ext, 0, NULL, HFILL }},
{ &hf_cip_addstat_size, { "Additional Status Size", "cip.addstat_size", FT_UINT8, BASE_DEC, NULL, 0, NULL, HFILL }},
};
static hf_register_info hf_cm[] = {
- { &hf_cip_cm_sc, { "Service", "cip.cm.sc", FT_UINT8, BASE_HEX, VALS(cip_sc_vals_cm), 0x7F, NULL, HFILL }},
+ { &hf_cip_cm_sc, { "Service", "cip.cm.sc", FT_UINT8, BASE_HEX, VALS(cip_sc_vals_cm), CIP_SC_MASK, NULL, HFILL }},
{ &hf_cip_cm_genstat, { "General Status", "cip.cm.genstat", FT_UINT8, BASE_HEX|BASE_EXT_STRING, &cip_gs_vals_ext, 0, NULL, HFILL }},
{ &hf_cip_cm_addstat_size, { "Additional Status Size", "cip.cm.addstat_size", FT_UINT8, BASE_DEC, NULL, 0, NULL, HFILL }},
{ &hf_cip_cm_ext_status, { "Extended Status", "cip.cm.ext_status", FT_UINT16, BASE_HEX|BASE_EXT_STRING, &cip_cm_ext_st_vals_ext, 0, NULL, HFILL }},
};
static hf_register_info hf_mb[] = {
- { &hf_cip_mb_sc, { "Service", "cip.mb.sc", FT_UINT8, BASE_HEX, VALS(cip_sc_vals_mb), 0x7F, NULL, HFILL }},
+ { &hf_cip_mb_sc, { "Service", "cip.mb.sc", FT_UINT8, BASE_HEX, VALS(cip_sc_vals_mb), CIP_SC_MASK, NULL, HFILL }},
{ &hf_cip_mb_read_coils_start_addr, { "Starting Address", "cip.mb.read_coils.start_addr", FT_UINT16, BASE_DEC, NULL, 0, NULL, HFILL }},
{ &hf_cip_mb_read_coils_num_coils, { "Quantity of Coils", "cip.mb.read_coils.num_coils", FT_UINT16, BASE_DEC, NULL, 0, NULL, HFILL }},
{ &hf_cip_mb_read_coils_data, { "Data", "cip.mb.read_coils.data", FT_BYTES, BASE_NONE, NULL, 0, NULL, HFILL }},
};
static hf_register_info hf_cco[] = {
- { &hf_cip_cco_sc, { "Service", "cip.cco.sc", FT_UINT8, BASE_HEX, VALS(cip_sc_vals_cco), 0x7F, NULL, HFILL }},
+ { &hf_cip_cco_sc, { "Service", "cip.cco.sc", FT_UINT8, BASE_HEX, VALS(cip_sc_vals_cco), CIP_SC_MASK, NULL, HFILL }},
{ &hf_cip_cco_format_number, { "Format Number", "cip.cco.format_number", FT_UINT16, BASE_DEC, NULL, 0, NULL, HFILL }},
{ &hf_cip_cco_edit_signature, { "Edit Signature", "cip.cco.edit_signature", FT_UINT32, BASE_HEX, NULL, 0, NULL, HFILL }},
{ &hf_cip_cco_con_flags, { "Connection Flags", "cip.cco.connflags", FT_UINT16, BASE_HEX, NULL, 0, NULL, HFILL }},
--- /dev/null
+/* packet-devicenet.c\r
+ * Routines for dissection of DeviceNet\r
+ *\r
+ * Michael Mann\r
+ * Erik Ivarsson <eriki@student.chalmers.se>\r
+ * Hans-Jorgen Gunnarsson <hag@hms.se>\r
+ * Copyright 2012\r
+ *\r
+ * $Id: packet-devicenet.c 39503 2011-10-21 02:10:19Z wmeier $\r
+ *\r
+ * Wireshark - Network traffic analyzer\r
+ * By Gerald Combs <gerald@wireshark.org>\r
+ * Copyright 1998 Gerald Combs\r
+ *\r
+ * This program is free software; you can redistribute it and/or\r
+ * modify it under the terms of the GNU General Public License\r
+ * as published by the Free Software Foundation; either version 2\r
+ * of the License, or (at your option) any later version.\r
+ *\r
+ * This program is distributed in the hope that it will be useful,\r
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
+ * GNU General Public License for more details.\r
+ *\r
+ * You should have received a copy of the GNU General Public License\r
+ * along with this program; if not, write to the Free Software\r
+ * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.\r
+ */\r
+#include "config.h"\r
+\r
+#include <glib.h>\r
+\r
+#include <epan/packet.h>\r
+#include <epan/uat.h>\r
+#include <epan/prefs.h>\r
+#include <epan/expert.h>\r
+#include <epan/reassemble.h>\r
+#include "packet-cip.h"\r
+\r
+#define DEVICENET_CANID_MASK 0x7FF\r
+#define MESSAGE_GROUP_1_ID 0x3FF\r
+#define MESSAGE_GROUP_1_MSG_MASK 0x3C0\r
+#define MESSAGE_GROUP_1_MAC_ID_MASK 0x03F\r
+\r
+#define MESSAGE_GROUP_2_ID 0x5FF\r
+#define MESSAGE_GROUP_2_MSG_MASK 0x007\r
+#define MESSAGE_GROUP_2_MAC_ID_MASK 0x1F8\r
+\r
+#define MESSAGE_GROUP_3_ID 0x7BF\r
+#define MESSAGE_GROUP_3_MSG_MASK 0x1C0\r
+#define MESSAGE_GROUP_3_MAC_ID_MASK 0x03F\r
+#define MESSAGE_GROUP_3_FRAG_MASK 0x80\r
+#define MESSAGE_GROUP_3_XID_MASK 0x40\r
+\r
+#define MESSAGE_GROUP_4_ID 0x7EF\r
+#define MESSAGE_GROUP_4_MSG_MASK 0x03F\r
+\r
+static int proto_devicenet = -1;\r
+\r
+static int hf_devicenet_can_id = -1;\r
+static int hf_devicenet_src_mac_id = -1;\r
+static int hf_devicenet_data = -1;\r
+static int hf_devicenet_grp_msg1_id = -1;\r
+static int hf_devicenet_grp_msg2_id = -1;\r
+static int hf_devicenet_grp_msg3_id = -1;\r
+static int hf_devicenet_grp_msg3_frag = -1;\r
+static int hf_devicenet_grp_msg3_xid = -1;\r
+static int hf_devicenet_grp_msg3_dest_mac_id = -1;\r
+static int hf_devicenet_grp_msg4_id = -1;\r
+static int hf_devicenet_rr_bit = -1;\r
+static int hf_devicenet_service_code = -1;\r
+static int hf_devicenet_connection_id = -1;\r
+static int hf_devicenet_open_exp_src_message_id = -1;\r
+static int hf_devicenet_open_exp_dest_message_id = -1;\r
+static int hf_devicenet_open_exp_msg_req_body_format = -1;\r
+static int hf_devicenet_open_exp_msg_actual_body_format = -1;\r
+static int hf_devicenet_open_exp_group_select = -1;\r
+static int hf_devicenet_open_exp_msg_reserved = -1;\r
+static int hf_devicenet_dup_mac_id_rr_bit = -1;\r
+static int hf_devicenet_dup_mac_id_physical_port_number = -1;\r
+static int hf_devicenet_dup_mac_id_serial_number = -1;\r
+static int hf_devicenet_dup_mac_id_vendor = -1;\r
+static int hf_devicenet_comm_fault_rsv = -1;\r
+static int hf_devicenet_comm_fault_match = -1;\r
+static int hf_devicenet_comm_fault_value = -1;\r
+static int hf_devicenet_offline_ownership_reserved = -1;\r
+static int hf_devicenet_offline_ownership_client_mac_id = -1;\r
+static int hf_devicenet_offline_ownership_allocate = -1;\r
+static int hf_devicenet_vendor = -1;\r
+static int hf_devicenet_serial_number = -1;\r
+static int hf_devicenet_class8 = -1;\r
+static int hf_devicenet_class16 = -1;\r
+static int hf_devicenet_instance8 = -1;\r
+static int hf_devicenet_instance16 = -1;\r
+static int hf_devicenet_fragment_type = -1;\r
+static int hf_devicenet_fragment_count = -1;\r
+\r
+static gint ett_devicenet = -1;\r
+static gint ett_devicenet_can = -1;\r
+static gint ett_devicenet_contents = -1;\r
+static gint ett_devicenet_8_8 = -1;\r
+static gint ett_devicenet_8_16 = -1;\r
+static gint ett_devicenet_16_8 = -1;\r
+static gint ett_devicenet_16_16 = -1;\r
+\r
+static expert_field ei_devicenet_invalid_service = EI_INIT;\r
+static expert_field ei_devicenet_invalid_can_id = EI_INIT;\r
+static expert_field ei_devicenet_invalid_msg_id = EI_INIT;\r
+static expert_field ei_devicenet_frag_not_supported = EI_INIT;\r
+\r
+enum node_behavior {\r
+ NODE_BEHAVIOR_8_8 = 0,\r
+ NODE_BEHAVIOR_8_16 = 1,\r
+ NODE_BEHAVIOR_16_8 = 2,\r
+ NODE_BEHAVIOR_16_16 = 3\r
+};\r
+\r
+/* UAT entry structure. */\r
+typedef struct {\r
+ guint mac_id;\r
+ enum node_behavior behavior;\r
+\r
+} uat_devicenet_record_t;\r
+\r
+static uat_devicenet_record_t *uat_devicenet_records = NULL;\r
+static uat_t *devicenet_uat = NULL;\r
+static guint num_devicenet_records_uat = 0;\r
+\r
+static void uat_devicenet_record_update_cb(void* r, const char** err) {\r
+ uat_devicenet_record_t* rec = (uat_devicenet_record_t *)r;\r
+\r
+ if (rec->mac_id > 63)\r
+ *err = g_strdup_printf("MAC ID must be between 0-63");\r
+}\r
+\r
+UAT_DEC_CB_DEF(uat_devicenet_records, mac_id, uat_devicenet_record_t)\r
+UAT_VS_DEF(uat_devicenet_records, behavior, uat_devicenet_record_t, enum node_behavior, NODE_BEHAVIOR_8_8, "string")\r
+\r
+static const enum_val_t bodytype_devicenet_protocol_options[] = {\r
+ { "eightovereight", "8/8", 0 },\r
+ { "eightoversixten", "8/16", 1 },\r
+ { "sixteenovereight", "16/8", 2 },\r
+ { "sixteenoversixteen", "16/16", 3 },\r
+ { NULL, NULL, 0 }\r
+};\r
+\r
+#define SC_OPEN_EXPLICIT_MESSAGE 0x4B\r
+#define SC_CLOSE_EXPLICIT_MESSAGE 0x4C\r
+#define SC_DEVICE_HEARTBEAT_MESSAGE 0x4D\r
+#define SC_DEVICE_SHUTOWN_MESSAGE 0x4E\r
+\r
+static const value_string devicenet_service_code_vals[] = {\r
+ GENERIC_SC_LIST\r
+\r
+ { SC_OPEN_EXPLICIT_MESSAGE, "Open Explicit Message Connection Request" },\r
+ { SC_CLOSE_EXPLICIT_MESSAGE, "Close Connection Request" },\r
+ { SC_DEVICE_HEARTBEAT_MESSAGE, "Device Heartbeat Message" },\r
+ { SC_DEVICE_SHUTOWN_MESSAGE, "Device Shutdown Message" },\r
+ { 0, NULL }\r
+};\r
+\r
+static const value_string devicenet_grp_msg1_vals[] = {\r
+ { 0x0300, "Slave's I/O Multicast Poll Response" },\r
+ { 0x0340, "Slave's I/O Change of State or Cyclic Message" },\r
+ { 0x0380, "Slave's I/O Bit-Strobe Response Message" },\r
+ { 0x03C0, "Slave's I/O Poll Response or COS/Cyclic Ack Message" },\r
+ { 0, NULL }\r
+};\r
+\r
+static const value_string devicenet_grp_msg2_vals[] = {\r
+ { 0x00, "Master's I/O Bit-Strobe Command Message" },\r
+ { 0x01, "Master's I/O Multicast Poll Group ID" },\r
+ { 0x02, "Master's Change of State or Cyclic Acknowledge Message" },\r
+ { 0x03, "Slave's Explicit/Unconnected Response Messages" },\r
+ { 0x04, "Master's Explicit Request Messages" },\r
+ { 0x05, "Master's I/O Poll Command/COS/Cyclic Messages" },\r
+ { 0x06, "Group 2 Only Unconnected Explicit Request Messages" },\r
+ { 0x07, "Duplicate MAC ID Check Messages" },\r
+ { 0, NULL }\r
+};\r
+\r
+static const value_string devicenet_grp_msg3_vals[] = {\r
+ { 0x000, "Group 3 Message" },\r
+ { 0x040, "Group 3 Message" },\r
+ { 0x080, "Group 3 Message" },\r
+ { 0x0C0, "Group 3 Message" },\r
+ { 0x100, "Group 3 Message" },\r
+ { 0x140, "Unconnected Explicit Response Message" },\r
+ { 0x180, "Unconnected Explicit Request Message" },\r
+ { 0x1C0, "Invalid Group 3 Message" },\r
+ { 0, NULL }\r
+};\r
+\r
+#define GRP4_COMM_FAULT_RESPONSE 0x2C\r
+#define GRP4_COMM_FAULT_REQUEST 0x2D\r
+#define GRP4_OFFLINE_OWNER_RESPONSE 0x2E\r
+#define GRP4_OFFLINE_OWNER_REQUEST 0x2F\r
+\r
+static const value_string devicenet_grp_msg4_vals[] = {\r
+ { GRP4_COMM_FAULT_RESPONSE, "Communication Faulted Response Message" },\r
+ { GRP4_COMM_FAULT_REQUEST, "Communication Faulted Request Message" },\r
+ { GRP4_OFFLINE_OWNER_RESPONSE, "Offline Ownership Response Message" },\r
+ { GRP4_OFFLINE_OWNER_REQUEST, "Offline Ownership Request Message" },\r
+ { 0, NULL }\r
+};\r
+\r
+static const value_string devicenet_message_body_format_vals[] = {\r
+ { 0x00, "DeviceNet 8/8. Class ID = 8 bit integer, Instance ID = 8 bit integer" },\r
+ { 0x01, "DeviceNet 8/16. Class ID = 8 bit integer, Instance ID = 16 bit integer" },\r
+ { 0x02, "DeviceNet 16/16. Class ID = 16 bit integer. Instance ID = 16 bit integer" },\r
+ { 0x03, "DeviceNet 16/8. Class ID = 16 bit integer. Instance ID = 8 bit integer" },\r
+ { 0x04, "CIP Path. The addressing size is variable and is provided as a Packed EPATH on each request" },\r
+ { 0x05, "Reserved by DeviceNet" },\r
+ { 0x06, "Reserved by DeviceNet" },\r
+ { 0x07, "Reserved by DeviceNet" },\r
+ { 0x08, "Reserved by DeviceNet" },\r
+ { 0x09, "Reserved by DeviceNet" },\r
+ { 0x0A, "Reserved by DeviceNet" },\r
+ { 0x0B, "Reserved by DeviceNet" },\r
+ { 0x0C, "Reserved by DeviceNet" },\r
+ { 0x0D, "Reserved by DeviceNet" },\r
+ { 0x0E, "Reserved by DeviceNet" },\r
+ { 0x0F, "Reserved by DeviceNet" },\r
+ { 0, NULL }\r
+};\r
+\r
+static const value_string devicenet_group_select_vals[] = {\r
+ { 0x00, "Message Group 1" },\r
+ { 0x01, "Message Group 2" },\r
+ { 0x02, "Reserved" },\r
+ { 0x03, "Message Group 3" },\r
+ { 0x04, "Reserved by DeviceNet" },\r
+ { 0x05, "Reserved by DeviceNet" },\r
+ { 0x06, "Reserved by DeviceNet" },\r
+ { 0x07, "Reserved by DeviceNet" },\r
+ { 0x08, "Reserved by DeviceNet" },\r
+ { 0x09, "Reserved by DeviceNet" },\r
+ { 0x0A, "Reserved by DeviceNet" },\r
+ { 0x0B, "Reserved by DeviceNet" },\r
+ { 0x0C, "Reserved by DeviceNet" },\r
+ { 0x0D, "Reserved by DeviceNet" },\r
+ { 0x0E, "Reserved by DeviceNet" },\r
+ { 0x0F, "Reserved by Node Ping" },\r
+ { 0, NULL }\r
+};\r
+\r
+static const value_string devicenet_fragmented_message_type_vals[] = {\r
+ { 0, "First Fragment" },\r
+ { 0x40, "Middle fragment" },\r
+ { 0x80, "Last fragment" },\r
+ { 0xC0, "Fragment Acknowledge" },\r
+ { 0, NULL }\r
+};\r
+\r
+static const value_string devicenet_io_attribute_vals[] = {\r
+ {0x01, "Vendor ID"},\r
+ {0x02, "Device Type"},\r
+ {0x03, "Product Code"},\r
+ {0x04, "Revision"},\r
+ {0x05, "Status"},\r
+ {0x06, "Serial Number"},\r
+ {0x07, "Product Name"},\r
+ { 0, NULL }\r
+};\r
+\r
+static gint body_type_8_over_8_dissection(guint8 data_length, proto_tree *devicenet_tree,\r
+ tvbuff_t *tvb, packet_info *pinfo, gint offset)\r
+{\r
+ proto_item *devicenet_8_8;\r
+ guint16 class_id, instance, attribute;\r
+ attribute_info_t* att_info;\r
+ gint start_offset = offset, length;\r
+\r
+ devicenet_8_8 = proto_tree_add_text(devicenet_tree, tvb, offset, -1, "DeviceNet 8/8");\r
+ devicenet_tree = proto_item_add_subtree(devicenet_8_8, ett_devicenet_8_8);\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_class8, tvb, offset, 1, ENC_LITTLE_ENDIAN);\r
+ class_id = tvb_get_guint8(tvb, offset);\r
+ offset++;\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_instance8, tvb, offset, 1, ENC_LITTLE_ENDIAN);\r
+ instance = tvb_get_guint8(tvb, offset);\r
+\r
+ offset++;\r
+ if (data_length > 3)\r
+ {\r
+ attribute = tvb_get_guint8(tvb, offset);\r
+ att_info = cip_get_attribute(class_id, instance, attribute);\r
+\r
+ if (att_info != NULL)\r
+ proto_tree_add_text(devicenet_tree, tvb, offset, 1, "Instance Attribute: %s", att_info->text);\r
+\r
+ offset++;\r
+ }\r
+\r
+ if (data_length > 4)\r
+ {\r
+ length = offset-start_offset;\r
+ proto_tree_add_bytes_format_value(devicenet_tree, hf_devicenet_data, tvb, offset, length,\r
+ NULL, "%s", tvb_bytes_to_str_punct(tvb, offset, length, ' '));\r
+ offset += length;\r
+ }\r
+ return offset;\r
+}\r
+\r
+static gint body_type_8_over_16_dissection(guint8 data_length, proto_tree *devicenet_tree,\r
+ tvbuff_t *tvb, packet_info *pinfo, gint offset)\r
+{\r
+ proto_item *devicenet_8_16;\r
+ guint16 class_id, instance, attribute;\r
+ attribute_info_t* att_info;\r
+\r
+ devicenet_8_16 = proto_tree_add_text(devicenet_tree, tvb, offset, -1, "DeviceNet 8/16");\r
+ devicenet_tree = proto_item_add_subtree(devicenet_8_16, ett_devicenet_8_16);\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_class8, tvb, offset, 1, ENC_LITTLE_ENDIAN);\r
+ class_id = tvb_get_guint8(tvb, offset);\r
+ offset++;\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_instance16, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ instance = tvb_get_letohs(tvb, offset);\r
+\r
+ if (data_length > 4)\r
+ {\r
+ attribute = tvb_get_guint8(tvb, offset);\r
+ att_info = cip_get_attribute(class_id, instance, attribute);\r
+\r
+ if (att_info != NULL)\r
+ proto_tree_add_text(devicenet_tree, tvb, offset, 1, "Instance Attribute: %s", att_info->text);\r
+\r
+ offset++;\r
+ }\r
+\r
+ return offset;\r
+}\r
+\r
+static gint body_type_16_over_8_dissection(guint8 data_length, proto_tree *devicenet_tree, tvbuff_t *tvb,\r
+ packet_info *pinfo, gint offset)\r
+{\r
+ proto_item *devicenet_16_8;\r
+ guint16 class_id, instance, attribute;\r
+ attribute_info_t* att_info;\r
+ \r
+ devicenet_16_8 = proto_tree_add_text(devicenet_tree, tvb, offset, -1, "DeviceNet 16/8");\r
+ devicenet_tree = proto_item_add_subtree(devicenet_16_8, ett_devicenet_16_8);\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_class16, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ class_id = tvb_get_letohs(tvb, offset);\r
+ offset += 2;\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_instance8, tvb, offset, 1, ENC_LITTLE_ENDIAN);\r
+ instance = tvb_get_guint8(tvb, offset);\r
+ offset++;\r
+\r
+ if (data_length > 4)\r
+ {\r
+ attribute = tvb_get_guint8(tvb, offset);\r
+ att_info = cip_get_attribute(class_id, instance, attribute);\r
+\r
+ if (att_info != NULL)\r
+ proto_tree_add_text(devicenet_tree, tvb, offset, 1, "Instance Attribute: %s" ,att_info->text);\r
+\r
+ offset++;\r
+ }\r
+\r
+ return offset;\r
+}\r
+\r
+static gint body_type_16_over_16_dissection(guint8 data_length, proto_tree *devicenet_tree, tvbuff_t *tvb,\r
+ packet_info *pinfo, gint offset)\r
+{\r
+ proto_item *devicenet_16_16;\r
+\r
+ guint16 class_id, instance, attribute;\r
+ attribute_info_t* att_info;\r
+\r
+ devicenet_16_16 = proto_tree_add_text(devicenet_tree, tvb, offset, 4, "DeviceNet 16/16");\r
+ devicenet_tree = proto_item_add_subtree(devicenet_16_16, ett_devicenet_16_16);\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_class16, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ class_id = tvb_get_letohs(tvb, offset);\r
+ offset += 2;\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_instance16, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ instance = tvb_get_letohs(tvb, offset);\r
+ offset+=2;\r
+\r
+ if (data_length > 5)\r
+ {\r
+ attribute = tvb_get_guint8(tvb, offset);\r
+ att_info = cip_get_attribute(class_id, instance, attribute);\r
+\r
+ if (att_info != NULL)\r
+ proto_tree_add_text(devicenet_tree, tvb, offset, 1, "Instance Attribute: %s" ,att_info->text);\r
+\r
+ offset++;\r
+ }\r
+\r
+ return offset;\r
+}\r
+\r
+struct can_identifier\r
+{\r
+ guint32 id;\r
+};\r
+\r
+static int dissect_devicenet(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data)\r
+{\r
+ proto_item *ti, *can_id_item, *devicenet_contents,\r
+ *msg_id_item, *service_item;\r
+ proto_tree *devicenet_tree, *can_tree, *content_tree;\r
+\r
+ gint offset = 0;\r
+ guint16 message_id;\r
+ guint32 data_length = tvb_reported_length(tvb);\r
+ guint8 source_mac;\r
+ struct can_identifier can_id;\r
+ guint8 service_rr;\r
+ guint8 *src_address, *dest_address;\r
+\r
+ DISSECTOR_ASSERT(data);\r
+ can_id = *((struct can_identifier*)data);\r
+\r
+ if (can_id.id & (~DEVICENET_CANID_MASK))\r
+ {\r
+ /* Not for us */\r
+ return 0;\r
+ }\r
+\r
+ col_set_str(pinfo->cinfo, COL_PROTOCOL, "DeviceNet");\r
+\r
+ ti = proto_tree_add_item(tree, proto_devicenet, tvb, offset, -1, ENC_NA);\r
+ devicenet_tree = proto_item_add_subtree(ti, ett_devicenet);\r
+\r
+ ti = proto_tree_add_text(devicenet_tree, tvb, 0, 0, "CAN Identifier: 0x%04x", can_id.id);\r
+ can_tree = proto_item_add_subtree(ti, ett_devicenet_can);\r
+ can_id_item = proto_tree_add_uint(can_tree, hf_devicenet_can_id, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(can_id_item);\r
+\r
+ /*\r
+ * Message group 1\r
+ */\r
+ if ( can_id.id <= MESSAGE_GROUP_1_ID )\r
+ {\r
+ ti = proto_tree_add_uint(can_tree, hf_devicenet_grp_msg1_id, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ ti = proto_tree_add_uint(can_tree, hf_devicenet_src_mac_id, tvb, 0, 0, can_id.id & MESSAGE_GROUP_1_MAC_ID_MASK);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+\r
+ /* Set source address */\r
+ src_address = (guint8*)wmem_alloc(pinfo->pool, 1);\r
+ *src_address = (guint8)(can_id.id & MESSAGE_GROUP_1_MAC_ID_MASK);\r
+ SET_ADDRESS(&pinfo->src, AT_DEVICENET, 1, (const void*)src_address);\r
+\r
+ message_id = can_id.id & MESSAGE_GROUP_1_MSG_MASK;\r
+ col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(message_id, devicenet_grp_msg1_vals, "Other Group 1 Message"));\r
+\r
+ proto_tree_add_bytes_format_value(devicenet_tree, hf_devicenet_data, tvb, offset, data_length,\r
+ NULL, "%s", tvb_bytes_to_str_punct(tvb, offset, data_length, ' '));\r
+ }\r
+ /*\r
+ * Message group 2\r
+ */\r
+ else if (can_id.id <= MESSAGE_GROUP_2_ID )\r
+ {\r
+ ti = proto_tree_add_uint(can_tree, hf_devicenet_grp_msg2_id, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+\r
+ /* create display subtree for the protocol */\r
+ message_id = can_id.id & MESSAGE_GROUP_2_MSG_MASK;\r
+ col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(message_id, devicenet_grp_msg2_vals, "Unknown"));\r
+\r
+ ti = proto_tree_add_uint(can_tree, hf_devicenet_src_mac_id, tvb, 0, 0, (can_id.id & MESSAGE_GROUP_2_MAC_ID_MASK) >> 3);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+\r
+ /* Set source address */\r
+ src_address = (guint8*)wmem_alloc(pinfo->pool, 1);\r
+ *src_address = (guint8)((can_id.id & MESSAGE_GROUP_2_MAC_ID_MASK) >> 3);\r
+ SET_ADDRESS(&pinfo->src, AT_DEVICENET, 1, (const void*)src_address);\r
+\r
+ devicenet_contents = proto_tree_add_text(devicenet_tree, tvb, offset, -1, "Contents");\r
+ content_tree = proto_item_add_subtree(devicenet_contents, ett_devicenet_contents);\r
+\r
+ switch (message_id)\r
+ {\r
+ case 0x0:\r
+ case 0x1:\r
+ case 0x2:\r
+ case 0x3:\r
+ case 0x4:\r
+ case 0x5:\r
+ proto_tree_add_bytes_format_value(content_tree, hf_devicenet_data, tvb, offset, data_length,\r
+ NULL, "%s", tvb_bytes_to_str_punct(tvb, offset, data_length, ' '));\r
+ break;\r
+\r
+ case 0x6:\r
+ proto_tree_add_bytes_format_value(content_tree, hf_devicenet_data, tvb, offset, data_length,\r
+ NULL, "%s", tvb_bytes_to_str_punct(tvb, offset, data_length, ' '));\r
+ break;\r
+\r
+ case 0x7:\r
+ proto_tree_add_item(content_tree, hf_devicenet_dup_mac_id_rr_bit, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(content_tree, hf_devicenet_dup_mac_id_physical_port_number, tvb, offset, 1, ENC_NA);\r
+ offset ++; \r
+\r
+ proto_tree_add_item(content_tree, hf_devicenet_dup_mac_id_vendor, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ offset+=2; \r
+\r
+ proto_tree_add_item(content_tree, hf_devicenet_dup_mac_id_serial_number, tvb, offset, 4, ENC_LITTLE_ENDIAN);\r
+ break;\r
+ }\r
+ }\r
+ /*\r
+ * Message group 3\r
+ */\r
+ else if (can_id.id <= MESSAGE_GROUP_3_ID )\r
+ {\r
+ guint8 byte1;\r
+\r
+ msg_id_item = proto_tree_add_uint(can_tree, hf_devicenet_grp_msg3_id, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(msg_id_item);\r
+ ti = proto_tree_add_uint(can_tree, hf_devicenet_src_mac_id, tvb, 0, 0, can_id.id & MESSAGE_GROUP_3_MAC_ID_MASK);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+\r
+ /* Set source address */\r
+ src_address = (guint8*)wmem_alloc(pinfo->pool, 1);\r
+ *src_address = (guint8)(can_id.id & MESSAGE_GROUP_3_MAC_ID_MASK);\r
+ SET_ADDRESS(&pinfo->src, AT_DEVICENET, 1, (const void*)src_address);\r
+\r
+ message_id = can_id.id & MESSAGE_GROUP_3_MSG_MASK;\r
+ col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(message_id, devicenet_grp_msg3_vals, "Unknown"));\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_grp_msg3_frag, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_grp_msg3_xid, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_grp_msg3_dest_mac_id, tvb, offset, 1, ENC_NA);\r
+ byte1 = tvb_get_guint8(tvb, offset);\r
+ source_mac = byte1 & MESSAGE_GROUP_3_MAC_ID_MASK;\r
+\r
+ /* Set destination address */\r
+ /* XXX - This may be source address depending on message type. Need to adjust accordingly) */\r
+ dest_address = (guint8*)wmem_alloc(pinfo->pool, 1);\r
+ *dest_address = (guint8)source_mac;\r
+ SET_ADDRESS(&pinfo->dst, AT_DEVICENET, 1, (const void*)dest_address);\r
+ offset++;\r
+\r
+ if (byte1 & MESSAGE_GROUP_3_FRAG_MASK)\r
+ {\r
+ col_set_str(pinfo->cinfo, COL_INFO, "Group 3 Message Fragment");\r
+\r
+ devicenet_contents = proto_tree_add_text(devicenet_tree, tvb, offset, -1, "Fragmentation");\r
+ content_tree = proto_item_add_subtree(devicenet_contents, ett_devicenet_contents);\r
+\r
+ proto_tree_add_item(content_tree, hf_devicenet_fragment_type, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(content_tree, hf_devicenet_fragment_count, tvb, offset, 1, ENC_NA);\r
+\r
+ /* TODO: Handle fragmentation */\r
+ proto_tree_add_expert(content_tree, pinfo, &ei_devicenet_frag_not_supported, tvb, offset, -1);\r
+\r
+ col_set_str(pinfo->cinfo, COL_INFO, try_val_to_str((tvb_get_guint8(tvb, offset) & 0xC0) >> 6, devicenet_fragmented_message_type_vals));\r
+ }\r
+ else\r
+ {\r
+ service_rr = tvb_get_guint8(tvb, offset);\r
+\r
+ devicenet_contents = proto_tree_add_text(devicenet_tree, tvb, offset, -1, "Service: %s (%s)",\r
+ val_to_str_const(service_rr & CIP_SC_MASK, devicenet_service_code_vals, "Unknown"),\r
+ service_rr & CIP_SC_RESPONSE_MASK ? "Response" : "Request");\r
+ content_tree = proto_item_add_subtree(devicenet_contents, ett_devicenet_contents);\r
+\r
+ proto_tree_add_item(content_tree, hf_devicenet_rr_bit, tvb, offset, 1, ENC_NA);\r
+ service_item = proto_tree_add_item(content_tree, hf_devicenet_service_code, tvb, offset, 1, ENC_NA);\r
+ offset++;\r
+\r
+ col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(service_rr & CIP_SC_MASK, devicenet_service_code_vals, "Unknown Service Code"));\r
+ if (service_rr & CIP_SC_RESPONSE_MASK)\r
+ {\r
+ col_append_str(pinfo->cinfo, COL_INFO, " - Response");\r
+ }\r
+ else\r
+ {\r
+ col_append_str(pinfo->cinfo, COL_INFO, " - Request");\r
+ }\r
+\r
+ switch(message_id)\r
+ {\r
+ case 0x140:\r
+ switch(service_rr & CIP_SC_MASK)\r
+ {\r
+ case SC_OPEN_EXPLICIT_MESSAGE:\r
+ case SC_CLOSE_EXPLICIT_MESSAGE:\r
+ case SC_DEVICE_HEARTBEAT_MESSAGE:\r
+ case SC_DEVICE_SHUTOWN_MESSAGE:\r
+ /* XXX - ERROR RESPONSE? */\r
+ break;\r
+ default:\r
+ expert_add_info_format(pinfo, service_item, &ei_devicenet_invalid_service,\r
+ "Invalid service code (0x%x) for Group 3 Messsage ID 5", service_rr & CIP_SC_MASK);\r
+ break;\r
+ }\r
+ break;\r
+ case 0x180:\r
+ switch(service_rr & CIP_SC_MASK)\r
+ {\r
+ case SC_OPEN_EXPLICIT_MESSAGE:\r
+ case SC_CLOSE_EXPLICIT_MESSAGE:\r
+ break;\r
+ default:\r
+ expert_add_info_format(pinfo, service_item, &ei_devicenet_invalid_service,\r
+ "Invalid service code (0x%x) for Group 3 Messsage ID 6", service_rr & CIP_SC_MASK);\r
+ break;\r
+ }\r
+ break;\r
+ break;\r
+ case 0x1C0:\r
+ expert_add_info_format(pinfo, msg_id_item, &ei_devicenet_invalid_msg_id,\r
+ "Invalid Group 3 Messsage ID (%d)", message_id);\r
+ break;\r
+ }\r
+\r
+ switch(service_rr & CIP_SC_MASK)\r
+ {\r
+ case SC_OPEN_EXPLICIT_MESSAGE:\r
+ /* XXX - Create conversation to track connections */\r
+ if (service_rr & CIP_SC_RESPONSE_MASK)\r
+ {\r
+ proto_tree_add_item(content_tree, hf_devicenet_open_exp_msg_reserved, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(content_tree, hf_devicenet_open_exp_msg_actual_body_format, tvb, offset, 1, ENC_NA);\r
+ offset++;\r
+ proto_tree_add_item(content_tree, hf_devicenet_open_exp_dest_message_id, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(content_tree, hf_devicenet_open_exp_src_message_id, tvb, offset, 1, ENC_NA);\r
+ offset++;\r
+ proto_tree_add_item(content_tree, hf_devicenet_connection_id, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ }\r
+ else\r
+ {\r
+ proto_tree_add_item(content_tree, hf_devicenet_open_exp_msg_reserved, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(content_tree, hf_devicenet_open_exp_msg_req_body_format, tvb, offset, 1, ENC_NA);\r
+ offset++;\r
+ proto_tree_add_item(content_tree, hf_devicenet_open_exp_group_select, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(content_tree, hf_devicenet_open_exp_src_message_id, tvb, offset, 1, ENC_NA);\r
+ }\r
+ break;\r
+ case SC_CLOSE_EXPLICIT_MESSAGE:\r
+ /* XXX - Use conversation to track connections */\r
+ if ((service_rr & CIP_SC_RESPONSE_MASK) == 0)\r
+ {\r
+ proto_tree_add_item(content_tree, hf_devicenet_connection_id, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ }\r
+ break;\r
+ default:\r
+ if(service_rr & CIP_SC_MASK)\r
+ {\r
+ proto_tree_add_bytes_format_value(devicenet_tree, hf_devicenet_data, tvb, offset, data_length - 2,\r
+ NULL, "%s", tvb_bytes_to_str_punct(tvb, offset, data_length - 2, ' '));\r
+ }\r
+ else\r
+ {\r
+ guint channel;\r
+\r
+ for (channel = 0; channel < num_devicenet_records_uat; channel++)\r
+ {\r
+ if (uat_devicenet_records[channel].mac_id == source_mac)\r
+ {\r
+ switch(uat_devicenet_records[channel].behavior)\r
+ {\r
+ case 0:\r
+ body_type_8_over_8_dissection(data_length, content_tree, tvb, pinfo, offset);\r
+ break;\r
+ case 1:\r
+ body_type_8_over_16_dissection(data_length, content_tree, tvb, pinfo, offset);\r
+ break;\r
+ case 2:\r
+ body_type_16_over_8_dissection(data_length, content_tree, tvb, pinfo, offset);\r
+ break;\r
+ case 3:\r
+ body_type_16_over_16_dissection(data_length, content_tree, tvb, pinfo, offset);\r
+ break;\r
+ default:\r
+ proto_tree_add_bytes_format_value(content_tree, hf_devicenet_data, tvb, offset, data_length,\r
+ NULL, "%s", tvb_bytes_to_str_punct(tvb, offset, data_length, ' '));\r
+ }\r
+ }\r
+ break;\r
+ }\r
+\r
+ /* Don't have a behavior defined for this address, default to 8 over 8 */\r
+ if (channel >= num_devicenet_records_uat)\r
+ {\r
+ body_type_8_over_8_dissection(data_length, content_tree, tvb, pinfo, offset);\r
+ }\r
+ }\r
+ break;\r
+ }\r
+ }\r
+ }\r
+ /*Message group 4*/\r
+ else if (can_id.id <= MESSAGE_GROUP_4_ID )\r
+ {\r
+ ti = proto_tree_add_uint(can_tree, hf_devicenet_grp_msg4_id, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+\r
+ message_id = can_id.id & MESSAGE_GROUP_4_MSG_MASK;\r
+ col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(message_id, devicenet_grp_msg4_vals, "Reserved Group 4 Message"));\r
+\r
+ switch(message_id)\r
+ {\r
+ case GRP4_COMM_FAULT_RESPONSE:\r
+ case GRP4_COMM_FAULT_REQUEST:\r
+ if(data_length == 2)\r
+ {\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_comm_fault_rsv, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_comm_fault_match, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_comm_fault_value, tvb, offset, 1, ENC_NA);\r
+ offset++;\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_rr_bit, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_service_code, tvb, offset, 1, ENC_NA);\r
+\r
+ if( tvb_get_guint8(tvb, offset) & CIP_SC_RESPONSE_MASK)\r
+ {\r
+ col_append_str(pinfo->cinfo, COL_INFO, " - Response");\r
+ }\r
+ else\r
+ {\r
+ col_append_str(pinfo->cinfo, COL_INFO, " - Request");\r
+ }\r
+ }\r
+ else if(data_length == 8)\r
+ {\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_comm_fault_rsv, tvb, offset, 1, ENC_NA);\r
+ offset++;\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_rr_bit, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_service_code, tvb, offset, 1, ENC_NA);\r
+\r
+ if( tvb_get_guint8(tvb, offset) & CIP_SC_RESPONSE_MASK)\r
+ {\r
+ col_append_str(pinfo->cinfo, COL_INFO, " - Response");\r
+ }\r
+ else\r
+ {\r
+ col_append_str(pinfo->cinfo, COL_INFO, " - Request");\r
+ }\r
+ offset++;\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_vendor, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ offset +=2;\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_serial_number, tvb, offset, 4, ENC_LITTLE_ENDIAN);\r
+ }\r
+ break;\r
+ case GRP4_OFFLINE_OWNER_REQUEST:\r
+ case GRP4_OFFLINE_OWNER_RESPONSE:\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_offline_ownership_reserved, tvb, offset, 1, ENC_NA);\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_offline_ownership_client_mac_id, tvb, offset, 1, ENC_NA);\r
+ offset++;\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_rr_bit, tvb, offset, 1, ENC_NA);\r
+\r
+ if( tvb_get_guint8(tvb, offset) & CIP_SC_RESPONSE_MASK)\r
+ {\r
+ col_append_str(pinfo->cinfo, COL_INFO, " - Response");\r
+ }\r
+ else\r
+ {\r
+ col_append_str(pinfo->cinfo, COL_INFO, " - Request");\r
+ }\r
+\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_offline_ownership_allocate, tvb, offset, 1, ENC_NA);\r
+ offset++;\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_vendor, tvb, offset, 2, ENC_LITTLE_ENDIAN);\r
+ offset +=2;\r
+ proto_tree_add_item(devicenet_tree, hf_devicenet_serial_number, tvb, offset, 4, ENC_LITTLE_ENDIAN);\r
+ break;\r
+ }\r
+ }\r
+ /*Invalid CAN message*/\r
+ else\r
+ {\r
+ col_add_fstr(pinfo->cinfo, COL_INFO, "Invalid CAN Message 0x%06X", can_id.id);\r
+ expert_add_info_format(pinfo, can_id_item, &ei_devicenet_invalid_can_id,\r
+ "Invalid CAN Message 0x%04X", can_id.id);\r
+ }\r
+\r
+ return tvb_length(tvb);\r
+}\r
+\r
+void proto_register_devicenet(void)\r
+{\r
+ module_t *devicenet_module;\r
+ expert_module_t*expert_devicenet;\r
+\r
+ static hf_register_info hf[] = {\r
+ { &hf_devicenet_can_id,\r
+ {"CAN Identifier", "devicenet.can_id",\r
+ FT_UINT16, BASE_HEX, NULL, DEVICENET_CANID_MASK,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_src_mac_id,\r
+ { "Source MAC ID", "devicenet.src_mac_id",\r
+ FT_UINT8, BASE_DEC, NULL, 0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_connection_id,\r
+ { "Connection ID", "devicenet.connection_id",\r
+ FT_UINT16, BASE_DEC, NULL, 0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_data,\r
+ { "Data", "devicenet.data",\r
+ FT_BYTES, BASE_NONE, NULL, 0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_grp_msg1_id,\r
+ { "Group 1 message ID", "devicenet.grp_msg1.id",\r
+ FT_UINT16, BASE_DEC, NULL, MESSAGE_GROUP_1_MSG_MASK,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_grp_msg2_id,\r
+ { "Group 2 message ID", "devicenet.grp_msg2.id",\r
+ FT_UINT16, BASE_DEC, NULL, MESSAGE_GROUP_2_MSG_MASK,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_grp_msg3_id,\r
+ { "Group 3 message ID", "devicenet.grp_msg3.id",\r
+ FT_UINT16, BASE_DEC, NULL, MESSAGE_GROUP_3_MSG_MASK,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_grp_msg3_dest_mac_id,\r
+ { "Destination MAC ID", "devicenet.dest_mac_id",\r
+ FT_UINT8, BASE_DEC, NULL, 0x3F,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_grp_msg3_frag,\r
+ { "Frag", "devicenet.grp_msg3.frag",\r
+ FT_BOOLEAN, 8, NULL, MESSAGE_GROUP_3_FRAG_MASK,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_grp_msg3_xid,\r
+ { "XID", "devicenet.grp_msg3.xid",\r
+ FT_BOOLEAN, 8, NULL, MESSAGE_GROUP_3_XID_MASK,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_grp_msg4_id,\r
+ { "Group 4 message ID", "devicenet.grp_msg4.id",\r
+ FT_UINT16, BASE_DEC, NULL, MESSAGE_GROUP_4_MSG_MASK,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_rr_bit,\r
+ { "Request/Response", "devicenet.rr",\r
+ FT_UINT8, BASE_DEC, VALS(cip_sc_rr), CIP_SC_RESPONSE_MASK,\r
+ "Request or Response message", HFILL }\r
+ },\r
+ { &hf_devicenet_service_code,\r
+ { "Service Code", "devicenet.service",\r
+ FT_UINT8, BASE_DEC, &devicenet_service_code_vals, CIP_SC_MASK,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_open_exp_src_message_id,\r
+ { "Source Message ID", "devicenet.open_message.src_message_id",\r
+ FT_UINT8, BASE_DEC, NULL, 0x0F,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_open_exp_dest_message_id,\r
+ { "Destination Message ID", "devicenet.open_message.dest_message_id",\r
+ FT_UINT8, BASE_DEC, NULL, 0xF0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_open_exp_msg_reserved,\r
+ { "Reserved", "devicenet.open_message.reserved",\r
+ FT_UINT8, BASE_DEC, NULL, 0xF0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_open_exp_msg_req_body_format,\r
+ { "Requested Message Body Format", "devicenet.open_message.req_body_format",\r
+ FT_UINT8, BASE_DEC, VALS(devicenet_message_body_format_vals), 0x0F,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_open_exp_msg_actual_body_format,\r
+ { "Actual Message Body Format", "devicenet.open_message.actual_body_format",\r
+ FT_UINT8, BASE_DEC, VALS(devicenet_message_body_format_vals), 0x0F,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_open_exp_group_select,\r
+ { "Group Select", "devicenet.open_message.group_select",\r
+ FT_UINT8, BASE_DEC, VALS(devicenet_group_select_vals), 0xF0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_dup_mac_id_rr_bit,\r
+ { "Request/Response", "devicenet.dup_mac_id.rr",\r
+ FT_UINT8, BASE_DEC, VALS(cip_sc_rr), CIP_SC_RESPONSE_MASK,\r
+ "Duplicate MAC ID Request or Response message", HFILL }\r
+ },\r
+ { &hf_devicenet_dup_mac_id_physical_port_number,\r
+ { "Physical port number", "devicenet.dup_mac_id.physical_port_number",\r
+ FT_UINT8, BASE_DEC, NULL, 0x7F,\r
+ "Duplicate MAC ID check message physical port number", HFILL }\r
+ },\r
+ { &hf_devicenet_dup_mac_id_vendor, \r
+ { "Vendor ID", "devicenet.dup_mac_id.vendor", \r
+ FT_UINT16, BASE_HEX|BASE_EXT_STRING, &cip_vendor_vals_ext, 0, \r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_dup_mac_id_serial_number, \r
+ { "Serial Number", "devicenet.dup_mac_id.serial_number", \r
+ FT_UINT32, BASE_HEX, NULL, 0x00,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_vendor, \r
+ { "Vendor ID", "devicenet.vendor", \r
+ FT_UINT16, BASE_HEX|BASE_EXT_STRING, &cip_vendor_vals_ext, 0, \r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_serial_number, \r
+ { "Serial Number", "devicenet.serial_number", \r
+ FT_UINT32, BASE_HEX, NULL, 0x00,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_instance8, \r
+ { "Instance", "devicenet.instance", \r
+ FT_UINT8, BASE_HEX, NULL, 0x00,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_instance16, \r
+ { "Instance", "devicenet.instance", \r
+ FT_UINT16, BASE_HEX, NULL, 0x00,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_fragment_type, \r
+ { "Fragment Type", "devicenet.fragment_type", \r
+ FT_UINT8, BASE_HEX, VALS(devicenet_fragmented_message_type_vals), 0xC0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_fragment_count, \r
+ { "Fragment Count", "devicenet.fragment_count", \r
+ FT_UINT8, BASE_HEX_DEC, NULL, 0x3F,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_class8,\r
+ { "Class", "devicenet.class",\r
+ FT_UINT8, BASE_HEX|BASE_EXT_STRING, &cip_class_names_vals_ext, 0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_class16,\r
+ { "Class", "devicenet.class",\r
+ FT_UINT16, BASE_HEX|BASE_EXT_STRING, &cip_class_names_vals_ext, 0,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_comm_fault_rsv, \r
+ { "Reserved", "devicenet.comm_fault.reserved", \r
+ FT_UINT8, BASE_HEX, NULL, 0x80,\r
+ NULL, HFILL }\r
+ },\r
+ { &hf_devicenet_comm_fault_match, \r
+ { "Match", "devicenet.comm_fault.match", \r
+ FT_UINT8, BASE_HEX, NULL, 0x40,\r
+ NULL, HFILL }\r
+ },\r
+ {&hf_devicenet_comm_fault_value, \r
+ { "Value", "devicenet.comm_fault.value", \r
+ FT_UINT8, BASE_HEX, NULL, 0x3F,\r
+ "Comm Fault Value", HFILL }\r
+ },\r
+ {&hf_devicenet_offline_ownership_reserved, \r
+ { "Reserved", "devicenet.offline_ownership.reserved", \r
+ FT_UINT8, BASE_HEX, NULL, 0xC0,\r
+ "Offline ownership Response Message Reserved", HFILL }\r
+ },\r
+ {&hf_devicenet_offline_ownership_client_mac_id, \r
+ { "Client MAC ID", "devicenet.offline_ownership.client_mac_id", \r
+ FT_UINT8, BASE_HEX, NULL, MESSAGE_GROUP_4_MSG_MASK,\r
+ "Offline ownership message client MAC ID", HFILL }\r
+ },\r
+ {&hf_devicenet_offline_ownership_allocate, \r
+ { "Allocate", "devicenet.offline_ownership.allocate", \r
+ FT_UINT8, BASE_HEX, NULL, CIP_SC_MASK,\r
+ "Offline ownership response message allocate", HFILL }\r
+ },\r
+ };\r
+\r
+ static gint *ett[] = {\r
+ &ett_devicenet,\r
+ &ett_devicenet_can,\r
+ &ett_devicenet_contents,\r
+ &ett_devicenet_8_8,\r
+ &ett_devicenet_8_16,\r
+ &ett_devicenet_16_8,\r
+ &ett_devicenet_16_16\r
+ };\r
+\r
+ static ei_register_info ei[] = {\r
+ { &ei_devicenet_invalid_service, { "devicenet.invalid_service", PI_PROTOCOL, PI_WARN, "Invalid service", EXPFILL }},\r
+ { &ei_devicenet_invalid_can_id, { "devicenet.invalid_can_id", PI_PROTOCOL, PI_WARN, "Invalid CAN ID", EXPFILL }},\r
+ { &ei_devicenet_invalid_msg_id, { "devicenet.invalid_msg_id", PI_PROTOCOL, PI_WARN, "Invalid Message ID", EXPFILL }},\r
+ { &ei_devicenet_frag_not_supported, { "devicenet.frag_not_supported", PI_UNDECODED, PI_WARN, "Fragmentation not currently supported", EXPFILL }},\r
+ };\r
+\r
+ static uat_field_t devicenet_uat_flds[] = {\r
+ UAT_FLD_DEC(uat_devicenet_records, mac_id, "Option number", "Custom Option Number"),\r
+ UAT_FLD_VS(uat_devicenet_records, behavior, "Option type", devicenet_message_body_format_vals, "Option datatype"),\r
+ UAT_END_FIELDS\r
+ };\r
+\r
+ proto_devicenet = proto_register_protocol("DeviceNet Protocol", "DeviceNet", "devicenet");\r
+\r
+ proto_register_field_array(proto_devicenet, hf, array_length(hf));\r
+ proto_register_subtree_array(ett, array_length(ett));\r
+ expert_devicenet = expert_register_protocol(proto_devicenet);\r
+ expert_register_field_array(expert_devicenet, ei, array_length(ei));\r
+\r
+ new_register_dissector("devicenet", dissect_devicenet, proto_devicenet);\r
+\r
+ devicenet_module = prefs_register_protocol(proto_devicenet, NULL);\r
+\r
+ devicenet_uat = uat_new("Node bodytypes",\r
+ sizeof(uat_devicenet_record_t), /* record size */\r
+ "devicenet_bodytypes", /* filename */\r
+ TRUE, /* from_profile */\r
+ (void**) &uat_devicenet_records,/* data_ptr */\r
+ &num_devicenet_records_uat, /* numitems_ptr */\r
+ UAT_AFFECTS_DISSECTION, /* affects dissection of packets, but not set of named fields */\r
+ NULL, /* help */\r
+ NULL, /* copy callback */\r
+ uat_devicenet_record_update_cb, /* update callback */\r
+ NULL, /* free callback */\r
+ NULL, /* post update callback */\r
+ devicenet_uat_flds); /* UAT field definitions */\r
+\r
+ prefs_register_uat_preference(devicenet_module,\r
+ "bodytype_table",\r
+ "Node bodytypes",\r
+ "Node bodytypes",\r
+ devicenet_uat);\r
+}\r
--- /dev/null
+/* packet-j1939.c\r
+ * Routines for dissection of SAE J1939\r
+ *\r
+ * Michael Mann\r
+ * Copyright 2013\r
+ *\r
+ * $Id: $\r
+ *\r
+ * Wireshark - Network traffic analyzer\r
+ * By Gerald Combs <gerald@wireshark.org>\r
+ * Copyright 1998 Gerald Combs\r
+ *\r
+ * This program is free software; you can redistribute it and/or\r
+ * modify it under the terms of the GNU General Public License\r
+ * as published by the Free Software Foundation; either version 2\r
+ * of the License, or (at your option) any later version.\r
+ *\r
+ * This program is distributed in the hope that it will be useful,\r
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
+ * GNU General Public License for more details.\r
+ *\r
+ * You should have received a copy of the GNU General Public License\r
+ * along with this program; if not, write to the Free Software\r
+ * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.\r
+ */\r
+#include "config.h"\r
+\r
+#include <glib.h>\r
+#include <epan/packet.h>\r
+\r
+#define J1939_CANID_MASK 0x1FFFFFFF\r
+#define J1939_11BIT_ID 0x000003FF\r
+\r
+static int proto_j1939 = -1;\r
+\r
+static int hf_j1939_can_id = -1;\r
+static int hf_j1939_priority = -1;\r
+static int hf_j1939_pgn = -1;\r
+static int hf_j1939_data_page = -1;\r
+static int hf_j1939_extended_data_page = -1;\r
+static int hf_j1939_pdu_format = -1;\r
+static int hf_j1939_pdu_specific = -1;\r
+static int hf_j1939_src_addr = -1;\r
+static int hf_j1939_dst_addr = -1;\r
+static int hf_j1939_group_extension = -1;\r
+static int hf_j1939_data = -1;\r
+\r
+static gint ett_j1939 = -1;\r
+static gint ett_j1939_can = -1;\r
+static gint ett_j1939_message = -1;\r
+\r
+static dissector_table_t subdissector_pgn_table;\r
+\r
+static const value_string j1939_address_vals[] = {\r
+ {0,"Engine #1"},\r
+ {1,"Engine #2"},\r
+ {2,"Turbocharger"},\r
+ {3,"Transmission #1"},\r
+ {4,"Transmission #2"},\r
+ {5,"Shift Console - Primary"},\r
+ {6,"Shift Console - Secondary"},\r
+ {7,"Power TakeOff - (Main or Rear)"},\r
+ {8,"Axle - Steering"},\r
+ {9,"Axle - Drive #1"},\r
+ {10,"Axle - Drive #2"},\r
+ {11,"Brakes - System Controller"},\r
+ {12,"Brakes - Steer Axle"},\r
+ {13,"Brakes - Drive axle #1"},\r
+ {14,"Brakes - Drive Axle #2"},\r
+ {15,"Retarder - Engine"},\r
+ {16,"Retarder - Driveline"},\r
+ {17,"Cruise Control"},\r
+ {18,"Fuel System"},\r
+ {19,"Steering Controller"},\r
+ {20,"Suspension - Steer Axle"},\r
+ {21,"Suspension - Drive Axle #1"},\r
+ {22,"Suspension - Drive Axle #2"},\r
+ {23,"Instrument Cluster #1"},\r
+ {24,"Trip Recorder"},\r
+ {25,"Passenger-Operator Climate Control #1"},\r
+ {26,"Alternator/Electrical Charging System"},\r
+ {27,"Aerodynamic Control"},\r
+ {28,"Vehicle Navigation"},\r
+ {29,"Vehicle Security"},\r
+ {30,"Electrical System"},\r
+ {31,"Starter System"},\r
+ {32,"Tractor-Trailer Bridge #1"},\r
+ {33,"Body Controller"},\r
+ {34,"Auxiliary Valve Control or Engine Air System Valve Control"},\r
+ {35,"Hitch Control"},\r
+ {36,"Power TakeOff (Front or Secondary)"},\r
+ {37,"Off Vehicle Gateway"},\r
+ {38,"Virtual Terminal (in cab)"},\r
+ {39,"Management Computer #1"},\r
+ {40,"Cab Display #1"},\r
+ {41,"Retarder, Exhaust, Engine #1"},\r
+ {42,"Headway Controller"},\r
+ {43,"On-Board Diagnostic Unit"},\r
+ {44,"Retarder, Exhaust, Engine #2"},\r
+ {45,"Endurance Braking System"},\r
+ {46,"Hydraulic Pump Controller"},\r
+ {47,"Suspension - System Controller #1"},\r
+ {48,"Pneumatic - System Controller"},\r
+ {49,"Cab Controller - Primary"},\r
+ {50,"Cab Controller - Secondary"},\r
+ {51,"Tire Pressure Controller"},\r
+ {52,"Ignition Control Module #1"},\r
+ {53,"Ignition Control Module #2"},\r
+ {54,"Seat Control #1"},\r
+ {55,"Lighting - Operator Controls"},\r
+ {56,"Rear Axle Steering Controller #1"},\r
+ {57,"Water Pump Controller"},\r
+ {58,"Passenger-Operator Climate Control #2"},\r
+ {59,"Transmission Display - Primary"},\r
+ {60,"Transmission Display - Secondary"},\r
+ {61,"Exhaust Emission Controller"},\r
+ {62,"Vehicle Dynamic Stability Controller"},\r
+ {63,"Oil Sensor"},\r
+ {64,"Suspension - System Controller #2"},\r
+ {65,"Information System Controller #1"},\r
+ {66,"Ramp Control"},\r
+ {67,"Clutch/Converter Unit"},\r
+ {68,"Auxiliary Heater #1"},\r
+ {69,"Auxiliary Heater #2"},\r
+ {70,"Engine Valve Controller"},\r
+ {71,"Chassis Controller #1"},\r
+ {72,"Chassis Controller #2"},\r
+ {73,"Propulsion Battery Charger"},\r
+ {74,"Communications Unit, Cellular"},\r
+ {75,"Communications Unit, Satellite"},\r
+ {76,"Communications Unit, Radio"},\r
+ {77,"Steering Column Unit"},\r
+ {78,"Fan Drive Controller"},\r
+ {79,"Seat Control #2"},\r
+ {80,"Parking brake controller"},\r
+ {81,"Aftertreatment #1 system gas intake"},\r
+ {82,"Aftertreatment #1 system gas outlet"},\r
+ {83,"Safety Restraint System"},\r
+ {84,"Cab Display #2"},\r
+ {85,"Diesel Particulate Filter Controller"},\r
+ {86,"Aftertreatment #2 system gas intake"},\r
+ {87,"Aftertreatment #2 system gas outlet"},\r
+ {88,"Safety Restraint System #2"},\r
+ {89,"Atmospheric Sensor"},\r
+ {248,"File Server / Printer"},\r
+ {249,"Off Board Diagnostic-Service Tool #1"},\r
+ {250,"Off Board Diagnostic-Service Tool #2"},\r
+ {251,"On-Board Data Logger"},\r
+ {252,"Reserved for Experimental Use"},\r
+ {253,"Reserved for OEM"},\r
+ {254,"Null Address"},\r
+ {255,"GLOBAL"},\r
+ { 0, NULL }\r
+};\r
+\r
+value_string_ext j1939_address_vals_ext = VALUE_STRING_EXT_INIT(j1939_address_vals);\r
+\r
+static void\r
+j1939_fmt_address(gchar *result, guint32 address )\r
+{\r
+ if ((address < 128) || (address > 247))\r
+ g_snprintf(result, ITEM_LABEL_LENGTH, "%d (%s)", address, val_to_str_ext_const(address, &j1939_address_vals_ext, "Reserved"));\r
+ else\r
+ g_snprintf(result, ITEM_LABEL_LENGTH, "%d (Arbitrary)", address);\r
+}\r
+\r
+struct can_identifier\r
+{\r
+ guint32 id;\r
+};\r
+\r
+static int dissect_j1939(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data)\r
+{\r
+ proto_item *ti, *can_id_item;\r
+ proto_tree *j1939_tree, *can_tree, *msg_tree;\r
+\r
+ gint offset = 0;\r
+ struct can_identifier can_id;\r
+ guint32 data_length = tvb_reported_length(tvb);\r
+ guint32 pgn;\r
+ guint8 *src_addr, *dest_addr;\r
+\r
+ DISSECTOR_ASSERT(data);\r
+ can_id = *((struct can_identifier*)data);\r
+\r
+ if (can_id.id & (~J1939_CANID_MASK))\r
+ {\r
+ /* Not for us */\r
+ return 0;\r
+ }\r
+\r
+ col_set_str(pinfo->cinfo, COL_PROTOCOL, "J1939");\r
+ col_clear(pinfo->cinfo, COL_INFO);\r
+\r
+ ti = proto_tree_add_item(tree, proto_j1939, tvb, offset, -1, ENC_NA);\r
+ j1939_tree = proto_item_add_subtree(ti, ett_j1939);\r
+\r
+ ti = proto_tree_add_text(j1939_tree, tvb, 0, 0, "CAN Identifier: 0x%08x", can_id.id);\r
+ can_tree = proto_item_add_subtree(ti, ett_j1939_can);\r
+ can_id_item = proto_tree_add_uint(can_tree, hf_j1939_can_id, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(can_id_item);\r
+\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_priority, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_pgn, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_extended_data_page, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_data_page, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_pdu_format, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_pdu_specific, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_src_addr, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+\r
+ /* Set source address */\r
+ src_addr = (guint8*)wmem_alloc(pinfo->pool, 1);\r
+ *src_addr = (guint8)(can_id.id & 0xFF);\r
+ SET_ADDRESS(&pinfo->src, AT_J1939, 1, (const void*)src_addr);\r
+\r
+ /* If PF < 240, PS is destination address */\r
+ if (!(can_id.id & 0x000F00000))\r
+ {\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_dst_addr, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ }\r
+ else\r
+ {\r
+ ti = proto_tree_add_uint(can_tree, hf_j1939_group_extension, tvb, 0, 0, can_id.id);\r
+ PROTO_ITEM_SET_GENERATED(ti);\r
+ }\r
+\r
+ /* Fill in "destination" address even if its "broadcast" */\r
+ dest_addr = (guint8*)wmem_alloc(pinfo->pool, 1);\r
+ *dest_addr = (guint8)((can_id.id & 0xFF00) >> 8);\r
+ SET_ADDRESS(&pinfo->dst, AT_J1939, 1, (const void*)dest_addr);\r
+\r
+ pgn = (can_id.id & 0x3FFFF00) >> 8;\r
+ col_add_fstr(pinfo->cinfo, COL_INFO, "PGN: %d", pgn);\r
+\r
+ /* For now just include raw bytes */\r
+ col_append_fstr(pinfo->cinfo, COL_INFO, " %s", tvb_bytes_to_str_punct(tvb, 0, data_length, ' '));\r
+\r
+\r
+ ti = proto_tree_add_text(j1939_tree, tvb, 0, -1, "Message");\r
+ msg_tree = proto_item_add_subtree(ti, ett_j1939_message);\r
+ if (!dissector_try_uint_new(subdissector_pgn_table, pgn, tvb, pinfo, msg_tree, TRUE, data))\r
+ {\r
+ proto_tree_add_item(msg_tree, hf_j1939_data, tvb, 0, -1, ENC_NA);\r
+ }\r
+\r
+ return tvb_length(tvb);\r
+}\r
+\r
+void proto_register_devicenet(void)\r
+{\r
+ static hf_register_info hf[] = {\r
+ { &hf_j1939_can_id,\r
+ {"CAN Identifier", "j1939.can_id",\r
+ FT_UINT32, BASE_HEX, NULL, J1939_CANID_MASK, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_priority,\r
+ {"Priority", "j1939.priority",\r
+ FT_UINT32, BASE_DEC, NULL, 0x1C000000, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_pgn,\r
+ {"PGN", "j1939.pgn",\r
+ FT_UINT32, BASE_DEC, NULL, 0x03FFFF00, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_extended_data_page,\r
+ {"Extended Data Page", "j1939.ex_data_page",\r
+ FT_UINT32, BASE_DEC, NULL, 0x02000000, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_data_page,\r
+ {"Data Page", "j1939.data_page",\r
+ FT_UINT32, BASE_DEC, NULL, 0x01000000, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_pdu_format,\r
+ {"PDU Format", "j1939.pdu_format",\r
+ FT_UINT32, BASE_DEC, NULL, 0x00FF0000, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_pdu_specific,\r
+ {"PDU Specific", "j1939.pdu_specific",\r
+ FT_UINT32, BASE_DEC, NULL, 0x0000FF00, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_src_addr,\r
+ {"Source Address", "j1939.src_addr",\r
+ FT_UINT32, BASE_CUSTOM, j1939_fmt_address, 0x000000FF, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_dst_addr,\r
+ {"Destination Address", "j1939.dst_addr",\r
+ FT_UINT32, BASE_CUSTOM, j1939_fmt_address, 0x0000FF00, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_group_extension,\r
+ {"Group Extension", "j1939.group_extension",\r
+ FT_UINT32, BASE_DEC, NULL, 0x0000FF00, NULL, HFILL }\r
+ },\r
+ { &hf_j1939_data,\r
+ {"Data", "j1939.data",\r
+ FT_BYTES, BASE_NONE, NULL, 0x0, NULL, HFILL }\r
+ },\r
+ };\r
+\r
+ static gint *ett[] = {\r
+ &ett_j1939,\r
+ &ett_j1939_can,\r
+ &ett_j1939_message\r
+ };\r
+\r
+ proto_j1939 = proto_register_protocol("SAE J1939", "J1939", "j1939");\r
+\r
+ proto_register_field_array(proto_j1939, hf, array_length(hf));\r
+ proto_register_subtree_array(ett, array_length(ett));\r
+\r
+ new_register_dissector("j1939", dissect_j1939, proto_j1939);\r
+\r
+ subdissector_pgn_table = register_dissector_table("j1939.pgn", "PGN Handle", FT_UINT32, BASE_DEC);\r
+}\r