takashi kadono / Mbed OS Nucleo_446

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   ssd1331

mbed-os/features/FEATURE_BLE/targets/TARGET_NORDIC/TARGET_MCU_NRF51822/source/nRF5xCharacteristicDescriptorDiscoverer.cpp@0:8fdf9a60065b, 2018-10-10 (annotated)

Committer:
kadonotakashi
Date:
Wed Oct 10 00:33:53 2018 +0000
Revision:
0:8fdf9a60065b
how to make mbed librry

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kadonotakashi 0:8fdf9a60065b 1 /* mbed Microcontroller Library
kadonotakashi 0:8fdf9a60065b 2 * Copyright (c) 2006-2015 ARM Limited
kadonotakashi 0:8fdf9a60065b 3 *
kadonotakashi 0:8fdf9a60065b 4 * Licensed under the Apache License, Version 2.0 (the "License");
kadonotakashi 0:8fdf9a60065b 5 * you may not use this file except in compliance with the License.
kadonotakashi 0:8fdf9a60065b 6 * You may obtain a copy of the License at
kadonotakashi 0:8fdf9a60065b 7 *
kadonotakashi 0:8fdf9a60065b 8 * http://www.apache.org/licenses/LICENSE-2.0
kadonotakashi 0:8fdf9a60065b 9 *
kadonotakashi 0:8fdf9a60065b 10 * Unless required by applicable law or agreed to in writing, software
kadonotakashi 0:8fdf9a60065b 11 * distributed under the License is distributed on an "AS IS" BASIS,
kadonotakashi 0:8fdf9a60065b 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kadonotakashi 0:8fdf9a60065b 13 * See the License for the specific language governing permissions and
kadonotakashi 0:8fdf9a60065b 14 * limitations under the License.
kadonotakashi 0:8fdf9a60065b 15 */
kadonotakashi 0:8fdf9a60065b 16 #include "nRF5xCharacteristicDescriptorDiscoverer.h"
kadonotakashi 0:8fdf9a60065b 17 #include "ble_err.h"
kadonotakashi 0:8fdf9a60065b 18 #include "ble/DiscoveredCharacteristicDescriptor.h"
kadonotakashi 0:8fdf9a60065b 19
kadonotakashi 0:8fdf9a60065b 20 nRF5xCharacteristicDescriptorDiscoverer::nRF5xCharacteristicDescriptorDiscoverer() :
kadonotakashi 0:8fdf9a60065b 21 discoveryRunning() {
kadonotakashi 0:8fdf9a60065b 22 // nothing to do
kadonotakashi 0:8fdf9a60065b 23 }
kadonotakashi 0:8fdf9a60065b 24
kadonotakashi 0:8fdf9a60065b 25 nRF5xCharacteristicDescriptorDiscoverer::~nRF5xCharacteristicDescriptorDiscoverer() {
kadonotakashi 0:8fdf9a60065b 26 // nothing to do
kadonotakashi 0:8fdf9a60065b 27 }
kadonotakashi 0:8fdf9a60065b 28
kadonotakashi 0:8fdf9a60065b 29 ble_error_t nRF5xCharacteristicDescriptorDiscoverer::launch(
kadonotakashi 0:8fdf9a60065b 30 const DiscoveredCharacteristic& characteristic,
kadonotakashi 0:8fdf9a60065b 31 const CharacteristicDescriptorDiscovery::DiscoveryCallback_t& discoveryCallback,
kadonotakashi 0:8fdf9a60065b 32 const CharacteristicDescriptorDiscovery::TerminationCallback_t& terminationCallback
kadonotakashi 0:8fdf9a60065b 33 ) {
kadonotakashi 0:8fdf9a60065b 34 Gap::Handle_t connHandle = characteristic.getConnectionHandle();
kadonotakashi 0:8fdf9a60065b 35 // it is ok to deduce that the start handle for descriptors is after
kadonotakashi 0:8fdf9a60065b 36 // the characteristic declaration and the characteristic value declaration
kadonotakashi 0:8fdf9a60065b 37 // see BLUETOOTH SPECIFICATION Version 4.2 [Vol 3, Part G] (3.3)
kadonotakashi 0:8fdf9a60065b 38 Gap::Handle_t descriptorStartHandle = characteristic.getDeclHandle() + 2;
kadonotakashi 0:8fdf9a60065b 39 Gap::Handle_t descriptorEndHandle = characteristic.getLastHandle();
kadonotakashi 0:8fdf9a60065b 40
kadonotakashi 0:8fdf9a60065b 41 // check if there is any descriptor to discover
kadonotakashi 0:8fdf9a60065b 42 if (descriptorEndHandle < descriptorStartHandle) {
kadonotakashi 0:8fdf9a60065b 43 CharacteristicDescriptorDiscovery::TerminationCallbackParams_t termParams = {
kadonotakashi 0:8fdf9a60065b 44 characteristic,
kadonotakashi 0:8fdf9a60065b 45 BLE_ERROR_NONE
kadonotakashi 0:8fdf9a60065b 46 };
kadonotakashi 0:8fdf9a60065b 47 terminationCallback.call(&termParams);
kadonotakashi 0:8fdf9a60065b 48 return BLE_ERROR_NONE;
kadonotakashi 0:8fdf9a60065b 49 }
kadonotakashi 0:8fdf9a60065b 50
kadonotakashi 0:8fdf9a60065b 51 // check if we can run this discovery
kadonotakashi 0:8fdf9a60065b 52 if (isConnectionInUse(connHandle)) {
kadonotakashi 0:8fdf9a60065b 53 return BLE_STACK_BUSY;
kadonotakashi 0:8fdf9a60065b 54 }
kadonotakashi 0:8fdf9a60065b 55
kadonotakashi 0:8fdf9a60065b 56 // get a new discovery slot, if none are available, just return
kadonotakashi 0:8fdf9a60065b 57 Discovery* discovery = getAvailableDiscoverySlot();
kadonotakashi 0:8fdf9a60065b 58 if(discovery == NULL) {
kadonotakashi 0:8fdf9a60065b 59 return BLE_STACK_BUSY;
kadonotakashi 0:8fdf9a60065b 60 }
kadonotakashi 0:8fdf9a60065b 61
kadonotakashi 0:8fdf9a60065b 62 // try to launch the discovery
kadonotakashi 0:8fdf9a60065b 63 ble_error_t err = gattc_descriptors_discover(connHandle, descriptorStartHandle, descriptorEndHandle);
kadonotakashi 0:8fdf9a60065b 64 if(!err) {
kadonotakashi 0:8fdf9a60065b 65 // commit the new discovery to its slot
kadonotakashi 0:8fdf9a60065b 66 *discovery = Discovery(characteristic, discoveryCallback, terminationCallback);
kadonotakashi 0:8fdf9a60065b 67 }
kadonotakashi 0:8fdf9a60065b 68
kadonotakashi 0:8fdf9a60065b 69 return err;
kadonotakashi 0:8fdf9a60065b 70 }
kadonotakashi 0:8fdf9a60065b 71
kadonotakashi 0:8fdf9a60065b 72 bool nRF5xCharacteristicDescriptorDiscoverer::isActive(const DiscoveredCharacteristic& characteristic) const {
kadonotakashi 0:8fdf9a60065b 73 for(size_t i = 0; i < MAXIMUM_CONCURRENT_CONNECTIONS_COUNT; ++i) {
kadonotakashi 0:8fdf9a60065b 74 if(discoveryRunning[i].getCharacteristic() == characteristic) {
kadonotakashi 0:8fdf9a60065b 75 return true;
kadonotakashi 0:8fdf9a60065b 76 }
kadonotakashi 0:8fdf9a60065b 77 }
kadonotakashi 0:8fdf9a60065b 78 return false;
kadonotakashi 0:8fdf9a60065b 79 }
kadonotakashi 0:8fdf9a60065b 80
kadonotakashi 0:8fdf9a60065b 81 void nRF5xCharacteristicDescriptorDiscoverer::requestTerminate(const DiscoveredCharacteristic& characteristic) {
kadonotakashi 0:8fdf9a60065b 82 Discovery* discovery = findRunningDiscovery(characteristic);
kadonotakashi 0:8fdf9a60065b 83 if(discovery) {
kadonotakashi 0:8fdf9a60065b 84 // call terminate anyway
kadonotakashi 0:8fdf9a60065b 85 terminate(discovery, BLE_ERROR_NONE);
kadonotakashi 0:8fdf9a60065b 86 }
kadonotakashi 0:8fdf9a60065b 87 }
kadonotakashi 0:8fdf9a60065b 88
kadonotakashi 0:8fdf9a60065b 89 void nRF5xCharacteristicDescriptorDiscoverer::process(uint16_t connectionHandle, const ble_gattc_evt_desc_disc_rsp_t& descriptors) {
kadonotakashi 0:8fdf9a60065b 90 Discovery* discovery = findRunningDiscovery(connectionHandle);
kadonotakashi 0:8fdf9a60065b 91 // the discovery has been removed
kadonotakashi 0:8fdf9a60065b 92 if(!discovery) {
kadonotakashi 0:8fdf9a60065b 93 return;
kadonotakashi 0:8fdf9a60065b 94 }
kadonotakashi 0:8fdf9a60065b 95
kadonotakashi 0:8fdf9a60065b 96 for (uint16_t i = 0; i < descriptors.count; ++i) {
kadonotakashi 0:8fdf9a60065b 97 discovery->process(
kadonotakashi 0:8fdf9a60065b 98 descriptors.descs[i].handle, UUID(descriptors.descs[i].uuid.uuid)
kadonotakashi 0:8fdf9a60065b 99 );
kadonotakashi 0:8fdf9a60065b 100 }
kadonotakashi 0:8fdf9a60065b 101
kadonotakashi 0:8fdf9a60065b 102 // prepare the next discovery request (if needed)
kadonotakashi 0:8fdf9a60065b 103 uint16_t startHandle = descriptors.descs[descriptors.count - 1].handle + 1;
kadonotakashi 0:8fdf9a60065b 104 uint16_t endHandle = discovery->getCharacteristic().getLastHandle();
kadonotakashi 0:8fdf9a60065b 105
kadonotakashi 0:8fdf9a60065b 106 if(startHandle > endHandle) {
kadonotakashi 0:8fdf9a60065b 107 terminate(discovery, BLE_ERROR_NONE);
kadonotakashi 0:8fdf9a60065b 108 return;
kadonotakashi 0:8fdf9a60065b 109 }
kadonotakashi 0:8fdf9a60065b 110
kadonotakashi 0:8fdf9a60065b 111 ble_error_t err = gattc_descriptors_discover(connectionHandle, startHandle, endHandle);
kadonotakashi 0:8fdf9a60065b 112 if(err) {
kadonotakashi 0:8fdf9a60065b 113 terminate(discovery, err);
kadonotakashi 0:8fdf9a60065b 114 return;
kadonotakashi 0:8fdf9a60065b 115 }
kadonotakashi 0:8fdf9a60065b 116 }
kadonotakashi 0:8fdf9a60065b 117
kadonotakashi 0:8fdf9a60065b 118 void nRF5xCharacteristicDescriptorDiscoverer::terminate(uint16_t handle, ble_error_t err) {
kadonotakashi 0:8fdf9a60065b 119 Discovery* discovery = findRunningDiscovery(handle);
kadonotakashi 0:8fdf9a60065b 120 // the discovery has already been terminated
kadonotakashi 0:8fdf9a60065b 121 if(!discovery) {
kadonotakashi 0:8fdf9a60065b 122 return;
kadonotakashi 0:8fdf9a60065b 123 }
kadonotakashi 0:8fdf9a60065b 124
kadonotakashi 0:8fdf9a60065b 125 terminate(discovery, err);
kadonotakashi 0:8fdf9a60065b 126 }
kadonotakashi 0:8fdf9a60065b 127
kadonotakashi 0:8fdf9a60065b 128 void nRF5xCharacteristicDescriptorDiscoverer::terminate(Discovery* discovery, ble_error_t err) {
kadonotakashi 0:8fdf9a60065b 129 // temporary copy, user code can try to launch a new discovery in the onTerminate
kadonotakashi 0:8fdf9a60065b 130 // callback. So, this discovery should not appear in such case.
kadonotakashi 0:8fdf9a60065b 131 Discovery tmp = *discovery;
kadonotakashi 0:8fdf9a60065b 132 *discovery = Discovery();
kadonotakashi 0:8fdf9a60065b 133 tmp.terminate(err);
kadonotakashi 0:8fdf9a60065b 134 }
kadonotakashi 0:8fdf9a60065b 135
kadonotakashi 0:8fdf9a60065b 136 nRF5xCharacteristicDescriptorDiscoverer::Discovery*
kadonotakashi 0:8fdf9a60065b 137 nRF5xCharacteristicDescriptorDiscoverer::findRunningDiscovery(const DiscoveredCharacteristic& characteristic) {
kadonotakashi 0:8fdf9a60065b 138 for(size_t i = 0; i < MAXIMUM_CONCURRENT_CONNECTIONS_COUNT; ++i) {
kadonotakashi 0:8fdf9a60065b 139 if((discoveryRunning[i].getCharacteristic() == characteristic) &&
kadonotakashi 0:8fdf9a60065b 140 (discoveryRunning[i].isEmpty() == false)) {
kadonotakashi 0:8fdf9a60065b 141 return &discoveryRunning[i];
kadonotakashi 0:8fdf9a60065b 142 }
kadonotakashi 0:8fdf9a60065b 143 }
kadonotakashi 0:8fdf9a60065b 144 return NULL;
kadonotakashi 0:8fdf9a60065b 145 }
kadonotakashi 0:8fdf9a60065b 146
kadonotakashi 0:8fdf9a60065b 147 nRF5xCharacteristicDescriptorDiscoverer::Discovery*
kadonotakashi 0:8fdf9a60065b 148 nRF5xCharacteristicDescriptorDiscoverer::findRunningDiscovery(uint16_t handle) {
kadonotakashi 0:8fdf9a60065b 149 for(size_t i = 0; i < MAXIMUM_CONCURRENT_CONNECTIONS_COUNT; ++i) {
kadonotakashi 0:8fdf9a60065b 150 if((discoveryRunning[i].getCharacteristic().getConnectionHandle() == handle) &&
kadonotakashi 0:8fdf9a60065b 151 (discoveryRunning[i].isEmpty() == false)) {
kadonotakashi 0:8fdf9a60065b 152 return &discoveryRunning[i];
kadonotakashi 0:8fdf9a60065b 153 }
kadonotakashi 0:8fdf9a60065b 154 }
kadonotakashi 0:8fdf9a60065b 155 return NULL;
kadonotakashi 0:8fdf9a60065b 156 }
kadonotakashi 0:8fdf9a60065b 157
kadonotakashi 0:8fdf9a60065b 158 nRF5xCharacteristicDescriptorDiscoverer::Discovery*
kadonotakashi 0:8fdf9a60065b 159 nRF5xCharacteristicDescriptorDiscoverer::getAvailableDiscoverySlot() {
kadonotakashi 0:8fdf9a60065b 160 for(size_t i = 0; i < MAXIMUM_CONCURRENT_CONNECTIONS_COUNT; ++i) {
kadonotakashi 0:8fdf9a60065b 161 if(discoveryRunning[i].isEmpty()) {
kadonotakashi 0:8fdf9a60065b 162 return &discoveryRunning[i];
kadonotakashi 0:8fdf9a60065b 163 }
kadonotakashi 0:8fdf9a60065b 164 }
kadonotakashi 0:8fdf9a60065b 165 return NULL;
kadonotakashi 0:8fdf9a60065b 166 }
kadonotakashi 0:8fdf9a60065b 167
kadonotakashi 0:8fdf9a60065b 168 bool nRF5xCharacteristicDescriptorDiscoverer::isConnectionInUse(uint16_t connHandle) {
kadonotakashi 0:8fdf9a60065b 169 return findRunningDiscovery(connHandle) != NULL;
kadonotakashi 0:8fdf9a60065b 170 }
kadonotakashi 0:8fdf9a60065b 171
kadonotakashi 0:8fdf9a60065b 172 ble_error_t nRF5xCharacteristicDescriptorDiscoverer::gattc_descriptors_discover(
kadonotakashi 0:8fdf9a60065b 173 uint16_t connection_handle, uint16_t start_handle, uint16_t end_handle) {
kadonotakashi 0:8fdf9a60065b 174
kadonotakashi 0:8fdf9a60065b 175 ble_gattc_handle_range_t discoveryRange = {
kadonotakashi 0:8fdf9a60065b 176 start_handle,
kadonotakashi 0:8fdf9a60065b 177 end_handle
kadonotakashi 0:8fdf9a60065b 178 };
kadonotakashi 0:8fdf9a60065b 179 uint32_t err = sd_ble_gattc_descriptors_discover(connection_handle, &discoveryRange);
kadonotakashi 0:8fdf9a60065b 180
kadonotakashi 0:8fdf9a60065b 181 switch(err) {
kadonotakashi 0:8fdf9a60065b 182 case NRF_SUCCESS:
kadonotakashi 0:8fdf9a60065b 183 return BLE_ERROR_NONE;
kadonotakashi 0:8fdf9a60065b 184 case BLE_ERROR_INVALID_CONN_HANDLE:
kadonotakashi 0:8fdf9a60065b 185 return BLE_ERROR_INVALID_PARAM;
kadonotakashi 0:8fdf9a60065b 186 case NRF_ERROR_INVALID_ADDR:
kadonotakashi 0:8fdf9a60065b 187 return BLE_ERROR_PARAM_OUT_OF_RANGE;
kadonotakashi 0:8fdf9a60065b 188 case NRF_ERROR_BUSY:
kadonotakashi 0:8fdf9a60065b 189 return BLE_STACK_BUSY;
kadonotakashi 0:8fdf9a60065b 190 default:
kadonotakashi 0:8fdf9a60065b 191 return BLE_ERROR_UNSPECIFIED;
kadonotakashi 0:8fdf9a60065b 192 }
kadonotakashi 0:8fdf9a60065b 193 }
kadonotakashi 0:8fdf9a60065b 194
kadonotakashi 0:8fdf9a60065b 195 // implementation of nRF5xCharacteristicDescriptorDiscoverer::Discovery
kadonotakashi 0:8fdf9a60065b 196
kadonotakashi 0:8fdf9a60065b 197 nRF5xCharacteristicDescriptorDiscoverer::Discovery::Discovery() :
kadonotakashi 0:8fdf9a60065b 198 characteristic(), onDiscovery(), onTerminate() {
kadonotakashi 0:8fdf9a60065b 199 }
kadonotakashi 0:8fdf9a60065b 200
kadonotakashi 0:8fdf9a60065b 201 nRF5xCharacteristicDescriptorDiscoverer::Discovery::Discovery(
kadonotakashi 0:8fdf9a60065b 202 const DiscoveredCharacteristic& c, const DiscoveryCallback_t& dCb, const TerminationCallback_t& tCb) :
kadonotakashi 0:8fdf9a60065b 203 characteristic(c), onDiscovery(dCb), onTerminate(tCb) {
kadonotakashi 0:8fdf9a60065b 204 }
kadonotakashi 0:8fdf9a60065b 205
kadonotakashi 0:8fdf9a60065b 206 void nRF5xCharacteristicDescriptorDiscoverer::Discovery::process(
kadonotakashi 0:8fdf9a60065b 207 GattAttribute::Handle_t handle, const UUID& uuid) {
kadonotakashi 0:8fdf9a60065b 208 CharacteristicDescriptorDiscovery::DiscoveryCallbackParams_t params = {
kadonotakashi 0:8fdf9a60065b 209 characteristic,
kadonotakashi 0:8fdf9a60065b 210 DiscoveredCharacteristicDescriptor(
kadonotakashi 0:8fdf9a60065b 211 characteristic.getGattClient(),
kadonotakashi 0:8fdf9a60065b 212 characteristic.getConnectionHandle(),
kadonotakashi 0:8fdf9a60065b 213 handle,
kadonotakashi 0:8fdf9a60065b 214 uuid
kadonotakashi 0:8fdf9a60065b 215 )
kadonotakashi 0:8fdf9a60065b 216 };
kadonotakashi 0:8fdf9a60065b 217 onDiscovery.call(&params);
kadonotakashi 0:8fdf9a60065b 218 }
kadonotakashi 0:8fdf9a60065b 219
kadonotakashi 0:8fdf9a60065b 220 void nRF5xCharacteristicDescriptorDiscoverer::Discovery::terminate(ble_error_t err) {
kadonotakashi 0:8fdf9a60065b 221 CharacteristicDescriptorDiscovery::TerminationCallbackParams_t params = {
kadonotakashi 0:8fdf9a60065b 222 characteristic,
kadonotakashi 0:8fdf9a60065b 223 err
kadonotakashi 0:8fdf9a60065b 224 };
kadonotakashi 0:8fdf9a60065b 225
kadonotakashi 0:8fdf9a60065b 226 onTerminate.call(&params);
kadonotakashi 0:8fdf9a60065b 227 }
kadonotakashi 0:8fdf9a60065b 228
kadonotakashi 0:8fdf9a60065b 229 bool nRF5xCharacteristicDescriptorDiscoverer::Discovery::isEmpty() const {
kadonotakashi 0:8fdf9a60065b 230 return *this == Discovery();
kadonotakashi 0:8fdf9a60065b 231 }
kadonotakashi 0:8fdf9a60065b 232
kadonotakashi 0:8fdf9a60065b 233 const DiscoveredCharacteristic& nRF5xCharacteristicDescriptorDiscoverer::Discovery::getCharacteristic() const {
kadonotakashi 0:8fdf9a60065b 234 return characteristic;
kadonotakashi 0:8fdf9a60065b 235 }