xref: /btstack/src/ble/gatt_client.c (revision 8450fbf5264226cc028949233b289d9e05776193)
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
232fca4dadSMilanka Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN
242fca4dadSMilanka Ringwald  * GMBH 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>
42a95ca902SMatthias Ringwald #include <stddef.h>
433deb3ec6SMatthias Ringwald 
447907f069SMatthias Ringwald #include "btstack_config.h"
453deb3ec6SMatthias Ringwald 
46296289e3SMatthias Ringwald #include "ble/att_dispatch.h"
470e2df43fSMatthias Ringwald #include "ble/att_db.h"
480e2df43fSMatthias Ringwald #include "ble/gatt_client.h"
490e2df43fSMatthias Ringwald #include "ble/le_device_db.h"
500e2df43fSMatthias Ringwald #include "ble/sm.h"
51c40517c3SMatthias Ringwald #include "bluetooth_psm.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"
573deb3ec6SMatthias Ringwald #include "hci.h"
583deb3ec6SMatthias Ringwald #include "hci_dump.h"
5958e8c9f5SMatthias Ringwald #include "hci_event_builder.h"
603deb3ec6SMatthias Ringwald #include "l2cap.h"
611450cdc6SMatthias Ringwald #include "classic/sdp_client.h"
621450cdc6SMatthias Ringwald #include "bluetooth_gatt.h"
631450cdc6SMatthias Ringwald #include "bluetooth_sdp.h"
641450cdc6SMatthias Ringwald #include "classic/sdp_util.h"
653deb3ec6SMatthias Ringwald 
664797b71aSMatthias Ringwald #if defined(ENABLE_GATT_OVER_EATT) && !defined(ENABLE_L2CAP_ENHANCED_CREDIT_BASED_FLOW_CONTROL_MODE)
674797b71aSMatthias Ringwald #error "GATT Over EATT requires support for L2CAP Enhanced CoC. Please enable ENABLE_L2CAP_ENHANCED_CREDIT_BASED_FLOW_CONTROL_MODE"
684797b71aSMatthias Ringwald #endif
694797b71aSMatthias Ringwald 
70b1da4983SMatthias Ringwald // L2CAP Test Spec p35 defines a minimum of 100 ms, but PTS might indicate an error if we sent after 100 ms
71b1da4983SMatthias Ringwald #define GATT_CLIENT_COLLISION_BACKOFF_MS 150
72b1da4983SMatthias Ringwald 
739c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections;
749c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners;
75842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED
7658e8c9f5SMatthias Ringwald static btstack_linked_list_t gatt_client_service_changed_handler;
77842492f0SMatthias Ringwald #endif
78361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration;
79f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration;
80544a5845SMatthias Ringwald static btstack_context_callback_registration_t gatt_client_deferred_event_emit;
81f4b33574SMatthias Ringwald 
8211279da7SMatthias Ringwald // GATT Client Configuration
8311279da7SMatthias Ringwald static bool                 gatt_client_mtu_exchange_enabled;
8411279da7SMatthias Ringwald static gap_security_level_t gatt_client_required_security_level;
855cf6c434SJakob Krantz 
863deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size);
87f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size);
885cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code);
897a766ebfSMatthias Ringwald 
907a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
913deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]);
927a766ebfSMatthias Ringwald #endif
933deb3ec6SMatthias Ringwald 
9459b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
9559b5e157SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid);
9659b5e157SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status);
9759b5e157SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client);
98180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts);
9959b5e157SMatthias Ringwald #endif
10059b5e157SMatthias Ringwald 
10126166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
1027627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client);
1036d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts);
10426166ecfSMatthias Ringwald #endif
10526166ecfSMatthias Ringwald 
1063deb3ec6SMatthias Ringwald void gatt_client_init(void){
1073deb3ec6SMatthias Ringwald     gatt_client_connections = NULL;
108842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED
10958e8c9f5SMatthias Ringwald     gatt_client_service_changed_handler = NULL;
110842492f0SMatthias Ringwald #endif
11111279da7SMatthias Ringwald     // default configuration
11211279da7SMatthias Ringwald     gatt_client_mtu_exchange_enabled    = true;
11311279da7SMatthias Ringwald     gatt_client_required_security_level = LEVEL_0;
11411279da7SMatthias Ringwald 
11511279da7SMatthias Ringwald     // register for HCI Events
116f4b33574SMatthias Ringwald     hci_event_callback_registration.callback = &gatt_client_event_packet_handler;
117361b1363SMatthias Ringwald     hci_add_event_handler(&hci_event_callback_registration);
118361b1363SMatthias Ringwald 
119f4b33574SMatthias Ringwald     // register for SM Events
120f4b33574SMatthias Ringwald     sm_event_callback_registration.callback = &gatt_client_event_packet_handler;
121f4b33574SMatthias Ringwald     sm_add_event_handler(&sm_event_callback_registration);
122f4b33574SMatthias Ringwald 
123361b1363SMatthias Ringwald     // and ATT Client PDUs
1243deb3ec6SMatthias Ringwald     att_dispatch_register_client(gatt_client_att_packet_handler);
1253deb3ec6SMatthias Ringwald }
1263deb3ec6SMatthias Ringwald 
12711279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){
12811279da7SMatthias Ringwald     gatt_client_required_security_level = level;
12911279da7SMatthias Ringwald }
13011279da7SMatthias Ringwald 
131ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){
132665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
133665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_connections);
134665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
1355cf1669fSMatthias Ringwald         gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
1365cf1669fSMatthias Ringwald         if (&gatt_client->gc_timeout == ts) {
1375cf1669fSMatthias Ringwald             return gatt_client;
1383deb3ec6SMatthias Ringwald         }
1393deb3ec6SMatthias Ringwald     }
1403deb3ec6SMatthias Ringwald     return NULL;
1413deb3ec6SMatthias Ringwald }
1423deb3ec6SMatthias Ringwald 
143ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){
1445cf1669fSMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_for_timer(timer);
1455cf1669fSMatthias Ringwald     if (gatt_client == NULL) return;
1465cf1669fSMatthias Ringwald     log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle);
1475cf1669fSMatthias Ringwald     gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT);
1483deb3ec6SMatthias Ringwald }
1493deb3ec6SMatthias Ringwald 
1505cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){
1518ac3a0b3SMatthias Ringwald     log_debug("GATT client timeout start, handle 0x%02x", gatt_client->con_handle);
1525cf1669fSMatthias Ringwald     btstack_run_loop_remove_timer(&gatt_client->gc_timeout);
1535cf1669fSMatthias Ringwald     btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler);
1545cf1669fSMatthias Ringwald     btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout
1555cf1669fSMatthias Ringwald     btstack_run_loop_add_timer(&gatt_client->gc_timeout);
1563deb3ec6SMatthias Ringwald }
1573deb3ec6SMatthias Ringwald 
1585cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){
1598ac3a0b3SMatthias Ringwald     log_debug("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle);
1605cf1669fSMatthias Ringwald     btstack_run_loop_remove_timer(&gatt_client->gc_timeout);
1613deb3ec6SMatthias Ringwald }
1623deb3ec6SMatthias Ringwald 
1631dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){
1641dfae9c7SMatthias Ringwald     uint8_t encryption_key_size = gap_encryption_key_size(con_handle);
1651dfae9c7SMatthias Ringwald     if (encryption_key_size == 0) return LEVEL_0;
1661dfae9c7SMatthias Ringwald 
167ff3f1026SMatthias Ringwald     bool authenticated = gap_authenticated(con_handle);
1681dfae9c7SMatthias Ringwald     if (!authenticated) return LEVEL_2;
1691dfae9c7SMatthias Ringwald 
1701dfae9c7SMatthias Ringwald     return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3;
1711dfae9c7SMatthias Ringwald }
1721dfae9c7SMatthias Ringwald 
1735cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){
174665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
175a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){
1765cf1669fSMatthias Ringwald         gatt_client_t * gatt_client = (gatt_client_t *) it;
1775cf1669fSMatthias Ringwald         if (gatt_client->con_handle == handle){
1785cf1669fSMatthias Ringwald             return gatt_client;
1793deb3ec6SMatthias Ringwald         }
1803deb3ec6SMatthias Ringwald     }
1813deb3ec6SMatthias Ringwald     return NULL;
1823deb3ec6SMatthias Ringwald }
1833deb3ec6SMatthias Ringwald 
1843deb3ec6SMatthias Ringwald 
1856b65794dSMilanka Ringwald // @return gatt_client context
1863deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one
18740faeb84SMilanka Ringwald static uint8_t gatt_client_provide_context_for_handle(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){
1885cf1669fSMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle);
18940faeb84SMilanka Ringwald 
19040faeb84SMilanka Ringwald     if (gatt_client != NULL){
19140faeb84SMilanka Ringwald         *out_gatt_client = gatt_client;
19240faeb84SMilanka Ringwald         return ERROR_CODE_SUCCESS;
19340faeb84SMilanka Ringwald     }
1943deb3ec6SMatthias Ringwald 
195ae1d1237SMatthias Ringwald     // bail if no such hci connection
1960e0bba86SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
1970e0bba86SMatthias Ringwald     if (hci_connection == NULL){
198ae1d1237SMatthias Ringwald         log_error("No connection for handle 0x%04x", con_handle);
19940faeb84SMilanka Ringwald         *out_gatt_client = NULL;
20040faeb84SMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
201ae1d1237SMatthias Ringwald     }
20240faeb84SMilanka Ringwald 
2035cf1669fSMatthias Ringwald     gatt_client = btstack_memory_gatt_client_get();
20440faeb84SMilanka Ringwald     if (gatt_client == NULL){
20540faeb84SMilanka Ringwald         *out_gatt_client = NULL;
20640faeb84SMilanka Ringwald         return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
20740faeb84SMilanka Ringwald     }
2083deb3ec6SMatthias Ringwald     // init state
209e9cdf30bSMatthias Ringwald     gatt_client->bearer_type = ATT_BEARER_UNENHANCED_LE;
2105cf1669fSMatthias Ringwald     gatt_client->con_handle = con_handle;
2115cf1669fSMatthias Ringwald     gatt_client->mtu = ATT_DEFAULT_MTU;
2121dfae9c7SMatthias Ringwald     gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle);
21311279da7SMatthias Ringwald     if (gatt_client_mtu_exchange_enabled){
2145cf1669fSMatthias Ringwald         gatt_client->mtu_state = SEND_MTU_EXCHANGE;
2155cf6c434SJakob Krantz     } else {
2165cf1669fSMatthias Ringwald         gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED;
2175cf6c434SJakob Krantz     }
218052dc82aSMatthias Ringwald     gatt_client->state = P_READY;
219d9ced76fSMatthias Ringwald     gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_W2_SEND;
220cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
221cbd76cecSMatthias Ringwald     gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE;
222cbd76cecSMatthias Ringwald #endif
2235cf1669fSMatthias Ringwald     btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client);
2240e0bba86SMatthias Ringwald 
2250e0bba86SMatthias Ringwald     // get unenhanced att bearer state
2260e0bba86SMatthias Ringwald     if (hci_connection->att_connection.mtu_exchanged){
2270e0bba86SMatthias Ringwald         gatt_client->mtu = hci_connection->att_connection.mtu;
2280e0bba86SMatthias Ringwald         gatt_client->mtu_state = MTU_EXCHANGED;
2290e0bba86SMatthias Ringwald     }
23040faeb84SMilanka Ringwald     *out_gatt_client = gatt_client;
23140faeb84SMilanka Ringwald     return ERROR_CODE_SUCCESS;
2323deb3ec6SMatthias Ringwald }
2333deb3ec6SMatthias Ringwald 
234de27733dSMatthias Ringwald static bool is_ready(gatt_client_t * gatt_client){
235052dc82aSMatthias Ringwald     return gatt_client->state == P_READY;
236de27733dSMatthias Ringwald }
237de27733dSMatthias Ringwald 
238de27733dSMatthias Ringwald static uint8_t gatt_client_provide_context_for_request(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){
239de27733dSMatthias Ringwald     gatt_client_t * gatt_client = NULL;
240de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
24140faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
24240faeb84SMilanka Ringwald         return status;
24340faeb84SMilanka Ringwald     }
244de27733dSMatthias Ringwald 
2457627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
2467627a0deSMatthias Ringwald     if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){
2477627a0deSMatthias Ringwald         btstack_linked_list_iterator_t it;
2487627a0deSMatthias Ringwald         gatt_client_t * eatt_client = NULL;
2497627a0deSMatthias Ringwald         // find free eatt client
2507627a0deSMatthias Ringwald         btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients);
2517627a0deSMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
2527627a0deSMatthias Ringwald             gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
253052dc82aSMatthias Ringwald             if (client->state == P_READY){
2547627a0deSMatthias Ringwald                 eatt_client = client;
2557627a0deSMatthias Ringwald                 break;
2567627a0deSMatthias Ringwald             }
2577627a0deSMatthias Ringwald         }
2587627a0deSMatthias Ringwald         if (eatt_client == NULL){
2597627a0deSMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
2607627a0deSMatthias Ringwald         }
2617627a0deSMatthias Ringwald         gatt_client = eatt_client;
2627627a0deSMatthias Ringwald     }
2637627a0deSMatthias Ringwald #endif
2647627a0deSMatthias Ringwald 
265643a64fcSMatthias Ringwald     if (is_ready(gatt_client) == false){
266de27733dSMatthias Ringwald         return GATT_CLIENT_IN_WRONG_STATE;
2673deb3ec6SMatthias Ringwald     }
2683deb3ec6SMatthias Ringwald 
269de27733dSMatthias Ringwald     gatt_client_timeout_start(gatt_client);
270de27733dSMatthias Ringwald 
271de27733dSMatthias Ringwald     *out_gatt_client = gatt_client;
272de27733dSMatthias Ringwald 
273de27733dSMatthias Ringwald     return status;
2743deb3ec6SMatthias Ringwald }
2753deb3ec6SMatthias Ringwald 
276fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){
27740faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
27840faeb84SMilanka Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
27940faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
28040faeb84SMilanka Ringwald         return 0;
28140faeb84SMilanka Ringwald     }
282aacf1b1aSMilanka Ringwald     return is_ready(gatt_client) ? 1 : 0;
2833deb3ec6SMatthias Ringwald }
2843deb3ec6SMatthias Ringwald 
2855cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){
28611279da7SMatthias Ringwald     gatt_client_mtu_exchange_enabled = enabled != 0;
2875cf6c434SJakob Krantz }
2885cf6c434SJakob Krantz 
289fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){
29040faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
29140faeb84SMilanka Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
29240faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
29340faeb84SMilanka Ringwald         return status;
29440faeb84SMilanka Ringwald     }
2957d2258b3SMilanka Ringwald 
2965cf1669fSMatthias Ringwald     if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){
2975cf1669fSMatthias Ringwald         *mtu = gatt_client->mtu;
2987d2258b3SMilanka Ringwald         return ERROR_CODE_SUCCESS;
2993deb3ec6SMatthias Ringwald     }
3003deb3ec6SMatthias Ringwald     *mtu = ATT_DEFAULT_MTU;
301616edd56SMatthias Ringwald     return GATT_CLIENT_IN_WRONG_STATE;
3023deb3ec6SMatthias Ringwald }
3033deb3ec6SMatthias Ringwald 
3049228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) {
3057627a0deSMatthias Ringwald     switch (gatt_client->bearer_type){
3067627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
3077627a0deSMatthias Ringwald         case ATT_BEARER_UNENHANCED_CLASSIC:
3087627a0deSMatthias Ringwald #endif
3097627a0deSMatthias Ringwald         case ATT_BEARER_UNENHANCED_LE:
3109228fd32SMatthias Ringwald             l2cap_reserve_packet_buffer();
3119228fd32SMatthias Ringwald             return l2cap_get_outgoing_buffer();
3127627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
3137627a0deSMatthias Ringwald         case ATT_BEARER_ENHANCED_LE:
3147627a0deSMatthias Ringwald             return gatt_client->eatt_storage_buffer;
3157627a0deSMatthias Ringwald #endif
3167627a0deSMatthias Ringwald         default:
3177627a0deSMatthias Ringwald             btstack_unreachable();
3187627a0deSMatthias Ringwald             break;
3197627a0deSMatthias Ringwald     }
3207627a0deSMatthias Ringwald     return NULL;
3219228fd32SMatthias Ringwald }
3229228fd32SMatthias Ringwald 
3233deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
3246e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){
32546012949SMatthias Ringwald     switch (gatt_client->bearer_type){
32646012949SMatthias Ringwald         case ATT_BEARER_UNENHANCED_LE:
3276e7b444cSMatthias Ringwald             return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len);
32846012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
32946012949SMatthias Ringwald         case ATT_BEARER_UNENHANCED_CLASSIC:
33046012949SMatthias Ringwald             return l2cap_send_prepared(gatt_client->l2cap_cid, len);
33146012949SMatthias Ringwald #endif
3327627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
3337627a0deSMatthias Ringwald         case ATT_BEARER_ENHANCED_LE:
3347627a0deSMatthias Ringwald             return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len);
3357627a0deSMatthias Ringwald #endif
33646012949SMatthias Ringwald         default:
33746012949SMatthias Ringwald             btstack_unreachable();
33846012949SMatthias Ringwald             return ERROR_CODE_HARDWARE_FAILURE;
33946012949SMatthias Ringwald     }
3403deb3ec6SMatthias Ringwald }
3413deb3ec6SMatthias Ringwald 
3423deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
3436e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) {
3449228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
3456e7b444cSMatthias Ringwald 
3466e7b444cSMatthias Ringwald     request[0] = ATT_HANDLE_VALUE_CONFIRMATION;
3476e7b444cSMatthias Ringwald 
3486e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 1);
3496e7b444cSMatthias Ringwald }
3506e7b444cSMatthias Ringwald 
3516e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE
3526e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle,
3536e7b444cSMatthias Ringwald                                             uint16_t end_handle) {
3549228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
3556e7b444cSMatthias Ringwald 
3563deb3ec6SMatthias Ringwald     request[0] = request_type;
357f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, start_handle);
358f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, end_handle);
3593deb3ec6SMatthias Ringwald 
3606e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 5);
3613deb3ec6SMatthias Ringwald }
3623deb3ec6SMatthias Ringwald 
3633deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
3646e7b444cSMatthias Ringwald static uint8_t
3656e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type,
3666e7b444cSMatthias Ringwald                                uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) {
3679228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
3683deb3ec6SMatthias Ringwald     request[0] = request_type;
3699228fd32SMatthias Ringwald 
370f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, start_handle);
371f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, end_handle);
372f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 5, attribute_group_type);
3736535961aSMatthias Ringwald     (void)memcpy(&request[7], value, value_size);
3743deb3ec6SMatthias Ringwald 
3756e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 7u + value_size);
3763deb3ec6SMatthias Ringwald }
3773deb3ec6SMatthias Ringwald 
3783deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
3796e7b444cSMatthias Ringwald static uint8_t
3806e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16,
3816e7b444cSMatthias Ringwald                                              uint16_t start_handle, uint16_t end_handle) {
3829228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
3836e7b444cSMatthias Ringwald 
3843deb3ec6SMatthias Ringwald     request[0] = request_type;
385f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, start_handle);
386f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, end_handle);
387f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 5, uuid16);
3883deb3ec6SMatthias Ringwald 
3896e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 7);
3903deb3ec6SMatthias Ringwald }
3913deb3ec6SMatthias Ringwald 
3923deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
3936e7b444cSMatthias Ringwald static uint8_t
3946e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128,
3956e7b444cSMatthias Ringwald                                               uint16_t start_handle, uint16_t end_handle) {
3969228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
3976e7b444cSMatthias Ringwald 
3983deb3ec6SMatthias Ringwald     request[0] = request_type;
399f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, start_handle);
400f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, end_handle);
4019c80e4ccSMatthias Ringwald     reverse_128(uuid128, &request[5]);
4023deb3ec6SMatthias Ringwald 
4036e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 21);
4043deb3ec6SMatthias Ringwald }
4053deb3ec6SMatthias Ringwald 
4063deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
4076e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) {
4089228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
4096e7b444cSMatthias Ringwald 
4103deb3ec6SMatthias Ringwald     request[0] = request_type;
411f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
4123deb3ec6SMatthias Ringwald 
4136e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 3);
4143deb3ec6SMatthias Ringwald }
4153deb3ec6SMatthias Ringwald 
4163deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
4176e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle,
4186e7b444cSMatthias Ringwald                                      uint16_t value_offset) {
4199228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
4209228fd32SMatthias Ringwald 
4213deb3ec6SMatthias Ringwald     request[0] = request_type;
422f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
423f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, value_offset);
4243deb3ec6SMatthias Ringwald 
4256e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 5);
4263deb3ec6SMatthias Ringwald }
4273deb3ec6SMatthias Ringwald 
4286e7b444cSMatthias Ringwald static uint8_t
429f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) {
4309228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
4319228fd32SMatthias Ringwald 
432f125a8efSMatthias Ringwald     request[0] = opcode;
4339228fd32SMatthias Ringwald     uint16_t i;
4349228fd32SMatthias Ringwald     uint16_t offset = 1;
4353deb3ec6SMatthias Ringwald     for (i=0;i<num_value_handles;i++){
436f8fbdce0SMatthias Ringwald         little_endian_store_16(request, offset, value_handles[i]);
4373deb3ec6SMatthias Ringwald         offset += 2;
4383deb3ec6SMatthias Ringwald     }
43925b7c058SMilanka Ringwald 
4406e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, offset);
4413deb3ec6SMatthias Ringwald }
4423deb3ec6SMatthias Ringwald 
443f125a8efSMatthias Ringwald static uint8_t
444f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) {
445f125a8efSMatthias Ringwald     return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST);
446f125a8efSMatthias Ringwald }
447f125a8efSMatthias Ringwald 
448f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
449f125a8efSMatthias Ringwald static uint8_t
450f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) {
451f125a8efSMatthias Ringwald     return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_VARIABLE_REQ);
452f125a8efSMatthias Ringwald }
453f125a8efSMatthias Ringwald #endif
454f125a8efSMatthias Ringwald 
4557a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
4563deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
4576e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle,
4586e7b444cSMatthias Ringwald                                         uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) {
4599228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
4609228fd32SMatthias Ringwald 
4613deb3ec6SMatthias Ringwald     request[0] = request_type;
462f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
4636535961aSMatthias Ringwald     (void)memcpy(&request[3], value, value_length);
464f8fbdce0SMatthias Ringwald     little_endian_store_32(request, 3 + value_length, sign_counter);
4659c80e4ccSMatthias Ringwald     reverse_64(sgn, &request[3 + value_length + 4]);
46625b7c058SMilanka Ringwald 
4676e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 3 + value_length + 12);
4683deb3ec6SMatthias Ringwald }
4697a766ebfSMatthias Ringwald #endif
4703deb3ec6SMatthias Ringwald 
4713deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
4726e7b444cSMatthias Ringwald static uint8_t
4736e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length,
4746e7b444cSMatthias Ringwald                   uint8_t *value) {
4759228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
4769228fd32SMatthias Ringwald 
4773deb3ec6SMatthias Ringwald     request[0] = request_type;
478f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
4796535961aSMatthias Ringwald     (void)memcpy(&request[3], value, value_length);
4803deb3ec6SMatthias Ringwald 
4816e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 3u + value_length);
4823deb3ec6SMatthias Ringwald }
4833deb3ec6SMatthias Ringwald 
4843deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
4856e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) {
4869228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
4879228fd32SMatthias Ringwald 
4883deb3ec6SMatthias Ringwald     request[0] = request_type;
4893deb3ec6SMatthias Ringwald     request[1] = execute_write;
49025b7c058SMilanka Ringwald 
4916e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 2);
4923deb3ec6SMatthias Ringwald }
4933deb3ec6SMatthias Ringwald 
4943deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE
4956e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle,
4966e7b444cSMatthias Ringwald                                          uint16_t value_offset, uint16_t blob_length, uint8_t *value) {
4979228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
4989228fd32SMatthias Ringwald 
4993deb3ec6SMatthias Ringwald     request[0] = request_type;
500f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, attribute_handle);
501f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 3, value_offset);
5026535961aSMatthias Ringwald     (void)memcpy(&request[5], &value[value_offset], blob_length);
5033deb3ec6SMatthias Ringwald 
5046e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client,  5u + blob_length);
5053deb3ec6SMatthias Ringwald }
5063deb3ec6SMatthias Ringwald 
5076e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) {
5089228fd32SMatthias Ringwald     uint8_t *request = gatt_client_reserve_request_buffer(gatt_client);
5099228fd32SMatthias Ringwald 
5103deb3ec6SMatthias Ringwald     request[0] = ATT_EXCHANGE_MTU_REQUEST;
5119228fd32SMatthias Ringwald     uint16_t mtu = l2cap_max_le_mtu();
512f8fbdce0SMatthias Ringwald     little_endian_store_16(request, 1, mtu);
51325b7c058SMilanka Ringwald 
5146e7b444cSMatthias Ringwald     return gatt_client_send(gatt_client, 3);
5153deb3ec6SMatthias Ringwald }
5163deb3ec6SMatthias Ringwald 
5175cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){
518dda77937SMatthias Ringwald     uint16_t max_blob_length = gatt_client->mtu - 5u;
5195cf1669fSMatthias Ringwald     if (gatt_client->attribute_offset >= gatt_client->attribute_length) {
5203deb3ec6SMatthias Ringwald         return 0;
5213deb3ec6SMatthias Ringwald     }
5225cf1669fSMatthias Ringwald     uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset;
5233deb3ec6SMatthias Ringwald     if (max_blob_length > rest_length){
5243deb3ec6SMatthias Ringwald         return rest_length;
5253deb3ec6SMatthias Ringwald     }
5263deb3ec6SMatthias Ringwald     return max_blob_length;
5273deb3ec6SMatthias Ringwald }
5283deb3ec6SMatthias Ringwald 
5295cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){
5306e7b444cSMatthias Ringwald     att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST,
5316e7b444cSMatthias Ringwald                                                  gatt_client->uuid16, gatt_client->start_group_handle,
5326e7b444cSMatthias Ringwald                                                  gatt_client->end_group_handle);
5333deb3ec6SMatthias Ringwald }
5343deb3ec6SMatthias Ringwald 
5355cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){
53652377058SMatthias Ringwald     if (gatt_client->uuid16 != 0u){
5373deb3ec6SMatthias Ringwald         uint8_t uuid16[2];
5385cf1669fSMatthias Ringwald         little_endian_store_16(uuid16, 0, gatt_client->uuid16);
5396e7b444cSMatthias Ringwald         att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type,
5406e7b444cSMatthias Ringwald                                        gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2);
5413deb3ec6SMatthias Ringwald         return;
5423deb3ec6SMatthias Ringwald     }
5433deb3ec6SMatthias Ringwald     uint8_t uuid128[16];
5445cf1669fSMatthias Ringwald     reverse_128(gatt_client->uuid128, uuid128);
5456e7b444cSMatthias Ringwald     att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type,
5466e7b444cSMatthias Ringwald                                    gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16);
5473deb3ec6SMatthias Ringwald }
5483deb3ec6SMatthias Ringwald 
5495cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){
5505cf1669fSMatthias Ringwald     send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID);
5513deb3ec6SMatthias Ringwald }
5523deb3ec6SMatthias Ringwald 
5535cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){
5546e7b444cSMatthias Ringwald     att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle);
5553deb3ec6SMatthias Ringwald }
5563deb3ec6SMatthias Ringwald 
5575cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){
5586e7b444cSMatthias Ringwald     att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST,
5596e7b444cSMatthias Ringwald                                                  GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle,
5606e7b444cSMatthias Ringwald                                                  gatt_client->end_group_handle);
5613deb3ec6SMatthias Ringwald }
5623deb3ec6SMatthias Ringwald 
5635cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){
5646e7b444cSMatthias Ringwald     att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST,
5656e7b444cSMatthias Ringwald                                                  GATT_CHARACTERISTICS_UUID, gatt_client->start_group_handle,
5666e7b444cSMatthias Ringwald                                                  gatt_client->end_group_handle);
5673deb3ec6SMatthias Ringwald }
5683deb3ec6SMatthias Ringwald 
5695cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){
5706e7b444cSMatthias Ringwald     att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle,
5716e7b444cSMatthias Ringwald                                  gatt_client->end_group_handle);
5723deb3ec6SMatthias Ringwald }
5733deb3ec6SMatthias Ringwald 
5745cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){
5756e7b444cSMatthias Ringwald     att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle);
5763deb3ec6SMatthias Ringwald }
5773deb3ec6SMatthias Ringwald 
5785cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){
57952377058SMatthias Ringwald     if (gatt_client->uuid16 != 0u){
5806e7b444cSMatthias Ringwald         att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST,
5816e7b444cSMatthias Ringwald                                                      gatt_client->uuid16, gatt_client->start_group_handle,
5826e7b444cSMatthias Ringwald                                                      gatt_client->end_group_handle);
5833deb3ec6SMatthias Ringwald     } else {
5846e7b444cSMatthias Ringwald         att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST,
5856e7b444cSMatthias Ringwald                                                       gatt_client->uuid128, gatt_client->start_group_handle,
5866e7b444cSMatthias Ringwald                                                       gatt_client->end_group_handle);
5873deb3ec6SMatthias Ringwald     }
5883deb3ec6SMatthias Ringwald }
5893deb3ec6SMatthias Ringwald 
5905cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){
59130952227SMilanka Ringwald     if (gatt_client->attribute_offset == 0){
5926e7b444cSMatthias Ringwald         att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle);
59330952227SMilanka Ringwald     } else {
5946e7b444cSMatthias Ringwald         att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle,
5956e7b444cSMatthias Ringwald                               gatt_client->attribute_offset);
5963deb3ec6SMatthias Ringwald     }
59730952227SMilanka Ringwald }
5983deb3ec6SMatthias Ringwald 
5995cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){
6006e7b444cSMatthias Ringwald     att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles);
6013deb3ec6SMatthias Ringwald }
6023deb3ec6SMatthias Ringwald 
603f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
604f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){
605f125a8efSMatthias Ringwald     att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles);
606f125a8efSMatthias Ringwald }
607f125a8efSMatthias Ringwald #endif
608f125a8efSMatthias Ringwald 
6095cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){
6106e7b444cSMatthias Ringwald     att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length,
6116e7b444cSMatthias Ringwald                       gatt_client->attribute_value);
6123deb3ec6SMatthias Ringwald }
6133deb3ec6SMatthias Ringwald 
6145cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){
6156e7b444cSMatthias Ringwald     att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2,
6166e7b444cSMatthias Ringwald                       gatt_client->client_characteristic_configuration_value);
6173deb3ec6SMatthias Ringwald }
6183deb3ec6SMatthias Ringwald 
6195cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){
6206e7b444cSMatthias Ringwald     att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle,
6216e7b444cSMatthias Ringwald                               gatt_client->attribute_offset, write_blob_length(gatt_client),
6226e7b444cSMatthias Ringwald                               gatt_client->attribute_value);
6233deb3ec6SMatthias Ringwald }
6243deb3ec6SMatthias Ringwald 
6255cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){
6266e7b444cSMatthias Ringwald     att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1);
6273deb3ec6SMatthias Ringwald }
6283deb3ec6SMatthias Ringwald 
6295cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){
6306e7b444cSMatthias Ringwald     att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0);
6313deb3ec6SMatthias Ringwald }
6323deb3ec6SMatthias Ringwald 
633abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
6345cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){
6356e7b444cSMatthias Ringwald     att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST,
6366e7b444cSMatthias Ringwald                                                  GATT_CLIENT_CHARACTERISTICS_CONFIGURATION,
6376e7b444cSMatthias Ringwald                                                  gatt_client->start_group_handle, gatt_client->end_group_handle);
6383deb3ec6SMatthias Ringwald }
639abdc9fb5SMatthias Ringwald #endif
6403deb3ec6SMatthias Ringwald 
6415cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){
6426e7b444cSMatthias Ringwald     att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle);
6433deb3ec6SMatthias Ringwald }
6443deb3ec6SMatthias Ringwald 
6457a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
6465cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){
6476e7b444cSMatthias Ringwald     att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle,
6486e7b444cSMatthias Ringwald                              gatt_client->attribute_length, gatt_client->attribute_value, sign_counter,
6496e7b444cSMatthias Ringwald                              gatt_client->cmac);
6503deb3ec6SMatthias Ringwald }
6517a766ebfSMatthias Ringwald #endif
6523deb3ec6SMatthias Ringwald 
6533deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){
65439ac9711SMatthias Ringwald     if (size < 2) return 0xffff;
6553deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
65639ac9711SMatthias Ringwald     if ((2 + attr_length) > size) return 0xffff;
6574ea43905SMatthias Ringwald     return little_endian_read_16(packet, size - attr_length + 2u);
6583deb3ec6SMatthias Ringwald }
6593deb3ec6SMatthias Ringwald 
6603deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){
66139ac9711SMatthias Ringwald     if (size < 2) return 0xffff;
6623deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
66339ac9711SMatthias Ringwald     if ((2 + attr_length) > size) return 0xffff;
6644ea43905SMatthias Ringwald     return little_endian_read_16(packet, size - attr_length + 3u);
6653deb3ec6SMatthias Ringwald }
6663deb3ec6SMatthias Ringwald 
6673deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){
66839ac9711SMatthias Ringwald     if (size < 2) return 0xffff;
6693deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
67039ac9711SMatthias Ringwald     if ((2 + attr_length) > size) return 0xffff;
671f8fbdce0SMatthias Ringwald     return little_endian_read_16(packet, size - attr_length);
6723deb3ec6SMatthias Ringwald }
6733deb3ec6SMatthias Ringwald 
674842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED
67558e8c9f5SMatthias Ringwald static void gatt_client_service_emit_event(gatt_client_t * gatt_client, uint8_t * event, uint16_t size){
67658e8c9f5SMatthias Ringwald     btstack_linked_list_iterator_t it;
67758e8c9f5SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_service_changed_handler);
67858e8c9f5SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
67958e8c9f5SMatthias Ringwald         btstack_packet_callback_registration_t *callback = (btstack_packet_callback_registration_t *) btstack_linked_list_iterator_next(&it);
68058e8c9f5SMatthias Ringwald         (*callback->callback)(HCI_EVENT_PACKET, (uint16_t) gatt_client->con_handle, event, size);
68158e8c9f5SMatthias Ringwald     }
68258e8c9f5SMatthias Ringwald }
68358e8c9f5SMatthias Ringwald 
68458e8c9f5SMatthias Ringwald static void
68558e8c9f5SMatthias Ringwald gatt_client_service_emit_database_hash(gatt_client_t *gatt_client, const uint8_t *value, uint16_t value_len) {
68658e8c9f5SMatthias Ringwald     if (value_len == 16){
68758e8c9f5SMatthias Ringwald         uint8_t event[21];
68858e8c9f5SMatthias Ringwald         hci_event_builder_context_t context;
68958e8c9f5SMatthias Ringwald         hci_event_builder_init(&context, event, sizeof(event), HCI_EVENT_GATTSERVICE_META, GATTSERVICE_SUBEVENT_GATT_DATABASE_HASH);
69058e8c9f5SMatthias Ringwald         hci_event_builder_add_con_handle(&context, gatt_client->con_handle);
69158e8c9f5SMatthias Ringwald         hci_event_builder_add_bytes(&context, value, 16);
69258e8c9f5SMatthias Ringwald         gatt_client_service_emit_event(gatt_client, event, hci_event_builder_get_length(&context));
69358e8c9f5SMatthias Ringwald     }
69458e8c9f5SMatthias Ringwald }
69558e8c9f5SMatthias Ringwald 
69658e8c9f5SMatthias Ringwald static void
69758e8c9f5SMatthias Ringwald gatt_client_service_emit_service_changed(gatt_client_t *gatt_client, const uint8_t *value, uint16_t value_len) {
69858e8c9f5SMatthias Ringwald     if (value_len == 4){
69958e8c9f5SMatthias Ringwald         uint8_t event[9];
70058e8c9f5SMatthias Ringwald         hci_event_builder_context_t context;
70158e8c9f5SMatthias Ringwald         hci_event_builder_init(&context, event, sizeof(event), HCI_EVENT_GATTSERVICE_META, GATTSERVICE_SUBEVENT_GATT_SERVICE_CHANGED);
70258e8c9f5SMatthias Ringwald         hci_event_builder_add_con_handle(&context, gatt_client->con_handle);
70358e8c9f5SMatthias Ringwald         hci_event_builder_add_bytes(&context, value, 4);
70458e8c9f5SMatthias Ringwald         gatt_client_service_emit_event(gatt_client, event, hci_event_builder_get_length(&context));
70558e8c9f5SMatthias Ringwald     }
70658e8c9f5SMatthias Ringwald }
70758e8c9f5SMatthias Ringwald 
708d9ced76fSMatthias Ringwald static void gatt_client_service_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
709e2c98440SMatthias Ringwald     UNUSED(channel);  // ok: handling own l2cap events
710e2c98440SMatthias Ringwald     UNUSED(size);     // ok: there is no channel
711e2c98440SMatthias Ringwald 
712d9ced76fSMatthias Ringwald     hci_con_handle_t con_handle;
713d9ced76fSMatthias Ringwald     gatt_client_t *gatt_client;
714d9ced76fSMatthias Ringwald     gatt_client_service_t service;
715d9ced76fSMatthias Ringwald     gatt_client_characteristic_t characteristic;
716d9ced76fSMatthias Ringwald     switch (packet_type) {
717d9ced76fSMatthias Ringwald         case HCI_EVENT_PACKET:
718d9ced76fSMatthias Ringwald             switch (hci_event_packet_get_type(packet)) {
719d9ced76fSMatthias Ringwald                 case GATT_EVENT_SERVICE_QUERY_RESULT:
720d9ced76fSMatthias Ringwald                     con_handle = gatt_event_service_query_result_get_handle(packet);
721d9ced76fSMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(con_handle);
722d9ced76fSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
723d9ced76fSMatthias Ringwald                     btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DISCOVER_W4_DONE);
724d9ced76fSMatthias Ringwald                     gatt_event_service_query_result_get_service(packet, &service);
725d9ced76fSMatthias Ringwald                     gatt_client->gatt_service_start_group_handle = service.start_group_handle;
726d9ced76fSMatthias Ringwald                     gatt_client->gatt_service_end_group_handle = service.end_group_handle;
727d9ced76fSMatthias Ringwald                     break;
728d9ced76fSMatthias Ringwald                 case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT:
729d9ced76fSMatthias Ringwald                     con_handle = gatt_event_characteristic_query_result_get_handle(packet);
730d9ced76fSMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(con_handle);
731d9ced76fSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
732d9ced76fSMatthias Ringwald                     btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE);
733d9ced76fSMatthias Ringwald                     gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic);
734d9ced76fSMatthias Ringwald                     switch (characteristic.uuid16){
735d9ced76fSMatthias Ringwald                         case ORG_BLUETOOTH_CHARACTERISTIC_GATT_SERVICE_CHANGED:
736d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_changed_value_handle = characteristic.value_handle;
737d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_changed_end_handle = characteristic.end_handle;
738d9ced76fSMatthias Ringwald                             break;
739d9ced76fSMatthias Ringwald                         case ORG_BLUETOOTH_CHARACTERISTIC_DATABASE_HASH:
740d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_database_hash_value_handle = characteristic.value_handle;
741d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_database_hash_end_handle = characteristic.end_handle;
742d9ced76fSMatthias Ringwald                             break;
743d9ced76fSMatthias Ringwald                         default:
744d9ced76fSMatthias Ringwald                             break;
745d9ced76fSMatthias Ringwald                     }
746d9ced76fSMatthias Ringwald                     break;
747d9ced76fSMatthias Ringwald                 case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT:
748d9ced76fSMatthias Ringwald                     con_handle = gatt_event_characteristic_value_query_result_get_handle(packet);
749d9ced76fSMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(con_handle);
750d9ced76fSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
751d9ced76fSMatthias Ringwald                     btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE);
75258e8c9f5SMatthias Ringwald                         gatt_client_service_emit_database_hash(gatt_client,
75358e8c9f5SMatthias Ringwald                                                                gatt_event_characteristic_value_query_result_get_value(packet),
75458e8c9f5SMatthias Ringwald                                                                gatt_event_characteristic_value_query_result_get_value_length(packet));
755d9ced76fSMatthias Ringwald                     break;
756d9ced76fSMatthias Ringwald                 case GATT_EVENT_QUERY_COMPLETE:
757d9ced76fSMatthias Ringwald                     con_handle = gatt_event_query_complete_get_handle(packet);
758d9ced76fSMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(con_handle);
759d9ced76fSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
760d9ced76fSMatthias Ringwald                     switch (gatt_client->gatt_service_state) {
761d9ced76fSMatthias Ringwald                         case GATT_CLIENT_SERVICE_DISCOVER_W4_DONE:
762d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W2_SEND;
763d9ced76fSMatthias Ringwald                             break;
764d9ced76fSMatthias Ringwald                         case GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE:
765d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W2_SEND;
766d9ced76fSMatthias Ringwald                             break;
767d9ced76fSMatthias Ringwald                         case GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W4_DONE:
768d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W2_SEND;
769d9ced76fSMatthias Ringwald                             break;
770d9ced76fSMatthias Ringwald                         case GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE:
771d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W2_SEND;
772d9ced76fSMatthias Ringwald                             break;
773d9ced76fSMatthias Ringwald                         case GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W4_DONE:
774d9ced76fSMatthias Ringwald                             gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DONE;
775d9ced76fSMatthias Ringwald                             break;
776d9ced76fSMatthias Ringwald                         default:
777d9ced76fSMatthias Ringwald                             btstack_unreachable();
778d9ced76fSMatthias Ringwald                             break;
779d9ced76fSMatthias Ringwald                     }
780d9ced76fSMatthias Ringwald                     break;
781d9ced76fSMatthias Ringwald                 default:
782d9ced76fSMatthias Ringwald                     break;
783d9ced76fSMatthias Ringwald             }
784d9ced76fSMatthias Ringwald             break;
785d9ced76fSMatthias Ringwald         default:
786d9ced76fSMatthias Ringwald             break;
787d9ced76fSMatthias Ringwald     }
788d9ced76fSMatthias Ringwald }
789842492f0SMatthias Ringwald #endif
790d9ced76fSMatthias Ringwald 
79153e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){
79219c614acSMatthias Ringwald 
79319c614acSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
79419c614acSMatthias Ringwald     // if eatt is ready, notify all clients that can send a query
79519c614acSMatthias Ringwald     if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){
79619c614acSMatthias Ringwald         btstack_linked_list_iterator_t it;
79719c614acSMatthias Ringwald         btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients);
79819c614acSMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
79919c614acSMatthias Ringwald             gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
800052dc82aSMatthias Ringwald             if (client->state == P_READY){
80119c614acSMatthias Ringwald                 // call callback
80219c614acSMatthias Ringwald                 btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests);
80319c614acSMatthias Ringwald                 if (callback == NULL) {
80419c614acSMatthias Ringwald                     return;
80519c614acSMatthias Ringwald                 }
80619c614acSMatthias Ringwald                 (*callback->callback)(callback->context);
80719c614acSMatthias Ringwald             }
80819c614acSMatthias Ringwald         }
80919c614acSMatthias Ringwald         return;
81019c614acSMatthias Ringwald     }
81119c614acSMatthias Ringwald #endif
81219c614acSMatthias Ringwald 
813842492f0SMatthias Ringwald     while (gatt_client->state == P_READY){
814842492f0SMatthias Ringwald         bool query_sent = false;
815842492f0SMatthias Ringwald         UNUSED(query_sent);
816842492f0SMatthias Ringwald 
817842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED
818d9ced76fSMatthias Ringwald         uint8_t status = ERROR_CODE_SUCCESS;
819d9ced76fSMatthias Ringwald         gatt_client_service_t gatt_service;
820d9ced76fSMatthias Ringwald         gatt_client_characteristic_t characteristic;
821d9ced76fSMatthias Ringwald         switch (gatt_client->gatt_service_state){
822d9ced76fSMatthias Ringwald             case GATT_CLIENT_SERVICE_DISCOVER_W2_SEND:
823d9ced76fSMatthias Ringwald                 gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_W4_DONE;
824d9ced76fSMatthias Ringwald                 status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_service_packet_handler,
825d9ced76fSMatthias Ringwald                                                                                          gatt_client->con_handle,
826d9ced76fSMatthias Ringwald                                                                                          ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE);
827d9ced76fSMatthias Ringwald                 query_sent = true;
828d9ced76fSMatthias Ringwald                 break;
829d9ced76fSMatthias Ringwald             case GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W2_SEND:
830d9ced76fSMatthias Ringwald                 if (gatt_client->gatt_service_start_group_handle != 0){
831d9ced76fSMatthias Ringwald                     gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE;
832d9ced76fSMatthias Ringwald                     gatt_service.start_group_handle = gatt_client->gatt_service_start_group_handle;
833d9ced76fSMatthias Ringwald                     gatt_service.end_group_handle   = gatt_client->gatt_service_end_group_handle;
834d9ced76fSMatthias Ringwald                     status = gatt_client_discover_characteristics_for_service(&gatt_client_service_packet_handler, gatt_client->con_handle, &gatt_service);
835d9ced76fSMatthias Ringwald                     query_sent = true;
836d9ced76fSMatthias Ringwald                     break;
837d9ced76fSMatthias Ringwald                 }
838d9ced76fSMatthias Ringwald 
839d9ced76fSMatthias Ringwald                 /* fall through */
840d9ced76fSMatthias Ringwald 
841d9ced76fSMatthias Ringwald             case GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W2_SEND:
842d9ced76fSMatthias Ringwald                 if (gatt_client->gatt_service_changed_value_handle != 0){
843d9ced76fSMatthias Ringwald                     gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W4_DONE;
844d9ced76fSMatthias Ringwald                     characteristic.value_handle = gatt_client->gatt_service_changed_value_handle;
845d9ced76fSMatthias Ringwald                     characteristic.end_handle   = gatt_client->gatt_service_changed_end_handle;
846d9ced76fSMatthias Ringwald                     // we assume good case. We cannot do much otherwise
847d9ced76fSMatthias Ringwald                     characteristic.properties = ATT_PROPERTY_INDICATE;
848d9ced76fSMatthias Ringwald                     status = gatt_client_write_client_characteristic_configuration(&gatt_client_service_packet_handler,
849d9ced76fSMatthias Ringwald                                                                                    gatt_client->con_handle, &characteristic,
850d9ced76fSMatthias Ringwald                                                                                    GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION);
851d9ced76fSMatthias Ringwald                     query_sent = true;
852d9ced76fSMatthias Ringwald                     break;
853d9ced76fSMatthias Ringwald                 }
854d9ced76fSMatthias Ringwald 
855d9ced76fSMatthias Ringwald                 /* fall through */
856d9ced76fSMatthias Ringwald 
857d9ced76fSMatthias Ringwald             case GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W2_SEND:
858d9ced76fSMatthias Ringwald                 if (gatt_client->gatt_service_database_hash_value_handle != 0){
859d9ced76fSMatthias Ringwald                     gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE;
860d9ced76fSMatthias Ringwald                     status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_service_packet_handler,
861d9ced76fSMatthias Ringwald                                                                                          gatt_client->con_handle,
862d9ced76fSMatthias Ringwald                                                                                          0x0001, 0xffff, ORG_BLUETOOTH_CHARACTERISTIC_DATABASE_HASH);
863d9ced76fSMatthias Ringwald                     query_sent = true;
864d9ced76fSMatthias Ringwald                     break;
865d9ced76fSMatthias Ringwald                 }
866d9ced76fSMatthias Ringwald 
867d9ced76fSMatthias Ringwald                 /* fall through */
868d9ced76fSMatthias Ringwald 
869d9ced76fSMatthias Ringwald             case GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W2_SEND:
870d9ced76fSMatthias Ringwald                 if (gatt_client->gatt_service_database_hash_value_handle != 0) {
871d9ced76fSMatthias Ringwald                     gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W4_DONE;
872d9ced76fSMatthias Ringwald                     characteristic.value_handle = gatt_client->gatt_service_database_hash_value_handle;
873d9ced76fSMatthias Ringwald                     characteristic.end_handle = gatt_client->gatt_service_database_hash_end_handle;
874d9ced76fSMatthias Ringwald                     // we assume good case. We cannot do much otherwise
875d9ced76fSMatthias Ringwald                     characteristic.properties = ATT_PROPERTY_INDICATE;
876d9ced76fSMatthias Ringwald                     status = gatt_client_write_client_characteristic_configuration(&gatt_client_service_packet_handler,
877d9ced76fSMatthias Ringwald                                                                                    gatt_client->con_handle,
878d9ced76fSMatthias Ringwald                                                                                    &characteristic,
879d9ced76fSMatthias Ringwald                                                                                    GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION);
880d9ced76fSMatthias Ringwald                     query_sent = true;
881d9ced76fSMatthias Ringwald                     break;
882d9ced76fSMatthias Ringwald                 }
883d9ced76fSMatthias Ringwald 
884d9ced76fSMatthias Ringwald                 // DONE
885d9ced76fSMatthias Ringwald                 gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DONE;
886d9ced76fSMatthias Ringwald                 break;
887d9ced76fSMatthias Ringwald             default:
888d9ced76fSMatthias Ringwald                 break;
889d9ced76fSMatthias Ringwald         }
890d9ced76fSMatthias Ringwald         btstack_assert(status == ERROR_CODE_SUCCESS);
891d9ced76fSMatthias Ringwald         UNUSED(status);
892d9ced76fSMatthias Ringwald         if (query_sent){
893d9ced76fSMatthias Ringwald             continue;
894d9ced76fSMatthias Ringwald         }
895842492f0SMatthias Ringwald #endif
896d9ced76fSMatthias Ringwald 
89726166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
898d9ced76fSMatthias Ringwald         query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client);
89926166ecfSMatthias Ringwald         if (query_sent){
90026166ecfSMatthias Ringwald             continue;
90126166ecfSMatthias Ringwald         }
90226166ecfSMatthias Ringwald #endif
90353e9c18fSMatthias Ringwald         btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests);
90409834412SMatthias Ringwald         if (callback == NULL) {
90509834412SMatthias Ringwald             return;
90653e9c18fSMatthias Ringwald         }
90709834412SMatthias Ringwald         (*callback->callback)(callback->context);
90853e9c18fSMatthias Ringwald     }
90953e9c18fSMatthias Ringwald }
91053e9c18fSMatthias Ringwald 
91123d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA)
91223d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) {
91323d583b8SMatthias Ringwald     // ignore messages until re-encryption is complete
91423d583b8SMatthias Ringwald     if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false;
91523d583b8SMatthias Ringwald 
91623d583b8SMatthias Ringwald 	// after that ignore if bonded but not encrypted
91723d583b8SMatthias Ringwald 	return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0);
91823d583b8SMatthias Ringwald }
91923d583b8SMatthias Ringwald 
9209c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){
9219c662c9bSMatthias Ringwald     if (!callback) return;
9229da9850bSMatthias Ringwald     hci_dump_btstack_event(packet, size);
9239c662c9bSMatthias Ringwald     (*callback)(HCI_EVENT_PACKET, 0, packet, size);
9243deb3ec6SMatthias Ringwald }
9253deb3ec6SMatthias Ringwald 
926711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){
927665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
9289c662c9bSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners);
929665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
93086c38559SMatthias Ringwald         gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it);
931b3f03c84SMatthias Ringwald         if ((notification->con_handle       != GATT_CLIENT_ANY_CONNECTION)   && (notification->con_handle       != con_handle)) continue;
932b3f03c84SMatthias Ringwald         if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue;
93386c38559SMatthias Ringwald         (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size);
9343deb3ec6SMatthias Ringwald     }
9353deb3ec6SMatthias Ringwald }
9363deb3ec6SMatthias Ringwald 
9375cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){
9383deb3ec6SMatthias Ringwald     // @format H1
9393deb3ec6SMatthias Ringwald     uint8_t packet[5];
9405611a760SMatthias Ringwald     packet[0] = GATT_EVENT_QUERY_COMPLETE;
9413deb3ec6SMatthias Ringwald     packet[1] = 3;
9425cf1669fSMatthias Ringwald     little_endian_store_16(packet, 2, gatt_client->con_handle);
9437d2258b3SMilanka Ringwald     packet[4] = att_status;
9445cf1669fSMatthias Ringwald     emit_event_new(gatt_client->callback, packet, sizeof(packet));
9453deb3ec6SMatthias Ringwald }
9463deb3ec6SMatthias Ringwald 
947045d700dSDavid Lechner static void emit_gatt_service_query_result_event(gatt_client_t * gatt_client, uint16_t start_group_handle, uint16_t end_group_handle, const uint8_t * uuid128){
9483deb3ec6SMatthias Ringwald     // @format HX
9493deb3ec6SMatthias Ringwald     uint8_t packet[24];
9505611a760SMatthias Ringwald     packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT;
9514ea43905SMatthias Ringwald     packet[1] = sizeof(packet) - 2u;
9525cf1669fSMatthias Ringwald     little_endian_store_16(packet, 2, gatt_client->con_handle);
9533deb3ec6SMatthias Ringwald     ///
954f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4, start_group_handle);
955f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 6, end_group_handle);
9569c80e4ccSMatthias Ringwald     reverse_128(uuid128, &packet[8]);
9575cf1669fSMatthias Ringwald     emit_event_new(gatt_client->callback, packet, sizeof(packet));
9583deb3ec6SMatthias Ringwald }
9593deb3ec6SMatthias Ringwald 
960045d700dSDavid Lechner static void emit_gatt_included_service_query_result_event(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t start_group_handle, uint16_t end_group_handle, const uint8_t * uuid128){
9613deb3ec6SMatthias Ringwald     // @format HX
9623deb3ec6SMatthias Ringwald     uint8_t packet[26];
9635611a760SMatthias Ringwald     packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT;
9644ea43905SMatthias Ringwald     packet[1] = sizeof(packet) - 2u;
9655cf1669fSMatthias Ringwald     little_endian_store_16(packet, 2, gatt_client->con_handle);
9663deb3ec6SMatthias Ringwald     ///
967f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4, include_handle);
9683deb3ec6SMatthias Ringwald     //
969f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 6, start_group_handle);
970f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 8, end_group_handle);
9719c80e4ccSMatthias Ringwald     reverse_128(uuid128, &packet[10]);
9725cf1669fSMatthias Ringwald     emit_event_new(gatt_client->callback, packet, sizeof(packet));
9733deb3ec6SMatthias Ringwald }
9743deb3ec6SMatthias Ringwald 
9755cf1669fSMatthias Ringwald static void emit_gatt_characteristic_query_result_event(gatt_client_t * gatt_client, uint16_t start_handle, uint16_t value_handle, uint16_t end_handle,
976045d700dSDavid Lechner                                                         uint16_t properties, const uint8_t * uuid128){
9773deb3ec6SMatthias Ringwald     // @format HY
9783deb3ec6SMatthias Ringwald     uint8_t packet[28];
9795611a760SMatthias Ringwald     packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT;
9804ea43905SMatthias Ringwald     packet[1] = sizeof(packet) - 2u;
9815cf1669fSMatthias Ringwald     little_endian_store_16(packet, 2, gatt_client->con_handle);
9823deb3ec6SMatthias Ringwald     ///
983f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4,  start_handle);
984f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 6,  value_handle);
985f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 8,  end_handle);
986f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 10, properties);
9879c80e4ccSMatthias Ringwald     reverse_128(uuid128, &packet[12]);
9885cf1669fSMatthias Ringwald     emit_event_new(gatt_client->callback, packet, sizeof(packet));
9893deb3ec6SMatthias Ringwald }
9903deb3ec6SMatthias Ringwald 
9913deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event(
992045d700dSDavid Lechner         gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){
9933deb3ec6SMatthias Ringwald     // @format HZ
9943deb3ec6SMatthias Ringwald     uint8_t packet[22];
9955611a760SMatthias Ringwald     packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT;
9964ea43905SMatthias Ringwald     packet[1] = sizeof(packet) - 2u;
9975cf1669fSMatthias Ringwald     little_endian_store_16(packet, 2, gatt_client->con_handle);
9983deb3ec6SMatthias Ringwald     ///
999f8fbdce0SMatthias Ringwald     little_endian_store_16(packet, 4,  descriptor_handle);
10009c80e4ccSMatthias Ringwald     reverse_128(uuid128, &packet[6]);
10015cf1669fSMatthias Ringwald     emit_event_new(gatt_client->callback, packet, sizeof(packet));
10023deb3ec6SMatthias Ringwald }
10033deb3ec6SMatthias Ringwald 
10045cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){
10058f37572aSJakob Krantz     // @format H2
10068f37572aSJakob Krantz     uint8_t packet[6];
10078f37572aSJakob Krantz     packet[0] = GATT_EVENT_MTU;
10084ea43905SMatthias Ringwald     packet[1] = sizeof(packet) - 2u;
10095cf1669fSMatthias Ringwald     little_endian_store_16(packet, 2, gatt_client->con_handle);
10108f37572aSJakob Krantz     little_endian_store_16(packet, 4, new_mtu);
10115cf1669fSMatthias Ringwald     att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu);
10125cf1669fSMatthias Ringwald     emit_event_new(gatt_client->callback, packet, sizeof(packet));
10138f37572aSJakob Krantz }
101423d583b8SMatthias Ringwald 
101523d583b8SMatthias Ringwald // helper
101623d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) {
1017052dc82aSMatthias Ringwald     gatt_client->state = P_READY;
101823d583b8SMatthias Ringwald     gatt_client_timeout_stop(gatt_client);
101923d583b8SMatthias Ringwald     emit_gatt_complete_event(gatt_client, att_status);
102023d583b8SMatthias Ringwald     gatt_client_notify_can_send_query(gatt_client);
102123d583b8SMatthias Ringwald }
102223d583b8SMatthias Ringwald 
102323d583b8SMatthias Ringwald // @return packet pointer
102423d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers
102523d583b8SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 8
1026*8450fbf5SMatthias Ringwald static uint8_t *
1027*8450fbf5SMatthias Ringwald setup_characteristic_value_packet(const gatt_client_t *gatt_client, uint8_t type, uint16_t attribute_handle,
1028*8450fbf5SMatthias Ringwald                                   uint8_t *value, uint16_t length) {
102923d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
103023d583b8SMatthias Ringwald     // copy value into test packet for testing
103123d583b8SMatthias Ringwald     static uint8_t packet[1000];
1032f51e6883SMatthias Ringwald     memcpy(&packet[CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE], value, length);
103323d583b8SMatthias Ringwald #else
103423d583b8SMatthias Ringwald     // before the value inside the ATT PDU
103523d583b8SMatthias Ringwald     uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE;
103623d583b8SMatthias Ringwald #endif
103723d583b8SMatthias Ringwald     packet[0] = type;
103823d583b8SMatthias Ringwald     packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length;
1039*8450fbf5SMatthias Ringwald     little_endian_store_16(packet, 2, gatt_client->con_handle);
104023d583b8SMatthias Ringwald     little_endian_store_16(packet, 4, attribute_handle);
104123d583b8SMatthias Ringwald     little_endian_store_16(packet, 6, length);
104223d583b8SMatthias Ringwald     return packet;
104323d583b8SMatthias Ringwald }
104423d583b8SMatthias Ringwald 
104523d583b8SMatthias Ringwald // @return packet pointer
104623d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
104723d583b8SMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 10
1048f51e6883SMatthias Ringwald 
1049f51e6883SMatthias Ringwald // L2CAP Header (4) + ACL Header (4) => 8 bytes
1050f51e6883SMatthias Ringwald #if !defined(HCI_INCOMING_PRE_BUFFER_SIZE) || ((HCI_INCOMING_PRE_BUFFER_SIZE < LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 8))
1051f51e6883SMatthias Ringwald #error "Long Characteristic reads requires HCI_INCOMING_PRE_BUFFER_SIZE >= 2"
1052f51e6883SMatthias Ringwald #endif
1053f51e6883SMatthias Ringwald 
105423d583b8SMatthias 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){
105523d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
105623d583b8SMatthias Ringwald     // avoid using pre ATT headers.
1057464b6e7bSMatthias Ringwald     // copy value into test packet for testing
1058464b6e7bSMatthias Ringwald     static uint8_t packet[1000];
1059464b6e7bSMatthias Ringwald     memcpy(&packet[LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE], value, length);
1060464b6e7bSMatthias Ringwald #else
106123d583b8SMatthias Ringwald     // before the value inside the ATT PDU
106223d583b8SMatthias Ringwald     uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE;
1063464b6e7bSMatthias Ringwald #endif
106423d583b8SMatthias Ringwald     packet[0] = type;
106523d583b8SMatthias Ringwald     packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length;
106623d583b8SMatthias Ringwald     little_endian_store_16(packet, 2, con_handle);
106723d583b8SMatthias Ringwald     little_endian_store_16(packet, 4, attribute_handle);
106823d583b8SMatthias Ringwald     little_endian_store_16(packet, 6, offset);
106923d583b8SMatthias Ringwald     little_endian_store_16(packet, 8, length);
107023d583b8SMatthias Ringwald     return packet;
107123d583b8SMatthias Ringwald }
107223d583b8SMatthias Ringwald 
1073f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE)
1074f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE
1075f7a42e72SMatthias Ringwald #else
1076f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE
1077f7a42e72SMatthias Ringwald #endif
1078f7a42e72SMatthias Ringwald 
10798f37572aSJakob Krantz ///
10805cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){
108139ac9711SMatthias Ringwald     if (size < 2) return;
10823deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
10834ea43905SMatthias Ringwald     uint8_t uuid_length = attr_length - 4u;
10843deb3ec6SMatthias Ringwald 
10853deb3ec6SMatthias Ringwald     int i;
108639ac9711SMatthias Ringwald     for (i = 2; (i+attr_length) <= size; i += attr_length){
1087f8fbdce0SMatthias Ringwald         uint16_t start_group_handle = little_endian_read_16(packet,i);
1088f8fbdce0SMatthias Ringwald         uint16_t end_group_handle   = little_endian_read_16(packet,i+2);
10893deb3ec6SMatthias Ringwald         uint8_t  uuid128[16];
10903deb3ec6SMatthias Ringwald         uint16_t uuid16 = 0;
10913deb3ec6SMatthias Ringwald 
10924ea43905SMatthias Ringwald         if (uuid_length == 2u){
1093f8fbdce0SMatthias Ringwald             uuid16 = little_endian_read_16(packet, i+4);
1094e1a125dfSMatthias Ringwald             uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16);
109539ac9711SMatthias Ringwald         } else if (uuid_length == 16u) {
10969c80e4ccSMatthias Ringwald             reverse_128(&packet[i+4], uuid128);
109739ac9711SMatthias Ringwald         } else {
109839ac9711SMatthias Ringwald             return;
10993deb3ec6SMatthias Ringwald         }
11005cf1669fSMatthias Ringwald         emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128);
11013deb3ec6SMatthias Ringwald     }
11023deb3ec6SMatthias Ringwald }
11033deb3ec6SMatthias Ringwald 
110423d583b8SMatthias Ringwald static void report_gatt_characteristic_start_found(gatt_client_t * gatt_client, uint16_t start_handle, uint8_t properties, uint16_t value_handle, uint8_t * uuid, uint16_t uuid_length){
11053deb3ec6SMatthias Ringwald     uint8_t uuid128[16];
11063deb3ec6SMatthias Ringwald     uint16_t uuid16 = 0;
11074ea43905SMatthias Ringwald     if (uuid_length == 2u){
1108f8fbdce0SMatthias Ringwald         uuid16 = little_endian_read_16(uuid, 0);
1109e1a125dfSMatthias Ringwald         uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16);
11104ea43905SMatthias Ringwald     } else if (uuid_length == 16u){
11119c80e4ccSMatthias Ringwald         reverse_128(uuid, uuid128);
1112d73c9dbeSMilanka Ringwald     } else {
1113d73c9dbeSMilanka Ringwald         return;
11143deb3ec6SMatthias Ringwald     }
11153deb3ec6SMatthias Ringwald 
11165cf1669fSMatthias Ringwald     if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return;
11173deb3ec6SMatthias Ringwald 
11185cf1669fSMatthias Ringwald     gatt_client->characteristic_properties = properties;
11195cf1669fSMatthias Ringwald     gatt_client->characteristic_start_handle = start_handle;
11205cf1669fSMatthias Ringwald     gatt_client->attribute_handle = value_handle;
11213deb3ec6SMatthias Ringwald 
11225cf1669fSMatthias Ringwald     if (gatt_client->filter_with_uuid) return;
11233deb3ec6SMatthias Ringwald 
11245cf1669fSMatthias Ringwald     gatt_client->uuid16 = uuid16;
11255cf1669fSMatthias Ringwald     (void)memcpy(gatt_client->uuid128, uuid128, 16);
11263deb3ec6SMatthias Ringwald }
11273deb3ec6SMatthias Ringwald 
112823d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){
11293deb3ec6SMatthias Ringwald     // TODO: stop searching if filter and uuid found
11303deb3ec6SMatthias Ringwald 
11315cf1669fSMatthias Ringwald     if (!gatt_client->characteristic_start_handle) return;
11323deb3ec6SMatthias Ringwald 
11335cf1669fSMatthias Ringwald     emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle,
11345cf1669fSMatthias Ringwald                                                 end_handle, gatt_client->characteristic_properties, gatt_client->uuid128);
11353deb3ec6SMatthias Ringwald 
11365cf1669fSMatthias Ringwald     gatt_client->characteristic_start_handle = 0;
11373deb3ec6SMatthias Ringwald }
11383deb3ec6SMatthias Ringwald 
113923d583b8SMatthias Ringwald 
11405cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){
11414ea43905SMatthias Ringwald     if (size < 2u) return;
11423deb3ec6SMatthias Ringwald     uint8_t attr_length = packet[1];
11434ea43905SMatthias Ringwald     if ((attr_length != 7u) && (attr_length != 21u)) return;
11444ea43905SMatthias Ringwald     uint8_t uuid_length = attr_length - 5u;
11453deb3ec6SMatthias Ringwald     int i;
11464ea43905SMatthias Ringwald     for (i = 2u; (i + attr_length) <= size; i += attr_length){
1147f8fbdce0SMatthias Ringwald         uint16_t start_handle = little_endian_read_16(packet, i);
11483deb3ec6SMatthias Ringwald         uint8_t  properties = packet[i+2];
1149f8fbdce0SMatthias Ringwald         uint16_t value_handle = little_endian_read_16(packet, i+3);
115023d583b8SMatthias Ringwald         report_gatt_characteristic_end_found(gatt_client, start_handle - 1u);
115123d583b8SMatthias Ringwald         report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5],
115223d583b8SMatthias Ringwald                                                uuid_length);
11533deb3ec6SMatthias Ringwald     }
11543deb3ec6SMatthias Ringwald }
11553deb3ec6SMatthias Ringwald 
11565cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){
11573deb3ec6SMatthias Ringwald     uint8_t normalized_uuid128[16];
1158e1a125dfSMatthias Ringwald     uuid_add_bluetooth_prefix(normalized_uuid128, uuid16);
11595cf1669fSMatthias Ringwald     emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle,
11605cf1669fSMatthias Ringwald                                                   gatt_client->query_end_handle, normalized_uuid128);
11613deb3ec6SMatthias Ringwald }
11623deb3ec6SMatthias Ringwald 
1163045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){
11645cf1669fSMatthias Ringwald     emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle,
11655cf1669fSMatthias Ringwald                                                   gatt_client->query_end_handle, uuid128);
11663deb3ec6SMatthias Ringwald }
11673deb3ec6SMatthias Ringwald 
11683deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
11690fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) {
11700fde3c5eSMatthias Ringwald 	if (!gatt_client_accept_server_message(gatt_client)) return;
1171*8450fbf5SMatthias Ringwald     uint8_t * packet = setup_characteristic_value_packet(gatt_client, GATT_EVENT_NOTIFICATION, value_handle,
1172*8450fbf5SMatthias Ringwald                                                          value, length);
117323d583b8SMatthias Ringwald     emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length);
11743deb3ec6SMatthias Ringwald }
11753deb3ec6SMatthias Ringwald 
11763deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
11770fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) {
11780fde3c5eSMatthias Ringwald 	if (!gatt_client_accept_server_message(gatt_client)) return;
1179842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED
118058e8c9f5SMatthias Ringwald     // Directly Handle GATT Service Changed and Database Hash indications
118158e8c9f5SMatthias Ringwald     if (value_handle == gatt_client->gatt_service_database_hash_value_handle){
118258e8c9f5SMatthias Ringwald         gatt_client_service_emit_database_hash(gatt_client, value, length);
118358e8c9f5SMatthias Ringwald     }
118458e8c9f5SMatthias Ringwald     if (value_handle == gatt_client->gatt_service_changed_value_handle){
118558e8c9f5SMatthias Ringwald         gatt_client_service_emit_service_changed(gatt_client, value, length);
118658e8c9f5SMatthias Ringwald     }
1187842492f0SMatthias Ringwald #endif
1188*8450fbf5SMatthias Ringwald     uint8_t * packet = setup_characteristic_value_packet(gatt_client, GATT_EVENT_INDICATION, value_handle,
1189*8450fbf5SMatthias Ringwald                                                          value, length);
119023d583b8SMatthias Ringwald     emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length);
11913deb3ec6SMatthias Ringwald }
11923deb3ec6SMatthias Ringwald 
11933deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
11945cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){
1195*8450fbf5SMatthias Ringwald     uint8_t * packet = setup_characteristic_value_packet(
1196*8450fbf5SMatthias Ringwald             gatt_client, GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, attribute_handle, value, length);
119723d583b8SMatthias Ringwald     emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length);
11983deb3ec6SMatthias Ringwald }
11993deb3ec6SMatthias Ringwald 
12003deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes
12015cf1669fSMatthias Ringwald static void report_gatt_long_characteristic_value_blob(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * blob, uint16_t blob_length, int value_offset){
12025cf1669fSMatthias Ringwald     uint8_t * packet = setup_long_characteristic_value_packet(GATT_EVENT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value_offset, blob, blob_length);
120323d583b8SMatthias Ringwald     emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE);
12043deb3ec6SMatthias Ringwald }
12053deb3ec6SMatthias Ringwald 
12065cf1669fSMatthias Ringwald static void report_gatt_characteristic_descriptor(gatt_client_t * gatt_client, uint16_t descriptor_handle, uint8_t *value, uint16_t value_length, uint16_t value_offset){
12079ec2630cSMatthias Ringwald     UNUSED(value_offset);
1208*8450fbf5SMatthias Ringwald     uint8_t * packet = setup_characteristic_value_packet(gatt_client, GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT,
1209*8450fbf5SMatthias Ringwald                                                          descriptor_handle, value,
1210*8450fbf5SMatthias Ringwald                                                          value_length);
12115cf1669fSMatthias Ringwald     emit_event_new(gatt_client->callback, packet, value_length + 8u);
12123deb3ec6SMatthias Ringwald }
12133deb3ec6SMatthias Ringwald 
12145cf1669fSMatthias Ringwald static void report_gatt_long_characteristic_descriptor(gatt_client_t * gatt_client, uint16_t descriptor_handle, uint8_t *blob, uint16_t blob_length, uint16_t value_offset){
12155cf1669fSMatthias Ringwald     uint8_t * packet = setup_long_characteristic_value_packet(GATT_EVENT_LONG_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value_offset, blob, blob_length);
121623d583b8SMatthias Ringwald     emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE);
12173deb3ec6SMatthias Ringwald }
12183deb3ec6SMatthias Ringwald 
12195cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){
12203deb3ec6SMatthias Ringwald     int i;
12214ea43905SMatthias Ringwald     for (i = 0u; (i + pair_size) <= size; i += pair_size){
1222f8fbdce0SMatthias Ringwald         uint16_t descriptor_handle = little_endian_read_16(packet,i);
12233deb3ec6SMatthias Ringwald         uint8_t uuid128[16];
12243deb3ec6SMatthias Ringwald         uint16_t uuid16 = 0;
12254ea43905SMatthias Ringwald         if (pair_size == 4u){
1226f8fbdce0SMatthias Ringwald             uuid16 = little_endian_read_16(packet,i+2);
1227e1a125dfSMatthias Ringwald             uuid_add_bluetooth_prefix(uuid128, uuid16);
12283deb3ec6SMatthias Ringwald         } else {
12299c80e4ccSMatthias Ringwald             reverse_128(&packet[i+2], uuid128);
12303deb3ec6SMatthias Ringwald         }
12315cf1669fSMatthias Ringwald         emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128);
12323deb3ec6SMatthias Ringwald     }
12333deb3ec6SMatthias Ringwald 
12343deb3ec6SMatthias Ringwald }
12353deb3ec6SMatthias Ringwald 
123652377058SMatthias Ringwald static bool is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){
12375cf1669fSMatthias Ringwald     return last_result_handle >= gatt_client->end_group_handle;
12383deb3ec6SMatthias Ringwald }
12393deb3ec6SMatthias Ringwald 
12405cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){
12415cf1669fSMatthias Ringwald     if (is_query_done(gatt_client, last_result_handle)){
1242526859e7SMatthias Ringwald         gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
12433deb3ec6SMatthias Ringwald         return;
12443deb3ec6SMatthias Ringwald     }
12453deb3ec6SMatthias Ringwald     // next
12465cf1669fSMatthias Ringwald     gatt_client->start_group_handle = last_result_handle + 1u;
1247052dc82aSMatthias Ringwald     gatt_client->state = next_query_state;
12483deb3ec6SMatthias Ringwald }
12493deb3ec6SMatthias Ringwald 
12505cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){
12515cf1669fSMatthias Ringwald     trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY);
12523deb3ec6SMatthias Ringwald }
12533deb3ec6SMatthias Ringwald 
12545cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){
12555cf1669fSMatthias Ringwald     trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY);
12563deb3ec6SMatthias Ringwald }
12573deb3ec6SMatthias Ringwald 
12585cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){
12595cf1669fSMatthias Ringwald     trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY);
12603deb3ec6SMatthias Ringwald }
12613deb3ec6SMatthias Ringwald 
12625cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){
12635cf1669fSMatthias Ringwald     if (is_query_done(gatt_client, last_result_handle)){
12643deb3ec6SMatthias Ringwald         // report last characteristic
126523d583b8SMatthias Ringwald         report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle);
12663deb3ec6SMatthias Ringwald     }
12675cf1669fSMatthias Ringwald     trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY);
12683deb3ec6SMatthias Ringwald }
12693deb3ec6SMatthias Ringwald 
12705cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){
12715cf1669fSMatthias Ringwald     trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY);
12723deb3ec6SMatthias Ringwald }
12733deb3ec6SMatthias Ringwald 
12745cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){
12755cf1669fSMatthias Ringwald     trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST);
12763deb3ec6SMatthias Ringwald }
12773deb3ec6SMatthias Ringwald 
12785cf1669fSMatthias Ringwald static void trigger_next_prepare_write_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, gatt_client_state_t done_state){
12795cf1669fSMatthias Ringwald     gatt_client->attribute_offset += write_blob_length(gatt_client);
12805cf1669fSMatthias Ringwald     uint16_t next_blob_length =  write_blob_length(gatt_client);
12813deb3ec6SMatthias Ringwald 
12824ea43905SMatthias Ringwald     if (next_blob_length == 0u){
1283052dc82aSMatthias Ringwald         gatt_client->state = done_state;
12843deb3ec6SMatthias Ringwald         return;
12853deb3ec6SMatthias Ringwald     }
1286052dc82aSMatthias Ringwald     gatt_client->state = next_query_state;
12873deb3ec6SMatthias Ringwald }
12883deb3ec6SMatthias Ringwald 
12895cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){
12903deb3ec6SMatthias Ringwald 
1291dda77937SMatthias Ringwald     uint16_t max_blob_length = gatt_client->mtu - 1u;
12923deb3ec6SMatthias Ringwald     if (received_blob_length < max_blob_length){
1293526859e7SMatthias Ringwald         gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
12943deb3ec6SMatthias Ringwald         return;
12953deb3ec6SMatthias Ringwald     }
12963deb3ec6SMatthias Ringwald 
12975cf1669fSMatthias Ringwald     gatt_client->attribute_offset += received_blob_length;
1298052dc82aSMatthias Ringwald     gatt_client->state = next_query_state;
12993deb3ec6SMatthias Ringwald }
13003deb3ec6SMatthias Ringwald 
130123d583b8SMatthias Ringwald void gatt_client_listen_for_characteristic_value_updates(gatt_client_notification_t * notification, btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){
130223d583b8SMatthias Ringwald     notification->callback = callback;
130323d583b8SMatthias Ringwald     notification->con_handle = con_handle;
130423d583b8SMatthias Ringwald     if (characteristic == NULL){
130523d583b8SMatthias Ringwald         notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE;
130623d583b8SMatthias Ringwald     } else {
130723d583b8SMatthias Ringwald         notification->attribute_handle = characteristic->value_handle;
130823d583b8SMatthias Ringwald     }
130923d583b8SMatthias Ringwald     btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification);
131023d583b8SMatthias Ringwald }
131123d583b8SMatthias Ringwald 
131223d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){
131323d583b8SMatthias Ringwald     btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification);
131423d583b8SMatthias Ringwald }
13153deb3ec6SMatthias Ringwald 
131662f7b41dSMatthias Ringwald static bool is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){
1317f8fbdce0SMatthias Ringwald     uint16_t attribute_handle = little_endian_read_16(packet, 1);
1318f8fbdce0SMatthias Ringwald     uint16_t value_offset = little_endian_read_16(packet, 3);
13193deb3ec6SMatthias Ringwald 
132062f7b41dSMatthias Ringwald     if (gatt_client->attribute_handle != attribute_handle) return false;
132162f7b41dSMatthias Ringwald     if (gatt_client->attribute_offset != value_offset) return false;
13225cf1669fSMatthias Ringwald     return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u;
13233deb3ec6SMatthias Ringwald }
13243deb3ec6SMatthias Ringwald 
13250038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
132692a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) {
132792a7335eSMatthias Ringwald     sm_key_t csrk;
132892a7335eSMatthias Ringwald     le_device_db_local_csrk_get(gatt_client->le_device_index, csrk);
132992a7335eSMatthias Ringwald     uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index);
1330052dc82aSMatthias Ringwald     gatt_client->state = P_W4_CMAC_RESULT;
133192a7335eSMatthias Ringwald     sm_cmac_signed_write_start(csrk, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, att_signed_write_handle_cmac_result);
133292a7335eSMatthias Ringwald }
13330038504eSMatthias Ringwald #endif
133492a7335eSMatthias Ringwald 
133592a7335eSMatthias Ringwald // returns true if packet was sent
13361979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){
13373deb3ec6SMatthias Ringwald 
1338e4d159baSMatthias Ringwald     // wait until re-encryption is complete
13391979f09cSMatthias Ringwald     if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false;
1340d1e1a57fSMatthias Ringwald 
1341e4d159baSMatthias Ringwald     // wait until re-encryption is complete
13421979f09cSMatthias Ringwald     if (gatt_client->reencryption_active) return false;
13436c124bc2SMatthias Ringwald 
134411279da7SMatthias Ringwald     // wait until pairing complete (either reactive authentication or due to required security level)
13451979f09cSMatthias Ringwald     if (gatt_client->wait_for_authentication_complete) return false;
134611279da7SMatthias Ringwald 
1347052dc82aSMatthias Ringwald     bool client_request_pending = gatt_client->state != P_READY;
1348fd14b205SMatthias Ringwald 
13491aa9e3e8SMatthias Ringwald     // verify security level for Mandatory Authentication over LE
135046012949SMatthias Ringwald     bool check_security;
135146012949SMatthias Ringwald     switch (gatt_client->bearer_type){
135246012949SMatthias Ringwald         case ATT_BEARER_UNENHANCED_LE:
135346012949SMatthias Ringwald             check_security = true;
135446012949SMatthias Ringwald             break;
135546012949SMatthias Ringwald         default:
13569ced96e1SMatthias Ringwald             check_security = false;
135746012949SMatthias Ringwald             break;
13589ced96e1SMatthias Ringwald     }
13599ced96e1SMatthias Ringwald     if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){
13601dfae9c7SMatthias Ringwald         log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level);
13612197dbafSMatthias Ringwald         gatt_client->wait_for_authentication_complete = true;
136211279da7SMatthias Ringwald         // set att error code for pairing failure based on required level
136311279da7SMatthias Ringwald         switch (gatt_client_required_security_level){
136411279da7SMatthias Ringwald             case LEVEL_4:
136511279da7SMatthias Ringwald             case LEVEL_3:
136611279da7SMatthias Ringwald                 gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION;
136711279da7SMatthias Ringwald                 break;
136811279da7SMatthias Ringwald             default:
136911279da7SMatthias Ringwald                 gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION;
137011279da7SMatthias Ringwald                 break;
137111279da7SMatthias Ringwald         }
137211279da7SMatthias Ringwald         sm_request_pairing(gatt_client->con_handle);
137311279da7SMatthias Ringwald         // sm probably just sent a pdu
13741979f09cSMatthias Ringwald         return true;
137511279da7SMatthias Ringwald     }
1376f4b33574SMatthias Ringwald 
13775cf1669fSMatthias Ringwald     switch (gatt_client->mtu_state) {
1378544128c3SMatthias Ringwald         case SEND_MTU_EXCHANGE:
13795cf1669fSMatthias Ringwald             gatt_client->mtu_state = SENT_MTU_EXCHANGE;
13806e7b444cSMatthias Ringwald             att_exchange_mtu_request(gatt_client);
13811979f09cSMatthias Ringwald             return true;
13823deb3ec6SMatthias Ringwald         case SENT_MTU_EXCHANGE:
13831979f09cSMatthias Ringwald             return false;
13843deb3ec6SMatthias Ringwald         default:
13853deb3ec6SMatthias Ringwald             break;
13863deb3ec6SMatthias Ringwald     }
13873deb3ec6SMatthias Ringwald 
13885cf1669fSMatthias Ringwald     if (gatt_client->send_confirmation){
138952377058SMatthias Ringwald         gatt_client->send_confirmation = false;
13906e7b444cSMatthias Ringwald         att_confirmation(gatt_client);
13911979f09cSMatthias Ringwald         return true;
13923deb3ec6SMatthias Ringwald     }
13933deb3ec6SMatthias Ringwald 
13943deb3ec6SMatthias Ringwald     // check MTU for writes
1395052dc82aSMatthias Ringwald     switch (gatt_client->state){
13963deb3ec6SMatthias Ringwald         case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE:
13973deb3ec6SMatthias Ringwald         case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR:
1398dda77937SMatthias Ringwald             if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break;
1399dda77937SMatthias Ringwald             log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu);
1400526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH);
14011979f09cSMatthias Ringwald             return false;
14023deb3ec6SMatthias Ringwald         default:
14033deb3ec6SMatthias Ringwald             break;
14043deb3ec6SMatthias Ringwald     }
14053deb3ec6SMatthias Ringwald 
14060038504eSMatthias Ringwald     bool packet_sent = true;
14070038504eSMatthias Ringwald     bool done = true;
1408052dc82aSMatthias Ringwald     switch (gatt_client->state){
14093deb3ec6SMatthias Ringwald         case P_W2_SEND_SERVICE_QUERY:
1410052dc82aSMatthias Ringwald             gatt_client->state = P_W4_SERVICE_QUERY_RESULT;
14115cf1669fSMatthias Ringwald             send_gatt_services_request(gatt_client);
14120038504eSMatthias Ringwald             break;
14133deb3ec6SMatthias Ringwald 
14143deb3ec6SMatthias Ringwald         case P_W2_SEND_SERVICE_WITH_UUID_QUERY:
1415052dc82aSMatthias Ringwald             gatt_client->state = P_W4_SERVICE_WITH_UUID_RESULT;
14165cf1669fSMatthias Ringwald             send_gatt_services_by_uuid_request(gatt_client);
14170038504eSMatthias Ringwald             break;
14183deb3ec6SMatthias Ringwald 
14193deb3ec6SMatthias Ringwald         case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY:
1420052dc82aSMatthias Ringwald             gatt_client->state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT;
14215cf1669fSMatthias Ringwald             send_gatt_characteristic_request(gatt_client);
14220038504eSMatthias Ringwald             break;
14233deb3ec6SMatthias Ringwald 
14243deb3ec6SMatthias Ringwald         case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY:
1425052dc82aSMatthias Ringwald             gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT;
14265cf1669fSMatthias Ringwald             send_gatt_characteristic_request(gatt_client);
14270038504eSMatthias Ringwald             break;
14283deb3ec6SMatthias Ringwald 
14293deb3ec6SMatthias Ringwald         case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY:
1430052dc82aSMatthias Ringwald             gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT;
14315cf1669fSMatthias Ringwald             send_gatt_characteristic_descriptor_request(gatt_client);
14320038504eSMatthias Ringwald             break;
14333deb3ec6SMatthias Ringwald 
14343deb3ec6SMatthias Ringwald         case P_W2_SEND_INCLUDED_SERVICE_QUERY:
1435052dc82aSMatthias Ringwald             gatt_client->state = P_W4_INCLUDED_SERVICE_QUERY_RESULT;
14365cf1669fSMatthias Ringwald             send_gatt_included_service_request(gatt_client);
14370038504eSMatthias Ringwald             break;
14383deb3ec6SMatthias Ringwald 
14393deb3ec6SMatthias Ringwald         case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY:
1440052dc82aSMatthias Ringwald             gatt_client->state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT;
14415cf1669fSMatthias Ringwald             send_gatt_included_service_uuid_request(gatt_client);
14420038504eSMatthias Ringwald             break;
14433deb3ec6SMatthias Ringwald 
14443deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY:
1445052dc82aSMatthias Ringwald             gatt_client->state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT;
14465cf1669fSMatthias Ringwald             send_gatt_read_characteristic_value_request(gatt_client);
14470038504eSMatthias Ringwald             break;
14483deb3ec6SMatthias Ringwald 
14493deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_BLOB_QUERY:
1450052dc82aSMatthias Ringwald             gatt_client->state = P_W4_READ_BLOB_RESULT;
14515cf1669fSMatthias Ringwald             send_gatt_read_blob_request(gatt_client);
14520038504eSMatthias Ringwald             break;
14533deb3ec6SMatthias Ringwald 
14543deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_BY_TYPE_REQUEST:
1455052dc82aSMatthias Ringwald             gatt_client->state = P_W4_READ_BY_TYPE_RESPONSE;
14565cf1669fSMatthias Ringwald             send_gatt_read_by_type_request(gatt_client);
14570038504eSMatthias Ringwald             break;
14583deb3ec6SMatthias Ringwald 
14593deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_MULTIPLE_REQUEST:
1460052dc82aSMatthias Ringwald             gatt_client->state = P_W4_READ_MULTIPLE_RESPONSE;
14615cf1669fSMatthias Ringwald             send_gatt_read_multiple_request(gatt_client);
14620038504eSMatthias Ringwald             break;
14633deb3ec6SMatthias Ringwald 
1464f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
1465f125a8efSMatthias Ringwald         case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST:
1466052dc82aSMatthias Ringwald             gatt_client->state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE;
1467f125a8efSMatthias Ringwald             send_gatt_read_multiple_variable_request(gatt_client);
1468f125a8efSMatthias Ringwald             break;
1469f125a8efSMatthias Ringwald #endif
1470f125a8efSMatthias Ringwald 
14713deb3ec6SMatthias Ringwald         case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE:
1472052dc82aSMatthias Ringwald             gatt_client->state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT;
14735cf1669fSMatthias Ringwald             send_gatt_write_attribute_value_request(gatt_client);
14740038504eSMatthias Ringwald             break;
14753deb3ec6SMatthias Ringwald 
14763deb3ec6SMatthias Ringwald         case P_W2_PREPARE_WRITE:
1477052dc82aSMatthias Ringwald             gatt_client->state = P_W4_PREPARE_WRITE_RESULT;
14785cf1669fSMatthias Ringwald             send_gatt_prepare_write_request(gatt_client);
14790038504eSMatthias Ringwald             break;
14803deb3ec6SMatthias Ringwald 
14813deb3ec6SMatthias Ringwald         case P_W2_PREPARE_WRITE_SINGLE:
1482052dc82aSMatthias Ringwald             gatt_client->state = P_W4_PREPARE_WRITE_SINGLE_RESULT;
14835cf1669fSMatthias Ringwald             send_gatt_prepare_write_request(gatt_client);
14840038504eSMatthias Ringwald             break;
14853deb3ec6SMatthias Ringwald 
14863deb3ec6SMatthias Ringwald         case P_W2_PREPARE_RELIABLE_WRITE:
1487052dc82aSMatthias Ringwald             gatt_client->state = P_W4_PREPARE_RELIABLE_WRITE_RESULT;
14885cf1669fSMatthias Ringwald             send_gatt_prepare_write_request(gatt_client);
14890038504eSMatthias Ringwald             break;
14903deb3ec6SMatthias Ringwald 
14913deb3ec6SMatthias Ringwald         case P_W2_EXECUTE_PREPARED_WRITE:
1492052dc82aSMatthias Ringwald             gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_RESULT;
14935cf1669fSMatthias Ringwald             send_gatt_execute_write_request(gatt_client);
14940038504eSMatthias Ringwald             break;
14953deb3ec6SMatthias Ringwald 
14963deb3ec6SMatthias Ringwald         case P_W2_CANCEL_PREPARED_WRITE:
1497052dc82aSMatthias Ringwald             gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_RESULT;
14985cf1669fSMatthias Ringwald             send_gatt_cancel_prepared_write_request(gatt_client);
14990038504eSMatthias Ringwald             break;
15003deb3ec6SMatthias Ringwald 
15013deb3ec6SMatthias Ringwald         case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH:
1502052dc82aSMatthias Ringwald             gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT;
15035cf1669fSMatthias Ringwald             send_gatt_cancel_prepared_write_request(gatt_client);
15040038504eSMatthias Ringwald             break;
15053deb3ec6SMatthias Ringwald 
1506abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
1507abdc9fb5SMatthias Ringwald         case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY:
1508abdc9fb5SMatthias Ringwald             // use Find Information
15095cf1669fSMatthias Ringwald             gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT;
15105cf1669fSMatthias Ringwald             send_gatt_characteristic_descriptor_request(gatt_client);
1511abdc9fb5SMatthias Ringwald #else
15123deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY:
1513abdc9fb5SMatthias Ringwald             // Use Read By Type
1514052dc82aSMatthias Ringwald             gatt_client->state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT;
15155cf1669fSMatthias Ringwald             send_gatt_read_client_characteristic_configuration_request(gatt_client);
1516abdc9fb5SMatthias Ringwald #endif
15170038504eSMatthias Ringwald             break;
15183deb3ec6SMatthias Ringwald 
15193deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY:
1520052dc82aSMatthias Ringwald             gatt_client->state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT;
15215cf1669fSMatthias Ringwald             send_gatt_read_characteristic_descriptor_request(gatt_client);
15220038504eSMatthias Ringwald             break;
15233deb3ec6SMatthias Ringwald 
15243deb3ec6SMatthias Ringwald         case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY:
1525052dc82aSMatthias Ringwald             gatt_client->state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT;
15265cf1669fSMatthias Ringwald             send_gatt_read_blob_request(gatt_client);
15270038504eSMatthias Ringwald             break;
15283deb3ec6SMatthias Ringwald 
15293deb3ec6SMatthias Ringwald         case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR:
1530052dc82aSMatthias Ringwald             gatt_client->state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT;
15315cf1669fSMatthias Ringwald             send_gatt_write_attribute_value_request(gatt_client);
15320038504eSMatthias Ringwald             break;
15333deb3ec6SMatthias Ringwald 
15343deb3ec6SMatthias Ringwald         case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION:
1535052dc82aSMatthias Ringwald             gatt_client->state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT;
15365cf1669fSMatthias Ringwald             send_gatt_write_client_characteristic_configuration_request(gatt_client);
15370038504eSMatthias Ringwald             break;
15383deb3ec6SMatthias Ringwald 
15393deb3ec6SMatthias Ringwald         case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR:
1540052dc82aSMatthias Ringwald             gatt_client->state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT;
15415cf1669fSMatthias Ringwald             send_gatt_prepare_write_request(gatt_client);
15420038504eSMatthias Ringwald             break;
15433deb3ec6SMatthias Ringwald 
15443deb3ec6SMatthias Ringwald         case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR:
1545052dc82aSMatthias Ringwald             gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT;
15465cf1669fSMatthias Ringwald             send_gatt_execute_write_request(gatt_client);
15470038504eSMatthias Ringwald             break;
15483deb3ec6SMatthias Ringwald 
15497a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
1550793cf6ceSMatthias Ringwald         case P_W4_IDENTITY_RESOLVING:
15515cf1669fSMatthias Ringwald             log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle));
15525cf1669fSMatthias Ringwald             switch (sm_identity_resolving_state(gatt_client->con_handle)){
1553793cf6ceSMatthias Ringwald                 case IRK_LOOKUP_SUCCEEDED:
15545cf1669fSMatthias Ringwald                     gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle);
1555052dc82aSMatthias Ringwald                     gatt_client->state = P_W4_CMAC_READY;
155692a7335eSMatthias Ringwald                     if (sm_cmac_ready()){
155792a7335eSMatthias Ringwald                         gatt_client_run_for_client_start_signed_write(gatt_client);
155892a7335eSMatthias Ringwald                     }
1559793cf6ceSMatthias Ringwald                     break;
1560793cf6ceSMatthias Ringwald                 case IRK_LOOKUP_FAILED:
1561526859e7SMatthias Ringwald                     gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING);
156292a7335eSMatthias Ringwald                     break;
1563793cf6ceSMatthias Ringwald                 default:
156492a7335eSMatthias Ringwald                     break;
1565793cf6ceSMatthias Ringwald             }
15660038504eSMatthias Ringwald             packet_sent = false;
15670038504eSMatthias Ringwald             break;
1568793cf6ceSMatthias Ringwald 
15693deb3ec6SMatthias Ringwald         case P_W4_CMAC_READY:
15703deb3ec6SMatthias Ringwald             if (sm_cmac_ready()){
157192a7335eSMatthias Ringwald                 gatt_client_run_for_client_start_signed_write(gatt_client);
15723deb3ec6SMatthias Ringwald             }
15730038504eSMatthias Ringwald             packet_sent = false;
15740038504eSMatthias Ringwald             break;
15753deb3ec6SMatthias Ringwald 
15763deb3ec6SMatthias Ringwald         case P_W2_SEND_SIGNED_WRITE: {
15774c7c987fSMatthias Ringwald             gatt_client->state = P_W4_SEND_SIGNED_WRITE_DONE;
15783deb3ec6SMatthias Ringwald             // bump local signing counter
15795cf1669fSMatthias Ringwald             uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index);
15805cf1669fSMatthias Ringwald             le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1);
158164b12680SMatthias Ringwald             // send signed write command
15825cf1669fSMatthias Ringwald             send_gatt_signed_write_request(gatt_client, sign_counter);
15833deb3ec6SMatthias Ringwald             // finally, notifiy client that write is complete
1584526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
1585b68ac7a5SMatthias Ringwald             break;
15863deb3ec6SMatthias Ringwald         }
15877a766ebfSMatthias Ringwald #endif
15883deb3ec6SMatthias Ringwald         default:
1589b68ac7a5SMatthias Ringwald             done = false;
15903deb3ec6SMatthias Ringwald             break;
15913deb3ec6SMatthias Ringwald     }
159247181045SMatthias Ringwald 
15930038504eSMatthias Ringwald     if (done){
15940038504eSMatthias Ringwald         return packet_sent;
15950038504eSMatthias Ringwald     }
15960038504eSMatthias Ringwald 
159759d34cd2SMatthias Ringwald     // write without response callback
159859d34cd2SMatthias Ringwald     btstack_context_callback_registration_t * callback =
159959d34cd2SMatthias Ringwald             (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests);
160059d34cd2SMatthias Ringwald     if (callback != NULL){
160159d34cd2SMatthias Ringwald         (*callback->callback)(callback->context);
160259d34cd2SMatthias Ringwald         return true;
160359d34cd2SMatthias Ringwald     }
160459d34cd2SMatthias Ringwald 
160559d34cd2SMatthias Ringwald     // requested can send now old
1606f688bdb8SMatthias Ringwald     if (gatt_client->write_without_response_callback != NULL){
16075cf1669fSMatthias Ringwald         btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback;
16085cf1669fSMatthias Ringwald         gatt_client->write_without_response_callback = NULL;
160947181045SMatthias Ringwald         uint8_t event[4];
161047181045SMatthias Ringwald         event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE;
16114ea43905SMatthias Ringwald         event[1] = sizeof(event) - 2u;
16125cf1669fSMatthias Ringwald         little_endian_store_16(event, 2, gatt_client->con_handle);
16135cf1669fSMatthias Ringwald         packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event));
16141979f09cSMatthias Ringwald         return true; // to trigger requeueing (even if higher layer didn't sent)
161547181045SMatthias Ringwald     }
161647181045SMatthias Ringwald 
16171979f09cSMatthias Ringwald     return false;
16183deb3ec6SMatthias Ringwald }
16193deb3ec6SMatthias Ringwald 
1620544128c3SMatthias Ringwald static void gatt_client_run(void){
1621544128c3SMatthias Ringwald     btstack_linked_item_t *it;
1622109c2548SMatthias Ringwald     bool packet_sent;
16237627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
16247627a0deSMatthias Ringwald     btstack_linked_list_iterator_t it_eatt;
16257627a0deSMatthias Ringwald #endif
1626a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){
16275cf1669fSMatthias Ringwald         gatt_client_t * gatt_client = (gatt_client_t *) it;
162846012949SMatthias Ringwald         switch (gatt_client->bearer_type){
162946012949SMatthias Ringwald             case ATT_BEARER_UNENHANCED_LE:
16307627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
16317627a0deSMatthias Ringwald                 btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients);
16327627a0deSMatthias Ringwald                 while (btstack_linked_list_iterator_has_next(&it_eatt)) {
16337627a0deSMatthias Ringwald                     gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt);
1634052dc82aSMatthias Ringwald                     if (eatt_client->state != P_READY){
16354c226876SMatthias Ringwald                         if (att_dispatch_client_can_send_now(gatt_client->con_handle)){
16367627a0deSMatthias Ringwald                             gatt_client_run_for_gatt_client(eatt_client);
16377627a0deSMatthias Ringwald                         }
16387627a0deSMatthias Ringwald                     }
16397627a0deSMatthias Ringwald                 }
16407627a0deSMatthias Ringwald #endif
164146012949SMatthias Ringwald                 if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) {
164246012949SMatthias Ringwald                     att_dispatch_client_request_can_send_now_event(gatt_client->con_handle);
164346012949SMatthias Ringwald                     return;
164446012949SMatthias Ringwald                 }
1645109c2548SMatthias Ringwald                 packet_sent = gatt_client_run_for_gatt_client(gatt_client);
164646012949SMatthias Ringwald                 if (packet_sent){
164746012949SMatthias Ringwald                     // request new permission
164846012949SMatthias Ringwald                     att_dispatch_client_request_can_send_now_event(gatt_client->con_handle);
164946012949SMatthias Ringwald                     // requeue client for fairness and exit
165046012949SMatthias Ringwald                     // note: iterator has become invalid
165146012949SMatthias Ringwald                     btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client);
165246012949SMatthias Ringwald                     btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client);
165346012949SMatthias Ringwald                     return;
165446012949SMatthias Ringwald                 }
165546012949SMatthias Ringwald                 break;
16561450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
165746012949SMatthias Ringwald             case ATT_BEARER_UNENHANCED_CLASSIC:
16581450cdc6SMatthias Ringwald                 if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) {
16591450cdc6SMatthias Ringwald                     continue;
16601450cdc6SMatthias Ringwald                 }
16611aa9e3e8SMatthias Ringwald 
16621aa9e3e8SMatthias Ringwald                 // handle GATT over BR/EDR
16634c226876SMatthias Ringwald                 if (att_dispatch_client_can_send_now(gatt_client->con_handle) == false) {
16644c226876SMatthias Ringwald                     att_dispatch_client_request_can_send_now_event(gatt_client->con_handle);
16651aa9e3e8SMatthias Ringwald                     return;
16661aa9e3e8SMatthias Ringwald                 }
1667109c2548SMatthias Ringwald                 packet_sent = gatt_client_run_for_gatt_client(gatt_client);
16681aa9e3e8SMatthias Ringwald                 if (packet_sent){
16691aa9e3e8SMatthias Ringwald                     // request new permission
16701aa9e3e8SMatthias Ringwald                     att_dispatch_client_request_can_send_now_event(gatt_client->con_handle);
16711aa9e3e8SMatthias Ringwald                     // requeue client for fairness and exit
16721aa9e3e8SMatthias Ringwald                     // note: iterator has become invalid
16731aa9e3e8SMatthias Ringwald                     btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client);
16741aa9e3e8SMatthias Ringwald                     btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client);
16751aa9e3e8SMatthias Ringwald                     return;
16761aa9e3e8SMatthias Ringwald                 }
167746012949SMatthias Ringwald                 break;
16781450cdc6SMatthias Ringwald #endif
167946012949SMatthias Ringwald             default:
168046012949SMatthias Ringwald                 btstack_unreachable();
168146012949SMatthias Ringwald                 break;
1682544128c3SMatthias Ringwald         }
168346012949SMatthias Ringwald 
168446012949SMatthias Ringwald 
1685544128c3SMatthias Ringwald     }
16863deb3ec6SMatthias Ringwald }
16873deb3ec6SMatthias Ringwald 
1688544a5845SMatthias Ringwald // emit complete event, used to avoid emitting event from API call
1689544a5845SMatthias Ringwald static void gatt_client_emit_events(void * context){
1690544a5845SMatthias Ringwald     UNUSED(context);
1691544a5845SMatthias Ringwald     btstack_linked_item_t *it;
1692544a5845SMatthias Ringwald     for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next) {
1693544a5845SMatthias Ringwald         gatt_client_t *gatt_client = (gatt_client_t *) it;
1694544a5845SMatthias Ringwald         if (gatt_client->state == P_W2_EMIT_QUERY_COMPLETE_EVENT){
1695544a5845SMatthias Ringwald             gatt_client->state = P_READY;
1696544a5845SMatthias Ringwald             emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS);
1697544a5845SMatthias Ringwald         }
1698544a5845SMatthias Ringwald     }
1699544a5845SMatthias Ringwald }
1700544a5845SMatthias Ringwald 
17015cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) {
1702643a64fcSMatthias Ringwald     if (is_ready(gatt_client)) return;
1703526859e7SMatthias Ringwald     gatt_client_handle_transaction_complete(gatt_client, att_error_code);
17043deb3ec6SMatthias Ringwald }
17053deb3ec6SMatthias Ringwald 
170678c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){
170778c4542aSMatthias Ringwald     hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet);
170878c4542aSMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle);
170978c4542aSMatthias Ringwald     if (gatt_client == NULL) return;
171078c4542aSMatthias Ringwald 
171178c4542aSMatthias Ringwald     // update security level
171278c4542aSMatthias Ringwald     gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle);
171378c4542aSMatthias Ringwald 
171478c4542aSMatthias Ringwald     gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet);
171578c4542aSMatthias Ringwald     gatt_client->reencryption_active = false;
17162197dbafSMatthias Ringwald     gatt_client->wait_for_authentication_complete = false;
171778c4542aSMatthias Ringwald 
1718052dc82aSMatthias Ringwald     if (gatt_client->state == P_READY) return;
171978c4542aSMatthias Ringwald 
172078c4542aSMatthias Ringwald     switch (sm_event_reencryption_complete_get_status(packet)){
172178c4542aSMatthias Ringwald         case ERROR_CODE_SUCCESS:
172278c4542aSMatthias Ringwald             log_info("re-encryption success, retry operation");
172378c4542aSMatthias Ringwald             break;
172478c4542aSMatthias Ringwald         case ERROR_CODE_AUTHENTICATION_FAILURE:
172578c4542aSMatthias Ringwald         case ERROR_CODE_PIN_OR_KEY_MISSING:
172678c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION)
172778c4542aSMatthias Ringwald             if (gatt_client_required_security_level == LEVEL_0) {
172878c4542aSMatthias Ringwald                 // re-encryption failed for reactive authentication with pairing and we have a pending client request
172978c4542aSMatthias Ringwald                 // => try to resolve it by deleting bonding information if we started pairing before
173078c4542aSMatthias Ringwald                 // delete bonding information
173178c4542aSMatthias Ringwald                 int le_device_db_index = sm_le_device_index(gatt_client->con_handle);
173278c4542aSMatthias Ringwald                 btstack_assert(le_device_db_index >= 0);
173378c4542aSMatthias Ringwald                 log_info("reactive auth with pairing: delete bonding and start pairing");
173478c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
173578c4542aSMatthias Ringwald                 hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index);
173678c4542aSMatthias Ringwald #endif
173778c4542aSMatthias Ringwald                 le_device_db_remove(le_device_db_index);
173878c4542aSMatthias Ringwald                 // trigger pairing again
173978c4542aSMatthias Ringwald                 sm_request_pairing(gatt_client->con_handle);
174078c4542aSMatthias Ringwald                 break;
174178c4542aSMatthias Ringwald             }
174278c4542aSMatthias Ringwald #endif
174378c4542aSMatthias Ringwald             // report bonding information missing
1744526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING);
174578c4542aSMatthias Ringwald             break;
174678c4542aSMatthias Ringwald         default:
174778c4542aSMatthias Ringwald             // report bonding information missing
1748526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code);
174978c4542aSMatthias Ringwald             break;
175078c4542aSMatthias Ringwald     }
175178c4542aSMatthias Ringwald }
175278c4542aSMatthias Ringwald 
175378c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){
175478c4542aSMatthias Ringwald     log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE");
175578c4542aSMatthias Ringwald     hci_con_handle_t con_handle = little_endian_read_16(packet,3);
175678c4542aSMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle);
175778c4542aSMatthias Ringwald     if (gatt_client == NULL) return;
175878c4542aSMatthias Ringwald 
175978c4542aSMatthias Ringwald     gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED);
176078c4542aSMatthias Ringwald     gatt_client_timeout_stop(gatt_client);
176178c4542aSMatthias Ringwald     btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client);
176278c4542aSMatthias Ringwald     btstack_memory_gatt_client_free(gatt_client);
176378c4542aSMatthias Ringwald }
176478c4542aSMatthias Ringwald 
1765f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
17661ac26e06SMatthias Ringwald     UNUSED(channel);    // ok: handling own l2cap events
17671ac26e06SMatthias Ringwald     UNUSED(size);       // ok: there is no channel
17689ec2630cSMatthias Ringwald 
1769361b1363SMatthias Ringwald     if (packet_type != HCI_EVENT_PACKET) return;
1770361b1363SMatthias Ringwald 
1771f4b33574SMatthias Ringwald     hci_con_handle_t con_handle;
17725cf1669fSMatthias Ringwald     gatt_client_t * gatt_client;
17730e2df43fSMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
17743deb3ec6SMatthias Ringwald         case HCI_EVENT_DISCONNECTION_COMPLETE:
177578c4542aSMatthias Ringwald             gatt_client_handle_disconnection_complete(packet);
17763deb3ec6SMatthias Ringwald             break;
1777f4b33574SMatthias Ringwald 
1778f4b33574SMatthias Ringwald         // Pairing complete (with/without bonding=storing of pairing information)
1779f4b33574SMatthias Ringwald         case SM_EVENT_PAIRING_COMPLETE:
1780f4b33574SMatthias Ringwald             con_handle = sm_event_pairing_complete_get_handle(packet);
17815cf1669fSMatthias Ringwald             gatt_client = gatt_client_get_context_for_handle(con_handle);
17825cf1669fSMatthias Ringwald             if (gatt_client == NULL) break;
1783f4b33574SMatthias Ringwald 
17841dfae9c7SMatthias Ringwald             // update security level
17851dfae9c7SMatthias Ringwald             gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle);
17861dfae9c7SMatthias Ringwald 
17873503dc74SMatthias Ringwald             if (gatt_client->wait_for_authentication_complete){
17882197dbafSMatthias Ringwald                 gatt_client->wait_for_authentication_complete = false;
1789f688bdb8SMatthias Ringwald                 if (sm_event_pairing_complete_get_status(packet) != ERROR_CODE_SUCCESS){
17905cf1669fSMatthias Ringwald                     log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code);
1791ec9babacSMatthias Ringwald                     gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code);
1792f4b33574SMatthias Ringwald                 } else {
1793f4b33574SMatthias Ringwald                     log_info("pairing success, retry operation");
17943deb3ec6SMatthias Ringwald                 }
1795f4b33574SMatthias Ringwald             }
1796f4b33574SMatthias Ringwald             break;
179711279da7SMatthias Ringwald 
1798793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
1799793cf6ceSMatthias Ringwald         // Identity Resolving completed (no code, gatt_client_run will continue)
1800793cf6ceSMatthias Ringwald         case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED:
1801793cf6ceSMatthias Ringwald         case SM_EVENT_IDENTITY_RESOLVING_FAILED:
1802793cf6ceSMatthias Ringwald             break;
1803793cf6ceSMatthias Ringwald #endif
1804a95ca902SMatthias Ringwald 
18058918bbdaSMatthias Ringwald         // re-encryption started
18068918bbdaSMatthias Ringwald         case SM_EVENT_REENCRYPTION_STARTED:
18078918bbdaSMatthias Ringwald             con_handle = sm_event_reencryption_complete_get_handle(packet);
18088918bbdaSMatthias Ringwald             gatt_client = gatt_client_get_context_for_handle(con_handle);
18098918bbdaSMatthias Ringwald             if (gatt_client == NULL) break;
18108918bbdaSMatthias Ringwald 
18118918bbdaSMatthias Ringwald             gatt_client->reencryption_active = true;
18128918bbdaSMatthias Ringwald             gatt_client->reencryption_result = ERROR_CODE_SUCCESS;
18138918bbdaSMatthias Ringwald             break;
18148918bbdaSMatthias Ringwald 
1815ec9babacSMatthias Ringwald         // re-encryption complete
1816ec9babacSMatthias Ringwald         case SM_EVENT_REENCRYPTION_COMPLETE:
181778c4542aSMatthias Ringwald             gatt_client_handle_reencryption_complete(packet);
1818ec9babacSMatthias Ringwald             break;
18193deb3ec6SMatthias Ringwald         default:
18203deb3ec6SMatthias Ringwald             break;
18213deb3ec6SMatthias Ringwald     }
18223deb3ec6SMatthias Ringwald 
1823361b1363SMatthias Ringwald     gatt_client_run();
18243deb3ec6SMatthias Ringwald }
18253deb3ec6SMatthias Ringwald 
18262da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) {
1827052dc82aSMatthias Ringwald     switch (gatt_client->state) {
18282da0d963SMatthias Ringwald         case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT:
18292da0d963SMatthias Ringwald             if (size >= 17) {
18302da0d963SMatthias Ringwald                 uint8_t uuid128[16];
18312da0d963SMatthias Ringwald                 reverse_128(&packet[1], uuid128);
18322da0d963SMatthias Ringwald                 report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128);
18332da0d963SMatthias Ringwald             }
18342da0d963SMatthias Ringwald             trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle);
18355611a760SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
18363deb3ec6SMatthias Ringwald             break;
18372da0d963SMatthias Ringwald 
18382da0d963SMatthias Ringwald         case P_W4_READ_CHARACTERISTIC_VALUE_RESULT:
18392da0d963SMatthias Ringwald             report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u);
1840526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
18412da0d963SMatthias Ringwald             break;
18422da0d963SMatthias Ringwald 
18432da0d963SMatthias Ringwald         case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:
18442da0d963SMatthias Ringwald             report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1],
18452da0d963SMatthias Ringwald                                                   size - 1u, 0u);
1846526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
18472da0d963SMatthias Ringwald             break;
18482da0d963SMatthias Ringwald 
18492da0d963SMatthias Ringwald             // Use ATT_READ_REQUEST for first blob of Read Long Characteristic
18502da0d963SMatthias Ringwald         case P_W4_READ_BLOB_RESULT:
18512da0d963SMatthias Ringwald             report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1],
18522da0d963SMatthias Ringwald                                                        size - 1u, gatt_client->attribute_offset);
18532da0d963SMatthias Ringwald             trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u);
18542da0d963SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
18552da0d963SMatthias Ringwald             break;
18562da0d963SMatthias Ringwald 
18572da0d963SMatthias Ringwald             // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor
18582da0d963SMatthias Ringwald         case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT:
18592da0d963SMatthias Ringwald             report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1],
18602da0d963SMatthias Ringwald                                                        size - 1u, gatt_client->attribute_offset);
18612da0d963SMatthias Ringwald             trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY,
18622da0d963SMatthias Ringwald                                     size - 1u);
18632da0d963SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
18642da0d963SMatthias Ringwald             break;
18652da0d963SMatthias Ringwald 
18663deb3ec6SMatthias Ringwald         default:
18673deb3ec6SMatthias Ringwald             break;
18683deb3ec6SMatthias Ringwald     }
18692da0d963SMatthias Ringwald }
18703deb3ec6SMatthias Ringwald 
18712da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) {
1872052dc82aSMatthias Ringwald     switch (gatt_client->state) {
18733deb3ec6SMatthias Ringwald         case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT:
18745cf1669fSMatthias Ringwald             report_gatt_characteristics(gatt_client, packet, size);
1875cf8e5718SMatthias Ringwald             trigger_next_characteristic_query(gatt_client,
1876cf8e5718SMatthias Ringwald                                               get_last_result_handle_from_characteristics_list(packet, size));
18775611a760SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR
18783deb3ec6SMatthias Ringwald             break;
18793deb3ec6SMatthias Ringwald         case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT:
18805cf1669fSMatthias Ringwald             report_gatt_characteristics(gatt_client, packet, size);
1881cf8e5718SMatthias Ringwald             trigger_next_characteristic_query(gatt_client,
1882cf8e5718SMatthias Ringwald                                               get_last_result_handle_from_characteristics_list(packet, size));
18835611a760SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR
18843deb3ec6SMatthias Ringwald             break;
1885cf8e5718SMatthias Ringwald         case P_W4_INCLUDED_SERVICE_QUERY_RESULT: {
18864ea43905SMatthias Ringwald             if (size < 2u) break;
18873deb3ec6SMatthias Ringwald             uint16_t uuid16 = 0;
18883deb3ec6SMatthias Ringwald             uint16_t pair_size = packet[1];
18893deb3ec6SMatthias Ringwald 
18904ea43905SMatthias Ringwald             if (pair_size == 6u) {
18914ea43905SMatthias Ringwald                 if (size < 8u) break;
18923deb3ec6SMatthias Ringwald                 // UUIDs not available, query first included service
18935cf1669fSMatthias Ringwald                 gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query
18945cf1669fSMatthias Ringwald                 gatt_client->query_start_handle = little_endian_read_16(packet, 4);
18955cf1669fSMatthias Ringwald                 gatt_client->query_end_handle = little_endian_read_16(packet, 6);
1896052dc82aSMatthias Ringwald                 gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY;
18973deb3ec6SMatthias Ringwald                 break;
18983deb3ec6SMatthias Ringwald             }
18993deb3ec6SMatthias Ringwald 
19004ea43905SMatthias Ringwald             if (pair_size != 8u) break;
19019f698c82SMatthias Ringwald 
19029f698c82SMatthias Ringwald             // UUIDs included, report all of them
19033deb3ec6SMatthias Ringwald             uint16_t offset;
19044ea43905SMatthias Ringwald             for (offset = 2u; (offset + 8u) <= size; offset += pair_size) {
1905f8fbdce0SMatthias Ringwald                 uint16_t include_handle = little_endian_read_16(packet, offset);
19065cf1669fSMatthias Ringwald                 gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u);
19075cf1669fSMatthias Ringwald                 gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u);
19084ea43905SMatthias Ringwald                 uuid16 = little_endian_read_16(packet, offset + 6u);
19095cf1669fSMatthias Ringwald                 report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16);
19103deb3ec6SMatthias Ringwald             }
19113deb3ec6SMatthias Ringwald 
1912cf8e5718SMatthias Ringwald             trigger_next_included_service_query(gatt_client,
1913cf8e5718SMatthias Ringwald                                                 get_last_result_handle_from_included_services_list(packet,
1914cf8e5718SMatthias Ringwald                                                                                                    size));
19155611a760SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
19163deb3ec6SMatthias Ringwald             break;
19173deb3ec6SMatthias Ringwald         }
1918abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
19193deb3ec6SMatthias Ringwald         case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT:
19205cf1669fSMatthias Ringwald             gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2);
1921052dc82aSMatthias Ringwald             gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION;
19223deb3ec6SMatthias Ringwald             break;
1923abdc9fb5SMatthias Ringwald #endif
19243deb3ec6SMatthias Ringwald         case P_W4_READ_BY_TYPE_RESPONSE: {
19253deb3ec6SMatthias Ringwald             uint16_t pair_size = packet[1];
192639ac9711SMatthias Ringwald             // set last result handle to last valid handle, only used if pair_size invalid
192739ac9711SMatthias Ringwald             uint16_t last_result_handle = 0xffff;
192839ac9711SMatthias Ringwald             if (pair_size > 2) {
19293deb3ec6SMatthias Ringwald                 uint16_t offset;
19303deb3ec6SMatthias Ringwald                 for (offset = 2; offset < size; offset += pair_size) {
1931f8fbdce0SMatthias Ringwald                     uint16_t value_handle = little_endian_read_16(packet, offset);
1932cf8e5718SMatthias Ringwald                     report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u],
1933cf8e5718SMatthias Ringwald                                                      pair_size - 2u);
19343deb3ec6SMatthias Ringwald                     last_result_handle = value_handle;
19353deb3ec6SMatthias Ringwald                 }
193639ac9711SMatthias Ringwald             }
19375cf1669fSMatthias Ringwald             trigger_next_read_by_type_query(gatt_client, last_result_handle);
19383deb3ec6SMatthias Ringwald             break;
19393deb3ec6SMatthias Ringwald         }
19403deb3ec6SMatthias Ringwald         default:
19413deb3ec6SMatthias Ringwald             break;
19423deb3ec6SMatthias Ringwald     }
194339ac9711SMatthias Ringwald }
1944dc13fd8dSMatthias Ringwald 
19452da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) {
1946052dc82aSMatthias Ringwald     switch (gatt_client->state) {
19472da0d963SMatthias Ringwald         case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT:
1948526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
19493deb3ec6SMatthias Ringwald             break;
19502da0d963SMatthias Ringwald         case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT:
1951526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
19523deb3ec6SMatthias Ringwald             break;
19532da0d963SMatthias Ringwald         case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
1954526859e7SMatthias Ringwald             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
19552da0d963SMatthias Ringwald             break;
19562da0d963SMatthias Ringwald         default:
19572da0d963SMatthias Ringwald             break;
19582da0d963SMatthias Ringwald     }
19592da0d963SMatthias Ringwald }
1960dc13fd8dSMatthias Ringwald 
19612da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) {
19624740230fSMatthias Ringwald     uint8_t att_status;
19632da0d963SMatthias Ringwald     switch (packet[0]) {
19642da0d963SMatthias Ringwald         case ATT_EXCHANGE_MTU_RESPONSE: {
19652da0d963SMatthias Ringwald             if (size < 3u) break;
196646012949SMatthias Ringwald             bool update_gatt_server_att_mtu = false;
19672da0d963SMatthias Ringwald             uint16_t remote_rx_mtu = little_endian_read_16(packet, 1);
19682da0d963SMatthias Ringwald             uint16_t local_rx_mtu = l2cap_max_le_mtu();
196946012949SMatthias Ringwald             switch (gatt_client->bearer_type){
197046012949SMatthias Ringwald                 case ATT_BEARER_UNENHANCED_LE:
197146012949SMatthias Ringwald                     update_gatt_server_att_mtu = true;
197246012949SMatthias Ringwald                     break;
19732da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
197446012949SMatthias Ringwald                 case ATT_BEARER_UNENHANCED_CLASSIC:
19752da0d963SMatthias Ringwald                     local_rx_mtu = gatt_client->mtu;
197646012949SMatthias Ringwald                     break;
19772da0d963SMatthias Ringwald #endif
197846012949SMatthias Ringwald                 default:
197946012949SMatthias Ringwald                     btstack_unreachable();
198046012949SMatthias Ringwald                     break;
198146012949SMatthias Ringwald             }
198246012949SMatthias Ringwald 
19832da0d963SMatthias Ringwald             uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu;
19842da0d963SMatthias Ringwald 
19852da0d963SMatthias Ringwald             // set gatt client mtu
19862da0d963SMatthias Ringwald             gatt_client->mtu = mtu;
19872da0d963SMatthias Ringwald             gatt_client->mtu_state = MTU_EXCHANGED;
19882da0d963SMatthias Ringwald 
198946012949SMatthias Ringwald             if (update_gatt_server_att_mtu){
19902da0d963SMatthias Ringwald                 // set per connection mtu state - for fixed channel
19912da0d963SMatthias Ringwald                 hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle);
19922da0d963SMatthias Ringwald                 hci_connection->att_connection.mtu = gatt_client->mtu;
19932da0d963SMatthias Ringwald                 hci_connection->att_connection.mtu_exchanged = true;
19942da0d963SMatthias Ringwald             }
19952da0d963SMatthias Ringwald             emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu);
19962da0d963SMatthias Ringwald             break;
19972da0d963SMatthias Ringwald         }
19982da0d963SMatthias Ringwald         case ATT_READ_BY_GROUP_TYPE_RESPONSE:
1999052dc82aSMatthias Ringwald             switch (gatt_client->state) {
20002da0d963SMatthias Ringwald                 case P_W4_SERVICE_QUERY_RESULT:
20012da0d963SMatthias Ringwald                     report_gatt_services(gatt_client, packet, size);
20022da0d963SMatthias Ringwald                     trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size));
200330952227SMilanka Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
200430952227SMilanka Ringwald                     break;
20053deb3ec6SMatthias Ringwald                 default:
20063deb3ec6SMatthias Ringwald                     break;
20073deb3ec6SMatthias Ringwald             }
20083deb3ec6SMatthias Ringwald             break;
20092da0d963SMatthias Ringwald         case ATT_HANDLE_VALUE_NOTIFICATION:
20102da0d963SMatthias Ringwald             if (size < 3u) return;
20112da0d963SMatthias Ringwald             report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u);
20122da0d963SMatthias Ringwald             return;
2013cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
2014cbba69d5SMatthias Ringwald         case ATT_MULTIPLE_HANDLE_VALUE_NTF:
2015cbba69d5SMatthias Ringwald             if (size >= 5u) {
2016cbba69d5SMatthias Ringwald                 uint16_t offset = 1;
2017cbba69d5SMatthias Ringwald                 while (true){
2018cbba69d5SMatthias Ringwald                     uint16_t value_handle = little_endian_read_16(packet, offset);
2019cbba69d5SMatthias Ringwald                     offset += 2;
2020cbba69d5SMatthias Ringwald                     uint16_t value_length = little_endian_read_16(packet, offset);
2021cbba69d5SMatthias Ringwald                     offset += 2;
2022cbba69d5SMatthias Ringwald                     if ((offset + value_length) > size) break;
2023cbba69d5SMatthias Ringwald                     report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length);
2024cbba69d5SMatthias Ringwald                     offset += value_length;
2025cbba69d5SMatthias Ringwald                 }
2026cbba69d5SMatthias Ringwald             }
2027cbba69d5SMatthias Ringwald             return;
2028cbba69d5SMatthias Ringwald #endif
20292da0d963SMatthias Ringwald         case ATT_HANDLE_VALUE_INDICATION:
20302da0d963SMatthias Ringwald             if (size < 3u) break;
20312da0d963SMatthias Ringwald             report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u);
203252377058SMatthias Ringwald             gatt_client->send_confirmation = true;
20332da0d963SMatthias Ringwald             break;
20342da0d963SMatthias Ringwald         case ATT_READ_BY_TYPE_RESPONSE:
20352da0d963SMatthias Ringwald             gatt_client_handle_att_read_by_type_response(gatt_client, packet, size);
20362da0d963SMatthias Ringwald             break;
20372da0d963SMatthias Ringwald         case ATT_READ_RESPONSE:
20382da0d963SMatthias Ringwald             gatt_client_handle_att_read_response(gatt_client, packet, size);
20392da0d963SMatthias Ringwald             break;
2040cf8e5718SMatthias Ringwald         case ATT_FIND_BY_TYPE_VALUE_RESPONSE: {
20413deb3ec6SMatthias Ringwald             uint8_t pair_size = 4;
20423deb3ec6SMatthias Ringwald             int i;
20433deb3ec6SMatthias Ringwald             uint16_t start_group_handle;
20445611a760SMatthias Ringwald             uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results
20454ea43905SMatthias Ringwald             for (i = 1u; (i + pair_size) <= size; i += pair_size) {
2046f8fbdce0SMatthias Ringwald                 start_group_handle = little_endian_read_16(packet, i);
2047f8fbdce0SMatthias Ringwald                 end_group_handle = little_endian_read_16(packet, i + 2);
2048cf8e5718SMatthias Ringwald                 emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle,
2049cf8e5718SMatthias Ringwald                                                      gatt_client->uuid128);
20503deb3ec6SMatthias Ringwald             }
20515cf1669fSMatthias Ringwald             trigger_next_service_by_uuid_query(gatt_client, end_group_handle);
20525611a760SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
20533deb3ec6SMatthias Ringwald             break;
20543deb3ec6SMatthias Ringwald         }
2055cf8e5718SMatthias Ringwald         case ATT_FIND_INFORMATION_REPLY: {
20564ea43905SMatthias Ringwald             if (size < 2u) break;
2057a6121b51SMilanka Ringwald 
20583deb3ec6SMatthias Ringwald             uint8_t pair_size = 4;
20594ea43905SMatthias Ringwald             if (packet[1u] == 2u) {
20603deb3ec6SMatthias Ringwald                 pair_size = 18;
20613deb3ec6SMatthias Ringwald             }
2062a6121b51SMilanka Ringwald             uint16_t offset = 2;
2063a6121b51SMilanka Ringwald 
2064a6121b51SMilanka Ringwald             if (size < (pair_size + offset)) break;
2065f8fbdce0SMatthias Ringwald             uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size);
2066abdc9fb5SMatthias Ringwald 
2067abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
20685cf1669fSMatthias Ringwald             log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state);
20695cf1669fSMatthias Ringwald             if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){
2070abdc9fb5SMatthias Ringwald                 // iterate over descriptors looking for CCC
2071abdc9fb5SMatthias Ringwald                 if (pair_size == 4){
2072a6121b51SMilanka Ringwald                     while ((offset + 4) <= size){
2073abdc9fb5SMatthias Ringwald                         uint16_t uuid16 = little_endian_read_16(packet, offset + 2);
2074abdc9fb5SMatthias Ringwald                         if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){
20755cf1669fSMatthias Ringwald                             gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset);
20765cf1669fSMatthias Ringwald                             gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION;
20775cf1669fSMatthias Ringwald                             log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle);
2078abdc9fb5SMatthias Ringwald                             break;
2079abdc9fb5SMatthias Ringwald                         }
2080abdc9fb5SMatthias Ringwald                         offset += pair_size;
2081abdc9fb5SMatthias Ringwald                     }
2082abdc9fb5SMatthias Ringwald                 }
20835cf1669fSMatthias Ringwald                 if (is_query_done(gatt_client, last_descriptor_handle)){
2084abdc9fb5SMatthias Ringwald 
2085abdc9fb5SMatthias Ringwald                 } else {
2086abdc9fb5SMatthias Ringwald                     // next
20875cf1669fSMatthias Ringwald                     gatt_client->start_group_handle = last_descriptor_handle + 1;
20885cf1669fSMatthias Ringwald                     gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY;
2089abdc9fb5SMatthias Ringwald                 }
2090abdc9fb5SMatthias Ringwald                 break;
2091abdc9fb5SMatthias Ringwald             }
2092abdc9fb5SMatthias Ringwald #endif
20935cf1669fSMatthias Ringwald             report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size);
20945cf1669fSMatthias Ringwald             trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle);
20955611a760SMatthias Ringwald             // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
20963deb3ec6SMatthias Ringwald             break;
20973deb3ec6SMatthias Ringwald         }
20983deb3ec6SMatthias Ringwald 
20993deb3ec6SMatthias Ringwald         case ATT_WRITE_RESPONSE:
21002da0d963SMatthias Ringwald             gatt_client_handle_att_write_response(gatt_client);
21013deb3ec6SMatthias Ringwald             break;
21023deb3ec6SMatthias Ringwald 
21033deb3ec6SMatthias Ringwald         case ATT_READ_BLOB_RESPONSE: {
21044ea43905SMatthias Ringwald             uint16_t received_blob_length = size - 1u;
2105052dc82aSMatthias Ringwald             switch (gatt_client->state) {
21063deb3ec6SMatthias Ringwald                 case P_W4_READ_BLOB_RESULT:
2107cf8e5718SMatthias Ringwald                     report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1],
2108cf8e5718SMatthias Ringwald                                                                received_blob_length, gatt_client->attribute_offset);
21095cf1669fSMatthias Ringwald                     trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length);
21105611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
21113deb3ec6SMatthias Ringwald                     break;
21123deb3ec6SMatthias Ringwald                 case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT:
21135cf1669fSMatthias Ringwald                     report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle,
21143deb3ec6SMatthias Ringwald                                                                &packet[1], received_blob_length,
21155cf1669fSMatthias Ringwald                                                                gatt_client->attribute_offset);
2116cf8e5718SMatthias Ringwald                     trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY,
2117cf8e5718SMatthias Ringwald                                             received_blob_length);
21185611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
21193deb3ec6SMatthias Ringwald                     break;
21203deb3ec6SMatthias Ringwald                 default:
21213deb3ec6SMatthias Ringwald                     break;
21223deb3ec6SMatthias Ringwald             }
21233deb3ec6SMatthias Ringwald             break;
21243deb3ec6SMatthias Ringwald         }
21253deb3ec6SMatthias Ringwald         case ATT_PREPARE_WRITE_RESPONSE:
2126052dc82aSMatthias Ringwald             switch (gatt_client->state) {
21273deb3ec6SMatthias Ringwald                 case P_W4_PREPARE_WRITE_SINGLE_RESULT:
21285cf1669fSMatthias Ringwald                     if (is_value_valid(gatt_client, packet, size)) {
21294740230fSMatthias Ringwald                         att_status = ATT_ERROR_SUCCESS;
21303deb3ec6SMatthias Ringwald                     } else {
21314740230fSMatthias Ringwald                         att_status = ATT_ERROR_DATA_MISMATCH;
21323deb3ec6SMatthias Ringwald                     }
2133526859e7SMatthias Ringwald                     gatt_client_handle_transaction_complete(gatt_client, att_status);
21343deb3ec6SMatthias Ringwald                     break;
21353deb3ec6SMatthias Ringwald 
21363deb3ec6SMatthias Ringwald                 case P_W4_PREPARE_WRITE_RESULT: {
21375cf1669fSMatthias Ringwald                     gatt_client->attribute_offset = little_endian_read_16(packet, 3);
21385cf1669fSMatthias Ringwald                     trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE);
21395611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
21403deb3ec6SMatthias Ringwald                     break;
21413deb3ec6SMatthias Ringwald                 }
21423deb3ec6SMatthias Ringwald                 case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: {
21435cf1669fSMatthias Ringwald                     gatt_client->attribute_offset = little_endian_read_16(packet, 3);
2144cf8e5718SMatthias Ringwald                     trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR,
2145cf8e5718SMatthias Ringwald                                                      P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR);
21465611a760SMatthias Ringwald                     // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
21473deb3ec6SMatthias Ringwald                     break;
21483deb3ec6SMatthias Ringwald                 }
21493deb3ec6SMatthias Ringwald                 case P_W4_PREPARE_RELIABLE_WRITE_RESULT: {
21505cf1669fSMatthias Ringwald                     if (is_value_valid(gatt_client, packet, size)) {
21515cf1669fSMatthias Ringwald                         gatt_client->attribute_offset = little_endian_read_16(packet, 3);
2152cf8e5718SMatthias Ringwald                         trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE,
2153cf8e5718SMatthias Ringwald                                                          P_W2_EXECUTE_PREPARED_WRITE);
21545611a760SMatthias Ringwald                         // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done
21553deb3ec6SMatthias Ringwald                         break;
21563deb3ec6SMatthias Ringwald                     }
2157052dc82aSMatthias Ringwald                     gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH;
21583deb3ec6SMatthias Ringwald                     break;
21593deb3ec6SMatthias Ringwald                 }
21603deb3ec6SMatthias Ringwald                 default:
21613deb3ec6SMatthias Ringwald                     break;
21623deb3ec6SMatthias Ringwald             }
21633deb3ec6SMatthias Ringwald             break;
21643deb3ec6SMatthias Ringwald 
21653deb3ec6SMatthias Ringwald         case ATT_EXECUTE_WRITE_RESPONSE:
2166052dc82aSMatthias Ringwald             switch (gatt_client->state) {
21673deb3ec6SMatthias Ringwald                 case P_W4_EXECUTE_PREPARED_WRITE_RESULT:
2168526859e7SMatthias Ringwald                     gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
21693deb3ec6SMatthias Ringwald                     break;
21703deb3ec6SMatthias Ringwald                 case P_W4_CANCEL_PREPARED_WRITE_RESULT:
2171526859e7SMatthias Ringwald                     gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
21723deb3ec6SMatthias Ringwald                     break;
21733deb3ec6SMatthias Ringwald                 case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT:
2174526859e7SMatthias Ringwald                     gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH);
21753deb3ec6SMatthias Ringwald                     break;
21763deb3ec6SMatthias Ringwald                 case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
2177526859e7SMatthias Ringwald                     gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
21783deb3ec6SMatthias Ringwald                     break;
21793deb3ec6SMatthias Ringwald                 default:
21803deb3ec6SMatthias Ringwald                     break;
21813deb3ec6SMatthias Ringwald 
21823deb3ec6SMatthias Ringwald             }
21833deb3ec6SMatthias Ringwald             break;
21843deb3ec6SMatthias Ringwald 
21853deb3ec6SMatthias Ringwald         case ATT_READ_MULTIPLE_RESPONSE:
2186052dc82aSMatthias Ringwald             switch (gatt_client->state) {
21873deb3ec6SMatthias Ringwald                 case P_W4_READ_MULTIPLE_RESPONSE:
21885cf1669fSMatthias Ringwald                     report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u);
2189526859e7SMatthias Ringwald                     gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
21903deb3ec6SMatthias Ringwald                     break;
21913deb3ec6SMatthias Ringwald                 default:
21923deb3ec6SMatthias Ringwald                     break;
21933deb3ec6SMatthias Ringwald             }
21943deb3ec6SMatthias Ringwald             break;
21953deb3ec6SMatthias Ringwald 
2196f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
2197f125a8efSMatthias Ringwald         case ATT_READ_MULTIPLE_VARIABLE_RSP:
2198052dc82aSMatthias Ringwald             switch (gatt_client->state) {
2199169b9876SMatthias Ringwald                 case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE:
2200f125a8efSMatthias Ringwald                     report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u);
2201f125a8efSMatthias Ringwald                     gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
2202f125a8efSMatthias Ringwald                     break;
2203f125a8efSMatthias Ringwald                 default:
2204f125a8efSMatthias Ringwald                     break;
2205f125a8efSMatthias Ringwald             }
2206f125a8efSMatthias Ringwald             break;
2207f125a8efSMatthias Ringwald #endif
2208f125a8efSMatthias Ringwald 
22093deb3ec6SMatthias Ringwald         case ATT_ERROR_RESPONSE:
22104ea43905SMatthias Ringwald             if (size < 5u) return;
22114740230fSMatthias Ringwald             att_status = packet[4];
22124740230fSMatthias Ringwald             switch (att_status) {
22133deb3ec6SMatthias Ringwald                 case ATT_ERROR_ATTRIBUTE_NOT_FOUND: {
2214052dc82aSMatthias Ringwald                     switch (gatt_client->state) {
22153deb3ec6SMatthias Ringwald                         case P_W4_SERVICE_QUERY_RESULT:
22163deb3ec6SMatthias Ringwald                         case P_W4_SERVICE_WITH_UUID_RESULT:
22173deb3ec6SMatthias Ringwald                         case P_W4_INCLUDED_SERVICE_QUERY_RESULT:
22183deb3ec6SMatthias Ringwald                         case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT:
2219526859e7SMatthias Ringwald                             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
22203deb3ec6SMatthias Ringwald                             break;
22213deb3ec6SMatthias Ringwald                         case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT:
22223deb3ec6SMatthias Ringwald                         case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT:
222323d583b8SMatthias Ringwald                             report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle);
2224526859e7SMatthias Ringwald                             gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS);
22253deb3ec6SMatthias Ringwald                             break;
22263deb3ec6SMatthias Ringwald                         case P_W4_READ_BY_TYPE_RESPONSE:
22275cf1669fSMatthias Ringwald                             if (gatt_client->start_group_handle == gatt_client->query_start_handle) {
22284740230fSMatthias Ringwald                                 att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND;
22293deb3ec6SMatthias Ringwald                             } else {
22304740230fSMatthias Ringwald                                 att_status = ATT_ERROR_SUCCESS;
22313deb3ec6SMatthias Ringwald                             }
2232526859e7SMatthias Ringwald                             gatt_client_handle_transaction_complete(gatt_client, att_status);
22333deb3ec6SMatthias Ringwald                             break;
22343deb3ec6SMatthias Ringwald                         default:
22354740230fSMatthias Ringwald                             gatt_client_report_error_if_pending(gatt_client, att_status);
22363deb3ec6SMatthias Ringwald                             break;
22373deb3ec6SMatthias Ringwald                     }
22383deb3ec6SMatthias Ringwald                     break;
22393deb3ec6SMatthias Ringwald                 }
2240f4b33574SMatthias Ringwald 
2241f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING
2242f4b33574SMatthias Ringwald 
2243f4b33574SMatthias Ringwald                     case ATT_ERROR_INSUFFICIENT_AUTHENTICATION:
2244f4b33574SMatthias Ringwald                     case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE:
2245a0e0c2beSMatthias Ringwald                     case ATT_ERROR_INSUFFICIENT_ENCRYPTION: {
2246a0e0c2beSMatthias Ringwald 
2247f4b33574SMatthias Ringwald                         // security too low
22485cf1669fSMatthias Ringwald                         if (gatt_client->security_counter > 0) {
22494740230fSMatthias Ringwald                             gatt_client_report_error_if_pending(gatt_client, att_status);
2250f4b33574SMatthias Ringwald                             break;
2251f4b33574SMatthias Ringwald                         }
2252f4b33574SMatthias Ringwald                         // start security
22535cf1669fSMatthias Ringwald                         gatt_client->security_counter++;
2254f4b33574SMatthias Ringwald 
2255f4b33574SMatthias Ringwald                         // setup action
2256f4b33574SMatthias Ringwald                         int retry = 1;
2257052dc82aSMatthias Ringwald                         switch (gatt_client->state){
2258f4b33574SMatthias Ringwald                             case P_W4_READ_CHARACTERISTIC_VALUE_RESULT:
2259052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ;
2260f4b33574SMatthias Ringwald                                 break;
2261f4b33574SMatthias Ringwald                             case P_W4_READ_BLOB_RESULT:
2262052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_READ_BLOB_QUERY;
2263f4b33574SMatthias Ringwald                                 break;
2264f4b33574SMatthias Ringwald                             case P_W4_READ_BY_TYPE_RESPONSE:
2265052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST;
2266f4b33574SMatthias Ringwald                                 break;
2267f4b33574SMatthias Ringwald                             case P_W4_READ_MULTIPLE_RESPONSE:
2268052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_READ_MULTIPLE_REQUEST;
2269f4b33574SMatthias Ringwald                                 break;
2270f125a8efSMatthias Ringwald                             case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE:
2271052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST;
2272f125a8efSMatthias Ringwald                                 break;
2273f4b33574SMatthias Ringwald                             case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT:
2274052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE;
2275f4b33574SMatthias Ringwald                                 break;
2276f4b33574SMatthias Ringwald                             case P_W4_PREPARE_WRITE_RESULT:
2277052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_PREPARE_WRITE;
2278f4b33574SMatthias Ringwald                                 break;
2279f4b33574SMatthias Ringwald                             case P_W4_PREPARE_WRITE_SINGLE_RESULT:
2280052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_PREPARE_WRITE_SINGLE;
2281f4b33574SMatthias Ringwald                                 break;
2282f4b33574SMatthias Ringwald                             case P_W4_PREPARE_RELIABLE_WRITE_RESULT:
2283052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE;
2284f4b33574SMatthias Ringwald                                 break;
2285f4b33574SMatthias Ringwald                             case P_W4_EXECUTE_PREPARED_WRITE_RESULT:
2286052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE;
2287f4b33574SMatthias Ringwald                                 break;
2288f4b33574SMatthias Ringwald                             case P_W4_CANCEL_PREPARED_WRITE_RESULT:
2289052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_CANCEL_PREPARED_WRITE;
2290f4b33574SMatthias Ringwald                                 break;
2291f4b33574SMatthias Ringwald                             case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT:
2292052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH;
2293f4b33574SMatthias Ringwald                                 break;
2294f4b33574SMatthias Ringwald                             case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:
2295052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY;
2296f4b33574SMatthias Ringwald                                 break;
2297f4b33574SMatthias Ringwald                             case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT:
2298052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY;
2299f4b33574SMatthias Ringwald                                 break;
2300f4b33574SMatthias Ringwald                             case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
2301052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR;
2302f4b33574SMatthias Ringwald                                 break;
2303f4b33574SMatthias Ringwald                             case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT:
2304052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION;
2305f4b33574SMatthias Ringwald                                 break;
2306f4b33574SMatthias Ringwald                             case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
2307052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR;
2308f4b33574SMatthias Ringwald                                 break;
2309f4b33574SMatthias Ringwald                             case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:
2310052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR;
2311f4b33574SMatthias Ringwald                                 break;
2312f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
231330cf4543SMilanka Ringwald                             case P_W4_SEND_SIGNED_WRITE_DONE:
2314052dc82aSMatthias Ringwald                                 gatt_client->state = P_W2_SEND_SIGNED_WRITE;
2315f4b33574SMatthias Ringwald                                 break;
2316f4b33574SMatthias Ringwald #endif
2317f4b33574SMatthias Ringwald                             default:
2318052dc82aSMatthias Ringwald                                 log_info("retry not supported for state %x", gatt_client->state);
2319f4b33574SMatthias Ringwald                                 retry = 0;
2320f4b33574SMatthias Ringwald                                 break;
2321f4b33574SMatthias Ringwald                         }
2322f4b33574SMatthias Ringwald 
2323f4b33574SMatthias Ringwald                         if (!retry) {
23244740230fSMatthias Ringwald                             gatt_client_report_error_if_pending(gatt_client, att_status);
2325f4b33574SMatthias Ringwald                             break;
2326f4b33574SMatthias Ringwald                         }
2327f4b33574SMatthias Ringwald 
2328f4b33574SMatthias Ringwald                         log_info("security error, start pairing");
2329f4b33574SMatthias Ringwald 
2330f060f108SMatthias Ringwald                         // start pairing for higher security level
23312197dbafSMatthias Ringwald                         gatt_client->wait_for_authentication_complete = true;
23324740230fSMatthias Ringwald                         gatt_client->pending_error_code = att_status;
23335cf1669fSMatthias Ringwald                         sm_request_pairing(gatt_client->con_handle);
2334f4b33574SMatthias Ringwald                         break;
2335a0e0c2beSMatthias Ringwald                     }
2336f4b33574SMatthias Ringwald #endif
2337f4b33574SMatthias Ringwald 
2338f4b33574SMatthias Ringwald                     // nothing we can do about that
2339f4b33574SMatthias Ringwald                 case ATT_ERROR_INSUFFICIENT_AUTHORIZATION:
23403deb3ec6SMatthias Ringwald                 default:
23414740230fSMatthias Ringwald                     gatt_client_report_error_if_pending(gatt_client, att_status);
23423deb3ec6SMatthias Ringwald                     break;
23433deb3ec6SMatthias Ringwald             }
23443deb3ec6SMatthias Ringwald             break;
23453deb3ec6SMatthias Ringwald 
23463deb3ec6SMatthias Ringwald         default:
23473deb3ec6SMatthias Ringwald             log_info("ATT Handler, unhandled response type 0x%02x", packet[0]);
23483deb3ec6SMatthias Ringwald             break;
23493deb3ec6SMatthias Ringwald     }
2350cf8e5718SMatthias Ringwald }
2351cf8e5718SMatthias Ringwald 
2352cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) {
2353cf8e5718SMatthias Ringwald     gatt_client_t *gatt_client;
2354180cbe79SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
2355b1da4983SMatthias Ringwald     uint8_t status;
2356b1da4983SMatthias Ringwald     hci_connection_t * hci_connection;
2357180cbe79SMatthias Ringwald     hci_con_handle_t con_handle;
2358180cbe79SMatthias Ringwald #endif
2359180cbe79SMatthias Ringwald 
2360cf8e5718SMatthias Ringwald     if (size < 1u) return;
236159b5e157SMatthias Ringwald     switch (packet_type){
236259b5e157SMatthias Ringwald         case HCI_EVENT_PACKET:
236359b5e157SMatthias Ringwald             switch (hci_event_packet_get_type(packet)) {
236459b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
236559b5e157SMatthias Ringwald                 case L2CAP_EVENT_CHANNEL_OPENED:
236659b5e157SMatthias Ringwald                     status = l2cap_event_channel_opened_get_status(packet);
236759b5e157SMatthias Ringwald                     gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet));
2368de5a18caSMatthias Ringwald                     if (gatt_client != NULL){
2369180cbe79SMatthias Ringwald                         con_handle = l2cap_event_channel_opened_get_handle(packet);
2370180cbe79SMatthias Ringwald                         hci_connection = hci_connection_for_handle(con_handle);
2371ab6f9d8fSMatthias Ringwald                         if (status == L2CAP_CONNECTION_RESPONSE_RESULT_REFUSED_RESOURCES){
2372ab6f9d8fSMatthias Ringwald                             if ((hci_connection != NULL) && hci_connection->att_server.incoming_connection_request) {
2373180cbe79SMatthias Ringwald                                 log_info("Collision, retry in 100ms");
2374180cbe79SMatthias Ringwald                                 gatt_client->state = P_W2_L2CAP_CONNECT;
2375180cbe79SMatthias Ringwald                                 // set timer for retry
2376b1da4983SMatthias Ringwald                                 btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS);
2377180cbe79SMatthias Ringwald                                 btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_classic_retry);
2378180cbe79SMatthias Ringwald                                 btstack_run_loop_add_timer(&gatt_client->gc_timeout);
2379180cbe79SMatthias Ringwald                                 break;
2380180cbe79SMatthias Ringwald                             }
2381ab6f9d8fSMatthias Ringwald                         }
238259b5e157SMatthias Ringwald                         // if status != 0, gatt_client will be discarded
2383052dc82aSMatthias Ringwald                         gatt_client->state = P_READY;
238459b5e157SMatthias Ringwald                         gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet);
238559b5e157SMatthias Ringwald                         gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet);
238659b5e157SMatthias Ringwald                         gatt_client_classic_handle_connected(gatt_client, status);
2387de5a18caSMatthias Ringwald                     }
238859b5e157SMatthias Ringwald                     break;
238959b5e157SMatthias Ringwald                 case L2CAP_EVENT_CHANNEL_CLOSED:
239059b5e157SMatthias Ringwald                     gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet));
2391de5a18caSMatthias Ringwald                     if (gatt_client != NULL){
239259b5e157SMatthias Ringwald                         // discard gatt client object
239359b5e157SMatthias Ringwald                         gatt_client_classic_handle_disconnected(gatt_client);
2394de5a18caSMatthias Ringwald                     }
239559b5e157SMatthias Ringwald                     break;
239659b5e157SMatthias Ringwald #endif
2397cf8e5718SMatthias Ringwald                 case L2CAP_EVENT_CAN_SEND_NOW:
23983deb3ec6SMatthias Ringwald                     gatt_client_run();
2399cf8e5718SMatthias Ringwald                     break;
2400cf8e5718SMatthias Ringwald                     // att_server has negotiated the mtu for this connection, cache if context exists
2401cf8e5718SMatthias Ringwald                 case ATT_EVENT_MTU_EXCHANGE_COMPLETE:
2402cf8e5718SMatthias Ringwald                     if (size < 6u) break;
2403cf8e5718SMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(handle);
2404de5a18caSMatthias Ringwald                     if (gatt_client != NULL) {
2405cf8e5718SMatthias Ringwald                         gatt_client->mtu = little_endian_read_16(packet, 4);
2406de5a18caSMatthias Ringwald                     }
2407cf8e5718SMatthias Ringwald                     break;
2408cf8e5718SMatthias Ringwald                 default:
2409cf8e5718SMatthias Ringwald                     break;
2410cf8e5718SMatthias Ringwald             }
241159b5e157SMatthias Ringwald             break;
2412cf8e5718SMatthias Ringwald 
241359b5e157SMatthias Ringwald         case ATT_DATA_PACKET:
2414cf8e5718SMatthias Ringwald             // special cases: notifications & indications motivate creating context
2415cf8e5718SMatthias Ringwald             switch (packet[0]) {
2416cf8e5718SMatthias Ringwald                 case ATT_HANDLE_VALUE_NOTIFICATION:
2417cf8e5718SMatthias Ringwald                 case ATT_HANDLE_VALUE_INDICATION:
2418cf8e5718SMatthias Ringwald                     gatt_client_provide_context_for_handle(handle, &gatt_client);
2419cf8e5718SMatthias Ringwald                     break;
2420cf8e5718SMatthias Ringwald                 default:
2421cf8e5718SMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(handle);
2422cf8e5718SMatthias Ringwald                     break;
2423cf8e5718SMatthias Ringwald             }
2424cf8e5718SMatthias Ringwald 
2425cf8e5718SMatthias Ringwald             if (gatt_client != NULL) {
2426cf8e5718SMatthias Ringwald                 gatt_client_handle_att_response(gatt_client, packet, size);
2427cf8e5718SMatthias Ringwald                 gatt_client_run();
2428cf8e5718SMatthias Ringwald             }
242959b5e157SMatthias Ringwald             break;
243059b5e157SMatthias Ringwald 
243159b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
243259b5e157SMatthias Ringwald         case L2CAP_DATA_PACKET:
243359b5e157SMatthias Ringwald             gatt_client = gatt_client_get_context_for_l2cap_cid(handle);
2434de5a18caSMatthias Ringwald             if (gatt_client != NULL){
243559b5e157SMatthias Ringwald                 gatt_client_handle_att_response(gatt_client, packet, size);
243659b5e157SMatthias Ringwald                 gatt_client_run();
2437de5a18caSMatthias Ringwald             }
243859b5e157SMatthias Ringwald             break;
243959b5e157SMatthias Ringwald #endif
244059b5e157SMatthias Ringwald 
244159b5e157SMatthias Ringwald         default:
244259b5e157SMatthias Ringwald             break;
244359b5e157SMatthias Ringwald     }
24443deb3ec6SMatthias Ringwald }
24453deb3ec6SMatthias Ringwald 
24467a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE
24473deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){
2448665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
2449665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_connections);
2450665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
24515cf1669fSMatthias Ringwald         gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
2452052dc82aSMatthias Ringwald         if (gatt_client->state == P_W4_CMAC_RESULT){
24533deb3ec6SMatthias Ringwald             // store result
24545cf1669fSMatthias Ringwald             (void)memcpy(gatt_client->cmac, hash, 8);
24555cf1669fSMatthias Ringwald             // reverse_64(hash, gatt_client->cmac);
2456052dc82aSMatthias Ringwald             gatt_client->state = P_W2_SEND_SIGNED_WRITE;
24573deb3ec6SMatthias Ringwald             gatt_client_run();
24583deb3ec6SMatthias Ringwald             return;
24593deb3ec6SMatthias Ringwald         }
24603deb3ec6SMatthias Ringwald     }
24613deb3ec6SMatthias Ringwald }
24623deb3ec6SMatthias Ringwald 
2463b45b7749SMilanka Ringwald uint8_t gatt_client_signed_write_without_response(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle, uint16_t message_len, uint8_t * message){
246440faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
246540faeb84SMilanka Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
246640faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
246740faeb84SMilanka Ringwald         return status;
246840faeb84SMilanka Ringwald     }
246940faeb84SMilanka Ringwald     if (is_ready(gatt_client) == 0){
247040faeb84SMilanka Ringwald         return GATT_CLIENT_IN_WRONG_STATE;
247140faeb84SMilanka Ringwald     }
24723deb3ec6SMatthias Ringwald 
24735cf1669fSMatthias Ringwald     gatt_client->callback = callback;
2474b45b7749SMilanka Ringwald     gatt_client->attribute_handle = value_handle;
24755cf1669fSMatthias Ringwald     gatt_client->attribute_length = message_len;
24765cf1669fSMatthias Ringwald     gatt_client->attribute_value = message;
2477052dc82aSMatthias Ringwald     gatt_client->state = P_W4_IDENTITY_RESOLVING;
24783deb3ec6SMatthias Ringwald     gatt_client_run();
247925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
24803deb3ec6SMatthias Ringwald }
24817a766ebfSMatthias Ringwald #endif
24823deb3ec6SMatthias Ringwald 
2483711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
248440faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2485de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
248640faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
248740faeb84SMilanka Ringwald         return status;
248840faeb84SMilanka Ringwald     }
24893deb3ec6SMatthias Ringwald 
24905cf1669fSMatthias Ringwald     gatt_client->callback = callback;
24915cf1669fSMatthias Ringwald     gatt_client->start_group_handle = 0x0001;
24925cf1669fSMatthias Ringwald     gatt_client->end_group_handle   = 0xffff;
2493052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_SERVICE_QUERY;
24948d1f34d3SMatheus Eduardo Garbelini     gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID;
24953deb3ec6SMatthias Ringwald     gatt_client_run();
249625b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
24973deb3ec6SMatthias Ringwald }
24983deb3ec6SMatthias Ringwald 
24998d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
250040faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2501de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
250240faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
250340faeb84SMilanka Ringwald         return status;
250440faeb84SMilanka Ringwald     }
25058d1f34d3SMatheus Eduardo Garbelini 
25068d1f34d3SMatheus Eduardo Garbelini     gatt_client->callback = callback;
25078d1f34d3SMatheus Eduardo Garbelini     gatt_client->start_group_handle = 0x0001;
25088d1f34d3SMatheus Eduardo Garbelini     gatt_client->end_group_handle   = 0xffff;
2509052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_SERVICE_QUERY;
25108d1f34d3SMatheus Eduardo Garbelini     gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID;
25118d1f34d3SMatheus Eduardo Garbelini     gatt_client_run();
25128d1f34d3SMatheus Eduardo Garbelini     return ERROR_CODE_SUCCESS;
25138d1f34d3SMatheus Eduardo Garbelini }
25143deb3ec6SMatthias Ringwald 
2515711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){
251640faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2517de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
251840faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
251940faeb84SMilanka Ringwald         return status;
252040faeb84SMilanka Ringwald     }
25213deb3ec6SMatthias Ringwald 
25225cf1669fSMatthias Ringwald     gatt_client->callback = callback;
25235cf1669fSMatthias Ringwald     gatt_client->start_group_handle = 0x0001;
25245cf1669fSMatthias Ringwald     gatt_client->end_group_handle   = 0xffff;
2525052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY;
25265cf1669fSMatthias Ringwald     gatt_client->uuid16 = uuid16;
25275cf1669fSMatthias Ringwald     uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16);
25283deb3ec6SMatthias Ringwald     gatt_client_run();
252925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
25303deb3ec6SMatthias Ringwald }
25313deb3ec6SMatthias Ringwald 
2532711e6c80SMatthias 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){
253340faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2534de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
253540faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
253640faeb84SMilanka Ringwald         return status;
253740faeb84SMilanka Ringwald     }
25383deb3ec6SMatthias Ringwald 
25395cf1669fSMatthias Ringwald     gatt_client->callback = callback;
25405cf1669fSMatthias Ringwald     gatt_client->start_group_handle = 0x0001;
25415cf1669fSMatthias Ringwald     gatt_client->end_group_handle   = 0xffff;
25425cf1669fSMatthias Ringwald     gatt_client->uuid16 = 0;
25435cf1669fSMatthias Ringwald     (void)memcpy(gatt_client->uuid128, uuid128, 16);
2544052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY;
25453deb3ec6SMatthias Ringwald     gatt_client_run();
254625b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
25473deb3ec6SMatthias Ringwald }
25483deb3ec6SMatthias Ringwald 
2549711e6c80SMatthias 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){
255040faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2551de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
255240faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
255340faeb84SMilanka Ringwald         return status;
255440faeb84SMilanka Ringwald     }
25553deb3ec6SMatthias Ringwald 
25565cf1669fSMatthias Ringwald     gatt_client->callback = callback;
25575cf1669fSMatthias Ringwald     gatt_client->start_group_handle = service->start_group_handle;
25585cf1669fSMatthias Ringwald     gatt_client->end_group_handle   = service->end_group_handle;
2559ab415e75SMatthias Ringwald     gatt_client->filter_with_uuid = false;
25605cf1669fSMatthias Ringwald     gatt_client->characteristic_start_handle = 0;
2561052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY;
25623deb3ec6SMatthias Ringwald     gatt_client_run();
256325b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
25643deb3ec6SMatthias Ringwald }
25653deb3ec6SMatthias Ringwald 
2566711e6c80SMatthias 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){
256740faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2568de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
256940faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
257040faeb84SMilanka Ringwald         return status;
257140faeb84SMilanka Ringwald     }
2572de27733dSMatthias Ringwald 
25735cf1669fSMatthias Ringwald     gatt_client->callback = callback;
25745cf1669fSMatthias Ringwald     gatt_client->start_group_handle = service->start_group_handle;
25755cf1669fSMatthias Ringwald     gatt_client->end_group_handle   = service->end_group_handle;
2576052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_QUERY;
25773deb3ec6SMatthias Ringwald 
25783deb3ec6SMatthias Ringwald     gatt_client_run();
257925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
25803deb3ec6SMatthias Ringwald }
25813deb3ec6SMatthias Ringwald 
2582711e6c80SMatthias 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){
258340faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2584de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
258540faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
258640faeb84SMilanka Ringwald         return status;
258740faeb84SMilanka Ringwald     }
25883deb3ec6SMatthias Ringwald 
25895cf1669fSMatthias Ringwald     gatt_client->callback = callback;
25905cf1669fSMatthias Ringwald     gatt_client->start_group_handle = start_handle;
25915cf1669fSMatthias Ringwald     gatt_client->end_group_handle   = end_handle;
2592ab415e75SMatthias Ringwald     gatt_client->filter_with_uuid = true;
25935cf1669fSMatthias Ringwald     gatt_client->uuid16 = uuid16;
25945cf1669fSMatthias Ringwald     uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16);
25955cf1669fSMatthias Ringwald     gatt_client->characteristic_start_handle = 0;
2596052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY;
25973deb3ec6SMatthias Ringwald     gatt_client_run();
259825b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
25993deb3ec6SMatthias Ringwald }
26003deb3ec6SMatthias Ringwald 
2601045d700dSDavid Lechner 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, const uint8_t * uuid128){
260240faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2603de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
260440faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
260540faeb84SMilanka Ringwald         return status;
260640faeb84SMilanka Ringwald     }
26073deb3ec6SMatthias Ringwald 
26085cf1669fSMatthias Ringwald     gatt_client->callback = callback;
26095cf1669fSMatthias Ringwald     gatt_client->start_group_handle = start_handle;
26105cf1669fSMatthias Ringwald     gatt_client->end_group_handle   = end_handle;
2611ab415e75SMatthias Ringwald     gatt_client->filter_with_uuid = true;
26125cf1669fSMatthias Ringwald     gatt_client->uuid16 = 0;
26135cf1669fSMatthias Ringwald     (void)memcpy(gatt_client->uuid128, uuid128, 16);
26145cf1669fSMatthias Ringwald     gatt_client->characteristic_start_handle = 0;
2615052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY;
26163deb3ec6SMatthias Ringwald     gatt_client_run();
261725b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
26183deb3ec6SMatthias Ringwald }
26193deb3ec6SMatthias Ringwald 
26203deb3ec6SMatthias Ringwald 
2621b45b7749SMilanka Ringwald uint8_t gatt_client_discover_characteristics_for_service_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_service_t * service, uint16_t uuid16){
2622b45b7749SMilanka Ringwald     return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16);
26233deb3ec6SMatthias Ringwald }
26243deb3ec6SMatthias Ringwald 
2625b45b7749SMilanka Ringwald uint8_t gatt_client_discover_characteristics_for_service_by_uuid128(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_service_t * service, const uint8_t * uuid128){
2626b45b7749SMilanka Ringwald     return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128);
26273deb3ec6SMatthias Ringwald }
26283deb3ec6SMatthias Ringwald 
2629711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){
263040faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2631de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
263240faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
263340faeb84SMilanka Ringwald         return status;
263440faeb84SMilanka Ringwald     }
26353deb3ec6SMatthias Ringwald 
2636544a5845SMatthias Ringwald     // check if there is space for characteristics descriptors
2637544a5845SMatthias Ringwald     if (characteristic->end_handle > characteristic->value_handle){
26385cf1669fSMatthias Ringwald         gatt_client->callback = callback;
26395cf1669fSMatthias Ringwald         gatt_client->start_group_handle = characteristic->value_handle + 1u;
26405cf1669fSMatthias Ringwald         gatt_client->end_group_handle   = characteristic->end_handle;
2641052dc82aSMatthias Ringwald         gatt_client->state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY;
26423deb3ec6SMatthias Ringwald         gatt_client_run();
2643544a5845SMatthias Ringwald     } else {
2644544a5845SMatthias Ringwald         // schedule gatt complete event on next run loop iteration otherwise
2645544a5845SMatthias Ringwald         gatt_client->state = P_W2_EMIT_QUERY_COMPLETE_EVENT;
2646544a5845SMatthias Ringwald         gatt_client_deferred_event_emit.callback = gatt_client_emit_events;
2647544a5845SMatthias Ringwald         btstack_run_loop_execute_on_main_thread(&gatt_client_deferred_event_emit);
2648544a5845SMatthias Ringwald     }
264925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
26503deb3ec6SMatthias Ringwald }
26513deb3ec6SMatthias Ringwald 
2652711e6c80SMatthias 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){
265340faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2654de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
265540faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
265640faeb84SMilanka Ringwald         return status;
265740faeb84SMilanka Ringwald     }
26583deb3ec6SMatthias Ringwald 
26595cf1669fSMatthias Ringwald     gatt_client->callback = callback;
26605cf1669fSMatthias Ringwald     gatt_client->attribute_handle = value_handle;
26615cf1669fSMatthias Ringwald     gatt_client->attribute_offset = 0;
2662052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY;
26633deb3ec6SMatthias Ringwald     gatt_client_run();
266425b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
26653deb3ec6SMatthias Ringwald }
26663deb3ec6SMatthias Ringwald 
2667711e6c80SMatthias 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){
266840faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2669de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
267040faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
267140faeb84SMilanka Ringwald         return status;
267240faeb84SMilanka Ringwald     }
26733deb3ec6SMatthias Ringwald 
26745cf1669fSMatthias Ringwald     gatt_client->callback = callback;
26755cf1669fSMatthias Ringwald     gatt_client->start_group_handle = start_handle;
26765cf1669fSMatthias Ringwald     gatt_client->end_group_handle = end_handle;
26775cf1669fSMatthias Ringwald     gatt_client->query_start_handle = start_handle;
26785cf1669fSMatthias Ringwald     gatt_client->query_end_handle = end_handle;
26795cf1669fSMatthias Ringwald     gatt_client->uuid16 = uuid16;
26805cf1669fSMatthias Ringwald     uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16);
2681052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST;
26823deb3ec6SMatthias Ringwald     gatt_client_run();
268325b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
26843deb3ec6SMatthias Ringwald }
26853deb3ec6SMatthias Ringwald 
2686045d700dSDavid Lechner 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, const uint8_t * uuid128){
268740faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2688de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
268940faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
269040faeb84SMilanka Ringwald         return status;
269140faeb84SMilanka Ringwald     }
26923deb3ec6SMatthias Ringwald 
26935cf1669fSMatthias Ringwald     gatt_client->callback = callback;
26945cf1669fSMatthias Ringwald     gatt_client->start_group_handle = start_handle;
26955cf1669fSMatthias Ringwald     gatt_client->end_group_handle = end_handle;
26965cf1669fSMatthias Ringwald     gatt_client->query_start_handle = start_handle;
26975cf1669fSMatthias Ringwald     gatt_client->query_end_handle = end_handle;
26985cf1669fSMatthias Ringwald     gatt_client->uuid16 = 0;
26995cf1669fSMatthias Ringwald     (void)memcpy(gatt_client->uuid128, uuid128, 16);
2700052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST;
27013deb3ec6SMatthias Ringwald     gatt_client_run();
270225b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
27033deb3ec6SMatthias Ringwald }
27043deb3ec6SMatthias Ringwald 
27053deb3ec6SMatthias Ringwald 
2706b45b7749SMilanka Ringwald uint8_t gatt_client_read_value_of_characteristic(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){
2707b45b7749SMilanka Ringwald     return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle);
27083deb3ec6SMatthias Ringwald }
27093deb3ec6SMatthias Ringwald 
2710b45b7749SMilanka 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 value_handle, uint16_t offset){
271140faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2712de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
271340faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
271440faeb84SMilanka Ringwald         return status;
271540faeb84SMilanka Ringwald     }
27163deb3ec6SMatthias Ringwald 
27175cf1669fSMatthias Ringwald     gatt_client->callback = callback;
2718b45b7749SMilanka Ringwald     gatt_client->attribute_handle = value_handle;
27195cf1669fSMatthias Ringwald     gatt_client->attribute_offset = offset;
2720052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_READ_BLOB_QUERY;
27213deb3ec6SMatthias Ringwald     gatt_client_run();
272225b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
27233deb3ec6SMatthias Ringwald }
27243deb3ec6SMatthias Ringwald 
2725b45b7749SMilanka 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 value_handle){
2726b45b7749SMilanka Ringwald     return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0);
27273deb3ec6SMatthias Ringwald }
27283deb3ec6SMatthias Ringwald 
2729b45b7749SMilanka Ringwald uint8_t gatt_client_read_long_value_of_characteristic(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){
2730b45b7749SMilanka Ringwald     return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle);
27313deb3ec6SMatthias Ringwald }
27323deb3ec6SMatthias Ringwald 
2733f125a8efSMatthias Ringwald static uint8_t gatt_client_read_multiple_characteristic_values_with_state(btstack_packet_handler_t callback, hci_con_handle_t con_handle, int num_value_handles, uint16_t * value_handles, gatt_client_state_t state){
273440faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2735de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
273640faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
273740faeb84SMilanka Ringwald         return status;
273840faeb84SMilanka Ringwald     }
27393deb3ec6SMatthias Ringwald 
2740f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
2741f125a8efSMatthias Ringwald     if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){
2742f125a8efSMatthias Ringwald         if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){
2743f125a8efSMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
2744f125a8efSMatthias Ringwald         }
2745f125a8efSMatthias Ringwald     }
2746f125a8efSMatthias Ringwald #endif
2747f125a8efSMatthias Ringwald 
27485cf1669fSMatthias Ringwald     gatt_client->callback = callback;
27495cf1669fSMatthias Ringwald     gatt_client->read_multiple_handle_count = num_value_handles;
27505cf1669fSMatthias Ringwald     gatt_client->read_multiple_handles = value_handles;
2751052dc82aSMatthias Ringwald     gatt_client->state = state;
27523deb3ec6SMatthias Ringwald     gatt_client_run();
275325b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
27543deb3ec6SMatthias Ringwald }
27553deb3ec6SMatthias Ringwald 
2756f125a8efSMatthias 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){
2757f125a8efSMatthias Ringwald     return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST);
2758f125a8efSMatthias Ringwald }
2759f125a8efSMatthias Ringwald 
2760f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
2761f125a8efSMatthias Ringwald uint8_t gatt_client_read_multiple_variable_characteristic_values(btstack_packet_handler_t callback, hci_con_handle_t con_handle, int num_value_handles, uint16_t * value_handles){
2762f125a8efSMatthias Ringwald     return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST);
2763f125a8efSMatthias Ringwald }
2764f125a8efSMatthias Ringwald #endif
2765f125a8efSMatthias Ringwald 
2766de9f8e94SMatthias 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){
276740faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
276840faeb84SMilanka Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
276940faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
277040faeb84SMilanka Ringwald         return status;
277140faeb84SMilanka Ringwald     }
27723deb3ec6SMatthias Ringwald 
2773dda77937SMatthias Ringwald     if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG;
27745cf1669fSMatthias Ringwald     if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY;
27753deb3ec6SMatthias Ringwald 
27766e7b444cSMatthias Ringwald     return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value);
27773deb3ec6SMatthias Ringwald }
27783deb3ec6SMatthias Ringwald 
2779b45b7749SMilanka 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 * value){
278040faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2781de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
278240faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
278340faeb84SMilanka Ringwald         return status;
278440faeb84SMilanka Ringwald     }
27853deb3ec6SMatthias Ringwald 
27865cf1669fSMatthias Ringwald     gatt_client->callback = callback;
27875cf1669fSMatthias Ringwald     gatt_client->attribute_handle = value_handle;
27885cf1669fSMatthias Ringwald     gatt_client->attribute_length = value_length;
2789b45b7749SMilanka Ringwald     gatt_client->attribute_value = value;
2790052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE;
27913deb3ec6SMatthias Ringwald     gatt_client_run();
279225b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
27933deb3ec6SMatthias Ringwald }
27943deb3ec6SMatthias Ringwald 
2795b45b7749SMilanka 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 * value){
279640faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2797de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
279840faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
279940faeb84SMilanka Ringwald         return status;
280040faeb84SMilanka Ringwald     }
28013deb3ec6SMatthias Ringwald 
28025cf1669fSMatthias Ringwald     gatt_client->callback = callback;
28035cf1669fSMatthias Ringwald     gatt_client->attribute_handle = value_handle;
28045cf1669fSMatthias Ringwald     gatt_client->attribute_length = value_length;
28055cf1669fSMatthias Ringwald     gatt_client->attribute_offset = offset;
2806b45b7749SMilanka Ringwald     gatt_client->attribute_value = value;
2807052dc82aSMatthias Ringwald     gatt_client->state = P_W2_PREPARE_WRITE;
28083deb3ec6SMatthias Ringwald     gatt_client_run();
280925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
28103deb3ec6SMatthias Ringwald }
28113deb3ec6SMatthias Ringwald 
2812711e6c80SMatthias 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){
28139c662c9bSMatthias Ringwald     return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value);
28143deb3ec6SMatthias Ringwald }
28153deb3ec6SMatthias Ringwald 
2816711e6c80SMatthias 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){
281740faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2818de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
281940faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
282040faeb84SMilanka Ringwald         return status;
282140faeb84SMilanka Ringwald     }
28223deb3ec6SMatthias Ringwald 
28235cf1669fSMatthias Ringwald     gatt_client->callback = callback;
28245cf1669fSMatthias Ringwald     gatt_client->attribute_handle = value_handle;
28255cf1669fSMatthias Ringwald     gatt_client->attribute_length = value_length;
28265cf1669fSMatthias Ringwald     gatt_client->attribute_offset = 0;
28275cf1669fSMatthias Ringwald     gatt_client->attribute_value = value;
2828052dc82aSMatthias Ringwald     gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE;
28293deb3ec6SMatthias Ringwald     gatt_client_run();
283025b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
28313deb3ec6SMatthias Ringwald }
28323deb3ec6SMatthias Ringwald 
2833711e6c80SMatthias 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){
283440faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2835de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
283640faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
283740faeb84SMilanka Ringwald         return status;
283840faeb84SMilanka Ringwald     }
28393deb3ec6SMatthias Ringwald 
28408915696fSMilanka Ringwald     if (configuration > 3){
28418915696fSMilanka Ringwald         return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
28428915696fSMilanka Ringwald     }
28438915696fSMilanka Ringwald 
28443deb3ec6SMatthias Ringwald     if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) &&
28454ea43905SMatthias Ringwald         ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) {
2846d8e8f12aSMatthias Ringwald         log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED");
2847616edd56SMatthias Ringwald         return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED;
28483deb3ec6SMatthias Ringwald     } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) &&
28494ea43905SMatthias Ringwald                ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){
2850d8e8f12aSMatthias Ringwald         log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED");
2851616edd56SMatthias Ringwald         return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED;
28523deb3ec6SMatthias Ringwald     }
28533deb3ec6SMatthias Ringwald 
28545cf1669fSMatthias Ringwald     gatt_client->callback = callback;
28555cf1669fSMatthias Ringwald     gatt_client->start_group_handle = characteristic->value_handle;
28565cf1669fSMatthias Ringwald     gatt_client->end_group_handle = characteristic->end_handle;
28575cf1669fSMatthias Ringwald     little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration);
28583deb3ec6SMatthias Ringwald 
2859abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY
28605cf1669fSMatthias Ringwald     gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY;
2861abdc9fb5SMatthias Ringwald #else
2862052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY;
2863abdc9fb5SMatthias Ringwald #endif
28643deb3ec6SMatthias Ringwald     gatt_client_run();
28659cb80b17SMilanka Ringwald     return ERROR_CODE_SUCCESS;
28663deb3ec6SMatthias Ringwald }
28673deb3ec6SMatthias Ringwald 
2868711e6c80SMatthias 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){
286940faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2870de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
287140faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
287240faeb84SMilanka Ringwald         return status;
287340faeb84SMilanka Ringwald     }
28743deb3ec6SMatthias Ringwald 
28755cf1669fSMatthias Ringwald     gatt_client->callback = callback;
28765cf1669fSMatthias Ringwald     gatt_client->attribute_handle = descriptor_handle;
28773deb3ec6SMatthias Ringwald 
2878052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY;
28793deb3ec6SMatthias Ringwald     gatt_client_run();
288025b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
28813deb3ec6SMatthias Ringwald }
28823deb3ec6SMatthias Ringwald 
2883711e6c80SMatthias 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){
28849c662c9bSMatthias Ringwald     return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle);
28853deb3ec6SMatthias Ringwald }
28863deb3ec6SMatthias Ringwald 
2887711e6c80SMatthias 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){
288840faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2889de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
289040faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
289140faeb84SMilanka Ringwald         return status;
289240faeb84SMilanka Ringwald     }
28933deb3ec6SMatthias Ringwald 
28945cf1669fSMatthias Ringwald     gatt_client->callback = callback;
28955cf1669fSMatthias Ringwald     gatt_client->attribute_handle = descriptor_handle;
28965cf1669fSMatthias Ringwald     gatt_client->attribute_offset = offset;
2897052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY;
28983deb3ec6SMatthias Ringwald     gatt_client_run();
289925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
29003deb3ec6SMatthias Ringwald }
29013deb3ec6SMatthias Ringwald 
2902711e6c80SMatthias 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){
29039c662c9bSMatthias Ringwald     return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0);
29043deb3ec6SMatthias Ringwald }
29053deb3ec6SMatthias Ringwald 
2906711e6c80SMatthias 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){
29079c662c9bSMatthias Ringwald     return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle);
29083deb3ec6SMatthias Ringwald }
29093deb3ec6SMatthias Ringwald 
2910b45b7749SMilanka 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 value_length, uint8_t * value){
291140faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2912de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
291340faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
291440faeb84SMilanka Ringwald         return status;
291540faeb84SMilanka Ringwald     }
29163deb3ec6SMatthias Ringwald 
29175cf1669fSMatthias Ringwald     gatt_client->callback = callback;
29185cf1669fSMatthias Ringwald     gatt_client->attribute_handle = descriptor_handle;
2919b45b7749SMilanka Ringwald     gatt_client->attribute_length = value_length;
29205cf1669fSMatthias Ringwald     gatt_client->attribute_offset = 0;
2921b45b7749SMilanka Ringwald     gatt_client->attribute_value = value;
2922052dc82aSMatthias Ringwald     gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR;
29233deb3ec6SMatthias Ringwald     gatt_client_run();
292425b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
29253deb3ec6SMatthias Ringwald }
29263deb3ec6SMatthias Ringwald 
292748cdff9cSMilanka 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 value_length, uint8_t * value){
292848cdff9cSMilanka Ringwald     return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value);
29293deb3ec6SMatthias Ringwald }
29303deb3ec6SMatthias Ringwald 
2931b45b7749SMilanka 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 value_length, uint8_t * value){
293240faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2933de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
293440faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
293540faeb84SMilanka Ringwald         return status;
293640faeb84SMilanka Ringwald     }
29373deb3ec6SMatthias Ringwald 
29385cf1669fSMatthias Ringwald     gatt_client->callback = callback;
29395cf1669fSMatthias Ringwald     gatt_client->attribute_handle = descriptor_handle;
2940b45b7749SMilanka Ringwald     gatt_client->attribute_length = value_length;
29415cf1669fSMatthias Ringwald     gatt_client->attribute_offset = offset;
2942b45b7749SMilanka Ringwald     gatt_client->attribute_value = value;
2943052dc82aSMatthias Ringwald     gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR;
29443deb3ec6SMatthias Ringwald     gatt_client_run();
294525b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
29463deb3ec6SMatthias Ringwald }
29473deb3ec6SMatthias Ringwald 
2948b45b7749SMilanka 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 value_length, uint8_t * value){
2949b45b7749SMilanka Ringwald     return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value);
29503deb3ec6SMatthias Ringwald }
29513deb3ec6SMatthias Ringwald 
2952b45b7749SMilanka 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 value_length, uint8_t * value){
2953b45b7749SMilanka Ringwald     return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value);
29543deb3ec6SMatthias Ringwald }
29553deb3ec6SMatthias Ringwald 
29563deb3ec6SMatthias Ringwald /**
29573deb3ec6SMatthias Ringwald  * @brief -> gatt complete event
29583deb3ec6SMatthias Ringwald  */
2959b45b7749SMilanka 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 value_length, uint8_t * value){
296040faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2961de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
296240faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
296340faeb84SMilanka Ringwald         return status;
296440faeb84SMilanka Ringwald     }
29653deb3ec6SMatthias Ringwald 
29665cf1669fSMatthias Ringwald     gatt_client->callback = callback;
29675cf1669fSMatthias Ringwald     gatt_client->attribute_handle = attribute_handle;
2968b45b7749SMilanka Ringwald     gatt_client->attribute_length = value_length;
29695cf1669fSMatthias Ringwald     gatt_client->attribute_offset = offset;
2970b45b7749SMilanka Ringwald     gatt_client->attribute_value = value;
2971052dc82aSMatthias Ringwald     gatt_client->state = P_W2_PREPARE_WRITE_SINGLE;
29723deb3ec6SMatthias Ringwald     gatt_client_run();
297325b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
29743deb3ec6SMatthias Ringwald }
29753deb3ec6SMatthias Ringwald 
29763deb3ec6SMatthias Ringwald /**
29773deb3ec6SMatthias Ringwald  * @brief -> gatt complete event
29783deb3ec6SMatthias Ringwald  */
2979711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
298040faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2981de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
298240faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
298340faeb84SMilanka Ringwald         return status;
298440faeb84SMilanka Ringwald     }
29853deb3ec6SMatthias Ringwald 
29865cf1669fSMatthias Ringwald     gatt_client->callback = callback;
2987052dc82aSMatthias Ringwald     gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE;
29883deb3ec6SMatthias Ringwald     gatt_client_run();
298925b7c058SMilanka Ringwald     return ERROR_CODE_SUCCESS;
29903deb3ec6SMatthias Ringwald }
29913deb3ec6SMatthias Ringwald 
29923deb3ec6SMatthias Ringwald /**
29933deb3ec6SMatthias Ringwald  * @brief -> gatt complete event
29943deb3ec6SMatthias Ringwald  */
2995711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
299640faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
2997de27733dSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client);
299840faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
299940faeb84SMilanka Ringwald         return status;
300040faeb84SMilanka Ringwald     }
30013deb3ec6SMatthias Ringwald 
30025cf1669fSMatthias Ringwald     gatt_client->callback = callback;
3003052dc82aSMatthias Ringwald     gatt_client->state = P_W2_CANCEL_PREPARED_WRITE;
30043deb3ec6SMatthias Ringwald     gatt_client_run();
30057d2258b3SMilanka Ringwald     return ERROR_CODE_SUCCESS;
30063deb3ec6SMatthias Ringwald }
30073deb3ec6SMatthias Ringwald 
3008313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){
30096ba2ad22SMatthias Ringwald     service->start_group_handle = little_endian_read_16(packet, offset);
30106ba2ad22SMatthias Ringwald     service->end_group_handle = little_endian_read_16(packet, offset + 2);
30116ba2ad22SMatthias Ringwald     reverse_128(&packet[offset + 4], service->uuid128);
30126ba2ad22SMatthias Ringwald     if (uuid_has_bluetooth_prefix(service->uuid128)){
30136ba2ad22SMatthias Ringwald         service->uuid16 = big_endian_read_32(service->uuid128, 0);
3014c839c6f9SMatthias Ringwald     } else {
3015c839c6f9SMatthias Ringwald         service->uuid16 = 0;
30166ba2ad22SMatthias Ringwald     }
30176ba2ad22SMatthias Ringwald }
30186ba2ad22SMatthias Ringwald 
3019313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){
30206ba2ad22SMatthias Ringwald     characteristic->start_handle = little_endian_read_16(packet, offset);
30216ba2ad22SMatthias Ringwald     characteristic->value_handle = little_endian_read_16(packet, offset + 2);
30226ba2ad22SMatthias Ringwald     characteristic->end_handle = little_endian_read_16(packet, offset + 4);
30236ba2ad22SMatthias Ringwald     characteristic->properties = little_endian_read_16(packet, offset + 6);
302486c38559SMatthias Ringwald     reverse_128(&packet[offset+8], characteristic->uuid128);
30256ba2ad22SMatthias Ringwald     if (uuid_has_bluetooth_prefix(characteristic->uuid128)){
30266ba2ad22SMatthias Ringwald         characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0);
3027c839c6f9SMatthias Ringwald     } else {
3028c839c6f9SMatthias Ringwald         characteristic->uuid16 = 0;
30296ba2ad22SMatthias Ringwald     }
30306ba2ad22SMatthias Ringwald }
30316ba2ad22SMatthias Ringwald 
3032313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){
30336ba2ad22SMatthias Ringwald     descriptor->handle = little_endian_read_16(packet, offset);
30346ba2ad22SMatthias Ringwald     reverse_128(&packet[offset+2], descriptor->uuid128);
3035b4895529SJakob Krantz     if (uuid_has_bluetooth_prefix(descriptor->uuid128)){
3036b4895529SJakob Krantz         descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0);
3037c839c6f9SMatthias Ringwald     } else {
3038c839c6f9SMatthias Ringwald         descriptor->uuid16 = 0;
3039b4895529SJakob Krantz     }
30406ba2ad22SMatthias Ringwald }
30415cf6c434SJakob Krantz 
30425cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
304340faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
304440faeb84SMilanka Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
304540faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
304640faeb84SMilanka Ringwald         return;
304740faeb84SMilanka Ringwald     }
304840faeb84SMilanka Ringwald     if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){
304940faeb84SMilanka Ringwald         gatt_client->callback = callback;
305040faeb84SMilanka Ringwald         gatt_client->mtu_state = SEND_MTU_EXCHANGE;
30515cf6c434SJakob Krantz         gatt_client_run();
30525cf6c434SJakob Krantz     }
30535cf6c434SJakob Krantz }
305447181045SMatthias Ringwald 
305559d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){
305659d34cd2SMatthias Ringwald     gatt_client_t * gatt_client;
305759d34cd2SMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
305859d34cd2SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
305959d34cd2SMatthias Ringwald         return status;
306059d34cd2SMatthias Ringwald     }
306159d34cd2SMatthias Ringwald     bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration);
30622832a98aSMatthias Ringwald     if (added == false){
306359d34cd2SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
30642832a98aSMatthias Ringwald     } else {
30652832a98aSMatthias Ringwald         att_dispatch_client_request_can_send_now_event(gatt_client->con_handle);
30662832a98aSMatthias Ringwald         return ERROR_CODE_SUCCESS;
306759d34cd2SMatthias Ringwald     }
306859d34cd2SMatthias Ringwald }
306959d34cd2SMatthias Ringwald 
307053e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){
307153e9c18fSMatthias Ringwald     gatt_client_t * gatt_client;
307253e9c18fSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
307353e9c18fSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
307453e9c18fSMatthias Ringwald         return status;
307553e9c18fSMatthias Ringwald     }
307653e9c18fSMatthias Ringwald     bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration);
30772832a98aSMatthias Ringwald     if (added == false){
307853e9c18fSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
30792832a98aSMatthias Ringwald     } else {
30802832a98aSMatthias Ringwald         gatt_client_notify_can_send_query(gatt_client);
30812832a98aSMatthias Ringwald         return ERROR_CODE_SUCCESS;
308253e9c18fSMatthias Ringwald     }
308353e9c18fSMatthias Ringwald }
308453e9c18fSMatthias Ringwald 
308548553f67SDirk Helbig uint8_t gatt_client_remove_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){
308648553f67SDirk Helbig     gatt_client_t * gatt_client;
308748553f67SDirk Helbig     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
308848553f67SDirk Helbig     if (status != ERROR_CODE_SUCCESS){
308948553f67SDirk Helbig         return status;
309048553f67SDirk Helbig     }
309148553f67SDirk Helbig     (void)btstack_linked_list_remove(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration);
309248553f67SDirk Helbig     return ERROR_CODE_SUCCESS;
309348553f67SDirk Helbig }
309448553f67SDirk Helbig 
309547181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
309640faeb84SMilanka Ringwald     gatt_client_t * gatt_client;
309740faeb84SMilanka Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
309840faeb84SMilanka Ringwald     if (status != ERROR_CODE_SUCCESS){
309940faeb84SMilanka Ringwald         return status;
310040faeb84SMilanka Ringwald     }
310140faeb84SMilanka Ringwald     if (gatt_client->write_without_response_callback != NULL){
310240faeb84SMilanka Ringwald         return GATT_CLIENT_IN_WRONG_STATE;
310340faeb84SMilanka Ringwald     }
310440faeb84SMilanka Ringwald     gatt_client->write_without_response_callback = callback;
310540faeb84SMilanka Ringwald     att_dispatch_client_request_can_send_now_event(gatt_client->con_handle);
31067d2258b3SMilanka Ringwald     return ERROR_CODE_SUCCESS;
310747181045SMatthias Ringwald }
3108842492f0SMatthias Ringwald 
3109842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED
311058e8c9f5SMatthias Ringwald void gatt_client_add_service_changed_handler(btstack_packet_callback_registration_t * callback) {
311158e8c9f5SMatthias Ringwald     btstack_linked_list_add_tail(&gatt_client_service_changed_handler, (btstack_linked_item_t*) callback);
311258e8c9f5SMatthias Ringwald }
3113a6121b51SMilanka Ringwald 
311458e8c9f5SMatthias Ringwald void gatt_client_remove_service_changed_handler(btstack_packet_callback_registration_t * callback){
311558e8c9f5SMatthias Ringwald     btstack_linked_list_remove(&gatt_client_service_changed_handler, (btstack_linked_item_t*) callback);
311658e8c9f5SMatthias Ringwald }
3117842492f0SMatthias Ringwald #endif
31187627a0deSMatthias Ringwald 
31197627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT)
31201450cdc6SMatthias Ringwald 
31211450cdc6SMatthias Ringwald #include "hci_event.h"
31221450cdc6SMatthias Ringwald 
31231450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = {
3124b2d70d58SMatthias Ringwald         GATT_EVENT_CONNECTED, 0, "11BH"
31251450cdc6SMatthias Ringwald };
31261450cdc6SMatthias Ringwald 
31276b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = {
31286b4a68c3SMatthias Ringwald         GATT_EVENT_DISCONNECTED, 0, "H"
31296b4a68c3SMatthias Ringwald };
31301c7a19feSMatthias Ringwald 
3131b2d70d58SMatthias Ringwald static void
3132b2d70d58SMatthias Ringwald gatt_client_emit_connected(btstack_packet_handler_t callback, uint8_t status, bd_addr_type_t addr_type, bd_addr_t addr,
31331c7a19feSMatthias Ringwald                            hci_con_handle_t con_handle) {
31341c7a19feSMatthias Ringwald     uint8_t buffer[20];
31351c7a19feSMatthias Ringwald     uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, con_handle);
31361c7a19feSMatthias Ringwald     (*callback)(HCI_EVENT_PACKET, 0, buffer, len);
31371c7a19feSMatthias Ringwald }
31381c7a19feSMatthias Ringwald 
31397627a0deSMatthias Ringwald #endif
31407627a0deSMatthias Ringwald 
31417627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC
31427627a0deSMatthias Ringwald 
31437627a0deSMatthias Ringwald #include "bluetooth_psm.h"
31447627a0deSMatthias Ringwald 
31457627a0deSMatthias Ringwald // single active SDP query
31467627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query;
31477627a0deSMatthias Ringwald 
31487627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes
31497627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32];
31507627a0deSMatthias Ringwald 
31516b4a68c3SMatthias Ringwald 
31521450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){
31531450cdc6SMatthias Ringwald     btstack_linked_item_t *it;
31541450cdc6SMatthias Ringwald     for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){
31551450cdc6SMatthias Ringwald         gatt_client_t * gatt_client = (gatt_client_t *) it;
31561450cdc6SMatthias Ringwald         if (memcmp(gatt_client->addr, addr, 6) == 0){
31571450cdc6SMatthias Ringwald             return gatt_client;
31581450cdc6SMatthias Ringwald         }
31591450cdc6SMatthias Ringwald     }
31601450cdc6SMatthias Ringwald     return NULL;
31611450cdc6SMatthias Ringwald }
31621450cdc6SMatthias Ringwald 
31631450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){
31641450cdc6SMatthias Ringwald     btstack_linked_item_t *it;
31651450cdc6SMatthias Ringwald     for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){
31661450cdc6SMatthias Ringwald         gatt_client_t * gatt_client = (gatt_client_t *) it;
31671450cdc6SMatthias Ringwald         if (gatt_client->l2cap_cid == l2cap_cid){
31681450cdc6SMatthias Ringwald             return gatt_client;
31691450cdc6SMatthias Ringwald         }
31701450cdc6SMatthias Ringwald     }
31711450cdc6SMatthias Ringwald     return NULL;
31721450cdc6SMatthias Ringwald }
31731450cdc6SMatthias Ringwald 
31741450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){
3175b2d70d58SMatthias Ringwald     // cache peer information
31761450cdc6SMatthias Ringwald     bd_addr_t addr;
3177d5529700SMatthias Ringwald     // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy
31781450cdc6SMatthias Ringwald     memcpy(addr, gatt_client->addr, 6);
3179b2d70d58SMatthias Ringwald     bd_addr_type_t addr_type = gatt_client->addr_type;
3180b2d70d58SMatthias Ringwald     gatt_client->addr_type = BD_ADDR_TYPE_ACL;
31811450cdc6SMatthias Ringwald     hci_con_handle_t con_handle = gatt_client->con_handle;
31821450cdc6SMatthias Ringwald     btstack_packet_handler_t callback = gatt_client->callback;
3183b2d70d58SMatthias Ringwald 
31849ed6f53cSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
31853b0e0cc5SMatthias Ringwald         btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client);
31863b0e0cc5SMatthias Ringwald         btstack_memory_gatt_client_free(gatt_client);
31873b0e0cc5SMatthias Ringwald     }
3188b2d70d58SMatthias Ringwald 
3189b2d70d58SMatthias Ringwald     gatt_client_emit_connected(callback, status, addr_type, addr, con_handle);
31901450cdc6SMatthias Ringwald }
31911450cdc6SMatthias Ringwald 
3192180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts){
3193180cbe79SMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_for_timer(ts);
3194180cbe79SMatthias Ringwald     if (gatt_client != NULL){
3195180cbe79SMatthias Ringwald         gatt_client->state = P_W4_L2CAP_CONNECTION;
3196180cbe79SMatthias Ringwald         att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid);
3197180cbe79SMatthias Ringwald     }
3198180cbe79SMatthias Ringwald }
3199180cbe79SMatthias Ringwald 
32006b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){
32016b4a68c3SMatthias Ringwald 
32026b4a68c3SMatthias Ringwald     gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED);
32036b4a68c3SMatthias Ringwald     gatt_client_timeout_stop(gatt_client);
32046b4a68c3SMatthias Ringwald 
32056b4a68c3SMatthias Ringwald     hci_con_handle_t con_handle = gatt_client->con_handle;
32066b4a68c3SMatthias Ringwald     btstack_packet_handler_t callback = gatt_client->callback;
32076b4a68c3SMatthias Ringwald     btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client);
32086b4a68c3SMatthias Ringwald     btstack_memory_gatt_client_free(gatt_client);
32096b4a68c3SMatthias Ringwald 
32106b4a68c3SMatthias Ringwald     uint8_t buffer[20];
32116b4a68c3SMatthias Ringwald     uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle);
32126b4a68c3SMatthias Ringwald     (*callback)(HCI_EVENT_PACKET, 0, buffer, len);
32136b4a68c3SMatthias Ringwald }
32146b4a68c3SMatthias Ringwald 
32151450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){
32161450cdc6SMatthias Ringwald     des_iterator_t des_list_it;
32171450cdc6SMatthias Ringwald     des_iterator_t prot_it;
32181450cdc6SMatthias Ringwald 
32191450cdc6SMatthias Ringwald     if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) {
32201450cdc6SMatthias Ringwald         gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet);
32211450cdc6SMatthias Ringwald         if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) {
32221450cdc6SMatthias Ringwald             switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) {
32231450cdc6SMatthias Ringwald                 case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST:
32241450cdc6SMatthias Ringwald                     for (des_iterator_init(&des_list_it, gatt_client_classic_sdp_buffer); des_iterator_has_more(&des_list_it); des_iterator_next(&des_list_it)) {
32251450cdc6SMatthias Ringwald                         uint8_t       *des_element;
32261450cdc6SMatthias Ringwald                         uint8_t       *element;
32271450cdc6SMatthias Ringwald                         uint32_t       uuid;
32281450cdc6SMatthias Ringwald 
32291450cdc6SMatthias Ringwald                         if (des_iterator_get_type(&des_list_it) != DE_DES) continue;
32301450cdc6SMatthias Ringwald 
32311450cdc6SMatthias Ringwald                         des_element = des_iterator_get_element(&des_list_it);
32321450cdc6SMatthias Ringwald                         des_iterator_init(&prot_it, des_element);
32331450cdc6SMatthias Ringwald                         element = des_iterator_get_element(&prot_it);
32341450cdc6SMatthias Ringwald 
32351450cdc6SMatthias Ringwald                         if (de_get_element_type(element) != DE_UUID) continue;
32361450cdc6SMatthias Ringwald 
32371450cdc6SMatthias Ringwald                         uuid = de_get_uuid32(element);
32381450cdc6SMatthias Ringwald                         des_iterator_next(&prot_it);
32391450cdc6SMatthias Ringwald                         // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both
32401450cdc6SMatthias Ringwald                         switch (uuid){
32411450cdc6SMatthias Ringwald                             case BLUETOOTH_PROTOCOL_L2CAP:
32421450cdc6SMatthias Ringwald                                 if (!des_iterator_has_more(&prot_it)) continue;
32431450cdc6SMatthias Ringwald                                 de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm);
32441450cdc6SMatthias Ringwald                                 break;
32451450cdc6SMatthias Ringwald                             default:
32461450cdc6SMatthias Ringwald                                 break;
32471450cdc6SMatthias Ringwald                         }
32481450cdc6SMatthias Ringwald                     }
32491450cdc6SMatthias Ringwald                     break;
32501450cdc6SMatthias Ringwald 
32511450cdc6SMatthias Ringwald                 default:
32521450cdc6SMatthias Ringwald                     break;
32531450cdc6SMatthias Ringwald             }
32541450cdc6SMatthias Ringwald         }
32551450cdc6SMatthias Ringwald     }
32561450cdc6SMatthias Ringwald }
32571450cdc6SMatthias Ringwald 
32581450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){
32591450cdc6SMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query;
32601450cdc6SMatthias Ringwald     btstack_assert(gatt_client != NULL);
32611450cdc6SMatthias Ringwald     uint8_t status;
32621450cdc6SMatthias Ringwald 
32631450cdc6SMatthias Ringwald     // TODO: handle sdp events, get l2cap psm
32641450cdc6SMatthias Ringwald     switch (hci_event_packet_get_type(packet)){
32651450cdc6SMatthias Ringwald         case SDP_EVENT_QUERY_ATTRIBUTE_VALUE:
32661450cdc6SMatthias Ringwald             gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet);
32671450cdc6SMatthias Ringwald             // TODO:
32681450cdc6SMatthias Ringwald             return;
32691450cdc6SMatthias Ringwald         case SDP_EVENT_QUERY_COMPLETE:
32701450cdc6SMatthias Ringwald             status = sdp_event_query_complete_get_status(packet);
32711450cdc6SMatthias Ringwald             gatt_client_classic_active_sdp_query = NULL;
32721450cdc6SMatthias Ringwald             log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status);
32731450cdc6SMatthias Ringwald             if (status != ERROR_CODE_SUCCESS) break;
32741450cdc6SMatthias Ringwald             if (gatt_client->l2cap_psm == 0) {
32751450cdc6SMatthias Ringwald                 status = SDP_SERVICE_NOT_FOUND;
32761450cdc6SMatthias Ringwald                 break;
32771450cdc6SMatthias Ringwald             }
32781450cdc6SMatthias Ringwald             break;
32791450cdc6SMatthias Ringwald         default:
32801450cdc6SMatthias Ringwald             btstack_assert(false);
32811450cdc6SMatthias Ringwald             return;
32821450cdc6SMatthias Ringwald     }
32831450cdc6SMatthias Ringwald 
32841450cdc6SMatthias Ringwald     // done
32851450cdc6SMatthias Ringwald     if (status == ERROR_CODE_SUCCESS){
3286052dc82aSMatthias Ringwald         gatt_client->state = P_W4_L2CAP_CONNECTION;
328759b5e157SMatthias Ringwald         status = att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid);
32881450cdc6SMatthias Ringwald     }
32891450cdc6SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS) {
32901450cdc6SMatthias Ringwald         gatt_client_classic_handle_connected(gatt_client, status);
32911450cdc6SMatthias Ringwald     }
32921450cdc6SMatthias Ringwald }
32931450cdc6SMatthias Ringwald 
32941450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){
32951450cdc6SMatthias Ringwald     gatt_client_classic_active_sdp_query = (gatt_client_t *) context;
3296052dc82aSMatthias Ringwald     gatt_client_classic_active_sdp_query->state = P_W4_SDP_QUERY;
32971450cdc6SMatthias Ringwald     sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE);
32981450cdc6SMatthias Ringwald }
32991450cdc6SMatthias Ringwald 
330074daebdeSMatthias Ringwald static void gatt_client_classic_emit_connected(void * context){
330174daebdeSMatthias Ringwald     gatt_client_t * gatt_client = (gatt_client_t *) context;
3302052dc82aSMatthias Ringwald     gatt_client->state = P_READY;
3303b2d70d58SMatthias Ringwald     gatt_client_emit_connected(gatt_client->callback, ERROR_CODE_SUCCESS, gatt_client->addr_type, gatt_client->addr, gatt_client->con_handle);
330474daebdeSMatthias Ringwald }
330574daebdeSMatthias Ringwald 
33061450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){
33071450cdc6SMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr);
33081450cdc6SMatthias Ringwald     if (gatt_client != NULL){
33091450cdc6SMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
33101450cdc6SMatthias Ringwald     }
33111450cdc6SMatthias Ringwald     gatt_client = btstack_memory_gatt_client_get();
33121450cdc6SMatthias Ringwald     if (gatt_client == NULL){
33131450cdc6SMatthias Ringwald         return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
33141450cdc6SMatthias Ringwald     }
33151450cdc6SMatthias Ringwald     // init state
3316e9cdf30bSMatthias Ringwald     gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC;
33171450cdc6SMatthias Ringwald     gatt_client->con_handle = HCI_CON_HANDLE_INVALID;
33181450cdc6SMatthias Ringwald     memcpy(gatt_client->addr, addr, 6);
3319b2d70d58SMatthias Ringwald     gatt_client->addr_type = BD_ADDR_TYPE_ACL;
33201450cdc6SMatthias Ringwald     gatt_client->mtu = ATT_DEFAULT_MTU;
33211450cdc6SMatthias Ringwald     gatt_client->security_level = LEVEL_0;
33221450cdc6SMatthias Ringwald     gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED;
33231450cdc6SMatthias Ringwald     gatt_client->callback = callback;
3324cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
3325cbd76cecSMatthias Ringwald     gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE;
3326cbd76cecSMatthias Ringwald #endif
33271450cdc6SMatthias Ringwald     btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client);
332874daebdeSMatthias Ringwald 
332974daebdeSMatthias Ringwald     // schedule emitted event if already connected, otherwise
333074daebdeSMatthias Ringwald     bool already_connected = false;
333174daebdeSMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
333274daebdeSMatthias Ringwald     if (hci_connection != NULL){
333374daebdeSMatthias Ringwald         if (hci_connection->att_server.l2cap_cid != 0){
333474daebdeSMatthias Ringwald             already_connected = true;
333574daebdeSMatthias Ringwald         }
333674daebdeSMatthias Ringwald     }
3337052dc82aSMatthias Ringwald     gatt_client->callback_request.context = gatt_client;
333874daebdeSMatthias Ringwald     if (already_connected){
333974daebdeSMatthias Ringwald         gatt_client->con_handle = hci_connection->con_handle;
3340052dc82aSMatthias Ringwald         gatt_client->callback_request.callback = &gatt_client_classic_emit_connected;
3341052dc82aSMatthias Ringwald         gatt_client->state = P_W2_EMIT_CONNECTED;
3342052dc82aSMatthias Ringwald         btstack_run_loop_execute_on_main_thread(&gatt_client->callback_request);
334374daebdeSMatthias Ringwald     } else {
3344052dc82aSMatthias Ringwald         gatt_client->callback_request.callback = &gatt_client_classic_sdp_start;
3345052dc82aSMatthias Ringwald         gatt_client->state = P_W2_SDP_QUERY;
3346052dc82aSMatthias Ringwald         sdp_client_register_query_callback(&gatt_client->callback_request);
334774daebdeSMatthias Ringwald     }
3348b7b03a30SMatthias Ringwald     return ERROR_CODE_SUCCESS;
33491450cdc6SMatthias Ringwald }
33501450cdc6SMatthias Ringwald 
33511450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){
33521450cdc6SMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle);
33531450cdc6SMatthias Ringwald     if (gatt_client == NULL){
33541450cdc6SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
33551450cdc6SMatthias Ringwald     }
33561450cdc6SMatthias Ringwald     gatt_client->callback = callback;
33571450cdc6SMatthias Ringwald     return l2cap_disconnect(gatt_client->l2cap_cid);
33581450cdc6SMatthias Ringwald }
33591450cdc6SMatthias Ringwald #endif
33601450cdc6SMatthias Ringwald 
336126166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT
336226166ecfSMatthias Ringwald 
336326166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5
33647627a0deSMatthias Ringwald 
33657627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size);
33667627a0deSMatthias Ringwald 
3367df0a5c68SMatthias Ringwald static uint8_t gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client_t * gatt_client, gatt_client_state_t state){
3368df0a5c68SMatthias Ringwald     uint8_t num_clients = 0;
3369df0a5c68SMatthias Ringwald     btstack_linked_list_iterator_t it;
3370df0a5c68SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients);
3371df0a5c68SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
3372df0a5c68SMatthias Ringwald         gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
3373df0a5c68SMatthias Ringwald         if (eatt_client->state == state){
3374df0a5c68SMatthias Ringwald             num_clients++;
3375df0a5c68SMatthias Ringwald         }
3376df0a5c68SMatthias Ringwald     }
3377df0a5c68SMatthias Ringwald     return num_clients;
3378df0a5c68SMatthias Ringwald }
3379df0a5c68SMatthias Ringwald 
33807627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) {
33817627a0deSMatthias Ringwald     // free eatt clients
33827627a0deSMatthias Ringwald     btstack_linked_list_iterator_t it;
33837627a0deSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_connections);
33847627a0deSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
33857627a0deSMatthias Ringwald         gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
33867627a0deSMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
33877627a0deSMatthias Ringwald         btstack_memory_gatt_client_free(eatt_client);
33887627a0deSMatthias Ringwald     }
33897627a0deSMatthias Ringwald }
33907627a0deSMatthias Ringwald 
33917627a0deSMatthias Ringwald // all channels connected
33927627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) {
33937627a0deSMatthias Ringwald     if (status == ERROR_CODE_SUCCESS){
3394df0a5c68SMatthias Ringwald         uint8_t num_ready = gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_READY);
3395df0a5c68SMatthias Ringwald         if (num_ready > 0){
33967627a0deSMatthias Ringwald             gatt_client->eatt_state = GATT_CLIENT_EATT_READY;
3397df0a5c68SMatthias Ringwald             // free unused channels
3398df0a5c68SMatthias Ringwald             btstack_linked_list_iterator_t it;
3399df0a5c68SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &gatt_client_connections);
3400df0a5c68SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
3401df0a5c68SMatthias Ringwald                 gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
3402df0a5c68SMatthias Ringwald                 if (eatt_client->state == P_L2CAP_CLOSED){
3403df0a5c68SMatthias Ringwald                     btstack_linked_list_iterator_remove(&it);
3404df0a5c68SMatthias Ringwald                     btstack_memory_gatt_client_free(eatt_client);
3405df0a5c68SMatthias Ringwald                 }
3406df0a5c68SMatthias Ringwald             }
3407df0a5c68SMatthias Ringwald         } else {
34086d0f6f49SMatthias Ringwald             hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle);
34096d0f6f49SMatthias Ringwald             btstack_assert(hci_connection != NULL);
34106d0f6f49SMatthias Ringwald             if (hci_connection->att_server.incoming_connection_request){
34116d0f6f49SMatthias Ringwald                 hci_connection->att_server.incoming_connection_request = false;
34126d0f6f49SMatthias Ringwald                 log_info("Collision, retry in 100ms");
34136d0f6f49SMatthias Ringwald                 gatt_client->state = P_W2_L2CAP_CONNECT;
34146d0f6f49SMatthias Ringwald                 // set timer for retry
3415b1da4983SMatthias Ringwald                 btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS);
34166d0f6f49SMatthias Ringwald                 btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_le_enhanced_retry);
34176d0f6f49SMatthias Ringwald                 btstack_run_loop_add_timer(&gatt_client->gc_timeout);
34186d0f6f49SMatthias Ringwald                 return;
34196d0f6f49SMatthias Ringwald             } else {
3420df0a5c68SMatthias Ringwald                 gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE;
3421df0a5c68SMatthias Ringwald                 status = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES;
3422df0a5c68SMatthias Ringwald             }
34236d0f6f49SMatthias Ringwald         }
34247627a0deSMatthias Ringwald     } else {
34257627a0deSMatthias Ringwald         gatt_client_eatt_finalize(gatt_client);
34267627a0deSMatthias Ringwald         gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE;
34277627a0deSMatthias Ringwald     }
34287627a0deSMatthias Ringwald 
3429b2d70d58SMatthias Ringwald     gatt_client_emit_connected(gatt_client->callback, status, gatt_client->addr_type, gatt_client->addr, gatt_client->con_handle);
34307627a0deSMatthias Ringwald }
34317627a0deSMatthias Ringwald 
34327627a0deSMatthias Ringwald // single channel disconnected
34337627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) {
34347627a0deSMatthias Ringwald 
34357627a0deSMatthias Ringwald     // report error
34367627a0deSMatthias Ringwald     gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED);
34377627a0deSMatthias Ringwald 
34387627a0deSMatthias Ringwald     // free memory
34397627a0deSMatthias Ringwald     btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client);
34407627a0deSMatthias Ringwald     btstack_memory_gatt_client_free(eatt_client);
34417627a0deSMatthias Ringwald 
3442570bdd2dSMatthias Ringwald     // last channel
34437627a0deSMatthias Ringwald     if (btstack_linked_list_empty(&gatt_client->eatt_clients)){
3444570bdd2dSMatthias Ringwald         hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle);
3445570bdd2dSMatthias Ringwald         hci_connection->att_server.eatt_outgoing_active = false;
3446570bdd2dSMatthias Ringwald 
3447570bdd2dSMatthias Ringwald         if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) {
3448570bdd2dSMatthias Ringwald             // report disconnected if last channel closed
34497627a0deSMatthias Ringwald             uint8_t buffer[20];
34507627a0deSMatthias Ringwald             uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle);
34517627a0deSMatthias Ringwald             (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len);
34527627a0deSMatthias Ringwald         }
34537627a0deSMatthias Ringwald     }
34547627a0deSMatthias Ringwald }
34557627a0deSMatthias Ringwald 
34567627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){
34577627a0deSMatthias Ringwald     btstack_linked_list_iterator_t it;
34587627a0deSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &gatt_client_connections);
34597627a0deSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
34607627a0deSMatthias Ringwald         gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
34617627a0deSMatthias Ringwald         btstack_linked_list_iterator_t it2;
34627627a0deSMatthias Ringwald         btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients);
34637627a0deSMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it2)) {
34647627a0deSMatthias Ringwald             gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2);
34657627a0deSMatthias Ringwald             if (eatt_client->l2cap_cid == l2cap_cid){
34667627a0deSMatthias Ringwald                 *out_eatt_client = eatt_client;
34677627a0deSMatthias Ringwald                 return gatt_client;
34687627a0deSMatthias Ringwald             }
34697627a0deSMatthias Ringwald         }
34707627a0deSMatthias Ringwald     }
34717627a0deSMatthias Ringwald     return NULL;
34727627a0deSMatthias Ringwald }
34737627a0deSMatthias Ringwald 
34747627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){
34757627a0deSMatthias Ringwald     uint8_t num_channels = gatt_client->eatt_num_clients;
34767627a0deSMatthias Ringwald 
34777627a0deSMatthias Ringwald     // setup channels
34787627a0deSMatthias Ringwald     uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels;
3479f7a42e72SMatthias Ringwald     uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2;
34807627a0deSMatthias Ringwald     uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS];
34817627a0deSMatthias Ringwald     uint16_t  new_cids[MAX_NR_EATT_CHANNELS];
34827627a0deSMatthias Ringwald     memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size);
34837627a0deSMatthias Ringwald     uint8_t i;
34847627a0deSMatthias Ringwald     for (i=0;i<gatt_client->eatt_num_clients; i++){
3485f7a42e72SMatthias Ringwald         receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER];
3486f7a42e72SMatthias Ringwald         gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu;
34877627a0deSMatthias Ringwald     }
34887627a0deSMatthias Ringwald 
34897627a0deSMatthias Ringwald     log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client);
34907627a0deSMatthias Ringwald 
3491f7a42e72SMatthias Ringwald     uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler,
3492f7a42e72SMatthias Ringwald                                                 gatt_client->con_handle,
34937627a0deSMatthias Ringwald                                                 gatt_client->security_level,
3494f7a42e72SMatthias Ringwald                                                 BLUETOOTH_PSM_EATT, num_channels,
3495f7a42e72SMatthias Ringwald                                                 L2CAP_LE_AUTOMATIC_CREDITS,
34967627a0deSMatthias Ringwald                                                 buffer_size_per_client,
3497f7a42e72SMatthias Ringwald                                                 receive_buffers,
3498f7a42e72SMatthias Ringwald                                                 new_cids);
34997627a0deSMatthias Ringwald 
35007627a0deSMatthias Ringwald     if (status == ERROR_CODE_SUCCESS){
35017627a0deSMatthias Ringwald         i = 0;
35027627a0deSMatthias Ringwald         btstack_linked_list_iterator_t it;
35037627a0deSMatthias Ringwald         btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients);
35047627a0deSMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)) {
35057627a0deSMatthias Ringwald             gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it);
35067627a0deSMatthias Ringwald 
35077627a0deSMatthias Ringwald             // init state with new cid and transmit buffer
35087627a0deSMatthias Ringwald             new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE;
35097627a0deSMatthias Ringwald             new_eatt_client->con_handle = gatt_client->con_handle;
35107627a0deSMatthias Ringwald             new_eatt_client->mtu = 64;
35117627a0deSMatthias Ringwald             new_eatt_client->security_level = LEVEL_0;
35127627a0deSMatthias Ringwald             new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED;
3513052dc82aSMatthias Ringwald             new_eatt_client->state = P_W4_L2CAP_CONNECTION;
35147627a0deSMatthias Ringwald             new_eatt_client->l2cap_cid = new_cids[i];
35157627a0deSMatthias Ringwald             new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer;
3516f7a42e72SMatthias Ringwald             gatt_client->eatt_storage_buffer += max_mtu;
35177627a0deSMatthias Ringwald             i++;
35187627a0deSMatthias Ringwald         }
35197627a0deSMatthias Ringwald         gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP;
35207627a0deSMatthias Ringwald     } else {
35217627a0deSMatthias Ringwald         gatt_client_le_enhanced_handle_connected(gatt_client, status);
35227627a0deSMatthias Ringwald     }
352326166ecfSMatthias Ringwald }
352426166ecfSMatthias Ringwald 
35256d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts){
35266d0f6f49SMatthias Ringwald     gatt_client_t * gatt_client = gatt_client_for_timer(ts);
35276d0f6f49SMatthias Ringwald     if (gatt_client != NULL){
35286d0f6f49SMatthias Ringwald         gatt_client->state = P_W4_L2CAP_CONNECTION;
35296d0f6f49SMatthias Ringwald         gatt_client_le_enhanced_setup_l2cap_channel(gatt_client);
35306d0f6f49SMatthias Ringwald     }
35316d0f6f49SMatthias Ringwald }
35326d0f6f49SMatthias Ringwald 
353326166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) {
35347627a0deSMatthias Ringwald     gatt_client_t *gatt_client;
35357627a0deSMatthias Ringwald     gatt_client_t *eatt_client;
353626166ecfSMatthias Ringwald     hci_con_handle_t con_handle;
35377627a0deSMatthias Ringwald     uint16_t l2cap_cid;
353826166ecfSMatthias Ringwald     uint8_t status;
353926166ecfSMatthias Ringwald     gatt_client_characteristic_t characteristic;
35407627a0deSMatthias Ringwald     gatt_client_service_t service;
354126166ecfSMatthias Ringwald     switch (packet_type) {
354226166ecfSMatthias Ringwald         case HCI_EVENT_PACKET:
354326166ecfSMatthias Ringwald             switch (hci_event_packet_get_type(packet)) {
35447627a0deSMatthias Ringwald                 case GATT_EVENT_SERVICE_QUERY_RESULT:
35457627a0deSMatthias Ringwald                     con_handle = gatt_event_service_query_result_get_handle(packet);
35467627a0deSMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(con_handle);
35477627a0deSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
35487627a0deSMatthias Ringwald                     btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE);
35497627a0deSMatthias Ringwald                     gatt_event_service_query_result_get_service(packet, &service);
35507627a0deSMatthias Ringwald                     gatt_client->gatt_service_start_group_handle = service.start_group_handle;
35517627a0deSMatthias Ringwald                     gatt_client->gatt_service_end_group_handle = service.end_group_handle;
35527627a0deSMatthias Ringwald                     break;
355326166ecfSMatthias Ringwald                 case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT:
355426166ecfSMatthias Ringwald                     con_handle = gatt_event_characteristic_value_query_result_get_handle(packet);
355526166ecfSMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(con_handle);
355626166ecfSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
35577627a0deSMatthias Ringwald                     btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE);
355826166ecfSMatthias Ringwald                     if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) {
35597627a0deSMatthias Ringwald                         gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0];
356026166ecfSMatthias Ringwald                     }
356126166ecfSMatthias Ringwald                     break;
356226166ecfSMatthias Ringwald                 case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT:
356326166ecfSMatthias Ringwald                     con_handle = gatt_event_characteristic_query_result_get_handle(packet);
356426166ecfSMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(con_handle);
356526166ecfSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
35667627a0deSMatthias Ringwald                     btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE);
35677627a0deSMatthias Ringwald                     gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic);
356826166ecfSMatthias Ringwald                     gatt_client->gatt_client_supported_features_handle = characteristic.value_handle;
356926166ecfSMatthias Ringwald                     break;
357026166ecfSMatthias Ringwald                 case GATT_EVENT_QUERY_COMPLETE:
357126166ecfSMatthias Ringwald                     con_handle = gatt_event_query_complete_get_handle(packet);
357226166ecfSMatthias Ringwald                     gatt_client = gatt_client_get_context_for_handle(con_handle);
357326166ecfSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
35747627a0deSMatthias Ringwald                     switch (gatt_client->eatt_state){
35757627a0deSMatthias Ringwald                         case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE:
35767627a0deSMatthias Ringwald                             if (gatt_client->gatt_service_start_group_handle == 0){
35777627a0deSMatthias Ringwald                                 gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE);
35787627a0deSMatthias Ringwald                             } else {
35797627a0deSMatthias Ringwald                                 gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND;
35807627a0deSMatthias Ringwald                             }
35817627a0deSMatthias Ringwald                             break;
35827627a0deSMatthias Ringwald                         case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE:
35837627a0deSMatthias Ringwald                             if ((gatt_client->gatt_server_supported_features & 1) == 0) {
35847627a0deSMatthias Ringwald                                 gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE);
35857627a0deSMatthias Ringwald                             } else {
35867627a0deSMatthias Ringwald                                 gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND;
35877627a0deSMatthias Ringwald                             }
35887627a0deSMatthias Ringwald                             break;
35897627a0deSMatthias Ringwald                         case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE:
35907627a0deSMatthias Ringwald                             if (gatt_client->gatt_client_supported_features_handle == 0){
35917627a0deSMatthias Ringwald                                 gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE);
35927627a0deSMatthias Ringwald                             } else {
35937627a0deSMatthias Ringwald                                 gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND;
35947627a0deSMatthias Ringwald                             }
35957627a0deSMatthias Ringwald                             break;
35967627a0deSMatthias Ringwald                         case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE:
35977627a0deSMatthias Ringwald                             gatt_client_le_enhanced_setup_l2cap_channel(gatt_client);
359826166ecfSMatthias Ringwald                             break;
359926166ecfSMatthias Ringwald                         default:
360026166ecfSMatthias Ringwald                             break;
360126166ecfSMatthias Ringwald                     }
360226166ecfSMatthias Ringwald                     break;
36037627a0deSMatthias Ringwald                 case L2CAP_EVENT_ECBM_CHANNEL_OPENED:
36047627a0deSMatthias Ringwald                     l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet);
36057627a0deSMatthias Ringwald                     gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client);
36067627a0deSMatthias Ringwald 
36077627a0deSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
36087627a0deSMatthias Ringwald                     btstack_assert(eatt_client != NULL);
3609052dc82aSMatthias Ringwald                     btstack_assert(eatt_client->state == P_W4_L2CAP_CONNECTION);
36107627a0deSMatthias Ringwald 
36117627a0deSMatthias Ringwald                     status = l2cap_event_channel_opened_get_status(packet);
36127627a0deSMatthias Ringwald                     if (status == ERROR_CODE_SUCCESS){
3613052dc82aSMatthias Ringwald                         eatt_client->state = P_READY;
36147627a0deSMatthias Ringwald                         eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet);
36157627a0deSMatthias Ringwald                     } else {
3616df0a5c68SMatthias Ringwald                         eatt_client->state = P_L2CAP_CLOSED;
36177627a0deSMatthias Ringwald                     }
3618df0a5c68SMatthias Ringwald                     // connected if opened event for all channels received
3619df0a5c68SMatthias Ringwald                     if (gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_W4_L2CAP_CONNECTION) == 0){
36207627a0deSMatthias Ringwald                         gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS);
36217627a0deSMatthias Ringwald                     }
36227627a0deSMatthias Ringwald                     break;
36237627a0deSMatthias Ringwald                 case L2CAP_EVENT_CHANNEL_CLOSED:
36247627a0deSMatthias Ringwald                     l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet);
36257627a0deSMatthias Ringwald                     gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client);
36267627a0deSMatthias Ringwald                     btstack_assert(gatt_client != NULL);
36277627a0deSMatthias Ringwald                     btstack_assert(eatt_client != NULL);
36287627a0deSMatthias Ringwald                     gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client);
36297627a0deSMatthias Ringwald                     break;
36307627a0deSMatthias Ringwald                 default:
36317627a0deSMatthias Ringwald                     break;
36327627a0deSMatthias Ringwald             }
36337627a0deSMatthias Ringwald             break;
36347627a0deSMatthias Ringwald         case L2CAP_DATA_PACKET:
36357627a0deSMatthias Ringwald             gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client);
36367627a0deSMatthias Ringwald             btstack_assert(gatt_client != NULL);
3637ce82ac7fSMatthias Ringwald             btstack_assert(eatt_client != NULL);
3638ce82ac7fSMatthias Ringwald             gatt_client_handle_att_response(eatt_client, packet, size);
36397627a0deSMatthias Ringwald             gatt_client_run();
36407627a0deSMatthias Ringwald             break;
364126166ecfSMatthias Ringwald         default:
364226166ecfSMatthias Ringwald             break;
364326166ecfSMatthias Ringwald     }
364426166ecfSMatthias Ringwald }
364526166ecfSMatthias Ringwald 
36467627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){
364726166ecfSMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
364826166ecfSMatthias Ringwald     uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications
364926166ecfSMatthias Ringwald     switch (gatt_client->eatt_state){
36507627a0deSMatthias Ringwald         case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND:
36517627a0deSMatthias Ringwald             gatt_client->gatt_service_start_group_handle = 0;
36527627a0deSMatthias Ringwald             gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE;
36537627a0deSMatthias Ringwald             status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler,
36547627a0deSMatthias Ringwald                                                                      gatt_client->con_handle,
36557627a0deSMatthias Ringwald                                                                      ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE);
36567627a0deSMatthias Ringwald             break;
365726166ecfSMatthias Ringwald         case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND:
36587627a0deSMatthias Ringwald             gatt_client->gatt_server_supported_features = 0;
36597627a0deSMatthias Ringwald             gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE;
366026166ecfSMatthias Ringwald             status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler,
36617627a0deSMatthias Ringwald                                                                          gatt_client->con_handle,
36627627a0deSMatthias Ringwald                                                                          gatt_client->gatt_service_start_group_handle,
36637627a0deSMatthias Ringwald                                                                          gatt_client->gatt_service_end_group_handle,
366426166ecfSMatthias Ringwald                                                                          ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES);
366526166ecfSMatthias Ringwald             return true;
366626166ecfSMatthias Ringwald         case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND:
36677627a0deSMatthias Ringwald             gatt_client->gatt_client_supported_features_handle = 0;
36687627a0deSMatthias Ringwald             gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE;
366926166ecfSMatthias Ringwald             status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler,
36707627a0deSMatthias Ringwald                                                                                      gatt_client->con_handle,
36717627a0deSMatthias Ringwald                                                                                      gatt_client->gatt_service_start_group_handle,
36727627a0deSMatthias Ringwald                                                                                      gatt_client->gatt_service_end_group_handle,
36737627a0deSMatthias Ringwald                                                                                      ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES);
367426166ecfSMatthias Ringwald             return true;
367526166ecfSMatthias Ringwald         case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND:
367626166ecfSMatthias Ringwald             gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE;
367726166ecfSMatthias Ringwald             status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle,
367826166ecfSMatthias Ringwald                                                                gatt_client->gatt_client_supported_features_handle, 1,
367926166ecfSMatthias Ringwald                                                                &gatt_client_supported_features);
368026166ecfSMatthias Ringwald             return true;
368126166ecfSMatthias Ringwald         default:
368226166ecfSMatthias Ringwald             break;
368326166ecfSMatthias Ringwald     }
36847627a0deSMatthias Ringwald     btstack_assert(status == ERROR_CODE_SUCCESS);
36857627a0deSMatthias Ringwald     UNUSED(status);
368626166ecfSMatthias Ringwald     return false;
368726166ecfSMatthias Ringwald }
368826166ecfSMatthias Ringwald 
368926166ecfSMatthias Ringwald uint8_t gatt_client_le_enhanced_connect(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint8_t num_channels, uint8_t * storage_buffer, uint16_t storage_size) {
369026166ecfSMatthias Ringwald     gatt_client_t * gatt_client;
369126166ecfSMatthias Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client);
369226166ecfSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
369326166ecfSMatthias Ringwald         return status;
369426166ecfSMatthias Ringwald     }
369526166ecfSMatthias Ringwald 
369626166ecfSMatthias Ringwald     if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){
369726166ecfSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
369826166ecfSMatthias Ringwald     }
369926166ecfSMatthias Ringwald 
3700f7a42e72SMatthias Ringwald     // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports
37017627a0deSMatthias Ringwald     uint16_t buffer_size_per_client = storage_size / num_channels;
3702f7a42e72SMatthias Ringwald     uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2;
3703f7a42e72SMatthias Ringwald     if (max_mtu < 64) {
37047627a0deSMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
37057627a0deSMatthias Ringwald     }
37067627a0deSMatthias Ringwald 
37077627a0deSMatthias Ringwald     if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){
37087627a0deSMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
37097627a0deSMatthias Ringwald     }
37107627a0deSMatthias Ringwald 
37117627a0deSMatthias Ringwald     // create max num_channel eatt clients
37127627a0deSMatthias Ringwald     uint8_t i;
37137627a0deSMatthias Ringwald     btstack_linked_list_t eatt_clients = NULL;
37147627a0deSMatthias Ringwald     for (i=0;i<num_channels;i++) {
37157627a0deSMatthias Ringwald         gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get();
37167627a0deSMatthias Ringwald         if (new_gatt_client == NULL) {
37177627a0deSMatthias Ringwald             break;
37187627a0deSMatthias Ringwald         }
37197627a0deSMatthias Ringwald         btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client);
37207627a0deSMatthias Ringwald     }
37217627a0deSMatthias Ringwald 
37227627a0deSMatthias Ringwald     if (i != num_channels){
37237627a0deSMatthias Ringwald         while (true){
37247627a0deSMatthias Ringwald             gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients);
37257627a0deSMatthias Ringwald             if (gatt_client == NULL) {
37267627a0deSMatthias Ringwald                 break;
37277627a0deSMatthias Ringwald             }
37287627a0deSMatthias Ringwald             btstack_memory_gatt_client_free(gatt_client);
37297627a0deSMatthias Ringwald         }
37307627a0deSMatthias Ringwald         return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
37317627a0deSMatthias Ringwald     }
37327627a0deSMatthias Ringwald 
3733570bdd2dSMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
3734570bdd2dSMatthias Ringwald     hci_connection->att_server.eatt_outgoing_active = true;
3735570bdd2dSMatthias Ringwald 
37367627a0deSMatthias Ringwald     gatt_client->callback = callback;
37377627a0deSMatthias Ringwald     gatt_client->eatt_num_clients   = num_channels;
37387627a0deSMatthias Ringwald     gatt_client->eatt_storage_buffer = storage_buffer;
37397627a0deSMatthias Ringwald     gatt_client->eatt_storage_size   = storage_size;
37407627a0deSMatthias Ringwald     gatt_client->eatt_clients = eatt_clients;
37417627a0deSMatthias Ringwald     gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND;
374226166ecfSMatthias Ringwald     gatt_client_notify_can_send_query(gatt_client);
374326166ecfSMatthias Ringwald 
374426166ecfSMatthias Ringwald     return ERROR_CODE_SUCCESS;
374526166ecfSMatthias Ringwald }
374626166ecfSMatthias Ringwald 
374726166ecfSMatthias Ringwald #endif
374826166ecfSMatthias Ringwald 
3749a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
3750a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){
3751a6121b51SMilanka Ringwald     gatt_client_att_packet_handler(packet_type, handle, packet, size);
3752a6121b51SMilanka Ringwald }
3753ae1ee62dSMilanka Ringwald 
375440faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){
375540faeb84SMilanka Ringwald     uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client);
375640faeb84SMilanka Ringwald     return status;
3757ae1ee62dSMilanka Ringwald }
3758a6121b51SMilanka Ringwald #endif
3759