13deb3ec6SMatthias Ringwald /* 23deb3ec6SMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 33deb3ec6SMatthias Ringwald * 43deb3ec6SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 53deb3ec6SMatthias Ringwald * modification, are permitted provided that the following conditions 63deb3ec6SMatthias Ringwald * are met: 73deb3ec6SMatthias Ringwald * 83deb3ec6SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 93deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 103deb3ec6SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 113deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 123deb3ec6SMatthias Ringwald * documentation and/or other materials provided with the distribution. 133deb3ec6SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 143deb3ec6SMatthias Ringwald * contributors may be used to endorse or promote products derived 153deb3ec6SMatthias Ringwald * from this software without specific prior written permission. 163deb3ec6SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 173deb3ec6SMatthias Ringwald * personal benefit and not for any commercial purpose or for 183deb3ec6SMatthias Ringwald * monetary gain. 193deb3ec6SMatthias Ringwald * 203deb3ec6SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 213deb3ec6SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 223deb3ec6SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 232fca4dadSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN 242fca4dadSMilanka Ringwald * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 253deb3ec6SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 263deb3ec6SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 273deb3ec6SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 283deb3ec6SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 293deb3ec6SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 303deb3ec6SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 313deb3ec6SMatthias Ringwald * SUCH DAMAGE. 323deb3ec6SMatthias Ringwald * 333deb3ec6SMatthias Ringwald * Please inquire about commercial licensing options at 343deb3ec6SMatthias Ringwald * [email protected] 353deb3ec6SMatthias Ringwald * 363deb3ec6SMatthias Ringwald */ 373deb3ec6SMatthias Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "gatt_client.c" 39ab2c6ae4SMatthias Ringwald 403deb3ec6SMatthias Ringwald #include <stdint.h> 413deb3ec6SMatthias Ringwald #include <string.h> 42a95ca902SMatthias Ringwald #include <stddef.h> 433deb3ec6SMatthias Ringwald 447907f069SMatthias Ringwald #include "btstack_config.h" 453deb3ec6SMatthias Ringwald 46296289e3SMatthias Ringwald #include "ble/att_dispatch.h" 470e2df43fSMatthias Ringwald #include "ble/att_db.h" 480e2df43fSMatthias Ringwald #include "ble/gatt_client.h" 490e2df43fSMatthias Ringwald #include "ble/le_device_db.h" 500e2df43fSMatthias Ringwald #include "ble/sm.h" 51c40517c3SMatthias Ringwald #include "bluetooth_psm.h" 5216ece135SMatthias Ringwald #include "btstack_debug.h" 530e2df43fSMatthias Ringwald #include "btstack_event.h" 543deb3ec6SMatthias Ringwald #include "btstack_memory.h" 550e2df43fSMatthias Ringwald #include "btstack_run_loop.h" 560e2df43fSMatthias Ringwald #include "btstack_util.h" 573deb3ec6SMatthias Ringwald #include "hci.h" 583deb3ec6SMatthias Ringwald #include "hci_dump.h" 593deb3ec6SMatthias Ringwald #include "l2cap.h" 601450cdc6SMatthias Ringwald #include "classic/sdp_client.h" 611450cdc6SMatthias Ringwald #include "bluetooth_gatt.h" 621450cdc6SMatthias Ringwald #include "bluetooth_sdp.h" 631450cdc6SMatthias Ringwald #include "classic/sdp_util.h" 643deb3ec6SMatthias Ringwald 654797b71aSMatthias Ringwald #if defined(ENABLE_GATT_OVER_EATT) && !defined(ENABLE_L2CAP_ENHANCED_CREDIT_BASED_FLOW_CONTROL_MODE) 664797b71aSMatthias Ringwald #error "GATT Over EATT requires support for L2CAP Enhanced CoC. Please enable ENABLE_L2CAP_ENHANCED_CREDIT_BASED_FLOW_CONTROL_MODE" 674797b71aSMatthias Ringwald #endif 684797b71aSMatthias Ringwald 69b1da4983SMatthias Ringwald // L2CAP Test Spec p35 defines a minimum of 100 ms, but PTS might indicate an error if we sent after 100 ms 70b1da4983SMatthias Ringwald #define GATT_CLIENT_COLLISION_BACKOFF_MS 150 71b1da4983SMatthias Ringwald 729c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections; 739c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners; 74361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 75f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration; 76544a5845SMatthias Ringwald static btstack_context_callback_registration_t gatt_client_deferred_event_emit; 77f4b33574SMatthias Ringwald 7811279da7SMatthias Ringwald // GATT Client Configuration 7911279da7SMatthias Ringwald static bool gatt_client_mtu_exchange_enabled; 8011279da7SMatthias Ringwald static gap_security_level_t gatt_client_required_security_level; 815cf6c434SJakob Krantz 823deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size); 83f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 845cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code); 857a766ebfSMatthias Ringwald 867a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 873deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]); 887a766ebfSMatthias Ringwald #endif 893deb3ec6SMatthias Ringwald 9059b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 9159b5e157SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid); 9259b5e157SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status); 9359b5e157SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client); 94180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts); 9559b5e157SMatthias Ringwald #endif 9659b5e157SMatthias Ringwald 9726166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 987627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client); 996d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts); 10026166ecfSMatthias Ringwald #endif 10126166ecfSMatthias Ringwald 1023deb3ec6SMatthias Ringwald void gatt_client_init(void){ 1033deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 104f4b33574SMatthias Ringwald 10511279da7SMatthias Ringwald // default configuration 10611279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = true; 10711279da7SMatthias Ringwald gatt_client_required_security_level = LEVEL_0; 10811279da7SMatthias Ringwald 10911279da7SMatthias Ringwald // register for HCI Events 110f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 111361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 112361b1363SMatthias Ringwald 113f4b33574SMatthias Ringwald // register for SM Events 114f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 115f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 116f4b33574SMatthias Ringwald 117361b1363SMatthias Ringwald // and ATT Client PDUs 1183deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 1193deb3ec6SMatthias Ringwald } 1203deb3ec6SMatthias Ringwald 12111279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){ 12211279da7SMatthias Ringwald gatt_client_required_security_level = level; 12311279da7SMatthias Ringwald } 12411279da7SMatthias Ringwald 125ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 126665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 127665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 128665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1295cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1305cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1315cf1669fSMatthias Ringwald return gatt_client; 1323deb3ec6SMatthias Ringwald } 1333deb3ec6SMatthias Ringwald } 1343deb3ec6SMatthias Ringwald return NULL; 1353deb3ec6SMatthias Ringwald } 1363deb3ec6SMatthias Ringwald 137ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1385cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1395cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1405cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1415cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1423deb3ec6SMatthias Ringwald } 1433deb3ec6SMatthias Ringwald 1445cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1458ac3a0b3SMatthias Ringwald log_debug("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1465cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1475cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1485cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1495cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1503deb3ec6SMatthias Ringwald } 1513deb3ec6SMatthias Ringwald 1525cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1538ac3a0b3SMatthias Ringwald log_debug("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1545cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1553deb3ec6SMatthias Ringwald } 1563deb3ec6SMatthias Ringwald 1571dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){ 1581dfae9c7SMatthias Ringwald uint8_t encryption_key_size = gap_encryption_key_size(con_handle); 1591dfae9c7SMatthias Ringwald if (encryption_key_size == 0) return LEVEL_0; 1601dfae9c7SMatthias Ringwald 161ff3f1026SMatthias Ringwald bool authenticated = gap_authenticated(con_handle); 1621dfae9c7SMatthias Ringwald if (!authenticated) return LEVEL_2; 1631dfae9c7SMatthias Ringwald 1641dfae9c7SMatthias Ringwald return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3; 1651dfae9c7SMatthias Ringwald } 1661dfae9c7SMatthias Ringwald 1675cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 168665d90f2SMatthias Ringwald btstack_linked_item_t *it; 169a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1705cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1715cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1725cf1669fSMatthias Ringwald return gatt_client; 1733deb3ec6SMatthias Ringwald } 1743deb3ec6SMatthias Ringwald } 1753deb3ec6SMatthias Ringwald return NULL; 1763deb3ec6SMatthias Ringwald } 1773deb3ec6SMatthias Ringwald 1783deb3ec6SMatthias Ringwald 1796b65794dSMilanka Ringwald // @return gatt_client context 1803deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 18140faeb84SMilanka Ringwald static uint8_t gatt_client_provide_context_for_handle(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 1825cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 18340faeb84SMilanka Ringwald 18440faeb84SMilanka Ringwald if (gatt_client != NULL){ 18540faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 18640faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 18740faeb84SMilanka Ringwald } 1883deb3ec6SMatthias Ringwald 189ae1d1237SMatthias Ringwald // bail if no such hci connection 1900e0bba86SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 1910e0bba86SMatthias Ringwald if (hci_connection == NULL){ 192ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 19340faeb84SMilanka Ringwald *out_gatt_client = NULL; 19440faeb84SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 195ae1d1237SMatthias Ringwald } 19640faeb84SMilanka Ringwald 1975cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 19840faeb84SMilanka Ringwald if (gatt_client == NULL){ 19940faeb84SMilanka Ringwald *out_gatt_client = NULL; 20040faeb84SMilanka Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 20140faeb84SMilanka Ringwald } 2023deb3ec6SMatthias Ringwald // init state 203e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_LE; 2045cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 2055cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 2061dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 20711279da7SMatthias Ringwald if (gatt_client_mtu_exchange_enabled){ 2085cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 2095cf6c434SJakob Krantz } else { 2105cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 2115cf6c434SJakob Krantz } 212052dc82aSMatthias Ringwald gatt_client->state = P_READY; 213*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_W2_SEND; 214cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 215cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 216cbd76cecSMatthias Ringwald #endif 2175cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 2180e0bba86SMatthias Ringwald 2190e0bba86SMatthias Ringwald // get unenhanced att bearer state 2200e0bba86SMatthias Ringwald if (hci_connection->att_connection.mtu_exchanged){ 2210e0bba86SMatthias Ringwald gatt_client->mtu = hci_connection->att_connection.mtu; 2220e0bba86SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 2230e0bba86SMatthias Ringwald } 22440faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 22540faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 2263deb3ec6SMatthias Ringwald } 2273deb3ec6SMatthias Ringwald 228de27733dSMatthias Ringwald static bool is_ready(gatt_client_t * gatt_client){ 229052dc82aSMatthias Ringwald return gatt_client->state == P_READY; 230de27733dSMatthias Ringwald } 231de27733dSMatthias Ringwald 232de27733dSMatthias Ringwald static uint8_t gatt_client_provide_context_for_request(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 233de27733dSMatthias Ringwald gatt_client_t * gatt_client = NULL; 234de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 23540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 23640faeb84SMilanka Ringwald return status; 23740faeb84SMilanka Ringwald } 238de27733dSMatthias Ringwald 2397627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2407627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 2417627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 2427627a0deSMatthias Ringwald gatt_client_t * eatt_client = NULL; 2437627a0deSMatthias Ringwald // find free eatt client 2447627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 2457627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 2467627a0deSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 247052dc82aSMatthias Ringwald if (client->state == P_READY){ 2487627a0deSMatthias Ringwald eatt_client = client; 2497627a0deSMatthias Ringwald break; 2507627a0deSMatthias Ringwald } 2517627a0deSMatthias Ringwald } 2527627a0deSMatthias Ringwald if (eatt_client == NULL){ 2537627a0deSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2547627a0deSMatthias Ringwald } 2557627a0deSMatthias Ringwald gatt_client = eatt_client; 2567627a0deSMatthias Ringwald } 2577627a0deSMatthias Ringwald #endif 2587627a0deSMatthias Ringwald 259643a64fcSMatthias Ringwald if (is_ready(gatt_client) == false){ 260de27733dSMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2613deb3ec6SMatthias Ringwald } 2623deb3ec6SMatthias Ringwald 263de27733dSMatthias Ringwald gatt_client_timeout_start(gatt_client); 264de27733dSMatthias Ringwald 265de27733dSMatthias Ringwald *out_gatt_client = gatt_client; 266de27733dSMatthias Ringwald 267de27733dSMatthias Ringwald return status; 2683deb3ec6SMatthias Ringwald } 2693deb3ec6SMatthias Ringwald 270fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 27140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 27240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 27340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 27440faeb84SMilanka Ringwald return 0; 27540faeb84SMilanka Ringwald } 276aacf1b1aSMilanka Ringwald return is_ready(gatt_client) ? 1 : 0; 2773deb3ec6SMatthias Ringwald } 2783deb3ec6SMatthias Ringwald 2795cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 28011279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = enabled != 0; 2815cf6c434SJakob Krantz } 2825cf6c434SJakob Krantz 283fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 28440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 28540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 28640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 28740faeb84SMilanka Ringwald return status; 28840faeb84SMilanka Ringwald } 2897d2258b3SMilanka Ringwald 2905cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2915cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2927d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2933deb3ec6SMatthias Ringwald } 2943deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 295616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2963deb3ec6SMatthias Ringwald } 2973deb3ec6SMatthias Ringwald 2989228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) { 2997627a0deSMatthias Ringwald switch (gatt_client->bearer_type){ 3007627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 3017627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 3027627a0deSMatthias Ringwald #endif 3037627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3049228fd32SMatthias Ringwald l2cap_reserve_packet_buffer(); 3059228fd32SMatthias Ringwald return l2cap_get_outgoing_buffer(); 3067627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3077627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3087627a0deSMatthias Ringwald return gatt_client->eatt_storage_buffer; 3097627a0deSMatthias Ringwald #endif 3107627a0deSMatthias Ringwald default: 3117627a0deSMatthias Ringwald btstack_unreachable(); 3127627a0deSMatthias Ringwald break; 3137627a0deSMatthias Ringwald } 3147627a0deSMatthias Ringwald return NULL; 3159228fd32SMatthias Ringwald } 3169228fd32SMatthias Ringwald 3173deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3186e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){ 31946012949SMatthias Ringwald switch (gatt_client->bearer_type){ 32046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3216e7b444cSMatthias Ringwald return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len); 32246012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 32346012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 32446012949SMatthias Ringwald return l2cap_send_prepared(gatt_client->l2cap_cid, len); 32546012949SMatthias Ringwald #endif 3267627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3277627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3287627a0deSMatthias Ringwald return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len); 3297627a0deSMatthias Ringwald #endif 33046012949SMatthias Ringwald default: 33146012949SMatthias Ringwald btstack_unreachable(); 33246012949SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 33346012949SMatthias Ringwald } 3343deb3ec6SMatthias Ringwald } 3353deb3ec6SMatthias Ringwald 3363deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3376e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) { 3389228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3396e7b444cSMatthias Ringwald 3406e7b444cSMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 3416e7b444cSMatthias Ringwald 3426e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 1); 3436e7b444cSMatthias Ringwald } 3446e7b444cSMatthias Ringwald 3456e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE 3466e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle, 3476e7b444cSMatthias Ringwald uint16_t end_handle) { 3489228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3496e7b444cSMatthias Ringwald 3503deb3ec6SMatthias Ringwald request[0] = request_type; 351f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 352f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3533deb3ec6SMatthias Ringwald 3546e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 3553deb3ec6SMatthias Ringwald } 3563deb3ec6SMatthias Ringwald 3573deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3586e7b444cSMatthias Ringwald static uint8_t 3596e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type, 3606e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) { 3619228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3623deb3ec6SMatthias Ringwald request[0] = request_type; 3639228fd32SMatthias Ringwald 364f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 365f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 366f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 3676535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 3683deb3ec6SMatthias Ringwald 3696e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7u + value_size); 3703deb3ec6SMatthias Ringwald } 3713deb3ec6SMatthias Ringwald 3723deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3736e7b444cSMatthias Ringwald static uint8_t 3746e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16, 3756e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3769228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3776e7b444cSMatthias Ringwald 3783deb3ec6SMatthias Ringwald request[0] = request_type; 379f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 380f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 381f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 3823deb3ec6SMatthias Ringwald 3836e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7); 3843deb3ec6SMatthias Ringwald } 3853deb3ec6SMatthias Ringwald 3863deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3876e7b444cSMatthias Ringwald static uint8_t 3886e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128, 3896e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3909228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3916e7b444cSMatthias Ringwald 3923deb3ec6SMatthias Ringwald request[0] = request_type; 393f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 394f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3959c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 3963deb3ec6SMatthias Ringwald 3976e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 21); 3983deb3ec6SMatthias Ringwald } 3993deb3ec6SMatthias Ringwald 4003deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4016e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) { 4029228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4036e7b444cSMatthias Ringwald 4043deb3ec6SMatthias Ringwald request[0] = request_type; 405f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4063deb3ec6SMatthias Ringwald 4076e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 4083deb3ec6SMatthias Ringwald } 4093deb3ec6SMatthias Ringwald 4103deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4116e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4126e7b444cSMatthias Ringwald uint16_t value_offset) { 4139228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4149228fd32SMatthias Ringwald 4153deb3ec6SMatthias Ringwald request[0] = request_type; 416f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 417f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4183deb3ec6SMatthias Ringwald 4196e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 4203deb3ec6SMatthias Ringwald } 4213deb3ec6SMatthias Ringwald 4226e7b444cSMatthias Ringwald static uint8_t 423f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) { 4249228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4259228fd32SMatthias Ringwald 426f125a8efSMatthias Ringwald request[0] = opcode; 4279228fd32SMatthias Ringwald uint16_t i; 4289228fd32SMatthias Ringwald uint16_t offset = 1; 4293deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 430f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 4313deb3ec6SMatthias Ringwald offset += 2; 4323deb3ec6SMatthias Ringwald } 43325b7c058SMilanka Ringwald 4346e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, offset); 4353deb3ec6SMatthias Ringwald } 4363deb3ec6SMatthias Ringwald 437f125a8efSMatthias Ringwald static uint8_t 438f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 439f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST); 440f125a8efSMatthias Ringwald } 441f125a8efSMatthias Ringwald 442f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 443f125a8efSMatthias Ringwald static uint8_t 444f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 445f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_VARIABLE_REQ); 446f125a8efSMatthias Ringwald } 447f125a8efSMatthias Ringwald #endif 448f125a8efSMatthias Ringwald 4497a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4503deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4516e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle, 4526e7b444cSMatthias Ringwald uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) { 4539228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4549228fd32SMatthias Ringwald 4553deb3ec6SMatthias Ringwald request[0] = request_type; 456f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4576535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 458f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 4599c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 46025b7c058SMilanka Ringwald 4616e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3 + value_length + 12); 4623deb3ec6SMatthias Ringwald } 4637a766ebfSMatthias Ringwald #endif 4643deb3ec6SMatthias Ringwald 4653deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4666e7b444cSMatthias Ringwald static uint8_t 4676e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length, 4686e7b444cSMatthias Ringwald uint8_t *value) { 4699228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4709228fd32SMatthias Ringwald 4713deb3ec6SMatthias Ringwald request[0] = request_type; 472f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4736535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 4743deb3ec6SMatthias Ringwald 4756e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3u + value_length); 4763deb3ec6SMatthias Ringwald } 4773deb3ec6SMatthias Ringwald 4783deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4796e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) { 4809228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4819228fd32SMatthias Ringwald 4823deb3ec6SMatthias Ringwald request[0] = request_type; 4833deb3ec6SMatthias Ringwald request[1] = execute_write; 48425b7c058SMilanka Ringwald 4856e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 2); 4863deb3ec6SMatthias Ringwald } 4873deb3ec6SMatthias Ringwald 4883deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4896e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4906e7b444cSMatthias Ringwald uint16_t value_offset, uint16_t blob_length, uint8_t *value) { 4919228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4929228fd32SMatthias Ringwald 4933deb3ec6SMatthias Ringwald request[0] = request_type; 494f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 495f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4966535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 4973deb3ec6SMatthias Ringwald 4986e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5u + blob_length); 4993deb3ec6SMatthias Ringwald } 5003deb3ec6SMatthias Ringwald 5016e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) { 5029228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 5039228fd32SMatthias Ringwald 5043deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 5059228fd32SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 506f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 50725b7c058SMilanka Ringwald 5086e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 5093deb3ec6SMatthias Ringwald } 5103deb3ec6SMatthias Ringwald 5115cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 512dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 5135cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 5143deb3ec6SMatthias Ringwald return 0; 5153deb3ec6SMatthias Ringwald } 5165cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 5173deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 5183deb3ec6SMatthias Ringwald return rest_length; 5193deb3ec6SMatthias Ringwald } 5203deb3ec6SMatthias Ringwald return max_blob_length; 5213deb3ec6SMatthias Ringwald } 5223deb3ec6SMatthias Ringwald 5235cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 5246e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST, 5256e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5266e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5273deb3ec6SMatthias Ringwald } 5283deb3ec6SMatthias Ringwald 5295cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 53052377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5313deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 5325cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 5336e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5346e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 5353deb3ec6SMatthias Ringwald return; 5363deb3ec6SMatthias Ringwald } 5373deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5385cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 5396e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5406e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16); 5413deb3ec6SMatthias Ringwald } 5423deb3ec6SMatthias Ringwald 5435cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 5445cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 5453deb3ec6SMatthias Ringwald } 5463deb3ec6SMatthias Ringwald 5475cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 5486e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle); 5493deb3ec6SMatthias Ringwald } 5503deb3ec6SMatthias Ringwald 5515cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 5526e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5536e7b444cSMatthias Ringwald GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle, 5546e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5553deb3ec6SMatthias Ringwald } 5563deb3ec6SMatthias Ringwald 5575cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 5586e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5596e7b444cSMatthias Ringwald GATT_CHARACTERISTICS_UUID, gatt_client->start_group_handle, 5606e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5613deb3ec6SMatthias Ringwald } 5623deb3ec6SMatthias Ringwald 5635cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 5646e7b444cSMatthias Ringwald att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle, 5656e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5663deb3ec6SMatthias Ringwald } 5673deb3ec6SMatthias Ringwald 5685cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 5696e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 5703deb3ec6SMatthias Ringwald } 5713deb3ec6SMatthias Ringwald 5725cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 57352377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5746e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5756e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5766e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5773deb3ec6SMatthias Ringwald } else { 5786e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5796e7b444cSMatthias Ringwald gatt_client->uuid128, gatt_client->start_group_handle, 5806e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5813deb3ec6SMatthias Ringwald } 5823deb3ec6SMatthias Ringwald } 5833deb3ec6SMatthias Ringwald 5845cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 58530952227SMilanka Ringwald if (gatt_client->attribute_offset == 0){ 5866e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 58730952227SMilanka Ringwald } else { 5886e7b444cSMatthias Ringwald att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle, 5896e7b444cSMatthias Ringwald gatt_client->attribute_offset); 5903deb3ec6SMatthias Ringwald } 59130952227SMilanka Ringwald } 5923deb3ec6SMatthias Ringwald 5935cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 5946e7b444cSMatthias Ringwald att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 5953deb3ec6SMatthias Ringwald } 5963deb3ec6SMatthias Ringwald 597f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 598f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){ 599f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 600f125a8efSMatthias Ringwald } 601f125a8efSMatthias Ringwald #endif 602f125a8efSMatthias Ringwald 6035cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 6046e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length, 6056e7b444cSMatthias Ringwald gatt_client->attribute_value); 6063deb3ec6SMatthias Ringwald } 6073deb3ec6SMatthias Ringwald 6085cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6096e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2, 6106e7b444cSMatthias Ringwald gatt_client->client_characteristic_configuration_value); 6113deb3ec6SMatthias Ringwald } 6123deb3ec6SMatthias Ringwald 6135cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 6146e7b444cSMatthias Ringwald att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle, 6156e7b444cSMatthias Ringwald gatt_client->attribute_offset, write_blob_length(gatt_client), 6166e7b444cSMatthias Ringwald gatt_client->attribute_value); 6173deb3ec6SMatthias Ringwald } 6183deb3ec6SMatthias Ringwald 6195cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 6206e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1); 6213deb3ec6SMatthias Ringwald } 6223deb3ec6SMatthias Ringwald 6235cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 6246e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0); 6253deb3ec6SMatthias Ringwald } 6263deb3ec6SMatthias Ringwald 627abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 6285cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6296e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 6306e7b444cSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, 6316e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle); 6323deb3ec6SMatthias Ringwald } 633abdc9fb5SMatthias Ringwald #endif 6343deb3ec6SMatthias Ringwald 6355cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 6366e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 6373deb3ec6SMatthias Ringwald } 6383deb3ec6SMatthias Ringwald 6397a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 6405cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 6416e7b444cSMatthias Ringwald att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, 6426e7b444cSMatthias Ringwald gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, 6436e7b444cSMatthias Ringwald gatt_client->cmac); 6443deb3ec6SMatthias Ringwald } 6457a766ebfSMatthias Ringwald #endif 6463deb3ec6SMatthias Ringwald 6473deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 64839ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6493deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65039ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6514ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 6523deb3ec6SMatthias Ringwald } 6533deb3ec6SMatthias Ringwald 6543deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 65539ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6563deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65739ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6584ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 6593deb3ec6SMatthias Ringwald } 6603deb3ec6SMatthias Ringwald 6613deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 66239ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6633deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 66439ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 665f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 6663deb3ec6SMatthias Ringwald } 6673deb3ec6SMatthias Ringwald 668*d9ced76fSMatthias Ringwald static void gatt_client_service_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 669*d9ced76fSMatthias Ringwald hci_con_handle_t con_handle; 670*d9ced76fSMatthias Ringwald gatt_client_t *gatt_client; 671*d9ced76fSMatthias Ringwald gatt_client_service_t service; 672*d9ced76fSMatthias Ringwald gatt_client_characteristic_t characteristic; 673*d9ced76fSMatthias Ringwald switch (packet_type) { 674*d9ced76fSMatthias Ringwald case HCI_EVENT_PACKET: 675*d9ced76fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 676*d9ced76fSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 677*d9ced76fSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 678*d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 679*d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 680*d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DISCOVER_W4_DONE); 681*d9ced76fSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 682*d9ced76fSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 683*d9ced76fSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 684*d9ced76fSMatthias Ringwald break; 685*d9ced76fSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 686*d9ced76fSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 687*d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 688*d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 689*d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE); 690*d9ced76fSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 691*d9ced76fSMatthias Ringwald switch (characteristic.uuid16){ 692*d9ced76fSMatthias Ringwald case ORG_BLUETOOTH_CHARACTERISTIC_GATT_SERVICE_CHANGED: 693*d9ced76fSMatthias Ringwald gatt_client->gatt_service_changed_value_handle = characteristic.value_handle; 694*d9ced76fSMatthias Ringwald gatt_client->gatt_service_changed_end_handle = characteristic.end_handle; 695*d9ced76fSMatthias Ringwald break; 696*d9ced76fSMatthias Ringwald case ORG_BLUETOOTH_CHARACTERISTIC_DATABASE_HASH: 697*d9ced76fSMatthias Ringwald gatt_client->gatt_service_database_hash_value_handle = characteristic.value_handle; 698*d9ced76fSMatthias Ringwald gatt_client->gatt_service_database_hash_end_handle = characteristic.end_handle; 699*d9ced76fSMatthias Ringwald break; 700*d9ced76fSMatthias Ringwald default: 701*d9ced76fSMatthias Ringwald break; 702*d9ced76fSMatthias Ringwald } 703*d9ced76fSMatthias Ringwald break; 704*d9ced76fSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 705*d9ced76fSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 706*d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 707*d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 708*d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE); 709*d9ced76fSMatthias Ringwald break; 710*d9ced76fSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 711*d9ced76fSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 712*d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 713*d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 714*d9ced76fSMatthias Ringwald switch (gatt_client->gatt_service_state) { 715*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_W4_DONE: 716*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W2_SEND; 717*d9ced76fSMatthias Ringwald break; 718*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE: 719*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W2_SEND; 720*d9ced76fSMatthias Ringwald break; 721*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W4_DONE: 722*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W2_SEND; 723*d9ced76fSMatthias Ringwald break; 724*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE: 725*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W2_SEND; 726*d9ced76fSMatthias Ringwald break; 727*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W4_DONE: 728*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DONE; 729*d9ced76fSMatthias Ringwald break; 730*d9ced76fSMatthias Ringwald default: 731*d9ced76fSMatthias Ringwald btstack_unreachable(); 732*d9ced76fSMatthias Ringwald break; 733*d9ced76fSMatthias Ringwald } 734*d9ced76fSMatthias Ringwald break; 735*d9ced76fSMatthias Ringwald default: 736*d9ced76fSMatthias Ringwald break; 737*d9ced76fSMatthias Ringwald } 738*d9ced76fSMatthias Ringwald break; 739*d9ced76fSMatthias Ringwald default: 740*d9ced76fSMatthias Ringwald break; 741*d9ced76fSMatthias Ringwald } 742*d9ced76fSMatthias Ringwald } 743*d9ced76fSMatthias Ringwald 74453e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){ 74519c614acSMatthias Ringwald 74619c614acSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 74719c614acSMatthias Ringwald // if eatt is ready, notify all clients that can send a query 74819c614acSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 74919c614acSMatthias Ringwald btstack_linked_list_iterator_t it; 75019c614acSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 75119c614acSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 75219c614acSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 753052dc82aSMatthias Ringwald if (client->state == P_READY){ 75419c614acSMatthias Ringwald // call callback 75519c614acSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 75619c614acSMatthias Ringwald if (callback == NULL) { 75719c614acSMatthias Ringwald return; 75819c614acSMatthias Ringwald } 75919c614acSMatthias Ringwald (*callback->callback)(callback->context); 76019c614acSMatthias Ringwald } 76119c614acSMatthias Ringwald } 76219c614acSMatthias Ringwald return; 76319c614acSMatthias Ringwald } 76419c614acSMatthias Ringwald #endif 76519c614acSMatthias Ringwald 766*d9ced76fSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 767*d9ced76fSMatthias Ringwald gatt_client_service_t gatt_service; 768*d9ced76fSMatthias Ringwald gatt_client_characteristic_t characteristic; 769052dc82aSMatthias Ringwald while (gatt_client->state == P_READY){ 770*d9ced76fSMatthias Ringwald bool query_sent = false; 771*d9ced76fSMatthias Ringwald switch (gatt_client->gatt_service_state){ 772*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_W2_SEND: 773*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_W4_DONE; 774*d9ced76fSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_service_packet_handler, 775*d9ced76fSMatthias Ringwald gatt_client->con_handle, 776*d9ced76fSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 777*d9ced76fSMatthias Ringwald query_sent = true; 778*d9ced76fSMatthias Ringwald break; 779*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W2_SEND: 780*d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle != 0){ 781*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE; 782*d9ced76fSMatthias Ringwald gatt_service.start_group_handle = gatt_client->gatt_service_start_group_handle; 783*d9ced76fSMatthias Ringwald gatt_service.end_group_handle = gatt_client->gatt_service_end_group_handle; 784*d9ced76fSMatthias Ringwald status = gatt_client_discover_characteristics_for_service(&gatt_client_service_packet_handler, gatt_client->con_handle, &gatt_service); 785*d9ced76fSMatthias Ringwald query_sent = true; 786*d9ced76fSMatthias Ringwald break; 787*d9ced76fSMatthias Ringwald } 788*d9ced76fSMatthias Ringwald 789*d9ced76fSMatthias Ringwald /* fall through */ 790*d9ced76fSMatthias Ringwald 791*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W2_SEND: 792*d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_changed_value_handle != 0){ 793*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W4_DONE; 794*d9ced76fSMatthias Ringwald characteristic.value_handle = gatt_client->gatt_service_changed_value_handle; 795*d9ced76fSMatthias Ringwald characteristic.end_handle = gatt_client->gatt_service_changed_end_handle; 796*d9ced76fSMatthias Ringwald // we assume good case. We cannot do much otherwise 797*d9ced76fSMatthias Ringwald characteristic.properties = ATT_PROPERTY_INDICATE; 798*d9ced76fSMatthias Ringwald status = gatt_client_write_client_characteristic_configuration(&gatt_client_service_packet_handler, 799*d9ced76fSMatthias Ringwald gatt_client->con_handle, &characteristic, 800*d9ced76fSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION); 801*d9ced76fSMatthias Ringwald query_sent = true; 802*d9ced76fSMatthias Ringwald break; 803*d9ced76fSMatthias Ringwald } 804*d9ced76fSMatthias Ringwald 805*d9ced76fSMatthias Ringwald /* fall through */ 806*d9ced76fSMatthias Ringwald 807*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W2_SEND: 808*d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_database_hash_value_handle != 0){ 809*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE; 810*d9ced76fSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_service_packet_handler, 811*d9ced76fSMatthias Ringwald gatt_client->con_handle, 812*d9ced76fSMatthias Ringwald 0x0001, 0xffff, ORG_BLUETOOTH_CHARACTERISTIC_DATABASE_HASH); 813*d9ced76fSMatthias Ringwald query_sent = true; 814*d9ced76fSMatthias Ringwald break; 815*d9ced76fSMatthias Ringwald } 816*d9ced76fSMatthias Ringwald 817*d9ced76fSMatthias Ringwald /* fall through */ 818*d9ced76fSMatthias Ringwald 819*d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W2_SEND: 820*d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_database_hash_value_handle != 0) { 821*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W4_DONE; 822*d9ced76fSMatthias Ringwald characteristic.value_handle = gatt_client->gatt_service_database_hash_value_handle; 823*d9ced76fSMatthias Ringwald characteristic.end_handle = gatt_client->gatt_service_database_hash_end_handle; 824*d9ced76fSMatthias Ringwald // we assume good case. We cannot do much otherwise 825*d9ced76fSMatthias Ringwald characteristic.properties = ATT_PROPERTY_INDICATE; 826*d9ced76fSMatthias Ringwald status = gatt_client_write_client_characteristic_configuration(&gatt_client_service_packet_handler, 827*d9ced76fSMatthias Ringwald gatt_client->con_handle, 828*d9ced76fSMatthias Ringwald &characteristic, 829*d9ced76fSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION); 830*d9ced76fSMatthias Ringwald query_sent = true; 831*d9ced76fSMatthias Ringwald break; 832*d9ced76fSMatthias Ringwald } 833*d9ced76fSMatthias Ringwald 834*d9ced76fSMatthias Ringwald // DONE 835*d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DONE; 836*d9ced76fSMatthias Ringwald break; 837*d9ced76fSMatthias Ringwald default: 838*d9ced76fSMatthias Ringwald break; 839*d9ced76fSMatthias Ringwald } 840*d9ced76fSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 841*d9ced76fSMatthias Ringwald UNUSED(status); 842*d9ced76fSMatthias Ringwald if (query_sent){ 843*d9ced76fSMatthias Ringwald continue; 844*d9ced76fSMatthias Ringwald } 845*d9ced76fSMatthias Ringwald 84626166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 847*d9ced76fSMatthias Ringwald query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client); 84826166ecfSMatthias Ringwald if (query_sent){ 84926166ecfSMatthias Ringwald continue; 85026166ecfSMatthias Ringwald } 85126166ecfSMatthias Ringwald #endif 85253e9c18fSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 85309834412SMatthias Ringwald if (callback == NULL) { 85409834412SMatthias Ringwald return; 85553e9c18fSMatthias Ringwald } 85609834412SMatthias Ringwald (*callback->callback)(callback->context); 85753e9c18fSMatthias Ringwald } 85853e9c18fSMatthias Ringwald } 85953e9c18fSMatthias Ringwald 86023d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 86123d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) { 86223d583b8SMatthias Ringwald // ignore messages until re-encryption is complete 86323d583b8SMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 86423d583b8SMatthias Ringwald 86523d583b8SMatthias Ringwald // after that ignore if bonded but not encrypted 86623d583b8SMatthias Ringwald return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0); 86723d583b8SMatthias Ringwald } 86823d583b8SMatthias Ringwald 8699c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 8709c662c9bSMatthias Ringwald if (!callback) return; 8719da9850bSMatthias Ringwald hci_dump_btstack_event(packet, size); 8729c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 8733deb3ec6SMatthias Ringwald } 8743deb3ec6SMatthias Ringwald 875711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 876665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 8779c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 878665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 87986c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 880b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 881b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 88286c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 8833deb3ec6SMatthias Ringwald } 8843deb3ec6SMatthias Ringwald } 8853deb3ec6SMatthias Ringwald 8865cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 8873deb3ec6SMatthias Ringwald // @format H1 8883deb3ec6SMatthias Ringwald uint8_t packet[5]; 8895611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 8903deb3ec6SMatthias Ringwald packet[1] = 3; 8915cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 8927d2258b3SMilanka Ringwald packet[4] = att_status; 8935cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 8943deb3ec6SMatthias Ringwald } 8953deb3ec6SMatthias Ringwald 896045d700dSDavid 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){ 8973deb3ec6SMatthias Ringwald // @format HX 8983deb3ec6SMatthias Ringwald uint8_t packet[24]; 8995611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 9004ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 9015cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 9023deb3ec6SMatthias Ringwald /// 903f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 904f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 9059c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 9065cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 9073deb3ec6SMatthias Ringwald } 9083deb3ec6SMatthias Ringwald 909045d700dSDavid 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){ 9103deb3ec6SMatthias Ringwald // @format HX 9113deb3ec6SMatthias Ringwald uint8_t packet[26]; 9125611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 9134ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 9145cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 9153deb3ec6SMatthias Ringwald /// 916f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 9173deb3ec6SMatthias Ringwald // 918f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 919f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 9209c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 9215cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 9223deb3ec6SMatthias Ringwald } 9233deb3ec6SMatthias Ringwald 9245cf1669fSMatthias 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, 925045d700dSDavid Lechner uint16_t properties, const uint8_t * uuid128){ 9263deb3ec6SMatthias Ringwald // @format HY 9273deb3ec6SMatthias Ringwald uint8_t packet[28]; 9285611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 9294ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 9305cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 9313deb3ec6SMatthias Ringwald /// 932f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_handle); 933f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 934f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 935f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 9369c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 9375cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 9383deb3ec6SMatthias Ringwald } 9393deb3ec6SMatthias Ringwald 9403deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 941045d700dSDavid Lechner gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 9423deb3ec6SMatthias Ringwald // @format HZ 9433deb3ec6SMatthias Ringwald uint8_t packet[22]; 9445611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 9454ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 9465cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 9473deb3ec6SMatthias Ringwald /// 948f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 9499c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 9505cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 9513deb3ec6SMatthias Ringwald } 9523deb3ec6SMatthias Ringwald 9535cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 9548f37572aSJakob Krantz // @format H2 9558f37572aSJakob Krantz uint8_t packet[6]; 9568f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 9574ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 9585cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 9598f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 9605cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 9615cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 9628f37572aSJakob Krantz } 96323d583b8SMatthias Ringwald 96423d583b8SMatthias Ringwald // helper 96523d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) { 966052dc82aSMatthias Ringwald gatt_client->state = P_READY; 96723d583b8SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 96823d583b8SMatthias Ringwald emit_gatt_complete_event(gatt_client, att_status); 96923d583b8SMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 97023d583b8SMatthias Ringwald } 97123d583b8SMatthias Ringwald 97223d583b8SMatthias Ringwald // @return packet pointer 97323d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 97423d583b8SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 8 97523d583b8SMatthias 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){ 97623d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 97723d583b8SMatthias Ringwald // copy value into test packet for testing 97823d583b8SMatthias Ringwald static uint8_t packet[1000]; 97923d583b8SMatthias Ringwald memcpy(&packet[8], value, length); 98023d583b8SMatthias Ringwald #else 98123d583b8SMatthias Ringwald // before the value inside the ATT PDU 98223d583b8SMatthias Ringwald uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 98323d583b8SMatthias Ringwald #endif 98423d583b8SMatthias Ringwald packet[0] = type; 98523d583b8SMatthias Ringwald packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 98623d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 98723d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 98823d583b8SMatthias Ringwald little_endian_store_16(packet, 6, length); 98923d583b8SMatthias Ringwald return packet; 99023d583b8SMatthias Ringwald } 99123d583b8SMatthias Ringwald 99223d583b8SMatthias Ringwald // @return packet pointer 99323d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 99423d583b8SMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 10 99523d583b8SMatthias 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){ 99623d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 99723d583b8SMatthias Ringwald // avoid using pre ATT headers. 99823d583b8SMatthias Ringwald return NULL; 99923d583b8SMatthias Ringwald #endif 100023d583b8SMatthias 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) 100123d583b8SMatthias Ringwald // before the value inside the ATT PDU 100223d583b8SMatthias Ringwald uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 100323d583b8SMatthias Ringwald packet[0] = type; 100423d583b8SMatthias Ringwald packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 100523d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 100623d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 100723d583b8SMatthias Ringwald little_endian_store_16(packet, 6, offset); 100823d583b8SMatthias Ringwald little_endian_store_16(packet, 8, length); 100923d583b8SMatthias Ringwald return packet; 101023d583b8SMatthias Ringwald #else 101123d583b8SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 101223d583b8SMatthias Ringwald return NULL; 101323d583b8SMatthias Ringwald #endif 101423d583b8SMatthias Ringwald } 101523d583b8SMatthias Ringwald 1016f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE) 1017f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 1018f7a42e72SMatthias Ringwald #else 1019f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 1020f7a42e72SMatthias Ringwald #endif 1021f7a42e72SMatthias Ringwald 10228f37572aSJakob Krantz /// 10235cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 102439ac9711SMatthias Ringwald if (size < 2) return; 10253deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 10264ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 10273deb3ec6SMatthias Ringwald 10283deb3ec6SMatthias Ringwald int i; 102939ac9711SMatthias Ringwald for (i = 2; (i+attr_length) <= size; i += attr_length){ 1030f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 1031f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 10323deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 10333deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 10343deb3ec6SMatthias Ringwald 10354ea43905SMatthias Ringwald if (uuid_length == 2u){ 1036f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 1037e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 103839ac9711SMatthias Ringwald } else if (uuid_length == 16u) { 10399c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 104039ac9711SMatthias Ringwald } else { 104139ac9711SMatthias Ringwald return; 10423deb3ec6SMatthias Ringwald } 10435cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 10443deb3ec6SMatthias Ringwald } 10453deb3ec6SMatthias Ringwald } 10463deb3ec6SMatthias Ringwald 104723d583b8SMatthias 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){ 10483deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 10493deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 10504ea43905SMatthias Ringwald if (uuid_length == 2u){ 1051f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 1052e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 10534ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 10549c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 1055d73c9dbeSMilanka Ringwald } else { 1056d73c9dbeSMilanka Ringwald return; 10573deb3ec6SMatthias Ringwald } 10583deb3ec6SMatthias Ringwald 10595cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 10603deb3ec6SMatthias Ringwald 10615cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 10625cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 10635cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 10643deb3ec6SMatthias Ringwald 10655cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 10663deb3ec6SMatthias Ringwald 10675cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 10685cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 10693deb3ec6SMatthias Ringwald } 10703deb3ec6SMatthias Ringwald 107123d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 10723deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 10733deb3ec6SMatthias Ringwald 10745cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 10753deb3ec6SMatthias Ringwald 10765cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 10775cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 10783deb3ec6SMatthias Ringwald 10795cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 10803deb3ec6SMatthias Ringwald } 10813deb3ec6SMatthias Ringwald 108223d583b8SMatthias Ringwald 10835cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 10844ea43905SMatthias Ringwald if (size < 2u) return; 10853deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 10864ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 10874ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 10883deb3ec6SMatthias Ringwald int i; 10894ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 1090f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 10913deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 1092f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 109323d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, start_handle - 1u); 109423d583b8SMatthias Ringwald report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], 109523d583b8SMatthias Ringwald uuid_length); 10963deb3ec6SMatthias Ringwald } 10973deb3ec6SMatthias Ringwald } 10983deb3ec6SMatthias Ringwald 10995cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 11003deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 1101e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 11025cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 11035cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 11043deb3ec6SMatthias Ringwald } 11053deb3ec6SMatthias Ringwald 1106045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){ 11075cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 11085cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 11093deb3ec6SMatthias Ringwald } 11103deb3ec6SMatthias Ringwald 11113deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11120fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 11130fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 11140fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, gatt_client->con_handle, value_handle, value, length); 111523d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 11163deb3ec6SMatthias Ringwald } 11173deb3ec6SMatthias Ringwald 11183deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11190fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 11200fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 11210fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, gatt_client->con_handle, value_handle, value, length); 112223d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 11233deb3ec6SMatthias Ringwald } 11243deb3ec6SMatthias Ringwald 11253deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11265cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 11275cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 112823d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 11293deb3ec6SMatthias Ringwald } 11303deb3ec6SMatthias Ringwald 11313deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11325cf1669fSMatthias 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){ 11335cf1669fSMatthias 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); 11343deb3ec6SMatthias Ringwald if (!packet) return; 113523d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 11363deb3ec6SMatthias Ringwald } 11373deb3ec6SMatthias Ringwald 11385cf1669fSMatthias 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){ 11399ec2630cSMatthias Ringwald UNUSED(value_offset); 11405cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 11415cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 11423deb3ec6SMatthias Ringwald } 11433deb3ec6SMatthias Ringwald 11445cf1669fSMatthias 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){ 11455cf1669fSMatthias 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); 11463deb3ec6SMatthias Ringwald if (!packet) return; 114723d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 11483deb3ec6SMatthias Ringwald } 11493deb3ec6SMatthias Ringwald 11505cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 11513deb3ec6SMatthias Ringwald int i; 11524ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 1153f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 11543deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 11553deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 11564ea43905SMatthias Ringwald if (pair_size == 4u){ 1157f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 1158e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 11593deb3ec6SMatthias Ringwald } else { 11609c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 11613deb3ec6SMatthias Ringwald } 11625cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 11633deb3ec6SMatthias Ringwald } 11643deb3ec6SMatthias Ringwald 11653deb3ec6SMatthias Ringwald } 11663deb3ec6SMatthias Ringwald 116752377058SMatthias Ringwald static bool is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 11685cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 11693deb3ec6SMatthias Ringwald } 11703deb3ec6SMatthias Ringwald 11715cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 11725cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 1173526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 11743deb3ec6SMatthias Ringwald return; 11753deb3ec6SMatthias Ringwald } 11763deb3ec6SMatthias Ringwald // next 11775cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 1178052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 11793deb3ec6SMatthias Ringwald } 11803deb3ec6SMatthias Ringwald 11815cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 11825cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 11833deb3ec6SMatthias Ringwald } 11843deb3ec6SMatthias Ringwald 11855cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 11865cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 11873deb3ec6SMatthias Ringwald } 11883deb3ec6SMatthias Ringwald 11895cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 11905cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 11913deb3ec6SMatthias Ringwald } 11923deb3ec6SMatthias Ringwald 11935cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 11945cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 11953deb3ec6SMatthias Ringwald // report last characteristic 119623d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 11973deb3ec6SMatthias Ringwald } 11985cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 11993deb3ec6SMatthias Ringwald } 12003deb3ec6SMatthias Ringwald 12015cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12025cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 12033deb3ec6SMatthias Ringwald } 12043deb3ec6SMatthias Ringwald 12055cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12065cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 12073deb3ec6SMatthias Ringwald } 12083deb3ec6SMatthias Ringwald 12095cf1669fSMatthias 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){ 12105cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 12115cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 12123deb3ec6SMatthias Ringwald 12134ea43905SMatthias Ringwald if (next_blob_length == 0u){ 1214052dc82aSMatthias Ringwald gatt_client->state = done_state; 12153deb3ec6SMatthias Ringwald return; 12163deb3ec6SMatthias Ringwald } 1217052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 12183deb3ec6SMatthias Ringwald } 12193deb3ec6SMatthias Ringwald 12205cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 12213deb3ec6SMatthias Ringwald 1222dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 12233deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 1224526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 12253deb3ec6SMatthias Ringwald return; 12263deb3ec6SMatthias Ringwald } 12273deb3ec6SMatthias Ringwald 12285cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 1229052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 12303deb3ec6SMatthias Ringwald } 12313deb3ec6SMatthias Ringwald 123223d583b8SMatthias 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){ 123323d583b8SMatthias Ringwald notification->callback = callback; 123423d583b8SMatthias Ringwald notification->con_handle = con_handle; 123523d583b8SMatthias Ringwald if (characteristic == NULL){ 123623d583b8SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 123723d583b8SMatthias Ringwald } else { 123823d583b8SMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 123923d583b8SMatthias Ringwald } 124023d583b8SMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 124123d583b8SMatthias Ringwald } 124223d583b8SMatthias Ringwald 124323d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 124423d583b8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 124523d583b8SMatthias Ringwald } 12463deb3ec6SMatthias Ringwald 124762f7b41dSMatthias Ringwald static bool is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 1248f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 1249f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 12503deb3ec6SMatthias Ringwald 125162f7b41dSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return false; 125262f7b41dSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return false; 12535cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 12543deb3ec6SMatthias Ringwald } 12553deb3ec6SMatthias Ringwald 12560038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 125792a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) { 125892a7335eSMatthias Ringwald sm_key_t csrk; 125992a7335eSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 126092a7335eSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 1261052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_RESULT; 126292a7335eSMatthias 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); 126392a7335eSMatthias Ringwald } 12640038504eSMatthias Ringwald #endif 126592a7335eSMatthias Ringwald 126692a7335eSMatthias Ringwald // returns true if packet was sent 12671979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 12683deb3ec6SMatthias Ringwald 1269e4d159baSMatthias Ringwald // wait until re-encryption is complete 12701979f09cSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 1271d1e1a57fSMatthias Ringwald 1272e4d159baSMatthias Ringwald // wait until re-encryption is complete 12731979f09cSMatthias Ringwald if (gatt_client->reencryption_active) return false; 12746c124bc2SMatthias Ringwald 127511279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 12761979f09cSMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return false; 127711279da7SMatthias Ringwald 1278052dc82aSMatthias Ringwald bool client_request_pending = gatt_client->state != P_READY; 1279fd14b205SMatthias Ringwald 12801aa9e3e8SMatthias Ringwald // verify security level for Mandatory Authentication over LE 128146012949SMatthias Ringwald bool check_security; 128246012949SMatthias Ringwald switch (gatt_client->bearer_type){ 128346012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 128446012949SMatthias Ringwald check_security = true; 128546012949SMatthias Ringwald break; 128646012949SMatthias Ringwald default: 12879ced96e1SMatthias Ringwald check_security = false; 128846012949SMatthias Ringwald break; 12899ced96e1SMatthias Ringwald } 12909ced96e1SMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){ 12911dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 12922197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 129311279da7SMatthias Ringwald // set att error code for pairing failure based on required level 129411279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 129511279da7SMatthias Ringwald case LEVEL_4: 129611279da7SMatthias Ringwald case LEVEL_3: 129711279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 129811279da7SMatthias Ringwald break; 129911279da7SMatthias Ringwald default: 130011279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 130111279da7SMatthias Ringwald break; 130211279da7SMatthias Ringwald } 130311279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 130411279da7SMatthias Ringwald // sm probably just sent a pdu 13051979f09cSMatthias Ringwald return true; 130611279da7SMatthias Ringwald } 1307f4b33574SMatthias Ringwald 13085cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 1309544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 13105cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 13116e7b444cSMatthias Ringwald att_exchange_mtu_request(gatt_client); 13121979f09cSMatthias Ringwald return true; 13133deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 13141979f09cSMatthias Ringwald return false; 13153deb3ec6SMatthias Ringwald default: 13163deb3ec6SMatthias Ringwald break; 13173deb3ec6SMatthias Ringwald } 13183deb3ec6SMatthias Ringwald 13195cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 132052377058SMatthias Ringwald gatt_client->send_confirmation = false; 13216e7b444cSMatthias Ringwald att_confirmation(gatt_client); 13221979f09cSMatthias Ringwald return true; 13233deb3ec6SMatthias Ringwald } 13243deb3ec6SMatthias Ringwald 13253deb3ec6SMatthias Ringwald // check MTU for writes 1326052dc82aSMatthias Ringwald switch (gatt_client->state){ 13273deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 13283deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1329dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 1330dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 1331526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 13321979f09cSMatthias Ringwald return false; 13333deb3ec6SMatthias Ringwald default: 13343deb3ec6SMatthias Ringwald break; 13353deb3ec6SMatthias Ringwald } 13363deb3ec6SMatthias Ringwald 13370038504eSMatthias Ringwald bool packet_sent = true; 13380038504eSMatthias Ringwald bool done = true; 1339052dc82aSMatthias Ringwald switch (gatt_client->state){ 13403deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 1341052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_QUERY_RESULT; 13425cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 13430038504eSMatthias Ringwald break; 13443deb3ec6SMatthias Ringwald 13453deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 1346052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_WITH_UUID_RESULT; 13475cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 13480038504eSMatthias Ringwald break; 13493deb3ec6SMatthias Ringwald 13503deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 1351052dc82aSMatthias Ringwald gatt_client->state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 13525cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 13530038504eSMatthias Ringwald break; 13543deb3ec6SMatthias Ringwald 13553deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 1356052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 13575cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 13580038504eSMatthias Ringwald break; 13593deb3ec6SMatthias Ringwald 13603deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 1361052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 13625cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 13630038504eSMatthias Ringwald break; 13643deb3ec6SMatthias Ringwald 13653deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 1366052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 13675cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 13680038504eSMatthias Ringwald break; 13693deb3ec6SMatthias Ringwald 13703deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 1371052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 13725cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 13730038504eSMatthias Ringwald break; 13743deb3ec6SMatthias Ringwald 13753deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 1376052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 13775cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 13780038504eSMatthias Ringwald break; 13793deb3ec6SMatthias Ringwald 13803deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 1381052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_RESULT; 13825cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 13830038504eSMatthias Ringwald break; 13843deb3ec6SMatthias Ringwald 13853deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 1386052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BY_TYPE_RESPONSE; 13875cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 13880038504eSMatthias Ringwald break; 13893deb3ec6SMatthias Ringwald 13903deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 1391052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_RESPONSE; 13925cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 13930038504eSMatthias Ringwald break; 13943deb3ec6SMatthias Ringwald 1395f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1396f125a8efSMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST: 1397052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE; 1398f125a8efSMatthias Ringwald send_gatt_read_multiple_variable_request(gatt_client); 1399f125a8efSMatthias Ringwald break; 1400f125a8efSMatthias Ringwald #endif 1401f125a8efSMatthias Ringwald 14023deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 1403052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 14045cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 14050038504eSMatthias Ringwald break; 14063deb3ec6SMatthias Ringwald 14073deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 1408052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_RESULT; 14095cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 14100038504eSMatthias Ringwald break; 14113deb3ec6SMatthias Ringwald 14123deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 1413052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 14145cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 14150038504eSMatthias Ringwald break; 14163deb3ec6SMatthias Ringwald 14173deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 1418052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 14195cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 14200038504eSMatthias Ringwald break; 14213deb3ec6SMatthias Ringwald 14223deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 1423052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 14245cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 14250038504eSMatthias Ringwald break; 14263deb3ec6SMatthias Ringwald 14273deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 1428052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 14295cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 14300038504eSMatthias Ringwald break; 14313deb3ec6SMatthias Ringwald 14323deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 1433052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 14345cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 14350038504eSMatthias Ringwald break; 14363deb3ec6SMatthias Ringwald 1437abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1438abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1439abdc9fb5SMatthias Ringwald // use Find Information 14405cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 14415cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1442abdc9fb5SMatthias Ringwald #else 14433deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1444abdc9fb5SMatthias Ringwald // Use Read By Type 1445052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 14465cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1447abdc9fb5SMatthias Ringwald #endif 14480038504eSMatthias Ringwald break; 14493deb3ec6SMatthias Ringwald 14503deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 1451052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 14525cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 14530038504eSMatthias Ringwald break; 14543deb3ec6SMatthias Ringwald 14553deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 1456052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 14575cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 14580038504eSMatthias Ringwald break; 14593deb3ec6SMatthias Ringwald 14603deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1461052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 14625cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 14630038504eSMatthias Ringwald break; 14643deb3ec6SMatthias Ringwald 14653deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 1466052dc82aSMatthias Ringwald gatt_client->state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 14675cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 14680038504eSMatthias Ringwald break; 14693deb3ec6SMatthias Ringwald 14703deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 1471052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 14725cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 14730038504eSMatthias Ringwald break; 14743deb3ec6SMatthias Ringwald 14753deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 1476052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 14775cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 14780038504eSMatthias Ringwald break; 14793deb3ec6SMatthias Ringwald 14807a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1481793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 14825cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 14835cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1484793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 14855cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 1486052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_READY; 148792a7335eSMatthias Ringwald if (sm_cmac_ready()){ 148892a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 148992a7335eSMatthias Ringwald } 1490793cf6ceSMatthias Ringwald break; 1491793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1492526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 149392a7335eSMatthias Ringwald break; 1494793cf6ceSMatthias Ringwald default: 149592a7335eSMatthias Ringwald break; 1496793cf6ceSMatthias Ringwald } 14970038504eSMatthias Ringwald packet_sent = false; 14980038504eSMatthias Ringwald break; 1499793cf6ceSMatthias Ringwald 15003deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 15013deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 150292a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 15033deb3ec6SMatthias Ringwald } 15040038504eSMatthias Ringwald packet_sent = false; 15050038504eSMatthias Ringwald break; 15063deb3ec6SMatthias Ringwald 15073deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 15084c7c987fSMatthias Ringwald gatt_client->state = P_W4_SEND_SIGNED_WRITE_DONE; 15093deb3ec6SMatthias Ringwald // bump local signing counter 15105cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 15115cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 151264b12680SMatthias Ringwald // send signed write command 15135cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 15143deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1515526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1516b68ac7a5SMatthias Ringwald break; 15173deb3ec6SMatthias Ringwald } 15187a766ebfSMatthias Ringwald #endif 15193deb3ec6SMatthias Ringwald default: 1520b68ac7a5SMatthias Ringwald done = false; 15213deb3ec6SMatthias Ringwald break; 15223deb3ec6SMatthias Ringwald } 152347181045SMatthias Ringwald 15240038504eSMatthias Ringwald if (done){ 15250038504eSMatthias Ringwald return packet_sent; 15260038504eSMatthias Ringwald } 15270038504eSMatthias Ringwald 152859d34cd2SMatthias Ringwald // write without response callback 152959d34cd2SMatthias Ringwald btstack_context_callback_registration_t * callback = 153059d34cd2SMatthias Ringwald (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests); 153159d34cd2SMatthias Ringwald if (callback != NULL){ 153259d34cd2SMatthias Ringwald (*callback->callback)(callback->context); 153359d34cd2SMatthias Ringwald return true; 153459d34cd2SMatthias Ringwald } 153559d34cd2SMatthias Ringwald 153659d34cd2SMatthias Ringwald // requested can send now old 1537f688bdb8SMatthias Ringwald if (gatt_client->write_without_response_callback != NULL){ 15385cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 15395cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 154047181045SMatthias Ringwald uint8_t event[4]; 154147181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 15424ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 15435cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 15445cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 15451979f09cSMatthias Ringwald return true; // to trigger requeueing (even if higher layer didn't sent) 154647181045SMatthias Ringwald } 154747181045SMatthias Ringwald 15481979f09cSMatthias Ringwald return false; 15493deb3ec6SMatthias Ringwald } 15503deb3ec6SMatthias Ringwald 1551544128c3SMatthias Ringwald static void gatt_client_run(void){ 1552544128c3SMatthias Ringwald btstack_linked_item_t *it; 1553109c2548SMatthias Ringwald bool packet_sent; 15547627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 15557627a0deSMatthias Ringwald btstack_linked_list_iterator_t it_eatt; 15567627a0deSMatthias Ringwald #endif 1557a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 15585cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 155946012949SMatthias Ringwald switch (gatt_client->bearer_type){ 156046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 15617627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 15627627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients); 15637627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it_eatt)) { 15647627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt); 1565052dc82aSMatthias Ringwald if (eatt_client->state != P_READY){ 15664c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle)){ 15677627a0deSMatthias Ringwald gatt_client_run_for_gatt_client(eatt_client); 15687627a0deSMatthias Ringwald } 15697627a0deSMatthias Ringwald } 15707627a0deSMatthias Ringwald } 15717627a0deSMatthias Ringwald #endif 157246012949SMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 157346012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 157446012949SMatthias Ringwald return; 157546012949SMatthias Ringwald } 1576109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 157746012949SMatthias Ringwald if (packet_sent){ 157846012949SMatthias Ringwald // request new permission 157946012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 158046012949SMatthias Ringwald // requeue client for fairness and exit 158146012949SMatthias Ringwald // note: iterator has become invalid 158246012949SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 158346012949SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 158446012949SMatthias Ringwald return; 158546012949SMatthias Ringwald } 158646012949SMatthias Ringwald break; 15871450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 158846012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 15891450cdc6SMatthias Ringwald if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) { 15901450cdc6SMatthias Ringwald continue; 15911450cdc6SMatthias Ringwald } 15921aa9e3e8SMatthias Ringwald 15931aa9e3e8SMatthias Ringwald // handle GATT over BR/EDR 15944c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle) == false) { 15954c226876SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 15961aa9e3e8SMatthias Ringwald return; 15971aa9e3e8SMatthias Ringwald } 1598109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 15991aa9e3e8SMatthias Ringwald if (packet_sent){ 16001aa9e3e8SMatthias Ringwald // request new permission 16011aa9e3e8SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 16021aa9e3e8SMatthias Ringwald // requeue client for fairness and exit 16031aa9e3e8SMatthias Ringwald // note: iterator has become invalid 16041aa9e3e8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 16051aa9e3e8SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 16061aa9e3e8SMatthias Ringwald return; 16071aa9e3e8SMatthias Ringwald } 160846012949SMatthias Ringwald break; 16091450cdc6SMatthias Ringwald #endif 161046012949SMatthias Ringwald default: 161146012949SMatthias Ringwald btstack_unreachable(); 161246012949SMatthias Ringwald break; 1613544128c3SMatthias Ringwald } 161446012949SMatthias Ringwald 161546012949SMatthias Ringwald 1616544128c3SMatthias Ringwald } 16173deb3ec6SMatthias Ringwald } 16183deb3ec6SMatthias Ringwald 1619544a5845SMatthias Ringwald // emit complete event, used to avoid emitting event from API call 1620544a5845SMatthias Ringwald static void gatt_client_emit_events(void * context){ 1621544a5845SMatthias Ringwald UNUSED(context); 1622544a5845SMatthias Ringwald btstack_linked_item_t *it; 1623544a5845SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next) { 1624544a5845SMatthias Ringwald gatt_client_t *gatt_client = (gatt_client_t *) it; 1625544a5845SMatthias Ringwald if (gatt_client->state == P_W2_EMIT_QUERY_COMPLETE_EVENT){ 1626544a5845SMatthias Ringwald gatt_client->state = P_READY; 1627544a5845SMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 1628544a5845SMatthias Ringwald } 1629544a5845SMatthias Ringwald } 1630544a5845SMatthias Ringwald } 1631544a5845SMatthias Ringwald 16325cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 1633643a64fcSMatthias Ringwald if (is_ready(gatt_client)) return; 1634526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_error_code); 16353deb3ec6SMatthias Ringwald } 16363deb3ec6SMatthias Ringwald 163778c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){ 163878c4542aSMatthias Ringwald hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet); 163978c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 164078c4542aSMatthias Ringwald if (gatt_client == NULL) return; 164178c4542aSMatthias Ringwald 164278c4542aSMatthias Ringwald // update security level 164378c4542aSMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 164478c4542aSMatthias Ringwald 164578c4542aSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 164678c4542aSMatthias Ringwald gatt_client->reencryption_active = false; 16472197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 164878c4542aSMatthias Ringwald 1649052dc82aSMatthias Ringwald if (gatt_client->state == P_READY) return; 165078c4542aSMatthias Ringwald 165178c4542aSMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 165278c4542aSMatthias Ringwald case ERROR_CODE_SUCCESS: 165378c4542aSMatthias Ringwald log_info("re-encryption success, retry operation"); 165478c4542aSMatthias Ringwald break; 165578c4542aSMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 165678c4542aSMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 165778c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 165878c4542aSMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 165978c4542aSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 166078c4542aSMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 166178c4542aSMatthias Ringwald // delete bonding information 166278c4542aSMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 166378c4542aSMatthias Ringwald btstack_assert(le_device_db_index >= 0); 166478c4542aSMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 166578c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 166678c4542aSMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 166778c4542aSMatthias Ringwald #endif 166878c4542aSMatthias Ringwald le_device_db_remove(le_device_db_index); 166978c4542aSMatthias Ringwald // trigger pairing again 167078c4542aSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 167178c4542aSMatthias Ringwald break; 167278c4542aSMatthias Ringwald } 167378c4542aSMatthias Ringwald #endif 167478c4542aSMatthias Ringwald // report bonding information missing 1675526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 167678c4542aSMatthias Ringwald break; 167778c4542aSMatthias Ringwald default: 167878c4542aSMatthias Ringwald // report bonding information missing 1679526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code); 168078c4542aSMatthias Ringwald break; 168178c4542aSMatthias Ringwald } 168278c4542aSMatthias Ringwald } 168378c4542aSMatthias Ringwald 168478c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){ 168578c4542aSMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 168678c4542aSMatthias Ringwald hci_con_handle_t con_handle = little_endian_read_16(packet,3); 168778c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 168878c4542aSMatthias Ringwald if (gatt_client == NULL) return; 168978c4542aSMatthias Ringwald 169078c4542aSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 169178c4542aSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 169278c4542aSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 169378c4542aSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 169478c4542aSMatthias Ringwald } 169578c4542aSMatthias Ringwald 1696f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 16971ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 16981ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 16999ec2630cSMatthias Ringwald 1700361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1701361b1363SMatthias Ringwald 1702f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 17035cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 17040e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 17053deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 170678c4542aSMatthias Ringwald gatt_client_handle_disconnection_complete(packet); 17073deb3ec6SMatthias Ringwald break; 1708f4b33574SMatthias Ringwald 1709f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1710f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1711f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 17125cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 17135cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1714f4b33574SMatthias Ringwald 17151dfae9c7SMatthias Ringwald // update security level 17161dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 17171dfae9c7SMatthias Ringwald 17183503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 17192197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 1720f688bdb8SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet) != ERROR_CODE_SUCCESS){ 17215cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1722ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1723f4b33574SMatthias Ringwald } else { 1724f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 17253deb3ec6SMatthias Ringwald } 1726f4b33574SMatthias Ringwald } 1727f4b33574SMatthias Ringwald break; 172811279da7SMatthias Ringwald 1729793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1730793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1731793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1732793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1733793cf6ceSMatthias Ringwald break; 1734793cf6ceSMatthias Ringwald #endif 1735a95ca902SMatthias Ringwald 17368918bbdaSMatthias Ringwald // re-encryption started 17378918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 17388918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 17398918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 17408918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 17418918bbdaSMatthias Ringwald 17428918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 17438918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 17448918bbdaSMatthias Ringwald break; 17458918bbdaSMatthias Ringwald 1746ec9babacSMatthias Ringwald // re-encryption complete 1747ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 174878c4542aSMatthias Ringwald gatt_client_handle_reencryption_complete(packet); 1749ec9babacSMatthias Ringwald break; 17503deb3ec6SMatthias Ringwald default: 17513deb3ec6SMatthias Ringwald break; 17523deb3ec6SMatthias Ringwald } 17533deb3ec6SMatthias Ringwald 1754361b1363SMatthias Ringwald gatt_client_run(); 17553deb3ec6SMatthias Ringwald } 17563deb3ec6SMatthias Ringwald 17572da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1758052dc82aSMatthias Ringwald switch (gatt_client->state) { 17592da0d963SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: 17602da0d963SMatthias Ringwald if (size >= 17) { 17612da0d963SMatthias Ringwald uint8_t uuid128[16]; 17622da0d963SMatthias Ringwald reverse_128(&packet[1], uuid128); 17632da0d963SMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 17642da0d963SMatthias Ringwald } 17652da0d963SMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 17665611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 17673deb3ec6SMatthias Ringwald break; 17682da0d963SMatthias Ringwald 17692da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 17702da0d963SMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1771526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17722da0d963SMatthias Ringwald break; 17732da0d963SMatthias Ringwald 17742da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 17752da0d963SMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 17762da0d963SMatthias Ringwald size - 1u, 0u); 1777526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17782da0d963SMatthias Ringwald break; 17792da0d963SMatthias Ringwald 17802da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic 17812da0d963SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 17822da0d963SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 17832da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 17842da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u); 17852da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 17862da0d963SMatthias Ringwald break; 17872da0d963SMatthias Ringwald 17882da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor 17892da0d963SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 17902da0d963SMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 17912da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 17922da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 17932da0d963SMatthias Ringwald size - 1u); 17942da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 17952da0d963SMatthias Ringwald break; 17962da0d963SMatthias Ringwald 17973deb3ec6SMatthias Ringwald default: 17983deb3ec6SMatthias Ringwald break; 17993deb3ec6SMatthias Ringwald } 18002da0d963SMatthias Ringwald } 18013deb3ec6SMatthias Ringwald 18022da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1803052dc82aSMatthias Ringwald switch (gatt_client->state) { 18043deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 18055cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1806cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1807cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 18085611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 18093deb3ec6SMatthias Ringwald break; 18103deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 18115cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1812cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1813cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 18145611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 18153deb3ec6SMatthias Ringwald break; 1816cf8e5718SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: { 18174ea43905SMatthias Ringwald if (size < 2u) break; 18183deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 18193deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 18203deb3ec6SMatthias Ringwald 18214ea43905SMatthias Ringwald if (pair_size == 6u) { 18224ea43905SMatthias Ringwald if (size < 8u) break; 18233deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 18245cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 18255cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 18265cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 1827052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 18283deb3ec6SMatthias Ringwald break; 18293deb3ec6SMatthias Ringwald } 18303deb3ec6SMatthias Ringwald 18314ea43905SMatthias Ringwald if (pair_size != 8u) break; 18329f698c82SMatthias Ringwald 18339f698c82SMatthias Ringwald // UUIDs included, report all of them 18343deb3ec6SMatthias Ringwald uint16_t offset; 18354ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size) { 1836f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 18375cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 18385cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 18394ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset + 6u); 18405cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 18413deb3ec6SMatthias Ringwald } 18423deb3ec6SMatthias Ringwald 1843cf8e5718SMatthias Ringwald trigger_next_included_service_query(gatt_client, 1844cf8e5718SMatthias Ringwald get_last_result_handle_from_included_services_list(packet, 1845cf8e5718SMatthias Ringwald size)); 18465611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18473deb3ec6SMatthias Ringwald break; 18483deb3ec6SMatthias Ringwald } 1849abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 18503deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 18515cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 1852052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 18533deb3ec6SMatthias Ringwald break; 1854abdc9fb5SMatthias Ringwald #endif 18553deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 18563deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 185739ac9711SMatthias Ringwald // set last result handle to last valid handle, only used if pair_size invalid 185839ac9711SMatthias Ringwald uint16_t last_result_handle = 0xffff; 185939ac9711SMatthias Ringwald if (pair_size > 2) { 18603deb3ec6SMatthias Ringwald uint16_t offset; 18613deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size) { 1862f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1863cf8e5718SMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], 1864cf8e5718SMatthias Ringwald pair_size - 2u); 18653deb3ec6SMatthias Ringwald last_result_handle = value_handle; 18663deb3ec6SMatthias Ringwald } 186739ac9711SMatthias Ringwald } 18685cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 18693deb3ec6SMatthias Ringwald break; 18703deb3ec6SMatthias Ringwald } 18713deb3ec6SMatthias Ringwald default: 18723deb3ec6SMatthias Ringwald break; 18733deb3ec6SMatthias Ringwald } 187439ac9711SMatthias Ringwald } 1875dc13fd8dSMatthias Ringwald 18762da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) { 1877052dc82aSMatthias Ringwald switch (gatt_client->state) { 18782da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1879526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 18803deb3ec6SMatthias Ringwald break; 18812da0d963SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1882526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 18833deb3ec6SMatthias Ringwald break; 18842da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1885526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 18862da0d963SMatthias Ringwald break; 18872da0d963SMatthias Ringwald default: 18882da0d963SMatthias Ringwald break; 18892da0d963SMatthias Ringwald } 18902da0d963SMatthias Ringwald } 1891dc13fd8dSMatthias Ringwald 18922da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) { 18934740230fSMatthias Ringwald uint8_t att_status; 18942da0d963SMatthias Ringwald switch (packet[0]) { 18952da0d963SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: { 18962da0d963SMatthias Ringwald if (size < 3u) break; 189746012949SMatthias Ringwald bool update_gatt_server_att_mtu = false; 18982da0d963SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 18992da0d963SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 190046012949SMatthias Ringwald switch (gatt_client->bearer_type){ 190146012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 190246012949SMatthias Ringwald update_gatt_server_att_mtu = true; 190346012949SMatthias Ringwald break; 19042da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 190546012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 19062da0d963SMatthias Ringwald local_rx_mtu = gatt_client->mtu; 190746012949SMatthias Ringwald break; 19082da0d963SMatthias Ringwald #endif 190946012949SMatthias Ringwald default: 191046012949SMatthias Ringwald btstack_unreachable(); 191146012949SMatthias Ringwald break; 191246012949SMatthias Ringwald } 191346012949SMatthias Ringwald 19142da0d963SMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 19152da0d963SMatthias Ringwald 19162da0d963SMatthias Ringwald // set gatt client mtu 19172da0d963SMatthias Ringwald gatt_client->mtu = mtu; 19182da0d963SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 19192da0d963SMatthias Ringwald 192046012949SMatthias Ringwald if (update_gatt_server_att_mtu){ 19212da0d963SMatthias Ringwald // set per connection mtu state - for fixed channel 19222da0d963SMatthias Ringwald hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle); 19232da0d963SMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 19242da0d963SMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 19252da0d963SMatthias Ringwald } 19262da0d963SMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 19272da0d963SMatthias Ringwald break; 19282da0d963SMatthias Ringwald } 19292da0d963SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 1930052dc82aSMatthias Ringwald switch (gatt_client->state) { 19312da0d963SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 19322da0d963SMatthias Ringwald report_gatt_services(gatt_client, packet, size); 19332da0d963SMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 193430952227SMilanka Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 193530952227SMilanka Ringwald break; 19363deb3ec6SMatthias Ringwald default: 19373deb3ec6SMatthias Ringwald break; 19383deb3ec6SMatthias Ringwald } 19393deb3ec6SMatthias Ringwald break; 19402da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 19412da0d963SMatthias Ringwald if (size < 3u) return; 19422da0d963SMatthias Ringwald report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 19432da0d963SMatthias Ringwald return; 1944cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1945cbba69d5SMatthias Ringwald case ATT_MULTIPLE_HANDLE_VALUE_NTF: 1946cbba69d5SMatthias Ringwald if (size >= 5u) { 1947cbba69d5SMatthias Ringwald uint16_t offset = 1; 1948cbba69d5SMatthias Ringwald while (true){ 1949cbba69d5SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1950cbba69d5SMatthias Ringwald offset += 2; 1951cbba69d5SMatthias Ringwald uint16_t value_length = little_endian_read_16(packet, offset); 1952cbba69d5SMatthias Ringwald offset += 2; 1953cbba69d5SMatthias Ringwald if ((offset + value_length) > size) break; 1954cbba69d5SMatthias Ringwald report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length); 1955cbba69d5SMatthias Ringwald offset += value_length; 1956cbba69d5SMatthias Ringwald } 1957cbba69d5SMatthias Ringwald } 1958cbba69d5SMatthias Ringwald return; 1959cbba69d5SMatthias Ringwald #endif 19602da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 19612da0d963SMatthias Ringwald if (size < 3u) break; 19622da0d963SMatthias Ringwald report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 196352377058SMatthias Ringwald gatt_client->send_confirmation = true; 19642da0d963SMatthias Ringwald break; 19652da0d963SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 19662da0d963SMatthias Ringwald gatt_client_handle_att_read_by_type_response(gatt_client, packet, size); 19672da0d963SMatthias Ringwald break; 19682da0d963SMatthias Ringwald case ATT_READ_RESPONSE: 19692da0d963SMatthias Ringwald gatt_client_handle_att_read_response(gatt_client, packet, size); 19702da0d963SMatthias Ringwald break; 1971cf8e5718SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: { 19723deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 19733deb3ec6SMatthias Ringwald int i; 19743deb3ec6SMatthias Ringwald uint16_t start_group_handle; 19755611a760SMatthias Ringwald uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 19764ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size) { 1977f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet, i); 1978f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet, i + 2); 1979cf8e5718SMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, 1980cf8e5718SMatthias Ringwald gatt_client->uuid128); 19813deb3ec6SMatthias Ringwald } 19825cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 19835611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19843deb3ec6SMatthias Ringwald break; 19853deb3ec6SMatthias Ringwald } 1986cf8e5718SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: { 19874ea43905SMatthias Ringwald if (size < 2u) break; 1988a6121b51SMilanka Ringwald 19893deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 19904ea43905SMatthias Ringwald if (packet[1u] == 2u) { 19913deb3ec6SMatthias Ringwald pair_size = 18; 19923deb3ec6SMatthias Ringwald } 1993a6121b51SMilanka Ringwald uint16_t offset = 2; 1994a6121b51SMilanka Ringwald 1995a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1996f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1997abdc9fb5SMatthias Ringwald 1998abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 19995cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 20005cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 2001abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 2002abdc9fb5SMatthias Ringwald if (pair_size == 4){ 2003a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 2004abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 2005abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 20065cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 20075cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 20085cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 2009abdc9fb5SMatthias Ringwald break; 2010abdc9fb5SMatthias Ringwald } 2011abdc9fb5SMatthias Ringwald offset += pair_size; 2012abdc9fb5SMatthias Ringwald } 2013abdc9fb5SMatthias Ringwald } 20145cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 2015abdc9fb5SMatthias Ringwald 2016abdc9fb5SMatthias Ringwald } else { 2017abdc9fb5SMatthias Ringwald // next 20185cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 20195cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2020abdc9fb5SMatthias Ringwald } 2021abdc9fb5SMatthias Ringwald break; 2022abdc9fb5SMatthias Ringwald } 2023abdc9fb5SMatthias Ringwald #endif 20245cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 20255cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 20265611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 20273deb3ec6SMatthias Ringwald break; 20283deb3ec6SMatthias Ringwald } 20293deb3ec6SMatthias Ringwald 20303deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 20312da0d963SMatthias Ringwald gatt_client_handle_att_write_response(gatt_client); 20323deb3ec6SMatthias Ringwald break; 20333deb3ec6SMatthias Ringwald 20343deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE: { 20354ea43905SMatthias Ringwald uint16_t received_blob_length = size - 1u; 2036052dc82aSMatthias Ringwald switch (gatt_client->state) { 20373deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2038cf8e5718SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 2039cf8e5718SMatthias Ringwald received_blob_length, gatt_client->attribute_offset); 20405cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 20415611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 20423deb3ec6SMatthias Ringwald break; 20433deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 20445cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 20453deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 20465cf1669fSMatthias Ringwald gatt_client->attribute_offset); 2047cf8e5718SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 2048cf8e5718SMatthias Ringwald received_blob_length); 20495611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 20503deb3ec6SMatthias Ringwald break; 20513deb3ec6SMatthias Ringwald default: 20523deb3ec6SMatthias Ringwald break; 20533deb3ec6SMatthias Ringwald } 20543deb3ec6SMatthias Ringwald break; 20553deb3ec6SMatthias Ringwald } 20563deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 2057052dc82aSMatthias Ringwald switch (gatt_client->state) { 20583deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 20595cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 20604740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 20613deb3ec6SMatthias Ringwald } else { 20624740230fSMatthias Ringwald att_status = ATT_ERROR_DATA_MISMATCH; 20633deb3ec6SMatthias Ringwald } 2064526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 20653deb3ec6SMatthias Ringwald break; 20663deb3ec6SMatthias Ringwald 20673deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: { 20685cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 20695cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 20705611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 20713deb3ec6SMatthias Ringwald break; 20723deb3ec6SMatthias Ringwald } 20733deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: { 20745cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 2075cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, 2076cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 20775611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 20783deb3ec6SMatthias Ringwald break; 20793deb3ec6SMatthias Ringwald } 20803deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: { 20815cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 20825cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 2083cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, 2084cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE); 20855611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 20863deb3ec6SMatthias Ringwald break; 20873deb3ec6SMatthias Ringwald } 2088052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 20893deb3ec6SMatthias Ringwald break; 20903deb3ec6SMatthias Ringwald } 20913deb3ec6SMatthias Ringwald default: 20923deb3ec6SMatthias Ringwald break; 20933deb3ec6SMatthias Ringwald } 20943deb3ec6SMatthias Ringwald break; 20953deb3ec6SMatthias Ringwald 20963deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 2097052dc82aSMatthias Ringwald switch (gatt_client->state) { 20983deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2099526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21003deb3ec6SMatthias Ringwald break; 21013deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2102526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21033deb3ec6SMatthias Ringwald break; 21043deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2105526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH); 21063deb3ec6SMatthias Ringwald break; 21073deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2108526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21093deb3ec6SMatthias Ringwald break; 21103deb3ec6SMatthias Ringwald default: 21113deb3ec6SMatthias Ringwald break; 21123deb3ec6SMatthias Ringwald 21133deb3ec6SMatthias Ringwald } 21143deb3ec6SMatthias Ringwald break; 21153deb3ec6SMatthias Ringwald 21163deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 2117052dc82aSMatthias Ringwald switch (gatt_client->state) { 21183deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 21195cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 2120526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21213deb3ec6SMatthias Ringwald break; 21223deb3ec6SMatthias Ringwald default: 21233deb3ec6SMatthias Ringwald break; 21243deb3ec6SMatthias Ringwald } 21253deb3ec6SMatthias Ringwald break; 21263deb3ec6SMatthias Ringwald 2127f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2128f125a8efSMatthias Ringwald case ATT_READ_MULTIPLE_VARIABLE_RSP: 2129052dc82aSMatthias Ringwald switch (gatt_client->state) { 2130169b9876SMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2131f125a8efSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 2132f125a8efSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 2133f125a8efSMatthias Ringwald break; 2134f125a8efSMatthias Ringwald default: 2135f125a8efSMatthias Ringwald break; 2136f125a8efSMatthias Ringwald } 2137f125a8efSMatthias Ringwald break; 2138f125a8efSMatthias Ringwald #endif 2139f125a8efSMatthias Ringwald 21403deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 21414ea43905SMatthias Ringwald if (size < 5u) return; 21424740230fSMatthias Ringwald att_status = packet[4]; 21434740230fSMatthias Ringwald switch (att_status) { 21443deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 2145052dc82aSMatthias Ringwald switch (gatt_client->state) { 21463deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 21473deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 21483deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 21493deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 2150526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21513deb3ec6SMatthias Ringwald break; 21523deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 21533deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 215423d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 2155526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21563deb3ec6SMatthias Ringwald break; 21573deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 21585cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle) { 21594740230fSMatthias Ringwald att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND; 21603deb3ec6SMatthias Ringwald } else { 21614740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 21623deb3ec6SMatthias Ringwald } 2163526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 21643deb3ec6SMatthias Ringwald break; 21653deb3ec6SMatthias Ringwald default: 21664740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 21673deb3ec6SMatthias Ringwald break; 21683deb3ec6SMatthias Ringwald } 21693deb3ec6SMatthias Ringwald break; 21703deb3ec6SMatthias Ringwald } 2171f4b33574SMatthias Ringwald 2172f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 2173f4b33574SMatthias Ringwald 2174f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 2175f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 2176a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 2177a0e0c2beSMatthias Ringwald 2178f4b33574SMatthias Ringwald // security too low 21795cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 21804740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2181f4b33574SMatthias Ringwald break; 2182f4b33574SMatthias Ringwald } 2183f4b33574SMatthias Ringwald // start security 21845cf1669fSMatthias Ringwald gatt_client->security_counter++; 2185f4b33574SMatthias Ringwald 2186f4b33574SMatthias Ringwald // setup action 2187f4b33574SMatthias Ringwald int retry = 1; 2188052dc82aSMatthias Ringwald switch (gatt_client->state){ 2189f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 2190052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 2191f4b33574SMatthias Ringwald break; 2192f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2193052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 2194f4b33574SMatthias Ringwald break; 2195f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 2196052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 2197f4b33574SMatthias Ringwald break; 2198f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 2199052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_REQUEST; 2200f4b33574SMatthias Ringwald break; 2201f125a8efSMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2202052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST; 2203f125a8efSMatthias Ringwald break; 2204f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 2205052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 2206f4b33574SMatthias Ringwald break; 2207f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 2208052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 2209f4b33574SMatthias Ringwald break; 2210f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 2211052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 2212f4b33574SMatthias Ringwald break; 2213f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 2214052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 2215f4b33574SMatthias Ringwald break; 2216f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2217052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 2218f4b33574SMatthias Ringwald break; 2219f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2220052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 2221f4b33574SMatthias Ringwald break; 2222f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2223052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 2224f4b33574SMatthias Ringwald break; 2225f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 2226052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 2227f4b33574SMatthias Ringwald break; 2228f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 2229052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 2230f4b33574SMatthias Ringwald break; 2231f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2232052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 2233f4b33574SMatthias Ringwald break; 2234f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 2235052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 2236f4b33574SMatthias Ringwald break; 2237f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2238052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 2239f4b33574SMatthias Ringwald break; 2240f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2241052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 2242f4b33574SMatthias Ringwald break; 2243f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 2244f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 2245052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 2246f4b33574SMatthias Ringwald break; 2247f4b33574SMatthias Ringwald #endif 2248f4b33574SMatthias Ringwald default: 2249052dc82aSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->state); 2250f4b33574SMatthias Ringwald retry = 0; 2251f4b33574SMatthias Ringwald break; 2252f4b33574SMatthias Ringwald } 2253f4b33574SMatthias Ringwald 2254f4b33574SMatthias Ringwald if (!retry) { 22554740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2256f4b33574SMatthias Ringwald break; 2257f4b33574SMatthias Ringwald } 2258f4b33574SMatthias Ringwald 2259f4b33574SMatthias Ringwald log_info("security error, start pairing"); 2260f4b33574SMatthias Ringwald 2261f060f108SMatthias Ringwald // start pairing for higher security level 22622197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 22634740230fSMatthias Ringwald gatt_client->pending_error_code = att_status; 22645cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 2265f4b33574SMatthias Ringwald break; 2266a0e0c2beSMatthias Ringwald } 2267f4b33574SMatthias Ringwald #endif 2268f4b33574SMatthias Ringwald 2269f4b33574SMatthias Ringwald // nothing we can do about that 2270f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 22713deb3ec6SMatthias Ringwald default: 22724740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 22733deb3ec6SMatthias Ringwald break; 22743deb3ec6SMatthias Ringwald } 22753deb3ec6SMatthias Ringwald break; 22763deb3ec6SMatthias Ringwald 22773deb3ec6SMatthias Ringwald default: 22783deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 22793deb3ec6SMatthias Ringwald break; 22803deb3ec6SMatthias Ringwald } 2281cf8e5718SMatthias Ringwald } 2282cf8e5718SMatthias Ringwald 2283cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) { 2284cf8e5718SMatthias Ringwald gatt_client_t *gatt_client; 2285180cbe79SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2286b1da4983SMatthias Ringwald uint8_t status; 2287b1da4983SMatthias Ringwald hci_connection_t * hci_connection; 2288180cbe79SMatthias Ringwald hci_con_handle_t con_handle; 2289180cbe79SMatthias Ringwald #endif 2290180cbe79SMatthias Ringwald 2291cf8e5718SMatthias Ringwald if (size < 1u) return; 229259b5e157SMatthias Ringwald switch (packet_type){ 229359b5e157SMatthias Ringwald case HCI_EVENT_PACKET: 229459b5e157SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 229559b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 229659b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_OPENED: 229759b5e157SMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 229859b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet)); 2299de5a18caSMatthias Ringwald if (gatt_client != NULL){ 2300180cbe79SMatthias Ringwald con_handle = l2cap_event_channel_opened_get_handle(packet); 2301180cbe79SMatthias Ringwald hci_connection = hci_connection_for_handle(con_handle); 2302ab6f9d8fSMatthias Ringwald if (status == L2CAP_CONNECTION_RESPONSE_RESULT_REFUSED_RESOURCES){ 2303ab6f9d8fSMatthias Ringwald if ((hci_connection != NULL) && hci_connection->att_server.incoming_connection_request) { 2304180cbe79SMatthias Ringwald log_info("Collision, retry in 100ms"); 2305180cbe79SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 2306180cbe79SMatthias Ringwald // set timer for retry 2307b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 2308180cbe79SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_classic_retry); 2309180cbe79SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 2310180cbe79SMatthias Ringwald break; 2311180cbe79SMatthias Ringwald } 2312ab6f9d8fSMatthias Ringwald } 231359b5e157SMatthias Ringwald // if status != 0, gatt_client will be discarded 2314052dc82aSMatthias Ringwald gatt_client->state = P_READY; 231559b5e157SMatthias Ringwald gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet); 231659b5e157SMatthias Ringwald gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 231759b5e157SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 2318de5a18caSMatthias Ringwald } 231959b5e157SMatthias Ringwald break; 232059b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 232159b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet)); 2322de5a18caSMatthias Ringwald if (gatt_client != NULL){ 232359b5e157SMatthias Ringwald // discard gatt client object 232459b5e157SMatthias Ringwald gatt_client_classic_handle_disconnected(gatt_client); 2325de5a18caSMatthias Ringwald } 232659b5e157SMatthias Ringwald break; 232759b5e157SMatthias Ringwald #endif 2328cf8e5718SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 23293deb3ec6SMatthias Ringwald gatt_client_run(); 2330cf8e5718SMatthias Ringwald break; 2331cf8e5718SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 2332cf8e5718SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 2333cf8e5718SMatthias Ringwald if (size < 6u) break; 2334cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2335de5a18caSMatthias Ringwald if (gatt_client != NULL) { 2336cf8e5718SMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 2337de5a18caSMatthias Ringwald } 2338cf8e5718SMatthias Ringwald break; 2339cf8e5718SMatthias Ringwald default: 2340cf8e5718SMatthias Ringwald break; 2341cf8e5718SMatthias Ringwald } 234259b5e157SMatthias Ringwald break; 2343cf8e5718SMatthias Ringwald 234459b5e157SMatthias Ringwald case ATT_DATA_PACKET: 2345cf8e5718SMatthias Ringwald // special cases: notifications & indications motivate creating context 2346cf8e5718SMatthias Ringwald switch (packet[0]) { 2347cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 2348cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 2349cf8e5718SMatthias Ringwald gatt_client_provide_context_for_handle(handle, &gatt_client); 2350cf8e5718SMatthias Ringwald break; 2351cf8e5718SMatthias Ringwald default: 2352cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2353cf8e5718SMatthias Ringwald break; 2354cf8e5718SMatthias Ringwald } 2355cf8e5718SMatthias Ringwald 2356cf8e5718SMatthias Ringwald if (gatt_client != NULL) { 2357cf8e5718SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2358cf8e5718SMatthias Ringwald gatt_client_run(); 2359cf8e5718SMatthias Ringwald } 236059b5e157SMatthias Ringwald break; 236159b5e157SMatthias Ringwald 236259b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 236359b5e157SMatthias Ringwald case L2CAP_DATA_PACKET: 236459b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(handle); 2365de5a18caSMatthias Ringwald if (gatt_client != NULL){ 236659b5e157SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 236759b5e157SMatthias Ringwald gatt_client_run(); 2368de5a18caSMatthias Ringwald } 236959b5e157SMatthias Ringwald break; 237059b5e157SMatthias Ringwald #endif 237159b5e157SMatthias Ringwald 237259b5e157SMatthias Ringwald default: 237359b5e157SMatthias Ringwald break; 237459b5e157SMatthias Ringwald } 23753deb3ec6SMatthias Ringwald } 23763deb3ec6SMatthias Ringwald 23777a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 23783deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 2379665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 2380665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 2381665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 23825cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 2383052dc82aSMatthias Ringwald if (gatt_client->state == P_W4_CMAC_RESULT){ 23843deb3ec6SMatthias Ringwald // store result 23855cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 23865cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 2387052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 23883deb3ec6SMatthias Ringwald gatt_client_run(); 23893deb3ec6SMatthias Ringwald return; 23903deb3ec6SMatthias Ringwald } 23913deb3ec6SMatthias Ringwald } 23923deb3ec6SMatthias Ringwald } 23933deb3ec6SMatthias Ringwald 2394b45b7749SMilanka 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){ 239540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 239640faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 239740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 239840faeb84SMilanka Ringwald return status; 239940faeb84SMilanka Ringwald } 240040faeb84SMilanka Ringwald if (is_ready(gatt_client) == 0){ 240140faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 240240faeb84SMilanka Ringwald } 24033deb3ec6SMatthias Ringwald 24045cf1669fSMatthias Ringwald gatt_client->callback = callback; 2405b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 24065cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 24075cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 2408052dc82aSMatthias Ringwald gatt_client->state = P_W4_IDENTITY_RESOLVING; 24093deb3ec6SMatthias Ringwald gatt_client_run(); 241025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24113deb3ec6SMatthias Ringwald } 24127a766ebfSMatthias Ringwald #endif 24133deb3ec6SMatthias Ringwald 2414711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 241540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2416de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 241740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 241840faeb84SMilanka Ringwald return status; 241940faeb84SMilanka Ringwald } 24203deb3ec6SMatthias Ringwald 24215cf1669fSMatthias Ringwald gatt_client->callback = callback; 24225cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 24235cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2424052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 24258d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID; 24263deb3ec6SMatthias Ringwald gatt_client_run(); 242725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24283deb3ec6SMatthias Ringwald } 24293deb3ec6SMatthias Ringwald 24308d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 243140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2432de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 243340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 243440faeb84SMilanka Ringwald return status; 243540faeb84SMilanka Ringwald } 24368d1f34d3SMatheus Eduardo Garbelini 24378d1f34d3SMatheus Eduardo Garbelini gatt_client->callback = callback; 24388d1f34d3SMatheus Eduardo Garbelini gatt_client->start_group_handle = 0x0001; 24398d1f34d3SMatheus Eduardo Garbelini gatt_client->end_group_handle = 0xffff; 2440052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 24418d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID; 24428d1f34d3SMatheus Eduardo Garbelini gatt_client_run(); 24438d1f34d3SMatheus Eduardo Garbelini return ERROR_CODE_SUCCESS; 24448d1f34d3SMatheus Eduardo Garbelini } 24453deb3ec6SMatthias Ringwald 2446711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 244740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2448de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 244940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 245040faeb84SMilanka Ringwald return status; 245140faeb84SMilanka Ringwald } 24523deb3ec6SMatthias Ringwald 24535cf1669fSMatthias Ringwald gatt_client->callback = callback; 24545cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 24555cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2456052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 24575cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 24585cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 24593deb3ec6SMatthias Ringwald gatt_client_run(); 246025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24613deb3ec6SMatthias Ringwald } 24623deb3ec6SMatthias Ringwald 2463711e6c80SMatthias 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){ 246440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2465de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 246640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 246740faeb84SMilanka Ringwald return status; 246840faeb84SMilanka Ringwald } 24693deb3ec6SMatthias Ringwald 24705cf1669fSMatthias Ringwald gatt_client->callback = callback; 24715cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 24725cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 24735cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 24745cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2475052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 24763deb3ec6SMatthias Ringwald gatt_client_run(); 247725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24783deb3ec6SMatthias Ringwald } 24793deb3ec6SMatthias Ringwald 2480711e6c80SMatthias 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){ 248140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2482de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 248340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 248440faeb84SMilanka Ringwald return status; 248540faeb84SMilanka Ringwald } 24863deb3ec6SMatthias Ringwald 24875cf1669fSMatthias Ringwald gatt_client->callback = callback; 24885cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 24895cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2490ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = false; 24915cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2492052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 24933deb3ec6SMatthias Ringwald gatt_client_run(); 249425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24953deb3ec6SMatthias Ringwald } 24963deb3ec6SMatthias Ringwald 2497711e6c80SMatthias 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){ 249840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2499de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 250040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 250140faeb84SMilanka Ringwald return status; 250240faeb84SMilanka Ringwald } 2503de27733dSMatthias Ringwald 25045cf1669fSMatthias Ringwald gatt_client->callback = callback; 25055cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 25065cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2507052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 25083deb3ec6SMatthias Ringwald 25093deb3ec6SMatthias Ringwald gatt_client_run(); 251025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25113deb3ec6SMatthias Ringwald } 25123deb3ec6SMatthias Ringwald 2513711e6c80SMatthias 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){ 251440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2515de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 251640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 251740faeb84SMilanka Ringwald return status; 251840faeb84SMilanka Ringwald } 25193deb3ec6SMatthias Ringwald 25205cf1669fSMatthias Ringwald gatt_client->callback = callback; 25215cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 25225cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2523ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 25245cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 25255cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 25265cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2527052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 25283deb3ec6SMatthias Ringwald gatt_client_run(); 252925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25303deb3ec6SMatthias Ringwald } 25313deb3ec6SMatthias Ringwald 2532045d700dSDavid 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){ 253340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2534de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 253540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 253640faeb84SMilanka Ringwald return status; 253740faeb84SMilanka Ringwald } 25383deb3ec6SMatthias Ringwald 25395cf1669fSMatthias Ringwald gatt_client->callback = callback; 25405cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 25415cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2542ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 25435cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 25445cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 25455cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2546052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 25473deb3ec6SMatthias Ringwald gatt_client_run(); 254825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25493deb3ec6SMatthias Ringwald } 25503deb3ec6SMatthias Ringwald 25513deb3ec6SMatthias Ringwald 2552b45b7749SMilanka 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){ 2553b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16); 25543deb3ec6SMatthias Ringwald } 25553deb3ec6SMatthias Ringwald 2556b45b7749SMilanka 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){ 2557b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128); 25583deb3ec6SMatthias Ringwald } 25593deb3ec6SMatthias Ringwald 2560711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 256140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2562de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 256340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 256440faeb84SMilanka Ringwald return status; 256540faeb84SMilanka Ringwald } 25663deb3ec6SMatthias Ringwald 2567544a5845SMatthias Ringwald // check if there is space for characteristics descriptors 2568544a5845SMatthias Ringwald if (characteristic->end_handle > characteristic->value_handle){ 25695cf1669fSMatthias Ringwald gatt_client->callback = callback; 25705cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 25715cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 2572052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 25733deb3ec6SMatthias Ringwald gatt_client_run(); 2574544a5845SMatthias Ringwald } else { 2575544a5845SMatthias Ringwald // schedule gatt complete event on next run loop iteration otherwise 2576544a5845SMatthias Ringwald gatt_client->state = P_W2_EMIT_QUERY_COMPLETE_EVENT; 2577544a5845SMatthias Ringwald gatt_client_deferred_event_emit.callback = gatt_client_emit_events; 2578544a5845SMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client_deferred_event_emit); 2579544a5845SMatthias Ringwald } 258025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25813deb3ec6SMatthias Ringwald } 25823deb3ec6SMatthias Ringwald 2583711e6c80SMatthias 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){ 258440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2585de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 258640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 258740faeb84SMilanka Ringwald return status; 258840faeb84SMilanka Ringwald } 25893deb3ec6SMatthias Ringwald 25905cf1669fSMatthias Ringwald gatt_client->callback = callback; 25915cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25925cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2593052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 25943deb3ec6SMatthias Ringwald gatt_client_run(); 259525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25963deb3ec6SMatthias Ringwald } 25973deb3ec6SMatthias Ringwald 2598711e6c80SMatthias 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){ 259940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2600de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 260140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 260240faeb84SMilanka Ringwald return status; 260340faeb84SMilanka Ringwald } 26043deb3ec6SMatthias Ringwald 26055cf1669fSMatthias Ringwald gatt_client->callback = callback; 26065cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 26075cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 26085cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 26095cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 26105cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 26115cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 2612052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 26133deb3ec6SMatthias Ringwald gatt_client_run(); 261425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26153deb3ec6SMatthias Ringwald } 26163deb3ec6SMatthias Ringwald 2617045d700dSDavid 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){ 261840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2619de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 262040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 262140faeb84SMilanka Ringwald return status; 262240faeb84SMilanka Ringwald } 26233deb3ec6SMatthias Ringwald 26245cf1669fSMatthias Ringwald gatt_client->callback = callback; 26255cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 26265cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 26275cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 26285cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 26295cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 26305cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2631052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 26323deb3ec6SMatthias Ringwald gatt_client_run(); 263325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26343deb3ec6SMatthias Ringwald } 26353deb3ec6SMatthias Ringwald 26363deb3ec6SMatthias Ringwald 2637b45b7749SMilanka 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){ 2638b45b7749SMilanka Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 26393deb3ec6SMatthias Ringwald } 26403deb3ec6SMatthias Ringwald 2641b45b7749SMilanka 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){ 264240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2643de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 264440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 264540faeb84SMilanka Ringwald return status; 264640faeb84SMilanka Ringwald } 26473deb3ec6SMatthias Ringwald 26485cf1669fSMatthias Ringwald gatt_client->callback = callback; 2649b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 26505cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2651052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 26523deb3ec6SMatthias Ringwald gatt_client_run(); 265325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26543deb3ec6SMatthias Ringwald } 26553deb3ec6SMatthias Ringwald 2656b45b7749SMilanka 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){ 2657b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0); 26583deb3ec6SMatthias Ringwald } 26593deb3ec6SMatthias Ringwald 2660b45b7749SMilanka 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){ 2661b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 26623deb3ec6SMatthias Ringwald } 26633deb3ec6SMatthias Ringwald 2664f125a8efSMatthias 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){ 266540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2666de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 266740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 266840faeb84SMilanka Ringwald return status; 266940faeb84SMilanka Ringwald } 26703deb3ec6SMatthias Ringwald 2671f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2672f125a8efSMatthias Ringwald if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){ 2673f125a8efSMatthias Ringwald if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){ 2674f125a8efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2675f125a8efSMatthias Ringwald } 2676f125a8efSMatthias Ringwald } 2677f125a8efSMatthias Ringwald #endif 2678f125a8efSMatthias Ringwald 26795cf1669fSMatthias Ringwald gatt_client->callback = callback; 26805cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 26815cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 2682052dc82aSMatthias Ringwald gatt_client->state = state; 26833deb3ec6SMatthias Ringwald gatt_client_run(); 268425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26853deb3ec6SMatthias Ringwald } 26863deb3ec6SMatthias Ringwald 2687f125a8efSMatthias 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){ 2688f125a8efSMatthias Ringwald return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST); 2689f125a8efSMatthias Ringwald } 2690f125a8efSMatthias Ringwald 2691f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2692f125a8efSMatthias 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){ 2693f125a8efSMatthias 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); 2694f125a8efSMatthias Ringwald } 2695f125a8efSMatthias Ringwald #endif 2696f125a8efSMatthias Ringwald 2697de9f8e94SMatthias 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){ 269840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 269940faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 270040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 270140faeb84SMilanka Ringwald return status; 270240faeb84SMilanka Ringwald } 27033deb3ec6SMatthias Ringwald 2704dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 27055cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 27063deb3ec6SMatthias Ringwald 27076e7b444cSMatthias Ringwald return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value); 27083deb3ec6SMatthias Ringwald } 27093deb3ec6SMatthias Ringwald 2710b45b7749SMilanka 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){ 271140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2712de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 271340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 271440faeb84SMilanka Ringwald return status; 271540faeb84SMilanka Ringwald } 27163deb3ec6SMatthias Ringwald 27175cf1669fSMatthias Ringwald gatt_client->callback = callback; 27185cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 27195cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 2720b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2721052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 27223deb3ec6SMatthias Ringwald gatt_client_run(); 272325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27243deb3ec6SMatthias Ringwald } 27253deb3ec6SMatthias Ringwald 2726b45b7749SMilanka 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){ 272740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2728de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 272940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 273040faeb84SMilanka Ringwald return status; 273140faeb84SMilanka Ringwald } 27323deb3ec6SMatthias Ringwald 27335cf1669fSMatthias Ringwald gatt_client->callback = callback; 27345cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 27355cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 27365cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2737b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2738052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 27393deb3ec6SMatthias Ringwald gatt_client_run(); 274025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27413deb3ec6SMatthias Ringwald } 27423deb3ec6SMatthias Ringwald 2743711e6c80SMatthias 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){ 27449c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 27453deb3ec6SMatthias Ringwald } 27463deb3ec6SMatthias Ringwald 2747711e6c80SMatthias 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){ 274840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2749de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 275040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 275140faeb84SMilanka Ringwald return status; 275240faeb84SMilanka Ringwald } 27533deb3ec6SMatthias Ringwald 27545cf1669fSMatthias Ringwald gatt_client->callback = callback; 27555cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 27565cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 27575cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 27585cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 2759052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 27603deb3ec6SMatthias Ringwald gatt_client_run(); 276125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27623deb3ec6SMatthias Ringwald } 27633deb3ec6SMatthias Ringwald 2764711e6c80SMatthias 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){ 276540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2766de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 276740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 276840faeb84SMilanka Ringwald return status; 276940faeb84SMilanka Ringwald } 27703deb3ec6SMatthias Ringwald 27718915696fSMilanka Ringwald if (configuration > 3){ 27728915696fSMilanka Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 27738915696fSMilanka Ringwald } 27748915696fSMilanka Ringwald 27753deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 27764ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2777d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2778616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 27793deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 27804ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2781d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2782616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 27833deb3ec6SMatthias Ringwald } 27843deb3ec6SMatthias Ringwald 27855cf1669fSMatthias Ringwald gatt_client->callback = callback; 27865cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 27875cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 27885cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 27893deb3ec6SMatthias Ringwald 2790abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 27915cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2792abdc9fb5SMatthias Ringwald #else 2793052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2794abdc9fb5SMatthias Ringwald #endif 27953deb3ec6SMatthias Ringwald gatt_client_run(); 27969cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 27973deb3ec6SMatthias Ringwald } 27983deb3ec6SMatthias Ringwald 2799711e6c80SMatthias 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){ 280040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2801de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 280240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 280340faeb84SMilanka Ringwald return status; 280440faeb84SMilanka Ringwald } 28053deb3ec6SMatthias Ringwald 28065cf1669fSMatthias Ringwald gatt_client->callback = callback; 28075cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 28083deb3ec6SMatthias Ringwald 2809052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 28103deb3ec6SMatthias Ringwald gatt_client_run(); 281125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28123deb3ec6SMatthias Ringwald } 28133deb3ec6SMatthias Ringwald 2814711e6c80SMatthias 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){ 28159c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 28163deb3ec6SMatthias Ringwald } 28173deb3ec6SMatthias Ringwald 2818711e6c80SMatthias 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){ 281940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2820de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 282140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 282240faeb84SMilanka Ringwald return status; 282340faeb84SMilanka Ringwald } 28243deb3ec6SMatthias Ringwald 28255cf1669fSMatthias Ringwald gatt_client->callback = callback; 28265cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 28275cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2828052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 28293deb3ec6SMatthias Ringwald gatt_client_run(); 283025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28313deb3ec6SMatthias Ringwald } 28323deb3ec6SMatthias Ringwald 2833711e6c80SMatthias 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){ 28349c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 28353deb3ec6SMatthias Ringwald } 28363deb3ec6SMatthias Ringwald 2837711e6c80SMatthias 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){ 28389c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 28393deb3ec6SMatthias Ringwald } 28403deb3ec6SMatthias Ringwald 2841b45b7749SMilanka 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){ 284240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2843de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 284440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 284540faeb84SMilanka Ringwald return status; 284640faeb84SMilanka Ringwald } 28473deb3ec6SMatthias Ringwald 28485cf1669fSMatthias Ringwald gatt_client->callback = callback; 28495cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2850b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 28515cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2852b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2853052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 28543deb3ec6SMatthias Ringwald gatt_client_run(); 285525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28563deb3ec6SMatthias Ringwald } 28573deb3ec6SMatthias Ringwald 285848cdff9cSMilanka 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){ 285948cdff9cSMilanka Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 28603deb3ec6SMatthias Ringwald } 28613deb3ec6SMatthias Ringwald 2862b45b7749SMilanka 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){ 286340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2864de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 286540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 286640faeb84SMilanka Ringwald return status; 286740faeb84SMilanka Ringwald } 28683deb3ec6SMatthias Ringwald 28695cf1669fSMatthias Ringwald gatt_client->callback = callback; 28705cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2871b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 28725cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2873b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2874052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 28753deb3ec6SMatthias Ringwald gatt_client_run(); 287625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28773deb3ec6SMatthias Ringwald } 28783deb3ec6SMatthias Ringwald 2879b45b7749SMilanka 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){ 2880b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value); 28813deb3ec6SMatthias Ringwald } 28823deb3ec6SMatthias Ringwald 2883b45b7749SMilanka 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){ 2884b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 28853deb3ec6SMatthias Ringwald } 28863deb3ec6SMatthias Ringwald 28873deb3ec6SMatthias Ringwald /** 28883deb3ec6SMatthias Ringwald * @brief -> gatt complete event 28893deb3ec6SMatthias Ringwald */ 2890b45b7749SMilanka 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){ 289140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2892de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 289340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 289440faeb84SMilanka Ringwald return status; 289540faeb84SMilanka Ringwald } 28963deb3ec6SMatthias Ringwald 28975cf1669fSMatthias Ringwald gatt_client->callback = callback; 28985cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 2899b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 29005cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2901b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2902052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 29033deb3ec6SMatthias Ringwald gatt_client_run(); 290425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29053deb3ec6SMatthias Ringwald } 29063deb3ec6SMatthias Ringwald 29073deb3ec6SMatthias Ringwald /** 29083deb3ec6SMatthias Ringwald * @brief -> gatt complete event 29093deb3ec6SMatthias Ringwald */ 2910711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 291140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2912de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 291340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 291440faeb84SMilanka Ringwald return status; 291540faeb84SMilanka Ringwald } 29163deb3ec6SMatthias Ringwald 29175cf1669fSMatthias Ringwald gatt_client->callback = callback; 2918052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 29193deb3ec6SMatthias Ringwald gatt_client_run(); 292025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29213deb3ec6SMatthias Ringwald } 29223deb3ec6SMatthias Ringwald 29233deb3ec6SMatthias Ringwald /** 29243deb3ec6SMatthias Ringwald * @brief -> gatt complete event 29253deb3ec6SMatthias Ringwald */ 2926711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 292740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2928de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 292940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 293040faeb84SMilanka Ringwald return status; 293140faeb84SMilanka Ringwald } 29323deb3ec6SMatthias Ringwald 29335cf1669fSMatthias Ringwald gatt_client->callback = callback; 2934052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 29353deb3ec6SMatthias Ringwald gatt_client_run(); 29367d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 29373deb3ec6SMatthias Ringwald } 29383deb3ec6SMatthias Ringwald 2939313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 29406ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 29416ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 29426ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 29436ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 29446ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2945c839c6f9SMatthias Ringwald } else { 2946c839c6f9SMatthias Ringwald service->uuid16 = 0; 29476ba2ad22SMatthias Ringwald } 29486ba2ad22SMatthias Ringwald } 29496ba2ad22SMatthias Ringwald 2950313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 29516ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 29526ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 29536ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 29546ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 295586c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 29566ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 29576ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2958c839c6f9SMatthias Ringwald } else { 2959c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 29606ba2ad22SMatthias Ringwald } 29616ba2ad22SMatthias Ringwald } 29626ba2ad22SMatthias Ringwald 2963313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 29646ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 29656ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2966b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2967b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2968c839c6f9SMatthias Ringwald } else { 2969c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2970b4895529SJakob Krantz } 29716ba2ad22SMatthias Ringwald } 29725cf6c434SJakob Krantz 29735cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 297440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 297540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 297640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 297740faeb84SMilanka Ringwald return; 297840faeb84SMilanka Ringwald } 297940faeb84SMilanka Ringwald if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 298040faeb84SMilanka Ringwald gatt_client->callback = callback; 298140faeb84SMilanka Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 29825cf6c434SJakob Krantz gatt_client_run(); 29835cf6c434SJakob Krantz } 29845cf6c434SJakob Krantz } 298547181045SMatthias Ringwald 298659d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 298759d34cd2SMatthias Ringwald gatt_client_t * gatt_client; 298859d34cd2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 298959d34cd2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 299059d34cd2SMatthias Ringwald return status; 299159d34cd2SMatthias Ringwald } 299259d34cd2SMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration); 29932832a98aSMatthias Ringwald if (added == false){ 299459d34cd2SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 29952832a98aSMatthias Ringwald } else { 29962832a98aSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 29972832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 299859d34cd2SMatthias Ringwald } 299959d34cd2SMatthias Ringwald } 300059d34cd2SMatthias Ringwald 300153e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 300253e9c18fSMatthias Ringwald gatt_client_t * gatt_client; 300353e9c18fSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 300453e9c18fSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 300553e9c18fSMatthias Ringwald return status; 300653e9c18fSMatthias Ringwald } 300753e9c18fSMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 30082832a98aSMatthias Ringwald if (added == false){ 300953e9c18fSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 30102832a98aSMatthias Ringwald } else { 30112832a98aSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 30122832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 301353e9c18fSMatthias Ringwald } 301453e9c18fSMatthias Ringwald } 301553e9c18fSMatthias Ringwald 301648553f67SDirk Helbig uint8_t gatt_client_remove_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 301748553f67SDirk Helbig gatt_client_t * gatt_client; 301848553f67SDirk Helbig uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 301948553f67SDirk Helbig if (status != ERROR_CODE_SUCCESS){ 302048553f67SDirk Helbig return status; 302148553f67SDirk Helbig } 302248553f67SDirk Helbig (void)btstack_linked_list_remove(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 302348553f67SDirk Helbig return ERROR_CODE_SUCCESS; 302448553f67SDirk Helbig } 302548553f67SDirk Helbig 302647181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 302740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 302840faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 302940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 303040faeb84SMilanka Ringwald return status; 303140faeb84SMilanka Ringwald } 303240faeb84SMilanka Ringwald if (gatt_client->write_without_response_callback != NULL){ 303340faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 303440faeb84SMilanka Ringwald } 303540faeb84SMilanka Ringwald gatt_client->write_without_response_callback = callback; 303640faeb84SMilanka Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 30377d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 303847181045SMatthias Ringwald } 3039a6121b51SMilanka Ringwald 30407627a0deSMatthias Ringwald 30417627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT) 30421450cdc6SMatthias Ringwald 30431450cdc6SMatthias Ringwald #include "hci_event.h" 30441450cdc6SMatthias Ringwald 30451450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = { 30461450cdc6SMatthias Ringwald GATT_EVENT_CONNECTED, 0, "1BH" 30471450cdc6SMatthias Ringwald }; 30481450cdc6SMatthias Ringwald 30496b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = { 30506b4a68c3SMatthias Ringwald GATT_EVENT_DISCONNECTED, 0, "H" 30516b4a68c3SMatthias Ringwald }; 30521c7a19feSMatthias Ringwald 30531c7a19feSMatthias Ringwald static void gatt_client_emit_connected(btstack_packet_handler_t callback, uint8_t status, bd_addr_t addr, 30541c7a19feSMatthias Ringwald hci_con_handle_t con_handle) { 30551c7a19feSMatthias Ringwald uint8_t buffer[20]; 30561c7a19feSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, con_handle); 30571c7a19feSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 30581c7a19feSMatthias Ringwald } 30591c7a19feSMatthias Ringwald 30607627a0deSMatthias Ringwald #endif 30617627a0deSMatthias Ringwald 30627627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 30637627a0deSMatthias Ringwald 30647627a0deSMatthias Ringwald #include "bluetooth_psm.h" 30657627a0deSMatthias Ringwald 30667627a0deSMatthias Ringwald // single active SDP query 30677627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query; 30687627a0deSMatthias Ringwald 30697627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes 30707627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32]; 30717627a0deSMatthias Ringwald 30726b4a68c3SMatthias Ringwald 30731450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){ 30741450cdc6SMatthias Ringwald btstack_linked_item_t *it; 30751450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 30761450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 30771450cdc6SMatthias Ringwald if (memcmp(gatt_client->addr, addr, 6) == 0){ 30781450cdc6SMatthias Ringwald return gatt_client; 30791450cdc6SMatthias Ringwald } 30801450cdc6SMatthias Ringwald } 30811450cdc6SMatthias Ringwald return NULL; 30821450cdc6SMatthias Ringwald } 30831450cdc6SMatthias Ringwald 30841450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){ 30851450cdc6SMatthias Ringwald btstack_linked_item_t *it; 30861450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 30871450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 30881450cdc6SMatthias Ringwald if (gatt_client->l2cap_cid == l2cap_cid){ 30891450cdc6SMatthias Ringwald return gatt_client; 30901450cdc6SMatthias Ringwald } 30911450cdc6SMatthias Ringwald } 30921450cdc6SMatthias Ringwald return NULL; 30931450cdc6SMatthias Ringwald } 30941450cdc6SMatthias Ringwald 30951450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){ 30961450cdc6SMatthias Ringwald bd_addr_t addr; 3097d5529700SMatthias Ringwald // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy 30981450cdc6SMatthias Ringwald memcpy(addr, gatt_client->addr, 6); 30991450cdc6SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 31001450cdc6SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 31019ed6f53cSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 31023b0e0cc5SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 31033b0e0cc5SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 31043b0e0cc5SMatthias Ringwald } 31051c7a19feSMatthias Ringwald gatt_client_emit_connected(callback, status, addr, con_handle); 31061450cdc6SMatthias Ringwald } 31071450cdc6SMatthias Ringwald 3108180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts){ 3109180cbe79SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 3110180cbe79SMatthias Ringwald if (gatt_client != NULL){ 3111180cbe79SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 3112180cbe79SMatthias Ringwald att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 3113180cbe79SMatthias Ringwald } 3114180cbe79SMatthias Ringwald } 3115180cbe79SMatthias Ringwald 31166b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){ 31176b4a68c3SMatthias Ringwald 31186b4a68c3SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 31196b4a68c3SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 31206b4a68c3SMatthias Ringwald 31216b4a68c3SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 31226b4a68c3SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 31236b4a68c3SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 31246b4a68c3SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 31256b4a68c3SMatthias Ringwald 31266b4a68c3SMatthias Ringwald uint8_t buffer[20]; 31276b4a68c3SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle); 31286b4a68c3SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 31296b4a68c3SMatthias Ringwald } 31306b4a68c3SMatthias Ringwald 31311450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){ 31321450cdc6SMatthias Ringwald des_iterator_t des_list_it; 31331450cdc6SMatthias Ringwald des_iterator_t prot_it; 31341450cdc6SMatthias Ringwald 31351450cdc6SMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) { 31361450cdc6SMatthias Ringwald gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 31371450cdc6SMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 31381450cdc6SMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 31391450cdc6SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: 31401450cdc6SMatthias 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)) { 31411450cdc6SMatthias Ringwald uint8_t *des_element; 31421450cdc6SMatthias Ringwald uint8_t *element; 31431450cdc6SMatthias Ringwald uint32_t uuid; 31441450cdc6SMatthias Ringwald 31451450cdc6SMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 31461450cdc6SMatthias Ringwald 31471450cdc6SMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 31481450cdc6SMatthias Ringwald des_iterator_init(&prot_it, des_element); 31491450cdc6SMatthias Ringwald element = des_iterator_get_element(&prot_it); 31501450cdc6SMatthias Ringwald 31511450cdc6SMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 31521450cdc6SMatthias Ringwald 31531450cdc6SMatthias Ringwald uuid = de_get_uuid32(element); 31541450cdc6SMatthias Ringwald des_iterator_next(&prot_it); 31551450cdc6SMatthias Ringwald // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both 31561450cdc6SMatthias Ringwald switch (uuid){ 31571450cdc6SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 31581450cdc6SMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 31591450cdc6SMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm); 31601450cdc6SMatthias Ringwald break; 31611450cdc6SMatthias Ringwald default: 31621450cdc6SMatthias Ringwald break; 31631450cdc6SMatthias Ringwald } 31641450cdc6SMatthias Ringwald } 31651450cdc6SMatthias Ringwald break; 31661450cdc6SMatthias Ringwald 31671450cdc6SMatthias Ringwald default: 31681450cdc6SMatthias Ringwald break; 31691450cdc6SMatthias Ringwald } 31701450cdc6SMatthias Ringwald } 31711450cdc6SMatthias Ringwald } 31721450cdc6SMatthias Ringwald } 31731450cdc6SMatthias Ringwald 31741450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 31751450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query; 31761450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 31771450cdc6SMatthias Ringwald uint8_t status; 31781450cdc6SMatthias Ringwald 31791450cdc6SMatthias Ringwald // TODO: handle sdp events, get l2cap psm 31801450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 31811450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 31821450cdc6SMatthias Ringwald gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet); 31831450cdc6SMatthias Ringwald // TODO: 31841450cdc6SMatthias Ringwald return; 31851450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 31861450cdc6SMatthias Ringwald status = sdp_event_query_complete_get_status(packet); 31871450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = NULL; 31881450cdc6SMatthias Ringwald log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status); 31891450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) break; 31901450cdc6SMatthias Ringwald if (gatt_client->l2cap_psm == 0) { 31911450cdc6SMatthias Ringwald status = SDP_SERVICE_NOT_FOUND; 31921450cdc6SMatthias Ringwald break; 31931450cdc6SMatthias Ringwald } 31941450cdc6SMatthias Ringwald break; 31951450cdc6SMatthias Ringwald default: 31961450cdc6SMatthias Ringwald btstack_assert(false); 31971450cdc6SMatthias Ringwald return; 31981450cdc6SMatthias Ringwald } 31991450cdc6SMatthias Ringwald 32001450cdc6SMatthias Ringwald // done 32011450cdc6SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3202052dc82aSMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 320359b5e157SMatthias Ringwald status = att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 32041450cdc6SMatthias Ringwald } 32051450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) { 32061450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 32071450cdc6SMatthias Ringwald } 32081450cdc6SMatthias Ringwald } 32091450cdc6SMatthias Ringwald 32101450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){ 32111450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = (gatt_client_t *) context; 3212052dc82aSMatthias Ringwald gatt_client_classic_active_sdp_query->state = P_W4_SDP_QUERY; 32131450cdc6SMatthias Ringwald sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 32141450cdc6SMatthias Ringwald } 32151450cdc6SMatthias Ringwald 321674daebdeSMatthias Ringwald static void gatt_client_classic_emit_connected(void * context){ 321774daebdeSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) context; 3218052dc82aSMatthias Ringwald gatt_client->state = P_READY; 321974daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 322074daebdeSMatthias Ringwald btstack_assert(hci_connection != NULL); 322174daebdeSMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, ERROR_CODE_SUCCESS, hci_connection->address, gatt_client->con_handle); 322274daebdeSMatthias Ringwald } 322374daebdeSMatthias Ringwald 32241450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){ 32251450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr); 32261450cdc6SMatthias Ringwald if (gatt_client != NULL){ 32271450cdc6SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 32281450cdc6SMatthias Ringwald } 32291450cdc6SMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 32301450cdc6SMatthias Ringwald if (gatt_client == NULL){ 32311450cdc6SMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 32321450cdc6SMatthias Ringwald } 32331450cdc6SMatthias Ringwald // init state 3234e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC; 32351450cdc6SMatthias Ringwald gatt_client->con_handle = HCI_CON_HANDLE_INVALID; 32361450cdc6SMatthias Ringwald memcpy(gatt_client->addr, addr, 6); 32371450cdc6SMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 32381450cdc6SMatthias Ringwald gatt_client->security_level = LEVEL_0; 32391450cdc6SMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 32401450cdc6SMatthias Ringwald gatt_client->callback = callback; 3241cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3242cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3243cbd76cecSMatthias Ringwald #endif 32441450cdc6SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 324574daebdeSMatthias Ringwald 324674daebdeSMatthias Ringwald // schedule emitted event if already connected, otherwise 324774daebdeSMatthias Ringwald bool already_connected = false; 324874daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 324974daebdeSMatthias Ringwald if (hci_connection != NULL){ 325074daebdeSMatthias Ringwald if (hci_connection->att_server.l2cap_cid != 0){ 325174daebdeSMatthias Ringwald already_connected = true; 325274daebdeSMatthias Ringwald } 325374daebdeSMatthias Ringwald } 3254052dc82aSMatthias Ringwald gatt_client->callback_request.context = gatt_client; 325574daebdeSMatthias Ringwald if (already_connected){ 325674daebdeSMatthias Ringwald gatt_client->con_handle = hci_connection->con_handle; 3257052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_emit_connected; 3258052dc82aSMatthias Ringwald gatt_client->state = P_W2_EMIT_CONNECTED; 3259052dc82aSMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client->callback_request); 326074daebdeSMatthias Ringwald } else { 3261052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_sdp_start; 3262052dc82aSMatthias Ringwald gatt_client->state = P_W2_SDP_QUERY; 3263052dc82aSMatthias Ringwald sdp_client_register_query_callback(&gatt_client->callback_request); 326474daebdeSMatthias Ringwald } 3265b7b03a30SMatthias Ringwald return ERROR_CODE_SUCCESS; 32661450cdc6SMatthias Ringwald } 32671450cdc6SMatthias Ringwald 32681450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 32691450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 32701450cdc6SMatthias Ringwald if (gatt_client == NULL){ 32711450cdc6SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 32721450cdc6SMatthias Ringwald } 32731450cdc6SMatthias Ringwald gatt_client->callback = callback; 32741450cdc6SMatthias Ringwald return l2cap_disconnect(gatt_client->l2cap_cid); 32751450cdc6SMatthias Ringwald } 32761450cdc6SMatthias Ringwald #endif 32771450cdc6SMatthias Ringwald 327826166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 327926166ecfSMatthias Ringwald 328026166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5 32817627a0deSMatthias Ringwald 32827627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 32837627a0deSMatthias Ringwald 3284df0a5c68SMatthias Ringwald static uint8_t gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client_t * gatt_client, gatt_client_state_t state){ 3285df0a5c68SMatthias Ringwald uint8_t num_clients = 0; 3286df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3287df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 3288df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 3289df0a5c68SMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3290df0a5c68SMatthias Ringwald if (eatt_client->state == state){ 3291df0a5c68SMatthias Ringwald num_clients++; 3292df0a5c68SMatthias Ringwald } 3293df0a5c68SMatthias Ringwald } 3294df0a5c68SMatthias Ringwald return num_clients; 3295df0a5c68SMatthias Ringwald } 3296df0a5c68SMatthias Ringwald 32977627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) { 32987627a0deSMatthias Ringwald // free eatt clients 32997627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 33007627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 33017627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 33027627a0deSMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 33037627a0deSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 33047627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 33057627a0deSMatthias Ringwald } 33067627a0deSMatthias Ringwald } 33077627a0deSMatthias Ringwald 33087627a0deSMatthias Ringwald // all channels connected 33097627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) { 33107627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3311df0a5c68SMatthias Ringwald uint8_t num_ready = gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_READY); 3312df0a5c68SMatthias Ringwald if (num_ready > 0){ 33137627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READY; 3314df0a5c68SMatthias Ringwald // free unused channels 3315df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3316df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 3317df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 3318df0a5c68SMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3319df0a5c68SMatthias Ringwald if (eatt_client->state == P_L2CAP_CLOSED){ 3320df0a5c68SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 3321df0a5c68SMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 3322df0a5c68SMatthias Ringwald } 3323df0a5c68SMatthias Ringwald } 3324df0a5c68SMatthias Ringwald } else { 33256d0f6f49SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 33266d0f6f49SMatthias Ringwald btstack_assert(hci_connection != NULL); 33276d0f6f49SMatthias Ringwald if (hci_connection->att_server.incoming_connection_request){ 33286d0f6f49SMatthias Ringwald hci_connection->att_server.incoming_connection_request = false; 33296d0f6f49SMatthias Ringwald log_info("Collision, retry in 100ms"); 33306d0f6f49SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 33316d0f6f49SMatthias Ringwald // set timer for retry 3332b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 33336d0f6f49SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_le_enhanced_retry); 33346d0f6f49SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 33356d0f6f49SMatthias Ringwald return; 33366d0f6f49SMatthias Ringwald } else { 3337df0a5c68SMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3338df0a5c68SMatthias Ringwald status = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 3339df0a5c68SMatthias Ringwald } 33406d0f6f49SMatthias Ringwald } 33417627a0deSMatthias Ringwald } else { 33427627a0deSMatthias Ringwald gatt_client_eatt_finalize(gatt_client); 33437627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 33447627a0deSMatthias Ringwald } 33457627a0deSMatthias Ringwald 33461c7a19feSMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, status, gatt_client->addr, gatt_client->con_handle); 33477627a0deSMatthias Ringwald } 33487627a0deSMatthias Ringwald 33497627a0deSMatthias Ringwald // single channel disconnected 33507627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) { 33517627a0deSMatthias Ringwald 33527627a0deSMatthias Ringwald // report error 33537627a0deSMatthias Ringwald gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 33547627a0deSMatthias Ringwald 33557627a0deSMatthias Ringwald // free memory 33567627a0deSMatthias Ringwald btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client); 33577627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 33587627a0deSMatthias Ringwald 3359570bdd2dSMatthias Ringwald // last channel 33607627a0deSMatthias Ringwald if (btstack_linked_list_empty(&gatt_client->eatt_clients)){ 3361570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 3362570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = false; 3363570bdd2dSMatthias Ringwald 3364570bdd2dSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) { 3365570bdd2dSMatthias Ringwald // report disconnected if last channel closed 33667627a0deSMatthias Ringwald uint8_t buffer[20]; 33677627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle); 33687627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 33697627a0deSMatthias Ringwald } 33707627a0deSMatthias Ringwald } 33717627a0deSMatthias Ringwald } 33727627a0deSMatthias Ringwald 33737627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){ 33747627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 33757627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 33767627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 33777627a0deSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 33787627a0deSMatthias Ringwald btstack_linked_list_iterator_t it2; 33797627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients); 33807627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it2)) { 33817627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2); 33827627a0deSMatthias Ringwald if (eatt_client->l2cap_cid == l2cap_cid){ 33837627a0deSMatthias Ringwald *out_eatt_client = eatt_client; 33847627a0deSMatthias Ringwald return gatt_client; 33857627a0deSMatthias Ringwald } 33867627a0deSMatthias Ringwald } 33877627a0deSMatthias Ringwald } 33887627a0deSMatthias Ringwald return NULL; 33897627a0deSMatthias Ringwald } 33907627a0deSMatthias Ringwald 33917627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){ 33927627a0deSMatthias Ringwald uint8_t num_channels = gatt_client->eatt_num_clients; 33937627a0deSMatthias Ringwald 33947627a0deSMatthias Ringwald // setup channels 33957627a0deSMatthias Ringwald uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels; 3396f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 33977627a0deSMatthias Ringwald uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS]; 33987627a0deSMatthias Ringwald uint16_t new_cids[MAX_NR_EATT_CHANNELS]; 33997627a0deSMatthias Ringwald memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size); 34007627a0deSMatthias Ringwald uint8_t i; 34017627a0deSMatthias Ringwald for (i=0;i<gatt_client->eatt_num_clients; i++){ 3402f7a42e72SMatthias Ringwald receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER]; 3403f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu; 34047627a0deSMatthias Ringwald } 34057627a0deSMatthias Ringwald 34067627a0deSMatthias Ringwald log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client); 34077627a0deSMatthias Ringwald 3408f7a42e72SMatthias Ringwald uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler, 3409f7a42e72SMatthias Ringwald gatt_client->con_handle, 34107627a0deSMatthias Ringwald gatt_client->security_level, 3411f7a42e72SMatthias Ringwald BLUETOOTH_PSM_EATT, num_channels, 3412f7a42e72SMatthias Ringwald L2CAP_LE_AUTOMATIC_CREDITS, 34137627a0deSMatthias Ringwald buffer_size_per_client, 3414f7a42e72SMatthias Ringwald receive_buffers, 3415f7a42e72SMatthias Ringwald new_cids); 34167627a0deSMatthias Ringwald 34177627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 34187627a0deSMatthias Ringwald i = 0; 34197627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 34207627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 34217627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 34227627a0deSMatthias Ringwald gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 34237627a0deSMatthias Ringwald 34247627a0deSMatthias Ringwald // init state with new cid and transmit buffer 34257627a0deSMatthias Ringwald new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE; 34267627a0deSMatthias Ringwald new_eatt_client->con_handle = gatt_client->con_handle; 34277627a0deSMatthias Ringwald new_eatt_client->mtu = 64; 34287627a0deSMatthias Ringwald new_eatt_client->security_level = LEVEL_0; 34297627a0deSMatthias Ringwald new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 3430052dc82aSMatthias Ringwald new_eatt_client->state = P_W4_L2CAP_CONNECTION; 34317627a0deSMatthias Ringwald new_eatt_client->l2cap_cid = new_cids[i]; 34327627a0deSMatthias Ringwald new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer; 3433f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += max_mtu; 34347627a0deSMatthias Ringwald i++; 34357627a0deSMatthias Ringwald } 34367627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP; 34377627a0deSMatthias Ringwald } else { 34387627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, status); 34397627a0deSMatthias Ringwald } 344026166ecfSMatthias Ringwald } 344126166ecfSMatthias Ringwald 34426d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts){ 34436d0f6f49SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 34446d0f6f49SMatthias Ringwald if (gatt_client != NULL){ 34456d0f6f49SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 34466d0f6f49SMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 34476d0f6f49SMatthias Ringwald } 34486d0f6f49SMatthias Ringwald } 34496d0f6f49SMatthias Ringwald 345026166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 34517627a0deSMatthias Ringwald gatt_client_t *gatt_client; 34527627a0deSMatthias Ringwald gatt_client_t *eatt_client; 345326166ecfSMatthias Ringwald hci_con_handle_t con_handle; 34547627a0deSMatthias Ringwald uint16_t l2cap_cid; 345526166ecfSMatthias Ringwald uint8_t status; 345626166ecfSMatthias Ringwald gatt_client_characteristic_t characteristic; 34577627a0deSMatthias Ringwald gatt_client_service_t service; 345826166ecfSMatthias Ringwald switch (packet_type) { 345926166ecfSMatthias Ringwald case HCI_EVENT_PACKET: 346026166ecfSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 34617627a0deSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 34627627a0deSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 34637627a0deSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 34647627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 34657627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE); 34667627a0deSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 34677627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 34687627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 34697627a0deSMatthias Ringwald break; 347026166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 347126166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 347226166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 347326166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 34747627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE); 347526166ecfSMatthias Ringwald if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) { 34767627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0]; 347726166ecfSMatthias Ringwald } 347826166ecfSMatthias Ringwald break; 347926166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 348026166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 348126166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 348226166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 34837627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE); 34847627a0deSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 348526166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = characteristic.value_handle; 348626166ecfSMatthias Ringwald break; 348726166ecfSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 348826166ecfSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 348926166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 349026166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 34917627a0deSMatthias Ringwald switch (gatt_client->eatt_state){ 34927627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE: 34937627a0deSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle == 0){ 34947627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 34957627a0deSMatthias Ringwald } else { 34967627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND; 34977627a0deSMatthias Ringwald } 34987627a0deSMatthias Ringwald break; 34997627a0deSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE: 35007627a0deSMatthias Ringwald if ((gatt_client->gatt_server_supported_features & 1) == 0) { 35017627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 35027627a0deSMatthias Ringwald } else { 35037627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND; 35047627a0deSMatthias Ringwald } 35057627a0deSMatthias Ringwald break; 35067627a0deSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE: 35077627a0deSMatthias Ringwald if (gatt_client->gatt_client_supported_features_handle == 0){ 35087627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 35097627a0deSMatthias Ringwald } else { 35107627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND; 35117627a0deSMatthias Ringwald } 35127627a0deSMatthias Ringwald break; 35137627a0deSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE: 35147627a0deSMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 351526166ecfSMatthias Ringwald break; 351626166ecfSMatthias Ringwald default: 351726166ecfSMatthias Ringwald break; 351826166ecfSMatthias Ringwald } 351926166ecfSMatthias Ringwald break; 35207627a0deSMatthias Ringwald case L2CAP_EVENT_ECBM_CHANNEL_OPENED: 35217627a0deSMatthias Ringwald l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet); 35227627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 35237627a0deSMatthias Ringwald 35247627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 35257627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 3526052dc82aSMatthias Ringwald btstack_assert(eatt_client->state == P_W4_L2CAP_CONNECTION); 35277627a0deSMatthias Ringwald 35287627a0deSMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 35297627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3530052dc82aSMatthias Ringwald eatt_client->state = P_READY; 35317627a0deSMatthias Ringwald eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 35327627a0deSMatthias Ringwald } else { 3533df0a5c68SMatthias Ringwald eatt_client->state = P_L2CAP_CLOSED; 35347627a0deSMatthias Ringwald } 3535df0a5c68SMatthias Ringwald // connected if opened event for all channels received 3536df0a5c68SMatthias Ringwald if (gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_W4_L2CAP_CONNECTION) == 0){ 35377627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS); 35387627a0deSMatthias Ringwald } 35397627a0deSMatthias Ringwald break; 35407627a0deSMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 35417627a0deSMatthias Ringwald l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet); 35427627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 35437627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 35447627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 35457627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 35467627a0deSMatthias Ringwald break; 35477627a0deSMatthias Ringwald default: 35487627a0deSMatthias Ringwald break; 35497627a0deSMatthias Ringwald } 35507627a0deSMatthias Ringwald break; 35517627a0deSMatthias Ringwald case L2CAP_DATA_PACKET: 35527627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client); 35537627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 3554ce82ac7fSMatthias Ringwald btstack_assert(eatt_client != NULL); 3555ce82ac7fSMatthias Ringwald gatt_client_handle_att_response(eatt_client, packet, size); 35567627a0deSMatthias Ringwald gatt_client_run(); 35577627a0deSMatthias Ringwald break; 355826166ecfSMatthias Ringwald default: 355926166ecfSMatthias Ringwald break; 356026166ecfSMatthias Ringwald } 356126166ecfSMatthias Ringwald } 356226166ecfSMatthias Ringwald 35637627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){ 356426166ecfSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 356526166ecfSMatthias Ringwald uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications 356626166ecfSMatthias Ringwald switch (gatt_client->eatt_state){ 35677627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND: 35687627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = 0; 35697627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE; 35707627a0deSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler, 35717627a0deSMatthias Ringwald gatt_client->con_handle, 35727627a0deSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 35737627a0deSMatthias Ringwald break; 357426166ecfSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND: 35757627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = 0; 35767627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE; 357726166ecfSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler, 35787627a0deSMatthias Ringwald gatt_client->con_handle, 35797627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 35807627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 358126166ecfSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES); 358226166ecfSMatthias Ringwald return true; 358326166ecfSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND: 35847627a0deSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = 0; 35857627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE; 358626166ecfSMatthias Ringwald status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler, 35877627a0deSMatthias Ringwald gatt_client->con_handle, 35887627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 35897627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 35907627a0deSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES); 359126166ecfSMatthias Ringwald return true; 359226166ecfSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND: 359326166ecfSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE; 359426166ecfSMatthias Ringwald status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle, 359526166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle, 1, 359626166ecfSMatthias Ringwald &gatt_client_supported_features); 359726166ecfSMatthias Ringwald return true; 359826166ecfSMatthias Ringwald default: 359926166ecfSMatthias Ringwald break; 360026166ecfSMatthias Ringwald } 36017627a0deSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 36027627a0deSMatthias Ringwald UNUSED(status); 360326166ecfSMatthias Ringwald return false; 360426166ecfSMatthias Ringwald } 360526166ecfSMatthias Ringwald 360626166ecfSMatthias 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) { 360726166ecfSMatthias Ringwald gatt_client_t * gatt_client; 360826166ecfSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 360926166ecfSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 361026166ecfSMatthias Ringwald return status; 361126166ecfSMatthias Ringwald } 361226166ecfSMatthias Ringwald 361326166ecfSMatthias Ringwald if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){ 361426166ecfSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 361526166ecfSMatthias Ringwald } 361626166ecfSMatthias Ringwald 3617f7a42e72SMatthias Ringwald // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports 36187627a0deSMatthias Ringwald uint16_t buffer_size_per_client = storage_size / num_channels; 3619f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 3620f7a42e72SMatthias Ringwald if (max_mtu < 64) { 36217627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 36227627a0deSMatthias Ringwald } 36237627a0deSMatthias Ringwald 36247627a0deSMatthias Ringwald if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){ 36257627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 36267627a0deSMatthias Ringwald } 36277627a0deSMatthias Ringwald 36287627a0deSMatthias Ringwald // create max num_channel eatt clients 36297627a0deSMatthias Ringwald uint8_t i; 36307627a0deSMatthias Ringwald btstack_linked_list_t eatt_clients = NULL; 36317627a0deSMatthias Ringwald for (i=0;i<num_channels;i++) { 36327627a0deSMatthias Ringwald gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get(); 36337627a0deSMatthias Ringwald if (new_gatt_client == NULL) { 36347627a0deSMatthias Ringwald break; 36357627a0deSMatthias Ringwald } 36367627a0deSMatthias Ringwald btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client); 36377627a0deSMatthias Ringwald } 36387627a0deSMatthias Ringwald 36397627a0deSMatthias Ringwald if (i != num_channels){ 36407627a0deSMatthias Ringwald while (true){ 36417627a0deSMatthias Ringwald gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients); 36427627a0deSMatthias Ringwald if (gatt_client == NULL) { 36437627a0deSMatthias Ringwald break; 36447627a0deSMatthias Ringwald } 36457627a0deSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 36467627a0deSMatthias Ringwald } 36477627a0deSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 36487627a0deSMatthias Ringwald } 36497627a0deSMatthias Ringwald 3650570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 3651570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = true; 3652570bdd2dSMatthias Ringwald 36537627a0deSMatthias Ringwald gatt_client->callback = callback; 36547627a0deSMatthias Ringwald gatt_client->eatt_num_clients = num_channels; 36557627a0deSMatthias Ringwald gatt_client->eatt_storage_buffer = storage_buffer; 36567627a0deSMatthias Ringwald gatt_client->eatt_storage_size = storage_size; 36577627a0deSMatthias Ringwald gatt_client->eatt_clients = eatt_clients; 36587627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND; 365926166ecfSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 366026166ecfSMatthias Ringwald 366126166ecfSMatthias Ringwald return ERROR_CODE_SUCCESS; 366226166ecfSMatthias Ringwald } 366326166ecfSMatthias Ringwald 366426166ecfSMatthias Ringwald #endif 366526166ecfSMatthias Ringwald 3666a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 3667a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 3668a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 3669a6121b51SMilanka Ringwald } 3670ae1ee62dSMilanka Ringwald 367140faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 367240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client); 367340faeb84SMilanka Ringwald return status; 3674ae1ee62dSMilanka Ringwald } 3675a6121b51SMilanka Ringwald #endif 3676