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