ST
BLE_API wrapper library for STMicroelectronics' BlueNRG Bluetooth Low Energy expansion board shield (Component)
Dependents: Nucleo_Zumo_BLE_IDB04A1 contest_IOT5 contest_IOT6 contest_IOT_10 ... more
Fork of
X_NUCLEO_IDB0XA1
by 
ST Expansion SW Team
Arduino Connector Compatibility Warning
X-NUCLEO-IDB04A1 and X-NUCLEO-IDB05A1 are Arduino compatible with an exception: instead of using pin D13 for the SPI clock, they use pin D3.
The default configuration for this library is having the SPI clock on pin D3.
To be fully Arduino compatible, X-NUCLEO-IDB04A1 and X-NUCLEO-IDB05A1 need a small HW patch.
For X-NUCLEO-IDB04A1 this patch consists in removing zero resistor R10 and instead soldering zero resistor R11.
For X-NUCLEO-IDB05A1 this patch consists in removing zero resistor R4 and instead soldering zero resistor R6.
In case you patch your board, then you also have to configure this library to use pin D13 to drive the SPI clock (see macro IDB0XA1_D13_PATCH in file x_nucleo_idb0xa1_targets.h).
If you use pin D13 for the SPI clock, please be aware that on STM32 Nucleo boards you may not drive the LED, otherwise you will get a conflict: the LED on STM32 Nucleo boards is connected to pin D13.
Referring to the current list of tested platforms (see X-NUCLEO-IDB04A1 and X-NUCLEO-IDB05A1 pages), the patch is required by ST-Nucleo-F103RB; ST-Nucleo-F302R8; ST-Nucleo-F411RE; and ST-Nucleo-F446RE.
source/BlueNRGGattClient.cpp@262:a3460768f3b7, 2016-09-15 (annotated)
- Committer:
- Vincent Coubard
- Date:
- Thu Sep 15 10:51:24 2016 +0100
- Branch:
- a38223e17a624c1ac4d9e2589f363d2e202f12a5
- Revision:
- 262:a3460768f3b7
- Parent:
- 259:323f588e5f57
- Child:
- 278:a5209d8cfd61
Sync with a38223e17a624c1ac4d9e2589f363d2e202f12a5
2016-07-08 18:04:01+01:00: Vincent Coubard
Fix characteristic descriptor discovery
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| Andrea Palmieri |
229:9981f62cdb1a | 1 | /* mbed Microcontroller Library |
| Andrea Palmieri |
229:9981f62cdb1a | 2 | * Copyright (c) 2006-2013 ARM Limited |
| Andrea Palmieri |
229:9981f62cdb1a | 3 | * |
| Andrea Palmieri |
229:9981f62cdb1a | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| Andrea Palmieri |
229:9981f62cdb1a | 5 | * you may not use this file except in compliance with the License. |
| Andrea Palmieri |
229:9981f62cdb1a | 6 | * You may obtain a copy of the License at |
| Andrea Palmieri |
229:9981f62cdb1a | 7 | * |
| Andrea Palmieri |
229:9981f62cdb1a | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
| Andrea Palmieri |
229:9981f62cdb1a | 9 | * |
| Andrea Palmieri |
229:9981f62cdb1a | 10 | * Unless required by applicable law or agreed to in writing, software |
| Andrea Palmieri |
229:9981f62cdb1a | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
| Andrea Palmieri |
229:9981f62cdb1a | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| Andrea Palmieri |
229:9981f62cdb1a | 13 | * See the License for the specific language governing permissions and |
| Andrea Palmieri |
229:9981f62cdb1a | 14 | * limitations under the License. |
| Andrea Palmieri |
229:9981f62cdb1a | 15 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 16 | /** |
| Andrea Palmieri |
229:9981f62cdb1a | 17 | ****************************************************************************** |
| Vincent Coubard |
259:323f588e5f57 | 18 | * @file BlueNRGGattServer.cpp |
| Andrea Palmieri |
229:9981f62cdb1a | 19 | * @author STMicroelectronics |
| Andrea Palmieri |
229:9981f62cdb1a | 20 | * @brief Implementation of BlueNRG BLE_API GattServer Class |
| Andrea Palmieri |
229:9981f62cdb1a | 21 | ****************************************************************************** |
| Andrea Palmieri |
229:9981f62cdb1a | 22 | * @copy |
| Andrea Palmieri |
229:9981f62cdb1a | 23 | * |
| Andrea Palmieri |
229:9981f62cdb1a | 24 | * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS |
| Andrea Palmieri |
229:9981f62cdb1a | 25 | * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE |
| Andrea Palmieri |
229:9981f62cdb1a | 26 | * TIME. AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY |
| Andrea Palmieri |
229:9981f62cdb1a | 27 | * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING |
| Andrea Palmieri |
229:9981f62cdb1a | 28 | * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE |
| Andrea Palmieri |
229:9981f62cdb1a | 29 | * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS. |
| Andrea Palmieri |
229:9981f62cdb1a | 30 | * |
| Andrea Palmieri |
229:9981f62cdb1a | 31 | * <h2><center>© COPYRIGHT 2013 STMicroelectronics</center></h2> |
| Vincent Coubard |
259:323f588e5f57 | 32 | */ |
| Vincent Coubard |
259:323f588e5f57 | 33 | |
| Andrea Palmieri |
229:9981f62cdb1a | 34 | /** @defgroup BlueNRGGATTClient |
| Andrea Palmieri |
229:9981f62cdb1a | 35 | * @brief BlueNRG BLE_API GattClient Adaptation |
| Andrea Palmieri |
229:9981f62cdb1a | 36 | * @{ |
| Andrea Palmieri |
229:9981f62cdb1a | 37 | */ |
| Vincent Coubard |
259:323f588e5f57 | 38 | |
| Andrea Palmieri |
229:9981f62cdb1a | 39 | #include "BlueNRGGattClient.h" |
| Vincent Coubard |
253:9665a6f8bbdb | 40 | #include "mbed-drivers/mbed.h" |
| Andrea Palmieri |
229:9981f62cdb1a | 41 | #include "BlueNRGGap.h" |
| Andrea Palmieri |
229:9981f62cdb1a | 42 | #include "Utils.h" |
| Andrea Palmieri |
229:9981f62cdb1a | 43 | #include "debug.h" |
| Andrea Palmieri |
229:9981f62cdb1a | 44 | |
| Andrea Palmieri |
229:9981f62cdb1a | 45 | static uint8_t props_mask[] = { |
| Andrea Palmieri |
229:9981f62cdb1a | 46 | 0x01, |
| Andrea Palmieri |
229:9981f62cdb1a | 47 | 0x02, |
| Andrea Palmieri |
229:9981f62cdb1a | 48 | 0x04, |
| Andrea Palmieri |
229:9981f62cdb1a | 49 | 0x08, |
| Andrea Palmieri |
229:9981f62cdb1a | 50 | 0x10, |
| Andrea Palmieri |
229:9981f62cdb1a | 51 | 0x20, |
| Andrea Palmieri |
229:9981f62cdb1a | 52 | 0x40, |
| Andrea Palmieri |
229:9981f62cdb1a | 53 | 0x80 |
| Andrea Palmieri |
229:9981f62cdb1a | 54 | }; |
| Andrea Palmieri |
229:9981f62cdb1a | 55 | |
| Andrea Palmieri |
229:9981f62cdb1a | 56 | void BlueNRGGattClient::gattProcedureCompleteCB(Gap::Handle_t connectionHandle, uint8_t error_code) |
| Andrea Palmieri |
229:9981f62cdb1a | 57 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 58 | if(error_code != BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 59 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 60 | return; |
| Andrea Palmieri |
229:9981f62cdb1a | 61 | } |
| Vincent Coubard |
259:323f588e5f57 | 62 | |
| Andrea Palmieri |
229:9981f62cdb1a | 63 | // Service Discovery complete |
| Andrea Palmieri |
229:9981f62cdb1a | 64 | /* |
| Vincent Coubard |
259:323f588e5f57 | 65 | if(_currentState != GATT_IDLE && |
| Andrea Palmieri |
229:9981f62cdb1a | 66 | _currentState != GATT_DISCOVERY_TERMINATED && |
| Andrea Palmieri |
229:9981f62cdb1a | 67 | _currentState != GATT_WRITE_CHAR && |
| Andrea Palmieri |
229:9981f62cdb1a | 68 | _currentState != GATT_READ_CHAR) { |
| Andrea Palmieri |
229:9981f62cdb1a | 69 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 70 | if(_currentState == GATT_SERVICE_DISCOVERY) { |
| Andrea Palmieri |
229:9981f62cdb1a | 71 | findServiceChars(connectionHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 72 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 73 | |
| Andrea Palmieri |
229:9981f62cdb1a | 74 | if(_currentState == GATT_CHAR_DESC_DISCOVERY) { |
| Vincent Coubard |
262:a3460768f3b7 | 75 | if(charDescTerminationCallback != NULL) { |
| Vincent Coubard |
262:a3460768f3b7 | 76 | CharacteristicDescriptorDiscovery::TerminationCallbackParams_t params = { |
| Vincent Coubard |
262:a3460768f3b7 | 77 | _characteristic, |
| Vincent Coubard |
262:a3460768f3b7 | 78 | BLE_ERROR_NONE |
| Vincent Coubard |
262:a3460768f3b7 | 79 | }; |
| Vincent Coubard |
262:a3460768f3b7 | 80 | charDescTerminationCallback(¶ms); |
| Vincent Coubard |
262:a3460768f3b7 | 81 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 82 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 83 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 84 | |
| Andrea Palmieri |
229:9981f62cdb1a | 85 | // Read complete |
| Andrea Palmieri |
229:9981f62cdb1a | 86 | if(_currentState == GATT_READ_CHAR) { |
| Andrea Palmieri |
229:9981f62cdb1a | 87 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 88 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 89 | |
| Andrea Palmieri |
229:9981f62cdb1a | 90 | // Write complete |
| Andrea Palmieri |
229:9981f62cdb1a | 91 | if(_currentState == GATT_WRITE_CHAR) { |
| Andrea Palmieri |
229:9981f62cdb1a | 92 | BlueNRGGattClient::getInstance().processWriteResponse(&writeCBParams); |
| Andrea Palmieri |
229:9981f62cdb1a | 93 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 94 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 95 | } |
| Vincent Coubard |
259:323f588e5f57 | 96 | |
| Andrea Palmieri |
229:9981f62cdb1a | 97 | void BlueNRGGattClient::primaryServicesCB(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 98 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 99 | uint8_t attribute_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 100 | uint8_t *attribute_data_list) |
| Andrea Palmieri |
229:9981f62cdb1a | 101 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 102 | GattAttribute::Handle_t startHandle, endHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 103 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 104 | uint8_t i, offset, numAttr; |
| Andrea Palmieri |
229:9981f62cdb1a | 105 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 106 | (void)connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 107 | |
| Andrea Palmieri |
229:9981f62cdb1a | 108 | numAttr = (event_data_length - 1) / attribute_data_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 109 | |
| Andrea Palmieri |
229:9981f62cdb1a | 110 | offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 111 | for (i=0; i<numAttr; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 112 | startHandle = attribute_data_list[offset]; |
| Andrea Palmieri |
229:9981f62cdb1a | 113 | endHandle = attribute_data_list[offset+2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 114 | |
| Andrea Palmieri |
229:9981f62cdb1a | 115 | // UUID Type |
| Andrea Palmieri |
229:9981f62cdb1a | 116 | if (attribute_data_length == 6) { |
| Vincent Coubard |
259:323f588e5f57 | 117 | |
| Andrea Palmieri |
229:9981f62cdb1a | 118 | PRINTF("UUID_TYPE_16\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 119 | uuid = attribute_data_list[offset+5]<<8|attribute_data_list[offset+4]; |
| Andrea Palmieri |
229:9981f62cdb1a | 120 | PRINTF("S UUID-%X attrs[%u %u]\r\n", uuid.getShortUUID(), startHandle, endHandle); |
| Vincent Coubard |
259:323f588e5f57 | 121 | |
| Andrea Palmieri |
229:9981f62cdb1a | 122 | } else { |
| Vincent Coubard |
259:323f588e5f57 | 123 | |
| Andrea Palmieri |
229:9981f62cdb1a | 124 | PRINTF("UUID_TYPE_128\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 125 | uuid.setupLong(attribute_data_list+offset+4, UUID::LSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 126 | |
| Andrea Palmieri |
229:9981f62cdb1a | 127 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 128 | PRINTF("S UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 129 | const uint8_t *longUUIDBytes = uuid.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 130 | for (unsigned j = 0; j < UUID::LENGTH_OF_LONG_UUID; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 131 | PRINTF("%02x", longUUIDBytes[j]); |
| Andrea Palmieri |
229:9981f62cdb1a | 132 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 133 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 134 | PRINTF(" attrs[%u %u]\r\n", startHandle, endHandle); |
| Vincent Coubard |
259:323f588e5f57 | 135 | |
| Andrea Palmieri |
229:9981f62cdb1a | 136 | } |
| Vincent Coubard |
259:323f588e5f57 | 137 | |
| Andrea Palmieri |
229:9981f62cdb1a | 138 | PRINTF("Setup serviceIndex = %d\n\r", _numServices); |
| Andrea Palmieri |
229:9981f62cdb1a | 139 | discoveredService[_numServices].setup(uuid, startHandle, endHandle); |
| Vincent Coubard |
259:323f588e5f57 | 140 | |
| Andrea Palmieri |
229:9981f62cdb1a | 141 | _numServices++; |
| Andrea Palmieri |
229:9981f62cdb1a | 142 | |
| Andrea Palmieri |
229:9981f62cdb1a | 143 | offset += attribute_data_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 144 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 145 | |
| Andrea Palmieri |
229:9981f62cdb1a | 146 | PRINTF("!!!Service Discovery complete (numAttr=%u)!!!\n\r", numAttr); |
| Andrea Palmieri |
229:9981f62cdb1a | 147 | |
| Andrea Palmieri |
229:9981f62cdb1a | 148 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 149 | |
| Andrea Palmieri |
229:9981f62cdb1a | 150 | void BlueNRGGattClient::primaryServiceCB(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 151 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 152 | uint8_t *handles_info_list) |
| Andrea Palmieri |
229:9981f62cdb1a | 153 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 154 | GattAttribute::Handle_t startHandle, endHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 155 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 156 | uint8_t i, offset, numHandlePairs; |
| Andrea Palmieri |
229:9981f62cdb1a | 157 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 158 | (void)connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 159 | |
| Andrea Palmieri |
229:9981f62cdb1a | 160 | numHandlePairs = (event_data_length - 1) / 2; |
| Andrea Palmieri |
229:9981f62cdb1a | 161 | |
| Andrea Palmieri |
229:9981f62cdb1a | 162 | offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 163 | for (i=0; i<numHandlePairs; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 164 | startHandle = handles_info_list[offset]; |
| Andrea Palmieri |
229:9981f62cdb1a | 165 | endHandle = handles_info_list[offset+2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 166 | |
| Andrea Palmieri |
229:9981f62cdb1a | 167 | PRINTF("primaryServiceCB attrs[%u %u]\r\n", startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 168 | |
| Andrea Palmieri |
229:9981f62cdb1a | 169 | |
| Andrea Palmieri |
229:9981f62cdb1a | 170 | if (_matchingServiceUUID.shortOrLong() == UUID::UUID_TYPE_SHORT) { |
| Andrea Palmieri |
229:9981f62cdb1a | 171 | PRINTF("S UUID-%x attrs[%u %u]\r\n", _matchingServiceUUID.getShortUUID(), startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 172 | uuid = _matchingServiceUUID.getShortUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 173 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 174 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 175 | PRINTF("S UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 176 | const uint8_t *longUUIDBytes = _matchingServiceUUID.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 177 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 178 | PRINTF("%02x", longUUIDBytes[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 179 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 180 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 181 | PRINTF(" attrs[%u %u]\r\n", startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 182 | uuid.setupLong(_matchingServiceUUID.getBaseUUID(), UUID::MSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 183 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 184 | |
| Andrea Palmieri |
229:9981f62cdb1a | 185 | discoveredService[i].setup(uuid, startHandle, endHandle); |
| Vincent Coubard |
259:323f588e5f57 | 186 | |
| Andrea Palmieri |
229:9981f62cdb1a | 187 | _numServices++; |
| Vincent Coubard |
259:323f588e5f57 | 188 | |
| Andrea Palmieri |
229:9981f62cdb1a | 189 | offset += 4; |
| Andrea Palmieri |
229:9981f62cdb1a | 190 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 191 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 192 | |
| Andrea Palmieri |
229:9981f62cdb1a | 193 | void BlueNRGGattClient::serviceCharsCB(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 194 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 195 | uint8_t handle_value_pair_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 196 | uint8_t *handle_value_pair) |
| Andrea Palmieri |
229:9981f62cdb1a | 197 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 198 | // Charac Handle (2), Charac Properties(1), Charac Value Handle(2), Charac UUID(2/16) |
| Andrea Palmieri |
229:9981f62cdb1a | 199 | |
| Andrea Palmieri |
229:9981f62cdb1a | 200 | GattAttribute::Handle_t declHandle, valueHandle, lastHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 201 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 202 | uint8_t i, numChar, offset; |
| Andrea Palmieri |
229:9981f62cdb1a | 203 | |
| Andrea Palmieri |
229:9981f62cdb1a | 204 | numChar = (event_data_length - 1) / handle_value_pair_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 205 | |
| Andrea Palmieri |
229:9981f62cdb1a | 206 | PRINTF("event_data_length=%d handle_value_pair_length=%d numChar=%d\n\r", event_data_length, handle_value_pair_length, numChar); |
| Andrea Palmieri |
229:9981f62cdb1a | 207 | |
| Andrea Palmieri |
229:9981f62cdb1a | 208 | offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 209 | for (i=0; i<numChar; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 210 | // UUID Type |
| Andrea Palmieri |
229:9981f62cdb1a | 211 | if (handle_value_pair_length == 7) { |
| Andrea Palmieri |
229:9981f62cdb1a | 212 | PRINTF("Char UUID_TYPE_16\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 213 | uuid = handle_value_pair[offset+6]<<8|handle_value_pair[offset+5]; |
| Andrea Palmieri |
229:9981f62cdb1a | 214 | PRINTF("C UUID-%X\r\n", uuid.getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 215 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 216 | PRINTF("Char UUID_TYPE_128\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 217 | uuid.setupLong(handle_value_pair+offset+5, UUID::LSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 218 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 219 | PRINTF("C UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 220 | const uint8_t *longUUIDBytes = uuid.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 221 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 222 | PRINTF("%02X", longUUIDBytes[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 223 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 224 | PRINTF("\r\n"); |
| Andrea Palmieri |
229:9981f62cdb1a | 225 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 226 | } |
| Vincent Coubard |
259:323f588e5f57 | 227 | |
| Andrea Palmieri |
229:9981f62cdb1a | 228 | // Properties |
| Andrea Palmieri |
229:9981f62cdb1a | 229 | DiscoveredCharacteristic::Properties_t p; |
| Vincent Coubard |
259:323f588e5f57 | 230 | |
| Andrea Palmieri |
229:9981f62cdb1a | 231 | p._broadcast = (props_mask[0] & handle_value_pair[offset+2]); |
| Andrea Palmieri |
229:9981f62cdb1a | 232 | p._read = (props_mask[1] & handle_value_pair[offset+2])>>1; |
| Andrea Palmieri |
229:9981f62cdb1a | 233 | p._writeWoResp = (props_mask[2] & handle_value_pair[offset+2])>>2; |
| Andrea Palmieri |
229:9981f62cdb1a | 234 | p._write = (props_mask[3] & handle_value_pair[offset+2])>>3; |
| Andrea Palmieri |
229:9981f62cdb1a | 235 | p._notify = (props_mask[4] & handle_value_pair[offset+2])>>4; |
| Andrea Palmieri |
229:9981f62cdb1a | 236 | p._indicate = (props_mask[5] & handle_value_pair[offset+2])>>5; |
| Andrea Palmieri |
229:9981f62cdb1a | 237 | p._authSignedWrite = (props_mask[6] & handle_value_pair[offset+2])>>6; |
| Andrea Palmieri |
229:9981f62cdb1a | 238 | PRINTF("p._broadcast=%d\n\r", p._broadcast); |
| Andrea Palmieri |
229:9981f62cdb1a | 239 | PRINTF("p._read=%d\n\r", p._read); |
| Andrea Palmieri |
229:9981f62cdb1a | 240 | PRINTF("p._writeWoResp=%d\n\r", p._writeWoResp); |
| Andrea Palmieri |
229:9981f62cdb1a | 241 | PRINTF("p._write=%d\n\r", p._write); |
| Andrea Palmieri |
229:9981f62cdb1a | 242 | PRINTF("p._notify=%d\n\r", p._notify); |
| Andrea Palmieri |
229:9981f62cdb1a | 243 | PRINTF("p._indicate=%d\n\r", p._indicate); |
| Andrea Palmieri |
229:9981f62cdb1a | 244 | PRINTF("p._authSignedWrite=%d\n\r", p._authSignedWrite); |
| Andrea Palmieri |
229:9981f62cdb1a | 245 | |
| Andrea Palmieri |
229:9981f62cdb1a | 246 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 247 | uint8_t props = handle_value_pair[offset+2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 248 | PRINTF("CHAR PROPS: %d\n\r", props); |
| Andrea Palmieri |
229:9981f62cdb1a | 249 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 250 | |
| Andrea Palmieri |
229:9981f62cdb1a | 251 | // Handles |
| Andrea Palmieri |
229:9981f62cdb1a | 252 | declHandle = handle_value_pair[offset]; |
| Andrea Palmieri |
229:9981f62cdb1a | 253 | valueHandle = handle_value_pair[offset+3]; |
| Andrea Palmieri |
229:9981f62cdb1a | 254 | lastHandle = valueHandle+1; |
| Andrea Palmieri |
229:9981f62cdb1a | 255 | PRINTF("declHandle: %u valueHandle=%u lastHandle=%u\n\r", declHandle, valueHandle, lastHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 256 | |
| Andrea Palmieri |
229:9981f62cdb1a | 257 | discoveredChar[_numChars].setup(this, |
| Andrea Palmieri |
229:9981f62cdb1a | 258 | connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 259 | uuid, |
| Andrea Palmieri |
229:9981f62cdb1a | 260 | p, |
| Andrea Palmieri |
229:9981f62cdb1a | 261 | declHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 262 | valueHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 263 | lastHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 264 | |
| Vincent Coubard |
259:323f588e5f57 | 265 | if (_numChars != 0) { |
| Vincent Coubard |
259:323f588e5f57 | 266 | discoveredChar[_numChars - 1].setLastHandle(declHandle - 1); |
| Vincent Coubard |
259:323f588e5f57 | 267 | |
| Vincent Coubard |
259:323f588e5f57 | 268 | if(characteristicDiscoveryCallback) { |
| Vincent Coubard |
259:323f588e5f57 | 269 | characteristicDiscoveryCallback(&discoveredChar[_numChars - 1]); |
| Vincent Coubard |
259:323f588e5f57 | 270 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 271 | } |
| Vincent Coubard |
259:323f588e5f57 | 272 | |
| Andrea Palmieri |
229:9981f62cdb1a | 273 | _numChars++; |
| Andrea Palmieri |
229:9981f62cdb1a | 274 | |
| Andrea Palmieri |
229:9981f62cdb1a | 275 | offset += handle_value_pair_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 276 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 277 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 278 | |
| Andrea Palmieri |
229:9981f62cdb1a | 279 | void BlueNRGGattClient::serviceCharByUUIDCB(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 280 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 281 | uint16_t attr_handle, |
| Andrea Palmieri |
229:9981f62cdb1a | 282 | uint8_t *attr_value) |
| Andrea Palmieri |
229:9981f62cdb1a | 283 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 284 | // Charac Properties(1), Charac Value Handle(2), Charac UUID(2/16) |
| Andrea Palmieri |
229:9981f62cdb1a | 285 | GattAttribute::Handle_t declHandle, valueHandle, lastHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 286 | UUID uuid; |
| Vincent Coubard |
259:323f588e5f57 | 287 | |
| Andrea Palmieri |
229:9981f62cdb1a | 288 | PRINTF("serviceCharByUUIDCB\n\r"); |
| Vincent Coubard |
259:323f588e5f57 | 289 | |
| Andrea Palmieri |
229:9981f62cdb1a | 290 | // UUID Type |
| Andrea Palmieri |
229:9981f62cdb1a | 291 | if (event_data_length == 7) { |
| Andrea Palmieri |
229:9981f62cdb1a | 292 | PRINTF("Char UUID_TYPE_16\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 293 | uuid = attr_value[4]<<8|attr_value[3]; |
| Andrea Palmieri |
229:9981f62cdb1a | 294 | PRINTF("C UUID-%X\r\n", uuid.getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 295 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 296 | PRINTF("Char UUID_TYPE_128\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 297 | uuid.setupLong(attr_value+3, UUID::LSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 298 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 299 | PRINTF("C UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 300 | const uint8_t *longUUIDBytes = uuid.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 301 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 302 | PRINTF("%02X", longUUIDBytes[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 303 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 304 | PRINTF("\r\n"); |
| Andrea Palmieri |
229:9981f62cdb1a | 305 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 306 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 307 | |
| Andrea Palmieri |
229:9981f62cdb1a | 308 | // Properties |
| Andrea Palmieri |
229:9981f62cdb1a | 309 | DiscoveredCharacteristic::Properties_t p; |
| Vincent Coubard |
259:323f588e5f57 | 310 | |
| Andrea Palmieri |
229:9981f62cdb1a | 311 | p._broadcast = (props_mask[0] & attr_value[0]); |
| Andrea Palmieri |
229:9981f62cdb1a | 312 | p._read = (props_mask[1] & attr_value[0])>>1; |
| Andrea Palmieri |
229:9981f62cdb1a | 313 | p._writeWoResp = (props_mask[2] & attr_value[0])>>2; |
| Andrea Palmieri |
229:9981f62cdb1a | 314 | p._write = (props_mask[3] & attr_value[0])>>3; |
| Andrea Palmieri |
229:9981f62cdb1a | 315 | p._notify = (props_mask[4] & attr_value[0])>>4; |
| Andrea Palmieri |
229:9981f62cdb1a | 316 | p._indicate = (props_mask[5] & attr_value[0])>>5; |
| Andrea Palmieri |
229:9981f62cdb1a | 317 | p._authSignedWrite = (props_mask[6] & attr_value[0])>>6; |
| Andrea Palmieri |
229:9981f62cdb1a | 318 | PRINTF("p._broadcast=%d\n\r", p._broadcast); |
| Andrea Palmieri |
229:9981f62cdb1a | 319 | PRINTF("p._read=%d\n\r", p._read); |
| Andrea Palmieri |
229:9981f62cdb1a | 320 | PRINTF("p._writeWoResp=%d\n\r", p._writeWoResp); |
| Andrea Palmieri |
229:9981f62cdb1a | 321 | PRINTF("p._write=%d\n\r", p._write); |
| Andrea Palmieri |
229:9981f62cdb1a | 322 | PRINTF("p._notify=%d\n\r", p._notify); |
| Andrea Palmieri |
229:9981f62cdb1a | 323 | PRINTF("p._indicate=%d\n\r", p._indicate); |
| Andrea Palmieri |
229:9981f62cdb1a | 324 | PRINTF("p._authSignedWrite=%d\n\r", p._authSignedWrite); |
| Andrea Palmieri |
229:9981f62cdb1a | 325 | |
| Andrea Palmieri |
229:9981f62cdb1a | 326 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 327 | uint8_t props = attr_value[0]; |
| Andrea Palmieri |
229:9981f62cdb1a | 328 | PRINTF("CHAR PROPS: %d\n\r", props); |
| Andrea Palmieri |
229:9981f62cdb1a | 329 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 330 | |
| Andrea Palmieri |
229:9981f62cdb1a | 331 | // Handles |
| Andrea Palmieri |
229:9981f62cdb1a | 332 | declHandle = attr_handle; |
| Andrea Palmieri |
229:9981f62cdb1a | 333 | valueHandle = attr_value[1]; |
| Andrea Palmieri |
229:9981f62cdb1a | 334 | lastHandle = valueHandle+1; |
| Andrea Palmieri |
229:9981f62cdb1a | 335 | |
| Andrea Palmieri |
229:9981f62cdb1a | 336 | discoveredChar[_numChars].setup(this, |
| Andrea Palmieri |
229:9981f62cdb1a | 337 | connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 338 | uuid, |
| Andrea Palmieri |
229:9981f62cdb1a | 339 | p, |
| Andrea Palmieri |
229:9981f62cdb1a | 340 | declHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 341 | valueHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 342 | lastHandle); |
| Vincent Coubard |
259:323f588e5f57 | 343 | |
| Andrea Palmieri |
229:9981f62cdb1a | 344 | if(characteristicDiscoveryCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 345 | characteristicDiscoveryCallback(&discoveredChar[_numChars]); |
| Andrea Palmieri |
229:9981f62cdb1a | 346 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 347 | _numChars++; |
| Andrea Palmieri |
229:9981f62cdb1a | 348 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 349 | |
| Andrea Palmieri |
229:9981f62cdb1a | 350 | ble_error_t BlueNRGGattClient::findServiceChars(Gap::Handle_t connectionHandle) |
| Andrea Palmieri |
229:9981f62cdb1a | 351 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 352 | PRINTF("findServiceChars\n\r"); |
| Vincent Coubard |
259:323f588e5f57 | 353 | |
| Andrea Palmieri |
229:9981f62cdb1a | 354 | tBleStatus ret; |
| Andrea Palmieri |
229:9981f62cdb1a | 355 | uint8_t uuid_type = UUID_TYPE_16; |
| Andrea Palmieri |
229:9981f62cdb1a | 356 | uint8_t short_uuid[2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 357 | uint8_t *uuid = NULL; |
| Vincent Coubard |
259:323f588e5f57 | 358 | |
| Andrea Palmieri |
229:9981f62cdb1a | 359 | DiscoveredService *service; |
| Vincent Coubard |
259:323f588e5f57 | 360 | |
| Vincent Coubard |
259:323f588e5f57 | 361 | // complete the discovery of the last characteristic of the previous service. |
| Vincent Coubard |
259:323f588e5f57 | 362 | // Its last handle wasn't known before this point |
| Vincent Coubard |
259:323f588e5f57 | 363 | // update the handle and call the characteristic discovery callback. |
| Vincent Coubard |
259:323f588e5f57 | 364 | if (_servIndex != 0 && _numChars != 0) { |
| Vincent Coubard |
259:323f588e5f57 | 365 | discoveredChar[_numChars - 1].setLastHandle(discoveredService[_servIndex - 1].getEndHandle()); |
| Vincent Coubard |
259:323f588e5f57 | 366 | |
| Vincent Coubard |
259:323f588e5f57 | 367 | if(characteristicDiscoveryCallback) { |
| Vincent Coubard |
259:323f588e5f57 | 368 | characteristicDiscoveryCallback(&discoveredChar[_numChars - 1]); |
| Vincent Coubard |
259:323f588e5f57 | 369 | } |
| Vincent Coubard |
259:323f588e5f57 | 370 | } |
| Vincent Coubard |
259:323f588e5f57 | 371 | |
| Vincent Coubard |
259:323f588e5f57 | 372 | _numChars = 0; |
| Vincent Coubard |
259:323f588e5f57 | 373 | |
| Andrea Palmieri |
229:9981f62cdb1a | 374 | // We finished chars discovery for all services |
| Andrea Palmieri |
229:9981f62cdb1a | 375 | if(_servIndex >= _numServices) { |
| Andrea Palmieri |
229:9981f62cdb1a | 376 | PRINTF("!!!We finished chars discovery for all services!!!\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 377 | //_currentState = GATT_CHARS_DISCOVERY_COMPLETE; |
| Vincent Coubard |
259:323f588e5f57 | 378 | |
| Andrea Palmieri |
229:9981f62cdb1a | 379 | terminateServiceDiscovery(); |
| Vincent Coubard |
259:323f588e5f57 | 380 | |
| Andrea Palmieri |
229:9981f62cdb1a | 381 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 382 | } |
| Vincent Coubard |
259:323f588e5f57 | 383 | |
| Andrea Palmieri |
229:9981f62cdb1a | 384 | service = &discoveredService[_servIndex]; |
| Andrea Palmieri |
229:9981f62cdb1a | 385 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 386 | if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) { |
| Andrea Palmieri |
229:9981f62cdb1a | 387 | PRINTF("S UUID-%X\r\n", service->getUUID().getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 388 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 389 | PRINTF("S UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 390 | const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 391 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 392 | PRINTF("%02X", longUUIDBytes[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 393 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 394 | PRINTF("\r\n"); |
| Andrea Palmieri |
229:9981f62cdb1a | 395 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 396 | */ |
| Vincent Coubard |
259:323f588e5f57 | 397 | |
| Vincent Coubard |
259:323f588e5f57 | 398 | if(serviceDiscoveryCallback) { |
| Vincent Coubard |
259:323f588e5f57 | 399 | serviceDiscoveryCallback(service); |
| Vincent Coubard |
259:323f588e5f57 | 400 | } |
| Vincent Coubard |
259:323f588e5f57 | 401 | |
| Andrea Palmieri |
229:9981f62cdb1a | 402 | PRINTF("findServiceChars (_servIndex=%d)\n\r", _servIndex); |
| Andrea Palmieri |
229:9981f62cdb1a | 403 | //ret = aci_gatt_disc_all_charac_of_serv(connectionHandle, service->getStartHandle(), service->getEndHandle()); |
| Andrea Palmieri |
229:9981f62cdb1a | 404 | |
| Vincent Coubard |
259:323f588e5f57 | 405 | if(_matchingCharacteristicUUIDIn == BLE_UUID_UNKNOWN) { |
| Vincent Coubard |
259:323f588e5f57 | 406 | PRINTF("findServiceChars (BLE_UUID_UNKNOWN)\n\r"); |
| Vincent Coubard |
259:323f588e5f57 | 407 | ret = aci_gatt_disc_all_charac_of_serv(connectionHandle, service->getStartHandle(), service->getEndHandle()); |
| Vincent Coubard |
259:323f588e5f57 | 408 | } else { |
| Vincent Coubard |
259:323f588e5f57 | 409 | |
| Vincent Coubard |
259:323f588e5f57 | 410 | uint8_t type = _matchingCharacteristicUUIDIn.shortOrLong(); |
| Vincent Coubard |
259:323f588e5f57 | 411 | |
| Vincent Coubard |
259:323f588e5f57 | 412 | if(type == UUID::UUID_TYPE_SHORT) { |
| Vincent Coubard |
259:323f588e5f57 | 413 | STORE_LE_16(short_uuid, _matchingCharacteristicUUIDIn.getShortUUID()); |
| Vincent Coubard |
259:323f588e5f57 | 414 | |
| Vincent Coubard |
259:323f588e5f57 | 415 | uuid_type = UUID_TYPE_16; |
| Vincent Coubard |
259:323f588e5f57 | 416 | uuid = short_uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 417 | #ifdef DEBUG |
| Vincent Coubard |
259:323f588e5f57 | 418 | PRINTF("findServiceChars C UUID-"); |
| Vincent Coubard |
259:323f588e5f57 | 419 | for(unsigned i = 0; i < 2; i++) { |
| Vincent Coubard |
259:323f588e5f57 | 420 | PRINTF("%02X", short_uuid[i]); |
| Vincent Coubard |
259:323f588e5f57 | 421 | } |
| Vincent Coubard |
259:323f588e5f57 | 422 | PRINTF("\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 423 | #endif |
| Vincent Coubard |
259:323f588e5f57 | 424 | } else if(type==UUID::UUID_TYPE_LONG) { |
| Vincent Coubard |
259:323f588e5f57 | 425 | |
| Vincent Coubard |
259:323f588e5f57 | 426 | uuid_type = UUID_TYPE_128; |
| Vincent Coubard |
259:323f588e5f57 | 427 | uuid = (unsigned char*)_matchingCharacteristicUUIDIn.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 428 | #ifdef DEBUG |
| Vincent Coubard |
259:323f588e5f57 | 429 | PRINTF("(findServiceChars) C UUID-"); |
| Vincent Coubard |
259:323f588e5f57 | 430 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Vincent Coubard |
259:323f588e5f57 | 431 | PRINTF("%02X", uuid[i]); |
| Vincent Coubard |
259:323f588e5f57 | 432 | } |
| Vincent Coubard |
259:323f588e5f57 | 433 | PRINTF("\r\n"); |
| Andrea Palmieri |
229:9981f62cdb1a | 434 | #endif |
| Vincent Coubard |
259:323f588e5f57 | 435 | } |
| Vincent Coubard |
259:323f588e5f57 | 436 | |
| Vincent Coubard |
259:323f588e5f57 | 437 | ret = aci_gatt_disc_charac_by_uuid(connectionHandle, |
| Vincent Coubard |
259:323f588e5f57 | 438 | service->getStartHandle(), |
| Vincent Coubard |
259:323f588e5f57 | 439 | service->getEndHandle(), |
| Vincent Coubard |
259:323f588e5f57 | 440 | uuid_type, |
| Vincent Coubard |
259:323f588e5f57 | 441 | uuid); |
| Andrea Palmieri |
229:9981f62cdb1a | 442 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 443 | |
| Andrea Palmieri |
229:9981f62cdb1a | 444 | if(ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 445 | _servIndex++; |
| Andrea Palmieri |
229:9981f62cdb1a | 446 | } |
| Vincent Coubard |
259:323f588e5f57 | 447 | |
| Andrea Palmieri |
229:9981f62cdb1a | 448 | PRINTF("findServiceChars ret=%d\n\r", ret); |
| Vincent Coubard |
259:323f588e5f57 | 449 | |
| Andrea Palmieri |
229:9981f62cdb1a | 450 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 451 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 452 | |
| Andrea Palmieri |
229:9981f62cdb1a | 453 | ble_error_t BlueNRGGattClient::launchServiceDiscovery(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 454 | ServiceDiscovery::ServiceCallback_t sc, |
| Andrea Palmieri |
229:9981f62cdb1a | 455 | ServiceDiscovery::CharacteristicCallback_t cc, |
| Andrea Palmieri |
229:9981f62cdb1a | 456 | const UUID &matchingServiceUUID, |
| Andrea Palmieri |
229:9981f62cdb1a | 457 | const UUID &matchingCharacteristicUUIDIn) |
| Andrea Palmieri |
229:9981f62cdb1a | 458 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 459 | PRINTF("launchServiceDiscovery\n\r"); |
| Vincent Coubard |
259:323f588e5f57 | 460 | |
| Andrea Palmieri |
229:9981f62cdb1a | 461 | tBleStatus ret; |
| Andrea Palmieri |
229:9981f62cdb1a | 462 | uint8_t uuid_type = UUID_TYPE_16; |
| Andrea Palmieri |
229:9981f62cdb1a | 463 | uint8_t short_uuid[2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 464 | uint8_t *uuid = NULL; |
| Andrea Palmieri |
229:9981f62cdb1a | 465 | unsigned j; |
| Andrea Palmieri |
229:9981f62cdb1a | 466 | |
| Andrea Palmieri |
229:9981f62cdb1a | 467 | if(isServiceDiscoveryActive()) { |
| Andrea Palmieri |
229:9981f62cdb1a | 468 | return BLE_ERROR_OPERATION_NOT_PERMITTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 469 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 470 | |
| Andrea Palmieri |
229:9981f62cdb1a | 471 | if(!sc && !cc) { |
| Andrea Palmieri |
229:9981f62cdb1a | 472 | // nothing to do |
| Andrea Palmieri |
229:9981f62cdb1a | 473 | PRINTF("launchServiceDiscovery: nothing to do\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 474 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 475 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 476 | |
| Andrea Palmieri |
229:9981f62cdb1a | 477 | _connectionHandle = connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 478 | serviceDiscoveryCallback = sc; |
| Andrea Palmieri |
229:9981f62cdb1a | 479 | characteristicDiscoveryCallback = cc; |
| Andrea Palmieri |
229:9981f62cdb1a | 480 | _matchingServiceUUID = matchingServiceUUID; |
| Andrea Palmieri |
229:9981f62cdb1a | 481 | _matchingCharacteristicUUIDIn = matchingCharacteristicUUIDIn; |
| Andrea Palmieri |
229:9981f62cdb1a | 482 | |
| Andrea Palmieri |
229:9981f62cdb1a | 483 | //reset services |
| Andrea Palmieri |
229:9981f62cdb1a | 484 | _numServices = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 485 | _numChars = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 486 | _servIndex = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 487 | for(j = 0; j < BLE_TOTAL_DISCOVERED_SERVICES; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 488 | discoveredService[j].setup(BLE_UUID_UNKNOWN, GattAttribute::INVALID_HANDLE, GattAttribute::INVALID_HANDLE); |
| Andrea Palmieri |
229:9981f62cdb1a | 489 | } |
| Vincent Coubard |
259:323f588e5f57 | 490 | |
| Andrea Palmieri |
229:9981f62cdb1a | 491 | if(matchingServiceUUID == BLE_UUID_UNKNOWN) { |
| Vincent Coubard |
259:323f588e5f57 | 492 | |
| Andrea Palmieri |
229:9981f62cdb1a | 493 | // Wildcard: search for all services |
| Andrea Palmieri |
229:9981f62cdb1a | 494 | ret = aci_gatt_disc_all_prim_services((uint16_t)connectionHandle); |
| Vincent Coubard |
259:323f588e5f57 | 495 | |
| Andrea Palmieri |
229:9981f62cdb1a | 496 | } else { |
| Vincent Coubard |
259:323f588e5f57 | 497 | |
| Andrea Palmieri |
229:9981f62cdb1a | 498 | uint8_t type = matchingServiceUUID.shortOrLong(); |
| Andrea Palmieri |
229:9981f62cdb1a | 499 | //PRINTF("AddService(): Type:%d\n\r", type); |
| Vincent Coubard |
259:323f588e5f57 | 500 | |
| Andrea Palmieri |
229:9981f62cdb1a | 501 | if(type == UUID::UUID_TYPE_SHORT) { |
| Andrea Palmieri |
229:9981f62cdb1a | 502 | STORE_LE_16(short_uuid, matchingServiceUUID.getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 503 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 504 | PRINTF("launchServiceDiscovery short_uuid=0x"); |
| Andrea Palmieri |
229:9981f62cdb1a | 505 | for(j = 0; j < 2; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 506 | PRINTF("%02X", short_uuid[j]); |
| Andrea Palmieri |
229:9981f62cdb1a | 507 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 508 | PRINTF("\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 509 | #endif |
| Vincent Coubard |
259:323f588e5f57 | 510 | |
| Andrea Palmieri |
229:9981f62cdb1a | 511 | uuid_type = UUID_TYPE_16; |
| Andrea Palmieri |
229:9981f62cdb1a | 512 | uuid = short_uuid; |
| Vincent Coubard |
259:323f588e5f57 | 513 | |
| Andrea Palmieri |
229:9981f62cdb1a | 514 | } else if(type==UUID::UUID_TYPE_LONG) { |
| Andrea Palmieri |
229:9981f62cdb1a | 515 | |
| Andrea Palmieri |
229:9981f62cdb1a | 516 | uuid_type = UUID_TYPE_128; |
| Andrea Palmieri |
229:9981f62cdb1a | 517 | uuid = (unsigned char*)matchingServiceUUID.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 518 | |
| Andrea Palmieri |
229:9981f62cdb1a | 519 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 520 | PRINTF("launchServiceDiscovery base_uuid=0x"); |
| Andrea Palmieri |
229:9981f62cdb1a | 521 | for(j = 0; j < 16; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 522 | PRINTF("%02X", uuid[j]); |
| Andrea Palmieri |
229:9981f62cdb1a | 523 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 524 | PRINTF("\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 525 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 526 | } |
| Vincent Coubard |
259:323f588e5f57 | 527 | |
| Andrea Palmieri |
229:9981f62cdb1a | 528 | // search for specific service by UUID |
| Andrea Palmieri |
229:9981f62cdb1a | 529 | ret = aci_gatt_disc_prim_service_by_uuid((uint16_t)connectionHandle, uuid_type, uuid); |
| Andrea Palmieri |
229:9981f62cdb1a | 530 | //ret = aci_gatt_disc_all_prim_services((uint16_t)connectionHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 531 | } |
| Vincent Coubard |
259:323f588e5f57 | 532 | |
| Andrea Palmieri |
229:9981f62cdb1a | 533 | if(ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 534 | _currentState = GATT_SERVICE_DISCOVERY; |
| Andrea Palmieri |
229:9981f62cdb1a | 535 | } |
| Vincent Coubard |
259:323f588e5f57 | 536 | |
| Andrea Palmieri |
229:9981f62cdb1a | 537 | PRINTF("launchServiceDiscovery ret=%d\n\r", ret); |
| Vincent Coubard |
259:323f588e5f57 | 538 | |
| Andrea Palmieri |
229:9981f62cdb1a | 539 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 540 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 541 | |
| Andrea Palmieri |
229:9981f62cdb1a | 542 | ble_error_t BlueNRGGattClient::discoverServices(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 543 | ServiceDiscovery::ServiceCallback_t callback, |
| Andrea Palmieri |
229:9981f62cdb1a | 544 | const UUID &matchingServiceUUID) |
| Andrea Palmieri |
229:9981f62cdb1a | 545 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 546 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 547 | (void)connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 548 | (void)callback; |
| Andrea Palmieri |
229:9981f62cdb1a | 549 | (void)matchingServiceUUID; |
| Andrea Palmieri |
229:9981f62cdb1a | 550 | |
| Andrea Palmieri |
229:9981f62cdb1a | 551 | return BLE_ERROR_NOT_IMPLEMENTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 552 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 553 | |
| Andrea Palmieri |
229:9981f62cdb1a | 554 | ble_error_t BlueNRGGattClient::discoverServices(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 555 | ServiceDiscovery::ServiceCallback_t callback, |
| Andrea Palmieri |
229:9981f62cdb1a | 556 | GattAttribute::Handle_t startHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 557 | GattAttribute::Handle_t endHandle) |
| Andrea Palmieri |
229:9981f62cdb1a | 558 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 559 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 560 | (void)connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 561 | (void)callback; |
| Andrea Palmieri |
229:9981f62cdb1a | 562 | (void)startHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 563 | (void)endHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 564 | |
| Andrea Palmieri |
229:9981f62cdb1a | 565 | return BLE_ERROR_NOT_IMPLEMENTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 566 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 567 | |
| Andrea Palmieri |
229:9981f62cdb1a | 568 | bool BlueNRGGattClient::isServiceDiscoveryActive(void) const |
| Andrea Palmieri |
229:9981f62cdb1a | 569 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 570 | if(_currentState == GATT_SERVICE_DISCOVERY) { |
| Andrea Palmieri |
229:9981f62cdb1a | 571 | return true; |
| Andrea Palmieri |
229:9981f62cdb1a | 572 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 573 | |
| Andrea Palmieri |
229:9981f62cdb1a | 574 | return false; |
| Andrea Palmieri |
229:9981f62cdb1a | 575 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 576 | if(_currentState == GATT_IDLE || |
| Andrea Palmieri |
229:9981f62cdb1a | 577 | _currentState == GATT_DISCOVERY_TERMINATED || |
| Andrea Palmieri |
229:9981f62cdb1a | 578 | _currentState == GATT_READ_CHAR || |
| Andrea Palmieri |
229:9981f62cdb1a | 579 | _currentState == GATT_WRITE_CHAR ) { |
| Andrea Palmieri |
229:9981f62cdb1a | 580 | return false; |
| Andrea Palmieri |
229:9981f62cdb1a | 581 | } |
| Vincent Coubard |
259:323f588e5f57 | 582 | |
| Andrea Palmieri |
229:9981f62cdb1a | 583 | return true; |
| Andrea Palmieri |
229:9981f62cdb1a | 584 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 585 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 586 | |
| Andrea Palmieri |
229:9981f62cdb1a | 587 | void BlueNRGGattClient::terminateServiceDiscovery(void) |
| Andrea Palmieri |
229:9981f62cdb1a | 588 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 589 | _currentState = GATT_IDLE;//GATT_DISCOVERY_TERMINATED; |
| Vincent Coubard |
259:323f588e5f57 | 590 | |
| Andrea Palmieri |
229:9981f62cdb1a | 591 | if (terminationCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 592 | terminationCallback(_connectionHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 593 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 594 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 595 | |
| Andrea Palmieri |
229:9981f62cdb1a | 596 | void BlueNRGGattClient::charReadCB(Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 597 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 598 | uint8_t* attribute_value) |
| Andrea Palmieri |
229:9981f62cdb1a | 599 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 600 | readCBParams.connHandle = connHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 601 | readCBParams.offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 602 | readCBParams.len = event_data_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 603 | readCBParams.data = attribute_value; |
| Andrea Palmieri |
229:9981f62cdb1a | 604 | |
| Andrea Palmieri |
229:9981f62cdb1a | 605 | BlueNRGGattClient::getInstance().processReadResponse(&readCBParams); |
| Andrea Palmieri |
229:9981f62cdb1a | 606 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 607 | |
| Andrea Palmieri |
229:9981f62cdb1a | 608 | ble_error_t BlueNRGGattClient::read(Gap::Handle_t connHandle, GattAttribute::Handle_t attributeHandle, uint16_t offset) const |
| Andrea Palmieri |
229:9981f62cdb1a | 609 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 610 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 611 | (void)offset; |
| Andrea Palmieri |
229:9981f62cdb1a | 612 | |
| Andrea Palmieri |
229:9981f62cdb1a | 613 | tBleStatus ret; |
| Vincent Coubard |
259:323f588e5f57 | 614 | |
| Andrea Palmieri |
229:9981f62cdb1a | 615 | BlueNRGGattClient *gattc = const_cast<BlueNRGGattClient*>(this); |
| Vincent Coubard |
259:323f588e5f57 | 616 | |
| Vincent Coubard |
259:323f588e5f57 | 617 | // Save the attribute_handle not provided by evt_att_read_resp |
| Andrea Palmieri |
229:9981f62cdb1a | 618 | gattc->readCBParams.handle = attributeHandle; |
| Vincent Coubard |
259:323f588e5f57 | 619 | |
| Andrea Palmieri |
229:9981f62cdb1a | 620 | // FIXME: We need to wait for a while before starting a read |
| Andrea Palmieri |
229:9981f62cdb1a | 621 | // due to BlueNRG process queue handling |
| Andrea Palmieri |
229:9981f62cdb1a | 622 | Clock_Wait(100); |
| Andrea Palmieri |
229:9981f62cdb1a | 623 | |
| Andrea Palmieri |
229:9981f62cdb1a | 624 | ret = aci_gatt_read_charac_val(connHandle, attributeHandle); |
| Vincent Coubard |
259:323f588e5f57 | 625 | |
| Andrea Palmieri |
229:9981f62cdb1a | 626 | if(ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 627 | gattc->_currentState = GATT_READ_CHAR; |
| Andrea Palmieri |
229:9981f62cdb1a | 628 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 629 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 630 | switch (ret) { |
| Andrea Palmieri |
229:9981f62cdb1a | 631 | case BLE_STATUS_BUSY: |
| Andrea Palmieri |
229:9981f62cdb1a | 632 | return BLE_STACK_BUSY; |
| Andrea Palmieri |
229:9981f62cdb1a | 633 | default: |
| Andrea Palmieri |
229:9981f62cdb1a | 634 | return BLE_ERROR_INVALID_STATE; |
| Andrea Palmieri |
229:9981f62cdb1a | 635 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 636 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 637 | |
| Andrea Palmieri |
229:9981f62cdb1a | 638 | void BlueNRGGattClient::charWritePrepareCB(Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 639 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 640 | uint16_t attribute_handle, |
| Andrea Palmieri |
229:9981f62cdb1a | 641 | uint16_t offset, |
| Andrea Palmieri |
229:9981f62cdb1a | 642 | uint8_t *part_attr_value) |
| Andrea Palmieri |
229:9981f62cdb1a | 643 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 644 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 645 | (void)connHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 646 | |
| Andrea Palmieri |
229:9981f62cdb1a | 647 | // Update the write response params |
| Andrea Palmieri |
229:9981f62cdb1a | 648 | writeCBParams.handle = attribute_handle; |
| Andrea Palmieri |
229:9981f62cdb1a | 649 | writeCBParams.offset = offset; |
| Andrea Palmieri |
229:9981f62cdb1a | 650 | writeCBParams.len = event_data_length-4; //(?) |
| Andrea Palmieri |
229:9981f62cdb1a | 651 | writeCBParams.data = part_attr_value; |
| Andrea Palmieri |
229:9981f62cdb1a | 652 | |
| Andrea Palmieri |
229:9981f62cdb1a | 653 | BlueNRGGattClient::getInstance().processWriteResponse(&writeCBParams); |
| Andrea Palmieri |
229:9981f62cdb1a | 654 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 655 | |
| Andrea Palmieri |
229:9981f62cdb1a | 656 | void BlueNRGGattClient::charWriteExecCB(Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 657 | uint8_t event_data_length) |
| Andrea Palmieri |
229:9981f62cdb1a | 658 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 659 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 660 | (void)event_data_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 661 | |
| Andrea Palmieri |
229:9981f62cdb1a | 662 | writeCBParams.connHandle = connHandle; |
| Vincent Coubard |
259:323f588e5f57 | 663 | |
| Andrea Palmieri |
229:9981f62cdb1a | 664 | BlueNRGGattClient::getInstance().processWriteResponse(&writeCBParams); |
| Andrea Palmieri |
229:9981f62cdb1a | 665 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 666 | |
| Andrea Palmieri |
229:9981f62cdb1a | 667 | ble_error_t BlueNRGGattClient::write(GattClient::WriteOp_t cmd, |
| Andrea Palmieri |
229:9981f62cdb1a | 668 | Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 669 | GattAttribute::Handle_t attributeHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 670 | size_t length, |
| Andrea Palmieri |
229:9981f62cdb1a | 671 | const uint8_t *value) const |
| Andrea Palmieri |
229:9981f62cdb1a | 672 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 673 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 674 | (void)cmd; |
| Andrea Palmieri |
229:9981f62cdb1a | 675 | |
| Andrea Palmieri |
229:9981f62cdb1a | 676 | tBleStatus ret; |
| Vincent Coubard |
259:323f588e5f57 | 677 | |
| Andrea Palmieri |
229:9981f62cdb1a | 678 | BlueNRGGattClient *gattc = const_cast<BlueNRGGattClient*>(this); |
| Vincent Coubard |
259:323f588e5f57 | 679 | |
| Andrea Palmieri |
229:9981f62cdb1a | 680 | // We save the write response params (used by the callback) because |
| Andrea Palmieri |
229:9981f62cdb1a | 681 | // when the aci_gatt_write_charac_value() is used the only event received is the EVT_BLUE_GATT_PROCEDURE_COMPLETE |
| Andrea Palmieri |
229:9981f62cdb1a | 682 | gattc->writeCBParams.connHandle = connHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 683 | gattc->writeCBParams.writeOp = GattWriteCallbackParams::OP_WRITE_CMD; |
| Andrea Palmieri |
229:9981f62cdb1a | 684 | gattc->writeCBParams.handle = attributeHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 685 | gattc->writeCBParams.offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 686 | gattc->writeCBParams.len = length; |
| Andrea Palmieri |
229:9981f62cdb1a | 687 | gattc->writeCBParams.data = value; |
| Vincent Coubard |
259:323f588e5f57 | 688 | |
| Andrea Palmieri |
229:9981f62cdb1a | 689 | ret = aci_gatt_write_charac_value(connHandle, attributeHandle, length, const_cast<uint8_t *>(value)); |
| Andrea Palmieri |
229:9981f62cdb1a | 690 | //ret = aci_gatt_write_charac_reliable(connHandle, attributeHandle, 0, length, const_cast<uint8_t *>(value)); |
| Vincent Coubard |
259:323f588e5f57 | 691 | |
| Andrea Palmieri |
229:9981f62cdb1a | 692 | if (ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 693 | gattc->_currentState = GATT_WRITE_CHAR; |
| Andrea Palmieri |
229:9981f62cdb1a | 694 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 695 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 696 | switch (ret) { |
| Andrea Palmieri |
229:9981f62cdb1a | 697 | case BLE_STATUS_BUSY: |
| Andrea Palmieri |
229:9981f62cdb1a | 698 | return BLE_STACK_BUSY; |
| Andrea Palmieri |
229:9981f62cdb1a | 699 | default: |
| Andrea Palmieri |
229:9981f62cdb1a | 700 | return BLE_ERROR_INVALID_STATE; |
| Andrea Palmieri |
229:9981f62cdb1a | 701 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 702 | |
| Andrea Palmieri |
229:9981f62cdb1a | 703 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 704 | |
| Andrea Palmieri |
229:9981f62cdb1a | 705 | void BlueNRGGattClient::discAllCharacDescCB(Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 706 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 707 | uint8_t format, |
| Andrea Palmieri |
229:9981f62cdb1a | 708 | uint8_t *handle_uuid_pair) { |
| Andrea Palmieri |
229:9981f62cdb1a | 709 | GattAttribute::Handle_t attHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 710 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 711 | uint8_t i, numCharacDesc, offset, handle_uuid_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 712 | |
| Andrea Palmieri |
229:9981f62cdb1a | 713 | handle_uuid_length = 4; //Handle + UUID_16 |
| Andrea Palmieri |
229:9981f62cdb1a | 714 | if (format == 2) |
| Andrea Palmieri |
229:9981f62cdb1a | 715 | handle_uuid_length = 18; //Handle + UUID_128 |
| Andrea Palmieri |
229:9981f62cdb1a | 716 | |
| Andrea Palmieri |
229:9981f62cdb1a | 717 | numCharacDesc = (event_data_length - 1) / handle_uuid_length; |
| Vincent Coubard |
259:323f588e5f57 | 718 | |
| Andrea Palmieri |
229:9981f62cdb1a | 719 | offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 720 | |
| Vincent Coubard |
262:a3460768f3b7 | 721 | PRINTF("\r\ncharacteristic descriptor discovered: data length %u, format %u\r\n", |
| Vincent Coubard |
262:a3460768f3b7 | 722 | event_data_length, format); |
| Vincent Coubard |
262:a3460768f3b7 | 723 | |
| Vincent Coubard |
262:a3460768f3b7 | 724 | |
| Andrea Palmieri |
229:9981f62cdb1a | 725 | for (i=0; i<numCharacDesc; i++) { |
| Vincent Coubard |
262:a3460768f3b7 | 726 | memcpy(&attHandle, handle_uuid_pair + offset, sizeof(attHandle)); |
| Andrea Palmieri |
229:9981f62cdb1a | 727 | |
| Andrea Palmieri |
229:9981f62cdb1a | 728 | // UUID Type |
| Andrea Palmieri |
229:9981f62cdb1a | 729 | if (handle_uuid_length == 4) { |
| Vincent Coubard |
259:323f588e5f57 | 730 | |
| Andrea Palmieri |
229:9981f62cdb1a | 731 | PRINTF("UUID_TYPE_16\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 732 | uuid = handle_uuid_pair[offset+3]<<8|handle_uuid_pair[offset+2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 733 | PRINTF("D UUID-%X attHandle=%u\r\n", uuid.getShortUUID(), attHandle); |
| Vincent Coubard |
259:323f588e5f57 | 734 | |
| Andrea Palmieri |
229:9981f62cdb1a | 735 | } else { |
| Vincent Coubard |
259:323f588e5f57 | 736 | |
| Andrea Palmieri |
229:9981f62cdb1a | 737 | PRINTF("UUID_TYPE_128\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 738 | uuid.setupLong(handle_uuid_pair+offset+2, UUID::LSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 739 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 740 | PRINTF("D UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 741 | const uint8_t *longUUIDBytes = uuid.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 742 | for (unsigned j = 0; j < UUID::LENGTH_OF_LONG_UUID; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 743 | PRINTF("%02x", longUUIDBytes[j]); |
| Andrea Palmieri |
229:9981f62cdb1a | 744 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 745 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 746 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 747 | |
| Andrea Palmieri |
229:9981f62cdb1a | 748 | if(charDescDiscoveryCallback != NULL) { |
| Andrea Palmieri |
229:9981f62cdb1a | 749 | CharacteristicDescriptorDiscovery::DiscoveryCallbackParams_t params = { |
| Andrea Palmieri |
229:9981f62cdb1a | 750 | _characteristic, |
| Andrea Palmieri |
229:9981f62cdb1a | 751 | DiscoveredCharacteristicDescriptor( |
| Andrea Palmieri |
229:9981f62cdb1a | 752 | _characteristic.getGattClient(), |
| Andrea Palmieri |
229:9981f62cdb1a | 753 | connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 754 | attHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 755 | uuid |
| Andrea Palmieri |
229:9981f62cdb1a | 756 | ) |
| Andrea Palmieri |
229:9981f62cdb1a | 757 | }; |
| Andrea Palmieri |
229:9981f62cdb1a | 758 | charDescDiscoveryCallback(¶ms); |
| Andrea Palmieri |
229:9981f62cdb1a | 759 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 760 | |
| Andrea Palmieri |
229:9981f62cdb1a | 761 | _numCharDesc++; |
| Andrea Palmieri |
229:9981f62cdb1a | 762 | |
| Andrea Palmieri |
229:9981f62cdb1a | 763 | offset += handle_uuid_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 764 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 765 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 766 | |
| Andrea Palmieri |
229:9981f62cdb1a | 767 | ble_error_t BlueNRGGattClient::discoverCharacteristicDescriptors( |
| Andrea Palmieri |
229:9981f62cdb1a | 768 | const DiscoveredCharacteristic& characteristic, |
| Andrea Palmieri |
229:9981f62cdb1a | 769 | const CharacteristicDescriptorDiscovery::DiscoveryCallback_t& discoveryCallback, |
| Andrea Palmieri |
229:9981f62cdb1a | 770 | const CharacteristicDescriptorDiscovery::TerminationCallback_t& terminationCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 771 | |
| Andrea Palmieri |
229:9981f62cdb1a | 772 | tBleStatus ret; |
| Andrea Palmieri |
229:9981f62cdb1a | 773 | |
| Andrea Palmieri |
229:9981f62cdb1a | 774 | if(_currentState != GATT_IDLE) { |
| Andrea Palmieri |
229:9981f62cdb1a | 775 | return BLE_ERROR_OPERATION_NOT_PERMITTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 776 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 777 | |
| Andrea Palmieri |
229:9981f62cdb1a | 778 | charDescDiscoveryCallback = discoveryCallback; |
| Andrea Palmieri |
229:9981f62cdb1a | 779 | charDescTerminationCallback = terminationCallback; |
| Andrea Palmieri |
229:9981f62cdb1a | 780 | |
| Andrea Palmieri |
229:9981f62cdb1a | 781 | Gap::Handle_t connHandle = characteristic.getConnectionHandle(); |
| Andrea Palmieri |
229:9981f62cdb1a | 782 | GattAttribute::Handle_t valueHandle = characteristic.getValueHandle(); |
| Andrea Palmieri |
229:9981f62cdb1a | 783 | GattAttribute::Handle_t lastHandle = characteristic.getLastHandle(); |
| Andrea Palmieri |
229:9981f62cdb1a | 784 | |
| Vincent Coubard |
262:a3460768f3b7 | 785 | PRINTF("Starting aci_gatt_disc_all_charac_descriptors... [%u : %u]\n\r", valueHandle, lastHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 786 | ret = aci_gatt_disc_all_charac_descriptors(connHandle, valueHandle, lastHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 787 | |
| Andrea Palmieri |
229:9981f62cdb1a | 788 | if (ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 789 | _currentState = GATT_CHAR_DESC_DISCOVERY; |
| Andrea Palmieri |
229:9981f62cdb1a | 790 | _characteristic = characteristic; |
| Andrea Palmieri |
229:9981f62cdb1a | 791 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 792 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 793 | switch (ret) { |
| Andrea Palmieri |
229:9981f62cdb1a | 794 | case BLE_STATUS_INVALID_PARAMS: |
| Andrea Palmieri |
229:9981f62cdb1a | 795 | return BLE_ERROR_INVALID_PARAM; |
| Andrea Palmieri |
229:9981f62cdb1a | 796 | default: |
| Andrea Palmieri |
229:9981f62cdb1a | 797 | return BLE_ERROR_OPERATION_NOT_PERMITTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 798 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 799 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 800 | |
| Andrea Palmieri |
229:9981f62cdb1a | 801 | /**************************************************************************/ |
| Andrea Palmieri |
229:9981f62cdb1a | 802 | /*! |
| Andrea Palmieri |
229:9981f62cdb1a | 803 | @brief Clear BlueNRGGattServer's state. |
| Andrea Palmieri |
229:9981f62cdb1a | 804 | |
| Andrea Palmieri |
229:9981f62cdb1a | 805 | @returns ble_error_t |
| Andrea Palmieri |
229:9981f62cdb1a | 806 | |
| Andrea Palmieri |
229:9981f62cdb1a | 807 | @retval BLE_ERROR_NONE |
| Andrea Palmieri |
229:9981f62cdb1a | 808 | Everything executed properly |
| Andrea Palmieri |
229:9981f62cdb1a | 809 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 810 | /**************************************************************************/ |
| Andrea Palmieri |
229:9981f62cdb1a | 811 | ble_error_t BlueNRGGattClient::reset(void) { |
| Andrea Palmieri |
229:9981f62cdb1a | 812 | /* Clear all state that is from the parent, including private members */ |
| Andrea Palmieri |
229:9981f62cdb1a | 813 | if (GattClient::reset() != BLE_ERROR_NONE) { |
| Andrea Palmieri |
229:9981f62cdb1a | 814 | return BLE_ERROR_INVALID_STATE; |
| Andrea Palmieri |
229:9981f62cdb1a | 815 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 816 | |
| Andrea Palmieri |
229:9981f62cdb1a | 817 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 818 | _matchingServiceUUID = BLE_UUID_UNKNOWN; |
| Andrea Palmieri |
229:9981f62cdb1a | 819 | _matchingCharacteristicUUIDIn = BLE_UUID_UNKNOWN; |
| Andrea Palmieri |
229:9981f62cdb1a | 820 | |
| Andrea Palmieri |
229:9981f62cdb1a | 821 | _numServices = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 822 | _servIndex = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 823 | _numChars = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 824 | _numCharDesc = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 825 | |
| Andrea Palmieri |
229:9981f62cdb1a | 826 | /* Clear class members */ |
| Andrea Palmieri |
229:9981f62cdb1a | 827 | memset(discoveredService, 0, sizeof(discoveredService)); |
| Andrea Palmieri |
229:9981f62cdb1a | 828 | memset(discoveredChar, 0, sizeof(discoveredChar)); |
| Andrea Palmieri |
229:9981f62cdb1a | 829 | |
| Andrea Palmieri |
229:9981f62cdb1a | 830 | return BLE_ERROR_NONE; |
| Vincent Coubard |
259:323f588e5f57 | 831 | } |
X-NUCLEO-IDB04A1 Bluetooth Low Energy
X-NUCLEO-IDB05A1 Bluetooth Low Energy