osmocom
/
wireshark
11
0
Fork 1
Code Issues Pull Requests Projects Releases Wiki Activity
wireshark/plugins/irda/packet-ircomm.c

433 lines
13 KiB
C
Raw Blame History

/* packet-ircomm.c
* Routines for IrCOMM dissection
* Copyright 2003 Jan Kiszka <jan.kiszka@web.de>
*
* 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 <glib.h>
#include <epan/packet.h>
/*
* See
*
* http://www.irda.org/standards/specifications.asp
*
* for various IrDA specifications.
*/
#include "irda-appl.h"
/* Parameters common to all service types */
#define IRCOMM_SERVICE_TYPE 0x00
#define IRCOMM_PORT_TYPE 0x01 /* Only used in LM-IAS */
#define IRCOMM_PORT_NAME 0x02 /* Only used in LM-IAS */
/* Parameters for both 3 wire and 9 wire */
#define IRCOMM_DATA_RATE 0x10
#define IRCOMM_DATA_FORMAT 0x11
#define IRCOMM_FLOW_CONTROL 0x12
#define IRCOMM_XON_XOFF 0x13
#define IRCOMM_ENQ_ACK 0x14
#define IRCOMM_LINE_STATUS 0x15
#define IRCOMM_BREAK 0x16
/* Parameters for 9 wire */
#define IRCOMM_DTE 0x20
#define IRCOMM_DCE 0x21
#define IRCOMM_POLL 0x22
/* Service type (details) */
#define IRCOMM_3_WIRE_RAW 0x01
#define IRCOMM_3_WIRE 0x02
#define IRCOMM_9_WIRE 0x04
#define IRCOMM_CENTRONICS 0x08
/* Port type (details) */
#define IRCOMM_SERIAL 0x01
#define IRCOMM_PARALLEL 0x02
/* Data format (details) */
#define IRCOMM_WSIZE_5 0x00
#define IRCOMM_WSIZE_6 0x01
#define IRCOMM_WSIZE_7 0x02
#define IRCOMM_WSIZE_8 0x03
#define IRCOMM_1_STOP_BIT 0x00
#define IRCOMM_2_STOP_BIT 0x04 /* 1.5 if char len 5 */
#define IRCOMM_PARITY_DISABLE 0x00
#define IRCOMM_PARITY_ENABLE 0x08
#define IRCOMM_PARITY_ODD 0x00
#define IRCOMM_PARITY_EVEN 0x10
#define IRCOMM_PARITY_MARK 0x20
#define IRCOMM_PARITY_SPACE 0x30
/* Flow control */
#define IRCOMM_XON_XOFF_IN 0x01
#define IRCOMM_XON_XOFF_OUT 0x02
#define IRCOMM_RTS_CTS_IN 0x04
#define IRCOMM_RTS_CTS_OUT 0x08
#define IRCOMM_DSR_DTR_IN 0x10
#define IRCOMM_DSR_DTR_OUT 0x20
#define IRCOMM_ENQ_ACK_IN 0x40
#define IRCOMM_ENQ_ACK_OUT 0x80
/* Line status */
#define IRCOMM_OVERRUN_ERROR 0x02
#define IRCOMM_PARITY_ERROR 0x04
#define IRCOMM_FRAMING_ERROR 0x08
/* DTE (Data terminal equipment) line settings */
#define IRCOMM_DELTA_DTR 0x01
#define IRCOMM_DELTA_RTS 0x02
#define IRCOMM_DTR 0x04
#define IRCOMM_RTS 0x08
/* DCE (Data communications equipment) line settings */
#define IRCOMM_DELTA_CTS 0x01 /* Clear to send has changed */
#define IRCOMM_DELTA_DSR 0x02 /* Data set ready has changed */
#define IRCOMM_DELTA_RI 0x04 /* Ring indicator has changed */
#define IRCOMM_DELTA_CD 0x08 /* Carrier detect has changed */
#define IRCOMM_CTS 0x10 /* Clear to send is high */
#define IRCOMM_DSR 0x20 /* Data set ready is high */
#define IRCOMM_RI 0x40 /* Ring indicator is high */
#define IRCOMM_CD 0x80 /* Carrier detect is high */
#define IRCOMM_DCE_DELTA_ANY 0x0f
void proto_reg_handoff_ircomm(void);
/* Initialize the subtree pointers */
static gint ett_ircomm = -1;
static gint ett_ircomm_ctrl = -1;
#define MAX_PARAMETERS 32
static gint ett_param[MAX_IAP_ENTRIES * MAX_PARAMETERS];
static dissector_handle_t data_handle;
static int proto_ircomm = -1;
static int hf_ircomm_param = -1;
/* static int hf_param_pi = -1; */
/* static int hf_param_pl = -1; */
/* static int hf_param_pv = -1; */
static int hf_control = -1;
static int hf_control_len = -1;
static gboolean dissect_ircomm_parameters(tvbuff_t* tvb, guint offset, packet_info* pinfo,
proto_tree* tree, guint list_index, guint8 attr_type);
static gboolean dissect_ircomm_ttp_lsap(tvbuff_t* tvb, guint offset, packet_info* pinfo,
proto_tree* tree, guint list_index, guint8 attr_type);
static gboolean dissect_ircomm_lmp_lsap(tvbuff_t* tvb, guint offset, packet_info* pinfo,
proto_tree* tree, guint list_index, guint8 attr_type);
ias_attr_dissector_t ircomm_attr_dissector[] = {
/* IrDA:IrCOMM attribute dissectors */
{ "Parameters", dissect_ircomm_parameters },
{ "IrDA:TinyTP:LsapSel", dissect_ircomm_ttp_lsap },
{ NULL, NULL }
};
ias_attr_dissector_t irlpt_attr_dissector[] = {
/* IrLPT attribute dissectors */
{ "IrDA:IrLMP:LsapSel", dissect_ircomm_lmp_lsap },
{ "IrDA:IrLMP:LSAPSel", dissect_ircomm_lmp_lsap }, /* according to IrCOMM V1.0, p25 */
{ NULL, NULL }
};
/*
* Dissect the cooked IrCOMM protocol
*/
static void dissect_cooked_ircomm(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root)
{
guint offset = 0;
guint clen;
char buf[128];
guint len;
if (tvb_length(tvb) == 0)
return;
/* Make entries in Protocol column on summary display */
col_set_str(pinfo->cinfo, COL_PROTOCOL, "IrCOMM");
clen = tvb_get_guint8(tvb, offset);
len = tvb_length(tvb) - 1 - clen;
if (len > 0)
g_snprintf(buf, 128, "Clen=%d, UserData: %d byte%s", clen, len, (len > 1)? "s": "");
else
g_snprintf(buf, 128, "Clen=%d", clen);
col_add_str(pinfo->cinfo, COL_INFO, buf);
if (root)
{
/* create display subtree for the protocol */
proto_item* ti = proto_tree_add_item(root, proto_ircomm, tvb, 0, -1, ENC_NA);
proto_tree* tree = proto_item_add_subtree(ti, ett_ircomm);
proto_tree* ctrl_tree;
ti = proto_tree_add_item(tree, hf_control, tvb, 0, clen + 1, ENC_NA);
ctrl_tree = proto_item_add_subtree(ti, ett_ircomm_ctrl);
proto_tree_add_item(ctrl_tree, hf_control_len, tvb, offset, 1, ENC_BIG_ENDIAN);
offset++;
{
tvbuff_t *cvalue = tvb_new_subset(tvb, offset, clen, clen);
call_dissector(data_handle, cvalue, pinfo, ctrl_tree);
offset += clen;
}
tvb = tvb_new_subset_remaining(tvb, offset);
call_dissector(data_handle, tvb, pinfo, tree);
}
}
/*
* Dissect the raw IrCOMM/IrLPT protocol
*/
static void dissect_raw_ircomm(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root)
{
guint len = tvb_length(tvb);
char buf[128];
if (len == 0)
return;
/* Make entries in Protocol column on summary display */
col_set_str(pinfo->cinfo, COL_PROTOCOL, "IrCOMM");
g_snprintf(buf, 128, "User Data: %d byte%s", len, (len > 1)? "s": "");
col_add_str(pinfo->cinfo, COL_INFO, buf);
if (root)
{
/* create display subtree for the protocol */
proto_item* ti = proto_tree_add_item(root, proto_ircomm, tvb, 0, -1, ENC_NA);
proto_tree* tree = proto_item_add_subtree(ti, ett_ircomm);
call_dissector(data_handle, tvb, pinfo, tree);
}
}
/*
* Dissect IrCOMM IAS "Parameters" attribute
*/
static gboolean dissect_ircomm_parameters(tvbuff_t* tvb, guint offset, packet_info* pinfo _U_,
proto_tree* tree, guint list_index, guint8 attr_type)
{
guint len;
guint n = 0;
proto_item* ti;
proto_tree* p_tree;
char buf[256];
guint8 pv;
if (!check_iap_octet_result(tvb, tree, offset, "Parameters", attr_type))
return TRUE;
if (tree)
{
len = tvb_get_ntohs(tvb, offset) + offset + 2;
offset += 2;
while (offset < len)
{
guint8 p_len = tvb_get_guint8(tvb, offset + 1);
ti = proto_tree_add_item(tree, hf_ircomm_param, tvb, offset, p_len + 2, ENC_NA);
p_tree = proto_item_add_subtree(ti, ett_param[list_index * MAX_PARAMETERS + n]);
buf[0] = 0;
switch (tvb_get_guint8(tvb, offset))
{
case IRCOMM_SERVICE_TYPE:
proto_item_append_text(ti, ": Service Type (");
pv = tvb_get_guint8(tvb, offset+2);
if (pv & IRCOMM_3_WIRE_RAW)
g_strlcat(buf, ", 3-Wire raw", 256);
if (pv & IRCOMM_3_WIRE)
g_strlcat(buf, ", 3-Wire", 256);
if (pv & IRCOMM_9_WIRE)
g_strlcat(buf, ", 9-Wire", 256);
if (pv & IRCOMM_CENTRONICS)
g_strlcat(buf, ", Centronics", 256);
g_strlcat(buf, ")", 256);
proto_item_append_text(ti, "%s", buf+2);
break;
case IRCOMM_PORT_TYPE:
proto_item_append_text(ti, ": Port Type (");
pv = tvb_get_guint8(tvb, offset+2);
if (pv & IRCOMM_SERIAL)
g_strlcat(buf, ", serial", 256);
if (pv & IRCOMM_PARALLEL)
g_strlcat(buf, ", parallel", 256);
g_strlcat(buf, ")", 256);
proto_item_append_text(ti, "%s", buf+2);
break;
case IRCOMM_PORT_NAME:
/* XXX - the IrCOMM V1.0 spec says this "Normally
human readable text, but not required". */
proto_item_append_text(ti, ": Port Name (\"%s\")",
tvb_format_text(tvb, offset+2, p_len));
break;
default:
proto_item_append_text(ti, ": unknown");
}
offset = dissect_param_tuple(tvb, p_tree, offset);
n++;
}
}
return TRUE;
}
/*
* Dissect IrCOMM IAS "IrDA:TinyTP:LsapSel" attribute
*/
static gboolean dissect_ircomm_ttp_lsap(tvbuff_t* tvb, guint offset, packet_info* pinfo,
proto_tree* tree, guint list_index _U_, guint8 attr_type)
{
guint8 dlsap;
if ((dlsap = check_iap_lsap_result(tvb, tree, offset, "IrDA:TinyTP:LsapSel", attr_type)) == 0)
return FALSE;
add_lmp_conversation(pinfo, dlsap, TRUE, dissect_cooked_ircomm);
return FALSE;
}
/*
* Dissect IrCOMM/IrLPT IAS "IrDA:IrLMP:LsapSel" attribute
*/
static gboolean dissect_ircomm_lmp_lsap(tvbuff_t* tvb, guint offset, packet_info* pinfo,
proto_tree* tree, guint list_index _U_, guint8 attr_type)
{
guint8 dlsap;
if ((dlsap = check_iap_lsap_result(tvb, tree, offset, "IrDA:IrLMP:LsapSel", attr_type)) == 0)
return FALSE;
add_lmp_conversation(pinfo, dlsap, FALSE, dissect_raw_ircomm);
return FALSE;
}
/*
* Register the IrCOMM protocol
*/
void proto_register_ircomm(void)
{
guint i;
/* Setup list of header fields */
static hf_register_info hf_ircomm[] = {
{ &hf_ircomm_param,
{ "IrCOMM Parameter", "ircomm.parameter",
FT_NONE, BASE_NONE, NULL, 0,
NULL, HFILL }},
#if 0
{ &hf_param_pi,
{ "Parameter Identifier", "ircomm.pi",
FT_UINT8, BASE_HEX, NULL, 0,
NULL, HFILL }},
{ &hf_param_pl,
{ "Parameter Length", "ircomm.pl",
FT_UINT8, BASE_HEX, NULL, 0,
NULL, HFILL }},
{ &hf_param_pv,
{ "Parameter Value", "ircomm.pv",
FT_BYTES, BASE_NONE, NULL, 0,
NULL, HFILL }},
#endif
{ &hf_control,
{ "Control Channel", "ircomm.control",
FT_NONE, BASE_NONE, NULL, 0,
NULL, HFILL }},
{ &hf_control_len,
{ "Clen", "ircomm.control.len",
FT_UINT8, BASE_DEC, NULL, 0,
NULL, HFILL }}
};
/* Setup protocol subtree arrays */
static gint* ett[] = {
&ett_ircomm,
&ett_ircomm_ctrl
};
gint* ett_p[MAX_IAP_ENTRIES * MAX_PARAMETERS];
/* Register protocol names and descriptions */
proto_ircomm = proto_register_protocol("IrCOMM Protocol", "IrCOMM", "ircomm");
/* Required function calls to register the header fields */
proto_register_field_array(proto_ircomm, hf_ircomm, array_length(hf_ircomm));
/* Register subtrees */
proto_register_subtree_array(ett, array_length(ett));
for (i = 0; i < MAX_IAP_ENTRIES * MAX_PARAMETERS; i++)
{
ett_param[i] = -1;
ett_p[i] = &ett_param[i];
}
proto_register_subtree_array(ett_p, MAX_IAP_ENTRIES * MAX_PARAMETERS);
}
void
proto_reg_handoff_ircomm(void) {
data_handle = find_dissector("data");
}
Reference in New Issue View Git Blame Copy Permalink