/* packet-irda.c * Routines for IrDA dissection * By Shaun Jackman * Copyright 2000 Shaun Jackman * * Extended by Jan Kiszka * Copyright 2003 Jan Kiszka * * $Id$ * * 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 "moduleinfo.h" #include #include #include #include #include #include #include #include #include #include "irda-appl.h" /* * This plugin dissects infrared data transmissions as defined by the IrDA * specification (www.irda.org). See * * http://www.irda.org/standards/specifications.asp * * for various IrDA specifications. * * The plugin operates both offline with libpcap files and online on supported * platforms. Live dissection is currently available for Linux-IrDA * (irda.sourceforge.net) and for Windows if the Linux-IrDA port IrCOMM2k * (www.ircomm2k.de) is installed. */ /* * LAP */ /* Frame types and templates */ #define INVALID 0xff /* * XXX - the IrDA spec gives XID as 0x2c; HDLC (and other HDLC-derived * protocolc) use 0xAC. */ #define IRDA_XID_CMD 0x2c /* Exchange Station Identification */ #define CMD_FRAME 0x01 #define RSP_FRAME 0x00 /* 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 ENABLE_STATIC G_MODULE_EXPORT const gchar version[] = VERSION; #endif /* 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_nr = -1; static int hf_lap_c_ns = -1; static int hf_lap_c_p = -1; static int hf_lap_c_f = -1; static int hf_lap_c_s = -1; static int hf_lap_c_u_cmd = -1; static int hf_lap_c_u_rsp = -1; static int hf_lap_c_i = -1; static int hf_lap_c_s_u = -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]; static const xdlc_cf_items irlap_cf_items = { &hf_lap_c_nr, &hf_lap_c_ns, &hf_lap_c_p, &hf_lap_c_f, &hf_lap_c_s, &hf_lap_c_u_cmd, &hf_lap_c_u_rsp, &hf_lap_c_i, &hf_lap_c_s_u }; /* 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_ftype_vals[] = { { XDLC_I, "Information frame" }, { XDLC_S, "Supervisory frame" }, { XDLC_U, "Unnumbered frame" }, { 0, NULL } }; static const value_string lap_c_u_cmd_abbr_vals[] = { { XDLC_SNRM, "SNRM" }, { XDLC_DISC, "DISC" }, { XDLC_UI, "UI" }, { IRDA_XID_CMD, "XID" }, { XDLC_TEST, "TEST" }, { 0, NULL } }; static const value_string lap_c_u_rsp_abbr_vals[] = { { XDLC_SNRM, "RNRM" }, { XDLC_UA, "UA" }, { XDLC_FRMR, "FRMR" }, { XDLC_DM, "DM" }, { XDLC_RD, "RD" }, { XDLC_UI, "UI" }, { XDLC_XID, "XID" }, { XDLC_TEST, "TEST" }, { 0, NULL } }; static const value_string lap_c_u_cmd_vals[] = { { XDLC_SNRM>>2, "Set Normal Response Mode" }, { XDLC_DISC>>2, "Disconnect" }, { XDLC_UI>>2, "Unnumbered Information" }, { IRDA_XID_CMD>>2, "Exchange Station Identification" }, { XDLC_TEST>>2, "Test" }, { 0, NULL } }; static const value_string lap_c_u_rsp_vals[] = { { XDLC_SNRM>>2, "Request Normal Response Mode" }, { XDLC_UA>>2, "Unnumbered Acknowledge" }, { XDLC_FRMR>>2, "Frame Reject" }, { XDLC_DM>>2, "Disconnect Mode" }, { XDLC_RD>>2, "Request Disconnect" }, { XDLC_UI>>2, "Unnumbered Information" }, { XDLC_XID>>2, "Exchange Station Identification" }, { XDLC_TEST>>2, "Test" }, { 0, NULL } }; static const value_string lap_c_s_vals[] = { { XDLC_RR>>2, "Receiver ready" }, { XDLC_RNR>>2, "Receiver not ready" }, { XDLC_REJ>>2, "Reject" }, { XDLC_SREJ>>2, "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); if (tree) proto_tree_add_item(tree, hf_param_pi, tvb, offset, 1, FALSE); offset++; if (tree) proto_tree_add_item(tree, hf_param_pl, tvb, offset, 1, FALSE); offset++; if (len > 0) { if (tree) 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(pinfo->fd->num, &srcaddr, &destaddr, PT_NONE, pinfo->srcport, pinfo->destport, 0); if (conv) { iap_conv = (iap_conversation_t*)conversation_get_proto_data(conv, proto_iap); 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(pinfo->fd->num, &srcaddr, &destaddr, PT_NONE, pinfo->srcport, pinfo->destport, 0); iap_conv = g_mem_chunk_alloc(iap_conv_chunk); conversation_add_proto_data(conv, proto_iap, (void*)iap_conv); } /* Dissect IAP query if it is new */ if (iap_conv) { int i, j; char class_name[256]; char attr_name[256]; iap_conv->pnext = NULL; iap_conv->iap_query_frame = pinfo->fd->num; iap_conv->pattr_dissector = NULL; 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; /* 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(pinfo->fd->num, &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, proto_iap); 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); g_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, "%s", 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, "%s", 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(pinfo->fd->num, &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, proto_irlmp); 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(pinfo->fd->num, &destaddr, &srcaddr, PT_NONE, dlsap, 0, NO_PORT_B); if (conv) { lmp_conv = (lmp_conversation_t*)conversation_get_proto_data(conv, proto_irlmp); 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(pinfo->fd->num, &destaddr, &srcaddr, PT_NONE, dlsap, 0, NO_PORT_B); lmp_conv = g_mem_chunk_alloc(lmp_conv_chunk); conversation_add_proto_data(conv, proto_irlmp, (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 n = 0; proto_item* ti; proto_tree* p_tree; char buf[256]; guint8 pv; while (tvb_reported_length_remaining(tvb, offset) > 0) { guint8 p_len = tvb_get_guint8(tvb, offset + 1); if (tree) { 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"); } } else p_tree = NULL; 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, gboolean is_command) { int offset = 0; proto_item* ti = NULL; proto_tree* i_tree = NULL; proto_tree* flags_tree; guint32 saddr, daddr; guint8 s; proto_tree* lmp_tree = NULL; if (lap_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++; saddr = tvb_get_letohl(tvb, offset); if (check_col(pinfo->cinfo, COL_DEF_SRC)) col_add_fstr(pinfo->cinfo, COL_DEF_SRC, "0x%08X", saddr); if (lap_tree) proto_tree_add_uint(i_tree, hf_xid_saddr, tvb, offset, 4, saddr); offset += 4; daddr = tvb_get_letohl(tvb, offset); if (check_col(pinfo->cinfo, COL_DEF_DST)) col_add_fstr(pinfo->cinfo, COL_DEF_DST, "0x%08X", daddr); if (lap_tree) proto_tree_add_uint(i_tree, hf_xid_daddr, tvb, offset, 4, daddr); offset += 4; if (lap_tree) { 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++; if (is_command) { s = tvb_get_guint8(tvb, offset); if (check_col(pinfo->cinfo, COL_INFO)) { if (s == 0xFF) col_append_str(pinfo->cinfo, COL_INFO, ", s=final"); else col_append_fstr(pinfo->cinfo, COL_INFO, ", s=%u", s); } if (lap_tree) { ti = proto_tree_add_uint(i_tree, hf_xid_slotnr, tvb, offset, 1, s); if (s == 0xFF) proto_item_append_text(ti, " (final)"); } } offset++; if (lap_tree) proto_tree_add_item(i_tree, hf_xid_version, tvb, offset, 1, FALSE); offset++; if (lap_tree) { proto_item_set_end(lap_tree, tvb, offset); proto_item_set_end(i_tree, tvb, offset); } if (tvb_reported_length_remaining(tvb, offset) > 0) { unsigned hints_len; guint8 hint1 = 0; guint8 hint2 = 0; if (root) { ti = proto_tree_add_item(root, proto_irlmp, tvb, offset, -1, FALSE); lmp_tree = proto_item_add_subtree(ti, ett_irlmp); } 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 (root) { ti = proto_tree_add_item(lmp_tree, hf_lmp_xid_hints, tvb, offset, hints_len, FALSE); 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); } } offset += hints_len; if (tvb_reported_length_remaining(tvb, offset) > 0) { guint8 cset; gint name_len; cset = tvb_get_guint8(tvb, offset); if (root) proto_tree_add_uint(lmp_tree, hf_lmp_xid_charset, tvb, offset, 1, cset); offset++; name_len = tvb_reported_length_remaining(tvb, offset); if (name_len > 0) { if (cset == 0x00) { if (check_col(pinfo->cinfo, COL_INFO)) { char buf[23]; if (name_len > 22) name_len = 22; tvb_memcpy(tvb, buf, offset, 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_tree_add_item(lmp_tree, hf_lmp_xid_name, tvb, offset, -1, FALSE); } else { if (root) proto_tree_add_item(lmp_tree, hf_lmp_xid_name_no_ascii, tvb, offset, -1, 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) { int offset = 0; guint8 a, c; gboolean is_response; char addr[9]; proto_item* ti = NULL; proto_tree* tree = NULL; proto_tree* i_tree = NULL; guint32 saddr, daddr; guint8 ca; /* Make entries in Protocol column on summary display */ if (check_col(pinfo->cinfo, COL_PROTOCOL)) col_set_str(pinfo->cinfo, COL_PROTOCOL, "IrLAP"); /* Clear Info column */ if (check_col(pinfo->cinfo, COL_INFO)) col_clear(pinfo->cinfo, COL_INFO); /* 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; } } /* decode values used for demuxing */ a = tvb_get_guint8(tvb, 0); /* save connection address field in pinfo */ pinfo->circuit_id = a; /* initially set address columns to connection address */ g_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); if (root) { proto_tree* a_tree; proto_item* addr_item; /* create display subtree for the protocol */ ti = proto_tree_add_item(root, proto_irlap, tvb, 0, -1, FALSE); tree = proto_item_add_subtree(ti, ett_irlap); /* create subtree for the address field */ 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; } } is_response = ((a & CMD_FRAME) == 0); offset++; /* process the control field */ c = dissect_xdlc_control(tvb, 1, pinfo, tree, hf_lap_c, ett_lap_c, &irlap_cf_items, NULL, lap_c_u_cmd_abbr_vals, lap_c_u_rsp_abbr_vals, is_response, FALSE, FALSE); offset++; if ((c & XDLC_I_MASK) == XDLC_I) { /* I frame */ proto_item_set_len(tree, offset); tvb = tvb_new_subset(tvb, offset, -1, -1); dissect_irlmp(tvb, pinfo, root); return; } if ((c & 0x03) == XDLC_U) { /* U frame */ switch (c & XDLC_U_MODIFIER_MASK) { case XDLC_SNRM: if (root) { ti = proto_tree_add_item(tree, hf_lap_i, tvb, offset, -1, FALSE); i_tree = proto_item_add_subtree(ti, ett_lap_i); } saddr = tvb_get_letohl(tvb, offset); if (!is_response) { if (check_col(pinfo->cinfo, COL_DEF_SRC)) col_add_fstr(pinfo->cinfo, COL_DEF_SRC, "0x%08X", saddr); } if (root) proto_tree_add_uint(i_tree, hf_snrm_saddr, tvb, offset, 4, saddr); offset += 4; daddr = tvb_get_letohl(tvb, offset); if (!is_response) { if (check_col(pinfo->cinfo, COL_DEF_DST)) col_add_fstr(pinfo->cinfo, COL_DEF_DST, "0x%08X", daddr); } if (root) proto_tree_add_uint(i_tree, hf_snrm_daddr, tvb, offset, 4, daddr); offset += 4; ca = tvb_get_guint8(tvb, offset); if (!is_response) { if (check_col(pinfo->cinfo, COL_INFO)) col_append_fstr(pinfo->cinfo, COL_INFO, ", ca=0x%02X", ca >> 1); } if (root) proto_tree_add_uint(i_tree, hf_snrm_ca, tvb, offset, 1, ca >> 1); offset++; offset = dissect_negotiation(tvb, i_tree, offset); if (root) proto_item_set_end(ti, tvb, offset); break; case IRDA_XID_CMD: tvb = tvb_new_subset(tvb, offset, -1, -1); dissect_xid(tvb, pinfo, root, tree, TRUE); return; case XDLC_UA: if (tvb_reported_length_remaining(tvb, offset) > 0) { if (root) { ti = proto_tree_add_item(tree, hf_lap_i, tvb, offset, -1, FALSE); i_tree = proto_item_add_subtree(ti, ett_lap_i); } saddr = tvb_get_letohl(tvb, offset); if (check_col(pinfo->cinfo, COL_DEF_SRC)) col_add_fstr(pinfo->cinfo, COL_DEF_SRC, "0x%08X", saddr); if (root) proto_tree_add_uint(i_tree, hf_ua_saddr, tvb, offset, 4, saddr); offset += 4; daddr = tvb_get_letohl(tvb, offset); if (check_col(pinfo->cinfo, COL_DEF_DST)) col_add_fstr(pinfo->cinfo, COL_DEF_DST, "0x%08X", daddr); if (root) proto_tree_add_uint(i_tree, hf_ua_daddr, tvb, offset, 4, daddr); offset += 4; offset = dissect_negotiation(tvb, i_tree, offset); if (root) proto_item_set_end(ti, tvb, offset); } break; case XDLC_XID: tvb = tvb_new_subset(tvb, offset, -1, -1); dissect_xid(tvb, pinfo, root, tree, FALSE); return; } } /* If any bytes remain, send it to the generic data dissector */ if (tvb_reported_length_remaining(tvb, offset) > 0) { 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_nr, { "N(R)", "irlap.c.n_r", FT_UINT8, BASE_DEC, NULL, XDLC_N_R_MASK, "", HFILL }}, { &hf_lap_c_ns, { "N(S)", "irlap.c.n_s", FT_UINT8, BASE_DEC, NULL, XDLC_N_S_MASK, "", HFILL }}, { &hf_lap_c_p, { "Poll", "irlap.c.p", FT_BOOLEAN, 8, TFS(&set_notset), XDLC_P_F, "", HFILL }}, { &hf_lap_c_f, { "Final", "irlap.c.f", FT_BOOLEAN, 8, TFS(&set_notset), XDLC_P_F, "", HFILL }}, { &hf_lap_c_s, { "Supervisory frame type", "irlap.c.s_ftype", FT_UINT8, BASE_HEX, VALS(lap_c_s_vals), XDLC_S_FTYPE_MASK, "", HFILL }}, { &hf_lap_c_u_cmd, { "Command", "irlap.c.u_modifier_cmd", FT_UINT8, BASE_HEX, VALS(lap_c_u_cmd_vals), XDLC_U_MODIFIER_MASK, "", HFILL }}, { &hf_lap_c_u_rsp, { "Response", "irlap.c.u_modifier_resp", FT_UINT8, BASE_HEX, VALS(lap_c_u_rsp_vals), XDLC_U_MODIFIER_MASK, "", HFILL }}, { &hf_lap_c_i, { "Frame Type", "irlap.c.ftype", FT_UINT8, BASE_HEX, VALS(lap_c_ftype_vals), XDLC_I_MASK, "", HFILL }}, { &hf_lap_c_s_u, { "Frame Type", "irlap.c.ftype", FT_UINT8, BASE_HEX, VALS(lap_c_ftype_vals), XDLC_S_U_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 ENABLE_STATIC G_MODULE_EXPORT void plugin_register(void) { /* register the new protocol, protocol fields, and subtrees */ if (proto_irlap == -1) { /* execute protocol initialization only once */ proto_register_irda(); REGISTER_SUB_PROTOCOLS(); } } G_MODULE_EXPORT void plugin_reg_handoff(void) { proto_reg_handoff_irda(); } #endif /* End the functions we need for plugin stuff */