xref: /btstack/src/ble/gatt_client.c (revision a6121b51b229b883431c4a1600b0f46db31d32dc)
13deb3ec6SMatthias Ringwald /*
23deb3ec6SMatthias Ringwald  * Copyright (C) 2014 BlueKitchen GmbH
33deb3ec6SMatthias Ringwald  *
43deb3ec6SMatthias Ringwald  * Redistribution and use in source and binary forms, with or without
53deb3ec6SMatthias Ringwald  * modification, are permitted provided that the following conditions
63deb3ec6SMatthias Ringwald  * are met:
73deb3ec6SMatthias Ringwald  *
83deb3ec6SMatthias Ringwald  * 1. Redistributions of source code must retain the above copyright
93deb3ec6SMatthias Ringwald  *    notice, this list of conditions and the following disclaimer.
103deb3ec6SMatthias Ringwald  * 2. Redistributions in binary form must reproduce the above copyright
113deb3ec6SMatthias Ringwald  *    notice, this list of conditions and the following disclaimer in the
123deb3ec6SMatthias Ringwald  *    documentation and/or other materials provided with the distribution.
133deb3ec6SMatthias Ringwald  * 3. Neither the name of the copyright holders nor the names of
143deb3ec6SMatthias Ringwald  *    contributors may be used to endorse or promote products derived
153deb3ec6SMatthias Ringwald  *    from this software without specific prior written permission.
163deb3ec6SMatthias Ringwald  * 4. Any redistribution, use, or modification is done solely for
173deb3ec6SMatthias Ringwald  *    personal benefit and not for any commercial purpose or for
183deb3ec6SMatthias Ringwald  *    monetary gain.
193deb3ec6SMatthias Ringwald  *
203deb3ec6SMatthias Ringwald  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
213deb3ec6SMatthias Ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
223deb3ec6SMatthias Ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
233deb3ec6SMatthias Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
243deb3ec6SMatthias Ringwald  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
253deb3ec6SMatthias Ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
263deb3ec6SMatthias Ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
273deb3ec6SMatthias Ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
283deb3ec6SMatthias Ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
293deb3ec6SMatthias Ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
303deb3ec6SMatthias Ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
313deb3ec6SMatthias Ringwald  * SUCH DAMAGE.
323deb3ec6SMatthias Ringwald  *
333deb3ec6SMatthias Ringwald  * Please inquire about commercial licensing options at
343deb3ec6SMatthias Ringwald  * [email protected]
353deb3ec6SMatthias Ringwald  *
363deb3ec6SMatthias Ringwald  */
373deb3ec6SMatthias Ringwald 
38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "gatt_client.c"
39ab2c6ae4SMatthias Ringwald 
403deb3ec6SMatthias Ringwald #include <stdint.h>
413deb3ec6SMatthias Ringwald #include <string.h>
423deb3ec6SMatthias Ringwald 
437907f069SMatthias Ringwald #include "btstack_config.h"
443deb3ec6SMatthias Ringwald 
450e2df43fSMatthias Ringwald #include "att_dispatch.h"
46fac60feaSMatthias Ringwald #include "ad_parser.h"
470e2df43fSMatthias Ringwald #include "ble/att_db.h"
4859c6af15SMatthias Ringwald #include "ble/core.h"
490e2df43fSMatthias Ringwald #include "ble/gatt_client.h"
500e2df43fSMatthias Ringwald #include "ble/le_device_db.h"
510e2df43fSMatthias Ringwald #include "ble/sm.h"
5216ece135SMatthias Ringwald #include "btstack_debug.h"
530e2df43fSMatthias Ringwald #include "btstack_event.h"
543deb3ec6SMatthias Ringwald #include "btstack_memory.h"
550e2df43fSMatthias Ringwald #include "btstack_run_loop.h"
560e2df43fSMatthias Ringwald #include "btstack_util.h"
570e2df43fSMatthias Ringwald #include "classic/sdp_util.h"
583deb3ec6SMatthias Ringwald #include "hci.h"
590e2df43fSMatthias Ringwald #include "hci_cmd.h"
603deb3ec6SMatthias Ringwald #include "hci_dump.h"
613deb3ec6SMatthias Ringwald #include "l2cap.h"
623deb3ec6SMatthias Ringwald 
639c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections;
649c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners;
65361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration;
663deb3ec6SMatthias Ringwald 
67793cf6ceSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) || defined (ENABLE_LE_SIGNED_WRITE)
68f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration;
69f4b33574SMatthias Ringwald #endif
70f4b33574SMatthias Ringwald 
715cf6c434SJakob Krantz static uint8_t mtu_exchange_enabled;
725cf6c434SJakob Krantz 
733deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size);
74f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size);
757d2258b3SMilanka Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *peripheral, uint8_t att_error_code);
767a766ebfSMatthias Ringwald 
777a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
783deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]);
797a766ebfSMatthias Ringwald #endif
803deb3ec6SMatthias Ringwald 
813deb3ec6SMatthias Ringwald static uint16_t peripheral_mtu(gatt_client_t *peripheral){
823deb3ec6SMatthias Ringwald     if (peripheral->mtu > l2cap_max_le_mtu()){
833deb3ec6SMatthias Ringwald         log_error("Peripheral mtu is not initialized");
843deb3ec6SMatthias Ringwald         return l2cap_max_le_mtu();
853deb3ec6SMatthias Ringwald     }
863deb3ec6SMatthias Ringwald     return peripheral->mtu;
873deb3ec6SMatthias Ringwald }
883deb3ec6SMatthias Ringwald 
893deb3ec6SMatthias Ringwald void gatt_client_init(void){
903deb3ec6SMatthias Ringwald     gatt_client_connections = NULL;
915cf6c434SJakob Krantz     mtu_exchange_enabled = 1;
92f4b33574SMatthias Ringwald 
93361b1363SMatthias Ringwald     // regsister for HCI Events
94f4b33574SMatthias Ringwald     hci_event_callback_registration.callback = &gatt_client_event_packet_handler;
95361b1363SMatthias Ringwald     hci_add_event_handler(&hci_event_callback_registration);
96361b1363SMatthias Ringwald 
97793cf6ceSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) || defined (ENABLE_LE_SIGNED_WRITE)
98f4b33574SMatthias Ringwald     // register for SM Events
99f4b33574SMatthias Ringwald     sm_event_callback_registration.callback = &gatt_client_event_packet_handler;
100f4b33574SMatthias Ringwald     sm_add_event_handler(&sm_event_callback_registration);
101f4b33574SMatthias Ringwald #endif
102f4b33574SMatthias Ringwald 
103361b1363SMatthias Ringwald     // and ATT Client PDUs
1043deb3ec6SMatthias Ringwald     att_dispatch_register_client(gatt_client_att_packet_handler);
1053deb3ec6SMatthias Ringwald }
1063deb3ec6SMatthias Ringwald 
107ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){
108665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
109665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_connections);
110665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
111665d90f2SMatthias Ringwald         gatt_client_t * peripheral = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
1123deb3ec6SMatthias Ringwald         if ( &peripheral->gc_timeout == ts) {
1133deb3ec6SMatthias Ringwald             return peripheral;
1143deb3ec6SMatthias Ringwald         }
1153deb3ec6SMatthias Ringwald     }
1163deb3ec6SMatthias Ringwald     return NULL;
1173deb3ec6SMatthias Ringwald }
1183deb3ec6SMatthias Ringwald 
119ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){
1203deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = gatt_client_for_timer(timer);
1217d2258b3SMilanka Ringwald     if (peripheral == NULL) return;
122fc64f94aSMatthias Ringwald     log_info("GATT client timeout handle, handle 0x%02x", peripheral->con_handle);
1233deb3ec6SMatthias Ringwald     gatt_client_report_error_if_pending(peripheral, ATT_ERROR_TIMEOUT);
1243deb3ec6SMatthias Ringwald }
1253deb3ec6SMatthias Ringwald 
1263deb3ec6SMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * peripheral){
127fc64f94aSMatthias Ringwald     log_info("GATT client timeout start, handle 0x%02x", peripheral->con_handle);
128528a4a3bSMatthias Ringwald     btstack_run_loop_remove_timer(&peripheral->gc_timeout);
129528a4a3bSMatthias Ringwald     btstack_run_loop_set_timer_handler(&peripheral->gc_timeout, gatt_client_timeout_handler);
130528a4a3bSMatthias Ringwald     btstack_run_loop_set_timer(&peripheral->gc_timeout, 30000); // 30 seconds sm timeout
131528a4a3bSMatthias Ringwald     btstack_run_loop_add_timer(&peripheral->gc_timeout);
1323deb3ec6SMatthias Ringwald }
1333deb3ec6SMatthias Ringwald 
1343deb3ec6SMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * peripheral){
135fc64f94aSMatthias Ringwald     log_info("GATT client timeout stop, handle 0x%02x", peripheral->con_handle);
136528a4a3bSMatthias Ringwald     btstack_run_loop_remove_timer(&peripheral->gc_timeout);
1373deb3ec6SMatthias Ringwald }
1383deb3ec6SMatthias Ringwald 
1393deb3ec6SMatthias Ringwald static gatt_client_t * get_gatt_client_context_for_handle(uint16_t handle){
140665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
141a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){
1423deb3ec6SMatthias Ringwald         gatt_client_t * peripheral = (gatt_client_t *) it;
143fc64f94aSMatthias Ringwald         if (peripheral->con_handle == handle){
1443deb3ec6SMatthias Ringwald             return peripheral;
1453deb3ec6SMatthias Ringwald         }
1463deb3ec6SMatthias Ringwald     }
1473deb3ec6SMatthias Ringwald     return NULL;
1483deb3ec6SMatthias Ringwald }
1493deb3ec6SMatthias Ringwald 
1503deb3ec6SMatthias Ringwald 
1513deb3ec6SMatthias Ringwald // @returns context
1523deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one
153711e6c80SMatthias Ringwald static gatt_client_t * provide_context_for_conn_handle(hci_con_handle_t con_handle){
1543deb3ec6SMatthias Ringwald     gatt_client_t * context = get_gatt_client_context_for_handle(con_handle);
1553deb3ec6SMatthias Ringwald     if (context) return context;
1563deb3ec6SMatthias Ringwald 
157ae1d1237SMatthias Ringwald     // bail if no such hci connection
158ae1d1237SMatthias Ringwald     if (!hci_connection_for_handle(con_handle)){
159ae1d1237SMatthias Ringwald         log_error("No connection for handle 0x%04x", con_handle);
160ae1d1237SMatthias Ringwald         return NULL;
161ae1d1237SMatthias Ringwald     }
1623deb3ec6SMatthias Ringwald     context = btstack_memory_gatt_client_get();
1633deb3ec6SMatthias Ringwald     if (!context) return NULL;
1643deb3ec6SMatthias Ringwald     // init state
165fc64f94aSMatthias Ringwald     context->con_handle = con_handle;
1663deb3ec6SMatthias Ringwald     context->mtu = ATT_DEFAULT_MTU;
1675cf6c434SJakob Krantz     if (mtu_exchange_enabled){
1683deb3ec6SMatthias Ringwald         context->mtu_state = SEND_MTU_EXCHANGE;
1695cf6c434SJakob Krantz     } else {
1705cf6c434SJakob Krantz         context->mtu_state = MTU_AUTO_EXCHANGE_DISABLED;
1715cf6c434SJakob Krantz     }
1723deb3ec6SMatthias Ringwald     context->gatt_client_state = P_READY;
173665d90f2SMatthias Ringwald     btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)context);
1743deb3ec6SMatthias Ringwald     return context;
1753deb3ec6SMatthias Ringwald }
1763deb3ec6SMatthias Ringwald 
177711e6c80SMatthias Ringwald static gatt_client_t * provide_context_for_conn_handle_and_start_timer(hci_con_handle_t con_handle){
1783deb3ec6SMatthias Ringwald     gatt_client_t * context = provide_context_for_conn_handle(con_handle);
1797d2258b3SMilanka Ringwald     if (context == NULL) return NULL;
1803deb3ec6SMatthias Ringwald     gatt_client_timeout_start(context);
1813deb3ec6SMatthias Ringwald     return context;
1823deb3ec6SMatthias Ringwald }
1833deb3ec6SMatthias Ringwald 
1843deb3ec6SMatthias Ringwald static int is_ready(gatt_client_t * context){
1853deb3ec6SMatthias Ringwald     return context->gatt_client_state == P_READY;
1863deb3ec6SMatthias Ringwald }
1873deb3ec6SMatthias Ringwald 
188fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){
189fc64f94aSMatthias Ringwald     gatt_client_t * context = provide_context_for_conn_handle(con_handle);
1907d2258b3SMilanka Ringwald     if (context == NULL) return 0;
1913deb3ec6SMatthias Ringwald     return is_ready(context);
1923deb3ec6SMatthias Ringwald }
1933deb3ec6SMatthias Ringwald 
1945cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){
1955cf6c434SJakob Krantz     mtu_exchange_enabled = enabled;
1965cf6c434SJakob Krantz }
1975cf6c434SJakob Krantz 
198fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){
199fc64f94aSMatthias Ringwald     gatt_client_t * context = provide_context_for_conn_handle(con_handle);
2007d2258b3SMilanka Ringwald     if (context == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
2017d2258b3SMilanka Ringwald 
2020e588213SMatthias Ringwald     if ((context->mtu_state == MTU_EXCHANGED) || (context->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){
2033deb3ec6SMatthias Ringwald         *mtu = context->mtu;
2047d2258b3SMilanka Ringwald         return ERROR_CODE_SUCCESS;
2053deb3ec6SMatthias Ringwald     }
2063deb3ec6SMatthias Ringwald     *mtu = ATT_DEFAULT_MTU;
207616edd56SMatthias Ringwald     return GATT_CLIENT_IN_WRONG_STATE;
2083deb3ec6SMatthias Ringwald }
2093deb3ec6SMatthias Ringwald 
2103deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
21125b7c058SMilanka Ringwald static uint8_t att_confirmation(uint16_t peripheral_handle){
2123deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
2133deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
2143deb3ec6SMatthias Ringwald     request[0] = ATT_HANDLE_VALUE_CONFIRMATION;
21525b7c058SMilanka Ringwald 
21625b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 1);
2173deb3ec6SMatthias Ringwald }
2183deb3ec6SMatthias Ringwald 
2193deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
22025b7c058SMilanka Ringwald static uint8_t att_find_information_request(uint16_t request_type, uint16_t peripheral_handle, uint16_t start_handle, uint16_t end_handle){
2213deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
2223deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
2233deb3ec6SMatthias Ringwald     request[0] = request_type;
224f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, start_handle);
225f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, end_handle);
2263deb3ec6SMatthias Ringwald 
22725b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5);
2283deb3ec6SMatthias Ringwald }
2293deb3ec6SMatthias Ringwald 
2303deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
23125b7c058SMilanka Ringwald static uint8_t att_find_by_type_value_request(uint16_t request_type, uint16_t attribute_group_type, uint16_t peripheral_handle, uint16_t start_handle, uint16_t end_handle, uint8_t * value, uint16_t value_size){
2323deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
2333deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
2343deb3ec6SMatthias Ringwald 
2353deb3ec6SMatthias Ringwald     request[0] = request_type;
236f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, start_handle);
237f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, end_handle);
238f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 5, attribute_group_type);
2396535961aSMatthias Ringwald     (void)memcpy(&request[7], value, value_size);
2403deb3ec6SMatthias Ringwald 
24125b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7+value_size);
2423deb3ec6SMatthias Ringwald }
2433deb3ec6SMatthias Ringwald 
2443deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
24525b7c058SMilanka Ringwald static uint8_t att_read_by_type_or_group_request_for_uuid16(uint16_t request_type, uint16_t uuid16, uint16_t peripheral_handle, uint16_t start_handle, uint16_t end_handle){
2463deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
2473deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
2483deb3ec6SMatthias Ringwald     request[0] = request_type;
249f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, start_handle);
250f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, end_handle);
251f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 5, uuid16);
2523deb3ec6SMatthias Ringwald 
25325b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7);
2543deb3ec6SMatthias Ringwald }
2553deb3ec6SMatthias Ringwald 
2563deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
25725b7c058SMilanka Ringwald static uint8_t att_read_by_type_or_group_request_for_uuid128(uint16_t request_type, uint8_t * uuid128, uint16_t peripheral_handle, uint16_t start_handle, uint16_t end_handle){
2583deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
2593deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
2603deb3ec6SMatthias Ringwald     request[0] = request_type;
261f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, start_handle);
262f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, end_handle);
2639c80e4ccSMatthias Ringwald     reverse_128(uuid128, &request[5]);
2643deb3ec6SMatthias Ringwald 
26525b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 21);
2663deb3ec6SMatthias Ringwald }
2673deb3ec6SMatthias Ringwald 
2683deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
26925b7c058SMilanka Ringwald static uint8_t att_read_request(uint16_t request_type, uint16_t peripheral_handle, uint16_t attribute_handle){
2703deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
2713deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
2723deb3ec6SMatthias Ringwald     request[0] = request_type;
273f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
2743deb3ec6SMatthias Ringwald 
27525b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3);
2763deb3ec6SMatthias Ringwald }
2773deb3ec6SMatthias Ringwald 
2783deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
27925b7c058SMilanka Ringwald static uint8_t att_read_blob_request(uint16_t request_type, uint16_t peripheral_handle, uint16_t attribute_handle, uint16_t value_offset){
2803deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
2813deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
2823deb3ec6SMatthias Ringwald     request[0] = request_type;
283f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
284f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, value_offset);
2853deb3ec6SMatthias Ringwald 
28625b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5);
2873deb3ec6SMatthias Ringwald }
2883deb3ec6SMatthias Ringwald 
28925b7c058SMilanka Ringwald static uint8_t att_read_multiple_request(uint16_t peripheral_handle, uint16_t num_value_handles, uint16_t * value_handles){
2903deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
2913deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
2923deb3ec6SMatthias Ringwald     request[0] = ATT_READ_MULTIPLE_REQUEST;
2933deb3ec6SMatthias Ringwald     int i;
2943deb3ec6SMatthias Ringwald     int offset = 1;
2953deb3ec6SMatthias Ringwald     for (i=0;i<num_value_handles;i++){
296f8fbdce0SMatthias Ringwald         little_endian_store_16(request, offset, value_handles[i]);
2973deb3ec6SMatthias Ringwald         offset += 2;
2983deb3ec6SMatthias Ringwald     }
29925b7c058SMilanka Ringwald 
30025b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, offset);
3013deb3ec6SMatthias Ringwald }
3023deb3ec6SMatthias Ringwald 
3037a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
3043deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
30525b7c058SMilanka Ringwald static uint8_t att_signed_write_request(uint16_t request_type, uint16_t peripheral_handle, uint16_t attribute_handle, uint16_t value_length, uint8_t * value, uint32_t sign_counter, uint8_t sgn[8]){
3063deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
3073deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
3083deb3ec6SMatthias Ringwald     request[0] = request_type;
309f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
3106535961aSMatthias Ringwald     (void)memcpy(&request[3], value, value_length);
311f8fbdce0SMatthias Ringwald     little_endian_store_32(request, 3 + value_length, sign_counter);
3129c80e4ccSMatthias Ringwald     reverse_64(sgn, &request[3 + value_length + 4]);
31325b7c058SMilanka Ringwald 
31425b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3 + value_length + 12);
3153deb3ec6SMatthias Ringwald }
3167a766ebfSMatthias Ringwald #endif
3173deb3ec6SMatthias Ringwald 
3183deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
31925b7c058SMilanka Ringwald static uint8_t att_write_request(uint16_t request_type, uint16_t peripheral_handle, uint16_t attribute_handle, uint16_t value_length, uint8_t * value){
3203deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
3213deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
3223deb3ec6SMatthias Ringwald     request[0] = request_type;
323f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
3246535961aSMatthias Ringwald     (void)memcpy(&request[3], value, value_length);
3253deb3ec6SMatthias Ringwald 
32625b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3 + value_length);
3273deb3ec6SMatthias Ringwald }
3283deb3ec6SMatthias Ringwald 
3293deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
33025b7c058SMilanka Ringwald static uint8_t att_execute_write_request(uint16_t request_type, uint16_t peripheral_handle, uint8_t execute_write){
3313deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
3323deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
3333deb3ec6SMatthias Ringwald     request[0] = request_type;
3343deb3ec6SMatthias Ringwald     request[1] = execute_write;
33525b7c058SMilanka Ringwald 
33625b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 2);
3373deb3ec6SMatthias Ringwald }
3383deb3ec6SMatthias Ringwald 
3393deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
34025b7c058SMilanka Ringwald static uint8_t att_prepare_write_request(uint16_t request_type, uint16_t peripheral_handle,  uint16_t attribute_handle, uint16_t value_offset, uint16_t blob_length, uint8_t * value){
3413deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
3423deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
3433deb3ec6SMatthias Ringwald     request[0] = request_type;
344f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
345f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, value_offset);
3466535961aSMatthias Ringwald     (void)memcpy(&request[5], &value[value_offset], blob_length);
3473deb3ec6SMatthias Ringwald 
34825b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5+blob_length);
3493deb3ec6SMatthias Ringwald }
3503deb3ec6SMatthias Ringwald 
35125b7c058SMilanka Ringwald static uint8_t att_exchange_mtu_request(uint16_t peripheral_handle){
3523deb3ec6SMatthias Ringwald     uint16_t mtu = l2cap_max_le_mtu();
3533deb3ec6SMatthias Ringwald     l2cap_reserve_packet_buffer();
3543deb3ec6SMatthias Ringwald     uint8_t * request = l2cap_get_outgoing_buffer();
3553deb3ec6SMatthias Ringwald     request[0] = ATT_EXCHANGE_MTU_REQUEST;
356f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, mtu);
35725b7c058SMilanka Ringwald 
35825b7c058SMilanka Ringwald     return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3);
3593deb3ec6SMatthias Ringwald }
3603deb3ec6SMatthias Ringwald 
3613deb3ec6SMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * peripheral){
3623deb3ec6SMatthias Ringwald     uint16_t max_blob_length = peripheral_mtu(peripheral) - 5;
3633deb3ec6SMatthias Ringwald     if (peripheral->attribute_offset >= peripheral->attribute_length) {
3643deb3ec6SMatthias Ringwald         return 0;
3653deb3ec6SMatthias Ringwald     }
3663deb3ec6SMatthias Ringwald     uint16_t rest_length = peripheral->attribute_length - peripheral->attribute_offset;
3673deb3ec6SMatthias Ringwald     if (max_blob_length > rest_length){
3683deb3ec6SMatthias Ringwald         return rest_length;
3693deb3ec6SMatthias Ringwald     }
3703deb3ec6SMatthias Ringwald     return max_blob_length;
3713deb3ec6SMatthias Ringwald }
3723deb3ec6SMatthias Ringwald 
3733deb3ec6SMatthias Ringwald static void send_gatt_services_request(gatt_client_t *peripheral){
374fc64f94aSMatthias Ringwald     att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_GROUP_TYPE_REQUEST, GATT_PRIMARY_SERVICE_UUID, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle);
3753deb3ec6SMatthias Ringwald }
3763deb3ec6SMatthias Ringwald 
3773deb3ec6SMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *peripheral, uint16_t attribute_group_type){
3783deb3ec6SMatthias Ringwald     if (peripheral->uuid16){
3793deb3ec6SMatthias Ringwald         uint8_t uuid16[2];
380f8fbdce0SMatthias Ringwald         little_endian_store_16(uuid16, 0, peripheral->uuid16);
381fc64f94aSMatthias Ringwald         att_find_by_type_value_request(ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle, uuid16, 2);
3823deb3ec6SMatthias Ringwald         return;
3833deb3ec6SMatthias Ringwald     }
3843deb3ec6SMatthias Ringwald     uint8_t uuid128[16];
3859c80e4ccSMatthias Ringwald     reverse_128(peripheral->uuid128, uuid128);
386fc64f94aSMatthias Ringwald     att_find_by_type_value_request(ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle, uuid128, 16);
3873deb3ec6SMatthias Ringwald }
3883deb3ec6SMatthias Ringwald 
3893deb3ec6SMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *peripheral){
3903deb3ec6SMatthias Ringwald     send_gatt_by_uuid_request(peripheral, GATT_PRIMARY_SERVICE_UUID);
3913deb3ec6SMatthias Ringwald }
3923deb3ec6SMatthias Ringwald 
3933deb3ec6SMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *peripheral){
394fc64f94aSMatthias Ringwald     att_read_request(ATT_READ_REQUEST, peripheral->con_handle, peripheral->query_start_handle);
3953deb3ec6SMatthias Ringwald }
3963deb3ec6SMatthias Ringwald 
3973deb3ec6SMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *peripheral){
398fc64f94aSMatthias Ringwald     att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_INCLUDE_SERVICE_UUID, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle);
3993deb3ec6SMatthias Ringwald }
4003deb3ec6SMatthias Ringwald 
4013deb3ec6SMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *peripheral){
402fc64f94aSMatthias Ringwald     att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_CHARACTERISTICS_UUID, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle);
4033deb3ec6SMatthias Ringwald }
4043deb3ec6SMatthias Ringwald 
4053deb3ec6SMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *peripheral){
406fc64f94aSMatthias Ringwald     att_find_information_request(ATT_FIND_INFORMATION_REQUEST, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle);
4073deb3ec6SMatthias Ringwald }
4083deb3ec6SMatthias Ringwald 
4093deb3ec6SMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *peripheral){
410fc64f94aSMatthias Ringwald     att_read_request(ATT_READ_REQUEST, peripheral->con_handle, peripheral->attribute_handle);
4113deb3ec6SMatthias Ringwald }
4123deb3ec6SMatthias Ringwald 
4133deb3ec6SMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * peripheral){
4143deb3ec6SMatthias Ringwald     if (peripheral->uuid16){
415fc64f94aSMatthias Ringwald         att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, peripheral->uuid16, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle);
4163deb3ec6SMatthias Ringwald     } else {
417fc64f94aSMatthias Ringwald         att_read_by_type_or_group_request_for_uuid128(ATT_READ_BY_TYPE_REQUEST, peripheral->uuid128, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle);
4183deb3ec6SMatthias Ringwald     }
4193deb3ec6SMatthias Ringwald }
4203deb3ec6SMatthias Ringwald 
4213deb3ec6SMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *peripheral){
422fc64f94aSMatthias Ringwald     att_read_blob_request(ATT_READ_BLOB_REQUEST, peripheral->con_handle, peripheral->attribute_handle, peripheral->attribute_offset);
4233deb3ec6SMatthias Ringwald }
4243deb3ec6SMatthias Ringwald 
4253deb3ec6SMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * peripheral){
426fc64f94aSMatthias Ringwald     att_read_multiple_request(peripheral->con_handle, peripheral->read_multiple_handle_count, peripheral->read_multiple_handles);
4273deb3ec6SMatthias Ringwald }
4283deb3ec6SMatthias Ringwald 
4293deb3ec6SMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * peripheral){
430fc64f94aSMatthias Ringwald     att_write_request(ATT_WRITE_REQUEST, peripheral->con_handle, peripheral->attribute_handle, peripheral->attribute_length, peripheral->attribute_value);
4313deb3ec6SMatthias Ringwald }
4323deb3ec6SMatthias Ringwald 
4333deb3ec6SMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * peripheral){
434fc64f94aSMatthias Ringwald     att_write_request(ATT_WRITE_REQUEST, peripheral->con_handle, peripheral->client_characteristic_configuration_handle, 2, peripheral->client_characteristic_configuration_value);
4353deb3ec6SMatthias Ringwald }
4363deb3ec6SMatthias Ringwald 
4373deb3ec6SMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * peripheral){
438fc64f94aSMatthias Ringwald     att_prepare_write_request(ATT_PREPARE_WRITE_REQUEST, peripheral->con_handle, peripheral->attribute_handle, peripheral->attribute_offset, write_blob_length(peripheral), peripheral->attribute_value);
4393deb3ec6SMatthias Ringwald }
4403deb3ec6SMatthias Ringwald 
4413deb3ec6SMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * peripheral){
442fc64f94aSMatthias Ringwald     att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, peripheral->con_handle, 1);
4433deb3ec6SMatthias Ringwald }
4443deb3ec6SMatthias Ringwald 
4453deb3ec6SMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * peripheral){
446fc64f94aSMatthias Ringwald     att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, peripheral->con_handle, 0);
4473deb3ec6SMatthias Ringwald }
4483deb3ec6SMatthias Ringwald 
449abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
4503deb3ec6SMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * peripheral){
451fc64f94aSMatthias Ringwald     att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle);
4523deb3ec6SMatthias Ringwald }
453abdc9fb5SMatthias Ringwald #endif
4543deb3ec6SMatthias Ringwald 
4553deb3ec6SMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * peripheral){
456fc64f94aSMatthias Ringwald     att_read_request(ATT_READ_REQUEST, peripheral->con_handle, peripheral->attribute_handle);
4573deb3ec6SMatthias Ringwald }
4583deb3ec6SMatthias Ringwald 
4597a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
4603deb3ec6SMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * peripheral, uint32_t sign_counter){
461fc64f94aSMatthias Ringwald     att_signed_write_request(ATT_SIGNED_WRITE_COMMAND, peripheral->con_handle, peripheral->attribute_handle, peripheral->attribute_length, peripheral->attribute_value, sign_counter, peripheral->cmac);
4623deb3ec6SMatthias Ringwald }
4637a766ebfSMatthias Ringwald #endif
4643deb3ec6SMatthias Ringwald 
4653deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){
4663deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
467f8fbdce0SMatthias Ringwald     return little_endian_read_16(packet, size - attr_length + 2);
4683deb3ec6SMatthias Ringwald }
4693deb3ec6SMatthias Ringwald 
4703deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){
4713deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
472f8fbdce0SMatthias Ringwald     return little_endian_read_16(packet, size - attr_length + 3);
4733deb3ec6SMatthias Ringwald }
4743deb3ec6SMatthias Ringwald 
4753deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){
4763deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
477f8fbdce0SMatthias Ringwald     return little_endian_read_16(packet, size - attr_length);
4783deb3ec6SMatthias Ringwald }
4793deb3ec6SMatthias Ringwald 
4803deb3ec6SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t * peripheral){
4813deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_READY;
4823deb3ec6SMatthias Ringwald     gatt_client_timeout_stop(peripheral);
4833deb3ec6SMatthias Ringwald }
4843deb3ec6SMatthias Ringwald 
4859c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){
4869c662c9bSMatthias Ringwald     if (!callback) return;
487b6e003bcSMatthias Ringwald     hci_dump_packet(HCI_EVENT_PACKET, 0, packet, size);
4889c662c9bSMatthias Ringwald     (*callback)(HCI_EVENT_PACKET, 0, packet, size);
4893deb3ec6SMatthias Ringwald }
4903deb3ec6SMatthias Ringwald 
49186c38559SMatthias Ringwald void gatt_client_listen_for_characteristic_value_updates(gatt_client_notification_t * notification, btstack_packet_handler_t packet_handler, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){
49286c38559SMatthias Ringwald     notification->callback = packet_handler;
4939c662c9bSMatthias Ringwald     notification->con_handle = con_handle;
494b3f03c84SMatthias Ringwald     if (characteristic == NULL){
495b3f03c84SMatthias Ringwald         notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE;
496b3f03c84SMatthias Ringwald     } else {
4979c662c9bSMatthias Ringwald         notification->attribute_handle = characteristic->value_handle;
498b3f03c84SMatthias Ringwald     }
4999c662c9bSMatthias Ringwald     btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification);
5009c662c9bSMatthias Ringwald }
5019c662c9bSMatthias Ringwald 
5021f734b5fSMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){
5031f734b5fSMatthias Ringwald     btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification);
5041f734b5fSMatthias Ringwald }
5051f734b5fSMatthias Ringwald 
506711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){
507665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
5089c662c9bSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners);
509665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
51086c38559SMatthias Ringwald         gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it);
511b3f03c84SMatthias Ringwald         if ((notification->con_handle       != GATT_CLIENT_ANY_CONNECTION)   && (notification->con_handle       != con_handle)) continue;
512b3f03c84SMatthias Ringwald         if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue;
51386c38559SMatthias Ringwald         (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size);
5143deb3ec6SMatthias Ringwald     }
5153deb3ec6SMatthias Ringwald }
5163deb3ec6SMatthias Ringwald 
5177d2258b3SMilanka Ringwald static void emit_gatt_complete_event(gatt_client_t * peripheral, uint8_t att_status){
5183deb3ec6SMatthias Ringwald     // @format H1
5193deb3ec6SMatthias Ringwald     uint8_t packet[5];
5205611a760SMatthias Ringwald     packet[0] = GATT_EVENT_QUERY_COMPLETE;
5213deb3ec6SMatthias Ringwald     packet[1] = 3;
522fc64f94aSMatthias Ringwald     little_endian_store_16(packet, 2, peripheral->con_handle);
5237d2258b3SMilanka Ringwald     packet[4] = att_status;
5249c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, sizeof(packet));
5253deb3ec6SMatthias Ringwald }
5263deb3ec6SMatthias Ringwald 
5273deb3ec6SMatthias Ringwald static void emit_gatt_service_query_result_event(gatt_client_t * peripheral, uint16_t start_group_handle, uint16_t end_group_handle, uint8_t * uuid128){
5283deb3ec6SMatthias Ringwald     // @format HX
5293deb3ec6SMatthias Ringwald     uint8_t packet[24];
5305611a760SMatthias Ringwald     packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT;
5313deb3ec6SMatthias Ringwald     packet[1] = sizeof(packet) - 2;
532fc64f94aSMatthias Ringwald     little_endian_store_16(packet, 2, peripheral->con_handle);
5333deb3ec6SMatthias Ringwald     ///
534f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4, start_group_handle);
535f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 6, end_group_handle);
5369c80e4ccSMatthias Ringwald     reverse_128(uuid128, &packet[8]);
5379c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, sizeof(packet));
5383deb3ec6SMatthias Ringwald }
5393deb3ec6SMatthias Ringwald 
5403deb3ec6SMatthias Ringwald static void emit_gatt_included_service_query_result_event(gatt_client_t * peripheral, uint16_t include_handle, uint16_t start_group_handle, uint16_t end_group_handle, uint8_t * uuid128){
5413deb3ec6SMatthias Ringwald     // @format HX
5423deb3ec6SMatthias Ringwald     uint8_t packet[26];
5435611a760SMatthias Ringwald     packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT;
5443deb3ec6SMatthias Ringwald     packet[1] = sizeof(packet) - 2;
545fc64f94aSMatthias Ringwald     little_endian_store_16(packet, 2, peripheral->con_handle);
5463deb3ec6SMatthias Ringwald     ///
547f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4, include_handle);
5483deb3ec6SMatthias Ringwald     //
549f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 6, start_group_handle);
550f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 8, end_group_handle);
5519c80e4ccSMatthias Ringwald     reverse_128(uuid128, &packet[10]);
5529c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, sizeof(packet));
5533deb3ec6SMatthias Ringwald }
5543deb3ec6SMatthias Ringwald 
5553deb3ec6SMatthias Ringwald static void emit_gatt_characteristic_query_result_event(gatt_client_t * peripheral, uint16_t start_handle, uint16_t value_handle, uint16_t end_handle,
5563deb3ec6SMatthias Ringwald         uint16_t properties, uint8_t * uuid128){
5573deb3ec6SMatthias Ringwald     // @format HY
5583deb3ec6SMatthias Ringwald     uint8_t packet[28];
5595611a760SMatthias Ringwald     packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT;
5603deb3ec6SMatthias Ringwald     packet[1] = sizeof(packet) - 2;
561fc64f94aSMatthias Ringwald     little_endian_store_16(packet, 2, peripheral->con_handle);
5623deb3ec6SMatthias Ringwald     ///
563f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4,  start_handle);
564f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 6,  value_handle);
565f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 8,  end_handle);
566f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 10, properties);
5679c80e4ccSMatthias Ringwald     reverse_128(uuid128, &packet[12]);
5689c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, sizeof(packet));
5693deb3ec6SMatthias Ringwald }
5703deb3ec6SMatthias Ringwald 
5713deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event(
5723deb3ec6SMatthias Ringwald     gatt_client_t * peripheral, uint16_t descriptor_handle, uint8_t * uuid128){
5733deb3ec6SMatthias Ringwald     // @format HZ
5743deb3ec6SMatthias Ringwald     uint8_t packet[22];
5755611a760SMatthias Ringwald     packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT;
5763deb3ec6SMatthias Ringwald     packet[1] = sizeof(packet) - 2;
577fc64f94aSMatthias Ringwald     little_endian_store_16(packet, 2, peripheral->con_handle);
5783deb3ec6SMatthias Ringwald     ///
579f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4,  descriptor_handle);
5809c80e4ccSMatthias Ringwald     reverse_128(uuid128, &packet[6]);
5819c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, sizeof(packet));
5823deb3ec6SMatthias Ringwald }
5833deb3ec6SMatthias Ringwald 
5848f37572aSJakob Krantz static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * peripheral, uint16_t new_mtu){
5858f37572aSJakob Krantz     // @format H2
5868f37572aSJakob Krantz     uint8_t packet[6];
5878f37572aSJakob Krantz     packet[0] = GATT_EVENT_MTU;
5888f37572aSJakob Krantz     packet[1] = sizeof(packet) - 2;
5898f37572aSJakob Krantz     little_endian_store_16(packet, 2, peripheral->con_handle);
5908f37572aSJakob Krantz     little_endian_store_16(packet, 4, new_mtu);
591b12646c5SJakob Krantz     att_dispatch_client_mtu_exchanged(peripheral->con_handle, new_mtu);
5928f37572aSJakob Krantz     emit_event_new(peripheral->callback, packet, sizeof(packet));
5938f37572aSJakob Krantz }
5948f37572aSJakob Krantz ///
5953deb3ec6SMatthias Ringwald static void report_gatt_services(gatt_client_t * peripheral, uint8_t * packet,  uint16_t size){
5963deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
5973deb3ec6SMatthias Ringwald     uint8_t uuid_length = attr_length - 4;
5983deb3ec6SMatthias Ringwald 
5993deb3ec6SMatthias Ringwald     int i;
6003deb3ec6SMatthias Ringwald     for (i = 2; i < size; i += attr_length){
601f8fbdce0SMatthias Ringwald         uint16_t start_group_handle = little_endian_read_16(packet,i);
602f8fbdce0SMatthias Ringwald         uint16_t end_group_handle   = little_endian_read_16(packet,i+2);
6033deb3ec6SMatthias Ringwald         uint8_t  uuid128[16];
6043deb3ec6SMatthias Ringwald         uint16_t uuid16 = 0;
6053deb3ec6SMatthias Ringwald 
6063deb3ec6SMatthias Ringwald         if (uuid_length == 2){
607f8fbdce0SMatthias Ringwald             uuid16 = little_endian_read_16(packet, i+4);
608e1a125dfSMatthias Ringwald             uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16);
6093deb3ec6SMatthias Ringwald         } else {
6109c80e4ccSMatthias Ringwald             reverse_128(&packet[i+4], uuid128);
6113deb3ec6SMatthias Ringwald         }
6123deb3ec6SMatthias Ringwald         emit_gatt_service_query_result_event(peripheral, start_group_handle, end_group_handle, uuid128);
6133deb3ec6SMatthias Ringwald     }
614fc64f94aSMatthias Ringwald     // log_info("report_gatt_services for %02X done", peripheral->con_handle);
6153deb3ec6SMatthias Ringwald }
6163deb3ec6SMatthias Ringwald 
6173deb3ec6SMatthias Ringwald // helper
6183deb3ec6SMatthias Ringwald static void characteristic_start_found(gatt_client_t * peripheral, uint16_t start_handle, uint8_t properties, uint16_t value_handle, uint8_t * uuid, uint16_t uuid_length){
6193deb3ec6SMatthias Ringwald     uint8_t uuid128[16];
6203deb3ec6SMatthias Ringwald     uint16_t uuid16 = 0;
6213deb3ec6SMatthias Ringwald     if (uuid_length == 2){
622f8fbdce0SMatthias Ringwald         uuid16 = little_endian_read_16(uuid, 0);
623e1a125dfSMatthias Ringwald         uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16);
6243deb3ec6SMatthias Ringwald     } else {
6259c80e4ccSMatthias Ringwald         reverse_128(uuid, uuid128);
6263deb3ec6SMatthias Ringwald     }
6273deb3ec6SMatthias Ringwald 
6285df9dc78SMatthias Ringwald     if (peripheral->filter_with_uuid && (memcmp(peripheral->uuid128, uuid128, 16) != 0)) return;
6293deb3ec6SMatthias Ringwald 
6303deb3ec6SMatthias Ringwald     peripheral->characteristic_properties = properties;
6313deb3ec6SMatthias Ringwald     peripheral->characteristic_start_handle = start_handle;
6323deb3ec6SMatthias Ringwald     peripheral->attribute_handle = value_handle;
6333deb3ec6SMatthias Ringwald 
6343deb3ec6SMatthias Ringwald     if (peripheral->filter_with_uuid) return;
6353deb3ec6SMatthias Ringwald 
6363deb3ec6SMatthias Ringwald     peripheral->uuid16 = uuid16;
6376535961aSMatthias Ringwald     (void)memcpy(peripheral->uuid128, uuid128, 16);
6383deb3ec6SMatthias Ringwald }
6393deb3ec6SMatthias Ringwald 
6403deb3ec6SMatthias Ringwald static void characteristic_end_found(gatt_client_t * peripheral, uint16_t end_handle){
6413deb3ec6SMatthias Ringwald     // TODO: stop searching if filter and uuid found
6423deb3ec6SMatthias Ringwald 
6433deb3ec6SMatthias Ringwald     if (!peripheral->characteristic_start_handle) return;
6443deb3ec6SMatthias Ringwald 
6453deb3ec6SMatthias Ringwald     emit_gatt_characteristic_query_result_event(peripheral, peripheral->characteristic_start_handle, peripheral->attribute_handle,
6463deb3ec6SMatthias Ringwald         end_handle, peripheral->characteristic_properties, peripheral->uuid128);
6473deb3ec6SMatthias Ringwald 
6483deb3ec6SMatthias Ringwald     peripheral->characteristic_start_handle = 0;
6493deb3ec6SMatthias Ringwald }
6503deb3ec6SMatthias Ringwald 
6513deb3ec6SMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * peripheral, uint8_t * packet,  uint16_t size){
6523deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
6533deb3ec6SMatthias Ringwald     uint8_t uuid_length = attr_length - 5;
6543deb3ec6SMatthias Ringwald     int i;
6553deb3ec6SMatthias Ringwald     for (i = 2; i < size; i += attr_length){
656f8fbdce0SMatthias Ringwald         uint16_t start_handle = little_endian_read_16(packet, i);
6573deb3ec6SMatthias Ringwald         uint8_t  properties = packet[i+2];
658f8fbdce0SMatthias Ringwald         uint16_t value_handle = little_endian_read_16(packet, i+3);
6593deb3ec6SMatthias Ringwald         characteristic_end_found(peripheral, start_handle-1);
6603deb3ec6SMatthias Ringwald         characteristic_start_found(peripheral, start_handle, properties, value_handle, &packet[i+5], uuid_length);
6613deb3ec6SMatthias Ringwald     }
6623deb3ec6SMatthias Ringwald }
6633deb3ec6SMatthias Ringwald 
6643deb3ec6SMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * peripheral, uint16_t include_handle, uint16_t uuid16){
6653deb3ec6SMatthias Ringwald     uint8_t normalized_uuid128[16];
666e1a125dfSMatthias Ringwald     uuid_add_bluetooth_prefix(normalized_uuid128, uuid16);
6673deb3ec6SMatthias Ringwald     emit_gatt_included_service_query_result_event(peripheral, include_handle, peripheral->query_start_handle,
6683deb3ec6SMatthias Ringwald         peripheral->query_end_handle, normalized_uuid128);
6693deb3ec6SMatthias Ringwald }
6703deb3ec6SMatthias Ringwald 
6713deb3ec6SMatthias Ringwald static void report_gatt_included_service_uuid128(gatt_client_t * peripheral, uint16_t include_handle, uint8_t *uuid128){
6723deb3ec6SMatthias Ringwald     emit_gatt_included_service_query_result_event(peripheral, include_handle, peripheral->query_start_handle,
6733deb3ec6SMatthias Ringwald         peripheral->query_end_handle, uuid128);
6743deb3ec6SMatthias Ringwald }
6753deb3ec6SMatthias Ringwald 
6763deb3ec6SMatthias Ringwald // @returns packet pointer
6773deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers
6783deb3ec6SMatthias Ringwald static const int characteristic_value_event_header_size = 8;
679711e6c80SMatthias Ringwald static uint8_t * setup_characteristic_value_packet(uint8_t type, hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * value, uint16_t length){
680*a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
681*a6121b51SMilanka Ringwald     // avoid using pre ATT headers.
682*a6121b51SMilanka Ringwald     return NULL;
683*a6121b51SMilanka Ringwald #endif
6843deb3ec6SMatthias Ringwald     // before the value inside the ATT PDU
6853deb3ec6SMatthias Ringwald     uint8_t * packet = value - characteristic_value_event_header_size;
6863deb3ec6SMatthias Ringwald     packet[0] = type;
6873deb3ec6SMatthias Ringwald     packet[1] = characteristic_value_event_header_size - 2 + length;
688f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 2, con_handle);
689f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4, attribute_handle);
690f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 6, length);
6913deb3ec6SMatthias Ringwald     return packet;
6923deb3ec6SMatthias Ringwald }
6933deb3ec6SMatthias Ringwald 
6943deb3ec6SMatthias Ringwald // @returns packet pointer
6953deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
6963deb3ec6SMatthias Ringwald static const int long_characteristic_value_event_header_size = 10;
697711e6c80SMatthias Ringwald static uint8_t * setup_long_characteristic_value_packet(uint8_t type, hci_con_handle_t con_handle, uint16_t attribute_handle, uint16_t offset, uint8_t * value, uint16_t length){
698*a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
699*a6121b51SMilanka Ringwald     // avoid using pre ATT headers.
700*a6121b51SMilanka Ringwald     return NULL;
701*a6121b51SMilanka Ringwald #endif
7023deb3ec6SMatthias Ringwald #if defined(HCI_INCOMING_PRE_BUFFER_SIZE) && (HCI_INCOMING_PRE_BUFFER_SIZE >= 10 - 8) // L2CAP Header (4) - ACL Header (4)
7033deb3ec6SMatthias Ringwald     // before the value inside the ATT PDU
7043deb3ec6SMatthias Ringwald     uint8_t * packet = value - long_characteristic_value_event_header_size;
7053deb3ec6SMatthias Ringwald     packet[0] = type;
7063deb3ec6SMatthias Ringwald     packet[1] = long_characteristic_value_event_header_size - 2 + length;
707f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 2, con_handle);
708f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4, attribute_handle);
709f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 6, offset);
710f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 8, length);
7113deb3ec6SMatthias Ringwald     return packet;
7123deb3ec6SMatthias Ringwald #else
7133deb3ec6SMatthias Ringwald     log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads");
7143deb3ec6SMatthias Ringwald     return NULL;
7153deb3ec6SMatthias Ringwald #endif
7163deb3ec6SMatthias Ringwald }
7173deb3ec6SMatthias Ringwald 
7183deb3ec6SMatthias Ringwald 
7193deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
720711e6c80SMatthias Ringwald static void report_gatt_notification(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){
7215611a760SMatthias Ringwald     uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, con_handle, value_handle, value, length);
7229c662c9bSMatthias Ringwald     emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length);
7233deb3ec6SMatthias Ringwald }
7243deb3ec6SMatthias Ringwald 
7253deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
726711e6c80SMatthias Ringwald static void report_gatt_indication(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){
7275611a760SMatthias Ringwald     uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, con_handle, value_handle, value, length);
7289c662c9bSMatthias Ringwald     emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length);
7293deb3ec6SMatthias Ringwald }
7303deb3ec6SMatthias Ringwald 
7313deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
7323deb3ec6SMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * peripheral, uint16_t attribute_handle, uint8_t * value, uint16_t length){
733fc64f94aSMatthias Ringwald     uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, peripheral->con_handle, attribute_handle, value, length);
7349c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, characteristic_value_event_header_size + length);
7353deb3ec6SMatthias Ringwald }
7363deb3ec6SMatthias Ringwald 
7373deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
7383deb3ec6SMatthias Ringwald static void report_gatt_long_characteristic_value_blob(gatt_client_t * peripheral, uint16_t attribute_handle, uint8_t * blob, uint16_t blob_length, int value_offset){
739fc64f94aSMatthias Ringwald     uint8_t * packet = setup_long_characteristic_value_packet(GATT_EVENT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT, peripheral->con_handle, attribute_handle, value_offset, blob, blob_length);
7403deb3ec6SMatthias Ringwald     if (!packet) return;
7419c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, blob_length + long_characteristic_value_event_header_size);
7423deb3ec6SMatthias Ringwald }
7433deb3ec6SMatthias Ringwald 
7443deb3ec6SMatthias Ringwald static void report_gatt_characteristic_descriptor(gatt_client_t * peripheral, uint16_t descriptor_handle, uint8_t *value, uint16_t value_length, uint16_t value_offset){
7459ec2630cSMatthias Ringwald     UNUSED(value_offset);
746fc64f94aSMatthias Ringwald     uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, peripheral->con_handle, descriptor_handle, value, value_length);
7479c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, value_length + 8);
7483deb3ec6SMatthias Ringwald }
7493deb3ec6SMatthias Ringwald 
7503deb3ec6SMatthias Ringwald static void report_gatt_long_characteristic_descriptor(gatt_client_t * peripheral, uint16_t descriptor_handle, uint8_t *blob, uint16_t blob_length, uint16_t value_offset){
751fc64f94aSMatthias Ringwald     uint8_t * packet = setup_long_characteristic_value_packet(GATT_EVENT_LONG_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, peripheral->con_handle, descriptor_handle, value_offset, blob, blob_length);
7523deb3ec6SMatthias Ringwald     if (!packet) return;
7539c662c9bSMatthias Ringwald     emit_event_new(peripheral->callback, packet, blob_length + long_characteristic_value_event_header_size);
7543deb3ec6SMatthias Ringwald }
7553deb3ec6SMatthias Ringwald 
7563deb3ec6SMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * peripheral, uint8_t * packet, uint16_t size, uint16_t pair_size){
7573deb3ec6SMatthias Ringwald     int i;
758*a6121b51SMilanka Ringwald     for (i = 0; (i + pair_size) <= size; i += pair_size){
759f8fbdce0SMatthias Ringwald         uint16_t descriptor_handle = little_endian_read_16(packet,i);
7603deb3ec6SMatthias Ringwald         uint8_t uuid128[16];
7613deb3ec6SMatthias Ringwald         uint16_t uuid16 = 0;
7623deb3ec6SMatthias Ringwald         if (pair_size == 4){
763f8fbdce0SMatthias Ringwald             uuid16 = little_endian_read_16(packet,i+2);
764e1a125dfSMatthias Ringwald             uuid_add_bluetooth_prefix(uuid128, uuid16);
7653deb3ec6SMatthias Ringwald         } else {
7669c80e4ccSMatthias Ringwald             reverse_128(&packet[i+2], uuid128);
7673deb3ec6SMatthias Ringwald         }
7683deb3ec6SMatthias Ringwald         emit_gatt_all_characteristic_descriptors_result_event(peripheral, descriptor_handle, uuid128);
7693deb3ec6SMatthias Ringwald     }
7703deb3ec6SMatthias Ringwald 
7713deb3ec6SMatthias Ringwald }
7723deb3ec6SMatthias Ringwald 
7733deb3ec6SMatthias Ringwald static int is_query_done(gatt_client_t * peripheral, uint16_t last_result_handle){
7743deb3ec6SMatthias Ringwald     return last_result_handle >= peripheral->end_group_handle;
7753deb3ec6SMatthias Ringwald }
7763deb3ec6SMatthias Ringwald 
7773deb3ec6SMatthias Ringwald static void trigger_next_query(gatt_client_t * peripheral, uint16_t last_result_handle, gatt_client_state_t next_query_state){
7783deb3ec6SMatthias Ringwald     if (is_query_done(peripheral, last_result_handle)){
7793deb3ec6SMatthias Ringwald         gatt_client_handle_transaction_complete(peripheral);
7809cb80b17SMilanka Ringwald         emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
7813deb3ec6SMatthias Ringwald         return;
7823deb3ec6SMatthias Ringwald     }
7833deb3ec6SMatthias Ringwald     // next
7843deb3ec6SMatthias Ringwald     peripheral->start_group_handle = last_result_handle + 1;
7853deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = next_query_state;
7863deb3ec6SMatthias Ringwald }
7873deb3ec6SMatthias Ringwald 
78800748105SMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * peripheral, uint16_t last_result_handle){
7893deb3ec6SMatthias Ringwald     trigger_next_query(peripheral, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY);
7903deb3ec6SMatthias Ringwald }
7913deb3ec6SMatthias Ringwald 
79200748105SMatthias Ringwald static void trigger_next_service_query(gatt_client_t * peripheral, uint16_t last_result_handle){
7933deb3ec6SMatthias Ringwald     trigger_next_query(peripheral, last_result_handle, P_W2_SEND_SERVICE_QUERY);
7943deb3ec6SMatthias Ringwald }
7953deb3ec6SMatthias Ringwald 
79600748105SMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * peripheral, uint16_t last_result_handle){
7973deb3ec6SMatthias Ringwald     trigger_next_query(peripheral, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY);
7983deb3ec6SMatthias Ringwald }
7993deb3ec6SMatthias Ringwald 
80000748105SMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * peripheral, uint16_t last_result_handle){
8013deb3ec6SMatthias Ringwald     if (is_query_done(peripheral, last_result_handle)){
8023deb3ec6SMatthias Ringwald         // report last characteristic
8033deb3ec6SMatthias Ringwald         characteristic_end_found(peripheral, peripheral->end_group_handle);
8043deb3ec6SMatthias Ringwald     }
8053deb3ec6SMatthias Ringwald     trigger_next_query(peripheral, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY);
8063deb3ec6SMatthias Ringwald }
8073deb3ec6SMatthias Ringwald 
80800748105SMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * peripheral, uint16_t last_result_handle){
8093deb3ec6SMatthias Ringwald     trigger_next_query(peripheral, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY);
8103deb3ec6SMatthias Ringwald }
8113deb3ec6SMatthias Ringwald 
81200748105SMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * peripheral, uint16_t last_result_handle){
8133deb3ec6SMatthias Ringwald     trigger_next_query(peripheral, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST);
8143deb3ec6SMatthias Ringwald }
8153deb3ec6SMatthias Ringwald 
81600748105SMatthias Ringwald static void trigger_next_prepare_write_query(gatt_client_t * peripheral, gatt_client_state_t next_query_state, gatt_client_state_t done_state){
8173deb3ec6SMatthias Ringwald     peripheral->attribute_offset += write_blob_length(peripheral);
8183deb3ec6SMatthias Ringwald     uint16_t next_blob_length =  write_blob_length(peripheral);
8193deb3ec6SMatthias Ringwald 
8203deb3ec6SMatthias Ringwald     if (next_blob_length == 0){
8213deb3ec6SMatthias Ringwald         peripheral->gatt_client_state = done_state;
8223deb3ec6SMatthias Ringwald         return;
8233deb3ec6SMatthias Ringwald     }
8243deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = next_query_state;
8253deb3ec6SMatthias Ringwald }
8263deb3ec6SMatthias Ringwald 
82700748105SMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * peripheral, gatt_client_state_t next_query_state, uint16_t received_blob_length){
8283deb3ec6SMatthias Ringwald 
8293deb3ec6SMatthias Ringwald     uint16_t max_blob_length = peripheral_mtu(peripheral) - 1;
8303deb3ec6SMatthias Ringwald     if (received_blob_length < max_blob_length){
8313deb3ec6SMatthias Ringwald         gatt_client_handle_transaction_complete(peripheral);
8329cb80b17SMilanka Ringwald         emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
8333deb3ec6SMatthias Ringwald         return;
8343deb3ec6SMatthias Ringwald     }
8353deb3ec6SMatthias Ringwald 
8363deb3ec6SMatthias Ringwald     peripheral->attribute_offset += received_blob_length;
8373deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = next_query_state;
8383deb3ec6SMatthias Ringwald }
8393deb3ec6SMatthias Ringwald 
8403deb3ec6SMatthias Ringwald 
8413deb3ec6SMatthias Ringwald static int is_value_valid(gatt_client_t *peripheral, uint8_t *packet, uint16_t size){
842f8fbdce0SMatthias Ringwald     uint16_t attribute_handle = little_endian_read_16(packet, 1);
843f8fbdce0SMatthias Ringwald     uint16_t value_offset = little_endian_read_16(packet, 3);
8443deb3ec6SMatthias Ringwald 
8453deb3ec6SMatthias Ringwald     if (peripheral->attribute_handle != attribute_handle) return 0;
8463deb3ec6SMatthias Ringwald     if (peripheral->attribute_offset != value_offset) return 0;
8473deb3ec6SMatthias Ringwald     return memcmp(&peripheral->attribute_value[peripheral->attribute_offset], &packet[5], size-5) == 0;
8483deb3ec6SMatthias Ringwald }
8493deb3ec6SMatthias Ringwald 
850544128c3SMatthias Ringwald // returns 1 if packet was sent
851544128c3SMatthias Ringwald static int gatt_client_run_for_peripheral( gatt_client_t * peripheral){
8523deb3ec6SMatthias Ringwald     // log_info("- handle_peripheral_list, mtu state %u, client state %u", peripheral->mtu_state, peripheral->gatt_client_state);
8533deb3ec6SMatthias Ringwald 
854d1e1a57fSMatthias Ringwald     // wait until re-encryption as central is complete
855d1e1a57fSMatthias Ringwald     if (gap_reconnect_security_setup_active(peripheral->con_handle)) return 0;
856d1e1a57fSMatthias Ringwald 
857f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING
858f4b33574SMatthias Ringwald     // wait until pairing complete
859f4b33574SMatthias Ringwald     if (peripheral->wait_for_pairing_complete) return 0;
860f4b33574SMatthias Ringwald #endif
861f4b33574SMatthias Ringwald 
8623deb3ec6SMatthias Ringwald     switch (peripheral->mtu_state) {
863544128c3SMatthias Ringwald         case SEND_MTU_EXCHANGE:
8643deb3ec6SMatthias Ringwald             peripheral->mtu_state = SENT_MTU_EXCHANGE;
865fc64f94aSMatthias Ringwald             att_exchange_mtu_request(peripheral->con_handle);
866544128c3SMatthias Ringwald             return 1;
8673deb3ec6SMatthias Ringwald         case SENT_MTU_EXCHANGE:
868544128c3SMatthias Ringwald             return 0;
8693deb3ec6SMatthias Ringwald         default:
8703deb3ec6SMatthias Ringwald             break;
8713deb3ec6SMatthias Ringwald     }
8723deb3ec6SMatthias Ringwald 
8733deb3ec6SMatthias Ringwald     if (peripheral->send_confirmation){
8743deb3ec6SMatthias Ringwald         peripheral->send_confirmation = 0;
875fc64f94aSMatthias Ringwald         att_confirmation(peripheral->con_handle);
876544128c3SMatthias Ringwald         return 1;
8773deb3ec6SMatthias Ringwald     }
8783deb3ec6SMatthias Ringwald 
8793deb3ec6SMatthias Ringwald     // check MTU for writes
8803deb3ec6SMatthias Ringwald     switch (peripheral->gatt_client_state){
8813deb3ec6SMatthias Ringwald         case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE:
8823deb3ec6SMatthias Ringwald         case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR:
883c1ab6cc1SMatthias Ringwald             if (peripheral->attribute_length <= (peripheral_mtu(peripheral) - 3)) break;
8843deb3ec6SMatthias Ringwald             log_error("gatt_client_run: value len %u > MTU %u - 3\n", peripheral->attribute_length, peripheral_mtu(peripheral));
8853deb3ec6SMatthias Ringwald             gatt_client_handle_transaction_complete(peripheral);
8863deb3ec6SMatthias Ringwald             emit_gatt_complete_event(peripheral, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH);
887544128c3SMatthias Ringwald             return 0;
8883deb3ec6SMatthias Ringwald         default:
8893deb3ec6SMatthias Ringwald             break;
8903deb3ec6SMatthias Ringwald     }
8913deb3ec6SMatthias Ringwald 
8923deb3ec6SMatthias Ringwald     // log_info("gatt_client_state %u", peripheral->gatt_client_state);
8933deb3ec6SMatthias Ringwald     switch (peripheral->gatt_client_state){
8943deb3ec6SMatthias Ringwald         case P_W2_SEND_SERVICE_QUERY:
8953deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_SERVICE_QUERY_RESULT;
8963deb3ec6SMatthias Ringwald             send_gatt_services_request(peripheral);
897544128c3SMatthias Ringwald             return 1;
8983deb3ec6SMatthias Ringwald 
8993deb3ec6SMatthias Ringwald         case P_W2_SEND_SERVICE_WITH_UUID_QUERY:
9003deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_SERVICE_WITH_UUID_RESULT;
9013deb3ec6SMatthias Ringwald             send_gatt_services_by_uuid_request(peripheral);
902544128c3SMatthias Ringwald             return 1;
9033deb3ec6SMatthias Ringwald 
9043deb3ec6SMatthias Ringwald         case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY:
9053deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT;
9063deb3ec6SMatthias Ringwald             send_gatt_characteristic_request(peripheral);
907544128c3SMatthias Ringwald             return 1;
9083deb3ec6SMatthias Ringwald 
9093deb3ec6SMatthias Ringwald         case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY:
9103deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT;
9113deb3ec6SMatthias Ringwald             send_gatt_characteristic_request(peripheral);
912544128c3SMatthias Ringwald             return 1;
9133deb3ec6SMatthias Ringwald 
9143deb3ec6SMatthias Ringwald         case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY:
9153deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT;
9163deb3ec6SMatthias Ringwald             send_gatt_characteristic_descriptor_request(peripheral);
917544128c3SMatthias Ringwald             return 1;
9183deb3ec6SMatthias Ringwald 
9193deb3ec6SMatthias Ringwald         case P_W2_SEND_INCLUDED_SERVICE_QUERY:
9203deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_INCLUDED_SERVICE_QUERY_RESULT;
9213deb3ec6SMatthias Ringwald             send_gatt_included_service_request(peripheral);
922544128c3SMatthias Ringwald             return 1;
9233deb3ec6SMatthias Ringwald 
9243deb3ec6SMatthias Ringwald         case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY:
9253deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT;
9263deb3ec6SMatthias Ringwald             send_gatt_included_service_uuid_request(peripheral);
927544128c3SMatthias Ringwald             return 1;
9283deb3ec6SMatthias Ringwald 
9293deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY:
9303deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT;
9313deb3ec6SMatthias Ringwald             send_gatt_read_characteristic_value_request(peripheral);
932544128c3SMatthias Ringwald             return 1;
9333deb3ec6SMatthias Ringwald 
9343deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_BLOB_QUERY:
9353deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_READ_BLOB_RESULT;
9363deb3ec6SMatthias Ringwald             send_gatt_read_blob_request(peripheral);
937544128c3SMatthias Ringwald             return 1;
9383deb3ec6SMatthias Ringwald 
9393deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_BY_TYPE_REQUEST:
9403deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_READ_BY_TYPE_RESPONSE;
9413deb3ec6SMatthias Ringwald             send_gatt_read_by_type_request(peripheral);
942544128c3SMatthias Ringwald             return 1;
9433deb3ec6SMatthias Ringwald 
9443deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_MULTIPLE_REQUEST:
9453deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_READ_MULTIPLE_RESPONSE;
9463deb3ec6SMatthias Ringwald             send_gatt_read_multiple_request(peripheral);
947544128c3SMatthias Ringwald             return 1;
9483deb3ec6SMatthias Ringwald 
9493deb3ec6SMatthias Ringwald         case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE:
9503deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT;
9513deb3ec6SMatthias Ringwald             send_gatt_write_attribute_value_request(peripheral);
952544128c3SMatthias Ringwald             return 1;
9533deb3ec6SMatthias Ringwald 
9543deb3ec6SMatthias Ringwald         case P_W2_PREPARE_WRITE:
9553deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_PREPARE_WRITE_RESULT;
9563deb3ec6SMatthias Ringwald             send_gatt_prepare_write_request(peripheral);
957544128c3SMatthias Ringwald             return 1;
9583deb3ec6SMatthias Ringwald 
9593deb3ec6SMatthias Ringwald         case P_W2_PREPARE_WRITE_SINGLE:
9603deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_PREPARE_WRITE_SINGLE_RESULT;
9613deb3ec6SMatthias Ringwald             send_gatt_prepare_write_request(peripheral);
962544128c3SMatthias Ringwald             return 1;
9633deb3ec6SMatthias Ringwald 
9643deb3ec6SMatthias Ringwald         case P_W2_PREPARE_RELIABLE_WRITE:
9653deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_PREPARE_RELIABLE_WRITE_RESULT;
9663deb3ec6SMatthias Ringwald             send_gatt_prepare_write_request(peripheral);
967544128c3SMatthias Ringwald             return 1;
9683deb3ec6SMatthias Ringwald 
9693deb3ec6SMatthias Ringwald         case P_W2_EXECUTE_PREPARED_WRITE:
9703deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_RESULT;
9713deb3ec6SMatthias Ringwald             send_gatt_execute_write_request(peripheral);
972544128c3SMatthias Ringwald             return 1;
9733deb3ec6SMatthias Ringwald 
9743deb3ec6SMatthias Ringwald         case P_W2_CANCEL_PREPARED_WRITE:
9753deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_RESULT;
9763deb3ec6SMatthias Ringwald             send_gatt_cancel_prepared_write_request(peripheral);
977544128c3SMatthias Ringwald             return 1;
9783deb3ec6SMatthias Ringwald 
9793deb3ec6SMatthias Ringwald         case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH:
9803deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT;
9813deb3ec6SMatthias Ringwald             send_gatt_cancel_prepared_write_request(peripheral);
982544128c3SMatthias Ringwald             return 1;
9833deb3ec6SMatthias Ringwald 
984abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
985abdc9fb5SMatthias Ringwald         case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY:
986abdc9fb5SMatthias Ringwald             // use Find Information
987abdc9fb5SMatthias Ringwald             peripheral->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT;
988abdc9fb5SMatthias Ringwald             send_gatt_characteristic_descriptor_request(peripheral);
989abdc9fb5SMatthias Ringwald #else
9903deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY:
991abdc9fb5SMatthias Ringwald             // Use Read By Type
9923deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT;
9933deb3ec6SMatthias Ringwald             send_gatt_read_client_characteristic_configuration_request(peripheral);
994abdc9fb5SMatthias Ringwald #endif
995544128c3SMatthias Ringwald             return 1;
9963deb3ec6SMatthias Ringwald 
9973deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY:
9983deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT;
9993deb3ec6SMatthias Ringwald             send_gatt_read_characteristic_descriptor_request(peripheral);
1000544128c3SMatthias Ringwald             return 1;
10013deb3ec6SMatthias Ringwald 
10023deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY:
10033deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT;
10043deb3ec6SMatthias Ringwald             send_gatt_read_blob_request(peripheral);
1005544128c3SMatthias Ringwald             return 1;
10063deb3ec6SMatthias Ringwald 
10073deb3ec6SMatthias Ringwald         case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR:
10083deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT;
10093deb3ec6SMatthias Ringwald             send_gatt_write_attribute_value_request(peripheral);
1010544128c3SMatthias Ringwald             return 1;
10113deb3ec6SMatthias Ringwald 
10123deb3ec6SMatthias Ringwald         case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION:
10133deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT;
10143deb3ec6SMatthias Ringwald             send_gatt_write_client_characteristic_configuration_request(peripheral);
1015544128c3SMatthias Ringwald             return 1;
10163deb3ec6SMatthias Ringwald 
10173deb3ec6SMatthias Ringwald         case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR:
10183deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT;
10193deb3ec6SMatthias Ringwald             send_gatt_prepare_write_request(peripheral);
1020544128c3SMatthias Ringwald             return 1;
10213deb3ec6SMatthias Ringwald 
10223deb3ec6SMatthias Ringwald         case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR:
10233deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT;
10243deb3ec6SMatthias Ringwald             send_gatt_execute_write_request(peripheral);
1025544128c3SMatthias Ringwald             return 1;
10263deb3ec6SMatthias Ringwald 
10277a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
1028793cf6ceSMatthias Ringwald         case P_W4_IDENTITY_RESOLVING:
1029793cf6ceSMatthias Ringwald             log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(peripheral->con_handle));
1030793cf6ceSMatthias Ringwald             switch (sm_identity_resolving_state(peripheral->con_handle)){
1031793cf6ceSMatthias Ringwald                 case IRK_LOOKUP_SUCCEEDED:
1032793cf6ceSMatthias Ringwald                     peripheral->le_device_index = sm_le_device_index(peripheral->con_handle);
1033793cf6ceSMatthias Ringwald                     peripheral->gatt_client_state = P_W4_CMAC_READY;
1034793cf6ceSMatthias Ringwald                     break;
1035793cf6ceSMatthias Ringwald                 case IRK_LOOKUP_FAILED:
1036793cf6ceSMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
1037793cf6ceSMatthias Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_BONDING_INFORMATION_MISSING);
1038793cf6ceSMatthias Ringwald                     return 0;
1039793cf6ceSMatthias Ringwald                 default:
1040793cf6ceSMatthias Ringwald                     return 0;
1041793cf6ceSMatthias Ringwald             }
1042793cf6ceSMatthias Ringwald 
1043793cf6ceSMatthias Ringwald             /* Fall through */
1044793cf6ceSMatthias Ringwald 
10453deb3ec6SMatthias Ringwald         case P_W4_CMAC_READY:
10463deb3ec6SMatthias Ringwald             if (sm_cmac_ready()){
10473deb3ec6SMatthias Ringwald                 sm_key_t csrk;
10483deb3ec6SMatthias Ringwald                 le_device_db_local_csrk_get(peripheral->le_device_index, csrk);
10493deb3ec6SMatthias Ringwald                 uint32_t sign_counter = le_device_db_local_counter_get(peripheral->le_device_index);
10503deb3ec6SMatthias Ringwald                 peripheral->gatt_client_state = P_W4_CMAC_RESULT;
10514dfd504aSMatthias Ringwald                 sm_cmac_signed_write_start(csrk, ATT_SIGNED_WRITE_COMMAND, peripheral->attribute_handle, peripheral->attribute_length, peripheral->attribute_value, sign_counter, att_signed_write_handle_cmac_result);
10523deb3ec6SMatthias Ringwald             }
1053544128c3SMatthias Ringwald             return 0;
10543deb3ec6SMatthias Ringwald 
10553deb3ec6SMatthias Ringwald         case P_W2_SEND_SIGNED_WRITE: {
10563deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W4_SEND_SINGED_WRITE_DONE;
10573deb3ec6SMatthias Ringwald             // bump local signing counter
10583deb3ec6SMatthias Ringwald             uint32_t sign_counter = le_device_db_local_counter_get(peripheral->le_device_index);
10593deb3ec6SMatthias Ringwald             le_device_db_local_counter_set(peripheral->le_device_index, sign_counter + 1);
106064b12680SMatthias Ringwald             // send signed write command
10613deb3ec6SMatthias Ringwald             send_gatt_signed_write_request(peripheral, sign_counter);
10623deb3ec6SMatthias Ringwald             // finally, notifiy client that write is complete
10633deb3ec6SMatthias Ringwald             gatt_client_handle_transaction_complete(peripheral);
10649cb80b17SMilanka Ringwald             emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
1065544128c3SMatthias Ringwald             return 1;
10663deb3ec6SMatthias Ringwald         }
10677a766ebfSMatthias Ringwald #endif
10683deb3ec6SMatthias Ringwald         default:
10693deb3ec6SMatthias Ringwald             break;
10703deb3ec6SMatthias Ringwald     }
107147181045SMatthias Ringwald 
107247181045SMatthias Ringwald     // requested can send snow?
107347181045SMatthias Ringwald     if (peripheral->write_without_response_callback){
107447181045SMatthias Ringwald         btstack_packet_handler_t packet_handler = peripheral->write_without_response_callback;
107547181045SMatthias Ringwald         peripheral->write_without_response_callback = NULL;
107647181045SMatthias Ringwald         uint8_t event[4];
107747181045SMatthias Ringwald         event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE;
107847181045SMatthias Ringwald         event[1] = sizeof(event) - 2;
107947181045SMatthias Ringwald         little_endian_store_16(event, 2, peripheral->con_handle);
108047181045SMatthias Ringwald         packet_handler(HCI_EVENT_PACKET, peripheral->con_handle, event, sizeof(event));
108147181045SMatthias Ringwald         return 1; // to trigger requeueing (even if higher layer didn't sent)
108247181045SMatthias Ringwald     }
108347181045SMatthias Ringwald 
1084544128c3SMatthias Ringwald     return 0;
10853deb3ec6SMatthias Ringwald }
10863deb3ec6SMatthias Ringwald 
1087544128c3SMatthias Ringwald static void gatt_client_run(void){
1088544128c3SMatthias Ringwald     btstack_linked_item_t *it;
1089a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){
1090544128c3SMatthias Ringwald         gatt_client_t * peripheral = (gatt_client_t *) it;
1091544128c3SMatthias Ringwald         if (!att_dispatch_client_can_send_now(peripheral->con_handle)) {
1092544128c3SMatthias Ringwald             att_dispatch_client_request_can_send_now_event(peripheral->con_handle);
1093544128c3SMatthias Ringwald             return;
1094544128c3SMatthias Ringwald         }
1095544128c3SMatthias Ringwald         int packet_sent = gatt_client_run_for_peripheral(peripheral);
1096544128c3SMatthias Ringwald         if (packet_sent){
109745f2a740SMatthias Ringwald             // request new permission
1098544128c3SMatthias Ringwald             att_dispatch_client_request_can_send_now_event(peripheral->con_handle);
109945f2a740SMatthias Ringwald             // requeue client for fairness and exit
110045f2a740SMatthias Ringwald             // note: iterator has become invalid
110145f2a740SMatthias Ringwald             btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) peripheral);
110245f2a740SMatthias Ringwald             btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) peripheral);
1103544128c3SMatthias Ringwald             return;
1104544128c3SMatthias Ringwald         }
1105544128c3SMatthias Ringwald     }
11063deb3ec6SMatthias Ringwald }
11073deb3ec6SMatthias Ringwald 
11087d2258b3SMilanka Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *peripheral, uint8_t att_error_code) {
11097d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 1) return;
11103deb3ec6SMatthias Ringwald     gatt_client_handle_transaction_complete(peripheral);
11117d2258b3SMilanka Ringwald     emit_gatt_complete_event(peripheral, att_error_code);
11123deb3ec6SMatthias Ringwald }
11133deb3ec6SMatthias Ringwald 
1114f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
11151ac26e06SMatthias Ringwald     UNUSED(channel);    // ok: handling own l2cap events
11161ac26e06SMatthias Ringwald     UNUSED(size);       // ok: there is no channel
11179ec2630cSMatthias Ringwald 
1118361b1363SMatthias Ringwald     if (packet_type != HCI_EVENT_PACKET) return;
1119361b1363SMatthias Ringwald 
1120f4b33574SMatthias Ringwald     hci_con_handle_t con_handle;
1121f4b33574SMatthias Ringwald     gatt_client_t * peripheral;
11220e2df43fSMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
11233deb3ec6SMatthias Ringwald         case HCI_EVENT_DISCONNECTION_COMPLETE:
11243deb3ec6SMatthias Ringwald             log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE");
1125f4b33574SMatthias Ringwald             con_handle = little_endian_read_16(packet,3);
1126f4b33574SMatthias Ringwald             peripheral = get_gatt_client_context_for_handle(con_handle);
11277d2258b3SMilanka Ringwald             if (peripheral == NULL) break;
11283deb3ec6SMatthias Ringwald 
1129cce308d6SMatthias Ringwald             gatt_client_report_error_if_pending(peripheral, ATT_ERROR_HCI_DISCONNECT_RECEIVED);
1130cce308d6SMatthias Ringwald             gatt_client_timeout_stop(peripheral);
1131665d90f2SMatthias Ringwald             btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) peripheral);
11323deb3ec6SMatthias Ringwald             btstack_memory_gatt_client_free(peripheral);
11333deb3ec6SMatthias Ringwald             break;
1134f4b33574SMatthias Ringwald 
1135f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING
1136f4b33574SMatthias Ringwald         // Pairing complete (with/without bonding=storing of pairing information)
1137f4b33574SMatthias Ringwald         case SM_EVENT_PAIRING_COMPLETE:
1138f4b33574SMatthias Ringwald             con_handle = sm_event_pairing_complete_get_handle(packet);
1139f4b33574SMatthias Ringwald             peripheral = get_gatt_client_context_for_handle(con_handle);
11407d2258b3SMilanka Ringwald             if (peripheral == NULL) break;
1141f4b33574SMatthias Ringwald 
1142f4b33574SMatthias Ringwald             if (peripheral->wait_for_pairing_complete){
1143f4b33574SMatthias Ringwald                 peripheral->wait_for_pairing_complete = 0;
1144f4b33574SMatthias Ringwald                 if (sm_event_pairing_complete_get_status(packet)){
1145f4b33574SMatthias Ringwald                     log_info("pairing failed, report previous error 0x%x", peripheral->pending_error_code);
1146f4b33574SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
1147f4b33574SMatthias Ringwald                     emit_gatt_complete_event(peripheral, peripheral->pending_error_code);
1148f4b33574SMatthias Ringwald                 } else {
1149f4b33574SMatthias Ringwald                     log_info("pairing success, retry operation");
11503deb3ec6SMatthias Ringwald                 }
1151f4b33574SMatthias Ringwald             }
1152f4b33574SMatthias Ringwald             break;
1153f4b33574SMatthias Ringwald #endif
1154793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
1155793cf6ceSMatthias Ringwald         // Identity Resolving completed (no code, gatt_client_run will continue)
1156793cf6ceSMatthias Ringwald         case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED:
1157793cf6ceSMatthias Ringwald         case SM_EVENT_IDENTITY_RESOLVING_FAILED:
1158793cf6ceSMatthias Ringwald             break;
1159793cf6ceSMatthias Ringwald #endif
1160f4b33574SMatthias Ringwald 
11613deb3ec6SMatthias Ringwald         default:
11623deb3ec6SMatthias Ringwald             break;
11633deb3ec6SMatthias Ringwald     }
11643deb3ec6SMatthias Ringwald 
1165361b1363SMatthias Ringwald     gatt_client_run();
11663deb3ec6SMatthias Ringwald }
11673deb3ec6SMatthias Ringwald 
11683deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){
11690fbf59a1SMatthias Ringwald     gatt_client_t * peripheral;
1170*a6121b51SMilanka Ringwald     if (size < 1) return;
11710fbf59a1SMatthias Ringwald 
11720fbf59a1SMatthias Ringwald     if (packet_type == HCI_EVENT_PACKET) {
11730fbf59a1SMatthias Ringwald         switch (packet[0]){
11740fbf59a1SMatthias Ringwald             case L2CAP_EVENT_CAN_SEND_NOW:
117551764b3bSMatthias Ringwald                 gatt_client_run();
11760fbf59a1SMatthias Ringwald                 break;
11770fbf59a1SMatthias Ringwald             // att_server has negotiated the mtu for this connection, cache if context exists
11780fbf59a1SMatthias Ringwald             case ATT_EVENT_MTU_EXCHANGE_COMPLETE:
1179*a6121b51SMilanka Ringwald                 if (size < 6) break;
11800fbf59a1SMatthias Ringwald                 peripheral = get_gatt_client_context_for_handle(handle);
11817d2258b3SMilanka Ringwald                 if (peripheral == NULL) break;
11820fbf59a1SMatthias Ringwald                 peripheral->mtu = little_endian_read_16(packet, 4);
11830fbf59a1SMatthias Ringwald                 break;
11840fbf59a1SMatthias Ringwald             default:
11850fbf59a1SMatthias Ringwald                 break;
11860fbf59a1SMatthias Ringwald         }
11870fbf59a1SMatthias Ringwald         return;
118851764b3bSMatthias Ringwald     }
118951764b3bSMatthias Ringwald 
11903deb3ec6SMatthias Ringwald     if (packet_type != ATT_DATA_PACKET) return;
11913deb3ec6SMatthias Ringwald 
11923deb3ec6SMatthias Ringwald     // special cases: notifications don't need a context while indications motivate creating one
11933deb3ec6SMatthias Ringwald     switch (packet[0]){
11943deb3ec6SMatthias Ringwald         case ATT_HANDLE_VALUE_NOTIFICATION:
1195*a6121b51SMilanka Ringwald             if (size < 3) return;
1196f8fbdce0SMatthias Ringwald             report_gatt_notification(handle, little_endian_read_16(packet,1), &packet[3], size-3);
11973deb3ec6SMatthias Ringwald             return;
11983deb3ec6SMatthias Ringwald         case ATT_HANDLE_VALUE_INDICATION:
11993deb3ec6SMatthias Ringwald             peripheral = provide_context_for_conn_handle(handle);
12003deb3ec6SMatthias Ringwald             break;
12013deb3ec6SMatthias Ringwald         default:
12023deb3ec6SMatthias Ringwald             peripheral = get_gatt_client_context_for_handle(handle);
12033deb3ec6SMatthias Ringwald             break;
12043deb3ec6SMatthias Ringwald     }
12053deb3ec6SMatthias Ringwald 
12067d2258b3SMilanka Ringwald     if (peripheral == NULL) return;
12073deb3ec6SMatthias Ringwald 
12083deb3ec6SMatthias Ringwald     switch (packet[0]){
12093deb3ec6SMatthias Ringwald         case ATT_EXCHANGE_MTU_RESPONSE:
12103deb3ec6SMatthias Ringwald         {
1211*a6121b51SMilanka Ringwald             if (size < 3) break;
1212f8fbdce0SMatthias Ringwald             uint16_t remote_rx_mtu = little_endian_read_16(packet, 1);
12133deb3ec6SMatthias Ringwald             uint16_t local_rx_mtu = l2cap_max_le_mtu();
1214c1ab6cc1SMatthias Ringwald             peripheral->mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu;
12153deb3ec6SMatthias Ringwald             peripheral->mtu_state = MTU_EXCHANGED;
12168f37572aSJakob Krantz             emit_gatt_mtu_exchanged_result_event(peripheral, peripheral->mtu);
12173deb3ec6SMatthias Ringwald             break;
12183deb3ec6SMatthias Ringwald         }
12193deb3ec6SMatthias Ringwald         case ATT_READ_BY_GROUP_TYPE_RESPONSE:
12203deb3ec6SMatthias Ringwald             switch(peripheral->gatt_client_state){
12213deb3ec6SMatthias Ringwald                 case P_W4_SERVICE_QUERY_RESULT:
12223deb3ec6SMatthias Ringwald                     report_gatt_services(peripheral, packet, size);
12233deb3ec6SMatthias Ringwald                     trigger_next_service_query(peripheral, get_last_result_handle_from_service_list(packet, size));
12245611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
12253deb3ec6SMatthias Ringwald                     break;
12263deb3ec6SMatthias Ringwald                 default:
12273deb3ec6SMatthias Ringwald                     break;
12283deb3ec6SMatthias Ringwald             }
12293deb3ec6SMatthias Ringwald             break;
12303deb3ec6SMatthias Ringwald         case ATT_HANDLE_VALUE_INDICATION:
1231*a6121b51SMilanka Ringwald             if (size < 3) break;
1232f8fbdce0SMatthias Ringwald             report_gatt_indication(handle, little_endian_read_16(packet,1), &packet[3], size-3);
12333deb3ec6SMatthias Ringwald             peripheral->send_confirmation = 1;
12343deb3ec6SMatthias Ringwald             break;
12353deb3ec6SMatthias Ringwald 
12363deb3ec6SMatthias Ringwald         case ATT_READ_BY_TYPE_RESPONSE:
12373deb3ec6SMatthias Ringwald             switch (peripheral->gatt_client_state){
12383deb3ec6SMatthias Ringwald                 case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT:
12393deb3ec6SMatthias Ringwald                     report_gatt_characteristics(peripheral, packet, size);
12403deb3ec6SMatthias Ringwald                     trigger_next_characteristic_query(peripheral, get_last_result_handle_from_characteristics_list(packet, size));
12415611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR
12423deb3ec6SMatthias Ringwald                     break;
12433deb3ec6SMatthias Ringwald                 case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT:
12443deb3ec6SMatthias Ringwald                     report_gatt_characteristics(peripheral, packet, size);
12453deb3ec6SMatthias Ringwald                     trigger_next_characteristic_query(peripheral, get_last_result_handle_from_characteristics_list(packet, size));
12465611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR
12473deb3ec6SMatthias Ringwald                     break;
12483deb3ec6SMatthias Ringwald                 case P_W4_INCLUDED_SERVICE_QUERY_RESULT:
12493deb3ec6SMatthias Ringwald                 {
1250*a6121b51SMilanka Ringwald                     if (size < 2) break;
12513deb3ec6SMatthias Ringwald                     uint16_t uuid16 = 0;
12523deb3ec6SMatthias Ringwald                     uint16_t pair_size = packet[1];
12533deb3ec6SMatthias Ringwald 
12543deb3ec6SMatthias Ringwald                     if (pair_size < 7){
1255*a6121b51SMilanka Ringwald                         if (size < 8) break;
12563deb3ec6SMatthias Ringwald                         // UUIDs not available, query first included service
1257f8fbdce0SMatthias Ringwald                         peripheral->start_group_handle = little_endian_read_16(packet, 2); // ready for next query
1258f8fbdce0SMatthias Ringwald                         peripheral->query_start_handle = little_endian_read_16(packet, 4);
1259f8fbdce0SMatthias Ringwald                         peripheral->query_end_handle = little_endian_read_16(packet,6);
12603deb3ec6SMatthias Ringwald                         peripheral->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY;
12613deb3ec6SMatthias Ringwald                         break;
12623deb3ec6SMatthias Ringwald                     }
12633deb3ec6SMatthias Ringwald 
12643deb3ec6SMatthias Ringwald                     uint16_t offset;
1265*a6121b51SMilanka Ringwald                     for (offset = 2; (offset + 8) < size; offset += pair_size){
1266f8fbdce0SMatthias Ringwald                         uint16_t include_handle = little_endian_read_16(packet, offset);
1267f8fbdce0SMatthias Ringwald                         peripheral->query_start_handle = little_endian_read_16(packet,offset+2);
1268f8fbdce0SMatthias Ringwald                         peripheral->query_end_handle = little_endian_read_16(packet,offset+4);
1269f8fbdce0SMatthias Ringwald                         uuid16 = little_endian_read_16(packet, offset+6);
12703deb3ec6SMatthias Ringwald                         report_gatt_included_service_uuid16(peripheral, include_handle, uuid16);
12713deb3ec6SMatthias Ringwald                     }
12723deb3ec6SMatthias Ringwald 
12733deb3ec6SMatthias Ringwald                     trigger_next_included_service_query(peripheral, get_last_result_handle_from_included_services_list(packet, size));
12745611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
12753deb3ec6SMatthias Ringwald                     break;
12763deb3ec6SMatthias Ringwald                 }
1277abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
12783deb3ec6SMatthias Ringwald                 case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT:
1279f8fbdce0SMatthias Ringwald                     peripheral->client_characteristic_configuration_handle = little_endian_read_16(packet, 2);
12803deb3ec6SMatthias Ringwald                     peripheral->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION;
12813deb3ec6SMatthias Ringwald                     break;
1282abdc9fb5SMatthias Ringwald #endif
12833deb3ec6SMatthias Ringwald                 case P_W4_READ_BY_TYPE_RESPONSE: {
12843deb3ec6SMatthias Ringwald                     uint16_t pair_size = packet[1];
12853deb3ec6SMatthias Ringwald                     uint16_t offset;
12863deb3ec6SMatthias Ringwald                     uint16_t last_result_handle = 0;
12873deb3ec6SMatthias Ringwald                     for (offset = 2; offset < size ; offset += pair_size){
1288f8fbdce0SMatthias Ringwald                         uint16_t value_handle = little_endian_read_16(packet, offset);
12893deb3ec6SMatthias Ringwald                         report_gatt_characteristic_value(peripheral, value_handle, &packet[offset+2], pair_size-2);
12903deb3ec6SMatthias Ringwald                         last_result_handle = value_handle;
12913deb3ec6SMatthias Ringwald                     }
12923deb3ec6SMatthias Ringwald                     trigger_next_read_by_type_query(peripheral, last_result_handle);
12933deb3ec6SMatthias Ringwald                     break;
12943deb3ec6SMatthias Ringwald                 }
12953deb3ec6SMatthias Ringwald                 default:
12963deb3ec6SMatthias Ringwald                     break;
12973deb3ec6SMatthias Ringwald             }
12983deb3ec6SMatthias Ringwald             break;
12993deb3ec6SMatthias Ringwald         case ATT_READ_RESPONSE:
13003deb3ec6SMatthias Ringwald             switch (peripheral->gatt_client_state){
13013deb3ec6SMatthias Ringwald                 case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: {
13023deb3ec6SMatthias Ringwald                     uint8_t uuid128[16];
13039c80e4ccSMatthias Ringwald                     reverse_128(&packet[1], uuid128);
13043deb3ec6SMatthias Ringwald                     report_gatt_included_service_uuid128(peripheral, peripheral->start_group_handle, uuid128);
13053deb3ec6SMatthias Ringwald                     trigger_next_included_service_query(peripheral, peripheral->start_group_handle);
13065611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
13073deb3ec6SMatthias Ringwald                     break;
13083deb3ec6SMatthias Ringwald                 }
13093deb3ec6SMatthias Ringwald                 case P_W4_READ_CHARACTERISTIC_VALUE_RESULT:
13103deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
13113deb3ec6SMatthias Ringwald                     report_gatt_characteristic_value(peripheral, peripheral->attribute_handle, &packet[1], size-1);
13129cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
13133deb3ec6SMatthias Ringwald                     break;
13143deb3ec6SMatthias Ringwald 
13153deb3ec6SMatthias Ringwald                 case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:{
13163deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
13173deb3ec6SMatthias Ringwald                     report_gatt_characteristic_descriptor(peripheral, peripheral->attribute_handle, &packet[1], size-1, 0);
13189cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
13193deb3ec6SMatthias Ringwald                     break;
13203deb3ec6SMatthias Ringwald                 }
13213deb3ec6SMatthias Ringwald                 default:
13223deb3ec6SMatthias Ringwald                     break;
13233deb3ec6SMatthias Ringwald             }
13243deb3ec6SMatthias Ringwald             break;
13253deb3ec6SMatthias Ringwald 
13263deb3ec6SMatthias Ringwald         case ATT_FIND_BY_TYPE_VALUE_RESPONSE:
13273deb3ec6SMatthias Ringwald         {
13283deb3ec6SMatthias Ringwald             uint8_t pair_size = 4;
13293deb3ec6SMatthias Ringwald             int i;
13303deb3ec6SMatthias Ringwald             uint16_t start_group_handle;
13315611a760SMatthias Ringwald             uint16_t   end_group_handle= 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results
1332*a6121b51SMilanka Ringwald             for (i = 1; (i + pair_size) <= size; i += pair_size){
1333f8fbdce0SMatthias Ringwald                 start_group_handle = little_endian_read_16(packet,i);
1334f8fbdce0SMatthias Ringwald                 end_group_handle = little_endian_read_16(packet,i+2);
13353deb3ec6SMatthias Ringwald                 emit_gatt_service_query_result_event(peripheral, start_group_handle, end_group_handle, peripheral->uuid128);
13363deb3ec6SMatthias Ringwald             }
13373deb3ec6SMatthias Ringwald             trigger_next_service_by_uuid_query(peripheral, end_group_handle);
13385611a760SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
13393deb3ec6SMatthias Ringwald             break;
13403deb3ec6SMatthias Ringwald         }
13413deb3ec6SMatthias Ringwald         case ATT_FIND_INFORMATION_REPLY:
13423deb3ec6SMatthias Ringwald         {
1343*a6121b51SMilanka Ringwald             if (size < 2) break;
1344*a6121b51SMilanka Ringwald 
13453deb3ec6SMatthias Ringwald             uint8_t pair_size = 4;
13463deb3ec6SMatthias Ringwald             if (packet[1] == 2){
13473deb3ec6SMatthias Ringwald                 pair_size = 18;
13483deb3ec6SMatthias Ringwald             }
1349*a6121b51SMilanka Ringwald             uint16_t offset = 2;
1350*a6121b51SMilanka Ringwald 
1351*a6121b51SMilanka Ringwald             if (size < (pair_size + offset)) break;
1352f8fbdce0SMatthias Ringwald             uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size);
1353abdc9fb5SMatthias Ringwald 
1354abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
1355abdc9fb5SMatthias Ringwald             log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", peripheral->gatt_client_state);
1356abdc9fb5SMatthias Ringwald             if (peripheral->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){
1357abdc9fb5SMatthias Ringwald                 // iterate over descriptors looking for CCC
1358abdc9fb5SMatthias Ringwald                 if (pair_size == 4){
1359*a6121b51SMilanka Ringwald                     while ((offset + 4) <= size){
1360abdc9fb5SMatthias Ringwald                         uint16_t uuid16 = little_endian_read_16(packet, offset + 2);
1361abdc9fb5SMatthias Ringwald                         if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){
1362abdc9fb5SMatthias Ringwald                             peripheral->client_characteristic_configuration_handle = little_endian_read_16(packet, offset);
1363abdc9fb5SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION;
1364abdc9fb5SMatthias Ringwald                             log_info("CCC found %x", peripheral->client_characteristic_configuration_handle);
1365abdc9fb5SMatthias Ringwald                             break;
1366abdc9fb5SMatthias Ringwald                         }
1367abdc9fb5SMatthias Ringwald                         offset += pair_size;
1368abdc9fb5SMatthias Ringwald                     }
1369abdc9fb5SMatthias Ringwald                 }
1370abdc9fb5SMatthias Ringwald                 if (is_query_done(peripheral, last_descriptor_handle)){
1371abdc9fb5SMatthias Ringwald 
1372abdc9fb5SMatthias Ringwald                 } else {
1373abdc9fb5SMatthias Ringwald                     // next
1374abdc9fb5SMatthias Ringwald                     peripheral->start_group_handle = last_descriptor_handle + 1;
1375abdc9fb5SMatthias Ringwald                     peripheral->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY;
1376abdc9fb5SMatthias Ringwald                 }
1377abdc9fb5SMatthias Ringwald                 break;
1378abdc9fb5SMatthias Ringwald             }
1379abdc9fb5SMatthias Ringwald #endif
13803deb3ec6SMatthias Ringwald             report_gatt_all_characteristic_descriptors(peripheral, &packet[2], size-2, pair_size);
13813deb3ec6SMatthias Ringwald             trigger_next_characteristic_descriptor_query(peripheral, last_descriptor_handle);
13825611a760SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
13833deb3ec6SMatthias Ringwald             break;
13843deb3ec6SMatthias Ringwald         }
13853deb3ec6SMatthias Ringwald 
13863deb3ec6SMatthias Ringwald         case ATT_WRITE_RESPONSE:
13873deb3ec6SMatthias Ringwald             switch (peripheral->gatt_client_state){
13883deb3ec6SMatthias Ringwald                 case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT:
13893deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
13909cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
13913deb3ec6SMatthias Ringwald                     break;
13923deb3ec6SMatthias Ringwald                 case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT:
13933deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
13949cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
13953deb3ec6SMatthias Ringwald                     break;
13963deb3ec6SMatthias Ringwald                 case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
13973deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
13989cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
13993deb3ec6SMatthias Ringwald                     break;
14003deb3ec6SMatthias Ringwald                 default:
14013deb3ec6SMatthias Ringwald                     break;
14023deb3ec6SMatthias Ringwald             }
14033deb3ec6SMatthias Ringwald             break;
14043deb3ec6SMatthias Ringwald 
14053deb3ec6SMatthias Ringwald         case ATT_READ_BLOB_RESPONSE:{
14063deb3ec6SMatthias Ringwald             uint16_t received_blob_length = size-1;
14073deb3ec6SMatthias Ringwald             switch(peripheral->gatt_client_state){
14083deb3ec6SMatthias Ringwald                 case P_W4_READ_BLOB_RESULT:
14093deb3ec6SMatthias Ringwald                     report_gatt_long_characteristic_value_blob(peripheral, peripheral->attribute_handle, &packet[1], received_blob_length, peripheral->attribute_offset);
14103deb3ec6SMatthias Ringwald                     trigger_next_blob_query(peripheral, P_W2_SEND_READ_BLOB_QUERY, received_blob_length);
14115611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
14123deb3ec6SMatthias Ringwald                     break;
14133deb3ec6SMatthias Ringwald                 case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT:
14143deb3ec6SMatthias Ringwald                     report_gatt_long_characteristic_descriptor(peripheral, peripheral->attribute_handle,
14153deb3ec6SMatthias Ringwald                                                           &packet[1], received_blob_length,
14163deb3ec6SMatthias Ringwald                                                           peripheral->attribute_offset);
14173deb3ec6SMatthias Ringwald                     trigger_next_blob_query(peripheral, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, received_blob_length);
14185611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
14193deb3ec6SMatthias Ringwald                     break;
14203deb3ec6SMatthias Ringwald                 default:
14213deb3ec6SMatthias Ringwald                     break;
14223deb3ec6SMatthias Ringwald             }
14233deb3ec6SMatthias Ringwald             break;
14243deb3ec6SMatthias Ringwald         }
14253deb3ec6SMatthias Ringwald         case ATT_PREPARE_WRITE_RESPONSE:
14263deb3ec6SMatthias Ringwald             switch (peripheral->gatt_client_state){
14273deb3ec6SMatthias Ringwald                 case P_W4_PREPARE_WRITE_SINGLE_RESULT:
14283deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
14293deb3ec6SMatthias Ringwald                     if (is_value_valid(peripheral, packet, size)){
14309cb80b17SMilanka Ringwald                         emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
14313deb3ec6SMatthias Ringwald                     } else {
14323deb3ec6SMatthias Ringwald                         emit_gatt_complete_event(peripheral, ATT_ERROR_DATA_MISMATCH);
14333deb3ec6SMatthias Ringwald                     }
14343deb3ec6SMatthias Ringwald                     break;
14353deb3ec6SMatthias Ringwald 
14363deb3ec6SMatthias Ringwald                 case P_W4_PREPARE_WRITE_RESULT:{
1437f8fbdce0SMatthias Ringwald                     peripheral->attribute_offset = little_endian_read_16(packet, 3);
14383deb3ec6SMatthias Ringwald                     trigger_next_prepare_write_query(peripheral, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE);
14395611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
14403deb3ec6SMatthias Ringwald                     break;
14413deb3ec6SMatthias Ringwald                 }
14423deb3ec6SMatthias Ringwald                 case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:{
1443f8fbdce0SMatthias Ringwald                     peripheral->attribute_offset = little_endian_read_16(packet, 3);
14443deb3ec6SMatthias Ringwald                     trigger_next_prepare_write_query(peripheral, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR);
14455611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
14463deb3ec6SMatthias Ringwald                     break;
14473deb3ec6SMatthias Ringwald                 }
14483deb3ec6SMatthias Ringwald                 case P_W4_PREPARE_RELIABLE_WRITE_RESULT:{
14493deb3ec6SMatthias Ringwald                     if (is_value_valid(peripheral, packet, size)){
1450f8fbdce0SMatthias Ringwald                         peripheral->attribute_offset = little_endian_read_16(packet, 3);
14513deb3ec6SMatthias Ringwald                         trigger_next_prepare_write_query(peripheral, P_W2_PREPARE_RELIABLE_WRITE, P_W2_EXECUTE_PREPARED_WRITE);
14525611a760SMatthias Ringwald                         // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
14533deb3ec6SMatthias Ringwald                         break;
14543deb3ec6SMatthias Ringwald                     }
14553deb3ec6SMatthias Ringwald                     peripheral->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH;
14563deb3ec6SMatthias Ringwald                     break;
14573deb3ec6SMatthias Ringwald                 }
14583deb3ec6SMatthias Ringwald                 default:
14593deb3ec6SMatthias Ringwald                     break;
14603deb3ec6SMatthias Ringwald             }
14613deb3ec6SMatthias Ringwald             break;
14623deb3ec6SMatthias Ringwald 
14633deb3ec6SMatthias Ringwald         case ATT_EXECUTE_WRITE_RESPONSE:
14643deb3ec6SMatthias Ringwald             switch (peripheral->gatt_client_state){
14653deb3ec6SMatthias Ringwald                 case P_W4_EXECUTE_PREPARED_WRITE_RESULT:
14663deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
14679cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
14683deb3ec6SMatthias Ringwald                     break;
14693deb3ec6SMatthias Ringwald                 case P_W4_CANCEL_PREPARED_WRITE_RESULT:
14703deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
14719cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
14723deb3ec6SMatthias Ringwald                     break;
14733deb3ec6SMatthias Ringwald                 case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT:
14743deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
14753deb3ec6SMatthias Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_DATA_MISMATCH);
14763deb3ec6SMatthias Ringwald                     break;
14773deb3ec6SMatthias Ringwald                 case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
14783deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
14799cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
14803deb3ec6SMatthias Ringwald                     break;
14813deb3ec6SMatthias Ringwald                 default:
14823deb3ec6SMatthias Ringwald                     break;
14833deb3ec6SMatthias Ringwald 
14843deb3ec6SMatthias Ringwald             }
14853deb3ec6SMatthias Ringwald             break;
14863deb3ec6SMatthias Ringwald 
14873deb3ec6SMatthias Ringwald         case ATT_READ_MULTIPLE_RESPONSE:
14883deb3ec6SMatthias Ringwald             switch(peripheral->gatt_client_state){
14893deb3ec6SMatthias Ringwald                 case P_W4_READ_MULTIPLE_RESPONSE:
14903deb3ec6SMatthias Ringwald                     report_gatt_characteristic_value(peripheral, 0, &packet[1], size-1);
14913deb3ec6SMatthias Ringwald                     gatt_client_handle_transaction_complete(peripheral);
14929cb80b17SMilanka Ringwald                     emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
14933deb3ec6SMatthias Ringwald                     break;
14943deb3ec6SMatthias Ringwald                 default:
14953deb3ec6SMatthias Ringwald                     break;
14963deb3ec6SMatthias Ringwald             }
14973deb3ec6SMatthias Ringwald             break;
14983deb3ec6SMatthias Ringwald 
14993deb3ec6SMatthias Ringwald         case ATT_ERROR_RESPONSE:
1500*a6121b51SMilanka Ringwald             if (size < 5) return;
15013deb3ec6SMatthias Ringwald             switch (packet[4]){
15023deb3ec6SMatthias Ringwald                 case ATT_ERROR_ATTRIBUTE_NOT_FOUND: {
15033deb3ec6SMatthias Ringwald                     switch(peripheral->gatt_client_state){
15043deb3ec6SMatthias Ringwald                         case P_W4_SERVICE_QUERY_RESULT:
15053deb3ec6SMatthias Ringwald                         case P_W4_SERVICE_WITH_UUID_RESULT:
15063deb3ec6SMatthias Ringwald                         case P_W4_INCLUDED_SERVICE_QUERY_RESULT:
15073deb3ec6SMatthias Ringwald                         case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT:
15083deb3ec6SMatthias Ringwald                             gatt_client_handle_transaction_complete(peripheral);
15099cb80b17SMilanka Ringwald                             emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
15103deb3ec6SMatthias Ringwald                             break;
15113deb3ec6SMatthias Ringwald                         case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT:
15123deb3ec6SMatthias Ringwald                         case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT:
15133deb3ec6SMatthias Ringwald                             characteristic_end_found(peripheral, peripheral->end_group_handle);
15143deb3ec6SMatthias Ringwald                             gatt_client_handle_transaction_complete(peripheral);
15159cb80b17SMilanka Ringwald                             emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
15163deb3ec6SMatthias Ringwald                             break;
15173deb3ec6SMatthias Ringwald                         case P_W4_READ_BY_TYPE_RESPONSE:
15183deb3ec6SMatthias Ringwald                             gatt_client_handle_transaction_complete(peripheral);
15193deb3ec6SMatthias Ringwald                             if (peripheral->start_group_handle == peripheral->query_start_handle){
15203deb3ec6SMatthias Ringwald                                 emit_gatt_complete_event(peripheral, ATT_ERROR_ATTRIBUTE_NOT_FOUND);
15213deb3ec6SMatthias Ringwald                             } else {
15229cb80b17SMilanka Ringwald                                 emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
15233deb3ec6SMatthias Ringwald                             }
15243deb3ec6SMatthias Ringwald                             break;
15253deb3ec6SMatthias Ringwald                         default:
15263deb3ec6SMatthias Ringwald                             gatt_client_report_error_if_pending(peripheral, packet[4]);
15273deb3ec6SMatthias Ringwald                             break;
15283deb3ec6SMatthias Ringwald                     }
15293deb3ec6SMatthias Ringwald                     break;
15303deb3ec6SMatthias Ringwald                 }
1531f4b33574SMatthias Ringwald 
1532f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING
1533f4b33574SMatthias Ringwald 
1534f4b33574SMatthias Ringwald                 case ATT_ERROR_INSUFFICIENT_AUTHENTICATION:
1535f4b33574SMatthias Ringwald                 case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE:
1536a0e0c2beSMatthias Ringwald                 case ATT_ERROR_INSUFFICIENT_ENCRYPTION: {
1537a0e0c2beSMatthias Ringwald 
1538f4b33574SMatthias Ringwald                     // security too low
1539f4b33574SMatthias Ringwald                     if (peripheral->security_counter > 0) {
1540f4b33574SMatthias Ringwald                         gatt_client_report_error_if_pending(peripheral, packet[4]);
1541f4b33574SMatthias Ringwald                         break;
1542f4b33574SMatthias Ringwald                     }
1543f4b33574SMatthias Ringwald                     // start security
1544f4b33574SMatthias Ringwald                     peripheral->security_counter++;
1545f4b33574SMatthias Ringwald 
1546f4b33574SMatthias Ringwald                     // setup action
1547f4b33574SMatthias Ringwald                     int retry = 1;
1548f4b33574SMatthias Ringwald                     switch (peripheral->gatt_client_state){
1549f4b33574SMatthias Ringwald                         case P_W4_READ_CHARACTERISTIC_VALUE_RESULT:
1550f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ;
1551f4b33574SMatthias Ringwald                             break;
1552f4b33574SMatthias Ringwald                         case P_W4_READ_BLOB_RESULT:
1553f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY;
1554f4b33574SMatthias Ringwald                             break;
1555f4b33574SMatthias Ringwald                         case P_W4_READ_BY_TYPE_RESPONSE:
1556f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST;
1557f4b33574SMatthias Ringwald                             break;
1558f4b33574SMatthias Ringwald                         case P_W4_READ_MULTIPLE_RESPONSE:
1559f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST;
1560f4b33574SMatthias Ringwald                             break;
1561f4b33574SMatthias Ringwald                         case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT:
1562f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE;
1563f4b33574SMatthias Ringwald                             break;
1564f4b33574SMatthias Ringwald                         case P_W4_PREPARE_WRITE_RESULT:
1565f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_PREPARE_WRITE;
1566f4b33574SMatthias Ringwald                             break;
1567f4b33574SMatthias Ringwald                         case P_W4_PREPARE_WRITE_SINGLE_RESULT:
1568f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE;
1569f4b33574SMatthias Ringwald                             break;
1570f4b33574SMatthias Ringwald                         case P_W4_PREPARE_RELIABLE_WRITE_RESULT:
1571f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE;
1572f4b33574SMatthias Ringwald                             break;
1573f4b33574SMatthias Ringwald                         case P_W4_EXECUTE_PREPARED_WRITE_RESULT:
1574f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE;
1575f4b33574SMatthias Ringwald                             break;
1576f4b33574SMatthias Ringwald                         case P_W4_CANCEL_PREPARED_WRITE_RESULT:
1577f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE;
1578f4b33574SMatthias Ringwald                             break;
1579f4b33574SMatthias Ringwald                         case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT:
1580f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH;
1581f4b33574SMatthias Ringwald                             break;
1582f4b33574SMatthias Ringwald                         case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:
1583f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY;
1584f4b33574SMatthias Ringwald                             break;
1585f4b33574SMatthias Ringwald                         case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT:
1586f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY;
1587f4b33574SMatthias Ringwald                             break;
1588f4b33574SMatthias Ringwald                         case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
1589f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR;
1590f4b33574SMatthias Ringwald                             break;
1591f4b33574SMatthias Ringwald                         case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT:
1592f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION;
1593f4b33574SMatthias Ringwald                             break;
1594f4b33574SMatthias Ringwald                         case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
1595f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR;
1596f4b33574SMatthias Ringwald                             break;
1597f4b33574SMatthias Ringwald                         case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
1598f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR;
1599f4b33574SMatthias Ringwald                             break;
1600f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
1601f4b33574SMatthias Ringwald                         case P_W4_SEND_SINGED_WRITE_DONE:
1602f4b33574SMatthias Ringwald                             peripheral->gatt_client_state = P_W2_SEND_SIGNED_WRITE;
1603f4b33574SMatthias Ringwald                             break;
1604f4b33574SMatthias Ringwald #endif
1605f4b33574SMatthias Ringwald                         default:
1606f4b33574SMatthias Ringwald                             log_info("retry not supported for state %x", peripheral->gatt_client_state);
1607f4b33574SMatthias Ringwald                             retry = 0;
1608f4b33574SMatthias Ringwald                             break;
1609f4b33574SMatthias Ringwald                     }
1610f4b33574SMatthias Ringwald 
1611f4b33574SMatthias Ringwald                     if (!retry) {
1612f4b33574SMatthias Ringwald                         gatt_client_report_error_if_pending(peripheral, packet[4]);
1613f4b33574SMatthias Ringwald                         break;
1614f4b33574SMatthias Ringwald                     }
1615f4b33574SMatthias Ringwald 
1616f4b33574SMatthias Ringwald                     log_info("security error, start pairing");
1617f4b33574SMatthias Ringwald 
1618f4b33574SMatthias Ringwald                     // requrest pairing
1619f4b33574SMatthias Ringwald                     peripheral->wait_for_pairing_complete = 1;
1620f4b33574SMatthias Ringwald                     peripheral->pending_error_code = packet[4];
1621f4b33574SMatthias Ringwald                     sm_request_pairing(peripheral->con_handle);
1622f4b33574SMatthias Ringwald                     break;
1623a0e0c2beSMatthias Ringwald                 }
1624f4b33574SMatthias Ringwald #endif
1625f4b33574SMatthias Ringwald 
1626f4b33574SMatthias Ringwald                 // nothing we can do about that
1627f4b33574SMatthias Ringwald                 case ATT_ERROR_INSUFFICIENT_AUTHORIZATION:
16283deb3ec6SMatthias Ringwald                 default:
16293deb3ec6SMatthias Ringwald                     gatt_client_report_error_if_pending(peripheral, packet[4]);
16303deb3ec6SMatthias Ringwald                     break;
16313deb3ec6SMatthias Ringwald             }
16323deb3ec6SMatthias Ringwald             break;
16333deb3ec6SMatthias Ringwald 
16343deb3ec6SMatthias Ringwald         default:
16353deb3ec6SMatthias Ringwald             log_info("ATT Handler, unhandled response type 0x%02x", packet[0]);
16363deb3ec6SMatthias Ringwald             break;
16373deb3ec6SMatthias Ringwald     }
16383deb3ec6SMatthias Ringwald     gatt_client_run();
16393deb3ec6SMatthias Ringwald }
16403deb3ec6SMatthias Ringwald 
16417a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
16423deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){
1643665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
1644665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_connections);
1645665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
1646665d90f2SMatthias Ringwald         gatt_client_t * peripheral = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
16473deb3ec6SMatthias Ringwald         if (peripheral->gatt_client_state == P_W4_CMAC_RESULT){
16483deb3ec6SMatthias Ringwald             // store result
16496535961aSMatthias Ringwald             (void)memcpy(peripheral->cmac, hash, 8);
16509c80e4ccSMatthias Ringwald             // reverse_64(hash, peripheral->cmac);
16513deb3ec6SMatthias Ringwald             peripheral->gatt_client_state = P_W2_SEND_SIGNED_WRITE;
16523deb3ec6SMatthias Ringwald             gatt_client_run();
16533deb3ec6SMatthias Ringwald             return;
16543deb3ec6SMatthias Ringwald         }
16553deb3ec6SMatthias Ringwald     }
16563deb3ec6SMatthias Ringwald }
16573deb3ec6SMatthias Ringwald 
1658711e6c80SMatthias Ringwald uint8_t gatt_client_signed_write_without_response(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t handle, uint16_t message_len, uint8_t * message){
16593deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle(con_handle);
16607d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
16617d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
16623deb3ec6SMatthias Ringwald 
16639c662c9bSMatthias Ringwald     peripheral->callback = callback;
16643deb3ec6SMatthias Ringwald     peripheral->attribute_handle = handle;
16653deb3ec6SMatthias Ringwald     peripheral->attribute_length = message_len;
16663deb3ec6SMatthias Ringwald     peripheral->attribute_value = message;
1667793cf6ceSMatthias Ringwald     peripheral->gatt_client_state = P_W4_IDENTITY_RESOLVING;
16683deb3ec6SMatthias Ringwald     gatt_client_run();
166925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
16703deb3ec6SMatthias Ringwald }
16717a766ebfSMatthias Ringwald #endif
16723deb3ec6SMatthias Ringwald 
1673711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
16743deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
16757d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
16767d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
16773deb3ec6SMatthias Ringwald 
16789c662c9bSMatthias Ringwald     peripheral->callback = callback;
16793deb3ec6SMatthias Ringwald     peripheral->start_group_handle = 0x0001;
16803deb3ec6SMatthias Ringwald     peripheral->end_group_handle   = 0xffff;
16813deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_SERVICE_QUERY;
16823deb3ec6SMatthias Ringwald     peripheral->uuid16 = 0;
16833deb3ec6SMatthias Ringwald     gatt_client_run();
168425b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
16853deb3ec6SMatthias Ringwald }
16863deb3ec6SMatthias Ringwald 
16873deb3ec6SMatthias Ringwald 
1688711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){
16893deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
16907d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
16917d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
16923deb3ec6SMatthias Ringwald 
16939c662c9bSMatthias Ringwald     peripheral->callback = callback;
16943deb3ec6SMatthias Ringwald     peripheral->start_group_handle = 0x0001;
16953deb3ec6SMatthias Ringwald     peripheral->end_group_handle   = 0xffff;
16963deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY;
16973deb3ec6SMatthias Ringwald     peripheral->uuid16 = uuid16;
1698e1a125dfSMatthias Ringwald     uuid_add_bluetooth_prefix((uint8_t*) &(peripheral->uuid128), peripheral->uuid16);
16993deb3ec6SMatthias Ringwald     gatt_client_run();
170025b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
17013deb3ec6SMatthias Ringwald }
17023deb3ec6SMatthias Ringwald 
1703711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid128(btstack_packet_handler_t callback, hci_con_handle_t con_handle, const uint8_t * uuid128){
17043deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
17057d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
17067d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
17073deb3ec6SMatthias Ringwald 
17089c662c9bSMatthias Ringwald     peripheral->callback = callback;
17093deb3ec6SMatthias Ringwald     peripheral->start_group_handle = 0x0001;
17103deb3ec6SMatthias Ringwald     peripheral->end_group_handle   = 0xffff;
17113deb3ec6SMatthias Ringwald     peripheral->uuid16 = 0;
17126535961aSMatthias Ringwald     (void)memcpy(peripheral->uuid128, uuid128, 16);
17133deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY;
17143deb3ec6SMatthias Ringwald     gatt_client_run();
171525b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
17163deb3ec6SMatthias Ringwald }
17173deb3ec6SMatthias Ringwald 
1718711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristics_for_service(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_service_t *service){
17193deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
17207d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
17217d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
17223deb3ec6SMatthias Ringwald 
17239c662c9bSMatthias Ringwald     peripheral->callback = callback;
17243deb3ec6SMatthias Ringwald     peripheral->start_group_handle = service->start_group_handle;
17253deb3ec6SMatthias Ringwald     peripheral->end_group_handle   = service->end_group_handle;
17263deb3ec6SMatthias Ringwald     peripheral->filter_with_uuid = 0;
17273deb3ec6SMatthias Ringwald     peripheral->characteristic_start_handle = 0;
17283deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY;
17293deb3ec6SMatthias Ringwald     gatt_client_run();
173025b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
17313deb3ec6SMatthias Ringwald }
17323deb3ec6SMatthias Ringwald 
1733711e6c80SMatthias Ringwald uint8_t gatt_client_find_included_services_for_service(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_service_t *service){
17343deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
17357d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
17367d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
17379c662c9bSMatthias Ringwald     peripheral->callback = callback;
17383deb3ec6SMatthias Ringwald     peripheral->start_group_handle = service->start_group_handle;
17393deb3ec6SMatthias Ringwald     peripheral->end_group_handle   = service->end_group_handle;
17403deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_QUERY;
17413deb3ec6SMatthias Ringwald 
17423deb3ec6SMatthias Ringwald     gatt_client_run();
174325b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
17443deb3ec6SMatthias Ringwald }
17453deb3ec6SMatthias Ringwald 
1746711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristics_for_handle_range_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t start_handle, uint16_t end_handle, uint16_t uuid16){
17473deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
17487d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
17497d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
17503deb3ec6SMatthias Ringwald 
17519c662c9bSMatthias Ringwald     peripheral->callback = callback;
17523deb3ec6SMatthias Ringwald     peripheral->start_group_handle = start_handle;
17533deb3ec6SMatthias Ringwald     peripheral->end_group_handle   = end_handle;
17543deb3ec6SMatthias Ringwald     peripheral->filter_with_uuid = 1;
17553deb3ec6SMatthias Ringwald     peripheral->uuid16 = uuid16;
1756e1a125dfSMatthias Ringwald     uuid_add_bluetooth_prefix((uint8_t*) &(peripheral->uuid128), uuid16);
17573deb3ec6SMatthias Ringwald     peripheral->characteristic_start_handle = 0;
17583deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY;
17593deb3ec6SMatthias Ringwald     gatt_client_run();
176025b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
17613deb3ec6SMatthias Ringwald }
17623deb3ec6SMatthias Ringwald 
1763711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristics_for_handle_range_by_uuid128(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t start_handle, uint16_t end_handle, uint8_t * uuid128){
17643deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
17657d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
17667d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
17673deb3ec6SMatthias Ringwald 
17689c662c9bSMatthias Ringwald     peripheral->callback = callback;
17693deb3ec6SMatthias Ringwald     peripheral->start_group_handle = start_handle;
17703deb3ec6SMatthias Ringwald     peripheral->end_group_handle   = end_handle;
17713deb3ec6SMatthias Ringwald     peripheral->filter_with_uuid = 1;
17723deb3ec6SMatthias Ringwald     peripheral->uuid16 = 0;
17736535961aSMatthias Ringwald     (void)memcpy(peripheral->uuid128, uuid128, 16);
17743deb3ec6SMatthias Ringwald     peripheral->characteristic_start_handle = 0;
17753deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY;
17763deb3ec6SMatthias Ringwald     gatt_client_run();
177725b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
17783deb3ec6SMatthias Ringwald }
17793deb3ec6SMatthias Ringwald 
17803deb3ec6SMatthias Ringwald 
1781d25c33e5SMatthias Ringwald uint8_t gatt_client_discover_characteristics_for_service_by_uuid16(btstack_packet_handler_t callback, uint16_t handle, gatt_client_service_t *service, uint16_t  uuid16){
17829c662c9bSMatthias Ringwald     return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, handle, service->start_group_handle, service->end_group_handle, uuid16);
17833deb3ec6SMatthias Ringwald }
17843deb3ec6SMatthias Ringwald 
1785d25c33e5SMatthias Ringwald uint8_t gatt_client_discover_characteristics_for_service_by_uuid128(btstack_packet_handler_t callback, uint16_t handle, gatt_client_service_t *service, uint8_t * uuid128){
17869c662c9bSMatthias Ringwald     return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, handle, service->start_group_handle, service->end_group_handle, uuid128);
17873deb3ec6SMatthias Ringwald }
17883deb3ec6SMatthias Ringwald 
1789711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t *characteristic){
17903deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
17917d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
17927d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
17933deb3ec6SMatthias Ringwald 
17943deb3ec6SMatthias Ringwald     if (characteristic->value_handle == characteristic->end_handle){
17959cb80b17SMilanka Ringwald         emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS);
179625b7c058SMilanka Ringwald         return ERROR_CODE_SUCCESS;
17973deb3ec6SMatthias Ringwald     }
17989c662c9bSMatthias Ringwald     peripheral->callback = callback;
17993deb3ec6SMatthias Ringwald     peripheral->start_group_handle = characteristic->value_handle + 1;
18003deb3ec6SMatthias Ringwald     peripheral->end_group_handle   = characteristic->end_handle;
18013deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY;
18023deb3ec6SMatthias Ringwald     gatt_client_run();
180325b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
18043deb3ec6SMatthias Ringwald }
18053deb3ec6SMatthias Ringwald 
1806711e6c80SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristic_using_value_handle(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle){
18073deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
18087d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
18097d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
18103deb3ec6SMatthias Ringwald 
18119c662c9bSMatthias Ringwald     peripheral->callback = callback;
18123deb3ec6SMatthias Ringwald     peripheral->attribute_handle = value_handle;
18133deb3ec6SMatthias Ringwald     peripheral->attribute_offset = 0;
18143deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY;
18153deb3ec6SMatthias Ringwald     gatt_client_run();
181625b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
18173deb3ec6SMatthias Ringwald }
18183deb3ec6SMatthias Ringwald 
1819711e6c80SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristics_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t start_handle, uint16_t end_handle, uint16_t uuid16){
18203deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
18217d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
18227d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
18233deb3ec6SMatthias Ringwald 
18249c662c9bSMatthias Ringwald     peripheral->callback = callback;
18253deb3ec6SMatthias Ringwald     peripheral->start_group_handle = start_handle;
18263deb3ec6SMatthias Ringwald     peripheral->end_group_handle = end_handle;
18273deb3ec6SMatthias Ringwald     peripheral->query_start_handle = start_handle;
18283deb3ec6SMatthias Ringwald     peripheral->query_end_handle = end_handle;
18293deb3ec6SMatthias Ringwald     peripheral->uuid16 = uuid16;
1830e1a125dfSMatthias Ringwald     uuid_add_bluetooth_prefix((uint8_t*) &(peripheral->uuid128), uuid16);
18313deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST;
18323deb3ec6SMatthias Ringwald     gatt_client_run();
183325b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
18343deb3ec6SMatthias Ringwald }
18353deb3ec6SMatthias Ringwald 
1836711e6c80SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristics_by_uuid128(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t start_handle, uint16_t end_handle, uint8_t * uuid128){
18373deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
18387d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
18397d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
18403deb3ec6SMatthias Ringwald 
18419c662c9bSMatthias Ringwald     peripheral->callback = callback;
18423deb3ec6SMatthias Ringwald     peripheral->start_group_handle = start_handle;
18433deb3ec6SMatthias Ringwald     peripheral->end_group_handle = end_handle;
18443deb3ec6SMatthias Ringwald     peripheral->query_start_handle = start_handle;
18453deb3ec6SMatthias Ringwald     peripheral->query_end_handle = end_handle;
18463deb3ec6SMatthias Ringwald     peripheral->uuid16 = 0;
18476535961aSMatthias Ringwald     (void)memcpy(peripheral->uuid128, uuid128, 16);
18483deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST;
18493deb3ec6SMatthias Ringwald     gatt_client_run();
185025b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
18513deb3ec6SMatthias Ringwald }
18523deb3ec6SMatthias Ringwald 
18533deb3ec6SMatthias Ringwald 
1854d25c33e5SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){
18559c662c9bSMatthias Ringwald     return gatt_client_read_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle);
18563deb3ec6SMatthias Ringwald }
18573deb3ec6SMatthias Ringwald 
1858711e6c80SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t characteristic_value_handle, uint16_t offset){
18593deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
18607d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
18617d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
18623deb3ec6SMatthias Ringwald 
18639c662c9bSMatthias Ringwald     peripheral->callback = callback;
18643deb3ec6SMatthias Ringwald     peripheral->attribute_handle = characteristic_value_handle;
18653deb3ec6SMatthias Ringwald     peripheral->attribute_offset = offset;
18663deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY;
18673deb3ec6SMatthias Ringwald     gatt_client_run();
186825b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
18693deb3ec6SMatthias Ringwald }
18703deb3ec6SMatthias Ringwald 
1871711e6c80SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic_using_value_handle(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t characteristic_value_handle){
18729c662c9bSMatthias Ringwald     return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, characteristic_value_handle, 0);
18733deb3ec6SMatthias Ringwald }
18743deb3ec6SMatthias Ringwald 
1875d25c33e5SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){
18769c662c9bSMatthias Ringwald     return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle);
18773deb3ec6SMatthias Ringwald }
18783deb3ec6SMatthias Ringwald 
1879711e6c80SMatthias Ringwald uint8_t gatt_client_read_multiple_characteristic_values(btstack_packet_handler_t callback, hci_con_handle_t con_handle, int num_value_handles, uint16_t * value_handles){
18803deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
18817d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
18827d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
18833deb3ec6SMatthias Ringwald 
18849c662c9bSMatthias Ringwald     peripheral->callback = callback;
18853deb3ec6SMatthias Ringwald     peripheral->read_multiple_handle_count = num_value_handles;
18863deb3ec6SMatthias Ringwald     peripheral->read_multiple_handles = value_handles;
18873deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST;
18883deb3ec6SMatthias Ringwald     gatt_client_run();
188925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
18903deb3ec6SMatthias Ringwald }
18913deb3ec6SMatthias Ringwald 
1892de9f8e94SMatthias Ringwald uint8_t gatt_client_write_value_of_characteristic_without_response(hci_con_handle_t con_handle, uint16_t value_handle, uint16_t value_length, uint8_t * value){
18933deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle(con_handle);
18947d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
18953deb3ec6SMatthias Ringwald 
1896a1df452eSMatthias Ringwald     if (value_length > (peripheral_mtu(peripheral) - 3)) return GATT_CLIENT_VALUE_TOO_LONG;
189751764b3bSMatthias Ringwald     if (!att_dispatch_client_can_send_now(peripheral->con_handle)) return GATT_CLIENT_BUSY;
18983deb3ec6SMatthias Ringwald 
189925b7c058SMilanka Ringwald     return att_write_request(ATT_WRITE_COMMAND, peripheral->con_handle, value_handle, value_length, value);
19003deb3ec6SMatthias Ringwald }
19013deb3ec6SMatthias Ringwald 
1902711e6c80SMatthias Ringwald uint8_t gatt_client_write_value_of_characteristic(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle, uint16_t value_length, uint8_t * data){
19033deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
19047d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
19057d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
19063deb3ec6SMatthias Ringwald 
19079c662c9bSMatthias Ringwald     peripheral->callback = callback;
19083deb3ec6SMatthias Ringwald     peripheral->attribute_handle = value_handle;
19093deb3ec6SMatthias Ringwald     peripheral->attribute_length = value_length;
19103deb3ec6SMatthias Ringwald     peripheral->attribute_value = data;
19113deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE;
19123deb3ec6SMatthias Ringwald     gatt_client_run();
191325b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
19143deb3ec6SMatthias Ringwald }
19153deb3ec6SMatthias Ringwald 
1916711e6c80SMatthias Ringwald uint8_t gatt_client_write_long_value_of_characteristic_with_offset(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle, uint16_t offset, uint16_t value_length, uint8_t  * data){
19173deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
19187d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
19197d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
19203deb3ec6SMatthias Ringwald 
19219c662c9bSMatthias Ringwald     peripheral->callback = callback;
19223deb3ec6SMatthias Ringwald     peripheral->attribute_handle = value_handle;
19233deb3ec6SMatthias Ringwald     peripheral->attribute_length = value_length;
19243deb3ec6SMatthias Ringwald     peripheral->attribute_offset = offset;
19253deb3ec6SMatthias Ringwald     peripheral->attribute_value = data;
19263deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_PREPARE_WRITE;
19273deb3ec6SMatthias Ringwald     gatt_client_run();
192825b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
19293deb3ec6SMatthias Ringwald }
19303deb3ec6SMatthias Ringwald 
1931711e6c80SMatthias Ringwald uint8_t gatt_client_write_long_value_of_characteristic(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle, uint16_t value_length, uint8_t * value){
19329c662c9bSMatthias Ringwald     return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value);
19333deb3ec6SMatthias Ringwald }
19343deb3ec6SMatthias Ringwald 
1935711e6c80SMatthias Ringwald uint8_t gatt_client_reliable_write_long_value_of_characteristic(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle, uint16_t value_length, uint8_t * value){
19363deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
19377d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
19387d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
19393deb3ec6SMatthias Ringwald 
19409c662c9bSMatthias Ringwald     peripheral->callback = callback;
19413deb3ec6SMatthias Ringwald     peripheral->attribute_handle = value_handle;
19423deb3ec6SMatthias Ringwald     peripheral->attribute_length = value_length;
19433deb3ec6SMatthias Ringwald     peripheral->attribute_offset = 0;
19443deb3ec6SMatthias Ringwald     peripheral->attribute_value = value;
19453deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE;
19463deb3ec6SMatthias Ringwald     gatt_client_run();
194725b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
19483deb3ec6SMatthias Ringwald }
19493deb3ec6SMatthias Ringwald 
1950711e6c80SMatthias Ringwald uint8_t gatt_client_write_client_characteristic_configuration(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic, uint16_t configuration){
19513deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
19527d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
19537d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
19543deb3ec6SMatthias Ringwald 
19553deb3ec6SMatthias Ringwald     if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) &&
1956a1df452eSMatthias Ringwald         ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0)) {
1957d8e8f12aSMatthias Ringwald         log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED");
1958616edd56SMatthias Ringwald         return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED;
19593deb3ec6SMatthias Ringwald     } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) &&
1960a1df452eSMatthias Ringwald                ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0)){
1961d8e8f12aSMatthias Ringwald         log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED");
1962616edd56SMatthias Ringwald         return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED;
19633deb3ec6SMatthias Ringwald     }
19643deb3ec6SMatthias Ringwald 
19659c662c9bSMatthias Ringwald     peripheral->callback = callback;
19663deb3ec6SMatthias Ringwald     peripheral->start_group_handle = characteristic->value_handle;
19673deb3ec6SMatthias Ringwald     peripheral->end_group_handle = characteristic->end_handle;
1968f8fbdce0SMatthias Ringwald     little_endian_store_16(peripheral->client_characteristic_configuration_value, 0, configuration);
19693deb3ec6SMatthias Ringwald 
1970abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
1971abdc9fb5SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY;
1972abdc9fb5SMatthias Ringwald #else
19733deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY;
1974abdc9fb5SMatthias Ringwald #endif
19753deb3ec6SMatthias Ringwald     gatt_client_run();
19769cb80b17SMilanka Ringwald     return ERROR_CODE_SUCCESS;
19773deb3ec6SMatthias Ringwald }
19783deb3ec6SMatthias Ringwald 
1979711e6c80SMatthias Ringwald uint8_t gatt_client_read_characteristic_descriptor_using_descriptor_handle(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t descriptor_handle){
19803deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
19817d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
19827d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
19833deb3ec6SMatthias Ringwald 
19849c662c9bSMatthias Ringwald     peripheral->callback = callback;
19853deb3ec6SMatthias Ringwald     peripheral->attribute_handle = descriptor_handle;
19863deb3ec6SMatthias Ringwald 
19873deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY;
19883deb3ec6SMatthias Ringwald     gatt_client_run();
198925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
19903deb3ec6SMatthias Ringwald }
19913deb3ec6SMatthias Ringwald 
1992711e6c80SMatthias Ringwald uint8_t gatt_client_read_characteristic_descriptor(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_descriptor_t * descriptor){
19939c662c9bSMatthias Ringwald     return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle);
19943deb3ec6SMatthias Ringwald }
19953deb3ec6SMatthias Ringwald 
1996711e6c80SMatthias Ringwald uint8_t gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t descriptor_handle, uint16_t offset){
19973deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
19987d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
19997d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
20003deb3ec6SMatthias Ringwald 
20019c662c9bSMatthias Ringwald     peripheral->callback = callback;
20023deb3ec6SMatthias Ringwald     peripheral->attribute_handle = descriptor_handle;
20033deb3ec6SMatthias Ringwald     peripheral->attribute_offset = offset;
20043deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY;
20053deb3ec6SMatthias Ringwald     gatt_client_run();
200625b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
20073deb3ec6SMatthias Ringwald }
20083deb3ec6SMatthias Ringwald 
2009711e6c80SMatthias Ringwald uint8_t gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t descriptor_handle){
20109c662c9bSMatthias Ringwald     return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0);
20113deb3ec6SMatthias Ringwald }
20123deb3ec6SMatthias Ringwald 
2013711e6c80SMatthias Ringwald uint8_t gatt_client_read_long_characteristic_descriptor(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_descriptor_t * descriptor){
20149c662c9bSMatthias Ringwald     return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle);
20153deb3ec6SMatthias Ringwald }
20163deb3ec6SMatthias Ringwald 
2017711e6c80SMatthias Ringwald uint8_t gatt_client_write_characteristic_descriptor_using_descriptor_handle(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t descriptor_handle, uint16_t length, uint8_t  * data){
20183deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
20197d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
20207d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
20213deb3ec6SMatthias Ringwald 
20229c662c9bSMatthias Ringwald     peripheral->callback = callback;
20233deb3ec6SMatthias Ringwald     peripheral->attribute_handle = descriptor_handle;
20243deb3ec6SMatthias Ringwald     peripheral->attribute_length = length;
20253deb3ec6SMatthias Ringwald     peripheral->attribute_offset = 0;
20263deb3ec6SMatthias Ringwald     peripheral->attribute_value = data;
20273deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR;
20283deb3ec6SMatthias Ringwald     gatt_client_run();
202925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
20303deb3ec6SMatthias Ringwald }
20313deb3ec6SMatthias Ringwald 
2032711e6c80SMatthias Ringwald uint8_t gatt_client_write_characteristic_descriptor(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_descriptor_t * descriptor, uint16_t length, uint8_t * value){
20339c662c9bSMatthias Ringwald     return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value);
20343deb3ec6SMatthias Ringwald }
20353deb3ec6SMatthias Ringwald 
2036711e6c80SMatthias Ringwald uint8_t gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t descriptor_handle, uint16_t offset, uint16_t length, uint8_t  * data){
20373deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
20387d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
20397d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
20403deb3ec6SMatthias Ringwald 
20419c662c9bSMatthias Ringwald     peripheral->callback = callback;
20423deb3ec6SMatthias Ringwald     peripheral->attribute_handle = descriptor_handle;
20433deb3ec6SMatthias Ringwald     peripheral->attribute_length = length;
20443deb3ec6SMatthias Ringwald     peripheral->attribute_offset = offset;
20453deb3ec6SMatthias Ringwald     peripheral->attribute_value = data;
20463deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR;
20473deb3ec6SMatthias Ringwald     gatt_client_run();
204825b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
20493deb3ec6SMatthias Ringwald }
20503deb3ec6SMatthias Ringwald 
2051711e6c80SMatthias Ringwald uint8_t gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t descriptor_handle, uint16_t length, uint8_t * data){
20529c662c9bSMatthias Ringwald     return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, length, data );
20533deb3ec6SMatthias Ringwald }
20543deb3ec6SMatthias Ringwald 
2055711e6c80SMatthias Ringwald uint8_t gatt_client_write_long_characteristic_descriptor(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_descriptor_t * descriptor, uint16_t length, uint8_t * value){
20569c662c9bSMatthias Ringwald     return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value);
20573deb3ec6SMatthias Ringwald }
20583deb3ec6SMatthias Ringwald 
20593deb3ec6SMatthias Ringwald /**
20603deb3ec6SMatthias Ringwald  * @brief -> gatt complete event
20613deb3ec6SMatthias Ringwald  */
2062711e6c80SMatthias Ringwald uint8_t gatt_client_prepare_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t attribute_handle, uint16_t offset, uint16_t length, uint8_t * data){
20633deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
20647d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
20657d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
20663deb3ec6SMatthias Ringwald 
20679c662c9bSMatthias Ringwald     peripheral->callback = callback;
20683deb3ec6SMatthias Ringwald     peripheral->attribute_handle = attribute_handle;
20693deb3ec6SMatthias Ringwald     peripheral->attribute_length = length;
20703deb3ec6SMatthias Ringwald     peripheral->attribute_offset = offset;
20713deb3ec6SMatthias Ringwald     peripheral->attribute_value = data;
20723deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE;
20733deb3ec6SMatthias Ringwald     gatt_client_run();
207425b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
20753deb3ec6SMatthias Ringwald }
20763deb3ec6SMatthias Ringwald 
20773deb3ec6SMatthias Ringwald /**
20783deb3ec6SMatthias Ringwald  * @brief -> gatt complete event
20793deb3ec6SMatthias Ringwald  */
2080711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
20813deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
20823deb3ec6SMatthias Ringwald 
20837d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
20847d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
20853deb3ec6SMatthias Ringwald 
20869c662c9bSMatthias Ringwald     peripheral->callback = callback;
20873deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE;
20883deb3ec6SMatthias Ringwald     gatt_client_run();
208925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
20903deb3ec6SMatthias Ringwald }
20913deb3ec6SMatthias Ringwald 
20923deb3ec6SMatthias Ringwald /**
20933deb3ec6SMatthias Ringwald  * @brief -> gatt complete event
20943deb3ec6SMatthias Ringwald  */
2095711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
20963deb3ec6SMatthias Ringwald     gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle);
20977d2258b3SMilanka Ringwald     if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
20987d2258b3SMilanka Ringwald     if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE;
20993deb3ec6SMatthias Ringwald 
21009c662c9bSMatthias Ringwald     peripheral->callback = callback;
21013deb3ec6SMatthias Ringwald     peripheral->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE;
21023deb3ec6SMatthias Ringwald     gatt_client_run();
21037d2258b3SMilanka Ringwald     return ERROR_CODE_SUCCESS;
21043deb3ec6SMatthias Ringwald }
21053deb3ec6SMatthias Ringwald 
2106313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t *service){
21076ba2ad22SMatthias Ringwald     service->start_group_handle = little_endian_read_16(packet, offset);
21086ba2ad22SMatthias Ringwald     service->end_group_handle = little_endian_read_16(packet, offset + 2);
21096ba2ad22SMatthias Ringwald     reverse_128(&packet[offset + 4], service->uuid128);
21106ba2ad22SMatthias Ringwald     if (uuid_has_bluetooth_prefix(service->uuid128)){
21116ba2ad22SMatthias Ringwald         service->uuid16 = big_endian_read_32(service->uuid128, 0);
2112c839c6f9SMatthias Ringwald     } else {
2113c839c6f9SMatthias Ringwald         service->uuid16 = 0;
21146ba2ad22SMatthias Ringwald     }
21156ba2ad22SMatthias Ringwald }
21166ba2ad22SMatthias Ringwald 
2117313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){
21186ba2ad22SMatthias Ringwald     characteristic->start_handle = little_endian_read_16(packet, offset);
21196ba2ad22SMatthias Ringwald     characteristic->value_handle = little_endian_read_16(packet, offset + 2);
21206ba2ad22SMatthias Ringwald     characteristic->end_handle = little_endian_read_16(packet, offset + 4);
21216ba2ad22SMatthias Ringwald     characteristic->properties = little_endian_read_16(packet, offset + 6);
212286c38559SMatthias Ringwald     reverse_128(&packet[offset+8], characteristic->uuid128);
21236ba2ad22SMatthias Ringwald     if (uuid_has_bluetooth_prefix(characteristic->uuid128)){
21246ba2ad22SMatthias Ringwald         characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0);
2125c839c6f9SMatthias Ringwald     } else {
2126c839c6f9SMatthias Ringwald         characteristic->uuid16 = 0;
21276ba2ad22SMatthias Ringwald     }
21286ba2ad22SMatthias Ringwald }
21296ba2ad22SMatthias Ringwald 
2130313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){
21316ba2ad22SMatthias Ringwald     descriptor->handle = little_endian_read_16(packet, offset);
21326ba2ad22SMatthias Ringwald     reverse_128(&packet[offset+2], descriptor->uuid128);
2133b4895529SJakob Krantz     if (uuid_has_bluetooth_prefix(descriptor->uuid128)){
2134b4895529SJakob Krantz         descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0);
2135c839c6f9SMatthias Ringwald     } else {
2136c839c6f9SMatthias Ringwald         descriptor->uuid16 = 0;
2137b4895529SJakob Krantz     }
21386ba2ad22SMatthias Ringwald }
21395cf6c434SJakob Krantz 
21405cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
21415cf6c434SJakob Krantz     gatt_client_t * context = provide_context_for_conn_handle(con_handle);
21427d2258b3SMilanka Ringwald     if (context == NULL) return;
21435cf6c434SJakob Krantz     if (context->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){
21445cf6c434SJakob Krantz         context->callback = callback;
21455cf6c434SJakob Krantz         context->mtu_state = SEND_MTU_EXCHANGE;
21465cf6c434SJakob Krantz         gatt_client_run();
21475cf6c434SJakob Krantz     }
21485cf6c434SJakob Krantz }
214947181045SMatthias Ringwald 
215047181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
215147181045SMatthias Ringwald     gatt_client_t * context = provide_context_for_conn_handle(con_handle);
21527d2258b3SMilanka Ringwald     if (context == NULL) return BTSTACK_MEMORY_ALLOC_FAILED;
21537d2258b3SMilanka Ringwald     if (context->write_without_response_callback != NULL) return GATT_CLIENT_IN_WRONG_STATE;
215447181045SMatthias Ringwald     context->write_without_response_callback = callback;
215547181045SMatthias Ringwald     att_dispatch_client_request_can_send_now_event(context->con_handle);
21567d2258b3SMilanka Ringwald     return ERROR_CODE_SUCCESS;
215747181045SMatthias Ringwald }
2158*a6121b51SMilanka Ringwald 
2159*a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
2160*a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){
2161*a6121b51SMilanka Ringwald     gatt_client_att_packet_handler(packet_type, handle, packet, size);
2162*a6121b51SMilanka Ringwald }
2163*a6121b51SMilanka Ringwald #endif
2164