13deb3ec6SMatthias Ringwald /* 23deb3ec6SMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 33deb3ec6SMatthias Ringwald * 43deb3ec6SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 53deb3ec6SMatthias Ringwald * modification, are permitted provided that the following conditions 63deb3ec6SMatthias Ringwald * are met: 73deb3ec6SMatthias Ringwald * 83deb3ec6SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 93deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 103deb3ec6SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 113deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 123deb3ec6SMatthias Ringwald * documentation and/or other materials provided with the distribution. 133deb3ec6SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 143deb3ec6SMatthias Ringwald * contributors may be used to endorse or promote products derived 153deb3ec6SMatthias Ringwald * from this software without specific prior written permission. 163deb3ec6SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 173deb3ec6SMatthias Ringwald * personal benefit and not for any commercial purpose or for 183deb3ec6SMatthias Ringwald * monetary gain. 193deb3ec6SMatthias Ringwald * 203deb3ec6SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 213deb3ec6SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 223deb3ec6SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 232fca4dadSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN 242fca4dadSMilanka Ringwald * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 253deb3ec6SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 263deb3ec6SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 273deb3ec6SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 283deb3ec6SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 293deb3ec6SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 303deb3ec6SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 313deb3ec6SMatthias Ringwald * SUCH DAMAGE. 323deb3ec6SMatthias Ringwald * 333deb3ec6SMatthias Ringwald * Please inquire about commercial licensing options at 343deb3ec6SMatthias Ringwald * [email protected] 353deb3ec6SMatthias Ringwald * 363deb3ec6SMatthias Ringwald */ 373deb3ec6SMatthias Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "gatt_client.c" 39ab2c6ae4SMatthias Ringwald 403deb3ec6SMatthias Ringwald #include <stdint.h> 413deb3ec6SMatthias Ringwald #include <string.h> 42a95ca902SMatthias Ringwald #include <stddef.h> 433deb3ec6SMatthias Ringwald 447907f069SMatthias Ringwald #include "btstack_config.h" 453deb3ec6SMatthias Ringwald 46296289e3SMatthias Ringwald #include "ble/att_dispatch.h" 470e2df43fSMatthias Ringwald #include "ble/att_db.h" 480e2df43fSMatthias Ringwald #include "ble/gatt_client.h" 490e2df43fSMatthias Ringwald #include "ble/le_device_db.h" 500e2df43fSMatthias Ringwald #include "ble/sm.h" 51c40517c3SMatthias Ringwald #include "bluetooth_psm.h" 5216ece135SMatthias Ringwald #include "btstack_debug.h" 530e2df43fSMatthias Ringwald #include "btstack_event.h" 543deb3ec6SMatthias Ringwald #include "btstack_memory.h" 550e2df43fSMatthias Ringwald #include "btstack_run_loop.h" 560e2df43fSMatthias Ringwald #include "btstack_util.h" 573deb3ec6SMatthias Ringwald #include "hci.h" 583deb3ec6SMatthias Ringwald #include "hci_dump.h" 5958e8c9f5SMatthias Ringwald #include "hci_event_builder.h" 603deb3ec6SMatthias Ringwald #include "l2cap.h" 611450cdc6SMatthias Ringwald #include "classic/sdp_client.h" 621450cdc6SMatthias Ringwald #include "bluetooth_gatt.h" 631450cdc6SMatthias Ringwald #include "bluetooth_sdp.h" 641450cdc6SMatthias Ringwald #include "classic/sdp_util.h" 653deb3ec6SMatthias Ringwald 664797b71aSMatthias Ringwald #if defined(ENABLE_GATT_OVER_EATT) && !defined(ENABLE_L2CAP_ENHANCED_CREDIT_BASED_FLOW_CONTROL_MODE) 674797b71aSMatthias Ringwald #error "GATT Over EATT requires support for L2CAP Enhanced CoC. Please enable ENABLE_L2CAP_ENHANCED_CREDIT_BASED_FLOW_CONTROL_MODE" 684797b71aSMatthias Ringwald #endif 694797b71aSMatthias Ringwald 70b1da4983SMatthias Ringwald // L2CAP Test Spec p35 defines a minimum of 100 ms, but PTS might indicate an error if we sent after 100 ms 71b1da4983SMatthias Ringwald #define GATT_CLIENT_COLLISION_BACKOFF_MS 150 72b1da4983SMatthias Ringwald 739c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections; 749c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners; 75842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 7658e8c9f5SMatthias Ringwald static btstack_linked_list_t gatt_client_service_changed_handler; 77842492f0SMatthias Ringwald #endif 78361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 79f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration; 80544a5845SMatthias Ringwald static btstack_context_callback_registration_t gatt_client_deferred_event_emit; 81f4b33574SMatthias Ringwald 8211279da7SMatthias Ringwald // GATT Client Configuration 8311279da7SMatthias Ringwald static bool gatt_client_mtu_exchange_enabled; 8411279da7SMatthias Ringwald static gap_security_level_t gatt_client_required_security_level; 855cf6c434SJakob Krantz 863deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size); 87f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 885cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code); 897a766ebfSMatthias Ringwald 907a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 913deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]); 927a766ebfSMatthias Ringwald #endif 933deb3ec6SMatthias Ringwald 9459b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 9559b5e157SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid); 9659b5e157SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status); 9759b5e157SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client); 98180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts); 9959b5e157SMatthias Ringwald #endif 10059b5e157SMatthias Ringwald 10126166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1027627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client); 1036d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts); 10426166ecfSMatthias Ringwald #endif 10526166ecfSMatthias Ringwald 1063deb3ec6SMatthias Ringwald void gatt_client_init(void){ 1073deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 108842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 10958e8c9f5SMatthias Ringwald gatt_client_service_changed_handler = NULL; 110842492f0SMatthias Ringwald #endif 11111279da7SMatthias Ringwald // default configuration 11211279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = true; 11311279da7SMatthias Ringwald gatt_client_required_security_level = LEVEL_0; 11411279da7SMatthias Ringwald 11511279da7SMatthias Ringwald // register for HCI Events 116f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 117361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 118361b1363SMatthias Ringwald 119f4b33574SMatthias Ringwald // register for SM Events 120f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 121f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 122f4b33574SMatthias Ringwald 123361b1363SMatthias Ringwald // and ATT Client PDUs 1243deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 1253deb3ec6SMatthias Ringwald } 1263deb3ec6SMatthias Ringwald 12711279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){ 12811279da7SMatthias Ringwald gatt_client_required_security_level = level; 12911279da7SMatthias Ringwald } 13011279da7SMatthias Ringwald 131ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 132665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 133665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 134665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1355cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1365cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1375cf1669fSMatthias Ringwald return gatt_client; 1383deb3ec6SMatthias Ringwald } 1393deb3ec6SMatthias Ringwald } 1403deb3ec6SMatthias Ringwald return NULL; 1413deb3ec6SMatthias Ringwald } 1423deb3ec6SMatthias Ringwald 143ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1445cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1455cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1465cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1475cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1483deb3ec6SMatthias Ringwald } 1493deb3ec6SMatthias Ringwald 1505cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1518ac3a0b3SMatthias Ringwald log_debug("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1525cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1535cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1545cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1555cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1563deb3ec6SMatthias Ringwald } 1573deb3ec6SMatthias Ringwald 1585cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1598ac3a0b3SMatthias Ringwald log_debug("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1605cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1613deb3ec6SMatthias Ringwald } 1623deb3ec6SMatthias Ringwald 1631dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){ 1641dfae9c7SMatthias Ringwald uint8_t encryption_key_size = gap_encryption_key_size(con_handle); 1651dfae9c7SMatthias Ringwald if (encryption_key_size == 0) return LEVEL_0; 1661dfae9c7SMatthias Ringwald 167ff3f1026SMatthias Ringwald bool authenticated = gap_authenticated(con_handle); 1681dfae9c7SMatthias Ringwald if (!authenticated) return LEVEL_2; 1691dfae9c7SMatthias Ringwald 1701dfae9c7SMatthias Ringwald return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3; 1711dfae9c7SMatthias Ringwald } 1721dfae9c7SMatthias Ringwald 1735cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 174665d90f2SMatthias Ringwald btstack_linked_item_t *it; 175a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1765cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1775cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1785cf1669fSMatthias Ringwald return gatt_client; 1793deb3ec6SMatthias Ringwald } 1803deb3ec6SMatthias Ringwald } 1813deb3ec6SMatthias Ringwald return NULL; 1823deb3ec6SMatthias Ringwald } 1833deb3ec6SMatthias Ringwald 1843deb3ec6SMatthias Ringwald 1856b65794dSMilanka Ringwald // @return gatt_client context 1863deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 18740faeb84SMilanka Ringwald static uint8_t gatt_client_provide_context_for_handle(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 1885cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 18940faeb84SMilanka Ringwald 19040faeb84SMilanka Ringwald if (gatt_client != NULL){ 19140faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 19240faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 19340faeb84SMilanka Ringwald } 1943deb3ec6SMatthias Ringwald 195ae1d1237SMatthias Ringwald // bail if no such hci connection 1960e0bba86SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 1970e0bba86SMatthias Ringwald if (hci_connection == NULL){ 198ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 19940faeb84SMilanka Ringwald *out_gatt_client = NULL; 20040faeb84SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 201ae1d1237SMatthias Ringwald } 20240faeb84SMilanka Ringwald 2035cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 20440faeb84SMilanka Ringwald if (gatt_client == NULL){ 20540faeb84SMilanka Ringwald *out_gatt_client = NULL; 20640faeb84SMilanka Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 20740faeb84SMilanka Ringwald } 2083deb3ec6SMatthias Ringwald // init state 209e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_LE; 2105cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 2115cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 2121dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 21311279da7SMatthias Ringwald if (gatt_client_mtu_exchange_enabled){ 2145cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 2155cf6c434SJakob Krantz } else { 2165cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 2175cf6c434SJakob Krantz } 218052dc82aSMatthias Ringwald gatt_client->state = P_READY; 219d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_W2_SEND; 220cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 221cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 222cbd76cecSMatthias Ringwald #endif 2235cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 2240e0bba86SMatthias Ringwald 2250e0bba86SMatthias Ringwald // get unenhanced att bearer state 2260e0bba86SMatthias Ringwald if (hci_connection->att_connection.mtu_exchanged){ 2270e0bba86SMatthias Ringwald gatt_client->mtu = hci_connection->att_connection.mtu; 2280e0bba86SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 2290e0bba86SMatthias Ringwald } 23040faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 23140faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 2323deb3ec6SMatthias Ringwald } 2333deb3ec6SMatthias Ringwald 234de27733dSMatthias Ringwald static bool is_ready(gatt_client_t * gatt_client){ 235052dc82aSMatthias Ringwald return gatt_client->state == P_READY; 236de27733dSMatthias Ringwald } 237de27733dSMatthias Ringwald 238de27733dSMatthias Ringwald static uint8_t gatt_client_provide_context_for_request(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 239de27733dSMatthias Ringwald gatt_client_t * gatt_client = NULL; 240de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 24140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 24240faeb84SMilanka Ringwald return status; 24340faeb84SMilanka Ringwald } 244de27733dSMatthias Ringwald 2457627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2467627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 2477627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 2487627a0deSMatthias Ringwald gatt_client_t * eatt_client = NULL; 2497627a0deSMatthias Ringwald // find free eatt client 2507627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 2517627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 2527627a0deSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 253052dc82aSMatthias Ringwald if (client->state == P_READY){ 2547627a0deSMatthias Ringwald eatt_client = client; 2557627a0deSMatthias Ringwald break; 2567627a0deSMatthias Ringwald } 2577627a0deSMatthias Ringwald } 2587627a0deSMatthias Ringwald if (eatt_client == NULL){ 2597627a0deSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2607627a0deSMatthias Ringwald } 2617627a0deSMatthias Ringwald gatt_client = eatt_client; 2627627a0deSMatthias Ringwald } 2637627a0deSMatthias Ringwald #endif 2647627a0deSMatthias Ringwald 265643a64fcSMatthias Ringwald if (is_ready(gatt_client) == false){ 266de27733dSMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2673deb3ec6SMatthias Ringwald } 2683deb3ec6SMatthias Ringwald 269de27733dSMatthias Ringwald gatt_client_timeout_start(gatt_client); 270de27733dSMatthias Ringwald 271de27733dSMatthias Ringwald *out_gatt_client = gatt_client; 272de27733dSMatthias Ringwald 273de27733dSMatthias Ringwald return status; 2743deb3ec6SMatthias Ringwald } 2753deb3ec6SMatthias Ringwald 276fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 27740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 27840faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 27940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 28040faeb84SMilanka Ringwald return 0; 28140faeb84SMilanka Ringwald } 282aacf1b1aSMilanka Ringwald return is_ready(gatt_client) ? 1 : 0; 2833deb3ec6SMatthias Ringwald } 2843deb3ec6SMatthias Ringwald 2855cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 28611279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = enabled != 0; 2875cf6c434SJakob Krantz } 2885cf6c434SJakob Krantz 289fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 29040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 29140faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 29240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 29340faeb84SMilanka Ringwald return status; 29440faeb84SMilanka Ringwald } 2957d2258b3SMilanka Ringwald 2965cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2975cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2987d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2993deb3ec6SMatthias Ringwald } 3003deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 301616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 3023deb3ec6SMatthias Ringwald } 3033deb3ec6SMatthias Ringwald 3049228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) { 3057627a0deSMatthias Ringwald switch (gatt_client->bearer_type){ 3067627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 3077627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 3087627a0deSMatthias Ringwald #endif 3097627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3109228fd32SMatthias Ringwald l2cap_reserve_packet_buffer(); 3119228fd32SMatthias Ringwald return l2cap_get_outgoing_buffer(); 3127627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3137627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3147627a0deSMatthias Ringwald return gatt_client->eatt_storage_buffer; 3157627a0deSMatthias Ringwald #endif 3167627a0deSMatthias Ringwald default: 3177627a0deSMatthias Ringwald btstack_unreachable(); 3187627a0deSMatthias Ringwald break; 3197627a0deSMatthias Ringwald } 3207627a0deSMatthias Ringwald return NULL; 3219228fd32SMatthias Ringwald } 3229228fd32SMatthias Ringwald 3233deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3246e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){ 32546012949SMatthias Ringwald switch (gatt_client->bearer_type){ 32646012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3276e7b444cSMatthias Ringwald return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len); 32846012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 32946012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 33046012949SMatthias Ringwald return l2cap_send_prepared(gatt_client->l2cap_cid, len); 33146012949SMatthias Ringwald #endif 3327627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3337627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3347627a0deSMatthias Ringwald return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len); 3357627a0deSMatthias Ringwald #endif 33646012949SMatthias Ringwald default: 33746012949SMatthias Ringwald btstack_unreachable(); 33846012949SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 33946012949SMatthias Ringwald } 3403deb3ec6SMatthias Ringwald } 3413deb3ec6SMatthias Ringwald 3423deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3436e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) { 3449228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3456e7b444cSMatthias Ringwald 3466e7b444cSMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 3476e7b444cSMatthias Ringwald 3486e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 1); 3496e7b444cSMatthias Ringwald } 3506e7b444cSMatthias Ringwald 3516e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE 3526e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle, 3536e7b444cSMatthias Ringwald uint16_t end_handle) { 3549228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3556e7b444cSMatthias Ringwald 3563deb3ec6SMatthias Ringwald request[0] = request_type; 357f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 358f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3593deb3ec6SMatthias Ringwald 3606e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 3613deb3ec6SMatthias Ringwald } 3623deb3ec6SMatthias Ringwald 3633deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3646e7b444cSMatthias Ringwald static uint8_t 3656e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type, 3666e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) { 3679228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3683deb3ec6SMatthias Ringwald request[0] = request_type; 3699228fd32SMatthias Ringwald 370f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 371f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 372f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 3736535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 3743deb3ec6SMatthias Ringwald 3756e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7u + value_size); 3763deb3ec6SMatthias Ringwald } 3773deb3ec6SMatthias Ringwald 3783deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3796e7b444cSMatthias Ringwald static uint8_t 3806e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16, 3816e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3829228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3836e7b444cSMatthias Ringwald 3843deb3ec6SMatthias Ringwald request[0] = request_type; 385f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 386f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 387f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 3883deb3ec6SMatthias Ringwald 3896e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7); 3903deb3ec6SMatthias Ringwald } 3913deb3ec6SMatthias Ringwald 3923deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3936e7b444cSMatthias Ringwald static uint8_t 3946e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128, 3956e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3969228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3976e7b444cSMatthias Ringwald 3983deb3ec6SMatthias Ringwald request[0] = request_type; 399f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 400f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 4019c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 4023deb3ec6SMatthias Ringwald 4036e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 21); 4043deb3ec6SMatthias Ringwald } 4053deb3ec6SMatthias Ringwald 4063deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4076e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) { 4089228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4096e7b444cSMatthias Ringwald 4103deb3ec6SMatthias Ringwald request[0] = request_type; 411f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4123deb3ec6SMatthias Ringwald 4136e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 4143deb3ec6SMatthias Ringwald } 4153deb3ec6SMatthias Ringwald 4163deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4176e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4186e7b444cSMatthias Ringwald uint16_t value_offset) { 4199228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4209228fd32SMatthias Ringwald 4213deb3ec6SMatthias Ringwald request[0] = request_type; 422f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 423f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4243deb3ec6SMatthias Ringwald 4256e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 4263deb3ec6SMatthias Ringwald } 4273deb3ec6SMatthias Ringwald 4286e7b444cSMatthias Ringwald static uint8_t 429f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) { 4309228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4319228fd32SMatthias Ringwald 432f125a8efSMatthias Ringwald request[0] = opcode; 4339228fd32SMatthias Ringwald uint16_t i; 4349228fd32SMatthias Ringwald uint16_t offset = 1; 4353deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 436f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 4373deb3ec6SMatthias Ringwald offset += 2; 4383deb3ec6SMatthias Ringwald } 43925b7c058SMilanka Ringwald 4406e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, offset); 4413deb3ec6SMatthias Ringwald } 4423deb3ec6SMatthias Ringwald 443f125a8efSMatthias Ringwald static uint8_t 444f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 445f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST); 446f125a8efSMatthias Ringwald } 447f125a8efSMatthias Ringwald 448f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 449f125a8efSMatthias Ringwald static uint8_t 450f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 451f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_VARIABLE_REQ); 452f125a8efSMatthias Ringwald } 453f125a8efSMatthias Ringwald #endif 454f125a8efSMatthias Ringwald 4557a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4563deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4576e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle, 4586e7b444cSMatthias Ringwald uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) { 4599228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4609228fd32SMatthias Ringwald 4613deb3ec6SMatthias Ringwald request[0] = request_type; 462f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4636535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 464f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 4659c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 46625b7c058SMilanka Ringwald 4676e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3 + value_length + 12); 4683deb3ec6SMatthias Ringwald } 4697a766ebfSMatthias Ringwald #endif 4703deb3ec6SMatthias Ringwald 4713deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4726e7b444cSMatthias Ringwald static uint8_t 4736e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length, 4746e7b444cSMatthias Ringwald uint8_t *value) { 4759228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4769228fd32SMatthias Ringwald 4773deb3ec6SMatthias Ringwald request[0] = request_type; 478f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4796535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 4803deb3ec6SMatthias Ringwald 4816e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3u + value_length); 4823deb3ec6SMatthias Ringwald } 4833deb3ec6SMatthias Ringwald 4843deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4856e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) { 4869228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4879228fd32SMatthias Ringwald 4883deb3ec6SMatthias Ringwald request[0] = request_type; 4893deb3ec6SMatthias Ringwald request[1] = execute_write; 49025b7c058SMilanka Ringwald 4916e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 2); 4923deb3ec6SMatthias Ringwald } 4933deb3ec6SMatthias Ringwald 4943deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4956e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4966e7b444cSMatthias Ringwald uint16_t value_offset, uint16_t blob_length, uint8_t *value) { 4979228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4989228fd32SMatthias Ringwald 4993deb3ec6SMatthias Ringwald request[0] = request_type; 500f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 501f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 5026535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 5033deb3ec6SMatthias Ringwald 5046e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5u + blob_length); 5053deb3ec6SMatthias Ringwald } 5063deb3ec6SMatthias Ringwald 5076e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) { 5089228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 5099228fd32SMatthias Ringwald 5103deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 5119228fd32SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 512f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 51325b7c058SMilanka Ringwald 5146e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 5153deb3ec6SMatthias Ringwald } 5163deb3ec6SMatthias Ringwald 5175cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 518dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 5195cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 5203deb3ec6SMatthias Ringwald return 0; 5213deb3ec6SMatthias Ringwald } 5225cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 5233deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 5243deb3ec6SMatthias Ringwald return rest_length; 5253deb3ec6SMatthias Ringwald } 5263deb3ec6SMatthias Ringwald return max_blob_length; 5273deb3ec6SMatthias Ringwald } 5283deb3ec6SMatthias Ringwald 5295cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 5306e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST, 5316e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5326e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5333deb3ec6SMatthias Ringwald } 5343deb3ec6SMatthias Ringwald 5355cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 53652377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5373deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 5385cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 5396e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5406e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 5413deb3ec6SMatthias Ringwald return; 5423deb3ec6SMatthias Ringwald } 5433deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5445cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 5456e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5466e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16); 5473deb3ec6SMatthias Ringwald } 5483deb3ec6SMatthias Ringwald 5495cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 5505cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 5513deb3ec6SMatthias Ringwald } 5523deb3ec6SMatthias Ringwald 5535cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 5546e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle); 5553deb3ec6SMatthias Ringwald } 5563deb3ec6SMatthias Ringwald 5575cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 5586e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5596e7b444cSMatthias Ringwald GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle, 5606e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5613deb3ec6SMatthias Ringwald } 5623deb3ec6SMatthias Ringwald 5635cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 5646e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5656e7b444cSMatthias Ringwald GATT_CHARACTERISTICS_UUID, gatt_client->start_group_handle, 5666e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5673deb3ec6SMatthias Ringwald } 5683deb3ec6SMatthias Ringwald 5695cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 5706e7b444cSMatthias Ringwald att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle, 5716e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5723deb3ec6SMatthias Ringwald } 5733deb3ec6SMatthias Ringwald 5745cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 5756e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 5763deb3ec6SMatthias Ringwald } 5773deb3ec6SMatthias Ringwald 5785cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 57952377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5806e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5816e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5826e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5833deb3ec6SMatthias Ringwald } else { 5846e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5856e7b444cSMatthias Ringwald gatt_client->uuid128, gatt_client->start_group_handle, 5866e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5873deb3ec6SMatthias Ringwald } 5883deb3ec6SMatthias Ringwald } 5893deb3ec6SMatthias Ringwald 5905cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 59130952227SMilanka Ringwald if (gatt_client->attribute_offset == 0){ 5926e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 59330952227SMilanka Ringwald } else { 5946e7b444cSMatthias Ringwald att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle, 5956e7b444cSMatthias Ringwald gatt_client->attribute_offset); 5963deb3ec6SMatthias Ringwald } 59730952227SMilanka Ringwald } 5983deb3ec6SMatthias Ringwald 5995cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 6006e7b444cSMatthias Ringwald att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 6013deb3ec6SMatthias Ringwald } 6023deb3ec6SMatthias Ringwald 603f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 604f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){ 605f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 606f125a8efSMatthias Ringwald } 607f125a8efSMatthias Ringwald #endif 608f125a8efSMatthias Ringwald 6095cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 6106e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length, 6116e7b444cSMatthias Ringwald gatt_client->attribute_value); 6123deb3ec6SMatthias Ringwald } 6133deb3ec6SMatthias Ringwald 6145cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6156e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2, 6166e7b444cSMatthias Ringwald gatt_client->client_characteristic_configuration_value); 6173deb3ec6SMatthias Ringwald } 6183deb3ec6SMatthias Ringwald 6195cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 6206e7b444cSMatthias Ringwald att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle, 6216e7b444cSMatthias Ringwald gatt_client->attribute_offset, write_blob_length(gatt_client), 6226e7b444cSMatthias Ringwald gatt_client->attribute_value); 6233deb3ec6SMatthias Ringwald } 6243deb3ec6SMatthias Ringwald 6255cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 6266e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1); 6273deb3ec6SMatthias Ringwald } 6283deb3ec6SMatthias Ringwald 6295cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 6306e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0); 6313deb3ec6SMatthias Ringwald } 6323deb3ec6SMatthias Ringwald 633abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 6345cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6356e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 6366e7b444cSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, 6376e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle); 6383deb3ec6SMatthias Ringwald } 639abdc9fb5SMatthias Ringwald #endif 6403deb3ec6SMatthias Ringwald 6415cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 6426e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 6433deb3ec6SMatthias Ringwald } 6443deb3ec6SMatthias Ringwald 6457a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 6465cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 6476e7b444cSMatthias Ringwald att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, 6486e7b444cSMatthias Ringwald gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, 6496e7b444cSMatthias Ringwald gatt_client->cmac); 6503deb3ec6SMatthias Ringwald } 6517a766ebfSMatthias Ringwald #endif 6523deb3ec6SMatthias Ringwald 6533deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 65439ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6553deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65639ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6574ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 6583deb3ec6SMatthias Ringwald } 6593deb3ec6SMatthias Ringwald 6603deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 66139ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6623deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 66339ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6644ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 6653deb3ec6SMatthias Ringwald } 6663deb3ec6SMatthias Ringwald 6673deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 66839ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6693deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 67039ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 671f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 6723deb3ec6SMatthias Ringwald } 6733deb3ec6SMatthias Ringwald 674842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 67558e8c9f5SMatthias Ringwald static void gatt_client_service_emit_event(gatt_client_t * gatt_client, uint8_t * event, uint16_t size){ 67658e8c9f5SMatthias Ringwald btstack_linked_list_iterator_t it; 67758e8c9f5SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_service_changed_handler); 67858e8c9f5SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 67958e8c9f5SMatthias Ringwald btstack_packet_callback_registration_t *callback = (btstack_packet_callback_registration_t *) btstack_linked_list_iterator_next(&it); 68058e8c9f5SMatthias Ringwald (*callback->callback)(HCI_EVENT_PACKET, (uint16_t) gatt_client->con_handle, event, size); 68158e8c9f5SMatthias Ringwald } 68258e8c9f5SMatthias Ringwald } 68358e8c9f5SMatthias Ringwald 68458e8c9f5SMatthias Ringwald static void 68558e8c9f5SMatthias Ringwald gatt_client_service_emit_database_hash(gatt_client_t *gatt_client, const uint8_t *value, uint16_t value_len) { 68658e8c9f5SMatthias Ringwald if (value_len == 16){ 68758e8c9f5SMatthias Ringwald uint8_t event[21]; 68858e8c9f5SMatthias Ringwald hci_event_builder_context_t context; 68958e8c9f5SMatthias Ringwald hci_event_builder_init(&context, event, sizeof(event), HCI_EVENT_GATTSERVICE_META, GATTSERVICE_SUBEVENT_GATT_DATABASE_HASH); 69058e8c9f5SMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 69158e8c9f5SMatthias Ringwald hci_event_builder_add_bytes(&context, value, 16); 69258e8c9f5SMatthias Ringwald gatt_client_service_emit_event(gatt_client, event, hci_event_builder_get_length(&context)); 69358e8c9f5SMatthias Ringwald } 69458e8c9f5SMatthias Ringwald } 69558e8c9f5SMatthias Ringwald 69658e8c9f5SMatthias Ringwald static void 69758e8c9f5SMatthias Ringwald gatt_client_service_emit_service_changed(gatt_client_t *gatt_client, const uint8_t *value, uint16_t value_len) { 69858e8c9f5SMatthias Ringwald if (value_len == 4){ 69958e8c9f5SMatthias Ringwald uint8_t event[9]; 70058e8c9f5SMatthias Ringwald hci_event_builder_context_t context; 70158e8c9f5SMatthias Ringwald hci_event_builder_init(&context, event, sizeof(event), HCI_EVENT_GATTSERVICE_META, GATTSERVICE_SUBEVENT_GATT_SERVICE_CHANGED); 70258e8c9f5SMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 70358e8c9f5SMatthias Ringwald hci_event_builder_add_bytes(&context, value, 4); 70458e8c9f5SMatthias Ringwald gatt_client_service_emit_event(gatt_client, event, hci_event_builder_get_length(&context)); 70558e8c9f5SMatthias Ringwald } 70658e8c9f5SMatthias Ringwald } 70758e8c9f5SMatthias Ringwald 708d9ced76fSMatthias Ringwald static void gatt_client_service_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 709e2c98440SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 710e2c98440SMatthias Ringwald UNUSED(size); // ok: there is no channel 711e2c98440SMatthias Ringwald 712d9ced76fSMatthias Ringwald hci_con_handle_t con_handle; 713d9ced76fSMatthias Ringwald gatt_client_t *gatt_client; 714d9ced76fSMatthias Ringwald gatt_client_service_t service; 715d9ced76fSMatthias Ringwald gatt_client_characteristic_t characteristic; 716d9ced76fSMatthias Ringwald switch (packet_type) { 717d9ced76fSMatthias Ringwald case HCI_EVENT_PACKET: 718d9ced76fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 719d9ced76fSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 720d9ced76fSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 721d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 722d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 723d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DISCOVER_W4_DONE); 724d9ced76fSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 725d9ced76fSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 726d9ced76fSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 727d9ced76fSMatthias Ringwald break; 728d9ced76fSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 729d9ced76fSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 730d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 731d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 732d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE); 733d9ced76fSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 734d9ced76fSMatthias Ringwald switch (characteristic.uuid16){ 735d9ced76fSMatthias Ringwald case ORG_BLUETOOTH_CHARACTERISTIC_GATT_SERVICE_CHANGED: 736d9ced76fSMatthias Ringwald gatt_client->gatt_service_changed_value_handle = characteristic.value_handle; 737d9ced76fSMatthias Ringwald gatt_client->gatt_service_changed_end_handle = characteristic.end_handle; 738d9ced76fSMatthias Ringwald break; 739d9ced76fSMatthias Ringwald case ORG_BLUETOOTH_CHARACTERISTIC_DATABASE_HASH: 740d9ced76fSMatthias Ringwald gatt_client->gatt_service_database_hash_value_handle = characteristic.value_handle; 741d9ced76fSMatthias Ringwald gatt_client->gatt_service_database_hash_end_handle = characteristic.end_handle; 742d9ced76fSMatthias Ringwald break; 743d9ced76fSMatthias Ringwald default: 744d9ced76fSMatthias Ringwald break; 745d9ced76fSMatthias Ringwald } 746d9ced76fSMatthias Ringwald break; 747d9ced76fSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 748d9ced76fSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 749d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 750d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 751d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE); 75258e8c9f5SMatthias Ringwald gatt_client_service_emit_database_hash(gatt_client, 75358e8c9f5SMatthias Ringwald gatt_event_characteristic_value_query_result_get_value(packet), 75458e8c9f5SMatthias Ringwald gatt_event_characteristic_value_query_result_get_value_length(packet)); 755d9ced76fSMatthias Ringwald break; 756d9ced76fSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 757d9ced76fSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 758d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 759d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 760d9ced76fSMatthias Ringwald switch (gatt_client->gatt_service_state) { 761d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_W4_DONE: 762d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W2_SEND; 763d9ced76fSMatthias Ringwald break; 764d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE: 765d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W2_SEND; 766d9ced76fSMatthias Ringwald break; 767d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W4_DONE: 768d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W2_SEND; 769d9ced76fSMatthias Ringwald break; 770d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE: 771d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W2_SEND; 772d9ced76fSMatthias Ringwald break; 773d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W4_DONE: 774d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DONE; 775d9ced76fSMatthias Ringwald break; 776d9ced76fSMatthias Ringwald default: 777d9ced76fSMatthias Ringwald btstack_unreachable(); 778d9ced76fSMatthias Ringwald break; 779d9ced76fSMatthias Ringwald } 780d9ced76fSMatthias Ringwald break; 781d9ced76fSMatthias Ringwald default: 782d9ced76fSMatthias Ringwald break; 783d9ced76fSMatthias Ringwald } 784d9ced76fSMatthias Ringwald break; 785d9ced76fSMatthias Ringwald default: 786d9ced76fSMatthias Ringwald break; 787d9ced76fSMatthias Ringwald } 788d9ced76fSMatthias Ringwald } 789842492f0SMatthias Ringwald #endif 790d9ced76fSMatthias Ringwald 79153e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){ 79219c614acSMatthias Ringwald 79319c614acSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 79419c614acSMatthias Ringwald // if eatt is ready, notify all clients that can send a query 79519c614acSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 79619c614acSMatthias Ringwald btstack_linked_list_iterator_t it; 79719c614acSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 79819c614acSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 79919c614acSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 800052dc82aSMatthias Ringwald if (client->state == P_READY){ 80119c614acSMatthias Ringwald // call callback 80219c614acSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 80319c614acSMatthias Ringwald if (callback == NULL) { 80419c614acSMatthias Ringwald return; 80519c614acSMatthias Ringwald } 80619c614acSMatthias Ringwald (*callback->callback)(callback->context); 80719c614acSMatthias Ringwald } 80819c614acSMatthias Ringwald } 80919c614acSMatthias Ringwald return; 81019c614acSMatthias Ringwald } 81119c614acSMatthias Ringwald #endif 81219c614acSMatthias Ringwald 813842492f0SMatthias Ringwald while (gatt_client->state == P_READY){ 814842492f0SMatthias Ringwald bool query_sent = false; 815842492f0SMatthias Ringwald UNUSED(query_sent); 816842492f0SMatthias Ringwald 817842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 818d9ced76fSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 819d9ced76fSMatthias Ringwald gatt_client_service_t gatt_service; 820d9ced76fSMatthias Ringwald gatt_client_characteristic_t characteristic; 821d9ced76fSMatthias Ringwald switch (gatt_client->gatt_service_state){ 822d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_W2_SEND: 823d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_W4_DONE; 824d9ced76fSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_service_packet_handler, 825d9ced76fSMatthias Ringwald gatt_client->con_handle, 826d9ced76fSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 827d9ced76fSMatthias Ringwald query_sent = true; 828d9ced76fSMatthias Ringwald break; 829d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W2_SEND: 830d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle != 0){ 831d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE; 832d9ced76fSMatthias Ringwald gatt_service.start_group_handle = gatt_client->gatt_service_start_group_handle; 833d9ced76fSMatthias Ringwald gatt_service.end_group_handle = gatt_client->gatt_service_end_group_handle; 834d9ced76fSMatthias Ringwald status = gatt_client_discover_characteristics_for_service(&gatt_client_service_packet_handler, gatt_client->con_handle, &gatt_service); 835d9ced76fSMatthias Ringwald query_sent = true; 836d9ced76fSMatthias Ringwald break; 837d9ced76fSMatthias Ringwald } 838d9ced76fSMatthias Ringwald 839d9ced76fSMatthias Ringwald /* fall through */ 840d9ced76fSMatthias Ringwald 841d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W2_SEND: 842d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_changed_value_handle != 0){ 843d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W4_DONE; 844d9ced76fSMatthias Ringwald characteristic.value_handle = gatt_client->gatt_service_changed_value_handle; 845d9ced76fSMatthias Ringwald characteristic.end_handle = gatt_client->gatt_service_changed_end_handle; 846d9ced76fSMatthias Ringwald // we assume good case. We cannot do much otherwise 847d9ced76fSMatthias Ringwald characteristic.properties = ATT_PROPERTY_INDICATE; 848d9ced76fSMatthias Ringwald status = gatt_client_write_client_characteristic_configuration(&gatt_client_service_packet_handler, 849d9ced76fSMatthias Ringwald gatt_client->con_handle, &characteristic, 850d9ced76fSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION); 851d9ced76fSMatthias Ringwald query_sent = true; 852d9ced76fSMatthias Ringwald break; 853d9ced76fSMatthias Ringwald } 854d9ced76fSMatthias Ringwald 855d9ced76fSMatthias Ringwald /* fall through */ 856d9ced76fSMatthias Ringwald 857d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W2_SEND: 858d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_database_hash_value_handle != 0){ 859d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE; 860d9ced76fSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_service_packet_handler, 861d9ced76fSMatthias Ringwald gatt_client->con_handle, 862d9ced76fSMatthias Ringwald 0x0001, 0xffff, ORG_BLUETOOTH_CHARACTERISTIC_DATABASE_HASH); 863d9ced76fSMatthias Ringwald query_sent = true; 864d9ced76fSMatthias Ringwald break; 865d9ced76fSMatthias Ringwald } 866d9ced76fSMatthias Ringwald 867d9ced76fSMatthias Ringwald /* fall through */ 868d9ced76fSMatthias Ringwald 869d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W2_SEND: 870d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_database_hash_value_handle != 0) { 871d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W4_DONE; 872d9ced76fSMatthias Ringwald characteristic.value_handle = gatt_client->gatt_service_database_hash_value_handle; 873d9ced76fSMatthias Ringwald characteristic.end_handle = gatt_client->gatt_service_database_hash_end_handle; 874d9ced76fSMatthias Ringwald // we assume good case. We cannot do much otherwise 875d9ced76fSMatthias Ringwald characteristic.properties = ATT_PROPERTY_INDICATE; 876d9ced76fSMatthias Ringwald status = gatt_client_write_client_characteristic_configuration(&gatt_client_service_packet_handler, 877d9ced76fSMatthias Ringwald gatt_client->con_handle, 878d9ced76fSMatthias Ringwald &characteristic, 879d9ced76fSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION); 880d9ced76fSMatthias Ringwald query_sent = true; 881d9ced76fSMatthias Ringwald break; 882d9ced76fSMatthias Ringwald } 883d9ced76fSMatthias Ringwald 884d9ced76fSMatthias Ringwald // DONE 885d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DONE; 886d9ced76fSMatthias Ringwald break; 887d9ced76fSMatthias Ringwald default: 888d9ced76fSMatthias Ringwald break; 889d9ced76fSMatthias Ringwald } 890d9ced76fSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 891d9ced76fSMatthias Ringwald UNUSED(status); 892d9ced76fSMatthias Ringwald if (query_sent){ 893d9ced76fSMatthias Ringwald continue; 894d9ced76fSMatthias Ringwald } 895842492f0SMatthias Ringwald #endif 896d9ced76fSMatthias Ringwald 89726166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 898d9ced76fSMatthias Ringwald query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client); 89926166ecfSMatthias Ringwald if (query_sent){ 90026166ecfSMatthias Ringwald continue; 90126166ecfSMatthias Ringwald } 90226166ecfSMatthias Ringwald #endif 90353e9c18fSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 90409834412SMatthias Ringwald if (callback == NULL) { 90509834412SMatthias Ringwald return; 90653e9c18fSMatthias Ringwald } 90709834412SMatthias Ringwald (*callback->callback)(callback->context); 90853e9c18fSMatthias Ringwald } 90953e9c18fSMatthias Ringwald } 91053e9c18fSMatthias Ringwald 91123d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 91223d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) { 91323d583b8SMatthias Ringwald // ignore messages until re-encryption is complete 91423d583b8SMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 91523d583b8SMatthias Ringwald 91623d583b8SMatthias Ringwald // after that ignore if bonded but not encrypted 91723d583b8SMatthias Ringwald return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0); 91823d583b8SMatthias Ringwald } 91923d583b8SMatthias Ringwald 9209c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 9219c662c9bSMatthias Ringwald if (!callback) return; 9229da9850bSMatthias Ringwald hci_dump_btstack_event(packet, size); 9239c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 9243deb3ec6SMatthias Ringwald } 9253deb3ec6SMatthias Ringwald 926711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 927665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 9289c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 929665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 93086c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 931b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 932b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 93386c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 9343deb3ec6SMatthias Ringwald } 9353deb3ec6SMatthias Ringwald } 9363deb3ec6SMatthias Ringwald 9375cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 93888371317SMatthias Ringwald // @format H122 93988371317SMatthias Ringwald uint8_t packet[9]; 9406a88036eSMatthias Ringwald hci_event_builder_context_t context; 9416a88036eSMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_QUERY_COMPLETE, 0); 9426a88036eSMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 94388371317SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->service_id); 94488371317SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->connection_id); 9456a88036eSMatthias Ringwald hci_event_builder_add_08(&context, att_status); 9466a88036eSMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 9473deb3ec6SMatthias Ringwald } 9483deb3ec6SMatthias Ringwald 949045d700dSDavid 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){ 950*521f5820SMatthias Ringwald // @format H22X 951*521f5820SMatthias Ringwald uint8_t packet[28]; 952c668d4cfSMatthias Ringwald hci_event_builder_context_t context; 953c668d4cfSMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_SERVICE_QUERY_RESULT, 0); 954c668d4cfSMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 955*521f5820SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->service_id); 956*521f5820SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->connection_id); 957c668d4cfSMatthias Ringwald hci_event_builder_add_16(&context, start_group_handle); 958c668d4cfSMatthias Ringwald hci_event_builder_add_16(&context, end_group_handle); 959c668d4cfSMatthias Ringwald hci_event_builder_add_128(&context, uuid128); 960c668d4cfSMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 9613deb3ec6SMatthias Ringwald } 9623deb3ec6SMatthias Ringwald 963045d700dSDavid 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){ 9643deb3ec6SMatthias Ringwald // @format HX 9653deb3ec6SMatthias Ringwald uint8_t packet[26]; 966d8ef101dSMatthias Ringwald hci_event_builder_context_t context; 967d8ef101dSMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT, 0); 968d8ef101dSMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 969d8ef101dSMatthias Ringwald hci_event_builder_add_16(&context, include_handle); 970d8ef101dSMatthias Ringwald hci_event_builder_add_16(&context, start_group_handle); 971d8ef101dSMatthias Ringwald hci_event_builder_add_16(&context, end_group_handle); 972d8ef101dSMatthias Ringwald hci_event_builder_add_128(&context, uuid128); 973d8ef101dSMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 9743deb3ec6SMatthias Ringwald } 9753deb3ec6SMatthias Ringwald 9765cf1669fSMatthias 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, 977045d700dSDavid Lechner uint16_t properties, const uint8_t * uuid128){ 9783deb3ec6SMatthias Ringwald // @format HY 9793deb3ec6SMatthias Ringwald uint8_t packet[28]; 980b5a7d6a2SMatthias Ringwald hci_event_builder_context_t context; 981b5a7d6a2SMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_CHARACTERISTIC_QUERY_RESULT, 0); 982b5a7d6a2SMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 983b5a7d6a2SMatthias Ringwald hci_event_builder_add_16(&context, start_handle); 984b5a7d6a2SMatthias Ringwald hci_event_builder_add_16(&context, value_handle); 985b5a7d6a2SMatthias Ringwald hci_event_builder_add_16(&context, end_handle); 986b5a7d6a2SMatthias Ringwald hci_event_builder_add_16(&context, properties); 987b5a7d6a2SMatthias Ringwald hci_event_builder_add_128(&context, uuid128); 988b5a7d6a2SMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 9893deb3ec6SMatthias Ringwald } 9903deb3ec6SMatthias Ringwald 9913deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 992045d700dSDavid Lechner gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 9933deb3ec6SMatthias Ringwald // @format HZ 9943deb3ec6SMatthias Ringwald uint8_t packet[22]; 9951cfd1613SMatthias Ringwald hci_event_builder_context_t context; 9961cfd1613SMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT, 0); 9971cfd1613SMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 9981cfd1613SMatthias Ringwald hci_event_builder_add_16(&context, descriptor_handle); 9991cfd1613SMatthias Ringwald hci_event_builder_add_128(&context, uuid128); 10001cfd1613SMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 10013deb3ec6SMatthias Ringwald } 10023deb3ec6SMatthias Ringwald 10035cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 10048f37572aSJakob Krantz // @format H2 10058f37572aSJakob Krantz uint8_t packet[6]; 10068f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 10074ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 10085cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 10098f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 10105cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 10115cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 10128f37572aSJakob Krantz } 101323d583b8SMatthias Ringwald 101423d583b8SMatthias Ringwald // helper 101523d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) { 1016052dc82aSMatthias Ringwald gatt_client->state = P_READY; 101723d583b8SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 101823d583b8SMatthias Ringwald emit_gatt_complete_event(gatt_client, att_status); 101923d583b8SMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 102023d583b8SMatthias Ringwald } 102123d583b8SMatthias Ringwald 102223d583b8SMatthias Ringwald // @return packet pointer 102323d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 102423d583b8SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 8 10258450fbf5SMatthias Ringwald static uint8_t * 10268450fbf5SMatthias Ringwald setup_characteristic_value_packet(const gatt_client_t *gatt_client, uint8_t type, uint16_t attribute_handle, 10278450fbf5SMatthias Ringwald uint8_t *value, uint16_t length) { 102823d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 102923d583b8SMatthias Ringwald // copy value into test packet for testing 103023d583b8SMatthias Ringwald static uint8_t packet[1000]; 1031f51e6883SMatthias Ringwald memcpy(&packet[CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE], value, length); 103223d583b8SMatthias Ringwald #else 103323d583b8SMatthias Ringwald // before the value inside the ATT PDU 103423d583b8SMatthias Ringwald uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 103523d583b8SMatthias Ringwald #endif 103623d583b8SMatthias Ringwald packet[0] = type; 103723d583b8SMatthias Ringwald packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 10388450fbf5SMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 103923d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 104023d583b8SMatthias Ringwald little_endian_store_16(packet, 6, length); 104123d583b8SMatthias Ringwald return packet; 104223d583b8SMatthias Ringwald } 104323d583b8SMatthias Ringwald 104423d583b8SMatthias Ringwald // @return packet pointer 104523d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 104623d583b8SMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 10 1047f51e6883SMatthias Ringwald 1048f51e6883SMatthias Ringwald // L2CAP Header (4) + ACL Header (4) => 8 bytes 1049f51e6883SMatthias Ringwald #if !defined(HCI_INCOMING_PRE_BUFFER_SIZE) || ((HCI_INCOMING_PRE_BUFFER_SIZE < LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 8)) 1050f51e6883SMatthias Ringwald #error "Long Characteristic reads requires HCI_INCOMING_PRE_BUFFER_SIZE >= 2" 1051f51e6883SMatthias Ringwald #endif 1052f51e6883SMatthias Ringwald 10533e78e462SMatthias Ringwald static uint8_t * 10543e78e462SMatthias Ringwald setup_long_characteristic_value_packet(const gatt_client_t *gatt_client, uint8_t type, uint16_t attribute_handle, 10553e78e462SMatthias Ringwald uint16_t offset, uint8_t *value, uint16_t length) { 105623d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 105723d583b8SMatthias Ringwald // avoid using pre ATT headers. 1058464b6e7bSMatthias Ringwald // copy value into test packet for testing 1059464b6e7bSMatthias Ringwald static uint8_t packet[1000]; 1060464b6e7bSMatthias Ringwald memcpy(&packet[LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE], value, length); 1061464b6e7bSMatthias Ringwald #else 106223d583b8SMatthias Ringwald // before the value inside the ATT PDU 106323d583b8SMatthias Ringwald uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 1064464b6e7bSMatthias Ringwald #endif 106523d583b8SMatthias Ringwald packet[0] = type; 106623d583b8SMatthias Ringwald packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 10673e78e462SMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 106823d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 106923d583b8SMatthias Ringwald little_endian_store_16(packet, 6, offset); 107023d583b8SMatthias Ringwald little_endian_store_16(packet, 8, length); 107123d583b8SMatthias Ringwald return packet; 107223d583b8SMatthias Ringwald } 107323d583b8SMatthias Ringwald 1074f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE) 1075f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 1076f7a42e72SMatthias Ringwald #else 1077f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 1078f7a42e72SMatthias Ringwald #endif 1079f7a42e72SMatthias Ringwald 10808f37572aSJakob Krantz /// 10815cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 108239ac9711SMatthias Ringwald if (size < 2) return; 10833deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 10844ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 10853deb3ec6SMatthias Ringwald 10863deb3ec6SMatthias Ringwald int i; 108739ac9711SMatthias Ringwald for (i = 2; (i+attr_length) <= size; i += attr_length){ 1088f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 1089f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 10903deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 10913deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 10923deb3ec6SMatthias Ringwald 10934ea43905SMatthias Ringwald if (uuid_length == 2u){ 1094f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 1095e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 109639ac9711SMatthias Ringwald } else if (uuid_length == 16u) { 10979c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 109839ac9711SMatthias Ringwald } else { 109939ac9711SMatthias Ringwald return; 11003deb3ec6SMatthias Ringwald } 11015cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 11023deb3ec6SMatthias Ringwald } 11033deb3ec6SMatthias Ringwald } 11043deb3ec6SMatthias Ringwald 110523d583b8SMatthias 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){ 11063deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 11073deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 11084ea43905SMatthias Ringwald if (uuid_length == 2u){ 1109f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 1110e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 11114ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 11129c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 1113d73c9dbeSMilanka Ringwald } else { 1114d73c9dbeSMilanka Ringwald return; 11153deb3ec6SMatthias Ringwald } 11163deb3ec6SMatthias Ringwald 11175cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 11183deb3ec6SMatthias Ringwald 11195cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 11205cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 11215cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 11223deb3ec6SMatthias Ringwald 11235cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 11243deb3ec6SMatthias Ringwald 11255cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 11265cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 11273deb3ec6SMatthias Ringwald } 11283deb3ec6SMatthias Ringwald 112923d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 11303deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 11313deb3ec6SMatthias Ringwald 11325cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 11333deb3ec6SMatthias Ringwald 11345cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 11355cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 11363deb3ec6SMatthias Ringwald 11375cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 11383deb3ec6SMatthias Ringwald } 11393deb3ec6SMatthias Ringwald 114023d583b8SMatthias Ringwald 11415cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 11424ea43905SMatthias Ringwald if (size < 2u) return; 11433deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 11444ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 11454ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 11463deb3ec6SMatthias Ringwald int i; 11474ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 1148f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 11493deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 1150f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 115123d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, start_handle - 1u); 115223d583b8SMatthias Ringwald report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], 115323d583b8SMatthias Ringwald uuid_length); 11543deb3ec6SMatthias Ringwald } 11553deb3ec6SMatthias Ringwald } 11563deb3ec6SMatthias Ringwald 11575cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 11583deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 1159e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 11605cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 11615cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 11623deb3ec6SMatthias Ringwald } 11633deb3ec6SMatthias Ringwald 1164045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){ 11655cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 11665cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 11673deb3ec6SMatthias Ringwald } 11683deb3ec6SMatthias Ringwald 11693deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11700fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 11710fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 11728450fbf5SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(gatt_client, GATT_EVENT_NOTIFICATION, value_handle, 11738450fbf5SMatthias Ringwald value, length); 117423d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 11753deb3ec6SMatthias Ringwald } 11763deb3ec6SMatthias Ringwald 11773deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11780fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 11790fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 1180842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 118158e8c9f5SMatthias Ringwald // Directly Handle GATT Service Changed and Database Hash indications 118258e8c9f5SMatthias Ringwald if (value_handle == gatt_client->gatt_service_database_hash_value_handle){ 118358e8c9f5SMatthias Ringwald gatt_client_service_emit_database_hash(gatt_client, value, length); 118458e8c9f5SMatthias Ringwald } 118558e8c9f5SMatthias Ringwald if (value_handle == gatt_client->gatt_service_changed_value_handle){ 118658e8c9f5SMatthias Ringwald gatt_client_service_emit_service_changed(gatt_client, value, length); 118758e8c9f5SMatthias Ringwald } 1188842492f0SMatthias Ringwald #endif 11898450fbf5SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(gatt_client, GATT_EVENT_INDICATION, value_handle, 11908450fbf5SMatthias Ringwald value, length); 119123d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 11923deb3ec6SMatthias Ringwald } 11933deb3ec6SMatthias Ringwald 11943deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11955cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 11968450fbf5SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet( 11978450fbf5SMatthias Ringwald gatt_client, GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, attribute_handle, value, length); 119823d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 11993deb3ec6SMatthias Ringwald } 12003deb3ec6SMatthias Ringwald 12013deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 12025cf1669fSMatthias 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){ 12033e78e462SMatthias Ringwald uint8_t * packet = setup_long_characteristic_value_packet(gatt_client, 12043e78e462SMatthias Ringwald GATT_EVENT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT, 12053e78e462SMatthias Ringwald attribute_handle, value_offset, 12063e78e462SMatthias Ringwald blob, blob_length); 120723d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 12083deb3ec6SMatthias Ringwald } 12093deb3ec6SMatthias Ringwald 12105cf1669fSMatthias 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){ 12119ec2630cSMatthias Ringwald UNUSED(value_offset); 12128450fbf5SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(gatt_client, GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, 12138450fbf5SMatthias Ringwald descriptor_handle, value, 12148450fbf5SMatthias Ringwald value_length); 12155cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 12163deb3ec6SMatthias Ringwald } 12173deb3ec6SMatthias Ringwald 12185cf1669fSMatthias 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){ 12193e78e462SMatthias Ringwald uint8_t * packet = setup_long_characteristic_value_packet(gatt_client, 12203e78e462SMatthias Ringwald GATT_EVENT_LONG_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, 12213e78e462SMatthias Ringwald descriptor_handle, value_offset, 12223e78e462SMatthias Ringwald blob, blob_length); 122323d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 12243deb3ec6SMatthias Ringwald } 12253deb3ec6SMatthias Ringwald 12265cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 12273deb3ec6SMatthias Ringwald int i; 12284ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 1229f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 12303deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 12313deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 12324ea43905SMatthias Ringwald if (pair_size == 4u){ 1233f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 1234e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 12353deb3ec6SMatthias Ringwald } else { 12369c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 12373deb3ec6SMatthias Ringwald } 12385cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 12393deb3ec6SMatthias Ringwald } 12403deb3ec6SMatthias Ringwald 12413deb3ec6SMatthias Ringwald } 12423deb3ec6SMatthias Ringwald 124352377058SMatthias Ringwald static bool is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12445cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 12453deb3ec6SMatthias Ringwald } 12463deb3ec6SMatthias Ringwald 12475cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 12485cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 1249526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 12503deb3ec6SMatthias Ringwald return; 12513deb3ec6SMatthias Ringwald } 12523deb3ec6SMatthias Ringwald // next 12535cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 1254052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 12553deb3ec6SMatthias Ringwald } 12563deb3ec6SMatthias Ringwald 12575cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12585cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 12593deb3ec6SMatthias Ringwald } 12603deb3ec6SMatthias Ringwald 12615cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12625cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 12633deb3ec6SMatthias Ringwald } 12643deb3ec6SMatthias Ringwald 12655cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12665cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 12673deb3ec6SMatthias Ringwald } 12683deb3ec6SMatthias Ringwald 12695cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12705cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 12713deb3ec6SMatthias Ringwald // report last characteristic 127223d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 12733deb3ec6SMatthias Ringwald } 12745cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 12753deb3ec6SMatthias Ringwald } 12763deb3ec6SMatthias Ringwald 12775cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12785cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 12793deb3ec6SMatthias Ringwald } 12803deb3ec6SMatthias Ringwald 12815cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12825cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 12833deb3ec6SMatthias Ringwald } 12843deb3ec6SMatthias Ringwald 12855cf1669fSMatthias 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){ 12865cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 12875cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 12883deb3ec6SMatthias Ringwald 12894ea43905SMatthias Ringwald if (next_blob_length == 0u){ 1290052dc82aSMatthias Ringwald gatt_client->state = done_state; 12913deb3ec6SMatthias Ringwald return; 12923deb3ec6SMatthias Ringwald } 1293052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 12943deb3ec6SMatthias Ringwald } 12953deb3ec6SMatthias Ringwald 12965cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 12973deb3ec6SMatthias Ringwald 1298dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 12993deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 1300526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 13013deb3ec6SMatthias Ringwald return; 13023deb3ec6SMatthias Ringwald } 13033deb3ec6SMatthias Ringwald 13045cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 1305052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 13063deb3ec6SMatthias Ringwald } 13073deb3ec6SMatthias Ringwald 130823d583b8SMatthias 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){ 130923d583b8SMatthias Ringwald notification->callback = callback; 131023d583b8SMatthias Ringwald notification->con_handle = con_handle; 131123d583b8SMatthias Ringwald if (characteristic == NULL){ 131223d583b8SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 131323d583b8SMatthias Ringwald } else { 131423d583b8SMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 131523d583b8SMatthias Ringwald } 131623d583b8SMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 131723d583b8SMatthias Ringwald } 131823d583b8SMatthias Ringwald 131923d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 132023d583b8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 132123d583b8SMatthias Ringwald } 13223deb3ec6SMatthias Ringwald 132362f7b41dSMatthias Ringwald static bool is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 1324f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 1325f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 13263deb3ec6SMatthias Ringwald 132762f7b41dSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return false; 132862f7b41dSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return false; 13295cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 13303deb3ec6SMatthias Ringwald } 13313deb3ec6SMatthias Ringwald 13320038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 133392a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) { 133492a7335eSMatthias Ringwald sm_key_t csrk; 133592a7335eSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 133692a7335eSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 1337052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_RESULT; 133892a7335eSMatthias 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); 133992a7335eSMatthias Ringwald } 13400038504eSMatthias Ringwald #endif 134192a7335eSMatthias Ringwald 134292a7335eSMatthias Ringwald // returns true if packet was sent 13431979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 13443deb3ec6SMatthias Ringwald 1345e4d159baSMatthias Ringwald // wait until re-encryption is complete 13461979f09cSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 1347d1e1a57fSMatthias Ringwald 1348e4d159baSMatthias Ringwald // wait until re-encryption is complete 13491979f09cSMatthias Ringwald if (gatt_client->reencryption_active) return false; 13506c124bc2SMatthias Ringwald 135111279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 13521979f09cSMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return false; 135311279da7SMatthias Ringwald 1354052dc82aSMatthias Ringwald bool client_request_pending = gatt_client->state != P_READY; 1355fd14b205SMatthias Ringwald 13561aa9e3e8SMatthias Ringwald // verify security level for Mandatory Authentication over LE 135746012949SMatthias Ringwald bool check_security; 135846012949SMatthias Ringwald switch (gatt_client->bearer_type){ 135946012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 136046012949SMatthias Ringwald check_security = true; 136146012949SMatthias Ringwald break; 136246012949SMatthias Ringwald default: 13639ced96e1SMatthias Ringwald check_security = false; 136446012949SMatthias Ringwald break; 13659ced96e1SMatthias Ringwald } 13669ced96e1SMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){ 13671dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 13682197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 136911279da7SMatthias Ringwald // set att error code for pairing failure based on required level 137011279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 137111279da7SMatthias Ringwald case LEVEL_4: 137211279da7SMatthias Ringwald case LEVEL_3: 137311279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 137411279da7SMatthias Ringwald break; 137511279da7SMatthias Ringwald default: 137611279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 137711279da7SMatthias Ringwald break; 137811279da7SMatthias Ringwald } 137911279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 138011279da7SMatthias Ringwald // sm probably just sent a pdu 13811979f09cSMatthias Ringwald return true; 138211279da7SMatthias Ringwald } 1383f4b33574SMatthias Ringwald 13845cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 1385544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 13865cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 13876e7b444cSMatthias Ringwald att_exchange_mtu_request(gatt_client); 13881979f09cSMatthias Ringwald return true; 13893deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 13901979f09cSMatthias Ringwald return false; 13913deb3ec6SMatthias Ringwald default: 13923deb3ec6SMatthias Ringwald break; 13933deb3ec6SMatthias Ringwald } 13943deb3ec6SMatthias Ringwald 13955cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 139652377058SMatthias Ringwald gatt_client->send_confirmation = false; 13976e7b444cSMatthias Ringwald att_confirmation(gatt_client); 13981979f09cSMatthias Ringwald return true; 13993deb3ec6SMatthias Ringwald } 14003deb3ec6SMatthias Ringwald 14013deb3ec6SMatthias Ringwald // check MTU for writes 1402052dc82aSMatthias Ringwald switch (gatt_client->state){ 14033deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 14043deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1405dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 1406dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 1407526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 14081979f09cSMatthias Ringwald return false; 14093deb3ec6SMatthias Ringwald default: 14103deb3ec6SMatthias Ringwald break; 14113deb3ec6SMatthias Ringwald } 14123deb3ec6SMatthias Ringwald 14130038504eSMatthias Ringwald bool packet_sent = true; 14140038504eSMatthias Ringwald bool done = true; 1415052dc82aSMatthias Ringwald switch (gatt_client->state){ 14163deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 1417052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_QUERY_RESULT; 14185cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 14190038504eSMatthias Ringwald break; 14203deb3ec6SMatthias Ringwald 14213deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 1422052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_WITH_UUID_RESULT; 14235cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 14240038504eSMatthias Ringwald break; 14253deb3ec6SMatthias Ringwald 14263deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 1427052dc82aSMatthias Ringwald gatt_client->state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 14285cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 14290038504eSMatthias Ringwald break; 14303deb3ec6SMatthias Ringwald 14313deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 1432052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 14335cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 14340038504eSMatthias Ringwald break; 14353deb3ec6SMatthias Ringwald 14363deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 1437052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 14385cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 14390038504eSMatthias Ringwald break; 14403deb3ec6SMatthias Ringwald 14413deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 1442052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 14435cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 14440038504eSMatthias Ringwald break; 14453deb3ec6SMatthias Ringwald 14463deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 1447052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 14485cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 14490038504eSMatthias Ringwald break; 14503deb3ec6SMatthias Ringwald 14513deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 1452052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 14535cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 14540038504eSMatthias Ringwald break; 14553deb3ec6SMatthias Ringwald 14563deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 1457052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_RESULT; 14585cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 14590038504eSMatthias Ringwald break; 14603deb3ec6SMatthias Ringwald 14613deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 1462052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BY_TYPE_RESPONSE; 14635cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 14640038504eSMatthias Ringwald break; 14653deb3ec6SMatthias Ringwald 14663deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 1467052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_RESPONSE; 14685cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 14690038504eSMatthias Ringwald break; 14703deb3ec6SMatthias Ringwald 1471f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1472f125a8efSMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST: 1473052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE; 1474f125a8efSMatthias Ringwald send_gatt_read_multiple_variable_request(gatt_client); 1475f125a8efSMatthias Ringwald break; 1476f125a8efSMatthias Ringwald #endif 1477f125a8efSMatthias Ringwald 14783deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 1479052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 14805cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 14810038504eSMatthias Ringwald break; 14823deb3ec6SMatthias Ringwald 14833deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 1484052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_RESULT; 14855cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 14860038504eSMatthias Ringwald break; 14873deb3ec6SMatthias Ringwald 14883deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 1489052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 14905cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 14910038504eSMatthias Ringwald break; 14923deb3ec6SMatthias Ringwald 14933deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 1494052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 14955cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 14960038504eSMatthias Ringwald break; 14973deb3ec6SMatthias Ringwald 14983deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 1499052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 15005cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 15010038504eSMatthias Ringwald break; 15023deb3ec6SMatthias Ringwald 15033deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 1504052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 15055cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 15060038504eSMatthias Ringwald break; 15073deb3ec6SMatthias Ringwald 15083deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 1509052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 15105cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 15110038504eSMatthias Ringwald break; 15123deb3ec6SMatthias Ringwald 1513abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1514abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1515abdc9fb5SMatthias Ringwald // use Find Information 15165cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 15175cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1518abdc9fb5SMatthias Ringwald #else 15193deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1520abdc9fb5SMatthias Ringwald // Use Read By Type 1521052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 15225cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1523abdc9fb5SMatthias Ringwald #endif 15240038504eSMatthias Ringwald break; 15253deb3ec6SMatthias Ringwald 15263deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 1527052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 15285cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 15290038504eSMatthias Ringwald break; 15303deb3ec6SMatthias Ringwald 15313deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 1532052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 15335cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 15340038504eSMatthias Ringwald break; 15353deb3ec6SMatthias Ringwald 15363deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1537052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 15385cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 15390038504eSMatthias Ringwald break; 15403deb3ec6SMatthias Ringwald 15413deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 1542052dc82aSMatthias Ringwald gatt_client->state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 15435cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 15440038504eSMatthias Ringwald break; 15453deb3ec6SMatthias Ringwald 15463deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 1547052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 15485cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 15490038504eSMatthias Ringwald break; 15503deb3ec6SMatthias Ringwald 15513deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 1552052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 15535cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 15540038504eSMatthias Ringwald break; 15553deb3ec6SMatthias Ringwald 15567a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1557793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 15585cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 15595cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1560793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 15615cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 1562052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_READY; 156392a7335eSMatthias Ringwald if (sm_cmac_ready()){ 156492a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 156592a7335eSMatthias Ringwald } 1566793cf6ceSMatthias Ringwald break; 1567793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1568526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 156992a7335eSMatthias Ringwald break; 1570793cf6ceSMatthias Ringwald default: 157192a7335eSMatthias Ringwald break; 1572793cf6ceSMatthias Ringwald } 15730038504eSMatthias Ringwald packet_sent = false; 15740038504eSMatthias Ringwald break; 1575793cf6ceSMatthias Ringwald 15763deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 15773deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 157892a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 15793deb3ec6SMatthias Ringwald } 15800038504eSMatthias Ringwald packet_sent = false; 15810038504eSMatthias Ringwald break; 15823deb3ec6SMatthias Ringwald 15833deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 15844c7c987fSMatthias Ringwald gatt_client->state = P_W4_SEND_SIGNED_WRITE_DONE; 15853deb3ec6SMatthias Ringwald // bump local signing counter 15865cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 15875cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 158864b12680SMatthias Ringwald // send signed write command 15895cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 15903deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1591526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1592b68ac7a5SMatthias Ringwald break; 15933deb3ec6SMatthias Ringwald } 15947a766ebfSMatthias Ringwald #endif 15953deb3ec6SMatthias Ringwald default: 1596b68ac7a5SMatthias Ringwald done = false; 15973deb3ec6SMatthias Ringwald break; 15983deb3ec6SMatthias Ringwald } 159947181045SMatthias Ringwald 16000038504eSMatthias Ringwald if (done){ 16010038504eSMatthias Ringwald return packet_sent; 16020038504eSMatthias Ringwald } 16030038504eSMatthias Ringwald 160459d34cd2SMatthias Ringwald // write without response callback 160559d34cd2SMatthias Ringwald btstack_context_callback_registration_t * callback = 160659d34cd2SMatthias Ringwald (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests); 160759d34cd2SMatthias Ringwald if (callback != NULL){ 160859d34cd2SMatthias Ringwald (*callback->callback)(callback->context); 160959d34cd2SMatthias Ringwald return true; 161059d34cd2SMatthias Ringwald } 161159d34cd2SMatthias Ringwald 161259d34cd2SMatthias Ringwald // requested can send now old 1613f688bdb8SMatthias Ringwald if (gatt_client->write_without_response_callback != NULL){ 16145cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 16155cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 161647181045SMatthias Ringwald uint8_t event[4]; 161747181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 16184ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 16195cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 16205cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 16211979f09cSMatthias Ringwald return true; // to trigger requeueing (even if higher layer didn't sent) 162247181045SMatthias Ringwald } 162347181045SMatthias Ringwald 16241979f09cSMatthias Ringwald return false; 16253deb3ec6SMatthias Ringwald } 16263deb3ec6SMatthias Ringwald 1627544128c3SMatthias Ringwald static void gatt_client_run(void){ 1628544128c3SMatthias Ringwald btstack_linked_item_t *it; 1629109c2548SMatthias Ringwald bool packet_sent; 16307627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 16317627a0deSMatthias Ringwald btstack_linked_list_iterator_t it_eatt; 16327627a0deSMatthias Ringwald #endif 1633a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 16345cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 163546012949SMatthias Ringwald switch (gatt_client->bearer_type){ 163646012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 16377627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 16387627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients); 16397627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it_eatt)) { 16407627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt); 1641052dc82aSMatthias Ringwald if (eatt_client->state != P_READY){ 16424c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle)){ 16437627a0deSMatthias Ringwald gatt_client_run_for_gatt_client(eatt_client); 16447627a0deSMatthias Ringwald } 16457627a0deSMatthias Ringwald } 16467627a0deSMatthias Ringwald } 16477627a0deSMatthias Ringwald #endif 164846012949SMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 164946012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 165046012949SMatthias Ringwald return; 165146012949SMatthias Ringwald } 1652109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 165346012949SMatthias Ringwald if (packet_sent){ 165446012949SMatthias Ringwald // request new permission 165546012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 165646012949SMatthias Ringwald // requeue client for fairness and exit 165746012949SMatthias Ringwald // note: iterator has become invalid 165846012949SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 165946012949SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 166046012949SMatthias Ringwald return; 166146012949SMatthias Ringwald } 166246012949SMatthias Ringwald break; 16631450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 166446012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 16651450cdc6SMatthias Ringwald if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) { 16661450cdc6SMatthias Ringwald continue; 16671450cdc6SMatthias Ringwald } 16681aa9e3e8SMatthias Ringwald 16691aa9e3e8SMatthias Ringwald // handle GATT over BR/EDR 16704c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle) == false) { 16714c226876SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 16721aa9e3e8SMatthias Ringwald return; 16731aa9e3e8SMatthias Ringwald } 1674109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 16751aa9e3e8SMatthias Ringwald if (packet_sent){ 16761aa9e3e8SMatthias Ringwald // request new permission 16771aa9e3e8SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 16781aa9e3e8SMatthias Ringwald // requeue client for fairness and exit 16791aa9e3e8SMatthias Ringwald // note: iterator has become invalid 16801aa9e3e8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 16811aa9e3e8SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 16821aa9e3e8SMatthias Ringwald return; 16831aa9e3e8SMatthias Ringwald } 168446012949SMatthias Ringwald break; 16851450cdc6SMatthias Ringwald #endif 168646012949SMatthias Ringwald default: 168746012949SMatthias Ringwald btstack_unreachable(); 168846012949SMatthias Ringwald break; 1689544128c3SMatthias Ringwald } 169046012949SMatthias Ringwald 169146012949SMatthias Ringwald 1692544128c3SMatthias Ringwald } 16933deb3ec6SMatthias Ringwald } 16943deb3ec6SMatthias Ringwald 1695544a5845SMatthias Ringwald // emit complete event, used to avoid emitting event from API call 1696544a5845SMatthias Ringwald static void gatt_client_emit_events(void * context){ 1697544a5845SMatthias Ringwald UNUSED(context); 1698544a5845SMatthias Ringwald btstack_linked_item_t *it; 1699544a5845SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next) { 1700544a5845SMatthias Ringwald gatt_client_t *gatt_client = (gatt_client_t *) it; 1701544a5845SMatthias Ringwald if (gatt_client->state == P_W2_EMIT_QUERY_COMPLETE_EVENT){ 1702544a5845SMatthias Ringwald gatt_client->state = P_READY; 1703544a5845SMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 1704544a5845SMatthias Ringwald } 1705544a5845SMatthias Ringwald } 1706544a5845SMatthias Ringwald } 1707544a5845SMatthias Ringwald 17085cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 1709643a64fcSMatthias Ringwald if (is_ready(gatt_client)) return; 1710526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_error_code); 17113deb3ec6SMatthias Ringwald } 17123deb3ec6SMatthias Ringwald 171378c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){ 171478c4542aSMatthias Ringwald hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet); 171578c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 171678c4542aSMatthias Ringwald if (gatt_client == NULL) return; 171778c4542aSMatthias Ringwald 171878c4542aSMatthias Ringwald // update security level 171978c4542aSMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 172078c4542aSMatthias Ringwald 172178c4542aSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 172278c4542aSMatthias Ringwald gatt_client->reencryption_active = false; 17232197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 172478c4542aSMatthias Ringwald 1725052dc82aSMatthias Ringwald if (gatt_client->state == P_READY) return; 172678c4542aSMatthias Ringwald 172778c4542aSMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 172878c4542aSMatthias Ringwald case ERROR_CODE_SUCCESS: 172978c4542aSMatthias Ringwald log_info("re-encryption success, retry operation"); 173078c4542aSMatthias Ringwald break; 173178c4542aSMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 173278c4542aSMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 173378c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 173478c4542aSMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 173578c4542aSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 173678c4542aSMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 173778c4542aSMatthias Ringwald // delete bonding information 173878c4542aSMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 173978c4542aSMatthias Ringwald btstack_assert(le_device_db_index >= 0); 174078c4542aSMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 174178c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 174278c4542aSMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 174378c4542aSMatthias Ringwald #endif 174478c4542aSMatthias Ringwald le_device_db_remove(le_device_db_index); 174578c4542aSMatthias Ringwald // trigger pairing again 174678c4542aSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 174778c4542aSMatthias Ringwald break; 174878c4542aSMatthias Ringwald } 174978c4542aSMatthias Ringwald #endif 175078c4542aSMatthias Ringwald // report bonding information missing 1751526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 175278c4542aSMatthias Ringwald break; 175378c4542aSMatthias Ringwald default: 175478c4542aSMatthias Ringwald // report bonding information missing 1755526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code); 175678c4542aSMatthias Ringwald break; 175778c4542aSMatthias Ringwald } 175878c4542aSMatthias Ringwald } 175978c4542aSMatthias Ringwald 176078c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){ 176178c4542aSMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 176278c4542aSMatthias Ringwald hci_con_handle_t con_handle = little_endian_read_16(packet,3); 176378c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 176478c4542aSMatthias Ringwald if (gatt_client == NULL) return; 176578c4542aSMatthias Ringwald 176678c4542aSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 176778c4542aSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 176878c4542aSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 176978c4542aSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 177078c4542aSMatthias Ringwald } 177178c4542aSMatthias Ringwald 1772f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 17731ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 17741ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 17759ec2630cSMatthias Ringwald 1776361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1777361b1363SMatthias Ringwald 1778f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 17795cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 17800e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 17813deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 178278c4542aSMatthias Ringwald gatt_client_handle_disconnection_complete(packet); 17833deb3ec6SMatthias Ringwald break; 1784f4b33574SMatthias Ringwald 1785f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1786f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1787f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 17885cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 17895cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1790f4b33574SMatthias Ringwald 17911dfae9c7SMatthias Ringwald // update security level 17921dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 17931dfae9c7SMatthias Ringwald 17943503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 17952197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 1796f688bdb8SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet) != ERROR_CODE_SUCCESS){ 17975cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1798ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1799f4b33574SMatthias Ringwald } else { 1800f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 18013deb3ec6SMatthias Ringwald } 1802f4b33574SMatthias Ringwald } 1803f4b33574SMatthias Ringwald break; 180411279da7SMatthias Ringwald 1805793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1806793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1807793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1808793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1809793cf6ceSMatthias Ringwald break; 1810793cf6ceSMatthias Ringwald #endif 1811a95ca902SMatthias Ringwald 18128918bbdaSMatthias Ringwald // re-encryption started 18138918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 18148918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 18158918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 18168918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 18178918bbdaSMatthias Ringwald 18188918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 18198918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 18208918bbdaSMatthias Ringwald break; 18218918bbdaSMatthias Ringwald 1822ec9babacSMatthias Ringwald // re-encryption complete 1823ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 182478c4542aSMatthias Ringwald gatt_client_handle_reencryption_complete(packet); 1825ec9babacSMatthias Ringwald break; 18263deb3ec6SMatthias Ringwald default: 18273deb3ec6SMatthias Ringwald break; 18283deb3ec6SMatthias Ringwald } 18293deb3ec6SMatthias Ringwald 1830361b1363SMatthias Ringwald gatt_client_run(); 18313deb3ec6SMatthias Ringwald } 18323deb3ec6SMatthias Ringwald 18332da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1834052dc82aSMatthias Ringwald switch (gatt_client->state) { 18352da0d963SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: 18362da0d963SMatthias Ringwald if (size >= 17) { 18372da0d963SMatthias Ringwald uint8_t uuid128[16]; 18382da0d963SMatthias Ringwald reverse_128(&packet[1], uuid128); 18392da0d963SMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 18402da0d963SMatthias Ringwald } 18412da0d963SMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 18425611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18433deb3ec6SMatthias Ringwald break; 18442da0d963SMatthias Ringwald 18452da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 18462da0d963SMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1847526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 18482da0d963SMatthias Ringwald break; 18492da0d963SMatthias Ringwald 18502da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 18512da0d963SMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 18522da0d963SMatthias Ringwald size - 1u, 0u); 1853526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 18542da0d963SMatthias Ringwald break; 18552da0d963SMatthias Ringwald 18562da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic 18572da0d963SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 18582da0d963SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 18592da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 18602da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u); 18612da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18622da0d963SMatthias Ringwald break; 18632da0d963SMatthias Ringwald 18642da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor 18652da0d963SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 18662da0d963SMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 18672da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 18682da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 18692da0d963SMatthias Ringwald size - 1u); 18702da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18712da0d963SMatthias Ringwald break; 18722da0d963SMatthias Ringwald 18733deb3ec6SMatthias Ringwald default: 18743deb3ec6SMatthias Ringwald break; 18753deb3ec6SMatthias Ringwald } 18762da0d963SMatthias Ringwald } 18773deb3ec6SMatthias Ringwald 18782da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1879052dc82aSMatthias Ringwald switch (gatt_client->state) { 18803deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 18815cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1882cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1883cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 18845611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 18853deb3ec6SMatthias Ringwald break; 18863deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 18875cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1888cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1889cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 18905611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 18913deb3ec6SMatthias Ringwald break; 1892cf8e5718SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: { 18934ea43905SMatthias Ringwald if (size < 2u) break; 18943deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 18953deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 18963deb3ec6SMatthias Ringwald 18974ea43905SMatthias Ringwald if (pair_size == 6u) { 18984ea43905SMatthias Ringwald if (size < 8u) break; 18993deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 19005cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 19015cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 19025cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 1903052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 19043deb3ec6SMatthias Ringwald break; 19053deb3ec6SMatthias Ringwald } 19063deb3ec6SMatthias Ringwald 19074ea43905SMatthias Ringwald if (pair_size != 8u) break; 19089f698c82SMatthias Ringwald 19099f698c82SMatthias Ringwald // UUIDs included, report all of them 19103deb3ec6SMatthias Ringwald uint16_t offset; 19114ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size) { 1912f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 19135cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 19145cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 19154ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset + 6u); 19165cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 19173deb3ec6SMatthias Ringwald } 19183deb3ec6SMatthias Ringwald 1919cf8e5718SMatthias Ringwald trigger_next_included_service_query(gatt_client, 1920cf8e5718SMatthias Ringwald get_last_result_handle_from_included_services_list(packet, 1921cf8e5718SMatthias Ringwald size)); 19225611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19233deb3ec6SMatthias Ringwald break; 19243deb3ec6SMatthias Ringwald } 1925abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 19263deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 19275cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 1928052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 19293deb3ec6SMatthias Ringwald break; 1930abdc9fb5SMatthias Ringwald #endif 19313deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 19323deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 193339ac9711SMatthias Ringwald // set last result handle to last valid handle, only used if pair_size invalid 193439ac9711SMatthias Ringwald uint16_t last_result_handle = 0xffff; 193539ac9711SMatthias Ringwald if (pair_size > 2) { 19363deb3ec6SMatthias Ringwald uint16_t offset; 19373deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size) { 1938f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1939cf8e5718SMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], 1940cf8e5718SMatthias Ringwald pair_size - 2u); 19413deb3ec6SMatthias Ringwald last_result_handle = value_handle; 19423deb3ec6SMatthias Ringwald } 194339ac9711SMatthias Ringwald } 19445cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 19453deb3ec6SMatthias Ringwald break; 19463deb3ec6SMatthias Ringwald } 19473deb3ec6SMatthias Ringwald default: 19483deb3ec6SMatthias Ringwald break; 19493deb3ec6SMatthias Ringwald } 195039ac9711SMatthias Ringwald } 1951dc13fd8dSMatthias Ringwald 19522da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) { 1953052dc82aSMatthias Ringwald switch (gatt_client->state) { 19542da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1955526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19563deb3ec6SMatthias Ringwald break; 19572da0d963SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1958526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19593deb3ec6SMatthias Ringwald break; 19602da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1961526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19622da0d963SMatthias Ringwald break; 19632da0d963SMatthias Ringwald default: 19642da0d963SMatthias Ringwald break; 19652da0d963SMatthias Ringwald } 19662da0d963SMatthias Ringwald } 1967dc13fd8dSMatthias Ringwald 19682da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) { 19694740230fSMatthias Ringwald uint8_t att_status; 19702da0d963SMatthias Ringwald switch (packet[0]) { 19712da0d963SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: { 19722da0d963SMatthias Ringwald if (size < 3u) break; 197346012949SMatthias Ringwald bool update_gatt_server_att_mtu = false; 19742da0d963SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 19752da0d963SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 197646012949SMatthias Ringwald switch (gatt_client->bearer_type){ 197746012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 197846012949SMatthias Ringwald update_gatt_server_att_mtu = true; 197946012949SMatthias Ringwald break; 19802da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 198146012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 19822da0d963SMatthias Ringwald local_rx_mtu = gatt_client->mtu; 198346012949SMatthias Ringwald break; 19842da0d963SMatthias Ringwald #endif 198546012949SMatthias Ringwald default: 198646012949SMatthias Ringwald btstack_unreachable(); 198746012949SMatthias Ringwald break; 198846012949SMatthias Ringwald } 198946012949SMatthias Ringwald 19902da0d963SMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 19912da0d963SMatthias Ringwald 19922da0d963SMatthias Ringwald // set gatt client mtu 19932da0d963SMatthias Ringwald gatt_client->mtu = mtu; 19942da0d963SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 19952da0d963SMatthias Ringwald 199646012949SMatthias Ringwald if (update_gatt_server_att_mtu){ 19972da0d963SMatthias Ringwald // set per connection mtu state - for fixed channel 19982da0d963SMatthias Ringwald hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle); 19992da0d963SMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 20002da0d963SMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 20012da0d963SMatthias Ringwald } 20022da0d963SMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 20032da0d963SMatthias Ringwald break; 20042da0d963SMatthias Ringwald } 20052da0d963SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 2006052dc82aSMatthias Ringwald switch (gatt_client->state) { 20072da0d963SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 20082da0d963SMatthias Ringwald report_gatt_services(gatt_client, packet, size); 20092da0d963SMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 201030952227SMilanka Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 201130952227SMilanka Ringwald break; 20123deb3ec6SMatthias Ringwald default: 20133deb3ec6SMatthias Ringwald break; 20143deb3ec6SMatthias Ringwald } 20153deb3ec6SMatthias Ringwald break; 20162da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 20172da0d963SMatthias Ringwald if (size < 3u) return; 20182da0d963SMatthias Ringwald report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 20192da0d963SMatthias Ringwald return; 2020cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2021cbba69d5SMatthias Ringwald case ATT_MULTIPLE_HANDLE_VALUE_NTF: 2022cbba69d5SMatthias Ringwald if (size >= 5u) { 2023cbba69d5SMatthias Ringwald uint16_t offset = 1; 2024cbba69d5SMatthias Ringwald while (true){ 2025cbba69d5SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 2026cbba69d5SMatthias Ringwald offset += 2; 2027cbba69d5SMatthias Ringwald uint16_t value_length = little_endian_read_16(packet, offset); 2028cbba69d5SMatthias Ringwald offset += 2; 2029cbba69d5SMatthias Ringwald if ((offset + value_length) > size) break; 2030cbba69d5SMatthias Ringwald report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length); 2031cbba69d5SMatthias Ringwald offset += value_length; 2032cbba69d5SMatthias Ringwald } 2033cbba69d5SMatthias Ringwald } 2034cbba69d5SMatthias Ringwald return; 2035cbba69d5SMatthias Ringwald #endif 20362da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 20372da0d963SMatthias Ringwald if (size < 3u) break; 20382da0d963SMatthias Ringwald report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 203952377058SMatthias Ringwald gatt_client->send_confirmation = true; 20402da0d963SMatthias Ringwald break; 20412da0d963SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 20422da0d963SMatthias Ringwald gatt_client_handle_att_read_by_type_response(gatt_client, packet, size); 20432da0d963SMatthias Ringwald break; 20442da0d963SMatthias Ringwald case ATT_READ_RESPONSE: 20452da0d963SMatthias Ringwald gatt_client_handle_att_read_response(gatt_client, packet, size); 20462da0d963SMatthias Ringwald break; 2047cf8e5718SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: { 20483deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 20493deb3ec6SMatthias Ringwald int i; 20503deb3ec6SMatthias Ringwald uint16_t start_group_handle; 20515611a760SMatthias Ringwald uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 20524ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size) { 2053f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet, i); 2054f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet, i + 2); 2055cf8e5718SMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, 2056cf8e5718SMatthias Ringwald gatt_client->uuid128); 20573deb3ec6SMatthias Ringwald } 20585cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 20595611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 20603deb3ec6SMatthias Ringwald break; 20613deb3ec6SMatthias Ringwald } 2062cf8e5718SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: { 20634ea43905SMatthias Ringwald if (size < 2u) break; 2064a6121b51SMilanka Ringwald 20653deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 20664ea43905SMatthias Ringwald if (packet[1u] == 2u) { 20673deb3ec6SMatthias Ringwald pair_size = 18; 20683deb3ec6SMatthias Ringwald } 2069a6121b51SMilanka Ringwald uint16_t offset = 2; 2070a6121b51SMilanka Ringwald 2071a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 2072f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 2073abdc9fb5SMatthias Ringwald 2074abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 20755cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 20765cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 2077abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 2078abdc9fb5SMatthias Ringwald if (pair_size == 4){ 2079a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 2080abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 2081abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 20825cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 20835cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 20845cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 2085abdc9fb5SMatthias Ringwald break; 2086abdc9fb5SMatthias Ringwald } 2087abdc9fb5SMatthias Ringwald offset += pair_size; 2088abdc9fb5SMatthias Ringwald } 2089abdc9fb5SMatthias Ringwald } 20905cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 2091abdc9fb5SMatthias Ringwald 2092abdc9fb5SMatthias Ringwald } else { 2093abdc9fb5SMatthias Ringwald // next 20945cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 20955cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2096abdc9fb5SMatthias Ringwald } 2097abdc9fb5SMatthias Ringwald break; 2098abdc9fb5SMatthias Ringwald } 2099abdc9fb5SMatthias Ringwald #endif 21005cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 21015cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 21025611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21033deb3ec6SMatthias Ringwald break; 21043deb3ec6SMatthias Ringwald } 21053deb3ec6SMatthias Ringwald 21063deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 21072da0d963SMatthias Ringwald gatt_client_handle_att_write_response(gatt_client); 21083deb3ec6SMatthias Ringwald break; 21093deb3ec6SMatthias Ringwald 21103deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE: { 21114ea43905SMatthias Ringwald uint16_t received_blob_length = size - 1u; 2112052dc82aSMatthias Ringwald switch (gatt_client->state) { 21133deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2114cf8e5718SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 2115cf8e5718SMatthias Ringwald received_blob_length, gatt_client->attribute_offset); 21165cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 21175611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21183deb3ec6SMatthias Ringwald break; 21193deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 21205cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 21213deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 21225cf1669fSMatthias Ringwald gatt_client->attribute_offset); 2123cf8e5718SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 2124cf8e5718SMatthias Ringwald received_blob_length); 21255611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21263deb3ec6SMatthias Ringwald break; 21273deb3ec6SMatthias Ringwald default: 21283deb3ec6SMatthias Ringwald break; 21293deb3ec6SMatthias Ringwald } 21303deb3ec6SMatthias Ringwald break; 21313deb3ec6SMatthias Ringwald } 21323deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 2133052dc82aSMatthias Ringwald switch (gatt_client->state) { 21343deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 21355cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 21364740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 21373deb3ec6SMatthias Ringwald } else { 21384740230fSMatthias Ringwald att_status = ATT_ERROR_DATA_MISMATCH; 21393deb3ec6SMatthias Ringwald } 2140526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 21413deb3ec6SMatthias Ringwald break; 21423deb3ec6SMatthias Ringwald 21433deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: { 21445cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 21455cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 21465611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21473deb3ec6SMatthias Ringwald break; 21483deb3ec6SMatthias Ringwald } 21493deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: { 21505cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 2151cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, 2152cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 21535611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21543deb3ec6SMatthias Ringwald break; 21553deb3ec6SMatthias Ringwald } 21563deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: { 21575cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 21585cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 2159cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, 2160cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE); 21615611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21623deb3ec6SMatthias Ringwald break; 21633deb3ec6SMatthias Ringwald } 2164052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 21653deb3ec6SMatthias Ringwald break; 21663deb3ec6SMatthias Ringwald } 21673deb3ec6SMatthias Ringwald default: 21683deb3ec6SMatthias Ringwald break; 21693deb3ec6SMatthias Ringwald } 21703deb3ec6SMatthias Ringwald break; 21713deb3ec6SMatthias Ringwald 21723deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 2173052dc82aSMatthias Ringwald switch (gatt_client->state) { 21743deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2175526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21763deb3ec6SMatthias Ringwald break; 21773deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2178526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21793deb3ec6SMatthias Ringwald break; 21803deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2181526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH); 21823deb3ec6SMatthias Ringwald break; 21833deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2184526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21853deb3ec6SMatthias Ringwald break; 21863deb3ec6SMatthias Ringwald default: 21873deb3ec6SMatthias Ringwald break; 21883deb3ec6SMatthias Ringwald 21893deb3ec6SMatthias Ringwald } 21903deb3ec6SMatthias Ringwald break; 21913deb3ec6SMatthias Ringwald 21923deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 2193052dc82aSMatthias Ringwald switch (gatt_client->state) { 21943deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 21955cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 2196526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21973deb3ec6SMatthias Ringwald break; 21983deb3ec6SMatthias Ringwald default: 21993deb3ec6SMatthias Ringwald break; 22003deb3ec6SMatthias Ringwald } 22013deb3ec6SMatthias Ringwald break; 22023deb3ec6SMatthias Ringwald 2203f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2204f125a8efSMatthias Ringwald case ATT_READ_MULTIPLE_VARIABLE_RSP: 2205052dc82aSMatthias Ringwald switch (gatt_client->state) { 2206169b9876SMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2207f125a8efSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 2208f125a8efSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 2209f125a8efSMatthias Ringwald break; 2210f125a8efSMatthias Ringwald default: 2211f125a8efSMatthias Ringwald break; 2212f125a8efSMatthias Ringwald } 2213f125a8efSMatthias Ringwald break; 2214f125a8efSMatthias Ringwald #endif 2215f125a8efSMatthias Ringwald 22163deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 22174ea43905SMatthias Ringwald if (size < 5u) return; 22184740230fSMatthias Ringwald att_status = packet[4]; 22194740230fSMatthias Ringwald switch (att_status) { 22203deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 2221052dc82aSMatthias Ringwald switch (gatt_client->state) { 22223deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 22233deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 22243deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 22253deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 2226526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 22273deb3ec6SMatthias Ringwald break; 22283deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 22293deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 223023d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 2231526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 22323deb3ec6SMatthias Ringwald break; 22333deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 22345cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle) { 22354740230fSMatthias Ringwald att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND; 22363deb3ec6SMatthias Ringwald } else { 22374740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 22383deb3ec6SMatthias Ringwald } 2239526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 22403deb3ec6SMatthias Ringwald break; 22413deb3ec6SMatthias Ringwald default: 22424740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 22433deb3ec6SMatthias Ringwald break; 22443deb3ec6SMatthias Ringwald } 22453deb3ec6SMatthias Ringwald break; 22463deb3ec6SMatthias Ringwald } 2247f4b33574SMatthias Ringwald 2248f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 2249f4b33574SMatthias Ringwald 2250f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 2251f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 2252a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 2253a0e0c2beSMatthias Ringwald 2254f4b33574SMatthias Ringwald // security too low 22555cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 22564740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2257f4b33574SMatthias Ringwald break; 2258f4b33574SMatthias Ringwald } 2259f4b33574SMatthias Ringwald // start security 22605cf1669fSMatthias Ringwald gatt_client->security_counter++; 2261f4b33574SMatthias Ringwald 2262f4b33574SMatthias Ringwald // setup action 2263f4b33574SMatthias Ringwald int retry = 1; 2264052dc82aSMatthias Ringwald switch (gatt_client->state){ 2265f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 2266052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 2267f4b33574SMatthias Ringwald break; 2268f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2269052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 2270f4b33574SMatthias Ringwald break; 2271f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 2272052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 2273f4b33574SMatthias Ringwald break; 2274f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 2275052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_REQUEST; 2276f4b33574SMatthias Ringwald break; 2277f125a8efSMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2278052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST; 2279f125a8efSMatthias Ringwald break; 2280f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 2281052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 2282f4b33574SMatthias Ringwald break; 2283f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 2284052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 2285f4b33574SMatthias Ringwald break; 2286f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 2287052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 2288f4b33574SMatthias Ringwald break; 2289f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 2290052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 2291f4b33574SMatthias Ringwald break; 2292f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2293052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 2294f4b33574SMatthias Ringwald break; 2295f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2296052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 2297f4b33574SMatthias Ringwald break; 2298f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2299052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 2300f4b33574SMatthias Ringwald break; 2301f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 2302052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 2303f4b33574SMatthias Ringwald break; 2304f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 2305052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 2306f4b33574SMatthias Ringwald break; 2307f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2308052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 2309f4b33574SMatthias Ringwald break; 2310f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 2311052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 2312f4b33574SMatthias Ringwald break; 2313f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2314052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 2315f4b33574SMatthias Ringwald break; 2316f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2317052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 2318f4b33574SMatthias Ringwald break; 2319f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 232030cf4543SMilanka Ringwald case P_W4_SEND_SIGNED_WRITE_DONE: 2321052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 2322f4b33574SMatthias Ringwald break; 2323f4b33574SMatthias Ringwald #endif 2324f4b33574SMatthias Ringwald default: 2325052dc82aSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->state); 2326f4b33574SMatthias Ringwald retry = 0; 2327f4b33574SMatthias Ringwald break; 2328f4b33574SMatthias Ringwald } 2329f4b33574SMatthias Ringwald 2330f4b33574SMatthias Ringwald if (!retry) { 23314740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2332f4b33574SMatthias Ringwald break; 2333f4b33574SMatthias Ringwald } 2334f4b33574SMatthias Ringwald 2335f4b33574SMatthias Ringwald log_info("security error, start pairing"); 2336f4b33574SMatthias Ringwald 2337f060f108SMatthias Ringwald // start pairing for higher security level 23382197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 23394740230fSMatthias Ringwald gatt_client->pending_error_code = att_status; 23405cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 2341f4b33574SMatthias Ringwald break; 2342a0e0c2beSMatthias Ringwald } 2343f4b33574SMatthias Ringwald #endif 2344f4b33574SMatthias Ringwald 2345f4b33574SMatthias Ringwald // nothing we can do about that 2346f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 23473deb3ec6SMatthias Ringwald default: 23484740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 23493deb3ec6SMatthias Ringwald break; 23503deb3ec6SMatthias Ringwald } 23513deb3ec6SMatthias Ringwald break; 23523deb3ec6SMatthias Ringwald 23533deb3ec6SMatthias Ringwald default: 23543deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 23553deb3ec6SMatthias Ringwald break; 23563deb3ec6SMatthias Ringwald } 2357cf8e5718SMatthias Ringwald } 2358cf8e5718SMatthias Ringwald 2359cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) { 2360cf8e5718SMatthias Ringwald gatt_client_t *gatt_client; 2361180cbe79SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2362b1da4983SMatthias Ringwald uint8_t status; 2363b1da4983SMatthias Ringwald hci_connection_t * hci_connection; 2364180cbe79SMatthias Ringwald hci_con_handle_t con_handle; 2365180cbe79SMatthias Ringwald #endif 2366180cbe79SMatthias Ringwald 2367cf8e5718SMatthias Ringwald if (size < 1u) return; 236859b5e157SMatthias Ringwald switch (packet_type){ 236959b5e157SMatthias Ringwald case HCI_EVENT_PACKET: 237059b5e157SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 237159b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 237259b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_OPENED: 237359b5e157SMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 237459b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet)); 2375de5a18caSMatthias Ringwald if (gatt_client != NULL){ 2376180cbe79SMatthias Ringwald con_handle = l2cap_event_channel_opened_get_handle(packet); 2377180cbe79SMatthias Ringwald hci_connection = hci_connection_for_handle(con_handle); 2378ab6f9d8fSMatthias Ringwald if (status == L2CAP_CONNECTION_RESPONSE_RESULT_REFUSED_RESOURCES){ 2379ab6f9d8fSMatthias Ringwald if ((hci_connection != NULL) && hci_connection->att_server.incoming_connection_request) { 2380180cbe79SMatthias Ringwald log_info("Collision, retry in 100ms"); 2381180cbe79SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 2382180cbe79SMatthias Ringwald // set timer for retry 2383b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 2384180cbe79SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_classic_retry); 2385180cbe79SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 2386180cbe79SMatthias Ringwald break; 2387180cbe79SMatthias Ringwald } 2388ab6f9d8fSMatthias Ringwald } 238959b5e157SMatthias Ringwald // if status != 0, gatt_client will be discarded 2390052dc82aSMatthias Ringwald gatt_client->state = P_READY; 239159b5e157SMatthias Ringwald gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet); 239259b5e157SMatthias Ringwald gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 239359b5e157SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 2394de5a18caSMatthias Ringwald } 239559b5e157SMatthias Ringwald break; 239659b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 239759b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet)); 2398de5a18caSMatthias Ringwald if (gatt_client != NULL){ 239959b5e157SMatthias Ringwald // discard gatt client object 240059b5e157SMatthias Ringwald gatt_client_classic_handle_disconnected(gatt_client); 2401de5a18caSMatthias Ringwald } 240259b5e157SMatthias Ringwald break; 240359b5e157SMatthias Ringwald #endif 2404cf8e5718SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 24053deb3ec6SMatthias Ringwald gatt_client_run(); 2406cf8e5718SMatthias Ringwald break; 2407cf8e5718SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 2408cf8e5718SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 2409cf8e5718SMatthias Ringwald if (size < 6u) break; 2410cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2411de5a18caSMatthias Ringwald if (gatt_client != NULL) { 2412cf8e5718SMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 2413de5a18caSMatthias Ringwald } 2414cf8e5718SMatthias Ringwald break; 2415cf8e5718SMatthias Ringwald default: 2416cf8e5718SMatthias Ringwald break; 2417cf8e5718SMatthias Ringwald } 241859b5e157SMatthias Ringwald break; 2419cf8e5718SMatthias Ringwald 242059b5e157SMatthias Ringwald case ATT_DATA_PACKET: 2421cf8e5718SMatthias Ringwald // special cases: notifications & indications motivate creating context 2422cf8e5718SMatthias Ringwald switch (packet[0]) { 2423cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 2424cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 2425cf8e5718SMatthias Ringwald gatt_client_provide_context_for_handle(handle, &gatt_client); 2426cf8e5718SMatthias Ringwald break; 2427cf8e5718SMatthias Ringwald default: 2428cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2429cf8e5718SMatthias Ringwald break; 2430cf8e5718SMatthias Ringwald } 2431cf8e5718SMatthias Ringwald 2432cf8e5718SMatthias Ringwald if (gatt_client != NULL) { 2433cf8e5718SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2434cf8e5718SMatthias Ringwald gatt_client_run(); 2435cf8e5718SMatthias Ringwald } 243659b5e157SMatthias Ringwald break; 243759b5e157SMatthias Ringwald 243859b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 243959b5e157SMatthias Ringwald case L2CAP_DATA_PACKET: 244059b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(handle); 2441de5a18caSMatthias Ringwald if (gatt_client != NULL){ 244259b5e157SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 244359b5e157SMatthias Ringwald gatt_client_run(); 2444de5a18caSMatthias Ringwald } 244559b5e157SMatthias Ringwald break; 244659b5e157SMatthias Ringwald #endif 244759b5e157SMatthias Ringwald 244859b5e157SMatthias Ringwald default: 244959b5e157SMatthias Ringwald break; 245059b5e157SMatthias Ringwald } 24513deb3ec6SMatthias Ringwald } 24523deb3ec6SMatthias Ringwald 24537a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 24543deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 2455665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 2456665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 2457665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 24585cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 2459052dc82aSMatthias Ringwald if (gatt_client->state == P_W4_CMAC_RESULT){ 24603deb3ec6SMatthias Ringwald // store result 24615cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 24625cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 2463052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 24643deb3ec6SMatthias Ringwald gatt_client_run(); 24653deb3ec6SMatthias Ringwald return; 24663deb3ec6SMatthias Ringwald } 24673deb3ec6SMatthias Ringwald } 24683deb3ec6SMatthias Ringwald } 24693deb3ec6SMatthias Ringwald 2470b45b7749SMilanka 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){ 247140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 247240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 247340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 247440faeb84SMilanka Ringwald return status; 247540faeb84SMilanka Ringwald } 247640faeb84SMilanka Ringwald if (is_ready(gatt_client) == 0){ 247740faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 247840faeb84SMilanka Ringwald } 24793deb3ec6SMatthias Ringwald 24805cf1669fSMatthias Ringwald gatt_client->callback = callback; 2481b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 24825cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 24835cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 2484052dc82aSMatthias Ringwald gatt_client->state = P_W4_IDENTITY_RESOLVING; 24853deb3ec6SMatthias Ringwald gatt_client_run(); 248625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24873deb3ec6SMatthias Ringwald } 24887a766ebfSMatthias Ringwald #endif 24893deb3ec6SMatthias Ringwald 2490711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 249140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2492de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 249340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 249440faeb84SMilanka Ringwald return status; 249540faeb84SMilanka Ringwald } 24963deb3ec6SMatthias Ringwald 24975cf1669fSMatthias Ringwald gatt_client->callback = callback; 24985cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 24995cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2500052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 25018d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID; 25023deb3ec6SMatthias Ringwald gatt_client_run(); 250325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25043deb3ec6SMatthias Ringwald } 25053deb3ec6SMatthias Ringwald 25068d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 250740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2508de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 250940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 251040faeb84SMilanka Ringwald return status; 251140faeb84SMilanka Ringwald } 25128d1f34d3SMatheus Eduardo Garbelini 25138d1f34d3SMatheus Eduardo Garbelini gatt_client->callback = callback; 25148d1f34d3SMatheus Eduardo Garbelini gatt_client->start_group_handle = 0x0001; 25158d1f34d3SMatheus Eduardo Garbelini gatt_client->end_group_handle = 0xffff; 2516052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 25178d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID; 25188d1f34d3SMatheus Eduardo Garbelini gatt_client_run(); 25198d1f34d3SMatheus Eduardo Garbelini return ERROR_CODE_SUCCESS; 25208d1f34d3SMatheus Eduardo Garbelini } 25213deb3ec6SMatthias Ringwald 2522711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 252340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2524de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 252540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 252640faeb84SMilanka Ringwald return status; 252740faeb84SMilanka Ringwald } 25283deb3ec6SMatthias Ringwald 25295cf1669fSMatthias Ringwald gatt_client->callback = callback; 25305cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 25315cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2532052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 25335cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 25345cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 25353deb3ec6SMatthias Ringwald gatt_client_run(); 253625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25373deb3ec6SMatthias Ringwald } 25383deb3ec6SMatthias Ringwald 2539711e6c80SMatthias 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){ 254040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2541de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 254240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 254340faeb84SMilanka Ringwald return status; 254440faeb84SMilanka Ringwald } 25453deb3ec6SMatthias Ringwald 25465cf1669fSMatthias Ringwald gatt_client->callback = callback; 25475cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 25485cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 25495cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 25505cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2551052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 25523deb3ec6SMatthias Ringwald gatt_client_run(); 255325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25543deb3ec6SMatthias Ringwald } 25553deb3ec6SMatthias Ringwald 2556711e6c80SMatthias 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){ 255740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2558de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 255940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 256040faeb84SMilanka Ringwald return status; 256140faeb84SMilanka Ringwald } 25623deb3ec6SMatthias Ringwald 25635cf1669fSMatthias Ringwald gatt_client->callback = callback; 25645cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 25655cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2566ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = false; 25675cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2568052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 25693deb3ec6SMatthias Ringwald gatt_client_run(); 257025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25713deb3ec6SMatthias Ringwald } 25723deb3ec6SMatthias Ringwald 2573711e6c80SMatthias 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){ 257440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2575de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 257640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 257740faeb84SMilanka Ringwald return status; 257840faeb84SMilanka Ringwald } 2579de27733dSMatthias Ringwald 25805cf1669fSMatthias Ringwald gatt_client->callback = callback; 25815cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 25825cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2583052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 25843deb3ec6SMatthias Ringwald 25853deb3ec6SMatthias Ringwald gatt_client_run(); 258625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25873deb3ec6SMatthias Ringwald } 25883deb3ec6SMatthias Ringwald 2589711e6c80SMatthias 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){ 259040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2591de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 259240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 259340faeb84SMilanka Ringwald return status; 259440faeb84SMilanka Ringwald } 25953deb3ec6SMatthias Ringwald 25965cf1669fSMatthias Ringwald gatt_client->callback = callback; 25975cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 25985cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2599ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 26005cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 26015cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 26025cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2603052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 26043deb3ec6SMatthias Ringwald gatt_client_run(); 260525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26063deb3ec6SMatthias Ringwald } 26073deb3ec6SMatthias Ringwald 2608045d700dSDavid 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){ 260940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2610de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 261140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 261240faeb84SMilanka Ringwald return status; 261340faeb84SMilanka Ringwald } 26143deb3ec6SMatthias Ringwald 26155cf1669fSMatthias Ringwald gatt_client->callback = callback; 26165cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 26175cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2618ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 26195cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 26205cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 26215cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2622052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 26233deb3ec6SMatthias Ringwald gatt_client_run(); 262425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26253deb3ec6SMatthias Ringwald } 26263deb3ec6SMatthias Ringwald 26273deb3ec6SMatthias Ringwald 2628b45b7749SMilanka 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){ 2629b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16); 26303deb3ec6SMatthias Ringwald } 26313deb3ec6SMatthias Ringwald 2632b45b7749SMilanka 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){ 2633b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128); 26343deb3ec6SMatthias Ringwald } 26353deb3ec6SMatthias Ringwald 2636711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 263740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2638de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 263940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 264040faeb84SMilanka Ringwald return status; 264140faeb84SMilanka Ringwald } 26423deb3ec6SMatthias Ringwald 2643544a5845SMatthias Ringwald // check if there is space for characteristics descriptors 2644544a5845SMatthias Ringwald if (characteristic->end_handle > characteristic->value_handle){ 26455cf1669fSMatthias Ringwald gatt_client->callback = callback; 26465cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 26475cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 2648052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 26493deb3ec6SMatthias Ringwald gatt_client_run(); 2650544a5845SMatthias Ringwald } else { 2651544a5845SMatthias Ringwald // schedule gatt complete event on next run loop iteration otherwise 2652544a5845SMatthias Ringwald gatt_client->state = P_W2_EMIT_QUERY_COMPLETE_EVENT; 2653544a5845SMatthias Ringwald gatt_client_deferred_event_emit.callback = gatt_client_emit_events; 2654544a5845SMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client_deferred_event_emit); 2655544a5845SMatthias Ringwald } 265625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26573deb3ec6SMatthias Ringwald } 26583deb3ec6SMatthias Ringwald 2659711e6c80SMatthias 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){ 266040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2661de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 266240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 266340faeb84SMilanka Ringwald return status; 266440faeb84SMilanka Ringwald } 26653deb3ec6SMatthias Ringwald 26665cf1669fSMatthias Ringwald gatt_client->callback = callback; 26675cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 26685cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2669052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 26703deb3ec6SMatthias Ringwald gatt_client_run(); 267125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26723deb3ec6SMatthias Ringwald } 26733deb3ec6SMatthias Ringwald 2674711e6c80SMatthias 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){ 267540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2676de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 267740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 267840faeb84SMilanka Ringwald return status; 267940faeb84SMilanka Ringwald } 26803deb3ec6SMatthias Ringwald 26815cf1669fSMatthias Ringwald gatt_client->callback = callback; 26825cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 26835cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 26845cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 26855cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 26865cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 26875cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 2688052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 26893deb3ec6SMatthias Ringwald gatt_client_run(); 269025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26913deb3ec6SMatthias Ringwald } 26923deb3ec6SMatthias Ringwald 2693045d700dSDavid 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){ 269440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2695de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 269640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 269740faeb84SMilanka Ringwald return status; 269840faeb84SMilanka Ringwald } 26993deb3ec6SMatthias Ringwald 27005cf1669fSMatthias Ringwald gatt_client->callback = callback; 27015cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 27025cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 27035cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 27045cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 27055cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 27065cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2707052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 27083deb3ec6SMatthias Ringwald gatt_client_run(); 270925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27103deb3ec6SMatthias Ringwald } 27113deb3ec6SMatthias Ringwald 27123deb3ec6SMatthias Ringwald 2713b45b7749SMilanka 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){ 2714b45b7749SMilanka Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 27153deb3ec6SMatthias Ringwald } 27163deb3ec6SMatthias Ringwald 2717b45b7749SMilanka 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){ 271840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2719de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 272040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 272140faeb84SMilanka Ringwald return status; 272240faeb84SMilanka Ringwald } 27233deb3ec6SMatthias Ringwald 27245cf1669fSMatthias Ringwald gatt_client->callback = callback; 2725b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 27265cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2727052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 27283deb3ec6SMatthias Ringwald gatt_client_run(); 272925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27303deb3ec6SMatthias Ringwald } 27313deb3ec6SMatthias Ringwald 2732b45b7749SMilanka 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){ 2733b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0); 27343deb3ec6SMatthias Ringwald } 27353deb3ec6SMatthias Ringwald 2736b45b7749SMilanka 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){ 2737b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 27383deb3ec6SMatthias Ringwald } 27393deb3ec6SMatthias Ringwald 2740f125a8efSMatthias 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){ 274140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2742de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 274340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 274440faeb84SMilanka Ringwald return status; 274540faeb84SMilanka Ringwald } 27463deb3ec6SMatthias Ringwald 2747f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2748f125a8efSMatthias Ringwald if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){ 2749f125a8efSMatthias Ringwald if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){ 2750f125a8efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2751f125a8efSMatthias Ringwald } 2752f125a8efSMatthias Ringwald } 2753f125a8efSMatthias Ringwald #endif 2754f125a8efSMatthias Ringwald 27555cf1669fSMatthias Ringwald gatt_client->callback = callback; 27565cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 27575cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 2758052dc82aSMatthias Ringwald gatt_client->state = state; 27593deb3ec6SMatthias Ringwald gatt_client_run(); 276025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27613deb3ec6SMatthias Ringwald } 27623deb3ec6SMatthias Ringwald 2763f125a8efSMatthias 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){ 2764f125a8efSMatthias Ringwald return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST); 2765f125a8efSMatthias Ringwald } 2766f125a8efSMatthias Ringwald 2767f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2768f125a8efSMatthias 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){ 2769f125a8efSMatthias 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); 2770f125a8efSMatthias Ringwald } 2771f125a8efSMatthias Ringwald #endif 2772f125a8efSMatthias Ringwald 2773de9f8e94SMatthias 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){ 277440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 277540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 277640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 277740faeb84SMilanka Ringwald return status; 277840faeb84SMilanka Ringwald } 27793deb3ec6SMatthias Ringwald 2780dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 27815cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 27823deb3ec6SMatthias Ringwald 27836e7b444cSMatthias Ringwald return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value); 27843deb3ec6SMatthias Ringwald } 27853deb3ec6SMatthias Ringwald 2786b45b7749SMilanka 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){ 278740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2788de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 278940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 279040faeb84SMilanka Ringwald return status; 279140faeb84SMilanka Ringwald } 27923deb3ec6SMatthias Ringwald 27935cf1669fSMatthias Ringwald gatt_client->callback = callback; 27945cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 27955cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 2796b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2797052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 27983deb3ec6SMatthias Ringwald gatt_client_run(); 279925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28003deb3ec6SMatthias Ringwald } 28013deb3ec6SMatthias Ringwald 2802b45b7749SMilanka 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){ 280340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2804de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 280540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 280640faeb84SMilanka Ringwald return status; 280740faeb84SMilanka Ringwald } 28083deb3ec6SMatthias Ringwald 28095cf1669fSMatthias Ringwald gatt_client->callback = callback; 28105cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 28115cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 28125cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2813b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2814052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 28153deb3ec6SMatthias Ringwald gatt_client_run(); 281625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28173deb3ec6SMatthias Ringwald } 28183deb3ec6SMatthias Ringwald 2819711e6c80SMatthias 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){ 28209c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 28213deb3ec6SMatthias Ringwald } 28223deb3ec6SMatthias Ringwald 2823711e6c80SMatthias 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){ 282440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2825de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 282640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 282740faeb84SMilanka Ringwald return status; 282840faeb84SMilanka Ringwald } 28293deb3ec6SMatthias Ringwald 28305cf1669fSMatthias Ringwald gatt_client->callback = callback; 28315cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 28325cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 28335cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 28345cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 2835052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 28363deb3ec6SMatthias Ringwald gatt_client_run(); 283725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28383deb3ec6SMatthias Ringwald } 28393deb3ec6SMatthias Ringwald 2840711e6c80SMatthias 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){ 284140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2842de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 284340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 284440faeb84SMilanka Ringwald return status; 284540faeb84SMilanka Ringwald } 28463deb3ec6SMatthias Ringwald 28478915696fSMilanka Ringwald if (configuration > 3){ 28488915696fSMilanka Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 28498915696fSMilanka Ringwald } 28508915696fSMilanka Ringwald 28513deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 28524ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2853d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2854616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 28553deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 28564ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2857d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2858616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 28593deb3ec6SMatthias Ringwald } 28603deb3ec6SMatthias Ringwald 28615cf1669fSMatthias Ringwald gatt_client->callback = callback; 28625cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 28635cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 28645cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 28653deb3ec6SMatthias Ringwald 2866abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 28675cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2868abdc9fb5SMatthias Ringwald #else 2869052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2870abdc9fb5SMatthias Ringwald #endif 28713deb3ec6SMatthias Ringwald gatt_client_run(); 28729cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 28733deb3ec6SMatthias Ringwald } 28743deb3ec6SMatthias Ringwald 2875711e6c80SMatthias 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){ 287640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2877de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 287840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 287940faeb84SMilanka Ringwald return status; 288040faeb84SMilanka Ringwald } 28813deb3ec6SMatthias Ringwald 28825cf1669fSMatthias Ringwald gatt_client->callback = callback; 28835cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 28843deb3ec6SMatthias Ringwald 2885052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 28863deb3ec6SMatthias Ringwald gatt_client_run(); 288725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28883deb3ec6SMatthias Ringwald } 28893deb3ec6SMatthias Ringwald 2890711e6c80SMatthias 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){ 28919c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 28923deb3ec6SMatthias Ringwald } 28933deb3ec6SMatthias Ringwald 2894711e6c80SMatthias 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){ 289540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2896de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 289740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 289840faeb84SMilanka Ringwald return status; 289940faeb84SMilanka Ringwald } 29003deb3ec6SMatthias Ringwald 29015cf1669fSMatthias Ringwald gatt_client->callback = callback; 29025cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 29035cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2904052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 29053deb3ec6SMatthias Ringwald gatt_client_run(); 290625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29073deb3ec6SMatthias Ringwald } 29083deb3ec6SMatthias Ringwald 2909711e6c80SMatthias 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){ 29109c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 29113deb3ec6SMatthias Ringwald } 29123deb3ec6SMatthias Ringwald 2913711e6c80SMatthias 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){ 29149c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 29153deb3ec6SMatthias Ringwald } 29163deb3ec6SMatthias Ringwald 2917b45b7749SMilanka 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){ 291840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2919de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 292040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 292140faeb84SMilanka Ringwald return status; 292240faeb84SMilanka Ringwald } 29233deb3ec6SMatthias Ringwald 29245cf1669fSMatthias Ringwald gatt_client->callback = callback; 29255cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2926b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 29275cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2928b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2929052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 29303deb3ec6SMatthias Ringwald gatt_client_run(); 293125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29323deb3ec6SMatthias Ringwald } 29333deb3ec6SMatthias Ringwald 293448cdff9cSMilanka 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){ 293548cdff9cSMilanka Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 29363deb3ec6SMatthias Ringwald } 29373deb3ec6SMatthias Ringwald 2938b45b7749SMilanka 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){ 293940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2940de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 294140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 294240faeb84SMilanka Ringwald return status; 294340faeb84SMilanka Ringwald } 29443deb3ec6SMatthias Ringwald 29455cf1669fSMatthias Ringwald gatt_client->callback = callback; 29465cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2947b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 29485cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2949b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2950052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 29513deb3ec6SMatthias Ringwald gatt_client_run(); 295225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29533deb3ec6SMatthias Ringwald } 29543deb3ec6SMatthias Ringwald 2955b45b7749SMilanka 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){ 2956b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value); 29573deb3ec6SMatthias Ringwald } 29583deb3ec6SMatthias Ringwald 2959b45b7749SMilanka 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){ 2960b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 29613deb3ec6SMatthias Ringwald } 29623deb3ec6SMatthias Ringwald 29633deb3ec6SMatthias Ringwald /** 29643deb3ec6SMatthias Ringwald * @brief -> gatt complete event 29653deb3ec6SMatthias Ringwald */ 2966b45b7749SMilanka 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){ 296740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2968de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 296940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 297040faeb84SMilanka Ringwald return status; 297140faeb84SMilanka Ringwald } 29723deb3ec6SMatthias Ringwald 29735cf1669fSMatthias Ringwald gatt_client->callback = callback; 29745cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 2975b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 29765cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2977b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2978052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 29793deb3ec6SMatthias Ringwald gatt_client_run(); 298025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29813deb3ec6SMatthias Ringwald } 29823deb3ec6SMatthias Ringwald 29833deb3ec6SMatthias Ringwald /** 29843deb3ec6SMatthias Ringwald * @brief -> gatt complete event 29853deb3ec6SMatthias Ringwald */ 2986711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 298740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2988de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 298940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 299040faeb84SMilanka Ringwald return status; 299140faeb84SMilanka Ringwald } 29923deb3ec6SMatthias Ringwald 29935cf1669fSMatthias Ringwald gatt_client->callback = callback; 2994052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 29953deb3ec6SMatthias Ringwald gatt_client_run(); 299625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29973deb3ec6SMatthias Ringwald } 29983deb3ec6SMatthias Ringwald 29993deb3ec6SMatthias Ringwald /** 30003deb3ec6SMatthias Ringwald * @brief -> gatt complete event 30013deb3ec6SMatthias Ringwald */ 3002711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 300340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 3004de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 300540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 300640faeb84SMilanka Ringwald return status; 300740faeb84SMilanka Ringwald } 30083deb3ec6SMatthias Ringwald 30095cf1669fSMatthias Ringwald gatt_client->callback = callback; 3010052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 30113deb3ec6SMatthias Ringwald gatt_client_run(); 30127d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 30133deb3ec6SMatthias Ringwald } 30143deb3ec6SMatthias Ringwald 3015313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 30166ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 30176ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 30186ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 30196ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 30206ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 3021c839c6f9SMatthias Ringwald } else { 3022c839c6f9SMatthias Ringwald service->uuid16 = 0; 30236ba2ad22SMatthias Ringwald } 30246ba2ad22SMatthias Ringwald } 30256ba2ad22SMatthias Ringwald 3026313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 30276ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 30286ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 30296ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 30306ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 303186c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 30326ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 30336ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 3034c839c6f9SMatthias Ringwald } else { 3035c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 30366ba2ad22SMatthias Ringwald } 30376ba2ad22SMatthias Ringwald } 30386ba2ad22SMatthias Ringwald 3039313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 30406ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 30416ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 3042b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 3043b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 3044c839c6f9SMatthias Ringwald } else { 3045c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 3046b4895529SJakob Krantz } 30476ba2ad22SMatthias Ringwald } 30485cf6c434SJakob Krantz 30495cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 305040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 305140faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 305240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 305340faeb84SMilanka Ringwald return; 305440faeb84SMilanka Ringwald } 305540faeb84SMilanka Ringwald if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 305640faeb84SMilanka Ringwald gatt_client->callback = callback; 305740faeb84SMilanka Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 30585cf6c434SJakob Krantz gatt_client_run(); 30595cf6c434SJakob Krantz } 30605cf6c434SJakob Krantz } 306147181045SMatthias Ringwald 306259d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 306359d34cd2SMatthias Ringwald gatt_client_t * gatt_client; 306459d34cd2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 306559d34cd2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 306659d34cd2SMatthias Ringwald return status; 306759d34cd2SMatthias Ringwald } 306859d34cd2SMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration); 30692832a98aSMatthias Ringwald if (added == false){ 307059d34cd2SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 30712832a98aSMatthias Ringwald } else { 30722832a98aSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 30732832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 307459d34cd2SMatthias Ringwald } 307559d34cd2SMatthias Ringwald } 307659d34cd2SMatthias Ringwald 307753e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 307853e9c18fSMatthias Ringwald gatt_client_t * gatt_client; 307953e9c18fSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 308053e9c18fSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 308153e9c18fSMatthias Ringwald return status; 308253e9c18fSMatthias Ringwald } 308353e9c18fSMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 30842832a98aSMatthias Ringwald if (added == false){ 308553e9c18fSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 30862832a98aSMatthias Ringwald } else { 30872832a98aSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 30882832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 308953e9c18fSMatthias Ringwald } 309053e9c18fSMatthias Ringwald } 309153e9c18fSMatthias Ringwald 309248553f67SDirk Helbig uint8_t gatt_client_remove_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 309348553f67SDirk Helbig gatt_client_t * gatt_client; 309448553f67SDirk Helbig uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 309548553f67SDirk Helbig if (status != ERROR_CODE_SUCCESS){ 309648553f67SDirk Helbig return status; 309748553f67SDirk Helbig } 309848553f67SDirk Helbig (void)btstack_linked_list_remove(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 309948553f67SDirk Helbig return ERROR_CODE_SUCCESS; 310048553f67SDirk Helbig } 310148553f67SDirk Helbig 310247181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 310340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 310440faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 310540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 310640faeb84SMilanka Ringwald return status; 310740faeb84SMilanka Ringwald } 310840faeb84SMilanka Ringwald if (gatt_client->write_without_response_callback != NULL){ 310940faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 311040faeb84SMilanka Ringwald } 311140faeb84SMilanka Ringwald gatt_client->write_without_response_callback = callback; 311240faeb84SMilanka Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 31137d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 311447181045SMatthias Ringwald } 3115842492f0SMatthias Ringwald 3116842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 311758e8c9f5SMatthias Ringwald void gatt_client_add_service_changed_handler(btstack_packet_callback_registration_t * callback) { 311858e8c9f5SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_service_changed_handler, (btstack_linked_item_t*) callback); 311958e8c9f5SMatthias Ringwald } 3120a6121b51SMilanka Ringwald 312158e8c9f5SMatthias Ringwald void gatt_client_remove_service_changed_handler(btstack_packet_callback_registration_t * callback){ 312258e8c9f5SMatthias Ringwald btstack_linked_list_remove(&gatt_client_service_changed_handler, (btstack_linked_item_t*) callback); 312358e8c9f5SMatthias Ringwald } 3124842492f0SMatthias Ringwald #endif 31257627a0deSMatthias Ringwald 31267627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT) 31271450cdc6SMatthias Ringwald 31281450cdc6SMatthias Ringwald #include "hci_event.h" 31291450cdc6SMatthias Ringwald 31301450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = { 3131b2d70d58SMatthias Ringwald GATT_EVENT_CONNECTED, 0, "11BH" 31321450cdc6SMatthias Ringwald }; 31331450cdc6SMatthias Ringwald 31346b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = { 31356b4a68c3SMatthias Ringwald GATT_EVENT_DISCONNECTED, 0, "H" 31366b4a68c3SMatthias Ringwald }; 31371c7a19feSMatthias Ringwald 3138b2d70d58SMatthias Ringwald static void 3139b2d70d58SMatthias Ringwald gatt_client_emit_connected(btstack_packet_handler_t callback, uint8_t status, bd_addr_type_t addr_type, bd_addr_t addr, 31401c7a19feSMatthias Ringwald hci_con_handle_t con_handle) { 31411c7a19feSMatthias Ringwald uint8_t buffer[20]; 31421c7a19feSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, con_handle); 31431c7a19feSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 31441c7a19feSMatthias Ringwald } 31451c7a19feSMatthias Ringwald 31467627a0deSMatthias Ringwald #endif 31477627a0deSMatthias Ringwald 31487627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 31497627a0deSMatthias Ringwald 31507627a0deSMatthias Ringwald #include "bluetooth_psm.h" 31517627a0deSMatthias Ringwald 31527627a0deSMatthias Ringwald // single active SDP query 31537627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query; 31547627a0deSMatthias Ringwald 31557627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes 31567627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32]; 31577627a0deSMatthias Ringwald 31586b4a68c3SMatthias Ringwald 31591450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){ 31601450cdc6SMatthias Ringwald btstack_linked_item_t *it; 31611450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 31621450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 31631450cdc6SMatthias Ringwald if (memcmp(gatt_client->addr, addr, 6) == 0){ 31641450cdc6SMatthias Ringwald return gatt_client; 31651450cdc6SMatthias Ringwald } 31661450cdc6SMatthias Ringwald } 31671450cdc6SMatthias Ringwald return NULL; 31681450cdc6SMatthias Ringwald } 31691450cdc6SMatthias Ringwald 31701450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){ 31711450cdc6SMatthias Ringwald btstack_linked_item_t *it; 31721450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 31731450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 31741450cdc6SMatthias Ringwald if (gatt_client->l2cap_cid == l2cap_cid){ 31751450cdc6SMatthias Ringwald return gatt_client; 31761450cdc6SMatthias Ringwald } 31771450cdc6SMatthias Ringwald } 31781450cdc6SMatthias Ringwald return NULL; 31791450cdc6SMatthias Ringwald } 31801450cdc6SMatthias Ringwald 31811450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){ 3182b2d70d58SMatthias Ringwald // cache peer information 31831450cdc6SMatthias Ringwald bd_addr_t addr; 3184d5529700SMatthias Ringwald // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy 31851450cdc6SMatthias Ringwald memcpy(addr, gatt_client->addr, 6); 3186b2d70d58SMatthias Ringwald bd_addr_type_t addr_type = gatt_client->addr_type; 3187b2d70d58SMatthias Ringwald gatt_client->addr_type = BD_ADDR_TYPE_ACL; 31881450cdc6SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 31891450cdc6SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 3190b2d70d58SMatthias Ringwald 31919ed6f53cSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 31923b0e0cc5SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 31933b0e0cc5SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 31943b0e0cc5SMatthias Ringwald } 3195b2d70d58SMatthias Ringwald 3196b2d70d58SMatthias Ringwald gatt_client_emit_connected(callback, status, addr_type, addr, con_handle); 31971450cdc6SMatthias Ringwald } 31981450cdc6SMatthias Ringwald 3199180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts){ 3200180cbe79SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 3201180cbe79SMatthias Ringwald if (gatt_client != NULL){ 3202180cbe79SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 3203180cbe79SMatthias Ringwald att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 3204180cbe79SMatthias Ringwald } 3205180cbe79SMatthias Ringwald } 3206180cbe79SMatthias Ringwald 32076b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){ 32086b4a68c3SMatthias Ringwald 32096b4a68c3SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 32106b4a68c3SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 32116b4a68c3SMatthias Ringwald 32126b4a68c3SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 32136b4a68c3SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 32146b4a68c3SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 32156b4a68c3SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 32166b4a68c3SMatthias Ringwald 32176b4a68c3SMatthias Ringwald uint8_t buffer[20]; 32186b4a68c3SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle); 32196b4a68c3SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 32206b4a68c3SMatthias Ringwald } 32216b4a68c3SMatthias Ringwald 32221450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){ 32231450cdc6SMatthias Ringwald des_iterator_t des_list_it; 32241450cdc6SMatthias Ringwald des_iterator_t prot_it; 32251450cdc6SMatthias Ringwald 32261450cdc6SMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) { 32271450cdc6SMatthias Ringwald gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 32281450cdc6SMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 32291450cdc6SMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 32301450cdc6SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: 32311450cdc6SMatthias 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)) { 32321450cdc6SMatthias Ringwald uint8_t *des_element; 32331450cdc6SMatthias Ringwald uint8_t *element; 32341450cdc6SMatthias Ringwald uint32_t uuid; 32351450cdc6SMatthias Ringwald 32361450cdc6SMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 32371450cdc6SMatthias Ringwald 32381450cdc6SMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 32391450cdc6SMatthias Ringwald des_iterator_init(&prot_it, des_element); 32401450cdc6SMatthias Ringwald element = des_iterator_get_element(&prot_it); 32411450cdc6SMatthias Ringwald 32421450cdc6SMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 32431450cdc6SMatthias Ringwald 32441450cdc6SMatthias Ringwald uuid = de_get_uuid32(element); 32451450cdc6SMatthias Ringwald des_iterator_next(&prot_it); 32461450cdc6SMatthias Ringwald // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both 32471450cdc6SMatthias Ringwald switch (uuid){ 32481450cdc6SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 32491450cdc6SMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 32501450cdc6SMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm); 32511450cdc6SMatthias Ringwald break; 32521450cdc6SMatthias Ringwald default: 32531450cdc6SMatthias Ringwald break; 32541450cdc6SMatthias Ringwald } 32551450cdc6SMatthias Ringwald } 32561450cdc6SMatthias Ringwald break; 32571450cdc6SMatthias Ringwald 32581450cdc6SMatthias Ringwald default: 32591450cdc6SMatthias Ringwald break; 32601450cdc6SMatthias Ringwald } 32611450cdc6SMatthias Ringwald } 32621450cdc6SMatthias Ringwald } 32631450cdc6SMatthias Ringwald } 32641450cdc6SMatthias Ringwald 32651450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 32661450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query; 32671450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 32681450cdc6SMatthias Ringwald uint8_t status; 32691450cdc6SMatthias Ringwald 32701450cdc6SMatthias Ringwald // TODO: handle sdp events, get l2cap psm 32711450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 32721450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 32731450cdc6SMatthias Ringwald gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet); 32741450cdc6SMatthias Ringwald // TODO: 32751450cdc6SMatthias Ringwald return; 32761450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 32771450cdc6SMatthias Ringwald status = sdp_event_query_complete_get_status(packet); 32781450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = NULL; 32791450cdc6SMatthias Ringwald log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status); 32801450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) break; 32811450cdc6SMatthias Ringwald if (gatt_client->l2cap_psm == 0) { 32821450cdc6SMatthias Ringwald status = SDP_SERVICE_NOT_FOUND; 32831450cdc6SMatthias Ringwald break; 32841450cdc6SMatthias Ringwald } 32851450cdc6SMatthias Ringwald break; 32861450cdc6SMatthias Ringwald default: 32871450cdc6SMatthias Ringwald btstack_assert(false); 32881450cdc6SMatthias Ringwald return; 32891450cdc6SMatthias Ringwald } 32901450cdc6SMatthias Ringwald 32911450cdc6SMatthias Ringwald // done 32921450cdc6SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3293052dc82aSMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 329459b5e157SMatthias Ringwald status = att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 32951450cdc6SMatthias Ringwald } 32961450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) { 32971450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 32981450cdc6SMatthias Ringwald } 32991450cdc6SMatthias Ringwald } 33001450cdc6SMatthias Ringwald 33011450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){ 33021450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = (gatt_client_t *) context; 3303052dc82aSMatthias Ringwald gatt_client_classic_active_sdp_query->state = P_W4_SDP_QUERY; 33041450cdc6SMatthias Ringwald sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 33051450cdc6SMatthias Ringwald } 33061450cdc6SMatthias Ringwald 330774daebdeSMatthias Ringwald static void gatt_client_classic_emit_connected(void * context){ 330874daebdeSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) context; 3309052dc82aSMatthias Ringwald gatt_client->state = P_READY; 3310b2d70d58SMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, ERROR_CODE_SUCCESS, gatt_client->addr_type, gatt_client->addr, gatt_client->con_handle); 331174daebdeSMatthias Ringwald } 331274daebdeSMatthias Ringwald 33131450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){ 33141450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr); 33151450cdc6SMatthias Ringwald if (gatt_client != NULL){ 33161450cdc6SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 33171450cdc6SMatthias Ringwald } 33181450cdc6SMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 33191450cdc6SMatthias Ringwald if (gatt_client == NULL){ 33201450cdc6SMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 33211450cdc6SMatthias Ringwald } 33221450cdc6SMatthias Ringwald // init state 3323e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC; 33241450cdc6SMatthias Ringwald gatt_client->con_handle = HCI_CON_HANDLE_INVALID; 33251450cdc6SMatthias Ringwald memcpy(gatt_client->addr, addr, 6); 3326b2d70d58SMatthias Ringwald gatt_client->addr_type = BD_ADDR_TYPE_ACL; 33271450cdc6SMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 33281450cdc6SMatthias Ringwald gatt_client->security_level = LEVEL_0; 33291450cdc6SMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 33301450cdc6SMatthias Ringwald gatt_client->callback = callback; 3331cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3332cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3333cbd76cecSMatthias Ringwald #endif 33341450cdc6SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 333574daebdeSMatthias Ringwald 333674daebdeSMatthias Ringwald // schedule emitted event if already connected, otherwise 333774daebdeSMatthias Ringwald bool already_connected = false; 333874daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 333974daebdeSMatthias Ringwald if (hci_connection != NULL){ 334074daebdeSMatthias Ringwald if (hci_connection->att_server.l2cap_cid != 0){ 334174daebdeSMatthias Ringwald already_connected = true; 334274daebdeSMatthias Ringwald } 334374daebdeSMatthias Ringwald } 3344052dc82aSMatthias Ringwald gatt_client->callback_request.context = gatt_client; 334574daebdeSMatthias Ringwald if (already_connected){ 334674daebdeSMatthias Ringwald gatt_client->con_handle = hci_connection->con_handle; 3347052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_emit_connected; 3348052dc82aSMatthias Ringwald gatt_client->state = P_W2_EMIT_CONNECTED; 3349052dc82aSMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client->callback_request); 335074daebdeSMatthias Ringwald } else { 3351052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_sdp_start; 3352052dc82aSMatthias Ringwald gatt_client->state = P_W2_SDP_QUERY; 3353052dc82aSMatthias Ringwald sdp_client_register_query_callback(&gatt_client->callback_request); 335474daebdeSMatthias Ringwald } 3355b7b03a30SMatthias Ringwald return ERROR_CODE_SUCCESS; 33561450cdc6SMatthias Ringwald } 33571450cdc6SMatthias Ringwald 33581450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 33591450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 33601450cdc6SMatthias Ringwald if (gatt_client == NULL){ 33611450cdc6SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 33621450cdc6SMatthias Ringwald } 33631450cdc6SMatthias Ringwald gatt_client->callback = callback; 33641450cdc6SMatthias Ringwald return l2cap_disconnect(gatt_client->l2cap_cid); 33651450cdc6SMatthias Ringwald } 33661450cdc6SMatthias Ringwald #endif 33671450cdc6SMatthias Ringwald 336826166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 336926166ecfSMatthias Ringwald 337026166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5 33717627a0deSMatthias Ringwald 33727627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 33737627a0deSMatthias Ringwald 3374df0a5c68SMatthias Ringwald static uint8_t gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client_t * gatt_client, gatt_client_state_t state){ 3375df0a5c68SMatthias Ringwald uint8_t num_clients = 0; 3376df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3377df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 3378df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 3379df0a5c68SMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3380df0a5c68SMatthias Ringwald if (eatt_client->state == state){ 3381df0a5c68SMatthias Ringwald num_clients++; 3382df0a5c68SMatthias Ringwald } 3383df0a5c68SMatthias Ringwald } 3384df0a5c68SMatthias Ringwald return num_clients; 3385df0a5c68SMatthias Ringwald } 3386df0a5c68SMatthias Ringwald 33877627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) { 33887627a0deSMatthias Ringwald // free eatt clients 33897627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 33907627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 33917627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 33927627a0deSMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 33937627a0deSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 33947627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 33957627a0deSMatthias Ringwald } 33967627a0deSMatthias Ringwald } 33977627a0deSMatthias Ringwald 33987627a0deSMatthias Ringwald // all channels connected 33997627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) { 34007627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3401df0a5c68SMatthias Ringwald uint8_t num_ready = gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_READY); 3402df0a5c68SMatthias Ringwald if (num_ready > 0){ 34037627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READY; 3404df0a5c68SMatthias Ringwald // free unused channels 3405df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3406df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 3407df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 3408df0a5c68SMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3409df0a5c68SMatthias Ringwald if (eatt_client->state == P_L2CAP_CLOSED){ 3410df0a5c68SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 3411df0a5c68SMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 3412df0a5c68SMatthias Ringwald } 3413df0a5c68SMatthias Ringwald } 3414df0a5c68SMatthias Ringwald } else { 34156d0f6f49SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 34166d0f6f49SMatthias Ringwald btstack_assert(hci_connection != NULL); 34176d0f6f49SMatthias Ringwald if (hci_connection->att_server.incoming_connection_request){ 34186d0f6f49SMatthias Ringwald hci_connection->att_server.incoming_connection_request = false; 34196d0f6f49SMatthias Ringwald log_info("Collision, retry in 100ms"); 34206d0f6f49SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 34216d0f6f49SMatthias Ringwald // set timer for retry 3422b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 34236d0f6f49SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_le_enhanced_retry); 34246d0f6f49SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 34256d0f6f49SMatthias Ringwald return; 34266d0f6f49SMatthias Ringwald } else { 3427df0a5c68SMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3428df0a5c68SMatthias Ringwald status = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 3429df0a5c68SMatthias Ringwald } 34306d0f6f49SMatthias Ringwald } 34317627a0deSMatthias Ringwald } else { 34327627a0deSMatthias Ringwald gatt_client_eatt_finalize(gatt_client); 34337627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 34347627a0deSMatthias Ringwald } 34357627a0deSMatthias Ringwald 3436b2d70d58SMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, status, gatt_client->addr_type, gatt_client->addr, gatt_client->con_handle); 34377627a0deSMatthias Ringwald } 34387627a0deSMatthias Ringwald 34397627a0deSMatthias Ringwald // single channel disconnected 34407627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) { 34417627a0deSMatthias Ringwald 34427627a0deSMatthias Ringwald // report error 34437627a0deSMatthias Ringwald gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 34447627a0deSMatthias Ringwald 34457627a0deSMatthias Ringwald // free memory 34467627a0deSMatthias Ringwald btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client); 34477627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 34487627a0deSMatthias Ringwald 3449570bdd2dSMatthias Ringwald // last channel 34507627a0deSMatthias Ringwald if (btstack_linked_list_empty(&gatt_client->eatt_clients)){ 3451570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 3452570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = false; 3453570bdd2dSMatthias Ringwald 3454570bdd2dSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) { 3455570bdd2dSMatthias Ringwald // report disconnected if last channel closed 34567627a0deSMatthias Ringwald uint8_t buffer[20]; 34577627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle); 34587627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 34597627a0deSMatthias Ringwald } 34607627a0deSMatthias Ringwald } 34617627a0deSMatthias Ringwald } 34627627a0deSMatthias Ringwald 34637627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){ 34647627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 34657627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 34667627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 34677627a0deSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 34687627a0deSMatthias Ringwald btstack_linked_list_iterator_t it2; 34697627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients); 34707627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it2)) { 34717627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2); 34727627a0deSMatthias Ringwald if (eatt_client->l2cap_cid == l2cap_cid){ 34737627a0deSMatthias Ringwald *out_eatt_client = eatt_client; 34747627a0deSMatthias Ringwald return gatt_client; 34757627a0deSMatthias Ringwald } 34767627a0deSMatthias Ringwald } 34777627a0deSMatthias Ringwald } 34787627a0deSMatthias Ringwald return NULL; 34797627a0deSMatthias Ringwald } 34807627a0deSMatthias Ringwald 34817627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){ 34827627a0deSMatthias Ringwald uint8_t num_channels = gatt_client->eatt_num_clients; 34837627a0deSMatthias Ringwald 34847627a0deSMatthias Ringwald // setup channels 34857627a0deSMatthias Ringwald uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels; 3486f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 34877627a0deSMatthias Ringwald uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS]; 34887627a0deSMatthias Ringwald uint16_t new_cids[MAX_NR_EATT_CHANNELS]; 34897627a0deSMatthias Ringwald memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size); 34907627a0deSMatthias Ringwald uint8_t i; 34917627a0deSMatthias Ringwald for (i=0;i<gatt_client->eatt_num_clients; i++){ 3492f7a42e72SMatthias Ringwald receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER]; 3493f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu; 34947627a0deSMatthias Ringwald } 34957627a0deSMatthias Ringwald 34967627a0deSMatthias Ringwald log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client); 34977627a0deSMatthias Ringwald 3498f7a42e72SMatthias Ringwald uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler, 3499f7a42e72SMatthias Ringwald gatt_client->con_handle, 35007627a0deSMatthias Ringwald gatt_client->security_level, 3501f7a42e72SMatthias Ringwald BLUETOOTH_PSM_EATT, num_channels, 3502f7a42e72SMatthias Ringwald L2CAP_LE_AUTOMATIC_CREDITS, 35037627a0deSMatthias Ringwald buffer_size_per_client, 3504f7a42e72SMatthias Ringwald receive_buffers, 3505f7a42e72SMatthias Ringwald new_cids); 35067627a0deSMatthias Ringwald 35077627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 35087627a0deSMatthias Ringwald i = 0; 35097627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 35107627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 35117627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 35127627a0deSMatthias Ringwald gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 35137627a0deSMatthias Ringwald 35147627a0deSMatthias Ringwald // init state with new cid and transmit buffer 35157627a0deSMatthias Ringwald new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE; 35167627a0deSMatthias Ringwald new_eatt_client->con_handle = gatt_client->con_handle; 35177627a0deSMatthias Ringwald new_eatt_client->mtu = 64; 35187627a0deSMatthias Ringwald new_eatt_client->security_level = LEVEL_0; 35197627a0deSMatthias Ringwald new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 3520052dc82aSMatthias Ringwald new_eatt_client->state = P_W4_L2CAP_CONNECTION; 35217627a0deSMatthias Ringwald new_eatt_client->l2cap_cid = new_cids[i]; 35227627a0deSMatthias Ringwald new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer; 3523f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += max_mtu; 35247627a0deSMatthias Ringwald i++; 35257627a0deSMatthias Ringwald } 35267627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP; 35277627a0deSMatthias Ringwald } else { 35287627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, status); 35297627a0deSMatthias Ringwald } 353026166ecfSMatthias Ringwald } 353126166ecfSMatthias Ringwald 35326d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts){ 35336d0f6f49SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 35346d0f6f49SMatthias Ringwald if (gatt_client != NULL){ 35356d0f6f49SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 35366d0f6f49SMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 35376d0f6f49SMatthias Ringwald } 35386d0f6f49SMatthias Ringwald } 35396d0f6f49SMatthias Ringwald 354026166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 35417627a0deSMatthias Ringwald gatt_client_t *gatt_client; 35427627a0deSMatthias Ringwald gatt_client_t *eatt_client; 354326166ecfSMatthias Ringwald hci_con_handle_t con_handle; 35447627a0deSMatthias Ringwald uint16_t l2cap_cid; 354526166ecfSMatthias Ringwald uint8_t status; 354626166ecfSMatthias Ringwald gatt_client_characteristic_t characteristic; 35477627a0deSMatthias Ringwald gatt_client_service_t service; 354826166ecfSMatthias Ringwald switch (packet_type) { 354926166ecfSMatthias Ringwald case HCI_EVENT_PACKET: 355026166ecfSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 35517627a0deSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 35527627a0deSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 35537627a0deSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 35547627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 35557627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE); 35567627a0deSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 35577627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 35587627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 35597627a0deSMatthias Ringwald break; 356026166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 356126166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 356226166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 356326166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 35647627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE); 356526166ecfSMatthias Ringwald if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) { 35667627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0]; 356726166ecfSMatthias Ringwald } 356826166ecfSMatthias Ringwald break; 356926166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 357026166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 357126166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 357226166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 35737627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE); 35747627a0deSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 357526166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = characteristic.value_handle; 357626166ecfSMatthias Ringwald break; 357726166ecfSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 357826166ecfSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 357926166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 358026166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 35817627a0deSMatthias Ringwald switch (gatt_client->eatt_state){ 35827627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE: 35837627a0deSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle == 0){ 35847627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 35857627a0deSMatthias Ringwald } else { 35867627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND; 35877627a0deSMatthias Ringwald } 35887627a0deSMatthias Ringwald break; 35897627a0deSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE: 35907627a0deSMatthias Ringwald if ((gatt_client->gatt_server_supported_features & 1) == 0) { 35917627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 35927627a0deSMatthias Ringwald } else { 35937627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND; 35947627a0deSMatthias Ringwald } 35957627a0deSMatthias Ringwald break; 35967627a0deSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE: 35977627a0deSMatthias Ringwald if (gatt_client->gatt_client_supported_features_handle == 0){ 35987627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 35997627a0deSMatthias Ringwald } else { 36007627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND; 36017627a0deSMatthias Ringwald } 36027627a0deSMatthias Ringwald break; 36037627a0deSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE: 36047627a0deSMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 360526166ecfSMatthias Ringwald break; 360626166ecfSMatthias Ringwald default: 360726166ecfSMatthias Ringwald break; 360826166ecfSMatthias Ringwald } 360926166ecfSMatthias Ringwald break; 36107627a0deSMatthias Ringwald case L2CAP_EVENT_ECBM_CHANNEL_OPENED: 36117627a0deSMatthias Ringwald l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet); 36127627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 36137627a0deSMatthias Ringwald 36147627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 36157627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 3616052dc82aSMatthias Ringwald btstack_assert(eatt_client->state == P_W4_L2CAP_CONNECTION); 36177627a0deSMatthias Ringwald 36187627a0deSMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 36197627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3620052dc82aSMatthias Ringwald eatt_client->state = P_READY; 36217627a0deSMatthias Ringwald eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 36227627a0deSMatthias Ringwald } else { 3623df0a5c68SMatthias Ringwald eatt_client->state = P_L2CAP_CLOSED; 36247627a0deSMatthias Ringwald } 3625df0a5c68SMatthias Ringwald // connected if opened event for all channels received 3626df0a5c68SMatthias Ringwald if (gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_W4_L2CAP_CONNECTION) == 0){ 36277627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS); 36287627a0deSMatthias Ringwald } 36297627a0deSMatthias Ringwald break; 36307627a0deSMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 36317627a0deSMatthias Ringwald l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet); 36327627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 36337627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 36347627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 36357627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 36367627a0deSMatthias Ringwald break; 36377627a0deSMatthias Ringwald default: 36387627a0deSMatthias Ringwald break; 36397627a0deSMatthias Ringwald } 36407627a0deSMatthias Ringwald break; 36417627a0deSMatthias Ringwald case L2CAP_DATA_PACKET: 36427627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client); 36437627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 3644ce82ac7fSMatthias Ringwald btstack_assert(eatt_client != NULL); 3645ce82ac7fSMatthias Ringwald gatt_client_handle_att_response(eatt_client, packet, size); 36467627a0deSMatthias Ringwald gatt_client_run(); 36477627a0deSMatthias Ringwald break; 364826166ecfSMatthias Ringwald default: 364926166ecfSMatthias Ringwald break; 365026166ecfSMatthias Ringwald } 365126166ecfSMatthias Ringwald } 365226166ecfSMatthias Ringwald 36537627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){ 365426166ecfSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 365526166ecfSMatthias Ringwald uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications 365626166ecfSMatthias Ringwald switch (gatt_client->eatt_state){ 36577627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND: 36587627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = 0; 36597627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE; 36607627a0deSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler, 36617627a0deSMatthias Ringwald gatt_client->con_handle, 36627627a0deSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 36637627a0deSMatthias Ringwald break; 366426166ecfSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND: 36657627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = 0; 36667627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE; 366726166ecfSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler, 36687627a0deSMatthias Ringwald gatt_client->con_handle, 36697627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 36707627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 367126166ecfSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES); 367226166ecfSMatthias Ringwald return true; 367326166ecfSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND: 36747627a0deSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = 0; 36757627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE; 367626166ecfSMatthias Ringwald status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler, 36777627a0deSMatthias Ringwald gatt_client->con_handle, 36787627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 36797627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 36807627a0deSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES); 368126166ecfSMatthias Ringwald return true; 368226166ecfSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND: 368326166ecfSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE; 368426166ecfSMatthias Ringwald status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle, 368526166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle, 1, 368626166ecfSMatthias Ringwald &gatt_client_supported_features); 368726166ecfSMatthias Ringwald return true; 368826166ecfSMatthias Ringwald default: 368926166ecfSMatthias Ringwald break; 369026166ecfSMatthias Ringwald } 36917627a0deSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 36927627a0deSMatthias Ringwald UNUSED(status); 369326166ecfSMatthias Ringwald return false; 369426166ecfSMatthias Ringwald } 369526166ecfSMatthias Ringwald 369626166ecfSMatthias 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) { 369726166ecfSMatthias Ringwald gatt_client_t * gatt_client; 369826166ecfSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 369926166ecfSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 370026166ecfSMatthias Ringwald return status; 370126166ecfSMatthias Ringwald } 370226166ecfSMatthias Ringwald 370326166ecfSMatthias Ringwald if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){ 370426166ecfSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 370526166ecfSMatthias Ringwald } 370626166ecfSMatthias Ringwald 3707f7a42e72SMatthias Ringwald // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports 37087627a0deSMatthias Ringwald uint16_t buffer_size_per_client = storage_size / num_channels; 3709f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 3710f7a42e72SMatthias Ringwald if (max_mtu < 64) { 37117627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 37127627a0deSMatthias Ringwald } 37137627a0deSMatthias Ringwald 37147627a0deSMatthias Ringwald if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){ 37157627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 37167627a0deSMatthias Ringwald } 37177627a0deSMatthias Ringwald 37187627a0deSMatthias Ringwald // create max num_channel eatt clients 37197627a0deSMatthias Ringwald uint8_t i; 37207627a0deSMatthias Ringwald btstack_linked_list_t eatt_clients = NULL; 37217627a0deSMatthias Ringwald for (i=0;i<num_channels;i++) { 37227627a0deSMatthias Ringwald gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get(); 37237627a0deSMatthias Ringwald if (new_gatt_client == NULL) { 37247627a0deSMatthias Ringwald break; 37257627a0deSMatthias Ringwald } 37267627a0deSMatthias Ringwald btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client); 37277627a0deSMatthias Ringwald } 37287627a0deSMatthias Ringwald 37297627a0deSMatthias Ringwald if (i != num_channels){ 37307627a0deSMatthias Ringwald while (true){ 37317627a0deSMatthias Ringwald gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients); 37327627a0deSMatthias Ringwald if (gatt_client == NULL) { 37337627a0deSMatthias Ringwald break; 37347627a0deSMatthias Ringwald } 37357627a0deSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 37367627a0deSMatthias Ringwald } 37377627a0deSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 37387627a0deSMatthias Ringwald } 37397627a0deSMatthias Ringwald 3740570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 3741570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = true; 3742570bdd2dSMatthias Ringwald 37437627a0deSMatthias Ringwald gatt_client->callback = callback; 37447627a0deSMatthias Ringwald gatt_client->eatt_num_clients = num_channels; 37457627a0deSMatthias Ringwald gatt_client->eatt_storage_buffer = storage_buffer; 37467627a0deSMatthias Ringwald gatt_client->eatt_storage_size = storage_size; 37477627a0deSMatthias Ringwald gatt_client->eatt_clients = eatt_clients; 37487627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND; 374926166ecfSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 375026166ecfSMatthias Ringwald 375126166ecfSMatthias Ringwald return ERROR_CODE_SUCCESS; 375226166ecfSMatthias Ringwald } 375326166ecfSMatthias Ringwald 375426166ecfSMatthias Ringwald #endif 375526166ecfSMatthias Ringwald 3756a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 3757a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 3758a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 3759a6121b51SMilanka Ringwald } 3760ae1ee62dSMilanka Ringwald 376140faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 376240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client); 376340faeb84SMilanka Ringwald return status; 3764ae1ee62dSMilanka Ringwald } 3765a6121b51SMilanka Ringwald #endif 3766