Shuta Nakamae / nRF51822

Fork of nRF51822 by Nordic Semiconductor

Committer:
rgrover1
Date:
Fri Jun 19 15:55:18 2015 +0100
Revision:
215:36f6796651ab
Parent:
214:196183e51de3
Child:
216:3443c78324b6
Synchronized with git rev 4703c1d2
Author: Rohit Grover
begin to work on DiscoveredCharacteristic

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 206:d8c5b97557f2 104 DiscoveredService services[BLE_DB_DISCOVERY_MAX_SRV]; /**< Information related to the current service being discovered.
rgrover1 206:d8c5b97557f2 105 * This is intended for internal use during service discovery. */
rgrover1 205:7b1c55e70f45 106
rgrover1 206:d8c5b97557f2 107 uint16_t connHandle; /**< Connection handle as provided by the SoftDevice. */
rgrover1 209:d24159a1dad5 108 uint8_t currSrvInd; /**< Index of the current service being discovered. This is intended for internal use during service discovery.*/
rgrover1 206:d8c5b97557f2 109 uint8_t srvCount; /**< Number of services at the peers GATT database.*/
rgrover1 206:d8c5b97557f2 110 uint8_t currCharInd; /**< Index of the current characteristic being discovered. This is intended for internal use during service discovery.*/
rgrover1 209:d24159a1dad5 111 uint8_t charCount; /**< Number of characteristics within the service.*/
rgrover1 206:d8c5b97557f2 112
rgrover1 206:d8c5b97557f2 113 bool serviceDiscoveryInProgress;
rgrover1 206:d8c5b97557f2 114 bool characteristicDiscoveryInProgress;
rgrover1 198:a69d3d4797e8 115 };
rgrover1 194:c99fc3160091 116
rgrover1 207:d70392d1af99 117 static DiscoveryStatus_t discoveryStatus;
rgrover1 195:061ed80ffbcf 118
rgrover1 194:c99fc3160091 119 void launchServiceDiscovery(Gap::Handle_t connectionHandle)
rgrover1 194:c99fc3160091 120 {
rgrover1 214:196183e51de3 121 discoveryStatus.serviceDiscoveryStarted(connectionHandle);
rgrover1 194:c99fc3160091 122 printf("launch service discovery returned %u\r\n", sd_ble_gattc_primary_services_discover(connectionHandle, SRV_DISC_START_HANDLE, NULL));
rgrover1 194:c99fc3160091 123 }
rgrover1 194:c99fc3160091 124
rgrover1 202:3ce954ce3eb8 125 void launchCharacteristicDiscovery(Gap::Handle_t connectionHandle, Gap::Handle_t startHandle, Gap::Handle_t endHandle) {
rgrover1 214:196183e51de3 126 discoveryStatus.characteristicDiscoveryStarted(connectionHandle);
rgrover1 211:bf81b20ede23 127
rgrover1 211:bf81b20ede23 128 ble_gattc_handle_range_t handleRange = {
rgrover1 211:bf81b20ede23 129 .start_handle = startHandle,
rgrover1 211:bf81b20ede23 130 .end_handle = endHandle
rgrover1 211:bf81b20ede23 131 };
rgrover1 211:bf81b20ede23 132 printf("launch characteristic discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(connectionHandle, &handleRange));
rgrover1 202:3ce954ce3eb8 133 }
rgrover1 202:3ce954ce3eb8 134
rgrover1 194:c99fc3160091 135 void bleGattcEventHandler(const ble_evt_t *p_ble_evt)
rgrover1 194:c99fc3160091 136 {
rgrover1 194:c99fc3160091 137 switch (p_ble_evt->header.evt_id) {
rgrover1 194:c99fc3160091 138 case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP:
rgrover1 194:c99fc3160091 139 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 194:c99fc3160091 140 case BLE_GATT_STATUS_SUCCESS: {
rgrover1 194:c99fc3160091 141 printf("count of primary services: %u\r\n", p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.count);
rgrover1 195:061ed80ffbcf 142 discoveryStatus.connHandle = p_ble_evt->evt.gattc_evt.conn_handle;
rgrover1 195:061ed80ffbcf 143 discoveryStatus.currSrvInd = 0;
rgrover1 195:061ed80ffbcf 144 discoveryStatus.srvCount = p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.count;
rgrover1 194:c99fc3160091 145
rgrover1 195:061ed80ffbcf 146 for (unsigned serviceIndex = 0; serviceIndex < discoveryStatus.srvCount; serviceIndex++) {
rgrover1 195:061ed80ffbcf 147 discoveryStatus.services[serviceIndex].
rgrover1 195:061ed80ffbcf 148 setup(p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[serviceIndex].uuid.uuid,
rgrover1 195:061ed80ffbcf 149 p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[serviceIndex].handle_range.start_handle,
rgrover1 195:061ed80ffbcf 150 p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[serviceIndex].handle_range.end_handle);
rgrover1 194:c99fc3160091 151 }
rgrover1 195:061ed80ffbcf 152 break;
rgrover1 194:c99fc3160091 153 }
rgrover1 195:061ed80ffbcf 154
rgrover1 194:c99fc3160091 155 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: {
rgrover1 214:196183e51de3 156 discoveryStatus.terminateServiceDiscovery();
rgrover1 194:c99fc3160091 157 break;
rgrover1 194:c99fc3160091 158 }
rgrover1 195:061ed80ffbcf 159
rgrover1 194:c99fc3160091 160 default: {
rgrover1 197:de757ae3358b 161 discoveryStatus.serviceDiscoveryInProgress = false;
rgrover1 194:c99fc3160091 162 printf("gatt failure status: %u\r\n", p_ble_evt->evt.gattc_evt.gatt_status);
rgrover1 194:c99fc3160091 163 break;
rgrover1 194:c99fc3160091 164 }
rgrover1 194:c99fc3160091 165 }
rgrover1 194:c99fc3160091 166 break;
rgrover1 194:c99fc3160091 167
rgrover1 194:c99fc3160091 168 case BLE_GATTC_EVT_CHAR_DISC_RSP: {
rgrover1 194:c99fc3160091 169 switch (p_ble_evt->evt.gattc_evt.gatt_status) {
rgrover1 212:f2316b17d8be 170 case BLE_GATT_STATUS_SUCCESS: {
rgrover1 212:f2316b17d8be 171 // printf("count of characteristics: %u\r\n", p_ble_evt->evt.gattc_evt.params.char_disc_rsp.count);
rgrover1 212:f2316b17d8be 172 discoveryStatus.currCharInd = 0;
rgrover1 212:f2316b17d8be 173 discoveryStatus.charCount = p_ble_evt->evt.gattc_evt.params.char_disc_rsp.count;
rgrover1 212:f2316b17d8be 174
rgrover1 212:f2316b17d8be 175 unsigned charIndex = 0;
rgrover1 212:f2316b17d8be 176 for (; charIndex < discoveryStatus.charCount; charIndex++) {
rgrover1 212:f2316b17d8be 177 printf("%x [%u]\r\n", p_ble_evt->evt.gattc_evt.params.char_disc_rsp.chars[charIndex].uuid.uuid,
rgrover1 214:196183e51de3 178 p_ble_evt->evt.gattc_evt.params.char_disc_rsp.chars[charIndex].handle_value);
rgrover1 212:f2316b17d8be 179 // discoveryStatus.characteristics[charIndex].
rgrover1 212:f2316b17d8be 180 // setup(p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[charIndex].uuid.uuid,
rgrover1 212:f2316b17d8be 181 // p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[charIndex].handle_range.start_handle,
rgrover1 212:f2316b17d8be 182 // p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[charIndex].handle_range.end_handle);
rgrover1 212:f2316b17d8be 183 }
rgrover1 212:f2316b17d8be 184
rgrover1 212:f2316b17d8be 185 Gap::Handle_t startHandle = p_ble_evt->evt.gattc_evt.params.char_disc_rsp.chars[charIndex - 1].handle_value + 1;
rgrover1 212:f2316b17d8be 186 Gap::Handle_t endHandle = discoveryStatus.services[discoveryStatus.currSrvInd].endHandle;
rgrover1 212:f2316b17d8be 187
rgrover1 212:f2316b17d8be 188 if (startHandle < endHandle) {
rgrover1 212:f2316b17d8be 189 ble_gattc_handle_range_t handleRange = {
rgrover1 212:f2316b17d8be 190 .start_handle = startHandle,
rgrover1 212:f2316b17d8be 191 .end_handle = endHandle
rgrover1 212:f2316b17d8be 192 };
rgrover1 212:f2316b17d8be 193 printf("restarting char discovery from %u to %u\r\n", handleRange.start_handle, handleRange.end_handle);
rgrover1 212:f2316b17d8be 194 printf("char discovery returned %u\r\n", sd_ble_gattc_characteristics_discover(p_ble_evt->evt.gattc_evt.conn_handle, &handleRange));
rgrover1 212:f2316b17d8be 195 break;
rgrover1 212:f2316b17d8be 196 }
rgrover1 212:f2316b17d8be 197 }
rgrover1 212:f2316b17d8be 198
rgrover1 212:f2316b17d8be 199 /* NOTE: fallthrough */
rgrover1 212:f2316b17d8be 200
rgrover1 212:f2316b17d8be 201 case BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND: {
rgrover1 214:196183e51de3 202 discoveryStatus.terminateCharacteristicDiscovery();
rgrover1 212:f2316b17d8be 203 break;
rgrover1 212:f2316b17d8be 204 }
rgrover1 212:f2316b17d8be 205
rgrover1 194:c99fc3160091 206 default:
rgrover1 212:f2316b17d8be 207 printf("char response: gatt failure status: %u\r\n", p_ble_evt->evt.gattc_evt.gatt_status);
rgrover1 194:c99fc3160091 208 break;
rgrover1 194:c99fc3160091 209 }
rgrover1 194:c99fc3160091 210 break;
rgrover1 194:c99fc3160091 211 }
rgrover1 194:c99fc3160091 212 }
rgrover1 195:061ed80ffbcf 213
rgrover1 199:c2c831c55f3d 214 while (discoveryStatus.serviceDiscoveryInProgress && (discoveryStatus.currSrvInd < discoveryStatus.srvCount)) {
rgrover1 195:061ed80ffbcf 215 printf("%x [%u %u]\r\n",
rgrover1 212:f2316b17d8be 216 discoveryStatus.services[discoveryStatus.currSrvInd].uuid,
rgrover1 212:f2316b17d8be 217 discoveryStatus.services[discoveryStatus.currSrvInd].startHandle,
rgrover1 212:f2316b17d8be 218 discoveryStatus.services[discoveryStatus.currSrvInd].endHandle);
rgrover1 195:061ed80ffbcf 219
rgrover1 212:f2316b17d8be 220 launchCharacteristicDiscovery(discoveryStatus.connHandle,
rgrover1 212:f2316b17d8be 221 discoveryStatus.services[discoveryStatus.currSrvInd].startHandle,
rgrover1 212:f2316b17d8be 222 discoveryStatus.services[discoveryStatus.currSrvInd].endHandle);
rgrover1 195:061ed80ffbcf 223 }
rgrover1 212:f2316b17d8be 224 if (discoveryStatus.serviceDiscoveryInProgress && (discoveryStatus.srvCount > 0) && (discoveryStatus.currSrvInd > 0)) {
rgrover1 212:f2316b17d8be 225 Gap::Handle_t endHandle = discoveryStatus.services[discoveryStatus.currSrvInd - 1].endHandle;
rgrover1 214:196183e51de3 226 discoveryStatus.resetDiscoveredServices();
rgrover1 196:70f1b8354d57 227 printf("services discover returned %u\r\n",
rgrover1 212:f2316b17d8be 228 sd_ble_gattc_primary_services_discover(discoveryStatus.connHandle, endHandle, NULL));
rgrover1 196:70f1b8354d57 229 }
rgrover1 194:c99fc3160091 230 }