2013-02-25 17:55:32 +00:00
|
|
|
/* packet-bthcrp.c
|
|
|
|
* Routines for Bluetooth HCRP dissection
|
|
|
|
*
|
|
|
|
* Copyright 2013, Michal Labedzki for Tieto Corporation
|
|
|
|
*
|
|
|
|
* Wireshark - Network traffic analyzer
|
|
|
|
* By Gerald Combs <gerald@wireshark.org>
|
|
|
|
* Copyright 1998 Gerald Combs
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU General Public License
|
|
|
|
* as published by the Free Software Foundation; either version 2
|
|
|
|
* of the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "config.h"
|
|
|
|
|
|
|
|
#include <epan/packet.h>
|
|
|
|
#include <epan/prefs.h>
|
|
|
|
#include <epan/expert.h>
|
|
|
|
|
|
|
|
#include "packet-btl2cap.h"
|
|
|
|
#include "packet-btsdp.h"
|
|
|
|
|
2013-12-07 01:01:31 +00:00
|
|
|
enum {
|
|
|
|
FORCE_CLIENT_DEFAULT = 0,
|
|
|
|
FORCE_CLIENT_YES = 1,
|
|
|
|
FORCE_CLIENT_NO = 2
|
|
|
|
};
|
|
|
|
|
2013-02-25 17:55:32 +00:00
|
|
|
static int proto_bthcrp = -1;
|
|
|
|
|
|
|
|
static int hf_bthcrp_notification_pdu_id = -1;
|
|
|
|
static int hf_bthcrp_control_pdu_id = -1;
|
|
|
|
static int hf_bthcrp_control_transaction_id = -1;
|
|
|
|
static int hf_bthcrp_control_parameter_length = -1;
|
|
|
|
static int hf_bthcrp_control_status = -1;
|
|
|
|
static int hf_bthcrp_callback_context_id = -1;
|
|
|
|
static int hf_bthcrp_control_callback_timeout = -1;
|
|
|
|
static int hf_bthcrp_control_timeout = -1;
|
|
|
|
static int hf_bthcrp_control_1284_id = -1;
|
|
|
|
static int hf_bthcrp_control_register = -1;
|
|
|
|
static int hf_bthcrp_control_start_byte = -1;
|
|
|
|
static int hf_bthcrp_control_number_of_bytes = -1;
|
|
|
|
static int hf_bthcrp_control_client_credit_granted = -1;
|
|
|
|
static int hf_bthcrp_control_server_credit_granted = -1;
|
|
|
|
static int hf_bthcrp_control_client_credit_return = -1;
|
|
|
|
static int hf_bthcrp_control_server_credit_return = -1;
|
|
|
|
static int hf_bthcrp_control_client_credit_query = -1;
|
|
|
|
static int hf_bthcrp_control_server_credit_query = -1;
|
|
|
|
static int hf_bthcrp_control_status_reserved_76 = -1;
|
|
|
|
static int hf_bthcrp_control_status_paper_empty = -1;
|
|
|
|
static int hf_bthcrp_control_status_select = -1;
|
|
|
|
static int hf_bthcrp_control_status_not_error = -1;
|
|
|
|
static int hf_bthcrp_control_status_reserved_20 = -1;
|
|
|
|
static int hf_bthcrp_data = -1;
|
|
|
|
|
|
|
|
static gint ett_bthcrp = -1;
|
|
|
|
|
2013-07-09 01:18:52 +00:00
|
|
|
static expert_field ei_bthcrp_control_parameter_length = EI_INIT;
|
|
|
|
static expert_field ei_bthcrp_unexpected_data = EI_INIT;
|
|
|
|
|
2013-12-07 01:01:31 +00:00
|
|
|
static dissector_handle_t bthcrp_handle;
|
2013-02-25 17:55:32 +00:00
|
|
|
static dissector_handle_t data_handle;
|
|
|
|
|
2013-12-07 01:01:31 +00:00
|
|
|
static gint force_client = FORCE_CLIENT_DEFAULT;
|
2013-02-25 17:55:32 +00:00
|
|
|
static gint psm_control = 0;
|
|
|
|
static gint psm_data_stream = 0;
|
|
|
|
static gint psm_notification = 0;
|
|
|
|
|
|
|
|
static const value_string control_pdu_id_vals[] = {
|
|
|
|
{ 0x0001, "CR_DataChannelCreditGrant" },
|
|
|
|
{ 0x0002, "CR_DataChannelCreditRequest" },
|
|
|
|
{ 0x0003, "CR_DataChannelCreditReturn" },
|
|
|
|
{ 0x0004, "CR_DataChannelCreditQuery" },
|
|
|
|
{ 0x0005, "CR_GetLPTStatus" },
|
|
|
|
{ 0x0006, "CR_Get1284ID" },
|
|
|
|
{ 0x0007, "CR_SoftReset" },
|
|
|
|
{ 0x0008, "CR_HardReset" },
|
|
|
|
{ 0x0009, "CR_RegisterNotification" },
|
|
|
|
{ 0x000A, "CR_NotificationConnectionAlive" },
|
|
|
|
{ 0, NULL }
|
|
|
|
};
|
|
|
|
|
|
|
|
static const value_string status_vals[] = {
|
|
|
|
{ 0x0000, "Feature Unsupported" },
|
|
|
|
{ 0x0001, "Success" },
|
|
|
|
{ 0x0002, "Credit Synchronization Error" },
|
|
|
|
{ 0xFFFF, "Generic Failure" },
|
|
|
|
{ 0, NULL }
|
|
|
|
};
|
|
|
|
|
|
|
|
static const value_string notification_pdu_id_vals[] = {
|
|
|
|
{ 0x0001, "N_Notification" },
|
|
|
|
{ 0, NULL }
|
|
|
|
};
|
|
|
|
|
|
|
|
static const value_string register_vals[] = {
|
|
|
|
{ 0x00, "Remove Client From Receiver Notification" },
|
|
|
|
{ 0x01, "Add Client To Receiver Notification" },
|
|
|
|
{ 0, NULL }
|
|
|
|
};
|
|
|
|
|
2013-12-07 01:01:31 +00:00
|
|
|
static const enum_val_t force_client_enum[] = {
|
|
|
|
{ "default", "Default", FORCE_CLIENT_DEFAULT },
|
|
|
|
{ "yes", "Yes", FORCE_CLIENT_YES },
|
|
|
|
{ "no", "No", FORCE_CLIENT_NO },
|
|
|
|
{ NULL, NULL, 0 }
|
|
|
|
};
|
|
|
|
|
2013-03-19 13:51:52 +00:00
|
|
|
void proto_register_bthcrp(void);
|
|
|
|
void proto_reg_handoff_bthcrp(void);
|
2013-02-25 17:55:32 +00:00
|
|
|
|
2013-12-07 01:01:31 +00:00
|
|
|
|
2013-02-25 17:55:32 +00:00
|
|
|
static gint
|
|
|
|
dissect_control(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree,
|
|
|
|
gint offset, gboolean is_client_message)
|
|
|
|
{
|
|
|
|
/* flow: reqests: only client -> server; responses: only server -> */
|
|
|
|
proto_item *pitem;
|
|
|
|
guint16 control_pdu_id;
|
|
|
|
guint credits;
|
|
|
|
guint timeout;
|
|
|
|
guint context_id;
|
|
|
|
guint notification_register;
|
|
|
|
guint number;
|
|
|
|
gint parameter_length;
|
|
|
|
|
|
|
|
pitem = proto_tree_add_item(tree, hf_bthcrp_control_pdu_id, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
control_pdu_id = tvb_get_ntohs(tvb, offset);
|
|
|
|
offset += 2;
|
|
|
|
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, "Control: %s %s",
|
|
|
|
((is_client_message) ? "Request" : "Response"),
|
|
|
|
val_to_str(control_pdu_id, control_pdu_id_vals, "Unknown PDU ID"));
|
|
|
|
|
|
|
|
if (control_pdu_id >= 0x8000) {
|
|
|
|
proto_item_append_text(pitem, " (Vendor Specific)");
|
2013-10-29 14:09:20 +00:00
|
|
|
col_append_str(pinfo->cinfo, COL_INFO, " (Vendor Specific)");
|
2013-02-25 17:55:32 +00:00
|
|
|
} else if (control_pdu_id == 0x0000 || control_pdu_id >= 0x000B ) {
|
|
|
|
proto_item_append_text(pitem, " (Reserved)");
|
2013-10-29 14:09:20 +00:00
|
|
|
col_append_str(pinfo->cinfo, COL_INFO, " (Reserved)");
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_transaction_id, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
offset += 2;
|
|
|
|
|
|
|
|
pitem = proto_tree_add_item(tree, hf_bthcrp_control_parameter_length, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
parameter_length = tvb_get_ntohs(tvb, offset);
|
|
|
|
offset += 2;
|
|
|
|
|
|
|
|
if (!is_client_message && parameter_length < 2) {
|
2013-09-09 00:44:09 +00:00
|
|
|
expert_add_info_format(pinfo, pitem, &ei_bthcrp_control_parameter_length,
|
2013-02-25 17:55:32 +00:00
|
|
|
"Parameter length is shorter than 2 in response");
|
|
|
|
}
|
|
|
|
|
2015-02-26 13:38:57 +00:00
|
|
|
if (parameter_length < tvb_reported_length_remaining(tvb, offset)) {
|
2013-09-09 00:44:09 +00:00
|
|
|
expert_add_info_format(pinfo, pitem, &ei_bthcrp_control_parameter_length,
|
2013-02-25 17:55:32 +00:00
|
|
|
"Parameter length is shorter than payload length");
|
2015-02-26 13:38:57 +00:00
|
|
|
} else if (parameter_length > tvb_reported_length_remaining(tvb, offset)) {
|
2013-09-09 00:44:09 +00:00
|
|
|
expert_add_info_format(pinfo, pitem, &ei_bthcrp_control_parameter_length,
|
2013-02-25 17:55:32 +00:00
|
|
|
"Parameter length is larger than payload length");
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_status, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
offset += 2;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (control_pdu_id >= 0x8000) {
|
2015-02-26 13:38:57 +00:00
|
|
|
if (tvb_reported_length_remaining(tvb, offset)) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_data, tvb, offset, tvb_reported_length_remaining(tvb, offset), ENC_NA);
|
|
|
|
offset += tvb_reported_length_remaining(tvb, offset);
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
} else switch(control_pdu_id) {
|
|
|
|
case 0x0001: /* CR_DataChannelCreditGrant */
|
|
|
|
if (is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_client_credit_granted, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
credits = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - CreditGranted: %u", credits);
|
|
|
|
offset += 4;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x0002: /* CR_DataChannelCreditRequest */
|
|
|
|
if (!is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_server_credit_granted, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
credits = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - CreditGranted: %u", credits);
|
|
|
|
offset += 4;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x0003: /* CR_DataChannelCreditReturn */
|
|
|
|
if (is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_client_credit_return, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
credits = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - Client Credit Return: %u", credits);
|
|
|
|
offset += 4;
|
|
|
|
} else {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_server_credit_return, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
credits = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - Server Credit Return: %u", credits);
|
|
|
|
offset += 4;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x0004: /* CR_DataChannelCreditQuery */
|
|
|
|
if (is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_client_credit_query, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
credits = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - Client Credit: %u", credits);
|
|
|
|
offset += 4;
|
|
|
|
} else {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_server_credit_query, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
credits = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - Server Credit: %u", credits);
|
|
|
|
offset += 4;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x0005: /* CR_GetLPTStatus */
|
|
|
|
if (!is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_status_reserved_76, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_status_paper_empty, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_status_select, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_status_not_error, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_status_reserved_20, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
|
|
offset += 1;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x0006: /* CR_Get1284ID */
|
|
|
|
if (is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_start_byte, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
number = tvb_get_ntohs(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - Start Byte: %u", number);
|
|
|
|
offset += 2;
|
|
|
|
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_number_of_bytes, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
number = tvb_get_ntohs(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", Number Of Bytes: %u", number);
|
|
|
|
offset += 2;
|
|
|
|
} else {
|
|
|
|
guint8 *id;
|
|
|
|
|
2015-02-26 13:38:57 +00:00
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_1284_id, tvb, offset, tvb_reported_length_remaining(tvb, offset), ENC_ASCII | ENC_NA);
|
2015-09-08 20:44:34 +00:00
|
|
|
id = tvb_get_string_enc(wmem_packet_scope(), tvb, offset, tvb_reported_length_remaining(tvb, offset), ENC_ASCII);
|
2013-02-25 17:55:32 +00:00
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - 1284 ID: %s", id);
|
2015-02-26 13:38:57 +00:00
|
|
|
offset += tvb_reported_length_remaining(tvb, offset);
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x0007: /* CR_SoftReset */
|
|
|
|
case 0x0008: /* CR_HardReset */
|
|
|
|
break;
|
|
|
|
case 0x0009: /* CR_RegisterNotification */
|
|
|
|
if (is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_register, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
|
|
notification_register = tvb_get_guint8(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - Register: %s", val_to_str(notification_register, register_vals, "unknown register"));
|
|
|
|
offset += 1;
|
|
|
|
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_callback_context_id, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
context_id = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", Callback ContextID: %u", context_id);
|
|
|
|
offset += 4;
|
|
|
|
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_callback_timeout, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
timeout = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", Callback Timeout: %u", timeout);
|
|
|
|
offset += 4;
|
|
|
|
} else {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_timeout, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
timeout = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - Timeout: %u", timeout);
|
|
|
|
offset += 4;
|
|
|
|
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_callback_timeout, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
timeout = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", Callback Timeout: %u", timeout);
|
|
|
|
offset += 4;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x000A: /* CR_NotificationConnectionAlive */
|
|
|
|
if (!is_client_message) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_control_timeout, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
timeout = tvb_get_ntohl(tvb, offset);
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, " - Timeout: %u", timeout);
|
|
|
|
offset += 4;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return offset;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static gint
|
|
|
|
dissect_data(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, gint offset)
|
|
|
|
{
|
|
|
|
/* flow: server <-> client */
|
|
|
|
tvbuff_t *next_tvb;
|
|
|
|
|
2013-10-29 14:09:20 +00:00
|
|
|
col_append_str(pinfo->cinfo, COL_INFO, "HCRP data stream");
|
2013-02-25 17:55:32 +00:00
|
|
|
|
|
|
|
next_tvb = tvb_new_subset_remaining(tvb, offset);
|
|
|
|
call_dissector(data_handle, next_tvb, pinfo, tree);
|
|
|
|
|
2015-02-26 13:38:57 +00:00
|
|
|
offset += tvb_reported_length_remaining(tvb, offset);
|
2013-02-25 17:55:32 +00:00
|
|
|
|
|
|
|
return offset;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static gint
|
|
|
|
dissect_notification(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree,
|
|
|
|
gint offset, gboolean is_client_message)
|
|
|
|
{
|
|
|
|
/* flow: only server -> client */
|
|
|
|
guint16 notification_pdu_id;
|
|
|
|
proto_item *pitem;
|
|
|
|
|
|
|
|
if (is_client_message) {
|
2013-10-29 14:09:20 +00:00
|
|
|
col_append_str(pinfo->cinfo, COL_INFO, "Notification: unexpected notification stream");
|
2013-02-25 17:55:32 +00:00
|
|
|
return offset;
|
|
|
|
}
|
|
|
|
|
|
|
|
pitem = proto_tree_add_item(tree, hf_bthcrp_notification_pdu_id, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
notification_pdu_id = tvb_get_ntohs(tvb, offset);
|
|
|
|
offset += 2;
|
|
|
|
|
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, "Notification: %s", val_to_str(notification_pdu_id, notification_pdu_id_vals, "Unknown PDU ID"));
|
|
|
|
|
|
|
|
if (notification_pdu_id >= 0x8000) {
|
|
|
|
proto_item_append_text(pitem, " (Vendor Specific)");
|
2013-10-29 14:09:20 +00:00
|
|
|
col_append_str(pinfo->cinfo, COL_INFO, " (Vendor Specific)");
|
2015-02-26 13:38:57 +00:00
|
|
|
if (tvb_reported_length_remaining(tvb, offset)) {
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_data, tvb, offset, tvb_reported_length_remaining(tvb, offset), ENC_NA);
|
|
|
|
offset += tvb_reported_length_remaining(tvb, offset);
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
} else if (notification_pdu_id != 0x001) {
|
|
|
|
proto_item_append_text(pitem, " (Reserved)");
|
2013-10-29 14:09:20 +00:00
|
|
|
col_append_str(pinfo->cinfo, COL_INFO, " (Reserved)");
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
switch(notification_pdu_id) {
|
|
|
|
case 0x01: /* N_NOTIFICATION */
|
|
|
|
proto_tree_add_item(tree, hf_bthcrp_callback_context_id, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
|
|
offset += 4;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return offset;
|
|
|
|
}
|
|
|
|
|
2013-11-02 19:20:04 +00:00
|
|
|
static gint
|
|
|
|
dissect_bthcrp(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data)
|
2013-02-25 17:55:32 +00:00
|
|
|
{
|
2013-12-07 01:01:31 +00:00
|
|
|
proto_item *main_item;
|
|
|
|
proto_tree *main_tree;
|
|
|
|
gint offset = 0;
|
|
|
|
gint protocol = -1;
|
2015-09-27 16:22:32 +00:00
|
|
|
gboolean is_client_message = FALSE;
|
|
|
|
gint previous_proto;
|
|
|
|
|
|
|
|
previous_proto = (GPOINTER_TO_INT(wmem_list_frame_data(wmem_list_frame_prev(wmem_list_tail(pinfo->layers)))));
|
|
|
|
if (previous_proto == proto_btl2cap) {
|
|
|
|
btl2cap_data_t *l2cap_data;
|
|
|
|
wmem_tree_key_t key[10];
|
|
|
|
guint32 interface_id;
|
|
|
|
guint32 adapter_id;
|
|
|
|
guint32 sdp_psm = SDP_PSM_DEFAULT;
|
|
|
|
guint32 direction;
|
|
|
|
guint32 bd_addr_oui;
|
|
|
|
guint32 bd_addr_id;
|
|
|
|
guint32 service_type;
|
|
|
|
guint32 service_channel;
|
|
|
|
guint32 frame_number;
|
|
|
|
service_info_t *service_info;
|
|
|
|
|
|
|
|
l2cap_data = (btl2cap_data_t *) data;
|
|
|
|
|
|
|
|
interface_id = l2cap_data->interface_id;
|
|
|
|
adapter_id = l2cap_data->adapter_id;
|
|
|
|
|
|
|
|
direction = (l2cap_data->is_local_psm) ? P2P_DIR_SENT : P2P_DIR_RECV;
|
|
|
|
if (direction == P2P_DIR_RECV) {
|
|
|
|
bd_addr_oui = l2cap_data->remote_bd_addr_oui;
|
|
|
|
bd_addr_id = l2cap_data->remote_bd_addr_id;
|
|
|
|
} else {
|
|
|
|
bd_addr_oui = 0;
|
|
|
|
bd_addr_id = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
service_type = BTSDP_L2CAP_PROTOCOL_UUID;
|
|
|
|
service_channel = l2cap_data->psm;
|
2016-01-24 03:40:51 +00:00
|
|
|
frame_number = pinfo->num;
|
2015-09-27 16:22:32 +00:00
|
|
|
|
|
|
|
key[0].length = 1;
|
|
|
|
key[0].key = &interface_id;
|
|
|
|
key[1].length = 1;
|
|
|
|
key[1].key = &adapter_id;
|
|
|
|
key[2].length = 1;
|
|
|
|
key[2].key = &sdp_psm;
|
|
|
|
key[3].length = 1;
|
|
|
|
key[3].key = &direction;
|
|
|
|
key[4].length = 1;
|
|
|
|
key[4].key = &bd_addr_oui;
|
|
|
|
key[5].length = 1;
|
|
|
|
key[5].key = &bd_addr_id;
|
|
|
|
key[6].length = 1;
|
|
|
|
key[6].key = &service_type;
|
|
|
|
key[7].length = 1;
|
|
|
|
key[7].key = &service_channel;
|
|
|
|
key[8].length = 1;
|
|
|
|
key[8].key = &frame_number;
|
|
|
|
key[9].length = 0;
|
|
|
|
key[9].key = NULL;
|
|
|
|
|
|
|
|
service_info = btsdp_get_service_info(key);
|
|
|
|
if (service_info && service_info->interface_id == interface_id &&
|
|
|
|
service_info->adapter_id == adapter_id &&
|
|
|
|
service_info->sdp_psm == SDP_PSM_DEFAULT &&
|
|
|
|
((service_info->direction == P2P_DIR_RECV &&
|
|
|
|
service_info->bd_addr_oui == bd_addr_oui &&
|
|
|
|
service_info->bd_addr_id == bd_addr_id) ||
|
|
|
|
(service_info->direction != P2P_DIR_RECV &&
|
|
|
|
service_info->bd_addr_oui == 0 &&
|
|
|
|
service_info->bd_addr_id == 0)) &&
|
|
|
|
service_info->type == BTSDP_L2CAP_PROTOCOL_UUID &&
|
|
|
|
service_info->channel == l2cap_data->psm) {
|
|
|
|
|
|
|
|
if ((service_info->protocol == BTSDP_HARDCOPY_CONTROL_CHANNEL_PROTOCOL_UUID ||
|
|
|
|
service_info->protocol == BTSDP_HARDCOPY_DATA_CHANNEL_PROTOCOL_UUID) &&
|
|
|
|
((!l2cap_data->is_local_psm && pinfo->p2p_dir == P2P_DIR_SENT) ||
|
|
|
|
(l2cap_data->is_local_psm && pinfo->p2p_dir == P2P_DIR_RECV))) {
|
|
|
|
is_client_message = TRUE;
|
|
|
|
} else if (service_info->protocol == BTSDP_HARDCOPY_NOTIFICATION_PROTOCOL_UUID &&
|
|
|
|
((l2cap_data->is_local_psm && pinfo->p2p_dir == P2P_DIR_SENT) ||
|
|
|
|
(!l2cap_data->is_local_psm && pinfo->p2p_dir == P2P_DIR_RECV))) {
|
|
|
|
is_client_message = TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
protocol = service_info->protocol;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (psm_control != 0 && l2cap_data->psm == psm_control) {
|
|
|
|
protocol = BTSDP_HARDCOPY_CONTROL_CHANNEL_PROTOCOL_UUID;
|
|
|
|
} else if (psm_data_stream != 0 && l2cap_data->psm == psm_data_stream) {
|
|
|
|
protocol = BTSDP_HARDCOPY_DATA_CHANNEL_PROTOCOL_UUID;
|
|
|
|
} else if (psm_notification != 0 && l2cap_data->psm == psm_notification) {
|
|
|
|
protocol = BTSDP_HARDCOPY_NOTIFICATION_PROTOCOL_UUID;
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
2013-12-02 21:34:23 +00:00
|
|
|
|
2013-11-02 19:20:04 +00:00
|
|
|
main_item = proto_tree_add_item(tree, proto_bthcrp, tvb, offset, -1, ENC_NA);
|
|
|
|
main_tree = proto_item_add_subtree(main_item, ett_bthcrp);
|
2013-02-25 17:55:32 +00:00
|
|
|
|
|
|
|
col_set_str(pinfo->cinfo, COL_PROTOCOL, "HCRP");
|
|
|
|
|
|
|
|
switch (pinfo->p2p_dir) {
|
2013-03-30 21:47:27 +00:00
|
|
|
case P2P_DIR_SENT:
|
2013-10-29 14:09:20 +00:00
|
|
|
col_set_str(pinfo->cinfo, COL_INFO, "Sent ");
|
2013-03-30 21:47:27 +00:00
|
|
|
break;
|
|
|
|
case P2P_DIR_RECV:
|
2013-10-29 14:09:20 +00:00
|
|
|
col_set_str(pinfo->cinfo, COL_INFO, "Rcvd ");
|
2013-03-30 21:47:27 +00:00
|
|
|
break;
|
|
|
|
default:
|
2015-01-18 09:44:04 +00:00
|
|
|
col_set_str(pinfo->cinfo, COL_INFO, "UnknownDirection ");
|
2013-03-30 21:47:27 +00:00
|
|
|
break;
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
|
2013-12-07 01:01:31 +00:00
|
|
|
if (force_client != FORCE_CLIENT_DEFAULT) {
|
|
|
|
is_client_message = (force_client == FORCE_CLIENT_YES && pinfo->p2p_dir == P2P_DIR_SENT) ||
|
|
|
|
(force_client != FORCE_CLIENT_YES && pinfo->p2p_dir == P2P_DIR_RECV);
|
|
|
|
}
|
|
|
|
|
2015-09-27 16:22:32 +00:00
|
|
|
if (protocol == BTSDP_HARDCOPY_CONTROL_CHANNEL_PROTOCOL_UUID) {
|
2013-02-25 17:55:32 +00:00
|
|
|
offset = dissect_control(tvb, pinfo, main_tree, offset, is_client_message);
|
2015-09-27 16:22:32 +00:00
|
|
|
} else if (protocol == BTSDP_HARDCOPY_DATA_CHANNEL_PROTOCOL_UUID) {
|
2013-02-25 17:55:32 +00:00
|
|
|
offset = dissect_data(tvb, pinfo, main_tree, offset);
|
2015-09-27 16:22:32 +00:00
|
|
|
} else if (protocol == BTSDP_HARDCOPY_NOTIFICATION_PROTOCOL_UUID) {
|
2013-02-25 17:55:32 +00:00
|
|
|
offset = dissect_notification(tvb, pinfo, main_tree, offset, is_client_message);
|
|
|
|
} else {
|
2015-09-27 16:22:32 +00:00
|
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, "HCRP stream");
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
|
2015-02-26 13:38:57 +00:00
|
|
|
if (tvb_reported_length_remaining(tvb, offset)) {
|
2013-02-25 17:55:32 +00:00
|
|
|
proto_item *pitem;
|
|
|
|
|
2015-02-26 13:38:57 +00:00
|
|
|
pitem = proto_tree_add_item(main_tree, hf_bthcrp_data, tvb, offset, tvb_reported_length_remaining(tvb, offset), ENC_NA);
|
2013-07-09 01:18:52 +00:00
|
|
|
expert_add_info(pinfo, pitem, &ei_bthcrp_unexpected_data);
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
2013-11-02 19:20:04 +00:00
|
|
|
|
|
|
|
return offset;
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void
|
|
|
|
proto_register_bthcrp(void)
|
|
|
|
{
|
|
|
|
module_t *module;
|
2013-07-09 01:18:52 +00:00
|
|
|
expert_module_t* expert_bthcrp;
|
2013-02-25 17:55:32 +00:00
|
|
|
|
|
|
|
static hf_register_info hf[] = {
|
|
|
|
{ &hf_bthcrp_control_pdu_id,
|
|
|
|
{ "Control PDU ID", "bthcrp.control.pdu_id",
|
|
|
|
FT_UINT16, BASE_HEX, VALS(control_pdu_id_vals), 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_transaction_id,
|
|
|
|
{ "Transaction ID", "bthcrp.control.transaction_id",
|
|
|
|
FT_UINT16, BASE_HEX, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_parameter_length,
|
|
|
|
{ "Parameter Length", "bthcrp.control.parameter_length",
|
|
|
|
FT_UINT16, BASE_HEX, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_status,
|
|
|
|
{ "Status", "bthcrp.control.status",
|
|
|
|
FT_UINT16, BASE_HEX, VALS(status_vals), 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_notification_pdu_id,
|
|
|
|
{ "Notification PDU ID", "bthcrp.notification.pdu_id",
|
|
|
|
FT_UINT16, BASE_HEX, VALS(notification_pdu_id_vals), 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_callback_context_id,
|
|
|
|
{ "Callback Context ID", "bthcrp.callback.context_id",
|
|
|
|
FT_UINT32, BASE_HEX, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_callback_timeout,
|
|
|
|
{ "Callback Timeout", "bthcrp.callback.timeout",
|
|
|
|
FT_UINT32, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_timeout,
|
|
|
|
{ "Timeout", "bthcrp.timeout",
|
|
|
|
FT_UINT32, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_register,
|
|
|
|
{ "Register", "bthcrp.register",
|
|
|
|
FT_UINT8, BASE_HEX, VALS(register_vals), 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_1284_id,
|
|
|
|
{ "1284 ID", "bthcrp.1284_id",
|
|
|
|
FT_STRING, BASE_NONE, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_start_byte,
|
|
|
|
{ "Start Byte", "bthcrp.start_byte",
|
|
|
|
FT_UINT16, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_number_of_bytes,
|
|
|
|
{ "Number Of Bytes", "bthcrp.number_of_bytes",
|
|
|
|
FT_UINT16, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_client_credit_granted,
|
|
|
|
{ "Client Credit Granted", "bthcrp.client_credit_granted",
|
|
|
|
FT_UINT32, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_server_credit_granted,
|
|
|
|
{ "Server Credit Granted", "bthcrp.server_credit_granted",
|
|
|
|
FT_UINT32, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_client_credit_return,
|
|
|
|
{ "Client Credit Return", "bthcrp.client_credit_return",
|
|
|
|
FT_UINT32, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_server_credit_return,
|
|
|
|
{ "Server Credit Return", "bthcrp.server_credit_return",
|
|
|
|
FT_UINT32, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_client_credit_query,
|
|
|
|
{ "Client Credit Query", "bthcrp.client_credit_query",
|
|
|
|
FT_UINT32, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_server_credit_query,
|
|
|
|
{ "Server Credit Query", "bthcrp.server_credit_query",
|
|
|
|
FT_UINT32, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_status_reserved_76,
|
|
|
|
{ "Reserved", "bthcrp.status.reserved76",
|
|
|
|
FT_UINT8, BASE_DEC, NULL, 0xC0,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_status_paper_empty,
|
|
|
|
{ "Paper Empty", "bthcrp.status.paper_empty",
|
|
|
|
FT_BOOLEAN, 8, NULL, 0x20,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_status_select,
|
|
|
|
{ "Select", "bthcrp.status.select",
|
|
|
|
FT_BOOLEAN, 8, NULL, 0x10,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_status_not_error,
|
|
|
|
{ "Not Error", "bthcrp.status.not_error",
|
|
|
|
FT_BOOLEAN, 8, NULL, 0x08,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_control_status_reserved_20,
|
|
|
|
{ "Reserved", "bthcrp.status.reserved210",
|
|
|
|
FT_UINT8, BASE_HEX, NULL, 0x07,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_bthcrp_data,
|
|
|
|
{ "Data", "bthcrp.data",
|
|
|
|
FT_NONE, BASE_NONE, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
|
|
|
static gint *ett[] = {
|
|
|
|
&ett_bthcrp
|
|
|
|
};
|
|
|
|
|
2013-07-09 01:18:52 +00:00
|
|
|
static ei_register_info ei[] = {
|
|
|
|
{ &ei_bthcrp_control_parameter_length, { "bthcrp.control_parameter_length.bad", PI_PROTOCOL, PI_WARN, "Length bad", EXPFILL }},
|
|
|
|
{ &ei_bthcrp_unexpected_data, { "bthcrp.unexpected_data", PI_PROTOCOL, PI_WARN, "Unexpected data", EXPFILL }},
|
|
|
|
};
|
|
|
|
|
2013-03-18 06:23:22 +00:00
|
|
|
proto_bthcrp = proto_register_protocol("Bluetooth HCRP Profile", "BT HCRP", "bthcrp");
|
2015-12-09 04:04:01 +00:00
|
|
|
bthcrp_handle = register_dissector("bthcrp", dissect_bthcrp, proto_bthcrp);
|
2013-02-25 17:55:32 +00:00
|
|
|
|
|
|
|
proto_register_field_array(proto_bthcrp, hf, array_length(hf));
|
|
|
|
proto_register_subtree_array(ett, array_length(ett));
|
2013-07-09 01:18:52 +00:00
|
|
|
expert_bthcrp = expert_register_protocol(proto_bthcrp);
|
|
|
|
expert_register_field_array(expert_bthcrp, ei, array_length(ei));
|
2013-02-25 17:55:32 +00:00
|
|
|
|
|
|
|
module = prefs_register_protocol(proto_bthcrp, NULL);
|
|
|
|
prefs_register_static_text_preference(module, "hcrp.version",
|
|
|
|
"Bluetooth Profile HCRP version: 1.2",
|
|
|
|
"Version of profile supported by this dissector.");
|
|
|
|
|
2013-12-07 01:01:31 +00:00
|
|
|
prefs_register_obsolete_preference(module, "hcrp.is_client");
|
|
|
|
|
|
|
|
prefs_register_enum_preference(module, "hcrp.force_client", "Force Client",
|
|
|
|
"If \"yes\" localhost will be treat as Client, \"no\" as Server",
|
|
|
|
&force_client, force_client_enum, FALSE);
|
|
|
|
|
2013-02-25 17:55:32 +00:00
|
|
|
prefs_register_uint_preference(module, "hcrp.control.psm", "L2CAP PSM for Control",
|
|
|
|
"L2CAP PSM for Control",
|
|
|
|
10, &psm_control);
|
|
|
|
prefs_register_uint_preference(module, "hcrp.data.psm", "L2CAP PSM for Data",
|
|
|
|
"L2CAP PSM for Data",
|
|
|
|
10, &psm_data_stream);
|
|
|
|
prefs_register_uint_preference(module, "hcrp.notification.psm", "L2CAP PSM for Notification",
|
|
|
|
"L2CAP PSM for Notification",
|
|
|
|
10, &psm_notification);
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
proto_reg_handoff_bthcrp(void)
|
|
|
|
{
|
|
|
|
data_handle = find_dissector("data");
|
|
|
|
|
2015-07-13 17:01:48 +00:00
|
|
|
dissector_add_string("bluetooth.uuid", "12", bthcrp_handle);
|
|
|
|
dissector_add_string("bluetooth.uuid", "14", bthcrp_handle);
|
|
|
|
dissector_add_string("bluetooth.uuid", "16", bthcrp_handle);
|
|
|
|
dissector_add_string("bluetooth.uuid", "1125", bthcrp_handle);
|
|
|
|
dissector_add_string("bluetooth.uuid", "1126", bthcrp_handle);
|
|
|
|
dissector_add_string("bluetooth.uuid", "1127", bthcrp_handle);
|
2013-02-25 17:55:32 +00:00
|
|
|
|
2014-06-20 16:43:28 +00:00
|
|
|
dissector_add_for_decode_as("btl2cap.psm", bthcrp_handle);
|
|
|
|
dissector_add_for_decode_as("btl2cap.cid", bthcrp_handle);
|
2013-02-25 17:55:32 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Editor modelines - http://www.wireshark.org/tools/modelines.html
|
|
|
|
*
|
|
|
|
* Local variables:
|
|
|
|
* c-basic-offset: 4
|
|
|
|
* tab-width: 8
|
|
|
|
* indent-tabs-mode: nil
|
|
|
|
* End:
|
|
|
|
*
|
|
|
|
* vi: set shiftwidth=4 tabstop=8 expandtab:
|
|
|
|
* :indentSize=4:tabSize=8:noTabs=true:
|
|
|
|
*/
|