robo 8080 / Mbed 2 deprecated BLE_TEST_konashi

konashi/SBBLEのテスト

Dependencies:   BLE_API mbed

Fork of BLE_LoopbackUART by Bluetooth Low Energy

nRF51822/nRF51GattServer.cpp@8:a62b8f7d5dcf, 2014-08-17 (annotated)

Committer:
robo8080
Date:
Sun Aug 17 00:53:23 2014 +0000
Revision:
8:a62b8f7d5dcf
Parent:
5:61109bce11fe 
DeviceName??

Who changed what in which revision?

UserRevisionLine numberNew contents of line
robo8080 5:61109bce11fe 1 /* mbed Microcontroller Library
robo8080 5:61109bce11fe 2 * Copyright (c) 2006-2013 ARM Limited
robo8080 5:61109bce11fe 3 *
robo8080 5:61109bce11fe 4 * Licensed under the Apache License, Version 2.0 (the "License");
robo8080 5:61109bce11fe 5 * you may not use this file except in compliance with the License.
robo8080 5:61109bce11fe 6 * You may obtain a copy of the License at
robo8080 5:61109bce11fe 7 *
robo8080 5:61109bce11fe 8 * http://www.apache.org/licenses/LICENSE-2.0
robo8080 5:61109bce11fe 9 *
robo8080 5:61109bce11fe 10 * Unless required by applicable law or agreed to in writing, software
robo8080 5:61109bce11fe 11 * distributed under the License is distributed on an "AS IS" BASIS,
robo8080 5:61109bce11fe 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
robo8080 5:61109bce11fe 13 * See the License for the specific language governing permissions and
robo8080 5:61109bce11fe 14 * limitations under the License.
robo8080 5:61109bce11fe 15 */
robo8080 5:61109bce11fe 16
robo8080 5:61109bce11fe 17 #include "nRF51GattServer.h"
robo8080 5:61109bce11fe 18 #include "mbed.h"
robo8080 5:61109bce11fe 19
robo8080 5:61109bce11fe 20 #include "common/common.h"
robo8080 5:61109bce11fe 21 #include "btle/custom/custom_helper.h"
robo8080 5:61109bce11fe 22
robo8080 5:61109bce11fe 23 #include "nRF51Gap.h"
robo8080 5:61109bce11fe 24
robo8080 5:61109bce11fe 25 /**************************************************************************/
robo8080 5:61109bce11fe 26 /*!
robo8080 5:61109bce11fe 27 @brief Adds a new service to the GATT table on the peripheral
robo8080 5:61109bce11fe 28
robo8080 5:61109bce11fe 29 @returns ble_error_t
robo8080 5:61109bce11fe 30
robo8080 5:61109bce11fe 31 @retval BLE_ERROR_NONE
robo8080 5:61109bce11fe 32 Everything executed properly
robo8080 5:61109bce11fe 33
robo8080 5:61109bce11fe 34 @section EXAMPLE
robo8080 5:61109bce11fe 35
robo8080 5:61109bce11fe 36 @code
robo8080 5:61109bce11fe 37
robo8080 5:61109bce11fe 38 @endcode
robo8080 5:61109bce11fe 39 */
robo8080 5:61109bce11fe 40 /**************************************************************************/
robo8080 5:61109bce11fe 41 ble_error_t nRF51GattServer::addService(GattService &service)
robo8080 5:61109bce11fe 42 {
robo8080 5:61109bce11fe 43 /* ToDo: Make sure we don't overflow the array, etc. */
robo8080 5:61109bce11fe 44 /* ToDo: Make sure this service UUID doesn't already exist (?) */
robo8080 5:61109bce11fe 45 /* ToDo: Basic validation */
robo8080 5:61109bce11fe 46
robo8080 5:61109bce11fe 47 /* Add the service to the nRF51 */
robo8080 5:61109bce11fe 48 ble_uuid_t nordicUUID;
robo8080 5:61109bce11fe 49 nordicUUID = custom_convert_to_nordic_uuid(service.getUUID());
robo8080 5:61109bce11fe 50
robo8080 5:61109bce11fe 51 uint16_t serviceHandle;
robo8080 5:61109bce11fe 52 ASSERT( ERROR_NONE ==
robo8080 5:61109bce11fe 53 sd_ble_gatts_service_add(BLE_GATTS_SRVC_TYPE_PRIMARY,
robo8080 5:61109bce11fe 54 &nordicUUID,
robo8080 5:61109bce11fe 55 &serviceHandle),
robo8080 5:61109bce11fe 56 BLE_ERROR_PARAM_OUT_OF_RANGE );
robo8080 5:61109bce11fe 57 service.setHandle(serviceHandle);
robo8080 5:61109bce11fe 58
robo8080 5:61109bce11fe 59 /* Add characteristics to the service */
robo8080 5:61109bce11fe 60 for (uint8_t i = 0; i < service.getCharacteristicCount(); i++) {
robo8080 5:61109bce11fe 61 GattCharacteristic *p_char = service.getCharacteristic(i);
robo8080 5:61109bce11fe 62
robo8080 5:61109bce11fe 63 nordicUUID = custom_convert_to_nordic_uuid(p_char->getUUID());
robo8080 5:61109bce11fe 64
robo8080 5:61109bce11fe 65 ASSERT ( ERROR_NONE ==
robo8080 5:61109bce11fe 66 custom_add_in_characteristic(service.getHandle(),
robo8080 5:61109bce11fe 67 &nordicUUID,
robo8080 5:61109bce11fe 68 p_char->getProperties(),
robo8080 5:61109bce11fe 69 NULL,
robo8080 5:61109bce11fe 70 p_char->getInitialLength(),
robo8080 5:61109bce11fe 71 p_char->getMaxLength(),
robo8080 5:61109bce11fe 72 &nrfCharacteristicHandles[characteristicCount]),
robo8080 5:61109bce11fe 73 BLE_ERROR_PARAM_OUT_OF_RANGE );
robo8080 5:61109bce11fe 74
robo8080 5:61109bce11fe 75 /* Update the characteristic handle */
robo8080 5:61109bce11fe 76 uint16_t charHandle = characteristicCount;
robo8080 5:61109bce11fe 77 p_characteristics[characteristicCount++] = p_char;
robo8080 5:61109bce11fe 78
robo8080 5:61109bce11fe 79 p_char->setHandle(charHandle);
robo8080 5:61109bce11fe 80 if ((p_char->getValuePtr() != NULL) && (p_char->getInitialLength() > 0)) {
robo8080 5:61109bce11fe 81 updateValue(charHandle, p_char->getValuePtr(), p_char->getInitialLength(), false /* localOnly */);
robo8080 5:61109bce11fe 82 }
robo8080 5:61109bce11fe 83 }
robo8080 5:61109bce11fe 84
robo8080 5:61109bce11fe 85 serviceCount++;
robo8080 5:61109bce11fe 86
robo8080 5:61109bce11fe 87 return BLE_ERROR_NONE;
robo8080 5:61109bce11fe 88 }
robo8080 5:61109bce11fe 89
robo8080 5:61109bce11fe 90 /**************************************************************************/
robo8080 5:61109bce11fe 91 /*!
robo8080 5:61109bce11fe 92 @brief Reads the value of a characteristic, based on the service
robo8080 5:61109bce11fe 93 and characteristic index fields
robo8080 5:61109bce11fe 94
robo8080 5:61109bce11fe 95 @param[in] charHandle
robo8080 5:61109bce11fe 96 The handle of the GattCharacteristic to read from
robo8080 5:61109bce11fe 97 @param[in] buffer
robo8080 5:61109bce11fe 98 Buffer to hold the the characteristic's value
robo8080 5:61109bce11fe 99 (raw byte array in LSB format)
robo8080 5:61109bce11fe 100 @param[in] len
robo8080 5:61109bce11fe 101 The number of bytes read into the buffer
robo8080 5:61109bce11fe 102
robo8080 5:61109bce11fe 103 @returns ble_error_t
robo8080 5:61109bce11fe 104
robo8080 5:61109bce11fe 105 @retval BLE_ERROR_NONE
robo8080 5:61109bce11fe 106 Everything executed properly
robo8080 5:61109bce11fe 107
robo8080 5:61109bce11fe 108 @section EXAMPLE
robo8080 5:61109bce11fe 109
robo8080 5:61109bce11fe 110 @code
robo8080 5:61109bce11fe 111
robo8080 5:61109bce11fe 112 @endcode
robo8080 5:61109bce11fe 113 */
robo8080 5:61109bce11fe 114 /**************************************************************************/
robo8080 5:61109bce11fe 115 ble_error_t nRF51GattServer::readValue(uint16_t charHandle, uint8_t buffer[], uint16_t *const lengthP)
robo8080 5:61109bce11fe 116 {
robo8080 5:61109bce11fe 117 ASSERT( ERROR_NONE ==
robo8080 5:61109bce11fe 118 sd_ble_gatts_value_get(nrfCharacteristicHandles[charHandle].value_handle, 0, lengthP, buffer),
robo8080 5:61109bce11fe 119 BLE_ERROR_PARAM_OUT_OF_RANGE);
robo8080 5:61109bce11fe 120
robo8080 5:61109bce11fe 121 return BLE_ERROR_NONE;
robo8080 5:61109bce11fe 122 }
robo8080 5:61109bce11fe 123
robo8080 5:61109bce11fe 124 /**************************************************************************/
robo8080 5:61109bce11fe 125 /*!
robo8080 5:61109bce11fe 126 @brief Updates the value of a characteristic, based on the service
robo8080 5:61109bce11fe 127 and characteristic index fields
robo8080 5:61109bce11fe 128
robo8080 5:61109bce11fe 129 @param[in] charHandle
robo8080 5:61109bce11fe 130 The handle of the GattCharacteristic to write to
robo8080 5:61109bce11fe 131 @param[in] buffer
robo8080 5:61109bce11fe 132 Data to use when updating the characteristic's value
robo8080 5:61109bce11fe 133 (raw byte array in LSB format)
robo8080 5:61109bce11fe 134 @param[in] len
robo8080 5:61109bce11fe 135 The number of bytes in buffer
robo8080 5:61109bce11fe 136
robo8080 5:61109bce11fe 137 @returns ble_error_t
robo8080 5:61109bce11fe 138
robo8080 5:61109bce11fe 139 @retval BLE_ERROR_NONE
robo8080 5:61109bce11fe 140 Everything executed properly
robo8080 5:61109bce11fe 141
robo8080 5:61109bce11fe 142 @section EXAMPLE
robo8080 5:61109bce11fe 143
robo8080 5:61109bce11fe 144 @code
robo8080 5:61109bce11fe 145
robo8080 5:61109bce11fe 146 @endcode
robo8080 5:61109bce11fe 147 */
robo8080 5:61109bce11fe 148 /**************************************************************************/
robo8080 5:61109bce11fe 149 ble_error_t nRF51GattServer::updateValue(uint16_t charHandle, uint8_t buffer[], uint16_t len, bool localOnly)
robo8080 5:61109bce11fe 150 {
robo8080 5:61109bce11fe 151 uint16_t gapConnectionHandle = nRF51Gap::getInstance().getConnectionHandle();
robo8080 5:61109bce11fe 152
robo8080 5:61109bce11fe 153 if (localOnly) {
robo8080 5:61109bce11fe 154 /* Only update locally regardless of notify/indicate */
robo8080 5:61109bce11fe 155 ASSERT_INT( ERROR_NONE,
robo8080 5:61109bce11fe 156 sd_ble_gatts_value_set(nrfCharacteristicHandles[charHandle].value_handle, 0, &len, buffer),
robo8080 5:61109bce11fe 157 BLE_ERROR_PARAM_OUT_OF_RANGE );
robo8080 5:61109bce11fe 158 return BLE_ERROR_NONE;
robo8080 5:61109bce11fe 159 }
robo8080 5:61109bce11fe 160
robo8080 5:61109bce11fe 161 if ((p_characteristics[charHandle]->getProperties() &
robo8080 5:61109bce11fe 162 (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE |
robo8080 5:61109bce11fe 163 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)) &&
robo8080 5:61109bce11fe 164 (gapConnectionHandle != BLE_CONN_HANDLE_INVALID)) {
robo8080 5:61109bce11fe 165 /* HVX update for the characteristic value */
robo8080 5:61109bce11fe 166 ble_gatts_hvx_params_t hvx_params;
robo8080 5:61109bce11fe 167
robo8080 5:61109bce11fe 168 hvx_params.handle = nrfCharacteristicHandles[charHandle].value_handle;
robo8080 5:61109bce11fe 169 hvx_params.type =
robo8080 5:61109bce11fe 170 (p_characteristics[charHandle]->getProperties() &
robo8080 5:61109bce11fe 171 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY) ?
robo8080 5:61109bce11fe 172 BLE_GATT_HVX_NOTIFICATION : BLE_GATT_HVX_INDICATION;
robo8080 5:61109bce11fe 173 hvx_params.offset = 0;
robo8080 5:61109bce11fe 174 hvx_params.p_data = buffer;
robo8080 5:61109bce11fe 175 hvx_params.p_len = &len;
robo8080 5:61109bce11fe 176
robo8080 5:61109bce11fe 177 error_t error = (error_t) sd_ble_gatts_hvx(gapConnectionHandle, &hvx_params);
robo8080 5:61109bce11fe 178
robo8080 5:61109bce11fe 179 /* ERROR_INVALID_STATE, ERROR_BUSY, ERROR_GATTS_SYS_ATTR_MISSING and
robo8080 5:61109bce11fe 180 *ERROR_NO_TX_BUFFERS the ATT table has been updated. */
robo8080 5:61109bce11fe 181 if ((error != ERROR_NONE) && (error != ERROR_INVALID_STATE) &&
robo8080 5:61109bce11fe 182 (error != ERROR_BLE_NO_TX_BUFFERS) && (error != ERROR_BUSY) &&
robo8080 5:61109bce11fe 183 (error != ERROR_BLEGATTS_SYS_ATTR_MISSING)) {
robo8080 5:61109bce11fe 184 ASSERT_INT( ERROR_NONE,
robo8080 5:61109bce11fe 185 sd_ble_gatts_value_set(nrfCharacteristicHandles[charHandle].value_handle, 0, &len, buffer),
robo8080 5:61109bce11fe 186 BLE_ERROR_PARAM_OUT_OF_RANGE );
robo8080 5:61109bce11fe 187 }
robo8080 5:61109bce11fe 188 } else {
robo8080 5:61109bce11fe 189 ASSERT_INT( ERROR_NONE,
robo8080 5:61109bce11fe 190 sd_ble_gatts_value_set(nrfCharacteristicHandles[charHandle].value_handle, 0, &len, buffer),
robo8080 5:61109bce11fe 191 BLE_ERROR_PARAM_OUT_OF_RANGE );
robo8080 5:61109bce11fe 192 }
robo8080 5:61109bce11fe 193
robo8080 5:61109bce11fe 194 return BLE_ERROR_NONE;
robo8080 5:61109bce11fe 195 }
robo8080 5:61109bce11fe 196
robo8080 5:61109bce11fe 197 ble_error_t nRF51GattServer::setDeviceName(const uint8_t *deviceName)
robo8080 5:61109bce11fe 198 {
robo8080 5:61109bce11fe 199 ble_gap_conn_sec_mode_t sec_mode;
robo8080 5:61109bce11fe 200 BLE_GAP_CONN_SEC_MODE_SET_OPEN(&sec_mode); // no security is needed
robo8080 5:61109bce11fe 201
robo8080 5:61109bce11fe 202 if (sd_ble_gap_device_name_set(&sec_mode, deviceName, strlen((const char *)deviceName)) == NRF_SUCCESS) {
robo8080 5:61109bce11fe 203 return BLE_ERROR_NONE;
robo8080 5:61109bce11fe 204 } else {
robo8080 5:61109bce11fe 205 return BLE_ERROR_PARAM_OUT_OF_RANGE;
robo8080 5:61109bce11fe 206 }
robo8080 5:61109bce11fe 207 }
robo8080 5:61109bce11fe 208
robo8080 5:61109bce11fe 209 ble_error_t nRF51GattServer::getDeviceName(uint8_t *deviceName, unsigned *lengthP)
robo8080 5:61109bce11fe 210 {
robo8080 5:61109bce11fe 211 if (sd_ble_gap_device_name_get(deviceName, (uint16_t *)lengthP) == NRF_SUCCESS) {
robo8080 5:61109bce11fe 212 return BLE_ERROR_NONE;
robo8080 5:61109bce11fe 213 } else {
robo8080 5:61109bce11fe 214 return BLE_ERROR_PARAM_OUT_OF_RANGE;
robo8080 5:61109bce11fe 215 }
robo8080 5:61109bce11fe 216 }
robo8080 5:61109bce11fe 217
robo8080 5:61109bce11fe 218 ble_error_t nRF51GattServer::setAppearance(uint16_t appearance)
robo8080 5:61109bce11fe 219 {
robo8080 5:61109bce11fe 220 if (sd_ble_gap_appearance_set(appearance) == NRF_SUCCESS) {
robo8080 5:61109bce11fe 221 return BLE_ERROR_NONE;
robo8080 5:61109bce11fe 222 } else {
robo8080 5:61109bce11fe 223 return BLE_ERROR_PARAM_OUT_OF_RANGE;
robo8080 5:61109bce11fe 224 }
robo8080 5:61109bce11fe 225 }
robo8080 5:61109bce11fe 226
robo8080 5:61109bce11fe 227 ble_error_t nRF51GattServer::getAppearance(uint16_t *appearanceP)
robo8080 5:61109bce11fe 228 {
robo8080 5:61109bce11fe 229 if (sd_ble_gap_appearance_get(appearanceP)) {
robo8080 5:61109bce11fe 230 return BLE_ERROR_NONE;
robo8080 5:61109bce11fe 231 } else {
robo8080 5:61109bce11fe 232 return BLE_ERROR_PARAM_OUT_OF_RANGE;
robo8080 5:61109bce11fe 233 }
robo8080 5:61109bce11fe 234 }
robo8080 5:61109bce11fe 235
robo8080 5:61109bce11fe 236 /**************************************************************************/
robo8080 5:61109bce11fe 237 /*!
robo8080 5:61109bce11fe 238 @brief Callback handler for events getting pushed up from the SD
robo8080 5:61109bce11fe 239 */
robo8080 5:61109bce11fe 240 /**************************************************************************/
robo8080 5:61109bce11fe 241 void nRF51GattServer::hwCallback(ble_evt_t *p_ble_evt)
robo8080 5:61109bce11fe 242 {
robo8080 5:61109bce11fe 243 uint16_t handle_value;
robo8080 5:61109bce11fe 244 GattServerEvents::gattEvent_t event;
robo8080 5:61109bce11fe 245
robo8080 5:61109bce11fe 246 switch (p_ble_evt->header.evt_id) {
robo8080 5:61109bce11fe 247 case BLE_GATTS_EVT_WRITE:
robo8080 5:61109bce11fe 248 /* There are 2 use case here: Values being updated & CCCD (indicate/notify) enabled */
robo8080 5:61109bce11fe 249
robo8080 5:61109bce11fe 250 /* 1.) Handle CCCD changes */
robo8080 5:61109bce11fe 251 handle_value = p_ble_evt->evt.gatts_evt.params.write.handle;
robo8080 5:61109bce11fe 252 for (uint8_t i = 0; i<characteristicCount; i++) {
robo8080 5:61109bce11fe 253 if ((p_characteristics[i]->getProperties() & (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)) &&
robo8080 5:61109bce11fe 254 (nrfCharacteristicHandles[i].cccd_handle == handle_value)) {
robo8080 5:61109bce11fe 255 uint16_t cccd_value =
robo8080 5:61109bce11fe 256 (p_ble_evt->evt.gatts_evt.params.write.data[1] << 8) |
robo8080 5:61109bce11fe 257 p_ble_evt->evt.gatts_evt.params.write.data[0]; /* Little Endian but M0 may be mis-aligned */
robo8080 5:61109bce11fe 258
robo8080 5:61109bce11fe 259 if (((p_characteristics[i]->getProperties() & GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE) && (cccd_value & BLE_GATT_HVX_INDICATION)) ||
robo8080 5:61109bce11fe 260 ((p_characteristics[i]->getProperties() & GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY) && (cccd_value & BLE_GATT_HVX_NOTIFICATION))) {
robo8080 5:61109bce11fe 261 event = GattServerEvents::GATT_EVENT_UPDATES_ENABLED;
robo8080 5:61109bce11fe 262 } else {
robo8080 5:61109bce11fe 263 event = GattServerEvents::GATT_EVENT_UPDATES_DISABLED;
robo8080 5:61109bce11fe 264 }
robo8080 5:61109bce11fe 265
robo8080 5:61109bce11fe 266 handleEvent(event, i);
robo8080 5:61109bce11fe 267 return;
robo8080 5:61109bce11fe 268 }
robo8080 5:61109bce11fe 269 }
robo8080 5:61109bce11fe 270
robo8080 5:61109bce11fe 271 /* 2.) Changes to the characteristic value will be handled with other events below */
robo8080 5:61109bce11fe 272 event = GattServerEvents::GATT_EVENT_DATA_WRITTEN;
robo8080 5:61109bce11fe 273 break;
robo8080 5:61109bce11fe 274
robo8080 5:61109bce11fe 275 case BLE_EVT_TX_COMPLETE:
robo8080 5:61109bce11fe 276 handleEvent(GattServerEvents::GATT_EVENT_DATA_SENT);
robo8080 5:61109bce11fe 277 return;
robo8080 5:61109bce11fe 278
robo8080 5:61109bce11fe 279 case BLE_GATTS_EVT_HVC:
robo8080 5:61109bce11fe 280 /* Indication confirmation received */
robo8080 5:61109bce11fe 281 event = GattServerEvents::GATT_EVENT_CONFIRMATION_RECEIVED;
robo8080 5:61109bce11fe 282 handle_value = p_ble_evt->evt.gatts_evt.params.hvc.handle;
robo8080 5:61109bce11fe 283 break;
robo8080 5:61109bce11fe 284
robo8080 5:61109bce11fe 285 case BLE_GATTS_EVT_SYS_ATTR_MISSING:
robo8080 5:61109bce11fe 286 sd_ble_gatts_sys_attr_set(p_ble_evt->evt.gatts_evt.conn_handle, NULL, 0);
robo8080 5:61109bce11fe 287 return;
robo8080 5:61109bce11fe 288
robo8080 5:61109bce11fe 289 default:
robo8080 5:61109bce11fe 290 return;
robo8080 5:61109bce11fe 291 }
robo8080 5:61109bce11fe 292
robo8080 5:61109bce11fe 293 /* Find index (charHandle) in the pool */
robo8080 5:61109bce11fe 294 for (uint8_t i = 0; i<characteristicCount; i++) {
robo8080 5:61109bce11fe 295 if (nrfCharacteristicHandles[i].value_handle == handle_value) {
robo8080 5:61109bce11fe 296 handleEvent(event, i);
robo8080 5:61109bce11fe 297 break;
robo8080 5:61109bce11fe 298 }
robo8080 5:61109bce11fe 299 }
robo8080 5:61109bce11fe 300 }