ARMmbed
/
mbed-os
mirror of https://github.com/ARMmbed/mbed-os.git
1
0
Fork 0
Code Issues Projects Releases Wiki Activity

BLE: Reduce complexity of GenericGap::setAdvertisingData

pull/8738/head
Vincent Coubard 2018-11-10 17:36:33 +00:00
parent 0d90671842
commit d2773e9731
1 changed files with 62 additions and 56 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

106
features/FEATURE_BLE/source/generic/GenericGap.cpp
View File

@ -1710,76 +1710,82 @@ ble_error_t GenericGap::setAdvertisingData(
bool minimiseFragmentation, bool minimiseFragmentation,
bool scan_response bool scan_response
) { ) {
// type declarations
typedef pal::advertising_fragment_description_t op_t;
typedef ble_error_t (pal::Gap::*legacy_set_data_fn_t)(
uint8_t ,
const pal::advertising_data_t&
);
typedef ble_error_t (pal::Gap::*set_data_fn_t)(
advertising_handle_t advertising_handle,
op_t operation,
bool minimize_fragmentation,
uint8_t scan_response_data_size,
const uint8_t *scan_response_data
);
if (!_existing_sets.get(handle)) { if (!_existing_sets.get(handle)) {
return BLE_ERROR_INVALID_PARAM; return BLE_ERROR_INVALID_PARAM;
} }
// handle special case of legacy advertising
if (!is_extended_advertising_available()) { if (!is_extended_advertising_available()) {
if (handle == Gap::LEGACY_ADVERTISING_HANDLE) { if (handle != Gap::LEGACY_ADVERTISING_HANDLE) {
return BLE_ERROR_INVALID_PARAM;
}
if (payload.size() < GAP_ADVERTISING_DATA_MAX_PAYLOAD) { if (payload.size() < GAP_ADVERTISING_DATA_MAX_PAYLOAD) {
return BLE_ERROR_INVALID_PARAM; return BLE_ERROR_INVALID_PARAM;
} }
if (scan_response) {
return _pal_gap.set_advertising_data( // select the pal function
payload.size(), legacy_set_data_fn_t set_data = scan_response ?
pal::advertising_data_t(payload.data(), payload.size()) &pal::Gap::set_scan_response_data :
); &pal::Gap::set_advertising_data;
} else {
return _pal_gap.set_scan_response_data( // set the payload
return (_pal_gap.*set_data)(
payload.size(), payload.size(),
pal::advertising_data_t(payload.data(), payload.size()) pal::advertising_data_t(payload.data(), payload.size())
); );
} }
} else {
return BLE_ERROR_INVALID_PARAM; // select the pal function
} set_data_fn_t set_data = scan_response ?
return BLE_ERROR_NOT_IMPLEMENTED; &pal::Gap::set_extended_scan_response_data :
&pal::Gap::set_extended_advertising_data;
for (size_t i = 0, end = payload.size(); i < end; i += MAX_HCI_DATA_LENGTH) {
// select the operation based on the index
op_t op(op_t::INTERMEDIATE_FRAGMENT);
if (end < MAX_HCI_DATA_LENGTH) {
op = op_t::COMPLETE_FRAGMENT;
} else if (i == 0) {
op = op_t::FIRST_FRAGMENT;
} else if ((end - i) <= MAX_HCI_DATA_LENGTH) {
op = op_t::LAST_FRAGMENT;
} }
ble_error_t status = BLE_ERROR_NONE; // extract the payload
uint16_t index = 0; mbed::Span<uint8_t> sub_payload = payload.subspan(
const uint16_t& length = payload.size(); i,
uint16_t packet_data_length = length; std::min(MAX_HCI_DATA_LENGTH, (end - i))
typedef pal::advertising_fragment_description_t op_t;
op_t operation = (length > MAX_HCI_DATA_LENGTH) ? op_t::FIRST_FRAGMENT : op_t::COMPLETE_FRAGMENT;
while (index < length) {
if ((length - index) > MAX_HCI_DATA_LENGTH) {
packet_data_length = MAX_HCI_DATA_LENGTH;
} else {
packet_data_length = length - index;
operation = op_t::LAST_FRAGMENT;
}
if (scan_response) {
status = _pal_gap.set_extended_scan_response_data(
handle,
operation,
minimiseFragmentation,
packet_data_length,
&payload[index]
); );
} else {
status = _pal_gap.set_extended_advertising_data( // set the payload
ble_error_t err = (_pal_gap.*set_data)(
handle, handle,
operation, op,
minimiseFragmentation, minimiseFragmentation,
packet_data_length, sub_payload.size(),
&payload[index] sub_payload.data()
); );
if (err) {
return err;
} }
if (status != BLE_ERROR_NONE) {
return status;
} }
return BLE_ERROR_NONE;
index += packet_data_length;
operation = op_t::INTERMEDIATE_FRAGMENT;
}
return status;
} }
ble_error_t GenericGap::startAdvertising( ble_error_t GenericGap::startAdvertising(