diff options
Diffstat (limited to 'epan/dissectors/packet-btrfcomm.c')
-rw-r--r-- | epan/dissectors/packet-btrfcomm.c | 1447 |
1 files changed, 724 insertions, 723 deletions
diff --git a/epan/dissectors/packet-btrfcomm.c b/epan/dissectors/packet-btrfcomm.c index 3ad37dfbd6..cf7514ea9a 100644 --- a/epan/dissectors/packet-btrfcomm.c +++ b/epan/dissectors/packet-btrfcomm.c @@ -104,315 +104,308 @@ static emem_tree_t *dlci_table; /* Initialize dissector table */ dissector_table_t rfcomm_service_dissector_table; -typedef struct _dlci_stream_t { - int len; - int current; - int is_escaped; - int mode; - guint8 *stream_buf; -} dlci_stream_t; - typedef struct _dlci_state_t { - guint32 service; - char do_credit_fc; + guint32 service; + char do_credit_fc; } dlci_state_t; static dissector_handle_t data_handle; static dissector_handle_t ppp_handle; static const value_string vs_ctl_pn_i[] = { - {0x0, "use UIH Frames"}, - /* specified by 07.10, but not used by RFCOMM - {0x1, "use UI Frames"}, - {0x2, "use I Frames"}, - */ - {0, NULL} + {0x0, "use UIH Frames"}, +#if 0 /* specified by 07.10, but not used by RFCOMM */ + {0x1, "use UI Frames"}, + {0x2, "use I Frames"}, +#endif + {0, NULL} }; static const value_string vs_ctl_pn_cl[] = { - {0x0, "no credit based flow control scheme"}, - {0xe, "support of credit based flow control scheme (resp)"}, - {0xf, "support of credit based flow control scheme (req)"}, - /* specified by 07.10. Redefined by RFCOMM - {0x0, "type 1 (unstructured octet stream)"}, - {0x1, "type 2 (unstructured octet stream with flow control)"}, - {0x2, "type 3 (uninterruptible framed data)"}, - {0x3, "type 4 (interruptible framed data)"}, - */ - {0, NULL} + {0x0, "no credit based flow control scheme"}, + {0xe, "support of credit based flow control scheme (resp)"}, + {0xf, "support of credit based flow control scheme (req)"}, +#if 0 /* specified by 07.10. Redefined by RFCOMM */ + {0x0, "type 1 (unstructured octet stream)"}, + {0x1, "type 2 (unstructured octet stream with flow control)"}, + {0x2, "type 3 (uninterruptible framed data)"}, + {0x3, "type 4 (interruptible framed data)"}, +#endif + {0, NULL} }; static const value_string vs_frame_type[] = { - /* masked 0xef */ - {0x2f, "Set Asynchronous Balanced Mode (SABM)"}, - {0x63, "Unnumbered Acknowledgement (UA)"}, - {0x0f, "Disconnected Mode (DM)"}, - {0x43, "Disconnect (DISC)"}, - {0xef, "Unnumbered Information with Header check (UIH)"}, - /* specified by 07.10, but not used by RFCOMM - {0x03, "Unnumbered Information (UI)"}, - */ + /* masked 0xef */ + {0x2f, "Set Asynchronous Balanced Mode (SABM)"}, + {0x63, "Unnumbered Acknowledgement (UA)"}, + {0x0f, "Disconnected Mode (DM)"}, + {0x43, "Disconnect (DISC)"}, + {0xef, "Unnumbered Information with Header check (UIH)"}, +#if 0 /* specified by 07.10, but not used by RFCOMM */ + {0x03, "Unnumbered Information (UI)"}, +#endif {0, NULL} }; static const value_string vs_frame_type_short[] = { - /* masked 0xef */ - {0x2f, "SABM"}, - {0x63, "UA"}, - {0x0f, "DM"}, - {0x43, "DISC"}, - {0xef, "UIH"}, - /* specified by 07.10, but not used by RFCOMM - {0x03, "UI"}, - */ + /* masked 0xef */ + {0x2f, "SABM"}, + {0x63, "UA"}, + {0x0f, "DM"}, + {0x43, "DISC"}, + {0xef, "UIH"}, +#if 0 /* specified by 07.10, but not used by RFCOMM */ + {0x03, "UI"}, +#endif {0, NULL} }; static const value_string vs_ctl[] = { /* masked 0xfc */ - {0x20, "DLC parameter negotiation (PN)"}, - {0x08, "Test Command (Test)"}, - {0x28, "Flow Control On Command (FCon)"}, - {0x18, "Flow Control Off Command (FCoff)"}, - {0x38, "Modem Status Command (MSC)"}, - {0x04, "Non Supported Command Response (NSC)"}, - {0x24, "Remote Port Negotiation Command (RPN)"}, - {0x14, "Remote Line Status Command (RLS)"}, - /* Specified by 07.10, but not used by RFCOMM - {0x10, "Power Saving Control (PSC)"}, - {0x30, "Multiplexer close down (CLD)"}, - {0x34, "Service Negotiation Command (SNC)"}, - */ - /* old - {0x80, "DLC parameter negotiation (PN)"}, - {0x20, "Test Command (Test)"}, - {0xa0, "Flow Control On Command (FCon)"}, - {0x60, "Flow Control Off Command (FCoff)"}, - {0xe0, "Modem Status Command (MSC)"}, - {0x10, "Non Supported Command Response (NSC)"}, - {0x90, "Remote Port Negotiation Command (RPN)"}, - {0x50, "Remote Line Status Command (RLS)"}, - {0x40, "Power Saving Control (PSC)"}, - {0xc0, "Multiplexer close down (CLD)"}, - {0xd0, "Service Negotiation Command (SNC)"}, - */ - {0x0, NULL} + {0x20, "DLC parameter negotiation (PN)"}, + {0x08, "Test Command (Test)"}, + {0x28, "Flow Control On Command (FCon)"}, + {0x18, "Flow Control Off Command (FCoff)"}, + {0x38, "Modem Status Command (MSC)"}, + {0x04, "Non Supported Command Response (NSC)"}, + {0x24, "Remote Port Negotiation Command (RPN)"}, + {0x14, "Remote Line Status Command (RLS)"}, +#if 0 /* Specified by 07.10, but not used by RFCOMM */ + {0x10, "Power Saving Control (PSC)"}, + {0x30, "Multiplexer close down (CLD)"}, + {0x34, "Service Negotiation Command (SNC)"}, +#endif +#if 0 /* old */ + {0x80, "DLC parameter negotiation (PN)"}, + {0x20, "Test Command (Test)"}, + {0xa0, "Flow Control On Command (FCon)"}, + {0x60, "Flow Control Off Command (FCoff)"}, + {0xe0, "Modem Status Command (MSC)"}, + {0x10, "Non Supported Command Response (NSC)"}, + {0x90, "Remote Port Negotiation Command (RPN)"}, + {0x50, "Remote Line Status Command (RLS)"}, + {0x40, "Power Saving Control (PSC)"}, + {0xc0, "Multiplexer close down (CLD)"}, + {0xd0, "Service Negotiation Command (SNC)"}, +#endif + {0x0, NULL} }; static const value_string vs_ea[] = { - {1, "Last field octet"}, - {0, "More field octets following"}, - {0, NULL} + {1, "Last field octet"}, + {0, "More field octets following"}, + {0, NULL} }; static const value_string vs_cr[] = { - {1, "Command"}, - {0, "Response"}, - {0, NULL} + {1, "Command"}, + {0, "Response"}, + {0, NULL} }; static int get_le_multi_byte_value(tvbuff_t *tvb, int offset, proto_tree *tree, guint32 *val_ptr, int hf_index) { - guint8 byte, bc = 0; - guint32 val = 0; - int start_offset=offset; + guint8 byte, bc = 0; + guint32 val = 0; + int start_offset = offset; - do{ - byte = tvb_get_guint8(tvb, offset); - offset++; - val |= ((byte>>1)&0xff) << (bc++ * 7); - }while((byte & 0x1)==0); + do { + byte = tvb_get_guint8(tvb, offset); + offset += 1; + val |= ((byte>>1)&0xff) << (bc++ * 7); + } while ((byte & 0x1) == 0); - *val_ptr = val; + *val_ptr = val; - if(hf_index>0){ - proto_tree_add_uint(tree, hf_index, tvb, start_offset, offset-start_offset, val); - } + if (hf_index > 0) { + proto_tree_add_uint(tree, hf_index, tvb, start_offset, offset-start_offset, val); + } - return offset; + return offset; } static int dissect_ctrl_pn(packet_info *pinfo, proto_tree *t, tvbuff_t *tvb, int offset, int cr_flag) { - proto_tree *st; - proto_item *ti; - int dlci; - int cl; - dlci_state_t *dlci_state; - guint8 flags; - - /* dlci */ - dlci=tvb_get_guint8(tvb, offset)&0x3f; - proto_tree_add_uint(t, hf_dlci, tvb, offset, 1, dlci); - offset++; - - /* cl */ - flags=tvb_get_guint8(tvb, offset); - cl=flags&0xf0; - - ti = proto_tree_add_text(t, tvb, offset, 1, "I1-I4: 0x%x, C1-C4: 0x%x", flags&0xf, (flags>>4)&0xf); - st = proto_item_add_subtree(ti, ett_ctrl_pn_ci); - - proto_tree_add_item(st, hf_pn_c14, tvb, offset, 1, ENC_LITTLE_ENDIAN); - proto_tree_add_item(st, hf_pn_i14, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; - - /* priority */ - proto_tree_add_item(t, hf_priority, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; - - /* Ack timer */ - proto_tree_add_text(t, tvb, offset, 1, "Acknowledgement timer (T1): %d ms", (guint32)tvb_get_guint8(tvb, offset) * 100); - offset++; - - /* max frame size */ - proto_tree_add_item(t, hf_max_frame_size, tvb, offset, 2, ENC_LITTLE_ENDIAN); - offset+=2; - - /* max retrans */ - proto_tree_add_item(t, hf_max_retrans, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; - - /* error recovery mode */ - proto_tree_add_item(t, hf_error_recovery_mode, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; - - if(!pinfo->fd->flags.visited){ - guint32 token; - - if( pinfo->p2p_dir == cr_flag ) - token = dlci | 0x01; /* local service */ - else - token = dlci; - - dlci_state=se_tree_lookup32(dlci_table, token); - if(!dlci_state){ - dlci_state=se_alloc0(sizeof(dlci_state_t)); - se_tree_insert32(dlci_table, token, dlci_state); - } - - if(!cl){ - /* sender does not do credit based flow control */ - dlci_state->do_credit_fc = 0; - } else if(cr_flag && (cl==0xf0)){ - /* sender requests to use credit based flow control */ - dlci_state->do_credit_fc |= 1; - } else if((!cr_flag) && (cl==0xe0)){ - /* receiver also knows how to handle credit based - flow control */ - dlci_state->do_credit_fc |= 2; - } - } - return offset; + proto_tree *st; + proto_item *ti; + int dlci; + int cl; + dlci_state_t *dlci_state; + guint8 flags; + + /* dlci */ + dlci = tvb_get_guint8(tvb, offset) & 0x3f; + proto_tree_add_uint(t, hf_dlci, tvb, offset, 1, dlci); + offset += 1; + + /* cl */ + flags = tvb_get_guint8(tvb, offset); + cl = flags&0xf0; + + ti = proto_tree_add_text(t, tvb, offset, 1, "I1-I4: 0x%x, C1-C4: 0x%x", flags&0xf, (flags>>4)&0xf); + st = proto_item_add_subtree(ti, ett_ctrl_pn_ci); + + proto_tree_add_item(st, hf_pn_c14, tvb, offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(st, hf_pn_i14, tvb, offset, 1, ENC_LITTLE_ENDIAN); + offset += 1; + + /* priority */ + proto_tree_add_item(t, hf_priority, tvb, offset, 1, ENC_LITTLE_ENDIAN); + offset += 1; + + /* Ack timer */ + proto_tree_add_text(t, tvb, offset, 1, "Acknowledgement timer (T1): %d ms", (guint32)tvb_get_guint8(tvb, offset) * 100); + offset += 1; + + /* max frame size */ + proto_tree_add_item(t, hf_max_frame_size, tvb, offset, 2, ENC_LITTLE_ENDIAN); + offset += 2; + + /* max retrans */ + proto_tree_add_item(t, hf_max_retrans, tvb, offset, 1, ENC_LITTLE_ENDIAN); + offset += 1; + + /* error recovery mode */ + proto_tree_add_item(t, hf_error_recovery_mode, tvb, offset, 1, ENC_LITTLE_ENDIAN); + offset += 1; + + if (!pinfo->fd->flags.visited) { + guint32 token; + + if (pinfo->p2p_dir == cr_flag) + token = dlci | 0x01; /* local service */ + else + token = dlci; + + dlci_state = se_tree_lookup32(dlci_table, token); + if (!dlci_state) { + dlci_state = se_alloc0(sizeof(dlci_state_t)); + se_tree_insert32(dlci_table, token, dlci_state); + } + + if (!cl) { + /* sender does not do credit based flow control */ + dlci_state->do_credit_fc = 0; + } else if (cr_flag && (cl == 0xf0)) { + /* sender requests to use credit based flow control */ + dlci_state->do_credit_fc |= 1; + } else if ((!cr_flag) && (cl == 0xe0)) { + /* receiver also knows how to handle credit based + flow control */ + dlci_state->do_credit_fc |= 2; + } + } + return offset; } static int dissect_ctrl_msc(proto_tree *t, tvbuff_t *tvb, int offset, int length) { - proto_tree *st; - proto_item *it; - guint8 status; - int start_offset; - - proto_tree_add_uint(t, hf_dlci, tvb, offset, 1, tvb_get_guint8(tvb, offset)&0x3f); - offset++; - - start_offset=offset; - status = tvb_get_guint8(tvb, offset); - it = proto_tree_add_text(t, tvb, offset, 1, "V.24 Signals: FC = %d, RTC = %d, RTR = %d, IC = %d, DV = %d", (status >> 1) & 1, - (status >> 2) & 1, (status >> 3) & 1, - (status >> 6) & 1, (status >> 7) & 1); - st = proto_item_add_subtree(it, ett_ctrl_pn_v24); - - proto_tree_add_item(st, hf_msc_fc, tvb, offset, 1, ENC_LITTLE_ENDIAN); - proto_tree_add_item(st, hf_msc_rtc, tvb, offset, 1, ENC_LITTLE_ENDIAN); - proto_tree_add_item(st, hf_msc_rtr, tvb, offset, 1, ENC_LITTLE_ENDIAN); - proto_tree_add_item(st, hf_msc_ic, tvb, offset, 1, ENC_LITTLE_ENDIAN); - proto_tree_add_item(st, hf_msc_dv, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; - - if(length==3){ - proto_tree_add_text(t, tvb, offset, 1, "Break bits B1-B3: 0x%x", (tvb_get_guint8(tvb, offset) & 0xf) >> 1); - proto_tree_add_item(t, hf_msc_l, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; - } - - proto_item_set_len(it, offset-start_offset); - - return offset; + proto_tree *st; + proto_item *it; + guint8 status; + int start_offset; + + proto_tree_add_uint(t, hf_dlci, tvb, offset, 1, tvb_get_guint8(tvb, offset)&0x3f); + offset += 1; + + start_offset = offset; + status = tvb_get_guint8(tvb, offset); + it = proto_tree_add_text(t, tvb, offset, 1, "V.24 Signals: FC = %d, RTC = %d, RTR = %d, IC = %d, DV = %d", (status >> 1) & 1, + (status >> 2) & 1, (status >> 3) & 1, + (status >> 6) & 1, (status >> 7) & 1); + st = proto_item_add_subtree(it, ett_ctrl_pn_v24); + + proto_tree_add_item(st, hf_msc_fc, tvb, offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(st, hf_msc_rtc, tvb, offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(st, hf_msc_rtr, tvb, offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(st, hf_msc_ic, tvb, offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(st, hf_msc_dv, tvb, offset, 1, ENC_LITTLE_ENDIAN); + offset += 1; + + if (length == 3) { + proto_tree_add_text(t, tvb, offset, 1, "Break bits B1-B3: 0x%x", (tvb_get_guint8(tvb, offset) & 0xf) >> 1); + proto_tree_add_item(t, hf_msc_l, tvb, offset, 1, ENC_LITTLE_ENDIAN); + offset += 1; + } + + proto_item_set_len(it, offset-start_offset); + + return offset; } static int dissect_btrfcomm_Address(tvbuff_t *tvb, int offset, proto_tree *tree, guint8 *ea_flagp, guint8 *cr_flagp, guint8 *dlcip) { - proto_item *ti; - proto_tree *addr_tree; - guint8 dlci, cr_flag, ea_flag, flags; + proto_item *ti; + proto_tree *addr_tree; + guint8 dlci, cr_flag, ea_flag, flags; - flags=tvb_get_guint8(tvb, offset); + flags = tvb_get_guint8(tvb, offset); - ea_flag=flags&0x01; - if(ea_flagp){ - *ea_flagp=ea_flag; - } + ea_flag = flags&0x01; + if (ea_flagp) { + *ea_flagp = ea_flag; + } - cr_flag=(flags&0x02)?1:0; - if(cr_flagp){ - *cr_flagp=cr_flag; - } + cr_flag = (flags&0x02) ? 1 : 0; + if (cr_flagp) { + *cr_flagp = cr_flag; + } - dlci=flags>>2; - if(dlcip){ - *dlcip=dlci; - } + dlci = flags>>2; + if (dlcip) { + *dlcip = dlci; + } - ti = proto_tree_add_text(tree, tvb, offset, 1, "Address: E/A flag: %d, C/R flag: %d, DLCI: 0x%02x", ea_flag, cr_flag, dlci); - addr_tree = proto_item_add_subtree(ti, ett_addr); + ti = proto_tree_add_text(tree, tvb, offset, 1, "Address: E/A flag: %d, C/R flag: %d, DLCI: 0x%02x", ea_flag, cr_flag, dlci); + addr_tree = proto_item_add_subtree(ti, ett_addr); - proto_tree_add_uint(addr_tree, hf_dlci, tvb, offset, 1, dlci); - proto_tree_add_item(addr_tree, hf_cr, tvb, offset, 1, ENC_LITTLE_ENDIAN); - proto_tree_add_item(addr_tree, hf_ea, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; + proto_tree_add_uint(addr_tree, hf_dlci, tvb, offset, 1, dlci); + proto_tree_add_item(addr_tree, hf_cr, tvb, offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(addr_tree, hf_ea, tvb, offset, 1, ENC_LITTLE_ENDIAN); + offset += 1; - return offset; + return offset; } static int dissect_btrfcomm_Control(tvbuff_t *tvb, int offset, proto_tree *tree, guint8 *pf_flagp, guint8 *frame_typep) { - proto_item *ti; - proto_tree *hctl_tree; - guint8 frame_type, pf_flag, flags; + proto_item *ti; + proto_tree *hctl_tree; + guint8 frame_type, pf_flag, flags; - flags=tvb_get_guint8(tvb, offset); + flags = tvb_get_guint8(tvb, offset); - pf_flag=(flags&0x10)?1:0; - if(pf_flagp){ - *pf_flagp=pf_flag; - } + pf_flag = (flags&0x10) ? 1 : 0; + if (pf_flagp) { + *pf_flagp = pf_flag; + } - frame_type=flags&0xef; - if(frame_typep){ - *frame_typep=frame_type; - } + frame_type = flags&0xef; + if (frame_typep) { + *frame_typep = frame_type; + } - ti = proto_tree_add_text(tree, tvb, offset, 1, "Control: Frame type: %s (0x%x), P/F flag: %d", val_to_str(frame_type, vs_frame_type, "Unknown"), frame_type, pf_flag); - hctl_tree = proto_item_add_subtree(ti, ett_control); + ti = proto_tree_add_text(tree, tvb, offset, 1, "Control: Frame type: %s (0x%x), P/F flag: %d", + val_to_str_const(frame_type, vs_frame_type, "Unknown"), frame_type, pf_flag); + hctl_tree = proto_item_add_subtree(ti, ett_control); - proto_tree_add_item(hctl_tree, hf_pf, tvb, offset, 1, ENC_LITTLE_ENDIAN); - proto_tree_add_item(hctl_tree, hf_frame_type, tvb, offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(hctl_tree, hf_pf, tvb, offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(hctl_tree, hf_frame_type, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; - return offset; + offset += 1; + return offset; } @@ -420,71 +413,74 @@ dissect_btrfcomm_Control(tvbuff_t *tvb, int offset, proto_tree *tree, guint8 *pf static int dissect_btrfcomm_PayloadLen(tvbuff_t *tvb, int offset, proto_tree *tree, guint16 *frame_lenp) { - guint16 frame_len; - int start_offset=offset; + guint16 frame_len; + int start_offset = offset; - frame_len = tvb_get_guint8(tvb, offset); - offset++; + frame_len = tvb_get_guint8(tvb, offset); + offset += 1; - if(frame_len&0x01){ - frame_len >>= 1; /* 0 - 127 */ - } else { - frame_len >>= 1; /* 128 - ... */ - frame_len |= (tvb_get_guint8(tvb, offset)) << 7; - offset++; - } + if (frame_len&0x01) { + frame_len >>= 1; /* 0 - 127 */ + } else { + frame_len >>= 1; /* 128 - ... */ + frame_len |= (tvb_get_guint8(tvb, offset)) << 7; + offset += 1; + } - proto_tree_add_uint(tree, hf_len, tvb, start_offset, offset-start_offset, frame_len); + proto_tree_add_uint(tree, hf_len, tvb, start_offset, offset-start_offset, frame_len); - if(frame_lenp){ - *frame_lenp=frame_len; - } + if (frame_lenp) { + *frame_lenp = frame_len; + } - return offset; + return offset; } static int dissect_btrfcomm_MccType(tvbuff_t *tvb, int offset, proto_tree *tree, packet_info *pinfo, guint8 *mcc_cr_flagp, guint8 *mcc_ea_flagp, guint32 *mcc_typep) { - int start_offset=offset; - proto_item *ti; - proto_tree *mcc_tree; - guint8 flags, mcc_cr_flag, mcc_ea_flag; - guint32 mcc_type; + int start_offset = offset; + proto_item *ti; + proto_tree *mcc_tree; + guint8 flags, mcc_cr_flag, mcc_ea_flag; + guint32 mcc_type; - flags=tvb_get_guint8(tvb, offset); + flags = tvb_get_guint8(tvb, offset); - mcc_cr_flag=(flags&0x2)?1:0; - if(mcc_cr_flagp){ - *mcc_cr_flagp=mcc_cr_flag; - } + mcc_cr_flag = (flags&0x2) ? 1 : 0; + if (mcc_cr_flagp) { + *mcc_cr_flagp = mcc_cr_flag; + } - mcc_ea_flag=flags&0x1; - if(mcc_ea_flagp){ - *mcc_ea_flagp=mcc_ea_flag; - } + mcc_ea_flag = flags & 0x1; + if (mcc_ea_flagp) { + *mcc_ea_flagp = mcc_ea_flag; + } - offset = get_le_multi_byte_value(tvb, offset, tree, &mcc_type, -1); - mcc_type =(mcc_type>>1)&0x3f; /* shift c/r flag off */ - if(mcc_typep){ - *mcc_typep=mcc_type; - } + offset = get_le_multi_byte_value(tvb, offset, tree, &mcc_type, -1); + mcc_type = (mcc_type>>1) & 0x3f; /* shift c/r flag off */ + if (mcc_typep) { + *mcc_typep = mcc_type; + } - if(mcc_type){ - col_append_fstr(pinfo->cinfo, COL_INFO, "%s ", val_to_str(mcc_type, vs_ctl, "Unknown")); - } + if (mcc_type) { + col_append_fstr(pinfo->cinfo, COL_INFO, "%s ", val_to_str_const(mcc_type, vs_ctl, "Unknown")); + } - ti = proto_tree_add_text(tree, tvb, start_offset, offset-start_offset, "Type: %s (0x%x), C/R flag = %d, E/A flag = %d", val_to_str(mcc_type, vs_ctl, "Unknown"), mcc_type, mcc_cr_flag, mcc_ea_flag); - mcc_tree = proto_item_add_subtree(ti, ett_mcc); + ti = proto_tree_add_text(tree, tvb, start_offset, offset-start_offset, + "Type: %s (0x%x), C/R flag = %d, E/A flag = %d", + val_to_str_const(mcc_type, vs_ctl, "Unknown"), + mcc_type, mcc_cr_flag, mcc_ea_flag); + mcc_tree = proto_item_add_subtree(ti, ett_mcc); - proto_tree_add_item(mcc_tree, hf_mcc_cmd, tvb, start_offset, offset-start_offset, ENC_LITTLE_ENDIAN); - proto_tree_add_item(mcc_tree, hf_mcc_cr, tvb, start_offset, 1, ENC_LITTLE_ENDIAN); - proto_tree_add_item(mcc_tree, hf_mcc_ea, tvb, start_offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(mcc_tree, hf_mcc_cmd, tvb, start_offset, offset-start_offset, ENC_LITTLE_ENDIAN); + proto_tree_add_item(mcc_tree, hf_mcc_cr, tvb, start_offset, 1, ENC_LITTLE_ENDIAN); + proto_tree_add_item(mcc_tree, hf_mcc_ea, tvb, start_offset, 1, ENC_LITTLE_ENDIAN); - return offset; + return offset; } /* This dissector is only called from L2CAP. @@ -495,532 +491,537 @@ dissect_btrfcomm_MccType(tvbuff_t *tvb, int offset, proto_tree *tree, packet_inf static void dissect_btrfcomm(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree) { - proto_item *ti; - proto_tree *rfcomm_tree; - proto_tree *ctrl_tree; - int offset=0; - int fcs_offset; - guint8 dlci, cr_flag, ea_flag; - guint8 frame_type, pf_flag; - guint16 frame_len; - dlci_state_t *dlci_state = NULL; - - ti = proto_tree_add_item(tree, proto_btrfcomm, tvb, offset, -1, ENC_NA); - rfcomm_tree = proto_item_add_subtree(ti, ett_btrfcomm); - - col_set_str(pinfo->cinfo, COL_PROTOCOL, "RFCOMM"); - switch (pinfo->p2p_dir) { - - case P2P_DIR_SENT: - col_add_str(pinfo->cinfo, COL_INFO, "Sent "); - break; - - case P2P_DIR_RECV: - col_add_str(pinfo->cinfo, COL_INFO, "Rcvd "); - break; - - case P2P_DIR_UNKNOWN: - col_clear(pinfo->cinfo, COL_INFO); - break; - - default: - col_add_fstr(pinfo->cinfo, COL_INFO, "Unknown direction %d ", - pinfo->p2p_dir); - break; - } - - - /* flags and dlci */ - offset=dissect_btrfcomm_Address(tvb, offset, rfcomm_tree, &ea_flag, &cr_flag, &dlci); - /* pf and frame type */ - offset=dissect_btrfcomm_Control(tvb, offset, rfcomm_tree, &pf_flag, &frame_type); - /* payload length */ - offset=dissect_btrfcomm_PayloadLen(tvb, offset, rfcomm_tree, &frame_len); - - if (dlci && (frame_len || (frame_type == 0xef) || (frame_type == 0x2f) )) { - guint32 token; - - if( pinfo->p2p_dir == cr_flag ) - token = dlci | 0x01; /* local service */ - else - token = dlci; - - dlci_state=se_tree_lookup32(dlci_table, token); - if(!dlci_state){ - dlci_state=se_alloc0(sizeof(dlci_state_t)); - se_tree_insert32(dlci_table, token, dlci_state); - } - } - - col_append_fstr(pinfo->cinfo, COL_INFO, "%s DLCI=%d ", val_to_str(frame_type, vs_frame_type_short, "Unknown"), dlci); - if(dlci && (frame_type == 0x2f)) - col_append_fstr(pinfo->cinfo, COL_INFO, "(%s) ", val_to_str(dlci_state->service, vs_service_classes, "Unknown")); - - /* UID frame */ - if(frame_type==0xef && dlci && pf_flag) { - col_append_str(pinfo->cinfo, COL_INFO, "UID "); - if((dlci_state->do_credit_fc&0x03)==0x03){ -/*QQQ use tvb_length_remaining()==2 and !frame_len as heuristics to catch this as well? */ - /* add credit based flow control byte */ - proto_tree_add_item(rfcomm_tree, hf_fc_credits, tvb, offset, 1, ENC_LITTLE_ENDIAN); - offset++; - } - } - - - fcs_offset = offset + frame_len; - - - /* multiplexer control command */ - if((!dlci)&&frame_len){ - proto_item *mcc_ti; - guint32 mcc_type, length; - guint8 mcc_cr_flag, mcc_ea_flag; - int start_offset=offset; - - col_append_str(pinfo->cinfo, COL_INFO, "MPX_CTRL "); - - mcc_ti = proto_tree_add_text(rfcomm_tree, tvb, offset, 1, "Multiplexer Control Command"); - ctrl_tree = proto_item_add_subtree(mcc_ti, ett_btrfcomm_ctrl); - - /* mcc type */ - offset=dissect_btrfcomm_MccType(tvb, offset, ctrl_tree, pinfo, &mcc_cr_flag, &mcc_ea_flag, &mcc_type); - - /* len */ - offset = get_le_multi_byte_value(tvb, offset, ctrl_tree, &length, hf_mcc_len); - - - if (length > (guint32) tvb_length_remaining(tvb, offset)) { - expert_add_info_format(pinfo, ctrl_tree, PI_MALFORMED, PI_ERROR, "Huge MCC length: %u", length); - return; - } - - switch(mcc_type) { - case 0x20: /* Parameter Negotiation */ - col_append_str(pinfo->cinfo, COL_INFO, "Parameter Negotiation "); - dissect_ctrl_pn(pinfo, ctrl_tree, tvb, offset, mcc_cr_flag); - break; - case 0x38: /* Model Status Command */ - col_append_str(pinfo->cinfo, COL_INFO, "Model Status Command "); - dissect_ctrl_msc(ctrl_tree, tvb, offset, length); - break; - } - offset += length; - - proto_item_set_len(mcc_ti, offset-start_offset); - } - - - /* try to find a higher layer dissector that has registered to handle data - * for this kind of service, if none is found dissect it as raw "data" - */ - if(dlci&&frame_len){ - tvbuff_t *next_tvb; - btl2cap_data_t *l2cap_data; - btrfcomm_data_t rfcomm_data; - - next_tvb = tvb_new_subset(tvb, offset, frame_len, frame_len); - - l2cap_data = pinfo->private_data; - pinfo->private_data = &rfcomm_data; - rfcomm_data.chandle = l2cap_data->chandle; - rfcomm_data.cid = l2cap_data->cid; - rfcomm_data.dlci = dlci; - - if(!dissector_try_uint(rfcomm_service_dissector_table, dlci_state->service, - next_tvb, pinfo, tree)){ - /* unknown service, let the data dissector handle it */ - call_dissector(data_handle, next_tvb, pinfo, tree); - } - } - - proto_tree_add_item(rfcomm_tree, hf_fcs, tvb, fcs_offset, 1, ENC_LITTLE_ENDIAN); + proto_item *ti; + proto_tree *rfcomm_tree; + proto_tree *ctrl_tree; + int offset = 0; + int fcs_offset; + guint8 dlci, cr_flag, ea_flag; + guint8 frame_type, pf_flag; + guint16 frame_len; + dlci_state_t *dlci_state = NULL; + + ti = proto_tree_add_item(tree, proto_btrfcomm, tvb, offset, -1, ENC_NA); + rfcomm_tree = proto_item_add_subtree(ti, ett_btrfcomm); + + col_set_str(pinfo->cinfo, COL_PROTOCOL, "RFCOMM"); + switch (pinfo->p2p_dir) { + + case P2P_DIR_SENT: + col_add_str(pinfo->cinfo, COL_INFO, "Sent "); + break; + + case P2P_DIR_RECV: + col_add_str(pinfo->cinfo, COL_INFO, "Rcvd "); + break; + + case P2P_DIR_UNKNOWN: + col_clear(pinfo->cinfo, COL_INFO); + break; + + default: + col_add_fstr(pinfo->cinfo, COL_INFO, "Unknown direction %d ", + pinfo->p2p_dir); + break; + } + + + /* flags and dlci */ + offset = dissect_btrfcomm_Address(tvb, offset, rfcomm_tree, &ea_flag, &cr_flag, &dlci); + /* pf and frame type */ + offset = dissect_btrfcomm_Control(tvb, offset, rfcomm_tree, &pf_flag, &frame_type); + /* payload length */ + offset = dissect_btrfcomm_PayloadLen(tvb, offset, rfcomm_tree, &frame_len); + + if (dlci && (frame_len || (frame_type == 0xef) || (frame_type == 0x2f))) { + guint32 token; + + if (pinfo->p2p_dir == cr_flag) + token = dlci | 0x01; /* local service */ + else + token = dlci; + + dlci_state = se_tree_lookup32(dlci_table, token); + if (!dlci_state) { + dlci_state = se_alloc0(sizeof(dlci_state_t)); + se_tree_insert32(dlci_table, token, dlci_state); + } + } + + col_append_fstr(pinfo->cinfo, COL_INFO, "%s DLCI=%d ", + val_to_str_const(frame_type, vs_frame_type_short, "Unknown"), dlci); + if (dlci && (frame_type == 0x2f)) + col_append_fstr(pinfo->cinfo, COL_INFO, "(%s) ", + val_to_str_ext_const(dlci_state->service, &vs_service_classes_ext, "Unknown")); + + /* UID frame */ + if ((frame_type == 0xef) && dlci && pf_flag) { + col_append_str(pinfo->cinfo, COL_INFO, "UID "); + if ((dlci_state->do_credit_fc & 0x03) == 0x03) { +/*QQQ use tvb_length_remaining() == 2 and !frame_len as heuristics to catch this as well? */ + /* add credit based flow control byte */ + proto_tree_add_item(rfcomm_tree, hf_fc_credits, tvb, offset, 1, ENC_LITTLE_ENDIAN); + offset += 1; + } + } + + + fcs_offset = offset + frame_len; + + + /* multiplexer control command */ + if (!dlci && frame_len) { + proto_item *mcc_ti; + guint32 mcc_type, length; + guint8 mcc_cr_flag, mcc_ea_flag; + int start_offset = offset; + + col_append_str(pinfo->cinfo, COL_INFO, "MPX_CTRL "); + + mcc_ti = proto_tree_add_text(rfcomm_tree, tvb, offset, 1, "Multiplexer Control Command"); + ctrl_tree = proto_item_add_subtree(mcc_ti, ett_btrfcomm_ctrl); + + /* mcc type */ + offset = dissect_btrfcomm_MccType(tvb, offset, ctrl_tree, pinfo, &mcc_cr_flag, &mcc_ea_flag, &mcc_type); + + /* len */ + offset = get_le_multi_byte_value(tvb, offset, ctrl_tree, &length, hf_mcc_len); + + + if (length > (guint32) tvb_length_remaining(tvb, offset)) { + expert_add_info_format(pinfo, ctrl_tree, PI_MALFORMED, PI_ERROR, "Huge MCC length: %u", length); + return; + } + + switch(mcc_type) { + case 0x20: /* Parameter Negotiation */ + col_append_str(pinfo->cinfo, COL_INFO, "Parameter Negotiation "); + dissect_ctrl_pn(pinfo, ctrl_tree, tvb, offset, mcc_cr_flag); + break; + case 0x38: /* Model Status Command */ + col_append_str(pinfo->cinfo, COL_INFO, "Model Status Command "); + dissect_ctrl_msc(ctrl_tree, tvb, offset, length); + break; + } + offset += length; + + proto_item_set_len(mcc_ti, offset-start_offset); + } + + + /* try to find a higher layer dissector that has registered to handle data + * for this kind of service, if none is found dissect it as raw "data" + */ + if (dlci && frame_len) { + tvbuff_t *next_tvb; + btl2cap_data_t *l2cap_data; + btrfcomm_data_t rfcomm_data; + + next_tvb = tvb_new_subset(tvb, offset, frame_len, frame_len); + + l2cap_data = pinfo->private_data; + pinfo->private_data = &rfcomm_data; + rfcomm_data.chandle = l2cap_data->chandle; + rfcomm_data.cid = l2cap_data->cid; + rfcomm_data.dlci = dlci; + + if (!dissector_try_uint(rfcomm_service_dissector_table, dlci_state->service, + next_tvb, pinfo, tree)) { + /* unknown service, let the data dissector handle it */ + call_dissector(data_handle, next_tvb, pinfo, tree); + } + } + + proto_tree_add_item(rfcomm_tree, hf_fcs, tvb, fcs_offset, 1, ENC_LITTLE_ENDIAN); } void proto_register_btrfcomm(void) { - static hf_register_info hf[] = { - {&hf_dlci, - {"DLCI", "btrfcomm.dlci", - FT_UINT8, BASE_HEX, NULL, 0, - "RFCOMM DLCI", HFILL} - }, - {&hf_priority, - {"Priority", "btrfcomm.priority", - FT_UINT8, BASE_DEC, NULL, 0x3f, - NULL, HFILL} - }, - {&hf_max_frame_size, - {"Max Frame Size", "btrfcomm.max_frame_size", - FT_UINT16, BASE_DEC, NULL, 0, - "Maximum Frame Size", HFILL} - }, - {&hf_max_retrans, - {"Max Retrans", "btrfcomm.max_retrans", - FT_UINT8, BASE_DEC, NULL, 0, - "Maximum number of retransmissions", HFILL} - }, - {&hf_error_recovery_mode, - {"Error Recovery Mode", "btrfcomm.error_recovery_mode", - FT_UINT8, BASE_DEC, NULL, 0x07, - NULL, HFILL} - }, - {&hf_ea, - {"EA Flag", "btrfcomm.ea", - FT_UINT8, BASE_HEX, VALS(vs_ea), 0x1, - "EA flag (should be always 1)", HFILL} - }, - {&hf_cr, - {"C/R Flag", "btrfcomm.cr", - FT_UINT8, BASE_HEX, VALS(vs_cr), 0x2, - "Command/Response flag", HFILL} - }, - {&hf_mcc_ea, - {"EA Flag", "btrfcomm.mcc.ea", - FT_UINT8, BASE_HEX, VALS(vs_ea), 0x1, - "EA flag (should be always 1)", HFILL} - }, - {&hf_mcc_cr, - {"C/R Flag", "btrfcomm.mcc.cr", - FT_UINT8, BASE_HEX, VALS(vs_cr), 0x2, - "Command/Response flag", HFILL} - }, - {&hf_mcc_cmd, - {"C/R Flag", "btrfcomm.mcc.cmd", - FT_UINT8, BASE_HEX, VALS(vs_ctl), 0xfc, - "Command/Response flag", HFILL} - }, - {&hf_frame_type, - {"Frame type", "btrfcomm.frame_type", - FT_UINT8, BASE_HEX, VALS(vs_frame_type), 0xef, - "Command/Response flag", HFILL} - }, - {&hf_pf, - {"P/F flag", "btrfcomm.pf", - FT_UINT8, BASE_HEX, NULL, 0x10, - "Poll/Final bit", HFILL} - }, - {&hf_pn_i14, - {"Type of frame", "btrfcomm.pn.i", - FT_UINT8, BASE_HEX, VALS(vs_ctl_pn_i), 0x0f, - "Type of information frames used for that particular DLCI", - HFILL} - }, - {&hf_pn_c14, - {"Convergence layer", "btrfcomm.pn.cl", - FT_UINT8, BASE_HEX, VALS(vs_ctl_pn_cl), 0xf0, - "Convergence layer used for that particular DLCI", HFILL} - }, - {&hf_len, - {"Payload length", "btrfcomm.len", - FT_UINT16, BASE_DEC, NULL, 0, - "Frame length", HFILL} - }, - {&hf_mcc_len, - {"MCC Length", "btrfcomm.mcc.len", - FT_UINT16, BASE_DEC, NULL, 0, - "Length of MCC data", HFILL} - }, - {&hf_fcs, - {"Frame Check Sequence", "btrfcomm.fcs", - FT_UINT8, BASE_HEX, NULL, 0, - "Checksum over frame", HFILL} - }, - {&hf_msc_fc, - {"Flow Control (FC)", "btrfcomm.msc.fc", - FT_UINT8, BASE_HEX, NULL, 0x2, - "Flow Control", HFILL} - }, - {&hf_msc_rtc, - {"Ready To Communicate (RTC)", "btrfcomm.msc.rtc", - FT_UINT8, BASE_HEX, NULL, 0x4, - "Ready To Communicate", HFILL} - }, - {&hf_msc_rtr, - {"Ready To Receive (RTR)", "btrfcomm.msc.rtr", - FT_UINT8, BASE_HEX, NULL, 0x8, - "Ready To Receive", HFILL} - }, - {&hf_msc_ic, - {"Incoming Call Indicator (IC)", "btrfcomm.msc.ic", - FT_UINT8, BASE_HEX, NULL, 0x40, - "Incoming Call Indicator", HFILL} - }, - {&hf_msc_dv, - {"Data Valid (DV)", "btrfcomm.msc.dv", - FT_UINT8, BASE_HEX, NULL, 0x80, - "Data Valid", HFILL} - }, - {&hf_msc_l, - {"Length of break in units of 200ms", "btrfcomm.msc.bl", - FT_UINT8, BASE_DEC, NULL, 0xf0, - NULL, HFILL} - }, - {&hf_fc_credits, - {"Credits", "btrfcomm.credits", - FT_UINT8, BASE_DEC, NULL, 0, - "Flow control: number of UIH frames allowed to send", HFILL} - } - - }; - - /* Setup protocol subtree array */ - static gint *ett[] = { - &ett_btrfcomm, - &ett_btrfcomm_ctrl, - &ett_addr, - &ett_control, - &ett_mcc, - &ett_ctrl_pn_ci, - &ett_ctrl_pn_v24 - }; - - /* Register the protocol name and description */ - proto_btrfcomm = proto_register_protocol("Bluetooth RFCOMM Protocol", "RFCOMM", "btrfcomm"); - - register_dissector("btrfcomm", dissect_btrfcomm, proto_btrfcomm); - - /* Required function calls to register the header fields and subtrees used */ - proto_register_field_array(proto_btrfcomm, hf, array_length(hf)); - proto_register_subtree_array(ett, array_length(ett)); - - rfcomm_service_dissector_table = register_dissector_table("btrfcomm.service", "RFCOMM SERVICE", FT_UINT16, BASE_HEX); - - dlci_table=se_tree_create(EMEM_TREE_TYPE_RED_BLACK, "RFCOMM dlci table"); + static hf_register_info hf[] = { + { &hf_dlci, + { "DLCI", "btrfcomm.dlci", + FT_UINT8, BASE_HEX, NULL, 0, + "RFCOMM DLCI", HFILL} + }, + { &hf_priority, + { "Priority", "btrfcomm.priority", + FT_UINT8, BASE_DEC, NULL, 0x3f, + NULL, HFILL} + }, + { &hf_max_frame_size, + { "Max Frame Size", "btrfcomm.max_frame_size", + FT_UINT16, BASE_DEC, NULL, 0, + "Maximum Frame Size", HFILL} + }, + { &hf_max_retrans, + { "Max Retrans", "btrfcomm.max_retrans", + FT_UINT8, BASE_DEC, NULL, 0, + "Maximum number of retransmissions", HFILL} + }, + { &hf_error_recovery_mode, + { "Error Recovery Mode", "btrfcomm.error_recovery_mode", + FT_UINT8, BASE_DEC, NULL, 0x07, + NULL, HFILL} + }, + { &hf_ea, + { "EA Flag", "btrfcomm.ea", + FT_UINT8, BASE_HEX, VALS(vs_ea), 0x1, + "EA flag (should be always 1)", HFILL} + }, + { &hf_cr, + { "C/R Flag", "btrfcomm.cr", + FT_UINT8, BASE_HEX, VALS(vs_cr), 0x2, + "Command/Response flag", HFILL} + }, + { &hf_mcc_ea, + { "EA Flag", "btrfcomm.mcc.ea", + FT_UINT8, BASE_HEX, VALS(vs_ea), 0x1, + "EA flag (should be always 1)", HFILL} + }, + { &hf_mcc_cr, + { "C/R Flag", "btrfcomm.mcc.cr", + FT_UINT8, BASE_HEX, VALS(vs_cr), 0x2, + "Command/Response flag", HFILL} + }, + { &hf_mcc_cmd, + { "C/R Flag", "btrfcomm.mcc.cmd", + FT_UINT8, BASE_HEX, VALS(vs_ctl), 0xfc, + "Command/Response flag", HFILL} + }, + { &hf_frame_type, + { "Frame type", "btrfcomm.frame_type", + FT_UINT8, BASE_HEX, VALS(vs_frame_type), 0xef, + "Command/Response flag", HFILL} + }, + { &hf_pf, + { "P/F flag", "btrfcomm.pf", + FT_UINT8, BASE_HEX, NULL, 0x10, + "Poll/Final bit", HFILL} + }, + { &hf_pn_i14, + { "Type of frame", "btrfcomm.pn.i", + FT_UINT8, BASE_HEX, VALS(vs_ctl_pn_i), 0x0f, + "Type of information frames used for that particular DLCI", + HFILL} + }, + { &hf_pn_c14, + { "Convergence layer", "btrfcomm.pn.cl", + FT_UINT8, BASE_HEX, VALS(vs_ctl_pn_cl), 0xf0, + "Convergence layer used for that particular DLCI", HFILL} + }, + { &hf_len, + { "Payload length", "btrfcomm.len", + FT_UINT16, BASE_DEC, NULL, 0, + "Frame length", HFILL} + }, + { &hf_mcc_len, + { "MCC Length", "btrfcomm.mcc.len", + FT_UINT16, BASE_DEC, NULL, 0, + "Length of MCC data", HFILL} + }, + { &hf_fcs, + { "Frame Check Sequence", "btrfcomm.fcs", + FT_UINT8, BASE_HEX, NULL, 0, + "Checksum over frame", HFILL} + }, + { &hf_msc_fc, + { "Flow Control (FC)", "btrfcomm.msc.fc", + FT_UINT8, BASE_HEX, NULL, 0x2, + "Flow Control", HFILL} + }, + { &hf_msc_rtc, + { "Ready To Communicate (RTC)", "btrfcomm.msc.rtc", + FT_UINT8, BASE_HEX, NULL, 0x4, + "Ready To Communicate", HFILL} + }, + { &hf_msc_rtr, + { "Ready To Receive (RTR)", "btrfcomm.msc.rtr", + FT_UINT8, BASE_HEX, NULL, 0x8, + "Ready To Receive", HFILL} + }, + { &hf_msc_ic, + { "Incoming Call Indicator (IC)", "btrfcomm.msc.ic", + FT_UINT8, BASE_HEX, NULL, 0x40, + "Incoming Call Indicator", HFILL} + }, + { &hf_msc_dv, + { "Data Valid (DV)", "btrfcomm.msc.dv", + FT_UINT8, BASE_HEX, NULL, 0x80, + "Data Valid", HFILL} + }, + { &hf_msc_l, + { "Length of break in units of 200ms", "btrfcomm.msc.bl", + FT_UINT8, BASE_DEC, NULL, 0xf0, + NULL, HFILL} + }, + { &hf_fc_credits, + { "Credits", "btrfcomm.credits", + FT_UINT8, BASE_DEC, NULL, 0, + "Flow control: number of UIH frames allowed to send", HFILL} + } + + }; + + /* Setup protocol subtree array */ + static gint *ett[] = { + &ett_btrfcomm, + &ett_btrfcomm_ctrl, + &ett_addr, + &ett_control, + &ett_mcc, + &ett_ctrl_pn_ci, + &ett_ctrl_pn_v24 + }; + + /* Register the protocol name and description */ + proto_btrfcomm = proto_register_protocol("Bluetooth RFCOMM Protocol", "RFCOMM", "btrfcomm"); + + register_dissector("btrfcomm", dissect_btrfcomm, proto_btrfcomm); + + /* Required function calls to register the header fields and subtrees used */ + proto_register_field_array(proto_btrfcomm, hf, array_length(hf)); + proto_register_subtree_array(ett, array_length(ett)); + + rfcomm_service_dissector_table = register_dissector_table("btrfcomm.service", "RFCOMM SERVICE", FT_UINT16, BASE_HEX); + + dlci_table = se_tree_create(EMEM_TREE_TYPE_RED_BLACK, "RFCOMM dlci table"); } static int btrfcomm_sdp_tap_packet(void *arg _U_, packet_info *pinfo _U_, epan_dissect_t *edt _U_, const void *arg2) { - btsdp_data_t *sdp_data = (btsdp_data_t *) arg2; - - if( sdp_data->protocol == BTSDP_RFCOMM_PROTOCOL_UUID ) { - guint32 token; - dlci_state_t *dlci_state; - - /* rfcomm channel * 2 = dlci */ - token = (sdp_data->channel<<1) | (sdp_data->flags & BTSDP_LOCAL_SERVICE_FLAG_MASK); - - dlci_state=se_tree_lookup32(dlci_table, token); - if(!dlci_state){ - dlci_state=se_alloc0(sizeof(dlci_state_t)); - se_tree_insert32(dlci_table, token, dlci_state); - } - dlci_state->service = sdp_data->service; - } - return 0; + btsdp_data_t *sdp_data = (btsdp_data_t *) arg2; + + if (sdp_data->protocol == BTSDP_RFCOMM_PROTOCOL_UUID) { + guint32 token; + dlci_state_t *dlci_state; + + /* rfcomm channel * 2 = dlci */ + token = (sdp_data->channel<<1) | (sdp_data->flags & BTSDP_LOCAL_SERVICE_FLAG_MASK); + + dlci_state = se_tree_lookup32(dlci_table, token); + if (!dlci_state) { + dlci_state = se_alloc0(sizeof(dlci_state_t)); + se_tree_insert32(dlci_table, token, dlci_state); + } + dlci_state->service = sdp_data->service; + } + return 0; } void proto_reg_handoff_btrfcomm(void) { - dissector_handle_t btrfcomm_handle; + dissector_handle_t btrfcomm_handle; - btrfcomm_handle = find_dissector("btrfcomm"); - dissector_add_uint("btl2cap.psm", BTL2CAP_PSM_RFCOMM, btrfcomm_handle); + btrfcomm_handle = find_dissector("btrfcomm"); + dissector_add_uint("btl2cap.psm", BTL2CAP_PSM_RFCOMM, btrfcomm_handle); - data_handle = find_dissector("data"); + data_handle = find_dissector("data"); - /* tap into the btsdp dissector to look for rfcomm channel infomation that - helps us determine the type of rfcomm payload, i.e. which service is - using the channels so we know which sub-dissector to call */ - register_tap_listener("btsdp", NULL, NULL, TL_IS_DISSECTOR_HELPER, NULL, btrfcomm_sdp_tap_packet, NULL); + /* tap into the btsdp dissector to look for rfcomm channel infomation that + helps us determine the type of rfcomm payload, i.e. which service is + using the channels so we know which sub-dissector to call */ + register_tap_listener("btsdp", NULL, NULL, TL_IS_DISSECTOR_HELPER, NULL, btrfcomm_sdp_tap_packet, NULL); } /* Bluetooth Handsfree (HF) profile dissection */ static void dissect_bthf(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree) { - proto_item *ti; - proto_tree *st; + proto_item *ti; + proto_tree *st; - guint length = tvb_length(tvb); + guint length = tvb_length(tvb); - col_set_str(pinfo->cinfo, COL_PROTOCOL, "HANDSFREE"); + col_set_str(pinfo->cinfo, COL_PROTOCOL, "HANDSFREE"); - ti = proto_tree_add_item(tree, proto_bthf, tvb, 0, -1, ENC_NA); - st = proto_item_add_subtree(ti, ett_bthf); + ti = proto_tree_add_item(tree, proto_bthf, tvb, 0, -1, ENC_NA); + st = proto_item_add_subtree(ti, ett_bthf); - col_add_fstr(pinfo->cinfo, COL_INFO, "%s \"%s\"", - pinfo->p2p_dir==P2P_DIR_SENT?"Sent":"Rcvd", tvb_format_text(tvb, 0, length)); + col_add_fstr(pinfo->cinfo, COL_INFO, "%s \"%s\"", + (pinfo->p2p_dir == P2P_DIR_SENT) ? "Sent" : "Rcvd", + tvb_format_text(tvb, 0, length)); - proto_tree_add_item(st, hf_at_cmd, tvb, 0, -1, ENC_ASCII|ENC_NA); + proto_tree_add_item(st, hf_at_cmd, tvb, 0, -1, ENC_ASCII|ENC_NA); } void proto_register_bthf(void) { - static hf_register_info hf[] = { - {&hf_at_cmd, - {"AT Cmd", "bthf.atcmd", - FT_STRING, BASE_NONE, NULL, 0, - "AT Command", HFILL} - }, - }; - - /* Setup protocol subtree array */ - static gint *ett[] = { - &ett_bthf, - }; - - proto_bthf = proto_register_protocol("Bluetooth Handsfree Packet", "BTHF", "bthf"); - - /* Required function calls to register the header fields and subtrees used */ - proto_register_field_array(proto_bthf, hf, array_length(hf)); - proto_register_subtree_array(ett, array_length(ett)); + static hf_register_info hf[] = { + { &hf_at_cmd, + { "AT Cmd", "bthf.atcmd", + FT_STRING, BASE_NONE, NULL, 0, + "AT Command", HFILL} + }, + }; + + /* Setup protocol subtree array */ + static gint *ett[] = { + &ett_bthf, + }; + + proto_bthf = proto_register_protocol("Bluetooth Handsfree Packet", "BTHF", "bthf"); + + /* Required function calls to register the header fields and subtrees used */ + proto_register_field_array(proto_bthf, hf, array_length(hf)); + proto_register_subtree_array(ett, array_length(ett)); } void proto_reg_handoff_bthf(void) { - dissector_handle_t bthf_handle; + dissector_handle_t bthf_handle; - bthf_handle = create_dissector_handle(dissect_bthf, proto_bthf); + bthf_handle = create_dissector_handle(dissect_bthf, proto_bthf); - dissector_add_uint("btrfcomm.service", BTSDP_HFP_SERVICE_UUID, bthf_handle); - dissector_add_uint("btrfcomm.service", BTSDP_HFP_GW_SERVICE_UUID, bthf_handle); + dissector_add_uint("btrfcomm.service", BTSDP_HFP_SERVICE_UUID, bthf_handle); + dissector_add_uint("btrfcomm.service", BTSDP_HFP_GW_SERVICE_UUID, bthf_handle); } /* Bluetooth Dial-Up Networking (DUN) profile dissection */ static void dissect_btdun(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree) { - proto_item *ti; - proto_tree *st; - gboolean is_at_cmd; - guint i, length; - - length = tvb_length(tvb); - - col_set_str(pinfo->cinfo, COL_PROTOCOL, "DUN"); - - ti = proto_tree_add_item(tree, proto_btdun, tvb, 0, -1, ENC_NA); - st = proto_item_add_subtree(ti, ett_btdun); - - is_at_cmd = TRUE; - for(i=0;i<length && is_at_cmd;i++) { - is_at_cmd = tvb_get_guint8(tvb, i) < 0x7d; - } - - if( is_at_cmd) { - /* presumably an AT command */ - col_add_fstr(pinfo->cinfo, COL_INFO, "%s \"%s\"", - pinfo->p2p_dir==P2P_DIR_SENT?"Sent":"Rcvd", tvb_format_text(tvb, 0, length)); - - proto_tree_add_item(st, hf_dun_at_cmd, tvb, 0, -1, ENC_ASCII|ENC_NA); - } - else { - /* ... or raw PPP */ - if( ppp_handle ) - call_dissector(ppp_handle, tvb, pinfo, tree); - else { - /* TODO: remove the above 'if' and this 'else-body' when "ppp_raw_hdlc" is available, requires that it is - made non-anonymous in ppp dissector to use */ - col_set_str(pinfo->cinfo, COL_PROTOCOL, "PPP"); - col_add_fstr(pinfo->cinfo, COL_INFO, "%s <PPP frame>", pinfo->p2p_dir==P2P_DIR_SENT?"Sent":"Rcvd"); - - call_dissector(data_handle, tvb, pinfo, tree); - } - } + proto_item *ti; + proto_tree *st; + gboolean is_at_cmd; + guint i, length; + + length = tvb_length(tvb); + + col_set_str(pinfo->cinfo, COL_PROTOCOL, "DUN"); + + ti = proto_tree_add_item(tree, proto_btdun, tvb, 0, -1, ENC_NA); + st = proto_item_add_subtree(ti, ett_btdun); + + is_at_cmd = TRUE; + for(i=0; i<length && is_at_cmd; i++) { + is_at_cmd = tvb_get_guint8(tvb, i) < 0x7d; + } + + if (is_at_cmd) { + /* presumably an AT command */ + col_add_fstr(pinfo->cinfo, COL_INFO, "%s \"%s\"", + (pinfo->p2p_dir == P2P_DIR_SENT) ? "Sent" : "Rcvd", + tvb_format_text(tvb, 0, length)); + + proto_tree_add_item(st, hf_dun_at_cmd, tvb, 0, -1, ENC_ASCII|ENC_NA); + } + else { + /* ... or raw PPP */ + if (ppp_handle) + call_dissector(ppp_handle, tvb, pinfo, tree); + else { + /* TODO: remove the above 'if' and this 'else-body' when "ppp_raw_hdlc" is available, requires that it is + made non-anonymous in ppp dissector to use */ + col_set_str(pinfo->cinfo, COL_PROTOCOL, "PPP"); + col_add_fstr(pinfo->cinfo, COL_INFO, "%s <PPP frame>", (pinfo->p2p_dir == P2P_DIR_SENT) ? "Sent" : "Rcvd"); + + call_dissector(data_handle, tvb, pinfo, tree); + } + } } void proto_register_btdun(void) { - static hf_register_info hf[] = { - {&hf_dun_at_cmd, - {"AT Cmd", "btdun.atcmd", - FT_STRING, BASE_NONE, NULL, 0, - "AT Command", HFILL} - }, - }; - - /* Setup protocol subtree array */ - static gint *ett[] = { - &ett_btdun, - }; - - proto_btdun = proto_register_protocol("Bluetooth DUN Packet", "BTDUN", "btdun"); - - /* Required function calls to register the header fields and subtrees used */ - proto_register_field_array(proto_bthf, hf, array_length(hf)); - proto_register_subtree_array(ett, array_length(ett)); + static hf_register_info hf[] = { + { &hf_dun_at_cmd, + { "AT Cmd", "btdun.atcmd", + FT_STRING, BASE_NONE, NULL, 0, + "AT Command", HFILL} + }, + }; + + /* Setup protocol subtree array */ + static gint *ett[] = { + &ett_btdun, + }; + + proto_btdun = proto_register_protocol("Bluetooth DUN Packet", "BTDUN", "btdun"); + + /* Required function calls to register the header fields and subtrees used */ + proto_register_field_array(proto_bthf, hf, array_length(hf)); + proto_register_subtree_array(ett, array_length(ett)); } void proto_reg_handoff_btdun(void) { - dissector_handle_t btdun_handle; + dissector_handle_t btdun_handle; - btdun_handle = create_dissector_handle(dissect_btdun, proto_btdun); + btdun_handle = create_dissector_handle(dissect_btdun, proto_btdun); - dissector_add_uint("btrfcomm.service", BTSDP_DUN_SERVICE_UUID, btdun_handle); + dissector_add_uint("btrfcomm.service", BTSDP_DUN_SERVICE_UUID, btdun_handle); - ppp_handle = find_dissector("ppp_raw_hdlc"); + ppp_handle = find_dissector("ppp_raw_hdlc"); } /* Bluetooth Serial Port profile (SPP) dissection */ static void dissect_btspp(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree) { - proto_item *ti; - proto_tree *st; - gboolean ascii_only; - guint i, length = tvb_length(tvb); - - col_set_str(pinfo->cinfo, COL_PROTOCOL, "SPP"); - - ti = proto_tree_add_item(tree, proto_btspp, tvb, 0, -1, ENC_NA); - st = proto_item_add_subtree(ti, ett_btspp); - - length = MIN(length,60); - ascii_only = TRUE; - for(i=0;i<length && ascii_only;i++) { - ascii_only = tvb_get_guint8(tvb, i) < 0x80; - } - - if(ascii_only) { - col_add_fstr(pinfo->cinfo, COL_INFO, "%s \"%s%s\"", - pinfo->p2p_dir==P2P_DIR_SENT?"Sent":"Rcvd", - tvb_format_text(tvb, 0, length), - tvb_length(tvb) > length ? "...":""); - } - - proto_tree_add_item(st, hf_data, tvb, 0, -1, ENC_NA); + proto_item *ti; + proto_tree *st; + gboolean ascii_only; + guint i, length = tvb_length(tvb); + + col_set_str(pinfo->cinfo, COL_PROTOCOL, "SPP"); + + ti = proto_tree_add_item(tree, proto_btspp, tvb, 0, -1, ENC_NA); + st = proto_item_add_subtree(ti, ett_btspp); + + length = MIN(length,60); + ascii_only = TRUE; + for(i=0; i<length && ascii_only; i++) { + ascii_only = tvb_get_guint8(tvb, i) < 0x80; + } + + if (ascii_only) { + col_add_fstr(pinfo->cinfo, COL_INFO, "%s \"%s%s\"", + (pinfo->p2p_dir == P2P_DIR_SENT) ? "Sent" : "Rcvd", + tvb_format_text(tvb, 0, length), + (tvb_length(tvb) > length) ? "..." : ""); + } + + proto_tree_add_item(st, hf_data, tvb, 0, -1, ENC_NA); } void proto_register_btspp(void) { - static hf_register_info hf[] = { - {&hf_data, - {"Data", "btspp.data", - FT_BYTES, BASE_NONE, NULL, 0, - NULL, HFILL}}, - }; - - /* Setup protocol subtree array */ - static gint *ett[] = { - &ett_btspp, - }; - - proto_btspp = proto_register_protocol("Bluetooth SPP Packet", "BTSPP", "btspp"); - - /* Required function calls to register the header fields and subtrees used */ - proto_register_field_array(proto_bthf, hf, array_length(hf)); - proto_register_subtree_array(ett, array_length(ett)); + static hf_register_info hf[] = { + { &hf_data, + { "Data", "btspp.data", + FT_BYTES, BASE_NONE, NULL, 0, + NULL, HFILL} + }, + }; + + /* Setup protocol subtree array */ + static gint *ett[] = { + &ett_btspp, + }; + + proto_btspp = proto_register_protocol("Bluetooth SPP Packet", "BTSPP", "btspp"); + + /* Required function calls to register the header fields and subtrees used */ + proto_register_field_array(proto_bthf, hf, array_length(hf)); + proto_register_subtree_array(ett, array_length(ett)); } void proto_reg_handoff_btspp(void) { - dissector_handle_t btspp_handle; + dissector_handle_t btspp_handle; - btspp_handle = create_dissector_handle(dissect_btspp, proto_btspp); + btspp_handle = create_dissector_handle(dissect_btspp, proto_btspp); - dissector_add_uint("btrfcomm.service", BTSDP_SPP_SERVICE_UUID, btspp_handle); + dissector_add_uint("btrfcomm.service", BTSDP_SPP_SERVICE_UUID, btspp_handle); } |