Shuta Nakamae / nRF51822

Fork of nRF51822 by Nordic Semiconductor

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