Michael Galis / nRF51822

No changes

Fork of nRF51822 by Nordic Semiconductor

source/nRF5xGattServer.cpp@522:0f791e328558, 2015-12-02 (annotated)

Committer:
rgrover1
Date:
Wed Dec 02 12:58:42 2015 +0000
Revision:
522:0f791e328558
Parent:
521:1db090c0e563
Child:
524:502e53732c75
Synchronized with git rev 9620c7a1

Author: Rohit Grover

Release 2.1.2

=============



Minor update around GattCharacteristics having variable length.

Who changed what in which revision?

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