From b8299f0b98b7ff518aceb62f998a174936cf4a50 Mon Sep 17 00:00:00 2001 From: Guy Harris Date: Thu, 18 Dec 2003 19:07:14 +0000 Subject: From Jan Kiszka: IrDA support. svn path=/trunk/; revision=9345 --- plugins/Makefile.am | 4 +- plugins/Makefile.nmake | 13 +- plugins/irda/.cvsignore | 19 + plugins/irda/Makefile.am | 43 + plugins/irda/Makefile.nmake | 21 + plugins/irda/irda-appl.h | 107 ++ plugins/irda/moduleinfo.h | 16 + plugins/irda/packet-ircomm.c | 446 ++++++++ plugins/irda/packet-irda.c | 2428 ++++++++++++++++++++++++++++++++++++++++++ 9 files changed, 3093 insertions(+), 4 deletions(-) create mode 100644 plugins/irda/.cvsignore create mode 100644 plugins/irda/Makefile.am create mode 100644 plugins/irda/Makefile.nmake create mode 100644 plugins/irda/irda-appl.h create mode 100644 plugins/irda/moduleinfo.h create mode 100644 plugins/irda/packet-ircomm.c create mode 100644 plugins/irda/packet-irda.c (limited to 'plugins') diff --git a/plugins/Makefile.am b/plugins/Makefile.am index 04350418d0..c9e081eff4 100644 --- a/plugins/Makefile.am +++ b/plugins/Makefile.am @@ -1,7 +1,7 @@ # Makefile.am # Automake file for Ethereal # -# $Id: Makefile.am,v 1.26 2003/12/17 05:16:21 guy Exp $ +# $Id: Makefile.am,v 1.27 2003/12/18 19:01:30 guy Exp $ # # Ethereal - Network traffic analyzer # By Gerald Combs @@ -21,7 +21,7 @@ # along with this program; if not, write to the Free Software # Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. -SUBDIRS = acn asn1 artnet docsis enttec giop gryphon lwres megaco mgcp pcli rdm rtnet v5ua +SUBDIRS = acn asn1 artnet docsis enttec giop gryphon irda lwres megaco mgcp pcli rdm rtnet v5ua plugindir = @plugindir@ diff --git a/plugins/Makefile.nmake b/plugins/Makefile.nmake index 7ebb71ef45..a8e9336801 100644 --- a/plugins/Makefile.nmake +++ b/plugins/Makefile.nmake @@ -1,5 +1,5 @@ # -# $Id: Makefile.nmake,v 1.31 2003/12/17 18:05:27 ulfl Exp $ +# $Id: Makefile.nmake,v 1.32 2003/12/18 19:04:47 guy Exp $ # include ..\config.nmake @@ -11,7 +11,7 @@ CFLAGS=/DHAVE_CONFIG_H /I.. /I../wiretap /I. $(GLIB_CFLAGS) \ OBJECTS=plugin_api.obj -all: $(OBJECTS) acn artnet asn1 docsis enttec giop gryphon lwres megaco mgcp pcli rdm rtnet v5ua +all: $(OBJECTS) acn artnet asn1 docsis enttec giop gryphon irda lwres megaco mgcp pcli rdm rtnet v5ua Xplugin_api.c: plugin_gen.py plugin_api_list.c @echo **** Plugin api may be out of date, please generate new files: @@ -59,6 +59,11 @@ gryphon:: $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake cd .. +irda:: + cd irda + $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake + cd .. + lwres:: cd lwres $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake @@ -110,6 +115,8 @@ clean: $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake clean cd ../gryphon $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake clean + cd ../irda + $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake clean cd ../lwres $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake clean cd ../megaco @@ -141,6 +148,8 @@ distclean: clean $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake distclean cd ../gryphon $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake distclean + cd ../irda + $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake distclean cd ../lwres $(MAKE) /$(MAKEFLAGS) -f Makefile.nmake distclean cd ../megaco diff --git a/plugins/irda/.cvsignore b/plugins/irda/.cvsignore new file mode 100644 index 0000000000..bab29245cb --- /dev/null +++ b/plugins/irda/.cvsignore @@ -0,0 +1,19 @@ +.deps +.libs +Makefile +Makefile.in +config.cache +config.h +config.h.in +config.log +config.status +configure +irda.la +packet-irda.lo +packet-irda-static.lo +stamp-h +*.obj +*.dll +*.exp +*.lib +*.pdb diff --git a/plugins/irda/Makefile.am b/plugins/irda/Makefile.am new file mode 100644 index 0000000000..92ce16bfcb --- /dev/null +++ b/plugins/irda/Makefile.am @@ -0,0 +1,43 @@ +# Makefile.am +# Automake file for Ethereal/IrDA +# +# $Id: Makefile.am,v 1.1 2003/12/18 19:04:47 guy Exp $ +# +# Ethereal - Network traffic analyzer +# By Gerald Combs +# 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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. +# + +INCLUDES = -I$(top_srcdir) + +plugindir = @plugindir@ + +plugin_LTLIBRARIES = irda.la +irda_la_SOURCES = packet-irda.c moduleinfo.h irda-appl.h packet-ircomm.c +irda_la_LDFLAGS = -module -avoid-version + +# Libs must be cleared, or else libtool won't create a shared module. +# If your module needs to be linked against any particular libraries, +# add them here. +LIBS = + +CLEANFILES = \ + irda \ + *~ + +EXTRA_DIST = \ + Makefile.nmake diff --git a/plugins/irda/Makefile.nmake b/plugins/irda/Makefile.nmake new file mode 100644 index 0000000000..297a48194c --- /dev/null +++ b/plugins/irda/Makefile.nmake @@ -0,0 +1,21 @@ +# +# $Id: Makefile.nmake,v 1.1 2003/12/18 19:07:12 guy Exp $ +# + +include ..\..\config.nmake + +############### no need to modify below this line ######### + +CFLAGS=/DHAVE_CONFIG_H /I../.. /I../../wiretap $(GLIB_CFLAGS) \ + /I$(PCAP_DIR)\include -D_U_="" $(LOCAL_CFLAGS) + +OBJECTS=packet-irda.obj packet-ircomm.obj + +irda.dll irda.exp irda.lib : $(OBJECTS) ..\plugin_api.obj + link -dll /out:irda.dll $(OBJECTS) ..\plugin_api.obj \ + $(GLIB_LIBS) + +clean: + rm -f $(OBJECTS) irda.dll irda.exp irda.lib $(PDB_FILE) + +distclean: clean diff --git a/plugins/irda/irda-appl.h b/plugins/irda/irda-appl.h new file mode 100644 index 0000000000..52f96d1d74 --- /dev/null +++ b/plugins/irda/irda-appl.h @@ -0,0 +1,107 @@ +/* irda-appl.h + * Interface for IrDA application dissectors + * By Jan Kiszka + * Copyright 2003 Jan Kiszka + * + * $Id: irda-appl.h,v 1.1 2003/12/18 19:07:12 guy Exp $ + * + * Ethereal - Network traffic analyzer + * By Gerald Combs + * 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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. + */ + + +#ifndef __IRDA_APPL_H__ +#define __IRDA_APPL_H__ + +/* + * Prototypes, defines, and typedefs needed for implementing IrDA application + * layer dissectors. + * There should be no need to modify this part. + */ + +/* LM-IAS Attribute types */ +#define IAS_MISSING 0 +#define IAS_INTEGER 1 +#define IAS_OCT_SEQ 2 +#define IAS_STRING 3 + +/* Maximum number of handled list entries of an IAP result */ +#define MAX_IAP_ENTRIES 32 + + +typedef enum { + CONNECT_PDU, + DISCONNECT_PDU, + DATA_PDU +} pdu_type_t; + +typedef gboolean (*ias_value_dissector_t)(tvbuff_t* tvb, unsigned offset, packet_info* pinfo, proto_tree* tree, + unsigned list_index, guint8 attr_type); + +typedef const struct ias_attr_dissector { + char* attr_name; + ias_value_dissector_t value_dissector; +} ias_attr_dissector_t; + +typedef const struct ias_class_dissector { + char* class_name; + ias_attr_dissector_t* pattr_dissector; +} ias_class_dissector_t; + + +extern gboolean check_iap_octet_result(tvbuff_t* tvb, proto_tree* tree, unsigned offset, + const char* attr_name, guint8 attr_type); +extern guint8 check_iap_lsap_result(tvbuff_t* tvb, proto_tree* tree, unsigned offset, + const char* attr_name, guint8 attr_type); + +extern void add_lmp_conversation(packet_info* pinfo, guint8 dlsap, gboolean ttp, dissector_t proto_dissector); + +extern unsigned dissect_param_tuple(tvbuff_t* tvb, proto_tree* tree, unsigned offset); + + +extern dissector_handle_t data_handle; + + +/* + * Protocol exports. + * Modify the lines below to add new protocols. + */ + +/* IrCOMM/IrLPT protocol */ +extern void proto_register_ircomm(void); +extern ias_attr_dissector_t ircomm_attr_dissector[]; +extern ias_attr_dissector_t irlpt_attr_dissector[]; + + +/* + * Protocol hooks + */ + +/* IAS class dissectors */ +#define CLASS_DISSECTORS \ + { "Device", device_attr_dissector }, \ + { "IrDA:IrCOMM", ircomm_attr_dissector }, \ + { "IrLPT", irlpt_attr_dissector }, \ + { NULL, NULL } + +/* Protocol initialisation */ +#define REGISTER_SUB_PROTOCOLS() do { \ + proto_register_ircomm(); \ + } while (0) + +#endif /* __IRDA_APPL_H__ */ diff --git a/plugins/irda/moduleinfo.h b/plugins/irda/moduleinfo.h new file mode 100644 index 0000000000..afd198ef94 --- /dev/null +++ b/plugins/irda/moduleinfo.h @@ -0,0 +1,16 @@ +/* Included *after* config.h, in order to re-define these macros */ + +#ifdef PACKAGE +#undef PACKAGE +#endif + +/* Name of package */ +#define PACKAGE "irda" + + +#ifdef VERSION +#undef VERSION +#endif + +/* Version number of package */ +#define VERSION "0.0.5" diff --git a/plugins/irda/packet-ircomm.c b/plugins/irda/packet-ircomm.c new file mode 100644 index 0000000000..539a131ba4 --- /dev/null +++ b/plugins/irda/packet-ircomm.c @@ -0,0 +1,446 @@ +/* packet-ircomm.c + * Routines for IrCOMM dissection + * By Jan Kiszka + * Copyright 2003 Jan Kiszka + * + * $Id: packet-ircomm.c,v 1.1 2003/12/18 19:07:12 guy Exp $ + * + * Ethereal - Network traffic analyzer + * By Gerald Combs + * 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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. + */ + +#ifdef HAVE_CONFIG_H +# include "config.h" +#endif + +#include "plugins/plugin_api.h" + +#include "moduleinfo.h" + +#include +#include +#include + +#include +#include +#include +#include + +#include "plugins/plugin_api_defs.h" + +#ifdef NEED_SNPRINTF_H +# include "snprintf.h" +#endif + +#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 + +/* 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 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, unsigned offset, packet_info* pinfo, + proto_tree* tree, unsigned list_index, guint8 attr_type); +static gboolean dissect_ircomm_ttp_lsap(tvbuff_t* tvb, unsigned offset, packet_info* pinfo, + proto_tree* tree, unsigned list_index, guint8 attr_type); +static gboolean dissect_ircomm_lmp_lsap(tvbuff_t* tvb, unsigned offset, packet_info* pinfo, + proto_tree* tree, unsigned 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) +{ + unsigned offset = 0; + unsigned clen; + + + if (tvb_length(tvb) == 0) + return; + + /* Make entries in Protocol column on summary display */ + if (check_col(pinfo->cinfo, COL_PROTOCOL)) + col_set_str(pinfo->cinfo, COL_PROTOCOL, "IrCOMM"); + + clen = tvb_get_guint8(tvb, offset); + + if (check_col(pinfo->cinfo, COL_INFO)) + { + char buf[128]; + unsigned len = tvb_length(tvb) - 1 - clen; + + + if (len > 0) + sprintf(buf, "Clen=%d, UserData: %d byte%s", clen, len, (len > 1)? "s": ""); + else + sprintf(buf, "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, FALSE); + 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, FALSE); + ctrl_tree = proto_item_add_subtree(ti, ett_ircomm_ctrl); + proto_tree_add_item(ctrl_tree, hf_control_len, tvb, offset, 1, FALSE); + 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(tvb, offset, -1, -1); + 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) +{ + unsigned len = tvb_length(tvb); + + + if (len == 0) + return; + + /* Make entries in Protocol column on summary display */ + if (check_col(pinfo->cinfo, COL_PROTOCOL)) + col_set_str(pinfo->cinfo, COL_PROTOCOL, "IrCOMM"); + + if (check_col(pinfo->cinfo, COL_INFO)) + { + char buf[128]; + + + sprintf(buf, "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, FALSE); + 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, unsigned offset, packet_info* pinfo _U_, + proto_tree* tree, unsigned list_index, guint8 attr_type) +{ + unsigned len; + unsigned 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, FALSE); + 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) + strcat(buf, ", 3-Wire raw"); + if (pv & IRCOMM_3_WIRE) + strcat(buf, ", 3-Wire"); + if (pv & IRCOMM_9_WIRE) + strcat(buf, ", 9-Wire"); + if (pv & IRCOMM_CENTRONICS) + strcat(buf, ", Centronics"); + + strcat(buf, ")"); + + proto_item_append_text(ti, 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) + strcat(buf, ", serial"); + if (pv & IRCOMM_PARALLEL) + strcat(buf, ", parallel"); + + strcat(buf, ")"); + + proto_item_append_text(ti, buf+2); + + break; + + case IRCOMM_PORT_NAME: + proto_item_append_text(ti, ": Port Name (\""); + + tvb_memcpy(tvb, buf, offset+2, p_len); + strcat(buf, "\")"); + + proto_item_append_text(ti, buf); + + 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, unsigned offset, packet_info* pinfo, + proto_tree* tree, unsigned 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, unsigned offset, packet_info* pinfo, + proto_tree* tree, unsigned 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) +{ + unsigned 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, + "", HFILL }}, + { &hf_param_pi, + { "Parameter Identifier", "ircomm.pi", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_param_pl, + { "Parameter Length", "ircomm.pl", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_param_pv, + { "Parameter Value", "ircomm.pv", + FT_BYTES, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_control, + { "Control Channel", "ircomm.control", + FT_NONE, BASE_NONE, NULL, 0, + "", HFILL }}, + { &hf_control_len, + { "Clen", "ircomm.control.len", + FT_UINT8, BASE_DEC, NULL, 0, + "", HFILL }}, + }; + + /* Setup protocol subtree arrays */ + static gint* ett[] = { + &ett_ircomm, + &ett_ircomm_ctrl + }; + + static 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); +} diff --git a/plugins/irda/packet-irda.c b/plugins/irda/packet-irda.c new file mode 100644 index 0000000000..1b3d530d98 --- /dev/null +++ b/plugins/irda/packet-irda.c @@ -0,0 +1,2428 @@ +/* packet-irda.c + * Routines for IrDA dissection + * By Shaun Jackman + * Copyright 2000 Shaun Jackman + * + * Extended by Jan Kiszka + * Copyright 2003 Jan Kiszka + * + * $Id: packet-irda.c,v 1.1 2003/12/18 19:07:13 guy Exp $ + * + * Ethereal - Network traffic analyzer + * By Gerald Combs + * 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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. + */ + +#ifdef HAVE_CONFIG_H +# include "config.h" +#endif + +#include "plugins/plugin_api.h" + +#include "moduleinfo.h" + +#include +#include +#include + +#include +#include +#include +#include + +#include "plugins/plugin_api_defs.h" + +#ifdef NEED_SNPRINTF_H +# include "snprintf.h" +#endif + +#include "irda-appl.h" + + +/* + * LAP + */ + +/* Frame types and templates */ +#define INVALID 0xff + +/* Unnumbered (U) commands */ +#define SNRM_CMD 0x83 /* Set Normal Response Mode */ +#define DISC_CMD 0x43 /* Disconnect */ +#define UI_CMD 0x03 /* Unnumbered Information */ +#define XID_CMD 0x2f /* Exchange Station Identification */ +#define TEST_CMD 0xe3 /* Test */ + +/* Unnumbered responses */ +#define RNRM_RSP 0x83 /* Request Normal Response Mode */ +#define UA_RSP 0x63 /* Unnumbered Acknowledgement */ +#define FRMR_RSP 0x87 /* Frame Reject */ +#define DM_RSP 0x0f /* Disconnect Mode */ +#define RD_RSP 0x43 /* Request Disconnection */ +#define UI_RSP 0x03 /* Unnumbered Information */ +#define XID_RSP 0xaf /* Exchange Station Identification */ +#define TEST_RSP 0xe3 /* Test frame */ + +/* Supervisory (S) */ +#define RR 0x01 /* Receive Ready */ +#define REJ 0x09 /* Reject */ +#define RNR 0x05 /* Receive Not Ready */ +#define SREJ 0x0d /* Selective Reject */ + +/* Information (I) */ +#define I_FRAME 0x00 /* Information Format */ +#define UI_FRAME 0x03 /* Unnumbered Information */ + +#define CMD_FRAME 0x01 +#define RSP_FRAME 0x00 + +#define PF_BIT 0x10 /* Poll/final bit */ +#define NR_MASK 0xE0 /* Ns bits */ +#define NS_MASK 0x0E /* Nr bits */ + +/* Discovery Flags */ +#define S_MASK 0x03 +#define CONFLICT 0x04 + +/* Negotiation Parameters */ +#define PI_BAUD_RATE 0x01 +#define PI_MAX_TURN_TIME 0x82 +#define PI_DATA_SIZE 0x83 +#define PI_WINDOW_SIZE 0x84 +#define PI_ADD_BOFS 0x85 +#define PI_MIN_TURN_TIME 0x86 +#define PI_LINK_DISC 0x08 + + +/* + * LMP + */ + +/* IrLMP frame opcodes */ +#define CONNECT_CMD 0x01 +#define CONNECT_CNF 0x81 +#define DISCONNECT 0x02 +#define ACCESSMODE_CMD 0x03 +#define ACCESSMODE_CNF 0x83 + +#define CONTROL_BIT 0x80 +#define RESERVED_BIT 0x80 + +/* LSAP-SEL's */ +#define LSAP_MASK 0x7f +#define LSAP_IAS 0x00 +#define LSAP_ANY 0xff +#define LSAP_MAX 0x6f /* 0x70-0x7f are reserved */ +#define LSAP_CONNLESS 0x70 /* Connectionless LSAP, mostly used for Ultra */ + + +/* + * IAP + */ + +/* IrIAP Op-codes */ +#define GET_INFO_BASE 0x01 +#define GET_OBJECTS 0x02 +#define GET_VALUE 0x03 +#define GET_VALUE_BY_CLASS 0x04 +#define GET_OBJECT_INFO 0x05 +#define GET_ATTRIB_NAMES 0x06 + +#define IAP_LST 0x80 +#define IAP_ACK 0x40 +#define IAP_OP 0x3F + +#define IAS_SUCCESS 0 +#define IAS_CLASS_UNKNOWN 1 +#define IAS_ATTRIB_UNKNOWN 2 +#define IAS_ATTR_TOO_LONG 3 +#define IAS_DISCONNECT 10 +#define IAS_UNSUPPORTED 0xFF + + +/* + * TTP + */ + +#define TTP_PARAMETERS 0x80 +#define TTP_MORE 0x80 + + +#ifndef __ETHEREAL_STATIC__ +G_MODULE_EXPORT const gchar version[] = VERSION; +#endif + +dissector_handle_t data_handle; + +/* Initialize the protocol and registered fields */ +static int proto_irlap = -1; +static int hf_lap_a = -1; +static int hf_lap_a_cr = -1; +static int hf_lap_a_address = -1; +static int hf_lap_c = -1; +static int hf_lap_c_pf = -1; +static int hf_lap_c_u_cmd = -1; +static int hf_lap_c_u_rsp = -1; +static int hf_lap_c_s = -1; +static int hf_lap_c_i = -1; +static int hf_lap_c_nr = -1; +static int hf_lap_c_ns = -1; +static int hf_lap_i = -1; +static int hf_snrm_saddr = -1; +static int hf_snrm_daddr = -1; +static int hf_snrm_ca = -1; +static int hf_ua_saddr = -1; +static int hf_ua_daddr = -1; +static int hf_negotiation_param = -1; +static int hf_param_pi = -1; +static int hf_param_pl = -1; +static int hf_param_pv = -1; +static int hf_xid_ident = -1; +static int hf_xid_saddr = -1; +static int hf_xid_daddr = -1; +static int hf_xid_flags = -1; +static int hf_xid_s = -1; +static int hf_xid_conflict = -1; +static int hf_xid_slotnr = -1; +static int hf_xid_version = -1; + +static int proto_irlmp = -1; +static int hf_lmp_xid_hints = -1; +static int hf_lmp_xid_charset = -1; +static int hf_lmp_xid_name = -1; +static int hf_lmp_xid_name_no_ascii = -1; +static int hf_lmp_dst = -1; +static int hf_lmp_dst_control = -1; +static int hf_lmp_dst_lsap = -1; +static int hf_lmp_src = -1; +static int hf_lmp_src_r = -1; +static int hf_lmp_src_lsap = -1; +static int hf_lmp_opcode = -1; +static int hf_lmp_rsvd = -1; +static int hf_lmp_reason = -1; +static int hf_lmp_mode = -1; +static int hf_lmp_status = -1; + +static int proto_iap = -1; +static int hf_iap_ctl = -1; +static int hf_iap_ctl_lst = -1; +static int hf_iap_ctl_ack = -1; +static int hf_iap_ctl_opcode = -1; +static int hf_iap_class_name = -1; +static int hf_iap_attr_name = -1; +static int hf_iap_return = -1; +static int hf_iap_list_len = -1; +static int hf_iap_list_entry = -1; +static int hf_iap_obj_id = -1; +static int hf_iap_attr_type = -1; +static int hf_iap_int = -1; +static int hf_iap_seq_len = -1; +static int hf_iap_oct_seq = -1; +static int hf_iap_char_set = -1; +static int hf_iap_string = -1; +static int hf_iap_invaloctet = -1; +static int hf_iap_invallsap = -1; + +static int proto_ttp = -1; +static int hf_ttp_p = -1; +static int hf_ttp_icredit = -1; +static int hf_ttp_m = -1; +static int hf_ttp_dcredit = -1; + +static int proto_log = -1; +static int hf_log_msg = -1; +static int hf_log_missed = -1; + +/* Initialize the subtree pointers */ +static gint ett_irlap = -1; +static gint ett_lap_a = -1; +static gint ett_lap_c = -1; +static gint ett_lap_i = -1; +static gint ett_xid_flags = -1; +static gint ett_log = -1; +static gint ett_irlmp = -1; +static gint ett_lmp_dst = -1; +static gint ett_lmp_src = -1; +static gint ett_iap = -1; +static gint ett_iap_ctl = -1; +static gint ett_ttp = -1; + +#define MAX_PARAMETERS 32 +static gint ett_param[MAX_PARAMETERS]; + +static gint ett_iap_entry[MAX_IAP_ENTRIES]; + +/* IAP conversation type */ +typedef struct iap_conversation { + struct iap_conversation* pnext; + guint32 iap_query_frame; + ias_attr_dissector_t* pattr_dissector; +} iap_conversation_t; + +/* IrLMP conversation type */ +typedef struct lmp_conversation { + struct lmp_conversation* pnext; + guint32 iap_result_frame; + gboolean ttp; + dissector_t proto_dissector; +} lmp_conversation_t; + +static GMemChunk* iap_conv_chunk = NULL; +static GMemChunk* lmp_conv_chunk = NULL; + +static const true_false_string lap_cr_vals = { + "Command", + "Response" +}; + +static const true_false_string set_notset = { + "Set", + "Not set" +}; + +static const value_string lap_c_u_cmd_abbr_vals[] = { +/* Unnumbered (U) commands */ + { SNRM_CMD, "SNRM" }, + { DISC_CMD, "DISC" }, + { UI_CMD, "UI" }, + { XID_CMD, "XID" }, + { TEST_CMD, "TEST" }, + { 0, NULL } +}; + +static const value_string lap_c_u_rsp_abbr_vals[] = { +/* Unnumbered responses */ + { RNRM_RSP, "RNRM" }, + { UA_RSP, "UA" }, + { FRMR_RSP, "FRMR" }, + { DM_RSP, "DM" }, + { RD_RSP, "RD" }, + { UI_RSP, "UI" }, + { XID_RSP, "XID" }, + { TEST_RSP, "TEST" }, + { 0, NULL } +}; + +static const value_string lap_c_s_abbr_vals[] = { +/* Supervisory (S) */ + { RR, "RR" }, + { REJ, "REJ" }, + { RNR, "RNR" }, + { SREJ, "SREJ" }, + { 0, NULL } +}; + +static const value_string lap_c_u_cmd_vals[] = { +/* Unnumbered (U) commands */ + { SNRM_CMD, "Set Normal Response Mode" }, + { DISC_CMD, "Disconnect" }, + { UI_CMD, "Unnumbered Information" }, + { XID_CMD, "Exchange Station Identification" }, + { TEST_CMD, "Test" }, + { 0, NULL } +}; + +static const value_string lap_c_u_rsp_vals[] = { +/* Unnumbered responses */ + { RNRM_RSP, "Request Normal Response Mode" }, + { UA_RSP, "Unnumbered Acknowledgement" }, + { FRMR_RSP, "Frame Reject" }, + { DM_RSP, "Disconnect Mode" }, + { RD_RSP, "Request Disconnect" }, + { UI_RSP, "Unnumbered Information" }, + { XID_RSP, "Exchange Station Identification" }, + { TEST_RSP, "Test" }, + { 0, NULL } +}; + +static const value_string lap_c_s_vals[] = { +/* Supervisory (S) */ + { RR, "Receive Ready" }, + { REJ, "Reject" }, + { RNR, "Receive Not Ready" }, + { SREJ, "Selective Reject" }, + { 0, NULL } +}; + +static const value_string xid_slot_numbers[] = { +/* Number of XID slots */ + { 0, "1" }, + { 1, "6" }, + { 2, "8" }, + { 3, "16" }, + { 0, NULL } +}; + +static const value_string lmp_opcode_vals[] = { +/* IrLMP frame opcodes */ + { CONNECT_CMD, "Connect Command" }, + { CONNECT_CNF, "Connect Confirm" }, + { DISCONNECT, "Disconnect" }, + { ACCESSMODE_CMD, "Access Mode Command" }, + { ACCESSMODE_CNF, "Access Mode Confirm" }, + { 0, NULL } +}; + +static const value_string lmp_reason_vals[] = { +/* IrLMP disconnect reasons */ + { 0x01, "User Request" }, + { 0x02, "Unexpected IrLAP Disconnect" }, + { 0x03, "Failed to establish IrLAP connection" }, + { 0x04, "IrLAP Reset" }, + { 0x05, "Link Management Initiated Disconnect" }, + { 0x06, "Data delivered on disconnected LSAP-Connection"}, + { 0x07, "Non Responsive LM-MUX Client" }, + { 0x08, "No available LM-MUX Client" }, + { 0x09, "Connection Half Open" }, + { 0x0A, "Illegal Source Address" }, + { 0xFF, "Unspecified Disconnect Reason" }, + { 0, NULL } +}; + +static const value_string lmp_mode_vals[] = { +/* IrLMP modes */ + { 0x00, "Multiplexed" }, + { 0x01, "Exclusive" }, + { 0, NULL } +}; + +static const value_string lmp_status_vals[] = { +/* IrLMP status */ + { 0x00, "Success" }, + { 0x01, "Failure" }, + { 0xFF, "Unsupported" }, + { 0, NULL } +}; + +static const value_string iap_opcode_vals[] = { +/* IrIAP Op-codes */ + { GET_INFO_BASE, "GetInfoBase" }, + { GET_OBJECTS, "GetObjects" }, + { GET_VALUE, "GetValue" }, + { GET_VALUE_BY_CLASS, "GetValueByClass" }, + { GET_OBJECT_INFO, "GetObjectInfo" }, + { GET_ATTRIB_NAMES, "GetAttributeNames" }, + { 0, NULL } +}; + +static const value_string iap_return_vals[] = { +/* IrIAP Return-codes */ + { IAS_SUCCESS, "Success" }, + { IAS_CLASS_UNKNOWN, "Class/Object Unknown" }, + { IAS_ATTRIB_UNKNOWN, "Attribute Unknown" }, + { IAS_ATTR_TOO_LONG, "Attribute List Too Long" }, + { IAS_DISCONNECT, "Disconnect (Linux-IrDA only)" }, + { IAS_UNSUPPORTED, "Unsupported Optional Operation" }, + { 0, NULL } +}; + +static const value_string iap_attr_type_vals[] = { +/* LM-IAS Attribute types */ + { IAS_MISSING, "Missing" }, + { IAS_INTEGER, "Integer" }, + { IAS_OCT_SEQ, "Octet Sequence" }, + { IAS_STRING, "String" }, + { 0, NULL } +}; + +static ias_attr_dissector_t device_attr_dissector[] = { +/* Device attribute dissectors */ +// { "IrLMPSupport", xxx }, not implemented yet... + { NULL, NULL } +}; + +/* IAS class dissectors */ +static ias_class_dissector_t class_dissector[] = { CLASS_DISSECTORS }; + + +/* + * Dissect parameter tuple + */ +unsigned dissect_param_tuple(tvbuff_t* tvb, proto_tree* tree, unsigned offset) +{ + guint8 len = tvb_get_guint8(tvb, offset + 1); + + proto_tree_add_item(tree, hf_param_pi, tvb, offset, 1, FALSE); + offset++; + + proto_tree_add_item(tree, hf_param_pl, tvb, offset, 1, FALSE); + offset++; + + if (len > 0) + { + proto_tree_add_item(tree, hf_param_pv, tvb, offset, len, FALSE); + offset += len; + } + + return offset; +} + + +/* + * Dissect TTP + */ +static unsigned dissect_ttp(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root, gboolean data) +{ + unsigned offset = 0; + guint8 head; + + + if (tvb_length(tvb) == 0) + return 0; + + /* Make entries in Protocol column on summary display */ + if (check_col(pinfo->cinfo, COL_PROTOCOL)) + col_set_str(pinfo->cinfo, COL_PROTOCOL, "TTP"); + + head = tvb_get_guint8(tvb, offset); + + if (check_col(pinfo->cinfo, COL_INFO)) + { + char buf[128]; + + + sprintf(buf, ", Credit=%d", head & ~TTP_PARAMETERS); + col_append_str(pinfo->cinfo, COL_INFO, buf); + } + + if (root) + { + /* create display subtree for the protocol */ + proto_item* ti = proto_tree_add_item(root, proto_ttp, tvb, 0, -1, FALSE); + proto_tree* tree = proto_item_add_subtree(ti, ett_ttp); + + if (data) + { + proto_tree_add_item(tree, hf_ttp_m, tvb, offset, 1, FALSE); + proto_tree_add_item(tree, hf_ttp_dcredit, tvb, offset, 1, FALSE); + offset++; + } + else + { + proto_tree_add_item(tree, hf_ttp_p, tvb, offset, 1, FALSE); + proto_tree_add_item(tree, hf_ttp_icredit, tvb, offset, 1, FALSE); + offset++; + } + proto_item_set_len(tree, offset); + } + else + offset++; + + return offset; +} + + +/* + * Dissect IAP request + */ +static void dissect_iap_request(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root) +{ + unsigned offset = 0; + guint8 op; + guint8 clen = 0; + guint8 alen = 0; + guint8 src; + address srcaddr; + address destaddr; + conversation_t* conv; + iap_conversation_t* iap_conv; + + + if (tvb_length(tvb) == 0) + return; + + /* Make entries in Protocol column on summary display */ + if (check_col(pinfo->cinfo, COL_PROTOCOL)) + col_set_str(pinfo->cinfo, COL_PROTOCOL, "IAP"); + + op = tvb_get_guint8(tvb, offset) & IAP_OP; + + switch (op) + { + case GET_VALUE_BY_CLASS: + clen = MIN(tvb_get_guint8(tvb, offset + 1), 60); + alen = MIN(tvb_get_guint8(tvb, offset + 1 + 1 + clen), 60); + + /* create conversation entry */ + src = pinfo->circuit_id ^ CMD_FRAME; + srcaddr.type = AT_NONE; + srcaddr.len = 1; + srcaddr.data = (char*)&src; + + destaddr.type = AT_NONE; + destaddr.len = 1; + destaddr.data = (char*)&pinfo->circuit_id; + + conv = find_conversation(&srcaddr, &destaddr, PT_NONE, pinfo->srcport, pinfo->destport, 0); + if (conv) + { + iap_conv = (iap_conversation_t*)conversation_get_proto_data(conv, PT_NONE); + while (1) + { + if (iap_conv->iap_query_frame == pinfo->fd->num) + { + iap_conv = NULL; + break; + } + if (iap_conv->pnext == NULL) + { + iap_conv->pnext = g_mem_chunk_alloc(iap_conv_chunk); + iap_conv = iap_conv->pnext; + break; + } + iap_conv = iap_conv->pnext; + } + } + else + { + conv = conversation_new(&srcaddr, &destaddr, PT_NONE, pinfo->srcport, pinfo->destport, 0); + iap_conv = g_mem_chunk_alloc(iap_conv_chunk); + conversation_add_proto_data(conv, PT_NONE, (void*)iap_conv); + } + + /* Dissect IAP query if it is new */ + if (iap_conv) + { + int i, j; + char class_name[256]; + char attr_name[256]; + + + tvb_memcpy(tvb, class_name, offset + 1 + 1, clen); + class_name[clen] = 0; + tvb_memcpy(tvb, attr_name, offset + 1 + 1 + clen + 1, alen); + attr_name[alen] = 0; + + iap_conv->pnext = NULL; + iap_conv->iap_query_frame = pinfo->fd->num; + iap_conv->pattr_dissector = NULL; + + /* Find the attribute dissector */ + for (i = 0; class_dissector[i].class_name != NULL; i++) + if (strcmp(class_name, class_dissector[i].class_name) == 0) + { + for (j = 0; class_dissector[i].pattr_dissector[j].attr_name != NULL; j++) + if (strcmp(attr_name, class_dissector[i].pattr_dissector[j].attr_name) == 0) + { + iap_conv->pattr_dissector = &class_dissector[i].pattr_dissector[j]; + break; + } + break; + } + } + + if (check_col(pinfo->cinfo, COL_INFO)) + { + char buf[128]; + + + col_add_str(pinfo->cinfo, COL_INFO, "GetValueByClass: \""); + + tvb_memcpy(tvb, buf, offset + 1 + 1, clen); + memcpy(&buf[clen], "\" \"", 3); + tvb_memcpy(tvb, buf + clen + 3, offset + 1 + 1 + clen + 1, alen); + buf[clen + 3 + alen] = '\"'; + buf[clen + 3 + alen + 1] = 0; + col_append_str(pinfo->cinfo, COL_INFO, buf); + } + } + + if (root) + { + /* create display subtree for the protocol */ + proto_item* ti = proto_tree_add_item(root, proto_iap, tvb, 0, -1, FALSE); + proto_tree* tree = proto_item_add_subtree(ti, ett_iap); + + proto_tree* ctl_tree; + + + ti = proto_tree_add_item(tree, hf_iap_ctl, tvb, offset, 1, FALSE); + ctl_tree = proto_item_add_subtree(ti, ett_iap_ctl); + proto_tree_add_item(ctl_tree, hf_iap_ctl_lst, tvb, offset, 1, FALSE); + proto_tree_add_item(ctl_tree, hf_iap_ctl_ack, tvb, offset, 1, FALSE); + proto_tree_add_item(ctl_tree, hf_iap_ctl_opcode, tvb, offset, 1, FALSE); + offset++; + + switch (op) + { + case GET_VALUE_BY_CLASS: + proto_tree_add_item(tree, hf_iap_class_name, tvb, offset, 1, FALSE); + offset += 1 + clen; + + proto_tree_add_item(tree, hf_iap_attr_name, tvb, offset, 1, FALSE); + offset += 1 + alen; + break; + } + } + else + { + offset++; + switch (op) + { + case GET_VALUE_BY_CLASS: + offset += 1 + clen + 1 + alen; + break; + } + } + + /* If any bytes remain, send it to the generic data dissector */ + tvb = tvb_new_subset(tvb, offset, -1, -1); + call_dissector(data_handle, tvb, pinfo, root); +} + + +/* + * Dissect IAP result + */ +static void dissect_iap_result(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root) +{ + unsigned offset = 0; + unsigned len = tvb_length(tvb); + unsigned n = 0; + unsigned list_len; + guint8 op; + guint8 retcode; + guint8 type; + guint16 attr_len; + char buf[300]; + guint8 src; + address srcaddr; + address destaddr; + conversation_t* conv; + iap_conversation_t* cur_iap_conv; + iap_conversation_t* iap_conv = NULL; + guint32 num; + + + if (tvb_length(tvb) == 0) + return; + + /* Make entries in Protocol column on summary display */ + if (check_col(pinfo->cinfo, COL_PROTOCOL)) + col_set_str(pinfo->cinfo, COL_PROTOCOL, "IAP"); + + op = tvb_get_guint8(tvb, offset) & IAP_OP; + retcode = tvb_get_guint8(tvb, offset + 1); + + src = pinfo->circuit_id ^ CMD_FRAME; + srcaddr.type = AT_NONE; + srcaddr.len = 1; + srcaddr.data = (char*)&src; + + destaddr.type = AT_NONE; + destaddr.len = 1; + destaddr.data = (char*)&pinfo->circuit_id; + + /* Find result value dissector */ + conv = find_conversation(&srcaddr, &destaddr, PT_NONE, pinfo->srcport, pinfo->destport, 0); + if (conv) + { + num = pinfo->fd->num; + + iap_conv = (iap_conversation_t*)conversation_get_proto_data(conv, PT_NONE); + while (iap_conv && (iap_conv->iap_query_frame >= num)) + iap_conv = iap_conv->pnext; + + if (iap_conv) + { + cur_iap_conv = iap_conv->pnext; + while (cur_iap_conv) + { + if ((cur_iap_conv->iap_query_frame < num) && + (cur_iap_conv->iap_query_frame > iap_conv->iap_query_frame)) + { + iap_conv = cur_iap_conv; + } + + cur_iap_conv = cur_iap_conv->pnext; + } + } + } + + if (check_col(pinfo->cinfo, COL_INFO)) + { + col_add_str(pinfo->cinfo, COL_INFO, "Result: "); + col_append_str(pinfo->cinfo, COL_INFO, val_to_str(retcode, iap_return_vals, "0x%02X")); + + switch (op) + { + case GET_VALUE_BY_CLASS: + if (retcode == 0) + { + switch (tvb_get_guint8(tvb, offset + 6)) + { + case IAS_MISSING: + strcpy(buf, ", Missing"); + break; + + case IAS_INTEGER: + sprintf(buf, ", Integer: %d", tvb_get_ntohl(tvb, offset + 7)); + break; + + case IAS_OCT_SEQ: + sprintf(buf, ", %d Octets", tvb_get_ntohs(tvb, offset + 7)); + break; + + case IAS_STRING: + strcpy(buf, ", \""); + n = tvb_get_guint8(tvb, offset + 8); + tvb_memcpy(tvb, buf + 3, offset + 9, n); + strcpy(buf + 3 + n, "\""); + break; + } + col_append_str(pinfo->cinfo, COL_INFO, buf); + if (tvb_get_ntohs(tvb, offset + 2) > 1) + col_append_str(pinfo->cinfo, COL_INFO, ", ..."); + } + break; + } + } + + if (root) + { + /* create display subtree for the protocol */ + proto_item* ti = proto_tree_add_item(root, proto_iap, tvb, 0, -1, FALSE); + proto_tree* tree = proto_item_add_subtree(ti, ett_iap); + + proto_tree* ctl_tree; + proto_tree* entry_tree; + + + ti = proto_tree_add_item(tree, hf_iap_ctl, tvb, offset, 1, FALSE); + ctl_tree = proto_item_add_subtree(ti, ett_iap_ctl); + proto_tree_add_item(ctl_tree, hf_iap_ctl_lst, tvb, offset, 1, FALSE); + proto_tree_add_item(ctl_tree, hf_iap_ctl_ack, tvb, offset, 1, FALSE); + proto_tree_add_item(ctl_tree, hf_iap_ctl_opcode, tvb, offset, 1, FALSE); + offset++; + + proto_tree_add_item(tree, hf_iap_return, tvb, offset, 1, FALSE); + offset++; + + switch (op) + { + case GET_VALUE_BY_CLASS: + if (retcode == 0) + { + list_len = tvb_get_ntohs(tvb, offset); + + proto_tree_add_item(tree, hf_iap_list_len, tvb, offset, 2, FALSE); + offset += 2; + + while ((offset < len) && (n < list_len)) + { + type = tvb_get_guint8(tvb, offset + 2); + switch (type) + { + case IAS_INTEGER: + attr_len = 4; + break; + + case IAS_OCT_SEQ: + attr_len = tvb_get_ntohs(tvb, offset + 2 + 1) + 2; + break; + + case IAS_STRING: + attr_len = tvb_get_guint8(tvb, offset + 2 + 1 + 1) + 2; + break; + + default: + attr_len = 0; + } + + ti = proto_tree_add_item(tree, hf_iap_list_entry, tvb, offset, 2 + 1 + attr_len, FALSE); + snprintf(buf, sizeof(buf) - 1, "%d", n + 1); + proto_item_append_text(ti, buf); + entry_tree = proto_item_add_subtree(ti, ett_iap_entry[n]); + + proto_tree_add_item(entry_tree, hf_iap_obj_id, tvb, offset, 2, FALSE); + offset += 2; + + proto_tree_add_item(entry_tree, hf_iap_attr_type, tvb, offset, 1, FALSE); + offset++; + + switch (type) + { + case IAS_INTEGER: + if (!iap_conv || !iap_conv->pattr_dissector || + !iap_conv->pattr_dissector->value_dissector(tvb, offset, pinfo, entry_tree, + n, type)) + proto_tree_add_item(entry_tree, hf_iap_int, tvb, offset, 4, FALSE); + break; + + case IAS_OCT_SEQ: + proto_tree_add_item(entry_tree, hf_iap_seq_len, tvb, offset, 2, FALSE); + if (!iap_conv || !iap_conv->pattr_dissector || + !iap_conv->pattr_dissector->value_dissector(tvb, offset, pinfo, entry_tree, + n, type)) + proto_tree_add_item(entry_tree, hf_iap_oct_seq, tvb, offset + 2, + attr_len - 2, FALSE); + break; + + case IAS_STRING: + proto_tree_add_item(entry_tree, hf_iap_char_set, tvb, offset, 1, FALSE); + if (!iap_conv || !iap_conv->pattr_dissector || + !iap_conv->pattr_dissector->value_dissector(tvb, offset, pinfo, entry_tree, + n, type)) + proto_tree_add_item(entry_tree, hf_iap_string, tvb, offset + 1, 1, FALSE); + break; + } + offset += attr_len; + + n++; + } + } + break; + } + } + else + { + offset += 2; + switch (op) + { + case GET_VALUE_BY_CLASS: + if (retcode == 0) + { + offset += 2; + + while (offset < len) + { + offset += 2; + type = tvb_get_guint8(tvb, offset); + offset++; + + switch (type) + { + case IAS_INTEGER: + attr_len = 4; + if (iap_conv && iap_conv->pattr_dissector) + iap_conv->pattr_dissector->value_dissector(tvb, offset, pinfo, 0, + n, type); + break; + + case IAS_OCT_SEQ: + attr_len = tvb_get_ntohs(tvb, offset) + 2; + if (iap_conv && iap_conv->pattr_dissector) + iap_conv->pattr_dissector->value_dissector(tvb, offset, pinfo, 0, + n, type); + break; + + case IAS_STRING: + attr_len = tvb_get_guint8(tvb, offset + 1) + 2; + if (iap_conv && iap_conv->pattr_dissector) + iap_conv->pattr_dissector->value_dissector(tvb, offset, pinfo, 0, + n, type); + + default: + attr_len = 0; + } + offset += attr_len; + + n++; + } + } + break; + } + } + + /* If any bytes remain, send it to the generic data dissector */ + tvb = tvb_new_subset(tvb, offset, -1, -1); + call_dissector(data_handle, tvb, pinfo, root); +} + + +/* + * Check if IAP result is octet sequence + */ +gboolean check_iap_octet_result(tvbuff_t* tvb, proto_tree* tree, unsigned offset, + const char* attr_name, guint8 attr_type) +{ + if (attr_type != IAS_OCT_SEQ) + { + if (tree) + { + proto_item* ti = proto_tree_add_item(tree, hf_iap_invaloctet, tvb, offset, 0, FALSE); + proto_item_append_text(ti, attr_name); + proto_item_append_text(ti, "\" attribute must be octet sequence!"); + } + + return FALSE; + } + else + return TRUE; +} + + +/* + * Check if IAP result is correct LsapSel + */ +guint8 check_iap_lsap_result(tvbuff_t* tvb, proto_tree* tree, unsigned offset, + const char* attr_name, guint8 attr_type) +{ + guint32 lsap; + + + if ((attr_type != IAS_INTEGER) || ((lsap = tvb_get_ntohl(tvb, offset)) < 0x01) || + (lsap > 0x6F)) + { + if (tree) + { + proto_item* ti = proto_tree_add_item(tree, hf_iap_invallsap, tvb, offset, 0, FALSE); + proto_item_append_text(ti, attr_name); + proto_item_append_text(ti, "\" attribute must be integer value between 0x01 and 0x6F!"); + } + + return 0; + } + else + return lsap; +} + + +/* + * Dissect IrDA application protocol + */ +static void dissect_appl_proto(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root, pdu_type_t pdu_type) +{ + unsigned offset = 0; + guint8 src; + address srcaddr; + address destaddr; + conversation_t* conv; + lmp_conversation_t* cur_lmp_conv; + lmp_conversation_t* lmp_conv = NULL; + guint32 num; + + + src = pinfo->circuit_id ^ CMD_FRAME; + srcaddr.type = AT_NONE; + srcaddr.len = 1; + srcaddr.data = (char*)&src; + + destaddr.type = AT_NONE; + destaddr.len = 1; + destaddr.data = (char*)&pinfo->circuit_id; + + /* Find result value dissector */ + conv = find_conversation(&srcaddr, &destaddr, PT_NONE, pinfo->srcport, pinfo->destport, 0); + if (conv) + { + num = pinfo->fd->num; + + lmp_conv = (lmp_conversation_t*)conversation_get_proto_data(conv, PT_NONE); + while (lmp_conv && (lmp_conv->iap_result_frame >= num)) + lmp_conv = lmp_conv->pnext; + + if (lmp_conv) + { + cur_lmp_conv = lmp_conv->pnext; + while (cur_lmp_conv) + { + if ((cur_lmp_conv->iap_result_frame < num) && + (cur_lmp_conv->iap_result_frame > lmp_conv->iap_result_frame)) + { + lmp_conv = cur_lmp_conv; + } + + cur_lmp_conv = cur_lmp_conv->pnext; + } + } + } + + if (lmp_conv) + { +//g_message("%x:%d->%x:%d = %p\n", src, pinfo->srcport, pinfo->circuit_id, pinfo->destport, lmp_conv); +//g_message("->%d: %d %d %p\n", pinfo->fd->num, lmp_conv->iap_result_frame, lmp_conv->ttp, lmp_conv->proto_dissector); + if ((lmp_conv->ttp) && (pdu_type != DISCONNECT_PDU)) + { + offset += dissect_ttp(tvb, pinfo, root, (pdu_type == DATA_PDU)); + + tvb = tvb_new_subset(tvb, offset, -1, -1); + } + + pinfo->private_data = (void *)pdu_type; + + lmp_conv->proto_dissector(tvb, pinfo, root); + } + else + call_dissector(data_handle, tvb, pinfo, root); +} + + +/* + * Dissect LMP + */ +static void dissect_irlmp(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root) +{ + unsigned offset = 0; + guint8 dlsap; + guint8 slsap; + guint8 cbit; + guint8 opcode = 0; + + + /* Make entries in Protocol column on summary display */ + if (check_col(pinfo->cinfo, COL_PROTOCOL)) + col_set_str(pinfo->cinfo, COL_PROTOCOL, "IrLMP"); + + dlsap = tvb_get_guint8(tvb, offset); + cbit = dlsap & CONTROL_BIT; + dlsap &= ~CONTROL_BIT; + + slsap = tvb_get_guint8(tvb, offset+1) & ~CONTROL_BIT; + + /* save Lsaps in pinfo */ + pinfo->srcport = slsap; + pinfo->destport = dlsap; + + if (cbit != 0) + { + opcode = tvb_get_guint8(tvb, offset+2); + + if (check_col(pinfo->cinfo, COL_INFO)) + { + col_add_fstr(pinfo->cinfo, COL_INFO, "%d > %d, ", slsap, dlsap); + col_append_str(pinfo->cinfo, COL_INFO, val_to_str(opcode, lmp_opcode_vals, "0x%02X")); + if ((opcode == ACCESSMODE_CMD) || (opcode == ACCESSMODE_CNF)) + { + col_append_str(pinfo->cinfo, COL_INFO, " ("); + col_append_str(pinfo->cinfo, COL_INFO, + val_to_str(tvb_get_guint8(tvb, offset+4), lmp_mode_vals, "0x%02X")); + col_append_str(pinfo->cinfo, COL_INFO, ")"); + } + } + } + else + if (check_col(pinfo->cinfo, COL_INFO)) + col_add_fstr(pinfo->cinfo, COL_INFO, "%d > %d, Len=%d", slsap, dlsap, + tvb_length(tvb) - 2); + + if (root) + { + /* create display subtree for the protocol */ + proto_item* ti = proto_tree_add_item(root, proto_irlmp, tvb, 0, -1, FALSE); + proto_tree* tree = proto_item_add_subtree(ti, ett_irlmp); + + proto_tree* dst_tree; + proto_tree* src_tree; + + + ti = proto_tree_add_item(tree, hf_lmp_dst, tvb, offset, 1, FALSE); + dst_tree = proto_item_add_subtree(ti, ett_lmp_dst); + proto_tree_add_item(dst_tree, hf_lmp_dst_control, tvb, offset, 1, FALSE); + proto_tree_add_item(dst_tree, hf_lmp_dst_lsap, tvb, offset, 1, FALSE); + offset++; + + ti = proto_tree_add_item(tree, hf_lmp_src, tvb, offset, 1, FALSE); + src_tree = proto_item_add_subtree(ti, ett_lmp_src); + proto_tree_add_item(src_tree, hf_lmp_src_r, tvb, offset, 1, FALSE); + proto_tree_add_item(src_tree, hf_lmp_src_lsap, tvb, offset, 1, FALSE); + offset++; + + if (cbit != 0) + { + proto_tree_add_item(tree, hf_lmp_opcode, tvb, offset, 1, FALSE); + offset++; + + switch (opcode) + { + case CONNECT_CMD: + case CONNECT_CNF: + if (offset < tvb_length(tvb)) + { + proto_tree_add_item(tree, hf_lmp_rsvd, tvb, offset, 1, FALSE); + offset++; + } + break; + + case DISCONNECT: + proto_tree_add_item(tree, hf_lmp_reason, tvb, offset, 1, FALSE); + offset++; + break; + + case ACCESSMODE_CMD: + proto_tree_add_item(tree, hf_lmp_rsvd, tvb, offset, 1, FALSE); + offset++; + + proto_tree_add_item(tree, hf_lmp_mode, tvb, offset, 1, FALSE); + offset++; + break; + + case ACCESSMODE_CNF: + proto_tree_add_item( tree, hf_lmp_status, tvb, offset, 1, FALSE); + offset++; + + proto_tree_add_item(tree, hf_lmp_mode, tvb, offset, 1, FALSE); + offset++; + break; + } + } + + tvb = tvb_new_subset(tvb, offset, -1, -1); + proto_item_set_len(tree, offset); + } + else + { + offset += 2; + if (cbit != 0) + { + offset += 1; + + switch (opcode) + { + case CONNECT_CMD: + case CONNECT_CNF: + if (offset < tvb_length(tvb)) + offset++; + break; + + case DISCONNECT: + offset++; + break; + + case ACCESSMODE_CMD: + case ACCESSMODE_CNF: + offset += 2; + break; + } + } + + tvb = tvb_new_subset(tvb, offset, -1, -1); + } + + if (cbit == 0) + { + if (dlsap == LSAP_IAS) + dissect_iap_request(tvb, pinfo, root); + else if (slsap == LSAP_IAS) + dissect_iap_result(tvb, pinfo, root); + else + dissect_appl_proto(tvb, pinfo, root, DATA_PDU); + } + else + { + if ((dlsap == LSAP_IAS) || (slsap == LSAP_IAS)) + call_dissector(data_handle, tvb, pinfo, root); + else + switch (opcode) + { + case CONNECT_CMD: + case CONNECT_CNF: + dissect_appl_proto(tvb, pinfo, root, CONNECT_PDU); + break; + + case DISCONNECT: + dissect_appl_proto(tvb, pinfo, root, DISCONNECT_PDU); + break; + + default: + call_dissector(data_handle, tvb, pinfo, root); + } + } +} + + +/* + * Add LMP conversation + */ +void add_lmp_conversation(packet_info* pinfo, guint8 dlsap, gboolean ttp, dissector_t proto_dissector) +{ + guint8 dest; + address srcaddr; + address destaddr; + conversation_t* conv; + lmp_conversation_t* lmp_conv = NULL; + + +//g_message("%d: add_lmp_conversation(%p, %d, %d, %p) = ", pinfo->fd->num, pinfo, dlsap, ttp, proto_dissector); + srcaddr.type = AT_NONE; + srcaddr.len = 1; + srcaddr.data = (char*)&pinfo->circuit_id; + + dest = pinfo->circuit_id ^ CMD_FRAME; + destaddr.type = AT_NONE; + destaddr.len = 1; + destaddr.data = (char*)&dest; + + conv = find_conversation(&destaddr, &srcaddr, PT_NONE, dlsap, 0, NO_PORT_B); + if (conv) + { + lmp_conv = (lmp_conversation_t*)conversation_get_proto_data(conv, PT_NONE); + while (1) + { + /* Does entry already exist? */ + if (lmp_conv->iap_result_frame == pinfo->fd->num) + return; + + if (lmp_conv->pnext == NULL) + { + lmp_conv->pnext = g_mem_chunk_alloc(lmp_conv_chunk); + lmp_conv = lmp_conv->pnext; + break; + } + lmp_conv = lmp_conv->pnext; + } + } + else + { + conv = conversation_new(&destaddr, &srcaddr, PT_NONE, dlsap, 0, NO_PORT_B); + lmp_conv = g_mem_chunk_alloc(lmp_conv_chunk); + conversation_add_proto_data(conv, PT_NONE, (void*)lmp_conv); + } + + lmp_conv->pnext = NULL; + lmp_conv->iap_result_frame = pinfo->fd->num; + lmp_conv->ttp = ttp; + lmp_conv->proto_dissector = proto_dissector; + +//g_message("%p\n", lmp_conv); +} + + +/* + * Dissect Negotiation Parameters + */ +static unsigned dissect_negotiation(tvbuff_t* tvb, proto_tree* tree, unsigned offset) +{ + unsigned len = tvb_length(tvb); + unsigned n = 0; + proto_item* ti; + proto_tree* p_tree; + char buf[256]; + guint8 pv; + + + while (offset < len) + { + guint8 p_len = tvb_get_guint8(tvb, offset + 1); + + + ti = proto_tree_add_item(tree, hf_negotiation_param, tvb, offset, p_len + 2, FALSE); + p_tree = proto_item_add_subtree(ti, ett_param[n]); + + pv = tvb_get_guint8(tvb, offset+2); + buf[0] = 0; + + switch (tvb_get_guint8(tvb, offset)) + { + case PI_BAUD_RATE: + proto_item_append_text(ti, ": Baud Rate ("); + + if (pv & 0x01) + strcat(buf, ", 2400"); + if (pv & 0x02) + strcat(buf, ", 9600"); + if (pv & 0x04) + strcat(buf, ", 19200"); + if (pv & 0x08) + strcat(buf, ", 38400"); + if (pv & 0x10) + strcat(buf, ", 57600"); + if (pv & 0x20) + strcat(buf, ", 115200"); + if (pv & 0x40) + strcat(buf, ", 576000"); + if (pv & 0x80) + strcat(buf, ", 1152000"); + if ((p_len > 1) && (tvb_get_guint8(tvb, offset+3) & 0x01)) + strcat(buf, ", 4000000"); + + strcat(buf, " bps)"); + + proto_item_append_text(ti, buf+2); + + break; + + case PI_MAX_TURN_TIME: + proto_item_append_text(ti, ": Maximum Turn Time ("); + + if (pv & 0x01) + strcat(buf, ", 500"); + if (pv & 0x02) + strcat(buf, ", 250"); + if (pv & 0x04) + strcat(buf, ", 100"); + if (pv & 0x08) + strcat(buf, ", 50"); + + strcat(buf, " ms)"); + + proto_item_append_text(ti, buf+2); + + break; + + case PI_DATA_SIZE: + proto_item_append_text(ti, ": Data Size ("); + + if (pv & 0x01) + strcat(buf, ", 64"); + if (pv & 0x02) + strcat(buf, ", 128"); + if (pv & 0x04) + strcat(buf, ", 256"); + if (pv & 0x08) + strcat(buf, ", 512"); + if (pv & 0x10) + strcat(buf, ", 1024"); + if (pv & 0x20) + strcat(buf, ", 2048"); + + strcat(buf, " bytes)"); + + proto_item_append_text(ti, buf+2); + + break; + + case PI_WINDOW_SIZE: + proto_item_append_text(ti, ": Window Size ("); + + if (pv & 0x01) + strcat(buf, ", 1"); + if (pv & 0x02) + strcat(buf, ", 2"); + if (pv & 0x04) + strcat(buf, ", 3"); + if (pv & 0x08) + strcat(buf, ", 4"); + if (pv & 0x10) + strcat(buf, ", 5"); + if (pv & 0x20) + strcat(buf, ", 6"); + if (pv & 0x40) + strcat(buf, ", 7"); + + strcat(buf, " frame window)"); + + proto_item_append_text(ti, buf+2); + + break; + + case PI_ADD_BOFS: + proto_item_append_text(ti, ": Additional BOFs ("); + + if (pv & 0x01) + strcat(buf, ", 48"); + if (pv & 0x02) + strcat(buf, ", 24"); + if (pv & 0x04) + strcat(buf, ", 12"); + if (pv & 0x08) + strcat(buf, ", 5"); + if (pv & 0x10) + strcat(buf, ", 3"); + if (pv & 0x20) + strcat(buf, ", 2"); + if (pv & 0x40) + strcat(buf, ", 1"); + if (pv & 0x80) + strcat(buf, ", 0"); + + strcat(buf, " additional BOFs at 115200)"); + + proto_item_append_text(ti, buf+2); + + break; + + case PI_MIN_TURN_TIME: + proto_item_append_text(ti, ": Minimum Turn Time ("); + + if (pv & 0x01) + strcat(buf, ", 10"); + if (pv & 0x02) + strcat(buf, ", 5"); + if (pv & 0x04) + strcat(buf, ", 1"); + if (pv & 0x08) + strcat(buf, ", 0.5"); + if (pv & 0x10) + strcat(buf, ", 0.1"); + if (pv & 0x20) + strcat(buf, ", 0.05"); + if (pv & 0x40) + strcat(buf, ", 0.01"); + if (pv & 0x80) + strcat(buf, ", 0"); + + strcat(buf, " ms)"); + + proto_item_append_text(ti, buf+2); + + break; + + case PI_LINK_DISC: + proto_item_append_text(ti, ": Link Disconnect/Threshold Time ("); + + if (pv & 0x01) + strcat(buf, ", 3/0"); + if (pv & 0x02) + strcat(buf, ", 8/3"); + if (pv & 0x04) + strcat(buf, ", 12/3"); + if (pv & 0x08) + strcat(buf, ", 16/3"); + if (pv & 0x10) + strcat(buf, ", 20/3"); + if (pv & 0x20) + strcat(buf, ", 25/3"); + if (pv & 0x40) + strcat(buf, ", 30/3"); + if (pv & 0x80) + strcat(buf, ", 40/3"); + + strcat(buf, " s)"); + + proto_item_append_text(ti, buf+2); + + break; + + default: + proto_item_append_text(ti, ": unknown"); + } + + offset = dissect_param_tuple(tvb, p_tree, offset); + n++; + } + + return offset; +} + + +/* + * Dissect XID packet + */ +static void dissect_xid(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root, proto_tree* lap_tree) +{ + unsigned len = tvb_length(tvb); + unsigned offset = 0; + + + if (lap_tree) + { + proto_item* ti; + proto_tree* i_tree; + proto_tree* flags_tree; + + + ti = proto_tree_add_item(lap_tree, hf_lap_i, tvb, offset, -1, FALSE); + i_tree = proto_item_add_subtree(ti, ett_lap_i); + + proto_tree_add_item(i_tree, hf_xid_ident, tvb, offset, 1, FALSE); + offset++; + + proto_tree_add_item(i_tree, hf_xid_saddr, tvb, offset, 4, FALSE); + offset += 4; + + proto_tree_add_item(i_tree, hf_xid_daddr, tvb, offset, 4, FALSE); + offset += 4; + + ti = proto_tree_add_item(i_tree, hf_xid_flags, tvb, offset, 1, FALSE); + flags_tree = proto_item_add_subtree(ti, ett_xid_flags); + proto_tree_add_item(flags_tree, hf_xid_s, tvb, offset, 1, FALSE); + proto_tree_add_item(flags_tree, hf_xid_conflict, tvb, offset, 1, FALSE); + offset++; + + ti = proto_tree_add_item(i_tree, hf_xid_slotnr, tvb, offset, 1, FALSE); + if (tvb_get_guint8(tvb, offset) == 0xFF) + proto_item_append_text(ti, " (final)"); + offset++; + + proto_tree_add_item(i_tree, hf_xid_version, tvb, offset, 1, FALSE); + offset++; + + proto_item_set_len(lap_tree, proto_item_get_len(lap_tree) - (tvb_length(tvb) - offset)); + proto_item_set_len(i_tree, offset); + } + else + offset += 12; /* skip IrLAP-related XID content */ + + if (offset < len) + { + unsigned hints_len; + guint8 hint1 = 0; + guint8 hint2 = 0; + + + for (hints_len = 0;;) + { + guint8 hint = tvb_get_guint8(tvb, offset + hints_len++); + + if (hints_len == 1) + hint1 = hint; + else if (hints_len == 2) + hint2 = hint; + + if ((hint & 0x80) == 0) + break; + } + + if (check_col(pinfo->cinfo, COL_INFO) && ((offset + hints_len) < len) && + (tvb_get_guint8(tvb, offset + hints_len) == 0x00)) + { + char buf[23]; + unsigned name_len = len - offset - hints_len - 1; + + if (name_len > 22) + name_len = 22; + tvb_memcpy(tvb, buf, offset + hints_len + 1, name_len); + buf[name_len] = 0; + col_append_str(pinfo->cinfo, COL_INFO, ", \""); + col_append_str(pinfo->cinfo, COL_INFO, buf); + col_append_str(pinfo->cinfo, COL_INFO, "\""); + } + + if (root) + { + proto_item* ti; + proto_tree* lmp_tree; + + + ti = proto_tree_add_item(root, proto_irlmp, tvb, offset, -1, FALSE); + lmp_tree = proto_item_add_subtree(ti, ett_irlmp); + + ti = proto_tree_add_item(lmp_tree, hf_lmp_xid_hints, tvb, offset, hints_len, FALSE); + offset += hints_len; + + if ((hint1 | hint2) != 0) + { + char service_hints[256]; + + + service_hints[0] = 0; + + if (hint1 & 0x01) + strcat(service_hints, ", PnP Compatible"); + if (hint1 & 0x02) + strcat(service_hints, ", PDA/Palmtop"); + if (hint1 & 0x04) + strcat(service_hints, ", Computer"); + if (hint1 & 0x08) + strcat(service_hints, ", Printer"); + if (hint1 & 0x10) + strcat(service_hints, ", Modem"); + if (hint1 & 0x20) + strcat(service_hints, ", Fax"); + if (hint1 & 0x40) + strcat(service_hints, ", LAN Access"); + if (hint2 & 0x01) + strcat(service_hints, ", Telephony"); + if (hint2 & 0x02) + strcat(service_hints, ", File Server"); + if (hint2 & 0x04) + strcat(service_hints, ", IrCOMM"); + if (hint2 & 0x20) + strcat(service_hints, ", OBEX"); + + strcat(service_hints, ")"); + service_hints[0] = ' '; + service_hints[1] = '('; + + proto_item_append_text(ti, service_hints); + } + + if (offset < len) + { + proto_tree_add_item(lmp_tree, hf_lmp_xid_charset, tvb, offset, 1, FALSE); + + if (tvb_get_guint8(tvb, offset++) == 0x00) + proto_tree_add_item(lmp_tree, hf_lmp_xid_name, tvb, offset, + len - offset, FALSE); + else + proto_tree_add_item(lmp_tree, hf_lmp_xid_name_no_ascii, tvb, offset, + len - offset, FALSE); + } + } + } +} + + +/* + * Dissect Log Messages + */ +static void dissect_log(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root) +{ + /* Make entries in Protocol column on summary display */ + if (check_col(pinfo->cinfo, COL_PROTOCOL)) + col_set_str(pinfo->cinfo, COL_PROTOCOL, "Log"); + + /* missed messages? */ + if (pinfo->pseudo_header->irda.pkttype == IRDA_MISSED_MSG) + { + if (check_col(pinfo->cinfo, COL_INFO)) + col_set_str(pinfo->cinfo, COL_INFO, + "WARNING: Missed one or more messages while capturing!"); + } + else if (check_col(pinfo->cinfo, COL_INFO)) + { + guint length; + char buf[256]; + + + length = tvb_length(tvb); + if (length > sizeof(buf)-1) + length = sizeof(buf)-1; + tvb_memcpy(tvb, buf, 0, length); + buf[length] = 0; + if (buf[length-1] == '\n') + buf[length-1] = 0; + else if (buf[length-2] == '\n') + buf[length-2] = 0; + + col_add_str(pinfo->cinfo, COL_INFO, buf); + } + + if (root) + { + proto_item* ti = proto_tree_add_item(root, proto_log, tvb, 0, -1, FALSE); + proto_tree* tree = proto_item_add_subtree(ti, ett_log); + + if (pinfo->pseudo_header->irda.pkttype == IRDA_MISSED_MSG) + proto_tree_add_item(tree, hf_log_missed, tvb, 0, 0, FALSE); + else + proto_tree_add_item(tree, hf_log_msg, tvb, 0, -1, FALSE); + } +} + + +/* + * Dissect IrLAP + */ +static void dissect_irlap(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root) +{ + guint8 a, c, op; + guint offset = 0; + int set_ca = TRUE; + char addr[9]; + + + /* decode values used for demuxing */ + a = tvb_get_guint8(tvb, 0); + c = tvb_get_guint8(tvb, 1); + + /* save connection address field in pinfo */ + pinfo->circuit_id = a; + + /* Make entries in Protocol column on summary display */ + if (check_col(pinfo->cinfo, COL_PROTOCOL)) + col_set_str(pinfo->cinfo, COL_PROTOCOL, "IrLAP"); + + switch (c & 3) + { + case 1: + /* Supervisory (S) */ + op = c & ~(PF_BIT | NR_MASK); + if (check_col(pinfo->cinfo, COL_INFO)) + { + col_add_str(pinfo->cinfo, COL_INFO, val_to_str(op, lap_c_s_abbr_vals, "0x%02X")); + col_append_fstr(pinfo->cinfo, COL_INFO, "%s, Nr=%d", + ((a & CMD_FRAME) != 0) ? " command" : " response", c >> 5); + } + break; + + case 3: + /* Unnumbered (U) */ + op = c & ~PF_BIT; + if (check_col(pinfo->cinfo, COL_INFO)) + { + if ((a & CMD_FRAME) != 0) + col_add_str(pinfo->cinfo, COL_INFO, + val_to_str(op, lap_c_u_cmd_abbr_vals, "0x%02X")); + else + col_add_str(pinfo->cinfo, COL_INFO, + val_to_str(op, lap_c_u_rsp_abbr_vals, "0x%02X")); + col_append_str(pinfo->cinfo, COL_INFO, + ((a & CMD_FRAME) != 0) ? " command" : " response"); + } + break; + + default: + /* Information (I) */ + op = I_FRAME; + } + + switch (op) + { + case SNRM_CMD: /* includes RNRM_RSP! */ + if ((a & CMD_FRAME) != 0) + { + if (check_col(pinfo->cinfo, COL_DEF_SRC)) + col_add_fstr(pinfo->cinfo, COL_DEF_SRC, "0x%08X", tvb_get_letohl(tvb, 2)); + if (check_col(pinfo->cinfo, COL_DEF_DST)) + col_add_fstr(pinfo->cinfo, COL_DEF_DST, "0x%08X", tvb_get_letohl(tvb, 6)); + set_ca = FALSE; + + if (check_col(pinfo->cinfo, COL_INFO)) + col_append_fstr(pinfo->cinfo, COL_INFO, ", ca=0x%02X", + tvb_get_guint8(tvb, 10) >> 1); + } + break; + + case XID_CMD: + { + guint8 s; + + + if (check_col(pinfo->cinfo, COL_DEF_SRC)) + col_add_fstr(pinfo->cinfo, COL_DEF_SRC, "0x%08X", tvb_get_letohl(tvb, 3)); + if (check_col(pinfo->cinfo, COL_DEF_DST)) + col_add_fstr(pinfo->cinfo, COL_DEF_DST, "0x%08X", tvb_get_letohl(tvb, 7)); + set_ca = FALSE; + + if (check_col(pinfo->cinfo, COL_INFO)) + { + s = tvb_get_guint8(tvb, 12); + if (s == 0xFF) + col_append_str(pinfo->cinfo, COL_INFO, ", s=final"); + else + col_append_fstr(pinfo->cinfo, COL_INFO, ", s=%d", s); + } + break; + } + case UA_RSP: + if (tvb_length(tvb) > 2) + { + if (check_col(pinfo->cinfo, COL_DEF_SRC)) + col_add_fstr(pinfo->cinfo, COL_DEF_SRC, "0x%08X", tvb_get_letohl(tvb, 2)); + if (check_col(pinfo->cinfo, COL_DEF_DST)) + col_add_fstr(pinfo->cinfo, COL_DEF_DST, "0x%08X", tvb_get_letohl(tvb, 6)); + set_ca = FALSE; + } + break; + + case XID_RSP: + { + guint8 s; + + + if (check_col(pinfo->cinfo, COL_DEF_SRC)) + col_add_fstr(pinfo->cinfo, COL_DEF_SRC, "0x%08X", tvb_get_letohl(tvb, 3)); + if (check_col(pinfo->cinfo, COL_DEF_DST)) + col_add_fstr(pinfo->cinfo, COL_DEF_DST, "0x%08X", tvb_get_letohl(tvb, 7)); + set_ca = FALSE; + + if (check_col(pinfo->cinfo, COL_INFO)) + { + s = tvb_get_guint8(tvb, 12); + col_append_fstr(pinfo->cinfo, COL_INFO, ", s=%d", s); + } + break; + } + } + + /* set address columns to connection address? */ + if (set_ca) + { + snprintf(addr, sizeof(addr)-1, "0x%02X", a >> 1); + if (check_col(pinfo->cinfo, COL_DEF_SRC)) + col_add_str(pinfo->cinfo, COL_DEF_SRC, addr); + if (check_col(pinfo->cinfo, COL_DEF_DST)) + col_add_str(pinfo->cinfo, COL_DEF_DST, addr); + } + + /* set direction column */ + if (check_col(pinfo->cinfo, COL_IF_DIR)) + { + switch (pinfo->pseudo_header->irda.pkttype) + { + case IRDA_OUTGOING: + col_set_str(pinfo->cinfo, COL_IF_DIR, "Out"); + break; + + case IRDA_INCOMING: + col_set_str(pinfo->cinfo, COL_IF_DIR, "In"); + break; + } + } + + if (root) + { + /* create display subtree for the protocol */ + proto_item* ti = proto_tree_add_item(root, proto_irlap, tvb, 0, -1, FALSE); + proto_tree* tree = proto_item_add_subtree(ti, ett_irlap); + + /* Set up structures needed to add the protocol subtree and manage it */ + proto_tree* a_tree; + proto_item* addr_item; + proto_tree* c_tree; + proto_tree* i_tree; + + ti = proto_tree_add_item(tree, hf_lap_a, tvb, offset, 1, FALSE); + a_tree = proto_item_add_subtree(ti, ett_lap_a); + proto_tree_add_item(a_tree, hf_lap_a_cr, tvb, offset, 1, FALSE); + addr_item = proto_tree_add_item(a_tree, hf_lap_a_address, tvb, offset, 1, FALSE); + switch (a & ~CMD_FRAME) + { + case 0: + proto_item_append_text(addr_item, " (NULL Address)"); + break; + case 0xFE: + proto_item_append_text(addr_item, " (Broadcast)"); + break; + } + offset++; + + ti = proto_tree_add_item(tree, hf_lap_c, tvb, offset, 1, FALSE); + proto_item_append_text(ti, " ("); + c_tree = proto_item_add_subtree(ti, ett_lap_c); + switch (c & 3) + { + case 1: + /* Supervisory (S) */ + proto_item_append_text(ti, val_to_str(op, lap_c_s_abbr_vals, "0x%02X")); + proto_tree_add_item(c_tree, hf_lap_c_s, tvb, offset, 1, FALSE); + proto_tree_add_item(c_tree, hf_lap_c_pf, tvb, offset, 1, FALSE); + proto_tree_add_item(c_tree, hf_lap_c_nr, tvb, offset, 1, FALSE); + break; + case 3: + /* Unnumbered (U) */ + if ((a & CMD_FRAME) != 0) + { + proto_item_append_text(ti, val_to_str(op, lap_c_u_cmd_abbr_vals, "0x%02X")); + proto_tree_add_item(c_tree, hf_lap_c_u_cmd, tvb, offset, 1, FALSE); + } + else + { + proto_item_append_text(ti, val_to_str(op, lap_c_u_rsp_abbr_vals, "0x%02X")); + proto_tree_add_item(c_tree, hf_lap_c_u_rsp, tvb, offset, 1, FALSE); + } + proto_tree_add_item(c_tree, hf_lap_c_pf, tvb, offset, 1, FALSE); + break; + default: + /* Information (I) */ + proto_item_append_text(ti, "I"); + proto_tree_add_item(c_tree, hf_lap_c_i, tvb, offset, 1, FALSE); + proto_tree_add_item(c_tree, hf_lap_c_ns, tvb, offset, 1, FALSE); + proto_tree_add_item(c_tree, hf_lap_c_pf, tvb, offset, 1, FALSE); + proto_tree_add_item(c_tree, hf_lap_c_nr, tvb, offset, 1, FALSE); + } + proto_item_append_text(ti, ")"); + offset++; + + switch (op) + { + case SNRM_CMD: + { + guint8 ca; + guint i_start = offset; + + + ti = proto_tree_add_item(tree, hf_lap_i, tvb, offset, -1, FALSE); + i_tree = proto_item_add_subtree(ti, ett_lap_i); + + proto_tree_add_item(i_tree, hf_snrm_saddr, tvb, offset, 4, TRUE); + offset += 4; + + proto_tree_add_item(i_tree, hf_snrm_daddr, tvb, offset, 4, TRUE); + offset += 4; + + ca = tvb_get_guint8(tvb, offset); + proto_tree_add_uint(i_tree, hf_snrm_ca, tvb, offset, 1, ca >> 1); + offset++; + + offset = dissect_negotiation(tvb, i_tree, offset); + proto_item_set_len(ti, offset - i_start); + break; + } + case UA_RSP: + { + guint i_start = offset; + + + if ((tvb_length(tvb) - offset) > 0) + { + ti = proto_tree_add_item(tree, hf_lap_i, tvb, offset, -1, FALSE); + i_tree = proto_item_add_subtree(ti, ett_lap_i); + + proto_tree_add_item(i_tree, hf_ua_saddr, tvb, offset, 4, FALSE); + offset += 4; + + proto_tree_add_item(i_tree, hf_ua_daddr, tvb, offset, 4, FALSE); + offset += 4; + + offset = dissect_negotiation(tvb, i_tree, offset); + proto_item_set_len(ti, offset - i_start); + } + break; + } + case XID_CMD: + case XID_RSP: + dissect_xid(tvb_new_subset(tvb, offset, -1, -1), pinfo, root, tree); + return; + + case I_FRAME: + proto_item_set_len(tree, offset); + dissect_irlmp(tvb_new_subset(tvb, offset, -1, -1), pinfo, root); + return; + } + } + else + { + /* no tree, still check for subdissectors though */ + switch (op) + { + case XID_CMD: + case XID_RSP: + offset = 2; /* skip A and C Field */ + dissect_xid(tvb_new_subset(tvb, offset, -1, -1), pinfo, 0, 0); + return; + + case I_FRAME: + offset = 2; /* skip A and C Field */ + dissect_irlmp(tvb_new_subset(tvb, offset, -1, -1), pinfo, 0); + return; + } + } + + /* If any bytes remain, send it to the generic data dissector */ + tvb = tvb_new_subset(tvb, offset, -1, -1); + call_dissector(data_handle, tvb, pinfo, root); +} + + +/* + * Dissect IrDA protocol + */ +static void dissect_irda(tvbuff_t* tvb, packet_info* pinfo, proto_tree* root) +{ + /* load the display labels */ + pinfo->current_proto = "IrDA"; + + /* check if log message */ + if ((pinfo->pseudo_header->irda.pkttype & IRDA_CLASS_MASK) == IRDA_CLASS_LOG) + { + dissect_log(tvb, pinfo, root); + return; + } + + + dissect_irlap(tvb, pinfo, root); +} + + +/* + * Re-initialize the IrDA dissector + */ +static void init_irda(void) +{ + if (iap_conv_chunk) + g_mem_chunk_destroy(iap_conv_chunk); + if (lmp_conv_chunk) + g_mem_chunk_destroy(lmp_conv_chunk); + + iap_conv_chunk = g_mem_chunk_new("iap_conversation", sizeof(iap_conversation_t), + 10 * sizeof(iap_conversation_t), G_ALLOC_AND_FREE); + lmp_conv_chunk = g_mem_chunk_new("lmp_conversation", sizeof(lmp_conversation_t), + 10 * sizeof(lmp_conversation_t), G_ALLOC_AND_FREE); +} + + +/* + * Register the protocol with Ethereal + * This format is required because a script is used to build the C function + * that calls all the protocol registrations. + */ +static void proto_register_irda(void) +{ + unsigned i; + + /* Setup list of header fields */ + static hf_register_info hf_lap[] = { + { &hf_lap_a, + { "Address Field", "irlap.a", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_lap_a_cr, + { "C/R", "irlap.a.cr", + FT_BOOLEAN, 8, TFS(&lap_cr_vals), CMD_FRAME, + "", HFILL }}, + { &hf_lap_a_address, + { "Address", "irlap.a.address", + FT_UINT8, BASE_HEX, NULL, ~CMD_FRAME, + "", HFILL }}, + { &hf_lap_c, + { "Control Field", "irlap.c", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_lap_c_u_cmd, + { "Unnumbered", "irlap.c.u_c", + FT_UINT8, BASE_HEX, VALS(lap_c_u_cmd_vals), ~PF_BIT, + "", HFILL }}, + { &hf_lap_c_u_rsp, + { "Unnumbered", "irlap.c.u_r", + FT_UINT8, BASE_HEX, VALS(lap_c_u_rsp_vals), ~PF_BIT, + "", HFILL }}, + { &hf_lap_c_s, + { "Supervisory", "irlap.c.s", + FT_UINT8, BASE_HEX, VALS(lap_c_s_vals), ~(PF_BIT | NR_MASK), + "", HFILL }}, + { &hf_lap_c_i, + { "Information Format", "irlap.c.i", + FT_UINT8, BASE_HEX, NULL, ~(PF_BIT | NR_MASK | NS_MASK), + "", HFILL }}, + { &hf_lap_c_pf, + { "Poll/Final", "irlap.c.pf", + FT_BOOLEAN, 8, TFS(&set_notset), PF_BIT, + "", HFILL }}, + { &hf_lap_c_nr, + { "Nr", "irlap.c.nr", + FT_UINT8, BASE_DEC, NULL, NR_MASK, + "", HFILL }}, + { &hf_lap_c_ns, + { "Ns", "irlap.c.ns", + FT_UINT8, BASE_DEC, NULL, NS_MASK, + "", HFILL }}, + { &hf_lap_i, + { "Information Field", "irlap.i", + FT_NONE, BASE_NONE, NULL, 0, + "", HFILL }}, + { &hf_snrm_saddr, + { "Source Device Address", "irlap.snrm.saddr", + FT_UINT32, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_snrm_daddr, + { "Destination Device Address", "irlap.snrm.daddr", + FT_UINT32, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_snrm_ca, + { "Connection Address", "irlap.snrm.ca", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_negotiation_param, + { "Negotiation Parameter", "irlap.negotiation", + FT_NONE, BASE_NONE, NULL, 0, + "", HFILL }}, + { &hf_param_pi, + { "Parameter Identifier", "irlap.pi", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_param_pl, + { "Parameter Length", "irlap.pl", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_param_pv, + { "Parameter Value", "irlap.pv", + FT_BYTES, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_ua_saddr, + { "Source Device Address", "irlap.ua.saddr", + FT_UINT32, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_ua_daddr, + { "Destination Device Address", "irlap.ua.daddr", + FT_UINT32, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_xid_ident, + { "Format Identifier", "irlap.xid.fi", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_xid_saddr, + { "Source Device Address", "irlap.xid.saddr", + FT_UINT32, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_xid_daddr, + { "Destination Device Address", "irlap.xid.daddr", + FT_UINT32, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_xid_flags, + { "Discovery Flags", "irlap.xid.flags", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_xid_s, + { "Number of Slots", "irlap.xid.s", + FT_UINT8, BASE_DEC, VALS(&xid_slot_numbers), S_MASK, + "", HFILL }}, + { &hf_xid_conflict, + { "Conflict", "irlap.xid.conflict", + FT_BOOLEAN, 8, TFS(&set_notset), CONFLICT, + "", HFILL }}, + { &hf_xid_slotnr, + { "Slot Number", "irlap.xid.slotnr", + FT_UINT8, BASE_DEC, NULL, 0, + "", HFILL }}, + { &hf_xid_version, + { "Version Number", "irlap.xid.version", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }} + }; + + static hf_register_info hf_log[] = { + { &hf_log_msg, + { "Message", "log.msg", + FT_STRING, BASE_NONE, NULL, 0, + "", HFILL }}, + { &hf_log_missed, + { "WARNING: Missed one or more messages while capturing!", "log.missed", + FT_NONE, BASE_NONE, NULL, 0, + "", HFILL }} + }; + + static hf_register_info hf_lmp[] = { + { &hf_lmp_xid_hints, + { "Service Hints", "irlmp.xid.hints", + FT_BYTES, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_lmp_xid_charset, + { "Character Set", "irlmp.xid.charset", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_lmp_xid_name, + { "Device Nickname", "irlmp.xid.name", + FT_STRING, BASE_NONE, NULL, 0, + "", HFILL }}, + { &hf_lmp_xid_name_no_ascii, + { "Device Nickname (unsupported character set)", "irlmp.xid.name", + FT_BYTES, BASE_NONE, NULL, 0, + "", HFILL }}, + { &hf_lmp_dst, + { "Destination", "irlmp.dst", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_lmp_dst_control, + { "Control Bit", "irlmp.dst.c", + FT_BOOLEAN, 8, TFS(&set_notset), CONTROL_BIT, + "", HFILL }}, + { &hf_lmp_dst_lsap, + { "Destination LSAP", "irlmp.dst.lsap", + FT_UINT8, BASE_DEC, NULL, ~CONTROL_BIT, + "", HFILL }}, + { &hf_lmp_src, + { "Source", "irlmp.src", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_lmp_src_r, + { "reserved", "irlmp.src.r", + FT_UINT8, BASE_DEC, NULL, RESERVED_BIT, + "", HFILL }}, + { &hf_lmp_src_lsap, + { "Source LSAP", "irlmp.src.lsap", + FT_UINT8, BASE_DEC, NULL, ~RESERVED_BIT, + "", HFILL }}, + { &hf_lmp_opcode, + { "Opcode", "irlmp.opcode", + FT_UINT8, BASE_HEX, VALS(lmp_opcode_vals), 0x0, + "", HFILL }}, + { &hf_lmp_rsvd, + { "Reserved", "irlmp.rsvd", + FT_UINT8, BASE_HEX, NULL, 0x0, + "", HFILL }}, + { &hf_lmp_reason, + { "Reason", "irlmp.reason", + FT_UINT8, BASE_HEX, VALS(lmp_reason_vals), 0x0, + "", HFILL }}, + { &hf_lmp_mode, + { "Mode", "irlmp.mode", + FT_UINT8, BASE_HEX, VALS(lmp_mode_vals), 0x0, + "", HFILL }}, + { &hf_lmp_status, + { "Status", "irlmp.status", + FT_UINT8, BASE_HEX, VALS(lmp_status_vals), 0x0, + "", HFILL }} + }; + + static hf_register_info hf_iap[] = { + { &hf_iap_ctl, + { "Control Field", "iap.ctl", + FT_UINT8, BASE_HEX, NULL, 0, + "", HFILL }}, + { &hf_iap_ctl_lst, + { "Last Frame", "iap.ctl.lst", + FT_BOOLEAN, 8, TFS(&set_notset), IAP_LST, + "", HFILL }}, + { &hf_iap_ctl_ack, + { "Acknowledge", "iap.ctl.ack", + FT_BOOLEAN, 8, TFS(&set_notset), IAP_ACK, + "", HFILL }}, + { &hf_iap_ctl_opcode, + { "Opcode", "iap.ctl.opcode", + FT_UINT8, BASE_HEX, VALS(iap_opcode_vals), IAP_OP, + "", HFILL }}, + { &hf_iap_class_name, + { "Class Name", "iap.classname", + FT_UINT_STRING, BASE_NONE, NULL, 0x0, + "", HFILL }}, + { &hf_iap_attr_name, + { "Attribute Name", "iap.attrname", + FT_UINT_STRING, BASE_NONE, NULL, 0x0, + "", HFILL }}, + { &hf_iap_return, + { "Return", "iap.return", + FT_UINT8, BASE_HEX, VALS(iap_return_vals), 0x0, + "", HFILL }}, + { &hf_iap_list_len, + { "List Length", "iap.listlen", + FT_UINT16, BASE_DEC, NULL, 0x0, + "", HFILL }}, + { &hf_iap_list_entry, + { "List Entry ", "iap.listentry", + FT_NONE, BASE_NONE, NULL, 0x0, + "", HFILL }}, + { &hf_iap_obj_id, + { "Object Identifier", "iap.objectid", + FT_UINT16, BASE_HEX, NULL, 0x0, + "", HFILL }}, + { &hf_iap_attr_type, + { "Type", "iap.attrtype", + FT_UINT8, BASE_DEC, VALS(iap_attr_type_vals), 0x0, + "", HFILL }}, + { &hf_iap_int, + { "Value", "iap.int", + FT_INT32, BASE_DEC, NULL, 0x0, + "", HFILL }}, + { &hf_iap_seq_len, + { "Sequence Length", "iap.seqlen", + FT_UINT16, BASE_DEC, NULL, 0x0, + "", HFILL }}, + { &hf_iap_oct_seq, + { "Sequence", "iap.octseq", + FT_BYTES, BASE_HEX, NULL, 0x0, + "", HFILL }}, + { &hf_iap_char_set, + { "Character Set", "iap.charset", + FT_UINT8, BASE_HEX, NULL, 0x0, + "", HFILL }}, + { &hf_iap_string, + { "String", "iap.string", + FT_UINT_STRING, BASE_NONE, NULL, 0x0, + "", HFILL }}, + { &hf_iap_invaloctet, + { "Mailformed IAP result: \"", "iap.invaloctet", + FT_NONE, BASE_NONE, NULL, 0, + "", HFILL }}, + { &hf_iap_invallsap, + { "Mailformed IAP result: \"", "iap.invallsap", + FT_NONE, BASE_NONE, NULL, 0, + "", HFILL }} + }; + + static hf_register_info hf_ttp[] = { + { &hf_ttp_p, + { "Parameter Bit", "ttp.p", + FT_BOOLEAN, 8, TFS(&set_notset), TTP_PARAMETERS, + "", HFILL }}, + { &hf_ttp_icredit, + { "Initial Credit", "ttp.icredit", + FT_UINT8, BASE_DEC, NULL, ~TTP_PARAMETERS, + "", HFILL }}, + { &hf_ttp_m, + { "More Bit", "ttp.m", + FT_BOOLEAN, 8, TFS(&set_notset), TTP_MORE, + "", HFILL }}, + { &hf_ttp_dcredit, + { "Delta Credit", "ttp.dcredit", + FT_UINT8, BASE_DEC, NULL, ~TTP_MORE, + "", HFILL }} + }; + + /* Setup protocol subtree arrays */ + static gint* ett[] = { + &ett_irlap, + &ett_lap_a, + &ett_lap_c, + &ett_lap_i, + &ett_xid_flags, + &ett_log, + &ett_irlmp, + &ett_lmp_dst, + &ett_lmp_src, + &ett_iap, + &ett_iap_ctl, + &ett_ttp + }; + + static gint* ett_p[MAX_PARAMETERS]; + static gint* ett_iap_e[MAX_IAP_ENTRIES]; + + + /* Register re-init routine */ + register_init_routine(init_irda); + + /* Register protocol names and descriptions */ + proto_irlap = proto_register_protocol("IrDA Link Access Protocol", "IrLAP", "irlap"); + proto_log = proto_register_protocol("Log Message", "Log", "log"); + proto_irlmp = proto_register_protocol("IrDA Link Management Protocol", "IrLMP", "irlmp"); + proto_iap = proto_register_protocol("Information Access Protocol", "IAP", "iap"); + proto_ttp = proto_register_protocol("Tiny Transport Protocol", "TTP", "ttp"); + + /* Register the dissector */ + register_dissector("irda", dissect_irda, proto_irlap); + + /* Required function calls to register the header fields */ + proto_register_field_array(proto_irlap, hf_lap, array_length(hf_lap)); + proto_register_field_array(proto_log, hf_log, array_length(hf_log)); + proto_register_field_array(proto_irlmp, hf_lmp, array_length(hf_lmp)); + proto_register_field_array(proto_iap, hf_iap, array_length(hf_iap)); + proto_register_field_array(proto_ttp, hf_ttp, array_length(hf_ttp)); + + /* Register subtrees */ + proto_register_subtree_array(ett, array_length(ett)); + for (i = 0; i < MAX_PARAMETERS; i++) + { + ett_param[i] = -1; + ett_p[i] = &ett_param[i]; + } + proto_register_subtree_array(ett_p, MAX_PARAMETERS); + for (i = 0; i < MAX_IAP_ENTRIES; i++) + { + ett_iap_entry[i] = -1; + ett_iap_e[i] = &ett_iap_entry[i]; + } + proto_register_subtree_array(ett_iap_e, MAX_IAP_ENTRIES); +} + + +/* If this dissector uses sub-dissector registration add a registration routine. + This format is required because a script is used to find these routines and + create the code that calls these routines. +*/ + +static void proto_reg_handoff_irda(void) +{ + dissector_handle_t irda_handle; + + irda_handle = find_dissector("irda"); + dissector_add("wtap_encap", WTAP_ENCAP_IRDA, irda_handle); + data_handle = find_dissector("data"); +} + + +/* Start the functions we need for the plugin stuff */ + +#ifndef __ETHEREAL_STATIC__ + +G_MODULE_EXPORT void plugin_reg_handoff(void) +{ + proto_reg_handoff_irda(); +} + +G_MODULE_EXPORT void plugin_init(plugin_address_table_t* pat +#ifndef PLUGINS_NEED_ADDRESS_TABLE +_U_ +#endif +){ + /* initialise the table of pointers needed in Win32 DLLs */ + plugin_address_table_init(pat); + /* register the new protocol, protocol fields, and subtrees */ + if (proto_irlap == -1) + { + /* execute protocol initialization only once */ + proto_register_irda(); + + REGISTER_SUB_PROTOCOLS(); + } +} + +#endif + +/* End the functions we need for plugin stuff */ -- cgit v1.2.3