Shuta Nakamae / nRF51822

Fork of nRF51822 by Nordic Semiconductor

Committer:
rgrover1
Date:
Fri Jun 19 15:55:19 2015 +0100
Revision:
223:cfa98ce48348
Parent:
222:0ba395e1303d
Child:
224:2f769d79a1b8
Synchronized with git rev 255d010a
Author: Rohit Grover
move progress[SC]Discovery into 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 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 223:cfa98ce48348 108 void progressCharacteristicDiscovery() {
rgrover1 223:cfa98ce48348 109 while (characteristicDiscoveryInProgress && (currCharInd < charCount)) {
rgrover1 223:cfa98ce48348 110 printf("%x [%u]\r\n",
rgrover1 223:cfa98ce48348 111 characteristics[currCharInd].uuid,
rgrover1 223:cfa98ce48348 112 characteristics[currCharInd].valueHandle);
rgrover1 223:cfa98ce48348 113 currCharInd++;
rgrover1 223:cfa98ce48348 114 }
rgrover1 223:cfa98ce48348 115
rgrover1 223:cfa98ce48348 116 if (characteristicDiscoveryInProgress) {
rgrover1 223:cfa98ce48348 117 Gap::Handle_t startHandle = characteristics[currCharInd - 1].valueHandle + 1;
rgrover1 223:cfa98ce48348 118 Gap::Handle_t endHandle = services[currSrvInd].endHandle;
rgrover1 223:cfa98ce48348 119
rgrover1 223:cfa98ce48348 120 if (startHandle < endHandle) {
rgrover1 223:cfa98ce48348 121 ble_gattc_handle_range_t handleRange = {
rgrover1 223:cfa98ce48348 122 .start_handle = startHandle,
rgrover1 223:cfa98ce48348 123 .end_handle = endHandle
rgrover1 223:cfa98ce48348 124 };
rgrover1 223:cfa98ce48348 125 printf("char discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connHandle, &handleRange));
rgrover1 223:cfa98ce48348 126 } else {
rgrover1 223:cfa98ce48348 127 terminateCharacteristicDiscovery();
rgrover1 223:cfa98ce48348 128 }
rgrover1 223:cfa98ce48348 129 }
rgrover1 223:cfa98ce48348 130 }
rgrover1 223:cfa98ce48348 131
rgrover1 223:cfa98ce48348 132 void progressServiceDiscovery() {
rgrover1 223:cfa98ce48348 133 while (serviceDiscoveryInProgress && (currSrvInd < srvCount)) {
rgrover1 223:cfa98ce48348 134 printf("%x [%u %u]\r\n",
rgrover1 223:cfa98ce48348 135 services[currSrvInd].uuid,
rgrover1 223:cfa98ce48348 136 services[currSrvInd].startHandle,
rgrover1 223:cfa98ce48348 137 services[currSrvInd].endHandle);
rgrover1 223:cfa98ce48348 138
rgrover1 223:cfa98ce48348 139 launchCharacteristicDiscovery(connHandle, services[currSrvInd].startHandle, services[currSrvInd].endHandle);
rgrover1 223:cfa98ce48348 140 }
rgrover1 223:cfa98ce48348 141 if (serviceDiscoveryInProgress && (srvCount > 0) && (currSrvInd > 0)) {
rgrover1 223:cfa98ce48348 142 Gap::Handle_t endHandle = services[currSrvInd - 1].endHandle;
rgrover1 223:cfa98ce48348 143 resetDiscoveredServices();
rgrover1 223:cfa98ce48348 144 printf("services discover returned %u\r\n",
rgrover1 223:cfa98ce48348 145 sd_ble_gattc_primary_services_discover(connHandle, endHandle, NULL));
rgrover1 223:cfa98ce48348 146 }
rgrover1 223:cfa98ce48348 147 }
rgrover1 223:cfa98ce48348 148
rgrover1 216:3443c78324b6 149 DiscoveredService services[BLE_DB_DISCOVERY_MAX_SRV]; /**< Information related to the current service being discovered.
rgrover1 216:3443c78324b6 150 * This is intended for internal use during service discovery. */
rgrover1 216:3443c78324b6 151 DiscoveredCharacteristic characteristics[BLE_DB_DISCOVERY_MAX_CHAR_PER_SRV];
rgrover1 205:7b1c55e70f45 152
rgrover1 206:d8c5b97557f2 153 uint16_t connHandle; /**< Connection handle as provided by the SoftDevice. */
rgrover1 209:d24159a1dad5 154 uint8_t currSrvInd; /**< Index of the current service being discovered. This is intended for internal use during service discovery.*/
rgrover1 206:d8c5b97557f2 155 uint8_t srvCount; /**< Number of services at the peers GATT database.*/
rgrover1 206:d8c5b97557f2 156 uint8_t currCharInd; /**< Index of the current characteristic being discovered. This is intended for internal use during service discovery.*/
rgrover1 209:d24159a1dad5 157 uint8_t charCount; /**< Number of characteristics within the service.*/
rgrover1 206:d8c5b97557f2 158
rgrover1 206:d8c5b97557f2 159 bool serviceDiscoveryInProgress;
rgrover1 206:d8c5b97557f2 160 bool characteristicDiscoveryInProgress;
rgrover1 198:a69d3d4797e8 161 };
rgrover1 194:c99fc3160091 162
rgrover1 222:0ba395e1303d 163 static DiscoveryStatus discoveryStatus;
rgrover1 195:061ed80ffbcf 164
rgrover1 194:c99fc3160091 165 void launchServiceDiscovery(Gap::Handle_t connectionHandle)
rgrover1 194:c99fc3160091 166 {
rgrover1 214:196183e51de3 167 discoveryStatus.serviceDiscoveryStarted(connectionHandle);
rgrover1 194:c99fc3160091 168 printf("launch service discovery returned %u\r\n", sd_ble_gattc_primary_services_discover(connectionHandle, SRV_DISC_START_HANDLE, NULL));
rgrover1 194:c99fc3160091 169 }
rgrover1 194:c99fc3160091 170
rgrover1 202:3ce954ce3eb8 171 void launchCharacteristicDiscovery(Gap::Handle_t connectionHandle, Gap::Handle_t startHandle, Gap::Handle_t endHandle) {
rgrover1 214:196183e51de3 172 discoveryStatus.characteristicDiscoveryStarted(connectionHandle);
rgrover1 211:bf81b20ede23 173
rgrover1 211:bf81b20ede23 174 ble_gattc_handle_range_t handleRange = {
rgrover1 211:bf81b20ede23 175 .start_handle = startHandle,
rgrover1 211:bf81b20ede23 176 .end_handle = endHandle
rgrover1 211:bf81b20ede23 177 };
rgrover1 211:bf81b20ede23 178 printf("launch characteristic discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connectionHandle, &handleRange));
rgrover1 202:3ce954ce3eb8 179 }
rgrover1 202:3ce954ce3eb8 180
rgrover1 194:c99fc3160091 181 void bleGattcEventHandler(const ble_evt_t *p_ble_evt)
rgrover1 194:c99fc3160091 182 {
rgrover1 194:c99fc3160091 183 switch (p_ble_evt->header.evt_id) {
rgrover1 194:c99fc3160091 184 case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP:
rgrover1 194:c99fc3160091 185 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 194:c99fc3160091 186 case BLE_GATT_STATUS_SUCCESS: {
rgrover1 194:c99fc3160091 187 printf("count of primary services: %u\r\n", p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.count);
rgrover1 195:061ed80ffbcf 188 discoveryStatus.connHandle = p_ble_evt->evt.gattc_evt.conn_handle;
rgrover1 195:061ed80ffbcf 189 discoveryStatus.currSrvInd = 0;
rgrover1 195:061ed80ffbcf 190 discoveryStatus.srvCount = p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.count;
rgrover1 194:c99fc3160091 191
rgrover1 195:061ed80ffbcf 192 for (unsigned serviceIndex = 0; serviceIndex < discoveryStatus.srvCount; serviceIndex++) {
rgrover1 195:061ed80ffbcf 193 discoveryStatus.services[serviceIndex].
rgrover1 195:061ed80ffbcf 194 setup(p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[serviceIndex].uuid.uuid,
rgrover1 195:061ed80ffbcf 195 p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[serviceIndex].handle_range.start_handle,
rgrover1 195:061ed80ffbcf 196 p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[serviceIndex].handle_range.end_handle);
rgrover1 194:c99fc3160091 197 }
rgrover1 195:061ed80ffbcf 198 break;
rgrover1 194:c99fc3160091 199 }
rgrover1 195:061ed80ffbcf 200
rgrover1 194:c99fc3160091 201 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: {
rgrover1 214:196183e51de3 202 discoveryStatus.terminateServiceDiscovery();
rgrover1 194:c99fc3160091 203 break;
rgrover1 194:c99fc3160091 204 }
rgrover1 195:061ed80ffbcf 205
rgrover1 194:c99fc3160091 206 default: {
rgrover1 197:de757ae3358b 207 discoveryStatus.serviceDiscoveryInProgress = false;
rgrover1 194:c99fc3160091 208 printf("gatt failure status: %u\r\n", p_ble_evt->evt.gattc_evt.gatt_status);
rgrover1 194:c99fc3160091 209 break;
rgrover1 194:c99fc3160091 210 }
rgrover1 194:c99fc3160091 211 }
rgrover1 194:c99fc3160091 212 break;
rgrover1 194:c99fc3160091 213
rgrover1 194:c99fc3160091 214 case BLE_GATTC_EVT_CHAR_DISC_RSP: {
rgrover1 194:c99fc3160091 215 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 212:f2316b17d8be 216 case BLE_GATT_STATUS_SUCCESS: {
rgrover1 212:f2316b17d8be 217 // printf("count of characteristics: %u\r\n", p_ble_evt->evt.gattc_evt.params.char_disc_rsp.count);
rgrover1 212:f2316b17d8be 218 discoveryStatus.currCharInd = 0;
rgrover1 212:f2316b17d8be 219 discoveryStatus.charCount = p_ble_evt->evt.gattc_evt.params.char_disc_rsp.count;
rgrover1 212:f2316b17d8be 220
rgrover1 212:f2316b17d8be 221 unsigned charIndex = 0;
rgrover1 212:f2316b17d8be 222 for (; charIndex < discoveryStatus.charCount; charIndex++) {
rgrover1 218:6812c045735a 223 discoveryStatus.characteristics[charIndex].
rgrover1 218:6812c045735a 224 setup(p_ble_evt->evt.gattc_evt.params.char_disc_rsp.chars[charIndex].uuid.uuid,
rgrover1 218:6812c045735a 225 p_ble_evt->evt.gattc_evt.params.char_disc_rsp.chars[charIndex].char_props,
rgrover1 218:6812c045735a 226 p_ble_evt->evt.gattc_evt.params.char_disc_rsp.chars[charIndex].handle_decl,
rgrover1 218:6812c045735a 227 p_ble_evt->evt.gattc_evt.params.char_disc_rsp.chars[charIndex].handle_value);
rgrover1 212:f2316b17d8be 228 }
rgrover1 219:681be3608738 229 break;
rgrover1 212:f2316b17d8be 230 }
rgrover1 212:f2316b17d8be 231
rgrover1 212:f2316b17d8be 232 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: {
rgrover1 214:196183e51de3 233 discoveryStatus.terminateCharacteristicDiscovery();
rgrover1 212:f2316b17d8be 234 break;
rgrover1 212:f2316b17d8be 235 }
rgrover1 212:f2316b17d8be 236
rgrover1 194:c99fc3160091 237 default:
rgrover1 212:f2316b17d8be 238 printf("char response: gatt failure status: %u\r\n", p_ble_evt->evt.gattc_evt.gatt_status);
rgrover1 194:c99fc3160091 239 break;
rgrover1 194:c99fc3160091 240 }
rgrover1 194:c99fc3160091 241 break;
rgrover1 194:c99fc3160091 242 }
rgrover1 194:c99fc3160091 243 }
rgrover1 195:061ed80ffbcf 244
rgrover1 223:cfa98ce48348 245 discoveryStatus.progressCharacteristicDiscovery();
rgrover1 223:cfa98ce48348 246 discoveryStatus.progressServiceDiscovery();
rgrover1 194:c99fc3160091 247 }