xref: /btstack/src/ble/att_db.c (revision 27c566a6f047ad37a8c27b63d77fef6fc5c71040)
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