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" 5116ece135SMatthias Ringwald #include "btstack_debug.h" 520e2df43fSMatthias Ringwald #include "btstack_event.h" 533deb3ec6SMatthias Ringwald #include "btstack_memory.h" 540e2df43fSMatthias Ringwald #include "btstack_run_loop.h" 550e2df43fSMatthias Ringwald #include "btstack_util.h" 563deb3ec6SMatthias Ringwald #include "hci.h" 573deb3ec6SMatthias Ringwald #include "hci_dump.h" 583deb3ec6SMatthias Ringwald #include "l2cap.h" 591450cdc6SMatthias Ringwald #include "classic/sdp_client.h" 601450cdc6SMatthias Ringwald #include "bluetooth_gatt.h" 611450cdc6SMatthias Ringwald #include "bluetooth_sdp.h" 621450cdc6SMatthias Ringwald #include "classic/sdp_util.h" 633deb3ec6SMatthias Ringwald 649c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections; 659c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners; 66361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 67f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration; 68f4b33574SMatthias Ringwald 6911279da7SMatthias Ringwald // GATT Client Configuration 7011279da7SMatthias Ringwald static bool gatt_client_mtu_exchange_enabled; 7111279da7SMatthias Ringwald static gap_security_level_t gatt_client_required_security_level; 725cf6c434SJakob Krantz 733deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size); 74f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 755cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code); 767a766ebfSMatthias Ringwald 777a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 783deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]); 797a766ebfSMatthias Ringwald #endif 803deb3ec6SMatthias Ringwald 8159b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 8259b5e157SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid); 8359b5e157SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status); 8459b5e157SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client); 85180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts); 8659b5e157SMatthias Ringwald #endif 8759b5e157SMatthias Ringwald 8826166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 897627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client); 90*6d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts); 9126166ecfSMatthias Ringwald #endif 9226166ecfSMatthias Ringwald 933deb3ec6SMatthias Ringwald void gatt_client_init(void){ 943deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 95f4b33574SMatthias Ringwald 9611279da7SMatthias Ringwald // default configuration 9711279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = true; 9811279da7SMatthias Ringwald gatt_client_required_security_level = LEVEL_0; 9911279da7SMatthias Ringwald 10011279da7SMatthias Ringwald // register for HCI Events 101f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 102361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 103361b1363SMatthias Ringwald 104f4b33574SMatthias Ringwald // register for SM Events 105f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 106f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 107f4b33574SMatthias Ringwald 108361b1363SMatthias Ringwald // and ATT Client PDUs 1093deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 1103deb3ec6SMatthias Ringwald } 1113deb3ec6SMatthias Ringwald 11211279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){ 11311279da7SMatthias Ringwald gatt_client_required_security_level = level; 11411279da7SMatthias Ringwald } 11511279da7SMatthias Ringwald 116ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 117665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 118665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 119665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1205cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1215cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1225cf1669fSMatthias Ringwald return gatt_client; 1233deb3ec6SMatthias Ringwald } 1243deb3ec6SMatthias Ringwald } 1253deb3ec6SMatthias Ringwald return NULL; 1263deb3ec6SMatthias Ringwald } 1273deb3ec6SMatthias Ringwald 128ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1295cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1305cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1315cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1325cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1333deb3ec6SMatthias Ringwald } 1343deb3ec6SMatthias Ringwald 1355cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1365cf1669fSMatthias Ringwald log_info("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1375cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1385cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1395cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1405cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1413deb3ec6SMatthias Ringwald } 1423deb3ec6SMatthias Ringwald 1435cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1445cf1669fSMatthias Ringwald log_info("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1455cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1463deb3ec6SMatthias Ringwald } 1473deb3ec6SMatthias Ringwald 1481dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){ 1491dfae9c7SMatthias Ringwald uint8_t encryption_key_size = gap_encryption_key_size(con_handle); 1501dfae9c7SMatthias Ringwald if (encryption_key_size == 0) return LEVEL_0; 1511dfae9c7SMatthias Ringwald 152ff3f1026SMatthias Ringwald bool authenticated = gap_authenticated(con_handle); 1531dfae9c7SMatthias Ringwald if (!authenticated) return LEVEL_2; 1541dfae9c7SMatthias Ringwald 1551dfae9c7SMatthias Ringwald return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3; 1561dfae9c7SMatthias Ringwald } 1571dfae9c7SMatthias Ringwald 1585cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 159665d90f2SMatthias Ringwald btstack_linked_item_t *it; 160a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1615cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1625cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1635cf1669fSMatthias Ringwald return gatt_client; 1643deb3ec6SMatthias Ringwald } 1653deb3ec6SMatthias Ringwald } 1663deb3ec6SMatthias Ringwald return NULL; 1673deb3ec6SMatthias Ringwald } 1683deb3ec6SMatthias Ringwald 1693deb3ec6SMatthias Ringwald 1706b65794dSMilanka Ringwald // @return gatt_client context 1713deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 17240faeb84SMilanka Ringwald static uint8_t gatt_client_provide_context_for_handle(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 1735cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 17440faeb84SMilanka Ringwald 17540faeb84SMilanka Ringwald if (gatt_client != NULL){ 17640faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 17740faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 17840faeb84SMilanka Ringwald } 1793deb3ec6SMatthias Ringwald 180ae1d1237SMatthias Ringwald // bail if no such hci connection 1810e0bba86SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 1820e0bba86SMatthias Ringwald if (hci_connection == NULL){ 183ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 18440faeb84SMilanka Ringwald *out_gatt_client = NULL; 18540faeb84SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 186ae1d1237SMatthias Ringwald } 18740faeb84SMilanka Ringwald 1885cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 18940faeb84SMilanka Ringwald if (gatt_client == NULL){ 19040faeb84SMilanka Ringwald *out_gatt_client = NULL; 19140faeb84SMilanka Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 19240faeb84SMilanka Ringwald } 1933deb3ec6SMatthias Ringwald // init state 194e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_LE; 1955cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 1965cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 1971dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 19811279da7SMatthias Ringwald if (gatt_client_mtu_exchange_enabled){ 1995cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 2005cf6c434SJakob Krantz } else { 2015cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 2025cf6c434SJakob Krantz } 203052dc82aSMatthias Ringwald gatt_client->state = P_READY; 204cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 205cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 206cbd76cecSMatthias Ringwald #endif 2075cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 2080e0bba86SMatthias Ringwald 2090e0bba86SMatthias Ringwald // get unenhanced att bearer state 2100e0bba86SMatthias Ringwald if (hci_connection->att_connection.mtu_exchanged){ 2110e0bba86SMatthias Ringwald gatt_client->mtu = hci_connection->att_connection.mtu; 2120e0bba86SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 2130e0bba86SMatthias Ringwald } 21440faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 21540faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 2163deb3ec6SMatthias Ringwald } 2173deb3ec6SMatthias Ringwald 218de27733dSMatthias Ringwald static bool is_ready(gatt_client_t * gatt_client){ 219052dc82aSMatthias Ringwald return gatt_client->state == P_READY; 220de27733dSMatthias Ringwald } 221de27733dSMatthias Ringwald 222de27733dSMatthias Ringwald static uint8_t gatt_client_provide_context_for_request(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 223de27733dSMatthias Ringwald gatt_client_t * gatt_client = NULL; 224de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 22540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 22640faeb84SMilanka Ringwald return status; 22740faeb84SMilanka Ringwald } 228de27733dSMatthias Ringwald 2297627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2307627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 2317627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 2327627a0deSMatthias Ringwald gatt_client_t * eatt_client = NULL; 2337627a0deSMatthias Ringwald // find free eatt client 2347627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 2357627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 2367627a0deSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 237052dc82aSMatthias Ringwald if (client->state == P_READY){ 2387627a0deSMatthias Ringwald eatt_client = client; 2397627a0deSMatthias Ringwald break; 2407627a0deSMatthias Ringwald } 2417627a0deSMatthias Ringwald } 2427627a0deSMatthias Ringwald if (eatt_client == NULL){ 2437627a0deSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2447627a0deSMatthias Ringwald } 2457627a0deSMatthias Ringwald gatt_client = eatt_client; 2467627a0deSMatthias Ringwald } 2477627a0deSMatthias Ringwald #endif 2487627a0deSMatthias Ringwald 249de27733dSMatthias Ringwald if (is_ready(gatt_client) == 0){ 250de27733dSMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2513deb3ec6SMatthias Ringwald } 2523deb3ec6SMatthias Ringwald 253de27733dSMatthias Ringwald gatt_client_timeout_start(gatt_client); 254de27733dSMatthias Ringwald 255de27733dSMatthias Ringwald *out_gatt_client = gatt_client; 256de27733dSMatthias Ringwald 257de27733dSMatthias Ringwald return status; 2583deb3ec6SMatthias Ringwald } 2593deb3ec6SMatthias Ringwald 260fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 26140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 26240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 26340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 26440faeb84SMilanka Ringwald return 0; 26540faeb84SMilanka Ringwald } 266aacf1b1aSMilanka Ringwald return is_ready(gatt_client) ? 1 : 0; 2673deb3ec6SMatthias Ringwald } 2683deb3ec6SMatthias Ringwald 2695cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 27011279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = enabled != 0; 2715cf6c434SJakob Krantz } 2725cf6c434SJakob Krantz 273fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 27440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 27540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 27640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 27740faeb84SMilanka Ringwald return status; 27840faeb84SMilanka Ringwald } 2797d2258b3SMilanka Ringwald 2805cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2815cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2827d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2833deb3ec6SMatthias Ringwald } 2843deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 285616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2863deb3ec6SMatthias Ringwald } 2873deb3ec6SMatthias Ringwald 2887627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2897627a0deSMatthias Ringwald // TODO: re-use single buffer for all eatt channels 2907627a0deSMatthias Ringwald static uint8_t gatt_client_le_enhanced_request_buffer[512]; 2917627a0deSMatthias Ringwald #endif 2927627a0deSMatthias Ringwald 2939228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) { 2947627a0deSMatthias Ringwald switch (gatt_client->bearer_type){ 2957627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2967627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 2977627a0deSMatthias Ringwald #endif 2987627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 2999228fd32SMatthias Ringwald l2cap_reserve_packet_buffer(); 3009228fd32SMatthias Ringwald return l2cap_get_outgoing_buffer(); 3017627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3027627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3037627a0deSMatthias Ringwald return gatt_client->eatt_storage_buffer; 3047627a0deSMatthias Ringwald #endif 3057627a0deSMatthias Ringwald default: 3067627a0deSMatthias Ringwald btstack_unreachable(); 3077627a0deSMatthias Ringwald break; 3087627a0deSMatthias Ringwald } 3097627a0deSMatthias Ringwald return NULL; 3109228fd32SMatthias Ringwald } 3119228fd32SMatthias Ringwald 3123deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3136e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){ 31446012949SMatthias Ringwald switch (gatt_client->bearer_type){ 31546012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3166e7b444cSMatthias Ringwald return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len); 31746012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 31846012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 31946012949SMatthias Ringwald return l2cap_send_prepared(gatt_client->l2cap_cid, len); 32046012949SMatthias Ringwald #endif 3217627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3227627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3237627a0deSMatthias Ringwald return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len); 3247627a0deSMatthias Ringwald #endif 32546012949SMatthias Ringwald default: 32646012949SMatthias Ringwald btstack_unreachable(); 32746012949SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 32846012949SMatthias Ringwald } 3293deb3ec6SMatthias Ringwald } 3303deb3ec6SMatthias Ringwald 3313deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3326e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) { 3339228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3346e7b444cSMatthias Ringwald 3356e7b444cSMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 3366e7b444cSMatthias Ringwald 3376e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 1); 3386e7b444cSMatthias Ringwald } 3396e7b444cSMatthias Ringwald 3406e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE 3416e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle, 3426e7b444cSMatthias Ringwald uint16_t end_handle) { 3439228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3446e7b444cSMatthias Ringwald 3453deb3ec6SMatthias Ringwald request[0] = request_type; 346f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 347f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3483deb3ec6SMatthias Ringwald 3496e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 3503deb3ec6SMatthias Ringwald } 3513deb3ec6SMatthias Ringwald 3523deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3536e7b444cSMatthias Ringwald static uint8_t 3546e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type, 3556e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) { 3569228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3573deb3ec6SMatthias Ringwald request[0] = request_type; 3589228fd32SMatthias Ringwald 359f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 360f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 361f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 3626535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 3633deb3ec6SMatthias Ringwald 3646e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7u + value_size); 3653deb3ec6SMatthias Ringwald } 3663deb3ec6SMatthias Ringwald 3673deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3686e7b444cSMatthias Ringwald static uint8_t 3696e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16, 3706e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3719228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3726e7b444cSMatthias Ringwald 3733deb3ec6SMatthias Ringwald request[0] = request_type; 374f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 375f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 376f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 3773deb3ec6SMatthias Ringwald 3786e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7); 3793deb3ec6SMatthias Ringwald } 3803deb3ec6SMatthias Ringwald 3813deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3826e7b444cSMatthias Ringwald static uint8_t 3836e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128, 3846e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3859228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3866e7b444cSMatthias Ringwald 3873deb3ec6SMatthias Ringwald request[0] = request_type; 388f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 389f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3909c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 3913deb3ec6SMatthias Ringwald 3926e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 21); 3933deb3ec6SMatthias Ringwald } 3943deb3ec6SMatthias Ringwald 3953deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3966e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) { 3979228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3986e7b444cSMatthias Ringwald 3993deb3ec6SMatthias Ringwald request[0] = request_type; 400f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4013deb3ec6SMatthias Ringwald 4026e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 4033deb3ec6SMatthias Ringwald } 4043deb3ec6SMatthias Ringwald 4053deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4066e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4076e7b444cSMatthias Ringwald uint16_t value_offset) { 4089228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4099228fd32SMatthias Ringwald 4103deb3ec6SMatthias Ringwald request[0] = request_type; 411f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 412f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4133deb3ec6SMatthias Ringwald 4146e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 4153deb3ec6SMatthias Ringwald } 4163deb3ec6SMatthias Ringwald 4176e7b444cSMatthias Ringwald static uint8_t 418f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) { 4199228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4209228fd32SMatthias Ringwald 421f125a8efSMatthias Ringwald request[0] = opcode; 4229228fd32SMatthias Ringwald uint16_t i; 4239228fd32SMatthias Ringwald uint16_t offset = 1; 4243deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 425f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 4263deb3ec6SMatthias Ringwald offset += 2; 4273deb3ec6SMatthias Ringwald } 42825b7c058SMilanka Ringwald 4296e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, offset); 4303deb3ec6SMatthias Ringwald } 4313deb3ec6SMatthias Ringwald 432f125a8efSMatthias Ringwald static uint8_t 433f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 434f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST); 435f125a8efSMatthias Ringwald } 436f125a8efSMatthias Ringwald 437f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 438f125a8efSMatthias Ringwald static uint8_t 439f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 440f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_VARIABLE_REQ); 441f125a8efSMatthias Ringwald } 442f125a8efSMatthias Ringwald #endif 443f125a8efSMatthias Ringwald 4447a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4453deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4466e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle, 4476e7b444cSMatthias Ringwald uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) { 4489228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4499228fd32SMatthias Ringwald 4503deb3ec6SMatthias Ringwald request[0] = request_type; 451f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4526535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 453f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 4549c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 45525b7c058SMilanka Ringwald 4566e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3 + value_length + 12); 4573deb3ec6SMatthias Ringwald } 4587a766ebfSMatthias Ringwald #endif 4593deb3ec6SMatthias Ringwald 4603deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4616e7b444cSMatthias Ringwald static uint8_t 4626e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length, 4636e7b444cSMatthias Ringwald uint8_t *value) { 4649228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4659228fd32SMatthias Ringwald 4663deb3ec6SMatthias Ringwald request[0] = request_type; 467f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4686535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 4693deb3ec6SMatthias Ringwald 4706e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3u + value_length); 4713deb3ec6SMatthias Ringwald } 4723deb3ec6SMatthias Ringwald 4733deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4746e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) { 4759228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4769228fd32SMatthias Ringwald 4773deb3ec6SMatthias Ringwald request[0] = request_type; 4783deb3ec6SMatthias Ringwald request[1] = execute_write; 47925b7c058SMilanka Ringwald 4806e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 2); 4813deb3ec6SMatthias Ringwald } 4823deb3ec6SMatthias Ringwald 4833deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4846e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4856e7b444cSMatthias Ringwald uint16_t value_offset, uint16_t blob_length, uint8_t *value) { 4869228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4879228fd32SMatthias Ringwald 4883deb3ec6SMatthias Ringwald request[0] = request_type; 489f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 490f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4916535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 4923deb3ec6SMatthias Ringwald 4936e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5u + blob_length); 4943deb3ec6SMatthias Ringwald } 4953deb3ec6SMatthias Ringwald 4966e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) { 4979228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4989228fd32SMatthias Ringwald 4993deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 5009228fd32SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 501f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 50225b7c058SMilanka Ringwald 5036e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 5043deb3ec6SMatthias Ringwald } 5053deb3ec6SMatthias Ringwald 5065cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 507dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 5085cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 5093deb3ec6SMatthias Ringwald return 0; 5103deb3ec6SMatthias Ringwald } 5115cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 5123deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 5133deb3ec6SMatthias Ringwald return rest_length; 5143deb3ec6SMatthias Ringwald } 5153deb3ec6SMatthias Ringwald return max_blob_length; 5163deb3ec6SMatthias Ringwald } 5173deb3ec6SMatthias Ringwald 5185cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 5196e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST, 5206e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5216e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5223deb3ec6SMatthias Ringwald } 5233deb3ec6SMatthias Ringwald 5245cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 5255cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 5263deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 5275cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 5286e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5296e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 5303deb3ec6SMatthias Ringwald return; 5313deb3ec6SMatthias Ringwald } 5323deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5335cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 5346e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5356e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16); 5363deb3ec6SMatthias Ringwald } 5373deb3ec6SMatthias Ringwald 5385cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 5395cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 5403deb3ec6SMatthias Ringwald } 5413deb3ec6SMatthias Ringwald 5425cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 5436e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle); 5443deb3ec6SMatthias Ringwald } 5453deb3ec6SMatthias Ringwald 5465cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 5476e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5486e7b444cSMatthias Ringwald GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle, 5496e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5503deb3ec6SMatthias Ringwald } 5513deb3ec6SMatthias Ringwald 5525cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 5536e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5546e7b444cSMatthias Ringwald GATT_CHARACTERISTICS_UUID, gatt_client->start_group_handle, 5556e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5563deb3ec6SMatthias Ringwald } 5573deb3ec6SMatthias Ringwald 5585cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 5596e7b444cSMatthias Ringwald att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle, 5606e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5613deb3ec6SMatthias Ringwald } 5623deb3ec6SMatthias Ringwald 5635cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 5646e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 5653deb3ec6SMatthias Ringwald } 5663deb3ec6SMatthias Ringwald 5675cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 5685cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 5696e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5706e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5716e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5723deb3ec6SMatthias Ringwald } else { 5736e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5746e7b444cSMatthias Ringwald gatt_client->uuid128, gatt_client->start_group_handle, 5756e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5763deb3ec6SMatthias Ringwald } 5773deb3ec6SMatthias Ringwald } 5783deb3ec6SMatthias Ringwald 5795cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 58030952227SMilanka Ringwald if (gatt_client->attribute_offset == 0){ 5816e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 58230952227SMilanka Ringwald } else { 5836e7b444cSMatthias Ringwald att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle, 5846e7b444cSMatthias Ringwald gatt_client->attribute_offset); 5853deb3ec6SMatthias Ringwald } 58630952227SMilanka Ringwald } 5873deb3ec6SMatthias Ringwald 5885cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 5896e7b444cSMatthias Ringwald att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 5903deb3ec6SMatthias Ringwald } 5913deb3ec6SMatthias Ringwald 592f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 593f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){ 594f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 595f125a8efSMatthias Ringwald } 596f125a8efSMatthias Ringwald #endif 597f125a8efSMatthias Ringwald 5985cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 5996e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length, 6006e7b444cSMatthias Ringwald gatt_client->attribute_value); 6013deb3ec6SMatthias Ringwald } 6023deb3ec6SMatthias Ringwald 6035cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6046e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2, 6056e7b444cSMatthias Ringwald gatt_client->client_characteristic_configuration_value); 6063deb3ec6SMatthias Ringwald } 6073deb3ec6SMatthias Ringwald 6085cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 6096e7b444cSMatthias Ringwald att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle, 6106e7b444cSMatthias Ringwald gatt_client->attribute_offset, write_blob_length(gatt_client), 6116e7b444cSMatthias Ringwald gatt_client->attribute_value); 6123deb3ec6SMatthias Ringwald } 6133deb3ec6SMatthias Ringwald 6145cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 6156e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1); 6163deb3ec6SMatthias Ringwald } 6173deb3ec6SMatthias Ringwald 6185cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 6196e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0); 6203deb3ec6SMatthias Ringwald } 6213deb3ec6SMatthias Ringwald 622abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 6235cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6246e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 6256e7b444cSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, 6266e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle); 6273deb3ec6SMatthias Ringwald } 628abdc9fb5SMatthias Ringwald #endif 6293deb3ec6SMatthias Ringwald 6305cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 6316e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 6323deb3ec6SMatthias Ringwald } 6333deb3ec6SMatthias Ringwald 6347a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 6355cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 6366e7b444cSMatthias Ringwald att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, 6376e7b444cSMatthias Ringwald gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, 6386e7b444cSMatthias Ringwald gatt_client->cmac); 6393deb3ec6SMatthias Ringwald } 6407a766ebfSMatthias Ringwald #endif 6413deb3ec6SMatthias Ringwald 6423deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 64339ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6443deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 64539ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6464ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 6473deb3ec6SMatthias Ringwald } 6483deb3ec6SMatthias Ringwald 6493deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 65039ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6513deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65239ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6534ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 6543deb3ec6SMatthias Ringwald } 6553deb3ec6SMatthias Ringwald 6563deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 65739ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6583deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65939ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 660f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 6613deb3ec6SMatthias Ringwald } 6623deb3ec6SMatthias Ringwald 66353e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){ 66419c614acSMatthias Ringwald 66519c614acSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 66619c614acSMatthias Ringwald // if eatt is ready, notify all clients that can send a query 66719c614acSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 66819c614acSMatthias Ringwald btstack_linked_list_iterator_t it; 66919c614acSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 67019c614acSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 67119c614acSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 672052dc82aSMatthias Ringwald if (client->state == P_READY){ 67319c614acSMatthias Ringwald // call callback 67419c614acSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 67519c614acSMatthias Ringwald if (callback == NULL) { 67619c614acSMatthias Ringwald return; 67719c614acSMatthias Ringwald } 67819c614acSMatthias Ringwald (*callback->callback)(callback->context); 67919c614acSMatthias Ringwald } 68019c614acSMatthias Ringwald } 68119c614acSMatthias Ringwald return; 68219c614acSMatthias Ringwald } 68319c614acSMatthias Ringwald #endif 68419c614acSMatthias Ringwald 685052dc82aSMatthias Ringwald while (gatt_client->state == P_READY){ 68626166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 6877627a0deSMatthias Ringwald bool query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client); 68826166ecfSMatthias Ringwald if (query_sent){ 68926166ecfSMatthias Ringwald continue; 69026166ecfSMatthias Ringwald } 69126166ecfSMatthias Ringwald #endif 69253e9c18fSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 69309834412SMatthias Ringwald if (callback == NULL) { 69409834412SMatthias Ringwald return; 69553e9c18fSMatthias Ringwald } 69609834412SMatthias Ringwald (*callback->callback)(callback->context); 69753e9c18fSMatthias Ringwald } 69853e9c18fSMatthias Ringwald } 69953e9c18fSMatthias Ringwald 70023d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 70123d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) { 70223d583b8SMatthias Ringwald // ignore messages until re-encryption is complete 70323d583b8SMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 70423d583b8SMatthias Ringwald 70523d583b8SMatthias Ringwald // after that ignore if bonded but not encrypted 70623d583b8SMatthias Ringwald return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0); 70723d583b8SMatthias Ringwald } 70823d583b8SMatthias Ringwald 7099c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 7109c662c9bSMatthias Ringwald if (!callback) return; 71192da54c4SMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 1, packet, size); 7129c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 7133deb3ec6SMatthias Ringwald } 7143deb3ec6SMatthias Ringwald 715711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 716665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 7179c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 718665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 71986c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 720b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 721b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 72286c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 7233deb3ec6SMatthias Ringwald } 7243deb3ec6SMatthias Ringwald } 7253deb3ec6SMatthias Ringwald 7265cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 7273deb3ec6SMatthias Ringwald // @format H1 7283deb3ec6SMatthias Ringwald uint8_t packet[5]; 7295611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 7303deb3ec6SMatthias Ringwald packet[1] = 3; 7315cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7327d2258b3SMilanka Ringwald packet[4] = att_status; 7335cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7343deb3ec6SMatthias Ringwald } 7353deb3ec6SMatthias Ringwald 736045d700dSDavid 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){ 7373deb3ec6SMatthias Ringwald // @format HX 7383deb3ec6SMatthias Ringwald uint8_t packet[24]; 7395611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 7404ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7415cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7423deb3ec6SMatthias Ringwald /// 743f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 744f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 7459c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 7465cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7473deb3ec6SMatthias Ringwald } 7483deb3ec6SMatthias Ringwald 749045d700dSDavid 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){ 7503deb3ec6SMatthias Ringwald // @format HX 7513deb3ec6SMatthias Ringwald uint8_t packet[26]; 7525611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 7534ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7545cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7553deb3ec6SMatthias Ringwald /// 756f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 7573deb3ec6SMatthias Ringwald // 758f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 759f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 7609c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 7615cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7623deb3ec6SMatthias Ringwald } 7633deb3ec6SMatthias Ringwald 7645cf1669fSMatthias 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, 765045d700dSDavid Lechner uint16_t properties, const uint8_t * uuid128){ 7663deb3ec6SMatthias Ringwald // @format HY 7673deb3ec6SMatthias Ringwald uint8_t packet[28]; 7685611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 7694ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7705cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7713deb3ec6SMatthias Ringwald /// 772f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_handle); 773f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 774f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 775f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 7769c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 7775cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7783deb3ec6SMatthias Ringwald } 7793deb3ec6SMatthias Ringwald 7803deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 781045d700dSDavid Lechner gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 7823deb3ec6SMatthias Ringwald // @format HZ 7833deb3ec6SMatthias Ringwald uint8_t packet[22]; 7845611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 7854ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7865cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7873deb3ec6SMatthias Ringwald /// 788f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 7899c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 7905cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7913deb3ec6SMatthias Ringwald } 7923deb3ec6SMatthias Ringwald 7935cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 7948f37572aSJakob Krantz // @format H2 7958f37572aSJakob Krantz uint8_t packet[6]; 7968f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 7974ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7985cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7998f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 8005cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 8015cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 8028f37572aSJakob Krantz } 80323d583b8SMatthias Ringwald 80423d583b8SMatthias Ringwald // helper 80523d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) { 806052dc82aSMatthias Ringwald gatt_client->state = P_READY; 80723d583b8SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 80823d583b8SMatthias Ringwald emit_gatt_complete_event(gatt_client, att_status); 80923d583b8SMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 81023d583b8SMatthias Ringwald } 81123d583b8SMatthias Ringwald 81223d583b8SMatthias Ringwald // @return packet pointer 81323d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 81423d583b8SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 8 81523d583b8SMatthias 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){ 81623d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 81723d583b8SMatthias Ringwald // copy value into test packet for testing 81823d583b8SMatthias Ringwald static uint8_t packet[1000]; 81923d583b8SMatthias Ringwald memcpy(&packet[8], value, length); 82023d583b8SMatthias Ringwald #else 82123d583b8SMatthias Ringwald // before the value inside the ATT PDU 82223d583b8SMatthias Ringwald uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 82323d583b8SMatthias Ringwald #endif 82423d583b8SMatthias Ringwald packet[0] = type; 82523d583b8SMatthias Ringwald packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 82623d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 82723d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 82823d583b8SMatthias Ringwald little_endian_store_16(packet, 6, length); 82923d583b8SMatthias Ringwald return packet; 83023d583b8SMatthias Ringwald } 83123d583b8SMatthias Ringwald 83223d583b8SMatthias Ringwald // @return packet pointer 83323d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 83423d583b8SMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 10 83523d583b8SMatthias 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){ 83623d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 83723d583b8SMatthias Ringwald // avoid using pre ATT headers. 83823d583b8SMatthias Ringwald return NULL; 83923d583b8SMatthias Ringwald #endif 84023d583b8SMatthias 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) 84123d583b8SMatthias Ringwald // before the value inside the ATT PDU 84223d583b8SMatthias Ringwald uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 84323d583b8SMatthias Ringwald packet[0] = type; 84423d583b8SMatthias Ringwald packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 84523d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 84623d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 84723d583b8SMatthias Ringwald little_endian_store_16(packet, 6, offset); 84823d583b8SMatthias Ringwald little_endian_store_16(packet, 8, length); 84923d583b8SMatthias Ringwald return packet; 85023d583b8SMatthias Ringwald #else 85123d583b8SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 85223d583b8SMatthias Ringwald return NULL; 85323d583b8SMatthias Ringwald #endif 85423d583b8SMatthias Ringwald } 85523d583b8SMatthias Ringwald 856f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE) 857f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 858f7a42e72SMatthias Ringwald #else 859f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 860f7a42e72SMatthias Ringwald #endif 861f7a42e72SMatthias Ringwald 8628f37572aSJakob Krantz /// 8635cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 86439ac9711SMatthias Ringwald if (size < 2) return; 8653deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 8664ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 8673deb3ec6SMatthias Ringwald 8683deb3ec6SMatthias Ringwald int i; 86939ac9711SMatthias Ringwald for (i = 2; (i+attr_length) <= size; i += attr_length){ 870f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 871f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 8723deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8733deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8743deb3ec6SMatthias Ringwald 8754ea43905SMatthias Ringwald if (uuid_length == 2u){ 876f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 877e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 87839ac9711SMatthias Ringwald } else if (uuid_length == 16u) { 8799c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 88039ac9711SMatthias Ringwald } else { 88139ac9711SMatthias Ringwald return; 8823deb3ec6SMatthias Ringwald } 8835cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 8843deb3ec6SMatthias Ringwald } 8853deb3ec6SMatthias Ringwald } 8863deb3ec6SMatthias Ringwald 88723d583b8SMatthias 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){ 8883deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8893deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8904ea43905SMatthias Ringwald if (uuid_length == 2u){ 891f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 892e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 8934ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 8949c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 895d73c9dbeSMilanka Ringwald } else { 896d73c9dbeSMilanka Ringwald return; 8973deb3ec6SMatthias Ringwald } 8983deb3ec6SMatthias Ringwald 8995cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 9003deb3ec6SMatthias Ringwald 9015cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 9025cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 9035cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 9043deb3ec6SMatthias Ringwald 9055cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 9063deb3ec6SMatthias Ringwald 9075cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 9085cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 9093deb3ec6SMatthias Ringwald } 9103deb3ec6SMatthias Ringwald 91123d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 9123deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 9133deb3ec6SMatthias Ringwald 9145cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 9153deb3ec6SMatthias Ringwald 9165cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 9175cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 9183deb3ec6SMatthias Ringwald 9195cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 9203deb3ec6SMatthias Ringwald } 9213deb3ec6SMatthias Ringwald 92223d583b8SMatthias Ringwald 9235cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 9244ea43905SMatthias Ringwald if (size < 2u) return; 9253deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 9264ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 9274ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 9283deb3ec6SMatthias Ringwald int i; 9294ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 930f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 9313deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 932f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 93323d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, start_handle - 1u); 93423d583b8SMatthias Ringwald report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], 93523d583b8SMatthias Ringwald uuid_length); 9363deb3ec6SMatthias Ringwald } 9373deb3ec6SMatthias Ringwald } 9383deb3ec6SMatthias Ringwald 9395cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 9403deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 941e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 9425cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9435cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 9443deb3ec6SMatthias Ringwald } 9453deb3ec6SMatthias Ringwald 946045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){ 9475cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9485cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 9493deb3ec6SMatthias Ringwald } 9503deb3ec6SMatthias Ringwald 9513deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9520fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9530fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9540fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, gatt_client->con_handle, value_handle, value, length); 95523d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9563deb3ec6SMatthias Ringwald } 9573deb3ec6SMatthias Ringwald 9583deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9590fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9600fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9610fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, gatt_client->con_handle, value_handle, value, length); 96223d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9633deb3ec6SMatthias Ringwald } 9643deb3ec6SMatthias Ringwald 9653deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9665cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 9675cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 96823d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9693deb3ec6SMatthias Ringwald } 9703deb3ec6SMatthias Ringwald 9713deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9725cf1669fSMatthias 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){ 9735cf1669fSMatthias 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); 9743deb3ec6SMatthias Ringwald if (!packet) return; 97523d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9763deb3ec6SMatthias Ringwald } 9773deb3ec6SMatthias Ringwald 9785cf1669fSMatthias 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){ 9799ec2630cSMatthias Ringwald UNUSED(value_offset); 9805cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 9815cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 9823deb3ec6SMatthias Ringwald } 9833deb3ec6SMatthias Ringwald 9845cf1669fSMatthias 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){ 9855cf1669fSMatthias 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); 9863deb3ec6SMatthias Ringwald if (!packet) return; 98723d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9883deb3ec6SMatthias Ringwald } 9893deb3ec6SMatthias Ringwald 9905cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 9913deb3ec6SMatthias Ringwald int i; 9924ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 993f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 9943deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 9953deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 9964ea43905SMatthias Ringwald if (pair_size == 4u){ 997f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 998e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 9993deb3ec6SMatthias Ringwald } else { 10009c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 10013deb3ec6SMatthias Ringwald } 10025cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 10033deb3ec6SMatthias Ringwald } 10043deb3ec6SMatthias Ringwald 10053deb3ec6SMatthias Ringwald } 10063deb3ec6SMatthias Ringwald 10075cf1669fSMatthias Ringwald static int is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10085cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 10093deb3ec6SMatthias Ringwald } 10103deb3ec6SMatthias Ringwald 10115cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 10125cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 1013526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10143deb3ec6SMatthias Ringwald return; 10153deb3ec6SMatthias Ringwald } 10163deb3ec6SMatthias Ringwald // next 10175cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 1018052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10193deb3ec6SMatthias Ringwald } 10203deb3ec6SMatthias Ringwald 10215cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10225cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 10233deb3ec6SMatthias Ringwald } 10243deb3ec6SMatthias Ringwald 10255cf1669fSMatthias Ringwald static void trigger_next_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_SERVICE_QUERY); 10273deb3ec6SMatthias Ringwald } 10283deb3ec6SMatthias Ringwald 10295cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_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_WITH_UUID_QUERY); 10313deb3ec6SMatthias Ringwald } 10323deb3ec6SMatthias Ringwald 10335cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10345cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 10353deb3ec6SMatthias Ringwald // report last characteristic 103623d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 10373deb3ec6SMatthias Ringwald } 10385cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 10393deb3ec6SMatthias Ringwald } 10403deb3ec6SMatthias Ringwald 10415cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10425cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 10433deb3ec6SMatthias Ringwald } 10443deb3ec6SMatthias Ringwald 10455cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10465cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 10473deb3ec6SMatthias Ringwald } 10483deb3ec6SMatthias Ringwald 10495cf1669fSMatthias 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){ 10505cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 10515cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 10523deb3ec6SMatthias Ringwald 10534ea43905SMatthias Ringwald if (next_blob_length == 0u){ 1054052dc82aSMatthias Ringwald gatt_client->state = done_state; 10553deb3ec6SMatthias Ringwald return; 10563deb3ec6SMatthias Ringwald } 1057052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10583deb3ec6SMatthias Ringwald } 10593deb3ec6SMatthias Ringwald 10605cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 10613deb3ec6SMatthias Ringwald 1062dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 10633deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 1064526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10653deb3ec6SMatthias Ringwald return; 10663deb3ec6SMatthias Ringwald } 10673deb3ec6SMatthias Ringwald 10685cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 1069052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10703deb3ec6SMatthias Ringwald } 10713deb3ec6SMatthias Ringwald 107223d583b8SMatthias 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){ 107323d583b8SMatthias Ringwald notification->callback = callback; 107423d583b8SMatthias Ringwald notification->con_handle = con_handle; 107523d583b8SMatthias Ringwald if (characteristic == NULL){ 107623d583b8SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 107723d583b8SMatthias Ringwald } else { 107823d583b8SMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 107923d583b8SMatthias Ringwald } 108023d583b8SMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 108123d583b8SMatthias Ringwald } 108223d583b8SMatthias Ringwald 108323d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 108423d583b8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 108523d583b8SMatthias Ringwald } 10863deb3ec6SMatthias Ringwald 10875cf1669fSMatthias Ringwald static int is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 1088f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 1089f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 10903deb3ec6SMatthias Ringwald 10915cf1669fSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return 0; 10925cf1669fSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return 0; 10935cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 10943deb3ec6SMatthias Ringwald } 10953deb3ec6SMatthias Ringwald 10960038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 109792a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) { 109892a7335eSMatthias Ringwald sm_key_t csrk; 109992a7335eSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 110092a7335eSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 1101052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_RESULT; 110292a7335eSMatthias 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); 110392a7335eSMatthias Ringwald } 11040038504eSMatthias Ringwald #endif 110592a7335eSMatthias Ringwald 110692a7335eSMatthias Ringwald // returns true if packet was sent 11071979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 11083deb3ec6SMatthias Ringwald 1109e4d159baSMatthias Ringwald // wait until re-encryption is complete 11101979f09cSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 1111d1e1a57fSMatthias Ringwald 1112e4d159baSMatthias Ringwald // wait until re-encryption is complete 11131979f09cSMatthias Ringwald if (gatt_client->reencryption_active) return false; 11146c124bc2SMatthias Ringwald 111511279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 11161979f09cSMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return false; 111711279da7SMatthias Ringwald 1118052dc82aSMatthias Ringwald bool client_request_pending = gatt_client->state != P_READY; 1119fd14b205SMatthias Ringwald 11201aa9e3e8SMatthias Ringwald // verify security level for Mandatory Authentication over LE 112146012949SMatthias Ringwald bool check_security; 112246012949SMatthias Ringwald switch (gatt_client->bearer_type){ 112346012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 112446012949SMatthias Ringwald check_security = true; 112546012949SMatthias Ringwald break; 112646012949SMatthias Ringwald default: 11279ced96e1SMatthias Ringwald check_security = false; 112846012949SMatthias Ringwald break; 11299ced96e1SMatthias Ringwald } 11309ced96e1SMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){ 11311dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 11323503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 113311279da7SMatthias Ringwald // set att error code for pairing failure based on required level 113411279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 113511279da7SMatthias Ringwald case LEVEL_4: 113611279da7SMatthias Ringwald case LEVEL_3: 113711279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 113811279da7SMatthias Ringwald break; 113911279da7SMatthias Ringwald default: 114011279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 114111279da7SMatthias Ringwald break; 114211279da7SMatthias Ringwald } 114311279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 114411279da7SMatthias Ringwald // sm probably just sent a pdu 11451979f09cSMatthias Ringwald return true; 114611279da7SMatthias Ringwald } 1147f4b33574SMatthias Ringwald 11485cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 1149544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 11505cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 11516e7b444cSMatthias Ringwald att_exchange_mtu_request(gatt_client); 11521979f09cSMatthias Ringwald return true; 11533deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 11541979f09cSMatthias Ringwald return false; 11553deb3ec6SMatthias Ringwald default: 11563deb3ec6SMatthias Ringwald break; 11573deb3ec6SMatthias Ringwald } 11583deb3ec6SMatthias Ringwald 11595cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 11605cf1669fSMatthias Ringwald gatt_client->send_confirmation = 0; 11616e7b444cSMatthias Ringwald att_confirmation(gatt_client); 11621979f09cSMatthias Ringwald return true; 11633deb3ec6SMatthias Ringwald } 11643deb3ec6SMatthias Ringwald 11653deb3ec6SMatthias Ringwald // check MTU for writes 1166052dc82aSMatthias Ringwald switch (gatt_client->state){ 11673deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 11683deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1169dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 1170dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 1171526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 11721979f09cSMatthias Ringwald return false; 11733deb3ec6SMatthias Ringwald default: 11743deb3ec6SMatthias Ringwald break; 11753deb3ec6SMatthias Ringwald } 11763deb3ec6SMatthias Ringwald 11770038504eSMatthias Ringwald bool packet_sent = true; 11780038504eSMatthias Ringwald bool done = true; 1179052dc82aSMatthias Ringwald switch (gatt_client->state){ 11803deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 1181052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_QUERY_RESULT; 11825cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 11830038504eSMatthias Ringwald break; 11843deb3ec6SMatthias Ringwald 11853deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 1186052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_WITH_UUID_RESULT; 11875cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 11880038504eSMatthias Ringwald break; 11893deb3ec6SMatthias Ringwald 11903deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 1191052dc82aSMatthias Ringwald gatt_client->state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 11925cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11930038504eSMatthias Ringwald break; 11943deb3ec6SMatthias Ringwald 11953deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 1196052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 11975cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11980038504eSMatthias Ringwald break; 11993deb3ec6SMatthias Ringwald 12003deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 1201052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 12025cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 12030038504eSMatthias Ringwald break; 12043deb3ec6SMatthias Ringwald 12053deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 1206052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 12075cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 12080038504eSMatthias Ringwald break; 12093deb3ec6SMatthias Ringwald 12103deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 1211052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 12125cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 12130038504eSMatthias Ringwald break; 12143deb3ec6SMatthias Ringwald 12153deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 1216052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 12175cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 12180038504eSMatthias Ringwald break; 12193deb3ec6SMatthias Ringwald 12203deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 1221052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_RESULT; 12225cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 12230038504eSMatthias Ringwald break; 12243deb3ec6SMatthias Ringwald 12253deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 1226052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BY_TYPE_RESPONSE; 12275cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 12280038504eSMatthias Ringwald break; 12293deb3ec6SMatthias Ringwald 12303deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 1231052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_RESPONSE; 12325cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 12330038504eSMatthias Ringwald break; 12343deb3ec6SMatthias Ringwald 1235f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1236f125a8efSMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST: 1237052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE; 1238f125a8efSMatthias Ringwald send_gatt_read_multiple_variable_request(gatt_client); 1239f125a8efSMatthias Ringwald break; 1240f125a8efSMatthias Ringwald #endif 1241f125a8efSMatthias Ringwald 12423deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 1243052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 12445cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 12450038504eSMatthias Ringwald break; 12463deb3ec6SMatthias Ringwald 12473deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 1248052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_RESULT; 12495cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12500038504eSMatthias Ringwald break; 12513deb3ec6SMatthias Ringwald 12523deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 1253052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 12545cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12550038504eSMatthias Ringwald break; 12563deb3ec6SMatthias Ringwald 12573deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 1258052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 12595cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12600038504eSMatthias Ringwald break; 12613deb3ec6SMatthias Ringwald 12623deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 1263052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 12645cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 12650038504eSMatthias Ringwald break; 12663deb3ec6SMatthias Ringwald 12673deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 1268052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 12695cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12700038504eSMatthias Ringwald break; 12713deb3ec6SMatthias Ringwald 12723deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 1273052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 12745cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12750038504eSMatthias Ringwald break; 12763deb3ec6SMatthias Ringwald 1277abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1278abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1279abdc9fb5SMatthias Ringwald // use Find Information 12805cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12815cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1282abdc9fb5SMatthias Ringwald #else 12833deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1284abdc9fb5SMatthias Ringwald // Use Read By Type 1285052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12865cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1287abdc9fb5SMatthias Ringwald #endif 12880038504eSMatthias Ringwald break; 12893deb3ec6SMatthias Ringwald 12903deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 1291052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 12925cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 12930038504eSMatthias Ringwald break; 12943deb3ec6SMatthias Ringwald 12953deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 1296052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 12975cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 12980038504eSMatthias Ringwald break; 12993deb3ec6SMatthias Ringwald 13003deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1301052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13025cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 13030038504eSMatthias Ringwald break; 13043deb3ec6SMatthias Ringwald 13053deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 1306052dc82aSMatthias Ringwald gatt_client->state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 13075cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 13080038504eSMatthias Ringwald break; 13093deb3ec6SMatthias Ringwald 13103deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 1311052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13125cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 13130038504eSMatthias Ringwald break; 13143deb3ec6SMatthias Ringwald 13153deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 1316052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13175cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 13180038504eSMatthias Ringwald break; 13193deb3ec6SMatthias Ringwald 13207a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1321793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 13225cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 13235cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1324793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 13255cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 1326052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_READY; 132792a7335eSMatthias Ringwald if (sm_cmac_ready()){ 132892a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 132992a7335eSMatthias Ringwald } 1330793cf6ceSMatthias Ringwald break; 1331793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1332526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 133392a7335eSMatthias Ringwald break; 1334793cf6ceSMatthias Ringwald default: 133592a7335eSMatthias Ringwald break; 1336793cf6ceSMatthias Ringwald } 13370038504eSMatthias Ringwald packet_sent = false; 13380038504eSMatthias Ringwald break; 1339793cf6ceSMatthias Ringwald 13403deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 13413deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 134292a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 13433deb3ec6SMatthias Ringwald } 13440038504eSMatthias Ringwald packet_sent = false; 13450038504eSMatthias Ringwald break; 13463deb3ec6SMatthias Ringwald 13473deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 1348052dc82aSMatthias Ringwald gatt_client->state = P_W4_SEND_SINGED_WRITE_DONE; 13493deb3ec6SMatthias Ringwald // bump local signing counter 13505cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 13515cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 135264b12680SMatthias Ringwald // send signed write command 13535cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 13543deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1355526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1356b68ac7a5SMatthias Ringwald break; 13573deb3ec6SMatthias Ringwald } 13587a766ebfSMatthias Ringwald #endif 13593deb3ec6SMatthias Ringwald default: 1360b68ac7a5SMatthias Ringwald done = false; 13613deb3ec6SMatthias Ringwald break; 13623deb3ec6SMatthias Ringwald } 136347181045SMatthias Ringwald 13640038504eSMatthias Ringwald if (done){ 13650038504eSMatthias Ringwald return packet_sent; 13660038504eSMatthias Ringwald } 13670038504eSMatthias Ringwald 136859d34cd2SMatthias Ringwald // write without response callback 136959d34cd2SMatthias Ringwald btstack_context_callback_registration_t * callback = 137059d34cd2SMatthias Ringwald (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests); 137159d34cd2SMatthias Ringwald if (callback != NULL){ 137259d34cd2SMatthias Ringwald (*callback->callback)(callback->context); 137359d34cd2SMatthias Ringwald return true; 137459d34cd2SMatthias Ringwald } 137559d34cd2SMatthias Ringwald 137659d34cd2SMatthias Ringwald // requested can send now old 13775cf1669fSMatthias Ringwald if (gatt_client->write_without_response_callback){ 13785cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 13795cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 138047181045SMatthias Ringwald uint8_t event[4]; 138147181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 13824ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 13835cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 13845cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 13851979f09cSMatthias Ringwald return true; // to trigger requeueing (even if higher layer didn't sent) 138647181045SMatthias Ringwald } 138747181045SMatthias Ringwald 13881979f09cSMatthias Ringwald return false; 13893deb3ec6SMatthias Ringwald } 13903deb3ec6SMatthias Ringwald 1391544128c3SMatthias Ringwald static void gatt_client_run(void){ 1392544128c3SMatthias Ringwald btstack_linked_item_t *it; 1393109c2548SMatthias Ringwald bool packet_sent; 13947627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 13957627a0deSMatthias Ringwald btstack_linked_list_iterator_t it_eatt; 13967627a0deSMatthias Ringwald #endif 1397a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 13985cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 139946012949SMatthias Ringwald switch (gatt_client->bearer_type){ 140046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 14017627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 14027627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients); 14037627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it_eatt)) { 14047627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt); 1405052dc82aSMatthias Ringwald if (eatt_client->state != P_READY){ 14064c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle)){ 14077627a0deSMatthias Ringwald gatt_client_run_for_gatt_client(eatt_client); 14087627a0deSMatthias Ringwald } 14097627a0deSMatthias Ringwald } 14107627a0deSMatthias Ringwald } 14117627a0deSMatthias Ringwald #endif 141246012949SMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 141346012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 141446012949SMatthias Ringwald return; 141546012949SMatthias Ringwald } 1416109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 141746012949SMatthias Ringwald if (packet_sent){ 141846012949SMatthias Ringwald // request new permission 141946012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 142046012949SMatthias Ringwald // requeue client for fairness and exit 142146012949SMatthias Ringwald // note: iterator has become invalid 142246012949SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 142346012949SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 142446012949SMatthias Ringwald return; 142546012949SMatthias Ringwald } 142646012949SMatthias Ringwald break; 14271450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 142846012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 14291450cdc6SMatthias Ringwald if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) { 14301450cdc6SMatthias Ringwald continue; 14311450cdc6SMatthias Ringwald } 14321aa9e3e8SMatthias Ringwald 14331aa9e3e8SMatthias Ringwald // handle GATT over BR/EDR 14344c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle) == false) { 14354c226876SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 14361aa9e3e8SMatthias Ringwald return; 14371aa9e3e8SMatthias Ringwald } 1438109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 14391aa9e3e8SMatthias Ringwald if (packet_sent){ 14401aa9e3e8SMatthias Ringwald // request new permission 14411aa9e3e8SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 14421aa9e3e8SMatthias Ringwald // requeue client for fairness and exit 14431aa9e3e8SMatthias Ringwald // note: iterator has become invalid 14441aa9e3e8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14451aa9e3e8SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14461aa9e3e8SMatthias Ringwald return; 14471aa9e3e8SMatthias Ringwald } 144846012949SMatthias Ringwald break; 14491450cdc6SMatthias Ringwald #endif 145046012949SMatthias Ringwald default: 145146012949SMatthias Ringwald btstack_unreachable(); 145246012949SMatthias Ringwald break; 1453544128c3SMatthias Ringwald } 145446012949SMatthias Ringwald 145546012949SMatthias Ringwald 1456544128c3SMatthias Ringwald } 14573deb3ec6SMatthias Ringwald } 14583deb3ec6SMatthias Ringwald 14595cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 14605cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 1) return; 1461526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_error_code); 14623deb3ec6SMatthias Ringwald } 14633deb3ec6SMatthias Ringwald 146478c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){ 146578c4542aSMatthias Ringwald hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet); 146678c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 146778c4542aSMatthias Ringwald if (gatt_client == NULL) return; 146878c4542aSMatthias Ringwald 146978c4542aSMatthias Ringwald // update security level 147078c4542aSMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 147178c4542aSMatthias Ringwald 147278c4542aSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 147378c4542aSMatthias Ringwald gatt_client->reencryption_active = false; 147478c4542aSMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 147578c4542aSMatthias Ringwald 1476052dc82aSMatthias Ringwald if (gatt_client->state == P_READY) return; 147778c4542aSMatthias Ringwald 147878c4542aSMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 147978c4542aSMatthias Ringwald case ERROR_CODE_SUCCESS: 148078c4542aSMatthias Ringwald log_info("re-encryption success, retry operation"); 148178c4542aSMatthias Ringwald break; 148278c4542aSMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 148378c4542aSMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 148478c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 148578c4542aSMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 148678c4542aSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 148778c4542aSMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 148878c4542aSMatthias Ringwald // delete bonding information 148978c4542aSMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 149078c4542aSMatthias Ringwald btstack_assert(le_device_db_index >= 0); 149178c4542aSMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 149278c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 149378c4542aSMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 149478c4542aSMatthias Ringwald #endif 149578c4542aSMatthias Ringwald le_device_db_remove(le_device_db_index); 149678c4542aSMatthias Ringwald // trigger pairing again 149778c4542aSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 149878c4542aSMatthias Ringwald break; 149978c4542aSMatthias Ringwald } 150078c4542aSMatthias Ringwald #endif 150178c4542aSMatthias Ringwald // report bonding information missing 1502526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 150378c4542aSMatthias Ringwald break; 150478c4542aSMatthias Ringwald default: 150578c4542aSMatthias Ringwald // report bonding information missing 1506526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code); 150778c4542aSMatthias Ringwald break; 150878c4542aSMatthias Ringwald } 150978c4542aSMatthias Ringwald } 151078c4542aSMatthias Ringwald 151178c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){ 151278c4542aSMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 151378c4542aSMatthias Ringwald hci_con_handle_t con_handle = little_endian_read_16(packet,3); 151478c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 151578c4542aSMatthias Ringwald if (gatt_client == NULL) return; 151678c4542aSMatthias Ringwald 151778c4542aSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 151878c4542aSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 151978c4542aSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 152078c4542aSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 152178c4542aSMatthias Ringwald } 152278c4542aSMatthias Ringwald 1523f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 15241ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 15251ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 15269ec2630cSMatthias Ringwald 1527361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1528361b1363SMatthias Ringwald 1529f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 15305cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 15310e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 15323deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 153378c4542aSMatthias Ringwald gatt_client_handle_disconnection_complete(packet); 15343deb3ec6SMatthias Ringwald break; 1535f4b33574SMatthias Ringwald 1536f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1537f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1538f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 15395cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15405cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1541f4b33574SMatthias Ringwald 15421dfae9c7SMatthias Ringwald // update security level 15431dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 15441dfae9c7SMatthias Ringwald 15453503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 15463503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 1547f4b33574SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet)){ 15485cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1549ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1550f4b33574SMatthias Ringwald } else { 1551f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 15523deb3ec6SMatthias Ringwald } 1553f4b33574SMatthias Ringwald } 1554f4b33574SMatthias Ringwald break; 155511279da7SMatthias Ringwald 1556793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1557793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1558793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1559793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1560793cf6ceSMatthias Ringwald break; 1561793cf6ceSMatthias Ringwald #endif 1562a95ca902SMatthias Ringwald 15638918bbdaSMatthias Ringwald // re-encryption started 15648918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 15658918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 15668918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15678918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 15688918bbdaSMatthias Ringwald 15698918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 15708918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 15718918bbdaSMatthias Ringwald break; 15728918bbdaSMatthias Ringwald 1573ec9babacSMatthias Ringwald // re-encryption complete 1574ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 157578c4542aSMatthias Ringwald gatt_client_handle_reencryption_complete(packet); 1576ec9babacSMatthias Ringwald break; 15773deb3ec6SMatthias Ringwald default: 15783deb3ec6SMatthias Ringwald break; 15793deb3ec6SMatthias Ringwald } 15803deb3ec6SMatthias Ringwald 1581361b1363SMatthias Ringwald gatt_client_run(); 15823deb3ec6SMatthias Ringwald } 15833deb3ec6SMatthias Ringwald 15842da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1585052dc82aSMatthias Ringwald switch (gatt_client->state) { 15862da0d963SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: 15872da0d963SMatthias Ringwald if (size >= 17) { 15882da0d963SMatthias Ringwald uint8_t uuid128[16]; 15892da0d963SMatthias Ringwald reverse_128(&packet[1], uuid128); 15902da0d963SMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 15912da0d963SMatthias Ringwald } 15922da0d963SMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 15935611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15943deb3ec6SMatthias Ringwald break; 15952da0d963SMatthias Ringwald 15962da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 15972da0d963SMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1598526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 15992da0d963SMatthias Ringwald break; 16002da0d963SMatthias Ringwald 16012da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 16022da0d963SMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 16032da0d963SMatthias Ringwald size - 1u, 0u); 1604526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16052da0d963SMatthias Ringwald break; 16062da0d963SMatthias Ringwald 16072da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic 16082da0d963SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 16092da0d963SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 16102da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 16112da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u); 16122da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16132da0d963SMatthias Ringwald break; 16142da0d963SMatthias Ringwald 16152da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor 16162da0d963SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 16172da0d963SMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 16182da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 16192da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 16202da0d963SMatthias Ringwald size - 1u); 16212da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16222da0d963SMatthias Ringwald break; 16232da0d963SMatthias Ringwald 16243deb3ec6SMatthias Ringwald default: 16253deb3ec6SMatthias Ringwald break; 16263deb3ec6SMatthias Ringwald } 16272da0d963SMatthias Ringwald } 16283deb3ec6SMatthias Ringwald 16292da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1630052dc82aSMatthias Ringwald switch (gatt_client->state) { 16313deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 16325cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1633cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1634cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16355611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16363deb3ec6SMatthias Ringwald break; 16373deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 16385cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1639cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1640cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16415611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16423deb3ec6SMatthias Ringwald break; 1643cf8e5718SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: { 16444ea43905SMatthias Ringwald if (size < 2u) break; 16453deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 16463deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 16473deb3ec6SMatthias Ringwald 16484ea43905SMatthias Ringwald if (pair_size == 6u) { 16494ea43905SMatthias Ringwald if (size < 8u) break; 16503deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 16515cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 16525cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 16535cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 1654052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 16553deb3ec6SMatthias Ringwald break; 16563deb3ec6SMatthias Ringwald } 16573deb3ec6SMatthias Ringwald 16584ea43905SMatthias Ringwald if (pair_size != 8u) break; 16599f698c82SMatthias Ringwald 16609f698c82SMatthias Ringwald // UUIDs included, report all of them 16613deb3ec6SMatthias Ringwald uint16_t offset; 16624ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size) { 1663f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 16645cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 16655cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 16664ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset + 6u); 16675cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 16683deb3ec6SMatthias Ringwald } 16693deb3ec6SMatthias Ringwald 1670cf8e5718SMatthias Ringwald trigger_next_included_service_query(gatt_client, 1671cf8e5718SMatthias Ringwald get_last_result_handle_from_included_services_list(packet, 1672cf8e5718SMatthias Ringwald size)); 16735611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16743deb3ec6SMatthias Ringwald break; 16753deb3ec6SMatthias Ringwald } 1676abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 16773deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 16785cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 1679052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 16803deb3ec6SMatthias Ringwald break; 1681abdc9fb5SMatthias Ringwald #endif 16823deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 16833deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 168439ac9711SMatthias Ringwald // set last result handle to last valid handle, only used if pair_size invalid 168539ac9711SMatthias Ringwald uint16_t last_result_handle = 0xffff; 168639ac9711SMatthias Ringwald if (pair_size > 2) { 16873deb3ec6SMatthias Ringwald uint16_t offset; 16883deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size) { 1689f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1690cf8e5718SMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], 1691cf8e5718SMatthias Ringwald pair_size - 2u); 16923deb3ec6SMatthias Ringwald last_result_handle = value_handle; 16933deb3ec6SMatthias Ringwald } 169439ac9711SMatthias Ringwald } 16955cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 16963deb3ec6SMatthias Ringwald break; 16973deb3ec6SMatthias Ringwald } 16983deb3ec6SMatthias Ringwald default: 16993deb3ec6SMatthias Ringwald break; 17003deb3ec6SMatthias Ringwald } 170139ac9711SMatthias Ringwald } 1702dc13fd8dSMatthias Ringwald 17032da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) { 1704052dc82aSMatthias Ringwald switch (gatt_client->state) { 17052da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1706526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17073deb3ec6SMatthias Ringwald break; 17082da0d963SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1709526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17103deb3ec6SMatthias Ringwald break; 17112da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1712526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17132da0d963SMatthias Ringwald break; 17142da0d963SMatthias Ringwald default: 17152da0d963SMatthias Ringwald break; 17162da0d963SMatthias Ringwald } 17172da0d963SMatthias Ringwald } 1718dc13fd8dSMatthias Ringwald 17192da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) { 17204740230fSMatthias Ringwald uint8_t att_status; 17212da0d963SMatthias Ringwald switch (packet[0]) { 17222da0d963SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: { 17232da0d963SMatthias Ringwald if (size < 3u) break; 172446012949SMatthias Ringwald bool update_gatt_server_att_mtu = false; 17252da0d963SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 17262da0d963SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 172746012949SMatthias Ringwald switch (gatt_client->bearer_type){ 172846012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 172946012949SMatthias Ringwald update_gatt_server_att_mtu = true; 173046012949SMatthias Ringwald break; 17312da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 173246012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 17332da0d963SMatthias Ringwald local_rx_mtu = gatt_client->mtu; 173446012949SMatthias Ringwald break; 17352da0d963SMatthias Ringwald #endif 173646012949SMatthias Ringwald default: 173746012949SMatthias Ringwald btstack_unreachable(); 173846012949SMatthias Ringwald break; 173946012949SMatthias Ringwald } 174046012949SMatthias Ringwald 17412da0d963SMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 17422da0d963SMatthias Ringwald 17432da0d963SMatthias Ringwald // set gatt client mtu 17442da0d963SMatthias Ringwald gatt_client->mtu = mtu; 17452da0d963SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 17462da0d963SMatthias Ringwald 174746012949SMatthias Ringwald if (update_gatt_server_att_mtu){ 17482da0d963SMatthias Ringwald // set per connection mtu state - for fixed channel 17492da0d963SMatthias Ringwald hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle); 17502da0d963SMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 17512da0d963SMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 17522da0d963SMatthias Ringwald } 17532da0d963SMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 17542da0d963SMatthias Ringwald break; 17552da0d963SMatthias Ringwald } 17562da0d963SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 1757052dc82aSMatthias Ringwald switch (gatt_client->state) { 17582da0d963SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 17592da0d963SMatthias Ringwald report_gatt_services(gatt_client, packet, size); 17602da0d963SMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 176130952227SMilanka Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 176230952227SMilanka Ringwald break; 17633deb3ec6SMatthias Ringwald default: 17643deb3ec6SMatthias Ringwald break; 17653deb3ec6SMatthias Ringwald } 17663deb3ec6SMatthias Ringwald break; 17672da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 17682da0d963SMatthias Ringwald if (size < 3u) return; 17692da0d963SMatthias Ringwald report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 17702da0d963SMatthias Ringwald return; 1771cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1772cbba69d5SMatthias Ringwald case ATT_MULTIPLE_HANDLE_VALUE_NTF: 1773cbba69d5SMatthias Ringwald if (size >= 5u) { 1774cbba69d5SMatthias Ringwald uint16_t offset = 1; 1775cbba69d5SMatthias Ringwald while (true){ 1776cbba69d5SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1777cbba69d5SMatthias Ringwald offset += 2; 1778cbba69d5SMatthias Ringwald uint16_t value_length = little_endian_read_16(packet, offset); 1779cbba69d5SMatthias Ringwald offset += 2; 1780cbba69d5SMatthias Ringwald if ((offset + value_length) > size) break; 1781cbba69d5SMatthias Ringwald report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length); 1782cbba69d5SMatthias Ringwald offset += value_length; 1783cbba69d5SMatthias Ringwald } 1784cbba69d5SMatthias Ringwald } 1785cbba69d5SMatthias Ringwald return; 1786cbba69d5SMatthias Ringwald #endif 17872da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 17882da0d963SMatthias Ringwald if (size < 3u) break; 17892da0d963SMatthias Ringwald report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 17902da0d963SMatthias Ringwald gatt_client->send_confirmation = 1; 17912da0d963SMatthias Ringwald break; 17922da0d963SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 17932da0d963SMatthias Ringwald gatt_client_handle_att_read_by_type_response(gatt_client, packet, size); 17942da0d963SMatthias Ringwald break; 17952da0d963SMatthias Ringwald case ATT_READ_RESPONSE: 17962da0d963SMatthias Ringwald gatt_client_handle_att_read_response(gatt_client, packet, size); 17972da0d963SMatthias Ringwald break; 1798cf8e5718SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: { 17993deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 18003deb3ec6SMatthias Ringwald int i; 18013deb3ec6SMatthias Ringwald uint16_t start_group_handle; 18025611a760SMatthias Ringwald uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 18034ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size) { 1804f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet, i); 1805f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet, i + 2); 1806cf8e5718SMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, 1807cf8e5718SMatthias Ringwald gatt_client->uuid128); 18083deb3ec6SMatthias Ringwald } 18095cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 18105611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18113deb3ec6SMatthias Ringwald break; 18123deb3ec6SMatthias Ringwald } 1813cf8e5718SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: { 18144ea43905SMatthias Ringwald if (size < 2u) break; 1815a6121b51SMilanka Ringwald 18163deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 18174ea43905SMatthias Ringwald if (packet[1u] == 2u) { 18183deb3ec6SMatthias Ringwald pair_size = 18; 18193deb3ec6SMatthias Ringwald } 1820a6121b51SMilanka Ringwald uint16_t offset = 2; 1821a6121b51SMilanka Ringwald 1822a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1823f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1824abdc9fb5SMatthias Ringwald 1825abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 18265cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 18275cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1828abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1829abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1830a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1831abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1832abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 18335cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 18345cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 18355cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1836abdc9fb5SMatthias Ringwald break; 1837abdc9fb5SMatthias Ringwald } 1838abdc9fb5SMatthias Ringwald offset += pair_size; 1839abdc9fb5SMatthias Ringwald } 1840abdc9fb5SMatthias Ringwald } 18415cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1842abdc9fb5SMatthias Ringwald 1843abdc9fb5SMatthias Ringwald } else { 1844abdc9fb5SMatthias Ringwald // next 18455cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 18465cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1847abdc9fb5SMatthias Ringwald } 1848abdc9fb5SMatthias Ringwald break; 1849abdc9fb5SMatthias Ringwald } 1850abdc9fb5SMatthias Ringwald #endif 18515cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 18525cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 18535611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18543deb3ec6SMatthias Ringwald break; 18553deb3ec6SMatthias Ringwald } 18563deb3ec6SMatthias Ringwald 18573deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 18582da0d963SMatthias Ringwald gatt_client_handle_att_write_response(gatt_client); 18593deb3ec6SMatthias Ringwald break; 18603deb3ec6SMatthias Ringwald 18613deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE: { 18624ea43905SMatthias Ringwald uint16_t received_blob_length = size - 1u; 1863052dc82aSMatthias Ringwald switch (gatt_client->state) { 18643deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 1865cf8e5718SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 1866cf8e5718SMatthias Ringwald received_blob_length, gatt_client->attribute_offset); 18675cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 18685611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18693deb3ec6SMatthias Ringwald break; 18703deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 18715cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 18723deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 18735cf1669fSMatthias Ringwald gatt_client->attribute_offset); 1874cf8e5718SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 1875cf8e5718SMatthias Ringwald received_blob_length); 18765611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18773deb3ec6SMatthias Ringwald break; 18783deb3ec6SMatthias Ringwald default: 18793deb3ec6SMatthias Ringwald break; 18803deb3ec6SMatthias Ringwald } 18813deb3ec6SMatthias Ringwald break; 18823deb3ec6SMatthias Ringwald } 18833deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 1884052dc82aSMatthias Ringwald switch (gatt_client->state) { 18853deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 18865cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 18874740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 18883deb3ec6SMatthias Ringwald } else { 18894740230fSMatthias Ringwald att_status = ATT_ERROR_DATA_MISMATCH; 18903deb3ec6SMatthias Ringwald } 1891526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 18923deb3ec6SMatthias Ringwald break; 18933deb3ec6SMatthias Ringwald 18943deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: { 18955cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 18965cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 18975611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18983deb3ec6SMatthias Ringwald break; 18993deb3ec6SMatthias Ringwald } 19003deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: { 19015cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1902cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, 1903cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 19045611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19053deb3ec6SMatthias Ringwald break; 19063deb3ec6SMatthias Ringwald } 19073deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: { 19085cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 19095cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1910cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, 1911cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE); 19125611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19133deb3ec6SMatthias Ringwald break; 19143deb3ec6SMatthias Ringwald } 1915052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 19163deb3ec6SMatthias Ringwald break; 19173deb3ec6SMatthias Ringwald } 19183deb3ec6SMatthias Ringwald default: 19193deb3ec6SMatthias Ringwald break; 19203deb3ec6SMatthias Ringwald } 19213deb3ec6SMatthias Ringwald break; 19223deb3ec6SMatthias Ringwald 19233deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 1924052dc82aSMatthias Ringwald switch (gatt_client->state) { 19253deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 1926526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19273deb3ec6SMatthias Ringwald break; 19283deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 1929526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19303deb3ec6SMatthias Ringwald break; 19313deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 1932526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH); 19333deb3ec6SMatthias Ringwald break; 19343deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1935526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19363deb3ec6SMatthias Ringwald break; 19373deb3ec6SMatthias Ringwald default: 19383deb3ec6SMatthias Ringwald break; 19393deb3ec6SMatthias Ringwald 19403deb3ec6SMatthias Ringwald } 19413deb3ec6SMatthias Ringwald break; 19423deb3ec6SMatthias Ringwald 19433deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 1944052dc82aSMatthias Ringwald switch (gatt_client->state) { 19453deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 19465cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1947526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19483deb3ec6SMatthias Ringwald break; 19493deb3ec6SMatthias Ringwald default: 19503deb3ec6SMatthias Ringwald break; 19513deb3ec6SMatthias Ringwald } 19523deb3ec6SMatthias Ringwald break; 19533deb3ec6SMatthias Ringwald 1954f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1955f125a8efSMatthias Ringwald case ATT_READ_MULTIPLE_VARIABLE_RSP: 1956052dc82aSMatthias Ringwald switch (gatt_client->state) { 1957169b9876SMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 1958f125a8efSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1959f125a8efSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1960f125a8efSMatthias Ringwald break; 1961f125a8efSMatthias Ringwald default: 1962f125a8efSMatthias Ringwald break; 1963f125a8efSMatthias Ringwald } 1964f125a8efSMatthias Ringwald break; 1965f125a8efSMatthias Ringwald #endif 1966f125a8efSMatthias Ringwald 19673deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 19684ea43905SMatthias Ringwald if (size < 5u) return; 19694740230fSMatthias Ringwald att_status = packet[4]; 19704740230fSMatthias Ringwald switch (att_status) { 19713deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 1972052dc82aSMatthias Ringwald switch (gatt_client->state) { 19733deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 19743deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 19753deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 19763deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 1977526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19783deb3ec6SMatthias Ringwald break; 19793deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 19803deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 198123d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 1982526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19833deb3ec6SMatthias Ringwald break; 19843deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 19855cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle) { 19864740230fSMatthias Ringwald att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND; 19873deb3ec6SMatthias Ringwald } else { 19884740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 19893deb3ec6SMatthias Ringwald } 1990526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 19913deb3ec6SMatthias Ringwald break; 19923deb3ec6SMatthias Ringwald default: 19934740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 19943deb3ec6SMatthias Ringwald break; 19953deb3ec6SMatthias Ringwald } 19963deb3ec6SMatthias Ringwald break; 19973deb3ec6SMatthias Ringwald } 1998f4b33574SMatthias Ringwald 1999f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 2000f4b33574SMatthias Ringwald 2001f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 2002f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 2003a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 2004a0e0c2beSMatthias Ringwald 2005f4b33574SMatthias Ringwald // security too low 20065cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 20074740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2008f4b33574SMatthias Ringwald break; 2009f4b33574SMatthias Ringwald } 2010f4b33574SMatthias Ringwald // start security 20115cf1669fSMatthias Ringwald gatt_client->security_counter++; 2012f4b33574SMatthias Ringwald 2013f4b33574SMatthias Ringwald // setup action 2014f4b33574SMatthias Ringwald int retry = 1; 2015052dc82aSMatthias Ringwald switch (gatt_client->state){ 2016f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 2017052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 2018f4b33574SMatthias Ringwald break; 2019f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2020052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 2021f4b33574SMatthias Ringwald break; 2022f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 2023052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 2024f4b33574SMatthias Ringwald break; 2025f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 2026052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_REQUEST; 2027f4b33574SMatthias Ringwald break; 2028f125a8efSMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2029052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST; 2030f125a8efSMatthias Ringwald break; 2031f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 2032052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 2033f4b33574SMatthias Ringwald break; 2034f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 2035052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 2036f4b33574SMatthias Ringwald break; 2037f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 2038052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 2039f4b33574SMatthias Ringwald break; 2040f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 2041052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 2042f4b33574SMatthias Ringwald break; 2043f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2044052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 2045f4b33574SMatthias Ringwald break; 2046f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2047052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 2048f4b33574SMatthias Ringwald break; 2049f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2050052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 2051f4b33574SMatthias Ringwald break; 2052f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 2053052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 2054f4b33574SMatthias Ringwald break; 2055f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 2056052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 2057f4b33574SMatthias Ringwald break; 2058f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2059052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 2060f4b33574SMatthias Ringwald break; 2061f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 2062052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 2063f4b33574SMatthias Ringwald break; 2064f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2065052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 2066f4b33574SMatthias Ringwald break; 2067f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2068052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 2069f4b33574SMatthias Ringwald break; 2070f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 2071f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 2072052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 2073f4b33574SMatthias Ringwald break; 2074f4b33574SMatthias Ringwald #endif 2075f4b33574SMatthias Ringwald default: 2076052dc82aSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->state); 2077f4b33574SMatthias Ringwald retry = 0; 2078f4b33574SMatthias Ringwald break; 2079f4b33574SMatthias Ringwald } 2080f4b33574SMatthias Ringwald 2081f4b33574SMatthias Ringwald if (!retry) { 20824740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2083f4b33574SMatthias Ringwald break; 2084f4b33574SMatthias Ringwald } 2085f4b33574SMatthias Ringwald 2086f4b33574SMatthias Ringwald log_info("security error, start pairing"); 2087f4b33574SMatthias Ringwald 2088f060f108SMatthias Ringwald // start pairing for higher security level 20893503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 20904740230fSMatthias Ringwald gatt_client->pending_error_code = att_status; 20915cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 2092f4b33574SMatthias Ringwald break; 2093a0e0c2beSMatthias Ringwald } 2094f4b33574SMatthias Ringwald #endif 2095f4b33574SMatthias Ringwald 2096f4b33574SMatthias Ringwald // nothing we can do about that 2097f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 20983deb3ec6SMatthias Ringwald default: 20994740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 21003deb3ec6SMatthias Ringwald break; 21013deb3ec6SMatthias Ringwald } 21023deb3ec6SMatthias Ringwald break; 21033deb3ec6SMatthias Ringwald 21043deb3ec6SMatthias Ringwald default: 21053deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 21063deb3ec6SMatthias Ringwald break; 21073deb3ec6SMatthias Ringwald } 2108cf8e5718SMatthias Ringwald } 2109cf8e5718SMatthias Ringwald 2110cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) { 2111cf8e5718SMatthias Ringwald gatt_client_t *gatt_client; 211259b5e157SMatthias Ringwald hci_connection_t * hci_connection; 211359b5e157SMatthias Ringwald uint8_t status; 2114180cbe79SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2115180cbe79SMatthias Ringwald hci_con_handle_t con_handle; 2116180cbe79SMatthias Ringwald #endif 2117180cbe79SMatthias Ringwald 2118cf8e5718SMatthias Ringwald if (size < 1u) return; 211959b5e157SMatthias Ringwald switch (packet_type){ 212059b5e157SMatthias Ringwald case HCI_EVENT_PACKET: 212159b5e157SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 212259b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 212359b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_OPENED: 212459b5e157SMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 212559b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet)); 212659b5e157SMatthias Ringwald btstack_assert(gatt_client != NULL); 2127180cbe79SMatthias Ringwald con_handle = l2cap_event_channel_opened_get_handle(packet); 2128180cbe79SMatthias Ringwald hci_connection = hci_connection_for_handle(con_handle); 2129ab6f9d8fSMatthias Ringwald if (status == L2CAP_CONNECTION_RESPONSE_RESULT_REFUSED_RESOURCES){ 2130ab6f9d8fSMatthias Ringwald if ((hci_connection != NULL) && hci_connection->att_server.incoming_connection_request) { 2131180cbe79SMatthias Ringwald log_info("Collision, retry in 100ms"); 2132180cbe79SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 2133180cbe79SMatthias Ringwald // set timer for retry 2134180cbe79SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 100); 2135180cbe79SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_classic_retry); 2136180cbe79SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 2137180cbe79SMatthias Ringwald break; 2138180cbe79SMatthias Ringwald } 2139ab6f9d8fSMatthias Ringwald } 214059b5e157SMatthias Ringwald // if status != 0, gatt_client will be discarded 2141052dc82aSMatthias Ringwald gatt_client->state = P_READY; 214259b5e157SMatthias Ringwald gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet); 214359b5e157SMatthias Ringwald gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 214459b5e157SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 214559b5e157SMatthias Ringwald break; 214659b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 214759b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet)); 214859b5e157SMatthias Ringwald // discard gatt client object 214959b5e157SMatthias Ringwald gatt_client_classic_handle_disconnected(gatt_client); 215059b5e157SMatthias Ringwald break; 215159b5e157SMatthias Ringwald #endif 2152cf8e5718SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 21533deb3ec6SMatthias Ringwald gatt_client_run(); 2154cf8e5718SMatthias Ringwald break; 2155cf8e5718SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 2156cf8e5718SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 2157cf8e5718SMatthias Ringwald if (size < 6u) break; 2158cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2159cf8e5718SMatthias Ringwald if (gatt_client == NULL) break; 2160cf8e5718SMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 2161cf8e5718SMatthias Ringwald break; 2162cf8e5718SMatthias Ringwald default: 2163cf8e5718SMatthias Ringwald break; 2164cf8e5718SMatthias Ringwald } 216559b5e157SMatthias Ringwald break; 2166cf8e5718SMatthias Ringwald 216759b5e157SMatthias Ringwald case ATT_DATA_PACKET: 2168cf8e5718SMatthias Ringwald // special cases: notifications & indications motivate creating context 2169cf8e5718SMatthias Ringwald switch (packet[0]) { 2170cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 2171cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 2172cf8e5718SMatthias Ringwald gatt_client_provide_context_for_handle(handle, &gatt_client); 2173cf8e5718SMatthias Ringwald break; 2174cf8e5718SMatthias Ringwald default: 2175cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2176cf8e5718SMatthias Ringwald break; 2177cf8e5718SMatthias Ringwald } 2178cf8e5718SMatthias Ringwald 2179cf8e5718SMatthias Ringwald if (gatt_client != NULL) { 2180cf8e5718SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2181cf8e5718SMatthias Ringwald gatt_client_run(); 2182cf8e5718SMatthias Ringwald } 218359b5e157SMatthias Ringwald break; 218459b5e157SMatthias Ringwald 218559b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 218659b5e157SMatthias Ringwald case L2CAP_DATA_PACKET: 218759b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(handle); 218859b5e157SMatthias Ringwald btstack_assert(gatt_client != NULL); 218959b5e157SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 219059b5e157SMatthias Ringwald gatt_client_run(); 219159b5e157SMatthias Ringwald break; 219259b5e157SMatthias Ringwald #endif 219359b5e157SMatthias Ringwald 219459b5e157SMatthias Ringwald default: 219559b5e157SMatthias Ringwald break; 219659b5e157SMatthias Ringwald } 21973deb3ec6SMatthias Ringwald } 21983deb3ec6SMatthias Ringwald 21997a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 22003deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 2201665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 2202665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 2203665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 22045cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 2205052dc82aSMatthias Ringwald if (gatt_client->state == P_W4_CMAC_RESULT){ 22063deb3ec6SMatthias Ringwald // store result 22075cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 22085cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 2209052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 22103deb3ec6SMatthias Ringwald gatt_client_run(); 22113deb3ec6SMatthias Ringwald return; 22123deb3ec6SMatthias Ringwald } 22133deb3ec6SMatthias Ringwald } 22143deb3ec6SMatthias Ringwald } 22153deb3ec6SMatthias Ringwald 2216b45b7749SMilanka 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){ 221740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 221840faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 221940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 222040faeb84SMilanka Ringwald return status; 222140faeb84SMilanka Ringwald } 222240faeb84SMilanka Ringwald if (is_ready(gatt_client) == 0){ 222340faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 222440faeb84SMilanka Ringwald } 22253deb3ec6SMatthias Ringwald 22265cf1669fSMatthias Ringwald gatt_client->callback = callback; 2227b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 22285cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 22295cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 2230052dc82aSMatthias Ringwald gatt_client->state = P_W4_IDENTITY_RESOLVING; 22313deb3ec6SMatthias Ringwald gatt_client_run(); 223225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22333deb3ec6SMatthias Ringwald } 22347a766ebfSMatthias Ringwald #endif 22353deb3ec6SMatthias Ringwald 2236711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 223740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2238de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 223940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 224040faeb84SMilanka Ringwald return status; 224140faeb84SMilanka Ringwald } 22423deb3ec6SMatthias Ringwald 22435cf1669fSMatthias Ringwald gatt_client->callback = callback; 22445cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22455cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2246052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 22478d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID; 22483deb3ec6SMatthias Ringwald gatt_client_run(); 224925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22503deb3ec6SMatthias Ringwald } 22513deb3ec6SMatthias Ringwald 22528d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 225340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2254de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 225540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 225640faeb84SMilanka Ringwald return status; 225740faeb84SMilanka Ringwald } 22588d1f34d3SMatheus Eduardo Garbelini 22598d1f34d3SMatheus Eduardo Garbelini gatt_client->callback = callback; 22608d1f34d3SMatheus Eduardo Garbelini gatt_client->start_group_handle = 0x0001; 22618d1f34d3SMatheus Eduardo Garbelini gatt_client->end_group_handle = 0xffff; 2262052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 22638d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID; 22648d1f34d3SMatheus Eduardo Garbelini gatt_client_run(); 22658d1f34d3SMatheus Eduardo Garbelini return ERROR_CODE_SUCCESS; 22668d1f34d3SMatheus Eduardo Garbelini } 22673deb3ec6SMatthias Ringwald 2268711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 226940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2270de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 227140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 227240faeb84SMilanka Ringwald return status; 227340faeb84SMilanka Ringwald } 22743deb3ec6SMatthias Ringwald 22755cf1669fSMatthias Ringwald gatt_client->callback = callback; 22765cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22775cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2278052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 22795cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 22805cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 22813deb3ec6SMatthias Ringwald gatt_client_run(); 228225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22833deb3ec6SMatthias Ringwald } 22843deb3ec6SMatthias Ringwald 2285711e6c80SMatthias 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){ 228640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2287de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 228840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 228940faeb84SMilanka Ringwald return status; 229040faeb84SMilanka Ringwald } 22913deb3ec6SMatthias Ringwald 22925cf1669fSMatthias Ringwald gatt_client->callback = callback; 22935cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22945cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 22955cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 22965cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2297052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 22983deb3ec6SMatthias Ringwald gatt_client_run(); 229925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23003deb3ec6SMatthias Ringwald } 23013deb3ec6SMatthias Ringwald 2302711e6c80SMatthias 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){ 230340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2304de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 230540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 230640faeb84SMilanka Ringwald return status; 230740faeb84SMilanka Ringwald } 23083deb3ec6SMatthias Ringwald 23095cf1669fSMatthias Ringwald gatt_client->callback = callback; 23105cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 23115cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 23125cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 0; 23135cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2314052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 23153deb3ec6SMatthias Ringwald gatt_client_run(); 231625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23173deb3ec6SMatthias Ringwald } 23183deb3ec6SMatthias Ringwald 2319711e6c80SMatthias 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){ 232040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2321de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 232240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 232340faeb84SMilanka Ringwald return status; 232440faeb84SMilanka Ringwald } 2325de27733dSMatthias Ringwald 23265cf1669fSMatthias Ringwald gatt_client->callback = callback; 23275cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 23285cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2329052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 23303deb3ec6SMatthias Ringwald 23313deb3ec6SMatthias Ringwald gatt_client_run(); 233225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23333deb3ec6SMatthias Ringwald } 23343deb3ec6SMatthias Ringwald 2335711e6c80SMatthias 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){ 233640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2337de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 233840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 233940faeb84SMilanka Ringwald return status; 234040faeb84SMilanka Ringwald } 23413deb3ec6SMatthias Ringwald 23425cf1669fSMatthias Ringwald gatt_client->callback = callback; 23435cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23445cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 23455cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 23465cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 23475cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 23485cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2349052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 23503deb3ec6SMatthias Ringwald gatt_client_run(); 235125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23523deb3ec6SMatthias Ringwald } 23533deb3ec6SMatthias Ringwald 2354045d700dSDavid 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){ 235540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2356de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 235740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 235840faeb84SMilanka Ringwald return status; 235940faeb84SMilanka Ringwald } 23603deb3ec6SMatthias Ringwald 23615cf1669fSMatthias Ringwald gatt_client->callback = callback; 23625cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23635cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 23645cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 23655cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 23665cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 23675cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2368052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 23693deb3ec6SMatthias Ringwald gatt_client_run(); 237025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23713deb3ec6SMatthias Ringwald } 23723deb3ec6SMatthias Ringwald 23733deb3ec6SMatthias Ringwald 2374b45b7749SMilanka 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){ 2375b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16); 23763deb3ec6SMatthias Ringwald } 23773deb3ec6SMatthias Ringwald 2378b45b7749SMilanka 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){ 2379b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128); 23803deb3ec6SMatthias Ringwald } 23813deb3ec6SMatthias Ringwald 2382711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 238340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2384de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 238540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 238640faeb84SMilanka Ringwald return status; 238740faeb84SMilanka Ringwald } 23883deb3ec6SMatthias Ringwald 23893deb3ec6SMatthias Ringwald if (characteristic->value_handle == characteristic->end_handle){ 239025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23913deb3ec6SMatthias Ringwald } 23925cf1669fSMatthias Ringwald gatt_client->callback = callback; 23935cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 23945cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 2395052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 23963deb3ec6SMatthias Ringwald gatt_client_run(); 239725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23983deb3ec6SMatthias Ringwald } 23993deb3ec6SMatthias Ringwald 2400711e6c80SMatthias 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){ 240140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2402de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 240340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 240440faeb84SMilanka Ringwald return status; 240540faeb84SMilanka Ringwald } 24063deb3ec6SMatthias Ringwald 24075cf1669fSMatthias Ringwald gatt_client->callback = callback; 24085cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 24095cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2410052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 24113deb3ec6SMatthias Ringwald gatt_client_run(); 241225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24133deb3ec6SMatthias Ringwald } 24143deb3ec6SMatthias Ringwald 2415711e6c80SMatthias 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){ 241640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2417de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 241840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 241940faeb84SMilanka Ringwald return status; 242040faeb84SMilanka Ringwald } 24213deb3ec6SMatthias Ringwald 24225cf1669fSMatthias Ringwald gatt_client->callback = callback; 24235cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 24245cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 24255cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 24265cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 24275cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 24285cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 2429052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 24303deb3ec6SMatthias Ringwald gatt_client_run(); 243125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24323deb3ec6SMatthias Ringwald } 24333deb3ec6SMatthias Ringwald 2434045d700dSDavid 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){ 243540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2436de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 243740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 243840faeb84SMilanka Ringwald return status; 243940faeb84SMilanka Ringwald } 24403deb3ec6SMatthias Ringwald 24415cf1669fSMatthias Ringwald gatt_client->callback = callback; 24425cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 24435cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 24445cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 24455cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 24465cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 24475cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2448052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 24493deb3ec6SMatthias Ringwald gatt_client_run(); 245025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24513deb3ec6SMatthias Ringwald } 24523deb3ec6SMatthias Ringwald 24533deb3ec6SMatthias Ringwald 2454b45b7749SMilanka 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){ 2455b45b7749SMilanka Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 24563deb3ec6SMatthias Ringwald } 24573deb3ec6SMatthias Ringwald 2458b45b7749SMilanka 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){ 245940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2460de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 246140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 246240faeb84SMilanka Ringwald return status; 246340faeb84SMilanka Ringwald } 24643deb3ec6SMatthias Ringwald 24655cf1669fSMatthias Ringwald gatt_client->callback = callback; 2466b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 24675cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2468052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 24693deb3ec6SMatthias Ringwald gatt_client_run(); 247025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24713deb3ec6SMatthias Ringwald } 24723deb3ec6SMatthias Ringwald 2473b45b7749SMilanka 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){ 2474b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0); 24753deb3ec6SMatthias Ringwald } 24763deb3ec6SMatthias Ringwald 2477b45b7749SMilanka 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){ 2478b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 24793deb3ec6SMatthias Ringwald } 24803deb3ec6SMatthias Ringwald 2481f125a8efSMatthias 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){ 248240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2483de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 248440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 248540faeb84SMilanka Ringwald return status; 248640faeb84SMilanka Ringwald } 24873deb3ec6SMatthias Ringwald 2488f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2489f125a8efSMatthias Ringwald if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){ 2490f125a8efSMatthias Ringwald if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){ 2491f125a8efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2492f125a8efSMatthias Ringwald } 2493f125a8efSMatthias Ringwald } 2494f125a8efSMatthias Ringwald #endif 2495f125a8efSMatthias Ringwald 24965cf1669fSMatthias Ringwald gatt_client->callback = callback; 24975cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 24985cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 2499052dc82aSMatthias Ringwald gatt_client->state = state; 25003deb3ec6SMatthias Ringwald gatt_client_run(); 250125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25023deb3ec6SMatthias Ringwald } 25033deb3ec6SMatthias Ringwald 2504f125a8efSMatthias 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){ 2505f125a8efSMatthias Ringwald return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST); 2506f125a8efSMatthias Ringwald } 2507f125a8efSMatthias Ringwald 2508f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2509f125a8efSMatthias 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){ 2510f125a8efSMatthias 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); 2511f125a8efSMatthias Ringwald } 2512f125a8efSMatthias Ringwald #endif 2513f125a8efSMatthias Ringwald 2514de9f8e94SMatthias 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){ 251540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 251640faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 251740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 251840faeb84SMilanka Ringwald return status; 251940faeb84SMilanka Ringwald } 25203deb3ec6SMatthias Ringwald 2521dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 25225cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 25233deb3ec6SMatthias Ringwald 25246e7b444cSMatthias Ringwald return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value); 25253deb3ec6SMatthias Ringwald } 25263deb3ec6SMatthias Ringwald 2527b45b7749SMilanka 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){ 252840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2529de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 253040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 253140faeb84SMilanka Ringwald return status; 253240faeb84SMilanka Ringwald } 25333deb3ec6SMatthias Ringwald 25345cf1669fSMatthias Ringwald gatt_client->callback = callback; 25355cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25365cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 2537b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2538052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 25393deb3ec6SMatthias Ringwald gatt_client_run(); 254025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25413deb3ec6SMatthias Ringwald } 25423deb3ec6SMatthias Ringwald 2543b45b7749SMilanka 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){ 254440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2545de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 254640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 254740faeb84SMilanka Ringwald return status; 254840faeb84SMilanka Ringwald } 25493deb3ec6SMatthias Ringwald 25505cf1669fSMatthias Ringwald gatt_client->callback = callback; 25515cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25525cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 25535cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2554b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2555052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 25563deb3ec6SMatthias Ringwald gatt_client_run(); 255725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25583deb3ec6SMatthias Ringwald } 25593deb3ec6SMatthias Ringwald 2560711e6c80SMatthias 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){ 25619c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 25623deb3ec6SMatthias Ringwald } 25633deb3ec6SMatthias Ringwald 2564711e6c80SMatthias 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){ 256540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2566de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 256740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 256840faeb84SMilanka Ringwald return status; 256940faeb84SMilanka Ringwald } 25703deb3ec6SMatthias Ringwald 25715cf1669fSMatthias Ringwald gatt_client->callback = callback; 25725cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25735cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 25745cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 25755cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 2576052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 25773deb3ec6SMatthias Ringwald gatt_client_run(); 257825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25793deb3ec6SMatthias Ringwald } 25803deb3ec6SMatthias Ringwald 2581711e6c80SMatthias 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){ 258240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2583de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 258440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 258540faeb84SMilanka Ringwald return status; 258640faeb84SMilanka Ringwald } 25873deb3ec6SMatthias Ringwald 25883deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 25894ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2590d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2591616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 25923deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 25934ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2594d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2595616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 25963deb3ec6SMatthias Ringwald } 25973deb3ec6SMatthias Ringwald 25985cf1669fSMatthias Ringwald gatt_client->callback = callback; 25995cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 26005cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 26015cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 26023deb3ec6SMatthias Ringwald 2603abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 26045cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2605abdc9fb5SMatthias Ringwald #else 2606052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2607abdc9fb5SMatthias Ringwald #endif 26083deb3ec6SMatthias Ringwald gatt_client_run(); 26099cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 26103deb3ec6SMatthias Ringwald } 26113deb3ec6SMatthias Ringwald 2612711e6c80SMatthias 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){ 261340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2614de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 261540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 261640faeb84SMilanka Ringwald return status; 261740faeb84SMilanka Ringwald } 26183deb3ec6SMatthias Ringwald 26195cf1669fSMatthias Ringwald gatt_client->callback = callback; 26205cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 26213deb3ec6SMatthias Ringwald 2622052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 26233deb3ec6SMatthias Ringwald gatt_client_run(); 262425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26253deb3ec6SMatthias Ringwald } 26263deb3ec6SMatthias Ringwald 2627711e6c80SMatthias 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){ 26289c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 26293deb3ec6SMatthias Ringwald } 26303deb3ec6SMatthias Ringwald 2631711e6c80SMatthias 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){ 263240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2633de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 263440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 263540faeb84SMilanka Ringwald return status; 263640faeb84SMilanka Ringwald } 26373deb3ec6SMatthias Ringwald 26385cf1669fSMatthias Ringwald gatt_client->callback = callback; 26395cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 26405cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2641052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 26423deb3ec6SMatthias Ringwald gatt_client_run(); 264325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26443deb3ec6SMatthias Ringwald } 26453deb3ec6SMatthias Ringwald 2646711e6c80SMatthias 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){ 26479c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 26483deb3ec6SMatthias Ringwald } 26493deb3ec6SMatthias Ringwald 2650711e6c80SMatthias 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){ 26519c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 26523deb3ec6SMatthias Ringwald } 26533deb3ec6SMatthias Ringwald 2654b45b7749SMilanka 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){ 265540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2656de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 265740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 265840faeb84SMilanka Ringwald return status; 265940faeb84SMilanka Ringwald } 26603deb3ec6SMatthias Ringwald 26615cf1669fSMatthias Ringwald gatt_client->callback = callback; 26625cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2663b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26645cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2665b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2666052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 26673deb3ec6SMatthias Ringwald gatt_client_run(); 266825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26693deb3ec6SMatthias Ringwald } 26703deb3ec6SMatthias Ringwald 267148cdff9cSMilanka 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){ 267248cdff9cSMilanka Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 26733deb3ec6SMatthias Ringwald } 26743deb3ec6SMatthias Ringwald 2675b45b7749SMilanka 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){ 267640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2677de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 267840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 267940faeb84SMilanka Ringwald return status; 268040faeb84SMilanka Ringwald } 26813deb3ec6SMatthias Ringwald 26825cf1669fSMatthias Ringwald gatt_client->callback = callback; 26835cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2684b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26855cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2686b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2687052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 26883deb3ec6SMatthias Ringwald gatt_client_run(); 268925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26903deb3ec6SMatthias Ringwald } 26913deb3ec6SMatthias Ringwald 2692b45b7749SMilanka 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){ 2693b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value); 26943deb3ec6SMatthias Ringwald } 26953deb3ec6SMatthias Ringwald 2696b45b7749SMilanka 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){ 2697b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 26983deb3ec6SMatthias Ringwald } 26993deb3ec6SMatthias Ringwald 27003deb3ec6SMatthias Ringwald /** 27013deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27023deb3ec6SMatthias Ringwald */ 2703b45b7749SMilanka 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){ 270440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2705de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 270640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 270740faeb84SMilanka Ringwald return status; 270840faeb84SMilanka Ringwald } 27093deb3ec6SMatthias Ringwald 27105cf1669fSMatthias Ringwald gatt_client->callback = callback; 27115cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 2712b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 27135cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2714b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2715052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 27163deb3ec6SMatthias Ringwald gatt_client_run(); 271725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27183deb3ec6SMatthias Ringwald } 27193deb3ec6SMatthias Ringwald 27203deb3ec6SMatthias Ringwald /** 27213deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27223deb3ec6SMatthias Ringwald */ 2723711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 272440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2725de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 272640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 272740faeb84SMilanka Ringwald return status; 272840faeb84SMilanka Ringwald } 27293deb3ec6SMatthias Ringwald 27305cf1669fSMatthias Ringwald gatt_client->callback = callback; 2731052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 27323deb3ec6SMatthias Ringwald gatt_client_run(); 273325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27343deb3ec6SMatthias Ringwald } 27353deb3ec6SMatthias Ringwald 27363deb3ec6SMatthias Ringwald /** 27373deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27383deb3ec6SMatthias Ringwald */ 2739711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 274040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2741de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 274240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 274340faeb84SMilanka Ringwald return status; 274440faeb84SMilanka Ringwald } 27453deb3ec6SMatthias Ringwald 27465cf1669fSMatthias Ringwald gatt_client->callback = callback; 2747052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 27483deb3ec6SMatthias Ringwald gatt_client_run(); 27497d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 27503deb3ec6SMatthias Ringwald } 27513deb3ec6SMatthias Ringwald 2752313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 27536ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 27546ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 27556ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 27566ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 27576ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2758c839c6f9SMatthias Ringwald } else { 2759c839c6f9SMatthias Ringwald service->uuid16 = 0; 27606ba2ad22SMatthias Ringwald } 27616ba2ad22SMatthias Ringwald } 27626ba2ad22SMatthias Ringwald 2763313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 27646ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 27656ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 27666ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 27676ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 276886c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 27696ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 27706ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2771c839c6f9SMatthias Ringwald } else { 2772c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 27736ba2ad22SMatthias Ringwald } 27746ba2ad22SMatthias Ringwald } 27756ba2ad22SMatthias Ringwald 2776313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 27776ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 27786ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2779b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2780b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2781c839c6f9SMatthias Ringwald } else { 2782c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2783b4895529SJakob Krantz } 27846ba2ad22SMatthias Ringwald } 27855cf6c434SJakob Krantz 27865cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 278740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 278840faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 278940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 279040faeb84SMilanka Ringwald return; 279140faeb84SMilanka Ringwald } 279240faeb84SMilanka Ringwald if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 279340faeb84SMilanka Ringwald gatt_client->callback = callback; 279440faeb84SMilanka Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 27955cf6c434SJakob Krantz gatt_client_run(); 27965cf6c434SJakob Krantz } 27975cf6c434SJakob Krantz } 279847181045SMatthias Ringwald 279959d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 280059d34cd2SMatthias Ringwald gatt_client_t * gatt_client; 280159d34cd2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 280259d34cd2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 280359d34cd2SMatthias Ringwald return status; 280459d34cd2SMatthias Ringwald } 280559d34cd2SMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration); 28062832a98aSMatthias Ringwald if (added == false){ 280759d34cd2SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 28082832a98aSMatthias Ringwald } else { 28092832a98aSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 28102832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 281159d34cd2SMatthias Ringwald } 281259d34cd2SMatthias Ringwald } 281359d34cd2SMatthias Ringwald 281453e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 281553e9c18fSMatthias Ringwald gatt_client_t * gatt_client; 281653e9c18fSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 281753e9c18fSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 281853e9c18fSMatthias Ringwald return status; 281953e9c18fSMatthias Ringwald } 282053e9c18fSMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 28212832a98aSMatthias Ringwald if (added == false){ 282253e9c18fSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 28232832a98aSMatthias Ringwald } else { 28242832a98aSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 28252832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 282653e9c18fSMatthias Ringwald } 282753e9c18fSMatthias Ringwald } 282853e9c18fSMatthias Ringwald 282947181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 283040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 283140faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 283240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 283340faeb84SMilanka Ringwald return status; 283440faeb84SMilanka Ringwald } 283540faeb84SMilanka Ringwald if (gatt_client->write_without_response_callback != NULL){ 283640faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 283740faeb84SMilanka Ringwald } 283840faeb84SMilanka Ringwald gatt_client->write_without_response_callback = callback; 283940faeb84SMilanka Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 28407d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 284147181045SMatthias Ringwald } 2842a6121b51SMilanka Ringwald 28437627a0deSMatthias Ringwald 28447627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT) 28451450cdc6SMatthias Ringwald 28461450cdc6SMatthias Ringwald #include "hci_event.h" 28471450cdc6SMatthias Ringwald 28481450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = { 28491450cdc6SMatthias Ringwald GATT_EVENT_CONNECTED, 0, "1BH" 28501450cdc6SMatthias Ringwald }; 28511450cdc6SMatthias Ringwald 28526b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = { 28536b4a68c3SMatthias Ringwald GATT_EVENT_DISCONNECTED, 0, "H" 28546b4a68c3SMatthias Ringwald }; 28551c7a19feSMatthias Ringwald 28561c7a19feSMatthias Ringwald static void gatt_client_emit_connected(btstack_packet_handler_t callback, uint8_t status, bd_addr_t addr, 28571c7a19feSMatthias Ringwald hci_con_handle_t con_handle) { 28581c7a19feSMatthias Ringwald uint8_t buffer[20]; 28591c7a19feSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, con_handle); 28601c7a19feSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 28611c7a19feSMatthias Ringwald } 28621c7a19feSMatthias Ringwald 28637627a0deSMatthias Ringwald #endif 28647627a0deSMatthias Ringwald 28657627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 28667627a0deSMatthias Ringwald 28677627a0deSMatthias Ringwald #include "bluetooth_psm.h" 28687627a0deSMatthias Ringwald 28697627a0deSMatthias Ringwald // single active SDP query 28707627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query; 28717627a0deSMatthias Ringwald 28727627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes 28737627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32]; 28747627a0deSMatthias Ringwald 28756b4a68c3SMatthias Ringwald 28761450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){ 28771450cdc6SMatthias Ringwald btstack_linked_item_t *it; 28781450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 28791450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 28801450cdc6SMatthias Ringwald if (memcmp(gatt_client->addr, addr, 6) == 0){ 28811450cdc6SMatthias Ringwald return gatt_client; 28821450cdc6SMatthias Ringwald } 28831450cdc6SMatthias Ringwald } 28841450cdc6SMatthias Ringwald return NULL; 28851450cdc6SMatthias Ringwald } 28861450cdc6SMatthias Ringwald 28871450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){ 28881450cdc6SMatthias Ringwald btstack_linked_item_t *it; 28891450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 28901450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 28911450cdc6SMatthias Ringwald if (gatt_client->l2cap_cid == l2cap_cid){ 28921450cdc6SMatthias Ringwald return gatt_client; 28931450cdc6SMatthias Ringwald } 28941450cdc6SMatthias Ringwald } 28951450cdc6SMatthias Ringwald return NULL; 28961450cdc6SMatthias Ringwald } 28971450cdc6SMatthias Ringwald 28981450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){ 28991450cdc6SMatthias Ringwald bd_addr_t addr; 2900d5529700SMatthias Ringwald // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy 29011450cdc6SMatthias Ringwald memcpy(addr, gatt_client->addr, 6); 29021450cdc6SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 29031450cdc6SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 29049ed6f53cSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 29053b0e0cc5SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 29063b0e0cc5SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 29073b0e0cc5SMatthias Ringwald } 29081c7a19feSMatthias Ringwald gatt_client_emit_connected(callback, status, addr, con_handle); 29091450cdc6SMatthias Ringwald } 29101450cdc6SMatthias Ringwald 2911180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts){ 2912180cbe79SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 2913180cbe79SMatthias Ringwald if (gatt_client != NULL){ 2914180cbe79SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 2915180cbe79SMatthias Ringwald att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 2916180cbe79SMatthias Ringwald } 2917180cbe79SMatthias Ringwald } 2918180cbe79SMatthias Ringwald 29196b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){ 29206b4a68c3SMatthias Ringwald 29216b4a68c3SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 29226b4a68c3SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 29236b4a68c3SMatthias Ringwald 29246b4a68c3SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 29256b4a68c3SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 29266b4a68c3SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 29276b4a68c3SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 29286b4a68c3SMatthias Ringwald 29296b4a68c3SMatthias Ringwald uint8_t buffer[20]; 29306b4a68c3SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle); 29316b4a68c3SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 29326b4a68c3SMatthias Ringwald } 29336b4a68c3SMatthias Ringwald 29341450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){ 29351450cdc6SMatthias Ringwald des_iterator_t des_list_it; 29361450cdc6SMatthias Ringwald des_iterator_t prot_it; 29371450cdc6SMatthias Ringwald 29381450cdc6SMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) { 29391450cdc6SMatthias Ringwald gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 29401450cdc6SMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 29411450cdc6SMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 29421450cdc6SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: 29431450cdc6SMatthias 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)) { 29441450cdc6SMatthias Ringwald uint8_t *des_element; 29451450cdc6SMatthias Ringwald uint8_t *element; 29461450cdc6SMatthias Ringwald uint32_t uuid; 29471450cdc6SMatthias Ringwald 29481450cdc6SMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 29491450cdc6SMatthias Ringwald 29501450cdc6SMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 29511450cdc6SMatthias Ringwald des_iterator_init(&prot_it, des_element); 29521450cdc6SMatthias Ringwald element = des_iterator_get_element(&prot_it); 29531450cdc6SMatthias Ringwald 29541450cdc6SMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 29551450cdc6SMatthias Ringwald 29561450cdc6SMatthias Ringwald uuid = de_get_uuid32(element); 29571450cdc6SMatthias Ringwald des_iterator_next(&prot_it); 29581450cdc6SMatthias Ringwald // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both 29591450cdc6SMatthias Ringwald switch (uuid){ 29601450cdc6SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 29611450cdc6SMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 29621450cdc6SMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm); 29631450cdc6SMatthias Ringwald break; 29641450cdc6SMatthias Ringwald default: 29651450cdc6SMatthias Ringwald break; 29661450cdc6SMatthias Ringwald } 29671450cdc6SMatthias Ringwald } 29681450cdc6SMatthias Ringwald break; 29691450cdc6SMatthias Ringwald 29701450cdc6SMatthias Ringwald default: 29711450cdc6SMatthias Ringwald break; 29721450cdc6SMatthias Ringwald } 29731450cdc6SMatthias Ringwald } 29741450cdc6SMatthias Ringwald } 29751450cdc6SMatthias Ringwald } 29761450cdc6SMatthias Ringwald 29771450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 29781450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query; 29791450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 29801450cdc6SMatthias Ringwald uint8_t status; 29811450cdc6SMatthias Ringwald 29821450cdc6SMatthias Ringwald // TODO: handle sdp events, get l2cap psm 29831450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 29841450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 29851450cdc6SMatthias Ringwald gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet); 29861450cdc6SMatthias Ringwald // TODO: 29871450cdc6SMatthias Ringwald return; 29881450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 29891450cdc6SMatthias Ringwald status = sdp_event_query_complete_get_status(packet); 29901450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = NULL; 29911450cdc6SMatthias Ringwald log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status); 29921450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) break; 29931450cdc6SMatthias Ringwald if (gatt_client->l2cap_psm == 0) { 29941450cdc6SMatthias Ringwald status = SDP_SERVICE_NOT_FOUND; 29951450cdc6SMatthias Ringwald break; 29961450cdc6SMatthias Ringwald } 29971450cdc6SMatthias Ringwald break; 29981450cdc6SMatthias Ringwald default: 29991450cdc6SMatthias Ringwald btstack_assert(false); 30001450cdc6SMatthias Ringwald return; 30011450cdc6SMatthias Ringwald } 30021450cdc6SMatthias Ringwald 30031450cdc6SMatthias Ringwald // done 30041450cdc6SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3005052dc82aSMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 300659b5e157SMatthias Ringwald status = att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 30071450cdc6SMatthias Ringwald } 30081450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) { 30091450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 30101450cdc6SMatthias Ringwald } 30111450cdc6SMatthias Ringwald } 30121450cdc6SMatthias Ringwald 30131450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){ 30141450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = (gatt_client_t *) context; 3015052dc82aSMatthias Ringwald gatt_client_classic_active_sdp_query->state = P_W4_SDP_QUERY; 30161450cdc6SMatthias Ringwald sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 30171450cdc6SMatthias Ringwald } 30181450cdc6SMatthias Ringwald 301974daebdeSMatthias Ringwald static void gatt_client_classic_emit_connected(void * context){ 302074daebdeSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) context; 3021052dc82aSMatthias Ringwald gatt_client->state = P_READY; 302274daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 302374daebdeSMatthias Ringwald btstack_assert(hci_connection != NULL); 302474daebdeSMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, ERROR_CODE_SUCCESS, hci_connection->address, gatt_client->con_handle); 302574daebdeSMatthias Ringwald } 302674daebdeSMatthias Ringwald 30271450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){ 30281450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr); 30291450cdc6SMatthias Ringwald if (gatt_client != NULL){ 30301450cdc6SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 30311450cdc6SMatthias Ringwald } 30321450cdc6SMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 30331450cdc6SMatthias Ringwald if (gatt_client == NULL){ 30341450cdc6SMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 30351450cdc6SMatthias Ringwald } 30361450cdc6SMatthias Ringwald // init state 3037e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC; 30381450cdc6SMatthias Ringwald gatt_client->con_handle = HCI_CON_HANDLE_INVALID; 30391450cdc6SMatthias Ringwald memcpy(gatt_client->addr, addr, 6); 30401450cdc6SMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 30411450cdc6SMatthias Ringwald gatt_client->security_level = LEVEL_0; 30421450cdc6SMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 30431450cdc6SMatthias Ringwald gatt_client->callback = callback; 3044cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3045cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3046cbd76cecSMatthias Ringwald #endif 30471450cdc6SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 304874daebdeSMatthias Ringwald 304974daebdeSMatthias Ringwald // schedule emitted event if already connected, otherwise 305074daebdeSMatthias Ringwald bool already_connected = false; 305174daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 305274daebdeSMatthias Ringwald if (hci_connection != NULL){ 305374daebdeSMatthias Ringwald if (hci_connection->att_server.l2cap_cid != 0){ 305474daebdeSMatthias Ringwald already_connected = true; 305574daebdeSMatthias Ringwald } 305674daebdeSMatthias Ringwald } 3057052dc82aSMatthias Ringwald gatt_client->callback_request.context = gatt_client; 305874daebdeSMatthias Ringwald if (already_connected){ 305974daebdeSMatthias Ringwald gatt_client->con_handle = hci_connection->con_handle; 3060052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_emit_connected; 3061052dc82aSMatthias Ringwald gatt_client->state = P_W2_EMIT_CONNECTED; 3062052dc82aSMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client->callback_request); 306374daebdeSMatthias Ringwald } else { 3064052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_sdp_start; 3065052dc82aSMatthias Ringwald gatt_client->state = P_W2_SDP_QUERY; 3066052dc82aSMatthias Ringwald sdp_client_register_query_callback(&gatt_client->callback_request); 306774daebdeSMatthias Ringwald } 3068b7b03a30SMatthias Ringwald return ERROR_CODE_SUCCESS; 30691450cdc6SMatthias Ringwald } 30701450cdc6SMatthias Ringwald 30711450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 30721450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 30731450cdc6SMatthias Ringwald if (gatt_client == NULL){ 30741450cdc6SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 30751450cdc6SMatthias Ringwald } 30761450cdc6SMatthias Ringwald gatt_client->callback = callback; 30771450cdc6SMatthias Ringwald return l2cap_disconnect(gatt_client->l2cap_cid); 30781450cdc6SMatthias Ringwald } 30791450cdc6SMatthias Ringwald #endif 30801450cdc6SMatthias Ringwald 308126166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 308226166ecfSMatthias Ringwald 308326166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5 30847627a0deSMatthias Ringwald 30857627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 30867627a0deSMatthias Ringwald 3087df0a5c68SMatthias Ringwald static uint8_t gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client_t * gatt_client, gatt_client_state_t state){ 3088df0a5c68SMatthias Ringwald uint8_t num_clients = 0; 3089df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3090df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 3091df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 3092df0a5c68SMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3093df0a5c68SMatthias Ringwald if (eatt_client->state == state){ 3094df0a5c68SMatthias Ringwald num_clients++; 3095df0a5c68SMatthias Ringwald } 3096df0a5c68SMatthias Ringwald } 3097df0a5c68SMatthias Ringwald return num_clients; 3098df0a5c68SMatthias Ringwald } 3099df0a5c68SMatthias Ringwald 31007627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) { 31017627a0deSMatthias Ringwald // free eatt clients 31027627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 31037627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 31047627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31057627a0deSMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 31067627a0deSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 31077627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 31087627a0deSMatthias Ringwald } 31097627a0deSMatthias Ringwald } 31107627a0deSMatthias Ringwald 31117627a0deSMatthias Ringwald // all channels connected 31127627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) { 31137627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3114df0a5c68SMatthias Ringwald uint8_t num_ready = gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_READY); 3115df0a5c68SMatthias Ringwald if (num_ready > 0){ 31167627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READY; 3117df0a5c68SMatthias Ringwald // free unused channels 3118df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3119df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 3120df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 3121df0a5c68SMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3122df0a5c68SMatthias Ringwald if (eatt_client->state == P_L2CAP_CLOSED){ 3123df0a5c68SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 3124df0a5c68SMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 3125df0a5c68SMatthias Ringwald } 3126df0a5c68SMatthias Ringwald } 3127df0a5c68SMatthias Ringwald } else { 3128*6d0f6f49SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 3129*6d0f6f49SMatthias Ringwald btstack_assert(hci_connection != NULL); 3130*6d0f6f49SMatthias Ringwald if (hci_connection->att_server.incoming_connection_request){ 3131*6d0f6f49SMatthias Ringwald hci_connection->att_server.incoming_connection_request = false; 3132*6d0f6f49SMatthias Ringwald log_info("Collision, retry in 100ms"); 3133*6d0f6f49SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 3134*6d0f6f49SMatthias Ringwald // set timer for retry 3135*6d0f6f49SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 100); 3136*6d0f6f49SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_le_enhanced_retry); 3137*6d0f6f49SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 3138*6d0f6f49SMatthias Ringwald return; 3139*6d0f6f49SMatthias Ringwald } else { 3140df0a5c68SMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3141df0a5c68SMatthias Ringwald status = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 3142df0a5c68SMatthias Ringwald } 3143*6d0f6f49SMatthias Ringwald } 31447627a0deSMatthias Ringwald } else { 31457627a0deSMatthias Ringwald gatt_client_eatt_finalize(gatt_client); 31467627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 31477627a0deSMatthias Ringwald } 31487627a0deSMatthias Ringwald 31491c7a19feSMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, status, gatt_client->addr, gatt_client->con_handle); 31507627a0deSMatthias Ringwald } 31517627a0deSMatthias Ringwald 31527627a0deSMatthias Ringwald // single channel disconnected 31537627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) { 31547627a0deSMatthias Ringwald 31557627a0deSMatthias Ringwald // report error 31567627a0deSMatthias Ringwald gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 31577627a0deSMatthias Ringwald 31587627a0deSMatthias Ringwald // free memory 31597627a0deSMatthias Ringwald btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client); 31607627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 31617627a0deSMatthias Ringwald 3162570bdd2dSMatthias Ringwald // last channel 31637627a0deSMatthias Ringwald if (btstack_linked_list_empty(&gatt_client->eatt_clients)){ 3164570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 3165570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = false; 3166570bdd2dSMatthias Ringwald 3167570bdd2dSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) { 3168570bdd2dSMatthias Ringwald // report disconnected if last channel closed 31697627a0deSMatthias Ringwald uint8_t buffer[20]; 31707627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle); 31717627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 31727627a0deSMatthias Ringwald } 31737627a0deSMatthias Ringwald } 31747627a0deSMatthias Ringwald } 31757627a0deSMatthias Ringwald 31767627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){ 31777627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 31787627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 31797627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31807627a0deSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 31817627a0deSMatthias Ringwald btstack_linked_list_iterator_t it2; 31827627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients); 31837627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it2)) { 31847627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2); 31857627a0deSMatthias Ringwald if (eatt_client->l2cap_cid == l2cap_cid){ 31867627a0deSMatthias Ringwald *out_eatt_client = eatt_client; 31877627a0deSMatthias Ringwald return gatt_client; 31887627a0deSMatthias Ringwald } 31897627a0deSMatthias Ringwald } 31907627a0deSMatthias Ringwald } 31917627a0deSMatthias Ringwald return NULL; 31927627a0deSMatthias Ringwald } 31937627a0deSMatthias Ringwald 31947627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){ 31957627a0deSMatthias Ringwald uint8_t num_channels = gatt_client->eatt_num_clients; 31967627a0deSMatthias Ringwald 31977627a0deSMatthias Ringwald // setup channels 31987627a0deSMatthias Ringwald uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels; 3199f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 32007627a0deSMatthias Ringwald uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS]; 32017627a0deSMatthias Ringwald uint16_t new_cids[MAX_NR_EATT_CHANNELS]; 32027627a0deSMatthias Ringwald memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size); 32037627a0deSMatthias Ringwald uint8_t i; 32047627a0deSMatthias Ringwald for (i=0;i<gatt_client->eatt_num_clients; i++){ 3205f7a42e72SMatthias Ringwald receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER]; 3206f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu; 32077627a0deSMatthias Ringwald } 32087627a0deSMatthias Ringwald 32097627a0deSMatthias Ringwald log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client); 32107627a0deSMatthias Ringwald 3211f7a42e72SMatthias Ringwald uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler, 3212f7a42e72SMatthias Ringwald gatt_client->con_handle, 32137627a0deSMatthias Ringwald gatt_client->security_level, 3214f7a42e72SMatthias Ringwald BLUETOOTH_PSM_EATT, num_channels, 3215f7a42e72SMatthias Ringwald L2CAP_LE_AUTOMATIC_CREDITS, 32167627a0deSMatthias Ringwald buffer_size_per_client, 3217f7a42e72SMatthias Ringwald receive_buffers, 3218f7a42e72SMatthias Ringwald new_cids); 32197627a0deSMatthias Ringwald 32207627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 32217627a0deSMatthias Ringwald i = 0; 32227627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 32237627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 32247627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 32257627a0deSMatthias Ringwald gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 32267627a0deSMatthias Ringwald 32277627a0deSMatthias Ringwald // init state with new cid and transmit buffer 32287627a0deSMatthias Ringwald new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE; 32297627a0deSMatthias Ringwald new_eatt_client->con_handle = gatt_client->con_handle; 32307627a0deSMatthias Ringwald new_eatt_client->mtu = 64; 32317627a0deSMatthias Ringwald new_eatt_client->security_level = LEVEL_0; 32327627a0deSMatthias Ringwald new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 3233052dc82aSMatthias Ringwald new_eatt_client->state = P_W4_L2CAP_CONNECTION; 32347627a0deSMatthias Ringwald new_eatt_client->l2cap_cid = new_cids[i]; 32357627a0deSMatthias Ringwald new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer; 3236f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += max_mtu; 32377627a0deSMatthias Ringwald i++; 32387627a0deSMatthias Ringwald } 32397627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP; 32407627a0deSMatthias Ringwald } else { 32417627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, status); 32427627a0deSMatthias Ringwald } 324326166ecfSMatthias Ringwald } 324426166ecfSMatthias Ringwald 3245*6d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts){ 3246*6d0f6f49SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 3247*6d0f6f49SMatthias Ringwald if (gatt_client != NULL){ 3248*6d0f6f49SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 3249*6d0f6f49SMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 3250*6d0f6f49SMatthias Ringwald } 3251*6d0f6f49SMatthias Ringwald } 3252*6d0f6f49SMatthias Ringwald 325326166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 32547627a0deSMatthias Ringwald gatt_client_t *gatt_client; 32557627a0deSMatthias Ringwald gatt_client_t *eatt_client; 325626166ecfSMatthias Ringwald hci_con_handle_t con_handle; 32577627a0deSMatthias Ringwald uint16_t l2cap_cid; 325826166ecfSMatthias Ringwald uint8_t status; 325926166ecfSMatthias Ringwald gatt_client_characteristic_t characteristic; 32607627a0deSMatthias Ringwald gatt_client_service_t service; 3261df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3262df0a5c68SMatthias Ringwald uint8_t num_pending_channels; 326326166ecfSMatthias Ringwald switch (packet_type) { 326426166ecfSMatthias Ringwald case HCI_EVENT_PACKET: 326526166ecfSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 32667627a0deSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 32677627a0deSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 32687627a0deSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 32697627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 32707627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE); 32717627a0deSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 32727627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 32737627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 32747627a0deSMatthias Ringwald break; 327526166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 327626166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 327726166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 327826166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 32797627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE); 328026166ecfSMatthias Ringwald if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) { 32817627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0]; 328226166ecfSMatthias Ringwald } 328326166ecfSMatthias Ringwald break; 328426166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 328526166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 328626166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 328726166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 32887627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE); 32897627a0deSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 329026166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = characteristic.value_handle; 329126166ecfSMatthias Ringwald break; 329226166ecfSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 329326166ecfSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 329426166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 329526166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 32967627a0deSMatthias Ringwald switch (gatt_client->eatt_state){ 32977627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE: 32987627a0deSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle == 0){ 32997627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33007627a0deSMatthias Ringwald } else { 33017627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND; 33027627a0deSMatthias Ringwald } 33037627a0deSMatthias Ringwald break; 33047627a0deSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE: 33057627a0deSMatthias Ringwald if ((gatt_client->gatt_server_supported_features & 1) == 0) { 33067627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33077627a0deSMatthias Ringwald } else { 33087627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND; 33097627a0deSMatthias Ringwald } 33107627a0deSMatthias Ringwald break; 33117627a0deSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE: 33127627a0deSMatthias Ringwald if (gatt_client->gatt_client_supported_features_handle == 0){ 33137627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33147627a0deSMatthias Ringwald } else { 33157627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND; 33167627a0deSMatthias Ringwald } 33177627a0deSMatthias Ringwald break; 33187627a0deSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE: 33197627a0deSMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 332026166ecfSMatthias Ringwald break; 332126166ecfSMatthias Ringwald default: 332226166ecfSMatthias Ringwald break; 332326166ecfSMatthias Ringwald } 332426166ecfSMatthias Ringwald break; 33257627a0deSMatthias Ringwald case L2CAP_EVENT_ECBM_CHANNEL_OPENED: 33267627a0deSMatthias Ringwald l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet); 33277627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 33287627a0deSMatthias Ringwald 33297627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 33307627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 3331052dc82aSMatthias Ringwald btstack_assert(eatt_client->state == P_W4_L2CAP_CONNECTION); 33327627a0deSMatthias Ringwald 33337627a0deSMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 33347627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3335052dc82aSMatthias Ringwald eatt_client->state = P_READY; 33367627a0deSMatthias Ringwald eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 33377627a0deSMatthias Ringwald } else { 3338df0a5c68SMatthias Ringwald eatt_client->state = P_L2CAP_CLOSED; 33397627a0deSMatthias Ringwald } 3340df0a5c68SMatthias Ringwald // connected if opened event for all channels received 3341df0a5c68SMatthias Ringwald if (gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_W4_L2CAP_CONNECTION) == 0){ 33427627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS); 33437627a0deSMatthias Ringwald } 33447627a0deSMatthias Ringwald break; 33457627a0deSMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 33467627a0deSMatthias Ringwald l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet); 33477627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 33487627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 33497627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 33507627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 33517627a0deSMatthias Ringwald break; 33527627a0deSMatthias Ringwald default: 33537627a0deSMatthias Ringwald break; 33547627a0deSMatthias Ringwald } 33557627a0deSMatthias Ringwald break; 33567627a0deSMatthias Ringwald case L2CAP_DATA_PACKET: 33577627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client); 33587627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 3359ce82ac7fSMatthias Ringwald btstack_assert(eatt_client != NULL); 3360ce82ac7fSMatthias Ringwald gatt_client_handle_att_response(eatt_client, packet, size); 33617627a0deSMatthias Ringwald gatt_client_run(); 33627627a0deSMatthias Ringwald break; 336326166ecfSMatthias Ringwald default: 336426166ecfSMatthias Ringwald break; 336526166ecfSMatthias Ringwald } 336626166ecfSMatthias Ringwald } 336726166ecfSMatthias Ringwald 33687627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){ 336926166ecfSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 337026166ecfSMatthias Ringwald uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications 337126166ecfSMatthias Ringwald switch (gatt_client->eatt_state){ 33727627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND: 33737627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = 0; 33747627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE; 33757627a0deSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler, 33767627a0deSMatthias Ringwald gatt_client->con_handle, 33777627a0deSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 33787627a0deSMatthias Ringwald break; 337926166ecfSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND: 33807627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = 0; 33817627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE; 338226166ecfSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler, 33837627a0deSMatthias Ringwald gatt_client->con_handle, 33847627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 33857627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 338626166ecfSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES); 338726166ecfSMatthias Ringwald return true; 338826166ecfSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND: 33897627a0deSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = 0; 33907627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE; 339126166ecfSMatthias Ringwald status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler, 33927627a0deSMatthias Ringwald gatt_client->con_handle, 33937627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 33947627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 33957627a0deSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES); 339626166ecfSMatthias Ringwald return true; 339726166ecfSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND: 339826166ecfSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE; 339926166ecfSMatthias Ringwald status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle, 340026166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle, 1, 340126166ecfSMatthias Ringwald &gatt_client_supported_features); 340226166ecfSMatthias Ringwald return true; 340326166ecfSMatthias Ringwald default: 340426166ecfSMatthias Ringwald break; 340526166ecfSMatthias Ringwald } 34067627a0deSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 34077627a0deSMatthias Ringwald UNUSED(status); 340826166ecfSMatthias Ringwald return false; 340926166ecfSMatthias Ringwald } 341026166ecfSMatthias Ringwald 341126166ecfSMatthias 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) { 341226166ecfSMatthias Ringwald gatt_client_t * gatt_client; 341326166ecfSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 341426166ecfSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 341526166ecfSMatthias Ringwald return status; 341626166ecfSMatthias Ringwald } 341726166ecfSMatthias Ringwald 341826166ecfSMatthias Ringwald if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){ 341926166ecfSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 342026166ecfSMatthias Ringwald } 342126166ecfSMatthias Ringwald 3422f7a42e72SMatthias Ringwald // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports 34237627a0deSMatthias Ringwald uint16_t buffer_size_per_client = storage_size / num_channels; 3424f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 3425f7a42e72SMatthias Ringwald if (max_mtu < 64) { 34267627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 34277627a0deSMatthias Ringwald } 34287627a0deSMatthias Ringwald 34297627a0deSMatthias Ringwald if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){ 34307627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 34317627a0deSMatthias Ringwald } 34327627a0deSMatthias Ringwald 34337627a0deSMatthias Ringwald // create max num_channel eatt clients 34347627a0deSMatthias Ringwald uint8_t i; 34357627a0deSMatthias Ringwald btstack_linked_list_t eatt_clients = NULL; 34367627a0deSMatthias Ringwald for (i=0;i<num_channels;i++) { 34377627a0deSMatthias Ringwald gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get(); 34387627a0deSMatthias Ringwald if (new_gatt_client == NULL) { 34397627a0deSMatthias Ringwald break; 34407627a0deSMatthias Ringwald } 34417627a0deSMatthias Ringwald btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client); 34427627a0deSMatthias Ringwald } 34437627a0deSMatthias Ringwald 34447627a0deSMatthias Ringwald if (i != num_channels){ 34457627a0deSMatthias Ringwald while (true){ 34467627a0deSMatthias Ringwald gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients); 34477627a0deSMatthias Ringwald if (gatt_client == NULL) { 34487627a0deSMatthias Ringwald break; 34497627a0deSMatthias Ringwald } 34507627a0deSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 34517627a0deSMatthias Ringwald } 34527627a0deSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 34537627a0deSMatthias Ringwald } 34547627a0deSMatthias Ringwald 3455570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 3456570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = true; 3457570bdd2dSMatthias Ringwald 34587627a0deSMatthias Ringwald gatt_client->callback = callback; 34597627a0deSMatthias Ringwald gatt_client->eatt_num_clients = num_channels; 34607627a0deSMatthias Ringwald gatt_client->eatt_storage_buffer = storage_buffer; 34617627a0deSMatthias Ringwald gatt_client->eatt_storage_size = storage_size; 34627627a0deSMatthias Ringwald gatt_client->eatt_clients = eatt_clients; 34637627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND; 346426166ecfSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 346526166ecfSMatthias Ringwald 346626166ecfSMatthias Ringwald return ERROR_CODE_SUCCESS; 346726166ecfSMatthias Ringwald } 346826166ecfSMatthias Ringwald 346926166ecfSMatthias Ringwald #endif 347026166ecfSMatthias Ringwald 3471a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 3472a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 3473a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 3474a6121b51SMilanka Ringwald } 3475ae1ee62dSMilanka Ringwald 347640faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 347740faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client); 347840faeb84SMilanka Ringwald return status; 3479ae1ee62dSMilanka Ringwald } 3480a6121b51SMilanka Ringwald #endif 3481