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 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "att_db.c" 39ab2c6ae4SMatthias Ringwald 40591423b2SMatthias Ringwald #include <string.h> 41591423b2SMatthias Ringwald 42591423b2SMatthias Ringwald #include "ble/att_db.h" 4359c6af15SMatthias Ringwald #include "ble/core.h" 448ac574d6SMatthias Ringwald #include "bluetooth.h" 45591423b2SMatthias Ringwald #include "btstack_debug.h" 46591423b2SMatthias Ringwald #include "btstack_util.h" 47591423b2SMatthias Ringwald 4884536330SMatthias Ringwald // check for ENABLE_ATT_DELAYED_READ_RESPONSE -> ENABLE_ATT_DELAYED_RESPONSE, 4984536330SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_READ_RESPONSE 5084536330SMatthias Ringwald #error "ENABLE_ATT_DELAYED_READ_RESPONSE was replaced by ENABLE_ATT_DELAYED_RESPONSE. Please update btstack_config.h" 5184536330SMatthias Ringwald #endif 5284536330SMatthias Ringwald 539d622fdeSMatthias Ringwald typedef enum { 549d622fdeSMatthias Ringwald ATT_READ, 559d622fdeSMatthias Ringwald ATT_WRITE, 569d622fdeSMatthias Ringwald } att_operation_t; 579d622fdeSMatthias Ringwald 58591423b2SMatthias Ringwald 59591423b2SMatthias Ringwald static int is_Bluetooth_Base_UUID(uint8_t const *uuid){ 608334d3d8SMatthias Ringwald // Bluetooth Base UUID 00000000-0000-1000-8000-00805F9B34FB in little endian 618334d3d8SMatthias Ringwald static const uint8_t bluetooth_base_uuid[] = { 0xfb, 0x34, 0x9b, 0x5f, 0x80, 0x00, 0x00, 0x80, 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; 628334d3d8SMatthias Ringwald 634d5915b3SMatthias Ringwald if (memcmp(&uuid[0], &bluetooth_base_uuid[0], 12) != 0) return false; 644d5915b3SMatthias Ringwald if (memcmp(&uuid[14], &bluetooth_base_uuid[14], 2) != 0) return false; 654d5915b3SMatthias Ringwald return true; 66591423b2SMatthias Ringwald 67591423b2SMatthias Ringwald } 68591423b2SMatthias Ringwald 69591423b2SMatthias Ringwald static uint16_t uuid16_from_uuid(uint16_t uuid_len, uint8_t * uuid){ 704ea43905SMatthias Ringwald if (uuid_len == 2u) return little_endian_read_16(uuid, 0u); 71591423b2SMatthias Ringwald if (!is_Bluetooth_Base_UUID(uuid)) return 0; 72591423b2SMatthias Ringwald return little_endian_read_16(uuid, 12); 73591423b2SMatthias Ringwald } 74591423b2SMatthias Ringwald 75591423b2SMatthias Ringwald // ATT Database 768b1d64c6SMatthias Ringwald 77591423b2SMatthias Ringwald // new java-style iterator 78591423b2SMatthias Ringwald typedef struct att_iterator { 79591423b2SMatthias Ringwald // private 80591423b2SMatthias Ringwald uint8_t const * att_ptr; 81591423b2SMatthias Ringwald // public 82591423b2SMatthias Ringwald uint16_t size; 83591423b2SMatthias Ringwald uint16_t flags; 84591423b2SMatthias Ringwald uint16_t handle; 85591423b2SMatthias Ringwald uint8_t const * uuid; 86591423b2SMatthias Ringwald uint16_t value_len; 87591423b2SMatthias Ringwald uint8_t const * value; 88591423b2SMatthias Ringwald } att_iterator_t; 89591423b2SMatthias Ringwald 90fd75a1c5SMatthias Ringwald static void att_persistent_ccc_cache(att_iterator_t * it); 9151e0c94cSMatthias Ringwald 9251e0c94cSMatthias Ringwald static uint8_t const * att_db = NULL; 9351e0c94cSMatthias Ringwald static att_read_callback_t att_read_callback = NULL; 9451e0c94cSMatthias Ringwald static att_write_callback_t att_write_callback = NULL; 9556c3a347SMatthias Ringwald static int att_prepare_write_error_code = 0; 9651e0c94cSMatthias Ringwald static uint16_t att_prepare_write_error_handle = 0x0000; 9751e0c94cSMatthias Ringwald 9851e0c94cSMatthias Ringwald // single cache for att_is_persistent_ccc - stores flags before write callback 9951e0c94cSMatthias Ringwald static uint16_t att_persistent_ccc_handle; 100fd75a1c5SMatthias Ringwald static uint16_t att_persistent_ccc_uuid16; 10151e0c94cSMatthias Ringwald 102591423b2SMatthias Ringwald static void att_iterator_init(att_iterator_t *it){ 103591423b2SMatthias Ringwald it->att_ptr = att_db; 104591423b2SMatthias Ringwald } 105591423b2SMatthias Ringwald 1064d5915b3SMatthias Ringwald static bool att_iterator_has_next(att_iterator_t *it){ 107591423b2SMatthias Ringwald return it->att_ptr != NULL; 108591423b2SMatthias Ringwald } 109591423b2SMatthias Ringwald 110591423b2SMatthias Ringwald static void att_iterator_fetch_next(att_iterator_t *it){ 111591423b2SMatthias Ringwald it->size = little_endian_read_16(it->att_ptr, 0); 1124ea43905SMatthias Ringwald if (it->size == 0u){ 113591423b2SMatthias Ringwald it->flags = 0; 114591423b2SMatthias Ringwald it->handle = 0; 115591423b2SMatthias Ringwald it->uuid = NULL; 116591423b2SMatthias Ringwald it->value_len = 0; 117591423b2SMatthias Ringwald it->value = NULL; 118591423b2SMatthias Ringwald it->att_ptr = NULL; 119591423b2SMatthias Ringwald return; 120591423b2SMatthias Ringwald } 121591423b2SMatthias Ringwald it->flags = little_endian_read_16(it->att_ptr, 2); 122591423b2SMatthias Ringwald it->handle = little_endian_read_16(it->att_ptr, 4); 123591423b2SMatthias Ringwald it->uuid = &it->att_ptr[6]; 124591423b2SMatthias Ringwald // handle 128 bit UUIDs 1254ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_UUID128) != 0u){ 1264ea43905SMatthias Ringwald it->value_len = it->size - 22u; 127591423b2SMatthias Ringwald it->value = &it->att_ptr[22]; 128591423b2SMatthias Ringwald } else { 1294ea43905SMatthias Ringwald it->value_len = it->size - 8u; 130591423b2SMatthias Ringwald it->value = &it->att_ptr[8]; 131591423b2SMatthias Ringwald } 132591423b2SMatthias Ringwald // advance AFTER setting values 133591423b2SMatthias Ringwald it->att_ptr += it->size; 134591423b2SMatthias Ringwald } 135591423b2SMatthias Ringwald 136591423b2SMatthias Ringwald static int att_iterator_match_uuid16(att_iterator_t *it, uint16_t uuid){ 1374ea43905SMatthias Ringwald if (it->handle == 0u) return 0u; 138591423b2SMatthias Ringwald if (it->flags & ATT_PROPERTY_UUID128){ 139591423b2SMatthias Ringwald if (!is_Bluetooth_Base_UUID(it->uuid)) return 0; 140591423b2SMatthias Ringwald return little_endian_read_16(it->uuid, 12) == uuid; 141591423b2SMatthias Ringwald } 142591423b2SMatthias Ringwald return little_endian_read_16(it->uuid, 0) == uuid; 143591423b2SMatthias Ringwald } 144591423b2SMatthias Ringwald 145591423b2SMatthias Ringwald static int att_iterator_match_uuid(att_iterator_t *it, uint8_t *uuid, uint16_t uuid_len){ 1464ea43905SMatthias Ringwald if (it->handle == 0u) return 0u; 147591423b2SMatthias Ringwald // input: UUID16 1484ea43905SMatthias Ringwald if (uuid_len == 2u) { 149591423b2SMatthias Ringwald return att_iterator_match_uuid16(it, little_endian_read_16(uuid, 0)); 150591423b2SMatthias Ringwald } 151591423b2SMatthias Ringwald // input and db: UUID128 1524ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_UUID128) != 0u){ 153591423b2SMatthias Ringwald return memcmp(it->uuid, uuid, 16) == 0; 154591423b2SMatthias Ringwald } 155591423b2SMatthias Ringwald // input: UUID128, db: UUID16 156591423b2SMatthias Ringwald if (!is_Bluetooth_Base_UUID(uuid)) return 0; 157591423b2SMatthias Ringwald return little_endian_read_16(uuid, 12) == little_endian_read_16(it->uuid, 0); 158591423b2SMatthias Ringwald } 159591423b2SMatthias Ringwald 160591423b2SMatthias Ringwald 161591423b2SMatthias Ringwald static int att_find_handle(att_iterator_t *it, uint16_t handle){ 1624ea43905SMatthias Ringwald if (handle == 0u) return 0u; 163591423b2SMatthias Ringwald att_iterator_init(it); 164591423b2SMatthias Ringwald while (att_iterator_has_next(it)){ 165591423b2SMatthias Ringwald att_iterator_fetch_next(it); 166591423b2SMatthias Ringwald if (it->handle != handle) continue; 167591423b2SMatthias Ringwald return 1; 168591423b2SMatthias Ringwald } 169591423b2SMatthias Ringwald return 0; 170591423b2SMatthias Ringwald } 171591423b2SMatthias Ringwald 172591423b2SMatthias Ringwald // experimental client API 173fc64f94aSMatthias Ringwald uint16_t att_uuid_for_handle(uint16_t attribute_handle){ 174591423b2SMatthias Ringwald att_iterator_t it; 175fc64f94aSMatthias Ringwald int ok = att_find_handle(&it, attribute_handle); 176591423b2SMatthias Ringwald if (!ok) return 0; 1774ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_UUID128) != 0u) return 0u; 178591423b2SMatthias Ringwald return little_endian_read_16(it.uuid, 0); 179591423b2SMatthias Ringwald } 180591423b2SMatthias Ringwald // end of client API 181591423b2SMatthias Ringwald 182711e6c80SMatthias Ringwald static void att_update_value_len(att_iterator_t *it, hci_con_handle_t con_handle){ 1834ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_DYNAMIC) == 0u) return; 1843d71c7a4SMatthias Ringwald it->value_len = (*att_read_callback)(con_handle, it->handle, 0, NULL, 0); 185591423b2SMatthias Ringwald return; 186591423b2SMatthias Ringwald } 187591423b2SMatthias Ringwald 188591423b2SMatthias Ringwald // copy attribute value from offset into buffer with given size 189711e6c80SMatthias 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){ 190591423b2SMatthias Ringwald 191591423b2SMatthias Ringwald // DYNAMIC 1924ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_DYNAMIC) != 0u){ 1933d71c7a4SMatthias Ringwald return (*att_read_callback)(con_handle, it->handle, offset, buffer, buffer_size); 194591423b2SMatthias Ringwald } 195591423b2SMatthias Ringwald 196591423b2SMatthias Ringwald // STATIC 197*27c566a6SMilanka Ringwald uint16_t bytes_to_copy = btstack_min(it->value_len - offset, buffer_size); 1986535961aSMatthias Ringwald (void)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){ 203fd1be25dSMatthias Ringwald // validate db version 204fd1be25dSMatthias Ringwald if (db == NULL) return; 205fd1be25dSMatthias Ringwald if (*db++ != ATT_DB_VERSION){ 206fd1be25dSMatthias Ringwald log_error("ATT DB version differs, please regenerate .h from .gatt file or update att_db_util.c"); 207fd1be25dSMatthias Ringwald return; 208fd1be25dSMatthias Ringwald } 209e7733bf2SMatthias Ringwald log_info("att_set_db %p", db); 210591423b2SMatthias Ringwald att_db = db; 211591423b2SMatthias Ringwald } 212591423b2SMatthias Ringwald 213591423b2SMatthias Ringwald void att_set_read_callback(att_read_callback_t callback){ 214591423b2SMatthias Ringwald att_read_callback = callback; 215591423b2SMatthias Ringwald } 216591423b2SMatthias Ringwald 217591423b2SMatthias Ringwald void att_set_write_callback(att_write_callback_t callback){ 218591423b2SMatthias Ringwald att_write_callback = callback; 219591423b2SMatthias Ringwald } 220591423b2SMatthias Ringwald 221591423b2SMatthias Ringwald void att_dump_attributes(void){ 222591423b2SMatthias Ringwald att_iterator_t it; 223591423b2SMatthias Ringwald att_iterator_init(&it); 224591423b2SMatthias Ringwald uint8_t uuid128[16]; 22542d64f2dSMatthias Ringwald log_info("att_dump_attributes, table %p", att_db); 226591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 227591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 2284ea43905SMatthias Ringwald if (it.handle == 0u) { 229591423b2SMatthias Ringwald log_info("Handle: END"); 230591423b2SMatthias Ringwald return; 231591423b2SMatthias Ringwald } 232591423b2SMatthias Ringwald log_info("Handle: 0x%04x, flags: 0x%04x, uuid: ", it.handle, it.flags); 2334ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_UUID128) != 0u){ 234591423b2SMatthias Ringwald reverse_128(it.uuid, uuid128); 235591423b2SMatthias Ringwald log_info("%s", uuid128_to_str(uuid128)); 236591423b2SMatthias Ringwald } else { 237591423b2SMatthias Ringwald log_info("%04x", little_endian_read_16(it.uuid, 0)); 238591423b2SMatthias Ringwald } 239591423b2SMatthias Ringwald log_info(", value_len: %u, value: ", it.value_len); 240591423b2SMatthias Ringwald log_info_hexdump(it.value, it.value_len); 241591423b2SMatthias Ringwald } 242591423b2SMatthias Ringwald } 243591423b2SMatthias Ringwald 244591423b2SMatthias Ringwald static void att_prepare_write_reset(void){ 245591423b2SMatthias Ringwald att_prepare_write_error_code = 0; 246591423b2SMatthias Ringwald att_prepare_write_error_handle = 0x0000; 247591423b2SMatthias Ringwald } 248591423b2SMatthias Ringwald 249591423b2SMatthias Ringwald static void att_prepare_write_update_errors(uint8_t error_code, uint16_t handle){ 250591423b2SMatthias Ringwald // first ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH has highest priority 251c1ab6cc1SMatthias Ringwald if ((error_code == ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH) && (error_code != att_prepare_write_error_code)){ 252591423b2SMatthias Ringwald att_prepare_write_error_code = error_code; 253591423b2SMatthias Ringwald att_prepare_write_error_handle = handle; 254591423b2SMatthias Ringwald return; 255591423b2SMatthias Ringwald } 256591423b2SMatthias Ringwald // first ATT_ERROR_INVALID_OFFSET is next 257c1ab6cc1SMatthias Ringwald if ((error_code == ATT_ERROR_INVALID_OFFSET) && (att_prepare_write_error_code == 0)){ 258591423b2SMatthias Ringwald att_prepare_write_error_code = error_code; 259591423b2SMatthias Ringwald att_prepare_write_error_handle = handle; 260591423b2SMatthias Ringwald return; 261591423b2SMatthias Ringwald } 262591423b2SMatthias Ringwald } 263591423b2SMatthias Ringwald 264591423b2SMatthias Ringwald static uint16_t setup_error(uint8_t * response_buffer, uint16_t request, uint16_t handle, uint8_t error_code){ 265591423b2SMatthias Ringwald response_buffer[0] = ATT_ERROR_RESPONSE; 266591423b2SMatthias Ringwald response_buffer[1] = request; 267591423b2SMatthias Ringwald little_endian_store_16(response_buffer, 2, handle); 268591423b2SMatthias Ringwald response_buffer[4] = error_code; 269591423b2SMatthias Ringwald return 5; 270591423b2SMatthias Ringwald } 271591423b2SMatthias Ringwald 272591423b2SMatthias Ringwald static inline uint16_t setup_error_read_not_permitted(uint8_t * response_buffer, uint16_t request, uint16_t start_handle){ 273591423b2SMatthias Ringwald return setup_error(response_buffer, request, start_handle, ATT_ERROR_READ_NOT_PERMITTED); 274591423b2SMatthias Ringwald } 275591423b2SMatthias Ringwald 276591423b2SMatthias Ringwald static inline uint16_t setup_error_write_not_permitted(uint8_t * response_buffer, uint16_t request, uint16_t start_handle){ 277591423b2SMatthias Ringwald return setup_error(response_buffer, request, start_handle, ATT_ERROR_WRITE_NOT_PERMITTED); 278591423b2SMatthias Ringwald } 279591423b2SMatthias Ringwald 280591423b2SMatthias Ringwald static inline uint16_t setup_error_atribute_not_found(uint8_t * response_buffer, uint16_t request, uint16_t start_handle){ 281591423b2SMatthias Ringwald return setup_error(response_buffer, request, start_handle, ATT_ERROR_ATTRIBUTE_NOT_FOUND); 282591423b2SMatthias Ringwald } 283591423b2SMatthias Ringwald 284591423b2SMatthias Ringwald static inline uint16_t setup_error_invalid_handle(uint8_t * response_buffer, uint16_t request, uint16_t handle){ 285591423b2SMatthias Ringwald return setup_error(response_buffer, request, handle, ATT_ERROR_INVALID_HANDLE); 286591423b2SMatthias Ringwald } 287591423b2SMatthias Ringwald 288591423b2SMatthias Ringwald static inline uint16_t setup_error_invalid_offset(uint8_t * response_buffer, uint16_t request, uint16_t handle){ 289591423b2SMatthias Ringwald return setup_error(response_buffer, request, handle, ATT_ERROR_INVALID_OFFSET); 290591423b2SMatthias Ringwald } 291591423b2SMatthias Ringwald 2929b49c4f4SMatthias Ringwald static inline uint16_t setup_error_invalid_pdu(uint8_t *response_buffer, uint16_t request) { 2939b49c4f4SMatthias Ringwald return setup_error(response_buffer, request, 0, ATT_ERROR_INVALID_PDU); 2949b49c4f4SMatthias Ringwald } 2959b49c4f4SMatthias Ringwald 2969d622fdeSMatthias Ringwald static uint8_t att_validate_security(att_connection_t * att_connection, att_operation_t operation, att_iterator_t * it){ 2971dd680d7SMatthias Ringwald int required_security_level = 0; 2984ea43905SMatthias Ringwald bool requires_secure_connection = false; 2991dd680d7SMatthias Ringwald switch (operation){ 3001dd680d7SMatthias Ringwald case ATT_READ: 3014ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_READ_PERMISSION_BIT_0) != 0u){ 3021dd680d7SMatthias Ringwald required_security_level |= 1; 3031dd680d7SMatthias Ringwald } 3044ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_READ_PERMISSION_BIT_1) != 0u){ 3051dd680d7SMatthias Ringwald required_security_level |= 2; 3061dd680d7SMatthias Ringwald } 3074ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_READ_PERMISSION_SC) != 0u){ 3084ea43905SMatthias Ringwald requires_secure_connection = true; 30996304e93SMatthias Ringwald } 3101dd680d7SMatthias Ringwald break; 3111dd680d7SMatthias Ringwald case ATT_WRITE: 3124ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_WRITE_PERMISSION_BIT_0) != 0u){ 3131dd680d7SMatthias Ringwald required_security_level |= 1; 3141dd680d7SMatthias Ringwald } 3154ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_WRITE_PERMISSION_BIT_1) != 0u){ 3161dd680d7SMatthias Ringwald required_security_level |= 2; 3171dd680d7SMatthias Ringwald } 3184ea43905SMatthias Ringwald if ((it->flags & ATT_PROPERTY_WRITE_PERMISSION_SC) != 0u){ 3194ea43905SMatthias Ringwald requires_secure_connection = true; 32096304e93SMatthias Ringwald } 3211dd680d7SMatthias Ringwald break; 3221dd680d7SMatthias Ringwald } 3231dd680d7SMatthias Ringwald 3244ea43905SMatthias Ringwald uint8_t required_encryption_size = it->flags >> 12; 3254d5915b3SMatthias Ringwald if (required_encryption_size != 0) required_encryption_size++; // store -1 to fit into 4 bit 3261dd680d7SMatthias Ringwald 3272ea28401SMatthias Ringwald log_debug("att_validate_security. flags 0x%04x (=> security level %u, key size %u) authorized %u, authenticated %u, encryption_key_size %u, secure connection %u", 3282ea28401SMatthias Ringwald it->flags, required_security_level, required_encryption_size, att_connection->authorized, att_connection->authenticated, att_connection->encryption_key_size, att_connection->secure_connection); 3291dd680d7SMatthias Ringwald 3304ea43905SMatthias Ringwald bool sc_missing = requires_secure_connection && (att_connection->secure_connection == 0u); 3312ea28401SMatthias Ringwald switch (required_security_level){ 3322ea28401SMatthias Ringwald case ATT_SECURITY_AUTHORIZED: 3334ea43905SMatthias Ringwald if ((att_connection->authorized == 0u) || sc_missing){ 334591423b2SMatthias Ringwald return ATT_ERROR_INSUFFICIENT_AUTHORIZATION; 335591423b2SMatthias Ringwald } 336cf373d3aSMatthias Ringwald /* fall through */ 3372ea28401SMatthias Ringwald case ATT_SECURITY_AUTHENTICATED: 3384ea43905SMatthias Ringwald if ((att_connection->authenticated == 0u) || sc_missing){ 3391dd680d7SMatthias Ringwald return ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 3401dd680d7SMatthias Ringwald } 341cf373d3aSMatthias Ringwald /* fall through */ 3422ea28401SMatthias Ringwald case ATT_SECURITY_ENCRYPTED: 3434ea43905SMatthias Ringwald if ((required_encryption_size > 0u) && ((att_connection->encryption_key_size == 0u) || sc_missing)){ 344591423b2SMatthias Ringwald return ATT_ERROR_INSUFFICIENT_ENCRYPTION; 345591423b2SMatthias Ringwald } 346591423b2SMatthias Ringwald if (required_encryption_size > att_connection->encryption_key_size){ 347591423b2SMatthias Ringwald return ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE; 348591423b2SMatthias Ringwald } 3492ea28401SMatthias Ringwald break; 3502ea28401SMatthias Ringwald default: 3512ea28401SMatthias Ringwald break; 3521dd680d7SMatthias Ringwald } 353602e97cdSMilanka Ringwald return ATT_ERROR_SUCCESS; 354591423b2SMatthias Ringwald } 355591423b2SMatthias Ringwald 356591423b2SMatthias Ringwald // 357591423b2SMatthias Ringwald // MARK: ATT_EXCHANGE_MTU_REQUEST 358591423b2SMatthias Ringwald // 359591423b2SMatthias Ringwald static uint16_t handle_exchange_mtu_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 360591423b2SMatthias Ringwald uint8_t * response_buffer){ 361591423b2SMatthias Ringwald 3624ea43905SMatthias Ringwald if (request_len != 3u) return setup_error_invalid_pdu(response_buffer, ATT_EXCHANGE_MTU_REQUEST); 3639ec2630cSMatthias Ringwald 364591423b2SMatthias Ringwald uint16_t client_rx_mtu = little_endian_read_16(request_buffer, 1); 365591423b2SMatthias Ringwald 366d60453d1SMatthias Ringwald // find min(local max mtu, remote mtu) >= ATT_DEFAULT_MTU and use as mtu for this connection 367d60453d1SMatthias Ringwald uint16_t min_mtu = btstack_min(client_rx_mtu, att_connection->max_mtu); 368d60453d1SMatthias Ringwald uint16_t new_mtu = btstack_max(ATT_DEFAULT_MTU, min_mtu); 369d60453d1SMatthias Ringwald att_connection->mtu = new_mtu; 370591423b2SMatthias Ringwald 371591423b2SMatthias Ringwald response_buffer[0] = ATT_EXCHANGE_MTU_RESPONSE; 372591423b2SMatthias Ringwald little_endian_store_16(response_buffer, 1, att_connection->mtu); 373591423b2SMatthias Ringwald return 3; 374591423b2SMatthias Ringwald } 375591423b2SMatthias Ringwald 376591423b2SMatthias Ringwald 377591423b2SMatthias Ringwald // 378591423b2SMatthias Ringwald // MARK: ATT_FIND_INFORMATION_REQUEST 379591423b2SMatthias Ringwald // 380591423b2SMatthias Ringwald // TODO: handle other types then GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID 381591423b2SMatthias Ringwald // 382591423b2SMatthias Ringwald static uint16_t handle_find_information_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, 383591423b2SMatthias Ringwald uint16_t start_handle, uint16_t end_handle){ 384591423b2SMatthias Ringwald 3859ec2630cSMatthias Ringwald UNUSED(att_connection); 3869ec2630cSMatthias Ringwald 387591423b2SMatthias Ringwald log_info("ATT_FIND_INFORMATION_REQUEST: from %04X to %04X", start_handle, end_handle); 388591423b2SMatthias Ringwald uint8_t request_type = ATT_FIND_INFORMATION_REQUEST; 389591423b2SMatthias Ringwald 3904ea43905SMatthias Ringwald if ((start_handle > end_handle) || (start_handle == 0u)){ 391591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, start_handle); 392591423b2SMatthias Ringwald } 393591423b2SMatthias Ringwald 394591423b2SMatthias Ringwald uint16_t offset = 1; 395591423b2SMatthias Ringwald uint16_t uuid_len = 0; 396591423b2SMatthias Ringwald 397591423b2SMatthias Ringwald att_iterator_t it; 398591423b2SMatthias Ringwald att_iterator_init(&it); 399591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 400591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 401591423b2SMatthias Ringwald if (!it.handle) break; 402591423b2SMatthias Ringwald if (it.handle > end_handle) break; 403591423b2SMatthias Ringwald if (it.handle < start_handle) continue; 404591423b2SMatthias Ringwald 405591423b2SMatthias Ringwald // log_info("Handle 0x%04x", it.handle); 406591423b2SMatthias Ringwald 407591423b2SMatthias Ringwald uint16_t this_uuid_len = (it.flags & ATT_PROPERTY_UUID128) ? 16 : 2; 408591423b2SMatthias Ringwald 409591423b2SMatthias Ringwald // check if value has same len as last one if not first result 4104ea43905SMatthias Ringwald if (offset > 1u){ 411591423b2SMatthias Ringwald if (this_uuid_len != uuid_len) { 412591423b2SMatthias Ringwald break; 413591423b2SMatthias Ringwald } 414591423b2SMatthias Ringwald } 415591423b2SMatthias Ringwald 416591423b2SMatthias Ringwald // first 4174ea43905SMatthias Ringwald if (offset == 1u) { 418591423b2SMatthias Ringwald uuid_len = this_uuid_len; 419591423b2SMatthias Ringwald // set format field 420591423b2SMatthias Ringwald response_buffer[offset] = (it.flags & ATT_PROPERTY_UUID128) ? 0x02 : 0x01; 421591423b2SMatthias Ringwald offset++; 422591423b2SMatthias Ringwald } 423591423b2SMatthias Ringwald 424591423b2SMatthias Ringwald // space? 4254ea43905SMatthias Ringwald if ((offset + 2u + uuid_len) > response_buffer_size) break; 426591423b2SMatthias Ringwald 427591423b2SMatthias Ringwald // store 428591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, it.handle); 4294ea43905SMatthias Ringwald offset += 2u; 430591423b2SMatthias Ringwald 4316535961aSMatthias Ringwald (void)memcpy(response_buffer + offset, it.uuid, uuid_len); 432591423b2SMatthias Ringwald offset += uuid_len; 433591423b2SMatthias Ringwald } 434591423b2SMatthias Ringwald 4354ea43905SMatthias Ringwald if (offset == 1u){ 436591423b2SMatthias Ringwald return setup_error_atribute_not_found(response_buffer, request_type, start_handle); 437591423b2SMatthias Ringwald } 438591423b2SMatthias Ringwald 439591423b2SMatthias Ringwald response_buffer[0] = ATT_FIND_INFORMATION_REPLY; 440591423b2SMatthias Ringwald return offset; 441591423b2SMatthias Ringwald } 442591423b2SMatthias Ringwald 443591423b2SMatthias Ringwald static uint16_t handle_find_information_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 444591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 4459b49c4f4SMatthias Ringwald 4464ea43905SMatthias Ringwald if (request_len != 5u) return setup_error_invalid_pdu(response_buffer, ATT_FIND_INFORMATION_REQUEST); 4479b49c4f4SMatthias Ringwald 4489b49c4f4SMatthias Ringwald uint16_t start_handle = little_endian_read_16(request_buffer, 1); 4499b49c4f4SMatthias Ringwald uint16_t end_handle = little_endian_read_16(request_buffer, 3); 4509b49c4f4SMatthias Ringwald return handle_find_information_request2(att_connection, response_buffer, response_buffer_size, start_handle, end_handle); 451591423b2SMatthias Ringwald } 452591423b2SMatthias Ringwald 453591423b2SMatthias Ringwald // 454591423b2SMatthias Ringwald // MARK: ATT_FIND_BY_TYPE_VALUE 455591423b2SMatthias Ringwald // 456591423b2SMatthias Ringwald // "Only attributes with attribute handles between and including the Starting Handle parameter 457591423b2SMatthias Ringwald // and the Ending Handle parameter that match the requested attri- bute type and the attribute 458591423b2SMatthias Ringwald // value that have sufficient permissions to allow reading will be returned" -> (1) 459591423b2SMatthias Ringwald // 460591423b2SMatthias Ringwald // TODO: handle other types then GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID 461591423b2SMatthias Ringwald // 462591423b2SMatthias Ringwald // NOTE: doesn't handle DYNAMIC values 463591423b2SMatthias Ringwald // NOTE: only supports 16 bit UUIDs 464591423b2SMatthias Ringwald // 465883180d3SMatthias Ringwald static uint16_t handle_find_by_type_value_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 466883180d3SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 4679ec2630cSMatthias Ringwald UNUSED(att_connection); 4689ec2630cSMatthias Ringwald 4694ea43905SMatthias Ringwald if (request_len < 7u) return setup_error_invalid_pdu(response_buffer, ATT_FIND_BY_TYPE_VALUE_REQUEST); 4709b49c4f4SMatthias Ringwald 471883180d3SMatthias Ringwald // parse request 472883180d3SMatthias Ringwald uint16_t start_handle = little_endian_read_16(request_buffer, 1); 473883180d3SMatthias Ringwald uint16_t end_handle = little_endian_read_16(request_buffer, 3); 474883180d3SMatthias Ringwald uint16_t attribute_type = little_endian_read_16(request_buffer, 5); 475883180d3SMatthias Ringwald const uint8_t *attribute_value = &request_buffer[7]; 4764ea43905SMatthias Ringwald uint16_t attribute_len = request_len - 7u; 477883180d3SMatthias Ringwald 478591423b2SMatthias Ringwald log_info("ATT_FIND_BY_TYPE_VALUE_REQUEST: from %04X to %04X, type %04X, value: ", start_handle, end_handle, attribute_type); 479591423b2SMatthias Ringwald log_info_hexdump(attribute_value, attribute_len); 480591423b2SMatthias Ringwald uint8_t request_type = ATT_FIND_BY_TYPE_VALUE_REQUEST; 481591423b2SMatthias Ringwald 4824ea43905SMatthias Ringwald if ((start_handle > end_handle) || (start_handle == 0u)){ 483591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, start_handle); 484591423b2SMatthias Ringwald } 485591423b2SMatthias Ringwald 486591423b2SMatthias Ringwald uint16_t offset = 1; 487591423b2SMatthias Ringwald uint16_t in_group = 0; 488591423b2SMatthias Ringwald uint16_t prev_handle = 0; 489591423b2SMatthias Ringwald 490591423b2SMatthias Ringwald att_iterator_t it; 491591423b2SMatthias Ringwald att_iterator_init(&it); 492591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 493591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 494591423b2SMatthias Ringwald 495c1ab6cc1SMatthias Ringwald if (it.handle && (it.handle < start_handle)) continue; 496591423b2SMatthias Ringwald if (it.handle > end_handle) break; // (1) 497591423b2SMatthias Ringwald 498591423b2SMatthias Ringwald // close current tag, if within a group and a new service definition starts or we reach end of att db 499591423b2SMatthias Ringwald if (in_group && 5004ea43905SMatthias Ringwald ((it.handle == 0u) || att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID))){ 501591423b2SMatthias Ringwald 502591423b2SMatthias Ringwald log_info("End of group, handle 0x%04x", prev_handle); 503591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, prev_handle); 5044ea43905SMatthias Ringwald offset += 2u; 505591423b2SMatthias Ringwald in_group = 0; 506591423b2SMatthias Ringwald 507591423b2SMatthias Ringwald // check if space for another handle pair available 5084ea43905SMatthias Ringwald if ((offset + 4u) > response_buffer_size){ 509591423b2SMatthias Ringwald break; 510591423b2SMatthias Ringwald } 511591423b2SMatthias Ringwald } 512591423b2SMatthias Ringwald 513591423b2SMatthias Ringwald // keep track of previous handle 514591423b2SMatthias Ringwald prev_handle = it.handle; 515591423b2SMatthias Ringwald 516591423b2SMatthias Ringwald // does current attribute match 5175df9dc78SMatthias 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)){ 518591423b2SMatthias Ringwald log_info("Begin of group, handle 0x%04x", it.handle); 519591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, it.handle); 5204ea43905SMatthias Ringwald offset += 2u; 521591423b2SMatthias Ringwald in_group = 1; 522591423b2SMatthias Ringwald } 523591423b2SMatthias Ringwald } 524591423b2SMatthias Ringwald 5254ea43905SMatthias Ringwald if (offset == 1u){ 526591423b2SMatthias Ringwald return setup_error_atribute_not_found(response_buffer, request_type, start_handle); 527591423b2SMatthias Ringwald } 528591423b2SMatthias Ringwald 529591423b2SMatthias Ringwald response_buffer[0] = ATT_FIND_BY_TYPE_VALUE_RESPONSE; 530591423b2SMatthias Ringwald return offset; 531591423b2SMatthias Ringwald } 532591423b2SMatthias Ringwald 533591423b2SMatthias Ringwald // 534591423b2SMatthias Ringwald // MARK: ATT_READ_BY_TYPE_REQUEST 535591423b2SMatthias Ringwald // 536591423b2SMatthias Ringwald static uint16_t handle_read_by_type_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, 537591423b2SMatthias Ringwald uint16_t start_handle, uint16_t end_handle, 538591423b2SMatthias Ringwald uint16_t attribute_type_len, uint8_t * attribute_type){ 539591423b2SMatthias Ringwald 540591423b2SMatthias Ringwald log_info("ATT_READ_BY_TYPE_REQUEST: from %04X to %04X, type: ", start_handle, end_handle); 541591423b2SMatthias Ringwald log_info_hexdump(attribute_type, attribute_type_len); 542591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_BY_TYPE_REQUEST; 543591423b2SMatthias Ringwald 5444ea43905SMatthias Ringwald if ((start_handle > end_handle) || (start_handle == 0u)){ 545591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, start_handle); 546591423b2SMatthias Ringwald } 547591423b2SMatthias Ringwald 548591423b2SMatthias Ringwald uint16_t offset = 1; 549591423b2SMatthias Ringwald uint16_t pair_len = 0; 550591423b2SMatthias Ringwald 551591423b2SMatthias Ringwald att_iterator_t it; 552591423b2SMatthias Ringwald att_iterator_init(&it); 553591423b2SMatthias Ringwald uint8_t error_code = 0; 554591423b2SMatthias Ringwald uint16_t first_matching_but_unreadable_handle = 0; 555591423b2SMatthias Ringwald 556591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 557591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 558591423b2SMatthias Ringwald 5594ea43905SMatthias Ringwald if ((it.handle == 0u ) || (it.handle > end_handle)) break; 5603b9a211cSMatthias Ringwald 561591423b2SMatthias Ringwald if (it.handle < start_handle) continue; 562591423b2SMatthias Ringwald 563591423b2SMatthias Ringwald // does current attribute match 564591423b2SMatthias Ringwald if (!att_iterator_match_uuid(&it, attribute_type, attribute_type_len)) continue; 565591423b2SMatthias Ringwald 5663b9a211cSMatthias Ringwald // skip handles that cannot be read but remember that there has been at least one 5674ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_READ) == 0u) { 5684ea43905SMatthias Ringwald if (first_matching_but_unreadable_handle == 0u) { 569591423b2SMatthias Ringwald first_matching_but_unreadable_handle = it.handle; 570591423b2SMatthias Ringwald } 571591423b2SMatthias Ringwald continue; 572591423b2SMatthias Ringwald } 573591423b2SMatthias Ringwald 574591423b2SMatthias Ringwald // check security requirements 5759d622fdeSMatthias Ringwald error_code = att_validate_security(att_connection, ATT_READ, &it); 5764ea43905SMatthias Ringwald if (error_code != 0u) break; 577591423b2SMatthias Ringwald 578591423b2SMatthias Ringwald att_update_value_len(&it, att_connection->con_handle); 579591423b2SMatthias Ringwald 5804f8235e6SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_RESPONSE 581e404a688SMatthias Ringwald if (it.value_len == ATT_READ_RESPONSE_PENDING){ 5823b9a211cSMatthias Ringwald return ATT_READ_RESPONSE_PENDING; 583e404a688SMatthias Ringwald } 584e404a688SMatthias Ringwald #endif 585e404a688SMatthias Ringwald 586591423b2SMatthias Ringwald // check if value has same len as last one 5874ea43905SMatthias Ringwald uint16_t this_pair_len = 2u + it.value_len; 5884ea43905SMatthias Ringwald if ((offset > 1u) && (pair_len != this_pair_len)) { 589591423b2SMatthias Ringwald break; 590591423b2SMatthias Ringwald } 591591423b2SMatthias Ringwald 592591423b2SMatthias Ringwald // first 5934ea43905SMatthias Ringwald if (offset == 1u) { 594591423b2SMatthias Ringwald pair_len = this_pair_len; 595591423b2SMatthias Ringwald response_buffer[offset] = pair_len; 596591423b2SMatthias Ringwald offset++; 597591423b2SMatthias Ringwald } 598591423b2SMatthias Ringwald 599591423b2SMatthias Ringwald // space? 600c1ab6cc1SMatthias Ringwald if ((offset + pair_len) > response_buffer_size) { 6014ea43905SMatthias Ringwald if (offset > 2u) break; 6024ea43905SMatthias Ringwald it.value_len = response_buffer_size - 4u; 6034ea43905SMatthias Ringwald response_buffer[1u] = 2u + it.value_len; 604591423b2SMatthias Ringwald } 605591423b2SMatthias Ringwald 606591423b2SMatthias Ringwald // store 607591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, it.handle); 6084ea43905SMatthias Ringwald offset += 2u; 609591423b2SMatthias Ringwald uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, it.value_len, att_connection->con_handle); 610591423b2SMatthias Ringwald offset += bytes_copied; 611591423b2SMatthias Ringwald } 612591423b2SMatthias Ringwald 613591423b2SMatthias Ringwald // at least one attribute could be read 6144ea43905SMatthias Ringwald if (offset > 1u){ 615591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_BY_TYPE_RESPONSE; 616591423b2SMatthias Ringwald return offset; 617591423b2SMatthias Ringwald } 618591423b2SMatthias Ringwald 619591423b2SMatthias Ringwald // first attribute had an error 6204ea43905SMatthias Ringwald if (error_code != 0u){ 621591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, start_handle, error_code); 622591423b2SMatthias Ringwald } 623591423b2SMatthias Ringwald 624591423b2SMatthias Ringwald // no other errors, but all found attributes had been non-readable 6254ea43905SMatthias Ringwald if (first_matching_but_unreadable_handle != 0u){ 626591423b2SMatthias Ringwald return setup_error_read_not_permitted(response_buffer, request_type, first_matching_but_unreadable_handle); 627591423b2SMatthias Ringwald } 628591423b2SMatthias Ringwald 629591423b2SMatthias Ringwald // attribute not found 630591423b2SMatthias Ringwald return setup_error_atribute_not_found(response_buffer, request_type, start_handle); 631591423b2SMatthias Ringwald } 632591423b2SMatthias Ringwald 633591423b2SMatthias Ringwald static uint16_t handle_read_by_type_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 634591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 6359b49c4f4SMatthias Ringwald 6369b49c4f4SMatthias Ringwald uint16_t attribute_type_len; 6379b49c4f4SMatthias Ringwald switch (request_len){ 6389b49c4f4SMatthias Ringwald case 7: 639591423b2SMatthias Ringwald attribute_type_len = 2; 6409b49c4f4SMatthias Ringwald break; 6419b49c4f4SMatthias Ringwald case 21: 642591423b2SMatthias Ringwald attribute_type_len = 16; 6439b49c4f4SMatthias Ringwald break; 6449b49c4f4SMatthias Ringwald default: 6459b49c4f4SMatthias Ringwald return setup_error_invalid_pdu(response_buffer, ATT_READ_BY_TYPE_REQUEST); 646591423b2SMatthias Ringwald } 6479b49c4f4SMatthias Ringwald 6489b49c4f4SMatthias Ringwald uint16_t start_handle = little_endian_read_16(request_buffer, 1); 6499b49c4f4SMatthias Ringwald uint16_t end_handle = little_endian_read_16(request_buffer, 3); 6509b49c4f4SMatthias Ringwald return handle_read_by_type_request2(att_connection, response_buffer, response_buffer_size, start_handle, end_handle, attribute_type_len, &request_buffer[5]); 651591423b2SMatthias Ringwald } 652591423b2SMatthias Ringwald 653591423b2SMatthias Ringwald // 654591423b2SMatthias Ringwald // MARK: ATT_READ_BY_TYPE_REQUEST 655591423b2SMatthias Ringwald // 656591423b2SMatthias Ringwald static uint16_t handle_read_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, uint16_t handle){ 657591423b2SMatthias Ringwald 658591423b2SMatthias Ringwald log_info("ATT_READ_REQUEST: handle %04x", handle); 659591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_REQUEST; 660591423b2SMatthias Ringwald 661591423b2SMatthias Ringwald att_iterator_t it; 662591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 663591423b2SMatthias Ringwald if (!ok){ 664591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 665591423b2SMatthias Ringwald } 666591423b2SMatthias Ringwald 667591423b2SMatthias Ringwald // check if handle can be read 6684ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_READ) == 0u) { 669591423b2SMatthias Ringwald return setup_error_read_not_permitted(response_buffer, request_type, handle); 670591423b2SMatthias Ringwald } 671591423b2SMatthias Ringwald 672591423b2SMatthias Ringwald // check security requirements 6739d622fdeSMatthias Ringwald uint8_t error_code = att_validate_security(att_connection, ATT_READ, &it); 674591423b2SMatthias Ringwald if (error_code) { 675591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 676591423b2SMatthias Ringwald } 677591423b2SMatthias Ringwald 678591423b2SMatthias Ringwald att_update_value_len(&it, att_connection->con_handle); 679591423b2SMatthias Ringwald 6804f8235e6SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_RESPONSE 681e404a688SMatthias Ringwald if (it.value_len == ATT_READ_RESPONSE_PENDING) return ATT_READ_RESPONSE_PENDING; 682e404a688SMatthias Ringwald #endif 683e404a688SMatthias Ringwald 684591423b2SMatthias Ringwald // store 6856098e908SMatthias Ringwald uint16_t offset = 1; 6866098e908SMatthias Ringwald uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, response_buffer_size - offset, att_connection->con_handle); 687591423b2SMatthias Ringwald offset += bytes_copied; 688591423b2SMatthias Ringwald 689591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_RESPONSE; 690591423b2SMatthias Ringwald return offset; 691591423b2SMatthias Ringwald } 692591423b2SMatthias Ringwald 693591423b2SMatthias Ringwald static uint16_t handle_read_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 694591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 6959b49c4f4SMatthias Ringwald 6964ea43905SMatthias Ringwald if (request_len != 3u) return setup_error_invalid_pdu(response_buffer, ATT_READ_REQUEST); 6979b49c4f4SMatthias Ringwald 6989b49c4f4SMatthias Ringwald uint16_t handle = little_endian_read_16(request_buffer, 1); 6999b49c4f4SMatthias Ringwald return handle_read_request2(att_connection, response_buffer, response_buffer_size, handle); 700591423b2SMatthias Ringwald } 701591423b2SMatthias Ringwald 7029b49c4f4SMatthias Ringwald //s 703591423b2SMatthias Ringwald // MARK: ATT_READ_BLOB_REQUEST 0x0c 704591423b2SMatthias Ringwald // 705591423b2SMatthias 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){ 706591423b2SMatthias Ringwald log_info("ATT_READ_BLOB_REQUEST: handle %04x, offset %u", handle, value_offset); 707591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_BLOB_REQUEST; 708591423b2SMatthias Ringwald 709591423b2SMatthias Ringwald att_iterator_t it; 710591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 711591423b2SMatthias Ringwald if (!ok){ 712591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 713591423b2SMatthias Ringwald } 714591423b2SMatthias Ringwald 715591423b2SMatthias Ringwald // check if handle can be read 7164ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_READ) == 0u) { 717591423b2SMatthias Ringwald return setup_error_read_not_permitted(response_buffer, request_type, handle); 718591423b2SMatthias Ringwald } 719591423b2SMatthias Ringwald 720591423b2SMatthias Ringwald // check security requirements 7219d622fdeSMatthias Ringwald uint8_t error_code = att_validate_security(att_connection, ATT_READ, &it); 722591423b2SMatthias Ringwald if (error_code) { 723591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 724591423b2SMatthias Ringwald } 725591423b2SMatthias Ringwald 726591423b2SMatthias Ringwald att_update_value_len(&it, att_connection->con_handle); 727591423b2SMatthias Ringwald 7284f8235e6SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_RESPONSE 729e404a688SMatthias Ringwald if (it.value_len == ATT_READ_RESPONSE_PENDING) return ATT_READ_RESPONSE_PENDING; 730e404a688SMatthias Ringwald #endif 731e404a688SMatthias Ringwald 732591423b2SMatthias Ringwald if (value_offset > it.value_len){ 733591423b2SMatthias Ringwald return setup_error_invalid_offset(response_buffer, request_type, handle); 734591423b2SMatthias Ringwald } 735591423b2SMatthias Ringwald 736af1b7cdcSMatthias Ringwald // prepare response 737591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_BLOB_RESPONSE; 738af1b7cdcSMatthias Ringwald uint16_t offset = 1; 739af1b7cdcSMatthias Ringwald 740af1b7cdcSMatthias Ringwald // fetch more data if available 741af1b7cdcSMatthias Ringwald if (value_offset < it.value_len){ 742af1b7cdcSMatthias Ringwald uint16_t bytes_copied = att_copy_value(&it, value_offset, &response_buffer[offset], response_buffer_size - offset, att_connection->con_handle); 743af1b7cdcSMatthias Ringwald offset += bytes_copied; 744af1b7cdcSMatthias Ringwald } 745591423b2SMatthias Ringwald return offset; 746591423b2SMatthias Ringwald } 747591423b2SMatthias Ringwald 748591423b2SMatthias Ringwald static uint16_t handle_read_blob_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 749591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 7509b49c4f4SMatthias Ringwald 7514ea43905SMatthias Ringwald if (request_len != 5u) return setup_error_invalid_pdu(response_buffer, ATT_READ_BLOB_REQUEST); 7529b49c4f4SMatthias Ringwald 7539b49c4f4SMatthias Ringwald uint16_t handle = little_endian_read_16(request_buffer, 1); 7549b49c4f4SMatthias Ringwald uint16_t value_offset = little_endian_read_16(request_buffer, 3); 7559b49c4f4SMatthias Ringwald return handle_read_blob_request2(att_connection, response_buffer, response_buffer_size, handle, value_offset); 756591423b2SMatthias Ringwald } 757591423b2SMatthias Ringwald 758591423b2SMatthias Ringwald // 759591423b2SMatthias Ringwald // MARK: ATT_READ_MULTIPLE_REQUEST 0x0e 760591423b2SMatthias Ringwald // 761591423b2SMatthias 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){ 762591423b2SMatthias Ringwald log_info("ATT_READ_MULTIPLE_REQUEST: num handles %u", num_handles); 763591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_MULTIPLE_REQUEST; 764591423b2SMatthias Ringwald 765591423b2SMatthias Ringwald uint16_t offset = 1; 766591423b2SMatthias Ringwald 767591423b2SMatthias Ringwald int i; 768591423b2SMatthias Ringwald uint8_t error_code = 0; 769591423b2SMatthias Ringwald uint16_t handle = 0; 770e404a688SMatthias Ringwald 7714f8235e6SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_RESPONSE 7724d5915b3SMatthias Ringwald bool read_request_pending = false; 773e404a688SMatthias Ringwald #endif 774e404a688SMatthias Ringwald 775591423b2SMatthias Ringwald for (i=0;i<num_handles;i++){ 776591423b2SMatthias Ringwald handle = little_endian_read_16(handles, i << 1); 777591423b2SMatthias Ringwald 7784ea43905SMatthias Ringwald if (handle == 0u){ 779591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 780591423b2SMatthias Ringwald } 781591423b2SMatthias Ringwald 782591423b2SMatthias Ringwald att_iterator_t it; 783591423b2SMatthias Ringwald 784591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 785591423b2SMatthias Ringwald if (!ok){ 786591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 787591423b2SMatthias Ringwald } 788591423b2SMatthias Ringwald 789591423b2SMatthias Ringwald // check if handle can be read 7904ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_READ) == 0u) { 791591423b2SMatthias Ringwald error_code = ATT_ERROR_READ_NOT_PERMITTED; 792591423b2SMatthias Ringwald break; 793591423b2SMatthias Ringwald } 794591423b2SMatthias Ringwald 795591423b2SMatthias Ringwald // check security requirements 7969d622fdeSMatthias Ringwald error_code = att_validate_security(att_connection, ATT_READ, &it); 797591423b2SMatthias Ringwald if (error_code) break; 798eeeae295SMatthias Ringwald 799591423b2SMatthias Ringwald att_update_value_len(&it, att_connection->con_handle); 800591423b2SMatthias Ringwald 8014f8235e6SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_RESPONSE 802e404a688SMatthias Ringwald if (it.value_len == ATT_READ_RESPONSE_PENDING) { 8034d5915b3SMatthias Ringwald read_request_pending = true; 804e404a688SMatthias Ringwald } 805e404a688SMatthias Ringwald if (read_request_pending) continue; 806e404a688SMatthias Ringwald #endif 807e404a688SMatthias Ringwald 808591423b2SMatthias Ringwald // store 8096098e908SMatthias Ringwald uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, response_buffer_size - offset, att_connection->con_handle); 810591423b2SMatthias Ringwald offset += bytes_copied; 811591423b2SMatthias Ringwald } 812591423b2SMatthias Ringwald 813591423b2SMatthias Ringwald if (error_code){ 814591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 815591423b2SMatthias Ringwald } 816591423b2SMatthias Ringwald 817591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_MULTIPLE_RESPONSE; 818591423b2SMatthias Ringwald return offset; 819591423b2SMatthias Ringwald } 820591423b2SMatthias Ringwald static uint16_t handle_read_multiple_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 821591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 8229b49c4f4SMatthias Ringwald 8239b49c4f4SMatthias Ringwald // 1 byte opcode + two or more attribute handles (2 bytes each) 8244ea43905SMatthias Ringwald if ( (request_len < 5u) || ((request_len & 1u) == 0u) ) return setup_error_invalid_pdu(response_buffer, 8259b49c4f4SMatthias Ringwald ATT_READ_MULTIPLE_REQUEST); 8269b49c4f4SMatthias Ringwald 8274ea43905SMatthias Ringwald int num_handles = (request_len - 1u) >> 1u; 828591423b2SMatthias Ringwald return handle_read_multiple_request2(att_connection, response_buffer, response_buffer_size, num_handles, &request_buffer[1]); 829591423b2SMatthias Ringwald } 830591423b2SMatthias Ringwald 831591423b2SMatthias Ringwald // 832591423b2SMatthias Ringwald // MARK: ATT_READ_BY_GROUP_TYPE_REQUEST 0x10 833591423b2SMatthias Ringwald // 834591423b2SMatthias Ringwald // Only handles GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID 835591423b2SMatthias Ringwald // Core v4.0, vol 3, part g, 2.5.3 836591423b2SMatthias Ringwald // "The «Primary Service» and «Secondary Service» grouping types may be used in the Read By Group Type Request. 837591423b2SMatthias Ringwald // The «Characteristic» grouping type shall not be used in the ATT Read By Group Type Request." 838591423b2SMatthias Ringwald // 839591423b2SMatthias Ringwald // NOTE: doesn't handle DYNAMIC values 840591423b2SMatthias Ringwald // 841591423b2SMatthias Ringwald // NOTE: we don't check for security as PRIMARY and SECONDAY SERVICE definition shouldn't be protected 842591423b2SMatthias Ringwald // Core 4.0, vol 3, part g, 8.1 843591423b2SMatthias Ringwald // "The list of services and characteristics that a device supports is not considered private or 844591423b2SMatthias Ringwald // confidential information, and therefore the Service and Characteristic Discovery procedures 845591423b2SMatthias Ringwald // shall always be permitted. " 846591423b2SMatthias Ringwald // 847591423b2SMatthias Ringwald static uint16_t handle_read_by_group_type_request2(att_connection_t * att_connection, uint8_t * response_buffer, uint16_t response_buffer_size, 848591423b2SMatthias Ringwald uint16_t start_handle, uint16_t end_handle, 849591423b2SMatthias Ringwald uint16_t attribute_type_len, uint8_t * attribute_type){ 850591423b2SMatthias Ringwald 8519ec2630cSMatthias Ringwald UNUSED(att_connection); 8529ec2630cSMatthias Ringwald 853591423b2SMatthias Ringwald log_info("ATT_READ_BY_GROUP_TYPE_REQUEST: from %04X to %04X, buffer size %u, type: ", start_handle, end_handle, response_buffer_size); 854591423b2SMatthias Ringwald log_info_hexdump(attribute_type, attribute_type_len); 855591423b2SMatthias Ringwald uint8_t request_type = ATT_READ_BY_GROUP_TYPE_REQUEST; 856591423b2SMatthias Ringwald 8574ea43905SMatthias Ringwald if ((start_handle > end_handle) || (start_handle == 0u)){ 858591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, start_handle); 859591423b2SMatthias Ringwald } 860591423b2SMatthias Ringwald 861591423b2SMatthias Ringwald // assert UUID is primary or secondary service uuid 862591423b2SMatthias Ringwald uint16_t uuid16 = uuid16_from_uuid(attribute_type_len, attribute_type); 863c1ab6cc1SMatthias Ringwald if ((uuid16 != GATT_PRIMARY_SERVICE_UUID) && (uuid16 != GATT_SECONDARY_SERVICE_UUID)){ 864591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, start_handle, ATT_ERROR_UNSUPPORTED_GROUP_TYPE); 865591423b2SMatthias Ringwald } 866591423b2SMatthias Ringwald 867591423b2SMatthias Ringwald uint16_t offset = 1; 868591423b2SMatthias Ringwald uint16_t pair_len = 0; 869591423b2SMatthias Ringwald uint16_t in_group = 0; 870591423b2SMatthias Ringwald uint16_t group_start_handle = 0; 871591423b2SMatthias Ringwald uint8_t const * group_start_value = NULL; 872591423b2SMatthias Ringwald uint16_t prev_handle = 0; 873591423b2SMatthias Ringwald 874591423b2SMatthias Ringwald att_iterator_t it; 875591423b2SMatthias Ringwald att_iterator_init(&it); 876591423b2SMatthias Ringwald while (att_iterator_has_next(&it)){ 877591423b2SMatthias Ringwald att_iterator_fetch_next(&it); 878591423b2SMatthias Ringwald 879c1ab6cc1SMatthias Ringwald if (it.handle && (it.handle < start_handle)) continue; 880591423b2SMatthias Ringwald if (it.handle > end_handle) break; // (1) 881591423b2SMatthias Ringwald 882591423b2SMatthias Ringwald // log_info("Handle 0x%04x", it.handle); 883591423b2SMatthias Ringwald 884591423b2SMatthias Ringwald // close current tag, if within a group and a new service definition starts or we reach end of att db 885591423b2SMatthias Ringwald if (in_group && 8864ea43905SMatthias Ringwald ((it.handle == 0u) || att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID))){ 887591423b2SMatthias Ringwald // log_info("End of group, handle 0x%04x, val_len: %u", prev_handle, pair_len - 4); 888591423b2SMatthias Ringwald 889591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, group_start_handle); 8904ea43905SMatthias Ringwald offset += 2u; 891591423b2SMatthias Ringwald little_endian_store_16(response_buffer, offset, prev_handle); 8924ea43905SMatthias Ringwald offset += 2u; 8936535961aSMatthias Ringwald (void)memcpy(response_buffer + offset, group_start_value, 8944ea43905SMatthias Ringwald pair_len - 4u); 8954ea43905SMatthias Ringwald offset += pair_len - 4u; 896591423b2SMatthias Ringwald in_group = 0; 897591423b2SMatthias Ringwald 898591423b2SMatthias Ringwald // check if space for another handle pair available 899c1ab6cc1SMatthias Ringwald if ((offset + pair_len) > response_buffer_size){ 900591423b2SMatthias Ringwald break; 901591423b2SMatthias Ringwald } 902591423b2SMatthias Ringwald } 903591423b2SMatthias Ringwald 904591423b2SMatthias Ringwald // keep track of previous handle 905591423b2SMatthias Ringwald prev_handle = it.handle; 906591423b2SMatthias Ringwald 907591423b2SMatthias Ringwald // does current attribute match 908591423b2SMatthias Ringwald // log_info("compare: %04x == %04x", *(uint16_t*) context->attribute_type, *(uint16_t*) uuid); 909591423b2SMatthias Ringwald if (it.handle && att_iterator_match_uuid(&it, attribute_type, attribute_type_len)) { 910591423b2SMatthias Ringwald 911591423b2SMatthias Ringwald // check if value has same len as last one 9124ea43905SMatthias Ringwald uint16_t this_pair_len = 4u + it.value_len; 9134ea43905SMatthias Ringwald if (offset > 1u){ 914591423b2SMatthias Ringwald if (this_pair_len != pair_len) { 915591423b2SMatthias Ringwald break; 916591423b2SMatthias Ringwald } 917591423b2SMatthias Ringwald } 918591423b2SMatthias Ringwald 919591423b2SMatthias Ringwald // log_info("Begin of group, handle 0x%04x", it.handle); 920591423b2SMatthias Ringwald 921591423b2SMatthias Ringwald // first 9224ea43905SMatthias Ringwald if (offset == 1u) { 923591423b2SMatthias Ringwald pair_len = this_pair_len; 924591423b2SMatthias Ringwald response_buffer[offset] = this_pair_len; 925591423b2SMatthias Ringwald offset++; 926591423b2SMatthias Ringwald } 927591423b2SMatthias Ringwald 928591423b2SMatthias Ringwald group_start_handle = it.handle; 929591423b2SMatthias Ringwald group_start_value = it.value; 930591423b2SMatthias Ringwald in_group = 1; 931591423b2SMatthias Ringwald } 932591423b2SMatthias Ringwald } 933591423b2SMatthias Ringwald 9344ea43905SMatthias Ringwald if (offset == 1u){ 935591423b2SMatthias Ringwald return setup_error_atribute_not_found(response_buffer, request_type, start_handle); 936591423b2SMatthias Ringwald } 937591423b2SMatthias Ringwald 938591423b2SMatthias Ringwald response_buffer[0] = ATT_READ_BY_GROUP_TYPE_RESPONSE; 939591423b2SMatthias Ringwald return offset; 940591423b2SMatthias Ringwald } 941591423b2SMatthias Ringwald static uint16_t handle_read_by_group_type_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 942591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 9439b49c4f4SMatthias Ringwald uint16_t attribute_type_len; 9449b49c4f4SMatthias Ringwald switch (request_len){ 9459b49c4f4SMatthias Ringwald case 7: 946591423b2SMatthias Ringwald attribute_type_len = 2; 9479b49c4f4SMatthias Ringwald break; 9489b49c4f4SMatthias Ringwald case 21: 949591423b2SMatthias Ringwald attribute_type_len = 16; 9509b49c4f4SMatthias Ringwald break; 9519b49c4f4SMatthias Ringwald default: 9529b49c4f4SMatthias Ringwald return setup_error_invalid_pdu(response_buffer, ATT_READ_BY_GROUP_TYPE_REQUEST); 953591423b2SMatthias Ringwald } 9549b49c4f4SMatthias Ringwald 9559b49c4f4SMatthias Ringwald uint16_t start_handle = little_endian_read_16(request_buffer, 1); 9569b49c4f4SMatthias Ringwald uint16_t end_handle = little_endian_read_16(request_buffer, 3); 9579b49c4f4SMatthias Ringwald return handle_read_by_group_type_request2(att_connection, response_buffer, response_buffer_size, start_handle, end_handle, attribute_type_len, &request_buffer[5]); 958591423b2SMatthias Ringwald } 959591423b2SMatthias Ringwald 960591423b2SMatthias Ringwald // 961591423b2SMatthias Ringwald // MARK: ATT_WRITE_REQUEST 0x12 962591423b2SMatthias Ringwald static uint16_t handle_write_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 963591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 964591423b2SMatthias Ringwald 9657e23d0c0SMatthias Ringwald UNUSED(response_buffer_size); 9667e23d0c0SMatthias Ringwald 9674ea43905SMatthias Ringwald if (request_len < 3u) return setup_error_invalid_pdu(response_buffer, ATT_WRITE_REQUEST); 9689ec2630cSMatthias Ringwald 969591423b2SMatthias Ringwald uint8_t request_type = ATT_WRITE_REQUEST; 970591423b2SMatthias Ringwald 971591423b2SMatthias Ringwald uint16_t handle = little_endian_read_16(request_buffer, 1); 972591423b2SMatthias Ringwald att_iterator_t it; 973591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 974591423b2SMatthias Ringwald if (!ok) { 975591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 976591423b2SMatthias Ringwald } 977602e97cdSMilanka Ringwald if (att_write_callback == NULL) { 978591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 979591423b2SMatthias Ringwald } 9804ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_WRITE) == 0u) { 981591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 982591423b2SMatthias Ringwald } 9834ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0u) { 984591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 985591423b2SMatthias Ringwald } 986591423b2SMatthias Ringwald // check security requirements 98756c3a347SMatthias Ringwald int error_code = att_validate_security(att_connection, ATT_WRITE, &it); 988591423b2SMatthias Ringwald if (error_code) { 989591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 990591423b2SMatthias Ringwald } 991fd75a1c5SMatthias Ringwald att_persistent_ccc_cache(&it); 9924ea43905SMatthias Ringwald error_code = (*att_write_callback)(att_connection->con_handle, handle, ATT_TRANSACTION_MODE_NONE, 0u, request_buffer + 3u, request_len - 3u); 9934f8235e6SMatthias Ringwald 9944f8235e6SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_RESPONSE 99556c3a347SMatthias Ringwald if (error_code == ATT_ERROR_WRITE_RESPONSE_PENDING) return ATT_INTERNAL_WRITE_RESPONSE_PENDING; 9964f8235e6SMatthias Ringwald #endif 9974f8235e6SMatthias Ringwald 998591423b2SMatthias Ringwald if (error_code) { 999591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 1000591423b2SMatthias Ringwald } 1001591423b2SMatthias Ringwald response_buffer[0] = ATT_WRITE_RESPONSE; 1002591423b2SMatthias Ringwald return 1; 1003591423b2SMatthias Ringwald } 1004591423b2SMatthias Ringwald 1005591423b2SMatthias Ringwald // 1006591423b2SMatthias Ringwald // MARK: ATT_PREPARE_WRITE_REQUEST 0x16 1007591423b2SMatthias Ringwald static uint16_t handle_prepare_write_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 1008591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 1009591423b2SMatthias Ringwald 1010591423b2SMatthias Ringwald uint8_t request_type = ATT_PREPARE_WRITE_REQUEST; 1011591423b2SMatthias Ringwald 10124ea43905SMatthias Ringwald if (request_len < 5u) return setup_error_invalid_pdu(response_buffer, request_type); 10139b49c4f4SMatthias Ringwald 1014591423b2SMatthias Ringwald uint16_t handle = little_endian_read_16(request_buffer, 1); 1015591423b2SMatthias Ringwald uint16_t offset = little_endian_read_16(request_buffer, 3); 1016602e97cdSMilanka Ringwald if (att_write_callback == NULL) { 1017591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 1018591423b2SMatthias Ringwald } 1019591423b2SMatthias Ringwald att_iterator_t it; 1020602e97cdSMilanka Ringwald if (att_find_handle(&it, handle) == 0) { 1021591423b2SMatthias Ringwald return setup_error_invalid_handle(response_buffer, request_type, handle); 1022591423b2SMatthias Ringwald } 10234ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_WRITE) == 0u) { 1024591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 1025591423b2SMatthias Ringwald } 10264ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0u) { 1027591423b2SMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, handle); 1028591423b2SMatthias Ringwald } 1029591423b2SMatthias Ringwald // check security requirements 103056c3a347SMatthias Ringwald int error_code = att_validate_security(att_connection, ATT_WRITE, &it); 1031591423b2SMatthias Ringwald if (error_code) { 1032591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 1033591423b2SMatthias Ringwald } 1034591423b2SMatthias Ringwald 10354ea43905SMatthias Ringwald error_code = (*att_write_callback)(att_connection->con_handle, handle, ATT_TRANSACTION_MODE_ACTIVE, offset, request_buffer + 5u, request_len - 5u); 1036591423b2SMatthias Ringwald switch (error_code){ 1037591423b2SMatthias Ringwald case 0: 1038591423b2SMatthias Ringwald break; 1039591423b2SMatthias Ringwald case ATT_ERROR_INVALID_OFFSET: 1040591423b2SMatthias Ringwald case ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH: 1041591423b2SMatthias Ringwald // postpone to execute write request 1042591423b2SMatthias Ringwald att_prepare_write_update_errors(error_code, handle); 1043591423b2SMatthias Ringwald break; 104456c3a347SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_RESPONSE 104556c3a347SMatthias Ringwald case ATT_ERROR_WRITE_RESPONSE_PENDING: 104656c3a347SMatthias Ringwald return ATT_INTERNAL_WRITE_RESPONSE_PENDING; 104756c3a347SMatthias Ringwald #endif 1048591423b2SMatthias Ringwald default: 1049591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 1050591423b2SMatthias Ringwald } 1051591423b2SMatthias Ringwald 1052591423b2SMatthias Ringwald // response: echo request 10537e23d0c0SMatthias Ringwald uint16_t bytes_to_echo = btstack_min(request_len, response_buffer_size); 10547e23d0c0SMatthias Ringwald (void)memcpy(response_buffer, request_buffer, bytes_to_echo); 1055591423b2SMatthias Ringwald response_buffer[0] = ATT_PREPARE_WRITE_RESPONSE; 1056591423b2SMatthias Ringwald return request_len; 1057591423b2SMatthias Ringwald } 1058591423b2SMatthias Ringwald 1059591423b2SMatthias Ringwald /* 1060591423b2SMatthias Ringwald * @brief transcation queue of prepared writes, e.g., after disconnect 1061591423b2SMatthias Ringwald */ 1062591423b2SMatthias Ringwald void att_clear_transaction_queue(att_connection_t * att_connection){ 10633d71c7a4SMatthias Ringwald (*att_write_callback)(att_connection->con_handle, 0, ATT_TRANSACTION_MODE_CANCEL, 0, NULL, 0); 1064591423b2SMatthias Ringwald } 1065591423b2SMatthias Ringwald 1066591423b2SMatthias Ringwald // MARK: ATT_EXECUTE_WRITE_REQUEST 0x18 1067591423b2SMatthias Ringwald // NOTE: security has been verified by handle_prepare_write_request 1068591423b2SMatthias Ringwald static uint16_t handle_execute_write_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, 1069591423b2SMatthias Ringwald uint8_t * response_buffer, uint16_t response_buffer_size){ 1070591423b2SMatthias Ringwald 10719ec2630cSMatthias Ringwald UNUSED(response_buffer_size); 10729ec2630cSMatthias Ringwald 1073591423b2SMatthias Ringwald uint8_t request_type = ATT_EXECUTE_WRITE_REQUEST; 10749b49c4f4SMatthias Ringwald 10754ea43905SMatthias Ringwald if (request_len < 2u) return setup_error_invalid_pdu(response_buffer, request_type); 10769b49c4f4SMatthias Ringwald 107742dfcacaSMatthias Ringwald if (att_write_callback == NULL) { 107842dfcacaSMatthias Ringwald return setup_error_write_not_permitted(response_buffer, request_type, 0); 107942dfcacaSMatthias Ringwald } 108042dfcacaSMatthias Ringwald 1081591423b2SMatthias Ringwald if (request_buffer[1]) { 10829b31df63SMatthias Ringwald // validate queued write 10839b31df63SMatthias Ringwald if (att_prepare_write_error_code == 0){ 10843d71c7a4SMatthias Ringwald att_prepare_write_error_code = (*att_write_callback)(att_connection->con_handle, 0, ATT_TRANSACTION_MODE_VALIDATE, 0, NULL, 0); 10859b31df63SMatthias Ringwald } 108656c3a347SMatthias Ringwald #ifdef ENABLE_ATT_DELAYED_RESPONSE 108756c3a347SMatthias Ringwald if (att_prepare_write_error_code == ATT_ERROR_WRITE_RESPONSE_PENDING) return ATT_INTERNAL_WRITE_RESPONSE_PENDING; 108856c3a347SMatthias Ringwald #endif 1089591423b2SMatthias Ringwald // deliver queued errors 1090591423b2SMatthias Ringwald if (att_prepare_write_error_code){ 1091591423b2SMatthias Ringwald att_clear_transaction_queue(att_connection); 1092591423b2SMatthias Ringwald uint8_t error_code = att_prepare_write_error_code; 1093591423b2SMatthias Ringwald uint16_t handle = att_prepare_write_error_handle; 1094591423b2SMatthias Ringwald att_prepare_write_reset(); 1095591423b2SMatthias Ringwald return setup_error(response_buffer, request_type, handle, error_code); 1096591423b2SMatthias Ringwald } 10973d71c7a4SMatthias Ringwald att_write_callback(att_connection->con_handle, 0, ATT_TRANSACTION_MODE_EXECUTE, 0, NULL, 0); 1098591423b2SMatthias Ringwald } else { 1099591423b2SMatthias Ringwald att_clear_transaction_queue(att_connection); 1100591423b2SMatthias Ringwald } 1101591423b2SMatthias Ringwald response_buffer[0] = ATT_EXECUTE_WRITE_RESPONSE; 1102591423b2SMatthias Ringwald return 1; 1103591423b2SMatthias Ringwald } 1104591423b2SMatthias Ringwald 1105591423b2SMatthias Ringwald // MARK: ATT_WRITE_COMMAND 0x52 1106591423b2SMatthias Ringwald // Core 4.0, vol 3, part F, 3.4.5.3 1107591423b2SMatthias Ringwald // "No Error Response or Write Response shall be sent in response to this command" 110815406929SMatthias Ringwald static void handle_write_command(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len, uint16_t required_flags){ 11099ec2630cSMatthias Ringwald 11104ea43905SMatthias Ringwald if (request_len < 3u) return; 11119b49c4f4SMatthias Ringwald 1112591423b2SMatthias Ringwald uint16_t handle = little_endian_read_16(request_buffer, 1); 1113602e97cdSMilanka Ringwald if (att_write_callback == NULL) return; 11148ac574d6SMatthias Ringwald 1115591423b2SMatthias Ringwald att_iterator_t it; 1116591423b2SMatthias Ringwald int ok = att_find_handle(&it, handle); 1117591423b2SMatthias Ringwald if (!ok) return; 11184ea43905SMatthias Ringwald if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0u) return; 11194ea43905SMatthias Ringwald if ((it.flags & required_flags) == 0u) return; 11209d622fdeSMatthias Ringwald if (att_validate_security(att_connection, ATT_WRITE, &it)) return; 1121fd75a1c5SMatthias Ringwald att_persistent_ccc_cache(&it); 11224ea43905SMatthias Ringwald (*att_write_callback)(att_connection->con_handle, handle, ATT_TRANSACTION_MODE_NONE, 0u, request_buffer + 3u, request_len - 3u); 1123591423b2SMatthias Ringwald } 1124591423b2SMatthias Ringwald 1125591423b2SMatthias Ringwald // MARK: helper for ATT_HANDLE_VALUE_NOTIFICATION and ATT_HANDLE_VALUE_INDICATION 1126591423b2SMatthias Ringwald static uint16_t prepare_handle_value(att_connection_t * att_connection, 1127591423b2SMatthias Ringwald uint16_t handle, 11283bb3035fSMilanka Ringwald const uint8_t *value, 1129591423b2SMatthias Ringwald uint16_t value_len, 1130591423b2SMatthias Ringwald uint8_t * response_buffer){ 1131591423b2SMatthias Ringwald little_endian_store_16(response_buffer, 1, handle); 11324ea43905SMatthias Ringwald if (value_len > (att_connection->mtu - 3u)){ 11334ea43905SMatthias Ringwald value_len = att_connection->mtu - 3u; 1134591423b2SMatthias Ringwald } 11356535961aSMatthias Ringwald (void)memcpy(&response_buffer[3], value, value_len); 11364ea43905SMatthias Ringwald return value_len + 3u; 1137591423b2SMatthias Ringwald } 1138591423b2SMatthias Ringwald 1139591423b2SMatthias Ringwald // MARK: ATT_HANDLE_VALUE_NOTIFICATION 0x1b 1140591423b2SMatthias Ringwald uint16_t att_prepare_handle_value_notification(att_connection_t * att_connection, 1141591423b2SMatthias Ringwald uint16_t handle, 11423bb3035fSMilanka Ringwald const uint8_t *value, 1143591423b2SMatthias Ringwald uint16_t value_len, 1144591423b2SMatthias Ringwald uint8_t * response_buffer){ 1145591423b2SMatthias Ringwald 1146591423b2SMatthias Ringwald response_buffer[0] = ATT_HANDLE_VALUE_NOTIFICATION; 1147591423b2SMatthias Ringwald return prepare_handle_value(att_connection, handle, value, value_len, response_buffer); 1148591423b2SMatthias Ringwald } 1149591423b2SMatthias Ringwald 1150591423b2SMatthias Ringwald // MARK: ATT_HANDLE_VALUE_INDICATION 0x1d 1151591423b2SMatthias Ringwald uint16_t att_prepare_handle_value_indication(att_connection_t * att_connection, 1152591423b2SMatthias Ringwald uint16_t handle, 11533bb3035fSMilanka Ringwald const uint8_t *value, 1154591423b2SMatthias Ringwald uint16_t value_len, 1155591423b2SMatthias Ringwald uint8_t * response_buffer){ 1156591423b2SMatthias Ringwald 1157591423b2SMatthias Ringwald response_buffer[0] = ATT_HANDLE_VALUE_INDICATION; 1158591423b2SMatthias Ringwald return prepare_handle_value(att_connection, handle, value, value_len, response_buffer); 1159591423b2SMatthias Ringwald } 1160591423b2SMatthias Ringwald 1161591423b2SMatthias Ringwald // MARK: Dispatcher 1162591423b2SMatthias Ringwald uint16_t att_handle_request(att_connection_t * att_connection, 1163591423b2SMatthias Ringwald uint8_t * request_buffer, 1164591423b2SMatthias Ringwald uint16_t request_len, 1165591423b2SMatthias Ringwald uint8_t * response_buffer){ 1166591423b2SMatthias Ringwald uint16_t response_len = 0; 1167591423b2SMatthias Ringwald uint16_t response_buffer_size = att_connection->mtu; 1168591423b2SMatthias Ringwald 1169591423b2SMatthias Ringwald switch (request_buffer[0]){ 1170591423b2SMatthias Ringwald case ATT_EXCHANGE_MTU_REQUEST: 1171591423b2SMatthias Ringwald response_len = handle_exchange_mtu_request(att_connection, request_buffer, request_len, response_buffer); 1172591423b2SMatthias Ringwald break; 1173591423b2SMatthias Ringwald case ATT_FIND_INFORMATION_REQUEST: 1174591423b2SMatthias Ringwald response_len = handle_find_information_request(att_connection, request_buffer, request_len,response_buffer, response_buffer_size); 1175591423b2SMatthias Ringwald break; 1176591423b2SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_REQUEST: 1177591423b2SMatthias Ringwald response_len = handle_find_by_type_value_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1178591423b2SMatthias Ringwald break; 1179591423b2SMatthias Ringwald case ATT_READ_BY_TYPE_REQUEST: 1180591423b2SMatthias Ringwald response_len = handle_read_by_type_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1181591423b2SMatthias Ringwald break; 1182591423b2SMatthias Ringwald case ATT_READ_REQUEST: 1183591423b2SMatthias Ringwald response_len = handle_read_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1184591423b2SMatthias Ringwald break; 1185591423b2SMatthias Ringwald case ATT_READ_BLOB_REQUEST: 1186591423b2SMatthias Ringwald response_len = handle_read_blob_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1187591423b2SMatthias Ringwald break; 1188591423b2SMatthias Ringwald case ATT_READ_MULTIPLE_REQUEST: 1189591423b2SMatthias Ringwald response_len = handle_read_multiple_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1190591423b2SMatthias Ringwald break; 1191591423b2SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_REQUEST: 1192591423b2SMatthias Ringwald response_len = handle_read_by_group_type_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1193591423b2SMatthias Ringwald break; 1194591423b2SMatthias Ringwald case ATT_WRITE_REQUEST: 1195591423b2SMatthias Ringwald response_len = handle_write_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1196591423b2SMatthias Ringwald break; 1197591423b2SMatthias Ringwald case ATT_PREPARE_WRITE_REQUEST: 1198591423b2SMatthias Ringwald response_len = handle_prepare_write_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1199591423b2SMatthias Ringwald break; 1200591423b2SMatthias Ringwald case ATT_EXECUTE_WRITE_REQUEST: 1201591423b2SMatthias Ringwald response_len = handle_execute_write_request(att_connection, request_buffer, request_len, response_buffer, response_buffer_size); 1202591423b2SMatthias Ringwald break; 1203591423b2SMatthias Ringwald case ATT_WRITE_COMMAND: 120415406929SMatthias Ringwald handle_write_command(att_connection, request_buffer, request_len, ATT_PROPERTY_WRITE_WITHOUT_RESPONSE); 1205591423b2SMatthias Ringwald break; 12067a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1207591423b2SMatthias Ringwald case ATT_SIGNED_WRITE_COMMAND: 120815406929SMatthias Ringwald handle_write_command(att_connection, request_buffer, request_len, ATT_PROPERTY_AUTHENTICATED_SIGNED_WRITE); 1209591423b2SMatthias Ringwald break; 12107a766ebfSMatthias Ringwald #endif 1211591423b2SMatthias Ringwald default: 1212591423b2SMatthias Ringwald log_info("Unhandled ATT Command: %02X, DATA: ", request_buffer[0]); 12134ea43905SMatthias Ringwald log_info_hexdump(&request_buffer[9u], request_len-9u); 1214591423b2SMatthias Ringwald break; 1215591423b2SMatthias Ringwald } 1216591423b2SMatthias Ringwald return response_len; 1217591423b2SMatthias Ringwald } 1218591423b2SMatthias Ringwald 1219660ce368SMatthias Ringwald // returns 1 if service found. only primary service. 12204d5915b3SMatthias Ringwald bool gatt_server_get_get_handle_range_for_service_with_uuid16(uint16_t uuid16, uint16_t * start_handle, uint16_t * end_handle){ 1221660ce368SMatthias Ringwald uint16_t in_group = 0; 1222660ce368SMatthias Ringwald uint16_t prev_handle = 0; 1223660ce368SMatthias Ringwald 1224660ce368SMatthias Ringwald uint8_t attribute_value[2]; 1225660ce368SMatthias Ringwald int attribute_len = sizeof(attribute_value); 1226660ce368SMatthias Ringwald little_endian_store_16(attribute_value, 0, uuid16); 1227660ce368SMatthias Ringwald 1228660ce368SMatthias Ringwald att_iterator_t it; 1229660ce368SMatthias Ringwald att_iterator_init(&it); 1230660ce368SMatthias Ringwald while (att_iterator_has_next(&it)){ 1231660ce368SMatthias Ringwald att_iterator_fetch_next(&it); 1232660ce368SMatthias Ringwald int new_service_started = att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID); 1233660ce368SMatthias Ringwald 1234660ce368SMatthias Ringwald // close current tag, if within a group and a new service definition starts or we reach end of att db 1235660ce368SMatthias Ringwald if (in_group && 12364ea43905SMatthias Ringwald ((it.handle == 0u) || new_service_started)){ 1237660ce368SMatthias Ringwald *end_handle = prev_handle; 12384d5915b3SMatthias Ringwald return true; 1239660ce368SMatthias Ringwald } 1240660ce368SMatthias Ringwald 1241660ce368SMatthias Ringwald // keep track of previous handle 1242660ce368SMatthias Ringwald prev_handle = it.handle; 1243660ce368SMatthias Ringwald 1244660ce368SMatthias Ringwald // check if found 12455df9dc78SMatthias Ringwald if (it.handle && new_service_started && (attribute_len == it.value_len) && (memcmp(attribute_value, it.value, it.value_len) == 0)){ 1246660ce368SMatthias Ringwald *start_handle = it.handle; 12474d5915b3SMatthias Ringwald in_group = true; 1248660ce368SMatthias Ringwald } 1249660ce368SMatthias Ringwald } 12504d5915b3SMatthias Ringwald return false; 1251660ce368SMatthias Ringwald } 1252660ce368SMatthias Ringwald 12534d5915b3SMatthias Ringwald // returns false if not found 1254660ce368SMatthias Ringwald uint16_t gatt_server_get_value_handle_for_characteristic_with_uuid16(uint16_t start_handle, uint16_t end_handle, uint16_t uuid16){ 1255660ce368SMatthias Ringwald att_iterator_t it; 1256660ce368SMatthias Ringwald att_iterator_init(&it); 1257660ce368SMatthias Ringwald while (att_iterator_has_next(&it)){ 1258660ce368SMatthias Ringwald att_iterator_fetch_next(&it); 1259c1ab6cc1SMatthias Ringwald if (it.handle && (it.handle < start_handle)) continue; 1260660ce368SMatthias Ringwald if (it.handle > end_handle) break; // (1) 12614ea43905SMatthias Ringwald if (it.handle == 0u) break; 1262660ce368SMatthias Ringwald if (att_iterator_match_uuid16(&it, uuid16)) return it.handle; 1263660ce368SMatthias Ringwald } 1264660ce368SMatthias Ringwald return 0; 1265660ce368SMatthias Ringwald } 1266660ce368SMatthias Ringwald 1267c7774db7SMilanka Ringwald uint16_t gatt_server_get_descriptor_handle_for_characteristic_with_uuid16(uint16_t start_handle, uint16_t end_handle, uint16_t characteristic_uuid16, uint16_t descriptor_uuid16){ 1268660ce368SMatthias Ringwald att_iterator_t it; 1269660ce368SMatthias Ringwald att_iterator_init(&it); 1270660ce368SMatthias Ringwald int characteristic_found = 0; 1271660ce368SMatthias Ringwald while (att_iterator_has_next(&it)){ 1272660ce368SMatthias Ringwald att_iterator_fetch_next(&it); 1273c1ab6cc1SMatthias Ringwald if (it.handle && (it.handle < start_handle)) continue; 1274660ce368SMatthias Ringwald if (it.handle > end_handle) break; // (1) 12754ea43905SMatthias Ringwald if (it.handle == 0u) break; 1276c7774db7SMilanka Ringwald if (att_iterator_match_uuid16(&it, characteristic_uuid16)){ 1277660ce368SMatthias Ringwald characteristic_found = 1; 1278660ce368SMatthias Ringwald continue; 1279660ce368SMatthias Ringwald } 1280660ce368SMatthias Ringwald if (att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) 1281660ce368SMatthias Ringwald || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID) 1282660ce368SMatthias Ringwald || att_iterator_match_uuid16(&it, GATT_CHARACTERISTICS_UUID)){ 1283660ce368SMatthias Ringwald if (characteristic_found) break; 1284660ce368SMatthias Ringwald continue; 1285660ce368SMatthias Ringwald } 1286c7774db7SMilanka Ringwald if (characteristic_found && att_iterator_match_uuid16(&it, descriptor_uuid16)){ 1287660ce368SMatthias Ringwald return it.handle; 1288660ce368SMatthias Ringwald } 1289660ce368SMatthias Ringwald } 1290660ce368SMatthias Ringwald return 0; 1291660ce368SMatthias Ringwald } 1292660ce368SMatthias Ringwald 1293c7774db7SMilanka Ringwald // returns 0 if not found 1294c7774db7SMilanka Ringwald uint16_t gatt_server_get_client_configuration_handle_for_characteristic_with_uuid16(uint16_t start_handle, uint16_t end_handle, uint16_t characteristic_uuid16){ 1295c7774db7SMilanka Ringwald return gatt_server_get_descriptor_handle_for_characteristic_with_uuid16(start_handle, end_handle, characteristic_uuid16, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION); 1296c7774db7SMilanka Ringwald } 1297c7774db7SMilanka Ringwald // returns 0 if not found 1298c7774db7SMilanka Ringwald 1299c7774db7SMilanka Ringwald uint16_t gatt_server_get_server_configuration_handle_for_characteristic_with_uuid16(uint16_t start_handle, uint16_t end_handle, uint16_t characteristic_uuid16){ 1300c7774db7SMilanka Ringwald return gatt_server_get_descriptor_handle_for_characteristic_with_uuid16(start_handle, end_handle, characteristic_uuid16, GATT_SERVER_CHARACTERISTICS_CONFIGURATION); 1301c7774db7SMilanka Ringwald } 1302c7774db7SMilanka Ringwald 130315f22304SMatthias Ringwald // returns 1 if service found. only primary service. 130415f22304SMatthias Ringwald int gatt_server_get_get_handle_range_for_service_with_uuid128(const uint8_t * uuid128, uint16_t * start_handle, uint16_t * end_handle){ 130515f22304SMatthias Ringwald uint16_t in_group = 0; 130615f22304SMatthias Ringwald uint16_t prev_handle = 0; 130715f22304SMatthias Ringwald 130815f22304SMatthias Ringwald uint8_t attribute_value[16]; 130915f22304SMatthias Ringwald int attribute_len = sizeof(attribute_value); 131015f22304SMatthias Ringwald reverse_128(uuid128, attribute_value); 131115f22304SMatthias Ringwald 131215f22304SMatthias Ringwald att_iterator_t it; 131315f22304SMatthias Ringwald att_iterator_init(&it); 131415f22304SMatthias Ringwald while (att_iterator_has_next(&it)){ 131515f22304SMatthias Ringwald att_iterator_fetch_next(&it); 131615f22304SMatthias Ringwald int new_service_started = att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID); 131715f22304SMatthias Ringwald 131815f22304SMatthias Ringwald // close current tag, if within a group and a new service definition starts or we reach end of att db 131915f22304SMatthias Ringwald if (in_group && 13204ea43905SMatthias Ringwald ((it.handle == 0u) || new_service_started)){ 132115f22304SMatthias Ringwald *end_handle = prev_handle; 132215f22304SMatthias Ringwald return 1; 132315f22304SMatthias Ringwald } 132415f22304SMatthias Ringwald 132515f22304SMatthias Ringwald // keep track of previous handle 132615f22304SMatthias Ringwald prev_handle = it.handle; 132715f22304SMatthias Ringwald 132815f22304SMatthias Ringwald // check if found 13295df9dc78SMatthias Ringwald if (it.handle && new_service_started && (attribute_len == it.value_len) && (memcmp(attribute_value, it.value, it.value_len) == 0)){ 133015f22304SMatthias Ringwald *start_handle = it.handle; 133115f22304SMatthias Ringwald in_group = 1; 133215f22304SMatthias Ringwald } 133315f22304SMatthias Ringwald } 133415f22304SMatthias Ringwald return 0; 133515f22304SMatthias Ringwald } 133615f22304SMatthias Ringwald 133715f22304SMatthias Ringwald // returns 0 if not found 133815f22304SMatthias Ringwald uint16_t gatt_server_get_value_handle_for_characteristic_with_uuid128(uint16_t start_handle, uint16_t end_handle, const uint8_t * uuid128){ 133915f22304SMatthias Ringwald uint8_t attribute_value[16]; 134015f22304SMatthias Ringwald reverse_128(uuid128, attribute_value); 134115f22304SMatthias Ringwald att_iterator_t it; 134215f22304SMatthias Ringwald att_iterator_init(&it); 134315f22304SMatthias Ringwald while (att_iterator_has_next(&it)){ 134415f22304SMatthias Ringwald att_iterator_fetch_next(&it); 1345c1ab6cc1SMatthias Ringwald if (it.handle && (it.handle < start_handle)) continue; 134615f22304SMatthias Ringwald if (it.handle > end_handle) break; // (1) 13474ea43905SMatthias Ringwald if (it.handle == 0u) break; 134815f22304SMatthias Ringwald if (att_iterator_match_uuid(&it, attribute_value, 16)) return it.handle; 134915f22304SMatthias Ringwald } 135015f22304SMatthias Ringwald return 0; 135115f22304SMatthias Ringwald } 135215f22304SMatthias Ringwald 135315f22304SMatthias Ringwald // returns 0 if not found 135415f22304SMatthias Ringwald uint16_t gatt_server_get_client_configuration_handle_for_characteristic_with_uuid128(uint16_t start_handle, uint16_t end_handle, const uint8_t * uuid128){ 135515f22304SMatthias Ringwald uint8_t attribute_value[16]; 135615f22304SMatthias Ringwald reverse_128(uuid128, attribute_value); 135715f22304SMatthias Ringwald att_iterator_t it; 135815f22304SMatthias Ringwald att_iterator_init(&it); 135915f22304SMatthias Ringwald int characteristic_found = 0; 136015f22304SMatthias Ringwald while (att_iterator_has_next(&it)){ 136115f22304SMatthias Ringwald att_iterator_fetch_next(&it); 1362c1ab6cc1SMatthias Ringwald if (it.handle && (it.handle < start_handle)) continue; 136315f22304SMatthias Ringwald if (it.handle > end_handle) break; // (1) 13644ea43905SMatthias Ringwald if (it.handle == 0u) break; 136515f22304SMatthias Ringwald if (att_iterator_match_uuid(&it, attribute_value, 16)){ 136615f22304SMatthias Ringwald characteristic_found = 1; 136715f22304SMatthias Ringwald continue; 136815f22304SMatthias Ringwald } 136915f22304SMatthias Ringwald if (att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) 137015f22304SMatthias Ringwald || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID) 137115f22304SMatthias Ringwald || att_iterator_match_uuid16(&it, GATT_CHARACTERISTICS_UUID)){ 137215f22304SMatthias Ringwald if (characteristic_found) break; 137315f22304SMatthias Ringwald continue; 137415f22304SMatthias Ringwald } 1375b58c6eb9SMilanka Ringwald if (characteristic_found && att_iterator_match_uuid16(&it, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION)){ 137615f22304SMatthias Ringwald return it.handle; 137715f22304SMatthias Ringwald } 137815f22304SMatthias Ringwald } 137915f22304SMatthias Ringwald return 0; 138015f22304SMatthias Ringwald } 138115f22304SMatthias Ringwald 138215f22304SMatthias Ringwald 13838b1d64c6SMatthias Ringwald // 1-item cache to optimize query during write_callback 1384fd75a1c5SMatthias Ringwald static void att_persistent_ccc_cache(att_iterator_t * it){ 1385fd75a1c5SMatthias Ringwald att_persistent_ccc_handle = it->handle; 1386fd75a1c5SMatthias Ringwald if (it->flags & ATT_PROPERTY_UUID128){ 1387fd75a1c5SMatthias Ringwald att_persistent_ccc_uuid16 = 0; 1388fd75a1c5SMatthias Ringwald } else { 1389fd75a1c5SMatthias Ringwald att_persistent_ccc_uuid16 = little_endian_read_16(it->uuid, 0); 1390fd75a1c5SMatthias Ringwald } 13918b1d64c6SMatthias Ringwald } 13928b1d64c6SMatthias Ringwald 13934d5915b3SMatthias Ringwald bool att_is_persistent_ccc(uint16_t handle){ 1394fd75a1c5SMatthias Ringwald if (handle != att_persistent_ccc_handle){ 13958b1d64c6SMatthias Ringwald att_iterator_t it; 13968b1d64c6SMatthias Ringwald int ok = att_find_handle(&it, handle); 13974d5915b3SMatthias Ringwald if (!ok) return false; 1398fd75a1c5SMatthias Ringwald att_persistent_ccc_cache(&it); 13998b1d64c6SMatthias Ringwald } 1400fd75a1c5SMatthias Ringwald return att_persistent_ccc_uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION; 14018b1d64c6SMatthias Ringwald } 14028b1d64c6SMatthias Ringwald 1403bfd413f0SMatthias Ringwald // att_read_callback helpers 1404bfd413f0SMatthias 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){ 1405c3b0d2daSMilanka Ringwald btstack_assert(blob != NULL); 1406c3b0d2daSMilanka Ringwald 1407bfd413f0SMatthias Ringwald if (buffer){ 1408c3b0d2daSMilanka Ringwald uint16_t bytes_to_copy = 0; 1409c3b0d2daSMilanka Ringwald if (blob_size >= offset){ 1410c3b0d2daSMilanka Ringwald bytes_to_copy = btstack_min(blob_size - offset, buffer_size); 14116535961aSMatthias Ringwald (void)memcpy(buffer, &blob[offset], bytes_to_copy); 1412c3b0d2daSMilanka Ringwald } 1413bfd413f0SMatthias Ringwald return bytes_to_copy; 1414bfd413f0SMatthias Ringwald } else { 1415bfd413f0SMatthias Ringwald return blob_size; 1416bfd413f0SMatthias Ringwald } 1417bfd413f0SMatthias Ringwald } 1418bfd413f0SMatthias Ringwald 1419bfd413f0SMatthias Ringwald uint16_t att_read_callback_handle_little_endian_32(uint32_t value, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){ 1420bfd413f0SMatthias Ringwald uint8_t value_buffer[4]; 1421bfd413f0SMatthias Ringwald little_endian_store_32(value_buffer, 0, value); 1422bfd413f0SMatthias Ringwald return att_read_callback_handle_blob(value_buffer, sizeof(value_buffer), offset, buffer, buffer_size); 1423bfd413f0SMatthias Ringwald } 1424bfd413f0SMatthias Ringwald 1425bfd413f0SMatthias Ringwald uint16_t att_read_callback_handle_little_endian_16(uint16_t value, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){ 1426bfd413f0SMatthias Ringwald uint8_t value_buffer[2]; 1427bfd413f0SMatthias Ringwald little_endian_store_16(value_buffer, 0, value); 1428bfd413f0SMatthias Ringwald return att_read_callback_handle_blob(value_buffer, sizeof(value_buffer), offset, buffer, buffer_size); 1429bfd413f0SMatthias Ringwald } 1430bfd413f0SMatthias Ringwald 1431bfd413f0SMatthias Ringwald uint16_t att_read_callback_handle_byte(uint8_t value, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){ 1432bfd413f0SMatthias Ringwald uint8_t value_buffer[1]; 1433bfd413f0SMatthias Ringwald value_buffer[0] = value; 1434bfd413f0SMatthias Ringwald return att_read_callback_handle_blob(value_buffer, sizeof(value_buffer), offset, buffer, buffer_size); 1435bfd413f0SMatthias Ringwald } 143644127f43SMatthias Ringwald 143744127f43SMatthias Ringwald 1438c3b0d2daSMilanka Ringwald #ifdef ENABLE_BTP 1439c3b0d2daSMilanka Ringwald 1440c3b0d2daSMilanka Ringwald // start of auto-PTS testing code, not used in production 1441d8d5d864SMilanka Ringwald // LCOV_EXCL_START 144244127f43SMatthias Ringwald #include "btp.h" 144344127f43SMatthias Ringwald 144444127f43SMatthias Ringwald static uint8_t btp_permissions_for_flags(uint16_t flags){ 144544127f43SMatthias Ringwald 144644127f43SMatthias Ringwald // see BT_GATT_PERM_* 144744127f43SMatthias Ringwald // https://docs.zephyrproject.org/latest/reference/bluetooth/gatt.html 144844127f43SMatthias Ringwald // set bit indicates requirement, e.g. BTP_GATT_PERM_READ_AUTHN requires authenticated connection 144944127f43SMatthias Ringwald 145044127f43SMatthias Ringwald uint8_t permissions = 0; 145144127f43SMatthias Ringwald 145244127f43SMatthias Ringwald uint8_t read_security_level = 0; 145344127f43SMatthias Ringwald uint8_t write_security_level = 0; 145444127f43SMatthias Ringwald if (flags & ATT_PROPERTY_READ){ 145544127f43SMatthias Ringwald if (flags & ATT_PROPERTY_READ_PERMISSION_BIT_0) { 145644127f43SMatthias Ringwald read_security_level |= 1; 145744127f43SMatthias Ringwald } 145844127f43SMatthias Ringwald if (flags & ATT_PROPERTY_READ_PERMISSION_BIT_1) { 145944127f43SMatthias Ringwald read_security_level |= 2; 146044127f43SMatthias Ringwald } 1461d386e180SMatthias Ringwald if (read_security_level == ATT_SECURITY_AUTHORIZED) { 146244127f43SMatthias Ringwald permissions |= BTP_GATT_PERM_READ_AUTHZ; 146344127f43SMatthias Ringwald } 1464d386e180SMatthias Ringwald if (read_security_level == ATT_SECURITY_AUTHENTICATED) { 146544127f43SMatthias Ringwald permissions |= BTP_GATT_PERM_READ_AUTHN; 146644127f43SMatthias Ringwald } 1467d386e180SMatthias Ringwald if (read_security_level == ATT_SECURITY_ENCRYPTED) { 146844127f43SMatthias Ringwald permissions |= BTP_GATT_PERM_READ_ENC; 146944127f43SMatthias Ringwald } 1470d386e180SMatthias Ringwald if (read_security_level == ATT_SECURITY_NONE) { 147144127f43SMatthias Ringwald permissions |= BTP_GATT_PERM_READ; 147244127f43SMatthias Ringwald } 147344127f43SMatthias Ringwald } 147444127f43SMatthias Ringwald if (flags & (ATT_PROPERTY_WRITE | ATT_PROPERTY_WRITE_WITHOUT_RESPONSE)){ 147544127f43SMatthias Ringwald if (flags & ATT_PROPERTY_WRITE_PERMISSION_BIT_0) { 147644127f43SMatthias Ringwald write_security_level |= 1; 147744127f43SMatthias Ringwald } 147844127f43SMatthias Ringwald if (flags & ATT_PROPERTY_WRITE_PERMISSION_BIT_1) { 147944127f43SMatthias Ringwald write_security_level |= 2; 148044127f43SMatthias Ringwald } 1481d386e180SMatthias Ringwald if (write_security_level == ATT_SECURITY_AUTHORIZED) { 148244127f43SMatthias Ringwald permissions |= BTP_GATT_PERM_WRITE_AUTHZ; 148344127f43SMatthias Ringwald } 1484d386e180SMatthias Ringwald if (write_security_level == ATT_SECURITY_AUTHENTICATED) { 148544127f43SMatthias Ringwald permissions |= BTP_GATT_PERM_WRITE_AUTHN; 148644127f43SMatthias Ringwald } 1487d386e180SMatthias Ringwald if (write_security_level == ATT_SECURITY_ENCRYPTED) { 148844127f43SMatthias Ringwald permissions |= BTP_GATT_PERM_WRITE_ENC; 148944127f43SMatthias Ringwald } 1490d386e180SMatthias Ringwald if (write_security_level == ATT_SECURITY_NONE) { 149144127f43SMatthias Ringwald permissions |= BTP_GATT_PERM_WRITE; 149244127f43SMatthias Ringwald } 149344127f43SMatthias Ringwald } 149444127f43SMatthias Ringwald return permissions; 149544127f43SMatthias Ringwald } 149644127f43SMatthias Ringwald 149744127f43SMatthias Ringwald uint16_t btp_att_get_attributes_by_uuid16(uint16_t start_handle, uint16_t end_handle, uint16_t uuid16, uint8_t * response_buffer, uint16_t response_buffer_size){ 1498e7733bf2SMatthias Ringwald log_info("btp_att_get_attributes_by_uuid16 %04x from 0x%04x to 0x%04x, db %p", uuid16, start_handle, end_handle, att_db); 1499e7733bf2SMatthias Ringwald att_dump_attributes(); 1500e7733bf2SMatthias Ringwald 150144127f43SMatthias Ringwald uint8_t num_attributes = 0; 150244127f43SMatthias Ringwald uint16_t pos = 1; 1503e7733bf2SMatthias Ringwald 150444127f43SMatthias Ringwald att_iterator_t it; 150544127f43SMatthias Ringwald att_iterator_init(&it); 150644127f43SMatthias Ringwald while (att_iterator_has_next(&it) && ((pos + 6) < response_buffer_size)){ 150744127f43SMatthias Ringwald att_iterator_fetch_next(&it); 1508e7733bf2SMatthias Ringwald log_info("handle %04x", it.handle); 150944127f43SMatthias Ringwald if (it.handle == 0) break; 151044127f43SMatthias Ringwald if (it.handle < start_handle) continue; 151144127f43SMatthias Ringwald if (it.handle > end_handle) break; 151259f775cfSMatthias Ringwald if ((uuid16 == 0) || att_iterator_match_uuid16(&it, uuid16)){ 151344127f43SMatthias Ringwald little_endian_store_16(response_buffer, pos, it.handle); 151444127f43SMatthias Ringwald pos += 2; 151544127f43SMatthias Ringwald response_buffer[pos++] = btp_permissions_for_flags(it.flags); 151644127f43SMatthias Ringwald response_buffer[pos++] = 2; 151744127f43SMatthias Ringwald little_endian_store_16(response_buffer, pos, uuid16); 151844127f43SMatthias Ringwald pos += 2; 151944127f43SMatthias Ringwald num_attributes++; 152044127f43SMatthias Ringwald } 152144127f43SMatthias Ringwald } 152244127f43SMatthias Ringwald response_buffer[0] = num_attributes; 152344127f43SMatthias Ringwald return pos; 152444127f43SMatthias Ringwald } 152544127f43SMatthias Ringwald 152644127f43SMatthias Ringwald uint16_t btp_att_get_attributes_by_uuid128(uint16_t start_handle, uint16_t end_handle, const uint8_t * uuid128, uint8_t * response_buffer, uint16_t response_buffer_size){ 152744127f43SMatthias Ringwald uint8_t num_attributes = 0; 152844127f43SMatthias Ringwald uint16_t pos = 1; 152944127f43SMatthias Ringwald att_iterator_t it; 153044127f43SMatthias Ringwald att_iterator_init(&it); 153144127f43SMatthias Ringwald while (att_iterator_has_next(&it) && ((pos + 20) < response_buffer_size)){ 153244127f43SMatthias Ringwald att_iterator_fetch_next(&it); 153344127f43SMatthias Ringwald if (it.handle == 0) break; 153444127f43SMatthias Ringwald if (it.handle < start_handle) continue; 153544127f43SMatthias Ringwald if (it.handle > end_handle) break; 153644127f43SMatthias Ringwald if (att_iterator_match_uuid(&it, (uint8_t*) uuid128, 16)){ 153744127f43SMatthias Ringwald little_endian_store_16(response_buffer, pos, it.handle); 153844127f43SMatthias Ringwald pos += 2; 153944127f43SMatthias Ringwald response_buffer[pos++] = btp_permissions_for_flags(it.flags); 154044127f43SMatthias Ringwald response_buffer[pos++] = 16; 154144127f43SMatthias Ringwald reverse_128(uuid128, &response_buffer[pos]); 154244127f43SMatthias Ringwald pos += 16; 154344127f43SMatthias Ringwald num_attributes++; 154444127f43SMatthias Ringwald } 154544127f43SMatthias Ringwald } 154644127f43SMatthias Ringwald response_buffer[0] = num_attributes; 154744127f43SMatthias Ringwald return pos; 154844127f43SMatthias Ringwald } 154944127f43SMatthias Ringwald 15506de29f25SMatthias Ringwald uint16_t btp_att_get_attribute_value(att_connection_t * att_connection, uint16_t attribute_handle, uint8_t * response_buffer, uint16_t response_buffer_size){ 155144127f43SMatthias Ringwald att_iterator_t it; 155244127f43SMatthias Ringwald int ok = att_find_handle(&it, attribute_handle); 155344127f43SMatthias Ringwald if (!ok) return 0; 155444127f43SMatthias Ringwald 155544127f43SMatthias Ringwald uint16_t pos = 0; 15566de29f25SMatthias Ringwald // field: ATT_Response - simulate READ operation on given connection 15576de29f25SMatthias Ringwald response_buffer[pos++] = att_validate_security(att_connection, ATT_READ, &it); 155844127f43SMatthias Ringwald // fetch len 155944127f43SMatthias Ringwald // assume: con handle not relevant here, else, it needs to get passed in 156044127f43SMatthias Ringwald // att_update_value_len(&it, HCI_CON_HANDLE_INVALID); 156144127f43SMatthias Ringwald uint16_t bytes_to_copy = btstack_min( response_buffer_size - 3, it.value_len); 156244127f43SMatthias Ringwald little_endian_store_16(response_buffer, pos, bytes_to_copy); 156344127f43SMatthias Ringwald pos += 2; 156444127f43SMatthias Ringwald // get value - only works for non-dynamic data 156544127f43SMatthias Ringwald if (it.value){ 156644127f43SMatthias Ringwald memcpy(&response_buffer[pos], it.value, bytes_to_copy); 156744127f43SMatthias Ringwald pos += bytes_to_copy; 156844127f43SMatthias Ringwald } 156944127f43SMatthias Ringwald return pos; 157044127f43SMatthias Ringwald } 1571d8d5d864SMilanka Ringwald // LCOV_EXCL_STOP 157244127f43SMatthias Ringwald #endif 1573