1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
|
// Copyright 2013 The Chromium Authors
// Use of this source code is governed by a BSD-style license that can be
// found in the LICENSE file.
#ifdef UNSAFE_BUFFERS_BUILD
// TODO(crbug.com/351564777): Remove this and convert code to safer constructs.
#pragma allow_unsafe_buffers
#endif
#include "device/bluetooth/bluetooth_service_record_win.h"
#include <math.h>
#include <string>
#include "base/strings/string_number_conversions.h"
#include "base/strings/stringprintf.h"
#include "device/bluetooth/bluetooth_init_win.h"
#include "device/bluetooth/public/cpp/bluetooth_uuid.h"
namespace {
const uint16_t kProtocolDescriptorListId = 4;
const uint16_t kRfcommUuid = 3;
const uint16_t kUuidId = 1;
bool AdvanceToSdpType(const SDP_ELEMENT_DATA& sequence_data,
SDP_TYPE type,
HBLUETOOTH_CONTAINER_ELEMENT* element,
SDP_ELEMENT_DATA* sdp_data) {
while (ERROR_SUCCESS == BluetoothSdpGetContainerElementData(
sequence_data.data.sequence.value,
sequence_data.data.sequence.length,
element,
sdp_data)) {
if (sdp_data->type == type) {
return true;
}
}
return false;
}
void ExtractChannels(const SDP_ELEMENT_DATA& protocol_descriptor_list_data,
bool* supports_rfcomm,
uint8_t* rfcomm_channel) {
HBLUETOOTH_CONTAINER_ELEMENT sequence_element = NULL;
SDP_ELEMENT_DATA sequence_data;
while (AdvanceToSdpType(protocol_descriptor_list_data,
SDP_TYPE_SEQUENCE,
&sequence_element,
&sequence_data)) {
HBLUETOOTH_CONTAINER_ELEMENT inner_sequence_element = NULL;
SDP_ELEMENT_DATA inner_sequence_data;
if (AdvanceToSdpType(sequence_data,
SDP_TYPE_UUID,
&inner_sequence_element,
&inner_sequence_data) &&
inner_sequence_data.data.uuid32 == kRfcommUuid &&
AdvanceToSdpType(sequence_data,
SDP_TYPE_UINT,
&inner_sequence_element,
&inner_sequence_data) &&
inner_sequence_data.specificType == SDP_ST_UINT8) {
*rfcomm_channel = inner_sequence_data.data.uint8;
*supports_rfcomm = true;
}
}
}
void ExtractUuid(const SDP_ELEMENT_DATA& uuid_data,
device::BluetoothUUID* uuid) {
HBLUETOOTH_CONTAINER_ELEMENT inner_uuid_element = NULL;
SDP_ELEMENT_DATA inner_uuid_data;
if (AdvanceToSdpType(uuid_data,
SDP_TYPE_UUID,
&inner_uuid_element,
&inner_uuid_data)) {
if (inner_uuid_data.specificType == SDP_ST_UUID16) {
std::string uuid_hex =
base::StringPrintf("%04x", inner_uuid_data.data.uuid16);
*uuid = device::BluetoothUUID(uuid_hex);
} else if (inner_uuid_data.specificType == SDP_ST_UUID32) {
std::string uuid_hex =
base::StringPrintf("%08lx", inner_uuid_data.data.uuid32);
*uuid = device::BluetoothUUID(uuid_hex);
} else if (inner_uuid_data.specificType == SDP_ST_UUID128) {
*uuid = device::BluetoothUUID(base::StringPrintf(
"%08lx-%04x-%04x-%02x%02x-%02x%02x%02x%02x%02x%02x",
inner_uuid_data.data.uuid128.Data1,
inner_uuid_data.data.uuid128.Data2,
inner_uuid_data.data.uuid128.Data3,
inner_uuid_data.data.uuid128.Data4[0],
inner_uuid_data.data.uuid128.Data4[1],
inner_uuid_data.data.uuid128.Data4[2],
inner_uuid_data.data.uuid128.Data4[3],
inner_uuid_data.data.uuid128.Data4[4],
inner_uuid_data.data.uuid128.Data4[5],
inner_uuid_data.data.uuid128.Data4[6],
inner_uuid_data.data.uuid128.Data4[7]));
} else {
*uuid = device::BluetoothUUID();
}
}
}
BTH_ADDR ConvertToBthAddr(const std::string& address) {
BTH_ADDR bth_addr = 0;
std::string numbers_only;
for (int i = 0; i < 6; ++i) {
numbers_only += address.substr(i * 3, 2);
}
std::vector<uint8_t> address_bytes;
base::HexStringToBytes(numbers_only, &address_bytes);
int byte_position = 0;
for (std::vector<uint8_t>::reverse_iterator iter = address_bytes.rbegin();
iter != address_bytes.rend(); ++iter) {
bth_addr += *iter * pow(256.0, byte_position);
byte_position++;
}
return bth_addr;
}
} // namespace
namespace device {
BluetoothServiceRecordWin::BluetoothServiceRecordWin(
const std::string& device_address,
const std::string& name,
const std::vector<uint8_t>& sdp_bytes,
const BluetoothUUID& gatt_uuid)
: device_bth_addr_(ConvertToBthAddr(device_address)),
device_address_(device_address),
name_(name),
uuid_(gatt_uuid),
supports_rfcomm_(false),
rfcomm_channel_(0xFF) {
// Bluetooth 2.0
if (sdp_bytes.size() > 0) {
LPBYTE blob_data = const_cast<LPBYTE>(&sdp_bytes[0]);
ULONG blob_size = static_cast<ULONG>(sdp_bytes.size());
SDP_ELEMENT_DATA protocol_descriptor_list_data;
if (ERROR_SUCCESS ==
BluetoothSdpGetAttributeValue(blob_data,
blob_size,
kProtocolDescriptorListId,
&protocol_descriptor_list_data)) {
ExtractChannels(
protocol_descriptor_list_data, &supports_rfcomm_, &rfcomm_channel_);
}
SDP_ELEMENT_DATA uuid_data;
if (ERROR_SUCCESS == BluetoothSdpGetAttributeValue(
blob_data, blob_size, kUuidId, &uuid_data)) {
ExtractUuid(uuid_data, &uuid_);
}
}
}
bool BluetoothServiceRecordWin::IsEqual(
const BluetoothServiceRecordWin& other) {
return device_address_ == other.device_address_ && name_ == other.name_ &&
uuid_ == other.uuid_ && supports_rfcomm_ == other.supports_rfcomm_ &&
rfcomm_channel_ == other.rfcomm_channel_;
}
} // namespace device
|
