fork

Fork of nRF51822 by Nordic Semiconductor

Committer:
elevatorguy
Date:
Thu Aug 13 02:33:38 2015 +0000
Revision:
386:52cd618a90b4
Parent:
381:c997e9717fb7
changes

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Rohit Grover 22:c6ee8136847e 1 /* mbed Microcontroller Library
Rohit Grover 22:c6ee8136847e 2 * Copyright (c) 2006-2013 ARM Limited
Rohit Grover 22:c6ee8136847e 3 *
Rohit Grover 22:c6ee8136847e 4 * Licensed under the Apache License, Version 2.0 (the "License");
Rohit Grover 22:c6ee8136847e 5 * you may not use this file except in compliance with the License.
Rohit Grover 22:c6ee8136847e 6 * You may obtain a copy of the License at
Rohit Grover 22:c6ee8136847e 7 *
Rohit Grover 22:c6ee8136847e 8 * http://www.apache.org/licenses/LICENSE-2.0
Rohit Grover 22:c6ee8136847e 9 *
Rohit Grover 22:c6ee8136847e 10 * Unless required by applicable law or agreed to in writing, software
Rohit Grover 22:c6ee8136847e 11 * distributed under the License is distributed on an "AS IS" BASIS,
Rohit Grover 22:c6ee8136847e 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Rohit Grover 22:c6ee8136847e 13 * See the License for the specific language governing permissions and
Rohit Grover 22:c6ee8136847e 14 * limitations under the License.
Rohit Grover 22:c6ee8136847e 15 */
Rohit Grover 22:c6ee8136847e 16
Rohit Grover 22:c6ee8136847e 17 #include "nRF51GattServer.h"
Rohit Grover 22:c6ee8136847e 18 #include "mbed.h"
Rohit Grover 22:c6ee8136847e 19
Rohit Grover 22:c6ee8136847e 20 #include "common/common.h"
Rohit Grover 22:c6ee8136847e 21 #include "btle/custom/custom_helper.h"
Rohit Grover 22:c6ee8136847e 22
Rohit Grover 22:c6ee8136847e 23 #include "nRF51Gap.h"
Rohit Grover 22:c6ee8136847e 24
rgrover1 180:5082f66bb16e 25 nRF51GattServer &nRF51GattServer::getInstance(void) {
rgrover1 180:5082f66bb16e 26 static nRF51GattServer m_instance;
rgrover1 180:5082f66bb16e 27 return m_instance;
rgrover1 180:5082f66bb16e 28 }
rgrover1 180:5082f66bb16e 29
Rohit Grover 22:c6ee8136847e 30 /**************************************************************************/
Rohit Grover 22:c6ee8136847e 31 /*!
Rohit Grover 22:c6ee8136847e 32 @brief Adds a new service to the GATT table on the peripheral
Rohit Grover 22:c6ee8136847e 33
Rohit Grover 22:c6ee8136847e 34 @returns ble_error_t
Rohit Grover 22:c6ee8136847e 35
Rohit Grover 22:c6ee8136847e 36 @retval BLE_ERROR_NONE
Rohit Grover 22:c6ee8136847e 37 Everything executed properly
Rohit Grover 22:c6ee8136847e 38
Rohit Grover 22:c6ee8136847e 39 @section EXAMPLE
Rohit Grover 22:c6ee8136847e 40
Rohit Grover 22:c6ee8136847e 41 @code
Rohit Grover 22:c6ee8136847e 42
Rohit Grover 22:c6ee8136847e 43 @endcode
Rohit Grover 22:c6ee8136847e 44 */
Rohit Grover 22:c6ee8136847e 45 /**************************************************************************/
Rohit Grover 22:c6ee8136847e 46 ble_error_t nRF51GattServer::addService(GattService &service)
Rohit Grover 22:c6ee8136847e 47 {
Rohit Grover 22:c6ee8136847e 48 /* ToDo: Make sure we don't overflow the array, etc. */
Rohit Grover 22:c6ee8136847e 49 /* ToDo: Make sure this service UUID doesn't already exist (?) */
Rohit Grover 22:c6ee8136847e 50 /* ToDo: Basic validation */
Rohit Grover 22:c6ee8136847e 51
Rohit Grover 22:c6ee8136847e 52 /* Add the service to the nRF51 */
Rohit Grover 22:c6ee8136847e 53 ble_uuid_t nordicUUID;
Rohit Grover 22:c6ee8136847e 54 nordicUUID = custom_convert_to_nordic_uuid(service.getUUID());
Rohit Grover 29:cee837a465a1 55
Rohit Grover 29:cee837a465a1 56 uint16_t serviceHandle;
Rohit Grover 22:c6ee8136847e 57 ASSERT( ERROR_NONE ==
Rohit Grover 22:c6ee8136847e 58 sd_ble_gatts_service_add(BLE_GATTS_SRVC_TYPE_PRIMARY,
Rohit Grover 22:c6ee8136847e 59 &nordicUUID,
Rohit Grover 29:cee837a465a1 60 &serviceHandle),
Rohit Grover 22:c6ee8136847e 61 BLE_ERROR_PARAM_OUT_OF_RANGE );
Rohit Grover 29:cee837a465a1 62 service.setHandle(serviceHandle);
Rohit Grover 22:c6ee8136847e 63
Rohit Grover 22:c6ee8136847e 64 /* Add characteristics to the service */
Rohit Grover 22:c6ee8136847e 65 for (uint8_t i = 0; i < service.getCharacteristicCount(); i++) {
Rohit Grover 22:c6ee8136847e 66 GattCharacteristic *p_char = service.getCharacteristic(i);
Rohit Grover 22:c6ee8136847e 67
Rohit Grover 66:b3680699d9a4 68 /* Skip any incompletely defined, read-only characteristics. */
Rohit Grover 66:b3680699d9a4 69 if ((p_char->getValueAttribute().getValuePtr() == NULL) &&
Rohit Grover 66:b3680699d9a4 70 (p_char->getValueAttribute().getInitialLength() == 0) &&
Rohit Grover 66:b3680699d9a4 71 (p_char->getProperties() == GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ)) {
Rohit Grover 66:b3680699d9a4 72 continue;
Rohit Grover 66:b3680699d9a4 73 }
Rohit Grover 66:b3680699d9a4 74
carlescufi 55:9689ec201907 75 nordicUUID = custom_convert_to_nordic_uuid(p_char->getValueAttribute().getUUID());
Rohit Grover 22:c6ee8136847e 76
rgrover1 119:3ba3e377b972 77 /* The user-description descriptor is a special case which needs to be
rgrover1 119:3ba3e377b972 78 * handled at the time of adding the characteristic. The following block
rgrover1 119:3ba3e377b972 79 * is meant to discover its presence. */
rgrover1 119:3ba3e377b972 80 const uint8_t *userDescriptionDescriptorValuePtr = NULL;
rgrover1 119:3ba3e377b972 81 uint16_t userDescriptionDescriptorValueLen = 0;
rgrover1 119:3ba3e377b972 82 for (uint8_t j = 0; j < p_char->getDescriptorCount(); j++) {
rgrover1 119:3ba3e377b972 83 GattAttribute *p_desc = p_char->getDescriptor(j);
rgrover1 119:3ba3e377b972 84 if (p_desc->getUUID() == BLE_UUID_DESCRIPTOR_CHAR_USER_DESC) {
rgrover1 119:3ba3e377b972 85 userDescriptionDescriptorValuePtr = p_desc->getValuePtr();
rgrover1 119:3ba3e377b972 86 userDescriptionDescriptorValueLen = p_desc->getLength();
rgrover1 119:3ba3e377b972 87 }
rgrover1 119:3ba3e377b972 88 }
rgrover1 119:3ba3e377b972 89
Rohit Grover 22:c6ee8136847e 90 ASSERT ( ERROR_NONE ==
carlescufi 54:e2294c844c83 91 custom_add_in_characteristic(BLE_GATT_HANDLE_INVALID,
Rohit Grover 22:c6ee8136847e 92 &nordicUUID,
Rohit Grover 22:c6ee8136847e 93 p_char->getProperties(),
rgrover1 131:b21411170d00 94 p_char->getRequiredSecurity(),
carlescufi 55:9689ec201907 95 p_char->getValueAttribute().getValuePtr(),
carlescufi 55:9689ec201907 96 p_char->getValueAttribute().getInitialLength(),
carlescufi 55:9689ec201907 97 p_char->getValueAttribute().getMaxLength(),
rgrover1 119:3ba3e377b972 98 userDescriptionDescriptorValuePtr,
rgrover1 119:3ba3e377b972 99 userDescriptionDescriptorValueLen,
rgrover1 83:71302acf1804 100 p_char->isReadAuthorizationEnabled(),
rgrover1 82:6c51cbe4bc12 101 p_char->isWriteAuthorizationEnabled(),
Rohit Grover 22:c6ee8136847e 102 &nrfCharacteristicHandles[characteristicCount]),
Rohit Grover 22:c6ee8136847e 103 BLE_ERROR_PARAM_OUT_OF_RANGE );
Rohit Grover 22:c6ee8136847e 104
Rohit Grover 22:c6ee8136847e 105 /* Update the characteristic handle */
rgrover1 378:7d1411fe3316 106 p_characteristics[characteristicCount] = p_char;
rgrover1 378:7d1411fe3316 107 p_char->getValueAttribute().setHandle(nrfCharacteristicHandles[characteristicCount].value_handle);
rgrover1 378:7d1411fe3316 108 characteristicCount++;
Rohit Grover 56:a1071b629aa3 109
carlescufi 54:e2294c844c83 110 /* Add optional descriptors if any */
carlescufi 54:e2294c844c83 111 /* ToDo: Make sure we don't overflow the array */
carlescufi 54:e2294c844c83 112 for (uint8_t j = 0; j < p_char->getDescriptorCount(); j++) {
rgrover1 118:f9e5e2935c5c 113 GattAttribute *p_desc = p_char->getDescriptor(j);
rgrover1 119:3ba3e377b972 114 /* skip the user-description-descriptor here; this has already been handled when adding the characteristic (above). */
rgrover1 119:3ba3e377b972 115 if (p_desc->getUUID() == BLE_UUID_DESCRIPTOR_CHAR_USER_DESC) {
rgrover1 119:3ba3e377b972 116 continue;
rgrover1 119:3ba3e377b972 117 }
carlescufi 54:e2294c844c83 118
rgrover1 118:f9e5e2935c5c 119 nordicUUID = custom_convert_to_nordic_uuid(p_desc->getUUID());
carlescufi 54:e2294c844c83 120
rgrover1 118:f9e5e2935c5c 121 ASSERT(ERROR_NONE ==
rgrover1 118:f9e5e2935c5c 122 custom_add_in_descriptor(BLE_GATT_HANDLE_INVALID,
rgrover1 118:f9e5e2935c5c 123 &nordicUUID,
rgrover1 118:f9e5e2935c5c 124 p_desc->getValuePtr(),
rgrover1 118:f9e5e2935c5c 125 p_desc->getInitialLength(),
rgrover1 118:f9e5e2935c5c 126 p_desc->getMaxLength(),
rgrover1 118:f9e5e2935c5c 127 &nrfDescriptorHandles[descriptorCount]),
rgrover1 118:f9e5e2935c5c 128 BLE_ERROR_PARAM_OUT_OF_RANGE);
carlescufi 54:e2294c844c83 129
Rohit Grover 56:a1071b629aa3 130 p_descriptors[descriptorCount++] = p_desc;
rgrover1 378:7d1411fe3316 131 p_desc->setHandle(nrfDescriptorHandles[descriptorCount]);
Rohit Grover 30:85305292b44f 132 }
Rohit Grover 22:c6ee8136847e 133 }
Rohit Grover 22:c6ee8136847e 134
Rohit Grover 22:c6ee8136847e 135 serviceCount++;
Rohit Grover 22:c6ee8136847e 136
Rohit Grover 22:c6ee8136847e 137 return BLE_ERROR_NONE;
Rohit Grover 22:c6ee8136847e 138 }
Rohit Grover 22:c6ee8136847e 139
Rohit Grover 22:c6ee8136847e 140 /**************************************************************************/
Rohit Grover 22:c6ee8136847e 141 /*!
Rohit Grover 22:c6ee8136847e 142 @brief Reads the value of a characteristic, based on the service
Rohit Grover 22:c6ee8136847e 143 and characteristic index fields
Rohit Grover 22:c6ee8136847e 144
rgrover1 112:737b08b3b995 145 @param[in] attributeHandle
Rohit Grover 22:c6ee8136847e 146 The handle of the GattCharacteristic to read from
Rohit Grover 22:c6ee8136847e 147 @param[in] buffer
Rohit Grover 22:c6ee8136847e 148 Buffer to hold the the characteristic's value
Rohit Grover 22:c6ee8136847e 149 (raw byte array in LSB format)
rgrover1 112:737b08b3b995 150 @param[in/out] len
rgrover1 112:737b08b3b995 151 input: Length in bytes to be read.
rgrover1 112:737b08b3b995 152 output: Total length of attribute value upon successful return.
Rohit Grover 22:c6ee8136847e 153
Rohit Grover 22:c6ee8136847e 154 @returns ble_error_t
Rohit Grover 22:c6ee8136847e 155
Rohit Grover 22:c6ee8136847e 156 @retval BLE_ERROR_NONE
Rohit Grover 22:c6ee8136847e 157 Everything executed properly
Rohit Grover 22:c6ee8136847e 158 */
Rohit Grover 22:c6ee8136847e 159 /**************************************************************************/
rgrover1 371:8f7d2137727a 160 ble_error_t nRF51GattServer::read(GattAttribute::Handle_t attributeHandle, uint8_t buffer[], uint16_t *lengthP)
rgrover1 112:737b08b3b995 161 {
rgrover1 371:8f7d2137727a 162 return read(BLE_CONN_HANDLE_INVALID, attributeHandle, buffer, lengthP);
rgrover1 112:737b08b3b995 163 }
rgrover1 112:737b08b3b995 164
rgrover1 371:8f7d2137727a 165 ble_error_t nRF51GattServer::read(Gap::Handle_t connectionHandle, GattAttribute::Handle_t attributeHandle, uint8_t buffer[], uint16_t *lengthP)
Rohit Grover 22:c6ee8136847e 166 {
rgrover1 112:737b08b3b995 167 ble_gatts_value_t value = {
rgrover1 112:737b08b3b995 168 .len = *lengthP,
rgrover1 112:737b08b3b995 169 .offset = 0,
rgrover1 112:737b08b3b995 170 .p_value = buffer,
rgrover1 112:737b08b3b995 171 };
rgrover1 112:737b08b3b995 172
Rohit Grover 22:c6ee8136847e 173 ASSERT( ERROR_NONE ==
rgrover1 378:7d1411fe3316 174 sd_ble_gatts_value_get(connectionHandle, attributeHandle, &value),
Rohit Grover 22:c6ee8136847e 175 BLE_ERROR_PARAM_OUT_OF_RANGE);
rgrover1 112:737b08b3b995 176 *lengthP = value.len;
Rohit Grover 22:c6ee8136847e 177
Rohit Grover 22:c6ee8136847e 178 return BLE_ERROR_NONE;
Rohit Grover 22:c6ee8136847e 179 }
Rohit Grover 22:c6ee8136847e 180
Rohit Grover 22:c6ee8136847e 181 /**************************************************************************/
Rohit Grover 22:c6ee8136847e 182 /*!
Rohit Grover 22:c6ee8136847e 183 @brief Updates the value of a characteristic, based on the service
Rohit Grover 22:c6ee8136847e 184 and characteristic index fields
Rohit Grover 22:c6ee8136847e 185
Rohit Grover 22:c6ee8136847e 186 @param[in] charHandle
Rohit Grover 22:c6ee8136847e 187 The handle of the GattCharacteristic to write to
Rohit Grover 22:c6ee8136847e 188 @param[in] buffer
Rohit Grover 22:c6ee8136847e 189 Data to use when updating the characteristic's value
Rohit Grover 22:c6ee8136847e 190 (raw byte array in LSB format)
Rohit Grover 22:c6ee8136847e 191 @param[in] len
Rohit Grover 22:c6ee8136847e 192 The number of bytes in buffer
Rohit Grover 22:c6ee8136847e 193
Rohit Grover 22:c6ee8136847e 194 @returns ble_error_t
Rohit Grover 22:c6ee8136847e 195
Rohit Grover 22:c6ee8136847e 196 @retval BLE_ERROR_NONE
Rohit Grover 22:c6ee8136847e 197 Everything executed properly
Rohit Grover 22:c6ee8136847e 198 */
Rohit Grover 22:c6ee8136847e 199 /**************************************************************************/
rgrover1 371:8f7d2137727a 200 ble_error_t nRF51GattServer::write(GattAttribute::Handle_t attributeHandle, const uint8_t buffer[], uint16_t len, bool localOnly)
rgrover1 112:737b08b3b995 201 {
rgrover1 371:8f7d2137727a 202 return write(BLE_CONN_HANDLE_INVALID, attributeHandle, buffer, len, localOnly);
rgrover1 112:737b08b3b995 203 }
rgrover1 112:737b08b3b995 204
rgrover1 371:8f7d2137727a 205 ble_error_t nRF51GattServer::write(Gap::Handle_t connectionHandle, GattAttribute::Handle_t attributeHandle, const uint8_t buffer[], uint16_t len, bool localOnly)
Rohit Grover 22:c6ee8136847e 206 {
Rohit Grover 22:c6ee8136847e 207 uint16_t gapConnectionHandle = nRF51Gap::getInstance().getConnectionHandle();
rgrover1 88:fdb2b0db620e 208 ble_error_t returnValue = BLE_ERROR_NONE;
Rohit Grover 22:c6ee8136847e 209
rgrover1 112:737b08b3b995 210 ble_gatts_value_t value = {
rgrover1 112:737b08b3b995 211 .len = len,
rgrover1 112:737b08b3b995 212 .offset = 0,
rgrover1 112:737b08b3b995 213 .p_value = const_cast<uint8_t *>(buffer),
rgrover1 112:737b08b3b995 214 };
rgrover1 112:737b08b3b995 215
Rohit Grover 22:c6ee8136847e 216 if (localOnly) {
Rohit Grover 22:c6ee8136847e 217 /* Only update locally regardless of notify/indicate */
Rohit Grover 22:c6ee8136847e 218 ASSERT_INT( ERROR_NONE,
rgrover1 378:7d1411fe3316 219 sd_ble_gatts_value_set(connectionHandle, attributeHandle, &value),
Rohit Grover 22:c6ee8136847e 220 BLE_ERROR_PARAM_OUT_OF_RANGE );
rgrover1 112:737b08b3b995 221 return BLE_ERROR_NONE;
Rohit Grover 22:c6ee8136847e 222 }
Rohit Grover 22:c6ee8136847e 223
rgrover1 378:7d1411fe3316 224 int characteristicIndex = resolveValueHandleToCharIndex(attributeHandle);
rgrover1 378:7d1411fe3316 225 if ((characteristicIndex != -1) &&
rgrover1 378:7d1411fe3316 226 (p_characteristics[characteristicIndex]->getProperties() & (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)) &&
rgrover1 112:737b08b3b995 227 (gapConnectionHandle != connectionHandle)) {
Rohit Grover 22:c6ee8136847e 228 /* HVX update for the characteristic value */
Rohit Grover 22:c6ee8136847e 229 ble_gatts_hvx_params_t hvx_params;
Rohit Grover 22:c6ee8136847e 230
rgrover1 378:7d1411fe3316 231 hvx_params.handle = attributeHandle;
Rohit Grover 22:c6ee8136847e 232 hvx_params.type =
rgrover1 378:7d1411fe3316 233 (p_characteristics[characteristicIndex]->getProperties() & GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY) ? BLE_GATT_HVX_NOTIFICATION : BLE_GATT_HVX_INDICATION;
Rohit Grover 22:c6ee8136847e 234 hvx_params.offset = 0;
rgrover1 108:27213b9fd4f9 235 hvx_params.p_data = const_cast<uint8_t *>(buffer);
Rohit Grover 22:c6ee8136847e 236 hvx_params.p_len = &len;
Rohit Grover 22:c6ee8136847e 237
Rohit Grover 22:c6ee8136847e 238 error_t error = (error_t) sd_ble_gatts_hvx(gapConnectionHandle, &hvx_params);
Rohit Grover 22:c6ee8136847e 239
rgrover1 112:737b08b3b995 240 /* ERROR_INVALID_STATE, ERROR_BUSY, ERROR_GATTS_SYS_ATTR_MISSING and ERROR_NO_TX_BUFFERS the ATT table has been updated. */
rgrover1 112:737b08b3b995 241 if ((error != ERROR_NONE) && (error != ERROR_INVALID_STATE) && (error != ERROR_BLE_NO_TX_BUFFERS) && (error != ERROR_BUSY) && (error != ERROR_BLEGATTS_SYS_ATTR_MISSING)) {
Rohit Grover 22:c6ee8136847e 242 ASSERT_INT( ERROR_NONE,
rgrover1 378:7d1411fe3316 243 sd_ble_gatts_value_set(connectionHandle, attributeHandle, &value),
Rohit Grover 22:c6ee8136847e 244 BLE_ERROR_PARAM_OUT_OF_RANGE );
Rohit Grover 22:c6ee8136847e 245 }
rgrover1 88:fdb2b0db620e 246
rgrover1 89:c0dbd55614b2 247 /* Notifications consume application buffers. The return value can
rgrover1 88:fdb2b0db620e 248 be used for resending notifications.
rgrover1 88:fdb2b0db620e 249 */
rgrover1 89:c0dbd55614b2 250 if (error != ERROR_NONE) {
rgrover1 88:fdb2b0db620e 251 returnValue = BLE_STACK_BUSY;
rgrover1 88:fdb2b0db620e 252 }
Rohit Grover 22:c6ee8136847e 253 } else {
Rohit Grover 22:c6ee8136847e 254 ASSERT_INT( ERROR_NONE,
rgrover1 378:7d1411fe3316 255 sd_ble_gatts_value_set(connectionHandle, attributeHandle, &value),
Rohit Grover 22:c6ee8136847e 256 BLE_ERROR_PARAM_OUT_OF_RANGE );
Rohit Grover 22:c6ee8136847e 257 }
Rohit Grover 22:c6ee8136847e 258
rgrover1 88:fdb2b0db620e 259 return returnValue;
Rohit Grover 22:c6ee8136847e 260 }
Rohit Grover 22:c6ee8136847e 261
rgrover1 379:da2b85a3dc5c 262 ble_error_t nRF51GattServer::areUpdatesEnabled(const GattCharacteristic &characteristic, bool *enabledP)
rgrover1 379:da2b85a3dc5c 263 {
rgrover1 379:da2b85a3dc5c 264 /* Forward the call with the default connection handle. */
rgrover1 379:da2b85a3dc5c 265 return areUpdatesEnabled(nRF51Gap::getInstance().getConnectionHandle(), characteristic, enabledP);
rgrover1 379:da2b85a3dc5c 266 }
rgrover1 379:da2b85a3dc5c 267
rgrover1 379:da2b85a3dc5c 268 ble_error_t nRF51GattServer::areUpdatesEnabled(Gap::Handle_t connectionHandle, const GattCharacteristic &characteristic, bool *enabledP)
rgrover1 379:da2b85a3dc5c 269 {
rgrover1 379:da2b85a3dc5c 270 int characteristicIndex = resolveValueHandleToCharIndex(characteristic.getValueHandle());
rgrover1 379:da2b85a3dc5c 271 if (characteristicIndex == -1) {
rgrover1 379:da2b85a3dc5c 272 return BLE_ERROR_INVALID_PARAM;
rgrover1 379:da2b85a3dc5c 273 }
rgrover1 379:da2b85a3dc5c 274
rgrover1 379:da2b85a3dc5c 275 /* Read the cccd value from the GATT server. */
rgrover1 379:da2b85a3dc5c 276 GattAttribute::Handle_t cccdHandle = nrfCharacteristicHandles[characteristicIndex].cccd_handle;
rgrover1 379:da2b85a3dc5c 277 uint16_t cccdValue;
rgrover1 379:da2b85a3dc5c 278 uint16_t length = sizeof(cccdValue);
rgrover1 379:da2b85a3dc5c 279 ble_error_t rc = read(connectionHandle, cccdHandle, reinterpret_cast<uint8_t *>(&cccdValue), &length);
rgrover1 379:da2b85a3dc5c 280 if (rc != BLE_ERROR_NONE) {
rgrover1 379:da2b85a3dc5c 281 return rc;
rgrover1 379:da2b85a3dc5c 282 }
rgrover1 379:da2b85a3dc5c 283 if (length != sizeof(cccdValue)) {
rgrover1 379:da2b85a3dc5c 284 return BLE_ERROR_INVALID_STATE;
rgrover1 379:da2b85a3dc5c 285 }
rgrover1 379:da2b85a3dc5c 286
rgrover1 379:da2b85a3dc5c 287 /* Check for NOTFICATION or INDICATION in CCCD. */
rgrover1 379:da2b85a3dc5c 288 if ((cccdValue & BLE_GATT_HVX_NOTIFICATION) || (cccdValue & BLE_GATT_HVX_INDICATION)) {
rgrover1 379:da2b85a3dc5c 289 *enabledP = true;
rgrover1 379:da2b85a3dc5c 290 }
rgrover1 379:da2b85a3dc5c 291
rgrover1 379:da2b85a3dc5c 292 return BLE_ERROR_NONE;
rgrover1 379:da2b85a3dc5c 293 }
rgrover1 379:da2b85a3dc5c 294
Rohit Grover 22:c6ee8136847e 295 /**************************************************************************/
Rohit Grover 22:c6ee8136847e 296 /*!
Rohit Grover 22:c6ee8136847e 297 @brief Callback handler for events getting pushed up from the SD
Rohit Grover 22:c6ee8136847e 298 */
Rohit Grover 22:c6ee8136847e 299 /**************************************************************************/
Rohit Grover 22:c6ee8136847e 300 void nRF51GattServer::hwCallback(ble_evt_t *p_ble_evt)
Rohit Grover 22:c6ee8136847e 301 {
rgrover1 162:ba351b0adc4b 302 GattAttribute::Handle_t handle_value;
Rohit Grover 56:a1071b629aa3 303 GattServerEvents::gattEvent_t eventType;
Rohit Grover 56:a1071b629aa3 304 const ble_gatts_evt_t *gattsEventP = &p_ble_evt->evt.gatts_evt;
Rohit Grover 22:c6ee8136847e 305
Rohit Grover 22:c6ee8136847e 306 switch (p_ble_evt->header.evt_id) {
rgrover1 378:7d1411fe3316 307 case BLE_GATTS_EVT_WRITE: {
rgrover1 378:7d1411fe3316 308 /* There are 2 use case here: Values being updated & CCCD (indicate/notify) enabled */
Rohit Grover 22:c6ee8136847e 309
rgrover1 378:7d1411fe3316 310 /* 1.) Handle CCCD changes */
rgrover1 378:7d1411fe3316 311 handle_value = gattsEventP->params.write.handle;
rgrover1 378:7d1411fe3316 312 int characteristicIndex = resolveCCCDHandleToCharIndex(handle_value);
rgrover1 378:7d1411fe3316 313 if ((characteristicIndex != -1) &&
rgrover1 378:7d1411fe3316 314 (p_characteristics[characteristicIndex]->getProperties() &
rgrover1 378:7d1411fe3316 315 (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY))) {
rgrover1 378:7d1411fe3316 316
rgrover1 175:d0385f84ef92 317 uint16_t cccd_value = (gattsEventP->params.write.data[1] << 8) | gattsEventP->params.write.data[0]; /* Little Endian but M0 may be mis-aligned */
Rohit Grover 22:c6ee8136847e 318
rgrover1 378:7d1411fe3316 319 if (((p_characteristics[characteristicIndex]->getProperties() & GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE) && (cccd_value & BLE_GATT_HVX_INDICATION)) ||
rgrover1 378:7d1411fe3316 320 ((p_characteristics[characteristicIndex]->getProperties() & GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY) && (cccd_value & BLE_GATT_HVX_NOTIFICATION))) {
Rohit Grover 56:a1071b629aa3 321 eventType = GattServerEvents::GATT_EVENT_UPDATES_ENABLED;
Rohit Grover 22:c6ee8136847e 322 } else {
Rohit Grover 56:a1071b629aa3 323 eventType = GattServerEvents::GATT_EVENT_UPDATES_DISABLED;
Rohit Grover 22:c6ee8136847e 324 }
Rohit Grover 22:c6ee8136847e 325
rgrover1 378:7d1411fe3316 326 handleEvent(eventType, p_characteristics[characteristicIndex]->getValueHandle());
Rohit Grover 22:c6ee8136847e 327 return;
Rohit Grover 22:c6ee8136847e 328 }
rgrover1 378:7d1411fe3316 329
rgrover1 378:7d1411fe3316 330 /* 2.) Changes to the characteristic value will be handled with other events below */
rgrover1 378:7d1411fe3316 331 eventType = GattServerEvents::GATT_EVENT_DATA_WRITTEN;
rgrover1 370:295f76db798e 332 }
Rohit Grover 22:c6ee8136847e 333 break;
Rohit Grover 22:c6ee8136847e 334
Rohit Grover 22:c6ee8136847e 335 case BLE_GATTS_EVT_HVC:
Rohit Grover 22:c6ee8136847e 336 /* Indication confirmation received */
Rohit Grover 56:a1071b629aa3 337 eventType = GattServerEvents::GATT_EVENT_CONFIRMATION_RECEIVED;
Rohit Grover 56:a1071b629aa3 338 handle_value = gattsEventP->params.hvc.handle;
Rohit Grover 22:c6ee8136847e 339 break;
Rohit Grover 22:c6ee8136847e 340
Rohit Grover 56:a1071b629aa3 341 case BLE_EVT_TX_COMPLETE: {
Rohit Grover 56:a1071b629aa3 342 handleDataSentEvent(p_ble_evt->evt.common_evt.params.tx_complete.count);
Rohit Grover 56:a1071b629aa3 343 return;
Rohit Grover 56:a1071b629aa3 344 }
Rohit Grover 56:a1071b629aa3 345
Rohit Grover 39:d52a28e1fa80 346 case BLE_GATTS_EVT_SYS_ATTR_MISSING:
rgrover1 112:737b08b3b995 347 sd_ble_gatts_sys_attr_set(gattsEventP->conn_handle, NULL, 0, 0);
Rohit Grover 39:d52a28e1fa80 348 return;
Rohit Grover 39:d52a28e1fa80 349
rgrover1 82:6c51cbe4bc12 350 case BLE_GATTS_EVT_RW_AUTHORIZE_REQUEST:
rgrover1 83:71302acf1804 351 switch (gattsEventP->params.authorize_request.type) {
rgrover1 83:71302acf1804 352 case BLE_GATTS_AUTHORIZE_TYPE_READ:
rgrover1 83:71302acf1804 353 eventType = GattServerEvents::GATT_EVENT_READ_AUTHORIZATION_REQ;
rgrover1 83:71302acf1804 354 handle_value = gattsEventP->params.authorize_request.request.read.handle;
rgrover1 83:71302acf1804 355 break;
rgrover1 83:71302acf1804 356 case BLE_GATTS_AUTHORIZE_TYPE_WRITE:
rgrover1 83:71302acf1804 357 eventType = GattServerEvents::GATT_EVENT_WRITE_AUTHORIZATION_REQ;
rgrover1 83:71302acf1804 358 handle_value = gattsEventP->params.authorize_request.request.write.handle;
rgrover1 83:71302acf1804 359 break;
rgrover1 83:71302acf1804 360 default:
rgrover1 83:71302acf1804 361 return;
rgrover1 82:6c51cbe4bc12 362 }
rgrover1 82:6c51cbe4bc12 363 break;
rgrover1 82:6c51cbe4bc12 364
Rohit Grover 22:c6ee8136847e 365 default:
Rohit Grover 22:c6ee8136847e 366 return;
Rohit Grover 22:c6ee8136847e 367 }
Rohit Grover 22:c6ee8136847e 368
rgrover1 378:7d1411fe3316 369 int characteristicIndex = resolveValueHandleToCharIndex(handle_value);
rgrover1 378:7d1411fe3316 370 if (characteristicIndex == -1) {
rgrover1 378:7d1411fe3316 371 return;
rgrover1 378:7d1411fe3316 372 }
rgrover1 378:7d1411fe3316 373
Rohit Grover 22:c6ee8136847e 374 /* Find index (charHandle) in the pool */
rgrover1 378:7d1411fe3316 375 switch (eventType) {
rgrover1 378:7d1411fe3316 376 case GattServerEvents::GATT_EVENT_DATA_WRITTEN: {
rgrover1 378:7d1411fe3316 377 GattWriteCallbackParams cbParams = {
rgrover1 378:7d1411fe3316 378 .handle = handle_value,
rgrover1 378:7d1411fe3316 379 .writeOp = static_cast<GattWriteCallbackParams::WriteOp_t>(gattsEventP->params.write.op),
rgrover1 378:7d1411fe3316 380 .offset = gattsEventP->params.write.offset,
rgrover1 378:7d1411fe3316 381 .len = gattsEventP->params.write.len,
rgrover1 378:7d1411fe3316 382 .data = gattsEventP->params.write.data
rgrover1 378:7d1411fe3316 383 };
rgrover1 378:7d1411fe3316 384 handleDataWrittenEvent(&cbParams);
rgrover1 378:7d1411fe3316 385 break;
rgrover1 378:7d1411fe3316 386 }
rgrover1 378:7d1411fe3316 387 case GattServerEvents::GATT_EVENT_WRITE_AUTHORIZATION_REQ: {
rgrover1 378:7d1411fe3316 388 GattWriteAuthCallbackParams cbParams = {
rgrover1 378:7d1411fe3316 389 .handle = handle_value,
rgrover1 378:7d1411fe3316 390 .offset = gattsEventP->params.authorize_request.request.write.offset,
rgrover1 378:7d1411fe3316 391 .len = gattsEventP->params.authorize_request.request.write.len,
rgrover1 378:7d1411fe3316 392 .data = gattsEventP->params.authorize_request.request.write.data,
rgrover1 378:7d1411fe3316 393 };
rgrover1 378:7d1411fe3316 394 ble_gatts_rw_authorize_reply_params_t reply = {
rgrover1 378:7d1411fe3316 395 .type = BLE_GATTS_AUTHORIZE_TYPE_WRITE,
rgrover1 378:7d1411fe3316 396 .params = {
rgrover1 378:7d1411fe3316 397 .write = {
rgrover1 378:7d1411fe3316 398 .gatt_status = p_characteristics[characteristicIndex]->authorizeWrite(&cbParams)
rgrover1 378:7d1411fe3316 399 }
Rohit Grover 56:a1071b629aa3 400 }
rgrover1 378:7d1411fe3316 401 };
rgrover1 378:7d1411fe3316 402 sd_ble_gatts_rw_authorize_reply(gattsEventP->conn_handle, &reply);
rgrover1 92:8c1553b39b03 403
rgrover1 378:7d1411fe3316 404 /*
rgrover1 378:7d1411fe3316 405 * If write-authorization is enabled for a characteristic,
rgrover1 378:7d1411fe3316 406 * AUTHORIZATION_REQ event (if replied with true) is *not*
rgrover1 378:7d1411fe3316 407 * followed by another DATA_WRITTEN event; so we still need
rgrover1 378:7d1411fe3316 408 * to invoke handleDataWritten(), much the same as we would
rgrover1 378:7d1411fe3316 409 * have done if write-authorization had not been enabled.
rgrover1 378:7d1411fe3316 410 */
rgrover1 378:7d1411fe3316 411 if (reply.params.write.gatt_status == BLE_GATT_STATUS_SUCCESS) {
rgrover1 378:7d1411fe3316 412 GattWriteCallbackParams cbParams = {
rgrover1 378:7d1411fe3316 413 .handle = handle_value,
rgrover1 378:7d1411fe3316 414 .writeOp = static_cast<GattWriteCallbackParams::WriteOp_t>(gattsEventP->params.authorize_request.request.write.op),
rgrover1 378:7d1411fe3316 415 .offset = gattsEventP->params.authorize_request.request.write.offset,
rgrover1 378:7d1411fe3316 416 .len = gattsEventP->params.authorize_request.request.write.len,
rgrover1 378:7d1411fe3316 417 .data = gattsEventP->params.authorize_request.request.write.data,
rgrover1 378:7d1411fe3316 418 };
rgrover1 378:7d1411fe3316 419 handleDataWrittenEvent(&cbParams);
rgrover1 378:7d1411fe3316 420 }
rgrover1 378:7d1411fe3316 421 break;
rgrover1 378:7d1411fe3316 422 }
rgrover1 378:7d1411fe3316 423 case GattServerEvents::GATT_EVENT_READ_AUTHORIZATION_REQ: {
rgrover1 378:7d1411fe3316 424 GattReadAuthCallbackParams cbParams = {
rgrover1 378:7d1411fe3316 425 .handle = handle_value,
rgrover1 378:7d1411fe3316 426 .offset = gattsEventP->params.authorize_request.request.read.offset,
rgrover1 378:7d1411fe3316 427 .len = 0,
rgrover1 378:7d1411fe3316 428 .data = NULL
rgrover1 378:7d1411fe3316 429 };
rgrover1 86:561631ee642d 430
rgrover1 378:7d1411fe3316 431 ble_gatts_rw_authorize_reply_params_t reply = {
rgrover1 378:7d1411fe3316 432 .type = BLE_GATTS_AUTHORIZE_TYPE_READ,
rgrover1 378:7d1411fe3316 433 .params = {
rgrover1 378:7d1411fe3316 434 .read = {
rgrover1 378:7d1411fe3316 435 .gatt_status = p_characteristics[characteristicIndex]->authorizeRead(&cbParams)
rgrover1 378:7d1411fe3316 436 }
rgrover1 378:7d1411fe3316 437 }
rgrover1 378:7d1411fe3316 438 };
rgrover1 370:295f76db798e 439
rgrover1 378:7d1411fe3316 440 if (cbParams.authorizationReply == BLE_GATT_STATUS_SUCCESS) {
rgrover1 378:7d1411fe3316 441 if (cbParams.data != NULL) {
rgrover1 378:7d1411fe3316 442 reply.params.read.update = 1;
rgrover1 378:7d1411fe3316 443 reply.params.read.offset = cbParams.offset;
rgrover1 378:7d1411fe3316 444 reply.params.read.len = cbParams.len;
rgrover1 378:7d1411fe3316 445 reply.params.read.p_data = cbParams.data;
rgrover1 378:7d1411fe3316 446 }
rgrover1 378:7d1411fe3316 447 }
rgrover1 86:561631ee642d 448
rgrover1 378:7d1411fe3316 449 sd_ble_gatts_rw_authorize_reply(gattsEventP->conn_handle, &reply);
rgrover1 378:7d1411fe3316 450 break;
rgrover1 378:7d1411fe3316 451 }
rgrover1 86:561631ee642d 452
rgrover1 378:7d1411fe3316 453 default:
rgrover1 378:7d1411fe3316 454 handleEvent(eventType, handle_value);
rgrover1 378:7d1411fe3316 455 break;
rgrover1 370:295f76db798e 456 }
rgrover1 78:9a5ba2c5d53c 457 }