1 //
2 // Copyright (C) 2015 Google, Inc.
3 //
4 // Licensed under the Apache License, Version 2.0 (the "License");
5 // you may not use this file except in compliance with the License.
6 // You may obtain a copy of the License at:
7 //
8 // http://www.apache.org/licenses/LICENSE-2.0
9 //
10 // Unless required by applicable law or agreed to in writing, software
11 // distributed under the License is distributed on an "AS IS" BASIS,
12 // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 // See the License for the specific language governing permissions and
14 // limitations under the License.
15 //
16
17 #include "service/low_energy_client.h"
18
19 #include <base/logging.h>
20
21 #include "service/adapter.h"
22 #include "service/common/bluetooth/util/address_helper.h"
23 #include "service/logging_helpers.h"
24 #include "stack/include/bt_types.h"
25 #include "stack/include/hcidefs.h"
26
27 using std::lock_guard;
28 using std::mutex;
29
30 namespace bluetooth {
31
32 namespace {
33
34 // 31 + 31 for advertising data and scan response. This is the maximum length
35 // TODO(armansito): Fix the HAL to return a concatenated blob that contains the
36 // true length of each field and also provide a length parameter so that we
37 // can support advertising length extensions in the future.
38 const size_t kScanRecordLength = 62;
39
GetBLEStatus(int status)40 BLEStatus GetBLEStatus(int status) {
41 if (status == BT_STATUS_FAIL)
42 return BLE_STATUS_FAILURE;
43
44 return static_cast<BLEStatus>(status);
45 }
46
47 // Returns the length of the given scan record array. We have to calculate this
48 // based on the maximum possible data length and the TLV data. See TODO above
49 // |kScanRecordLength|.
GetScanRecordLength(uint8_t * bytes)50 size_t GetScanRecordLength(uint8_t* bytes) {
51 for (size_t i = 0, field_len = 0; i < kScanRecordLength;
52 i += (field_len + 1)) {
53 field_len = bytes[i];
54
55 // Assert here that the data returned from the stack is correctly formatted
56 // in TLV form and that the length of the current field won't exceed the
57 // total data length.
58 CHECK(i + field_len < kScanRecordLength);
59
60 // If the field length is zero and we haven't reached the maximum length,
61 // then we have found the length, as the stack will pad the data with zeros
62 // accordingly.
63 if (field_len == 0)
64 return i;
65 }
66
67 // We have reached the end.
68 return kScanRecordLength;
69 }
70
71 // TODO(armansito): BTIF currently expects each advertising field in a
72 // specific format passed directly in arguments. We should fix BTIF to accept
73 // the advertising data directly instead.
74 struct HALAdvertiseData {
75 std::vector<uint8_t> manufacturer_data;
76 std::vector<uint8_t> service_data;
77 std::vector<uint8_t> service_uuid;
78 };
79
ProcessUUID(const uint8_t * uuid_data,size_t uuid_len,UUID * out_uuid)80 bool ProcessUUID(const uint8_t* uuid_data, size_t uuid_len, UUID* out_uuid) {
81 // BTIF expects a single 128-bit UUID to be passed in little-endian form, so
82 // we need to convert into that from raw data.
83 // TODO(armansito): We have three repeated if bodies below only because UUID
84 // accepts std::array which requires constexpr lengths. We should just have a
85 // single UUID constructor that takes in an std::vector instead.
86 if (uuid_len == UUID::kNumBytes16) {
87 UUID::UUID16Bit uuid_bytes;
88 for (size_t i = 0; i < uuid_len; ++i)
89 uuid_bytes[uuid_len - i - 1] = uuid_data[i];
90 *out_uuid = UUID(uuid_bytes);
91 } else if (uuid_len == UUID::kNumBytes32) {
92 UUID::UUID32Bit uuid_bytes;
93 for (size_t i = 0; i < uuid_len; ++i)
94 uuid_bytes[uuid_len - i - 1] = uuid_data[i];
95 *out_uuid = UUID(uuid_bytes);
96 } else if (uuid_len == UUID::kNumBytes128) {
97 UUID::UUID128Bit uuid_bytes;
98 for (size_t i = 0; i < uuid_len; ++i)
99 uuid_bytes[uuid_len - i - 1] = uuid_data[i];
100 *out_uuid = UUID(uuid_bytes);
101 } else {
102 LOG(ERROR) << "Invalid UUID length";
103 return false;
104 }
105
106 return true;
107 }
108
ProcessServiceData(const uint8_t * data,uint8_t uuid_len,HALAdvertiseData * out_data)109 bool ProcessServiceData(const uint8_t* data,
110 uint8_t uuid_len,
111 HALAdvertiseData* out_data) {
112 size_t field_len = data[0];
113
114 // Minimum packet size should be equal to the uuid length + 1 to include
115 // the byte for the type of packet
116 if (field_len < uuid_len + 1) {
117 // Invalid packet size
118 return false;
119 }
120
121 if (!out_data->service_data.empty()) {
122 // More than one Service Data is not allowed due to the limitations
123 // of the HAL API. We error in order to make sure there
124 // is no ambiguity on which data to send.
125 VLOG(1) << "More than one Service Data entry not allowed";
126 return false;
127 }
128
129 const uint8_t* service_uuid = data + 2;
130 UUID uuid;
131 if (!ProcessUUID(service_uuid, uuid_len, &uuid))
132 return false;
133
134 UUID::UUID128Bit uuid_bytes = uuid.GetFullLittleEndian();
135 const std::vector<uint8_t> temp_uuid(
136 uuid_bytes.data(), uuid_bytes.data() + uuid_bytes.size());
137
138 // This section is to make sure that there is no UUID conflict
139 if (out_data->service_uuid.empty()) {
140 out_data->service_uuid = temp_uuid;
141 } else if (out_data->service_uuid != temp_uuid) {
142 // Mismatch in uuid passed through service data and uuid passed
143 // through uuid field
144 VLOG(1) << "More than one UUID entry not allowed";
145 return false;
146 } // else do nothing as UUID is already properly assigned
147
148 // Use + uuid_len + 2 here in order to skip over a
149 // uuid contained in the beggining of the field
150 const uint8_t* srv_data = data + uuid_len + 2;
151
152
153 out_data->service_data.insert(
154 out_data->service_data.begin(),
155 srv_data, srv_data + field_len - uuid_len - 1);
156
157 return true;
158 }
159
ProcessAdvertiseData(const AdvertiseData & adv,HALAdvertiseData * out_data)160 bool ProcessAdvertiseData(const AdvertiseData& adv,
161 HALAdvertiseData* out_data) {
162 CHECK(out_data);
163 CHECK(out_data->manufacturer_data.empty());
164 CHECK(out_data->service_data.empty());
165 CHECK(out_data->service_uuid.empty());
166
167 const auto& data = adv.data();
168 size_t len = data.size();
169 for (size_t i = 0, field_len = 0; i < len; i += (field_len + 1)) {
170 // The length byte is the first byte in the adv. "TLV" format.
171 field_len = data[i];
172
173 // The type byte is the next byte in the adv. "TLV" format.
174 uint8_t type = data[i + 1];
175
176 switch (type) {
177 case HCI_EIR_MANUFACTURER_SPECIFIC_TYPE: {
178 // TODO(armansito): BTIF doesn't allow setting more than one
179 // manufacturer-specific data entry. This is something we should fix. For
180 // now, fail if more than one entry was set.
181 if (!out_data->manufacturer_data.empty()) {
182 LOG(ERROR) << "More than one Manufacturer Specific Data entry not allowed";
183 return false;
184 }
185
186 // The value bytes start at the next byte in the "TLV" format.
187 const uint8_t* mnf_data = data.data() + i + 2;
188 out_data->manufacturer_data.insert(
189 out_data->manufacturer_data.begin(),
190 mnf_data, mnf_data + field_len - 1);
191 break;
192 }
193 case HCI_EIR_MORE_16BITS_UUID_TYPE:
194 case HCI_EIR_COMPLETE_16BITS_UUID_TYPE:
195 case HCI_EIR_MORE_32BITS_UUID_TYPE:
196 case HCI_EIR_COMPLETE_32BITS_UUID_TYPE:
197 case HCI_EIR_MORE_128BITS_UUID_TYPE:
198 case HCI_EIR_COMPLETE_128BITS_UUID_TYPE: {
199 const uint8_t* uuid_data = data.data() + i + 2;
200 size_t uuid_len = field_len - 1;
201 UUID uuid;
202 if (!ProcessUUID(uuid_data, uuid_len, &uuid))
203 return false;
204
205 UUID::UUID128Bit uuid_bytes = uuid.GetFullLittleEndian();
206
207 if (!out_data->service_uuid.empty() &&
208 memcmp(out_data->service_uuid.data(),
209 uuid_bytes.data(), uuid_bytes.size()) != 0) {
210 // More than one UUID is not allowed due to the limitations
211 // of the HAL API. We error in order to make sure there
212 // is no ambiguity on which UUID to send. Also makes sure that
213 // UUID Hasn't been set by service data first
214 LOG(ERROR) << "More than one UUID entry not allowed";
215 return false;
216 }
217
218 out_data->service_uuid.assign(
219 uuid_bytes.data(), uuid_bytes.data() + UUID::kNumBytes128);
220 break;
221 }
222 case HCI_EIR_SERVICE_DATA_16BITS_UUID_TYPE: {
223 if (!ProcessServiceData(data.data() + i, 2, out_data))
224 return false;
225 break;
226 }
227 case HCI_EIR_SERVICE_DATA_32BITS_UUID_TYPE: {
228 if (!ProcessServiceData(data.data() + i, 4, out_data))
229 return false;
230 break;
231 }
232 case HCI_EIR_SERVICE_DATA_128BITS_UUID_TYPE: {
233 if (!ProcessServiceData(data.data() + i, 16, out_data))
234 return false;
235 break;
236 }
237 // TODO(armansito): Support other fields.
238 default:
239 VLOG(1) << "Unrecognized EIR field: " << type;
240 return false;
241 }
242 }
243
244 return true;
245 }
246
247 // The Bluetooth Core Specification defines time interval (e.g. Page Scan
248 // Interval, Advertising Interval, etc) units as 0.625 milliseconds (or 1
249 // Baseband slot). The HAL advertising functions expect the interval in this
250 // unit. This function maps an AdvertiseSettings::Mode value to the
251 // corresponding time unit.
GetAdvertisingIntervalUnit(AdvertiseSettings::Mode mode)252 int GetAdvertisingIntervalUnit(AdvertiseSettings::Mode mode) {
253 int ms;
254
255 switch (mode) {
256 case AdvertiseSettings::MODE_BALANCED:
257 ms = kAdvertisingIntervalMediumMs;
258 break;
259 case AdvertiseSettings::MODE_LOW_LATENCY:
260 ms = kAdvertisingIntervalLowMs;
261 break;
262 case AdvertiseSettings::MODE_LOW_POWER:
263 // Fall through
264 default:
265 ms = kAdvertisingIntervalHighMs;
266 break;
267 }
268
269 // Convert milliseconds Bluetooth units.
270 return (ms * 1000) / 625;
271 }
272
273 struct AdvertiseParams {
274 int min_interval;
275 int max_interval;
276 int event_type;
277 int tx_power_level;
278 int timeout_s;
279 };
280
GetAdvertiseParams(const AdvertiseSettings & settings,bool has_scan_rsp,AdvertiseParams * out_params)281 void GetAdvertiseParams(const AdvertiseSettings& settings, bool has_scan_rsp,
282 AdvertiseParams* out_params) {
283 CHECK(out_params);
284
285 out_params->min_interval = GetAdvertisingIntervalUnit(settings.mode());
286 out_params->max_interval =
287 out_params->min_interval + kAdvertisingIntervalDeltaUnit;
288
289 if (settings.connectable())
290 out_params->event_type = kAdvertisingEventTypeConnectable;
291 else if (has_scan_rsp)
292 out_params->event_type = kAdvertisingEventTypeScannable;
293 else
294 out_params->event_type = kAdvertisingEventTypeNonConnectable;
295
296 out_params->tx_power_level = settings.tx_power_level();
297 out_params->timeout_s = settings.timeout().InSeconds();
298 }
299
300 } // namespace
301
302 // LowEnergyClient implementation
303 // ========================================================
304
LowEnergyClient(Adapter & adapter,const UUID & uuid,int client_id)305 LowEnergyClient::LowEnergyClient(
306 Adapter& adapter, const UUID& uuid, int client_id)
307 : adapter_(adapter),
308 app_identifier_(uuid),
309 client_id_(client_id),
310 adv_data_needs_update_(false),
311 scan_rsp_needs_update_(false),
312 is_setting_adv_data_(false),
313 adv_started_(false),
314 adv_start_callback_(nullptr),
315 adv_stop_callback_(nullptr),
316 scan_started_(false) {
317 }
318
~LowEnergyClient()319 LowEnergyClient::~LowEnergyClient() {
320 // Automatically unregister the client.
321 VLOG(1) << "LowEnergyClient unregistering client: " << client_id_;
322
323 // Unregister as observer so we no longer receive any callbacks.
324 hal::BluetoothGattInterface::Get()->RemoveClientObserver(this);
325
326 // Stop advertising and ignore the result.
327 hal::BluetoothGattInterface::Get()->
328 GetClientHALInterface()->multi_adv_disable(client_id_);
329 hal::BluetoothGattInterface::Get()->
330 GetClientHALInterface()->unregister_client(client_id_);
331
332 // Stop any scans started by this client.
333 if (scan_started_.load())
334 StopScan();
335 }
336
Connect(std::string address,bool is_direct)337 bool LowEnergyClient::Connect(std::string address, bool is_direct) {
338 VLOG(2) << __func__ << "Address: " << address << " is_direct: " << is_direct;
339
340 bt_bdaddr_t bda;
341 util::BdAddrFromString(address, &bda);
342
343 bt_status_t status = hal::BluetoothGattInterface::Get()->
344 GetClientHALInterface()->connect(client_id_, &bda, is_direct,
345 BT_TRANSPORT_LE);
346 if (status != BT_STATUS_SUCCESS) {
347 LOG(ERROR) << "HAL call to connect failed";
348 return false;
349 }
350
351 return true;
352 }
353
Disconnect(std::string address)354 bool LowEnergyClient::Disconnect(std::string address) {
355 VLOG(2) << __func__ << "Address: " << address;
356
357 bt_bdaddr_t bda;
358 util::BdAddrFromString(address, &bda);
359
360 std::map<const bt_bdaddr_t, int>::iterator conn_id;
361 {
362 lock_guard<mutex> lock(connection_fields_lock_);
363 conn_id = connection_ids_.find(bda);
364 if (conn_id == connection_ids_.end()) {
365 LOG(WARNING) << "Can't disconnect, no existing connection to " << address;
366 return false;
367 }
368 }
369
370 bt_status_t status = hal::BluetoothGattInterface::Get()->
371 GetClientHALInterface()->disconnect(client_id_, &bda, conn_id->second);
372 if (status != BT_STATUS_SUCCESS) {
373 LOG(ERROR) << "HAL call to disconnect failed";
374 return false;
375 }
376
377 return true;
378 }
379
SetMtu(std::string address,int mtu)380 bool LowEnergyClient::SetMtu(std::string address, int mtu) {
381 VLOG(2) << __func__ << "Address: " << address
382 << " MTU: " << mtu;
383
384 bt_bdaddr_t bda;
385 util::BdAddrFromString(address, &bda);
386
387 std::map<const bt_bdaddr_t, int>::iterator conn_id;
388 {
389 lock_guard<mutex> lock(connection_fields_lock_);
390 conn_id = connection_ids_.find(bda);
391 if (conn_id == connection_ids_.end()) {
392 LOG(WARNING) << "Can't set MTU, no existing connection to " << address;
393 return false;
394 }
395 }
396
397 bt_status_t status = hal::BluetoothGattInterface::Get()->
398 GetClientHALInterface()->configure_mtu(conn_id->second, mtu);
399 if (status != BT_STATUS_SUCCESS) {
400 LOG(ERROR) << "HAL call to set MTU failed";
401 return false;
402 }
403
404 return true;
405 }
406
SetDelegate(Delegate * delegate)407 void LowEnergyClient::SetDelegate(Delegate* delegate) {
408 lock_guard<mutex> lock(delegate_mutex_);
409 delegate_ = delegate;
410 }
411
StartScan(const ScanSettings & settings,const std::vector<ScanFilter> & filters)412 bool LowEnergyClient::StartScan(const ScanSettings& settings,
413 const std::vector<ScanFilter>& filters) {
414 VLOG(2) << __func__;
415
416 // Cannot start a scan if the adapter is not enabled.
417 if (!adapter_.IsEnabled()) {
418 LOG(ERROR) << "Cannot scan while Bluetooth is disabled";
419 return false;
420 }
421
422 // TODO(jpawlowski): Push settings and filtering logic below the HAL.
423 bt_status_t status = hal::BluetoothGattInterface::Get()->
424 StartScan(client_id_);
425 if (status != BT_STATUS_SUCCESS) {
426 LOG(ERROR) << "Failed to initiate scanning for client: " << client_id_;
427 return false;
428 }
429
430 scan_started_ = true;
431 return true;
432 }
433
StopScan()434 bool LowEnergyClient::StopScan() {
435 VLOG(2) << __func__;
436
437 // TODO(armansito): We don't support batch scanning yet so call
438 // StopRegularScanForClient directly. In the future we will need to
439 // conditionally call a batch scan API here.
440 bt_status_t status = hal::BluetoothGattInterface::Get()->
441 StopScan(client_id_);
442 if (status != BT_STATUS_SUCCESS) {
443 LOG(ERROR) << "Failed to stop scan for client: " << client_id_;
444 return false;
445 }
446
447 scan_started_ = false;
448 return true;
449 }
450
StartAdvertising(const AdvertiseSettings & settings,const AdvertiseData & advertise_data,const AdvertiseData & scan_response,const StatusCallback & callback)451 bool LowEnergyClient::StartAdvertising(const AdvertiseSettings& settings,
452 const AdvertiseData& advertise_data,
453 const AdvertiseData& scan_response,
454 const StatusCallback& callback) {
455 VLOG(2) << __func__;
456 lock_guard<mutex> lock(adv_fields_lock_);
457
458 if (IsAdvertisingStarted()) {
459 LOG(WARNING) << "Already advertising";
460 return false;
461 }
462
463 if (IsStartingAdvertising()) {
464 LOG(WARNING) << "StartAdvertising already pending";
465 return false;
466 }
467
468 if (!advertise_data.IsValid()) {
469 LOG(ERROR) << "Invalid advertising data";
470 return false;
471 }
472
473 if (!scan_response.IsValid()) {
474 LOG(ERROR) << "Invalid scan response data";
475 return false;
476 }
477
478 CHECK(!adv_data_needs_update_.load());
479 CHECK(!scan_rsp_needs_update_.load());
480
481 adv_data_ = advertise_data;
482 scan_response_ = scan_response;
483 advertise_settings_ = settings;
484
485 AdvertiseParams params;
486 GetAdvertiseParams(settings, !scan_response_.data().empty(), ¶ms);
487
488 bt_status_t status = hal::BluetoothGattInterface::Get()->
489 GetClientHALInterface()->multi_adv_enable(
490 client_id_,
491 params.min_interval,
492 params.max_interval,
493 params.event_type,
494 kAdvertisingChannelAll,
495 params.tx_power_level,
496 params.timeout_s);
497 if (status != BT_STATUS_SUCCESS) {
498 LOG(ERROR) << "Failed to initiate call to enable multi-advertising";
499 return false;
500 }
501
502 // Always update advertising data.
503 adv_data_needs_update_ = true;
504
505 // Update scan response only if it has data, since otherwise we just won't
506 // send ADV_SCAN_IND.
507 if (!scan_response_.data().empty())
508 scan_rsp_needs_update_ = true;
509
510 // OK to set this at the end since we're still holding |adv_fields_lock_|.
511 adv_start_callback_.reset(new StatusCallback(callback));
512
513 return true;
514 }
515
StopAdvertising(const StatusCallback & callback)516 bool LowEnergyClient::StopAdvertising(const StatusCallback& callback) {
517 VLOG(2) << __func__;
518 lock_guard<mutex> lock(adv_fields_lock_);
519
520 if (!IsAdvertisingStarted()) {
521 LOG(ERROR) << "Not advertising";
522 return false;
523 }
524
525 if (IsStoppingAdvertising()) {
526 LOG(ERROR) << "StopAdvertising already pending";
527 return false;
528 }
529
530 CHECK(!adv_start_callback_);
531
532 bt_status_t status = hal::BluetoothGattInterface::Get()->
533 GetClientHALInterface()->multi_adv_disable(client_id_);
534 if (status != BT_STATUS_SUCCESS) {
535 LOG(ERROR) << "Failed to initiate call to disable multi-advertising";
536 return false;
537 }
538
539 // OK to set this at the end since we're still holding |adv_fields_lock_|.
540 adv_stop_callback_.reset(new StatusCallback(callback));
541
542 return true;
543 }
544
IsAdvertisingStarted() const545 bool LowEnergyClient::IsAdvertisingStarted() const {
546 return adv_started_.load();
547 }
548
IsStartingAdvertising() const549 bool LowEnergyClient::IsStartingAdvertising() const {
550 return !IsAdvertisingStarted() && adv_start_callback_;
551 }
552
IsStoppingAdvertising() const553 bool LowEnergyClient::IsStoppingAdvertising() const {
554 return IsAdvertisingStarted() && adv_stop_callback_;
555 }
556
GetAppIdentifier() const557 const UUID& LowEnergyClient::GetAppIdentifier() const {
558 return app_identifier_;
559 }
560
GetInstanceId() const561 int LowEnergyClient::GetInstanceId() const {
562 return client_id_;
563 }
564
ScanResultCallback(hal::BluetoothGattInterface * gatt_iface,const bt_bdaddr_t & bda,int rssi,uint8_t * adv_data)565 void LowEnergyClient::ScanResultCallback(
566 hal::BluetoothGattInterface* gatt_iface,
567 const bt_bdaddr_t& bda, int rssi, uint8_t* adv_data) {
568 // Ignore scan results if this client didn't start a scan.
569 if (!scan_started_.load())
570 return;
571
572 lock_guard<mutex> lock(delegate_mutex_);
573 if (!delegate_)
574 return;
575
576 // TODO(armansito): Apply software filters here.
577
578 size_t record_len = GetScanRecordLength(adv_data);
579 std::vector<uint8_t> scan_record(adv_data, adv_data + record_len);
580
581 ScanResult result(BtAddrString(&bda), scan_record, rssi);
582
583 delegate_->OnScanResult(this, result);
584 }
585
ConnectCallback(hal::BluetoothGattInterface * gatt_iface,int conn_id,int status,int client_id,const bt_bdaddr_t & bda)586 void LowEnergyClient::ConnectCallback(
587 hal::BluetoothGattInterface* gatt_iface, int conn_id, int status,
588 int client_id, const bt_bdaddr_t& bda) {
589 if (client_id != client_id_)
590 return;
591
592 VLOG(1) << __func__ << "client_id: " << client_id << " status: " << status;
593
594 {
595 lock_guard<mutex> lock(connection_fields_lock_);
596 auto success = connection_ids_.emplace(bda, conn_id);
597 if (!success.second) {
598 LOG(ERROR) << __func__ << " Insertion into connection_ids_ failed!";
599 }
600 }
601
602 if (delegate_)
603 delegate_->OnConnectionState(this, status, BtAddrString(&bda).c_str(),
604 true);
605 }
606
DisconnectCallback(hal::BluetoothGattInterface * gatt_iface,int conn_id,int status,int client_id,const bt_bdaddr_t & bda)607 void LowEnergyClient::DisconnectCallback(
608 hal::BluetoothGattInterface* gatt_iface, int conn_id, int status,
609 int client_id, const bt_bdaddr_t& bda) {
610 if (client_id != client_id_)
611 return;
612
613 VLOG(1) << __func__ << " client_id: " << client_id << " status: " << status;
614 {
615 lock_guard<mutex> lock(connection_fields_lock_);
616 if (!connection_ids_.erase(bda)) {
617 LOG(ERROR) << __func__ << " Erasing from connection_ids_ failed!";
618 }
619 }
620
621 if (delegate_)
622 delegate_->OnConnectionState(this, status, BtAddrString(&bda).c_str(),
623 false);
624 }
625
MtuChangedCallback(hal::BluetoothGattInterface * gatt_iface,int conn_id,int status,int mtu)626 void LowEnergyClient::MtuChangedCallback(
627 hal::BluetoothGattInterface* gatt_iface, int conn_id, int status,
628 int mtu) {
629 VLOG(1) << __func__ << " conn_id: " << conn_id << " status: " << status
630 << " mtu: " << mtu;
631
632 const bt_bdaddr_t *bda = nullptr;
633 {
634 lock_guard<mutex> lock(connection_fields_lock_);
635 for (auto& connection: connection_ids_) {
636 if (connection.second == conn_id) {
637 bda = &connection.first;
638 break;
639 }
640 }
641 }
642
643 if (!bda)
644 return;
645
646 const char *addr = BtAddrString(bda).c_str();
647 if (delegate_)
648 delegate_->OnMtuChanged(this, status, addr, mtu);
649 }
650
MultiAdvEnableCallback(hal::BluetoothGattInterface * gatt_iface,int client_id,int status)651 void LowEnergyClient::MultiAdvEnableCallback(
652 hal::BluetoothGattInterface* gatt_iface,
653 int client_id, int status) {
654 if (client_id != client_id_)
655 return;
656
657 lock_guard<mutex> lock(adv_fields_lock_);
658
659 VLOG(1) << __func__ << "client_id: " << client_id << " status: " << status;
660
661 CHECK(adv_start_callback_);
662 CHECK(!adv_stop_callback_);
663
664 // Terminate operation in case of error.
665 if (status != BT_STATUS_SUCCESS) {
666 LOG(ERROR) << "Failed to enable multi-advertising";
667 InvokeAndClearStartCallback(GetBLEStatus(status));
668 return;
669 }
670
671 // Now handle deferred tasks.
672 HandleDeferredAdvertiseData(gatt_iface);
673 }
674
MultiAdvDataCallback(hal::BluetoothGattInterface * gatt_iface,int client_id,int status)675 void LowEnergyClient::MultiAdvDataCallback(
676 hal::BluetoothGattInterface* gatt_iface,
677 int client_id, int status) {
678 if (client_id != client_id_)
679 return;
680
681 lock_guard<mutex> lock(adv_fields_lock_);
682
683 VLOG(1) << __func__ << "client_id: " << client_id << " status: " << status;
684
685 is_setting_adv_data_ = false;
686
687 // Terminate operation in case of error.
688 if (status != BT_STATUS_SUCCESS) {
689 LOG(ERROR) << "Failed to set advertising data";
690 InvokeAndClearStartCallback(GetBLEStatus(status));
691 return;
692 }
693
694 // Now handle deferred tasks.
695 HandleDeferredAdvertiseData(gatt_iface);
696 }
697
MultiAdvDisableCallback(hal::BluetoothGattInterface *,int client_id,int status)698 void LowEnergyClient::MultiAdvDisableCallback(
699 hal::BluetoothGattInterface* /* gatt_iface */,
700 int client_id, int status) {
701 if (client_id != client_id_)
702 return;
703
704 lock_guard<mutex> lock(adv_fields_lock_);
705
706 VLOG(1) << __func__ << "client_id: " << client_id << " status: " << status;
707
708 CHECK(!adv_start_callback_);
709 CHECK(adv_stop_callback_);
710
711 if (status == BT_STATUS_SUCCESS) {
712 VLOG(1) << "Multi-advertising stopped for client_id: " << client_id;
713 adv_started_ = false;
714 } else {
715 LOG(ERROR) << "Failed to stop multi-advertising";
716 }
717
718 InvokeAndClearStopCallback(GetBLEStatus(status));
719 }
720
SetAdvertiseData(hal::BluetoothGattInterface * gatt_iface,const AdvertiseData & data,bool set_scan_rsp)721 bt_status_t LowEnergyClient::SetAdvertiseData(
722 hal::BluetoothGattInterface* gatt_iface,
723 const AdvertiseData& data,
724 bool set_scan_rsp) {
725 VLOG(2) << __func__;
726
727 HALAdvertiseData hal_data;
728
729 // TODO(armansito): The stack should check that the length is valid when other
730 // fields inserted by the stack (e.g. flags, device name, tx-power) are taken
731 // into account. At the moment we are skipping this check; this means that if
732 // the given data is too long then the stack will truncate it.
733 if (!ProcessAdvertiseData(data, &hal_data)) {
734 LOG(ERROR) << "Malformed advertise data given";
735 return BT_STATUS_FAIL;
736 }
737
738 if (is_setting_adv_data_.load()) {
739 LOG(ERROR) << "Setting advertising data already in progress.";
740 return BT_STATUS_FAIL;
741 }
742
743 // TODO(armansito): The length fields in the BTIF function below are signed
744 // integers so a call to std::vector::size might get capped. This is very
745 // unlikely anyway but it's safer to stop using signed-integer types for
746 // length in APIs, so we should change that.
747 bt_status_t status = gatt_iface->GetClientHALInterface()->
748 multi_adv_set_inst_data(
749 client_id_,
750 set_scan_rsp,
751 data.include_device_name(),
752 data.include_tx_power_level(),
753 0, // This is what Bluetooth.apk current hardcodes for "appearance".
754 hal_data.manufacturer_data.size(),
755 reinterpret_cast<char*>(hal_data.manufacturer_data.data()),
756 hal_data.service_data.size(),
757 reinterpret_cast<char*>(hal_data.service_data.data()),
758 hal_data.service_uuid.size(),
759 reinterpret_cast<char*>(hal_data.service_uuid.data()));
760
761 if (status != BT_STATUS_SUCCESS) {
762 LOG(ERROR) << "Failed to set instance advertising data.";
763 return status;
764 }
765
766 if (set_scan_rsp)
767 scan_rsp_needs_update_ = false;
768 else
769 adv_data_needs_update_ = false;
770
771 is_setting_adv_data_ = true;
772
773 return status;
774 }
775
HandleDeferredAdvertiseData(hal::BluetoothGattInterface * gatt_iface)776 void LowEnergyClient::HandleDeferredAdvertiseData(
777 hal::BluetoothGattInterface* gatt_iface) {
778 VLOG(2) << __func__;
779
780 CHECK(!IsAdvertisingStarted());
781 CHECK(!IsStoppingAdvertising());
782 CHECK(IsStartingAdvertising());
783 CHECK(!is_setting_adv_data_.load());
784
785 if (adv_data_needs_update_.load()) {
786 bt_status_t status = SetAdvertiseData(gatt_iface, adv_data_, false);
787 if (status != BT_STATUS_SUCCESS) {
788 LOG(ERROR) << "Failed setting advertisement data";
789 InvokeAndClearStartCallback(GetBLEStatus(status));
790 }
791 return;
792 }
793
794 if (scan_rsp_needs_update_.load()) {
795 bt_status_t status = SetAdvertiseData(gatt_iface, scan_response_, true);
796 if (status != BT_STATUS_SUCCESS) {
797 LOG(ERROR) << "Failed setting scan response data";
798 InvokeAndClearStartCallback(GetBLEStatus(status));
799 }
800 return;
801 }
802
803 // All pending tasks are complete. Report success.
804 adv_started_ = true;
805 InvokeAndClearStartCallback(BLE_STATUS_SUCCESS);
806 }
807
InvokeAndClearStartCallback(BLEStatus status)808 void LowEnergyClient::InvokeAndClearStartCallback(BLEStatus status) {
809 adv_data_needs_update_ = false;
810 scan_rsp_needs_update_ = false;
811
812 // We allow NULL callbacks.
813 if (*adv_start_callback_)
814 (*adv_start_callback_)(status);
815
816 adv_start_callback_ = nullptr;
817 }
818
InvokeAndClearStopCallback(BLEStatus status)819 void LowEnergyClient::InvokeAndClearStopCallback(BLEStatus status) {
820 // We allow NULL callbacks.
821 if (*adv_stop_callback_)
822 (*adv_stop_callback_)(status);
823
824 adv_stop_callback_ = nullptr;
825 }
826
827 // LowEnergyClientFactory implementation
828 // ========================================================
829
LowEnergyClientFactory(Adapter & adapter)830 LowEnergyClientFactory::LowEnergyClientFactory(Adapter& adapter)
831 : adapter_(adapter) {
832 hal::BluetoothGattInterface::Get()->AddClientObserver(this);
833 }
834
~LowEnergyClientFactory()835 LowEnergyClientFactory::~LowEnergyClientFactory() {
836 hal::BluetoothGattInterface::Get()->RemoveClientObserver(this);
837 }
838
RegisterInstance(const UUID & uuid,const RegisterCallback & callback)839 bool LowEnergyClientFactory::RegisterInstance(
840 const UUID& uuid,
841 const RegisterCallback& callback) {
842 VLOG(1) << __func__ << " - UUID: " << uuid.ToString();
843 lock_guard<mutex> lock(pending_calls_lock_);
844
845 if (pending_calls_.find(uuid) != pending_calls_.end()) {
846 LOG(ERROR) << "Low-Energy client with given UUID already registered - "
847 << "UUID: " << uuid.ToString();
848 return false;
849 }
850
851 const btgatt_client_interface_t* hal_iface =
852 hal::BluetoothGattInterface::Get()->GetClientHALInterface();
853 bt_uuid_t app_uuid = uuid.GetBlueDroid();
854
855 if (hal_iface->register_client(&app_uuid) != BT_STATUS_SUCCESS)
856 return false;
857
858 pending_calls_[uuid] = callback;
859
860 return true;
861 }
862
RegisterClientCallback(hal::BluetoothGattInterface * gatt_iface,int status,int client_id,const bt_uuid_t & app_uuid)863 void LowEnergyClientFactory::RegisterClientCallback(
864 hal::BluetoothGattInterface* gatt_iface,
865 int status, int client_id,
866 const bt_uuid_t& app_uuid) {
867 UUID uuid(app_uuid);
868
869 VLOG(1) << __func__ << " - UUID: " << uuid.ToString();
870 lock_guard<mutex> lock(pending_calls_lock_);
871
872 auto iter = pending_calls_.find(uuid);
873 if (iter == pending_calls_.end()) {
874 VLOG(1) << "Ignoring callback for unknown app_id: " << uuid.ToString();
875 return;
876 }
877
878 // No need to construct a client if the call wasn't successful.
879 std::unique_ptr<LowEnergyClient> client;
880 BLEStatus result = BLE_STATUS_FAILURE;
881 if (status == BT_STATUS_SUCCESS) {
882 client.reset(new LowEnergyClient(adapter_, uuid, client_id));
883
884 gatt_iface->AddClientObserver(client.get());
885
886 result = BLE_STATUS_SUCCESS;
887 }
888
889 // Notify the result via the result callback.
890 iter->second(result, uuid, std::move(client));
891
892 pending_calls_.erase(iter);
893 }
894
895 } // namespace bluetooth
896