1591423b2SMatthias Ringwald /* 2591423b2SMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 3591423b2SMatthias Ringwald * 4591423b2SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 5591423b2SMatthias Ringwald * modification, are permitted provided that the following conditions 6591423b2SMatthias Ringwald * are met: 7591423b2SMatthias Ringwald * 8591423b2SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 9591423b2SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 10591423b2SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 11591423b2SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 12591423b2SMatthias Ringwald * documentation and/or other materials provided with the distribution. 13591423b2SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 14591423b2SMatthias Ringwald * contributors may be used to endorse or promote products derived 15591423b2SMatthias Ringwald * from this software without specific prior written permission. 16591423b2SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 17591423b2SMatthias Ringwald * personal benefit and not for any commercial purpose or for 18591423b2SMatthias Ringwald * monetary gain. 19591423b2SMatthias Ringwald * 20591423b2SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21591423b2SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22591423b2SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23591423b2SMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 24591423b2SMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25591423b2SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26591423b2SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27591423b2SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28591423b2SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29591423b2SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30591423b2SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31591423b2SMatthias Ringwald * SUCH DAMAGE. 32591423b2SMatthias Ringwald * 33591423b2SMatthias Ringwald * Please inquire about commercial licensing options at 34591423b2SMatthias Ringwald * [email protected] 35591423b2SMatthias Ringwald * 36591423b2SMatthias Ringwald */ 37591423b2SMatthias Ringwald 38ab2c6ae4SMatthias Ringwald #define __BTSTACK_FILE__ "att_db.c" 39ab2c6ae4SMatthias Ringwald 40591423b2SMatthias Ringwald 41591423b2SMatthias Ringwald #include <stdio.h> 42591423b2SMatthias Ringwald #include <string.h> 43591423b2SMatthias Ringwald 44591423b2SMatthias Ringwald #include "ble/att_db.h" 4559c6af15SMatthias Ringwald #include "ble/core.h" 468ac574d6SMatthias Ringwald #include "bluetooth.h" 47591423b2SMatthias Ringwald #include "btstack_debug.h" 48591423b2SMatthias Ringwald #include "btstack_util.h" 49591423b2SMatthias Ringwald 509d622fdeSMatthias Ringwald typedef enum { 519d622fdeSMatthias Ringwald ATT_READ, 529d622fdeSMatthias Ringwald ATT_WRITE, 539d622fdeSMatthias Ringwald } att_operation_t; 549d622fdeSMatthias Ringwald 55591423b2SMatthias Ringwald // Buetooth Base UUID 00000000-0000-1000-8000-00805F9B34FB in little endian 56591423b2SMatthias Ringwald static const uint8_t bluetooth_base_uuid[] = { 0xfb, 0x34, 0x9b, 0x5f, 0x80, 0x00, 0x00, 0x80, 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; 57591423b2SMatthias Ringwald 58591423b2SMatthias Ringwald 59591423b2SMatthias Ringwald static int is_Bluetooth_Base_UUID(uint8_t const *uuid){ 60591423b2SMatthias Ringwald if (memcmp(&uuid[0], &bluetooth_base_uuid[0], 12)) return 0; 61591423b2SMatthias Ringwald if (memcmp(&uuid[14], &bluetooth_base_uuid[14], 2)) return 0; 62591423b2SMatthias Ringwald return 1; 63591423b2SMatthias Ringwald 64591423b2SMatthias Ringwald } 65591423b2SMatthias Ringwald 66591423b2SMatthias Ringwald static uint16_t uuid16_from_uuid(uint16_t uuid_len, uint8_t * uuid){ 67591423b2SMatthias Ringwald if (uuid_len == 2) return little_endian_read_16(uuid, 0); 68591423b2SMatthias Ringwald if (!is_Bluetooth_Base_UUID(uuid)) return 0; 69591423b2SMatthias Ringwald return little_endian_read_16(uuid, 12); 70591423b2SMatthias Ringwald } 71591423b2SMatthias Ringwald 72591423b2SMatthias Ringwald // ATT Database 738b1d64c6SMatthias Ringwald 74591423b2SMatthias Ringwald // new java-style iterator 75591423b2SMatthias Ringwald typedef struct att_iterator { 76591423b2SMatthias Ringwald // private 77591423b2SMatthias Ringwald uint8_t const * att_ptr; 78591423b2SMatthias Ringwald // public 79591423b2SMatthias Ringwald uint16_t size; 80591423b2SMatthias Ringwald uint16_t flags; 81591423b2SMatthias Ringwald uint16_t handle; 82591423b2SMatthias Ringwald uint8_t const * uuid; 83591423b2SMatthias Ringwald uint16_t value_len; 84591423b2SMatthias Ringwald uint8_t const * value; 85591423b2SMatthias Ringwald } att_iterator_t; 86591423b2SMatthias Ringwald 87fd75a1c5SMatthias Ringwald static void att_persistent_ccc_cache(att_iterator_t * it); 8851e0c94cSMatthias Ringwald 8951e0c94cSMatthias Ringwald static uint8_t const * att_db = NULL; 9051e0c94cSMatthias Ringwald static att_read_callback_t att_read_callback = NULL; 9151e0c94cSMatthias Ringwald static att_write_callback_t att_write_callback = NULL; 9251e0c94cSMatthias Ringwald static uint8_t att_prepare_write_error_code = 0; 9351e0c94cSMatthias Ringwald static uint16_t att_prepare_write_error_handle = 0x0000; 9451e0c94cSMatthias Ringwald 9551e0c94cSMatthias Ringwald // single cache for att_is_persistent_ccc - stores flags before write callback 9651e0c94cSMatthias Ringwald static uint16_t att_persistent_ccc_handle; 97fd75a1c5SMatthias Ringwald static uint16_t att_persistent_ccc_uuid16; 9851e0c94cSMatthias Ringwald 99591423b2SMatthias Ringwald static void att_iterator_init(att_iterator_t *it){ 100591423b2SMatthias Ringwald it->att_ptr = att_db; 101591423b2SMatthias Ringwald } 102591423b2SMatthias Ringwald 103591423b2SMatthias Ringwald static int att_iterator_has_next(att_iterator_t *it){ 104591423b2SMatthias Ringwald return it->att_ptr != NULL; 105591423b2SMatthias Ringwald } 106591423b2SMatthias Ringwald 107591423b2SMatthias Ringwald static void att_iterator_fetch_next(att_iterator_t *it){ 108591423b2SMatthias Ringwald it->size = little_endian_read_16(it->att_ptr, 0); 109591423b2SMatthias Ringwald if (it->size == 0){ 110591423b2SMatthias Ringwald it->flags = 0; 111591423b2SMatthias Ringwald it->handle = 0; 112591423b2SMatthias Ringwald it->uuid = NULL; 113591423b2SMatthias Ringwald it->value_len = 0; 114591423b2SMatthias Ringwald it->value = NULL; 115591423b2SMatthias Ringwald it->att_ptr = NULL; 116591423b2SMatthias Ringwald return; 117591423b2SMatthias Ringwald } 118591423b2SMatthias Ringwald it->flags = little_endian_read_16(it->att_ptr, 2); 119591423b2SMatthias Ringwald it->handle = little_endian_read_16(it->att_ptr, 4); 120591423b2SMatthias Ringwald it->uuid = &it->att_ptr[6]; 121591423b2SMatthias Ringwald // handle 128 bit UUIDs 122591423b2SMatthias Ringwald if (it->flags & ATT_PROPERTY_UUID128){ 123591423b2SMatthias Ringwald it->value_len = it->size - 22; 124591423b2SMatthias Ringwald it->value = &it->att_ptr[22]; 125591423b2SMatthias Ringwald } else { 126591423b2SMatthias Ringwald it->value_len = it->size - 8; 127591423b2SMatthias Ringwald it->value = &it->att_ptr[8]; 128591423b2SMatthias Ringwald } 129591423b2SMatthias Ringwald // advance AFTER setting values 130591423b2SMatthias Ringwald it->att_ptr += it->size; 131591423b2SMatthias Ringwald } 132591423b2SMatthias Ringwald 133591423b2SMatthias Ringwald static int att_iterator_match_uuid16(att_iterator_t *it, uint16_t uuid){ 134591423b2SMatthias Ringwald if (it->handle == 0) return 0; 135591423b2SMatthias Ringwald if (it->flags & ATT_PROPERTY_UUID128){ 136591423b2SMatthias Ringwald if (!is_Bluetooth_Base_UUID(it->uuid)) return 0; 137591423b2SMatthias Ringwald return little_endian_read_16(it->uuid, 12) == uuid; 138591423b2SMatthias Ringwald } 139591423b2SMatthias Ringwald return little_endian_read_16(it->uuid, 0) == uuid; 140591423b2SMatthias Ringwald } 141591423b2SMatthias Ringwald 142591423b2SMatthias Ringwald static int att_iterator_match_uuid(att_iterator_t *it, uint8_t *uuid, uint16_t uuid_len){ 143591423b2SMatthias Ringwald if (it->handle == 0) return 0; 144591423b2SMatthias Ringwald // input: UUID16 145591423b2SMatthias Ringwald if (uuid_len == 2) { 146591423b2SMatthias Ringwald return att_iterator_match_uuid16(it, little_endian_read_16(uuid, 0)); 147591423b2SMatthias Ringwald } 148591423b2SMatthias Ringwald // input and db: UUID128 149591423b2SMatthias Ringwald if (it->flags & ATT_PROPERTY_UUID128){ 150591423b2SMatthias Ringwald return memcmp(it->uuid, uuid, 16) == 0; 151591423b2SMatthias Ringwald } 152591423b2SMatthias Ringwald // input: UUID128, db: UUID16 153591423b2SMatthias Ringwald if (!is_Bluetooth_Base_UUID(uuid)) return 0; 154591423b2SMatthias Ringwald return little_endian_read_16(uuid, 12) == little_endian_read_16(it->uuid, 0); 155591423b2SMatthias Ringwald } 156591423b2SMatthias Ringwald 157591423b2SMatthias Ringwald 158591423b2SMatthias Ringwald static int att_find_handle(att_iterator_t *it, uint16_t handle){ 159591423b2SMatthias Ringwald if (handle == 0) return 0; 160591423b2SMatthias Ringwald att_iterator_init(it); 161591423b2SMatthias Ringwald while (att_iterator_has_next(it)){ 162591423b2SMatthias Ringwald att_iterator_fetch_next(it); 163591423b2SMatthias Ringwald if (it->handle != handle) continue; 164591423b2SMatthias Ringwald return 1; 165591423b2SMatthias Ringwald } 166591423b2SMatthias Ringwald return 0; 167591423b2SMatthias Ringwald } 168591423b2SMatthias Ringwald 169591423b2SMatthias Ringwald // experimental client API 170fc64f94aSMatthias Ringwald uint16_t att_uuid_for_handle(uint16_t attribute_handle){ 171591423b2SMatthias Ringwald att_iterator_t it; 172fc64f94aSMatthias Ringwald int ok = att_find_handle(&it, attribute_handle); 173591423b2SMatthias Ringwald if (!ok) return 0; 174591423b2SMatthias Ringwald if (it.flags & ATT_PROPERTY_UUID128) return 0; 175591423b2SMatthias Ringwald return little_endian_read_16(it.uuid, 0); 176591423b2SMatthias Ringwald } 177591423b2SMatthias Ringwald // end of client API 178591423b2SMatthias Ringwald 179711e6c80SMatthias Ringwald static void att_update_value_len(att_iterator_t *it, hci_con_handle_t con_handle){ 1808ac574d6SMatthias Ringwald if ((it->flags & ATT_PROPERTY_DYNAMIC) == 0) return; 1813d71c7a4SMatthias Ringwald it->value_len = (*att_read_callback)(con_handle, it->handle, 0, NULL, 0); 182591423b2SMatthias Ringwald return; 183591423b2SMatthias Ringwald } 184591423b2SMatthias Ringwald 185591423b2SMatthias Ringwald // copy attribute value from offset into buffer with given size 186711e6c80SMatthias Ringwald static int att_copy_value(att_iterator_t *it, uint16_t offset, uint8_t * buffer, uint16_t buffer_size, hci_con_handle_t con_handle){ 187591423b2SMatthias Ringwald 188591423b2SMatthias Ringwald // DYNAMIC 1898ac574d6SMatthias Ringwald if (it->flags & ATT_PROPERTY_DYNAMIC){ 1903d71c7a4SMatthias Ringwald return (*att_read_callback)(con_handle, it->handle, offset, buffer, buffer_size); 191591423b2SMatthias Ringwald } 192591423b2SMatthias Ringwald 193591423b2SMatthias Ringwald // STATIC 194591423b2SMatthias Ringwald uint16_t bytes_to_copy = it->value_len - offset; 195591423b2SMatthias Ringwald if (bytes_to_copy > buffer_size){ 196591423b2SMatthias Ringwald bytes_to_copy = buffer_size; 197591423b2SMatthias Ringwald } 198591423b2SMatthias Ringwald memcpy(buffer, it->value, bytes_to_copy); 199591423b2SMatthias Ringwald return bytes_to_copy; 200591423b2SMatthias Ringwald } 201591423b2SMatthias Ringwald 202591423b2SMatthias Ringwald void att_set_db(uint8_t const * db){ 203591423b2SMatthias Ringwald att_db = db; 204591423b2SMatthias Ringwald } 205591423b2SMatthias Ringwald 206591423b2SMatthias Ringwald void att_set_read_callback(att_read_callback_t callback){ 207591423b2SMatthias Ringwald att_read_callback = callback; 208591423b2SMatthias Ringwald } 209591423b2SMatthias Ringwald 210591423b2SMatthias Ringwald void att_set_write_callback(att_write_callback_t callback){ 211591423b2SMatthias Ringwald att_write_callback = callback; 212591423b2SMatthias Ringwald } 213591423b2SMatthias Ringwald 214591423b2SMatthias Ringwald void att_dump_attributes(void){ 215591423b2SMatthias Ringwald att_iterator_t it; 216591423b2SMatthias Ringwald att_iterator_init(&it); 217591423b2SMatthias Ringwald uint8_t uuid128[16]; 218591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 219591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 220591423b2SMatthias Ringwald if (it.handle == 0) { 221591423b2SMatthias Ringwald log_info("Handle: END"); 222591423b2SMatthias Ringwald return; 223591423b2SMatthias Ringwald } 224591423b2SMatthias Ringwald log_info("Handle: 0x%04x, flags: 0x%04x, uuid: ", it.handle, it.flags); 225591423b2SMatthias Ringwald if (it.flags & ATT_PROPERTY_UUID128){ 226591423b2SMatthias Ringwald reverse_128(it.uuid, uuid128); 227591423b2SMatthias Ringwald log_info("%s", uuid128_to_str(uuid128)); 228591423b2SMatthias Ringwald } else { 229591423b2SMatthias Ringwald log_info("%04x", little_endian_read_16(it.uuid, 0)); 230591423b2SMatthias Ringwald } 231591423b2SMatthias Ringwald log_info(", value_len: %u, value: ", it.value_len); 232591423b2SMatthias Ringwald log_info_hexdump(it.value, it.value_len); 233591423b2SMatthias Ringwald } 234591423b2SMatthias Ringwald } 235591423b2SMatthias Ringwald 236591423b2SMatthias Ringwald static void att_prepare_write_reset(void){ 237591423b2SMatthias Ringwald att_prepare_write_error_code = 0; 238591423b2SMatthias Ringwald att_prepare_write_error_handle = 0x0000; 239591423b2SMatthias Ringwald } 240591423b2SMatthias Ringwald 241591423b2SMatthias Ringwald static void att_prepare_write_update_errors(uint8_t error_code, uint16_t handle){ 242591423b2SMatthias Ringwald // first ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH has highest priority 243591423b2SMatthias Ringwald if (error_code == ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH && error_code != att_prepare_write_error_code){ 244591423b2SMatthias Ringwald att_prepare_write_error_code = error_code; 245591423b2SMatthias Ringwald att_prepare_write_error_handle = handle; 246591423b2SMatthias Ringwald return; 247591423b2SMatthias Ringwald } 248591423b2SMatthias Ringwald // first ATT_ERROR_INVALID_OFFSET is next 249591423b2SMatthias Ringwald if (error_code == ATT_ERROR_INVALID_OFFSET && att_prepare_write_error_code == 0){ 250591423b2SMatthias Ringwald att_prepare_write_error_code = error_code; 251591423b2SMatthias Ringwald att_prepare_write_error_handle = handle; 252591423b2SMatthias Ringwald return; 253591423b2SMatthias Ringwald } 254591423b2SMatthias Ringwald } 255591423b2SMatthias Ringwald 256591423b2SMatthias Ringwald static uint16_t setup_error(uint8_t * response_buffer, uint16_t request, uint16_t handle, uint8_t error_code){ 257591423b2SMatthias Ringwald response_buffer[0] = ATT_ERROR_RESPONSE; 258591423b2SMatthias Ringwald response_buffer[1] = request; 259591423b2SMatthias Ringwald little_endian_store_16(response_buffer, 2, handle); 260591423b2SMatthias Ringwald response_buffer[4] = error_code; 261591423b2SMatthias Ringwald return 5; 262591423b2SMatthias Ringwald } 263591423b2SMatthias Ringwald 264591423b2SMatthias Ringwald static inline uint16_t setup_error_read_not_permitted(uint8_t * response_buffer, uint16_t request, uint16_t start_handle){ 265591423b2SMatthias Ringwald return setup_error(response_buffer, request, start_handle, ATT_ERROR_READ_NOT_PERMITTED); 266591423b2SMatthias Ringwald } 267591423b2SMatthias Ringwald 268591423b2SMatthias Ringwald static inline uint16_t setup_error_write_not_permitted(uint8_t * response_buffer, uint16_t request, uint16_t start_handle){ 269591423b2SMatthias Ringwald return setup_error(response_buffer, request, start_handle, ATT_ERROR_WRITE_NOT_PERMITTED); 270591423b2SMatthias Ringwald } 271591423b2SMatthias Ringwald 272591423b2SMatthias Ringwald static inline uint16_t setup_error_atribute_not_found(uint8_t * response_buffer, uint16_t request, uint16_t start_handle){ 273591423b2SMatthias Ringwald return setup_error(response_buffer, request, start_handle, ATT_ERROR_ATTRIBUTE_NOT_FOUND); 274591423b2SMatthias Ringwald } 275591423b2SMatthias Ringwald 276591423b2SMatthias Ringwald static inline uint16_t setup_error_invalid_handle(uint8_t * response_buffer, uint16_t request, uint16_t handle){ 277591423b2SMatthias Ringwald return setup_error(response_buffer, request, handle, ATT_ERROR_INVALID_HANDLE); 278591423b2SMatthias Ringwald } 279591423b2SMatthias Ringwald 280591423b2SMatthias Ringwald static inline uint16_t setup_error_invalid_offset(uint8_t * response_buffer, uint16_t request, uint16_t handle){ 281591423b2SMatthias Ringwald return setup_error(response_buffer, request, handle, ATT_ERROR_INVALID_OFFSET); 282591423b2SMatthias Ringwald } 283591423b2SMatthias Ringwald 2849d622fdeSMatthias Ringwald static uint8_t att_validate_security(att_connection_t * att_connection, att_operation_t operation, att_iterator_t * it){ 285*1dd680d7SMatthias Ringwald int required_security_level = 0; 286*1dd680d7SMatthias Ringwald switch (operation){ 287*1dd680d7SMatthias Ringwald case ATT_READ: 288*1dd680d7SMatthias Ringwald if (it->flags & ATT_PROPERTY_READ_PERMISSION_BIT_0) { 289*1dd680d7SMatthias Ringwald required_security_level |= 1; 290*1dd680d7SMatthias Ringwald } 291*1dd680d7SMatthias Ringwald if (it->flags & ATT_PROPERTY_READ_PERMISSION_BIT_1) { 292*1dd680d7SMatthias Ringwald required_security_level |= 2; 293*1dd680d7SMatthias Ringwald } 294*1dd680d7SMatthias Ringwald break; 295*1dd680d7SMatthias Ringwald case ATT_WRITE: 296*1dd680d7SMatthias Ringwald if (it->flags & ATT_PROPERTY_WRITE_PERMISSION_BIT_0) { 297*1dd680d7SMatthias Ringwald required_security_level |= 1; 298*1dd680d7SMatthias Ringwald } 299*1dd680d7SMatthias Ringwald if (it->flags & ATT_PROPERTY_WRITE_PERMISSION_BIT_1) { 300*1dd680d7SMatthias Ringwald required_security_level |= 2; 301*1dd680d7SMatthias Ringwald } 302*1dd680d7SMatthias Ringwald break; 303*1dd680d7SMatthias Ringwald } 304*1dd680d7SMatthias Ringwald 305591423b2SMatthias Ringwald int required_encryption_size = it->flags >> 12; 306591423b2SMatthias Ringwald if (required_encryption_size) required_encryption_size++; // store -1 to fit into 4 bit 307*1dd680d7SMatthias Ringwald 308*1dd680d7SMatthias Ringwald log_debug("att_validate_security. flags 0x%04x - req enc size %u, req security level %u, authorized %u, authenticated %u, encryption_key_size %u", 309*1dd680d7SMatthias Ringwald it->flags, required_encryption_size, required_security_level, att_connection->authorized, att_connection->authenticated, att_connection->encryption_key_size); 310*1dd680d7SMatthias Ringwald 311*1dd680d7SMatthias Ringwald if ((required_security_level >= ATT_SECURITY_AUTHORIZED) && (att_connection->authorized == 0)) { 312591423b2SMatthias Ringwald return ATT_ERROR_INSUFFICIENT_AUTHORIZATION; 313591423b2SMatthias Ringwald } 314*1dd680d7SMatthias Ringwald if ((required_security_level >= ATT_SECURITY_AUTHENTICATED) && (att_connection->authenticated == 0)) { 315*1dd680d7SMatthias Ringwald return ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 316*1dd680d7SMatthias Ringwald } 317*1dd680d7SMatthias Ringwald if (required_security_level >= ATT_SECURITY_ENCRYPTED) { 318*1dd680d7SMatthias Ringwald if ((required_encryption_size > 0) && (att_connection->encryption_key_size == 0)){ 319591423b2SMatthias Ringwald return ATT_ERROR_INSUFFICIENT_ENCRYPTION; 320591423b2SMatthias Ringwald } 321591423b2SMatthias Ringwald if (required_encryption_size > att_connection->encryption_key_size){ 322591423b2SMatthias Ringwald return ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE; 323591423b2SMatthias Ringwald } 324*1dd680d7SMatthias Ringwald } 325591423b2SMatthias Ringwald return 0; 326591423b2SMatthias Ringwald } 327591423b2SMatthias Ringwald 328591423b2SMatthias Ringwald // 329591423b2SMatthias Ringwald // MARK: ATT_EXCHANGE_MTU_REQUEST 330591423b2SMatthias Ringwald // 331591423b2SMatthias Ringwald static uint16_t handle_exchange_mtu_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 332591423b2SMatthias Ringwald uint8_t * response_buffer){ 333591423b2SMatthias Ringwald 3349ec2630cSMatthias Ringwald UNUSED(request_len); 3359ec2630cSMatthias Ringwald 336591423b2SMatthias Ringwald uint16_t client_rx_mtu = little_endian_read_16(request_buffer, 1); 337591423b2SMatthias Ringwald 338591423b2SMatthias Ringwald // find min(local max mtu, remote mtu) and use as mtu for this connection 339591423b2SMatthias Ringwald if (client_rx_mtu < att_connection->max_mtu){ 340591423b2SMatthias Ringwald att_connection->mtu = client_rx_mtu; 341591423b2SMatthias Ringwald } else { 342591423b2SMatthias Ringwald att_connection->mtu = att_connection->max_mtu; 343591423b2SMatthias Ringwald } 344591423b2SMatthias Ringwald 345591423b2SMatthias Ringwald response_buffer[0] = ATT_EXCHANGE_MTU_RESPONSE; 346591423b2SMatthias Ringwald little_endian_store_16(response_buffer, 1, att_connection->mtu); 347591423b2SMatthias Ringwald return 3; 348591423b2SMatthias Ringwald } 349591423b2SMatthias Ringwald 350591423b2SMatthias Ringwald 351591423b2SMatthias Ringwald // 352591423b2SMatthias Ringwald // MARK: ATT_FIND_INFORMATION_REQUEST 353591423b2SMatthias Ringwald // 354591423b2SMatthias Ringwald // TODO: handle other types then GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID 355591423b2SMatthias Ringwald // 356591423b2SMatthias Ringwald static uint16_t handle_find_information_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, 357591423b2SMatthias Ringwald uint16_t start_handle, uint16_t end_handle){ 358591423b2SMatthias Ringwald 3599ec2630cSMatthias Ringwald UNUSED(att_connection); 3609ec2630cSMatthias Ringwald 361591423b2SMatthias Ringwald log_info("ATT_FIND_INFORMATION_REQUEST: from %04X to %04X", start_handle, end_handle); 362591423b2SMatthias Ringwald uint8_t request_type = ATT_FIND_INFORMATION_REQUEST; 363591423b2SMatthias Ringwald 364591423b2SMatthias Ringwald if (start_handle > end_handle || start_handle == 0){ 365591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, start_handle); 366591423b2SMatthias Ringwald } 367591423b2SMatthias Ringwald 368591423b2SMatthias Ringwald uint16_t offset = 1; 369591423b2SMatthias Ringwald uint16_t uuid_len = 0; 370591423b2SMatthias Ringwald 371591423b2SMatthias Ringwald att_iterator_t it; 372591423b2SMatthias Ringwald att_iterator_init(&it); 373591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 374591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 375591423b2SMatthias Ringwald if (!it.handle) break; 376591423b2SMatthias Ringwald if (it.handle > end_handle) break; 377591423b2SMatthias Ringwald if (it.handle < start_handle) continue; 378591423b2SMatthias Ringwald 379591423b2SMatthias Ringwald // log_info("Handle 0x%04x", it.handle); 380591423b2SMatthias Ringwald 381591423b2SMatthias Ringwald uint16_t this_uuid_len = (it.flags & ATT_PROPERTY_UUID128) ? 16 : 2; 382591423b2SMatthias Ringwald 383591423b2SMatthias Ringwald // check if value has same len as last one if not first result 384591423b2SMatthias Ringwald if (offset > 1){ 385591423b2SMatthias Ringwald if (this_uuid_len != uuid_len) { 386591423b2SMatthias Ringwald break; 387591423b2SMatthias Ringwald } 388591423b2SMatthias Ringwald } 389591423b2SMatthias Ringwald 390591423b2SMatthias Ringwald // first 391591423b2SMatthias Ringwald if (offset == 1) { 392591423b2SMatthias Ringwald uuid_len = this_uuid_len; 393591423b2SMatthias Ringwald // set format field 394591423b2SMatthias Ringwald response_buffer[offset] = (it.flags & ATT_PROPERTY_UUID128) ? 0x02 : 0x01; 395591423b2SMatthias Ringwald offset++; 396591423b2SMatthias Ringwald } 397591423b2SMatthias Ringwald 398591423b2SMatthias Ringwald // space? 399591423b2SMatthias Ringwald if (offset + 2 + uuid_len > response_buffer_size) break; 400591423b2SMatthias Ringwald 401591423b2SMatthias Ringwald // store 402591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, it.handle); 403591423b2SMatthias Ringwald offset += 2; 404591423b2SMatthias Ringwald 405591423b2SMatthias Ringwald memcpy(response_buffer + offset, it.uuid, uuid_len); 406591423b2SMatthias Ringwald offset += uuid_len; 407591423b2SMatthias Ringwald } 408591423b2SMatthias Ringwald 409591423b2SMatthias Ringwald if (offset == 1){ 410591423b2SMatthias Ringwald return setup_error_atribute_not_found(response_buffer, request_type, start_handle); 411591423b2SMatthias Ringwald } 412591423b2SMatthias Ringwald 413591423b2SMatthias Ringwald response_buffer[0] = ATT_FIND_INFORMATION_REPLY; 414591423b2SMatthias Ringwald return offset; 415591423b2SMatthias Ringwald } 416591423b2SMatthias Ringwald 417591423b2SMatthias Ringwald static uint16_t handle_find_information_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 418591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 4199ec2630cSMatthias Ringwald UNUSED(request_len); 420591423b2SMatthias Ringwald return handle_find_information_request2(att_connection, response_buffer, response_buffer_size, little_endian_read_16(request_buffer, 1), little_endian_read_16(request_buffer, 3)); 421591423b2SMatthias Ringwald } 422591423b2SMatthias Ringwald 423591423b2SMatthias Ringwald // 424591423b2SMatthias Ringwald // MARK: ATT_FIND_BY_TYPE_VALUE 425591423b2SMatthias Ringwald // 426591423b2SMatthias Ringwald // "Only attributes with attribute handles between and including the Starting Handle parameter 427591423b2SMatthias Ringwald // and the Ending Handle parameter that match the requested attri- bute type and the attribute 428591423b2SMatthias Ringwald // value that have sufficient permissions to allow reading will be returned" -> (1) 429591423b2SMatthias Ringwald // 430591423b2SMatthias Ringwald // TODO: handle other types then GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID 431591423b2SMatthias Ringwald // 432591423b2SMatthias Ringwald // NOTE: doesn't handle DYNAMIC values 433591423b2SMatthias Ringwald // NOTE: only supports 16 bit UUIDs 434591423b2SMatthias Ringwald // 435591423b2SMatthias Ringwald static uint16_t handle_find_by_type_value_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, 436591423b2SMatthias Ringwald uint16_t start_handle, uint16_t end_handle, 437591423b2SMatthias Ringwald uint16_t attribute_type, uint16_t attribute_len, uint8_t* attribute_value){ 438591423b2SMatthias Ringwald 4399ec2630cSMatthias Ringwald UNUSED(att_connection); 4409ec2630cSMatthias Ringwald 441591423b2SMatthias Ringwald log_info("ATT_FIND_BY_TYPE_VALUE_REQUEST: from %04X to %04X, type %04X, value: ", start_handle, end_handle, attribute_type); 442591423b2SMatthias Ringwald log_info_hexdump(attribute_value, attribute_len); 443591423b2SMatthias Ringwald uint8_t request_type = ATT_FIND_BY_TYPE_VALUE_REQUEST; 444591423b2SMatthias Ringwald 445591423b2SMatthias Ringwald if (start_handle > end_handle || start_handle == 0){ 446591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, start_handle); 447591423b2SMatthias Ringwald } 448591423b2SMatthias Ringwald 449591423b2SMatthias Ringwald uint16_t offset = 1; 450591423b2SMatthias Ringwald uint16_t in_group = 0; 451591423b2SMatthias Ringwald uint16_t prev_handle = 0; 452591423b2SMatthias Ringwald 453591423b2SMatthias Ringwald att_iterator_t it; 454591423b2SMatthias Ringwald att_iterator_init(&it); 455591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 456591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 457591423b2SMatthias Ringwald 458591423b2SMatthias Ringwald if (it.handle && it.handle < start_handle) continue; 459591423b2SMatthias Ringwald if (it.handle > end_handle) break; // (1) 460591423b2SMatthias Ringwald 461591423b2SMatthias Ringwald // close current tag, if within a group and a new service definition starts or we reach end of att db 462591423b2SMatthias Ringwald if (in_group && 463591423b2SMatthias Ringwald (it.handle == 0 || att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID))){ 464591423b2SMatthias Ringwald 465591423b2SMatthias Ringwald log_info("End of group, handle 0x%04x", prev_handle); 466591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, prev_handle); 467591423b2SMatthias Ringwald offset += 2; 468591423b2SMatthias Ringwald in_group = 0; 469591423b2SMatthias Ringwald 470591423b2SMatthias Ringwald // check if space for another handle pair available 471591423b2SMatthias Ringwald if (offset + 4 > response_buffer_size){ 472591423b2SMatthias Ringwald break; 473591423b2SMatthias Ringwald } 474591423b2SMatthias Ringwald } 475591423b2SMatthias Ringwald 476591423b2SMatthias Ringwald // keep track of previous handle 477591423b2SMatthias Ringwald prev_handle = it.handle; 478591423b2SMatthias Ringwald 479591423b2SMatthias Ringwald // does current attribute match 480591423b2SMatthias Ringwald if (it.handle && att_iterator_match_uuid16(&it, attribute_type) && attribute_len == it.value_len && memcmp(attribute_value, it.value, it.value_len) == 0){ 481591423b2SMatthias Ringwald log_info("Begin of group, handle 0x%04x", it.handle); 482591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, it.handle); 483591423b2SMatthias Ringwald offset += 2; 484591423b2SMatthias Ringwald in_group = 1; 485591423b2SMatthias Ringwald } 486591423b2SMatthias Ringwald } 487591423b2SMatthias Ringwald 488591423b2SMatthias Ringwald if (offset == 1){ 489591423b2SMatthias Ringwald return setup_error_atribute_not_found(response_buffer, request_type, start_handle); 490591423b2SMatthias Ringwald } 491591423b2SMatthias Ringwald 492591423b2SMatthias Ringwald response_buffer[0] = ATT_FIND_BY_TYPE_VALUE_RESPONSE; 493591423b2SMatthias Ringwald return offset; 494591423b2SMatthias Ringwald } 495591423b2SMatthias Ringwald 496591423b2SMatthias Ringwald static uint16_t handle_find_by_type_value_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 497591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 498591423b2SMatthias Ringwald int attribute_len = request_len - 7; 499591423b2SMatthias Ringwald return handle_find_by_type_value_request2(att_connection, response_buffer, response_buffer_size, little_endian_read_16(request_buffer, 1), 500591423b2SMatthias Ringwald little_endian_read_16(request_buffer, 3), little_endian_read_16(request_buffer, 5), attribute_len, &request_buffer[7]); 501591423b2SMatthias Ringwald } 502591423b2SMatthias Ringwald 503591423b2SMatthias Ringwald // 504591423b2SMatthias Ringwald // MARK: ATT_READ_BY_TYPE_REQUEST 505591423b2SMatthias Ringwald // 506591423b2SMatthias Ringwald static uint16_t handle_read_by_type_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, 507591423b2SMatthias Ringwald uint16_t start_handle, uint16_t end_handle, 508591423b2SMatthias Ringwald uint16_t attribute_type_len, uint8_t * attribute_type){ 509591423b2SMatthias Ringwald 510591423b2SMatthias Ringwald log_info("ATT_READ_BY_TYPE_REQUEST: from %04X to %04X, type: ", start_handle, end_handle); 511591423b2SMatthias Ringwald log_info_hexdump(attribute_type, attribute_type_len); 512591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_BY_TYPE_REQUEST; 513591423b2SMatthias Ringwald 514591423b2SMatthias Ringwald if (start_handle > end_handle || start_handle == 0){ 515591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, start_handle); 516591423b2SMatthias Ringwald } 517591423b2SMatthias Ringwald 518591423b2SMatthias Ringwald uint16_t offset = 1; 519591423b2SMatthias Ringwald uint16_t pair_len = 0; 520591423b2SMatthias Ringwald 521591423b2SMatthias Ringwald att_iterator_t it; 522591423b2SMatthias Ringwald att_iterator_init(&it); 523591423b2SMatthias Ringwald uint8_t error_code = 0; 524591423b2SMatthias Ringwald uint16_t first_matching_but_unreadable_handle = 0; 525591423b2SMatthias Ringwald 526e404a688SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_READ_RESPONSE 527e404a688SMatthias Ringwald int read_request_pending = 0; 528e404a688SMatthias Ringwald #endif 529e404a688SMatthias Ringwald 530591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 531591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 532591423b2SMatthias Ringwald 533591423b2SMatthias Ringwald if (!it.handle) break; 534591423b2SMatthias Ringwald if (it.handle < start_handle) continue; 535591423b2SMatthias Ringwald if (it.handle > end_handle) break; // (1) 536591423b2SMatthias Ringwald 537591423b2SMatthias Ringwald // does current attribute match 538591423b2SMatthias Ringwald if (!att_iterator_match_uuid(&it, attribute_type, attribute_type_len)) continue; 539591423b2SMatthias Ringwald 540591423b2SMatthias Ringwald // skip handles that cannot be read but rembember that there has been at least one 541591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_READ) == 0) { 542591423b2SMatthias Ringwald if (first_matching_but_unreadable_handle == 0) { 543591423b2SMatthias Ringwald first_matching_but_unreadable_handle = it.handle; 544591423b2SMatthias Ringwald } 545591423b2SMatthias Ringwald continue; 546591423b2SMatthias Ringwald } 547591423b2SMatthias Ringwald 548591423b2SMatthias Ringwald // check security requirements 549eb6072adSMatthias Ringwald if ((it.flags & ATT_DB_FLAGS_READ_WITHOUT_AUTHENTICATION) == 0){ 5509d622fdeSMatthias Ringwald error_code = att_validate_security(att_connection, ATT_READ, &it); 551591423b2SMatthias Ringwald if (error_code) break; 552eb6072adSMatthias Ringwald } 553591423b2SMatthias Ringwald 554591423b2SMatthias Ringwald att_update_value_len(&it, att_connection->con_handle); 555591423b2SMatthias Ringwald 556e404a688SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_READ_RESPONSE 557e404a688SMatthias Ringwald if (it.value_len == ATT_READ_RESPONSE_PENDING){ 558e404a688SMatthias Ringwald read_request_pending = 1; 559e404a688SMatthias Ringwald } 560e404a688SMatthias Ringwald if (read_request_pending) continue; 561e404a688SMatthias Ringwald #endif 562e404a688SMatthias Ringwald 563591423b2SMatthias Ringwald // check if value has same len as last one 564591423b2SMatthias Ringwald uint16_t this_pair_len = 2 + it.value_len; 565591423b2SMatthias Ringwald if (offset > 1){ 566591423b2SMatthias Ringwald if (pair_len != this_pair_len) { 567591423b2SMatthias Ringwald break; 568591423b2SMatthias Ringwald } 569591423b2SMatthias Ringwald } 570591423b2SMatthias Ringwald 571591423b2SMatthias Ringwald // first 572591423b2SMatthias Ringwald if (offset == 1) { 573591423b2SMatthias Ringwald pair_len = this_pair_len; 574591423b2SMatthias Ringwald response_buffer[offset] = pair_len; 575591423b2SMatthias Ringwald offset++; 576591423b2SMatthias Ringwald } 577591423b2SMatthias Ringwald 578591423b2SMatthias Ringwald // space? 579591423b2SMatthias Ringwald if (offset + pair_len > response_buffer_size) { 580591423b2SMatthias Ringwald if (offset > 2) break; 581591423b2SMatthias Ringwald it.value_len = response_buffer_size - 4; 582591423b2SMatthias Ringwald response_buffer[1] = 2 + it.value_len; 583591423b2SMatthias Ringwald } 584591423b2SMatthias Ringwald 585591423b2SMatthias Ringwald // store 586591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, it.handle); 587591423b2SMatthias Ringwald offset += 2; 588591423b2SMatthias Ringwald uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, it.value_len, att_connection->con_handle); 589591423b2SMatthias Ringwald offset += bytes_copied; 590591423b2SMatthias Ringwald } 591591423b2SMatthias Ringwald 592e404a688SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_READ_RESPONSE 593e404a688SMatthias Ringwald if (read_request_pending) return ATT_READ_RESPONSE_PENDING; 594e404a688SMatthias Ringwald #endif 595e404a688SMatthias Ringwald 596591423b2SMatthias Ringwald // at least one attribute could be read 597591423b2SMatthias Ringwald if (offset > 1){ 598591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_BY_TYPE_RESPONSE; 599591423b2SMatthias Ringwald return offset; 600591423b2SMatthias Ringwald } 601591423b2SMatthias Ringwald 602591423b2SMatthias Ringwald // first attribute had an error 603591423b2SMatthias Ringwald if (error_code){ 604591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, start_handle, error_code); 605591423b2SMatthias Ringwald } 606591423b2SMatthias Ringwald 607591423b2SMatthias Ringwald // no other errors, but all found attributes had been non-readable 608591423b2SMatthias Ringwald if (first_matching_but_unreadable_handle){ 609591423b2SMatthias Ringwald return setup_error_read_not_permitted(response_buffer, request_type, first_matching_but_unreadable_handle); 610591423b2SMatthias Ringwald } 611591423b2SMatthias Ringwald 612591423b2SMatthias Ringwald // attribute not found 613591423b2SMatthias Ringwald return setup_error_atribute_not_found(response_buffer, request_type, start_handle); 614591423b2SMatthias Ringwald } 615591423b2SMatthias Ringwald 616591423b2SMatthias Ringwald static uint16_t handle_read_by_type_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 617591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 618591423b2SMatthias Ringwald int attribute_type_len; 619591423b2SMatthias Ringwald if (request_len <= 7){ 620591423b2SMatthias Ringwald attribute_type_len = 2; 621591423b2SMatthias Ringwald } else { 622591423b2SMatthias Ringwald attribute_type_len = 16; 623591423b2SMatthias Ringwald } 624591423b2SMatthias Ringwald return handle_read_by_type_request2(att_connection, response_buffer, response_buffer_size, little_endian_read_16(request_buffer, 1), little_endian_read_16(request_buffer, 3), attribute_type_len, &request_buffer[5]); 625591423b2SMatthias Ringwald } 626591423b2SMatthias Ringwald 627591423b2SMatthias Ringwald // 628591423b2SMatthias Ringwald // MARK: ATT_READ_BY_TYPE_REQUEST 629591423b2SMatthias Ringwald // 630591423b2SMatthias Ringwald static uint16_t handle_read_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, uint16_t handle){ 631591423b2SMatthias Ringwald 632591423b2SMatthias Ringwald log_info("ATT_READ_REQUEST: handle %04x", handle); 633591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_REQUEST; 634591423b2SMatthias Ringwald 635591423b2SMatthias Ringwald att_iterator_t it; 636591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 637591423b2SMatthias Ringwald if (!ok){ 638591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 639591423b2SMatthias Ringwald } 640591423b2SMatthias Ringwald 641591423b2SMatthias Ringwald // check if handle can be read 642591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_READ) == 0) { 643591423b2SMatthias Ringwald return setup_error_read_not_permitted(response_buffer, request_type, handle); 644591423b2SMatthias Ringwald } 645591423b2SMatthias Ringwald 646591423b2SMatthias Ringwald // check security requirements 647eb6072adSMatthias Ringwald if ((it.flags & ATT_DB_FLAGS_READ_WITHOUT_AUTHENTICATION) == 0){ 6489d622fdeSMatthias Ringwald uint8_t error_code = att_validate_security(att_connection, ATT_READ, &it); 649591423b2SMatthias Ringwald if (error_code) { 650591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 651591423b2SMatthias Ringwald } 652eb6072adSMatthias Ringwald } 653591423b2SMatthias Ringwald 654591423b2SMatthias Ringwald att_update_value_len(&it, att_connection->con_handle); 655591423b2SMatthias Ringwald 656e404a688SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_READ_RESPONSE 657e404a688SMatthias Ringwald if (it.value_len == ATT_READ_RESPONSE_PENDING) return ATT_READ_RESPONSE_PENDING; 658e404a688SMatthias Ringwald #endif 659e404a688SMatthias Ringwald 660591423b2SMatthias Ringwald uint16_t offset = 1; 661591423b2SMatthias Ringwald // limit data 662591423b2SMatthias Ringwald if (offset + it.value_len > response_buffer_size) { 663591423b2SMatthias Ringwald it.value_len = response_buffer_size - 1; 664591423b2SMatthias Ringwald } 665591423b2SMatthias Ringwald 666591423b2SMatthias Ringwald // store 667591423b2SMatthias Ringwald uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, it.value_len, att_connection->con_handle); 668591423b2SMatthias Ringwald offset += bytes_copied; 669591423b2SMatthias Ringwald 670591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_RESPONSE; 671591423b2SMatthias Ringwald return offset; 672591423b2SMatthias Ringwald } 673591423b2SMatthias Ringwald 674591423b2SMatthias Ringwald static uint16_t handle_read_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 675591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 6769ec2630cSMatthias Ringwald UNUSED(request_len); 677591423b2SMatthias Ringwald return handle_read_request2(att_connection, response_buffer, response_buffer_size, little_endian_read_16(request_buffer, 1)); 678591423b2SMatthias Ringwald } 679591423b2SMatthias Ringwald 680591423b2SMatthias Ringwald // 681591423b2SMatthias Ringwald // MARK: ATT_READ_BLOB_REQUEST 0x0c 682591423b2SMatthias Ringwald // 683591423b2SMatthias Ringwald static uint16_t handle_read_blob_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, uint16_t handle, uint16_t value_offset){ 684591423b2SMatthias Ringwald log_info("ATT_READ_BLOB_REQUEST: handle %04x, offset %u", handle, value_offset); 685591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_BLOB_REQUEST; 686591423b2SMatthias Ringwald 687591423b2SMatthias Ringwald att_iterator_t it; 688591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 689591423b2SMatthias Ringwald if (!ok){ 690591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 691591423b2SMatthias Ringwald } 692591423b2SMatthias Ringwald 693591423b2SMatthias Ringwald // check if handle can be read 694591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_READ) == 0) { 695591423b2SMatthias Ringwald return setup_error_read_not_permitted(response_buffer, request_type, handle); 696591423b2SMatthias Ringwald } 697591423b2SMatthias Ringwald 698591423b2SMatthias Ringwald // check security requirements 699eb6072adSMatthias Ringwald if ((it.flags & ATT_DB_FLAGS_READ_WITHOUT_AUTHENTICATION) == 0){ 7009d622fdeSMatthias Ringwald uint8_t error_code = att_validate_security(att_connection, ATT_READ, &it); 701591423b2SMatthias Ringwald if (error_code) { 702591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 703591423b2SMatthias Ringwald } 704eb6072adSMatthias Ringwald } 705591423b2SMatthias Ringwald 706591423b2SMatthias Ringwald att_update_value_len(&it, att_connection->con_handle); 707591423b2SMatthias Ringwald 708e404a688SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_READ_RESPONSE 709e404a688SMatthias Ringwald if (it.value_len == ATT_READ_RESPONSE_PENDING) return ATT_READ_RESPONSE_PENDING; 710e404a688SMatthias Ringwald #endif 711e404a688SMatthias Ringwald 712591423b2SMatthias Ringwald if (value_offset > it.value_len){ 713591423b2SMatthias Ringwald return setup_error_invalid_offset(response_buffer, request_type, handle); 714591423b2SMatthias Ringwald } 715591423b2SMatthias Ringwald 716591423b2SMatthias Ringwald // limit data 717591423b2SMatthias Ringwald uint16_t offset = 1; 718591423b2SMatthias Ringwald if (offset + it.value_len - value_offset > response_buffer_size) { 719591423b2SMatthias Ringwald it.value_len = response_buffer_size - 1 + value_offset; 720591423b2SMatthias Ringwald } 721591423b2SMatthias Ringwald 722591423b2SMatthias Ringwald // store 723591423b2SMatthias Ringwald uint16_t bytes_copied = att_copy_value(&it, value_offset, response_buffer + offset, it.value_len - value_offset, att_connection->con_handle); 724591423b2SMatthias Ringwald offset += bytes_copied; 725591423b2SMatthias Ringwald 726591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_BLOB_RESPONSE; 727591423b2SMatthias Ringwald return offset; 728591423b2SMatthias Ringwald } 729591423b2SMatthias Ringwald 730591423b2SMatthias Ringwald static uint16_t handle_read_blob_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 731591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 7329ec2630cSMatthias Ringwald UNUSED(request_len); 733591423b2SMatthias Ringwald return handle_read_blob_request2(att_connection, response_buffer, response_buffer_size, little_endian_read_16(request_buffer, 1), little_endian_read_16(request_buffer, 3)); 734591423b2SMatthias Ringwald } 735591423b2SMatthias Ringwald 736591423b2SMatthias Ringwald // 737591423b2SMatthias Ringwald // MARK: ATT_READ_MULTIPLE_REQUEST 0x0e 738591423b2SMatthias Ringwald // 739591423b2SMatthias Ringwald static uint16_t handle_read_multiple_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, uint16_t num_handles, uint8_t * handles){ 740591423b2SMatthias Ringwald log_info("ATT_READ_MULTIPLE_REQUEST: num handles %u", num_handles); 741591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_MULTIPLE_REQUEST; 742591423b2SMatthias Ringwald 743591423b2SMatthias Ringwald // TODO: figure out which error to respond with 744591423b2SMatthias Ringwald // if (num_handles < 2){ 745591423b2SMatthias Ringwald // return setup_error(response_buffer, ATT_READ_MULTIPLE_REQUEST, handle, ???); 746591423b2SMatthias Ringwald // } 747591423b2SMatthias Ringwald 748591423b2SMatthias Ringwald uint16_t offset = 1; 749591423b2SMatthias Ringwald 750591423b2SMatthias Ringwald int i; 751591423b2SMatthias Ringwald uint8_t error_code = 0; 752591423b2SMatthias Ringwald uint16_t handle = 0; 753e404a688SMatthias Ringwald 754e404a688SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_READ_RESPONSE 755e404a688SMatthias Ringwald int read_request_pending = 0; 756e404a688SMatthias Ringwald #endif 757e404a688SMatthias Ringwald 758591423b2SMatthias Ringwald for (i=0;i<num_handles;i++){ 759591423b2SMatthias Ringwald handle = little_endian_read_16(handles, i << 1); 760591423b2SMatthias Ringwald 761591423b2SMatthias Ringwald if (handle == 0){ 762591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 763591423b2SMatthias Ringwald } 764591423b2SMatthias Ringwald 765591423b2SMatthias Ringwald att_iterator_t it; 766591423b2SMatthias Ringwald 767591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 768591423b2SMatthias Ringwald if (!ok){ 769591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 770591423b2SMatthias Ringwald } 771591423b2SMatthias Ringwald 772591423b2SMatthias Ringwald // check if handle can be read 773591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_READ) == 0) { 774591423b2SMatthias Ringwald error_code = ATT_ERROR_READ_NOT_PERMITTED; 775591423b2SMatthias Ringwald break; 776591423b2SMatthias Ringwald } 777591423b2SMatthias Ringwald 778591423b2SMatthias Ringwald // check security requirements 779eb6072adSMatthias Ringwald if ((it.flags & ATT_DB_FLAGS_READ_WITHOUT_AUTHENTICATION) == 0){ 7809d622fdeSMatthias Ringwald error_code = att_validate_security(att_connection, ATT_READ, &it); 781591423b2SMatthias Ringwald if (error_code) break; 782eb6072adSMatthias Ringwald } 783591423b2SMatthias Ringwald att_update_value_len(&it, att_connection->con_handle); 784591423b2SMatthias Ringwald 785e404a688SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_READ_RESPONSE 786e404a688SMatthias Ringwald if (it.value_len == ATT_READ_RESPONSE_PENDING) { 787e404a688SMatthias Ringwald read_request_pending = 1; 788e404a688SMatthias Ringwald } 789e404a688SMatthias Ringwald if (read_request_pending) continue; 790e404a688SMatthias Ringwald #endif 791e404a688SMatthias Ringwald 792591423b2SMatthias Ringwald // limit data 793591423b2SMatthias Ringwald if (offset + it.value_len > response_buffer_size) { 794591423b2SMatthias Ringwald it.value_len = response_buffer_size - 1; 795591423b2SMatthias Ringwald } 796591423b2SMatthias Ringwald 797591423b2SMatthias Ringwald // store 798591423b2SMatthias Ringwald uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, it.value_len, att_connection->con_handle); 799591423b2SMatthias Ringwald offset += bytes_copied; 800591423b2SMatthias Ringwald } 801591423b2SMatthias Ringwald 802591423b2SMatthias Ringwald if (error_code){ 803591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 804591423b2SMatthias Ringwald } 805591423b2SMatthias Ringwald 806591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_MULTIPLE_RESPONSE; 807591423b2SMatthias Ringwald return offset; 808591423b2SMatthias Ringwald } 809591423b2SMatthias Ringwald static uint16_t handle_read_multiple_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 810591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 811591423b2SMatthias Ringwald int num_handles = (request_len - 1) >> 1; 812591423b2SMatthias Ringwald return handle_read_multiple_request2(att_connection, response_buffer, response_buffer_size, num_handles, &request_buffer[1]); 813591423b2SMatthias Ringwald } 814591423b2SMatthias Ringwald 815591423b2SMatthias Ringwald // 816591423b2SMatthias Ringwald // MARK: ATT_READ_BY_GROUP_TYPE_REQUEST 0x10 817591423b2SMatthias Ringwald // 818591423b2SMatthias Ringwald // Only handles GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID 819591423b2SMatthias Ringwald // Core v4.0, vol 3, part g, 2.5.3 820591423b2SMatthias Ringwald // "The «Primary Service» and «Secondary Service» grouping types may be used in the Read By Group Type Request. 821591423b2SMatthias Ringwald // The «Characteristic» grouping type shall not be used in the ATT Read By Group Type Request." 822591423b2SMatthias Ringwald // 823591423b2SMatthias Ringwald // NOTE: doesn't handle DYNAMIC values 824591423b2SMatthias Ringwald // 825591423b2SMatthias Ringwald // NOTE: we don't check for security as PRIMARY and SECONDAY SERVICE definition shouldn't be protected 826591423b2SMatthias Ringwald // Core 4.0, vol 3, part g, 8.1 827591423b2SMatthias Ringwald // "The list of services and characteristics that a device supports is not considered private or 828591423b2SMatthias Ringwald // confidential information, and therefore the Service and Characteristic Discovery procedures 829591423b2SMatthias Ringwald // shall always be permitted. " 830591423b2SMatthias Ringwald // 831591423b2SMatthias Ringwald static uint16_t handle_read_by_group_type_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, 832591423b2SMatthias Ringwald uint16_t start_handle, uint16_t end_handle, 833591423b2SMatthias Ringwald uint16_t attribute_type_len, uint8_t * attribute_type){ 834591423b2SMatthias Ringwald 8359ec2630cSMatthias Ringwald UNUSED(att_connection); 8369ec2630cSMatthias Ringwald 837591423b2SMatthias Ringwald log_info("ATT_READ_BY_GROUP_TYPE_REQUEST: from %04X to %04X, buffer size %u, type: ", start_handle, end_handle, response_buffer_size); 838591423b2SMatthias Ringwald log_info_hexdump(attribute_type, attribute_type_len); 839591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_BY_GROUP_TYPE_REQUEST; 840591423b2SMatthias Ringwald 841591423b2SMatthias Ringwald if (start_handle > end_handle || start_handle == 0){ 842591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, start_handle); 843591423b2SMatthias Ringwald } 844591423b2SMatthias Ringwald 845591423b2SMatthias Ringwald // assert UUID is primary or secondary service uuid 846591423b2SMatthias Ringwald uint16_t uuid16 = uuid16_from_uuid(attribute_type_len, attribute_type); 847591423b2SMatthias Ringwald if (uuid16 != GATT_PRIMARY_SERVICE_UUID && uuid16 != GATT_SECONDARY_SERVICE_UUID){ 848591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, start_handle, ATT_ERROR_UNSUPPORTED_GROUP_TYPE); 849591423b2SMatthias Ringwald } 850591423b2SMatthias Ringwald 851591423b2SMatthias Ringwald uint16_t offset = 1; 852591423b2SMatthias Ringwald uint16_t pair_len = 0; 853591423b2SMatthias Ringwald uint16_t in_group = 0; 854591423b2SMatthias Ringwald uint16_t group_start_handle = 0; 855591423b2SMatthias Ringwald uint8_t const * group_start_value = NULL; 856591423b2SMatthias Ringwald uint16_t prev_handle = 0; 857591423b2SMatthias Ringwald 858591423b2SMatthias Ringwald att_iterator_t it; 859591423b2SMatthias Ringwald att_iterator_init(&it); 860591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 861591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 862591423b2SMatthias Ringwald 863591423b2SMatthias Ringwald if (it.handle && it.handle < start_handle) continue; 864591423b2SMatthias Ringwald if (it.handle > end_handle) break; // (1) 865591423b2SMatthias Ringwald 866591423b2SMatthias Ringwald // log_info("Handle 0x%04x", it.handle); 867591423b2SMatthias Ringwald 868591423b2SMatthias Ringwald // close current tag, if within a group and a new service definition starts or we reach end of att db 869591423b2SMatthias Ringwald if (in_group && 870591423b2SMatthias Ringwald (it.handle == 0 || att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID))){ 871591423b2SMatthias Ringwald // log_info("End of group, handle 0x%04x, val_len: %u", prev_handle, pair_len - 4); 872591423b2SMatthias Ringwald 873591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, group_start_handle); 874591423b2SMatthias Ringwald offset += 2; 875591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, prev_handle); 876591423b2SMatthias Ringwald offset += 2; 877591423b2SMatthias Ringwald memcpy(response_buffer + offset, group_start_value, pair_len - 4); 878591423b2SMatthias Ringwald offset += pair_len - 4; 879591423b2SMatthias Ringwald in_group = 0; 880591423b2SMatthias Ringwald 881591423b2SMatthias Ringwald // check if space for another handle pair available 882591423b2SMatthias Ringwald if (offset + pair_len > response_buffer_size){ 883591423b2SMatthias Ringwald break; 884591423b2SMatthias Ringwald } 885591423b2SMatthias Ringwald } 886591423b2SMatthias Ringwald 887591423b2SMatthias Ringwald // keep track of previous handle 888591423b2SMatthias Ringwald prev_handle = it.handle; 889591423b2SMatthias Ringwald 890591423b2SMatthias Ringwald // does current attribute match 891591423b2SMatthias Ringwald // log_info("compare: %04x == %04x", *(uint16_t*) context->attribute_type, *(uint16_t*) uuid); 892591423b2SMatthias Ringwald if (it.handle && att_iterator_match_uuid(&it, attribute_type, attribute_type_len)) { 893591423b2SMatthias Ringwald 894591423b2SMatthias Ringwald // check if value has same len as last one 895591423b2SMatthias Ringwald uint16_t this_pair_len = 4 + it.value_len; 896591423b2SMatthias Ringwald if (offset > 1){ 897591423b2SMatthias Ringwald if (this_pair_len != pair_len) { 898591423b2SMatthias Ringwald break; 899591423b2SMatthias Ringwald } 900591423b2SMatthias Ringwald } 901591423b2SMatthias Ringwald 902591423b2SMatthias Ringwald // log_info("Begin of group, handle 0x%04x", it.handle); 903591423b2SMatthias Ringwald 904591423b2SMatthias Ringwald // first 905591423b2SMatthias Ringwald if (offset == 1) { 906591423b2SMatthias Ringwald pair_len = this_pair_len; 907591423b2SMatthias Ringwald response_buffer[offset] = this_pair_len; 908591423b2SMatthias Ringwald offset++; 909591423b2SMatthias Ringwald } 910591423b2SMatthias Ringwald 911591423b2SMatthias Ringwald group_start_handle = it.handle; 912591423b2SMatthias Ringwald group_start_value = it.value; 913591423b2SMatthias Ringwald in_group = 1; 914591423b2SMatthias Ringwald } 915591423b2SMatthias Ringwald } 916591423b2SMatthias Ringwald 917591423b2SMatthias Ringwald if (offset == 1){ 918591423b2SMatthias Ringwald return setup_error_atribute_not_found(response_buffer, request_type, start_handle); 919591423b2SMatthias Ringwald } 920591423b2SMatthias Ringwald 921591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_BY_GROUP_TYPE_RESPONSE; 922591423b2SMatthias Ringwald return offset; 923591423b2SMatthias Ringwald } 924591423b2SMatthias Ringwald static uint16_t handle_read_by_group_type_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 925591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 926591423b2SMatthias Ringwald int attribute_type_len; 927591423b2SMatthias Ringwald if (request_len <= 7){ 928591423b2SMatthias Ringwald attribute_type_len = 2; 929591423b2SMatthias Ringwald } else { 930591423b2SMatthias Ringwald attribute_type_len = 16; 931591423b2SMatthias Ringwald } 932591423b2SMatthias Ringwald return handle_read_by_group_type_request2(att_connection, response_buffer, response_buffer_size, little_endian_read_16(request_buffer, 1), little_endian_read_16(request_buffer, 3), attribute_type_len, &request_buffer[5]); 933591423b2SMatthias Ringwald } 934591423b2SMatthias Ringwald 935591423b2SMatthias Ringwald // 936591423b2SMatthias Ringwald // MARK: ATT_WRITE_REQUEST 0x12 937591423b2SMatthias Ringwald static uint16_t handle_write_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 938591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 939591423b2SMatthias Ringwald 9409ec2630cSMatthias Ringwald UNUSED(response_buffer_size); 9419ec2630cSMatthias Ringwald 942591423b2SMatthias Ringwald uint8_t request_type = ATT_WRITE_REQUEST; 943591423b2SMatthias Ringwald 944591423b2SMatthias Ringwald uint16_t handle = little_endian_read_16(request_buffer, 1); 945591423b2SMatthias Ringwald att_iterator_t it; 946591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 947591423b2SMatthias Ringwald if (!ok) { 948591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 949591423b2SMatthias Ringwald } 9503d71c7a4SMatthias Ringwald if (!att_write_callback) { 951591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 952591423b2SMatthias Ringwald } 953591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_WRITE) == 0) { 954591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 955591423b2SMatthias Ringwald } 956591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0) { 957591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 958591423b2SMatthias Ringwald } 959591423b2SMatthias Ringwald // check security requirements 9609d622fdeSMatthias Ringwald uint8_t error_code = att_validate_security(att_connection, ATT_WRITE, &it); 961591423b2SMatthias Ringwald if (error_code) { 962591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 963591423b2SMatthias Ringwald } 964fd75a1c5SMatthias Ringwald att_persistent_ccc_cache(&it); 9653d71c7a4SMatthias Ringwald error_code = (*att_write_callback)(att_connection->con_handle, handle, ATT_TRANSACTION_MODE_NONE, 0, request_buffer + 3, request_len - 3); 966591423b2SMatthias Ringwald if (error_code) { 967591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 968591423b2SMatthias Ringwald } 969591423b2SMatthias Ringwald response_buffer[0] = ATT_WRITE_RESPONSE; 970591423b2SMatthias Ringwald return 1; 971591423b2SMatthias Ringwald } 972591423b2SMatthias Ringwald 973591423b2SMatthias Ringwald // 974591423b2SMatthias Ringwald // MARK: ATT_PREPARE_WRITE_REQUEST 0x16 975591423b2SMatthias Ringwald static uint16_t handle_prepare_write_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 976591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 977591423b2SMatthias Ringwald 9789ec2630cSMatthias Ringwald UNUSED(response_buffer_size); 9799ec2630cSMatthias Ringwald 980591423b2SMatthias Ringwald uint8_t request_type = ATT_PREPARE_WRITE_REQUEST; 981591423b2SMatthias Ringwald 982591423b2SMatthias Ringwald uint16_t handle = little_endian_read_16(request_buffer, 1); 983591423b2SMatthias Ringwald uint16_t offset = little_endian_read_16(request_buffer, 3); 9843d71c7a4SMatthias Ringwald if (!att_write_callback) { 985591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 986591423b2SMatthias Ringwald } 987591423b2SMatthias Ringwald att_iterator_t it; 988591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 989591423b2SMatthias Ringwald if (!ok) { 990591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 991591423b2SMatthias Ringwald } 992591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_WRITE) == 0) { 993591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 994591423b2SMatthias Ringwald } 995591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0) { 996591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 997591423b2SMatthias Ringwald } 998591423b2SMatthias Ringwald // check security requirements 9999d622fdeSMatthias Ringwald uint8_t error_code = att_validate_security(att_connection, ATT_WRITE, &it); 1000591423b2SMatthias Ringwald if (error_code) { 1001591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 1002591423b2SMatthias Ringwald } 1003591423b2SMatthias Ringwald 10043d71c7a4SMatthias Ringwald error_code = (*att_write_callback)(att_connection->con_handle, handle, ATT_TRANSACTION_MODE_ACTIVE, offset, request_buffer + 5, request_len - 5); 1005591423b2SMatthias Ringwald switch (error_code){ 1006591423b2SMatthias Ringwald case 0: 1007591423b2SMatthias Ringwald break; 1008591423b2SMatthias Ringwald case ATT_ERROR_INVALID_OFFSET: 1009591423b2SMatthias Ringwald case ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH: 1010591423b2SMatthias Ringwald // postpone to execute write request 1011591423b2SMatthias Ringwald att_prepare_write_update_errors(error_code, handle); 1012591423b2SMatthias Ringwald break; 1013591423b2SMatthias Ringwald default: 1014591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 1015591423b2SMatthias Ringwald } 1016591423b2SMatthias Ringwald 1017591423b2SMatthias Ringwald // response: echo request 1018591423b2SMatthias Ringwald memcpy(response_buffer, request_buffer, request_len); 1019591423b2SMatthias Ringwald response_buffer[0] = ATT_PREPARE_WRITE_RESPONSE; 1020591423b2SMatthias Ringwald return request_len; 1021591423b2SMatthias Ringwald } 1022591423b2SMatthias Ringwald 1023591423b2SMatthias Ringwald /* 1024591423b2SMatthias Ringwald * @brief transcation queue of prepared writes, e.g., after disconnect 1025591423b2SMatthias Ringwald */ 1026591423b2SMatthias Ringwald void att_clear_transaction_queue(att_connection_t * att_connection){ 10273d71c7a4SMatthias Ringwald (*att_write_callback)(att_connection->con_handle, 0, ATT_TRANSACTION_MODE_CANCEL, 0, NULL, 0); 1028591423b2SMatthias Ringwald } 1029591423b2SMatthias Ringwald 1030591423b2SMatthias Ringwald // MARK: ATT_EXECUTE_WRITE_REQUEST 0x18 1031591423b2SMatthias Ringwald // NOTE: security has been verified by handle_prepare_write_request 1032591423b2SMatthias Ringwald static uint16_t handle_execute_write_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 1033591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 1034591423b2SMatthias Ringwald 10359ec2630cSMatthias Ringwald UNUSED(request_len); 10369ec2630cSMatthias Ringwald UNUSED(response_buffer_size); 10379ec2630cSMatthias Ringwald 1038591423b2SMatthias Ringwald uint8_t request_type = ATT_EXECUTE_WRITE_REQUEST; 1039591423b2SMatthias Ringwald if (request_buffer[1]) { 10409b31df63SMatthias Ringwald // validate queued write 10419b31df63SMatthias Ringwald if (att_prepare_write_error_code == 0){ 10423d71c7a4SMatthias Ringwald att_prepare_write_error_code = (*att_write_callback)(att_connection->con_handle, 0, ATT_TRANSACTION_MODE_VALIDATE, 0, NULL, 0); 10439b31df63SMatthias Ringwald } 1044591423b2SMatthias Ringwald // deliver queued errors 1045591423b2SMatthias Ringwald if (att_prepare_write_error_code){ 1046591423b2SMatthias Ringwald att_clear_transaction_queue(att_connection); 1047591423b2SMatthias Ringwald uint8_t error_code = att_prepare_write_error_code; 1048591423b2SMatthias Ringwald uint16_t handle = att_prepare_write_error_handle; 1049591423b2SMatthias Ringwald att_prepare_write_reset(); 1050591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 1051591423b2SMatthias Ringwald } 10523d71c7a4SMatthias Ringwald att_write_callback(att_connection->con_handle, 0, ATT_TRANSACTION_MODE_EXECUTE, 0, NULL, 0); 1053591423b2SMatthias Ringwald } else { 1054591423b2SMatthias Ringwald att_clear_transaction_queue(att_connection); 1055591423b2SMatthias Ringwald } 1056591423b2SMatthias Ringwald response_buffer[0] = ATT_EXECUTE_WRITE_RESPONSE; 1057591423b2SMatthias Ringwald return 1; 1058591423b2SMatthias Ringwald } 1059591423b2SMatthias Ringwald 1060591423b2SMatthias Ringwald // MARK: ATT_WRITE_COMMAND 0x52 1061591423b2SMatthias Ringwald // Core 4.0, vol 3, part F, 3.4.5.3 1062591423b2SMatthias Ringwald // "No Error Response or Write Response shall be sent in response to this command" 1063591423b2SMatthias Ringwald static void handle_write_command(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 1064591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 1065591423b2SMatthias Ringwald 10669ec2630cSMatthias Ringwald UNUSED(response_buffer); 10679ec2630cSMatthias Ringwald UNUSED(response_buffer_size); 10689ec2630cSMatthias Ringwald 1069591423b2SMatthias Ringwald uint16_t handle = little_endian_read_16(request_buffer, 1); 10703d71c7a4SMatthias Ringwald if (!att_write_callback) return; 10718ac574d6SMatthias Ringwald 1072591423b2SMatthias Ringwald att_iterator_t it; 1073591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 1074591423b2SMatthias Ringwald if (!ok) return; 1075591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0) return; 1076591423b2SMatthias Ringwald if ((it.flags & ATT_PROPERTY_WRITE_WITHOUT_RESPONSE) == 0) return; 10779d622fdeSMatthias Ringwald if (att_validate_security(att_connection, ATT_WRITE, &it)) return; 1078fd75a1c5SMatthias Ringwald att_persistent_ccc_cache(&it); 10793d71c7a4SMatthias Ringwald (*att_write_callback)(att_connection->con_handle, handle, ATT_TRANSACTION_MODE_NONE, 0, request_buffer + 3, request_len - 3); 1080591423b2SMatthias Ringwald } 1081591423b2SMatthias Ringwald 1082591423b2SMatthias Ringwald // MARK: helper for ATT_HANDLE_VALUE_NOTIFICATION and ATT_HANDLE_VALUE_INDICATION 1083591423b2SMatthias Ringwald static uint16_t prepare_handle_value(att_connection_t * att_connection, 1084591423b2SMatthias Ringwald uint16_t handle, 1085591423b2SMatthias Ringwald uint8_t *value, 1086591423b2SMatthias Ringwald uint16_t value_len, 1087591423b2SMatthias Ringwald uint8_t * response_buffer){ 1088591423b2SMatthias Ringwald little_endian_store_16(response_buffer, 1, handle); 1089591423b2SMatthias Ringwald if (value_len > att_connection->mtu - 3){ 1090591423b2SMatthias Ringwald value_len = att_connection->mtu - 3; 1091591423b2SMatthias Ringwald } 1092591423b2SMatthias Ringwald memcpy(&response_buffer[3], value, value_len); 1093591423b2SMatthias Ringwald return value_len + 3; 1094591423b2SMatthias Ringwald } 1095591423b2SMatthias Ringwald 1096591423b2SMatthias Ringwald // MARK: ATT_HANDLE_VALUE_NOTIFICATION 0x1b 1097591423b2SMatthias Ringwald uint16_t att_prepare_handle_value_notification(att_connection_t * att_connection, 1098591423b2SMatthias Ringwald uint16_t handle, 1099591423b2SMatthias Ringwald uint8_t *value, 1100591423b2SMatthias Ringwald uint16_t value_len, 1101591423b2SMatthias Ringwald uint8_t * response_buffer){ 1102591423b2SMatthias Ringwald 1103591423b2SMatthias Ringwald response_buffer[0] = ATT_HANDLE_VALUE_NOTIFICATION; 1104591423b2SMatthias Ringwald return prepare_handle_value(att_connection, handle, value, value_len, response_buffer); 1105591423b2SMatthias Ringwald } 1106591423b2SMatthias Ringwald 1107591423b2SMatthias Ringwald // MARK: ATT_HANDLE_VALUE_INDICATION 0x1d 1108591423b2SMatthias Ringwald uint16_t att_prepare_handle_value_indication(att_connection_t * att_connection, 1109591423b2SMatthias Ringwald uint16_t handle, 1110591423b2SMatthias Ringwald uint8_t *value, 1111591423b2SMatthias Ringwald uint16_t value_len, 1112591423b2SMatthias Ringwald uint8_t * response_buffer){ 1113591423b2SMatthias Ringwald 1114591423b2SMatthias Ringwald response_buffer[0] = ATT_HANDLE_VALUE_INDICATION; 1115591423b2SMatthias Ringwald return prepare_handle_value(att_connection, handle, value, value_len, response_buffer); 1116591423b2SMatthias Ringwald } 1117591423b2SMatthias Ringwald 1118591423b2SMatthias Ringwald // MARK: Dispatcher 1119591423b2SMatthias Ringwald uint16_t att_handle_request(att_connection_t * att_connection, 1120591423b2SMatthias Ringwald uint8_t * request_buffer, 1121591423b2SMatthias Ringwald uint16_t request_len, 1122591423b2SMatthias Ringwald uint8_t * response_buffer){ 1123591423b2SMatthias Ringwald uint16_t response_len = 0; 1124591423b2SMatthias Ringwald uint16_t response_buffer_size = att_connection->mtu; 1125591423b2SMatthias Ringwald 1126591423b2SMatthias Ringwald switch (request_buffer[0]){ 1127591423b2SMatthias Ringwald case ATT_EXCHANGE_MTU_REQUEST: 1128591423b2SMatthias Ringwald response_len = handle_exchange_mtu_request(att_connection, request_buffer, request_len, response_buffer); 1129591423b2SMatthias Ringwald break; 1130591423b2SMatthias Ringwald case ATT_FIND_INFORMATION_REQUEST: 1131591423b2SMatthias Ringwald response_len = handle_find_information_request(att_connection, request_buffer, request_len,response_buffer, response_buffer_size); 1132591423b2SMatthias Ringwald break; 1133591423b2SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_REQUEST: 1134591423b2SMatthias Ringwald response_len = handle_find_by_type_value_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1135591423b2SMatthias Ringwald break; 1136591423b2SMatthias Ringwald case ATT_READ_BY_TYPE_REQUEST: 1137591423b2SMatthias Ringwald response_len = handle_read_by_type_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1138591423b2SMatthias Ringwald break; 1139591423b2SMatthias Ringwald case ATT_READ_REQUEST: 1140591423b2SMatthias Ringwald response_len = handle_read_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1141591423b2SMatthias Ringwald break; 1142591423b2SMatthias Ringwald case ATT_READ_BLOB_REQUEST: 1143591423b2SMatthias Ringwald response_len = handle_read_blob_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1144591423b2SMatthias Ringwald break; 1145591423b2SMatthias Ringwald case ATT_READ_MULTIPLE_REQUEST: 1146591423b2SMatthias Ringwald response_len = handle_read_multiple_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1147591423b2SMatthias Ringwald break; 1148591423b2SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_REQUEST: 1149591423b2SMatthias Ringwald response_len = handle_read_by_group_type_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1150591423b2SMatthias Ringwald break; 1151591423b2SMatthias Ringwald case ATT_WRITE_REQUEST: 1152591423b2SMatthias Ringwald response_len = handle_write_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1153591423b2SMatthias Ringwald break; 1154591423b2SMatthias Ringwald case ATT_PREPARE_WRITE_REQUEST: 1155591423b2SMatthias Ringwald response_len = handle_prepare_write_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1156591423b2SMatthias Ringwald break; 1157591423b2SMatthias Ringwald case ATT_EXECUTE_WRITE_REQUEST: 1158591423b2SMatthias Ringwald response_len = handle_execute_write_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1159591423b2SMatthias Ringwald break; 1160591423b2SMatthias Ringwald case ATT_WRITE_COMMAND: 1161591423b2SMatthias Ringwald handle_write_command(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1162591423b2SMatthias Ringwald break; 11637a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1164591423b2SMatthias Ringwald case ATT_SIGNED_WRITE_COMMAND: 1165591423b2SMatthias Ringwald log_info("handle_signed_write_command preprocessed by att_server.c"); 1166591423b2SMatthias Ringwald break; 11677a766ebfSMatthias Ringwald #endif 1168591423b2SMatthias Ringwald default: 1169591423b2SMatthias Ringwald log_info("Unhandled ATT Command: %02X, DATA: ", request_buffer[0]); 1170591423b2SMatthias Ringwald log_info_hexdump(&request_buffer[9], request_len-9); 1171591423b2SMatthias Ringwald break; 1172591423b2SMatthias Ringwald } 1173591423b2SMatthias Ringwald return response_len; 1174591423b2SMatthias Ringwald } 1175591423b2SMatthias Ringwald 1176660ce368SMatthias Ringwald // returns 1 if service found. only primary service. 1177660ce368SMatthias Ringwald int gatt_server_get_get_handle_range_for_service_with_uuid16(uint16_t uuid16, uint16_t * start_handle, uint16_t * end_handle){ 1178660ce368SMatthias Ringwald uint16_t in_group = 0; 1179660ce368SMatthias Ringwald uint16_t prev_handle = 0; 1180660ce368SMatthias Ringwald 1181660ce368SMatthias Ringwald uint8_t attribute_value[2]; 1182660ce368SMatthias Ringwald int attribute_len = sizeof(attribute_value); 1183660ce368SMatthias Ringwald little_endian_store_16(attribute_value, 0, uuid16); 1184660ce368SMatthias Ringwald 1185660ce368SMatthias Ringwald att_iterator_t it; 1186660ce368SMatthias Ringwald att_iterator_init(&it); 1187660ce368SMatthias Ringwald while (att_iterator_has_next(&it)){ 1188660ce368SMatthias Ringwald att_iterator_fetch_next(&it); 1189660ce368SMatthias Ringwald int new_service_started = att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID); 1190660ce368SMatthias Ringwald 1191660ce368SMatthias Ringwald // close current tag, if within a group and a new service definition starts or we reach end of att db 1192660ce368SMatthias Ringwald if (in_group && 1193660ce368SMatthias Ringwald (it.handle == 0 || new_service_started)){ 1194660ce368SMatthias Ringwald *end_handle = prev_handle; 1195660ce368SMatthias Ringwald return 1; 1196660ce368SMatthias Ringwald } 1197660ce368SMatthias Ringwald 1198660ce368SMatthias Ringwald // keep track of previous handle 1199660ce368SMatthias Ringwald prev_handle = it.handle; 1200660ce368SMatthias Ringwald 1201660ce368SMatthias Ringwald // check if found 1202660ce368SMatthias Ringwald if (it.handle && new_service_started && attribute_len == it.value_len && memcmp(attribute_value, it.value, it.value_len) == 0){ 1203660ce368SMatthias Ringwald *start_handle = it.handle; 1204660ce368SMatthias Ringwald in_group = 1; 1205660ce368SMatthias Ringwald } 1206660ce368SMatthias Ringwald } 1207660ce368SMatthias Ringwald return 0; 1208660ce368SMatthias Ringwald } 1209660ce368SMatthias Ringwald 1210660ce368SMatthias Ringwald // returns 0 if not found 1211660ce368SMatthias Ringwald uint16_t gatt_server_get_value_handle_for_characteristic_with_uuid16(uint16_t start_handle, uint16_t end_handle, uint16_t uuid16){ 1212660ce368SMatthias Ringwald att_iterator_t it; 1213660ce368SMatthias Ringwald att_iterator_init(&it); 1214660ce368SMatthias Ringwald while (att_iterator_has_next(&it)){ 1215660ce368SMatthias Ringwald att_iterator_fetch_next(&it); 1216660ce368SMatthias Ringwald if (it.handle && it.handle < start_handle) continue; 1217660ce368SMatthias Ringwald if (it.handle > end_handle) break; // (1) 1218660ce368SMatthias Ringwald if (it.handle == 0) break; 1219660ce368SMatthias Ringwald if (att_iterator_match_uuid16(&it, uuid16)) return it.handle; 1220660ce368SMatthias Ringwald } 1221660ce368SMatthias Ringwald return 0; 1222660ce368SMatthias Ringwald } 1223660ce368SMatthias Ringwald 1224660ce368SMatthias Ringwald // returns 0 if not found 1225660ce368SMatthias Ringwald uint16_t gatt_server_get_client_configuration_handle_for_characteristic_with_uuid16(uint16_t start_handle, uint16_t end_handle, uint16_t uuid16){ 1226660ce368SMatthias Ringwald att_iterator_t it; 1227660ce368SMatthias Ringwald att_iterator_init(&it); 1228660ce368SMatthias Ringwald int characteristic_found = 0; 1229660ce368SMatthias Ringwald while (att_iterator_has_next(&it)){ 1230660ce368SMatthias Ringwald att_iterator_fetch_next(&it); 1231660ce368SMatthias Ringwald if (it.handle && it.handle < start_handle) continue; 1232660ce368SMatthias Ringwald if (it.handle > end_handle) break; // (1) 1233660ce368SMatthias Ringwald if (it.handle == 0) break; 1234660ce368SMatthias Ringwald if (att_iterator_match_uuid16(&it, uuid16)){ 1235660ce368SMatthias Ringwald characteristic_found = 1; 1236660ce368SMatthias Ringwald continue; 1237660ce368SMatthias Ringwald } 1238660ce368SMatthias Ringwald if (att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) 1239660ce368SMatthias Ringwald || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID) 1240660ce368SMatthias Ringwald || att_iterator_match_uuid16(&it, GATT_CHARACTERISTICS_UUID)){ 1241660ce368SMatthias Ringwald if (characteristic_found) break; 1242660ce368SMatthias Ringwald continue; 1243660ce368SMatthias Ringwald } 1244660ce368SMatthias Ringwald if (att_iterator_match_uuid16(&it, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION)){ 1245660ce368SMatthias Ringwald return it.handle; 1246660ce368SMatthias Ringwald } 1247660ce368SMatthias Ringwald } 1248660ce368SMatthias Ringwald return 0; 1249660ce368SMatthias Ringwald } 1250660ce368SMatthias Ringwald 12518b1d64c6SMatthias Ringwald // 1-item cache to optimize query during write_callback 1252fd75a1c5SMatthias Ringwald static void att_persistent_ccc_cache(att_iterator_t * it){ 1253fd75a1c5SMatthias Ringwald att_persistent_ccc_handle = it->handle; 1254fd75a1c5SMatthias Ringwald if (it->flags & ATT_PROPERTY_UUID128){ 1255fd75a1c5SMatthias Ringwald att_persistent_ccc_uuid16 = 0; 1256fd75a1c5SMatthias Ringwald } else { 1257fd75a1c5SMatthias Ringwald att_persistent_ccc_uuid16 = little_endian_read_16(it->uuid, 0); 1258fd75a1c5SMatthias Ringwald } 12598b1d64c6SMatthias Ringwald } 12608b1d64c6SMatthias Ringwald 12618b1d64c6SMatthias Ringwald int att_is_persistent_ccc(uint16_t handle){ 1262fd75a1c5SMatthias Ringwald if (handle != att_persistent_ccc_handle){ 12638b1d64c6SMatthias Ringwald att_iterator_t it; 12648b1d64c6SMatthias Ringwald int ok = att_find_handle(&it, handle); 1265fd75a1c5SMatthias Ringwald if (!ok) return 0; 1266fd75a1c5SMatthias Ringwald att_persistent_ccc_cache(&it); 12678b1d64c6SMatthias Ringwald } 1268fd75a1c5SMatthias Ringwald return att_persistent_ccc_uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION; 12698b1d64c6SMatthias Ringwald } 12708b1d64c6SMatthias Ringwald 1271bfd413f0SMatthias Ringwald // att_read_callback helpers 1272bfd413f0SMatthias Ringwald uint16_t att_read_callback_handle_blob(const uint8_t * blob, uint16_t blob_size, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){ 1273bfd413f0SMatthias Ringwald if (buffer){ 1274bfd413f0SMatthias Ringwald uint16_t bytes_to_copy = btstack_min(blob_size - offset, buffer_size); 1275bfd413f0SMatthias Ringwald memcpy(buffer, &blob[offset], bytes_to_copy); 1276bfd413f0SMatthias Ringwald return bytes_to_copy; 1277bfd413f0SMatthias Ringwald } else { 1278bfd413f0SMatthias Ringwald return blob_size; 1279bfd413f0SMatthias Ringwald } 1280bfd413f0SMatthias Ringwald } 1281bfd413f0SMatthias Ringwald 1282bfd413f0SMatthias Ringwald uint16_t att_read_callback_handle_little_endian_32(uint32_t value, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){ 1283bfd413f0SMatthias Ringwald uint8_t value_buffer[4]; 1284bfd413f0SMatthias Ringwald little_endian_store_32(value_buffer, 0, value); 1285bfd413f0SMatthias Ringwald return att_read_callback_handle_blob(value_buffer, sizeof(value_buffer), offset, buffer, buffer_size); 1286bfd413f0SMatthias Ringwald } 1287bfd413f0SMatthias Ringwald 1288bfd413f0SMatthias Ringwald uint16_t att_read_callback_handle_little_endian_16(uint16_t value, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){ 1289bfd413f0SMatthias Ringwald uint8_t value_buffer[2]; 1290bfd413f0SMatthias Ringwald little_endian_store_16(value_buffer, 0, value); 1291bfd413f0SMatthias Ringwald return att_read_callback_handle_blob(value_buffer, sizeof(value_buffer), offset, buffer, buffer_size); 1292bfd413f0SMatthias Ringwald } 1293bfd413f0SMatthias Ringwald 1294bfd413f0SMatthias Ringwald uint16_t att_read_callback_handle_byte(uint8_t value, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){ 1295bfd413f0SMatthias Ringwald uint8_t value_buffer[1]; 1296bfd413f0SMatthias Ringwald value_buffer[0] = value; 1297bfd413f0SMatthias Ringwald return att_read_callback_handle_blob(value_buffer, sizeof(value_buffer), offset, buffer, buffer_size); 1298bfd413f0SMatthias Ringwald } 1299