Shuta Nakamae / nRF51822

Fork of nRF51822 by Nordic Semiconductor

Committer:
rgrover1
Date:
Fri Jun 19 15:55:20 2015 +0100
Revision:
235:10bb73f9d15d
Parent:
234:80732a210425
Child:
236:631719c927ed
Synchronized with git rev 62f199e9
Author: Rohit Grover
remove un-necessary braces.

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 230:4c2bb92598b7 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 234:80732a210425 49 struct Properties_t {
rgrover1 234:80732a210425 50 Properties_t() : broadcast(0), read(0), write_wo_resp(0), write(0), notify(0), indicate(0), auth_signed_wr(0) {
rgrover1 234:80732a210425 51 /* empty */
rgrover1 234:80732a210425 52 }
rgrover1 234:80732a210425 53 Properties_t(uint8_t props) :
rgrover1 234:80732a210425 54 broadcast(props & 0x01),
rgrover1 234:80732a210425 55 read(props & 0x02),
rgrover1 234:80732a210425 56 write_wo_resp(props & 0x04),
rgrover1 234:80732a210425 57 write(props & 0x08),
rgrover1 234:80732a210425 58 notify(props & 0x10),
rgrover1 234:80732a210425 59 indicate(props & 0x20),
rgrover1 234:80732a210425 60 auth_signed_wr(props & 0x40) {
rgrover1 234:80732a210425 61 /* empty*/
rgrover1 234:80732a210425 62 }
rgrover1 234:80732a210425 63
rgrover1 234:80732a210425 64 uint8_t broadcast :1; /**< Broadcasting of the value permitted. */
rgrover1 234:80732a210425 65 uint8_t read :1; /**< Reading the value permitted. */
rgrover1 234:80732a210425 66 uint8_t write_wo_resp :1; /**< Writing the value with Write Command permitted. */
rgrover1 234:80732a210425 67 uint8_t write :1; /**< Writing the value with Write Request permitted. */
rgrover1 234:80732a210425 68 uint8_t notify :1; /**< Notications of the value permitted. */
rgrover1 234:80732a210425 69 uint8_t indicate :1; /**< Indications of the value permitted. */
rgrover1 234:80732a210425 70 uint8_t auth_signed_wr :1; /**< Writing the value with Signed Write Command permitted. */
rgrover1 234:80732a210425 71 };
rgrover1 234:80732a210425 72
rgrover1 234:80732a210425 73 void setup(ShortUUIDBytes_t uuidIn, Properties_t propsIn, Gap::Handle_t declHandleIn, Gap::Handle_t valueHandleIn) {
rgrover1 210:e7749aec4203 74 uuid = uuidIn;
rgrover1 215:36f6796651ab 75 props = propsIn;
rgrover1 215:36f6796651ab 76 declHandle = declHandleIn;
rgrover1 215:36f6796651ab 77 valueHandle = valueHandleIn;
rgrover1 210:e7749aec4203 78 }
rgrover1 210:e7749aec4203 79
rgrover1 234:80732a210425 80 ShortUUIDBytes_t uuid;
rgrover1 234:80732a210425 81 Properties_t props;
rgrover1 234:80732a210425 82 Gap::Handle_t declHandle;
rgrover1 234:80732a210425 83 Gap::Handle_t valueHandle;
rgrover1 210:e7749aec4203 84 };
rgrover1 210:e7749aec4203 85
rgrover1 222:0ba395e1303d 86 struct DiscoveryStatus {
rgrover1 214:196183e51de3 87 void terminateServiceDiscovery(void) {
rgrover1 214:196183e51de3 88 serviceDiscoveryInProgress = false;
rgrover1 214:196183e51de3 89 printf("end of service discovery\r\n");
rgrover1 214:196183e51de3 90 }
rgrover1 214:196183e51de3 91
rgrover1 214:196183e51de3 92 void terminateCharacteristicDiscovery(void) {
rgrover1 214:196183e51de3 93 characteristicDiscoveryInProgress = false;
rgrover1 214:196183e51de3 94 serviceDiscoveryInProgress = true;
rgrover1 217:c57cbfdfb5ca 95 currSrvInd++; /* Progress service index to keep discovery alive. */
rgrover1 214:196183e51de3 96 }
rgrover1 214:196183e51de3 97
rgrover1 214:196183e51de3 98 void resetDiscoveredServices(void) {
rgrover1 227:7a0bb8545c75 99 srvCount = 0;
rgrover1 227:7a0bb8545c75 100 currSrvInd = 0;
rgrover1 214:196183e51de3 101 memset(services, 0, sizeof(DiscoveredService) * BLE_DB_DISCOVERY_MAX_SRV);
rgrover1 214:196183e51de3 102 }
rgrover1 214:196183e51de3 103
rgrover1 227:7a0bb8545c75 104 void resetDiscoveredCharacteristics(void) {
rgrover1 227:7a0bb8545c75 105 charCount = 0;
rgrover1 227:7a0bb8545c75 106 currCharInd = 0;
rgrover1 227:7a0bb8545c75 107 memset(characteristics, 0, sizeof(DiscoveredCharacteristic) * BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV);
rgrover1 227:7a0bb8545c75 108 }
rgrover1 227:7a0bb8545c75 109
rgrover1 214:196183e51de3 110 void serviceDiscoveryStarted(Gap::Handle_t connectionHandle) {
rgrover1 214:196183e51de3 111 connHandle = connectionHandle;
rgrover1 227:7a0bb8545c75 112 resetDiscoveredServices();
rgrover1 214:196183e51de3 113 serviceDiscoveryInProgress = true;
rgrover1 214:196183e51de3 114 characteristicDiscoveryInProgress = false;
rgrover1 214:196183e51de3 115 }
rgrover1 214:196183e51de3 116
rgrover1 214:196183e51de3 117 void characteristicDiscoveryStarted(Gap::Handle_t connectionHandle) {
rgrover1 214:196183e51de3 118 connHandle = connectionHandle;
rgrover1 227:7a0bb8545c75 119 resetDiscoveredCharacteristics();
rgrover1 214:196183e51de3 120 characteristicDiscoveryInProgress = true;
rgrover1 214:196183e51de3 121 serviceDiscoveryInProgress = false;
rgrover1 214:196183e51de3 122 }
rgrover1 214:196183e51de3 123
rgrover1 225:08f36b78e0f1 124 void setupDiscoveredServices(const ble_gattc_evt_prim_srvc_disc_rsp_t *response) {
rgrover1 225:08f36b78e0f1 125 currSrvInd = 0;
rgrover1 225:08f36b78e0f1 126 srvCount = response->count;
rgrover1 225:08f36b78e0f1 127
rgrover1 233:0b15e714801b 128 /* Account for the limitation on the number of discovered services we can handle at a time. */
rgrover1 233:0b15e714801b 129 if (srvCount > BLE_DB_DISCOVERY_MAX_SRV) {
rgrover1 233:0b15e714801b 130 srvCount = BLE_DB_DISCOVERY_MAX_SRV;
rgrover1 233:0b15e714801b 131 }
rgrover1 233:0b15e714801b 132
rgrover1 225:08f36b78e0f1 133 for (unsigned serviceIndex = 0; serviceIndex < srvCount; serviceIndex++) {
rgrover1 225:08f36b78e0f1 134 services[serviceIndex].setup(response->services[serviceIndex].uuid.uuid,
rgrover1 225:08f36b78e0f1 135 response->services[serviceIndex].handle_range.start_handle,
rgrover1 225:08f36b78e0f1 136 response->services[serviceIndex].handle_range.end_handle);
rgrover1 225:08f36b78e0f1 137 }
rgrover1 225:08f36b78e0f1 138 }
rgrover1 225:08f36b78e0f1 139
rgrover1 225:08f36b78e0f1 140 void setupDiscoveredCharacteristics(const ble_gattc_evt_char_disc_rsp_t *response) {
rgrover1 225:08f36b78e0f1 141 currCharInd = 0;
rgrover1 225:08f36b78e0f1 142 charCount = response->count;
rgrover1 225:08f36b78e0f1 143
rgrover1 233:0b15e714801b 144 /* Account for the limitation on the number of discovered characteristics we can handle at a time. */
rgrover1 233:0b15e714801b 145 if (charCount > BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV) {
rgrover1 233:0b15e714801b 146 charCount = BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV;
rgrover1 233:0b15e714801b 147 }
rgrover1 233:0b15e714801b 148
rgrover1 225:08f36b78e0f1 149 for (unsigned charIndex = 0; charIndex < charCount; charIndex++) {
rgrover1 225:08f36b78e0f1 150 characteristics[charIndex].setup(response->chars[charIndex].uuid.uuid,
rgrover1 234:80732a210425 151 *(const uint8_t *)(&response->chars[charIndex].char_props),
rgrover1 225:08f36b78e0f1 152 response->chars[charIndex].handle_decl,
rgrover1 225:08f36b78e0f1 153 response->chars[charIndex].handle_value);
rgrover1 225:08f36b78e0f1 154 }
rgrover1 225:08f36b78e0f1 155 }
rgrover1 225:08f36b78e0f1 156
rgrover1 223:cfa98ce48348 157 void progressCharacteristicDiscovery() {
rgrover1 223:cfa98ce48348 158 while (characteristicDiscoveryInProgress && (currCharInd < charCount)) {
rgrover1 231:4362ce7ffbd7 159 /* THIS IS WHERE THE CALLBACK WILL GO */
rgrover1 231:4362ce7ffbd7 160 printf("%x [%u]\r\n", characteristics[currCharInd].uuid, characteristics[currCharInd].valueHandle);
rgrover1 231:4362ce7ffbd7 161
rgrover1 223:cfa98ce48348 162 currCharInd++;
rgrover1 223:cfa98ce48348 163 }
rgrover1 223:cfa98ce48348 164
rgrover1 223:cfa98ce48348 165 if (characteristicDiscoveryInProgress) {
rgrover1 223:cfa98ce48348 166 Gap::Handle_t startHandle = characteristics[currCharInd - 1].valueHandle + 1;
rgrover1 223:cfa98ce48348 167 Gap::Handle_t endHandle = services[currSrvInd].endHandle;
rgrover1 227:7a0bb8545c75 168 resetDiscoveredCharacteristics();
rgrover1 223:cfa98ce48348 169
rgrover1 223:cfa98ce48348 170 if (startHandle < endHandle) {
rgrover1 223:cfa98ce48348 171 ble_gattc_handle_range_t handleRange = {
rgrover1 223:cfa98ce48348 172 .start_handle = startHandle,
rgrover1 223:cfa98ce48348 173 .end_handle = endHandle
rgrover1 223:cfa98ce48348 174 };
rgrover1 223:cfa98ce48348 175 printf("char discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connHandle, &handleRange));
rgrover1 223:cfa98ce48348 176 } else {
rgrover1 223:cfa98ce48348 177 terminateCharacteristicDiscovery();
rgrover1 223:cfa98ce48348 178 }
rgrover1 223:cfa98ce48348 179 }
rgrover1 223:cfa98ce48348 180 }
rgrover1 223:cfa98ce48348 181
rgrover1 223:cfa98ce48348 182 void progressServiceDiscovery() {
rgrover1 223:cfa98ce48348 183 while (serviceDiscoveryInProgress && (currSrvInd < srvCount)) {
rgrover1 231:4362ce7ffbd7 184 /* THIS IS WHERE THE CALLBACK WILL GO */
rgrover1 231:4362ce7ffbd7 185 printf("%x [%u %u]\r\n", services[currSrvInd].uuid, services[currSrvInd].startHandle, services[currSrvInd].endHandle);
rgrover1 223:cfa98ce48348 186
rgrover1 231:4362ce7ffbd7 187 if (true) { /* characteristic discovery is optional. */
rgrover1 231:4362ce7ffbd7 188 launchCharacteristicDiscovery(connHandle, services[currSrvInd].startHandle, services[currSrvInd].endHandle);
rgrover1 231:4362ce7ffbd7 189 } else {
rgrover1 231:4362ce7ffbd7 190 currSrvInd++; /* Progress service index to keep discovery alive. */
rgrover1 231:4362ce7ffbd7 191 }
rgrover1 223:cfa98ce48348 192 }
rgrover1 223:cfa98ce48348 193 if (serviceDiscoveryInProgress && (srvCount > 0) && (currSrvInd > 0)) {
rgrover1 223:cfa98ce48348 194 Gap::Handle_t endHandle = services[currSrvInd - 1].endHandle;
rgrover1 223:cfa98ce48348 195 resetDiscoveredServices();
rgrover1 227:7a0bb8545c75 196
rgrover1 231:4362ce7ffbd7 197 printf("services discover returned %u\r\n", sd_ble_gattc_primary_services_discover(connHandle, endHandle, NULL));
rgrover1 223:cfa98ce48348 198 }
rgrover1 223:cfa98ce48348 199 }
rgrover1 223:cfa98ce48348 200
rgrover1 216:3443c78324b6 201 DiscoveredService services[BLE_DB_DISCOVERY_MAX_SRV]; /**< Information related to the current service being discovered.
rgrover1 216:3443c78324b6 202 * This is intended for internal use during service discovery. */
rgrover1 216:3443c78324b6 203 DiscoveredCharacteristic characteristics[BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV];
rgrover1 205:7b1c55e70f45 204
rgrover1 206:d8c5b97557f2 205 uint16_t connHandle; /**< Connection handle as provided by the SoftDevice. */
rgrover1 209:d24159a1dad5 206 uint8_t currSrvInd; /**< Index of the current service being discovered. This is intended for internal use during service discovery.*/
rgrover1 206:d8c5b97557f2 207 uint8_t srvCount; /**< Number of services at the peers GATT database.*/
rgrover1 206:d8c5b97557f2 208 uint8_t currCharInd; /**< Index of the current characteristic being discovered. This is intended for internal use during service discovery.*/
rgrover1 209:d24159a1dad5 209 uint8_t charCount; /**< Number of characteristics within the service.*/
rgrover1 206:d8c5b97557f2 210
rgrover1 206:d8c5b97557f2 211 bool serviceDiscoveryInProgress;
rgrover1 206:d8c5b97557f2 212 bool characteristicDiscoveryInProgress;
rgrover1 198:a69d3d4797e8 213 };
rgrover1 194:c99fc3160091 214
rgrover1 222:0ba395e1303d 215 static DiscoveryStatus discoveryStatus;
rgrover1 195:061ed80ffbcf 216
rgrover1 194:c99fc3160091 217 void launchServiceDiscovery(Gap::Handle_t connectionHandle)
rgrover1 194:c99fc3160091 218 {
rgrover1 214:196183e51de3 219 discoveryStatus.serviceDiscoveryStarted(connectionHandle);
rgrover1 194:c99fc3160091 220 printf("launch service discovery returned %u\r\n", sd_ble_gattc_primary_services_discover(connectionHandle, SRV_DISC_START_HANDLE, NULL));
rgrover1 194:c99fc3160091 221 }
rgrover1 194:c99fc3160091 222
rgrover1 202:3ce954ce3eb8 223 void launchCharacteristicDiscovery(Gap::Handle_t connectionHandle, Gap::Handle_t startHandle, Gap::Handle_t endHandle) {
rgrover1 214:196183e51de3 224 discoveryStatus.characteristicDiscoveryStarted(connectionHandle);
rgrover1 211:bf81b20ede23 225
rgrover1 211:bf81b20ede23 226 ble_gattc_handle_range_t handleRange = {
rgrover1 211:bf81b20ede23 227 .start_handle = startHandle,
rgrover1 211:bf81b20ede23 228 .end_handle = endHandle
rgrover1 211:bf81b20ede23 229 };
rgrover1 211:bf81b20ede23 230 printf("launch characteristic discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connectionHandle, &handleRange));
rgrover1 202:3ce954ce3eb8 231 }
rgrover1 202:3ce954ce3eb8 232
rgrover1 194:c99fc3160091 233 void bleGattcEventHandler(const ble_evt_t *p_ble_evt)
rgrover1 194:c99fc3160091 234 {
rgrover1 194:c99fc3160091 235 switch (p_ble_evt->header.evt_id) {
rgrover1 194:c99fc3160091 236 case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP:
rgrover1 194:c99fc3160091 237 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 235:10bb73f9d15d 238 case BLE_GATT_STATUS_SUCCESS:
rgrover1 225:08f36b78e0f1 239 discoveryStatus.setupDiscoveredServices(&p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp);
rgrover1 195:061ed80ffbcf 240 break;
rgrover1 195:061ed80ffbcf 241
rgrover1 229:6394db9a71ba 242 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND:
rgrover1 229:6394db9a71ba 243 default:
rgrover1 214:196183e51de3 244 discoveryStatus.terminateServiceDiscovery();
rgrover1 194:c99fc3160091 245 break;
rgrover1 194:c99fc3160091 246 }
rgrover1 194:c99fc3160091 247 break;
rgrover1 194:c99fc3160091 248
rgrover1 235:10bb73f9d15d 249 case BLE_GATTC_EVT_CHAR_DISC_RSP:
rgrover1 194:c99fc3160091 250 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 235:10bb73f9d15d 251 case BLE_GATT_STATUS_SUCCESS:
rgrover1 225:08f36b78e0f1 252 discoveryStatus.setupDiscoveredCharacteristics(&p_ble_evt->evt.gattc_evt.params.char_disc_rsp);
rgrover1 219:681be3608738 253 break;
rgrover1 212:f2316b17d8be 254
rgrover1 229:6394db9a71ba 255 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND:
rgrover1 229:6394db9a71ba 256 default:
rgrover1 214:196183e51de3 257 discoveryStatus.terminateCharacteristicDiscovery();
rgrover1 212:f2316b17d8be 258 break;
rgrover1 194:c99fc3160091 259 }
rgrover1 194:c99fc3160091 260 break;
rgrover1 194:c99fc3160091 261 }
rgrover1 195:061ed80ffbcf 262
rgrover1 223:cfa98ce48348 263 discoveryStatus.progressCharacteristicDiscovery();
rgrover1 223:cfa98ce48348 264 discoveryStatus.progressServiceDiscovery();
rgrover1 194:c99fc3160091 265 }