Vincent (pan-) Coubard
/
X_NUCLEO_IDB0XA1
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Fork of
X_NUCLEO_IDB0XA1
by 
ST
source/BlueNRGGattClient.cpp@231:a0d2544b38cd, 2016-05-20 (annotated)
- Committer:
- Andrea Palmieri
- Date:
- Fri May 20 16:59:24 2016 +0200
- Revision:
- 231:a0d2544b38cd
- Parent:
- 229:9981f62cdb1a
- Child:
- 242:058b2e731adc
Minor change
Signed-off-by: Andrea Palmieri <andrea.palmieri@st.com>
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 | ****************************************************************************** |
| Andrea Palmieri |
229:9981f62cdb1a | 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> |
| Andrea Palmieri |
229:9981f62cdb1a | 32 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 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 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 38 | |
| Andrea Palmieri |
229:9981f62cdb1a | 39 | #include "BlueNRGGattClient.h" |
| Andrea Palmieri |
229:9981f62cdb1a | 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 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 62 | |
| Andrea Palmieri |
229:9981f62cdb1a | 63 | // Service Discovery complete |
| Andrea Palmieri |
229:9981f62cdb1a | 64 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 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) { |
| Andrea Palmieri |
229:9981f62cdb1a | 75 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 76 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 77 | |
| Andrea Palmieri |
229:9981f62cdb1a | 78 | // Read complete |
| Andrea Palmieri |
229:9981f62cdb1a | 79 | if(_currentState == GATT_READ_CHAR) { |
| Andrea Palmieri |
229:9981f62cdb1a | 80 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 81 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 82 | |
| Andrea Palmieri |
229:9981f62cdb1a | 83 | // Write complete |
| Andrea Palmieri |
229:9981f62cdb1a | 84 | if(_currentState == GATT_WRITE_CHAR) { |
| Andrea Palmieri |
229:9981f62cdb1a | 85 | BlueNRGGattClient::getInstance().processWriteResponse(&writeCBParams); |
| Andrea Palmieri |
229:9981f62cdb1a | 86 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 87 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 88 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 89 | |
| Andrea Palmieri |
229:9981f62cdb1a | 90 | void BlueNRGGattClient::primaryServicesCB(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 91 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 92 | uint8_t attribute_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 93 | uint8_t *attribute_data_list) |
| Andrea Palmieri |
229:9981f62cdb1a | 94 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 95 | GattAttribute::Handle_t startHandle, endHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 96 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 97 | uint8_t i, offset, numAttr; |
| Andrea Palmieri |
229:9981f62cdb1a | 98 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 99 | (void)connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 100 | |
| Andrea Palmieri |
229:9981f62cdb1a | 101 | numAttr = (event_data_length - 1) / attribute_data_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 102 | |
| Andrea Palmieri |
229:9981f62cdb1a | 103 | offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 104 | for (i=0; i<numAttr; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 105 | startHandle = attribute_data_list[offset]; |
| Andrea Palmieri |
229:9981f62cdb1a | 106 | endHandle = attribute_data_list[offset+2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 107 | |
| Andrea Palmieri |
229:9981f62cdb1a | 108 | // UUID Type |
| Andrea Palmieri |
229:9981f62cdb1a | 109 | if (attribute_data_length == 6) { |
| Andrea Palmieri |
229:9981f62cdb1a | 110 | |
| Andrea Palmieri |
229:9981f62cdb1a | 111 | PRINTF("UUID_TYPE_16\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 112 | uuid = attribute_data_list[offset+5]<<8|attribute_data_list[offset+4]; |
| Andrea Palmieri |
229:9981f62cdb1a | 113 | PRINTF("S UUID-%X attrs[%u %u]\r\n", uuid.getShortUUID(), startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 114 | |
| Andrea Palmieri |
229:9981f62cdb1a | 115 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 116 | |
| Andrea Palmieri |
229:9981f62cdb1a | 117 | PRINTF("UUID_TYPE_128\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 118 | uuid.setupLong(attribute_data_list+offset+4, UUID::LSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 119 | |
| Andrea Palmieri |
229:9981f62cdb1a | 120 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 121 | PRINTF("S UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 122 | const uint8_t *longUUIDBytes = uuid.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 123 | for (unsigned j = 0; j < UUID::LENGTH_OF_LONG_UUID; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 124 | PRINTF("%02x", longUUIDBytes[j]); |
| Andrea Palmieri |
229:9981f62cdb1a | 125 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 126 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 127 | PRINTF(" attrs[%u %u]\r\n", startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 128 | |
| Andrea Palmieri |
229:9981f62cdb1a | 129 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 130 | |
| Andrea Palmieri |
229:9981f62cdb1a | 131 | PRINTF("Setup serviceIndex = %d\n\r", _numServices); |
| Andrea Palmieri |
229:9981f62cdb1a | 132 | discoveredService[_numServices].setup(uuid, startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 133 | |
| Andrea Palmieri |
229:9981f62cdb1a | 134 | if(serviceDiscoveryCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 135 | if(_matchingServiceUUID == BLE_UUID_UNKNOWN || _matchingServiceUUID == discoveredService[_numServices].getUUID()) { |
| Andrea Palmieri |
229:9981f62cdb1a | 136 | serviceDiscoveryCallback(&discoveredService[_numServices]); |
| Andrea Palmieri |
229:9981f62cdb1a | 137 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 138 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 139 | _numServices++; |
| Andrea Palmieri |
229:9981f62cdb1a | 140 | |
| Andrea Palmieri |
229:9981f62cdb1a | 141 | offset += attribute_data_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 142 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 143 | |
| Andrea Palmieri |
229:9981f62cdb1a | 144 | PRINTF("!!!Service Discovery complete (numAttr=%u)!!!\n\r", numAttr); |
| Andrea Palmieri |
229:9981f62cdb1a | 145 | |
| Andrea Palmieri |
229:9981f62cdb1a | 146 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 147 | |
| Andrea Palmieri |
229:9981f62cdb1a | 148 | void BlueNRGGattClient::primaryServiceCB(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 149 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 150 | uint8_t *handles_info_list) |
| Andrea Palmieri |
229:9981f62cdb1a | 151 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 152 | GattAttribute::Handle_t startHandle, endHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 153 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 154 | uint8_t i, offset, numHandlePairs; |
| Andrea Palmieri |
229:9981f62cdb1a | 155 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 156 | (void)connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 157 | |
| Andrea Palmieri |
229:9981f62cdb1a | 158 | numHandlePairs = (event_data_length - 1) / 2; |
| Andrea Palmieri |
229:9981f62cdb1a | 159 | |
| Andrea Palmieri |
229:9981f62cdb1a | 160 | offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 161 | for (i=0; i<numHandlePairs; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 162 | startHandle = handles_info_list[offset]; |
| Andrea Palmieri |
229:9981f62cdb1a | 163 | endHandle = handles_info_list[offset+2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 164 | |
| Andrea Palmieri |
229:9981f62cdb1a | 165 | PRINTF("primaryServiceCB attrs[%u %u]\r\n", startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 166 | |
| Andrea Palmieri |
229:9981f62cdb1a | 167 | |
| Andrea Palmieri |
229:9981f62cdb1a | 168 | if (_matchingServiceUUID.shortOrLong() == UUID::UUID_TYPE_SHORT) { |
| Andrea Palmieri |
229:9981f62cdb1a | 169 | PRINTF("S UUID-%x attrs[%u %u]\r\n", _matchingServiceUUID.getShortUUID(), startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 170 | uuid = _matchingServiceUUID.getShortUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 171 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 172 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 173 | PRINTF("S UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 174 | const uint8_t *longUUIDBytes = _matchingServiceUUID.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 175 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 176 | PRINTF("%02x", longUUIDBytes[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 177 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 178 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 179 | PRINTF(" attrs[%u %u]\r\n", startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 180 | uuid.setupLong(_matchingServiceUUID.getBaseUUID(), UUID::MSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 181 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 182 | |
| Andrea Palmieri |
229:9981f62cdb1a | 183 | discoveredService[i].setup(uuid, startHandle, endHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 184 | |
| Andrea Palmieri |
229:9981f62cdb1a | 185 | if(serviceDiscoveryCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 186 | serviceDiscoveryCallback(&discoveredService[_numServices]); |
| Andrea Palmieri |
229:9981f62cdb1a | 187 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 188 | _numServices++; |
| Andrea Palmieri |
229:9981f62cdb1a | 189 | |
| Andrea Palmieri |
229:9981f62cdb1a | 190 | offset += 4; |
| Andrea Palmieri |
229:9981f62cdb1a | 191 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 192 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 193 | |
| Andrea Palmieri |
229:9981f62cdb1a | 194 | void BlueNRGGattClient::serviceCharsCB(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 195 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 196 | uint8_t handle_value_pair_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 197 | uint8_t *handle_value_pair) |
| Andrea Palmieri |
229:9981f62cdb1a | 198 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 199 | // Charac Handle (2), Charac Properties(1), Charac Value Handle(2), Charac UUID(2/16) |
| Andrea Palmieri |
229:9981f62cdb1a | 200 | |
| Andrea Palmieri |
229:9981f62cdb1a | 201 | GattAttribute::Handle_t declHandle, valueHandle, lastHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 202 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 203 | uint8_t i, numChar, offset; |
| Andrea Palmieri |
229:9981f62cdb1a | 204 | |
| Andrea Palmieri |
229:9981f62cdb1a | 205 | numChar = (event_data_length - 1) / handle_value_pair_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 206 | |
| Andrea Palmieri |
229:9981f62cdb1a | 207 | 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 | 208 | |
| Andrea Palmieri |
229:9981f62cdb1a | 209 | offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 210 | for (i=0; i<numChar; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 211 | // UUID Type |
| Andrea Palmieri |
229:9981f62cdb1a | 212 | if (handle_value_pair_length == 7) { |
| Andrea Palmieri |
229:9981f62cdb1a | 213 | PRINTF("Char UUID_TYPE_16\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 214 | uuid = handle_value_pair[offset+6]<<8|handle_value_pair[offset+5]; |
| Andrea Palmieri |
229:9981f62cdb1a | 215 | PRINTF("C UUID-%X\r\n", uuid.getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 216 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 217 | PRINTF("Char UUID_TYPE_128\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 218 | uuid.setupLong(handle_value_pair+offset+5, UUID::LSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 219 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 220 | PRINTF("C UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 221 | const uint8_t *longUUIDBytes = uuid.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 222 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 223 | PRINTF("%02X", longUUIDBytes[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 224 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 225 | PRINTF("\r\n"); |
| Andrea Palmieri |
229:9981f62cdb1a | 226 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 227 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 228 | |
| Andrea Palmieri |
229:9981f62cdb1a | 229 | // Properties |
| Andrea Palmieri |
229:9981f62cdb1a | 230 | DiscoveredCharacteristic::Properties_t p; |
| Andrea Palmieri |
229:9981f62cdb1a | 231 | |
| Andrea Palmieri |
229:9981f62cdb1a | 232 | p._broadcast = (props_mask[0] & handle_value_pair[offset+2]); |
| Andrea Palmieri |
229:9981f62cdb1a | 233 | p._read = (props_mask[1] & handle_value_pair[offset+2])>>1; |
| Andrea Palmieri |
229:9981f62cdb1a | 234 | p._writeWoResp = (props_mask[2] & handle_value_pair[offset+2])>>2; |
| Andrea Palmieri |
229:9981f62cdb1a | 235 | p._write = (props_mask[3] & handle_value_pair[offset+2])>>3; |
| Andrea Palmieri |
229:9981f62cdb1a | 236 | p._notify = (props_mask[4] & handle_value_pair[offset+2])>>4; |
| Andrea Palmieri |
229:9981f62cdb1a | 237 | p._indicate = (props_mask[5] & handle_value_pair[offset+2])>>5; |
| Andrea Palmieri |
229:9981f62cdb1a | 238 | p._authSignedWrite = (props_mask[6] & handle_value_pair[offset+2])>>6; |
| Andrea Palmieri |
229:9981f62cdb1a | 239 | PRINTF("p._broadcast=%d\n\r", p._broadcast); |
| Andrea Palmieri |
229:9981f62cdb1a | 240 | PRINTF("p._read=%d\n\r", p._read); |
| Andrea Palmieri |
229:9981f62cdb1a | 241 | PRINTF("p._writeWoResp=%d\n\r", p._writeWoResp); |
| Andrea Palmieri |
229:9981f62cdb1a | 242 | PRINTF("p._write=%d\n\r", p._write); |
| Andrea Palmieri |
229:9981f62cdb1a | 243 | PRINTF("p._notify=%d\n\r", p._notify); |
| Andrea Palmieri |
229:9981f62cdb1a | 244 | PRINTF("p._indicate=%d\n\r", p._indicate); |
| Andrea Palmieri |
229:9981f62cdb1a | 245 | PRINTF("p._authSignedWrite=%d\n\r", p._authSignedWrite); |
| Andrea Palmieri |
229:9981f62cdb1a | 246 | |
| Andrea Palmieri |
229:9981f62cdb1a | 247 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 248 | uint8_t props = handle_value_pair[offset+2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 249 | PRINTF("CHAR PROPS: %d\n\r", props); |
| Andrea Palmieri |
229:9981f62cdb1a | 250 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 251 | |
| Andrea Palmieri |
229:9981f62cdb1a | 252 | // Handles |
| Andrea Palmieri |
229:9981f62cdb1a | 253 | declHandle = handle_value_pair[offset]; |
| Andrea Palmieri |
229:9981f62cdb1a | 254 | valueHandle = handle_value_pair[offset+3]; |
| Andrea Palmieri |
229:9981f62cdb1a | 255 | lastHandle = valueHandle+1; |
| Andrea Palmieri |
229:9981f62cdb1a | 256 | PRINTF("declHandle: %u valueHandle=%u lastHandle=%u\n\r", declHandle, valueHandle, lastHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 257 | |
| Andrea Palmieri |
229:9981f62cdb1a | 258 | discoveredChar[_numChars].setup(this, |
| Andrea Palmieri |
229:9981f62cdb1a | 259 | connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 260 | uuid, |
| Andrea Palmieri |
229:9981f62cdb1a | 261 | p, |
| Andrea Palmieri |
229:9981f62cdb1a | 262 | declHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 263 | valueHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 264 | lastHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 265 | |
| Andrea Palmieri |
229:9981f62cdb1a | 266 | if(characteristicDiscoveryCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 267 | characteristicDiscoveryCallback(&discoveredChar[_numChars]); |
| Andrea Palmieri |
229:9981f62cdb1a | 268 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 269 | _numChars++; |
| Andrea Palmieri |
229:9981f62cdb1a | 270 | |
| Andrea Palmieri |
229:9981f62cdb1a | 271 | offset += handle_value_pair_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 272 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 273 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 274 | |
| Andrea Palmieri |
229:9981f62cdb1a | 275 | void BlueNRGGattClient::serviceCharByUUIDCB(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 276 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 277 | uint16_t attr_handle, |
| Andrea Palmieri |
229:9981f62cdb1a | 278 | uint8_t *attr_value) |
| Andrea Palmieri |
229:9981f62cdb1a | 279 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 280 | // Charac Properties(1), Charac Value Handle(2), Charac UUID(2/16) |
| Andrea Palmieri |
229:9981f62cdb1a | 281 | GattAttribute::Handle_t declHandle, valueHandle, lastHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 282 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 283 | |
| Andrea Palmieri |
229:9981f62cdb1a | 284 | PRINTF("serviceCharByUUIDCB\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 285 | |
| Andrea Palmieri |
229:9981f62cdb1a | 286 | // UUID Type |
| Andrea Palmieri |
229:9981f62cdb1a | 287 | if (event_data_length == 7) { |
| Andrea Palmieri |
229:9981f62cdb1a | 288 | PRINTF("Char UUID_TYPE_16\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 289 | uuid = attr_value[4]<<8|attr_value[3]; |
| Andrea Palmieri |
229:9981f62cdb1a | 290 | PRINTF("C UUID-%X\r\n", uuid.getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 291 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 292 | PRINTF("Char UUID_TYPE_128\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 293 | uuid.setupLong(attr_value+3, UUID::LSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 294 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 295 | PRINTF("C UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 296 | const uint8_t *longUUIDBytes = uuid.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 297 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 298 | PRINTF("%02X", longUUIDBytes[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 299 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 300 | PRINTF("\r\n"); |
| Andrea Palmieri |
229:9981f62cdb1a | 301 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 302 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 303 | |
| Andrea Palmieri |
229:9981f62cdb1a | 304 | // Properties |
| Andrea Palmieri |
229:9981f62cdb1a | 305 | DiscoveredCharacteristic::Properties_t p; |
| Andrea Palmieri |
229:9981f62cdb1a | 306 | |
| Andrea Palmieri |
229:9981f62cdb1a | 307 | p._broadcast = (props_mask[0] & attr_value[0]); |
| Andrea Palmieri |
229:9981f62cdb1a | 308 | p._read = (props_mask[1] & attr_value[0])>>1; |
| Andrea Palmieri |
229:9981f62cdb1a | 309 | p._writeWoResp = (props_mask[2] & attr_value[0])>>2; |
| Andrea Palmieri |
229:9981f62cdb1a | 310 | p._write = (props_mask[3] & attr_value[0])>>3; |
| Andrea Palmieri |
229:9981f62cdb1a | 311 | p._notify = (props_mask[4] & attr_value[0])>>4; |
| Andrea Palmieri |
229:9981f62cdb1a | 312 | p._indicate = (props_mask[5] & attr_value[0])>>5; |
| Andrea Palmieri |
229:9981f62cdb1a | 313 | p._authSignedWrite = (props_mask[6] & attr_value[0])>>6; |
| Andrea Palmieri |
229:9981f62cdb1a | 314 | PRINTF("p._broadcast=%d\n\r", p._broadcast); |
| Andrea Palmieri |
229:9981f62cdb1a | 315 | PRINTF("p._read=%d\n\r", p._read); |
| Andrea Palmieri |
229:9981f62cdb1a | 316 | PRINTF("p._writeWoResp=%d\n\r", p._writeWoResp); |
| Andrea Palmieri |
229:9981f62cdb1a | 317 | PRINTF("p._write=%d\n\r", p._write); |
| Andrea Palmieri |
229:9981f62cdb1a | 318 | PRINTF("p._notify=%d\n\r", p._notify); |
| Andrea Palmieri |
229:9981f62cdb1a | 319 | PRINTF("p._indicate=%d\n\r", p._indicate); |
| Andrea Palmieri |
229:9981f62cdb1a | 320 | PRINTF("p._authSignedWrite=%d\n\r", p._authSignedWrite); |
| Andrea Palmieri |
229:9981f62cdb1a | 321 | |
| Andrea Palmieri |
229:9981f62cdb1a | 322 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 323 | uint8_t props = attr_value[0]; |
| Andrea Palmieri |
229:9981f62cdb1a | 324 | PRINTF("CHAR PROPS: %d\n\r", props); |
| Andrea Palmieri |
229:9981f62cdb1a | 325 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 326 | |
| Andrea Palmieri |
229:9981f62cdb1a | 327 | // Handles |
| Andrea Palmieri |
229:9981f62cdb1a | 328 | declHandle = attr_handle; |
| Andrea Palmieri |
229:9981f62cdb1a | 329 | valueHandle = attr_value[1]; |
| Andrea Palmieri |
229:9981f62cdb1a | 330 | lastHandle = valueHandle+1; |
| Andrea Palmieri |
229:9981f62cdb1a | 331 | |
| Andrea Palmieri |
229:9981f62cdb1a | 332 | discoveredChar[_numChars].setup(this, |
| Andrea Palmieri |
229:9981f62cdb1a | 333 | connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 334 | uuid, |
| Andrea Palmieri |
229:9981f62cdb1a | 335 | p, |
| Andrea Palmieri |
229:9981f62cdb1a | 336 | declHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 337 | valueHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 338 | lastHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 339 | |
| Andrea Palmieri |
229:9981f62cdb1a | 340 | if(characteristicDiscoveryCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 341 | characteristicDiscoveryCallback(&discoveredChar[_numChars]); |
| Andrea Palmieri |
229:9981f62cdb1a | 342 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 343 | _numChars++; |
| Andrea Palmieri |
229:9981f62cdb1a | 344 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 345 | |
| Andrea Palmieri |
229:9981f62cdb1a | 346 | ble_error_t BlueNRGGattClient::findServiceChars(Gap::Handle_t connectionHandle) |
| Andrea Palmieri |
229:9981f62cdb1a | 347 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 348 | PRINTF("findServiceChars\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 349 | |
| Andrea Palmieri |
229:9981f62cdb1a | 350 | tBleStatus ret; |
| Andrea Palmieri |
229:9981f62cdb1a | 351 | uint8_t uuid_type = UUID_TYPE_16; |
| Andrea Palmieri |
229:9981f62cdb1a | 352 | uint8_t short_uuid[2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 353 | uint8_t *uuid = NULL; |
| Andrea Palmieri |
229:9981f62cdb1a | 354 | |
| Andrea Palmieri |
229:9981f62cdb1a | 355 | DiscoveredService *service; |
| Andrea Palmieri |
229:9981f62cdb1a | 356 | |
| Andrea Palmieri |
229:9981f62cdb1a | 357 | // We finished chars discovery for all services |
| Andrea Palmieri |
229:9981f62cdb1a | 358 | if(_servIndex >= _numServices) { |
| Andrea Palmieri |
229:9981f62cdb1a | 359 | PRINTF("!!!We finished chars discovery for all services!!!\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 360 | //_currentState = GATT_CHARS_DISCOVERY_COMPLETE; |
| Andrea Palmieri |
229:9981f62cdb1a | 361 | |
| Andrea Palmieri |
229:9981f62cdb1a | 362 | terminateServiceDiscovery(); |
| Andrea Palmieri |
229:9981f62cdb1a | 363 | |
| Andrea Palmieri |
229:9981f62cdb1a | 364 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 365 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 366 | |
| Andrea Palmieri |
229:9981f62cdb1a | 367 | service = &discoveredService[_servIndex]; |
| Andrea Palmieri |
229:9981f62cdb1a | 368 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 369 | if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) { |
| Andrea Palmieri |
229:9981f62cdb1a | 370 | PRINTF("S UUID-%X\r\n", service->getUUID().getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 371 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 372 | PRINTF("S UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 373 | const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 374 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 375 | PRINTF("%02X", longUUIDBytes[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 376 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 377 | PRINTF("\r\n"); |
| Andrea Palmieri |
229:9981f62cdb1a | 378 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 379 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 380 | |
| Andrea Palmieri |
229:9981f62cdb1a | 381 | PRINTF("findServiceChars (_servIndex=%d)\n\r", _servIndex); |
| Andrea Palmieri |
229:9981f62cdb1a | 382 | //ret = aci_gatt_disc_all_charac_of_serv(connectionHandle, service->getStartHandle(), service->getEndHandle()); |
| Andrea Palmieri |
229:9981f62cdb1a | 383 | |
| Andrea Palmieri |
229:9981f62cdb1a | 384 | if(_matchingCharacteristicUUIDIn == BLE_UUID_UNKNOWN) { |
| Andrea Palmieri |
229:9981f62cdb1a | 385 | PRINTF("findServiceChars (BLE_UUID_UNKNOWN)\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 386 | ret = aci_gatt_disc_all_charac_of_serv(connectionHandle, service->getStartHandle(), service->getEndHandle()); |
| Andrea Palmieri |
229:9981f62cdb1a | 387 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 388 | |
| Andrea Palmieri |
229:9981f62cdb1a | 389 | uint8_t type = _matchingCharacteristicUUIDIn.shortOrLong(); |
| Andrea Palmieri |
229:9981f62cdb1a | 390 | |
| Andrea Palmieri |
229:9981f62cdb1a | 391 | if(type == UUID::UUID_TYPE_SHORT) { |
| Andrea Palmieri |
229:9981f62cdb1a | 392 | STORE_LE_16(short_uuid, _matchingCharacteristicUUIDIn.getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 393 | |
| Andrea Palmieri |
229:9981f62cdb1a | 394 | uuid_type = UUID_TYPE_16; |
| Andrea Palmieri |
229:9981f62cdb1a | 395 | uuid = short_uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 396 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 397 | PRINTF("findServiceChars C UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 398 | for(unsigned i = 0; i < 2; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 399 | PRINTF("%02X", short_uuid[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 400 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 401 | PRINTF("\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 402 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 403 | } else if(type==UUID::UUID_TYPE_LONG) { |
| Andrea Palmieri |
229:9981f62cdb1a | 404 | |
| Andrea Palmieri |
229:9981f62cdb1a | 405 | uuid_type = UUID_TYPE_128; |
| Andrea Palmieri |
229:9981f62cdb1a | 406 | uuid = (unsigned char*)_matchingCharacteristicUUIDIn.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 407 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 408 | PRINTF("(findServiceChars) C UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 409 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 410 | PRINTF("%02X", uuid[i]); |
| Andrea Palmieri |
229:9981f62cdb1a | 411 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 412 | PRINTF("\r\n"); |
| Andrea Palmieri |
229:9981f62cdb1a | 413 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 414 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 415 | |
| Andrea Palmieri |
229:9981f62cdb1a | 416 | ret = aci_gatt_disc_charac_by_uuid(connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 417 | service->getStartHandle(), |
| Andrea Palmieri |
229:9981f62cdb1a | 418 | service->getEndHandle(), |
| Andrea Palmieri |
229:9981f62cdb1a | 419 | uuid_type, |
| Andrea Palmieri |
229:9981f62cdb1a | 420 | uuid); |
| Andrea Palmieri |
229:9981f62cdb1a | 421 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 422 | |
| Andrea Palmieri |
229:9981f62cdb1a | 423 | if(ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 424 | _servIndex++; |
| Andrea Palmieri |
229:9981f62cdb1a | 425 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 426 | |
| Andrea Palmieri |
229:9981f62cdb1a | 427 | PRINTF("findServiceChars ret=%d\n\r", ret); |
| Andrea Palmieri |
229:9981f62cdb1a | 428 | |
| Andrea Palmieri |
229:9981f62cdb1a | 429 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 430 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 431 | |
| Andrea Palmieri |
229:9981f62cdb1a | 432 | ble_error_t BlueNRGGattClient::launchServiceDiscovery(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 433 | ServiceDiscovery::ServiceCallback_t sc, |
| Andrea Palmieri |
229:9981f62cdb1a | 434 | ServiceDiscovery::CharacteristicCallback_t cc, |
| Andrea Palmieri |
229:9981f62cdb1a | 435 | const UUID &matchingServiceUUID, |
| Andrea Palmieri |
229:9981f62cdb1a | 436 | const UUID &matchingCharacteristicUUIDIn) |
| Andrea Palmieri |
229:9981f62cdb1a | 437 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 438 | PRINTF("launchServiceDiscovery\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 439 | |
| Andrea Palmieri |
229:9981f62cdb1a | 440 | tBleStatus ret; |
| Andrea Palmieri |
229:9981f62cdb1a | 441 | uint8_t uuid_type = UUID_TYPE_16; |
| Andrea Palmieri |
229:9981f62cdb1a | 442 | uint8_t short_uuid[2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 443 | uint8_t *uuid = NULL; |
| Andrea Palmieri |
229:9981f62cdb1a | 444 | unsigned j; |
| Andrea Palmieri |
229:9981f62cdb1a | 445 | |
| Andrea Palmieri |
229:9981f62cdb1a | 446 | if(isServiceDiscoveryActive()) { |
| Andrea Palmieri |
229:9981f62cdb1a | 447 | return BLE_ERROR_OPERATION_NOT_PERMITTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 448 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 449 | |
| Andrea Palmieri |
229:9981f62cdb1a | 450 | if(!sc && !cc) { |
| Andrea Palmieri |
229:9981f62cdb1a | 451 | // nothing to do |
| Andrea Palmieri |
229:9981f62cdb1a | 452 | PRINTF("launchServiceDiscovery: nothing to do\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 453 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 454 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 455 | |
| Andrea Palmieri |
229:9981f62cdb1a | 456 | _connectionHandle = connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 457 | serviceDiscoveryCallback = sc; |
| Andrea Palmieri |
229:9981f62cdb1a | 458 | characteristicDiscoveryCallback = cc; |
| Andrea Palmieri |
229:9981f62cdb1a | 459 | _matchingServiceUUID = matchingServiceUUID; |
| Andrea Palmieri |
229:9981f62cdb1a | 460 | _matchingCharacteristicUUIDIn = matchingCharacteristicUUIDIn; |
| Andrea Palmieri |
229:9981f62cdb1a | 461 | |
| Andrea Palmieri |
229:9981f62cdb1a | 462 | //reset services |
| Andrea Palmieri |
229:9981f62cdb1a | 463 | _numServices = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 464 | _numChars = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 465 | _servIndex = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 466 | for(j = 0; j < BLE_TOTAL_DISCOVERED_SERVICES; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 467 | discoveredService[j].setup(BLE_UUID_UNKNOWN, GattAttribute::INVALID_HANDLE, GattAttribute::INVALID_HANDLE); |
| Andrea Palmieri |
229:9981f62cdb1a | 468 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 469 | |
| Andrea Palmieri |
229:9981f62cdb1a | 470 | if(matchingServiceUUID == BLE_UUID_UNKNOWN) { |
| Andrea Palmieri |
229:9981f62cdb1a | 471 | |
| Andrea Palmieri |
229:9981f62cdb1a | 472 | // Wildcard: search for all services |
| Andrea Palmieri |
229:9981f62cdb1a | 473 | ret = aci_gatt_disc_all_prim_services((uint16_t)connectionHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 474 | |
| Andrea Palmieri |
229:9981f62cdb1a | 475 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 476 | |
| Andrea Palmieri |
229:9981f62cdb1a | 477 | uint8_t type = matchingServiceUUID.shortOrLong(); |
| Andrea Palmieri |
229:9981f62cdb1a | 478 | //PRINTF("AddService(): Type:%d\n\r", type); |
| Andrea Palmieri |
229:9981f62cdb1a | 479 | |
| Andrea Palmieri |
229:9981f62cdb1a | 480 | if(type == UUID::UUID_TYPE_SHORT) { |
| Andrea Palmieri |
229:9981f62cdb1a | 481 | STORE_LE_16(short_uuid, matchingServiceUUID.getShortUUID()); |
| Andrea Palmieri |
229:9981f62cdb1a | 482 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 483 | PRINTF("launchServiceDiscovery short_uuid=0x"); |
| Andrea Palmieri |
229:9981f62cdb1a | 484 | for(j = 0; j < 2; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 485 | PRINTF("%02X", short_uuid[j]); |
| Andrea Palmieri |
229:9981f62cdb1a | 486 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 487 | PRINTF("\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 488 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 489 | |
| Andrea Palmieri |
229:9981f62cdb1a | 490 | uuid_type = UUID_TYPE_16; |
| Andrea Palmieri |
229:9981f62cdb1a | 491 | uuid = short_uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 492 | |
| Andrea Palmieri |
229:9981f62cdb1a | 493 | } else if(type==UUID::UUID_TYPE_LONG) { |
| Andrea Palmieri |
229:9981f62cdb1a | 494 | |
| Andrea Palmieri |
229:9981f62cdb1a | 495 | uuid_type = UUID_TYPE_128; |
| Andrea Palmieri |
229:9981f62cdb1a | 496 | uuid = (unsigned char*)matchingServiceUUID.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 497 | |
| Andrea Palmieri |
229:9981f62cdb1a | 498 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 499 | PRINTF("launchServiceDiscovery base_uuid=0x"); |
| Andrea Palmieri |
229:9981f62cdb1a | 500 | for(j = 0; j < 16; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 501 | PRINTF("%02X", uuid[j]); |
| Andrea Palmieri |
229:9981f62cdb1a | 502 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 503 | PRINTF("\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 504 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 505 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 506 | |
| Andrea Palmieri |
229:9981f62cdb1a | 507 | // search for specific service by UUID |
| Andrea Palmieri |
229:9981f62cdb1a | 508 | ret = aci_gatt_disc_prim_service_by_uuid((uint16_t)connectionHandle, uuid_type, uuid); |
| Andrea Palmieri |
229:9981f62cdb1a | 509 | //ret = aci_gatt_disc_all_prim_services((uint16_t)connectionHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 510 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 511 | |
| Andrea Palmieri |
229:9981f62cdb1a | 512 | if(ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 513 | _currentState = GATT_SERVICE_DISCOVERY; |
| Andrea Palmieri |
229:9981f62cdb1a | 514 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 515 | |
| Andrea Palmieri |
229:9981f62cdb1a | 516 | PRINTF("launchServiceDiscovery ret=%d\n\r", ret); |
| Andrea Palmieri |
229:9981f62cdb1a | 517 | |
| Andrea Palmieri |
229:9981f62cdb1a | 518 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 519 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 520 | |
| Andrea Palmieri |
229:9981f62cdb1a | 521 | ble_error_t BlueNRGGattClient::discoverServices(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 522 | ServiceDiscovery::ServiceCallback_t callback, |
| Andrea Palmieri |
229:9981f62cdb1a | 523 | const UUID &matchingServiceUUID) |
| Andrea Palmieri |
229:9981f62cdb1a | 524 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 525 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 526 | (void)connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 527 | (void)callback; |
| Andrea Palmieri |
229:9981f62cdb1a | 528 | (void)matchingServiceUUID; |
| Andrea Palmieri |
229:9981f62cdb1a | 529 | |
| Andrea Palmieri |
229:9981f62cdb1a | 530 | return BLE_ERROR_NOT_IMPLEMENTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 531 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 532 | |
| Andrea Palmieri |
229:9981f62cdb1a | 533 | ble_error_t BlueNRGGattClient::discoverServices(Gap::Handle_t connectionHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 534 | ServiceDiscovery::ServiceCallback_t callback, |
| Andrea Palmieri |
229:9981f62cdb1a | 535 | GattAttribute::Handle_t startHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 536 | GattAttribute::Handle_t endHandle) |
| Andrea Palmieri |
229:9981f62cdb1a | 537 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 538 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 539 | (void)connectionHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 540 | (void)callback; |
| Andrea Palmieri |
229:9981f62cdb1a | 541 | (void)startHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 542 | (void)endHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 543 | |
| Andrea Palmieri |
229:9981f62cdb1a | 544 | return BLE_ERROR_NOT_IMPLEMENTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 545 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 546 | |
| Andrea Palmieri |
229:9981f62cdb1a | 547 | bool BlueNRGGattClient::isServiceDiscoveryActive(void) const |
| Andrea Palmieri |
229:9981f62cdb1a | 548 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 549 | if(_currentState == GATT_SERVICE_DISCOVERY) { |
| Andrea Palmieri |
229:9981f62cdb1a | 550 | return true; |
| Andrea Palmieri |
229:9981f62cdb1a | 551 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 552 | |
| Andrea Palmieri |
229:9981f62cdb1a | 553 | return false; |
| Andrea Palmieri |
229:9981f62cdb1a | 554 | /* |
| Andrea Palmieri |
229:9981f62cdb1a | 555 | if(_currentState == GATT_IDLE || |
| Andrea Palmieri |
229:9981f62cdb1a | 556 | _currentState == GATT_DISCOVERY_TERMINATED || |
| Andrea Palmieri |
229:9981f62cdb1a | 557 | _currentState == GATT_READ_CHAR || |
| Andrea Palmieri |
229:9981f62cdb1a | 558 | _currentState == GATT_WRITE_CHAR ) { |
| Andrea Palmieri |
229:9981f62cdb1a | 559 | return false; |
| Andrea Palmieri |
229:9981f62cdb1a | 560 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 561 | |
| Andrea Palmieri |
229:9981f62cdb1a | 562 | return true; |
| Andrea Palmieri |
229:9981f62cdb1a | 563 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 564 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 565 | |
| Andrea Palmieri |
229:9981f62cdb1a | 566 | void BlueNRGGattClient::terminateServiceDiscovery(void) |
| Andrea Palmieri |
229:9981f62cdb1a | 567 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 568 | _currentState = GATT_IDLE;//GATT_DISCOVERY_TERMINATED; |
| Andrea Palmieri |
229:9981f62cdb1a | 569 | |
| Andrea Palmieri |
229:9981f62cdb1a | 570 | if (terminationCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 571 | terminationCallback(_connectionHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 572 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 573 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 574 | |
| Andrea Palmieri |
229:9981f62cdb1a | 575 | void BlueNRGGattClient::charReadCB(Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 576 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 577 | uint8_t* attribute_value) |
| Andrea Palmieri |
229:9981f62cdb1a | 578 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 579 | readCBParams.connHandle = connHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 580 | readCBParams.offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 581 | readCBParams.len = event_data_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 582 | readCBParams.data = attribute_value; |
| Andrea Palmieri |
229:9981f62cdb1a | 583 | |
| Andrea Palmieri |
229:9981f62cdb1a | 584 | BlueNRGGattClient::getInstance().processReadResponse(&readCBParams); |
| Andrea Palmieri |
229:9981f62cdb1a | 585 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 586 | |
| Andrea Palmieri |
229:9981f62cdb1a | 587 | ble_error_t BlueNRGGattClient::read(Gap::Handle_t connHandle, GattAttribute::Handle_t attributeHandle, uint16_t offset) const |
| Andrea Palmieri |
229:9981f62cdb1a | 588 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 589 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 590 | (void)offset; |
| Andrea Palmieri |
229:9981f62cdb1a | 591 | |
| Andrea Palmieri |
229:9981f62cdb1a | 592 | tBleStatus ret; |
| Andrea Palmieri |
229:9981f62cdb1a | 593 | |
| Andrea Palmieri |
229:9981f62cdb1a | 594 | BlueNRGGattClient *gattc = const_cast<BlueNRGGattClient*>(this); |
| Andrea Palmieri |
229:9981f62cdb1a | 595 | |
| Andrea Palmieri |
229:9981f62cdb1a | 596 | // Save the attribute_handle not provided by evt_att_read_resp |
| Andrea Palmieri |
229:9981f62cdb1a | 597 | gattc->readCBParams.handle = attributeHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 598 | |
| Andrea Palmieri |
229:9981f62cdb1a | 599 | // FIXME: We need to wait for a while before starting a read |
| Andrea Palmieri |
229:9981f62cdb1a | 600 | // due to BlueNRG process queue handling |
| Andrea Palmieri |
229:9981f62cdb1a | 601 | Clock_Wait(100); |
| Andrea Palmieri |
229:9981f62cdb1a | 602 | |
| Andrea Palmieri |
229:9981f62cdb1a | 603 | ret = aci_gatt_read_charac_val(connHandle, attributeHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 604 | |
| Andrea Palmieri |
229:9981f62cdb1a | 605 | if(ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 606 | gattc->_currentState = GATT_READ_CHAR; |
| Andrea Palmieri |
229:9981f62cdb1a | 607 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 608 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 609 | switch (ret) { |
| Andrea Palmieri |
229:9981f62cdb1a | 610 | case BLE_STATUS_BUSY: |
| Andrea Palmieri |
229:9981f62cdb1a | 611 | return BLE_STACK_BUSY; |
| Andrea Palmieri |
229:9981f62cdb1a | 612 | default: |
| Andrea Palmieri |
229:9981f62cdb1a | 613 | return BLE_ERROR_INVALID_STATE; |
| Andrea Palmieri |
229:9981f62cdb1a | 614 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 615 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 616 | |
| Andrea Palmieri |
229:9981f62cdb1a | 617 | void BlueNRGGattClient::charWritePrepareCB(Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 618 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 619 | uint16_t attribute_handle, |
| Andrea Palmieri |
229:9981f62cdb1a | 620 | uint16_t offset, |
| Andrea Palmieri |
229:9981f62cdb1a | 621 | uint8_t *part_attr_value) |
| Andrea Palmieri |
229:9981f62cdb1a | 622 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 623 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 624 | (void)connHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 625 | |
| Andrea Palmieri |
229:9981f62cdb1a | 626 | // Update the write response params |
| Andrea Palmieri |
229:9981f62cdb1a | 627 | writeCBParams.handle = attribute_handle; |
| Andrea Palmieri |
229:9981f62cdb1a | 628 | writeCBParams.offset = offset; |
| Andrea Palmieri |
229:9981f62cdb1a | 629 | writeCBParams.len = event_data_length-4; //(?) |
| Andrea Palmieri |
229:9981f62cdb1a | 630 | writeCBParams.data = part_attr_value; |
| Andrea Palmieri |
229:9981f62cdb1a | 631 | |
| Andrea Palmieri |
229:9981f62cdb1a | 632 | BlueNRGGattClient::getInstance().processWriteResponse(&writeCBParams); |
| Andrea Palmieri |
229:9981f62cdb1a | 633 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 634 | |
| Andrea Palmieri |
229:9981f62cdb1a | 635 | void BlueNRGGattClient::charWriteExecCB(Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 636 | uint8_t event_data_length) |
| Andrea Palmieri |
229:9981f62cdb1a | 637 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 638 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 639 | (void)event_data_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 640 | |
| Andrea Palmieri |
229:9981f62cdb1a | 641 | writeCBParams.connHandle = connHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 642 | |
| Andrea Palmieri |
229:9981f62cdb1a | 643 | BlueNRGGattClient::getInstance().processWriteResponse(&writeCBParams); |
| Andrea Palmieri |
229:9981f62cdb1a | 644 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 645 | |
| Andrea Palmieri |
229:9981f62cdb1a | 646 | ble_error_t BlueNRGGattClient::write(GattClient::WriteOp_t cmd, |
| Andrea Palmieri |
229:9981f62cdb1a | 647 | Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 648 | GattAttribute::Handle_t attributeHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 649 | size_t length, |
| Andrea Palmieri |
229:9981f62cdb1a | 650 | const uint8_t *value) const |
| Andrea Palmieri |
229:9981f62cdb1a | 651 | { |
| Andrea Palmieri |
229:9981f62cdb1a | 652 | /* avoid compiler warnings about unused variables */ |
| Andrea Palmieri |
229:9981f62cdb1a | 653 | (void)cmd; |
| Andrea Palmieri |
229:9981f62cdb1a | 654 | |
| Andrea Palmieri |
229:9981f62cdb1a | 655 | tBleStatus ret; |
| Andrea Palmieri |
229:9981f62cdb1a | 656 | |
| Andrea Palmieri |
229:9981f62cdb1a | 657 | BlueNRGGattClient *gattc = const_cast<BlueNRGGattClient*>(this); |
| Andrea Palmieri |
229:9981f62cdb1a | 658 | |
| Andrea Palmieri |
229:9981f62cdb1a | 659 | // We save the write response params (used by the callback) because |
| Andrea Palmieri |
229:9981f62cdb1a | 660 | // when the aci_gatt_write_charac_value() is used the only event received is the EVT_BLUE_GATT_PROCEDURE_COMPLETE |
| Andrea Palmieri |
229:9981f62cdb1a | 661 | gattc->writeCBParams.connHandle = connHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 662 | gattc->writeCBParams.writeOp = GattWriteCallbackParams::OP_WRITE_CMD; |
| Andrea Palmieri |
229:9981f62cdb1a | 663 | gattc->writeCBParams.handle = attributeHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 664 | gattc->writeCBParams.offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 665 | gattc->writeCBParams.len = length; |
| Andrea Palmieri |
229:9981f62cdb1a | 666 | gattc->writeCBParams.data = value; |
| Andrea Palmieri |
229:9981f62cdb1a | 667 | |
| Andrea Palmieri |
229:9981f62cdb1a | 668 | ret = aci_gatt_write_charac_value(connHandle, attributeHandle, length, const_cast<uint8_t *>(value)); |
| Andrea Palmieri |
229:9981f62cdb1a | 669 | //ret = aci_gatt_write_charac_reliable(connHandle, attributeHandle, 0, length, const_cast<uint8_t *>(value)); |
| Andrea Palmieri |
229:9981f62cdb1a | 670 | |
| Andrea Palmieri |
229:9981f62cdb1a | 671 | if (ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 672 | gattc->_currentState = GATT_WRITE_CHAR; |
| Andrea Palmieri |
229:9981f62cdb1a | 673 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 674 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 675 | switch (ret) { |
| Andrea Palmieri |
229:9981f62cdb1a | 676 | case BLE_STATUS_BUSY: |
| Andrea Palmieri |
229:9981f62cdb1a | 677 | return BLE_STACK_BUSY; |
| Andrea Palmieri |
229:9981f62cdb1a | 678 | default: |
| Andrea Palmieri |
229:9981f62cdb1a | 679 | return BLE_ERROR_INVALID_STATE; |
| Andrea Palmieri |
229:9981f62cdb1a | 680 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 681 | |
| Andrea Palmieri |
229:9981f62cdb1a | 682 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 683 | |
| Andrea Palmieri |
229:9981f62cdb1a | 684 | void BlueNRGGattClient::discAllCharacDescCB(Gap::Handle_t connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 685 | uint8_t event_data_length, |
| Andrea Palmieri |
229:9981f62cdb1a | 686 | uint8_t format, |
| Andrea Palmieri |
229:9981f62cdb1a | 687 | uint8_t *handle_uuid_pair) { |
| Andrea Palmieri |
229:9981f62cdb1a | 688 | GattAttribute::Handle_t attHandle; |
| Andrea Palmieri |
229:9981f62cdb1a | 689 | UUID uuid; |
| Andrea Palmieri |
229:9981f62cdb1a | 690 | uint8_t i, numCharacDesc, offset, handle_uuid_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 691 | |
| Andrea Palmieri |
229:9981f62cdb1a | 692 | handle_uuid_length = 4; //Handle + UUID_16 |
| Andrea Palmieri |
229:9981f62cdb1a | 693 | if (format == 2) |
| Andrea Palmieri |
229:9981f62cdb1a | 694 | handle_uuid_length = 18; //Handle + UUID_128 |
| Andrea Palmieri |
229:9981f62cdb1a | 695 | |
| Andrea Palmieri |
229:9981f62cdb1a | 696 | numCharacDesc = (event_data_length - 1) / handle_uuid_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 697 | |
| Andrea Palmieri |
229:9981f62cdb1a | 698 | offset = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 699 | |
| Andrea Palmieri |
229:9981f62cdb1a | 700 | for (i=0; i<numCharacDesc; i++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 701 | attHandle = handle_uuid_pair[offset]; |
| Andrea Palmieri |
229:9981f62cdb1a | 702 | |
| Andrea Palmieri |
229:9981f62cdb1a | 703 | // UUID Type |
| Andrea Palmieri |
229:9981f62cdb1a | 704 | if (handle_uuid_length == 4) { |
| Andrea Palmieri |
229:9981f62cdb1a | 705 | |
| Andrea Palmieri |
229:9981f62cdb1a | 706 | PRINTF("UUID_TYPE_16\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 707 | uuid = handle_uuid_pair[offset+3]<<8|handle_uuid_pair[offset+2]; |
| Andrea Palmieri |
229:9981f62cdb1a | 708 | PRINTF("D UUID-%X attHandle=%u\r\n", uuid.getShortUUID(), attHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 709 | |
| Andrea Palmieri |
229:9981f62cdb1a | 710 | } else { |
| Andrea Palmieri |
229:9981f62cdb1a | 711 | |
| Andrea Palmieri |
229:9981f62cdb1a | 712 | PRINTF("UUID_TYPE_128\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 713 | uuid.setupLong(handle_uuid_pair+offset+2, UUID::LSB); |
| Andrea Palmieri |
229:9981f62cdb1a | 714 | #ifdef DEBUG |
| Andrea Palmieri |
229:9981f62cdb1a | 715 | PRINTF("D UUID-"); |
| Andrea Palmieri |
229:9981f62cdb1a | 716 | const uint8_t *longUUIDBytes = uuid.getBaseUUID(); |
| Andrea Palmieri |
229:9981f62cdb1a | 717 | for (unsigned j = 0; j < UUID::LENGTH_OF_LONG_UUID; j++) { |
| Andrea Palmieri |
229:9981f62cdb1a | 718 | PRINTF("%02x", longUUIDBytes[j]); |
| Andrea Palmieri |
229:9981f62cdb1a | 719 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 720 | #endif |
| Andrea Palmieri |
229:9981f62cdb1a | 721 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 722 | |
| Andrea Palmieri |
229:9981f62cdb1a | 723 | if(charDescDiscoveryCallback != NULL) { |
| Andrea Palmieri |
229:9981f62cdb1a | 724 | CharacteristicDescriptorDiscovery::DiscoveryCallbackParams_t params = { |
| Andrea Palmieri |
229:9981f62cdb1a | 725 | _characteristic, |
| Andrea Palmieri |
229:9981f62cdb1a | 726 | DiscoveredCharacteristicDescriptor( |
| Andrea Palmieri |
229:9981f62cdb1a | 727 | _characteristic.getGattClient(), |
| Andrea Palmieri |
229:9981f62cdb1a | 728 | connHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 729 | attHandle, |
| Andrea Palmieri |
229:9981f62cdb1a | 730 | uuid |
| Andrea Palmieri |
229:9981f62cdb1a | 731 | ) |
| Andrea Palmieri |
229:9981f62cdb1a | 732 | }; |
| Andrea Palmieri |
229:9981f62cdb1a | 733 | charDescDiscoveryCallback(¶ms); |
| Andrea Palmieri |
229:9981f62cdb1a | 734 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 735 | |
| Andrea Palmieri |
229:9981f62cdb1a | 736 | _numCharDesc++; |
| Andrea Palmieri |
229:9981f62cdb1a | 737 | |
| Andrea Palmieri |
229:9981f62cdb1a | 738 | offset += handle_uuid_length; |
| Andrea Palmieri |
229:9981f62cdb1a | 739 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 740 | |
| Andrea Palmieri |
229:9981f62cdb1a | 741 | if(charDescTerminationCallback != NULL) { |
| Andrea Palmieri |
229:9981f62cdb1a | 742 | CharacteristicDescriptorDiscovery::TerminationCallbackParams_t params = { |
| Andrea Palmieri |
229:9981f62cdb1a | 743 | _characteristic, |
| Andrea Palmieri |
229:9981f62cdb1a | 744 | BLE_ERROR_NONE |
| Andrea Palmieri |
229:9981f62cdb1a | 745 | }; |
| Andrea Palmieri |
229:9981f62cdb1a | 746 | charDescTerminationCallback(¶ms); |
| Andrea Palmieri |
229:9981f62cdb1a | 747 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 748 | |
| Andrea Palmieri |
229:9981f62cdb1a | 749 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 750 | |
| Andrea Palmieri |
229:9981f62cdb1a | 751 | ble_error_t BlueNRGGattClient::discoverCharacteristicDescriptors( |
| Andrea Palmieri |
229:9981f62cdb1a | 752 | const DiscoveredCharacteristic& characteristic, |
| Andrea Palmieri |
229:9981f62cdb1a | 753 | const CharacteristicDescriptorDiscovery::DiscoveryCallback_t& discoveryCallback, |
| Andrea Palmieri |
229:9981f62cdb1a | 754 | const CharacteristicDescriptorDiscovery::TerminationCallback_t& terminationCallback) { |
| Andrea Palmieri |
229:9981f62cdb1a | 755 | |
| Andrea Palmieri |
229:9981f62cdb1a | 756 | tBleStatus ret; |
| Andrea Palmieri |
229:9981f62cdb1a | 757 | |
| Andrea Palmieri |
229:9981f62cdb1a | 758 | if(_currentState != GATT_IDLE) { |
| Andrea Palmieri |
229:9981f62cdb1a | 759 | return BLE_ERROR_OPERATION_NOT_PERMITTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 760 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 761 | |
| Andrea Palmieri |
229:9981f62cdb1a | 762 | charDescDiscoveryCallback = discoveryCallback; |
| Andrea Palmieri |
229:9981f62cdb1a | 763 | charDescTerminationCallback = terminationCallback; |
| Andrea Palmieri |
229:9981f62cdb1a | 764 | |
| Andrea Palmieri |
229:9981f62cdb1a | 765 | Gap::Handle_t connHandle = characteristic.getConnectionHandle(); |
| Andrea Palmieri |
229:9981f62cdb1a | 766 | GattAttribute::Handle_t valueHandle = characteristic.getValueHandle(); |
| Andrea Palmieri |
229:9981f62cdb1a | 767 | GattAttribute::Handle_t lastHandle = characteristic.getLastHandle(); |
| Andrea Palmieri |
229:9981f62cdb1a | 768 | |
| Andrea Palmieri |
231:a0d2544b38cd | 769 | PRINTF("Starting aci_gatt_disc_all_charac_descriptors...\n\r"); |
| Andrea Palmieri |
229:9981f62cdb1a | 770 | ret = aci_gatt_disc_all_charac_descriptors(connHandle, valueHandle, lastHandle); |
| Andrea Palmieri |
229:9981f62cdb1a | 771 | |
| Andrea Palmieri |
229:9981f62cdb1a | 772 | if (ret == BLE_STATUS_SUCCESS) { |
| Andrea Palmieri |
229:9981f62cdb1a | 773 | _currentState = GATT_CHAR_DESC_DISCOVERY; |
| Andrea Palmieri |
229:9981f62cdb1a | 774 | _characteristic = characteristic; |
| Andrea Palmieri |
229:9981f62cdb1a | 775 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 776 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 777 | switch (ret) { |
| Andrea Palmieri |
229:9981f62cdb1a | 778 | case BLE_STATUS_INVALID_PARAMS: |
| Andrea Palmieri |
229:9981f62cdb1a | 779 | return BLE_ERROR_INVALID_PARAM; |
| Andrea Palmieri |
229:9981f62cdb1a | 780 | default: |
| Andrea Palmieri |
229:9981f62cdb1a | 781 | return BLE_ERROR_OPERATION_NOT_PERMITTED; |
| Andrea Palmieri |
229:9981f62cdb1a | 782 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 783 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 784 | |
| Andrea Palmieri |
229:9981f62cdb1a | 785 | /**************************************************************************/ |
| Andrea Palmieri |
229:9981f62cdb1a | 786 | /*! |
| Andrea Palmieri |
229:9981f62cdb1a | 787 | @brief Clear BlueNRGGattServer's state. |
| Andrea Palmieri |
229:9981f62cdb1a | 788 | |
| Andrea Palmieri |
229:9981f62cdb1a | 789 | @returns ble_error_t |
| Andrea Palmieri |
229:9981f62cdb1a | 790 | |
| Andrea Palmieri |
229:9981f62cdb1a | 791 | @retval BLE_ERROR_NONE |
| Andrea Palmieri |
229:9981f62cdb1a | 792 | Everything executed properly |
| Andrea Palmieri |
229:9981f62cdb1a | 793 | */ |
| Andrea Palmieri |
229:9981f62cdb1a | 794 | /**************************************************************************/ |
| Andrea Palmieri |
229:9981f62cdb1a | 795 | ble_error_t BlueNRGGattClient::reset(void) { |
| Andrea Palmieri |
229:9981f62cdb1a | 796 | /* Clear all state that is from the parent, including private members */ |
| Andrea Palmieri |
229:9981f62cdb1a | 797 | if (GattClient::reset() != BLE_ERROR_NONE) { |
| Andrea Palmieri |
229:9981f62cdb1a | 798 | return BLE_ERROR_INVALID_STATE; |
| Andrea Palmieri |
229:9981f62cdb1a | 799 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 800 | |
| Andrea Palmieri |
229:9981f62cdb1a | 801 | _currentState = GATT_IDLE; |
| Andrea Palmieri |
229:9981f62cdb1a | 802 | _matchingServiceUUID = BLE_UUID_UNKNOWN; |
| Andrea Palmieri |
229:9981f62cdb1a | 803 | _matchingCharacteristicUUIDIn = BLE_UUID_UNKNOWN; |
| Andrea Palmieri |
229:9981f62cdb1a | 804 | |
| Andrea Palmieri |
229:9981f62cdb1a | 805 | _numServices = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 806 | _servIndex = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 807 | _numChars = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 808 | _numCharDesc = 0; |
| Andrea Palmieri |
229:9981f62cdb1a | 809 | |
| Andrea Palmieri |
229:9981f62cdb1a | 810 | /* Clear class members */ |
| Andrea Palmieri |
229:9981f62cdb1a | 811 | memset(discoveredService, 0, sizeof(discoveredService)); |
| Andrea Palmieri |
229:9981f62cdb1a | 812 | memset(discoveredChar, 0, sizeof(discoveredChar)); |
| Andrea Palmieri |
229:9981f62cdb1a | 813 | |
| Andrea Palmieri |
229:9981f62cdb1a | 814 | return BLE_ERROR_NONE; |
| Andrea Palmieri |
229:9981f62cdb1a | 815 | } |
| Andrea Palmieri |
229:9981f62cdb1a | 816 |