Shuta Nakamae / nRF51822

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.

Fork of nRF51822 by Nordic Semiconductor

btle/btle_gattc.cpp@225:08f36b78e0f1, 2015-06-19 (annotated)

Committer:
rgrover1
Date:
Fri Jun 19 15:55:19 2015 +0100
Revision:
225:08f36b78e0f1
Parent:
224:2f769d79a1b8
Child:
226:416f90600fbe
Synchronized with git rev 9f37001a

Author: Rohit Grover

add DiscoveryStatus::setupDiscovered[SC]()

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rgrover1 194:c99fc3160091 1 /* mbed Microcontroller Library
rgrover1 194:c99fc3160091 2 * Copyright (c) 2006-2013 ARM Limited
rgrover1 194:c99fc3160091 3 *
rgrover1 194:c99fc3160091 4 * Licensed under the Apache License, Version 2.0 (the "License");
rgrover1 194:c99fc3160091 5 * you may not use this file except in compliance with the License.
rgrover1 194:c99fc3160091 6 * You may obtain a copy of the License at
rgrover1 194:c99fc3160091 7 *
rgrover1 194:c99fc3160091 8 * http://www.apache.org/licenses/LICENSE-2.0
rgrover1 194:c99fc3160091 9 *
rgrover1 194:c99fc3160091 10 * Unless required by applicable law or agreed to in writing, software
rgrover1 194:c99fc3160091 11 * distributed under the License is distributed on an "AS IS" BASIS,
rgrover1 194:c99fc3160091 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
rgrover1 194:c99fc3160091 13 * See the License for the specific language governing permissions and
rgrover1 194:c99fc3160091 14 * limitations under the License.
rgrover1 194:c99fc3160091 15 */
rgrover1 194:c99fc3160091 16
rgrover1 194:c99fc3160091 17 #include "btle_gattc.h"
rgrover1 195:061ed80ffbcf 18 #include "UUID.h"
rgrover1 194:c99fc3160091 19
rgrover1 194:c99fc3160091 20 #define BLE_DB_DISCOVERY_MAX_SRV 4 /**< Maximum number of services supported by this module. This also indicates the maximum number of users allowed to be registered to this module. (one user per service). */
rgrover1 194:c99fc3160091 21 #define BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV 4 /**< Maximum number of characteristics per service supported by this module. */
rgrover1 194:c99fc3160091 22
rgrover1 194:c99fc3160091 23 #define SRV_DISC_START_HANDLE 0x0001 /**< The start handle value used during service discovery. */
rgrover1 194:c99fc3160091 24
rgrover1 194:c99fc3160091 25
rgrover1 221:61527a178b9a 26 void launchServiceDiscovery(Gap::Handle_t connectionHandle);
rgrover1 221:61527a178b9a 27 void launchCharacteristicDiscovery(Gap::Handle_t connectionHandle, Gap::Handle_t startHandle, Gap::Handle_t endHandle);
rgrover1 221:61527a178b9a 28
rgrover1 221:61527a178b9a 29
rgrover1 194:c99fc3160091 30 /**@brief Structure for holding information about the service and the characteristics found during
rgrover1 194:c99fc3160091 31 * the discovery process.
rgrover1 194:c99fc3160091 32 */
rgrover1 195:061ed80ffbcf 33 struct DiscoveredService {
rgrover1 195:061ed80ffbcf 34 DiscoveredService() {
rgrover1 195:061ed80ffbcf 35 /* empty */
rgrover1 195:061ed80ffbcf 36 }
rgrover1 195:061ed80ffbcf 37 DiscoveredService(ShortUUIDBytes_t uuidIn, Gap::Handle_t start, Gap::Handle_t end) {
rgrover1 195:061ed80ffbcf 38 setup(uuidIn, start, end);
rgrover1 195:061ed80ffbcf 39 }
rgrover1 195:061ed80ffbcf 40
rgrover1 195:061ed80ffbcf 41 void setup(ShortUUIDBytes_t uuidIn, Gap::Handle_t start, Gap::Handle_t end) {
rgrover1 195:061ed80ffbcf 42 uuid = uuidIn;
rgrover1 195:061ed80ffbcf 43 startHandle = start;
rgrover1 195:061ed80ffbcf 44 endHandle = end;
rgrover1 195:061ed80ffbcf 45 }
rgrover1 201:a13ada00eac7 46
rgrover1 208:12b6b06ffcd6 47 ShortUUIDBytes_t uuid; /**< UUID of the service. */
rgrover1 208:12b6b06ffcd6 48 Gap::Handle_t startHandle; /**< Service Handle Range. */
rgrover1 208:12b6b06ffcd6 49 Gap::Handle_t endHandle; /**< Service Handle Range. */
rgrover1 195:061ed80ffbcf 50 };
rgrover1 194:c99fc3160091 51
rgrover1 210:e7749aec4203 52 /**@brief Structure for holding information about the service and the characteristics found during
rgrover1 210:e7749aec4203 53 * the discovery process.
rgrover1 210:e7749aec4203 54 */
rgrover1 210:e7749aec4203 55 struct DiscoveredCharacteristic {
rgrover1 210:e7749aec4203 56 DiscoveredCharacteristic() {
rgrover1 210:e7749aec4203 57 /* empty */
rgrover1 210:e7749aec4203 58 }
rgrover1 215:36f6796651ab 59 DiscoveredCharacteristic(ShortUUIDBytes_t uuidIn, ble_gatt_char_props_t props, Gap::Handle_t declHandle, Gap::Handle_t valueHandle) {
rgrover1 215:36f6796651ab 60 setup(uuidIn, props, declHandle, valueHandle);
rgrover1 210:e7749aec4203 61 }
rgrover1 210:e7749aec4203 62
rgrover1 215:36f6796651ab 63 void setup(ShortUUIDBytes_t uuidIn, ble_gatt_char_props_t propsIn, Gap::Handle_t declHandleIn, Gap::Handle_t valueHandleIn) {
rgrover1 210:e7749aec4203 64 uuid = uuidIn;
rgrover1 215:36f6796651ab 65 props = propsIn;
rgrover1 215:36f6796651ab 66 declHandle = declHandleIn;
rgrover1 215:36f6796651ab 67 valueHandle = valueHandleIn;
rgrover1 210:e7749aec4203 68 }
rgrover1 210:e7749aec4203 69
rgrover1 215:36f6796651ab 70 ShortUUIDBytes_t uuid;
rgrover1 215:36f6796651ab 71 ble_gatt_char_props_t props;
rgrover1 215:36f6796651ab 72 Gap::Handle_t declHandle; /**< Service Handle Range. */
rgrover1 215:36f6796651ab 73 Gap::Handle_t valueHandle; /**< Service Handle Range. */
rgrover1 210:e7749aec4203 74 };
rgrover1 210:e7749aec4203 75
rgrover1 222:0ba395e1303d 76 struct DiscoveryStatus {
rgrover1 214:196183e51de3 77 void terminateServiceDiscovery(void) {
rgrover1 214:196183e51de3 78 serviceDiscoveryInProgress = false;
rgrover1 214:196183e51de3 79 printf("end of service discovery\r\n");
rgrover1 214:196183e51de3 80 }
rgrover1 214:196183e51de3 81
rgrover1 214:196183e51de3 82 void terminateCharacteristicDiscovery(void) {
rgrover1 214:196183e51de3 83 characteristicDiscoveryInProgress = false;
rgrover1 214:196183e51de3 84 serviceDiscoveryInProgress = true;
rgrover1 217:c57cbfdfb5ca 85 currSrvInd++; /* Progress service index to keep discovery alive. */
rgrover1 214:196183e51de3 86 }
rgrover1 214:196183e51de3 87
rgrover1 214:196183e51de3 88 void resetDiscoveredServices(void) {
rgrover1 214:196183e51de3 89 memset(services, 0, sizeof(DiscoveredService) * BLE_DB_DISCOVERY_MAX_SRV);
rgrover1 214:196183e51de3 90 }
rgrover1 214:196183e51de3 91
rgrover1 214:196183e51de3 92 void serviceDiscoveryStarted(Gap::Handle_t connectionHandle) {
rgrover1 214:196183e51de3 93 connHandle = connectionHandle;
rgrover1 214:196183e51de3 94 srvCount = 0;
rgrover1 214:196183e51de3 95 currSrvInd = 0;
rgrover1 214:196183e51de3 96 serviceDiscoveryInProgress = true;
rgrover1 214:196183e51de3 97 characteristicDiscoveryInProgress = false;
rgrover1 214:196183e51de3 98 }
rgrover1 214:196183e51de3 99
rgrover1 214:196183e51de3 100 void characteristicDiscoveryStarted(Gap::Handle_t connectionHandle) {
rgrover1 214:196183e51de3 101 connHandle = connectionHandle;
rgrover1 214:196183e51de3 102 charCount = 0;
rgrover1 214:196183e51de3 103 currCharInd = 0;
rgrover1 214:196183e51de3 104 characteristicDiscoveryInProgress = true;
rgrover1 214:196183e51de3 105 serviceDiscoveryInProgress = false;
rgrover1 214:196183e51de3 106 }
rgrover1 214:196183e51de3 107
rgrover1 225:08f36b78e0f1 108 void setupDiscoveredServices(const ble_gattc_evt_prim_srvc_disc_rsp_t *response) {
rgrover1 225:08f36b78e0f1 109 currSrvInd = 0;
rgrover1 225:08f36b78e0f1 110 srvCount = response->count;
rgrover1 225:08f36b78e0f1 111
rgrover1 225:08f36b78e0f1 112 for (unsigned serviceIndex = 0; serviceIndex < srvCount; serviceIndex++) {
rgrover1 225:08f36b78e0f1 113 services[serviceIndex].setup(response->services[serviceIndex].uuid.uuid,
rgrover1 225:08f36b78e0f1 114 response->services[serviceIndex].handle_range.start_handle,
rgrover1 225:08f36b78e0f1 115 response->services[serviceIndex].handle_range.end_handle);
rgrover1 225:08f36b78e0f1 116 }
rgrover1 225:08f36b78e0f1 117 }
rgrover1 225:08f36b78e0f1 118
rgrover1 225:08f36b78e0f1 119 void setupDiscoveredCharacteristics(const ble_gattc_evt_char_disc_rsp_t *response) {
rgrover1 225:08f36b78e0f1 120 currCharInd = 0;
rgrover1 225:08f36b78e0f1 121 charCount = response->count;
rgrover1 225:08f36b78e0f1 122
rgrover1 225:08f36b78e0f1 123 for (unsigned charIndex = 0; charIndex < charCount; charIndex++) {
rgrover1 225:08f36b78e0f1 124 characteristics[charIndex].setup(response->chars[charIndex].uuid.uuid,
rgrover1 225:08f36b78e0f1 125 response->chars[charIndex].char_props,
rgrover1 225:08f36b78e0f1 126 response->chars[charIndex].handle_decl,
rgrover1 225:08f36b78e0f1 127 response->chars[charIndex].handle_value);
rgrover1 225:08f36b78e0f1 128 }
rgrover1 225:08f36b78e0f1 129 }
rgrover1 225:08f36b78e0f1 130
rgrover1 223:cfa98ce48348 131 void progressCharacteristicDiscovery() {
rgrover1 223:cfa98ce48348 132 while (characteristicDiscoveryInProgress && (currCharInd < charCount)) {
rgrover1 223:cfa98ce48348 133 printf("%x [%u]\r\n",
rgrover1 223:cfa98ce48348 134 characteristics[currCharInd].uuid,
rgrover1 223:cfa98ce48348 135 characteristics[currCharInd].valueHandle);
rgrover1 223:cfa98ce48348 136 currCharInd++;
rgrover1 223:cfa98ce48348 137 }
rgrover1 223:cfa98ce48348 138
rgrover1 223:cfa98ce48348 139 if (characteristicDiscoveryInProgress) {
rgrover1 223:cfa98ce48348 140 Gap::Handle_t startHandle = characteristics[currCharInd - 1].valueHandle + 1;
rgrover1 223:cfa98ce48348 141 Gap::Handle_t endHandle = services[currSrvInd].endHandle;
rgrover1 223:cfa98ce48348 142
rgrover1 223:cfa98ce48348 143 if (startHandle < endHandle) {
rgrover1 223:cfa98ce48348 144 ble_gattc_handle_range_t handleRange = {
rgrover1 223:cfa98ce48348 145 .start_handle = startHandle,
rgrover1 223:cfa98ce48348 146 .end_handle = endHandle
rgrover1 223:cfa98ce48348 147 };
rgrover1 223:cfa98ce48348 148 printf("char discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connHandle, &handleRange));
rgrover1 223:cfa98ce48348 149 } else {
rgrover1 223:cfa98ce48348 150 terminateCharacteristicDiscovery();
rgrover1 223:cfa98ce48348 151 }
rgrover1 223:cfa98ce48348 152 }
rgrover1 223:cfa98ce48348 153 }
rgrover1 223:cfa98ce48348 154
rgrover1 223:cfa98ce48348 155 void progressServiceDiscovery() {
rgrover1 223:cfa98ce48348 156 while (serviceDiscoveryInProgress && (currSrvInd < srvCount)) {
rgrover1 223:cfa98ce48348 157 printf("%x [%u %u]\r\n",
rgrover1 223:cfa98ce48348 158 services[currSrvInd].uuid,
rgrover1 223:cfa98ce48348 159 services[currSrvInd].startHandle,
rgrover1 223:cfa98ce48348 160 services[currSrvInd].endHandle);
rgrover1 223:cfa98ce48348 161
rgrover1 223:cfa98ce48348 162 launchCharacteristicDiscovery(connHandle, services[currSrvInd].startHandle, services[currSrvInd].endHandle);
rgrover1 223:cfa98ce48348 163 }
rgrover1 223:cfa98ce48348 164 if (serviceDiscoveryInProgress && (srvCount > 0) && (currSrvInd > 0)) {
rgrover1 223:cfa98ce48348 165 Gap::Handle_t endHandle = services[currSrvInd - 1].endHandle;
rgrover1 223:cfa98ce48348 166 resetDiscoveredServices();
rgrover1 223:cfa98ce48348 167 printf("services discover returned %u\r\n",
rgrover1 223:cfa98ce48348 168 sd_ble_gattc_primary_services_discover(connHandle, endHandle, NULL));
rgrover1 223:cfa98ce48348 169 }
rgrover1 223:cfa98ce48348 170 }
rgrover1 223:cfa98ce48348 171
rgrover1 216:3443c78324b6 172 DiscoveredService services[BLE_DB_DISCOVERY_MAX_SRV]; /**< Information related to the current service being discovered.
rgrover1 216:3443c78324b6 173 * This is intended for internal use during service discovery. */
rgrover1 216:3443c78324b6 174 DiscoveredCharacteristic characteristics[BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV];
rgrover1 205:7b1c55e70f45 175
rgrover1 206:d8c5b97557f2 176 uint16_t connHandle; /**< Connection handle as provided by the SoftDevice. */
rgrover1 209:d24159a1dad5 177 uint8_t currSrvInd; /**< Index of the current service being discovered. This is intended for internal use during service discovery.*/
rgrover1 206:d8c5b97557f2 178 uint8_t srvCount; /**< Number of services at the peers GATT database.*/
rgrover1 206:d8c5b97557f2 179 uint8_t currCharInd; /**< Index of the current characteristic being discovered. This is intended for internal use during service discovery.*/
rgrover1 209:d24159a1dad5 180 uint8_t charCount; /**< Number of characteristics within the service.*/
rgrover1 206:d8c5b97557f2 181
rgrover1 206:d8c5b97557f2 182 bool serviceDiscoveryInProgress;
rgrover1 206:d8c5b97557f2 183 bool characteristicDiscoveryInProgress;
rgrover1 198:a69d3d4797e8 184 };
rgrover1 194:c99fc3160091 185
rgrover1 222:0ba395e1303d 186 static DiscoveryStatus discoveryStatus;
rgrover1 195:061ed80ffbcf 187
rgrover1 194:c99fc3160091 188 void launchServiceDiscovery(Gap::Handle_t connectionHandle)
rgrover1 194:c99fc3160091 189 {
rgrover1 214:196183e51de3 190 discoveryStatus.serviceDiscoveryStarted(connectionHandle);
rgrover1 194:c99fc3160091 191 printf("launch service discovery returned %u\r\n", sd_ble_gattc_primary_services_discover(connectionHandle, SRV_DISC_START_HANDLE, NULL));
rgrover1 194:c99fc3160091 192 }
rgrover1 194:c99fc3160091 193
rgrover1 202:3ce954ce3eb8 194 void launchCharacteristicDiscovery(Gap::Handle_t connectionHandle, Gap::Handle_t startHandle, Gap::Handle_t endHandle) {
rgrover1 214:196183e51de3 195 discoveryStatus.characteristicDiscoveryStarted(connectionHandle);
rgrover1 211:bf81b20ede23 196
rgrover1 211:bf81b20ede23 197 ble_gattc_handle_range_t handleRange = {
rgrover1 211:bf81b20ede23 198 .start_handle = startHandle,
rgrover1 211:bf81b20ede23 199 .end_handle = endHandle
rgrover1 211:bf81b20ede23 200 };
rgrover1 211:bf81b20ede23 201 printf("launch characteristic discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connectionHandle, &handleRange));
rgrover1 202:3ce954ce3eb8 202 }
rgrover1 202:3ce954ce3eb8 203
rgrover1 194:c99fc3160091 204 void bleGattcEventHandler(const ble_evt_t *p_ble_evt)
rgrover1 194:c99fc3160091 205 {
rgrover1 194:c99fc3160091 206 switch (p_ble_evt->header.evt_id) {
rgrover1 194:c99fc3160091 207 case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP:
rgrover1 194:c99fc3160091 208 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 194:c99fc3160091 209 case BLE_GATT_STATUS_SUCCESS: {
rgrover1 225:08f36b78e0f1 210 discoveryStatus.setupDiscoveredServices(&p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp);
rgrover1 195:061ed80ffbcf 211 break;
rgrover1 194:c99fc3160091 212 }
rgrover1 195:061ed80ffbcf 213
rgrover1 194:c99fc3160091 214 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: {
rgrover1 214:196183e51de3 215 discoveryStatus.terminateServiceDiscovery();
rgrover1 194:c99fc3160091 216 break;
rgrover1 194:c99fc3160091 217 }
rgrover1 195:061ed80ffbcf 218
rgrover1 194:c99fc3160091 219 default: {
rgrover1 197:de757ae3358b 220 discoveryStatus.serviceDiscoveryInProgress = false;
rgrover1 194:c99fc3160091 221 printf("gatt failure status: %u\r\n", p_ble_evt->evt.gattc_evt.gatt_status);
rgrover1 194:c99fc3160091 222 break;
rgrover1 194:c99fc3160091 223 }
rgrover1 194:c99fc3160091 224 }
rgrover1 194:c99fc3160091 225 break;
rgrover1 194:c99fc3160091 226
rgrover1 194:c99fc3160091 227 case BLE_GATTC_EVT_CHAR_DISC_RSP: {
rgrover1 194:c99fc3160091 228 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 212:f2316b17d8be 229 case BLE_GATT_STATUS_SUCCESS: {
rgrover1 225:08f36b78e0f1 230 discoveryStatus.setupDiscoveredCharacteristics(&p_ble_evt->evt.gattc_evt.params.char_disc_rsp);
rgrover1 219:681be3608738 231 break;
rgrover1 212:f2316b17d8be 232 }
rgrover1 212:f2316b17d8be 233
rgrover1 212:f2316b17d8be 234 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: {
rgrover1 214:196183e51de3 235 discoveryStatus.terminateCharacteristicDiscovery();
rgrover1 212:f2316b17d8be 236 break;
rgrover1 212:f2316b17d8be 237 }
rgrover1 212:f2316b17d8be 238
rgrover1 194:c99fc3160091 239 default:
rgrover1 212:f2316b17d8be 240 printf("char response: gatt failure status: %u\r\n", p_ble_evt->evt.gattc_evt.gatt_status);
rgrover1 194:c99fc3160091 241 break;
rgrover1 194:c99fc3160091 242 }
rgrover1 194:c99fc3160091 243 break;
rgrover1 194:c99fc3160091 244 }
rgrover1 194:c99fc3160091 245 }
rgrover1 195:061ed80ffbcf 246
rgrover1 223:cfa98ce48348 247 discoveryStatus.progressCharacteristicDiscovery();
rgrover1 223:cfa98ce48348 248 discoveryStatus.progressServiceDiscovery();
rgrover1 194:c99fc3160091 249 }