aa
Dependents: Peripheral_1_serial_copy Peripheral_1_serial 151006_1st_Scenario_normal
Fork of nRF51822 by
btle/btle_discovery.cpp@280:cbaa4cb83548, 2015-06-19 (annotated)
- Committer:
- rgrover1
- Date:
- Fri Jun 19 15:55:26 2015 +0100
- Revision:
- 280:cbaa4cb83548
- Parent:
- 279:6e5e79f1fb61
- Child:
- 281:2280bb1a9a9e
Synchronized with git rev 7a7b768e
Author: Rohit Grover
get onTerminationCallback invoked at the end of serviceDiscovery
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
rgrover1 | 243:a966506d1e5b | 1 | /* mbed Microcontroller Library |
rgrover1 | 243:a966506d1e5b | 2 | * Copyright (c) 2006-2013 ARM Limited |
rgrover1 | 243:a966506d1e5b | 3 | * |
rgrover1 | 243:a966506d1e5b | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
rgrover1 | 243:a966506d1e5b | 5 | * you may not use this file except in compliance with the License. |
rgrover1 | 243:a966506d1e5b | 6 | * You may obtain a copy of the License at |
rgrover1 | 243:a966506d1e5b | 7 | * |
rgrover1 | 243:a966506d1e5b | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
rgrover1 | 243:a966506d1e5b | 9 | * |
rgrover1 | 243:a966506d1e5b | 10 | * Unless required by applicable law or agreed to in writing, software |
rgrover1 | 243:a966506d1e5b | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
rgrover1 | 243:a966506d1e5b | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
rgrover1 | 243:a966506d1e5b | 13 | * See the License for the specific language governing permissions and |
rgrover1 | 243:a966506d1e5b | 14 | * limitations under the License. |
rgrover1 | 243:a966506d1e5b | 15 | */ |
rgrover1 | 243:a966506d1e5b | 16 | |
rgrover1 | 239:693a1f145b5a | 17 | #include "blecommon.h" |
rgrover1 | 239:693a1f145b5a | 18 | #include "UUID.h" |
rgrover1 | 239:693a1f145b5a | 19 | #include "Gap.h" |
rgrover1 | 239:693a1f145b5a | 20 | #include "nrf_error.h" |
rgrover1 | 239:693a1f145b5a | 21 | #include "btle_discovery.h" |
rgrover1 | 239:693a1f145b5a | 22 | #include "ble_err.h" |
rgrover1 | 243:a966506d1e5b | 23 | |
rgrover1 | 278:26e3f0ef1e14 | 24 | static NordicServiceDiscovery sdSingleton; |
rgrover1 | 239:693a1f145b5a | 25 | |
rgrover1 | 239:693a1f145b5a | 26 | ble_error_t |
rgrover1 | 275:fd709cd8b1b2 | 27 | ServiceDiscovery::launch(Gap::Handle_t connectionHandle, |
rgrover1 | 275:fd709cd8b1b2 | 28 | ServiceCallback_t sc, |
rgrover1 | 275:fd709cd8b1b2 | 29 | CharacteristicCallback_t cc, |
rgrover1 | 275:fd709cd8b1b2 | 30 | const UUID &matchingServiceUUIDIn, |
rgrover1 | 275:fd709cd8b1b2 | 31 | const UUID &matchingCharacteristicUUIDIn) |
rgrover1 | 239:693a1f145b5a | 32 | { |
rgrover1 | 278:26e3f0ef1e14 | 33 | sdSingleton.serviceCallback = sc; |
rgrover1 | 278:26e3f0ef1e14 | 34 | sdSingleton.characteristicCallback = cc; |
rgrover1 | 278:26e3f0ef1e14 | 35 | sdSingleton.matchingServiceUUID = matchingServiceUUIDIn; |
rgrover1 | 278:26e3f0ef1e14 | 36 | sdSingleton.matchingCharacteristicUUID = matchingCharacteristicUUIDIn; |
rgrover1 | 273:8ada9e8111a3 | 37 | |
rgrover1 | 278:26e3f0ef1e14 | 38 | sdSingleton.serviceDiscoveryStarted(connectionHandle); |
rgrover1 | 239:693a1f145b5a | 39 | |
rgrover1 | 239:693a1f145b5a | 40 | uint32_t rc; |
rgrover1 | 248:71ef03789dd3 | 41 | if ((rc = sd_ble_gattc_primary_services_discover(connectionHandle, NordicServiceDiscovery::SRV_DISC_START_HANDLE, NULL)) != NRF_SUCCESS) { |
rgrover1 | 278:26e3f0ef1e14 | 42 | sdSingleton.terminate(); |
rgrover1 | 239:693a1f145b5a | 43 | switch (rc) { |
rgrover1 | 239:693a1f145b5a | 44 | case NRF_ERROR_INVALID_PARAM: |
rgrover1 | 239:693a1f145b5a | 45 | case BLE_ERROR_INVALID_CONN_HANDLE: |
rgrover1 | 239:693a1f145b5a | 46 | return BLE_ERROR_INVALID_PARAM; |
rgrover1 | 239:693a1f145b5a | 47 | case NRF_ERROR_BUSY: |
rgrover1 | 239:693a1f145b5a | 48 | return BLE_STACK_BUSY; |
rgrover1 | 239:693a1f145b5a | 49 | default: |
rgrover1 | 239:693a1f145b5a | 50 | case NRF_ERROR_INVALID_STATE: |
rgrover1 | 239:693a1f145b5a | 51 | return BLE_ERROR_INVALID_STATE; |
rgrover1 | 239:693a1f145b5a | 52 | } |
rgrover1 | 239:693a1f145b5a | 53 | } |
rgrover1 | 239:693a1f145b5a | 54 | |
rgrover1 | 239:693a1f145b5a | 55 | return BLE_ERROR_NONE; |
rgrover1 | 239:693a1f145b5a | 56 | } |
rgrover1 | 239:693a1f145b5a | 57 | |
rgrover1 | 248:71ef03789dd3 | 58 | void |
rgrover1 | 248:71ef03789dd3 | 59 | ServiceDiscovery::terminate(void) |
rgrover1 | 248:71ef03789dd3 | 60 | { |
rgrover1 | 278:26e3f0ef1e14 | 61 | sdSingleton.terminateServiceDiscovery(); |
rgrover1 | 248:71ef03789dd3 | 62 | } |
rgrover1 | 248:71ef03789dd3 | 63 | |
rgrover1 | 279:6e5e79f1fb61 | 64 | bool |
rgrover1 | 279:6e5e79f1fb61 | 65 | ServiceDiscovery::isActive(void) |
rgrover1 | 279:6e5e79f1fb61 | 66 | { |
rgrover1 | 279:6e5e79f1fb61 | 67 | return sdSingleton.isActive(); |
rgrover1 | 279:6e5e79f1fb61 | 68 | } |
rgrover1 | 279:6e5e79f1fb61 | 69 | |
rgrover1 | 280:cbaa4cb83548 | 70 | void ServiceDiscovery::onTermination(TerminationCallback_t callback) { |
rgrover1 | 280:cbaa4cb83548 | 71 | sdSingleton.setOnTermination(callback); |
rgrover1 | 280:cbaa4cb83548 | 72 | } |
rgrover1 | 280:cbaa4cb83548 | 73 | |
rgrover1 | 243:a966506d1e5b | 74 | ble_error_t |
rgrover1 | 252:4b3f294415f5 | 75 | NordicServiceDiscovery::launchCharacteristicDiscovery(Gap::Handle_t connectionHandle, |
rgrover1 | 252:4b3f294415f5 | 76 | Gap::Handle_t startHandle, |
rgrover1 | 252:4b3f294415f5 | 77 | Gap::Handle_t endHandle) |
rgrover1 | 252:4b3f294415f5 | 78 | { |
rgrover1 | 278:26e3f0ef1e14 | 79 | sdSingleton.characteristicDiscoveryStarted(connectionHandle); |
rgrover1 | 239:693a1f145b5a | 80 | |
rgrover1 | 239:693a1f145b5a | 81 | ble_gattc_handle_range_t handleRange = { |
rgrover1 | 239:693a1f145b5a | 82 | .start_handle = startHandle, |
rgrover1 | 239:693a1f145b5a | 83 | .end_handle = endHandle |
rgrover1 | 239:693a1f145b5a | 84 | }; |
rgrover1 | 239:693a1f145b5a | 85 | uint32_t rc; |
rgrover1 | 239:693a1f145b5a | 86 | if ((rc = sd_ble_gattc_characteristics_discover(connectionHandle, &handleRange)) != NRF_SUCCESS) { |
rgrover1 | 278:26e3f0ef1e14 | 87 | sdSingleton.terminateCharacteristicDiscovery(); |
rgrover1 | 239:693a1f145b5a | 88 | switch (rc) { |
rgrover1 | 239:693a1f145b5a | 89 | case BLE_ERROR_INVALID_CONN_HANDLE: |
rgrover1 | 239:693a1f145b5a | 90 | case NRF_ERROR_INVALID_ADDR: |
rgrover1 | 239:693a1f145b5a | 91 | return BLE_ERROR_INVALID_PARAM; |
rgrover1 | 239:693a1f145b5a | 92 | case NRF_ERROR_BUSY: |
rgrover1 | 239:693a1f145b5a | 93 | return BLE_STACK_BUSY; |
rgrover1 | 239:693a1f145b5a | 94 | default: |
rgrover1 | 239:693a1f145b5a | 95 | case NRF_ERROR_INVALID_STATE: |
rgrover1 | 239:693a1f145b5a | 96 | return BLE_ERROR_INVALID_STATE; |
rgrover1 | 239:693a1f145b5a | 97 | } |
rgrover1 | 239:693a1f145b5a | 98 | } |
rgrover1 | 239:693a1f145b5a | 99 | |
rgrover1 | 239:693a1f145b5a | 100 | return BLE_ERROR_NONE; |
rgrover1 | 239:693a1f145b5a | 101 | } |
rgrover1 | 239:693a1f145b5a | 102 | |
rgrover1 | 239:693a1f145b5a | 103 | void |
rgrover1 | 240:75b69581d1dd | 104 | NordicServiceDiscovery::setupDiscoveredServices(const ble_gattc_evt_prim_srvc_disc_rsp_t *response) |
rgrover1 | 239:693a1f145b5a | 105 | { |
rgrover1 | 242:73fc02cc20b1 | 106 | serviceIndex = 0; |
rgrover1 | 242:73fc02cc20b1 | 107 | numServices = response->count; |
rgrover1 | 239:693a1f145b5a | 108 | |
rgrover1 | 239:693a1f145b5a | 109 | /* Account for the limitation on the number of discovered services we can handle at a time. */ |
rgrover1 | 242:73fc02cc20b1 | 110 | if (numServices > BLE_DB_DISCOVERY_MAX_SRV) { |
rgrover1 | 242:73fc02cc20b1 | 111 | numServices = BLE_DB_DISCOVERY_MAX_SRV; |
rgrover1 | 239:693a1f145b5a | 112 | } |
rgrover1 | 239:693a1f145b5a | 113 | |
rgrover1 | 242:73fc02cc20b1 | 114 | for (unsigned serviceIndex = 0; serviceIndex < numServices; serviceIndex++) { |
rgrover1 | 239:693a1f145b5a | 115 | services[serviceIndex].setup(response->services[serviceIndex].uuid.uuid, |
rgrover1 | 239:693a1f145b5a | 116 | response->services[serviceIndex].handle_range.start_handle, |
rgrover1 | 239:693a1f145b5a | 117 | response->services[serviceIndex].handle_range.end_handle); |
rgrover1 | 239:693a1f145b5a | 118 | } |
rgrover1 | 239:693a1f145b5a | 119 | } |
rgrover1 | 239:693a1f145b5a | 120 | |
rgrover1 | 239:693a1f145b5a | 121 | void |
rgrover1 | 240:75b69581d1dd | 122 | NordicServiceDiscovery::setupDiscoveredCharacteristics(const ble_gattc_evt_char_disc_rsp_t *response) |
rgrover1 | 239:693a1f145b5a | 123 | { |
rgrover1 | 242:73fc02cc20b1 | 124 | characteristicIndex = 0; |
rgrover1 | 242:73fc02cc20b1 | 125 | numCharacteristics = response->count; |
rgrover1 | 239:693a1f145b5a | 126 | |
rgrover1 | 239:693a1f145b5a | 127 | /* Account for the limitation on the number of discovered characteristics we can handle at a time. */ |
rgrover1 | 242:73fc02cc20b1 | 128 | if (numCharacteristics > BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV) { |
rgrover1 | 242:73fc02cc20b1 | 129 | numCharacteristics = BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV; |
rgrover1 | 239:693a1f145b5a | 130 | } |
rgrover1 | 239:693a1f145b5a | 131 | |
rgrover1 | 242:73fc02cc20b1 | 132 | for (unsigned charIndex = 0; charIndex < numCharacteristics; charIndex++) { |
rgrover1 | 239:693a1f145b5a | 133 | characteristics[charIndex].setup(response->chars[charIndex].uuid.uuid, |
rgrover1 | 239:693a1f145b5a | 134 | *(const uint8_t *)(&response->chars[charIndex].char_props), |
rgrover1 | 239:693a1f145b5a | 135 | response->chars[charIndex].handle_decl, |
rgrover1 | 239:693a1f145b5a | 136 | response->chars[charIndex].handle_value); |
rgrover1 | 239:693a1f145b5a | 137 | } |
rgrover1 | 243:a966506d1e5b | 138 | } |
rgrover1 | 243:a966506d1e5b | 139 | |
rgrover1 | 251:d4e0cf5e8751 | 140 | void |
rgrover1 | 251:d4e0cf5e8751 | 141 | NordicServiceDiscovery::progressCharacteristicDiscovery(void) |
rgrover1 | 251:d4e0cf5e8751 | 142 | { |
rgrover1 | 276:ae6e5129b395 | 143 | /* Iterate through the previously discovered characteristics cached in characteristics[]. */ |
rgrover1 | 251:d4e0cf5e8751 | 144 | while (cDiscoveryActive && (characteristicIndex < numCharacteristics)) { |
rgrover1 | 255:d228656b0cd1 | 145 | if (characteristicCallback) { |
rgrover1 | 255:d228656b0cd1 | 146 | characteristicCallback(characteristics[characteristicIndex]); |
rgrover1 | 255:d228656b0cd1 | 147 | } |
rgrover1 | 251:d4e0cf5e8751 | 148 | |
rgrover1 | 251:d4e0cf5e8751 | 149 | characteristicIndex++; |
rgrover1 | 251:d4e0cf5e8751 | 150 | } |
rgrover1 | 251:d4e0cf5e8751 | 151 | |
rgrover1 | 276:ae6e5129b395 | 152 | /* Relaunch discovery of new characteristics beyond the last entry cached in characteristics[]. */ |
rgrover1 | 251:d4e0cf5e8751 | 153 | if (cDiscoveryActive) { |
rgrover1 | 276:ae6e5129b395 | 154 | /* Determine the ending handle of the last cached characteristic. */ |
rgrover1 | 264:5533ac0adf4b | 155 | Gap::Handle_t startHandle = characteristics[characteristicIndex - 1].getValueHandle() + 1; |
rgrover1 | 264:5533ac0adf4b | 156 | Gap::Handle_t endHandle = services[serviceIndex].getEndHandle(); |
rgrover1 | 274:f82e0ecba699 | 157 | resetDiscoveredCharacteristics(); /* Note: resetDiscoveredCharacteristics() must come after fetching start and end Handles. */ |
rgrover1 | 251:d4e0cf5e8751 | 158 | |
rgrover1 | 251:d4e0cf5e8751 | 159 | if (startHandle < endHandle) { |
rgrover1 | 251:d4e0cf5e8751 | 160 | ble_gattc_handle_range_t handleRange = { |
rgrover1 | 251:d4e0cf5e8751 | 161 | .start_handle = startHandle, |
rgrover1 | 251:d4e0cf5e8751 | 162 | .end_handle = endHandle |
rgrover1 | 251:d4e0cf5e8751 | 163 | }; |
rgrover1 | 258:62d6bf03e6a4 | 164 | if (sd_ble_gattc_characteristics_discover(connHandle, &handleRange) != NRF_SUCCESS) { |
rgrover1 | 258:62d6bf03e6a4 | 165 | terminateCharacteristicDiscovery(); |
rgrover1 | 258:62d6bf03e6a4 | 166 | } |
rgrover1 | 251:d4e0cf5e8751 | 167 | } else { |
rgrover1 | 277:91705df8495e | 168 | terminateCharacteristicDiscovery(); |
rgrover1 | 251:d4e0cf5e8751 | 169 | } |
rgrover1 | 251:d4e0cf5e8751 | 170 | } |
rgrover1 | 251:d4e0cf5e8751 | 171 | } |
rgrover1 | 251:d4e0cf5e8751 | 172 | |
rgrover1 | 251:d4e0cf5e8751 | 173 | void |
rgrover1 | 251:d4e0cf5e8751 | 174 | NordicServiceDiscovery::progressServiceDiscovery(void) |
rgrover1 | 251:d4e0cf5e8751 | 175 | { |
rgrover1 | 276:ae6e5129b395 | 176 | /* Iterate through the previously discovered services cached in services[]. */ |
rgrover1 | 251:d4e0cf5e8751 | 177 | while (sDiscoveryActive && (serviceIndex < numServices)) { |
rgrover1 | 277:91705df8495e | 178 | if ((matchingServiceUUID == ShortUUIDBytes_t(BLE_UUID_UNKNOWN)) || |
rgrover1 | 277:91705df8495e | 179 | (matchingServiceUUID == services[serviceIndex].getShortUUID())) { |
rgrover1 | 277:91705df8495e | 180 | if (serviceCallback) { |
rgrover1 | 277:91705df8495e | 181 | serviceCallback(services[serviceIndex]); |
rgrover1 | 277:91705df8495e | 182 | } |
rgrover1 | 251:d4e0cf5e8751 | 183 | |
rgrover1 | 277:91705df8495e | 184 | if (sDiscoveryActive && characteristicCallback) { |
rgrover1 | 277:91705df8495e | 185 | launchCharacteristicDiscovery(connHandle, services[serviceIndex].getStartHandle(), services[serviceIndex].getEndHandle()); |
rgrover1 | 277:91705df8495e | 186 | } else { |
rgrover1 | 277:91705df8495e | 187 | serviceIndex++; |
rgrover1 | 277:91705df8495e | 188 | } |
rgrover1 | 251:d4e0cf5e8751 | 189 | } else { |
rgrover1 | 277:91705df8495e | 190 | serviceIndex++; |
rgrover1 | 251:d4e0cf5e8751 | 191 | } |
rgrover1 | 251:d4e0cf5e8751 | 192 | } |
rgrover1 | 276:ae6e5129b395 | 193 | |
rgrover1 | 276:ae6e5129b395 | 194 | /* Relaunch discovery of new services beyond the last entry cached in services[]. */ |
rgrover1 | 251:d4e0cf5e8751 | 195 | if (sDiscoveryActive && (numServices > 0) && (serviceIndex > 0)) { |
rgrover1 | 276:ae6e5129b395 | 196 | /* Determine the ending handle of the last cached service. */ |
rgrover1 | 264:5533ac0adf4b | 197 | Gap::Handle_t endHandle = services[serviceIndex - 1].getEndHandle(); |
rgrover1 | 274:f82e0ecba699 | 198 | resetDiscoveredServices(); /* Note: resetDiscoveredServices() must come after fetching endHandle. */ |
rgrover1 | 251:d4e0cf5e8751 | 199 | |
rgrover1 | 258:62d6bf03e6a4 | 200 | if (sd_ble_gattc_primary_services_discover(connHandle, endHandle, NULL) != NRF_SUCCESS) { |
rgrover1 | 258:62d6bf03e6a4 | 201 | terminateServiceDiscovery(); |
rgrover1 | 258:62d6bf03e6a4 | 202 | } |
rgrover1 | 251:d4e0cf5e8751 | 203 | } |
rgrover1 | 251:d4e0cf5e8751 | 204 | } |
rgrover1 | 251:d4e0cf5e8751 | 205 | |
rgrover1 | 243:a966506d1e5b | 206 | void bleGattcEventHandler(const ble_evt_t *p_ble_evt) |
rgrover1 | 243:a966506d1e5b | 207 | { |
rgrover1 | 243:a966506d1e5b | 208 | switch (p_ble_evt->header.evt_id) { |
rgrover1 | 243:a966506d1e5b | 209 | case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP: |
rgrover1 | 243:a966506d1e5b | 210 | switch (p_ble_evt->evt.gattc_evt.gatt_status) { |
rgrover1 | 243:a966506d1e5b | 211 | case BLE_GATT_STATUS_SUCCESS: |
rgrover1 | 278:26e3f0ef1e14 | 212 | sdSingleton.setupDiscoveredServices(&p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp); |
rgrover1 | 243:a966506d1e5b | 213 | break; |
rgrover1 | 243:a966506d1e5b | 214 | |
rgrover1 | 243:a966506d1e5b | 215 | case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: |
rgrover1 | 243:a966506d1e5b | 216 | default: |
rgrover1 | 278:26e3f0ef1e14 | 217 | sdSingleton.terminate(); |
rgrover1 | 243:a966506d1e5b | 218 | break; |
rgrover1 | 243:a966506d1e5b | 219 | } |
rgrover1 | 243:a966506d1e5b | 220 | break; |
rgrover1 | 243:a966506d1e5b | 221 | |
rgrover1 | 243:a966506d1e5b | 222 | case BLE_GATTC_EVT_CHAR_DISC_RSP: |
rgrover1 | 243:a966506d1e5b | 223 | switch (p_ble_evt->evt.gattc_evt.gatt_status) { |
rgrover1 | 243:a966506d1e5b | 224 | case BLE_GATT_STATUS_SUCCESS: |
rgrover1 | 278:26e3f0ef1e14 | 225 | sdSingleton.setupDiscoveredCharacteristics(&p_ble_evt->evt.gattc_evt.params.char_disc_rsp); |
rgrover1 | 243:a966506d1e5b | 226 | break; |
rgrover1 | 243:a966506d1e5b | 227 | |
rgrover1 | 243:a966506d1e5b | 228 | case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: |
rgrover1 | 243:a966506d1e5b | 229 | default: |
rgrover1 | 278:26e3f0ef1e14 | 230 | sdSingleton.terminateCharacteristicDiscovery(); |
rgrover1 | 243:a966506d1e5b | 231 | break; |
rgrover1 | 243:a966506d1e5b | 232 | } |
rgrover1 | 243:a966506d1e5b | 233 | break; |
rgrover1 | 243:a966506d1e5b | 234 | } |
rgrover1 | 243:a966506d1e5b | 235 | |
rgrover1 | 278:26e3f0ef1e14 | 236 | sdSingleton.progressCharacteristicDiscovery(); |
rgrover1 | 278:26e3f0ef1e14 | 237 | sdSingleton.progressServiceDiscovery(); |
rgrover1 | 239:693a1f145b5a | 238 | } |