Nordic stack and drivers for the mbed BLE API
Dependents: BLE_ANCS_SDAPI BLE_temperature BLE_HeartRate writable_gatt ... more
source/nRF5xGattServer.cpp@517:23d16e238129, 2015-12-02 (annotated)
- Committer:
- rgrover1
- Date:
- Wed Dec 02 12:58:41 2015 +0000
- Revision:
- 517:23d16e238129
- Parent:
- 514:a3b6d669c210
- Child:
- 521:1db090c0e563
Synchronized with git rev 60a7c0c0
Author: Rohit Grover
bring in the latest changes for BLE::init() where we allow <object, member> tuples for init callback.
Who changed what in which revision?
User | Revision | Line number | New 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 | 517:23d16e238129 | 72 | (p_char->getValueAttribute().getInitialLength() == 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 | 517:23d16e238129 | 98 | p_char->getValueAttribute().getInitialLength(), |
rgrover1 | 388:db85a09c27ef | 99 | p_char->getValueAttribute().getMaxLength(), |
rgrover1 | 388:db85a09c27ef | 100 | userDescriptionDescriptorValuePtr, |
rgrover1 | 388:db85a09c27ef | 101 | userDescriptionDescriptorValueLen, |
rgrover1 | 388:db85a09c27ef | 102 | p_char->isReadAuthorizationEnabled(), |
rgrover1 | 388:db85a09c27ef | 103 | p_char->isWriteAuthorizationEnabled(), |
rgrover1 | 388:db85a09c27ef | 104 | &nrfCharacteristicHandles[characteristicCount]), |
rgrover1 | 388:db85a09c27ef | 105 | BLE_ERROR_PARAM_OUT_OF_RANGE ); |
rgrover1 | 388:db85a09c27ef | 106 | |
rgrover1 | 388:db85a09c27ef | 107 | /* Update the characteristic handle */ |
rgrover1 | 388:db85a09c27ef | 108 | p_characteristics[characteristicCount] = p_char; |
rgrover1 | 388:db85a09c27ef | 109 | p_char->getValueAttribute().setHandle(nrfCharacteristicHandles[characteristicCount].value_handle); |
rgrover1 | 388:db85a09c27ef | 110 | characteristicCount++; |
rgrover1 | 388:db85a09c27ef | 111 | |
rgrover1 | 388:db85a09c27ef | 112 | /* Add optional descriptors if any */ |
rgrover1 | 388:db85a09c27ef | 113 | for (uint8_t j = 0; j < p_char->getDescriptorCount(); j++) { |
rgrover1 | 455:e33de7c4574c | 114 | if (descriptorCount >= BLE_TOTAL_DESCRIPTORS) { |
rgrover1 | 455:e33de7c4574c | 115 | return BLE_ERROR_NO_MEM; |
rgrover1 | 455:e33de7c4574c | 116 | } |
rgrover1 | 455:e33de7c4574c | 117 | |
rgrover1 | 451:87e7f14a3fa1 | 118 | GattAttribute *p_desc = p_char->getDescriptor(j); |
rgrover1 | 388:db85a09c27ef | 119 | /* skip the user-description-descriptor here; this has already been handled when adding the characteristic (above). */ |
rgrover1 | 388:db85a09c27ef | 120 | if (p_desc->getUUID() == BLE_UUID_DESCRIPTOR_CHAR_USER_DESC) { |
rgrover1 | 388:db85a09c27ef | 121 | continue; |
rgrover1 | 388:db85a09c27ef | 122 | } |
rgrover1 | 388:db85a09c27ef | 123 | |
rgrover1 | 388:db85a09c27ef | 124 | nordicUUID = custom_convert_to_nordic_uuid(p_desc->getUUID()); |
rgrover1 | 388:db85a09c27ef | 125 | |
rgrover1 | 388:db85a09c27ef | 126 | ASSERT(ERROR_NONE == |
rgrover1 | 388:db85a09c27ef | 127 | custom_add_in_descriptor(BLE_GATT_HANDLE_INVALID, |
rgrover1 | 388:db85a09c27ef | 128 | &nordicUUID, |
rgrover1 | 388:db85a09c27ef | 129 | p_desc->getValuePtr(), |
rgrover1 | 517:23d16e238129 | 130 | p_desc->getInitialLength(), |
rgrover1 | 388:db85a09c27ef | 131 | p_desc->getMaxLength(), |
rgrover1 | 388:db85a09c27ef | 132 | &nrfDescriptorHandles[descriptorCount]), |
rgrover1 | 388:db85a09c27ef | 133 | BLE_ERROR_PARAM_OUT_OF_RANGE); |
rgrover1 | 388:db85a09c27ef | 134 | |
rgrover1 | 388:db85a09c27ef | 135 | p_descriptors[descriptorCount++] = p_desc; |
rgrover1 | 388:db85a09c27ef | 136 | p_desc->setHandle(nrfDescriptorHandles[descriptorCount]); |
rgrover1 | 388:db85a09c27ef | 137 | } |
rgrover1 | 388:db85a09c27ef | 138 | } |
rgrover1 | 388:db85a09c27ef | 139 | |
rgrover1 | 388:db85a09c27ef | 140 | serviceCount++; |
rgrover1 | 388:db85a09c27ef | 141 | |
rgrover1 | 388:db85a09c27ef | 142 | return BLE_ERROR_NONE; |
rgrover1 | 388:db85a09c27ef | 143 | } |
rgrover1 | 388:db85a09c27ef | 144 | |
rgrover1 | 388:db85a09c27ef | 145 | /**************************************************************************/ |
rgrover1 | 388:db85a09c27ef | 146 | /*! |
rgrover1 | 388:db85a09c27ef | 147 | @brief Reads the value of a characteristic, based on the service |
rgrover1 | 388:db85a09c27ef | 148 | and characteristic index fields |
rgrover1 | 388:db85a09c27ef | 149 | |
rgrover1 | 388:db85a09c27ef | 150 | @param[in] attributeHandle |
rgrover1 | 388:db85a09c27ef | 151 | The handle of the GattCharacteristic to read from |
rgrover1 | 388:db85a09c27ef | 152 | @param[in] buffer |
rgrover1 | 388:db85a09c27ef | 153 | Buffer to hold the the characteristic's value |
rgrover1 | 388:db85a09c27ef | 154 | (raw byte array in LSB format) |
rgrover1 | 388:db85a09c27ef | 155 | @param[in/out] len |
rgrover1 | 388:db85a09c27ef | 156 | input: Length in bytes to be read. |
rgrover1 | 388:db85a09c27ef | 157 | output: Total length of attribute value upon successful return. |
rgrover1 | 388:db85a09c27ef | 158 | |
rgrover1 | 388:db85a09c27ef | 159 | @returns ble_error_t |
rgrover1 | 388:db85a09c27ef | 160 | |
rgrover1 | 388:db85a09c27ef | 161 | @retval BLE_ERROR_NONE |
rgrover1 | 388:db85a09c27ef | 162 | Everything executed properly |
rgrover1 | 388:db85a09c27ef | 163 | */ |
rgrover1 | 388:db85a09c27ef | 164 | /**************************************************************************/ |
rgrover1 | 388:db85a09c27ef | 165 | ble_error_t nRF5xGattServer::read(GattAttribute::Handle_t attributeHandle, uint8_t buffer[], uint16_t *lengthP) |
rgrover1 | 388:db85a09c27ef | 166 | { |
rgrover1 | 388:db85a09c27ef | 167 | return read(BLE_CONN_HANDLE_INVALID, attributeHandle, buffer, lengthP); |
rgrover1 | 388:db85a09c27ef | 168 | } |
rgrover1 | 388:db85a09c27ef | 169 | |
rgrover1 | 388:db85a09c27ef | 170 | ble_error_t nRF5xGattServer::read(Gap::Handle_t connectionHandle, GattAttribute::Handle_t attributeHandle, uint8_t buffer[], uint16_t *lengthP) |
rgrover1 | 388:db85a09c27ef | 171 | { |
rgrover1 | 388:db85a09c27ef | 172 | ble_gatts_value_t value = { |
rgrover1 | 388:db85a09c27ef | 173 | .len = *lengthP, |
rgrover1 | 388:db85a09c27ef | 174 | .offset = 0, |
rgrover1 | 388:db85a09c27ef | 175 | .p_value = buffer, |
rgrover1 | 388:db85a09c27ef | 176 | }; |
rgrover1 | 388:db85a09c27ef | 177 | |
rgrover1 | 388:db85a09c27ef | 178 | ASSERT( ERROR_NONE == |
rgrover1 | 388:db85a09c27ef | 179 | sd_ble_gatts_value_get(connectionHandle, attributeHandle, &value), |
rgrover1 | 388:db85a09c27ef | 180 | BLE_ERROR_PARAM_OUT_OF_RANGE); |
rgrover1 | 388:db85a09c27ef | 181 | *lengthP = value.len; |
rgrover1 | 388:db85a09c27ef | 182 | |
rgrover1 | 388:db85a09c27ef | 183 | return BLE_ERROR_NONE; |
rgrover1 | 388:db85a09c27ef | 184 | } |
rgrover1 | 388:db85a09c27ef | 185 | |
rgrover1 | 388:db85a09c27ef | 186 | /**************************************************************************/ |
rgrover1 | 388:db85a09c27ef | 187 | /*! |
rgrover1 | 388:db85a09c27ef | 188 | @brief Updates the value of a characteristic, based on the service |
rgrover1 | 388:db85a09c27ef | 189 | and characteristic index fields |
rgrover1 | 388:db85a09c27ef | 190 | |
rgrover1 | 388:db85a09c27ef | 191 | @param[in] charHandle |
rgrover1 | 388:db85a09c27ef | 192 | The handle of the GattCharacteristic to write to |
rgrover1 | 388:db85a09c27ef | 193 | @param[in] buffer |
rgrover1 | 388:db85a09c27ef | 194 | Data to use when updating the characteristic's value |
rgrover1 | 388:db85a09c27ef | 195 | (raw byte array in LSB format) |
rgrover1 | 388:db85a09c27ef | 196 | @param[in] len |
rgrover1 | 388:db85a09c27ef | 197 | The number of bytes in buffer |
rgrover1 | 388:db85a09c27ef | 198 | |
rgrover1 | 388:db85a09c27ef | 199 | @returns ble_error_t |
rgrover1 | 388:db85a09c27ef | 200 | |
rgrover1 | 388:db85a09c27ef | 201 | @retval BLE_ERROR_NONE |
rgrover1 | 388:db85a09c27ef | 202 | Everything executed properly |
rgrover1 | 388:db85a09c27ef | 203 | */ |
rgrover1 | 388:db85a09c27ef | 204 | /**************************************************************************/ |
rgrover1 | 388:db85a09c27ef | 205 | ble_error_t nRF5xGattServer::write(GattAttribute::Handle_t attributeHandle, const uint8_t buffer[], uint16_t len, bool localOnly) |
rgrover1 | 388:db85a09c27ef | 206 | { |
rgrover1 | 388:db85a09c27ef | 207 | return write(BLE_CONN_HANDLE_INVALID, attributeHandle, buffer, len, localOnly); |
rgrover1 | 388:db85a09c27ef | 208 | } |
rgrover1 | 388:db85a09c27ef | 209 | |
rgrover1 | 388:db85a09c27ef | 210 | 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 | 211 | { |
rgrover1 | 388:db85a09c27ef | 212 | ble_error_t returnValue = BLE_ERROR_NONE; |
rgrover1 | 388:db85a09c27ef | 213 | |
rgrover1 | 388:db85a09c27ef | 214 | ble_gatts_value_t value = { |
rgrover1 | 388:db85a09c27ef | 215 | .len = len, |
rgrover1 | 388:db85a09c27ef | 216 | .offset = 0, |
rgrover1 | 388:db85a09c27ef | 217 | .p_value = const_cast<uint8_t *>(buffer), |
rgrover1 | 388:db85a09c27ef | 218 | }; |
rgrover1 | 388:db85a09c27ef | 219 | |
rgrover1 | 388:db85a09c27ef | 220 | if (localOnly) { |
rgrover1 | 388:db85a09c27ef | 221 | /* Only update locally regardless of notify/indicate */ |
rgrover1 | 388:db85a09c27ef | 222 | ASSERT_INT( ERROR_NONE, |
rgrover1 | 388:db85a09c27ef | 223 | sd_ble_gatts_value_set(connectionHandle, attributeHandle, &value), |
rgrover1 | 388:db85a09c27ef | 224 | BLE_ERROR_PARAM_OUT_OF_RANGE ); |
rgrover1 | 388:db85a09c27ef | 225 | return BLE_ERROR_NONE; |
rgrover1 | 388:db85a09c27ef | 226 | } |
rgrover1 | 388:db85a09c27ef | 227 | |
rgrover1 | 388:db85a09c27ef | 228 | int characteristicIndex = resolveValueHandleToCharIndex(attributeHandle); |
rgrover1 | 388:db85a09c27ef | 229 | if ((characteristicIndex != -1) && |
rgrover1 | 445:8328a7d1eac2 | 230 | (p_characteristics[characteristicIndex]->getProperties() & (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY))) { |
rgrover1 | 388:db85a09c27ef | 231 | /* HVX update for the characteristic value */ |
rgrover1 | 388:db85a09c27ef | 232 | ble_gatts_hvx_params_t hvx_params; |
rgrover1 | 388:db85a09c27ef | 233 | |
rgrover1 | 388:db85a09c27ef | 234 | hvx_params.handle = attributeHandle; |
rgrover1 | 388:db85a09c27ef | 235 | hvx_params.type = |
rgrover1 | 388:db85a09c27ef | 236 | (p_characteristics[characteristicIndex]->getProperties() & GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY) ? BLE_GATT_HVX_NOTIFICATION : BLE_GATT_HVX_INDICATION; |
rgrover1 | 388:db85a09c27ef | 237 | hvx_params.offset = 0; |
rgrover1 | 388:db85a09c27ef | 238 | hvx_params.p_data = const_cast<uint8_t *>(buffer); |
rgrover1 | 388:db85a09c27ef | 239 | hvx_params.p_len = &len; |
rgrover1 | 441:b52f5b70e62a | 240 | |
rgrover1 | 445:8328a7d1eac2 | 241 | if (connectionHandle == BLE_CONN_HANDLE_INVALID) { /* use the default connection handle if the caller hasn't specified a valid connectionHandle. */ |
rgrover1 | 445:8328a7d1eac2 | 242 | connectionHandle = nRF5xGap::getInstance().getConnectionHandle(); |
rgrover1 | 445:8328a7d1eac2 | 243 | } |
rgrover1 | 445:8328a7d1eac2 | 244 | error_t error = (error_t) sd_ble_gatts_hvx(connectionHandle, &hvx_params); |
rgrover1 | 445:8328a7d1eac2 | 245 | if (error != ERROR_NONE) { |
rgrover1 | 445:8328a7d1eac2 | 246 | switch (error) { |
rgrover1 | 445:8328a7d1eac2 | 247 | case ERROR_BLE_NO_TX_BUFFERS: /* Notifications consume application buffers. The return value can be used for resending notifications. */ |
rgrover1 | 445:8328a7d1eac2 | 248 | case ERROR_BUSY: |
rgrover1 | 445:8328a7d1eac2 | 249 | returnValue = BLE_STACK_BUSY; |
rgrover1 | 445:8328a7d1eac2 | 250 | break; |
rgrover1 | 388:db85a09c27ef | 251 | |
rgrover1 | 445:8328a7d1eac2 | 252 | case ERROR_INVALID_STATE: |
rgrover1 | 445:8328a7d1eac2 | 253 | case ERROR_BLEGATTS_SYS_ATTR_MISSING: |
rgrover1 | 445:8328a7d1eac2 | 254 | returnValue = BLE_ERROR_INVALID_STATE; |
rgrover1 | 445:8328a7d1eac2 | 255 | break; |
rgrover1 | 388:db85a09c27ef | 256 | |
rgrover1 | 445:8328a7d1eac2 | 257 | default : |
rgrover1 | 445:8328a7d1eac2 | 258 | ASSERT_INT( ERROR_NONE, |
rgrover1 | 445:8328a7d1eac2 | 259 | sd_ble_gatts_value_set(connectionHandle, attributeHandle, &value), |
rgrover1 | 445:8328a7d1eac2 | 260 | BLE_ERROR_PARAM_OUT_OF_RANGE ); |
rgrover1 | 445:8328a7d1eac2 | 261 | |
rgrover1 | 445:8328a7d1eac2 | 262 | /* Notifications consume application buffers. The return value can |
rgrover1 | 445:8328a7d1eac2 | 263 | * be used for resending notifications. */ |
rgrover1 | 445:8328a7d1eac2 | 264 | returnValue = BLE_STACK_BUSY; |
rgrover1 | 445:8328a7d1eac2 | 265 | break; |
rgrover1 | 445:8328a7d1eac2 | 266 | } |
rgrover1 | 388:db85a09c27ef | 267 | } |
rgrover1 | 388:db85a09c27ef | 268 | } else { |
rgrover1 | 445:8328a7d1eac2 | 269 | returnValue = BLE_ERROR_INVALID_STATE; // if assert is not used |
rgrover1 | 388:db85a09c27ef | 270 | ASSERT_INT( ERROR_NONE, |
rgrover1 | 388:db85a09c27ef | 271 | sd_ble_gatts_value_set(connectionHandle, attributeHandle, &value), |
rgrover1 | 388:db85a09c27ef | 272 | BLE_ERROR_PARAM_OUT_OF_RANGE ); |
rgrover1 | 388:db85a09c27ef | 273 | } |
rgrover1 | 388:db85a09c27ef | 274 | |
rgrover1 | 388:db85a09c27ef | 275 | return returnValue; |
rgrover1 | 388:db85a09c27ef | 276 | } |
rgrover1 | 388:db85a09c27ef | 277 | |
rgrover1 | 388:db85a09c27ef | 278 | ble_error_t nRF5xGattServer::areUpdatesEnabled(const GattCharacteristic &characteristic, bool *enabledP) |
rgrover1 | 388:db85a09c27ef | 279 | { |
rgrover1 | 388:db85a09c27ef | 280 | /* Forward the call with the default connection handle. */ |
rgrover1 | 388:db85a09c27ef | 281 | return areUpdatesEnabled(nRF5xGap::getInstance().getConnectionHandle(), characteristic, enabledP); |
rgrover1 | 388:db85a09c27ef | 282 | } |
rgrover1 | 388:db85a09c27ef | 283 | |
rgrover1 | 388:db85a09c27ef | 284 | ble_error_t nRF5xGattServer::areUpdatesEnabled(Gap::Handle_t connectionHandle, const GattCharacteristic &characteristic, bool *enabledP) |
rgrover1 | 388:db85a09c27ef | 285 | { |
rgrover1 | 388:db85a09c27ef | 286 | int characteristicIndex = resolveValueHandleToCharIndex(characteristic.getValueHandle()); |
rgrover1 | 388:db85a09c27ef | 287 | if (characteristicIndex == -1) { |
rgrover1 | 388:db85a09c27ef | 288 | return BLE_ERROR_INVALID_PARAM; |
rgrover1 | 388:db85a09c27ef | 289 | } |
rgrover1 | 388:db85a09c27ef | 290 | |
rgrover1 | 388:db85a09c27ef | 291 | /* Read the cccd value from the GATT server. */ |
rgrover1 | 388:db85a09c27ef | 292 | GattAttribute::Handle_t cccdHandle = nrfCharacteristicHandles[characteristicIndex].cccd_handle; |
rgrover1 | 388:db85a09c27ef | 293 | uint16_t cccdValue; |
rgrover1 | 388:db85a09c27ef | 294 | uint16_t length = sizeof(cccdValue); |
rgrover1 | 388:db85a09c27ef | 295 | ble_error_t rc = read(connectionHandle, cccdHandle, reinterpret_cast<uint8_t *>(&cccdValue), &length); |
rgrover1 | 388:db85a09c27ef | 296 | if (rc != BLE_ERROR_NONE) { |
rgrover1 | 388:db85a09c27ef | 297 | return rc; |
rgrover1 | 388:db85a09c27ef | 298 | } |
rgrover1 | 388:db85a09c27ef | 299 | if (length != sizeof(cccdValue)) { |
rgrover1 | 388:db85a09c27ef | 300 | return BLE_ERROR_INVALID_STATE; |
rgrover1 | 388:db85a09c27ef | 301 | } |
rgrover1 | 388:db85a09c27ef | 302 | |
rgrover1 | 388:db85a09c27ef | 303 | /* Check for NOTFICATION or INDICATION in CCCD. */ |
rgrover1 | 388:db85a09c27ef | 304 | if ((cccdValue & BLE_GATT_HVX_NOTIFICATION) || (cccdValue & BLE_GATT_HVX_INDICATION)) { |
rgrover1 | 388:db85a09c27ef | 305 | *enabledP = true; |
rgrover1 | 388:db85a09c27ef | 306 | } |
rgrover1 | 388:db85a09c27ef | 307 | |
rgrover1 | 388:db85a09c27ef | 308 | return BLE_ERROR_NONE; |
rgrover1 | 388:db85a09c27ef | 309 | } |
rgrover1 | 388:db85a09c27ef | 310 | |
rgrover1 | 388:db85a09c27ef | 311 | /**************************************************************************/ |
rgrover1 | 388:db85a09c27ef | 312 | /*! |
rgrover1 | 388:db85a09c27ef | 313 | @brief Callback handler for events getting pushed up from the SD |
rgrover1 | 388:db85a09c27ef | 314 | */ |
rgrover1 | 388:db85a09c27ef | 315 | /**************************************************************************/ |
rgrover1 | 388:db85a09c27ef | 316 | void nRF5xGattServer::hwCallback(ble_evt_t *p_ble_evt) |
rgrover1 | 388:db85a09c27ef | 317 | { |
rgrover1 | 388:db85a09c27ef | 318 | GattAttribute::Handle_t handle_value; |
rgrover1 | 388:db85a09c27ef | 319 | GattServerEvents::gattEvent_t eventType; |
rgrover1 | 388:db85a09c27ef | 320 | const ble_gatts_evt_t *gattsEventP = &p_ble_evt->evt.gatts_evt; |
rgrover1 | 388:db85a09c27ef | 321 | |
rgrover1 | 388:db85a09c27ef | 322 | switch (p_ble_evt->header.evt_id) { |
rgrover1 | 388:db85a09c27ef | 323 | case BLE_GATTS_EVT_WRITE: { |
rgrover1 | 388:db85a09c27ef | 324 | /* There are 2 use case here: Values being updated & CCCD (indicate/notify) enabled */ |
rgrover1 | 388:db85a09c27ef | 325 | |
rgrover1 | 388:db85a09c27ef | 326 | /* 1.) Handle CCCD changes */ |
rgrover1 | 388:db85a09c27ef | 327 | handle_value = gattsEventP->params.write.handle; |
rgrover1 | 388:db85a09c27ef | 328 | int characteristicIndex = resolveCCCDHandleToCharIndex(handle_value); |
rgrover1 | 388:db85a09c27ef | 329 | if ((characteristicIndex != -1) && |
rgrover1 | 388:db85a09c27ef | 330 | (p_characteristics[characteristicIndex]->getProperties() & |
rgrover1 | 388:db85a09c27ef | 331 | (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY))) { |
rgrover1 | 388:db85a09c27ef | 332 | |
rgrover1 | 388:db85a09c27ef | 333 | 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 | 334 | |
rgrover1 | 388:db85a09c27ef | 335 | if (((p_characteristics[characteristicIndex]->getProperties() & GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE) && (cccd_value & BLE_GATT_HVX_INDICATION)) || |
rgrover1 | 388:db85a09c27ef | 336 | ((p_characteristics[characteristicIndex]->getProperties() & GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY) && (cccd_value & BLE_GATT_HVX_NOTIFICATION))) { |
rgrover1 | 388:db85a09c27ef | 337 | eventType = GattServerEvents::GATT_EVENT_UPDATES_ENABLED; |
rgrover1 | 388:db85a09c27ef | 338 | } else { |
rgrover1 | 388:db85a09c27ef | 339 | eventType = GattServerEvents::GATT_EVENT_UPDATES_DISABLED; |
rgrover1 | 388:db85a09c27ef | 340 | } |
rgrover1 | 388:db85a09c27ef | 341 | |
rgrover1 | 388:db85a09c27ef | 342 | handleEvent(eventType, p_characteristics[characteristicIndex]->getValueHandle()); |
rgrover1 | 388:db85a09c27ef | 343 | return; |
rgrover1 | 388:db85a09c27ef | 344 | } |
rgrover1 | 388:db85a09c27ef | 345 | |
rgrover1 | 388:db85a09c27ef | 346 | /* 2.) Changes to the characteristic value will be handled with other events below */ |
rgrover1 | 388:db85a09c27ef | 347 | eventType = GattServerEvents::GATT_EVENT_DATA_WRITTEN; |
rgrover1 | 388:db85a09c27ef | 348 | } |
rgrover1 | 388:db85a09c27ef | 349 | break; |
rgrover1 | 388:db85a09c27ef | 350 | |
rgrover1 | 388:db85a09c27ef | 351 | case BLE_GATTS_EVT_HVC: |
rgrover1 | 388:db85a09c27ef | 352 | /* Indication confirmation received */ |
rgrover1 | 388:db85a09c27ef | 353 | eventType = GattServerEvents::GATT_EVENT_CONFIRMATION_RECEIVED; |
rgrover1 | 388:db85a09c27ef | 354 | handle_value = gattsEventP->params.hvc.handle; |
rgrover1 | 388:db85a09c27ef | 355 | break; |
rgrover1 | 388:db85a09c27ef | 356 | |
rgrover1 | 388:db85a09c27ef | 357 | case BLE_EVT_TX_COMPLETE: { |
rgrover1 | 388:db85a09c27ef | 358 | handleDataSentEvent(p_ble_evt->evt.common_evt.params.tx_complete.count); |
rgrover1 | 388:db85a09c27ef | 359 | return; |
rgrover1 | 388:db85a09c27ef | 360 | } |
rgrover1 | 388:db85a09c27ef | 361 | |
rgrover1 | 388:db85a09c27ef | 362 | case BLE_GATTS_EVT_SYS_ATTR_MISSING: |
rgrover1 | 388:db85a09c27ef | 363 | sd_ble_gatts_sys_attr_set(gattsEventP->conn_handle, NULL, 0, 0); |
rgrover1 | 388:db85a09c27ef | 364 | return; |
rgrover1 | 388:db85a09c27ef | 365 | |
rgrover1 | 388:db85a09c27ef | 366 | case BLE_GATTS_EVT_RW_AUTHORIZE_REQUEST: |
rgrover1 | 388:db85a09c27ef | 367 | switch (gattsEventP->params.authorize_request.type) { |
rgrover1 | 388:db85a09c27ef | 368 | case BLE_GATTS_AUTHORIZE_TYPE_READ: |
rgrover1 | 388:db85a09c27ef | 369 | eventType = GattServerEvents::GATT_EVENT_READ_AUTHORIZATION_REQ; |
rgrover1 | 388:db85a09c27ef | 370 | handle_value = gattsEventP->params.authorize_request.request.read.handle; |
rgrover1 | 388:db85a09c27ef | 371 | break; |
rgrover1 | 388:db85a09c27ef | 372 | case BLE_GATTS_AUTHORIZE_TYPE_WRITE: |
rgrover1 | 388:db85a09c27ef | 373 | eventType = GattServerEvents::GATT_EVENT_WRITE_AUTHORIZATION_REQ; |
rgrover1 | 388:db85a09c27ef | 374 | handle_value = gattsEventP->params.authorize_request.request.write.handle; |
rgrover1 | 388:db85a09c27ef | 375 | break; |
rgrover1 | 388:db85a09c27ef | 376 | default: |
rgrover1 | 388:db85a09c27ef | 377 | return; |
rgrover1 | 388:db85a09c27ef | 378 | } |
rgrover1 | 388:db85a09c27ef | 379 | break; |
rgrover1 | 388:db85a09c27ef | 380 | |
rgrover1 | 388:db85a09c27ef | 381 | default: |
rgrover1 | 388:db85a09c27ef | 382 | return; |
rgrover1 | 388:db85a09c27ef | 383 | } |
rgrover1 | 388:db85a09c27ef | 384 | |
rgrover1 | 388:db85a09c27ef | 385 | int characteristicIndex = resolveValueHandleToCharIndex(handle_value); |
rgrover1 | 388:db85a09c27ef | 386 | if (characteristicIndex == -1) { |
rgrover1 | 388:db85a09c27ef | 387 | return; |
rgrover1 | 388:db85a09c27ef | 388 | } |
rgrover1 | 388:db85a09c27ef | 389 | |
rgrover1 | 388:db85a09c27ef | 390 | /* Find index (charHandle) in the pool */ |
rgrover1 | 388:db85a09c27ef | 391 | switch (eventType) { |
rgrover1 | 388:db85a09c27ef | 392 | case GattServerEvents::GATT_EVENT_DATA_WRITTEN: { |
rgrover1 | 388:db85a09c27ef | 393 | GattWriteCallbackParams cbParams = { |
rgrover1 | 430:db7edc9ad0bc | 394 | .connHandle = gattsEventP->conn_handle, |
rgrover1 | 430:db7edc9ad0bc | 395 | .handle = handle_value, |
rgrover1 | 430:db7edc9ad0bc | 396 | .writeOp = static_cast<GattWriteCallbackParams::WriteOp_t>(gattsEventP->params.write.op), |
rgrover1 | 430:db7edc9ad0bc | 397 | .offset = gattsEventP->params.write.offset, |
rgrover1 | 430:db7edc9ad0bc | 398 | .len = gattsEventP->params.write.len, |
rgrover1 | 430:db7edc9ad0bc | 399 | .data = gattsEventP->params.write.data |
rgrover1 | 388:db85a09c27ef | 400 | }; |
rgrover1 | 388:db85a09c27ef | 401 | handleDataWrittenEvent(&cbParams); |
rgrover1 | 388:db85a09c27ef | 402 | break; |
rgrover1 | 388:db85a09c27ef | 403 | } |
rgrover1 | 388:db85a09c27ef | 404 | case GattServerEvents::GATT_EVENT_WRITE_AUTHORIZATION_REQ: { |
rgrover1 | 388:db85a09c27ef | 405 | GattWriteAuthCallbackParams cbParams = { |
rgrover1 | 430:db7edc9ad0bc | 406 | .connHandle = gattsEventP->conn_handle, |
rgrover1 | 430:db7edc9ad0bc | 407 | .handle = handle_value, |
rgrover1 | 430:db7edc9ad0bc | 408 | .offset = gattsEventP->params.authorize_request.request.write.offset, |
rgrover1 | 430:db7edc9ad0bc | 409 | .len = gattsEventP->params.authorize_request.request.write.len, |
rgrover1 | 430:db7edc9ad0bc | 410 | .data = gattsEventP->params.authorize_request.request.write.data, |
rgrover1 | 445:8328a7d1eac2 | 411 | .authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS /* the callback handler must leave this member |
rgrover1 | 445:8328a7d1eac2 | 412 | * set to AUTH_CALLBACK_REPLY_SUCCESS if the client |
rgrover1 | 445:8328a7d1eac2 | 413 | * request is to proceed. */ |
rgrover1 | 388:db85a09c27ef | 414 | }; |
rgrover1 | 388:db85a09c27ef | 415 | ble_gatts_rw_authorize_reply_params_t reply = { |
rgrover1 | 388:db85a09c27ef | 416 | .type = BLE_GATTS_AUTHORIZE_TYPE_WRITE, |
rgrover1 | 388:db85a09c27ef | 417 | .params = { |
rgrover1 | 388:db85a09c27ef | 418 | .write = { |
rgrover1 | 388:db85a09c27ef | 419 | .gatt_status = p_characteristics[characteristicIndex]->authorizeWrite(&cbParams) |
rgrover1 | 388:db85a09c27ef | 420 | } |
rgrover1 | 388:db85a09c27ef | 421 | } |
rgrover1 | 388:db85a09c27ef | 422 | }; |
rgrover1 | 388:db85a09c27ef | 423 | sd_ble_gatts_rw_authorize_reply(gattsEventP->conn_handle, &reply); |
rgrover1 | 388:db85a09c27ef | 424 | |
rgrover1 | 388:db85a09c27ef | 425 | /* |
rgrover1 | 388:db85a09c27ef | 426 | * If write-authorization is enabled for a characteristic, |
rgrover1 | 388:db85a09c27ef | 427 | * AUTHORIZATION_REQ event (if replied with true) is *not* |
rgrover1 | 388:db85a09c27ef | 428 | * followed by another DATA_WRITTEN event; so we still need |
rgrover1 | 388:db85a09c27ef | 429 | * to invoke handleDataWritten(), much the same as we would |
rgrover1 | 388:db85a09c27ef | 430 | * have done if write-authorization had not been enabled. |
rgrover1 | 388:db85a09c27ef | 431 | */ |
rgrover1 | 388:db85a09c27ef | 432 | if (reply.params.write.gatt_status == BLE_GATT_STATUS_SUCCESS) { |
rgrover1 | 388:db85a09c27ef | 433 | GattWriteCallbackParams cbParams = { |
rgrover1 | 430:db7edc9ad0bc | 434 | .connHandle = gattsEventP->conn_handle, |
rgrover1 | 430:db7edc9ad0bc | 435 | .handle = handle_value, |
rgrover1 | 430:db7edc9ad0bc | 436 | .writeOp = static_cast<GattWriteCallbackParams::WriteOp_t>(gattsEventP->params.authorize_request.request.write.op), |
rgrover1 | 430:db7edc9ad0bc | 437 | .offset = gattsEventP->params.authorize_request.request.write.offset, |
rgrover1 | 430:db7edc9ad0bc | 438 | .len = gattsEventP->params.authorize_request.request.write.len, |
rgrover1 | 430:db7edc9ad0bc | 439 | .data = gattsEventP->params.authorize_request.request.write.data, |
rgrover1 | 388:db85a09c27ef | 440 | }; |
rgrover1 | 388:db85a09c27ef | 441 | handleDataWrittenEvent(&cbParams); |
rgrover1 | 388:db85a09c27ef | 442 | } |
rgrover1 | 388:db85a09c27ef | 443 | break; |
rgrover1 | 388:db85a09c27ef | 444 | } |
rgrover1 | 388:db85a09c27ef | 445 | case GattServerEvents::GATT_EVENT_READ_AUTHORIZATION_REQ: { |
rgrover1 | 388:db85a09c27ef | 446 | GattReadAuthCallbackParams cbParams = { |
rgrover1 | 445:8328a7d1eac2 | 447 | .connHandle = gattsEventP->conn_handle, |
rgrover1 | 445:8328a7d1eac2 | 448 | .handle = handle_value, |
rgrover1 | 445:8328a7d1eac2 | 449 | .offset = gattsEventP->params.authorize_request.request.read.offset, |
rgrover1 | 445:8328a7d1eac2 | 450 | .len = 0, |
rgrover1 | 445:8328a7d1eac2 | 451 | .data = NULL, |
rgrover1 | 445:8328a7d1eac2 | 452 | .authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS /* the callback handler must leave this member |
rgrover1 | 445:8328a7d1eac2 | 453 | * set to AUTH_CALLBACK_REPLY_SUCCESS if the client |
rgrover1 | 445:8328a7d1eac2 | 454 | * request is to proceed. */ |
rgrover1 | 388:db85a09c27ef | 455 | }; |
rgrover1 | 388:db85a09c27ef | 456 | |
rgrover1 | 388:db85a09c27ef | 457 | ble_gatts_rw_authorize_reply_params_t reply = { |
rgrover1 | 388:db85a09c27ef | 458 | .type = BLE_GATTS_AUTHORIZE_TYPE_READ, |
rgrover1 | 388:db85a09c27ef | 459 | .params = { |
rgrover1 | 388:db85a09c27ef | 460 | .read = { |
rgrover1 | 388:db85a09c27ef | 461 | .gatt_status = p_characteristics[characteristicIndex]->authorizeRead(&cbParams) |
rgrover1 | 388:db85a09c27ef | 462 | } |
rgrover1 | 388:db85a09c27ef | 463 | } |
rgrover1 | 388:db85a09c27ef | 464 | }; |
rgrover1 | 388:db85a09c27ef | 465 | |
rgrover1 | 388:db85a09c27ef | 466 | if (cbParams.authorizationReply == BLE_GATT_STATUS_SUCCESS) { |
rgrover1 | 388:db85a09c27ef | 467 | if (cbParams.data != NULL) { |
rgrover1 | 388:db85a09c27ef | 468 | reply.params.read.update = 1; |
rgrover1 | 388:db85a09c27ef | 469 | reply.params.read.offset = cbParams.offset; |
rgrover1 | 388:db85a09c27ef | 470 | reply.params.read.len = cbParams.len; |
rgrover1 | 388:db85a09c27ef | 471 | reply.params.read.p_data = cbParams.data; |
rgrover1 | 388:db85a09c27ef | 472 | } |
rgrover1 | 388:db85a09c27ef | 473 | } |
rgrover1 | 388:db85a09c27ef | 474 | |
rgrover1 | 388:db85a09c27ef | 475 | sd_ble_gatts_rw_authorize_reply(gattsEventP->conn_handle, &reply); |
rgrover1 | 388:db85a09c27ef | 476 | break; |
rgrover1 | 388:db85a09c27ef | 477 | } |
rgrover1 | 388:db85a09c27ef | 478 | |
rgrover1 | 388:db85a09c27ef | 479 | default: |
rgrover1 | 388:db85a09c27ef | 480 | handleEvent(eventType, handle_value); |
rgrover1 | 388:db85a09c27ef | 481 | break; |
rgrover1 | 388:db85a09c27ef | 482 | } |
rgrover1 | 388:db85a09c27ef | 483 | } |