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" 593deb3ec6SMatthias Ringwald #include "l2cap.h" 601450cdc6SMatthias Ringwald #include "classic/sdp_client.h" 611450cdc6SMatthias Ringwald #include "bluetooth_gatt.h" 621450cdc6SMatthias Ringwald #include "bluetooth_sdp.h" 631450cdc6SMatthias Ringwald #include "classic/sdp_util.h" 643deb3ec6SMatthias Ringwald 65*4797b71aSMatthias Ringwald #if defined(ENABLE_GATT_OVER_EATT) && !defined(ENABLE_L2CAP_ENHANCED_CREDIT_BASED_FLOW_CONTROL_MODE) 66*4797b71aSMatthias Ringwald #error "GATT Over EATT requires support for L2CAP Enhanced CoC. Please enable ENABLE_L2CAP_ENHANCED_CREDIT_BASED_FLOW_CONTROL_MODE" 67*4797b71aSMatthias Ringwald #endif 68*4797b71aSMatthias Ringwald 69b1da4983SMatthias Ringwald // L2CAP Test Spec p35 defines a minimum of 100 ms, but PTS might indicate an error if we sent after 100 ms 70b1da4983SMatthias Ringwald #define GATT_CLIENT_COLLISION_BACKOFF_MS 150 71b1da4983SMatthias Ringwald 729c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections; 739c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners; 74361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 75f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration; 76544a5845SMatthias Ringwald static btstack_context_callback_registration_t gatt_client_deferred_event_emit; 77f4b33574SMatthias Ringwald 7811279da7SMatthias Ringwald // GATT Client Configuration 7911279da7SMatthias Ringwald static bool gatt_client_mtu_exchange_enabled; 8011279da7SMatthias Ringwald static gap_security_level_t gatt_client_required_security_level; 815cf6c434SJakob Krantz 823deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size); 83f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 845cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code); 857a766ebfSMatthias Ringwald 867a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 873deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]); 887a766ebfSMatthias Ringwald #endif 893deb3ec6SMatthias Ringwald 9059b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 9159b5e157SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid); 9259b5e157SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status); 9359b5e157SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client); 94180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts); 9559b5e157SMatthias Ringwald #endif 9659b5e157SMatthias Ringwald 9726166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 987627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client); 996d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts); 10026166ecfSMatthias Ringwald #endif 10126166ecfSMatthias Ringwald 1023deb3ec6SMatthias Ringwald void gatt_client_init(void){ 1033deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 104f4b33574SMatthias Ringwald 10511279da7SMatthias Ringwald // default configuration 10611279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = true; 10711279da7SMatthias Ringwald gatt_client_required_security_level = LEVEL_0; 10811279da7SMatthias Ringwald 10911279da7SMatthias Ringwald // register for HCI Events 110f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 111361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 112361b1363SMatthias Ringwald 113f4b33574SMatthias Ringwald // register for SM Events 114f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 115f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 116f4b33574SMatthias Ringwald 117361b1363SMatthias Ringwald // and ATT Client PDUs 1183deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 1193deb3ec6SMatthias Ringwald } 1203deb3ec6SMatthias Ringwald 12111279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){ 12211279da7SMatthias Ringwald gatt_client_required_security_level = level; 12311279da7SMatthias Ringwald } 12411279da7SMatthias Ringwald 125ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 126665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 127665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 128665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1295cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1305cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1315cf1669fSMatthias Ringwald return gatt_client; 1323deb3ec6SMatthias Ringwald } 1333deb3ec6SMatthias Ringwald } 1343deb3ec6SMatthias Ringwald return NULL; 1353deb3ec6SMatthias Ringwald } 1363deb3ec6SMatthias Ringwald 137ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1385cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1395cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1405cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1415cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1423deb3ec6SMatthias Ringwald } 1433deb3ec6SMatthias Ringwald 1445cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1458ac3a0b3SMatthias Ringwald log_debug("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1465cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1475cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1485cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1495cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1503deb3ec6SMatthias Ringwald } 1513deb3ec6SMatthias Ringwald 1525cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1538ac3a0b3SMatthias Ringwald log_debug("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1545cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1553deb3ec6SMatthias Ringwald } 1563deb3ec6SMatthias Ringwald 1571dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){ 1581dfae9c7SMatthias Ringwald uint8_t encryption_key_size = gap_encryption_key_size(con_handle); 1591dfae9c7SMatthias Ringwald if (encryption_key_size == 0) return LEVEL_0; 1601dfae9c7SMatthias Ringwald 161ff3f1026SMatthias Ringwald bool authenticated = gap_authenticated(con_handle); 1621dfae9c7SMatthias Ringwald if (!authenticated) return LEVEL_2; 1631dfae9c7SMatthias Ringwald 1641dfae9c7SMatthias Ringwald return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3; 1651dfae9c7SMatthias Ringwald } 1661dfae9c7SMatthias Ringwald 1675cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 168665d90f2SMatthias Ringwald btstack_linked_item_t *it; 169a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1705cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1715cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1725cf1669fSMatthias Ringwald return gatt_client; 1733deb3ec6SMatthias Ringwald } 1743deb3ec6SMatthias Ringwald } 1753deb3ec6SMatthias Ringwald return NULL; 1763deb3ec6SMatthias Ringwald } 1773deb3ec6SMatthias Ringwald 1783deb3ec6SMatthias Ringwald 1796b65794dSMilanka Ringwald // @return gatt_client context 1803deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 18140faeb84SMilanka Ringwald static uint8_t gatt_client_provide_context_for_handle(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 1825cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 18340faeb84SMilanka Ringwald 18440faeb84SMilanka Ringwald if (gatt_client != NULL){ 18540faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 18640faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 18740faeb84SMilanka Ringwald } 1883deb3ec6SMatthias Ringwald 189ae1d1237SMatthias Ringwald // bail if no such hci connection 1900e0bba86SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 1910e0bba86SMatthias Ringwald if (hci_connection == NULL){ 192ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 19340faeb84SMilanka Ringwald *out_gatt_client = NULL; 19440faeb84SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 195ae1d1237SMatthias Ringwald } 19640faeb84SMilanka Ringwald 1975cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 19840faeb84SMilanka Ringwald if (gatt_client == NULL){ 19940faeb84SMilanka Ringwald *out_gatt_client = NULL; 20040faeb84SMilanka Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 20140faeb84SMilanka Ringwald } 2023deb3ec6SMatthias Ringwald // init state 203e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_LE; 2045cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 2055cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 2061dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 20711279da7SMatthias Ringwald if (gatt_client_mtu_exchange_enabled){ 2085cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 2095cf6c434SJakob Krantz } else { 2105cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 2115cf6c434SJakob Krantz } 212052dc82aSMatthias Ringwald gatt_client->state = P_READY; 213cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 214cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 215cbd76cecSMatthias Ringwald #endif 2165cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 2170e0bba86SMatthias Ringwald 2180e0bba86SMatthias Ringwald // get unenhanced att bearer state 2190e0bba86SMatthias Ringwald if (hci_connection->att_connection.mtu_exchanged){ 2200e0bba86SMatthias Ringwald gatt_client->mtu = hci_connection->att_connection.mtu; 2210e0bba86SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 2220e0bba86SMatthias Ringwald } 22340faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 22440faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 2253deb3ec6SMatthias Ringwald } 2263deb3ec6SMatthias Ringwald 227de27733dSMatthias Ringwald static bool is_ready(gatt_client_t * gatt_client){ 228052dc82aSMatthias Ringwald return gatt_client->state == P_READY; 229de27733dSMatthias Ringwald } 230de27733dSMatthias Ringwald 231de27733dSMatthias Ringwald static uint8_t gatt_client_provide_context_for_request(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 232de27733dSMatthias Ringwald gatt_client_t * gatt_client = NULL; 233de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 23440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 23540faeb84SMilanka Ringwald return status; 23640faeb84SMilanka Ringwald } 237de27733dSMatthias Ringwald 2387627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2397627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 2407627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 2417627a0deSMatthias Ringwald gatt_client_t * eatt_client = NULL; 2427627a0deSMatthias Ringwald // find free eatt client 2437627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 2447627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 2457627a0deSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 246052dc82aSMatthias Ringwald if (client->state == P_READY){ 2477627a0deSMatthias Ringwald eatt_client = client; 2487627a0deSMatthias Ringwald break; 2497627a0deSMatthias Ringwald } 2507627a0deSMatthias Ringwald } 2517627a0deSMatthias Ringwald if (eatt_client == NULL){ 2527627a0deSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2537627a0deSMatthias Ringwald } 2547627a0deSMatthias Ringwald gatt_client = eatt_client; 2557627a0deSMatthias Ringwald } 2567627a0deSMatthias Ringwald #endif 2577627a0deSMatthias Ringwald 258643a64fcSMatthias Ringwald if (is_ready(gatt_client) == false){ 259de27733dSMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2603deb3ec6SMatthias Ringwald } 2613deb3ec6SMatthias Ringwald 262de27733dSMatthias Ringwald gatt_client_timeout_start(gatt_client); 263de27733dSMatthias Ringwald 264de27733dSMatthias Ringwald *out_gatt_client = gatt_client; 265de27733dSMatthias Ringwald 266de27733dSMatthias Ringwald return status; 2673deb3ec6SMatthias Ringwald } 2683deb3ec6SMatthias Ringwald 269fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 27040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 27140faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 27240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 27340faeb84SMilanka Ringwald return 0; 27440faeb84SMilanka Ringwald } 275aacf1b1aSMilanka Ringwald return is_ready(gatt_client) ? 1 : 0; 2763deb3ec6SMatthias Ringwald } 2773deb3ec6SMatthias Ringwald 2785cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 27911279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = enabled != 0; 2805cf6c434SJakob Krantz } 2815cf6c434SJakob Krantz 282fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 28340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 28440faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 28540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 28640faeb84SMilanka Ringwald return status; 28740faeb84SMilanka Ringwald } 2887d2258b3SMilanka Ringwald 2895cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2905cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2917d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2923deb3ec6SMatthias Ringwald } 2933deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 294616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2953deb3ec6SMatthias Ringwald } 2963deb3ec6SMatthias Ringwald 2979228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) { 2987627a0deSMatthias Ringwald switch (gatt_client->bearer_type){ 2997627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 3007627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 3017627a0deSMatthias Ringwald #endif 3027627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3039228fd32SMatthias Ringwald l2cap_reserve_packet_buffer(); 3049228fd32SMatthias Ringwald return l2cap_get_outgoing_buffer(); 3057627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3067627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3077627a0deSMatthias Ringwald return gatt_client->eatt_storage_buffer; 3087627a0deSMatthias Ringwald #endif 3097627a0deSMatthias Ringwald default: 3107627a0deSMatthias Ringwald btstack_unreachable(); 3117627a0deSMatthias Ringwald break; 3127627a0deSMatthias Ringwald } 3137627a0deSMatthias Ringwald return NULL; 3149228fd32SMatthias Ringwald } 3159228fd32SMatthias Ringwald 3163deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3176e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){ 31846012949SMatthias Ringwald switch (gatt_client->bearer_type){ 31946012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3206e7b444cSMatthias Ringwald return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len); 32146012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 32246012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 32346012949SMatthias Ringwald return l2cap_send_prepared(gatt_client->l2cap_cid, len); 32446012949SMatthias Ringwald #endif 3257627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3267627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3277627a0deSMatthias Ringwald return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len); 3287627a0deSMatthias Ringwald #endif 32946012949SMatthias Ringwald default: 33046012949SMatthias Ringwald btstack_unreachable(); 33146012949SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 33246012949SMatthias Ringwald } 3333deb3ec6SMatthias Ringwald } 3343deb3ec6SMatthias Ringwald 3353deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3366e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) { 3379228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3386e7b444cSMatthias Ringwald 3396e7b444cSMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 3406e7b444cSMatthias Ringwald 3416e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 1); 3426e7b444cSMatthias Ringwald } 3436e7b444cSMatthias Ringwald 3446e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE 3456e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle, 3466e7b444cSMatthias Ringwald uint16_t end_handle) { 3479228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3486e7b444cSMatthias Ringwald 3493deb3ec6SMatthias Ringwald request[0] = request_type; 350f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 351f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3523deb3ec6SMatthias Ringwald 3536e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 3543deb3ec6SMatthias Ringwald } 3553deb3ec6SMatthias Ringwald 3563deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3576e7b444cSMatthias Ringwald static uint8_t 3586e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type, 3596e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) { 3609228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3613deb3ec6SMatthias Ringwald request[0] = request_type; 3629228fd32SMatthias Ringwald 363f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 364f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 365f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 3666535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 3673deb3ec6SMatthias Ringwald 3686e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7u + value_size); 3693deb3ec6SMatthias Ringwald } 3703deb3ec6SMatthias Ringwald 3713deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3726e7b444cSMatthias Ringwald static uint8_t 3736e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16, 3746e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3759228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3766e7b444cSMatthias Ringwald 3773deb3ec6SMatthias Ringwald request[0] = request_type; 378f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 379f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 380f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 3813deb3ec6SMatthias Ringwald 3826e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7); 3833deb3ec6SMatthias Ringwald } 3843deb3ec6SMatthias Ringwald 3853deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3866e7b444cSMatthias Ringwald static uint8_t 3876e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128, 3886e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3899228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3906e7b444cSMatthias Ringwald 3913deb3ec6SMatthias Ringwald request[0] = request_type; 392f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 393f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3949c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 3953deb3ec6SMatthias Ringwald 3966e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 21); 3973deb3ec6SMatthias Ringwald } 3983deb3ec6SMatthias Ringwald 3993deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4006e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) { 4019228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4026e7b444cSMatthias Ringwald 4033deb3ec6SMatthias Ringwald request[0] = request_type; 404f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4053deb3ec6SMatthias Ringwald 4066e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 4073deb3ec6SMatthias Ringwald } 4083deb3ec6SMatthias Ringwald 4093deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4106e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4116e7b444cSMatthias Ringwald uint16_t value_offset) { 4129228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4139228fd32SMatthias Ringwald 4143deb3ec6SMatthias Ringwald request[0] = request_type; 415f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 416f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4173deb3ec6SMatthias Ringwald 4186e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 4193deb3ec6SMatthias Ringwald } 4203deb3ec6SMatthias Ringwald 4216e7b444cSMatthias Ringwald static uint8_t 422f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) { 4239228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4249228fd32SMatthias Ringwald 425f125a8efSMatthias Ringwald request[0] = opcode; 4269228fd32SMatthias Ringwald uint16_t i; 4279228fd32SMatthias Ringwald uint16_t offset = 1; 4283deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 429f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 4303deb3ec6SMatthias Ringwald offset += 2; 4313deb3ec6SMatthias Ringwald } 43225b7c058SMilanka Ringwald 4336e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, offset); 4343deb3ec6SMatthias Ringwald } 4353deb3ec6SMatthias Ringwald 436f125a8efSMatthias Ringwald static uint8_t 437f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 438f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST); 439f125a8efSMatthias Ringwald } 440f125a8efSMatthias Ringwald 441f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 442f125a8efSMatthias Ringwald static uint8_t 443f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 444f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_VARIABLE_REQ); 445f125a8efSMatthias Ringwald } 446f125a8efSMatthias Ringwald #endif 447f125a8efSMatthias Ringwald 4487a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4493deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4506e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle, 4516e7b444cSMatthias Ringwald uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) { 4529228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4539228fd32SMatthias Ringwald 4543deb3ec6SMatthias Ringwald request[0] = request_type; 455f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4566535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 457f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 4589c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 45925b7c058SMilanka Ringwald 4606e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3 + value_length + 12); 4613deb3ec6SMatthias Ringwald } 4627a766ebfSMatthias Ringwald #endif 4633deb3ec6SMatthias Ringwald 4643deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4656e7b444cSMatthias Ringwald static uint8_t 4666e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length, 4676e7b444cSMatthias Ringwald uint8_t *value) { 4689228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4699228fd32SMatthias Ringwald 4703deb3ec6SMatthias Ringwald request[0] = request_type; 471f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4726535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 4733deb3ec6SMatthias Ringwald 4746e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3u + value_length); 4753deb3ec6SMatthias Ringwald } 4763deb3ec6SMatthias Ringwald 4773deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4786e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) { 4799228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4809228fd32SMatthias Ringwald 4813deb3ec6SMatthias Ringwald request[0] = request_type; 4823deb3ec6SMatthias Ringwald request[1] = execute_write; 48325b7c058SMilanka Ringwald 4846e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 2); 4853deb3ec6SMatthias Ringwald } 4863deb3ec6SMatthias Ringwald 4873deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4886e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4896e7b444cSMatthias Ringwald uint16_t value_offset, uint16_t blob_length, uint8_t *value) { 4909228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4919228fd32SMatthias Ringwald 4923deb3ec6SMatthias Ringwald request[0] = request_type; 493f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 494f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4956535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 4963deb3ec6SMatthias Ringwald 4976e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5u + blob_length); 4983deb3ec6SMatthias Ringwald } 4993deb3ec6SMatthias Ringwald 5006e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) { 5019228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 5029228fd32SMatthias Ringwald 5033deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 5049228fd32SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 505f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 50625b7c058SMilanka Ringwald 5076e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 5083deb3ec6SMatthias Ringwald } 5093deb3ec6SMatthias Ringwald 5105cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 511dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 5125cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 5133deb3ec6SMatthias Ringwald return 0; 5143deb3ec6SMatthias Ringwald } 5155cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 5163deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 5173deb3ec6SMatthias Ringwald return rest_length; 5183deb3ec6SMatthias Ringwald } 5193deb3ec6SMatthias Ringwald return max_blob_length; 5203deb3ec6SMatthias Ringwald } 5213deb3ec6SMatthias Ringwald 5225cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 5236e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST, 5246e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5256e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5263deb3ec6SMatthias Ringwald } 5273deb3ec6SMatthias Ringwald 5285cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 52952377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5303deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 5315cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 5326e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5336e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 5343deb3ec6SMatthias Ringwald return; 5353deb3ec6SMatthias Ringwald } 5363deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5375cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 5386e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5396e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16); 5403deb3ec6SMatthias Ringwald } 5413deb3ec6SMatthias Ringwald 5425cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 5435cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 5443deb3ec6SMatthias Ringwald } 5453deb3ec6SMatthias Ringwald 5465cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 5476e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle); 5483deb3ec6SMatthias Ringwald } 5493deb3ec6SMatthias Ringwald 5505cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 5516e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5526e7b444cSMatthias Ringwald GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle, 5536e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5543deb3ec6SMatthias Ringwald } 5553deb3ec6SMatthias Ringwald 5565cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 5576e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5586e7b444cSMatthias Ringwald GATT_CHARACTERISTICS_UUID, gatt_client->start_group_handle, 5596e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5603deb3ec6SMatthias Ringwald } 5613deb3ec6SMatthias Ringwald 5625cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 5636e7b444cSMatthias Ringwald att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle, 5646e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5653deb3ec6SMatthias Ringwald } 5663deb3ec6SMatthias Ringwald 5675cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 5686e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 5693deb3ec6SMatthias Ringwald } 5703deb3ec6SMatthias Ringwald 5715cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 57252377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5736e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5746e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5756e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5763deb3ec6SMatthias Ringwald } else { 5776e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5786e7b444cSMatthias Ringwald gatt_client->uuid128, gatt_client->start_group_handle, 5796e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5803deb3ec6SMatthias Ringwald } 5813deb3ec6SMatthias Ringwald } 5823deb3ec6SMatthias Ringwald 5835cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 58430952227SMilanka Ringwald if (gatt_client->attribute_offset == 0){ 5856e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 58630952227SMilanka Ringwald } else { 5876e7b444cSMatthias Ringwald att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle, 5886e7b444cSMatthias Ringwald gatt_client->attribute_offset); 5893deb3ec6SMatthias Ringwald } 59030952227SMilanka Ringwald } 5913deb3ec6SMatthias Ringwald 5925cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 5936e7b444cSMatthias Ringwald att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 5943deb3ec6SMatthias Ringwald } 5953deb3ec6SMatthias Ringwald 596f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 597f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){ 598f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 599f125a8efSMatthias Ringwald } 600f125a8efSMatthias Ringwald #endif 601f125a8efSMatthias Ringwald 6025cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 6036e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length, 6046e7b444cSMatthias Ringwald gatt_client->attribute_value); 6053deb3ec6SMatthias Ringwald } 6063deb3ec6SMatthias Ringwald 6075cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6086e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2, 6096e7b444cSMatthias Ringwald gatt_client->client_characteristic_configuration_value); 6103deb3ec6SMatthias Ringwald } 6113deb3ec6SMatthias Ringwald 6125cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 6136e7b444cSMatthias Ringwald att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle, 6146e7b444cSMatthias Ringwald gatt_client->attribute_offset, write_blob_length(gatt_client), 6156e7b444cSMatthias Ringwald gatt_client->attribute_value); 6163deb3ec6SMatthias Ringwald } 6173deb3ec6SMatthias Ringwald 6185cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 6196e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1); 6203deb3ec6SMatthias Ringwald } 6213deb3ec6SMatthias Ringwald 6225cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 6236e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0); 6243deb3ec6SMatthias Ringwald } 6253deb3ec6SMatthias Ringwald 626abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 6275cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6286e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 6296e7b444cSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, 6306e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle); 6313deb3ec6SMatthias Ringwald } 632abdc9fb5SMatthias Ringwald #endif 6333deb3ec6SMatthias Ringwald 6345cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 6356e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 6363deb3ec6SMatthias Ringwald } 6373deb3ec6SMatthias Ringwald 6387a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 6395cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 6406e7b444cSMatthias Ringwald att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, 6416e7b444cSMatthias Ringwald gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, 6426e7b444cSMatthias Ringwald gatt_client->cmac); 6433deb3ec6SMatthias Ringwald } 6447a766ebfSMatthias Ringwald #endif 6453deb3ec6SMatthias Ringwald 6463deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 64739ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6483deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 64939ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6504ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 6513deb3ec6SMatthias Ringwald } 6523deb3ec6SMatthias Ringwald 6533deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_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 + 3u); 6583deb3ec6SMatthias Ringwald } 6593deb3ec6SMatthias Ringwald 6603deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_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; 664f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 6653deb3ec6SMatthias Ringwald } 6663deb3ec6SMatthias Ringwald 66753e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){ 66819c614acSMatthias Ringwald 66919c614acSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 67019c614acSMatthias Ringwald // if eatt is ready, notify all clients that can send a query 67119c614acSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 67219c614acSMatthias Ringwald btstack_linked_list_iterator_t it; 67319c614acSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 67419c614acSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 67519c614acSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 676052dc82aSMatthias Ringwald if (client->state == P_READY){ 67719c614acSMatthias Ringwald // call callback 67819c614acSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 67919c614acSMatthias Ringwald if (callback == NULL) { 68019c614acSMatthias Ringwald return; 68119c614acSMatthias Ringwald } 68219c614acSMatthias Ringwald (*callback->callback)(callback->context); 68319c614acSMatthias Ringwald } 68419c614acSMatthias Ringwald } 68519c614acSMatthias Ringwald return; 68619c614acSMatthias Ringwald } 68719c614acSMatthias Ringwald #endif 68819c614acSMatthias Ringwald 689052dc82aSMatthias Ringwald while (gatt_client->state == P_READY){ 69026166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 6917627a0deSMatthias Ringwald bool query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client); 69226166ecfSMatthias Ringwald if (query_sent){ 69326166ecfSMatthias Ringwald continue; 69426166ecfSMatthias Ringwald } 69526166ecfSMatthias Ringwald #endif 69653e9c18fSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 69709834412SMatthias Ringwald if (callback == NULL) { 69809834412SMatthias Ringwald return; 69953e9c18fSMatthias Ringwald } 70009834412SMatthias Ringwald (*callback->callback)(callback->context); 70153e9c18fSMatthias Ringwald } 70253e9c18fSMatthias Ringwald } 70353e9c18fSMatthias Ringwald 70423d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 70523d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) { 70623d583b8SMatthias Ringwald // ignore messages until re-encryption is complete 70723d583b8SMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 70823d583b8SMatthias Ringwald 70923d583b8SMatthias Ringwald // after that ignore if bonded but not encrypted 71023d583b8SMatthias Ringwald return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0); 71123d583b8SMatthias Ringwald } 71223d583b8SMatthias Ringwald 7139c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 7149c662c9bSMatthias Ringwald if (!callback) return; 7159da9850bSMatthias Ringwald hci_dump_btstack_event(packet, size); 7169c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 7173deb3ec6SMatthias Ringwald } 7183deb3ec6SMatthias Ringwald 719711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 720665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 7219c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 722665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 72386c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 724b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 725b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 72686c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 7273deb3ec6SMatthias Ringwald } 7283deb3ec6SMatthias Ringwald } 7293deb3ec6SMatthias Ringwald 7305cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 7313deb3ec6SMatthias Ringwald // @format H1 7323deb3ec6SMatthias Ringwald uint8_t packet[5]; 7335611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 7343deb3ec6SMatthias Ringwald packet[1] = 3; 7355cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7367d2258b3SMilanka Ringwald packet[4] = att_status; 7375cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7383deb3ec6SMatthias Ringwald } 7393deb3ec6SMatthias Ringwald 740045d700dSDavid 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){ 7413deb3ec6SMatthias Ringwald // @format HX 7423deb3ec6SMatthias Ringwald uint8_t packet[24]; 7435611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 7444ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7455cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7463deb3ec6SMatthias Ringwald /// 747f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 748f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 7499c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 7505cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7513deb3ec6SMatthias Ringwald } 7523deb3ec6SMatthias Ringwald 753045d700dSDavid 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){ 7543deb3ec6SMatthias Ringwald // @format HX 7553deb3ec6SMatthias Ringwald uint8_t packet[26]; 7565611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 7574ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7585cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7593deb3ec6SMatthias Ringwald /// 760f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 7613deb3ec6SMatthias Ringwald // 762f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 763f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 7649c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 7655cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7663deb3ec6SMatthias Ringwald } 7673deb3ec6SMatthias Ringwald 7685cf1669fSMatthias 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, 769045d700dSDavid Lechner uint16_t properties, const uint8_t * uuid128){ 7703deb3ec6SMatthias Ringwald // @format HY 7713deb3ec6SMatthias Ringwald uint8_t packet[28]; 7725611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 7734ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7745cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7753deb3ec6SMatthias Ringwald /// 776f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_handle); 777f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 778f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 779f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 7809c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 7815cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7823deb3ec6SMatthias Ringwald } 7833deb3ec6SMatthias Ringwald 7843deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 785045d700dSDavid Lechner gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 7863deb3ec6SMatthias Ringwald // @format HZ 7873deb3ec6SMatthias Ringwald uint8_t packet[22]; 7885611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 7894ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7905cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7913deb3ec6SMatthias Ringwald /// 792f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 7939c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 7945cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7953deb3ec6SMatthias Ringwald } 7963deb3ec6SMatthias Ringwald 7975cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 7988f37572aSJakob Krantz // @format H2 7998f37572aSJakob Krantz uint8_t packet[6]; 8008f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 8014ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 8025cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 8038f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 8045cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 8055cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 8068f37572aSJakob Krantz } 80723d583b8SMatthias Ringwald 80823d583b8SMatthias Ringwald // helper 80923d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) { 810052dc82aSMatthias Ringwald gatt_client->state = P_READY; 81123d583b8SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 81223d583b8SMatthias Ringwald emit_gatt_complete_event(gatt_client, att_status); 81323d583b8SMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 81423d583b8SMatthias Ringwald } 81523d583b8SMatthias Ringwald 81623d583b8SMatthias Ringwald // @return packet pointer 81723d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 81823d583b8SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 8 81923d583b8SMatthias Ringwald static uint8_t * setup_characteristic_value_packet(uint8_t type, hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 82023d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 82123d583b8SMatthias Ringwald // copy value into test packet for testing 82223d583b8SMatthias Ringwald static uint8_t packet[1000]; 82323d583b8SMatthias Ringwald memcpy(&packet[8], value, length); 82423d583b8SMatthias Ringwald #else 82523d583b8SMatthias Ringwald // before the value inside the ATT PDU 82623d583b8SMatthias Ringwald uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 82723d583b8SMatthias Ringwald #endif 82823d583b8SMatthias Ringwald packet[0] = type; 82923d583b8SMatthias Ringwald packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 83023d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 83123d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 83223d583b8SMatthias Ringwald little_endian_store_16(packet, 6, length); 83323d583b8SMatthias Ringwald return packet; 83423d583b8SMatthias Ringwald } 83523d583b8SMatthias Ringwald 83623d583b8SMatthias Ringwald // @return packet pointer 83723d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 83823d583b8SMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 10 83923d583b8SMatthias 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){ 84023d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 84123d583b8SMatthias Ringwald // avoid using pre ATT headers. 84223d583b8SMatthias Ringwald return NULL; 84323d583b8SMatthias Ringwald #endif 84423d583b8SMatthias Ringwald #if defined(HCI_INCOMING_PRE_BUFFER_SIZE) && (HCI_INCOMING_PRE_BUFFER_SIZE >= LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 8) // L2CAP Header (4) - ACL Header (4) 84523d583b8SMatthias Ringwald // before the value inside the ATT PDU 84623d583b8SMatthias Ringwald uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 84723d583b8SMatthias Ringwald packet[0] = type; 84823d583b8SMatthias Ringwald packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 84923d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 85023d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 85123d583b8SMatthias Ringwald little_endian_store_16(packet, 6, offset); 85223d583b8SMatthias Ringwald little_endian_store_16(packet, 8, length); 85323d583b8SMatthias Ringwald return packet; 85423d583b8SMatthias Ringwald #else 85523d583b8SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 85623d583b8SMatthias Ringwald return NULL; 85723d583b8SMatthias Ringwald #endif 85823d583b8SMatthias Ringwald } 85923d583b8SMatthias Ringwald 860f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE) 861f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 862f7a42e72SMatthias Ringwald #else 863f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 864f7a42e72SMatthias Ringwald #endif 865f7a42e72SMatthias Ringwald 8668f37572aSJakob Krantz /// 8675cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 86839ac9711SMatthias Ringwald if (size < 2) return; 8693deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 8704ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 8713deb3ec6SMatthias Ringwald 8723deb3ec6SMatthias Ringwald int i; 87339ac9711SMatthias Ringwald for (i = 2; (i+attr_length) <= size; i += attr_length){ 874f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 875f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 8763deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8773deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8783deb3ec6SMatthias Ringwald 8794ea43905SMatthias Ringwald if (uuid_length == 2u){ 880f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 881e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 88239ac9711SMatthias Ringwald } else if (uuid_length == 16u) { 8839c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 88439ac9711SMatthias Ringwald } else { 88539ac9711SMatthias Ringwald return; 8863deb3ec6SMatthias Ringwald } 8875cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 8883deb3ec6SMatthias Ringwald } 8893deb3ec6SMatthias Ringwald } 8903deb3ec6SMatthias Ringwald 89123d583b8SMatthias 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){ 8923deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8933deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8944ea43905SMatthias Ringwald if (uuid_length == 2u){ 895f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 896e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 8974ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 8989c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 899d73c9dbeSMilanka Ringwald } else { 900d73c9dbeSMilanka Ringwald return; 9013deb3ec6SMatthias Ringwald } 9023deb3ec6SMatthias Ringwald 9035cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 9043deb3ec6SMatthias Ringwald 9055cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 9065cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 9075cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 9083deb3ec6SMatthias Ringwald 9095cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 9103deb3ec6SMatthias Ringwald 9115cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 9125cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 9133deb3ec6SMatthias Ringwald } 9143deb3ec6SMatthias Ringwald 91523d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 9163deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 9173deb3ec6SMatthias Ringwald 9185cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 9193deb3ec6SMatthias Ringwald 9205cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 9215cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 9223deb3ec6SMatthias Ringwald 9235cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 9243deb3ec6SMatthias Ringwald } 9253deb3ec6SMatthias Ringwald 92623d583b8SMatthias Ringwald 9275cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 9284ea43905SMatthias Ringwald if (size < 2u) return; 9293deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 9304ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 9314ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 9323deb3ec6SMatthias Ringwald int i; 9334ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 934f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 9353deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 936f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 93723d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, start_handle - 1u); 93823d583b8SMatthias Ringwald report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], 93923d583b8SMatthias Ringwald uuid_length); 9403deb3ec6SMatthias Ringwald } 9413deb3ec6SMatthias Ringwald } 9423deb3ec6SMatthias Ringwald 9435cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 9443deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 945e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 9465cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9475cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 9483deb3ec6SMatthias Ringwald } 9493deb3ec6SMatthias Ringwald 950045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){ 9515cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9525cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 9533deb3ec6SMatthias Ringwald } 9543deb3ec6SMatthias Ringwald 9553deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9560fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9570fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9580fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, gatt_client->con_handle, value_handle, value, length); 95923d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9603deb3ec6SMatthias Ringwald } 9613deb3ec6SMatthias Ringwald 9623deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9630fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9640fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9650fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, gatt_client->con_handle, value_handle, value, length); 96623d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9673deb3ec6SMatthias Ringwald } 9683deb3ec6SMatthias Ringwald 9693deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9705cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 9715cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 97223d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9733deb3ec6SMatthias Ringwald } 9743deb3ec6SMatthias Ringwald 9753deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9765cf1669fSMatthias 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){ 9775cf1669fSMatthias 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); 9783deb3ec6SMatthias Ringwald if (!packet) return; 97923d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9803deb3ec6SMatthias Ringwald } 9813deb3ec6SMatthias Ringwald 9825cf1669fSMatthias 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){ 9839ec2630cSMatthias Ringwald UNUSED(value_offset); 9845cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 9855cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 9863deb3ec6SMatthias Ringwald } 9873deb3ec6SMatthias Ringwald 9885cf1669fSMatthias 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){ 9895cf1669fSMatthias 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); 9903deb3ec6SMatthias Ringwald if (!packet) return; 99123d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9923deb3ec6SMatthias Ringwald } 9933deb3ec6SMatthias Ringwald 9945cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 9953deb3ec6SMatthias Ringwald int i; 9964ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 997f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 9983deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 9993deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 10004ea43905SMatthias Ringwald if (pair_size == 4u){ 1001f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 1002e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 10033deb3ec6SMatthias Ringwald } else { 10049c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 10053deb3ec6SMatthias Ringwald } 10065cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 10073deb3ec6SMatthias Ringwald } 10083deb3ec6SMatthias Ringwald 10093deb3ec6SMatthias Ringwald } 10103deb3ec6SMatthias Ringwald 101152377058SMatthias Ringwald static bool is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10125cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 10133deb3ec6SMatthias Ringwald } 10143deb3ec6SMatthias Ringwald 10155cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 10165cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 1017526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10183deb3ec6SMatthias Ringwald return; 10193deb3ec6SMatthias Ringwald } 10203deb3ec6SMatthias Ringwald // next 10215cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 1022052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10233deb3ec6SMatthias Ringwald } 10243deb3ec6SMatthias Ringwald 10255cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10265cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 10273deb3ec6SMatthias Ringwald } 10283deb3ec6SMatthias Ringwald 10295cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10305cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 10313deb3ec6SMatthias Ringwald } 10323deb3ec6SMatthias Ringwald 10335cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10345cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 10353deb3ec6SMatthias Ringwald } 10363deb3ec6SMatthias Ringwald 10375cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10385cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 10393deb3ec6SMatthias Ringwald // report last characteristic 104023d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 10413deb3ec6SMatthias Ringwald } 10425cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 10433deb3ec6SMatthias Ringwald } 10443deb3ec6SMatthias Ringwald 10455cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10465cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 10473deb3ec6SMatthias Ringwald } 10483deb3ec6SMatthias Ringwald 10495cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10505cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 10513deb3ec6SMatthias Ringwald } 10523deb3ec6SMatthias Ringwald 10535cf1669fSMatthias 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){ 10545cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 10555cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 10563deb3ec6SMatthias Ringwald 10574ea43905SMatthias Ringwald if (next_blob_length == 0u){ 1058052dc82aSMatthias Ringwald gatt_client->state = done_state; 10593deb3ec6SMatthias Ringwald return; 10603deb3ec6SMatthias Ringwald } 1061052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10623deb3ec6SMatthias Ringwald } 10633deb3ec6SMatthias Ringwald 10645cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 10653deb3ec6SMatthias Ringwald 1066dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 10673deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 1068526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10693deb3ec6SMatthias Ringwald return; 10703deb3ec6SMatthias Ringwald } 10713deb3ec6SMatthias Ringwald 10725cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 1073052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10743deb3ec6SMatthias Ringwald } 10753deb3ec6SMatthias Ringwald 107623d583b8SMatthias 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){ 107723d583b8SMatthias Ringwald notification->callback = callback; 107823d583b8SMatthias Ringwald notification->con_handle = con_handle; 107923d583b8SMatthias Ringwald if (characteristic == NULL){ 108023d583b8SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 108123d583b8SMatthias Ringwald } else { 108223d583b8SMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 108323d583b8SMatthias Ringwald } 108423d583b8SMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 108523d583b8SMatthias Ringwald } 108623d583b8SMatthias Ringwald 108723d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 108823d583b8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 108923d583b8SMatthias Ringwald } 10903deb3ec6SMatthias Ringwald 109162f7b41dSMatthias Ringwald static bool is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 1092f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 1093f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 10943deb3ec6SMatthias Ringwald 109562f7b41dSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return false; 109662f7b41dSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return false; 10975cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 10983deb3ec6SMatthias Ringwald } 10993deb3ec6SMatthias Ringwald 11000038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 110192a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) { 110292a7335eSMatthias Ringwald sm_key_t csrk; 110392a7335eSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 110492a7335eSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 1105052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_RESULT; 110692a7335eSMatthias 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); 110792a7335eSMatthias Ringwald } 11080038504eSMatthias Ringwald #endif 110992a7335eSMatthias Ringwald 111092a7335eSMatthias Ringwald // returns true if packet was sent 11111979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 11123deb3ec6SMatthias Ringwald 1113e4d159baSMatthias Ringwald // wait until re-encryption is complete 11141979f09cSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 1115d1e1a57fSMatthias Ringwald 1116e4d159baSMatthias Ringwald // wait until re-encryption is complete 11171979f09cSMatthias Ringwald if (gatt_client->reencryption_active) return false; 11186c124bc2SMatthias Ringwald 111911279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 11201979f09cSMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return false; 112111279da7SMatthias Ringwald 1122052dc82aSMatthias Ringwald bool client_request_pending = gatt_client->state != P_READY; 1123fd14b205SMatthias Ringwald 11241aa9e3e8SMatthias Ringwald // verify security level for Mandatory Authentication over LE 112546012949SMatthias Ringwald bool check_security; 112646012949SMatthias Ringwald switch (gatt_client->bearer_type){ 112746012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 112846012949SMatthias Ringwald check_security = true; 112946012949SMatthias Ringwald break; 113046012949SMatthias Ringwald default: 11319ced96e1SMatthias Ringwald check_security = false; 113246012949SMatthias Ringwald break; 11339ced96e1SMatthias Ringwald } 11349ced96e1SMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){ 11351dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 11362197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 113711279da7SMatthias Ringwald // set att error code for pairing failure based on required level 113811279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 113911279da7SMatthias Ringwald case LEVEL_4: 114011279da7SMatthias Ringwald case LEVEL_3: 114111279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 114211279da7SMatthias Ringwald break; 114311279da7SMatthias Ringwald default: 114411279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 114511279da7SMatthias Ringwald break; 114611279da7SMatthias Ringwald } 114711279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 114811279da7SMatthias Ringwald // sm probably just sent a pdu 11491979f09cSMatthias Ringwald return true; 115011279da7SMatthias Ringwald } 1151f4b33574SMatthias Ringwald 11525cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 1153544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 11545cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 11556e7b444cSMatthias Ringwald att_exchange_mtu_request(gatt_client); 11561979f09cSMatthias Ringwald return true; 11573deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 11581979f09cSMatthias Ringwald return false; 11593deb3ec6SMatthias Ringwald default: 11603deb3ec6SMatthias Ringwald break; 11613deb3ec6SMatthias Ringwald } 11623deb3ec6SMatthias Ringwald 11635cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 116452377058SMatthias Ringwald gatt_client->send_confirmation = false; 11656e7b444cSMatthias Ringwald att_confirmation(gatt_client); 11661979f09cSMatthias Ringwald return true; 11673deb3ec6SMatthias Ringwald } 11683deb3ec6SMatthias Ringwald 11693deb3ec6SMatthias Ringwald // check MTU for writes 1170052dc82aSMatthias Ringwald switch (gatt_client->state){ 11713deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 11723deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1173dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 1174dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 1175526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 11761979f09cSMatthias Ringwald return false; 11773deb3ec6SMatthias Ringwald default: 11783deb3ec6SMatthias Ringwald break; 11793deb3ec6SMatthias Ringwald } 11803deb3ec6SMatthias Ringwald 11810038504eSMatthias Ringwald bool packet_sent = true; 11820038504eSMatthias Ringwald bool done = true; 1183052dc82aSMatthias Ringwald switch (gatt_client->state){ 11843deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 1185052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_QUERY_RESULT; 11865cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 11870038504eSMatthias Ringwald break; 11883deb3ec6SMatthias Ringwald 11893deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 1190052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_WITH_UUID_RESULT; 11915cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 11920038504eSMatthias Ringwald break; 11933deb3ec6SMatthias Ringwald 11943deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 1195052dc82aSMatthias Ringwald gatt_client->state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 11965cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11970038504eSMatthias Ringwald break; 11983deb3ec6SMatthias Ringwald 11993deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 1200052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 12015cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 12020038504eSMatthias Ringwald break; 12033deb3ec6SMatthias Ringwald 12043deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 1205052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 12065cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 12070038504eSMatthias Ringwald break; 12083deb3ec6SMatthias Ringwald 12093deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 1210052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 12115cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 12120038504eSMatthias Ringwald break; 12133deb3ec6SMatthias Ringwald 12143deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 1215052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 12165cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 12170038504eSMatthias Ringwald break; 12183deb3ec6SMatthias Ringwald 12193deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 1220052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 12215cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 12220038504eSMatthias Ringwald break; 12233deb3ec6SMatthias Ringwald 12243deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 1225052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_RESULT; 12265cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 12270038504eSMatthias Ringwald break; 12283deb3ec6SMatthias Ringwald 12293deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 1230052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BY_TYPE_RESPONSE; 12315cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 12320038504eSMatthias Ringwald break; 12333deb3ec6SMatthias Ringwald 12343deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 1235052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_RESPONSE; 12365cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 12370038504eSMatthias Ringwald break; 12383deb3ec6SMatthias Ringwald 1239f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1240f125a8efSMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST: 1241052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE; 1242f125a8efSMatthias Ringwald send_gatt_read_multiple_variable_request(gatt_client); 1243f125a8efSMatthias Ringwald break; 1244f125a8efSMatthias Ringwald #endif 1245f125a8efSMatthias Ringwald 12463deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 1247052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 12485cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 12490038504eSMatthias Ringwald break; 12503deb3ec6SMatthias Ringwald 12513deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 1252052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_RESULT; 12535cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12540038504eSMatthias Ringwald break; 12553deb3ec6SMatthias Ringwald 12563deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 1257052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 12585cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12590038504eSMatthias Ringwald break; 12603deb3ec6SMatthias Ringwald 12613deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 1262052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 12635cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12640038504eSMatthias Ringwald break; 12653deb3ec6SMatthias Ringwald 12663deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 1267052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 12685cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 12690038504eSMatthias Ringwald break; 12703deb3ec6SMatthias Ringwald 12713deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 1272052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 12735cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12740038504eSMatthias Ringwald break; 12753deb3ec6SMatthias Ringwald 12763deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 1277052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 12785cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12790038504eSMatthias Ringwald break; 12803deb3ec6SMatthias Ringwald 1281abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1282abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1283abdc9fb5SMatthias Ringwald // use Find Information 12845cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12855cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1286abdc9fb5SMatthias Ringwald #else 12873deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1288abdc9fb5SMatthias Ringwald // Use Read By Type 1289052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12905cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1291abdc9fb5SMatthias Ringwald #endif 12920038504eSMatthias Ringwald break; 12933deb3ec6SMatthias Ringwald 12943deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 1295052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 12965cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 12970038504eSMatthias Ringwald break; 12983deb3ec6SMatthias Ringwald 12993deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 1300052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 13015cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 13020038504eSMatthias Ringwald break; 13033deb3ec6SMatthias Ringwald 13043deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1305052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13065cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 13070038504eSMatthias Ringwald break; 13083deb3ec6SMatthias Ringwald 13093deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 1310052dc82aSMatthias Ringwald gatt_client->state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 13115cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 13120038504eSMatthias Ringwald break; 13133deb3ec6SMatthias Ringwald 13143deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 1315052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13165cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 13170038504eSMatthias Ringwald break; 13183deb3ec6SMatthias Ringwald 13193deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 1320052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13215cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 13220038504eSMatthias Ringwald break; 13233deb3ec6SMatthias Ringwald 13247a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1325793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 13265cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 13275cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1328793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 13295cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 1330052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_READY; 133192a7335eSMatthias Ringwald if (sm_cmac_ready()){ 133292a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 133392a7335eSMatthias Ringwald } 1334793cf6ceSMatthias Ringwald break; 1335793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1336526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 133792a7335eSMatthias Ringwald break; 1338793cf6ceSMatthias Ringwald default: 133992a7335eSMatthias Ringwald break; 1340793cf6ceSMatthias Ringwald } 13410038504eSMatthias Ringwald packet_sent = false; 13420038504eSMatthias Ringwald break; 1343793cf6ceSMatthias Ringwald 13443deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 13453deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 134692a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 13473deb3ec6SMatthias Ringwald } 13480038504eSMatthias Ringwald packet_sent = false; 13490038504eSMatthias Ringwald break; 13503deb3ec6SMatthias Ringwald 13513deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 13524c7c987fSMatthias Ringwald gatt_client->state = P_W4_SEND_SIGNED_WRITE_DONE; 13533deb3ec6SMatthias Ringwald // bump local signing counter 13545cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 13555cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 135664b12680SMatthias Ringwald // send signed write command 13575cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 13583deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1359526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1360b68ac7a5SMatthias Ringwald break; 13613deb3ec6SMatthias Ringwald } 13627a766ebfSMatthias Ringwald #endif 13633deb3ec6SMatthias Ringwald default: 1364b68ac7a5SMatthias Ringwald done = false; 13653deb3ec6SMatthias Ringwald break; 13663deb3ec6SMatthias Ringwald } 136747181045SMatthias Ringwald 13680038504eSMatthias Ringwald if (done){ 13690038504eSMatthias Ringwald return packet_sent; 13700038504eSMatthias Ringwald } 13710038504eSMatthias Ringwald 137259d34cd2SMatthias Ringwald // write without response callback 137359d34cd2SMatthias Ringwald btstack_context_callback_registration_t * callback = 137459d34cd2SMatthias Ringwald (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests); 137559d34cd2SMatthias Ringwald if (callback != NULL){ 137659d34cd2SMatthias Ringwald (*callback->callback)(callback->context); 137759d34cd2SMatthias Ringwald return true; 137859d34cd2SMatthias Ringwald } 137959d34cd2SMatthias Ringwald 138059d34cd2SMatthias Ringwald // requested can send now old 1381f688bdb8SMatthias Ringwald if (gatt_client->write_without_response_callback != NULL){ 13825cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 13835cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 138447181045SMatthias Ringwald uint8_t event[4]; 138547181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 13864ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 13875cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 13885cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 13891979f09cSMatthias Ringwald return true; // to trigger requeueing (even if higher layer didn't sent) 139047181045SMatthias Ringwald } 139147181045SMatthias Ringwald 13921979f09cSMatthias Ringwald return false; 13933deb3ec6SMatthias Ringwald } 13943deb3ec6SMatthias Ringwald 1395544128c3SMatthias Ringwald static void gatt_client_run(void){ 1396544128c3SMatthias Ringwald btstack_linked_item_t *it; 1397109c2548SMatthias Ringwald bool packet_sent; 13987627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 13997627a0deSMatthias Ringwald btstack_linked_list_iterator_t it_eatt; 14007627a0deSMatthias Ringwald #endif 1401a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 14025cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 140346012949SMatthias Ringwald switch (gatt_client->bearer_type){ 140446012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 14057627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 14067627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients); 14077627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it_eatt)) { 14087627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt); 1409052dc82aSMatthias Ringwald if (eatt_client->state != P_READY){ 14104c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle)){ 14117627a0deSMatthias Ringwald gatt_client_run_for_gatt_client(eatt_client); 14127627a0deSMatthias Ringwald } 14137627a0deSMatthias Ringwald } 14147627a0deSMatthias Ringwald } 14157627a0deSMatthias Ringwald #endif 141646012949SMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 141746012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 141846012949SMatthias Ringwald return; 141946012949SMatthias Ringwald } 1420109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 142146012949SMatthias Ringwald if (packet_sent){ 142246012949SMatthias Ringwald // request new permission 142346012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 142446012949SMatthias Ringwald // requeue client for fairness and exit 142546012949SMatthias Ringwald // note: iterator has become invalid 142646012949SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 142746012949SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 142846012949SMatthias Ringwald return; 142946012949SMatthias Ringwald } 143046012949SMatthias Ringwald break; 14311450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 143246012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 14331450cdc6SMatthias Ringwald if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) { 14341450cdc6SMatthias Ringwald continue; 14351450cdc6SMatthias Ringwald } 14361aa9e3e8SMatthias Ringwald 14371aa9e3e8SMatthias Ringwald // handle GATT over BR/EDR 14384c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle) == false) { 14394c226876SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 14401aa9e3e8SMatthias Ringwald return; 14411aa9e3e8SMatthias Ringwald } 1442109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 14431aa9e3e8SMatthias Ringwald if (packet_sent){ 14441aa9e3e8SMatthias Ringwald // request new permission 14451aa9e3e8SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 14461aa9e3e8SMatthias Ringwald // requeue client for fairness and exit 14471aa9e3e8SMatthias Ringwald // note: iterator has become invalid 14481aa9e3e8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14491aa9e3e8SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14501aa9e3e8SMatthias Ringwald return; 14511aa9e3e8SMatthias Ringwald } 145246012949SMatthias Ringwald break; 14531450cdc6SMatthias Ringwald #endif 145446012949SMatthias Ringwald default: 145546012949SMatthias Ringwald btstack_unreachable(); 145646012949SMatthias Ringwald break; 1457544128c3SMatthias Ringwald } 145846012949SMatthias Ringwald 145946012949SMatthias Ringwald 1460544128c3SMatthias Ringwald } 14613deb3ec6SMatthias Ringwald } 14623deb3ec6SMatthias Ringwald 1463544a5845SMatthias Ringwald // emit complete event, used to avoid emitting event from API call 1464544a5845SMatthias Ringwald static void gatt_client_emit_events(void * context){ 1465544a5845SMatthias Ringwald UNUSED(context); 1466544a5845SMatthias Ringwald btstack_linked_item_t *it; 1467544a5845SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next) { 1468544a5845SMatthias Ringwald gatt_client_t *gatt_client = (gatt_client_t *) it; 1469544a5845SMatthias Ringwald if (gatt_client->state == P_W2_EMIT_QUERY_COMPLETE_EVENT){ 1470544a5845SMatthias Ringwald gatt_client->state = P_READY; 1471544a5845SMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 1472544a5845SMatthias Ringwald } 1473544a5845SMatthias Ringwald } 1474544a5845SMatthias Ringwald } 1475544a5845SMatthias Ringwald 14765cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 1477643a64fcSMatthias Ringwald if (is_ready(gatt_client)) return; 1478526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_error_code); 14793deb3ec6SMatthias Ringwald } 14803deb3ec6SMatthias Ringwald 148178c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){ 148278c4542aSMatthias Ringwald hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet); 148378c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 148478c4542aSMatthias Ringwald if (gatt_client == NULL) return; 148578c4542aSMatthias Ringwald 148678c4542aSMatthias Ringwald // update security level 148778c4542aSMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 148878c4542aSMatthias Ringwald 148978c4542aSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 149078c4542aSMatthias Ringwald gatt_client->reencryption_active = false; 14912197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 149278c4542aSMatthias Ringwald 1493052dc82aSMatthias Ringwald if (gatt_client->state == P_READY) return; 149478c4542aSMatthias Ringwald 149578c4542aSMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 149678c4542aSMatthias Ringwald case ERROR_CODE_SUCCESS: 149778c4542aSMatthias Ringwald log_info("re-encryption success, retry operation"); 149878c4542aSMatthias Ringwald break; 149978c4542aSMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 150078c4542aSMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 150178c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 150278c4542aSMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 150378c4542aSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 150478c4542aSMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 150578c4542aSMatthias Ringwald // delete bonding information 150678c4542aSMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 150778c4542aSMatthias Ringwald btstack_assert(le_device_db_index >= 0); 150878c4542aSMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 150978c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 151078c4542aSMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 151178c4542aSMatthias Ringwald #endif 151278c4542aSMatthias Ringwald le_device_db_remove(le_device_db_index); 151378c4542aSMatthias Ringwald // trigger pairing again 151478c4542aSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 151578c4542aSMatthias Ringwald break; 151678c4542aSMatthias Ringwald } 151778c4542aSMatthias Ringwald #endif 151878c4542aSMatthias Ringwald // report bonding information missing 1519526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 152078c4542aSMatthias Ringwald break; 152178c4542aSMatthias Ringwald default: 152278c4542aSMatthias Ringwald // report bonding information missing 1523526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code); 152478c4542aSMatthias Ringwald break; 152578c4542aSMatthias Ringwald } 152678c4542aSMatthias Ringwald } 152778c4542aSMatthias Ringwald 152878c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){ 152978c4542aSMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 153078c4542aSMatthias Ringwald hci_con_handle_t con_handle = little_endian_read_16(packet,3); 153178c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 153278c4542aSMatthias Ringwald if (gatt_client == NULL) return; 153378c4542aSMatthias Ringwald 153478c4542aSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 153578c4542aSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 153678c4542aSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 153778c4542aSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 153878c4542aSMatthias Ringwald } 153978c4542aSMatthias Ringwald 1540f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 15411ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 15421ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 15439ec2630cSMatthias Ringwald 1544361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1545361b1363SMatthias Ringwald 1546f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 15475cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 15480e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 15493deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 155078c4542aSMatthias Ringwald gatt_client_handle_disconnection_complete(packet); 15513deb3ec6SMatthias Ringwald break; 1552f4b33574SMatthias Ringwald 1553f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1554f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1555f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 15565cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15575cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1558f4b33574SMatthias Ringwald 15591dfae9c7SMatthias Ringwald // update security level 15601dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 15611dfae9c7SMatthias Ringwald 15623503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 15632197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 1564f688bdb8SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet) != ERROR_CODE_SUCCESS){ 15655cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1566ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1567f4b33574SMatthias Ringwald } else { 1568f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 15693deb3ec6SMatthias Ringwald } 1570f4b33574SMatthias Ringwald } 1571f4b33574SMatthias Ringwald break; 157211279da7SMatthias Ringwald 1573793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1574793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1575793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1576793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1577793cf6ceSMatthias Ringwald break; 1578793cf6ceSMatthias Ringwald #endif 1579a95ca902SMatthias Ringwald 15808918bbdaSMatthias Ringwald // re-encryption started 15818918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 15828918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 15838918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15848918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 15858918bbdaSMatthias Ringwald 15868918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 15878918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 15888918bbdaSMatthias Ringwald break; 15898918bbdaSMatthias Ringwald 1590ec9babacSMatthias Ringwald // re-encryption complete 1591ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 159278c4542aSMatthias Ringwald gatt_client_handle_reencryption_complete(packet); 1593ec9babacSMatthias Ringwald break; 15943deb3ec6SMatthias Ringwald default: 15953deb3ec6SMatthias Ringwald break; 15963deb3ec6SMatthias Ringwald } 15973deb3ec6SMatthias Ringwald 1598361b1363SMatthias Ringwald gatt_client_run(); 15993deb3ec6SMatthias Ringwald } 16003deb3ec6SMatthias Ringwald 16012da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1602052dc82aSMatthias Ringwald switch (gatt_client->state) { 16032da0d963SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: 16042da0d963SMatthias Ringwald if (size >= 17) { 16052da0d963SMatthias Ringwald uint8_t uuid128[16]; 16062da0d963SMatthias Ringwald reverse_128(&packet[1], uuid128); 16072da0d963SMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 16082da0d963SMatthias Ringwald } 16092da0d963SMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 16105611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16113deb3ec6SMatthias Ringwald break; 16122da0d963SMatthias Ringwald 16132da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 16142da0d963SMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1615526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16162da0d963SMatthias Ringwald break; 16172da0d963SMatthias Ringwald 16182da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 16192da0d963SMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 16202da0d963SMatthias Ringwald size - 1u, 0u); 1621526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16222da0d963SMatthias Ringwald break; 16232da0d963SMatthias Ringwald 16242da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic 16252da0d963SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 16262da0d963SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 16272da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 16282da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u); 16292da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16302da0d963SMatthias Ringwald break; 16312da0d963SMatthias Ringwald 16322da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor 16332da0d963SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 16342da0d963SMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 16352da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 16362da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 16372da0d963SMatthias Ringwald size - 1u); 16382da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16392da0d963SMatthias Ringwald break; 16402da0d963SMatthias Ringwald 16413deb3ec6SMatthias Ringwald default: 16423deb3ec6SMatthias Ringwald break; 16433deb3ec6SMatthias Ringwald } 16442da0d963SMatthias Ringwald } 16453deb3ec6SMatthias Ringwald 16462da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1647052dc82aSMatthias Ringwald switch (gatt_client->state) { 16483deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 16495cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1650cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1651cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16525611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16533deb3ec6SMatthias Ringwald break; 16543deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 16555cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1656cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1657cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16585611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16593deb3ec6SMatthias Ringwald break; 1660cf8e5718SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: { 16614ea43905SMatthias Ringwald if (size < 2u) break; 16623deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 16633deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 16643deb3ec6SMatthias Ringwald 16654ea43905SMatthias Ringwald if (pair_size == 6u) { 16664ea43905SMatthias Ringwald if (size < 8u) break; 16673deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 16685cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 16695cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 16705cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 1671052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 16723deb3ec6SMatthias Ringwald break; 16733deb3ec6SMatthias Ringwald } 16743deb3ec6SMatthias Ringwald 16754ea43905SMatthias Ringwald if (pair_size != 8u) break; 16769f698c82SMatthias Ringwald 16779f698c82SMatthias Ringwald // UUIDs included, report all of them 16783deb3ec6SMatthias Ringwald uint16_t offset; 16794ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size) { 1680f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 16815cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 16825cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 16834ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset + 6u); 16845cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 16853deb3ec6SMatthias Ringwald } 16863deb3ec6SMatthias Ringwald 1687cf8e5718SMatthias Ringwald trigger_next_included_service_query(gatt_client, 1688cf8e5718SMatthias Ringwald get_last_result_handle_from_included_services_list(packet, 1689cf8e5718SMatthias Ringwald size)); 16905611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16913deb3ec6SMatthias Ringwald break; 16923deb3ec6SMatthias Ringwald } 1693abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 16943deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 16955cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 1696052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 16973deb3ec6SMatthias Ringwald break; 1698abdc9fb5SMatthias Ringwald #endif 16993deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 17003deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 170139ac9711SMatthias Ringwald // set last result handle to last valid handle, only used if pair_size invalid 170239ac9711SMatthias Ringwald uint16_t last_result_handle = 0xffff; 170339ac9711SMatthias Ringwald if (pair_size > 2) { 17043deb3ec6SMatthias Ringwald uint16_t offset; 17053deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size) { 1706f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1707cf8e5718SMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], 1708cf8e5718SMatthias Ringwald pair_size - 2u); 17093deb3ec6SMatthias Ringwald last_result_handle = value_handle; 17103deb3ec6SMatthias Ringwald } 171139ac9711SMatthias Ringwald } 17125cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 17133deb3ec6SMatthias Ringwald break; 17143deb3ec6SMatthias Ringwald } 17153deb3ec6SMatthias Ringwald default: 17163deb3ec6SMatthias Ringwald break; 17173deb3ec6SMatthias Ringwald } 171839ac9711SMatthias Ringwald } 1719dc13fd8dSMatthias Ringwald 17202da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) { 1721052dc82aSMatthias Ringwald switch (gatt_client->state) { 17222da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1723526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17243deb3ec6SMatthias Ringwald break; 17252da0d963SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1726526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17273deb3ec6SMatthias Ringwald break; 17282da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1729526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17302da0d963SMatthias Ringwald break; 17312da0d963SMatthias Ringwald default: 17322da0d963SMatthias Ringwald break; 17332da0d963SMatthias Ringwald } 17342da0d963SMatthias Ringwald } 1735dc13fd8dSMatthias Ringwald 17362da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) { 17374740230fSMatthias Ringwald uint8_t att_status; 17382da0d963SMatthias Ringwald switch (packet[0]) { 17392da0d963SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: { 17402da0d963SMatthias Ringwald if (size < 3u) break; 174146012949SMatthias Ringwald bool update_gatt_server_att_mtu = false; 17422da0d963SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 17432da0d963SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 174446012949SMatthias Ringwald switch (gatt_client->bearer_type){ 174546012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 174646012949SMatthias Ringwald update_gatt_server_att_mtu = true; 174746012949SMatthias Ringwald break; 17482da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 174946012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 17502da0d963SMatthias Ringwald local_rx_mtu = gatt_client->mtu; 175146012949SMatthias Ringwald break; 17522da0d963SMatthias Ringwald #endif 175346012949SMatthias Ringwald default: 175446012949SMatthias Ringwald btstack_unreachable(); 175546012949SMatthias Ringwald break; 175646012949SMatthias Ringwald } 175746012949SMatthias Ringwald 17582da0d963SMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 17592da0d963SMatthias Ringwald 17602da0d963SMatthias Ringwald // set gatt client mtu 17612da0d963SMatthias Ringwald gatt_client->mtu = mtu; 17622da0d963SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 17632da0d963SMatthias Ringwald 176446012949SMatthias Ringwald if (update_gatt_server_att_mtu){ 17652da0d963SMatthias Ringwald // set per connection mtu state - for fixed channel 17662da0d963SMatthias Ringwald hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle); 17672da0d963SMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 17682da0d963SMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 17692da0d963SMatthias Ringwald } 17702da0d963SMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 17712da0d963SMatthias Ringwald break; 17722da0d963SMatthias Ringwald } 17732da0d963SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 1774052dc82aSMatthias Ringwald switch (gatt_client->state) { 17752da0d963SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 17762da0d963SMatthias Ringwald report_gatt_services(gatt_client, packet, size); 17772da0d963SMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 177830952227SMilanka Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 177930952227SMilanka Ringwald break; 17803deb3ec6SMatthias Ringwald default: 17813deb3ec6SMatthias Ringwald break; 17823deb3ec6SMatthias Ringwald } 17833deb3ec6SMatthias Ringwald break; 17842da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 17852da0d963SMatthias Ringwald if (size < 3u) return; 17862da0d963SMatthias Ringwald report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 17872da0d963SMatthias Ringwald return; 1788cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1789cbba69d5SMatthias Ringwald case ATT_MULTIPLE_HANDLE_VALUE_NTF: 1790cbba69d5SMatthias Ringwald if (size >= 5u) { 1791cbba69d5SMatthias Ringwald uint16_t offset = 1; 1792cbba69d5SMatthias Ringwald while (true){ 1793cbba69d5SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1794cbba69d5SMatthias Ringwald offset += 2; 1795cbba69d5SMatthias Ringwald uint16_t value_length = little_endian_read_16(packet, offset); 1796cbba69d5SMatthias Ringwald offset += 2; 1797cbba69d5SMatthias Ringwald if ((offset + value_length) > size) break; 1798cbba69d5SMatthias Ringwald report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length); 1799cbba69d5SMatthias Ringwald offset += value_length; 1800cbba69d5SMatthias Ringwald } 1801cbba69d5SMatthias Ringwald } 1802cbba69d5SMatthias Ringwald return; 1803cbba69d5SMatthias Ringwald #endif 18042da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 18052da0d963SMatthias Ringwald if (size < 3u) break; 18062da0d963SMatthias Ringwald report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 180752377058SMatthias Ringwald gatt_client->send_confirmation = true; 18082da0d963SMatthias Ringwald break; 18092da0d963SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 18102da0d963SMatthias Ringwald gatt_client_handle_att_read_by_type_response(gatt_client, packet, size); 18112da0d963SMatthias Ringwald break; 18122da0d963SMatthias Ringwald case ATT_READ_RESPONSE: 18132da0d963SMatthias Ringwald gatt_client_handle_att_read_response(gatt_client, packet, size); 18142da0d963SMatthias Ringwald break; 1815cf8e5718SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: { 18163deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 18173deb3ec6SMatthias Ringwald int i; 18183deb3ec6SMatthias Ringwald uint16_t start_group_handle; 18195611a760SMatthias Ringwald uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 18204ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size) { 1821f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet, i); 1822f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet, i + 2); 1823cf8e5718SMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, 1824cf8e5718SMatthias Ringwald gatt_client->uuid128); 18253deb3ec6SMatthias Ringwald } 18265cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 18275611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18283deb3ec6SMatthias Ringwald break; 18293deb3ec6SMatthias Ringwald } 1830cf8e5718SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: { 18314ea43905SMatthias Ringwald if (size < 2u) break; 1832a6121b51SMilanka Ringwald 18333deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 18344ea43905SMatthias Ringwald if (packet[1u] == 2u) { 18353deb3ec6SMatthias Ringwald pair_size = 18; 18363deb3ec6SMatthias Ringwald } 1837a6121b51SMilanka Ringwald uint16_t offset = 2; 1838a6121b51SMilanka Ringwald 1839a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1840f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1841abdc9fb5SMatthias Ringwald 1842abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 18435cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 18445cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1845abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1846abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1847a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1848abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1849abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 18505cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 18515cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 18525cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1853abdc9fb5SMatthias Ringwald break; 1854abdc9fb5SMatthias Ringwald } 1855abdc9fb5SMatthias Ringwald offset += pair_size; 1856abdc9fb5SMatthias Ringwald } 1857abdc9fb5SMatthias Ringwald } 18585cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1859abdc9fb5SMatthias Ringwald 1860abdc9fb5SMatthias Ringwald } else { 1861abdc9fb5SMatthias Ringwald // next 18625cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 18635cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1864abdc9fb5SMatthias Ringwald } 1865abdc9fb5SMatthias Ringwald break; 1866abdc9fb5SMatthias Ringwald } 1867abdc9fb5SMatthias Ringwald #endif 18685cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 18695cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 18705611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18713deb3ec6SMatthias Ringwald break; 18723deb3ec6SMatthias Ringwald } 18733deb3ec6SMatthias Ringwald 18743deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 18752da0d963SMatthias Ringwald gatt_client_handle_att_write_response(gatt_client); 18763deb3ec6SMatthias Ringwald break; 18773deb3ec6SMatthias Ringwald 18783deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE: { 18794ea43905SMatthias Ringwald uint16_t received_blob_length = size - 1u; 1880052dc82aSMatthias Ringwald switch (gatt_client->state) { 18813deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 1882cf8e5718SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 1883cf8e5718SMatthias Ringwald received_blob_length, gatt_client->attribute_offset); 18845cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 18855611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18863deb3ec6SMatthias Ringwald break; 18873deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 18885cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 18893deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 18905cf1669fSMatthias Ringwald gatt_client->attribute_offset); 1891cf8e5718SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 1892cf8e5718SMatthias Ringwald received_blob_length); 18935611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18943deb3ec6SMatthias Ringwald break; 18953deb3ec6SMatthias Ringwald default: 18963deb3ec6SMatthias Ringwald break; 18973deb3ec6SMatthias Ringwald } 18983deb3ec6SMatthias Ringwald break; 18993deb3ec6SMatthias Ringwald } 19003deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 1901052dc82aSMatthias Ringwald switch (gatt_client->state) { 19023deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 19035cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 19044740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 19053deb3ec6SMatthias Ringwald } else { 19064740230fSMatthias Ringwald att_status = ATT_ERROR_DATA_MISMATCH; 19073deb3ec6SMatthias Ringwald } 1908526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 19093deb3ec6SMatthias Ringwald break; 19103deb3ec6SMatthias Ringwald 19113deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: { 19125cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 19135cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 19145611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19153deb3ec6SMatthias Ringwald break; 19163deb3ec6SMatthias Ringwald } 19173deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: { 19185cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1919cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, 1920cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 19215611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19223deb3ec6SMatthias Ringwald break; 19233deb3ec6SMatthias Ringwald } 19243deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: { 19255cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 19265cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1927cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, 1928cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE); 19295611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19303deb3ec6SMatthias Ringwald break; 19313deb3ec6SMatthias Ringwald } 1932052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 19333deb3ec6SMatthias Ringwald break; 19343deb3ec6SMatthias Ringwald } 19353deb3ec6SMatthias Ringwald default: 19363deb3ec6SMatthias Ringwald break; 19373deb3ec6SMatthias Ringwald } 19383deb3ec6SMatthias Ringwald break; 19393deb3ec6SMatthias Ringwald 19403deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 1941052dc82aSMatthias Ringwald switch (gatt_client->state) { 19423deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 1943526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19443deb3ec6SMatthias Ringwald break; 19453deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 1946526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19473deb3ec6SMatthias Ringwald break; 19483deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 1949526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH); 19503deb3ec6SMatthias Ringwald break; 19513deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1952526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19533deb3ec6SMatthias Ringwald break; 19543deb3ec6SMatthias Ringwald default: 19553deb3ec6SMatthias Ringwald break; 19563deb3ec6SMatthias Ringwald 19573deb3ec6SMatthias Ringwald } 19583deb3ec6SMatthias Ringwald break; 19593deb3ec6SMatthias Ringwald 19603deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 1961052dc82aSMatthias Ringwald switch (gatt_client->state) { 19623deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 19635cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1964526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19653deb3ec6SMatthias Ringwald break; 19663deb3ec6SMatthias Ringwald default: 19673deb3ec6SMatthias Ringwald break; 19683deb3ec6SMatthias Ringwald } 19693deb3ec6SMatthias Ringwald break; 19703deb3ec6SMatthias Ringwald 1971f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1972f125a8efSMatthias Ringwald case ATT_READ_MULTIPLE_VARIABLE_RSP: 1973052dc82aSMatthias Ringwald switch (gatt_client->state) { 1974169b9876SMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 1975f125a8efSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1976f125a8efSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1977f125a8efSMatthias Ringwald break; 1978f125a8efSMatthias Ringwald default: 1979f125a8efSMatthias Ringwald break; 1980f125a8efSMatthias Ringwald } 1981f125a8efSMatthias Ringwald break; 1982f125a8efSMatthias Ringwald #endif 1983f125a8efSMatthias Ringwald 19843deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 19854ea43905SMatthias Ringwald if (size < 5u) return; 19864740230fSMatthias Ringwald att_status = packet[4]; 19874740230fSMatthias Ringwald switch (att_status) { 19883deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 1989052dc82aSMatthias Ringwald switch (gatt_client->state) { 19903deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 19913deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 19923deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 19933deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 1994526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19953deb3ec6SMatthias Ringwald break; 19963deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 19973deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 199823d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 1999526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 20003deb3ec6SMatthias Ringwald break; 20013deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 20025cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle) { 20034740230fSMatthias Ringwald att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND; 20043deb3ec6SMatthias Ringwald } else { 20054740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 20063deb3ec6SMatthias Ringwald } 2007526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 20083deb3ec6SMatthias Ringwald break; 20093deb3ec6SMatthias Ringwald default: 20104740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 20113deb3ec6SMatthias Ringwald break; 20123deb3ec6SMatthias Ringwald } 20133deb3ec6SMatthias Ringwald break; 20143deb3ec6SMatthias Ringwald } 2015f4b33574SMatthias Ringwald 2016f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 2017f4b33574SMatthias Ringwald 2018f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 2019f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 2020a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 2021a0e0c2beSMatthias Ringwald 2022f4b33574SMatthias Ringwald // security too low 20235cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 20244740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2025f4b33574SMatthias Ringwald break; 2026f4b33574SMatthias Ringwald } 2027f4b33574SMatthias Ringwald // start security 20285cf1669fSMatthias Ringwald gatt_client->security_counter++; 2029f4b33574SMatthias Ringwald 2030f4b33574SMatthias Ringwald // setup action 2031f4b33574SMatthias Ringwald int retry = 1; 2032052dc82aSMatthias Ringwald switch (gatt_client->state){ 2033f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 2034052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 2035f4b33574SMatthias Ringwald break; 2036f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2037052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 2038f4b33574SMatthias Ringwald break; 2039f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 2040052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 2041f4b33574SMatthias Ringwald break; 2042f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 2043052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_REQUEST; 2044f4b33574SMatthias Ringwald break; 2045f125a8efSMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2046052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST; 2047f125a8efSMatthias Ringwald break; 2048f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 2049052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 2050f4b33574SMatthias Ringwald break; 2051f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 2052052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 2053f4b33574SMatthias Ringwald break; 2054f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 2055052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 2056f4b33574SMatthias Ringwald break; 2057f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 2058052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 2059f4b33574SMatthias Ringwald break; 2060f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2061052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 2062f4b33574SMatthias Ringwald break; 2063f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2064052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 2065f4b33574SMatthias Ringwald break; 2066f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2067052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 2068f4b33574SMatthias Ringwald break; 2069f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 2070052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 2071f4b33574SMatthias Ringwald break; 2072f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 2073052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 2074f4b33574SMatthias Ringwald break; 2075f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2076052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 2077f4b33574SMatthias Ringwald break; 2078f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 2079052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 2080f4b33574SMatthias Ringwald break; 2081f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2082052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 2083f4b33574SMatthias Ringwald break; 2084f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2085052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 2086f4b33574SMatthias Ringwald break; 2087f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 2088f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 2089052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 2090f4b33574SMatthias Ringwald break; 2091f4b33574SMatthias Ringwald #endif 2092f4b33574SMatthias Ringwald default: 2093052dc82aSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->state); 2094f4b33574SMatthias Ringwald retry = 0; 2095f4b33574SMatthias Ringwald break; 2096f4b33574SMatthias Ringwald } 2097f4b33574SMatthias Ringwald 2098f4b33574SMatthias Ringwald if (!retry) { 20994740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2100f4b33574SMatthias Ringwald break; 2101f4b33574SMatthias Ringwald } 2102f4b33574SMatthias Ringwald 2103f4b33574SMatthias Ringwald log_info("security error, start pairing"); 2104f4b33574SMatthias Ringwald 2105f060f108SMatthias Ringwald // start pairing for higher security level 21062197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 21074740230fSMatthias Ringwald gatt_client->pending_error_code = att_status; 21085cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 2109f4b33574SMatthias Ringwald break; 2110a0e0c2beSMatthias Ringwald } 2111f4b33574SMatthias Ringwald #endif 2112f4b33574SMatthias Ringwald 2113f4b33574SMatthias Ringwald // nothing we can do about that 2114f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 21153deb3ec6SMatthias Ringwald default: 21164740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 21173deb3ec6SMatthias Ringwald break; 21183deb3ec6SMatthias Ringwald } 21193deb3ec6SMatthias Ringwald break; 21203deb3ec6SMatthias Ringwald 21213deb3ec6SMatthias Ringwald default: 21223deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 21233deb3ec6SMatthias Ringwald break; 21243deb3ec6SMatthias Ringwald } 2125cf8e5718SMatthias Ringwald } 2126cf8e5718SMatthias Ringwald 2127cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) { 2128cf8e5718SMatthias Ringwald gatt_client_t *gatt_client; 2129180cbe79SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2130b1da4983SMatthias Ringwald uint8_t status; 2131b1da4983SMatthias Ringwald hci_connection_t * hci_connection; 2132180cbe79SMatthias Ringwald hci_con_handle_t con_handle; 2133180cbe79SMatthias Ringwald #endif 2134180cbe79SMatthias Ringwald 2135cf8e5718SMatthias Ringwald if (size < 1u) return; 213659b5e157SMatthias Ringwald switch (packet_type){ 213759b5e157SMatthias Ringwald case HCI_EVENT_PACKET: 213859b5e157SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 213959b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 214059b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_OPENED: 214159b5e157SMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 214259b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet)); 2143de5a18caSMatthias Ringwald if (gatt_client != NULL){ 2144180cbe79SMatthias Ringwald con_handle = l2cap_event_channel_opened_get_handle(packet); 2145180cbe79SMatthias Ringwald hci_connection = hci_connection_for_handle(con_handle); 2146ab6f9d8fSMatthias Ringwald if (status == L2CAP_CONNECTION_RESPONSE_RESULT_REFUSED_RESOURCES){ 2147ab6f9d8fSMatthias Ringwald if ((hci_connection != NULL) && hci_connection->att_server.incoming_connection_request) { 2148180cbe79SMatthias Ringwald log_info("Collision, retry in 100ms"); 2149180cbe79SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 2150180cbe79SMatthias Ringwald // set timer for retry 2151b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 2152180cbe79SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_classic_retry); 2153180cbe79SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 2154180cbe79SMatthias Ringwald break; 2155180cbe79SMatthias Ringwald } 2156ab6f9d8fSMatthias Ringwald } 215759b5e157SMatthias Ringwald // if status != 0, gatt_client will be discarded 2158052dc82aSMatthias Ringwald gatt_client->state = P_READY; 215959b5e157SMatthias Ringwald gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet); 216059b5e157SMatthias Ringwald gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 216159b5e157SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 2162de5a18caSMatthias Ringwald } 216359b5e157SMatthias Ringwald break; 216459b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 216559b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet)); 2166de5a18caSMatthias Ringwald if (gatt_client != NULL){ 216759b5e157SMatthias Ringwald // discard gatt client object 216859b5e157SMatthias Ringwald gatt_client_classic_handle_disconnected(gatt_client); 2169de5a18caSMatthias Ringwald } 217059b5e157SMatthias Ringwald break; 217159b5e157SMatthias Ringwald #endif 2172cf8e5718SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 21733deb3ec6SMatthias Ringwald gatt_client_run(); 2174cf8e5718SMatthias Ringwald break; 2175cf8e5718SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 2176cf8e5718SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 2177cf8e5718SMatthias Ringwald if (size < 6u) break; 2178cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2179de5a18caSMatthias Ringwald if (gatt_client != NULL) { 2180cf8e5718SMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 2181de5a18caSMatthias Ringwald } 2182cf8e5718SMatthias Ringwald break; 2183cf8e5718SMatthias Ringwald default: 2184cf8e5718SMatthias Ringwald break; 2185cf8e5718SMatthias Ringwald } 218659b5e157SMatthias Ringwald break; 2187cf8e5718SMatthias Ringwald 218859b5e157SMatthias Ringwald case ATT_DATA_PACKET: 2189cf8e5718SMatthias Ringwald // special cases: notifications & indications motivate creating context 2190cf8e5718SMatthias Ringwald switch (packet[0]) { 2191cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 2192cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 2193cf8e5718SMatthias Ringwald gatt_client_provide_context_for_handle(handle, &gatt_client); 2194cf8e5718SMatthias Ringwald break; 2195cf8e5718SMatthias Ringwald default: 2196cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2197cf8e5718SMatthias Ringwald break; 2198cf8e5718SMatthias Ringwald } 2199cf8e5718SMatthias Ringwald 2200cf8e5718SMatthias Ringwald if (gatt_client != NULL) { 2201cf8e5718SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2202cf8e5718SMatthias Ringwald gatt_client_run(); 2203cf8e5718SMatthias Ringwald } 220459b5e157SMatthias Ringwald break; 220559b5e157SMatthias Ringwald 220659b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 220759b5e157SMatthias Ringwald case L2CAP_DATA_PACKET: 220859b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(handle); 2209de5a18caSMatthias Ringwald if (gatt_client != NULL){ 221059b5e157SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 221159b5e157SMatthias Ringwald gatt_client_run(); 2212de5a18caSMatthias Ringwald } 221359b5e157SMatthias Ringwald break; 221459b5e157SMatthias Ringwald #endif 221559b5e157SMatthias Ringwald 221659b5e157SMatthias Ringwald default: 221759b5e157SMatthias Ringwald break; 221859b5e157SMatthias Ringwald } 22193deb3ec6SMatthias Ringwald } 22203deb3ec6SMatthias Ringwald 22217a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 22223deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 2223665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 2224665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 2225665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 22265cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 2227052dc82aSMatthias Ringwald if (gatt_client->state == P_W4_CMAC_RESULT){ 22283deb3ec6SMatthias Ringwald // store result 22295cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 22305cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 2231052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 22323deb3ec6SMatthias Ringwald gatt_client_run(); 22333deb3ec6SMatthias Ringwald return; 22343deb3ec6SMatthias Ringwald } 22353deb3ec6SMatthias Ringwald } 22363deb3ec6SMatthias Ringwald } 22373deb3ec6SMatthias Ringwald 2238b45b7749SMilanka 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){ 223940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 224040faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 224140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 224240faeb84SMilanka Ringwald return status; 224340faeb84SMilanka Ringwald } 224440faeb84SMilanka Ringwald if (is_ready(gatt_client) == 0){ 224540faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 224640faeb84SMilanka Ringwald } 22473deb3ec6SMatthias Ringwald 22485cf1669fSMatthias Ringwald gatt_client->callback = callback; 2249b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 22505cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 22515cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 2252052dc82aSMatthias Ringwald gatt_client->state = P_W4_IDENTITY_RESOLVING; 22533deb3ec6SMatthias Ringwald gatt_client_run(); 225425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22553deb3ec6SMatthias Ringwald } 22567a766ebfSMatthias Ringwald #endif 22573deb3ec6SMatthias Ringwald 2258711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 225940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2260de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 226140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 226240faeb84SMilanka Ringwald return status; 226340faeb84SMilanka Ringwald } 22643deb3ec6SMatthias Ringwald 22655cf1669fSMatthias Ringwald gatt_client->callback = callback; 22665cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22675cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2268052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 22698d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID; 22703deb3ec6SMatthias Ringwald gatt_client_run(); 227125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22723deb3ec6SMatthias Ringwald } 22733deb3ec6SMatthias Ringwald 22748d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 227540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2276de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 227740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 227840faeb84SMilanka Ringwald return status; 227940faeb84SMilanka Ringwald } 22808d1f34d3SMatheus Eduardo Garbelini 22818d1f34d3SMatheus Eduardo Garbelini gatt_client->callback = callback; 22828d1f34d3SMatheus Eduardo Garbelini gatt_client->start_group_handle = 0x0001; 22838d1f34d3SMatheus Eduardo Garbelini gatt_client->end_group_handle = 0xffff; 2284052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 22858d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID; 22868d1f34d3SMatheus Eduardo Garbelini gatt_client_run(); 22878d1f34d3SMatheus Eduardo Garbelini return ERROR_CODE_SUCCESS; 22888d1f34d3SMatheus Eduardo Garbelini } 22893deb3ec6SMatthias Ringwald 2290711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 229140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2292de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 229340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 229440faeb84SMilanka Ringwald return status; 229540faeb84SMilanka Ringwald } 22963deb3ec6SMatthias Ringwald 22975cf1669fSMatthias Ringwald gatt_client->callback = callback; 22985cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22995cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2300052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 23015cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 23025cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 23033deb3ec6SMatthias Ringwald gatt_client_run(); 230425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23053deb3ec6SMatthias Ringwald } 23063deb3ec6SMatthias Ringwald 2307711e6c80SMatthias 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){ 230840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2309de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 231040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 231140faeb84SMilanka Ringwald return status; 231240faeb84SMilanka Ringwald } 23133deb3ec6SMatthias Ringwald 23145cf1669fSMatthias Ringwald gatt_client->callback = callback; 23155cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 23165cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 23175cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 23185cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2319052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 23203deb3ec6SMatthias Ringwald gatt_client_run(); 232125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23223deb3ec6SMatthias Ringwald } 23233deb3ec6SMatthias Ringwald 2324711e6c80SMatthias 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){ 232540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2326de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 232740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 232840faeb84SMilanka Ringwald return status; 232940faeb84SMilanka Ringwald } 23303deb3ec6SMatthias Ringwald 23315cf1669fSMatthias Ringwald gatt_client->callback = callback; 23325cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 23335cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2334ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = false; 23355cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2336052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 23373deb3ec6SMatthias Ringwald gatt_client_run(); 233825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23393deb3ec6SMatthias Ringwald } 23403deb3ec6SMatthias Ringwald 2341711e6c80SMatthias 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){ 234240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2343de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 234440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 234540faeb84SMilanka Ringwald return status; 234640faeb84SMilanka Ringwald } 2347de27733dSMatthias Ringwald 23485cf1669fSMatthias Ringwald gatt_client->callback = callback; 23495cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 23505cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2351052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 23523deb3ec6SMatthias Ringwald 23533deb3ec6SMatthias Ringwald gatt_client_run(); 235425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23553deb3ec6SMatthias Ringwald } 23563deb3ec6SMatthias Ringwald 2357711e6c80SMatthias 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){ 235840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2359de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 236040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 236140faeb84SMilanka Ringwald return status; 236240faeb84SMilanka Ringwald } 23633deb3ec6SMatthias Ringwald 23645cf1669fSMatthias Ringwald gatt_client->callback = callback; 23655cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23665cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2367ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 23685cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 23695cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 23705cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2371052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 23723deb3ec6SMatthias Ringwald gatt_client_run(); 237325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23743deb3ec6SMatthias Ringwald } 23753deb3ec6SMatthias Ringwald 2376045d700dSDavid 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){ 237740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2378de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 237940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 238040faeb84SMilanka Ringwald return status; 238140faeb84SMilanka Ringwald } 23823deb3ec6SMatthias Ringwald 23835cf1669fSMatthias Ringwald gatt_client->callback = callback; 23845cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23855cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2386ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 23875cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 23885cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 23895cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2390052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 23913deb3ec6SMatthias Ringwald gatt_client_run(); 239225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23933deb3ec6SMatthias Ringwald } 23943deb3ec6SMatthias Ringwald 23953deb3ec6SMatthias Ringwald 2396b45b7749SMilanka 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){ 2397b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16); 23983deb3ec6SMatthias Ringwald } 23993deb3ec6SMatthias Ringwald 2400b45b7749SMilanka 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){ 2401b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128); 24023deb3ec6SMatthias Ringwald } 24033deb3ec6SMatthias Ringwald 2404711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 240540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2406de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 240740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 240840faeb84SMilanka Ringwald return status; 240940faeb84SMilanka Ringwald } 24103deb3ec6SMatthias Ringwald 2411544a5845SMatthias Ringwald // check if there is space for characteristics descriptors 2412544a5845SMatthias Ringwald if (characteristic->end_handle > characteristic->value_handle){ 24135cf1669fSMatthias Ringwald gatt_client->callback = callback; 24145cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 24155cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 2416052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 24173deb3ec6SMatthias Ringwald gatt_client_run(); 2418544a5845SMatthias Ringwald } else { 2419544a5845SMatthias Ringwald // schedule gatt complete event on next run loop iteration otherwise 2420544a5845SMatthias Ringwald gatt_client->state = P_W2_EMIT_QUERY_COMPLETE_EVENT; 2421544a5845SMatthias Ringwald gatt_client_deferred_event_emit.callback = gatt_client_emit_events; 2422544a5845SMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client_deferred_event_emit); 2423544a5845SMatthias Ringwald } 242425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24253deb3ec6SMatthias Ringwald } 24263deb3ec6SMatthias Ringwald 2427711e6c80SMatthias 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){ 242840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2429de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 243040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 243140faeb84SMilanka Ringwald return status; 243240faeb84SMilanka Ringwald } 24333deb3ec6SMatthias Ringwald 24345cf1669fSMatthias Ringwald gatt_client->callback = callback; 24355cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 24365cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2437052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 24383deb3ec6SMatthias Ringwald gatt_client_run(); 243925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24403deb3ec6SMatthias Ringwald } 24413deb3ec6SMatthias Ringwald 2442711e6c80SMatthias 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){ 244340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2444de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 244540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 244640faeb84SMilanka Ringwald return status; 244740faeb84SMilanka Ringwald } 24483deb3ec6SMatthias Ringwald 24495cf1669fSMatthias Ringwald gatt_client->callback = callback; 24505cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 24515cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 24525cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 24535cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 24545cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 24555cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 2456052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 24573deb3ec6SMatthias Ringwald gatt_client_run(); 245825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24593deb3ec6SMatthias Ringwald } 24603deb3ec6SMatthias Ringwald 2461045d700dSDavid 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){ 246240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2463de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 246440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 246540faeb84SMilanka Ringwald return status; 246640faeb84SMilanka Ringwald } 24673deb3ec6SMatthias Ringwald 24685cf1669fSMatthias Ringwald gatt_client->callback = callback; 24695cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 24705cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 24715cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 24725cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 24735cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 24745cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2475052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 24763deb3ec6SMatthias Ringwald gatt_client_run(); 247725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24783deb3ec6SMatthias Ringwald } 24793deb3ec6SMatthias Ringwald 24803deb3ec6SMatthias Ringwald 2481b45b7749SMilanka 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){ 2482b45b7749SMilanka Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 24833deb3ec6SMatthias Ringwald } 24843deb3ec6SMatthias Ringwald 2485b45b7749SMilanka 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){ 248640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2487de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 248840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 248940faeb84SMilanka Ringwald return status; 249040faeb84SMilanka Ringwald } 24913deb3ec6SMatthias Ringwald 24925cf1669fSMatthias Ringwald gatt_client->callback = callback; 2493b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 24945cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2495052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 24963deb3ec6SMatthias Ringwald gatt_client_run(); 249725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24983deb3ec6SMatthias Ringwald } 24993deb3ec6SMatthias Ringwald 2500b45b7749SMilanka 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){ 2501b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0); 25023deb3ec6SMatthias Ringwald } 25033deb3ec6SMatthias Ringwald 2504b45b7749SMilanka 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){ 2505b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 25063deb3ec6SMatthias Ringwald } 25073deb3ec6SMatthias Ringwald 2508f125a8efSMatthias 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){ 250940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2510de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 251140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 251240faeb84SMilanka Ringwald return status; 251340faeb84SMilanka Ringwald } 25143deb3ec6SMatthias Ringwald 2515f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2516f125a8efSMatthias Ringwald if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){ 2517f125a8efSMatthias Ringwald if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){ 2518f125a8efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2519f125a8efSMatthias Ringwald } 2520f125a8efSMatthias Ringwald } 2521f125a8efSMatthias Ringwald #endif 2522f125a8efSMatthias Ringwald 25235cf1669fSMatthias Ringwald gatt_client->callback = callback; 25245cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 25255cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 2526052dc82aSMatthias Ringwald gatt_client->state = state; 25273deb3ec6SMatthias Ringwald gatt_client_run(); 252825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25293deb3ec6SMatthias Ringwald } 25303deb3ec6SMatthias Ringwald 2531f125a8efSMatthias 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){ 2532f125a8efSMatthias Ringwald return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST); 2533f125a8efSMatthias Ringwald } 2534f125a8efSMatthias Ringwald 2535f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2536f125a8efSMatthias 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){ 2537f125a8efSMatthias 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); 2538f125a8efSMatthias Ringwald } 2539f125a8efSMatthias Ringwald #endif 2540f125a8efSMatthias Ringwald 2541de9f8e94SMatthias 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){ 254240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 254340faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 254440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 254540faeb84SMilanka Ringwald return status; 254640faeb84SMilanka Ringwald } 25473deb3ec6SMatthias Ringwald 2548dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 25495cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 25503deb3ec6SMatthias Ringwald 25516e7b444cSMatthias Ringwald return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value); 25523deb3ec6SMatthias Ringwald } 25533deb3ec6SMatthias Ringwald 2554b45b7749SMilanka 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){ 255540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2556de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 255740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 255840faeb84SMilanka Ringwald return status; 255940faeb84SMilanka Ringwald } 25603deb3ec6SMatthias Ringwald 25615cf1669fSMatthias Ringwald gatt_client->callback = callback; 25625cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25635cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 2564b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2565052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 25663deb3ec6SMatthias Ringwald gatt_client_run(); 256725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25683deb3ec6SMatthias Ringwald } 25693deb3ec6SMatthias Ringwald 2570b45b7749SMilanka 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){ 257140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2572de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 257340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 257440faeb84SMilanka Ringwald return status; 257540faeb84SMilanka Ringwald } 25763deb3ec6SMatthias Ringwald 25775cf1669fSMatthias Ringwald gatt_client->callback = callback; 25785cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25795cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 25805cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2581b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2582052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 25833deb3ec6SMatthias Ringwald gatt_client_run(); 258425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25853deb3ec6SMatthias Ringwald } 25863deb3ec6SMatthias Ringwald 2587711e6c80SMatthias 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){ 25889c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 25893deb3ec6SMatthias Ringwald } 25903deb3ec6SMatthias Ringwald 2591711e6c80SMatthias 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){ 259240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2593de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 259440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 259540faeb84SMilanka Ringwald return status; 259640faeb84SMilanka Ringwald } 25973deb3ec6SMatthias Ringwald 25985cf1669fSMatthias Ringwald gatt_client->callback = callback; 25995cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 26005cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 26015cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 26025cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 2603052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 26043deb3ec6SMatthias Ringwald gatt_client_run(); 260525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26063deb3ec6SMatthias Ringwald } 26073deb3ec6SMatthias Ringwald 2608711e6c80SMatthias 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){ 260940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2610de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 261140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 261240faeb84SMilanka Ringwald return status; 261340faeb84SMilanka Ringwald } 26143deb3ec6SMatthias Ringwald 26158915696fSMilanka Ringwald if (configuration > 3){ 26168915696fSMilanka Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 26178915696fSMilanka Ringwald } 26188915696fSMilanka Ringwald 26193deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 26204ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2621d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2622616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 26233deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 26244ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2625d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2626616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 26273deb3ec6SMatthias Ringwald } 26283deb3ec6SMatthias Ringwald 26295cf1669fSMatthias Ringwald gatt_client->callback = callback; 26305cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 26315cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 26325cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 26333deb3ec6SMatthias Ringwald 2634abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 26355cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2636abdc9fb5SMatthias Ringwald #else 2637052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2638abdc9fb5SMatthias Ringwald #endif 26393deb3ec6SMatthias Ringwald gatt_client_run(); 26409cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 26413deb3ec6SMatthias Ringwald } 26423deb3ec6SMatthias Ringwald 2643711e6c80SMatthias 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){ 264440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2645de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 264640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 264740faeb84SMilanka Ringwald return status; 264840faeb84SMilanka Ringwald } 26493deb3ec6SMatthias Ringwald 26505cf1669fSMatthias Ringwald gatt_client->callback = callback; 26515cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 26523deb3ec6SMatthias Ringwald 2653052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 26543deb3ec6SMatthias Ringwald gatt_client_run(); 265525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26563deb3ec6SMatthias Ringwald } 26573deb3ec6SMatthias Ringwald 2658711e6c80SMatthias 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){ 26599c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 26603deb3ec6SMatthias Ringwald } 26613deb3ec6SMatthias Ringwald 2662711e6c80SMatthias 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){ 266340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2664de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 266540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 266640faeb84SMilanka Ringwald return status; 266740faeb84SMilanka Ringwald } 26683deb3ec6SMatthias Ringwald 26695cf1669fSMatthias Ringwald gatt_client->callback = callback; 26705cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 26715cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2672052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 26733deb3ec6SMatthias Ringwald gatt_client_run(); 267425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26753deb3ec6SMatthias Ringwald } 26763deb3ec6SMatthias Ringwald 2677711e6c80SMatthias 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){ 26789c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 26793deb3ec6SMatthias Ringwald } 26803deb3ec6SMatthias Ringwald 2681711e6c80SMatthias 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){ 26829c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 26833deb3ec6SMatthias Ringwald } 26843deb3ec6SMatthias Ringwald 2685b45b7749SMilanka 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){ 268640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2687de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 268840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 268940faeb84SMilanka Ringwald return status; 269040faeb84SMilanka Ringwald } 26913deb3ec6SMatthias Ringwald 26925cf1669fSMatthias Ringwald gatt_client->callback = callback; 26935cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2694b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26955cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2696b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2697052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 26983deb3ec6SMatthias Ringwald gatt_client_run(); 269925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27003deb3ec6SMatthias Ringwald } 27013deb3ec6SMatthias Ringwald 270248cdff9cSMilanka 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){ 270348cdff9cSMilanka Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 27043deb3ec6SMatthias Ringwald } 27053deb3ec6SMatthias Ringwald 2706b45b7749SMilanka 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){ 270740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2708de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 270940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 271040faeb84SMilanka Ringwald return status; 271140faeb84SMilanka Ringwald } 27123deb3ec6SMatthias Ringwald 27135cf1669fSMatthias Ringwald gatt_client->callback = callback; 27145cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2715b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 27165cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2717b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2718052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 27193deb3ec6SMatthias Ringwald gatt_client_run(); 272025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27213deb3ec6SMatthias Ringwald } 27223deb3ec6SMatthias Ringwald 2723b45b7749SMilanka 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){ 2724b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value); 27253deb3ec6SMatthias Ringwald } 27263deb3ec6SMatthias Ringwald 2727b45b7749SMilanka 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){ 2728b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 27293deb3ec6SMatthias Ringwald } 27303deb3ec6SMatthias Ringwald 27313deb3ec6SMatthias Ringwald /** 27323deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27333deb3ec6SMatthias Ringwald */ 2734b45b7749SMilanka 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){ 273540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2736de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 273740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 273840faeb84SMilanka Ringwald return status; 273940faeb84SMilanka Ringwald } 27403deb3ec6SMatthias Ringwald 27415cf1669fSMatthias Ringwald gatt_client->callback = callback; 27425cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 2743b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 27445cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2745b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2746052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 27473deb3ec6SMatthias Ringwald gatt_client_run(); 274825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27493deb3ec6SMatthias Ringwald } 27503deb3ec6SMatthias Ringwald 27513deb3ec6SMatthias Ringwald /** 27523deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27533deb3ec6SMatthias Ringwald */ 2754711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 275540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2756de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 275740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 275840faeb84SMilanka Ringwald return status; 275940faeb84SMilanka Ringwald } 27603deb3ec6SMatthias Ringwald 27615cf1669fSMatthias Ringwald gatt_client->callback = callback; 2762052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 27633deb3ec6SMatthias Ringwald gatt_client_run(); 276425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27653deb3ec6SMatthias Ringwald } 27663deb3ec6SMatthias Ringwald 27673deb3ec6SMatthias Ringwald /** 27683deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27693deb3ec6SMatthias Ringwald */ 2770711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 277140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2772de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 277340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 277440faeb84SMilanka Ringwald return status; 277540faeb84SMilanka Ringwald } 27763deb3ec6SMatthias Ringwald 27775cf1669fSMatthias Ringwald gatt_client->callback = callback; 2778052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 27793deb3ec6SMatthias Ringwald gatt_client_run(); 27807d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 27813deb3ec6SMatthias Ringwald } 27823deb3ec6SMatthias Ringwald 2783313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 27846ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 27856ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 27866ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 27876ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 27886ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2789c839c6f9SMatthias Ringwald } else { 2790c839c6f9SMatthias Ringwald service->uuid16 = 0; 27916ba2ad22SMatthias Ringwald } 27926ba2ad22SMatthias Ringwald } 27936ba2ad22SMatthias Ringwald 2794313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 27956ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 27966ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 27976ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 27986ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 279986c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 28006ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 28016ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2802c839c6f9SMatthias Ringwald } else { 2803c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 28046ba2ad22SMatthias Ringwald } 28056ba2ad22SMatthias Ringwald } 28066ba2ad22SMatthias Ringwald 2807313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 28086ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 28096ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2810b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2811b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2812c839c6f9SMatthias Ringwald } else { 2813c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2814b4895529SJakob Krantz } 28156ba2ad22SMatthias Ringwald } 28165cf6c434SJakob Krantz 28175cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 281840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 281940faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 282040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 282140faeb84SMilanka Ringwald return; 282240faeb84SMilanka Ringwald } 282340faeb84SMilanka Ringwald if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 282440faeb84SMilanka Ringwald gatt_client->callback = callback; 282540faeb84SMilanka Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 28265cf6c434SJakob Krantz gatt_client_run(); 28275cf6c434SJakob Krantz } 28285cf6c434SJakob Krantz } 282947181045SMatthias Ringwald 283059d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 283159d34cd2SMatthias Ringwald gatt_client_t * gatt_client; 283259d34cd2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 283359d34cd2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 283459d34cd2SMatthias Ringwald return status; 283559d34cd2SMatthias Ringwald } 283659d34cd2SMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration); 28372832a98aSMatthias Ringwald if (added == false){ 283859d34cd2SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 28392832a98aSMatthias Ringwald } else { 28402832a98aSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 28412832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 284259d34cd2SMatthias Ringwald } 284359d34cd2SMatthias Ringwald } 284459d34cd2SMatthias Ringwald 284553e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 284653e9c18fSMatthias Ringwald gatt_client_t * gatt_client; 284753e9c18fSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 284853e9c18fSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 284953e9c18fSMatthias Ringwald return status; 285053e9c18fSMatthias Ringwald } 285153e9c18fSMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 28522832a98aSMatthias Ringwald if (added == false){ 285353e9c18fSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 28542832a98aSMatthias Ringwald } else { 28552832a98aSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 28562832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 285753e9c18fSMatthias Ringwald } 285853e9c18fSMatthias Ringwald } 285953e9c18fSMatthias Ringwald 286048553f67SDirk Helbig uint8_t gatt_client_remove_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 286148553f67SDirk Helbig gatt_client_t * gatt_client; 286248553f67SDirk Helbig uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 286348553f67SDirk Helbig if (status != ERROR_CODE_SUCCESS){ 286448553f67SDirk Helbig return status; 286548553f67SDirk Helbig } 286648553f67SDirk Helbig (void)btstack_linked_list_remove(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 286748553f67SDirk Helbig return ERROR_CODE_SUCCESS; 286848553f67SDirk Helbig } 286948553f67SDirk Helbig 287047181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 287140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 287240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 287340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 287440faeb84SMilanka Ringwald return status; 287540faeb84SMilanka Ringwald } 287640faeb84SMilanka Ringwald if (gatt_client->write_without_response_callback != NULL){ 287740faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 287840faeb84SMilanka Ringwald } 287940faeb84SMilanka Ringwald gatt_client->write_without_response_callback = callback; 288040faeb84SMilanka Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 28817d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 288247181045SMatthias Ringwald } 2883a6121b51SMilanka Ringwald 28847627a0deSMatthias Ringwald 28857627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT) 28861450cdc6SMatthias Ringwald 28871450cdc6SMatthias Ringwald #include "hci_event.h" 28881450cdc6SMatthias Ringwald 28891450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = { 28901450cdc6SMatthias Ringwald GATT_EVENT_CONNECTED, 0, "1BH" 28911450cdc6SMatthias Ringwald }; 28921450cdc6SMatthias Ringwald 28936b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = { 28946b4a68c3SMatthias Ringwald GATT_EVENT_DISCONNECTED, 0, "H" 28956b4a68c3SMatthias Ringwald }; 28961c7a19feSMatthias Ringwald 28971c7a19feSMatthias Ringwald static void gatt_client_emit_connected(btstack_packet_handler_t callback, uint8_t status, bd_addr_t addr, 28981c7a19feSMatthias Ringwald hci_con_handle_t con_handle) { 28991c7a19feSMatthias Ringwald uint8_t buffer[20]; 29001c7a19feSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, con_handle); 29011c7a19feSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 29021c7a19feSMatthias Ringwald } 29031c7a19feSMatthias Ringwald 29047627a0deSMatthias Ringwald #endif 29057627a0deSMatthias Ringwald 29067627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 29077627a0deSMatthias Ringwald 29087627a0deSMatthias Ringwald #include "bluetooth_psm.h" 29097627a0deSMatthias Ringwald 29107627a0deSMatthias Ringwald // single active SDP query 29117627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query; 29127627a0deSMatthias Ringwald 29137627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes 29147627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32]; 29157627a0deSMatthias Ringwald 29166b4a68c3SMatthias Ringwald 29171450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){ 29181450cdc6SMatthias Ringwald btstack_linked_item_t *it; 29191450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 29201450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 29211450cdc6SMatthias Ringwald if (memcmp(gatt_client->addr, addr, 6) == 0){ 29221450cdc6SMatthias Ringwald return gatt_client; 29231450cdc6SMatthias Ringwald } 29241450cdc6SMatthias Ringwald } 29251450cdc6SMatthias Ringwald return NULL; 29261450cdc6SMatthias Ringwald } 29271450cdc6SMatthias Ringwald 29281450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){ 29291450cdc6SMatthias Ringwald btstack_linked_item_t *it; 29301450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 29311450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 29321450cdc6SMatthias Ringwald if (gatt_client->l2cap_cid == l2cap_cid){ 29331450cdc6SMatthias Ringwald return gatt_client; 29341450cdc6SMatthias Ringwald } 29351450cdc6SMatthias Ringwald } 29361450cdc6SMatthias Ringwald return NULL; 29371450cdc6SMatthias Ringwald } 29381450cdc6SMatthias Ringwald 29391450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){ 29401450cdc6SMatthias Ringwald bd_addr_t addr; 2941d5529700SMatthias Ringwald // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy 29421450cdc6SMatthias Ringwald memcpy(addr, gatt_client->addr, 6); 29431450cdc6SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 29441450cdc6SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 29459ed6f53cSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 29463b0e0cc5SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 29473b0e0cc5SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 29483b0e0cc5SMatthias Ringwald } 29491c7a19feSMatthias Ringwald gatt_client_emit_connected(callback, status, addr, con_handle); 29501450cdc6SMatthias Ringwald } 29511450cdc6SMatthias Ringwald 2952180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts){ 2953180cbe79SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 2954180cbe79SMatthias Ringwald if (gatt_client != NULL){ 2955180cbe79SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 2956180cbe79SMatthias Ringwald att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 2957180cbe79SMatthias Ringwald } 2958180cbe79SMatthias Ringwald } 2959180cbe79SMatthias Ringwald 29606b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){ 29616b4a68c3SMatthias Ringwald 29626b4a68c3SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 29636b4a68c3SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 29646b4a68c3SMatthias Ringwald 29656b4a68c3SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 29666b4a68c3SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 29676b4a68c3SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 29686b4a68c3SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 29696b4a68c3SMatthias Ringwald 29706b4a68c3SMatthias Ringwald uint8_t buffer[20]; 29716b4a68c3SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle); 29726b4a68c3SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 29736b4a68c3SMatthias Ringwald } 29746b4a68c3SMatthias Ringwald 29751450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){ 29761450cdc6SMatthias Ringwald des_iterator_t des_list_it; 29771450cdc6SMatthias Ringwald des_iterator_t prot_it; 29781450cdc6SMatthias Ringwald 29791450cdc6SMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) { 29801450cdc6SMatthias Ringwald gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 29811450cdc6SMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 29821450cdc6SMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 29831450cdc6SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: 29841450cdc6SMatthias 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)) { 29851450cdc6SMatthias Ringwald uint8_t *des_element; 29861450cdc6SMatthias Ringwald uint8_t *element; 29871450cdc6SMatthias Ringwald uint32_t uuid; 29881450cdc6SMatthias Ringwald 29891450cdc6SMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 29901450cdc6SMatthias Ringwald 29911450cdc6SMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 29921450cdc6SMatthias Ringwald des_iterator_init(&prot_it, des_element); 29931450cdc6SMatthias Ringwald element = des_iterator_get_element(&prot_it); 29941450cdc6SMatthias Ringwald 29951450cdc6SMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 29961450cdc6SMatthias Ringwald 29971450cdc6SMatthias Ringwald uuid = de_get_uuid32(element); 29981450cdc6SMatthias Ringwald des_iterator_next(&prot_it); 29991450cdc6SMatthias Ringwald // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both 30001450cdc6SMatthias Ringwald switch (uuid){ 30011450cdc6SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 30021450cdc6SMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 30031450cdc6SMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm); 30041450cdc6SMatthias Ringwald break; 30051450cdc6SMatthias Ringwald default: 30061450cdc6SMatthias Ringwald break; 30071450cdc6SMatthias Ringwald } 30081450cdc6SMatthias Ringwald } 30091450cdc6SMatthias Ringwald break; 30101450cdc6SMatthias Ringwald 30111450cdc6SMatthias Ringwald default: 30121450cdc6SMatthias Ringwald break; 30131450cdc6SMatthias Ringwald } 30141450cdc6SMatthias Ringwald } 30151450cdc6SMatthias Ringwald } 30161450cdc6SMatthias Ringwald } 30171450cdc6SMatthias Ringwald 30181450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 30191450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query; 30201450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 30211450cdc6SMatthias Ringwald uint8_t status; 30221450cdc6SMatthias Ringwald 30231450cdc6SMatthias Ringwald // TODO: handle sdp events, get l2cap psm 30241450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 30251450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 30261450cdc6SMatthias Ringwald gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet); 30271450cdc6SMatthias Ringwald // TODO: 30281450cdc6SMatthias Ringwald return; 30291450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 30301450cdc6SMatthias Ringwald status = sdp_event_query_complete_get_status(packet); 30311450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = NULL; 30321450cdc6SMatthias Ringwald log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status); 30331450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) break; 30341450cdc6SMatthias Ringwald if (gatt_client->l2cap_psm == 0) { 30351450cdc6SMatthias Ringwald status = SDP_SERVICE_NOT_FOUND; 30361450cdc6SMatthias Ringwald break; 30371450cdc6SMatthias Ringwald } 30381450cdc6SMatthias Ringwald break; 30391450cdc6SMatthias Ringwald default: 30401450cdc6SMatthias Ringwald btstack_assert(false); 30411450cdc6SMatthias Ringwald return; 30421450cdc6SMatthias Ringwald } 30431450cdc6SMatthias Ringwald 30441450cdc6SMatthias Ringwald // done 30451450cdc6SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3046052dc82aSMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 304759b5e157SMatthias Ringwald status = att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 30481450cdc6SMatthias Ringwald } 30491450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) { 30501450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 30511450cdc6SMatthias Ringwald } 30521450cdc6SMatthias Ringwald } 30531450cdc6SMatthias Ringwald 30541450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){ 30551450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = (gatt_client_t *) context; 3056052dc82aSMatthias Ringwald gatt_client_classic_active_sdp_query->state = P_W4_SDP_QUERY; 30571450cdc6SMatthias Ringwald sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 30581450cdc6SMatthias Ringwald } 30591450cdc6SMatthias Ringwald 306074daebdeSMatthias Ringwald static void gatt_client_classic_emit_connected(void * context){ 306174daebdeSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) context; 3062052dc82aSMatthias Ringwald gatt_client->state = P_READY; 306374daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 306474daebdeSMatthias Ringwald btstack_assert(hci_connection != NULL); 306574daebdeSMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, ERROR_CODE_SUCCESS, hci_connection->address, gatt_client->con_handle); 306674daebdeSMatthias Ringwald } 306774daebdeSMatthias Ringwald 30681450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){ 30691450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr); 30701450cdc6SMatthias Ringwald if (gatt_client != NULL){ 30711450cdc6SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 30721450cdc6SMatthias Ringwald } 30731450cdc6SMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 30741450cdc6SMatthias Ringwald if (gatt_client == NULL){ 30751450cdc6SMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 30761450cdc6SMatthias Ringwald } 30771450cdc6SMatthias Ringwald // init state 3078e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC; 30791450cdc6SMatthias Ringwald gatt_client->con_handle = HCI_CON_HANDLE_INVALID; 30801450cdc6SMatthias Ringwald memcpy(gatt_client->addr, addr, 6); 30811450cdc6SMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 30821450cdc6SMatthias Ringwald gatt_client->security_level = LEVEL_0; 30831450cdc6SMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 30841450cdc6SMatthias Ringwald gatt_client->callback = callback; 3085cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3086cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3087cbd76cecSMatthias Ringwald #endif 30881450cdc6SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 308974daebdeSMatthias Ringwald 309074daebdeSMatthias Ringwald // schedule emitted event if already connected, otherwise 309174daebdeSMatthias Ringwald bool already_connected = false; 309274daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 309374daebdeSMatthias Ringwald if (hci_connection != NULL){ 309474daebdeSMatthias Ringwald if (hci_connection->att_server.l2cap_cid != 0){ 309574daebdeSMatthias Ringwald already_connected = true; 309674daebdeSMatthias Ringwald } 309774daebdeSMatthias Ringwald } 3098052dc82aSMatthias Ringwald gatt_client->callback_request.context = gatt_client; 309974daebdeSMatthias Ringwald if (already_connected){ 310074daebdeSMatthias Ringwald gatt_client->con_handle = hci_connection->con_handle; 3101052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_emit_connected; 3102052dc82aSMatthias Ringwald gatt_client->state = P_W2_EMIT_CONNECTED; 3103052dc82aSMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client->callback_request); 310474daebdeSMatthias Ringwald } else { 3105052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_sdp_start; 3106052dc82aSMatthias Ringwald gatt_client->state = P_W2_SDP_QUERY; 3107052dc82aSMatthias Ringwald sdp_client_register_query_callback(&gatt_client->callback_request); 310874daebdeSMatthias Ringwald } 3109b7b03a30SMatthias Ringwald return ERROR_CODE_SUCCESS; 31101450cdc6SMatthias Ringwald } 31111450cdc6SMatthias Ringwald 31121450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 31131450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 31141450cdc6SMatthias Ringwald if (gatt_client == NULL){ 31151450cdc6SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 31161450cdc6SMatthias Ringwald } 31171450cdc6SMatthias Ringwald gatt_client->callback = callback; 31181450cdc6SMatthias Ringwald return l2cap_disconnect(gatt_client->l2cap_cid); 31191450cdc6SMatthias Ringwald } 31201450cdc6SMatthias Ringwald #endif 31211450cdc6SMatthias Ringwald 312226166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 312326166ecfSMatthias Ringwald 312426166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5 31257627a0deSMatthias Ringwald 31267627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 31277627a0deSMatthias Ringwald 3128df0a5c68SMatthias Ringwald static uint8_t gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client_t * gatt_client, gatt_client_state_t state){ 3129df0a5c68SMatthias Ringwald uint8_t num_clients = 0; 3130df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3131df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 3132df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 3133df0a5c68SMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3134df0a5c68SMatthias Ringwald if (eatt_client->state == state){ 3135df0a5c68SMatthias Ringwald num_clients++; 3136df0a5c68SMatthias Ringwald } 3137df0a5c68SMatthias Ringwald } 3138df0a5c68SMatthias Ringwald return num_clients; 3139df0a5c68SMatthias Ringwald } 3140df0a5c68SMatthias Ringwald 31417627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) { 31427627a0deSMatthias Ringwald // free eatt clients 31437627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 31447627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 31457627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31467627a0deSMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 31477627a0deSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 31487627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 31497627a0deSMatthias Ringwald } 31507627a0deSMatthias Ringwald } 31517627a0deSMatthias Ringwald 31527627a0deSMatthias Ringwald // all channels connected 31537627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) { 31547627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3155df0a5c68SMatthias Ringwald uint8_t num_ready = gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_READY); 3156df0a5c68SMatthias Ringwald if (num_ready > 0){ 31577627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READY; 3158df0a5c68SMatthias Ringwald // free unused channels 3159df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3160df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 3161df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 3162df0a5c68SMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3163df0a5c68SMatthias Ringwald if (eatt_client->state == P_L2CAP_CLOSED){ 3164df0a5c68SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 3165df0a5c68SMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 3166df0a5c68SMatthias Ringwald } 3167df0a5c68SMatthias Ringwald } 3168df0a5c68SMatthias Ringwald } else { 31696d0f6f49SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 31706d0f6f49SMatthias Ringwald btstack_assert(hci_connection != NULL); 31716d0f6f49SMatthias Ringwald if (hci_connection->att_server.incoming_connection_request){ 31726d0f6f49SMatthias Ringwald hci_connection->att_server.incoming_connection_request = false; 31736d0f6f49SMatthias Ringwald log_info("Collision, retry in 100ms"); 31746d0f6f49SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 31756d0f6f49SMatthias Ringwald // set timer for retry 3176b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 31776d0f6f49SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_le_enhanced_retry); 31786d0f6f49SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 31796d0f6f49SMatthias Ringwald return; 31806d0f6f49SMatthias Ringwald } else { 3181df0a5c68SMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3182df0a5c68SMatthias Ringwald status = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 3183df0a5c68SMatthias Ringwald } 31846d0f6f49SMatthias Ringwald } 31857627a0deSMatthias Ringwald } else { 31867627a0deSMatthias Ringwald gatt_client_eatt_finalize(gatt_client); 31877627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 31887627a0deSMatthias Ringwald } 31897627a0deSMatthias Ringwald 31901c7a19feSMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, status, gatt_client->addr, gatt_client->con_handle); 31917627a0deSMatthias Ringwald } 31927627a0deSMatthias Ringwald 31937627a0deSMatthias Ringwald // single channel disconnected 31947627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) { 31957627a0deSMatthias Ringwald 31967627a0deSMatthias Ringwald // report error 31977627a0deSMatthias Ringwald gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 31987627a0deSMatthias Ringwald 31997627a0deSMatthias Ringwald // free memory 32007627a0deSMatthias Ringwald btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client); 32017627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 32027627a0deSMatthias Ringwald 3203570bdd2dSMatthias Ringwald // last channel 32047627a0deSMatthias Ringwald if (btstack_linked_list_empty(&gatt_client->eatt_clients)){ 3205570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 3206570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = false; 3207570bdd2dSMatthias Ringwald 3208570bdd2dSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) { 3209570bdd2dSMatthias Ringwald // report disconnected if last channel closed 32107627a0deSMatthias Ringwald uint8_t buffer[20]; 32117627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle); 32127627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 32137627a0deSMatthias Ringwald } 32147627a0deSMatthias Ringwald } 32157627a0deSMatthias Ringwald } 32167627a0deSMatthias Ringwald 32177627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){ 32187627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 32197627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 32207627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 32217627a0deSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 32227627a0deSMatthias Ringwald btstack_linked_list_iterator_t it2; 32237627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients); 32247627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it2)) { 32257627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2); 32267627a0deSMatthias Ringwald if (eatt_client->l2cap_cid == l2cap_cid){ 32277627a0deSMatthias Ringwald *out_eatt_client = eatt_client; 32287627a0deSMatthias Ringwald return gatt_client; 32297627a0deSMatthias Ringwald } 32307627a0deSMatthias Ringwald } 32317627a0deSMatthias Ringwald } 32327627a0deSMatthias Ringwald return NULL; 32337627a0deSMatthias Ringwald } 32347627a0deSMatthias Ringwald 32357627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){ 32367627a0deSMatthias Ringwald uint8_t num_channels = gatt_client->eatt_num_clients; 32377627a0deSMatthias Ringwald 32387627a0deSMatthias Ringwald // setup channels 32397627a0deSMatthias Ringwald uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels; 3240f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 32417627a0deSMatthias Ringwald uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS]; 32427627a0deSMatthias Ringwald uint16_t new_cids[MAX_NR_EATT_CHANNELS]; 32437627a0deSMatthias Ringwald memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size); 32447627a0deSMatthias Ringwald uint8_t i; 32457627a0deSMatthias Ringwald for (i=0;i<gatt_client->eatt_num_clients; i++){ 3246f7a42e72SMatthias Ringwald receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER]; 3247f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu; 32487627a0deSMatthias Ringwald } 32497627a0deSMatthias Ringwald 32507627a0deSMatthias Ringwald log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client); 32517627a0deSMatthias Ringwald 3252f7a42e72SMatthias Ringwald uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler, 3253f7a42e72SMatthias Ringwald gatt_client->con_handle, 32547627a0deSMatthias Ringwald gatt_client->security_level, 3255f7a42e72SMatthias Ringwald BLUETOOTH_PSM_EATT, num_channels, 3256f7a42e72SMatthias Ringwald L2CAP_LE_AUTOMATIC_CREDITS, 32577627a0deSMatthias Ringwald buffer_size_per_client, 3258f7a42e72SMatthias Ringwald receive_buffers, 3259f7a42e72SMatthias Ringwald new_cids); 32607627a0deSMatthias Ringwald 32617627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 32627627a0deSMatthias Ringwald i = 0; 32637627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 32647627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 32657627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 32667627a0deSMatthias Ringwald gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 32677627a0deSMatthias Ringwald 32687627a0deSMatthias Ringwald // init state with new cid and transmit buffer 32697627a0deSMatthias Ringwald new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE; 32707627a0deSMatthias Ringwald new_eatt_client->con_handle = gatt_client->con_handle; 32717627a0deSMatthias Ringwald new_eatt_client->mtu = 64; 32727627a0deSMatthias Ringwald new_eatt_client->security_level = LEVEL_0; 32737627a0deSMatthias Ringwald new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 3274052dc82aSMatthias Ringwald new_eatt_client->state = P_W4_L2CAP_CONNECTION; 32757627a0deSMatthias Ringwald new_eatt_client->l2cap_cid = new_cids[i]; 32767627a0deSMatthias Ringwald new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer; 3277f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += max_mtu; 32787627a0deSMatthias Ringwald i++; 32797627a0deSMatthias Ringwald } 32807627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP; 32817627a0deSMatthias Ringwald } else { 32827627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, status); 32837627a0deSMatthias Ringwald } 328426166ecfSMatthias Ringwald } 328526166ecfSMatthias Ringwald 32866d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts){ 32876d0f6f49SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 32886d0f6f49SMatthias Ringwald if (gatt_client != NULL){ 32896d0f6f49SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 32906d0f6f49SMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 32916d0f6f49SMatthias Ringwald } 32926d0f6f49SMatthias Ringwald } 32936d0f6f49SMatthias Ringwald 329426166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 32957627a0deSMatthias Ringwald gatt_client_t *gatt_client; 32967627a0deSMatthias Ringwald gatt_client_t *eatt_client; 329726166ecfSMatthias Ringwald hci_con_handle_t con_handle; 32987627a0deSMatthias Ringwald uint16_t l2cap_cid; 329926166ecfSMatthias Ringwald uint8_t status; 330026166ecfSMatthias Ringwald gatt_client_characteristic_t characteristic; 33017627a0deSMatthias Ringwald gatt_client_service_t service; 3302df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3303df0a5c68SMatthias Ringwald uint8_t num_pending_channels; 330426166ecfSMatthias Ringwald switch (packet_type) { 330526166ecfSMatthias Ringwald case HCI_EVENT_PACKET: 330626166ecfSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 33077627a0deSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 33087627a0deSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 33097627a0deSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 33107627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 33117627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE); 33127627a0deSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 33137627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 33147627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 33157627a0deSMatthias Ringwald break; 331626166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 331726166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 331826166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 331926166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 33207627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE); 332126166ecfSMatthias Ringwald if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) { 33227627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0]; 332326166ecfSMatthias Ringwald } 332426166ecfSMatthias Ringwald break; 332526166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 332626166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 332726166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 332826166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 33297627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE); 33307627a0deSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 333126166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = characteristic.value_handle; 333226166ecfSMatthias Ringwald break; 333326166ecfSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 333426166ecfSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 333526166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 333626166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 33377627a0deSMatthias Ringwald switch (gatt_client->eatt_state){ 33387627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE: 33397627a0deSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle == 0){ 33407627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33417627a0deSMatthias Ringwald } else { 33427627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND; 33437627a0deSMatthias Ringwald } 33447627a0deSMatthias Ringwald break; 33457627a0deSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE: 33467627a0deSMatthias Ringwald if ((gatt_client->gatt_server_supported_features & 1) == 0) { 33477627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33487627a0deSMatthias Ringwald } else { 33497627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND; 33507627a0deSMatthias Ringwald } 33517627a0deSMatthias Ringwald break; 33527627a0deSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE: 33537627a0deSMatthias Ringwald if (gatt_client->gatt_client_supported_features_handle == 0){ 33547627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33557627a0deSMatthias Ringwald } else { 33567627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND; 33577627a0deSMatthias Ringwald } 33587627a0deSMatthias Ringwald break; 33597627a0deSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE: 33607627a0deSMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 336126166ecfSMatthias Ringwald break; 336226166ecfSMatthias Ringwald default: 336326166ecfSMatthias Ringwald break; 336426166ecfSMatthias Ringwald } 336526166ecfSMatthias Ringwald break; 33667627a0deSMatthias Ringwald case L2CAP_EVENT_ECBM_CHANNEL_OPENED: 33677627a0deSMatthias Ringwald l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet); 33687627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 33697627a0deSMatthias Ringwald 33707627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 33717627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 3372052dc82aSMatthias Ringwald btstack_assert(eatt_client->state == P_W4_L2CAP_CONNECTION); 33737627a0deSMatthias Ringwald 33747627a0deSMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 33757627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3376052dc82aSMatthias Ringwald eatt_client->state = P_READY; 33777627a0deSMatthias Ringwald eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 33787627a0deSMatthias Ringwald } else { 3379df0a5c68SMatthias Ringwald eatt_client->state = P_L2CAP_CLOSED; 33807627a0deSMatthias Ringwald } 3381df0a5c68SMatthias Ringwald // connected if opened event for all channels received 3382df0a5c68SMatthias Ringwald if (gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_W4_L2CAP_CONNECTION) == 0){ 33837627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS); 33847627a0deSMatthias Ringwald } 33857627a0deSMatthias Ringwald break; 33867627a0deSMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 33877627a0deSMatthias Ringwald l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet); 33887627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 33897627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 33907627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 33917627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 33927627a0deSMatthias Ringwald break; 33937627a0deSMatthias Ringwald default: 33947627a0deSMatthias Ringwald break; 33957627a0deSMatthias Ringwald } 33967627a0deSMatthias Ringwald break; 33977627a0deSMatthias Ringwald case L2CAP_DATA_PACKET: 33987627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client); 33997627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 3400ce82ac7fSMatthias Ringwald btstack_assert(eatt_client != NULL); 3401ce82ac7fSMatthias Ringwald gatt_client_handle_att_response(eatt_client, packet, size); 34027627a0deSMatthias Ringwald gatt_client_run(); 34037627a0deSMatthias Ringwald break; 340426166ecfSMatthias Ringwald default: 340526166ecfSMatthias Ringwald break; 340626166ecfSMatthias Ringwald } 340726166ecfSMatthias Ringwald } 340826166ecfSMatthias Ringwald 34097627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){ 341026166ecfSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 341126166ecfSMatthias Ringwald uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications 341226166ecfSMatthias Ringwald switch (gatt_client->eatt_state){ 34137627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND: 34147627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = 0; 34157627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE; 34167627a0deSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler, 34177627a0deSMatthias Ringwald gatt_client->con_handle, 34187627a0deSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 34197627a0deSMatthias Ringwald break; 342026166ecfSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND: 34217627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = 0; 34227627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE; 342326166ecfSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler, 34247627a0deSMatthias Ringwald gatt_client->con_handle, 34257627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 34267627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 342726166ecfSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES); 342826166ecfSMatthias Ringwald return true; 342926166ecfSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND: 34307627a0deSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = 0; 34317627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE; 343226166ecfSMatthias Ringwald status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler, 34337627a0deSMatthias Ringwald gatt_client->con_handle, 34347627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 34357627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 34367627a0deSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES); 343726166ecfSMatthias Ringwald return true; 343826166ecfSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND: 343926166ecfSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE; 344026166ecfSMatthias Ringwald status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle, 344126166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle, 1, 344226166ecfSMatthias Ringwald &gatt_client_supported_features); 344326166ecfSMatthias Ringwald return true; 344426166ecfSMatthias Ringwald default: 344526166ecfSMatthias Ringwald break; 344626166ecfSMatthias Ringwald } 34477627a0deSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 34487627a0deSMatthias Ringwald UNUSED(status); 344926166ecfSMatthias Ringwald return false; 345026166ecfSMatthias Ringwald } 345126166ecfSMatthias Ringwald 345226166ecfSMatthias 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) { 345326166ecfSMatthias Ringwald gatt_client_t * gatt_client; 345426166ecfSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 345526166ecfSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 345626166ecfSMatthias Ringwald return status; 345726166ecfSMatthias Ringwald } 345826166ecfSMatthias Ringwald 345926166ecfSMatthias Ringwald if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){ 346026166ecfSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 346126166ecfSMatthias Ringwald } 346226166ecfSMatthias Ringwald 3463f7a42e72SMatthias Ringwald // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports 34647627a0deSMatthias Ringwald uint16_t buffer_size_per_client = storage_size / num_channels; 3465f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 3466f7a42e72SMatthias Ringwald if (max_mtu < 64) { 34677627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 34687627a0deSMatthias Ringwald } 34697627a0deSMatthias Ringwald 34707627a0deSMatthias Ringwald if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){ 34717627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 34727627a0deSMatthias Ringwald } 34737627a0deSMatthias Ringwald 34747627a0deSMatthias Ringwald // create max num_channel eatt clients 34757627a0deSMatthias Ringwald uint8_t i; 34767627a0deSMatthias Ringwald btstack_linked_list_t eatt_clients = NULL; 34777627a0deSMatthias Ringwald for (i=0;i<num_channels;i++) { 34787627a0deSMatthias Ringwald gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get(); 34797627a0deSMatthias Ringwald if (new_gatt_client == NULL) { 34807627a0deSMatthias Ringwald break; 34817627a0deSMatthias Ringwald } 34827627a0deSMatthias Ringwald btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client); 34837627a0deSMatthias Ringwald } 34847627a0deSMatthias Ringwald 34857627a0deSMatthias Ringwald if (i != num_channels){ 34867627a0deSMatthias Ringwald while (true){ 34877627a0deSMatthias Ringwald gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients); 34887627a0deSMatthias Ringwald if (gatt_client == NULL) { 34897627a0deSMatthias Ringwald break; 34907627a0deSMatthias Ringwald } 34917627a0deSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 34927627a0deSMatthias Ringwald } 34937627a0deSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 34947627a0deSMatthias Ringwald } 34957627a0deSMatthias Ringwald 3496570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 3497570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = true; 3498570bdd2dSMatthias Ringwald 34997627a0deSMatthias Ringwald gatt_client->callback = callback; 35007627a0deSMatthias Ringwald gatt_client->eatt_num_clients = num_channels; 35017627a0deSMatthias Ringwald gatt_client->eatt_storage_buffer = storage_buffer; 35027627a0deSMatthias Ringwald gatt_client->eatt_storage_size = storage_size; 35037627a0deSMatthias Ringwald gatt_client->eatt_clients = eatt_clients; 35047627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND; 350526166ecfSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 350626166ecfSMatthias Ringwald 350726166ecfSMatthias Ringwald return ERROR_CODE_SUCCESS; 350826166ecfSMatthias Ringwald } 350926166ecfSMatthias Ringwald 351026166ecfSMatthias Ringwald #endif 351126166ecfSMatthias Ringwald 3512a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 3513a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 3514a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 3515a6121b51SMilanka Ringwald } 3516ae1ee62dSMilanka Ringwald 351740faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 351840faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client); 351940faeb84SMilanka Ringwald return status; 3520ae1ee62dSMilanka Ringwald } 3521a6121b51SMilanka Ringwald #endif 3522