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@214:196183e51de3, 2015-06-19 (annotated)

Committer:
rgrover1
Date:
Fri Jun 19 15:55:18 2015 +0100
Revision:
214:196183e51de3
Parent:
213:146636a106b1
Child:
215:36f6796651ab
Synchronized with git rev 9d1ddc36

Author: Rohit Grover

add some helper functions to DiscoveryStatus

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