forked from osmocom/wireshark
d47551982b
Mirror it after protocol dissector API. Change-Id: I7985bcfa9e07654c7cf005efec94efc205d7a304 Reviewed-on: https://code.wireshark.org/review/18496 Reviewed-by: Michael Mann <mmann78@netscape.net>
290 lines
9.7 KiB
C
290 lines
9.7 KiB
C
/* packet-i2c.c
|
|
* Routines for I2C captures (using libpcap extensions)
|
|
*
|
|
* Pigeon Point Systems <www.pigeonpoint.com>
|
|
*
|
|
* Wireshark - Network traffic analyzer
|
|
* By Gerald Combs <gerald@wireshark.org>
|
|
* Copyright 1998 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.
|
|
*/
|
|
|
|
#include "config.h"
|
|
|
|
#include <epan/packet.h>
|
|
#include <epan/capture_dissectors.h>
|
|
#include <epan/prefs.h>
|
|
#include <epan/decode_as.h>
|
|
#include <wiretap/wtap.h>
|
|
|
|
void proto_register_i2c(void);
|
|
void proto_reg_handoff_i2c(void);
|
|
|
|
static int proto_i2c = -1;
|
|
static int proto_i2c_event = -1;
|
|
static int proto_i2c_data = -1;
|
|
|
|
|
|
static int hf_i2c_bus = -1;
|
|
static int hf_i2c_event = -1;
|
|
static int hf_i2c_flags = -1;
|
|
static int hf_i2c_addr = -1;
|
|
|
|
static gint ett_i2c = -1;
|
|
|
|
static dissector_table_t subdissector_table;
|
|
|
|
/* I2C packet flags. */
|
|
#define I2C_FLAG_RD 0x00000001
|
|
#define I2C_FLAG_TEN 0x00000010
|
|
#define I2C_FLAG_REV_DIR_ADDR 0x00002000
|
|
#define I2C_FLAG_NOSTART 0x00004000
|
|
|
|
/* I2C events. */
|
|
#define I2C_EVENT_PROM_ON (1 << 0) /* Promiscuous mode: on */
|
|
#define I2C_EVENT_PROM_OFF (1 << 1) /* Promiscuous mode: off */
|
|
#define I2C_EVENT_ONLINE_ON (1 << 2) /* Online state: on */
|
|
#define I2C_EVENT_ONLINE_OFF (1 << 3) /* Online state: off */
|
|
#define I2C_EVENT_ATTACHED_ON (1 << 4) /* Attached state: on */
|
|
#define I2C_EVENT_ATTACHED_OFF (1 << 5) /* Attached state: off */
|
|
#define I2C_EVENT_PROM_OVFL_ON (1 << 6) /* Prom. queue overflow: on */
|
|
#define I2C_EVENT_PROM_OVFL_OFF (1 << 7) /* Prom. queue overflow: off */
|
|
#define I2C_EVENT_OVFL_ON (1 << 8) /* Queue overflow: on */
|
|
#define I2C_EVENT_OVFL_OFF (1 << 9) /* Queue overflow: off */
|
|
|
|
/* I2C errors. */
|
|
#define I2C_EVENT_ERR_DATA_LO (1 << 16) /* Unable to drive data LO */
|
|
#define I2C_EVENT_ERR_DATA_HI (1 << 17) /* Unable to drive data HI */
|
|
#define I2C_EVENT_ERR_CLOCK_LO (1 << 18) /* Unable to drive clock LO */
|
|
#define I2C_EVENT_ERR_CLOCK_HI (1 << 19) /* Unable to drive clock HI */
|
|
#define I2C_EVENT_ERR_CLOCK_TO (1 << 20) /* Clock low timeout */
|
|
#define I2C_EVENT_ERR_PHYS (1 << 21) /* The I2C bus controller
|
|
has been physically
|
|
disconnected from the bus */
|
|
#define I2C_EVENT_ERR_FAIL (1 << 22) /* Undiagnosed failure */
|
|
|
|
static void i2c_prompt(packet_info *pinfo _U_, gchar* result)
|
|
{
|
|
g_snprintf(result, MAX_DECODE_AS_PROMPT_LEN, "Interpret I2C messages as");
|
|
}
|
|
|
|
static gpointer i2c_value(packet_info *pinfo _U_)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static gboolean
|
|
capture_i2c(const guchar *pd _U_, int offset _U_, int len _U_, capture_packet_info_t *cpinfo, const union wtap_pseudo_header *pseudo_header)
|
|
{
|
|
if (pseudo_header->i2c.is_event) {
|
|
capture_dissector_increment_count(cpinfo, proto_i2c_event);
|
|
} else {
|
|
capture_dissector_increment_count(cpinfo, proto_i2c_data);
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
static const char *
|
|
i2c_get_event_desc(guint32 event)
|
|
{
|
|
const char *desc;
|
|
|
|
switch (event & 0x0000ffff) {
|
|
case I2C_EVENT_PROM_ON:
|
|
desc = "Promiscuous mode is enabled";
|
|
break;
|
|
case I2C_EVENT_PROM_OFF:
|
|
desc = "Promiscuous mode is disabled";
|
|
break;
|
|
case I2C_EVENT_ONLINE_ON:
|
|
desc = "The I2C controller is operational";
|
|
break;
|
|
case I2C_EVENT_ONLINE_OFF:
|
|
desc = "The I2C controller is non-operational";
|
|
break;
|
|
case I2C_EVENT_ATTACHED_ON:
|
|
desc = "The I2C controller is attached to an I2C bus";
|
|
break;
|
|
case I2C_EVENT_ATTACHED_OFF:
|
|
desc = "The I2C controller is detached from an I2C bus";
|
|
if (event & I2C_EVENT_ERR_DATA_LO) {
|
|
desc = "The I2C controller is detached from an I2C bus: "
|
|
"unable to drive data LO";
|
|
} else if (event & I2C_EVENT_ERR_DATA_HI) {
|
|
desc = "The I2C controller is detached from an I2C bus: "
|
|
"unable to drive data HI";
|
|
} else if (event & I2C_EVENT_ERR_CLOCK_LO) {
|
|
desc = "The I2C controller is detached from an I2C bus: "
|
|
"unable to drive clock LO";
|
|
} else if (event & I2C_EVENT_ERR_CLOCK_HI) {
|
|
desc = "The I2C controller is detached from an I2C bus: "
|
|
"unable to drive clock HI";
|
|
} else if (event & I2C_EVENT_ERR_CLOCK_TO) {
|
|
desc = "The I2C controller is detached from an I2C bus: "
|
|
"clock low timeout";
|
|
} else if (event & I2C_EVENT_ERR_PHYS) {
|
|
desc = "The I2C controller is detached from an I2C bus: "
|
|
"the I2C bus controller has been physically "
|
|
"disconnected from the bus";
|
|
} else if (event & I2C_EVENT_ERR_FAIL) {
|
|
desc = "The I2C controller is detached from an I2C bus: "
|
|
"undiagnosed failure";
|
|
}
|
|
break;
|
|
case I2C_EVENT_PROM_OVFL_ON:
|
|
desc = "The incoming promiscuous data buffer has been overrun; "
|
|
"some data is lost";
|
|
break;
|
|
case I2C_EVENT_PROM_OVFL_OFF:
|
|
desc = "The incoming promiscuous data buffer is available";
|
|
break;
|
|
case I2C_EVENT_OVFL_ON:
|
|
desc = "The incoming I2C data buffer has been overrun; "
|
|
"some data is lost";
|
|
break;
|
|
case I2C_EVENT_OVFL_OFF:
|
|
desc = "The incoming I2C data buffer is available";
|
|
break;
|
|
default:
|
|
desc = "<unknown state event>";
|
|
break;
|
|
}
|
|
|
|
return desc;
|
|
}
|
|
|
|
static int
|
|
dissect_i2c(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data _U_)
|
|
{
|
|
proto_item *ti;
|
|
proto_tree *i2c_tree;
|
|
guint8 is_event;
|
|
guint8 bus, addr;
|
|
guint32 flags;
|
|
|
|
flags = pinfo->pseudo_header->i2c.flags;
|
|
|
|
bus = pinfo->pseudo_header->i2c.bus;
|
|
col_add_fstr(pinfo->cinfo, COL_DEF_SRC, "I2C-%d", bus);
|
|
|
|
is_event = pinfo->pseudo_header->i2c.is_event;
|
|
if (is_event) {
|
|
addr = 0;
|
|
col_set_str(pinfo->cinfo, COL_PROTOCOL, "I2C Event");
|
|
col_add_fstr(pinfo->cinfo, COL_DEF_DST, "----");
|
|
col_add_fstr(pinfo->cinfo, COL_INFO, "%s",
|
|
i2c_get_event_desc(flags));
|
|
} else {
|
|
/* Report 7-bit hardware address */
|
|
addr = tvb_get_guint8(tvb, 0) >> 1;
|
|
col_add_fstr(pinfo->cinfo, COL_PROTOCOL, "I2C %s",
|
|
(flags & I2C_FLAG_RD) ? "Read" : "Write");
|
|
col_add_fstr(pinfo->cinfo, COL_DEF_DST, "0x%02x", addr);
|
|
col_add_fstr(pinfo->cinfo, COL_INFO, "I2C %s, %d bytes",
|
|
(flags & I2C_FLAG_RD) ? "Read" : "Write", tvb_captured_length(tvb));
|
|
}
|
|
|
|
pinfo->ptype = PT_I2C;
|
|
|
|
ti = proto_tree_add_protocol_format(tree, proto_i2c, tvb, 0, -1,
|
|
"Inter-Integrated Circuit (%s)",
|
|
is_event ? "Event" : "Data");
|
|
|
|
i2c_tree = proto_item_add_subtree(ti, ett_i2c);
|
|
proto_tree_add_uint_format(i2c_tree, hf_i2c_bus, tvb, 0, 0, bus,
|
|
"Bus: I2C-%d", bus);
|
|
|
|
if (is_event) {
|
|
proto_tree_add_uint_format_value(i2c_tree, hf_i2c_event, tvb, 0, 0,
|
|
flags, "%s (0x%08x)",
|
|
i2c_get_event_desc(flags), flags);
|
|
} else {
|
|
proto_tree_add_uint_format_value(i2c_tree, hf_i2c_addr, tvb, 0, 1,
|
|
addr, "0x%02x%s", addr, addr ? "" : " (General Call)");
|
|
proto_tree_add_uint(i2c_tree, hf_i2c_flags, tvb, 0, 0, flags);
|
|
|
|
/* Functionality for choosing subdissector is controlled through Decode As as I2C doesn't
|
|
have a unique identifier to determine subdissector */
|
|
if (!dissector_try_uint(subdissector_table, 0, tvb, pinfo, tree))
|
|
{
|
|
call_data_dissector(tvb, pinfo, tree);
|
|
}
|
|
}
|
|
return tvb_captured_length(tvb);
|
|
}
|
|
|
|
void
|
|
proto_register_i2c(void)
|
|
{
|
|
static hf_register_info hf[] = {
|
|
{ &hf_i2c_bus, { "Bus ID", "i2c.bus", FT_UINT8, BASE_DEC, NULL, 0, NULL, HFILL }},
|
|
{ &hf_i2c_addr, { "Target address", "i2c.addr", FT_UINT8, BASE_HEX, NULL, 0, NULL, HFILL }},
|
|
{ &hf_i2c_event, { "Event", "i2c.event", FT_UINT32, BASE_HEX, NULL, 0, NULL, HFILL }},
|
|
{ &hf_i2c_flags, { "Flags", "i2c.flags", FT_UINT32, BASE_HEX, NULL, 0, NULL, HFILL }},
|
|
};
|
|
static gint *ett[] = {
|
|
&ett_i2c
|
|
};
|
|
module_t *m;
|
|
|
|
/* Decode As handling */
|
|
static build_valid_func i2c_da_build_value[1] = {i2c_value};
|
|
static decode_as_value_t i2c_da_values = {i2c_prompt, 1, i2c_da_build_value};
|
|
static decode_as_t i2c_da = {"i2c", "I2C Message", "i2c.message", 1, 0, &i2c_da_values, NULL, NULL,
|
|
decode_as_default_populate_list, decode_as_default_reset, decode_as_default_change, NULL};
|
|
|
|
/* Placeholders for capture statistics */
|
|
proto_i2c_event = proto_register_protocol("I2C Events", "I2C Events", "i2c_event");
|
|
proto_i2c_data = proto_register_protocol("I2C Data", "I2C Data", "i2c_data");
|
|
|
|
proto_i2c = proto_register_protocol("Inter-Integrated Circuit", "I2C", "i2c");
|
|
proto_register_field_array(proto_i2c, hf, array_length(hf));
|
|
proto_register_subtree_array(ett, array_length(ett));
|
|
|
|
subdissector_table = register_dissector_table("i2c.message", "I2C messages dissector", proto_i2c, FT_UINT32, BASE_DEC);
|
|
|
|
m = prefs_register_protocol(proto_i2c, NULL);
|
|
prefs_register_obsolete_preference(m, "type");
|
|
|
|
register_decode_as(&i2c_da);
|
|
}
|
|
|
|
void
|
|
proto_reg_handoff_i2c(void)
|
|
{
|
|
dissector_handle_t i2c_handle;
|
|
capture_dissector_handle_t i2c_cap_handle;
|
|
|
|
i2c_handle = create_dissector_handle(dissect_i2c, proto_i2c);
|
|
dissector_add_uint("wtap_encap", WTAP_ENCAP_I2C, i2c_handle);
|
|
i2c_cap_handle = create_capture_dissector_handle(capture_i2c, proto_i2c);
|
|
capture_dissector_add_uint("wtap_encap", WTAP_ENCAP_I2C, i2c_cap_handle);
|
|
}
|
|
|
|
/*
|
|
* Editor modelines - http://www.wireshark.org/tools/modelines.html
|
|
*
|
|
* Local variables:
|
|
* c-basic-offset: 8
|
|
* tab-width: 8
|
|
* indent-tabs-mode: t
|
|
* End:
|
|
*
|
|
* vi: set shiftwidth=8 tabstop=8 noexpandtab:
|
|
* :indentSize=8:tabSize=8:noTabs=false:
|
|
*/
|