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@228:0c14d4e5207b, 2015-06-19 (annotated)

Committer:
rgrover1
Date:
Fri Jun 19 15:55:20 2015 +0100
Revision:
228:0c14d4e5207b
Parent:
227:7a0bb8545c75
Child:
229:6394db9a71ba
Synchronized with git rev 442ce247

Author: Rohit Grover

remove some debugging printfs.

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 void setup(ShortUUIDBytes_t uuidIn, Gap::Handle_t start, Gap::Handle_t end) {
rgrover1 195:061ed80ffbcf 35 uuid = uuidIn;
rgrover1 195:061ed80ffbcf 36 startHandle = start;
rgrover1 195:061ed80ffbcf 37 endHandle = end;
rgrover1 195:061ed80ffbcf 38 }
rgrover1 201:a13ada00eac7 39
rgrover1 208:12b6b06ffcd6 40 ShortUUIDBytes_t uuid; /**< UUID of the service. */
rgrover1 208:12b6b06ffcd6 41 Gap::Handle_t startHandle; /**< Service Handle Range. */
rgrover1 208:12b6b06ffcd6 42 Gap::Handle_t endHandle; /**< Service Handle Range. */
rgrover1 195:061ed80ffbcf 43 };
rgrover1 194:c99fc3160091 44
rgrover1 210:e7749aec4203 45 /**@brief Structure for holding information about the service and the characteristics found during
rgrover1 210:e7749aec4203 46 * the discovery process.
rgrover1 210:e7749aec4203 47 */
rgrover1 210:e7749aec4203 48 struct DiscoveredCharacteristic {
rgrover1 215:36f6796651ab 49 void setup(ShortUUIDBytes_t uuidIn, ble_gatt_char_props_t propsIn, Gap::Handle_t declHandleIn, Gap::Handle_t valueHandleIn) {
rgrover1 210:e7749aec4203 50 uuid = uuidIn;
rgrover1 215:36f6796651ab 51 props = propsIn;
rgrover1 215:36f6796651ab 52 declHandle = declHandleIn;
rgrover1 215:36f6796651ab 53 valueHandle = valueHandleIn;
rgrover1 210:e7749aec4203 54 }
rgrover1 210:e7749aec4203 55
rgrover1 215:36f6796651ab 56 ShortUUIDBytes_t uuid;
rgrover1 215:36f6796651ab 57 ble_gatt_char_props_t props;
rgrover1 215:36f6796651ab 58 Gap::Handle_t declHandle; /**< Service Handle Range. */
rgrover1 215:36f6796651ab 59 Gap::Handle_t valueHandle; /**< Service Handle Range. */
rgrover1 210:e7749aec4203 60 };
rgrover1 210:e7749aec4203 61
rgrover1 222:0ba395e1303d 62 struct DiscoveryStatus {
rgrover1 214:196183e51de3 63 void terminateServiceDiscovery(void) {
rgrover1 214:196183e51de3 64 serviceDiscoveryInProgress = false;
rgrover1 214:196183e51de3 65 printf("end of service discovery\r\n");
rgrover1 214:196183e51de3 66 }
rgrover1 214:196183e51de3 67
rgrover1 214:196183e51de3 68 void terminateCharacteristicDiscovery(void) {
rgrover1 214:196183e51de3 69 characteristicDiscoveryInProgress = false;
rgrover1 214:196183e51de3 70 serviceDiscoveryInProgress = true;
rgrover1 217:c57cbfdfb5ca 71 currSrvInd++; /* Progress service index to keep discovery alive. */
rgrover1 214:196183e51de3 72 }
rgrover1 214:196183e51de3 73
rgrover1 214:196183e51de3 74 void resetDiscoveredServices(void) {
rgrover1 227:7a0bb8545c75 75 srvCount = 0;
rgrover1 227:7a0bb8545c75 76 currSrvInd = 0;
rgrover1 214:196183e51de3 77 memset(services, 0, sizeof(DiscoveredService) * BLE_DB_DISCOVERY_MAX_SRV);
rgrover1 214:196183e51de3 78 }
rgrover1 214:196183e51de3 79
rgrover1 227:7a0bb8545c75 80 void resetDiscoveredCharacteristics(void) {
rgrover1 227:7a0bb8545c75 81 charCount = 0;
rgrover1 227:7a0bb8545c75 82 currCharInd = 0;
rgrover1 227:7a0bb8545c75 83 memset(characteristics, 0, sizeof(DiscoveredCharacteristic) * BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV);
rgrover1 227:7a0bb8545c75 84 }
rgrover1 227:7a0bb8545c75 85
rgrover1 214:196183e51de3 86 void serviceDiscoveryStarted(Gap::Handle_t connectionHandle) {
rgrover1 214:196183e51de3 87 connHandle = connectionHandle;
rgrover1 227:7a0bb8545c75 88 resetDiscoveredServices();
rgrover1 214:196183e51de3 89 serviceDiscoveryInProgress = true;
rgrover1 214:196183e51de3 90 characteristicDiscoveryInProgress = false;
rgrover1 214:196183e51de3 91 }
rgrover1 214:196183e51de3 92
rgrover1 214:196183e51de3 93 void characteristicDiscoveryStarted(Gap::Handle_t connectionHandle) {
rgrover1 214:196183e51de3 94 connHandle = connectionHandle;
rgrover1 227:7a0bb8545c75 95 resetDiscoveredCharacteristics();
rgrover1 214:196183e51de3 96 characteristicDiscoveryInProgress = true;
rgrover1 214:196183e51de3 97 serviceDiscoveryInProgress = false;
rgrover1 214:196183e51de3 98 }
rgrover1 214:196183e51de3 99
rgrover1 225:08f36b78e0f1 100 void setupDiscoveredServices(const ble_gattc_evt_prim_srvc_disc_rsp_t *response) {
rgrover1 225:08f36b78e0f1 101 currSrvInd = 0;
rgrover1 225:08f36b78e0f1 102 srvCount = response->count;
rgrover1 225:08f36b78e0f1 103
rgrover1 225:08f36b78e0f1 104 for (unsigned serviceIndex = 0; serviceIndex < srvCount; serviceIndex++) {
rgrover1 225:08f36b78e0f1 105 services[serviceIndex].setup(response->services[serviceIndex].uuid.uuid,
rgrover1 225:08f36b78e0f1 106 response->services[serviceIndex].handle_range.start_handle,
rgrover1 225:08f36b78e0f1 107 response->services[serviceIndex].handle_range.end_handle);
rgrover1 225:08f36b78e0f1 108 }
rgrover1 225:08f36b78e0f1 109 }
rgrover1 225:08f36b78e0f1 110
rgrover1 225:08f36b78e0f1 111 void setupDiscoveredCharacteristics(const ble_gattc_evt_char_disc_rsp_t *response) {
rgrover1 225:08f36b78e0f1 112 currCharInd = 0;
rgrover1 225:08f36b78e0f1 113 charCount = response->count;
rgrover1 225:08f36b78e0f1 114
rgrover1 225:08f36b78e0f1 115 for (unsigned charIndex = 0; charIndex < charCount; charIndex++) {
rgrover1 225:08f36b78e0f1 116 characteristics[charIndex].setup(response->chars[charIndex].uuid.uuid,
rgrover1 225:08f36b78e0f1 117 response->chars[charIndex].char_props,
rgrover1 225:08f36b78e0f1 118 response->chars[charIndex].handle_decl,
rgrover1 225:08f36b78e0f1 119 response->chars[charIndex].handle_value);
rgrover1 225:08f36b78e0f1 120 }
rgrover1 225:08f36b78e0f1 121 }
rgrover1 225:08f36b78e0f1 122
rgrover1 223:cfa98ce48348 123 void progressCharacteristicDiscovery() {
rgrover1 223:cfa98ce48348 124 while (characteristicDiscoveryInProgress && (currCharInd < charCount)) {
rgrover1 223:cfa98ce48348 125 printf("%x [%u]\r\n",
rgrover1 223:cfa98ce48348 126 characteristics[currCharInd].uuid,
rgrover1 223:cfa98ce48348 127 characteristics[currCharInd].valueHandle);
rgrover1 223:cfa98ce48348 128 currCharInd++;
rgrover1 223:cfa98ce48348 129 }
rgrover1 223:cfa98ce48348 130
rgrover1 223:cfa98ce48348 131 if (characteristicDiscoveryInProgress) {
rgrover1 223:cfa98ce48348 132 Gap::Handle_t startHandle = characteristics[currCharInd - 1].valueHandle + 1;
rgrover1 223:cfa98ce48348 133 Gap::Handle_t endHandle = services[currSrvInd].endHandle;
rgrover1 227:7a0bb8545c75 134 resetDiscoveredCharacteristics();
rgrover1 223:cfa98ce48348 135
rgrover1 223:cfa98ce48348 136 if (startHandle < endHandle) {
rgrover1 223:cfa98ce48348 137 ble_gattc_handle_range_t handleRange = {
rgrover1 223:cfa98ce48348 138 .start_handle = startHandle,
rgrover1 223:cfa98ce48348 139 .end_handle = endHandle
rgrover1 223:cfa98ce48348 140 };
rgrover1 223:cfa98ce48348 141 printf("char discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connHandle, &handleRange));
rgrover1 223:cfa98ce48348 142 } else {
rgrover1 223:cfa98ce48348 143 terminateCharacteristicDiscovery();
rgrover1 223:cfa98ce48348 144 }
rgrover1 223:cfa98ce48348 145 }
rgrover1 223:cfa98ce48348 146 }
rgrover1 223:cfa98ce48348 147
rgrover1 223:cfa98ce48348 148 void progressServiceDiscovery() {
rgrover1 223:cfa98ce48348 149 while (serviceDiscoveryInProgress && (currSrvInd < srvCount)) {
rgrover1 223:cfa98ce48348 150 printf("%x [%u %u]\r\n",
rgrover1 223:cfa98ce48348 151 services[currSrvInd].uuid,
rgrover1 223:cfa98ce48348 152 services[currSrvInd].startHandle,
rgrover1 223:cfa98ce48348 153 services[currSrvInd].endHandle);
rgrover1 223:cfa98ce48348 154
rgrover1 223:cfa98ce48348 155 launchCharacteristicDiscovery(connHandle, services[currSrvInd].startHandle, services[currSrvInd].endHandle);
rgrover1 223:cfa98ce48348 156 }
rgrover1 223:cfa98ce48348 157 if (serviceDiscoveryInProgress && (srvCount > 0) && (currSrvInd > 0)) {
rgrover1 223:cfa98ce48348 158 Gap::Handle_t endHandle = services[currSrvInd - 1].endHandle;
rgrover1 223:cfa98ce48348 159 resetDiscoveredServices();
rgrover1 227:7a0bb8545c75 160
rgrover1 223:cfa98ce48348 161 printf("services discover returned %u\r\n",
rgrover1 223:cfa98ce48348 162 sd_ble_gattc_primary_services_discover(connHandle, endHandle, NULL));
rgrover1 223:cfa98ce48348 163 }
rgrover1 223:cfa98ce48348 164 }
rgrover1 223:cfa98ce48348 165
rgrover1 216:3443c78324b6 166 DiscoveredService services[BLE_DB_DISCOVERY_MAX_SRV]; /**< Information related to the current service being discovered.
rgrover1 216:3443c78324b6 167 * This is intended for internal use during service discovery. */
rgrover1 216:3443c78324b6 168 DiscoveredCharacteristic characteristics[BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV];
rgrover1 205:7b1c55e70f45 169
rgrover1 206:d8c5b97557f2 170 uint16_t connHandle; /**< Connection handle as provided by the SoftDevice. */
rgrover1 209:d24159a1dad5 171 uint8_t currSrvInd; /**< Index of the current service being discovered. This is intended for internal use during service discovery.*/
rgrover1 206:d8c5b97557f2 172 uint8_t srvCount; /**< Number of services at the peers GATT database.*/
rgrover1 206:d8c5b97557f2 173 uint8_t currCharInd; /**< Index of the current characteristic being discovered. This is intended for internal use during service discovery.*/
rgrover1 209:d24159a1dad5 174 uint8_t charCount; /**< Number of characteristics within the service.*/
rgrover1 206:d8c5b97557f2 175
rgrover1 206:d8c5b97557f2 176 bool serviceDiscoveryInProgress;
rgrover1 206:d8c5b97557f2 177 bool characteristicDiscoveryInProgress;
rgrover1 198:a69d3d4797e8 178 };
rgrover1 194:c99fc3160091 179
rgrover1 222:0ba395e1303d 180 static DiscoveryStatus discoveryStatus;
rgrover1 195:061ed80ffbcf 181
rgrover1 194:c99fc3160091 182 void launchServiceDiscovery(Gap::Handle_t connectionHandle)
rgrover1 194:c99fc3160091 183 {
rgrover1 214:196183e51de3 184 discoveryStatus.serviceDiscoveryStarted(connectionHandle);
rgrover1 194:c99fc3160091 185 printf("launch service discovery returned %u\r\n", sd_ble_gattc_primary_services_discover(connectionHandle, SRV_DISC_START_HANDLE, NULL));
rgrover1 194:c99fc3160091 186 }
rgrover1 194:c99fc3160091 187
rgrover1 202:3ce954ce3eb8 188 void launchCharacteristicDiscovery(Gap::Handle_t connectionHandle, Gap::Handle_t startHandle, Gap::Handle_t endHandle) {
rgrover1 214:196183e51de3 189 discoveryStatus.characteristicDiscoveryStarted(connectionHandle);
rgrover1 211:bf81b20ede23 190
rgrover1 211:bf81b20ede23 191 ble_gattc_handle_range_t handleRange = {
rgrover1 211:bf81b20ede23 192 .start_handle = startHandle,
rgrover1 211:bf81b20ede23 193 .end_handle = endHandle
rgrover1 211:bf81b20ede23 194 };
rgrover1 211:bf81b20ede23 195 printf("launch characteristic discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connectionHandle, &handleRange));
rgrover1 202:3ce954ce3eb8 196 }
rgrover1 202:3ce954ce3eb8 197
rgrover1 194:c99fc3160091 198 void bleGattcEventHandler(const ble_evt_t *p_ble_evt)
rgrover1 194:c99fc3160091 199 {
rgrover1 194:c99fc3160091 200 switch (p_ble_evt->header.evt_id) {
rgrover1 194:c99fc3160091 201 case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP:
rgrover1 194:c99fc3160091 202 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 194:c99fc3160091 203 case BLE_GATT_STATUS_SUCCESS: {
rgrover1 225:08f36b78e0f1 204 discoveryStatus.setupDiscoveredServices(&p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp);
rgrover1 195:061ed80ffbcf 205 break;
rgrover1 194:c99fc3160091 206 }
rgrover1 195:061ed80ffbcf 207
rgrover1 194:c99fc3160091 208 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: {
rgrover1 214:196183e51de3 209 discoveryStatus.terminateServiceDiscovery();
rgrover1 194:c99fc3160091 210 break;
rgrover1 194:c99fc3160091 211 }
rgrover1 195:061ed80ffbcf 212
rgrover1 194:c99fc3160091 213 default: {
rgrover1 197:de757ae3358b 214 discoveryStatus.serviceDiscoveryInProgress = false;
rgrover1 194:c99fc3160091 215 break;
rgrover1 194:c99fc3160091 216 }
rgrover1 194:c99fc3160091 217 }
rgrover1 194:c99fc3160091 218 break;
rgrover1 194:c99fc3160091 219
rgrover1 194:c99fc3160091 220 case BLE_GATTC_EVT_CHAR_DISC_RSP: {
rgrover1 194:c99fc3160091 221 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 212:f2316b17d8be 222 case BLE_GATT_STATUS_SUCCESS: {
rgrover1 225:08f36b78e0f1 223 discoveryStatus.setupDiscoveredCharacteristics(&p_ble_evt->evt.gattc_evt.params.char_disc_rsp);
rgrover1 219:681be3608738 224 break;
rgrover1 212:f2316b17d8be 225 }
rgrover1 212:f2316b17d8be 226
rgrover1 212:f2316b17d8be 227 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: {
rgrover1 214:196183e51de3 228 discoveryStatus.terminateCharacteristicDiscovery();
rgrover1 212:f2316b17d8be 229 break;
rgrover1 212:f2316b17d8be 230 }
rgrover1 212:f2316b17d8be 231
rgrover1 194:c99fc3160091 232 default:
rgrover1 194:c99fc3160091 233 break;
rgrover1 194:c99fc3160091 234 }
rgrover1 194:c99fc3160091 235 break;
rgrover1 194:c99fc3160091 236 }
rgrover1 194:c99fc3160091 237 }
rgrover1 195:061ed80ffbcf 238
rgrover1 223:cfa98ce48348 239 discoveryStatus.progressCharacteristicDiscovery();
rgrover1 223:cfa98ce48348 240 discoveryStatus.progressServiceDiscovery();
rgrover1 194:c99fc3160091 241 }