14cc286f3SDominic Spill /* packet-btbredr.c
24cc286f3SDominic Spill * Routines for Bluetooth baseband dissection
34cc286f3SDominic Spill * Copyright 2014, Dominic Spill <[email protected]>
44cc286f3SDominic Spill * Copyright 2009, Michael Ossmann <[email protected]>
54cc286f3SDominic Spill *
64cc286f3SDominic Spill * Wireshark - Network traffic analyzer
74cc286f3SDominic Spill * By Gerald Combs <[email protected]>
84cc286f3SDominic Spill * Copyright 1998 Gerald Combs
94cc286f3SDominic Spill *
104cc286f3SDominic Spill * This program is free software; you can redistribute it and/or
114cc286f3SDominic Spill * modify it under the terms of the GNU General Public License
124cc286f3SDominic Spill * as published by the Free Software Foundation; either version 2
134cc286f3SDominic Spill * of the License, or (at your option) any later version.
144cc286f3SDominic Spill *
154cc286f3SDominic Spill * This program is distributed in the hope that it will be useful,
164cc286f3SDominic Spill * but WITHOUT ANY WARRANTY; without even the implied warranty of
174cc286f3SDominic Spill * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
184cc286f3SDominic Spill * GNU General Public License for more details.
194cc286f3SDominic Spill *
204cc286f3SDominic Spill * You should have received a copy of the GNU General Public License
214cc286f3SDominic Spill * along with this program; if not, write to the Free Software
224cc286f3SDominic Spill * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
234cc286f3SDominic Spill */
244cc286f3SDominic Spill
254cc286f3SDominic Spill #ifdef HAVE_CONFIG_H
264cc286f3SDominic Spill #include "config.h"
274cc286f3SDominic Spill #else
284cc286f3SDominic Spill #include <wireshark/config.h>
294cc286f3SDominic Spill #endif
304cc286f3SDominic Spill
314cc286f3SDominic Spill #include <epan/packet.h>
324cc286f3SDominic Spill #include <epan/prefs.h>
334cc286f3SDominic Spill
344cc286f3SDominic Spill #include <stdio.h>
354cc286f3SDominic Spill
364cc286f3SDominic Spill /* function prototypes */
374cc286f3SDominic Spill void proto_reg_handoff_btbredr(void);
384cc286f3SDominic Spill
394cc286f3SDominic Spill /* initialize the protocol and registered fields */
404cc286f3SDominic Spill static int proto_btbredr = -1;
414cc286f3SDominic Spill static int hf_btbredr_meta = -1;
424cc286f3SDominic Spill static int hf_btbredr_channel = -1;
434cc286f3SDominic Spill static int hf_btbredr_signal = -1;
444cc286f3SDominic Spill static int hf_btbredr_noise = -1;
454cc286f3SDominic Spill static int hf_btbredr_ac_offenses = -1;
464cc286f3SDominic Spill static int hf_btbredr_mod = -1;
474cc286f3SDominic Spill static int hf_btbredr_transport = -1;
484cc286f3SDominic Spill static int hf_btbredr_corrected_header = -1;
494cc286f3SDominic Spill static int hf_btbredr_corrected_payload = -1;
504cc286f3SDominic Spill static int hf_btbredr_lap = -1;
514cc286f3SDominic Spill static int hf_btbredr_ref_lap = -1;
524cc286f3SDominic Spill static int hf_btbredr_ref_uap = -1;
534cc286f3SDominic Spill static int hf_btbredr_pkthdr = -1;
544cc286f3SDominic Spill static int hf_btbredr_ltaddr = -1;
554cc286f3SDominic Spill static int hf_btbredr_type = -1;
564cc286f3SDominic Spill static int hf_btbredr_flags = -1;
574cc286f3SDominic Spill static int hf_btbredr_flow = -1;
584cc286f3SDominic Spill static int hf_btbredr_arqn = -1;
594cc286f3SDominic Spill static int hf_btbredr_seqn = -1;
604cc286f3SDominic Spill static int hf_btbredr_hec = -1;
614cc286f3SDominic Spill static int hf_btbredr_payload = -1;
624cc286f3SDominic Spill static int hf_btbredr_pldhdr = -1;
634cc286f3SDominic Spill static int hf_btbredr_llid = -1;
644cc286f3SDominic Spill static int hf_btbredr_pldflow = -1;
654cc286f3SDominic Spill static int hf_btbredr_length = -1;
664cc286f3SDominic Spill static int hf_btbredr_pldbody = -1;
674cc286f3SDominic Spill static int hf_btbredr_crc = -1;
684cc286f3SDominic Spill static int hf_btbredr_fhs_parity = -1;
694cc286f3SDominic Spill static int hf_btbredr_fhs_lap = -1;
704cc286f3SDominic Spill static int hf_btbredr_fhs_eir = -1;
714cc286f3SDominic Spill static int hf_btbredr_fhs_sr = -1;
724cc286f3SDominic Spill static int hf_btbredr_fhs_uap = -1;
734cc286f3SDominic Spill static int hf_btbredr_fhs_nap = -1;
744cc286f3SDominic Spill static int hf_btbredr_fhs_class = -1;
754cc286f3SDominic Spill static int hf_btbredr_fhs_ltaddr = -1;
764cc286f3SDominic Spill static int hf_btbredr_fhs_clk = -1;
774cc286f3SDominic Spill static int hf_btbredr_fhs_psmode = -1;
784cc286f3SDominic Spill
794cc286f3SDominic Spill /* field values */
804cc286f3SDominic Spill static const true_false_string direction = {
814cc286f3SDominic Spill "Slave to Master",
824cc286f3SDominic Spill "Master to Slave"
834cc286f3SDominic Spill };
844cc286f3SDominic Spill
854cc286f3SDominic Spill static const true_false_string clock_bits = {
864cc286f3SDominic Spill "27",
874cc286f3SDominic Spill "6"
884cc286f3SDominic Spill };
894cc286f3SDominic Spill
904cc286f3SDominic Spill static const true_false_string valid_flags = {
914cc286f3SDominic Spill "Invalid",
924cc286f3SDominic Spill "Valid"
934cc286f3SDominic Spill };
944cc286f3SDominic Spill
954cc286f3SDominic Spill static const value_string modulation[] = {
964cc286f3SDominic Spill { 0x0, "Basic Rate (GFSK)" },
974cc286f3SDominic Spill { 0x1, "Enhanced Data Rate (PI/2-DQPSK)" },
984cc286f3SDominic Spill { 0x2, "Enhanced Data Rate (8DPSK)" }
994cc286f3SDominic Spill };
1004cc286f3SDominic Spill
1014cc286f3SDominic Spill static const value_string transports[] = {
1024cc286f3SDominic Spill { 0x0, "unknown" },
1034cc286f3SDominic Spill { 0x1, "SCO" },
1044cc286f3SDominic Spill { 0x2, "eSCO" },
1054cc286f3SDominic Spill { 0x3, "ACL" },
1064cc286f3SDominic Spill { 0x4, "CSB" }
1074cc286f3SDominic Spill };
1084cc286f3SDominic Spill
1094cc286f3SDominic Spill static const value_string packet_types[] = {
1104cc286f3SDominic Spill /* generic names for unknown logical transport */
1114cc286f3SDominic Spill { 0x0, "NULL" },
1124cc286f3SDominic Spill { 0x1, "POLL" },
1134cc286f3SDominic Spill { 0x2, "FHS" },
1144cc286f3SDominic Spill { 0x3, "DM1" },
1154cc286f3SDominic Spill { 0x4, "DH1/2-DH1" },
1164cc286f3SDominic Spill { 0x5, "HV1" },
1174cc286f3SDominic Spill { 0x6, "HV2/2-EV3" },
1184cc286f3SDominic Spill { 0x7, "HV3/EV3/3-EV3" },
1194cc286f3SDominic Spill { 0x8, "DV/3-DH1" },
1204cc286f3SDominic Spill { 0x9, "AUX1" },
1214cc286f3SDominic Spill { 0xa, "DM3/2-DH3" },
1224cc286f3SDominic Spill { 0xb, "DH3/3-DH3" },
1234cc286f3SDominic Spill { 0xc, "EV4/2-EV5" },
1244cc286f3SDominic Spill { 0xd, "EV5/3-EV5" },
1254cc286f3SDominic Spill { 0xe, "DM5/2-DH5" },
1264cc286f3SDominic Spill { 0xf, "DH5/3-DH5" },
1274cc286f3SDominic Spill { 0, NULL }
1284cc286f3SDominic Spill };
1294cc286f3SDominic Spill
1304cc286f3SDominic Spill static const value_string sr_modes[] = {
1314cc286f3SDominic Spill { 0x0, "R0" },
1324cc286f3SDominic Spill { 0x1, "R1" },
1334cc286f3SDominic Spill { 0x2, "R2" },
1344cc286f3SDominic Spill { 0x3, "Reserved" },
1354cc286f3SDominic Spill { 0, NULL }
1364cc286f3SDominic Spill };
1374cc286f3SDominic Spill
1384cc286f3SDominic Spill static const range_string ps_modes[] = {
1394cc286f3SDominic Spill { 0x0, 0x0, "Mandatory scan mode" },
1404cc286f3SDominic Spill { 0x1, 0x7, "Reserved" },
1414cc286f3SDominic Spill { 0, 0, NULL }
1424cc286f3SDominic Spill };
1434cc286f3SDominic Spill
1444cc286f3SDominic Spill static const value_string llid_codes[] = {
1454cc286f3SDominic Spill { 0x0, "undefined" },
1464cc286f3SDominic Spill { 0x1, "Continuation fragment of an L2CAP message (ACL-U)" },
1474cc286f3SDominic Spill { 0x2, "Start of an L2CAP message or no fragmentation (ACL-U)" },
1484cc286f3SDominic Spill { 0x3, "LMP message (ACL-C)" },
1494cc286f3SDominic Spill { 0, NULL }
1504cc286f3SDominic Spill };
1514cc286f3SDominic Spill
1524cc286f3SDominic Spill /* initialize the subtree pointers */
1534cc286f3SDominic Spill static gint ett_btbredr = -1;
1544cc286f3SDominic Spill static gint ett_btbredr_meta = -1;
1554cc286f3SDominic Spill static gint ett_btbredr_pkthdr = -1;
1564cc286f3SDominic Spill static gint ett_btbredr_flags = -1;
1574cc286f3SDominic Spill static gint ett_btbredr_payload = -1;
1584cc286f3SDominic Spill static gint ett_btbredr_pldhdr = -1;
1594cc286f3SDominic Spill
1604cc286f3SDominic Spill /* subdissectors */
1614cc286f3SDominic Spill static dissector_handle_t btlmp_handle = NULL;
1624cc286f3SDominic Spill static dissector_handle_t btl2cap_handle = NULL;
1634cc286f3SDominic Spill
1644cc286f3SDominic Spill /* packet header flags */
1654cc286f3SDominic Spill static const int *flag_fields[] = {
1664cc286f3SDominic Spill &hf_btbredr_flow,
1674cc286f3SDominic Spill &hf_btbredr_arqn,
1684cc286f3SDominic Spill &hf_btbredr_seqn,
1694cc286f3SDominic Spill NULL
1704cc286f3SDominic Spill };
1714cc286f3SDominic Spill
1724cc286f3SDominic Spill /* one byte payload header */
1734cc286f3SDominic Spill int
dissect_payload_header1(proto_tree * tree,tvbuff_t * tvb,int offset)1744cc286f3SDominic Spill dissect_payload_header1(proto_tree *tree, tvbuff_t *tvb, int offset)
1754cc286f3SDominic Spill {
1764cc286f3SDominic Spill proto_item *hdr_item;
1774cc286f3SDominic Spill proto_tree *hdr_tree;
1784cc286f3SDominic Spill
1794cc286f3SDominic Spill DISSECTOR_ASSERT(tvb_reported_length_remaining(tvb, offset) >= 1);
1804cc286f3SDominic Spill
1814cc286f3SDominic Spill hdr_item = proto_tree_add_item(tree, hf_btbredr_pldhdr, tvb, offset, 1, ENC_NA);
1824cc286f3SDominic Spill hdr_tree = proto_item_add_subtree(hdr_item, ett_btbredr_pldhdr);
1834cc286f3SDominic Spill
1844cc286f3SDominic Spill proto_tree_add_item(hdr_tree, hf_btbredr_llid, tvb, offset, 1, ENC_NA);
1854cc286f3SDominic Spill proto_tree_add_item(hdr_tree, hf_btbredr_pldflow, tvb, offset, 1, ENC_NA);
1864cc286f3SDominic Spill proto_tree_add_item(hdr_tree, hf_btbredr_length, tvb, offset, 1, ENC_NA);
1874cc286f3SDominic Spill
1884cc286f3SDominic Spill /* payload length */
1894cc286f3SDominic Spill return tvb_get_guint8(tvb, offset) >> 3;
1904cc286f3SDominic Spill }
1914cc286f3SDominic Spill
1924cc286f3SDominic Spill void
dissect_fhs(proto_tree * tree,tvbuff_t * tvb,packet_info * pinfo,int offset)1934cc286f3SDominic Spill dissect_fhs(proto_tree *tree, tvbuff_t *tvb, packet_info *pinfo, int offset)
1944cc286f3SDominic Spill {
1954cc286f3SDominic Spill proto_item *fhs_item, *psmode_item;
1964cc286f3SDominic Spill proto_tree *fhs_tree;
1974cc286f3SDominic Spill const gchar *description;
1984cc286f3SDominic Spill guint8 psmode;
1994cc286f3SDominic Spill
2004cc286f3SDominic Spill if(tvb_reported_length_remaining(tvb, offset) != 20) {
2014cc286f3SDominic Spill col_add_str(pinfo->cinfo, COL_INFO, "Encrypted or malformed payload data");
2024cc286f3SDominic Spill return;
2034cc286f3SDominic Spill }
2044cc286f3SDominic Spill
2054cc286f3SDominic Spill fhs_item = proto_tree_add_item(tree, hf_btbredr_payload, tvb, offset, -1, ENC_NA);
2064cc286f3SDominic Spill fhs_tree = proto_item_add_subtree(fhs_item, ett_btbredr_payload);
2074cc286f3SDominic Spill
2084cc286f3SDominic Spill /* Use proto_tree_add_bits_item() to get around 32bit limit on bitmasks */
2094cc286f3SDominic Spill proto_tree_add_bits_item(fhs_tree, hf_btbredr_fhs_parity, tvb, offset*8, 34, ENC_LITTLE_ENDIAN);
2104cc286f3SDominic Spill /* proto_tree_add_item(fhs_tree, hf_btbredr_fhs_parity, tvb, offset, 5, ENC_LITTLE_ENDIAN); */
2114cc286f3SDominic Spill offset += 4;
2124cc286f3SDominic Spill
2134cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_fhs_lap, tvb, offset, 4, ENC_LITTLE_ENDIAN);
2144cc286f3SDominic Spill offset += 3;
2154cc286f3SDominic Spill
2164cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_fhs_eir, tvb, offset, 1, ENC_NA);
2174cc286f3SDominic Spill /* skipping 1 undefined bit */
2184cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_fhs_sr, tvb, offset, 1, ENC_NA);
2194cc286f3SDominic Spill /* skipping 2 reserved bits */
2204cc286f3SDominic Spill offset += 1;
2214cc286f3SDominic Spill
2224cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_fhs_uap, tvb, offset, 1, ENC_NA);
2234cc286f3SDominic Spill offset += 1;
2244cc286f3SDominic Spill
2254cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_fhs_nap, tvb, offset, 2, ENC_LITTLE_ENDIAN);
2264cc286f3SDominic Spill offset += 2;
2274cc286f3SDominic Spill
2284cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_fhs_class, tvb, offset, 3, ENC_LITTLE_ENDIAN);
2294cc286f3SDominic Spill offset += 3;
2304cc286f3SDominic Spill
2314cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_fhs_ltaddr, tvb, offset, 1, ENC_NA);
2324cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_fhs_clk, tvb, offset, 4, ENC_LITTLE_ENDIAN);
2334cc286f3SDominic Spill offset += 3;
2344cc286f3SDominic Spill
2354cc286f3SDominic Spill psmode = tvb_get_guint8(tvb, offset);
2364cc286f3SDominic Spill description = try_rval_to_str(psmode, ps_modes);
2374cc286f3SDominic Spill psmode_item = proto_tree_add_item(fhs_tree, hf_btbredr_fhs_psmode, tvb, offset, 1, ENC_NA);
2384cc286f3SDominic Spill if (description)
2394cc286f3SDominic Spill proto_item_append_text(psmode_item, " (%s)", description);
2404cc286f3SDominic Spill offset += 1;
2414cc286f3SDominic Spill
2424cc286f3SDominic Spill proto_tree_add_item(fhs_tree, hf_btbredr_crc, tvb, offset, 2, ENC_LITTLE_ENDIAN);
2434cc286f3SDominic Spill offset += 2;
2444cc286f3SDominic Spill }
2454cc286f3SDominic Spill
2464cc286f3SDominic Spill void
dissect_dm1(proto_tree * tree,tvbuff_t * tvb,packet_info * pinfo,int offset)2474cc286f3SDominic Spill dissect_dm1(proto_tree *tree, tvbuff_t *tvb, packet_info *pinfo, int offset)
2484cc286f3SDominic Spill {
2494cc286f3SDominic Spill int len; /* payload length indicated by payload header */
2504cc286f3SDominic Spill int llid; /* logical link id */
2514cc286f3SDominic Spill int l2len; /* length indicated by l2cap header */
2524cc286f3SDominic Spill proto_item *dm1_item;
2534cc286f3SDominic Spill proto_tree *dm1_tree;
2544cc286f3SDominic Spill tvbuff_t *pld_tvb;
2554cc286f3SDominic Spill
2564cc286f3SDominic Spill /*
2574cc286f3SDominic Spill * FIXME
2584cc286f3SDominic Spill * I'm probably doing a terrible, terrible thing here, but it gets my
2594cc286f3SDominic Spill * initial test cases working.
2604cc286f3SDominic Spill */
2614cc286f3SDominic Spill guint16 fake_acl_data;
2624cc286f3SDominic Spill
2634cc286f3SDominic Spill if(tvb_reported_length_remaining(tvb, offset) < 3) {
2644cc286f3SDominic Spill col_add_str(pinfo->cinfo, COL_INFO, "Encrypted or malformed payload data");
2654cc286f3SDominic Spill return;
2664cc286f3SDominic Spill }
2674cc286f3SDominic Spill
2684cc286f3SDominic Spill dm1_item = proto_tree_add_item(tree, hf_btbredr_payload, tvb, offset, -1, ENC_NA);
2694cc286f3SDominic Spill dm1_tree = proto_item_add_subtree(dm1_item, ett_btbredr_payload);
2704cc286f3SDominic Spill
2714cc286f3SDominic Spill len = dissect_payload_header1(dm1_tree, tvb, offset);
2724cc286f3SDominic Spill llid = tvb_get_guint8(tvb, offset) & 0x3;
2734cc286f3SDominic Spill offset += 1;
2744cc286f3SDominic Spill
2754cc286f3SDominic Spill if(tvb_reported_length_remaining(tvb, offset) < len + 2) {
2764cc286f3SDominic Spill col_add_str(pinfo->cinfo, COL_INFO, "Encrypted or malformed payload data");
2774cc286f3SDominic Spill return;
2784cc286f3SDominic Spill }
2794cc286f3SDominic Spill
2804cc286f3SDominic Spill if (llid == 3 && btlmp_handle) {
2814cc286f3SDominic Spill /* LMP */
2824cc286f3SDominic Spill pld_tvb = tvb_new_subset(tvb, offset, len, len);
2834cc286f3SDominic Spill call_dissector(btlmp_handle, pld_tvb, pinfo, dm1_tree);
2844cc286f3SDominic Spill } else if (llid == 2 && btl2cap_handle) {
2854cc286f3SDominic Spill /* unfragmented L2CAP or start of fragment */
2864cc286f3SDominic Spill l2len = tvb_get_letohs(tvb, offset);
2874cc286f3SDominic Spill if (l2len + 4 == len) {
2884cc286f3SDominic Spill /* unfragmented */
2894cc286f3SDominic Spill pld_tvb = tvb_new_subset(tvb, offset, len, len);
2904cc286f3SDominic Spill call_dissector_with_data(btl2cap_handle, pld_tvb, pinfo, dm1_tree, &fake_acl_data);
2914cc286f3SDominic Spill } else {
2924cc286f3SDominic Spill /* start of fragment */
2934cc286f3SDominic Spill proto_tree_add_item(dm1_tree, hf_btbredr_pldbody, tvb, offset, len, ENC_NA);
2944cc286f3SDominic Spill }
2954cc286f3SDominic Spill } else {
2964cc286f3SDominic Spill proto_tree_add_item(dm1_tree, hf_btbredr_pldbody, tvb, offset, len, ENC_NA);
2974cc286f3SDominic Spill }
2984cc286f3SDominic Spill offset += len;
2994cc286f3SDominic Spill
3004cc286f3SDominic Spill proto_tree_add_item(dm1_tree, hf_btbredr_crc, tvb, offset, 2, ENC_LITTLE_ENDIAN);
3014cc286f3SDominic Spill offset += 2;
3024cc286f3SDominic Spill }
3034cc286f3SDominic Spill
3044cc286f3SDominic Spill /* dissect a packet */
3054cc286f3SDominic Spill static int
dissect_btbredr(tvbuff_t * tvb,packet_info * pinfo,proto_tree * tree,void * data _U_)3064cc286f3SDominic Spill dissect_btbredr(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_)
3074cc286f3SDominic Spill {
3084cc286f3SDominic Spill proto_item *btbredr_item, *meta_item, *pkthdr_item;
3094cc286f3SDominic Spill proto_tree *btbredr_tree, *meta_tree, *pkthdr_tree;
3104cc286f3SDominic Spill int offset;
3114cc286f3SDominic Spill /* Avoid error: 'type' may be used uninitialized in this function */
3124cc286f3SDominic Spill guint8 type = 0xff;
3134cc286f3SDominic Spill const gchar *info;
3144cc286f3SDominic Spill
3154cc286f3SDominic Spill /* sanity check: length */
3164cc286f3SDominic Spill if (tvb_reported_length(tvb) > 0 && tvb_reported_length(tvb) < 9)
3174cc286f3SDominic Spill /* bad length: look for a different dissector */
3184cc286f3SDominic Spill return 0;
3194cc286f3SDominic Spill
3204cc286f3SDominic Spill /* maybe should verify HEC */
3214cc286f3SDominic Spill
3224cc286f3SDominic Spill /* make entries in protocol column and info column on summary display */
3234cc286f3SDominic Spill col_set_str(pinfo->cinfo, COL_PROTOCOL, "Bluetooth");
3244cc286f3SDominic Spill
3254cc286f3SDominic Spill if (tvb_reported_length(tvb) == 0) {
3264cc286f3SDominic Spill info = "ID";
3274cc286f3SDominic Spill } else {
3284cc286f3SDominic Spill type = (tvb_get_guint8(tvb, 16) >> 3) & 0x0f;
3294cc286f3SDominic Spill info = val_to_str(type, packet_types, "Unknown type: 0x%x");
3304cc286f3SDominic Spill }
3314cc286f3SDominic Spill
3324cc286f3SDominic Spill col_clear(pinfo->cinfo, COL_INFO);
3334cc286f3SDominic Spill col_add_str(pinfo->cinfo, COL_INFO, info);
3344cc286f3SDominic Spill
3354cc286f3SDominic Spill /* see if we are being asked for details */
3364cc286f3SDominic Spill if (tree) {
3374cc286f3SDominic Spill
3384cc286f3SDominic Spill /* create display subtree for the protocol */
3394cc286f3SDominic Spill offset = 0;
3404cc286f3SDominic Spill btbredr_item = proto_tree_add_item(tree, proto_btbredr, tvb, offset, -1, ENC_NA);
3414cc286f3SDominic Spill btbredr_tree = proto_item_add_subtree(btbredr_item, ett_btbredr);
3424cc286f3SDominic Spill
3434cc286f3SDominic Spill /* ID packets have no header, no payload */
3444cc286f3SDominic Spill if (tvb_reported_length(tvb) == 0)
3454cc286f3SDominic Spill return 1;
3464cc286f3SDominic Spill
3474cc286f3SDominic Spill /* meta data */
3484cc286f3SDominic Spill meta_item = proto_tree_add_item(btbredr_tree, hf_btbredr_meta, tvb, offset, 3, ENC_NA);
3494cc286f3SDominic Spill meta_tree = proto_item_add_subtree(meta_item, ett_btbredr_meta);
3504cc286f3SDominic Spill
3514cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_channel, tvb, offset, 1, ENC_NA);
3524cc286f3SDominic Spill offset += 1;
3534cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_signal, tvb, offset, 1, ENC_NA);
3544cc286f3SDominic Spill offset += 1;
3554cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_noise, tvb, offset, 1, ENC_NA);
3564cc286f3SDominic Spill offset += 1;
3574cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_ac_offenses, tvb, offset, 1, ENC_NA);
3584cc286f3SDominic Spill offset += 1;
3594cc286f3SDominic Spill
3604cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_mod, tvb, offset, 1, ENC_NA);
3614cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_transport, tvb, offset, 1, ENC_NA);
3624cc286f3SDominic Spill offset += 1;
3634cc286f3SDominic Spill
3644cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_corrected_header, tvb, offset, 1, ENC_NA);
3654cc286f3SDominic Spill offset += 1;
3664cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_corrected_payload, tvb, offset, 2, ENC_LITTLE_ENDIAN);
3674cc286f3SDominic Spill offset += 2;
3684cc286f3SDominic Spill
3694cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_lap, tvb, offset, 4, ENC_LITTLE_ENDIAN);
3704cc286f3SDominic Spill offset += 4;
3714cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_ref_lap, tvb, offset, 3, ENC_LITTLE_ENDIAN);
3724cc286f3SDominic Spill offset += 3;
3734cc286f3SDominic Spill proto_tree_add_item(meta_tree, hf_btbredr_ref_uap, tvb, offset, 1, ENC_NA);
3744cc286f3SDominic Spill offset += 1;
3754cc286f3SDominic Spill
3764cc286f3SDominic Spill
3774cc286f3SDominic Spill /* packet header */
3784cc286f3SDominic Spill pkthdr_item = proto_tree_add_item(btbredr_tree, hf_btbredr_pkthdr, tvb, offset, 3, ENC_NA);
3794cc286f3SDominic Spill pkthdr_tree = proto_item_add_subtree(pkthdr_item, ett_btbredr_pkthdr);
3804cc286f3SDominic Spill
3814cc286f3SDominic Spill proto_tree_add_item(pkthdr_tree, hf_btbredr_ltaddr, tvb, offset, 1, ENC_NA);
3824cc286f3SDominic Spill proto_tree_add_item(pkthdr_tree, hf_btbredr_type, tvb, offset, 1, ENC_NA);
3834cc286f3SDominic Spill offset += 1;
3844cc286f3SDominic Spill proto_tree_add_bitmask(pkthdr_tree, tvb, offset, hf_btbredr_flags,
3854cc286f3SDominic Spill ett_btbredr_flags, flag_fields, ENC_NA);
3864cc286f3SDominic Spill offset += 1;
3874cc286f3SDominic Spill proto_tree_add_item(pkthdr_tree, hf_btbredr_hec, tvb, offset, 1, ENC_NA);
3884cc286f3SDominic Spill offset += 2;
3894cc286f3SDominic Spill
3904cc286f3SDominic Spill /* payload */
3914cc286f3SDominic Spill switch (type) {
3924cc286f3SDominic Spill case 0x0: /* NULL */
3934cc286f3SDominic Spill case 0x1: /* POLL */
3944cc286f3SDominic Spill break;
3954cc286f3SDominic Spill case 0x2: /* FHS */
3964cc286f3SDominic Spill dissect_fhs(btbredr_tree, tvb, pinfo, offset);
3974cc286f3SDominic Spill break;
3984cc286f3SDominic Spill case 0x3: /* DM1 */
3994cc286f3SDominic Spill dissect_dm1(btbredr_tree, tvb, pinfo, offset);
4004cc286f3SDominic Spill break;
4014cc286f3SDominic Spill case 0x4: /* DH1/2-DH1 */
4024cc286f3SDominic Spill dissect_dm1(btbredr_tree, tvb, pinfo, offset);
4034cc286f3SDominic Spill break;
4044cc286f3SDominic Spill case 0x5: /* HV1 */
4054cc286f3SDominic Spill case 0x6: /* HV2/2-EV3 */
4064cc286f3SDominic Spill case 0x7: /* HV3/EV3/3-EV3 */
4074cc286f3SDominic Spill case 0x8: /* DV/3-DH1 */
4084cc286f3SDominic Spill case 0x9: /* AUX1 */
4094cc286f3SDominic Spill case 0xa: /* DM3/2-DH3 */
4104cc286f3SDominic Spill case 0xb: /* DH3/3-DH3 */
4114cc286f3SDominic Spill case 0xc: /* EV4/2-EV5 */
4124cc286f3SDominic Spill case 0xd: /* EV5/3-EV5 */
4134cc286f3SDominic Spill case 0xe: /* DM5/2-DH5 */
4144cc286f3SDominic Spill case 0xf: /* DH5/3-DH5 */
4154cc286f3SDominic Spill proto_tree_add_item(btbredr_tree, hf_btbredr_payload, tvb, offset, -1, ENC_NA);
4164cc286f3SDominic Spill break;
4174cc286f3SDominic Spill default:
4184cc286f3SDominic Spill break;
4194cc286f3SDominic Spill }
4204cc286f3SDominic Spill }
4214cc286f3SDominic Spill
4224cc286f3SDominic Spill /* Return the amount of data this dissector was able to dissect */
4234cc286f3SDominic Spill return tvb_reported_length(tvb);
4244cc286f3SDominic Spill }
4254cc286f3SDominic Spill
4264cc286f3SDominic Spill /* register the protocol with Wireshark */
4274cc286f3SDominic Spill void
proto_register_btbredr(void)4284cc286f3SDominic Spill proto_register_btbredr(void)
4294cc286f3SDominic Spill {
4304cc286f3SDominic Spill /* list of fields */
4314cc286f3SDominic Spill static hf_register_info hf[] = {
4324cc286f3SDominic Spill { &hf_btbredr_meta,
4334cc286f3SDominic Spill { "Meta Data", "btbredr.meta",
4344cc286f3SDominic Spill FT_NONE, BASE_NONE, NULL, 0x0,
4354cc286f3SDominic Spill "Meta Data About the Packet", HFILL }
4364cc286f3SDominic Spill },
4374cc286f3SDominic Spill { &hf_btbredr_channel,
4384cc286f3SDominic Spill { "Channel", "btbredr.channel",
4394cc286f3SDominic Spill FT_UINT8, BASE_DEC, NULL, 0x0,
4404cc286f3SDominic Spill "Channel (0-78)", HFILL }
4414cc286f3SDominic Spill },
4424cc286f3SDominic Spill { &hf_btbredr_signal,
4434cc286f3SDominic Spill { "Signal", "btbredr.signal",
444*419ade37SDominic Spill FT_INT8, BASE_DEC, NULL, 0x0,
4454cc286f3SDominic Spill "Signal Power", HFILL }
4464cc286f3SDominic Spill },
4474cc286f3SDominic Spill { &hf_btbredr_noise,
4484cc286f3SDominic Spill { "Noise", "btbredr.noise",
449*419ade37SDominic Spill FT_INT8, BASE_DEC, NULL, 0x0,
4504cc286f3SDominic Spill "Noise Power", HFILL }
4514cc286f3SDominic Spill },
4524cc286f3SDominic Spill { &hf_btbredr_ac_offenses,
4534cc286f3SDominic Spill { "AC Offenses", "btbredr.ac_offenses",
4544cc286f3SDominic Spill FT_UINT8, BASE_DEC, NULL, 0x0,
4554cc286f3SDominic Spill "Access Code Offenses", HFILL }
4564cc286f3SDominic Spill },
4574cc286f3SDominic Spill { &hf_btbredr_mod,
4584cc286f3SDominic Spill { "Transport Rate", "btbredr.mod",
4594cc286f3SDominic Spill FT_UINT8, BASE_HEX, VALS(&modulation), 0x02,
4604cc286f3SDominic Spill "Transport Data Rate", HFILL }
4614cc286f3SDominic Spill },
4624cc286f3SDominic Spill { &hf_btbredr_transport,
4634cc286f3SDominic Spill { "Transport", "btbredr.transport",
4644cc286f3SDominic Spill FT_UINT8, BASE_HEX, VALS(&transports), 0x70,
4654cc286f3SDominic Spill "Logical Transport", HFILL }
4664cc286f3SDominic Spill },
4674cc286f3SDominic Spill { &hf_btbredr_corrected_header,
4684cc286f3SDominic Spill { "Corrected Header", "btbredr.corrected_header",
4694cc286f3SDominic Spill FT_UINT8, BASE_DEC, NULL, 0x0,
4704cc286f3SDominic Spill "Corrected Header Bits", HFILL }
4714cc286f3SDominic Spill },
4724cc286f3SDominic Spill { &hf_btbredr_corrected_payload,
4734cc286f3SDominic Spill { "Corrected Payload", "btbredr.corrected_payload",
4744cc286f3SDominic Spill FT_UINT16, BASE_DEC, NULL, 0x0,
4754cc286f3SDominic Spill "Corrected Payload Bits", HFILL }
4764cc286f3SDominic Spill },
4774cc286f3SDominic Spill { &hf_btbredr_lap,
4784cc286f3SDominic Spill { "LAP", "btbredr.lap",
4794cc286f3SDominic Spill FT_UINT32, BASE_HEX, NULL, 0x0,
4804cc286f3SDominic Spill "Lower Address Part", HFILL }
4814cc286f3SDominic Spill },
4824cc286f3SDominic Spill { &hf_btbredr_ref_lap,
4834cc286f3SDominic Spill { "Ref. LAP", "btbredr.ref_lap",
4844cc286f3SDominic Spill FT_UINT32, BASE_HEX, NULL, 0x0,
4854cc286f3SDominic Spill "Reference LAP", HFILL }
4864cc286f3SDominic Spill },
4874cc286f3SDominic Spill { &hf_btbredr_ref_uap,
4884cc286f3SDominic Spill { "Ref. UAP", "btbredr.ref_uap",
4894cc286f3SDominic Spill FT_UINT8, BASE_HEX, NULL, 0x0,
4904cc286f3SDominic Spill "Reference UAP", HFILL }
4914cc286f3SDominic Spill },
4924cc286f3SDominic Spill { &hf_btbredr_pkthdr,
4934cc286f3SDominic Spill { "Packet Header", "btbredr.pkthdr",
4944cc286f3SDominic Spill FT_NONE, BASE_NONE, NULL, 0x0,
4954cc286f3SDominic Spill "Bluetooth Baseband Packet Header", HFILL }
4964cc286f3SDominic Spill },
4974cc286f3SDominic Spill { &hf_btbredr_ltaddr,
4984cc286f3SDominic Spill { "LT_ADDR", "btbredr.lt_addr",
4994cc286f3SDominic Spill FT_UINT8, BASE_HEX, NULL, 0x07,
5004cc286f3SDominic Spill "Logical Transport Address", HFILL }
5014cc286f3SDominic Spill },
5024cc286f3SDominic Spill { &hf_btbredr_type,
5034cc286f3SDominic Spill { "TYPE", "btbredr.type",
5044cc286f3SDominic Spill FT_UINT8, BASE_HEX, VALS(packet_types), 0x78,
5054cc286f3SDominic Spill "Packet Type", HFILL }
5064cc286f3SDominic Spill },
5074cc286f3SDominic Spill { &hf_btbredr_flags,
5084cc286f3SDominic Spill { "Flags", "btbredr.flags",
5094cc286f3SDominic Spill FT_UINT8, BASE_HEX, NULL, 0x0,
5104cc286f3SDominic Spill "Packet Header Flags", HFILL }
5114cc286f3SDominic Spill },
5124cc286f3SDominic Spill { &hf_btbredr_flow,
5134cc286f3SDominic Spill { "FLOW", "btbredr.flow",
5144cc286f3SDominic Spill FT_BOOLEAN, 8, NULL, 0x01,
5154cc286f3SDominic Spill "Flow control indication", HFILL }
5164cc286f3SDominic Spill },
5174cc286f3SDominic Spill { &hf_btbredr_arqn,
5184cc286f3SDominic Spill { "ARQN", "btbredr.arqn",
5194cc286f3SDominic Spill FT_BOOLEAN, 8, NULL, 0x02,
5204cc286f3SDominic Spill "Acknowledgment indication", HFILL }
5214cc286f3SDominic Spill },
5224cc286f3SDominic Spill { &hf_btbredr_seqn,
5234cc286f3SDominic Spill { "SEQN", "btbredr.seqn",
5244cc286f3SDominic Spill FT_BOOLEAN, 8, NULL, 0x04,
5254cc286f3SDominic Spill "Sequence number", HFILL }
5264cc286f3SDominic Spill },
5274cc286f3SDominic Spill { &hf_btbredr_hec,
5284cc286f3SDominic Spill { "HEC", "btbredr.lt_addr",
5294cc286f3SDominic Spill FT_UINT8, BASE_HEX, NULL, 0x0,
5304cc286f3SDominic Spill "Header Error Check", HFILL }
5314cc286f3SDominic Spill },
5324cc286f3SDominic Spill { &hf_btbredr_payload,
5334cc286f3SDominic Spill { "Payload", "btbredr.payload",
5344cc286f3SDominic Spill FT_NONE, BASE_NONE, NULL, 0x0,
5354cc286f3SDominic Spill NULL, HFILL }
5364cc286f3SDominic Spill },
5374cc286f3SDominic Spill { &hf_btbredr_llid,
5384cc286f3SDominic Spill { "LLID", "btbredr.llid",
5394cc286f3SDominic Spill FT_UINT8, BASE_HEX, VALS(llid_codes), 0x03,
5404cc286f3SDominic Spill "Logical Link ID", HFILL }
5414cc286f3SDominic Spill },
5424cc286f3SDominic Spill { &hf_btbredr_pldflow,
5434cc286f3SDominic Spill { "Flow", "btbredr.flow",
5444cc286f3SDominic Spill FT_BOOLEAN, 8, NULL, 0x04,
5454cc286f3SDominic Spill "Payload Flow indication", HFILL }
5464cc286f3SDominic Spill },
5474cc286f3SDominic Spill { &hf_btbredr_length,
5484cc286f3SDominic Spill { "Length", "btbredr.length",
5494cc286f3SDominic Spill FT_UINT8, BASE_DEC, NULL, 0xf8,
5504cc286f3SDominic Spill "Payload Length", HFILL }
5514cc286f3SDominic Spill },
5524cc286f3SDominic Spill { &hf_btbredr_pldhdr,
5534cc286f3SDominic Spill { "Payload Header", "btbredr.pldhdr",
5544cc286f3SDominic Spill FT_NONE, BASE_NONE, NULL, 0x0,
5554cc286f3SDominic Spill NULL, HFILL }
5564cc286f3SDominic Spill },
5574cc286f3SDominic Spill { &hf_btbredr_pldbody,
5584cc286f3SDominic Spill { "Payload Body", "btbredr.pldbody",
5594cc286f3SDominic Spill FT_BYTES, BASE_NONE, NULL, 0x0,
5604cc286f3SDominic Spill NULL, HFILL }
5614cc286f3SDominic Spill },
5624cc286f3SDominic Spill { &hf_btbredr_crc,
5634cc286f3SDominic Spill { "CRC", "btbredr.crc",
5644cc286f3SDominic Spill FT_UINT16, BASE_HEX, NULL, 0x0,
5654cc286f3SDominic Spill "Payload CRC", HFILL }
5664cc286f3SDominic Spill },
5674cc286f3SDominic Spill { &hf_btbredr_fhs_parity,
5684cc286f3SDominic Spill { "Parity", "btbredr.parity",
5694cc286f3SDominic Spill /* FIXME this doesn't work because bitmasks can only be 32 bits */
5704cc286f3SDominic Spill FT_UINT64, BASE_HEX, NULL, /*0x00000003ffffffffULL,*/ 0x0,
5714cc286f3SDominic Spill "LAP parity", HFILL }
5724cc286f3SDominic Spill },
5734cc286f3SDominic Spill { &hf_btbredr_fhs_lap,
5744cc286f3SDominic Spill { "LAP", "btbredr.lap",
5754cc286f3SDominic Spill FT_UINT24, BASE_HEX, NULL, 0x03fffffc,
5764cc286f3SDominic Spill "Lower Address Part", HFILL }
5774cc286f3SDominic Spill },
5784cc286f3SDominic Spill { &hf_btbredr_fhs_eir,
5794cc286f3SDominic Spill { "EIR", "btbredr.eir",
5804cc286f3SDominic Spill FT_BOOLEAN, 8, NULL, 0x04,
5814cc286f3SDominic Spill "Extended Inquiry Response packet may follow", HFILL }
5824cc286f3SDominic Spill },
5834cc286f3SDominic Spill { &hf_btbredr_fhs_sr,
5844cc286f3SDominic Spill { "SR", "btbredr.sr",
5854cc286f3SDominic Spill FT_UINT8, BASE_HEX, VALS(sr_modes), 0x30,
5864cc286f3SDominic Spill "Scan Repetition", HFILL }
5874cc286f3SDominic Spill },
5884cc286f3SDominic Spill { &hf_btbredr_fhs_uap,
5894cc286f3SDominic Spill { "UAP", "btbredr.uap",
5904cc286f3SDominic Spill FT_UINT8, BASE_HEX, NULL, 0x0,
5914cc286f3SDominic Spill "Upper Address Part", HFILL }
5924cc286f3SDominic Spill },
5934cc286f3SDominic Spill { &hf_btbredr_fhs_nap,
5944cc286f3SDominic Spill { "NAP", "btbredr.nap",
5954cc286f3SDominic Spill FT_UINT16, BASE_HEX, NULL, 0x0,
5964cc286f3SDominic Spill "Non-Significant Address Part", HFILL }
5974cc286f3SDominic Spill },
5984cc286f3SDominic Spill { &hf_btbredr_fhs_class, /* FIXME break out further */
5994cc286f3SDominic Spill { "Class of Device", "btbredr.class",
6004cc286f3SDominic Spill FT_UINT24, BASE_HEX, NULL, 0x0,
6014cc286f3SDominic Spill NULL, HFILL }
6024cc286f3SDominic Spill },
6034cc286f3SDominic Spill { &hf_btbredr_fhs_ltaddr,
6044cc286f3SDominic Spill { "LT_ADDR", "btbredr.lt_addr",
6054cc286f3SDominic Spill FT_UINT8, BASE_HEX, NULL, 0x07,
6064cc286f3SDominic Spill "Logical Transport Address", HFILL }
6074cc286f3SDominic Spill },
6084cc286f3SDominic Spill { &hf_btbredr_fhs_clk,
6094cc286f3SDominic Spill { "CLK", "btbredr.clk",
6104cc286f3SDominic Spill FT_UINT32, BASE_HEX, NULL, 0x1ffffff8,
6114cc286f3SDominic Spill "Clock bits 2 through 27", HFILL }
6124cc286f3SDominic Spill },
6134cc286f3SDominic Spill { &hf_btbredr_fhs_psmode,
6144cc286f3SDominic Spill { "Page Scan Mode", "btbredr.psmode",
6154cc286f3SDominic Spill FT_UINT8, BASE_HEX, NULL, 0xe0,
6164cc286f3SDominic Spill NULL, HFILL }
6174cc286f3SDominic Spill },
6184cc286f3SDominic Spill };
6194cc286f3SDominic Spill
6204cc286f3SDominic Spill /* protocol subtree arrays */
6214cc286f3SDominic Spill static gint *ett[] = {
6224cc286f3SDominic Spill &ett_btbredr,
6234cc286f3SDominic Spill &ett_btbredr_meta,
6244cc286f3SDominic Spill &ett_btbredr_pkthdr,
6254cc286f3SDominic Spill &ett_btbredr_flags,
6264cc286f3SDominic Spill &ett_btbredr_payload,
6274cc286f3SDominic Spill &ett_btbredr_pldhdr,
6284cc286f3SDominic Spill };
6294cc286f3SDominic Spill
6304cc286f3SDominic Spill /* register the protocol name and description */
6314cc286f3SDominic Spill proto_btbredr = proto_register_protocol(
6324cc286f3SDominic Spill "Bluetooth BR/EDR Baseband", /* full name */
6334cc286f3SDominic Spill "BT BR/EDR Baseband", /* short name */
6344cc286f3SDominic Spill "btbredr" /* abbreviation (e.g. for filters) */
6354cc286f3SDominic Spill );
6364cc286f3SDominic Spill
6374cc286f3SDominic Spill /* register the header fields and subtrees used */
6384cc286f3SDominic Spill proto_register_field_array(proto_btbredr, hf, array_length(hf));
6394cc286f3SDominic Spill proto_register_subtree_array(ett, array_length(ett));
6404cc286f3SDominic Spill }
6414cc286f3SDominic Spill
6424cc286f3SDominic Spill /* Remove this once recent Wireshark/TCPdump releases are more common */
6434cc286f3SDominic Spill #ifndef WTAP_ENCAP_BLUETOOTH_BREDR_BB
6444cc286f3SDominic Spill #define WTAP_ENCAP_BLUETOOTH_BREDR_BB 161
6454cc286f3SDominic Spill #endif
6464cc286f3SDominic Spill
6474cc286f3SDominic Spill void
proto_reg_handoff_btbredr(void)6484cc286f3SDominic Spill proto_reg_handoff_btbredr(void)
6494cc286f3SDominic Spill {
6504cc286f3SDominic Spill dissector_handle_t btbredr_handle;
6514cc286f3SDominic Spill btbredr_handle = new_create_dissector_handle(dissect_btbredr,
6524cc286f3SDominic Spill proto_btbredr);
6534cc286f3SDominic Spill dissector_add_uint("wtap_encap",
6544cc286f3SDominic Spill WTAP_ENCAP_BLUETOOTH_BREDR_BB,
6554cc286f3SDominic Spill btbredr_handle);
6564cc286f3SDominic Spill
6574cc286f3SDominic Spill btlmp_handle = find_dissector("btlmp");
6584cc286f3SDominic Spill btl2cap_handle = find_dissector("btl2cap");
6594cc286f3SDominic Spill }
6604cc286f3SDominic Spill
6614cc286f3SDominic Spill /*
6624cc286f3SDominic Spill * Editor modelines - http://www.wireshark.org/tools/modelines.html
6634cc286f3SDominic Spill *
6644cc286f3SDominic Spill * Local variables:
6654cc286f3SDominic Spill * c-basic-offset: 4
6664cc286f3SDominic Spill * tab-width: 8
6674cc286f3SDominic Spill * indent-tabs-mode: nil
6684cc286f3SDominic Spill * End:
6694cc286f3SDominic Spill *
6704cc286f3SDominic Spill * vi: set shiftwidth=4 tabstop=8 expandtab:
6714cc286f3SDominic Spill * :indentSize=4:tabSize=8:noTabs=true:
6724cc286f3SDominic Spill */
673